diff --git a/.cocciconfig b/.cocciconfig
old mode 100644
new mode 100755
diff --git a/.get_maintainer.ignore b/.get_maintainer.ignore
old mode 100644
new mode 100755
diff --git a/.gitattributes b/.gitattributes
old mode 100644
new mode 100755
diff --git a/.gitignore b/.gitignore
old mode 100644
new mode 100755
diff --git a/.mailmap b/.mailmap
old mode 100644
new mode 100755
diff --git a/Documentation/devicetree/bindings/drm/msm/mdss-dsi-panel.txt b/Documentation/devicetree/bindings/drm/msm/mdss-dsi-panel.txt
index c8fb809a5a0fd380e1e11195f5e6ba6b81f8837b..697ff8672a9dede52964044a52c410e35eb1c26c 100644
--- a/Documentation/devicetree/bindings/drm/msm/mdss-dsi-panel.txt
+++ b/Documentation/devicetree/bindings/drm/msm/mdss-dsi-panel.txt
@@ -164,10 +164,7 @@ Optional properties:
 					"dfps_immediate_porch_mode_vfp" = FPS change request is
 					implemented immediately by changing panel vertical
 					front porch values.
-- qcom,min-refresh-rate:		Minimum refresh rate supported by the panel.
-- qcom,max-refresh-rate:		Maximum refresh rate supported by the panel. If max refresh
-					rate is not specified, then the frame rate of the panel in
-					qcom,mdss-dsi-panel-framerate is used.
+- qcom,dsi-supported-dfps-list:		List containing all the supported refresh rates.
 - qcom,mdss-dsi-bl-pmic-control-type:	A string that specifies the implementation of backlight
 					control for this panel.
 					"bl_ctrl_pwm" = Backlight controlled by PWM gpio.
@@ -545,6 +542,10 @@ Optional properties:
 - qcom,mdss-dsi-ext-bridge-mode:	External bridge chip is connected instead of panel.
 - qcom,mdss-dsi-dma-schedule-line:	An integer value indicates the line number after vertical active
 					region, at which command DMA needs to be triggered.
+- qcom,dsi-dyn-clk-enable:		Boolean to indicate dsi dynamic clock switch feature
+					is supported.
+- qcom,dsi-dyn-clk-list:		An u32 array which lists all the supported dsi bit clock
+					frequencies in Hz for the given panel.
 
 Required properties for sub-nodes:	None
 Optional properties:
@@ -669,8 +670,7 @@ Example:
 		qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_wled";
 		qcom,mdss-dsi-pan-enable-dynamic-fps;
 		qcom,mdss-dsi-pan-fps-update = "dfps_suspend_resume_mode";
-		qcom,min-refresh-rate = <30>;
-		qcom,max-refresh-rate = <60>;
+		qcom,dsi-supported-dfps-list = <48 55 60>;
 		qcom,mdss-dsi-bl-pmic-bank-select = <0>;
 		qcom,mdss-dsi-bl-pmic-pwm-frequency = <0>;
 		qcom,mdss-dsi-pwm-gpio = <&pm8941_mpps 5 0>;
@@ -807,5 +807,7 @@ Example:
 			                <2 2 1>;
 		qcom,default-topology-index = <0>;
 		qcom,mdss-dsi-dma-schedule-line = <5>;
+		qcom,dsi-dyn-clk-enable;
+		qcom,dsi-dyn-clk-list = <798240576 801594528 804948480>;
 	};
 };
diff --git a/Documentation/devicetree/bindings/input/tri_state_key.txt b/Documentation/devicetree/bindings/input/tri_state_key.txt
new file mode 100644
index 0000000000000000000000000000000000000000..37f9d47a8da8008252d6270130ff650661c97493
--- /dev/null
+++ b/Documentation/devicetree/bindings/input/tri_state_key.txt
@@ -0,0 +1,21 @@
+Tri-state key
+
+Required Properties:
+- compatible:			Must be "ompatible = "oneplus,tri-state-key".
+
+
+Example:
+
+		tri_state_key {
+		compatible = "oneplus, tri-state-key";
+		status = "okay";
+		interrupt-parent = <&tlmm>;
+		tristate,gpio_key1 = <&tlmm 125 0x00>;
+		tristate,gpio_key2 = <&tlmm 134 0x00>;
+		tristate,gpio_key3 = <&tlmm 27 0x00>;
+		pinctrl-names =
+				"pmx_tri_state_key_active",
+				"pmx_tri_state_key_suspend";
+		pinctrl-0 = <&tri_state_key_active>;
+		pinctrl-1 = <&tri_state_key_suspend>;
+	};
diff --git a/Documentation/devicetree/bindings/sound/tfa98xx.txt b/Documentation/devicetree/bindings/sound/tfa98xx.txt
new file mode 100644
index 0000000000000000000000000000000000000000..cf43fd717d5ba4f333b18b85267eb3b48e9403fe
--- /dev/null
+++ b/Documentation/devicetree/bindings/sound/tfa98xx.txt
@@ -0,0 +1,23 @@
+Tfa98xx device
+
+Required Properties
+- compatible		Must be "compatible = "nxp,tfa98xx".
+
+Example:
+
+
+	&qupv3_se4_i2c {
+	tfa98xx_right: tfa98xx_right@34 {
+			       compatible = "nxp,tfa98xx";
+			       reg = <0x34>;
+			       reset-gpio = <&tlmm 37 0>;
+			       status = "ok";
+		       };
+
+	tfa98xx_left: tfa98xx_left@35 {
+			      compatible = "nxp,tfa98xx";
+			      reg = <0x35>;
+			      reset-gpio = <&tlmm 37 0>;
+			      status = "ok";
+		      };
+	};
diff --git a/arch/arm64/boot/dts/qcom/Makefile b/arch/arm64/boot/dts/qcom/Makefile
index ef8c3fd46c3f29853d0511a667f567f04221ad4e..64a51025791965878ed58d8265dea687e53f9ba5 100644
--- a/arch/arm64/boot/dts/qcom/Makefile
+++ b/arch/arm64/boot/dts/qcom/Makefile
@@ -1,4 +1,5 @@
 # SPDX-License-Identifier: GPL-2.0
+ifeq ($(CONFIG_BUILD_ARM64_DT_OVERLAY_QCOM),y)
 dtb-$(CONFIG_ARCH_QCOM)	+= apq8016-sbc.dtb
 dtb-$(CONFIG_ARCH_QCOM)	+= apq8096-db820c.dtb
 dtb-$(CONFIG_ARCH_QCOM)	+= ipq8074-hk01.dtb
@@ -61,6 +62,28 @@ sm8150-sdx50m-mtp-2.5k-panel-overlay.dtbo-base := sm8150.dtb sm8150-v2.dtb sm815
 sm8150-sdx50m-qrd-overlay.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
 sm8150-sdxprairie-cdp-overlay.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
 sm8150-sdxprairie-mtp-overlay.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+endif
+endif
+
+ifeq ($(CONFIG_BUILD_ARM64_DT_OVERLAY),y)
+	dtbo-$(CONFIG_ARCH_SM8150) += \
+		sm8150-mtp-overlay.dtbo \
+		guacamole-overlay-t0.dtbo \
+		guacamole-overlay-evt1.dtbo \
+		guacamole-overlay-evt2.dtbo \
+		guacamole-overlay-evt2-second.dtbo \
+		guacamole-overlay-evt3.dtbo \
+		guacamole-overlay-dvt.dtbo \
+		guacamole-overlay-pvt.dtbo
+
+sm8150-mtp-overlay.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-t0.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-evt1.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-evt2.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-evt2-second.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-evt3.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-dvt.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
+guacamole-overlay-pvt.dtbo-base := sm8150.dtb sm8150-v2.dtb sm8150p.dtb sm8150p-v2.dtb
 else
 dtb-$(CONFIG_ARCH_SM8150)	+= sm8150-rumi.dtb \
 	sm8150-mtp.dtb \
diff --git a/arch/arm64/boot/dts/qcom/OP-fg-batterydata-3700mah.dtsi b/arch/arm64/boot/dts/qcom/OP-fg-batterydata-3700mah.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..131fb2dc9e0dc730ec1799455de1d4b1caac1582
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/OP-fg-batterydata-3700mah.dtsi
@@ -0,0 +1,144 @@
+/* Copyright (c) 2016, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+qcom,OP_3700mAh {
+	qcom,max-voltage-uv = <4370000>;
+	qcom,fastchg-current-ma = <3000>;
+	qcom,jeita-fcc-ranges = <0  100  2500000
+				110 400  5400000
+				410 450  2500000>;
+	qcom,jeita-fv-ranges = <0   100  4250000
+				110 400  4350000
+				410 450  4250000>;
+	qcom,step-chg-ranges = <3600000  3800000  5400000
+				3801000  4300000  3600000
+				4301000  4350000  2500000>;
+	qcom,ocv-based-step-chg;
+	qcom,batt-id-kohm = <200>;
+	qcom,battery-beta = <4250>;
+	qcom,therm-room-temp = <100000>;
+	qcom,fg-cc-cv-threshold-mv = <4340>;
+	qcom,battery-type = "OP_3700mAh";
+	qcom,therm-coefficients = <0x2318 0xd0c 0xdaf7 0xc556 0x848d>;
+	qcom,therm-center-offset = <0x70>;
+	qcom,therm-pull-up = <100>;
+	qcom,rslow-normal-coeffs = <0xdf 0x02 0x77 0x1a>;
+	qcom,rslow-low-coeffs = <0x51 0x04 0xd0 0x13>;
+	qcom,checksum = <0x1538>;
+	qcom,gui-version = "PM855GUI - 1.0.0.10";
+	qcom,fg-profile-data = [
+		09 00 C7 EA
+		C4 DC 8E E2
+		3A DD 00 00
+		15 BC A5 8A
+		02 80 D1 92
+		AB 9D 47 80
+		10 00 DF 02
+		77 1A 85 EC
+		E1 FD CE 07
+		32 00 75 EB
+		AA ED F3 CD
+		0C 0A 7A E4
+		ED C5 40 1B
+		D0 02 1F CA
+		FF 00 52 00
+		4D 00 4A 00
+		3C 00 35 00
+		38 00 39 00
+		48 00 43 00
+		3F 00 FF 00
+		38 00 40 00
+		46 00 50 00
+		45 00 5C 00
+		7E 64 60 00
+		50 08 50 10
+		FF 00 6A 00
+		5F 00 63 00
+		6E 00 60 00
+		7D 20 96 40
+		75 50 6B 13
+		63 00 D8 00
+		14 22 7E 0D
+		21 02 AA 04
+		ED 1C D4 09
+		64 0C D3 23
+		A4 18 D3 42
+		B5 55 91 02
+		90 12 2A 1F
+		02 06 1F 0A
+		A3 06 AE 1C
+		8D 02 96 04
+		D2 03 D1 17
+		51 23 3F 45
+		28 53 69 14
+		93 20 8E EC
+		18 CB C8 C5
+		DB 1C 7B C9
+		7C 05 E6 C2
+		B9 17 2C 93
+		87 85 A2 92
+		91 A8 09 80
+		92 F2 1A 0D
+		F4 FC 5E EB
+		00 F8 FB ED
+		15 E2 F6 0F
+		75 02 72 05
+		49 01 10 00
+		FA E5 E2 03
+		8D 05 85 02
+		CE 07 32 00
+		23 03 46 02
+		9C 04 03 02
+		48 07 0A 00
+		BA 03 97 02
+		65 05 50 00
+		3A 00 41 00
+		43 64 45 00
+		45 10 45 18
+		46 08 44 00
+		47 00 3A 08
+		4B 08 37 00
+		47 20 4E 40
+		54 58 60 10
+		57 00 5F 00
+		57 08 55 00
+		4B 00 50 00
+		3E 08 52 08
+		52 00 5C 20
+		6F 40 7D 58
+		67 10 63 00
+		69 08 4F 10
+		D8 00 8C 2A
+		DB 04 28 02
+		AD 04 0B 1D
+		50 22 A7 45
+		0D 52 A2 18
+		74 03 AD 04
+		35 02 AE 13
+		3F 0A 5A 20
+		DD 04 F1 02
+		D8 05 C7 1C
+		DD 02 3D 04
+		EB 03 97 18
+		52 03 D5 04
+		19 02 72 00
+		14 22 7E 05
+		21 02 AA 04
+		ED 1C D4 01
+		64 04 D3 03
+		A4 18 D3 02
+		B5 05 91 02
+		90 00 7C 01
+		C0 00 FA 00
+		04 0E 00 00
+	];
+};
diff --git a/arch/arm64/boot/dts/qcom/OP-fg-batterydata-4000mah.dtsi b/arch/arm64/boot/dts/qcom/OP-fg-batterydata-4000mah.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..3f0116c033bab78eecd8028b4b4181c19cfd6f67
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/OP-fg-batterydata-4000mah.dtsi
@@ -0,0 +1,145 @@
+/*
+ * Copyright (c) 2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+qcom,OP_4000mAh {
+	qcom,max-voltage-uv = <4370000>;
+	qcom,fastchg-current-ma = <3000>;
+	qcom,jeita-fcc-ranges = <0  100  2500000
+				110 400  5400000
+				410 450  2500000>;
+	qcom,jeita-fv-ranges = <0   100  4250000
+				110 400  4350000
+				410 450  4250000>;
+	qcom,step-chg-ranges = <3600000  3800000  5400000
+				3801000  4300000  3600000
+				4301000  4350000  2500000>;
+	qcom,ocv-based-step-chg;
+	qcom,batt-id-kohm = <200>;
+	qcom,battery-beta = <4250>;
+	qcom,therm-room-temp = <100000>;
+	qcom,fg-cc-cv-threshold-mv = <4340>;
+	qcom,battery-type = "OP_4000mAh ";
+	qcom,therm-coefficients = <0x2318 0xd0c 0xdaf7 0xc556 0x848d>;
+	qcom,therm-center-offset = <0x70>;
+	qcom,therm-pull-up = <100>;
+	qcom,rslow-normal-coeffs = <0xdf 0x02 0x77 0x1a>;
+	qcom,rslow-low-coeffs = <0x51 0x04 0xd0 0x13>;
+	qcom,checksum = <0x1538>;
+	qcom,gui-version = "PM855GUI - 1.0.0.10";
+	qcom,fg-profile-data = [
+		09 00 C7 EA
+		C4 DC 8E E2
+		3A DD 00 00
+		15 BC A5 8A
+		02 80 D1 92
+		AB 9D 47 80
+		10 00 DF 02
+		77 1A 85 EC
+		E1 FD CE 07
+		32 00 75 EB
+		AA ED F3 CD
+		0C 0A 7A E4
+		ED C5 40 1B
+		D0 02 1F CA
+		FF 00 52 00
+		4D 00 4A 00
+		3C 00 35 00
+		38 00 39 00
+		48 00 43 00
+		3F 00 FF 00
+		38 00 40 00
+		46 00 50 00
+		45 00 5C 00
+		7E 64 60 00
+		50 08 50 10
+		FF 00 6A 00
+		5F 00 63 00
+		6E 00 60 00
+		7D 20 96 40
+		75 50 6B 13
+		63 00 D8 00
+		14 22 7E 0D
+		21 02 AA 04
+		ED 1C D4 09
+		64 0C D3 23
+		A4 18 D3 42
+		B5 55 91 02
+		90 12 2A 1F
+		02 06 1F 0A
+		A3 06 AE 1C
+		8D 02 96 04
+		D2 03 D1 17
+		51 23 3F 45
+		28 53 69 14
+		93 20 8E EC
+		18 CB C8 C5
+		DB 1C 7B C9
+		7C 05 E6 C2
+		B9 17 2C 93
+		87 85 A2 92
+		91 A8 09 80
+		92 F2 1A 0D
+		F4 FC 5E EB
+		00 F8 FB ED
+		15 E2 F6 0F
+		75 02 72 05
+		49 01 10 00
+		FA E5 E2 03
+		8D 05 85 02
+		CE 07 32 00
+		23 03 46 02
+		9C 04 03 02
+		48 07 0A 00
+		BA 03 97 02
+		65 05 50 00
+		3A 00 41 00
+		43 64 45 00
+		45 10 45 18
+		46 08 44 00
+		47 00 3A 08
+		4B 08 37 00
+		47 20 4E 40
+		54 58 60 10
+		57 00 5F 00
+		57 08 55 00
+		4B 00 50 00
+		3E 08 52 08
+		52 00 5C 20
+		6F 40 7D 58
+		67 10 63 00
+		69 08 4F 10
+		D8 00 8C 2A
+		DB 04 28 02
+		AD 04 0B 1D
+		50 22 A7 45
+		0D 52 A2 18
+		74 03 AD 04
+		35 02 AE 13
+		3F 0A 5A 20
+		DD 04 F1 02
+		D8 05 C7 1C
+		DD 02 3D 04
+		EB 03 97 18
+		52 03 D5 04
+		19 02 72 00
+		14 22 7E 05
+		21 02 AA 04
+		ED 1C D4 01
+		64 04 D3 03
+		A4 18 D3 02
+		B5 05 91 02
+		90 00 7C 01
+		C0 00 FA 00
+		04 0E 00 00
+	];
+};
diff --git a/arch/arm64/boot/dts/qcom/dsi-panel-samsung-sofef00_m-fhd-video.dtsi b/arch/arm64/boot/dts/qcom/dsi-panel-samsung-sofef00_m-fhd-video.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..106155b52befb3bc42195d4874a528c13831da34
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi-panel-samsung-sofef00_m-fhd-video.dtsi
@@ -0,0 +1,103 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+	dsi_samsung_sofef00_m_video: qcom,mdss_dsi_samsung_sofef00_m_video {
+		qcom,mdss-dsi-panel-name = "samsung sofef00_m video mode dsi panel";
+		qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-version = "SOFEF00M";
+		qcom,mdss-dsi-backlight-version = "SAMSUNG";
+		qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-type = "dsi_video_mode";
+		qcom,mdss-dsi-virtual-channel-id = <0>;
+		qcom,mdss-dsi-stream = <0>;
+		qcom,mdss-dsi-bpp = <24>;
+		qcom,mdss-dsi-underflow-color = <0xff>;
+		qcom,mdss-dsi-border-color = <0>;
+		qcom,mdss-dsi-reset-sequence = <1 5>, <0 2>, <1 10>;
+		qcom,mdss-pan-physical-width-dimension = <68>;
+		qcom,mdss-pan-physical-height-dimension = <145>;
+		qcom,mdss-dsi-traffic-mode = "burst_mode";
+		qcom,mdss-dsi-bllp-eof-power-mode;
+		qcom,mdss-dsi-bllp-power-mode;
+		qcom,mdss-dsi-lane-0-state;
+		qcom,mdss-dsi-lane-1-state;
+		qcom,mdss-dsi-lane-2-state;
+		qcom,mdss-dsi-lane-3-state;
+		qcom,mdss-dsi-dma-trigger = "trigger_sw";
+		qcom,mdss-dsi-mdp-trigger = "none";
+		qcom,mdss-dsi-lp11-init;
+	  	qcom,mdss-dsi-high-brightness-panel;
+		qcom,mdss-bl-high2bit;
+		qcom,mdss-dsi-display-timings {
+			timing@0{
+				qcom,mdss-dsi-panel-framerate = <60>;
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2280>;
+				qcom,mdss-dsi-h-front-porch = <100>;
+				qcom,mdss-dsi-h-back-porch = <24>;
+				qcom,mdss-dsi-h-pulse-width = <12>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <8>;
+				qcom,mdss-dsi-v-front-porch = <18>;
+				qcom,mdss-dsi-v-pulse-width = <4>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-on-command = [
+						05 01 00 00 0A 00 02 11 00
+						39 01 00 00 00 00 03 F0 5A 5A
+						15 01 00 00 00 00 02 35 00
+						39 01 00 00 00 00 03 F0 A5 A5
+						15 01 00 00 00 00 02 53 20
+						15 01 00 00 00 00 02 55 00
+						05 01 00 00 00 00 01 29
+					];
+				qcom,mdss-dsi-off-command = [
+					05 01 00 00 28 00 01 28
+					05 01 00 00 82 00 01 10
+					];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+				};
+		};
+	};
+};
+
+&dsi_samsung_sofef00_m_video {
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_sofef00_m_video_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_sofef00_m_video {
+	qcom,mdss-dsi-display-timings {
+		timing@0{
+			qcom,mdss-dsi-panel-phy-timings = [00 22 09 09 25 23
+				09 09 06 03 04 00 1C 19];
+			qcom,display-topology = <1 0 1>;
+			qcom,default-topology-index = <0>;
+		};
+	};
+};
+
diff --git a/arch/arm64/boot/dts/qcom/dsi-panel-samsung_oneplus_dsc.dtsi b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_oneplus_dsc.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..c0f4d1573c25f7b7826f8f256d9bb92e03511e90
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_oneplus_dsc.dtsi
@@ -0,0 +1,2573 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+		dsi_samsung_oneplus_dsc_cmd: qcom,mdss_dsi_samsung_oneplus_dsc_cmd {
+		qcom,mdss-dsi-panel-name = "samsung dsc cmd mode oneplus dsi panel";
+		qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-version = "DSC";
+		qcom,mdss-dsi-backlight-version = "SAMSUNG";
+		qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-type = "dsi_cmd_mode";
+		qcom,mdss-dsi-virtual-channel-id = <0>;
+		qcom,mdss-dsi-stream = <0>;
+		qcom,mdss-dsi-bpp = <24>;
+		qcom,mdss-dsi-underflow-color = <0xff>;
+		qcom,mdss-dsi-border-color = <0>;
+		qcom,mdss-dsi-reset-sequence = <1 10>, <0 2>, <1 5>;
+		qcom,mdss-dsi-traffic-mode = "burst_mode";
+		qcom,mdss-dsi-bllp-eof-power-mode;
+		qcom,mdss-dsi-bllp-power-mode;
+		qcom,mdss-dsi-color-order = "rgb_swap_rgb";
+		qcom,mdss-dsi-lane-0-state;
+		qcom,mdss-dsi-lane-1-state;
+		qcom,mdss-dsi-lane-2-state;
+		qcom,mdss-dsi-lane-3-state;
+		qcom,mdss-dsi-lane-map = "lane_map_0123";
+		qcom,mdss-dsi-dma-trigger = "trigger_sw";
+		qcom,mdss-dsi-mdp-trigger = "none";
+		qcom,mdss-dsi-te-pin-select = <1>;
+		qcom,mdss-dsi-wr-mem-start = <0x2c>;
+		qcom,mdss-dsi-wr-mem-continue = <0x3c>;
+		qcom,mdss-dsi-te-dcs-command = <1>;
+		qcom,mdss-dsi-bl-min-level = <1>;
+		qcom,mdss-dsi-bl-max-level = <1023>;
+		qcom,mdss-brightness-default-val = <200>;
+		qcom,mdss-brightness-max-level = <1023>;
+		qcom,mdss-pan-physical-width-dimension = <71>;
+		qcom,mdss-pan-physical-height-dimension = <154>;
+		qcom,mdss-dsi-init-delay-us = <1000>;
+		qcom,mdss-dsi-te-check-enable;
+		qcom,mdss-dsi-te-using-te-pin;
+		qcom,mdss-dsi-lp11-init;
+		qcom,mdss-dsi-high-brightness-panel;
+		qcom,mdss-dsi-acl-cmd-index = <0>;
+		qcom,mdss-dsi-acl-mode-index = <1>;
+		qcom,mdss-bl-high2bit;
+		qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+		qcom,dynamic-mode-switch-enabled;
+		qcom,dynamic-mode-switch-type = "dynamic-resolution-switch-immediate";
+		qcom,mdss-dsi-panel-clockrate = <1100000000>;
+		/* HDR Setting */
+		qcom,mdss-dsi-panel-hdr-enabled;
+		qcom,mdss-dsi-panel-hdr-color-primaries = <15635 16450 34000 16000 13250 34500 7500 3000>;
+		qcom,mdss-dsi-panel-peak-brightness = <5400000>;
+		qcom,mdss-dsi-panel-average-brightness = <2000000>;
+		qcom,mdss-dsi-panel-blackness-level = <2000>;
+		qcom,mdss-dsi-panel-seria-num-year-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-mon-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-day-index = <13>;
+		qcom,mdss-dsi-panel-seria-num-hour-index = <14>;
+		qcom,mdss-dsi-panel-seria-num-min-index = <15>;
+		qcom,mdss-dsi-panel-seria-num-sec-index = <16>;
+		qcom,esd-check-enabled;
+		qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+		qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 00];
+		qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-status-value = <0x9F>;
+		qcom,mdss-dsi-panel-status-read-length = <1>;
+		qcom,mdss-dsi-panel-id1-command = [06 01 00 00 00 00 02 0A 00];
+		qcom,mdss-dsi-panel-id2-command = [06 01 00 00 00 00 02 0E 00];
+		qcom,mdss-dsi-panel-id3-command = [06 01 00 00 00 00 02 0F 00];
+		qcom,mdss-dsi-panel-id4-command = [06 01 00 00 00 00 02 C4 00];
+		qcom,mdss-dsi-panel-id5-command = [06 01 00 00 00 00 02 E7 00];
+		qcom,mdss-dsi-panel-id6-command = [06 01 00 00 00 00 02 EA 00];
+		qcom,mdss-dsi-panel-id7-command = [06 01 00 00 00 00 02 FB 00];
+		qcom,mdss-dsi-panel-read-register-open-command = [
+		39 01 00 00 00 00 03 F0 5A 5A
+		];
+		qcom,mdss-dsi-panel-read-register-close-command = [
+		39 01 00 00 00 00 03 F0 A5 A5
+		];
+		qcom,mdss-dsi-panel-read-esd-registed-longread-command = [
+		37 01 00 00 05 00 02 22 00
+		];
+		qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-read-esd-registed-longread-command-state = "dsi_lp_mode";
+
+		/*
+		* ************************************************************************************************************************
+		*  DMS (Dynamic Mode Switch)
+		* ************************************************************************************************************************
+		*/
+		qcom,mdss-dsi-display-timings {
+			timing@0{
+				qcom,display-topology = <1 1 1>,<2 2 1>;
+				qcom,default-topology-index = <1>;
+				qcom,mdss-mdp-transfer-time-us = <8000>; //for 60fps
+				qcom,mdss-dsi-timing-default;
+				qcom,mdss-dsi-panel-framerate = <60>;
+				qcom,mdss-dsi-panel-clockrate = <1107000000>;
+				qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+				qcom,mdss-dsi-panel-width = <1440>;
+				qcom,mdss-dsi-panel-height = <3120>;
+				qcom,mdss-dsi-h-front-porch = <16>;
+				qcom,mdss-dsi-h-back-porch = <8>;
+				qcom,mdss-dsi-h-pulse-width = <8>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <1156>;
+				qcom,mdss-dsi-v-front-porch = <400>;
+				qcom,mdss-dsi-v-pulse-width = <28>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+				qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+				qcom,esd-check-enabled;
+				qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+				qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 00];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-status-value = <0x9F>;
+				qcom,mdss-dsi-panel-status-read-length = <1>;
+				qcom,mdss-dsi-panel-id1-command = [06 01 00 00 00 00 02 0A 00];
+				qcom,mdss-dsi-panel-id2-command = [06 01 00 00 00 00 02 0E 00];
+				qcom,mdss-dsi-panel-id3-command = [06 01 00 00 00 00 02 0F 00];
+				qcom,mdss-dsi-panel-id4-command = [06 01 00 00 00 00 02 C4 00];
+				qcom,mdss-dsi-panel-id5-command = [06 01 00 00 00 00 02 E7 00];
+				qcom,mdss-dsi-panel-id6-command = [06 01 00 00 00 00 02 EA 00];
+				qcom,mdss-dsi-panel-id7-command = [06 01 00 00 00 00 02 FB 00];
+				qcom,mdss-dsi-panel-read-register-open-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-read-register-close-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command = [
+				37 01 00 00 05 00 02 22 00
+				];
+				qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-timing-switch-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				//29 01 00 00 00 00 03 9F A5 A5
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				29 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				39 01 00 00 00 00 5A 0A 				/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				//29 01 00 00 00 00 03 9F 5A 5A
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-t-clk-pre = <0x1E>;
+				qcom,mdss-dsi-t-clk-post = <0x1A>;
+				qcom,mdss-dsi-on-command = [
+				/* DSC Setting */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				39 01 00 00 00 00 5A 0A					/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				39 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				39 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame*/
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-113mhz-osc-dsi-on-command = [
+				/* DSC Setting */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				39 01 00 00 00 00 5A 0A					/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				39 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				39 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame*/
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-dsi-timing-switch-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-113mhz-osc-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+				qcom,mdss-dsi-off-command=[
+				05 01 00 00 0A 00 02 28 00
+				05 01 00 00 78 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 53				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM Mode ON */
+				15 01 00 00 11 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 53				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 11 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-3 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-4 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 14 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				29 01 00 00 0D 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 11 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				];
+				qcom,mdss-dsi-panel-serial-num-pre-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				37 01 00 00 05 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-serial-num-command = [
+				06 01 00 00 00 00 01 A1 00
+				];
+				qcom,mdss-dsi-panel-stage-info-command = [
+				06 01 00 00 00 00 01 DB 00
+				];
+				qcom,mdss-dsi-panel-production-info-command = [
+				06 01 00 00 00 00 01 DC 00
+				];
+				qcom,mdss-dsi-panel-serial-num-post-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-aod-off-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				29 01 00 00 00 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command = [
+				/*Level2 key Enable*/
+				29 01 00 00 00 00 03 F0 5A 5A
+				//07 01 00 00 00 00 01 01
+				//29 00 00 00 00 00 05 2A 00 00 05 9F
+				//29 00 00 00 00 00 05 2B 00 00 0C 2F
+				/*OTP key Enable*/
+				29 01 00 00 00 00 03 F1 F1 A2
+				29 01 00 00 00 00 0D C1 00 00 00 06 00 00 00 00 00 00 00 05
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0C C1 00 00 00 01 40 02 00 00 00 00 10
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0E C1 00 00 00 6B 00 00 00 0A 00 00 00 05 01
+				15 01 00 00 00 00 02 B0 07
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command = [
+				15 01 00 00 00 00 02 C0 03
+				15 01 00 00 00 00 02 B0 08
+				];
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command = [
+				/*13th Parameter : 1byte Read value*/
+				06 01 00 00 00 00 02 FB 00
+				];
+				qcom,mdss-dsi-panel-level2-key-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command = [
+				37 01 00 00 05 00 02 87 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command = [
+				06 01 00 00 00 00 02 C8 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command = [
+				37 01 00 00 00 00 02 B4 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command = [
+				06 01 00 00 00 00 02 C9 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command  = [
+				37 01 00 00 00 00 02 2F 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command = [
+				06 01 00 00 00 00 02 B3 00
+				];
+				qcom,mdss-dsi-panel-level2-key-disable-command = [
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 F8 00 00 00 F0 00 05 00 EC 0A EA ED FD 01 F7 F1 EA 00 FF FE FE
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 E5 08 00 86 FF 00 04 03 F8 1B F0 E8 E9 03 ED DD F0 00 FF FE E4
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-p3-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 D3 03 00 11 E4 01 0B 06 F0 1A FA FC E5 09 F6 EA F3 01 FC FF EA
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 03 67 00 01
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 81
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 FF 6D
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-disable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 A1
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 28 28
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-srgb-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 EA 12 06 4A F4 14 09 02 BF 47 FC DC D3 0B E5 D2 F6 14 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 FF 05 00 0B EB 00 07 00 FF 14 F8 EA F0 03 F5 DE F5 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-customer-srgb-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-laoding-effect-enable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-laoding-effect-disable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-p3-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-night-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-dci-p3-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-aod-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-pre-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-state-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-production-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-post-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-3-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-4-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-enable-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-disable-command-state = "dsi_lp_mode";
+				qcom,panel-roi-alignment=<720 65 720 65 720 65>;
+				qcom,compression-mode = "dsc";
+				qcom,lm-split = <720 720>;
+				qcom,mdss-dsc-encoders = <2>;
+				qcom,mdss-dsc-slice-height = <65>;
+				qcom,mdss-dsc-slice-width = <720>;
+				qcom,mdss-dsc-slice-per-pkt = <2>;
+				qcom,mdss-dsc-bit-per-component = <8>;
+				qcom,mdss-dsc-bit-per-pixel = <8>;
+				qcom,mdss-dsc-block-prediction-enable;
+				};
+
+			timing@1{
+				qcom,display-topology = <1 1 1>,<2 2 1>;
+				qcom,default-topology-index = <1>;
+				qcom,mdss-mdp-transfer-time-us = <8000>; //for 90fps
+				qcom,mdss-dsi-panel-framerate = <90>;
+				qcom,mdss-dsi-panel-clockrate = <1107000000>;
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2336>;
+				qcom,mdss-dsi-h-front-porch = <16>;
+				qcom,mdss-dsi-h-back-porch = <8>;
+				qcom,mdss-dsi-h-pulse-width = <8>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <8>;
+				qcom,mdss-dsi-v-front-porch = <4>;
+				qcom,mdss-dsi-v-pulse-width = <4>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+				qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+				qcom,esd-check-enabled;
+				qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+				qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 00];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-status-value = <0x9F>;
+				qcom,mdss-dsi-panel-status-read-length = <1>;
+				qcom,mdss-dsi-panel-id1-command = [06 01 00 00 00 00 02 0A 00];
+				qcom,mdss-dsi-panel-id2-command = [06 01 00 00 00 00 02 0E 00];
+				qcom,mdss-dsi-panel-id3-command = [06 01 00 00 00 00 02 0F 00];
+				qcom,mdss-dsi-panel-id4-command = [06 01 00 00 00 00 02 C4 00];
+				qcom,mdss-dsi-panel-id5-command = [06 01 00 00 00 00 02 E7 00];
+				qcom,mdss-dsi-panel-id6-command = [06 01 00 00 00 00 02 EA 00];
+				qcom,mdss-dsi-panel-id7-command = [06 01 00 00 00 00 02 FB 00];
+				qcom,mdss-dsi-panel-read-register-open-command = [
+				39 01 00 00 00 00 03 F0 5A 5A];
+				qcom,mdss-dsi-panel-read-register-close-command = [
+				39 01 00 00 00 00 03 F0 A5 A5];
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command = [
+				37 01 00 00 05 00 02 22 00
+				];
+				qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-timing-switch-command = [
+				29 01 00 00 00 00 03 F0 5A 5A			/* Level2 key Access Enable */
+				//29 01 00 00 00 00 03 9F A5 A5			/* Level1 key Access Enable */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				//29 01 00 00 00 00 03 9F 5A 5A
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+				qcom,mdss-dsi-t-clk-pre = <0x1E>;
+				qcom,mdss-dsi-t-clk-post = <0x1A>;
+				qcom,mdss-dsi-on-command = [
+				/* DSC Setting */
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				29 01 00 00 00 00 03 F0 A5 A5
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame */
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-113mhz-osc-dsi-on-command = [
+				/* DSC Setting */
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				29 01 00 00 00 00 03 F0 A5 A5
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame */
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-113mhz-osc-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-timing-switch-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+				qcom,mdss-dsi-off-command=[
+				05 01 00 00 0A 00 02 28 00
+				05 01 00 00 78 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 53				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM Mode ON */
+				15 01 00 00 0C 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 53				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 0C 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-3 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-4 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 10 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				29 01 00 00 0C 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-serial-num-pre-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				37 01 00 00 05 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-serial-num-command = [
+				06 01 00 00 00 00 01 A1 00
+				];
+				qcom,mdss-dsi-panel-stage-info-command = [
+				06 01 00 00 00 00 01 DB 00
+				];
+				qcom,mdss-dsi-panel-production-info-command = [
+				06 01 00 00 00 00 01 DC 00
+				];
+				qcom,mdss-dsi-panel-serial-num-post-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-aod-off-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				29 01 00 00 00 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command = [
+				/*Level2 key Enable*/
+				29 01 00 00 00 00 03 F0 5A 5A
+				//07 01 00 00 00 00 01 01
+				//29 00 00 00 00 00 05 2A 00 00 05 9F
+				//29 00 00 00 00 00 05 2B 00 00 0C 2F
+				/*OTP key Enable*/
+				29 01 00 00 00 00 03 F1 F1 A2
+				29 01 00 00 00 00 0D C1 00 00 00 06 00 00 00 00 00 00 00 05
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0C C1 00 00 00 01 40 02 00 00 00 00 10
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0E C1 00 00 00 6B 00 00 00 0A 00 00 00 05 01
+				15 01 00 00 00 00 02 B0 07
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command = [
+				15 01 00 00 00 00 02 C0 03
+				15 01 00 00 00 00 02 B0 08
+				];
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command = [
+				/*13th Parameter : 1byte Read value*/
+				06 01 00 00 00 00 02 FB 00
+				];
+				qcom,mdss-dsi-panel-level2-key-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command = [
+				37 01 00 00 00 00 02 87 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command = [
+				06 01 00 00 00 00 02 C8 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command = [
+				37 01 00 00 00 00 02 B4 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command = [
+				06 01 00 00 00 00 02 C9 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command  = [
+				37 01 00 00 00 00 02 2F 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command = [
+				06 01 00 00 00 00 02 B3 00
+				];
+				qcom,mdss-dsi-panel-level2-key-disable-command = [
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 F8 00 00 00 F0 00 05 00 EC 0A EA ED FD 01 F7 F1 EA 00 FF FE FE
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 E5 08 00 86 FF 00 04 03 F8 1B F0 E8 E9 03 ED DD F0 00 FF FE E4
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-p3-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 D3 03 00 11 E4 01 0B 06 F0 1A FA FC E5 09 F6 EA F3 01 FC FF EA
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 03 67 00 01
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 81
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 FF 6D
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-disable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 A1
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 28 28
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-srgb-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 EA 12 06 4A F4 14 09 02 BF 47 FC DC D3 0B E5 D2 F6 14 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 FF 05 00 0B EB 00 07 00 FF 14 F8 EA F0 03 F5 DE F5 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-customer-srgb-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-laoding-effect-enable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-laoding-effect-disable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-p3-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-night-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-dci-p3-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-aod-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-pre-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-state-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-production-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-post-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-3-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-4-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-enable-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-disable-command-state = "dsi_lp_mode";
+				qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+				qcom,compression-mode = "dsc";
+				qcom,lm-split = <540 540>;
+				qcom,mdss-dsc-encoders = <2>;
+				qcom,mdss-dsc-slice-height = <73>;
+				qcom,mdss-dsc-slice-width = <540>;
+				qcom,mdss-dsc-slice-per-pkt = <2>;
+				qcom,mdss-dsc-bit-per-component = <8>;
+				qcom,mdss-dsc-bit-per-pixel = <8>;
+				qcom,mdss-dsc-block-prediction-enable;
+				};
+
+			timing@2{
+				qcom,display-topology = <1 1 1>,<2 2 1>;
+				qcom,default-topology-index = <1>;
+				qcom,mdss-mdp-transfer-time-us = <8000>; //for 60fps
+				qcom,mdss-dsi-timing-default;
+				qcom,mdss-dsi-panel-framerate = <60>;
+				qcom,mdss-dsi-panel-clockrate = <1107000000>;
+				qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2336>;
+				qcom,mdss-dsi-h-front-porch = <16>;
+				qcom,mdss-dsi-h-back-porch = <8>;
+				qcom,mdss-dsi-h-pulse-width = <8>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <1156>;
+				qcom,mdss-dsi-v-front-porch = <400>;
+				qcom,mdss-dsi-v-pulse-width = <28>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+				qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+				qcom,esd-check-enabled;
+				qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+				qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 00];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-status-value = <0x9F>;
+				qcom,mdss-dsi-panel-status-read-length = <1>;
+				qcom,mdss-dsi-panel-id1-command = [06 01 00 00 00 00 02 0A 00];
+				qcom,mdss-dsi-panel-id2-command = [06 01 00 00 00 00 02 0E 00];
+				qcom,mdss-dsi-panel-id3-command = [06 01 00 00 00 00 02 0F 00];
+				qcom,mdss-dsi-panel-id4-command = [06 01 00 00 00 00 02 C4 00];
+				qcom,mdss-dsi-panel-id5-command = [06 01 00 00 00 00 02 E7 00];
+				qcom,mdss-dsi-panel-id6-command = [06 01 00 00 00 00 02 EA 00];
+				qcom,mdss-dsi-panel-id7-command = [06 01 00 00 00 00 02 FB 00];
+				qcom,mdss-dsi-panel-read-register-open-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-read-register-close-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command = [
+				37 01 00 00 05 00 02 22 00
+				];
+				qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-timing-switch-command = [
+				29 01 00 00 00 00 03 F0 5A 5A			/* Level2 key Access Enable */
+				//29 01 00 00 00 00 03 9F A5 A5			/* Level1 key Access Enable */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				//29 01 00 00 00 00 03 9F 5A 5A
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-t-clk-pre = <0x1E>;
+				qcom,mdss-dsi-t-clk-post = <0x1A>;
+				qcom,mdss-dsi-on-command = [
+				/* DSC Setting */
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				29 01 00 00 00 00 03 F0 A5 A5
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame */
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-113mhz-osc-dsi-on-command = [
+				/* DSC Setting */
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 01				/* Scaler enable(x1.78) */
+				39 01 00 00 00 00 59 0A					/* PPS Setting (1080 x 2336) */
+				11 00 00 89 30 80 09 20
+				04 38 00 49 02 1C 02 1C
+				02 00 02 0E 00 20 07 16
+				00 07 00 0C 01 56 01 65
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A F6
+				2B 34 2B 74 3B 74 6B F4
+				29 01 00 00 00 00 03 F0 A5 A5
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				29 01 00 00 00 00 05 2A 00 00 04 37		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 09 1F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame */
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-dsi-timing-switch-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-113mhz-osc-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+				qcom,mdss-dsi-off-command=[
+				05 01 00 00 0A 00 02 28 00
+				05 01 00 00 78 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 53				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM Mode ON */
+				15 01 00 00 11 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 53				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 11 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-3 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-4 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 14 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				29 01 00 00 0D 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 11 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				15 01 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				];
+				qcom,mdss-dsi-panel-serial-num-pre-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				37 01 00 00 05 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-serial-num-command = [
+				06 01 00 00 00 00 01 A1 00
+				];
+				qcom,mdss-dsi-panel-stage-info-command = [
+				06 01 00 00 00 00 01 DB 00
+				];
+				qcom,mdss-dsi-panel-production-info-command = [
+				06 01 00 00 00 00 01 DC 00
+				];
+				qcom,mdss-dsi-panel-serial-num-post-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-aod-off-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 20				/* 0x20 Normal transition(60Hz) */
+				29 01 00 00 00 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command = [
+				/*Level2 key Enable*/
+				29 01 00 00 00 00 03 F0 5A 5A
+				//07 01 00 00 00 00 01 01
+				//29 00 00 00 00 00 05 2A 00 00 05 9F
+				//29 00 00 00 00 00 05 2B 00 00 0C 2F
+				/*OTP key Enable*/
+				29 01 00 00 00 00 03 F1 F1 A2
+				29 01 00 00 00 00 0D C1 00 00 00 06 00 00 00 00 00 00 00 05
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0C C1 00 00 00 01 40 02 00 00 00 00 10
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0E C1 00 00 00 6B 00 00 00 0A 00 00 00 05 01
+				15 01 00 00 00 00 02 B0 07
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command = [
+				15 01 00 00 00 00 02 C0 03
+				15 01 00 00 00 00 02 B0 08
+				];
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command = [
+				/*13th Parameter : 1byte Read value*/
+				06 01 00 00 00 00 02 FB 00
+				];
+				qcom,mdss-dsi-panel-level2-key-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command = [
+				37 01 00 00 05 00 02 87 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command = [
+				06 01 00 00 00 00 02 C8 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command = [
+				37 01 00 00 00 00 02 B4 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command = [
+				06 01 00 00 00 00 02 C9 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command  = [
+				37 01 00 00 00 00 02 2F 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command = [
+				06 01 00 00 00 00 02 B3 00
+				];
+				qcom,mdss-dsi-panel-level2-key-disable-command = [
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 F8 00 00 00 F0 00 05 00 EC 0A EA ED FD 01 F7 F1 EA 00 FF FE FE
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 E5 08 00 86 FF 00 04 03 F8 1B F0 E8 E9 03 ED DD F0 00 FF FE E4
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-p3-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 D3 03 00 11 E4 01 0B 06 F0 1A FA FC E5 09 F6 EA F3 01 FC FF EA
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 03 67 00 01
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 81
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 FF 6D
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-disable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 A1
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 28 28
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-srgb-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 EA 12 06 4A F4 14 09 02 BF 47 FC DC D3 0B E5 D2 F6 14 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 FF 05 00 0B EB 00 07 00 FF 14 F8 EA F0 03 F5 DE F5 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-customer-srgb-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-laoding-effect-enable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-laoding-effect-disable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-p3-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-night-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-dci-p3-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-aod-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-pre-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-state-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-production-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-post-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-3-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-4-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-enable-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-disable-command-state = "dsi_lp_mode";
+				qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+				qcom,compression-mode = "dsc";
+				qcom,lm-split = <540 540>;
+				qcom,mdss-dsc-encoders = <2>;
+				qcom,mdss-dsc-slice-height = <73>;
+				qcom,mdss-dsc-slice-width = <540>;
+				qcom,mdss-dsc-slice-per-pkt = <2>;
+				qcom,mdss-dsc-bit-per-component = <8>;
+				qcom,mdss-dsc-bit-per-pixel = <8>;
+				qcom,mdss-dsc-block-prediction-enable;
+				};
+
+			timing@3{
+				qcom,display-topology = <1 1 1>,<2 2 1>;
+				qcom,default-topology-index = <1>;
+				qcom,mdss-mdp-transfer-time-us = <8000>; //for 90fps
+				qcom,mdss-dsi-panel-framerate = <90>;
+				qcom,mdss-dsi-panel-clockrate = <1107000000>;
+				qcom,mdss-dsi-panel-width = <1440>;
+				qcom,mdss-dsi-panel-height = <3120>;
+				qcom,mdss-dsi-h-front-porch = <16>;
+				qcom,mdss-dsi-h-back-porch = <8>;
+				qcom,mdss-dsi-h-pulse-width = <8>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <8>;
+				qcom,mdss-dsi-v-front-porch = <4>;
+				qcom,mdss-dsi-v-pulse-width = <4>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+				qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+				qcom,esd-check-enabled;
+				qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+				qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 00];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-status-value = <0x9F>;
+				qcom,mdss-dsi-panel-status-read-length = <1>;
+				qcom,mdss-dsi-panel-id1-command = [06 01 00 00 00 00 02 0A 00];
+				qcom,mdss-dsi-panel-id2-command = [06 01 00 00 00 00 02 0E 00];
+				qcom,mdss-dsi-panel-id3-command = [06 01 00 00 00 00 02 0F 00];
+				qcom,mdss-dsi-panel-id4-command = [06 01 00 00 00 00 02 C4 00];
+				qcom,mdss-dsi-panel-id5-command = [06 01 00 00 00 00 02 E7 00];
+				qcom,mdss-dsi-panel-id6-command = [06 01 00 00 00 00 02 EA 00];
+				qcom,mdss-dsi-panel-id7-command = [06 01 00 00 00 00 02 FB 00];
+				qcom,mdss-dsi-panel-read-register-open-command = [
+				39 01 00 00 00 00 03 F0 5A 5A];
+				qcom,mdss-dsi-panel-read-register-close-command = [
+				39 01 00 00 00 00 03 F0 A5 A5];
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command = [
+				37 01 00 00 05 00 02 22 00
+				];
+				qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-esd-registed-longread-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-timing-switch-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				//29 01 00 00 00 00 03 9F A5 A5
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				29 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				29 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				39 01 00 00 00 00 5A 0A 				/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				//29 01 00 00 00 00 03 9F 5A 5A
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+				qcom,mdss-dsi-t-clk-pre = <0x1E>;
+				qcom,mdss-dsi-t-clk-post = <0x1A>;
+				qcom,mdss-dsi-on-command = [
+				/* DSC Setting */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				39 01 00 00 00 00 5A 0A					/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				39 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				39 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame*/
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-113mhz-osc-dsi-on-command = [
+				/* DSC Setting */
+				07 01 00 00 00 00 01 01					/* DSC enable */
+				15 01 00 00 00 00 02 C3 00				/* Scaler disable */
+				39 01 00 00 00 00 5A 0A					/* PPS Setting (1440 x 3120) (initial value) */
+				10 00 00 89 30 80 0C 30
+				05 A0 00 41 02 D0 02 D0
+				02 00 02 C2 00 20 06 58
+				00 0A 00 0F 01 E0 01 2D
+				18 00 10 F0 03 0C 20 00
+				06 0B 0B 33 0E 1C 2A 38
+				46 54 62 69 70 77 79 7B
+				7D 7E 01 02 01 00 09 40
+				09 BE 19 FC 19 FA 19 F8
+				1A 38 1A 78 1A B6 2A B6
+				2A F4 2A F4 4B 34 63 74
+				00
+				/* Sleep Out(11h) */
+				05 01 00 00 0A 00 01 11
+				/* Common Setting */
+				15 00 00 00 00 00 02 35 00				/* TE On(Vsync) */
+				/* CASET/PASET Setting */
+				39 01 00 00 00 00 05 2A 00 00 05 9F		/* CASET */
+				39 01 00 00 00 00 05 2B 00 00 0C 2F		/* PASET */
+				/* TSP SYNC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0A B9 01 C0 3C 0B 00 00 00 11 03	/* SYNC ENABLE */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FD(Fast Discharge) Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 45				/* FD setting (Normal mode) */
+				15 01 00 00 00 00 02 B5 48
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* FFC Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 1E
+				39 01 00 00 00 00 06 C5 09 10 B4 24 D9	/* FFC Setting; 0x09 : Enable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* OSC Spread Setting */
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 37
+				39 01 00 00 00 00 06 C5 04 FF 00 01 64	/* FFC Setting; 0x04 : Disable */
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC 5A 5A
+				15 01 00 00 00 00 02 B0 86				/* Global para */
+				15 01 00 00 00 00 02 EB 01				/* Dither IP Setting */
+				39 01 00 00 00 00 03 FC A5 A5
+				/* Brightness Control */
+				39 01 00 00 00 00 03 F0 5A 5A			/* Dimming Setting */
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01				/* Dimming Speed Setting : 0x01 : 1Frame*/
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 D3				/* 0xD3 : ELVSS DIM ON */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				39 01 00 00 00 00 03 F0 A5 A5
+				/* Display On */
+				05 01 00 00 00 00 01 29
+				];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-113mhz-osc-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-timing-switch-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+				qcom,mdss-dsi-off-command=[
+				05 01 00 00 0A 00 02 28 00
+				05 01 00 00 78 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 53				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 00 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM Mode ON */
+				15 01 00 00 0C 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 53				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 0C 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-3 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-4 = [
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 10 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				29 01 00 00 0C 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-serial-num-pre-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				37 01 00 00 05 00 02 10 00
+				];
+				qcom,mdss-dsi-panel-serial-num-command = [
+				06 01 00 00 00 00 01 A1 00
+				];
+				qcom,mdss-dsi-panel-stage-info-command = [
+				06 01 00 00 00 00 01 DB 00
+				];
+				qcom,mdss-dsi-panel-production-info-command = [
+				06 01 00 00 00 00 01 DC 00
+				];
+				qcom,mdss-dsi-panel-serial-num-post-command = [
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+				];
+				qcom,mdss-dsi-panel-aod-off-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+				/* ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02				/* ELVSS Dim Setting */
+				15 00 00 00 00 00 02 B5 93				/* 0x93 : ELVSS DIM OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode Setting */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 27				/* HMB setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 4B
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 10
+				00 00 0F 03 06 02 0C 18 24
+				3C 77 00 FF 00 00 00 00 00
+				10 02 0C 18 24 3C 59 77 9B
+				BE E2 06
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14 14 14 14 14 14
+				14 14 14 14
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 30
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				/* HBM MODE ON */
+				15 00 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				29 01 00 00 00 00 03 51 0F FF			/* 600nit */
+				/* HBM 670 ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 00				/* HBM_670 ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* 90Hz Setting */
+				15 01 00 00 00 00 02 53 30				/* 0x30 Normal transition(90Hz) */
+				];
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+				/* DLY ON */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 B0 02
+				15 00 00 00 00 00 02 B5 13				/* DLY ON */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM 670 OFF */
+				29 00 00 00 00 00 03 F0 5A 5A
+				15 00 00 00 00 00 02 92 02				/* HBM_670 OFF */
+				29 00 00 00 00 00 03 F0 A5 A5
+				/* HBM Mode OFF */
+				29 00 00 00 00 00 03 51 03 FF			/* 430nit */
+				29 00 00 00 00 00 03 F0 5A 5A			/* Level2 key Access */
+				15 00 00 00 00 00 02 C7 23				/* Normal setting */
+				15 00 00 00 00 00 02 B0 34
+				15 00 00 00 00 00 02 B1 6D
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 20 B1 40
+				00 00 1F 0F 18 08 30 60 90
+				F0 DC FC FC 00 00 01 12 23
+				40 08 30 60 90 F0 66 DC 6C
+				FA 8A 18
+				15 00 00 00 00 00 02 B0 06
+				29 00 00 00 00 00 18 B5 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50 50 50 50 50 50
+				50 50 50 50
+				15 00 00 00 00 00 02 B0 17
+				15 00 00 00 00 00 02 95 00
+				29 01 00 00 00 00 03 F0 A5 A5			/* Level2 key Access Disable */
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command = [
+				/*Level2 key Enable*/
+				29 01 00 00 00 00 03 F0 5A 5A
+				//07 01 00 00 00 00 01 01
+				//29 00 00 00 00 00 05 2A 00 00 05 9F
+				//29 00 00 00 00 00 05 2B 00 00 0C 2F
+				/*OTP key Enable*/
+				29 01 00 00 00 00 03 F1 F1 A2
+				29 01 00 00 00 00 0D C1 00 00 00 06 00 00 00 00 00 00 00 05
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0C C1 00 00 00 01 40 02 00 00 00 00 10
+				15 01 00 00 00 00 02 C0 03
+				29 01 00 00 00 00 0E C1 00 00 00 6B 00 00 00 0A 00 00 00 05 01
+				15 01 00 00 00 00 02 B0 07
+				];
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command = [
+				15 01 00 00 00 00 02 C0 03
+				15 01 00 00 00 00 02 B0 08
+				];
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command = [
+				/*13th Parameter : 1byte Read value*/
+				06 01 00 00 00 00 02 FB 00
+				];
+				qcom,mdss-dsi-panel-level2-key-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command = [
+				37 01 00 00 00 00 02 87 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command = [
+				06 01 00 00 00 00 02 C8 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command = [
+				37 01 00 00 00 00 02 B4 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command = [
+				06 01 00 00 00 00 02 C9 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command  = [
+				37 01 00 00 00 00 02 2F 00
+				];
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command = [
+				06 01 00 00 00 00 02 B3 00
+				];
+				qcom,mdss-dsi-panel-level2-key-disable-command = [
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 F8 00 00 00 F0 00 05 00 EC 0A EA ED FD 01 F7 F1 EA 00 FF FE FE
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 E5 08 00 86 FF 00 04 03 F8 1B F0 E8 E9 03 ED DD F0 00 FF FE E4
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-p3-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 D3 03 00 11 E4 01 0B 06 F0 1A FA FC E5 09 F6 EA F3 01 FC FF EA
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 02
+				29 01 00 00 00 00 16 67 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 03 67 00 01
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-enable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 81
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 FF 6D
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-laoding-effect-disable-command = [
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 00 00 02 B0 01
+				29 01 00 00 00 00 02 95 A1
+				29 01 00 00 00 00 02 B0 14
+				29 01 00 00 00 00 03 95 28 28
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-srgb-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 EA 12 06 4A F4 14 09 02 BF 47 FC DC D3 0B E5 D2 F6 14 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command = [
+				29 01 00 00 00 00 02 81 80
+				29 01 00 00 00 00 03 F0 5A 5A
+				29 01 00 00 0A 00 02 B0 02
+				29 01 00 00 0A 00 16 67 FF 05 00 0B EB 00 07 00 FF 14 F8 EA F0 03 F5 DE F5 00 FF FF FF
+				29 01 00 00 00 00 03 67 00 00
+				29 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-customer-srgb-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-laoding-effect-enable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-laoding-effect-disable-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-p3-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-night-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-dci-p3-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-aod-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-pre-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-state-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-production-info-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-post-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-1-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-3-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-4-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-off-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-flash-read-fb-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-enable-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c8-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-c9-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-gamma-otp-read-b3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-level2-key-disable-command-state = "dsi_lp_mode";
+				qcom,panel-roi-alignment=<720 65 720 65 720 65>;
+				qcom,compression-mode = "dsc";
+				qcom,lm-split = <720 720>;
+				qcom,mdss-dsc-encoders = <2>;
+				qcom,mdss-dsc-slice-height = <65>;
+				qcom,mdss-dsc-slice-width = <720>;
+				qcom,mdss-dsc-slice-per-pkt = <2>;
+				qcom,mdss-dsc-bit-per-component = <8>;
+				qcom,mdss-dsc-bit-per-pixel = <8>;
+				qcom,mdss-dsc-block-prediction-enable;
+				};
+
+		};
+	};
+};
+
+&dsi_samsung_oneplus_dsc_cmd {
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_oneplus_dsc_cmd_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_oneplus_dsc_cmd {
+	qcom,mdss-dsi-display-timings {
+		timing@0 { /* wqhd 60hz */
+			qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			qcom,panel-roi-alignment=<720 65 720 65 720 65>;
+		};
+		timing@1 { /* fhd 90hz */
+			qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+		};
+		timing@2 { /* fhd 60hz */
+			qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+		};
+		timing@3 { /* wqhd 90hz */
+			qcom,mdss-dsi-panel-phy-timings = [00 24 0A 0A 26 24 0A 0A 06 02 04 00 1E 1A];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			qcom,panel-roi-alignment=<720 65 720 65 720 65>;
+		};
+	};
+};
+
+
diff --git a/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01.dtsi b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..81325e406b41285844e8b7bd1c5762fd390124c4
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01.dtsi
@@ -0,0 +1,404 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+	dsi_samsung_s6e3fc2x01_cmd: qcom,mdss_dsi_samsung_s6e3fc2x01_cmd {
+		qcom,mdss-dsi-panel-name = "samsung s6e3fc2x01 cmd mode dsi panel";
+		qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-version = "S6E3FC2X01";
+		qcom,mdss-dsi-backlight-version = "SAMSUNG";
+		qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-type = "dsi_cmd_mode";
+		qcom,mdss-dsi-virtual-channel-id = <0>;
+		qcom,mdss-dsi-stream = <0>;
+		qcom,mdss-dsi-bpp = <24>;
+		qcom,mdss-dsi-underflow-color = <0xff>;
+		qcom,mdss-dsi-border-color = <0>;
+		qcom,mdss-dsi-reset-sequence = <1 5>, <0 2>, <1 10>;
+		qcom,mdss-pan-physical-width-dimension = <68>;
+		qcom,mdss-pan-physical-height-dimension = <145>;
+		qcom,mdss-dsi-traffic-mode = "burst_mode";
+		qcom,mdss-dsi-bllp-eof-power-mode;
+		qcom,mdss-dsi-bllp-power-mode;
+		qcom,mdss-dsi-lane-0-state;
+		qcom,mdss-dsi-lane-1-state;
+		qcom,mdss-dsi-lane-2-state;
+		qcom,mdss-dsi-lane-3-state;
+		qcom,mdss-dsi-dma-trigger = "trigger_sw";
+		qcom,mdss-dsi-mdp-trigger = "none";
+		qcom,mdss-dsi-te-pin-select = <1>;
+		qcom,mdss-dsi-wr-mem-start = <0x2c>;
+		qcom,mdss-dsi-wr-mem-continue = <0x3c>;
+		qcom,mdss-dsi-te-dcs-command = <1>;
+		//qcom,mdss-dsi-te-check-enable;
+		qcom,esd-check-enabled;
+		qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+		qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 08];
+		qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-status-value = <0x9F>;
+		qcom,mdss-dsi-panel-status-read-length = <1>;
+		qcom,mdss-dsi-te-using-te-pin;
+		qcom,mdss-dsi-lp11-init;
+	    qcom,mdss-dsi-high-brightness-panel;
+		qcom,mdss-dsi-acl-cmd-index = <0>;
+		qcom,mdss-dsi-acl-mode-index = <1>;
+		qcom,mdss-bl-high2bit;
+		//qcom,mdss-dsi-panel-status-check-mode = "te_signal_check";
+		qcom,mdss-dsi-panel-seria-num-year-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-mon-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-day-index = <13>;
+		qcom,mdss-dsi-panel-seria-num-hour-index = <14>;
+		qcom,mdss-dsi-panel-seria-num-min-index = <15>;
+		qcom,mdss-dsi-panel-seria-num-sec-index = <16>;
+		qcom,ulps-enabled;
+		qcom,mdss-brightness-max-level = <1023>;
+		/* HDR Setting */
+		qcom,mdss-dsi-panel-hdr-enabled;
+		qcom,mdss-dsi-panel-hdr-color-primaries = <15635 16450 34000 16000 13250 34500 7500 3000>;
+		qcom,mdss-dsi-panel-peak-brightness = <8000000>;
+		qcom,mdss-dsi-panel-average-brightness = <2000000>;
+		qcom,mdss-dsi-panel-blackness-level = <5>;
+		qcom,mdss-dsi-display-timings {
+			timing@0{
+				qcom,mdss-dsi-panel-framerate = <60>;
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2340>;
+				qcom,mdss-dsi-h-front-porch = <72>;
+				qcom,mdss-dsi-h-back-porch = <36>;
+				qcom,mdss-dsi-h-pulse-width = <16>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <18>;
+				qcom,mdss-dsi-v-front-porch = <32>;
+				qcom,mdss-dsi-v-pulse-width = <4>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x4 0x1>;
+				qcom,mdss-dsi-panel-clockrate = <1037000000>;//	518.5MHZ
+				qcom,mdss-dsi-on-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*FD setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					39 01 00 00 0F 00 03 F0 A5 A5
+					/*TE ON*/
+					39 01 00 00 00 00 03 9F A5 A5
+					15 01 00 00 00 00 02 35 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*MIC Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 08 EB 17 41 92 0E 10 82 5A
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*CASET/PASET*/
+					39 01 00 00 00 00 05 2A 00 00 04 37
+					39 01 00 00 00 00 05 2B 00 00 09 23
+					/*TSP H_sync Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 02 B0 09
+					39 01 00 00 00 00 03 E8 10 30
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Dimming Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*ESD improvement Setting*/
+					39 01 00 00 00 00 03 FC 5A 5A
+					39 01 00 00 00 00 02 B0 01
+					39 01 00 00 00 00 02 E3 88
+					39 01 00 00 00 00 02 B0 07
+					39 01 00 00 00 00 02 ED 67
+					39 01 00 00 00 00 03 FC A5 A5
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 20
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*ACL off*/
+					39 01 00 00 01 00 02 55 00
+					/*SEED OFF*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 B1 00 01
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*SEED TCS OFF*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 B3 00 C1
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Display on*/
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 00 00 02 29 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					];
+				qcom,mdss-dsi-off-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 01 28
+					05 01 00 00 00 00 01 10
+					39 01 00 00 00 00 03 9F 5A 5A
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 05
+					15 01 00 00 00 00 02 F4 01
+					39 01 00 00 96 00 03 F0 A5 A5
+					];
+			//qcom,mdss-dsi-post-on-backlight=[
+			//	39 01 00 00 00 00 03 9F A5 A5
+			//	05 01 00 00 00 00 01 29
+			//	39 01 00 00 00 00 03 9F 5A 5A
+			//];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+		   /**************************************************************/
+				qcom,mdss-dsi-panel-hbm-brightness-on-command = [
+					/*HBM ON */
+					39 00 00 00 00 00 03 F0 5A 5A
+					15 00 00 00 00 00 02 53 E0
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-off-command = [
+					/* DLY ON */
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 04 B7 00 01 5B
+					39 00 00 00 00 00 03 F0 A5 A5
+
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 02 53 20
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+						/*ELVSS OFF*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					15 00 00 00 00 00 02 B0 08
+					15 00 00 00 00 00 02 B7 12
+					39 01 00 00 10 00 03 F0 A5 A5
+						/*DLY OFF*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 04 B7 00 01 5B
+					39 00 00 00 00 00 03 F0 A5 A5
+						/*HBM ON */
+					15 00 00 00 00 00 02 53 E0
+					39 01 00 00 0E 00 03 51 03 FF
+						/*HBM 670nit*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 03 BD 00 00
+					39 00 00 00 00 00 03 F0 A5 A5
+						/*DLY OFF*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 04 B7 00 01 53
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+						/*HBM 670nit off*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 03 BD 00 02
+					39 00 00 00 00 00 03 F0 A5 A5
+						/*HBM off */
+					15 01 00 00 00 00 02 53 20
+				];
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-on = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 80 00 02 B7 92
+					39 01 00 00 40 00 02 53 E8
+					39 01 00 00 80 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 51 03 FF
+				];
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-off = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 40 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 40 00 02 B7 92
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 10 00 02 53 28
+				];
+				qcom,mdss-dsi-panel-hbm-brightness-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-brightness-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-on-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-off-state = "dsi_lp_mode";
+				qcom,mdss-dsi-hbm-off-command-state = "dsi_hs_mode";
+
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+
+				];
+
+				qcom,mdss-dsi-panel-aod-off-command = [
+
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";		
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+							/*ELVSS OFF*/
+						39 00 00 00 00 00 03 F0 5A 5A
+						15 00 00 00 00 00 02 B0 08
+						15 00 00 00 00 00 02 B7 12
+						39 00 00 00 00 00 03 F0 A5 A5
+							/*DL0 OFF*/
+						39 00 00 00 00 00 03 F0 5A 5A
+						39 00 00 00 00 00 04 B7 00 01 5B
+						39 00 00 00 00 00 03 F0 A5 A5
+							/*HB0 ON */
+						15 00 00 00 00 00 02 53 E0
+						39 00 00 00 00 00 03 51 03 FF
+							/*HB0 670nit*/
+						39 00 00 00 00 00 03 F0 5A 5A
+						39 00 00 00 00 00 03 BD 00 00
+						39 00 00 00 00 00 03 F0 A5 A5
+							/*DL0 OFF*/
+						39 00 00 00 00 00 03 F0 5A 5A
+						39 00 00 00 00 00 04 B7 00 01 53
+						39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+						/*HBM 670nit off*/
+					39 00 00 00 00 00 03 F0 5A 5A
+					39 00 00 00 00 00 03 BD 00 02
+					39 00 00 00 00 00 03 F0 A5 A5
+						/*HBM off */
+					15 01 00 00 00 00 02 53 20
+				];
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command = [
+
+				39 01 00 00 00 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+
+				];
+				qcom,mdss-dsi-panel-display-p3-mode-on-command = [
+				39 01 00 00 00 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 CE 01 02 1D E3 00 07 0D E9 28 FD F0 D3 0A E2 EA EA 01 FF FF F2
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command = [
+				39 01 00 00 00 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 FF 00 00 00 FF 00 00 00 FF 00 FF FF FF 00 FF FF FF 00 FF FF FF
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+
+				];
+				qcom,mdss-dsi-customer-srgb-enable-command = [
+				39 01 00 00 00 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 AF 06 0A 48 DF 10 05 08 C0 4D EF EA BD 0F DB F2 F0 18 FF FF FF
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command = [
+				39 01 00 00 00 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 CE 00 00 19 E5 00 06 09 C2 22 FA F3 DB 00 E6 EC E9 00 FF FF FF 
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-customer-p3-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-customer-srgb-enable-command-state  = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-p3-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-aod-mode-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command = [
+					06 01 00 00 00 00 01 A1
+				];
+			
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0E 08];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";	
+				qcom,mdss-dsi-panel-id-command = [06 01 00 01 05 00 02 DC 08];
+				qcom,mdss-dsi-panel-id-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id1-command = [06 01 00 01 05 00 02 0A 08];
+				qcom,mdss-dsi-panel-id1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id2-command = [06 01 00 01 05 00 02 0E 08];
+				qcom,mdss-dsi-panel-id2-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id3-command = [06 01 00 01 05 00 02 E0 08];
+				qcom,mdss-dsi-panel-id3-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id4-command = [06 01 00 01 05 00 02 0F 08];
+				qcom,mdss-dsi-panel-id4-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id5-command = [06 01 00 01 05 00 02 E3 08];
+				qcom,mdss-dsi-panel-id5-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id6-command = [06 01 00 01 05 00 02 E5 08];
+				qcom,mdss-dsi-panel-id6-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-id7-command = [06 01 00 01 05 00 02 FB 08];
+				qcom,mdss-dsi-panel-id7-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-level1-command = [15 01 00 00 00 00 02 B0 08];
+				qcom,mdss-dsi-panel-hbm-level1-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-read-command = [06 01 00 01 05 00 02 B7 08];
+				qcom,mdss-dsi-panel-hbm-read-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-open-command = [
+				39 01 00 00 00 00 03 FC 5A 5A];
+				qcom,mdss-dsi-panel-read-register-close-command = [
+				39 01 00 00 00 00 03 FC A5 A5];
+				qcom,mdss-dsi-panel-read-register-open-command-state  = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-read-register-close-command-state = "dsi_lp_mode";				
+				};
+		};
+	};
+};
+
+&dsi_samsung_s6e3fc2x01_cmd {
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_s6e3fc2x01_cmd_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_s6e3fc2x01_cmd {
+	qcom,mdss-dsi-display-timings {
+		timing@0{
+			qcom,mdss-dsi-panel-phy-timings = [00 22 09 09 25 23
+				09 09 06 03 04 00 1C 19];
+			qcom,display-topology = <1 0 1>;
+			qcom,default-topology-index = <0>;
+		};
+	};
+};
+
+
diff --git a/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01_ed173.dtsi b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01_ed173.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..0d40a8769153da52b2279e3c5d51d0310b5dda27
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_s6e3fc2x01_ed173.dtsi
@@ -0,0 +1,543 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+	dsi_samsung_s6e3fc2x01_ed173_cmd: qcom,mdss_dsi_samsung_s6e3fc2x01_ed173_cmd {
+		qcom,mdss-dsi-panel-name = "samsung s6e3fc2x01 ed173 cmd mode dsi panel";
+		qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-version = "S6E3FC2X01_ED173";
+		qcom,mdss-dsi-backlight-version = "SAMSUNG";
+		qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-type = "dsi_cmd_mode";
+		qcom,mdss-dsi-virtual-channel-id = <0>;
+		qcom,mdss-dsi-stream = <0>;
+		qcom,mdss-dsi-bpp = <24>;
+		qcom,mdss-dsi-underflow-color = <0xff>;
+		qcom,mdss-dsi-border-color = <0>;
+		qcom,mdss-dsi-reset-sequence = <1 5>, <0 2>, <1 10>;
+		qcom,mdss-pan-physical-width-dimension = <68>;
+		qcom,mdss-pan-physical-height-dimension = <145>;
+		qcom,mdss-dsi-traffic-mode = "burst_mode";
+		qcom,mdss-dsi-bllp-eof-power-mode;
+		qcom,mdss-dsi-bllp-power-mode;
+		qcom,mdss-dsi-lane-0-state;
+		qcom,mdss-dsi-lane-1-state;
+		qcom,mdss-dsi-lane-2-state;
+		qcom,mdss-dsi-lane-3-state;
+		qcom,mdss-dsi-dma-trigger = "trigger_sw";
+		qcom,mdss-dsi-mdp-trigger = "none";
+		qcom,mdss-dsi-te-pin-select = <1>;
+		qcom,mdss-dsi-wr-mem-start = <0x2c>;
+		qcom,mdss-dsi-wr-mem-continue = <0x3c>;
+		qcom,mdss-dsi-te-dcs-command = <1>;
+		//qcom,mdss-dsi-te-check-enable;
+		//qcom,esd-check-enabled;
+		qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+		qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0A 08];
+		qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+		qcom,mdss-dsi-panel-status-value = <0x9F>;
+		qcom,mdss-dsi-panel-status-read-length = <1>;
+		qcom,mdss-dsi-te-using-te-pin;
+		qcom,mdss-dsi-lp11-init;
+	    qcom,mdss-dsi-high-brightness-panel;
+		qcom,mdss-dsi-acl-cmd-index = <0>;
+		qcom,mdss-dsi-acl-mode-index = <1>;
+		qcom,mdss-bl-high2bit;
+		//qcom,mdss-dsi-panel-status-check-mode = "te_signal_check";
+		qcom,mdss-dsi-panel-seria-num-year-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-mon-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-day-index = <13>;
+		qcom,mdss-dsi-panel-seria-num-hour-index = <14>;
+		qcom,mdss-dsi-panel-seria-num-min-index = <15>;
+		qcom,ulps-enabled;
+		/* HDR Setting */
+		qcom,mdss-dsi-panel-hdr-enabled;
+		qcom,mdss-dsi-panel-hdr-color-primaries = <15635 16450 34000 16000 13250 34500 7500 3000>;
+		qcom,mdss-dsi-panel-peak-brightness = <5400000>;
+		qcom,mdss-dsi-panel-average-brightness = <2000000>;
+		qcom,mdss-dsi-panel-blackness-level = <2000>;
+		qcom,mdss-dsi-display-timings {
+			timing@0{
+				qcom,mdss-dsi-panel-framerate = <60>;
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2340>;
+				qcom,mdss-dsi-h-front-porch = <72>;
+				qcom,mdss-dsi-h-back-porch = <36>;
+				qcom,mdss-dsi-h-pulse-width = <16>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <18>;
+				qcom,mdss-dsi-v-front-porch = <32>;
+				qcom,mdss-dsi-v-pulse-width = <4>;
+				qcom,mdss-dsi-h-left-border = <0>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x4 0x1>;
+				qcom,mdss-dsi-panel-clockrate = <1037000000>;//	518.5MHZ
+				qcom,mdss-dsi-on-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*FD setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					39 01 00 00 0F 00 03 F0 A5 A5
+					/*TE ON*/
+					39 01 00 00 00 00 03 9F A5 A5
+					15 01 00 00 00 00 02 35 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*MIC Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 08 EB 17 41 92 0E 10 82 5A
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*CASET/PASET*/
+					39 01 00 00 00 00 05 2A 00 00 04 37
+					39 01 00 00 00 00 05 2B 00 00 09 23
+					/*TSP H_sync Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 02 B0 09
+					39 01 00 00 00 00 03 E8 10 30
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Dimming Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*ESD improvement Setting*/
+					39 01 00 00 00 00 03 FC 5A 5A
+					39 01 00 00 00 00 02 B0 01
+					39 01 00 00 00 00 02 E3 88
+					39 01 00 00 00 00 02 B0 07
+					39 01 00 00 00 00 02 ED 67
+					39 01 00 00 00 00 03 FC A5 A5
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 20
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*ACL off*/
+					39 01 00 00 01 00 02 55 00
+					/*SEED OFF*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 B1 00 01
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*SEED TCS OFF*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 B3 00 C1
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Display on*/
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 00 00 02 29 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					];
+				qcom,mdss-dsi-off-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 01 28
+					05 01 00 00 00 00 01 10
+					39 01 00 00 00 00 03 9F 5A 5A
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 05
+					15 01 00 00 00 00 02 F4 01
+					39 01 00 00 96 00 03 F0 A5 A5
+					];
+			//qcom,mdss-dsi-post-panel-on-command=[
+			//	39 01 00 00 00 00 03 9F A5 A5
+			//	05 01 00 00 00 00 01 29
+			//	39 01 00 00 00 00 03 9F 5A 5A
+			//];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;
+		   /**************************************************************/
+				qcom,mdss-dsi-panel-hbm-on-command = [
+				   39 01 00 00 00 00 03 F0 5A 5A
+				   15 01 00 00 00 00 02 B0 07
+				   15 01 00 00 00 00 02 B7 7F
+				   15 01 00 00 00 00 02 B0 08
+				   15 01 00 00 80 00 02 B7 92
+				   39 01 00 00 00 00 02 53 E8
+				   39 01 00 00 23 00 03 F0 A5 A5
+				   39 01 00 00 00 00 03 51 00 26
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-2 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 80 00 02 B7 92
+					39 01 00 00 00 00 02 53 E8
+					39 01 00 00 23 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 51 00 78
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-3 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 80 00 02 B7 92
+					39 01 00 00 00 00 02 53 E8
+					39 01 00 00 23 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 51 00 CA
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-4 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 80 00 02 B7 92
+					39 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 51 01 2A
+
+				];
+				qcom,mdss-dsi-panel-hbm-on-command-5 = [
+					/*ELVSS OFF*/
+				    39 01 00 00 00 00 03 F0 5A 5A
+				    15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+				    15 01 00 00 00 00 02 B0 08
+				    15 01 00 00 00 00 02 B7 12
+				    39 01 00 00 00 00 03 F0 A5 A5
+				    /*DLY OFF*/
+					39 01 00 00 00 00 03 F0 5A 5A
+			   	    39 01 00 00 00 00 04 B7 00 01 5B
+				    39 01 00 00 00 00 03 F0 A5 A5
+				    15 01 00 00 0A 00 02 53 E0
+					39 01 00 00 00 00 03 51 03 FF
+					/*DLY ON*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 04 B7 00 01 53
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-command = [
+				    /*DLY OFF*/
+			   	    39 01 00 00 00 00 03 F0 5A 5A
+				    39 01 00 00 00 00 04 B7 00 01 5B
+				    39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 02 53 20
+					/*DLY ON*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 04 B7 00 01 53
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-on = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 80 00 02 B7 92
+					39 01 00 00 40 00 02 53 E8
+					39 01 00 00 80 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 51 03 FF
+				];
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-off = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 40 00 02 B7 7F
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 40 00 02 B7 92
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 10 00 02 53 28
+				];
+				qcom,mdss-dsi-hbm-on-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-on-command-5-state = "dsi_hs_mode";
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-on-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-max-brightness-command-off-state = "dsi_lp_mode";
+				qcom,mdss-dsi-hbm-off-command-state = "dsi_hs_mode";
+
+				qcom,mdss-dsi-panel-aod-on-command-1 = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 01 28
+					05 01 00 00 78 00 01 10
+					05 01 00 00 05 00 01 11
+					39 01 00 00 00 00 03 9F 5A 5A
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 64 00 02 CD 02
+					15 01 00 00 00 00 02 53 23
+					15 01 00 00 00 00 02 B0 A5
+					15 01 00 00 00 00 02 C7 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 00 00 01 29
+					39 01 00 00 00 00 03 9F 5A 5A
+				];
+				qcom,mdss-dsi-panel-aod-on-command-2 = [
+					  39 01 00 00 00 00 03 9F A5 A5
+					  05 01 00 00 05 00 01 11
+					  39 01 00 00 00 00 03 9F 5A 5A
+					  39 01 00 00 00 00 03 f0 5a 5a
+					  15 01 00 00 00 00 02 b0 01
+					  15 01 00 00 53 00 02 cd 02
+					  15 01 00 00 00 00 02 53 20
+					  15 01 00 00 00 00 02 b0 a5
+					  15 01 00 00 00 00 02 c7 00
+					  15 01 00 00 00 00 02 53 22
+					  39 01 00 00 00 00 03 f0 a5 a5
+					  39 01 00 00 00 00 03 9F A5 A5
+					  05 01 00 00 00 00 01 29
+					  39 01 00 00 00 00 03 9F 5A 5A
+				];
+				qcom,mdss-dsi-panel-aod-on-command-3 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 02 53 20		
+				];
+				qcom,mdss-dsi-panel-aod-off-command = [
+					/*ELVSS OFF*/
+				    39 01 00 00 00 00 03 F0 5A 5A
+				    15 01 00 00 00 00 02 B0 08
+				    15 01 00 00 00 00 02 B7 12
+				    39 01 00 00 00 00 03 F0 A5 A5
+				    /*DLY OFF*/
+			   	    39 01 00 00 00 00 03 F0 5A 5A
+				    39 01 00 00 00 00 04 B7 00 01 5B
+				    39 01 00 00 00 00 03 F0 A5 A5
+				    39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					39 01 00 00 00 00 02 53 20
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*DLY ON*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 04 B7 00 01 53
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-aod-off-samsung-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 01 28
+					05 01 00 00 80 00 01 10
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 05
+					15 01 00 00 00 00 02 F4 01
+					39 01 00 00 32 00 03 F0 A5 A5
+					05 01 00 00 07 00 01 11
+					39 01 00 00 00 00 03 9F 5A 5A
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+					15 01 00 00 00 00 02 53 28
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 00 00 01 13
+					05 01 00 00 00 00 01 29
+					39 01 00 00 00 00 03 9F 5A 5A				
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command = [
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 01 28
+					05 01 00 00 00 00 01 10
+					39 01 00 00 00 00 03 9F 5A 5A
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 05
+					15 01 00 00 00 00 02 F4 01
+					39 01 00 00 96 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*FD setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 01
+					15 01 00 00 00 00 02 CD 01
+					39 01 00 00 0F 00 03 F0 A5 A5
+					/*TE ON*/
+					39 01 00 00 00 00 03 9F A5 A5
+					15 01 00 00 00 00 02 35 00
+					39 01 00 00 00 00 03 9F 5A 5A
+					/*MIC Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 08 EB 17 41 92 0E 10 82 5A
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*CASET/PASET*/
+					39 01 00 00 00 00 05 2A 00 00 04 37
+					39 01 00 00 00 00 05 2B 00 00 09 23
+					/*TSP H_sync Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 02 B0 09
+					39 01 00 00 00 00 03 E8 10 30
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Dimming Setting*/
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 20
+					39 01 00 00 00 00 03 F0 A5 A5
+					/*Display on*/
+					39 01 00 00 00 00 03 9F A5 A5
+					05 01 00 00 00 00 02 29 00
+					39 01 00 00 00 00 03 9F 5A 5A
+				];
+				qcom,mdss-dsi-panel-aod-off-new-command-state = "dsi_lp_mode";		
+				qcom,mdss-dsi-panel-aod-off-samsung-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command = [
+					
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 02 B0 07
+				39 01 00 00 00 00 02 B7 01
+				39 01 00 00 00 00 02 B0 08
+				39 01 00 00 00 00 02 B7 12
+				39 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 03 51 03 FF
+				39 01 00 00 00 00 02 53 E0
+				];
+				qcom,mdss-dsi-panel-aod-off-hbm-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command = [
+					39 01 00 00 00 00 02 53 22
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B7 01
+					15 01 00 00 00 00 02 B0 08
+					15 01 00 00 00 00 02 B7 12
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-hbm-off-aod-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-on-command-2-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-aod-off-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-aod-mode-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-serial-num-command = [
+					06 01 00 00 00 00 01 A1
+				];
+				qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+
+				qcom,mdss-dsi-panel-srgb-on-command = [
+					39 01 00 00 12 00 02 81 90
+					39 01 00 00 00 00 03 f0 5A 5A
+					39 01 00 00 00 00 02 B0 02
+					39 01 00 00 00 00 16 B1 a6 04 04 47 DF 10 05 05 C3 4C EF D4 Bb 0B BF f1 EB 18 fe f9 d8
+					39 01 00 00 00 00 03 B1 00 00
+					39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-srgb-off-command = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 B1 00 01
+					39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-srgb-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-srgb-off-command-state = "dsi_lp_mode";
+
+				qcom,mdss-dsi-panel-dci-p3-on-command = [
+				39 01 00 00 12 00 02 81 90
+				39 01 00 00 00 00 03 f0 5A 5A
+				39 01 00 00 00 00 02 B0 02
+				39 01 00 00 00 00 16 B1 C6 00 00 21 ED 02 08 06 c1 27 FC dC E4 00 D9 e6 e7 00 fe f9 d8
+				39 01 00 00 00 00 03 B1 00 00
+				39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-off-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 B1 00 01
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-dci-p3-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-dci-p3-off-command-state = "dsi_lp_mode";
+
+				qcom,mdss-dsi-panel-night-mode-on-command = [
+					39 01 00 00 12 00 02 81 90
+				  	39 01 00 00 00 00 03 f0 5A 5A
+				  	39 01 00 00 00 00 02 B0 02
+					39 01 00 00 00 00 16 B1 a6 04 04 47 DF 10 05 05 C3 4C EF D4 Bb 0B BF f1 EB 18 FF FE FA
+					39 01 00 00 00 00 03 B1 00 00
+					39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-off-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 B1 00 01
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-night-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-night-mode-off-command-state = "dsi_lp_mode";
+
+				qcom,mdss-dsi-panel-oneplus-mode-on-command = [
+					39 01 00 00 12 00 02 81 90
+				  39 01 00 00 00 00 03 f0 5A 5A
+				  39 01 00 00 00 00 02 B0 02
+					39 01 00 00 00 00 16 B1 b4 02 04 05 ff 02 00 00 ff 00 ff ff f0 00 f0 e0 e1 18 ff fe fB
+					39 01 00 00 00 00 03 B1 00 00
+					39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-oneplus-mode-off-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 B1 00 01
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-panel-oneplus-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-panel-oneplus-mode-off-comman-state = "dsi_lp_mode";
+
+				qcom,mdss-dsi-panel-adaption-mode-on-command = [
+				  39 01 00 00 12 00 02 81 90
+				  39 01 00 00 00 00 03 f0 5A 5A
+				  39 01 00 00 00 00 02 B0 02
+			          39 01 00 00 00 00 16 B1 C6 00 00 12 f8 02 04 00 c1 13 e9 de d5 00 e0 e4 e7 00 fb ff ff
+				  39 01 00 00 00 00 03 B1 00 00
+				  39 01 00 00 00 00 03 f0 A5 A5
+				];
+				qcom,mdss-dsi-panel-adaption-mode-off-command = [
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 03 B1 00 01
+				39 01 00 00 00 00 03 F0 A5 A5
+				];
+				qcom,mdss-dsi-adaption-mode-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-adaption-mode-off-command-state = "dsi_lp_mode";
+
+		    qcom,mdss-dsi-panel-status-command = [06 01 00 01 05 00 02 0a 08];
+		    qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+			qcom,mdss-dsi-panel-id-command = [06 01 00 01 05 00 02 dc 08];
+		    qcom,mdss-dsi-panel-id-command-state = "dsi_lp_mode";
+				};
+		};
+	};
+};
+
+&dsi_samsung_s6e3fc2x01_ed173_cmd {
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_s6e3fc2x01_ed173_cmd_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_s6e3fc2x01_ed173_cmd {
+	qcom,mdss-dsi-display-timings {
+		timing@0{
+			qcom,mdss-dsi-panel-phy-timings = [00 22 09 09 25 23
+				09 09 06 03 04 00 1C 19];
+			qcom,display-topology = <1 0 1>;
+			qcom,default-topology-index = <0>;
+		};
+	};
+};
+
+
diff --git a/arch/arm64/boot/dts/qcom/dsi-panel-samsung_sofef00_m_cmd.dtsi b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_sofef00_m_cmd.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..3f7a9df2d7f0afd578707c7e9a5e6c07de7793d9
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi-panel-samsung_sofef00_m_cmd.dtsi
@@ -0,0 +1,406 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+	dsi_samsung_sofef00_m_cmd: qcom,mdss_dsi_samsung_sofef00_m_cmd {
+			qcom,mdss-dsi-panel-name = "samsung sofef00_m cmd mode dsi panel";
+			qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+			qcom,mdss-dsi-panel-version = "SOFEF00_M";
+			qcom,mdss-dsi-backlight-version = "SAMSUNG";
+			qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+			qcom,mdss-dsi-panel-type = "dsi_cmd_mode";	
+			qcom,mdss-dsi-virtual-channel-id = <0>;
+			qcom,mdss-dsi-stream = <0>;
+			qcom,mdss-dsi-bpp = <24>;
+			qcom,mdss-dsi-underflow-color = <0xff>;
+			qcom,mdss-dsi-border-color = <0>;
+			qcom,mdss-dsi-reset-sequence = <1 20>, <0 10>, <1 20>;
+			qcom,mdss-pan-physical-width-dimension = <68>;
+			qcom,mdss-pan-physical-height-dimension = <145>;
+			qcom,mdss-dsi-traffic-mode = "burst_mode";
+			qcom,mdss-dsi-bllp-eof-power-mode;
+			qcom,mdss-dsi-bllp-power-mode;
+			qcom,mdss-dsi-lane-0-state;
+			qcom,mdss-dsi-lane-1-state;
+			qcom,mdss-dsi-lane-2-state;
+			qcom,mdss-dsi-lane-3-state;
+			qcom,mdss-dsi-dma-trigger = "trigger_sw";
+			qcom,mdss-dsi-mdp-trigger = "none";
+			qcom,mdss-dsi-te-pin-select = <1>;
+			qcom,mdss-dsi-wr-mem-start = <0x2c>;
+			qcom,mdss-dsi-wr-mem-continue = <0x3c>;
+			qcom,mdss-dsi-te-dcs-command = <1>;
+			//qcom,mdss-dsi-te-check-enable;
+			qcom,mdss-dsi-tx-eot-append;
+			qcom,mdss-dsi-post-init-delay = <1>;			
+			//qcom,esd-check-enabled;
+			qcom,mdss-dsi-panel-status-check-mode = "reg_read";
+			qcom,mdss-dsi-panel-status-command =
+			[06 01 00 01 05 00 02 0A 08];
+			qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+			qcom,mdss-dsi-panel-status-value = <0x9c>;
+			qcom,mdss-dsi-panel-status-read-length = <1>;
+			qcom,mdss-dsi-panel-status-value-2 = <0xdc>;
+			qcom,mdss-dsi-te-using-te-pin;
+			qcom,mdss-dsi-lp11-init;
+			qcom,mdss-dsi-high-brightness-panel;
+			qcom,mdss-dsi-acl-cmd-index = <0>;
+			qcom,mdss-dsi-acl-mode-index = <1>;
+			qcom,mdss-bl-high2bit;
+			//qcom,mdss-dsi-panel-status-check-mode = "te_signal_check";
+			qcom,mdss-dsi-panel-seria-num-year-index = <12>;
+			qcom,mdss-dsi-panel-seria-num-mon-index = <12>;
+			qcom,mdss-dsi-panel-seria-num-day-index = <13>;
+			qcom,mdss-dsi-panel-seria-num-hour-index = <14>;
+			qcom,mdss-dsi-panel-seria-num-min-index = <15>;
+			qcom,ulps-enabled;	
+			qcom,mdss-dsi-display-timings {
+				timing@0{
+					qcom,mdss-dsi-panel-framerate = <60>;
+					qcom,mdss-dsi-panel-width = <1080>;
+					qcom,mdss-dsi-panel-height = <2280>;
+					
+					qcom,mdss-dsi-h-front-porch = <124>;
+					qcom,mdss-dsi-h-back-porch = <36>;
+					qcom,mdss-dsi-h-pulse-width = <12>;
+					qcom,mdss-dsi-h-sync-skew = <0>;
+					qcom,mdss-dsi-v-back-porch = <2>;
+					qcom,mdss-dsi-v-front-porch = <12>;
+					qcom,mdss-dsi-v-pulse-width = <2>;
+					qcom,mdss-dsi-h-left-border = <0>;
+					qcom,mdss-dsi-h-right-border = <0>;
+					qcom,mdss-dsi-v-top-border = <0>;
+					qcom,mdss-dsi-v-bottom-border = <0>;				
+					qcom,mdss-dsi-panel-jitter = <0x8 0xa>;
+					qcom,mdss-dsi-on-command = [
+					 05 01 00 00 0A 00 02 11 00
+		      		 15 01 00 00 00 00 02 B0 1C
+					 15 01 00 00 0F 00 02 B5 24
+		       		 15 01 00 00 00 00 02 35 00
+		      		 39 01 00 00 00 00 03 FC 5A 5A
+		       		 39 01 00 00 00 00 04 E8 64 08 0C
+		             39 01 00 00 00 00 03 FC A5 A5
+		             39 01 00 00 00 00 03 F0 5A 5A
+		             39 01 00 00 00 00 02 B0 01
+		             39 01 00 00 00 00 02 ED 04
+		             39 01 00 00 00 00 03 F0 A5 A5
+		             15 01 00 00 00 00 02 53 20
+		             15 01 00 00 78 00 02 55 00
+				     05 01 00 00 00 00 02 29 00
+						];
+					qcom,mdss-dsi-off-command = [
+						05 01 00 00 28 00 02 28 00
+						05 01 00 00 A0 00 02 10 00
+						];
+					qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+					qcom,mdss-dsi-h-sync-pulse = <0>;
+			   /**************************************************************/
+					qcom,mdss-dsi-panel-acl-command = [15 01 00 00 00 00 02 55 00];
+					qcom,mdss-dsi-acl-command-state = "dsi_hs_mode";
+					qcom,mdss-dsi-panel-hbm-on-command = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 B2 02 D4
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-hbm-on-command-2 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 B2 02 3C
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-hbm-on-command-3 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 B2 01 9C
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-hbm-on-command-4 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 B2 00 F0
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-hbm-on-command-5 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 E8
+					39 01 00 00 00 00 03 B2 00 40
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-hbm-off-command = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 28
+					15 01 00 00 00 00 02 F7 03
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-hbm-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-hbm-off-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-panel-aod-on-command-1 = [
+					05 01 00 00 23 00 02 28 00
+					05 01 00 00 78 00 02 10 00
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 35 00
+					15 01 00 00 00 00 02 55 00
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B6 22
+					15 01 00 00 00 00 02 53 23
+					05 01 00 00 01 00 02 39 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					05 01 00 00 00 00 02 29 00
+					];
+					qcom,mdss-dsi-panel-aod-on-command-2 = [
+					05 01 00 00 23 00 02 28 00
+					05 01 00 00 78 00 02 10 00
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 35 00
+					15 01 00 00 00 00 02 55 00
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B6 22
+					15 01 00 00 00 00 02 53 22
+					05 01 00 00 01 00 02 39 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					05 01 00 00 00 00 02 29 00
+					];
+					qcom,mdss-dsi-panel-aod-on-command-3 = [
+					05 01 00 00 23 00 02 28 00
+					05 01 00 00 78 00 02 10 00
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 35 00
+					15 01 00 00 00 00 02 55 00
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B6 22
+					15 01 00 00 00 00 02 53 23
+					05 01 00 00 01 00 02 38 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					05 01 00 00 00 00 02 29 00
+					];
+					qcom,mdss-dsi-panel-aod-on-command-4 = [
+					05 01 00 00 23 00 02 28 00
+					05 01 00 00 78 00 02 10 00
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 35 00
+					15 01 00 00 00 00 02 55 00
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B6 22
+					15 01 00 00 00 00 02 53 22
+					05 01 00 00 01 00 02 38 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					05 01 00 00 00 00 02 29 00
+					];
+					qcom,mdss-dsi-panel-aod-off-command = [
+					05 01 00 00 23 00 02 28 00
+					05 01 00 00 78 00 02 10 00
+					05 01 00 00 0A 00 02 11 00
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 35 00
+					15 01 00 00 00 00 02 55 00
+					15 01 00 00 00 00 02 B0 07
+					15 01 00 00 00 00 02 B6 12
+					15 01 00 00 00 00 02 53 20
+					05 01 00 00 01 00 02 38 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					05 01 00 00 00 00 02 29 00
+					];
+					qcom,mdss-dsi-panel-aod-mode-command-1 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 23
+					05 01 00 00 01 00 02 39 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-aod-mode-command-2 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 22
+					05 01 00 00 01 00 02 39 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-aod-mode-command-3 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 23
+					05 01 00 00 01 00 02 38 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-aod-mode-command-4 = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					15 01 00 00 00 00 02 53 22
+					05 01 00 00 01 00 02 38 00
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-aod-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-aod-off-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-aod-mode-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-serial-num-command = [
+						06 01 00 00 00 00 01 A1
+					];
+					qcom,mdss-dsi-panel-serial-num-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-srgb-on-command = [
+						39 01 00 00 00 00 03 f0 5A 5A
+						39 01 00 00 00 00 03 E2 00 85
+						39 01 00 00 00 00 02 B0 2C
+						39 01 00 00 00 00 16 E2 B1 07 06 3E CD 14 07 08 B0 4D E6 C9 C1 0B B9 E5 DA 18 FE F6 D7
+						39 01 00 00 00 00 02 b0 49
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4A
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4B
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4C
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4D
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 03 f0 A5 A5
+					];
+					qcom,mdss-dsi-panel-srgb-off-command = [
+						39 01 00 00 00 00 03 F0 5A 5A
+						39 01 00 00 00 00 03 E2 00 40
+						39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-srgb-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-srgb-off-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-dci-p3-on-command = [
+						39 01 00 00 00 00 03 f0 5A 5A
+						39 01 00 00 00 00 03 E2 00 85
+						39 01 00 00 00 00 02 B0 2C
+						39 01 00 00 00 00 16 E2 D0 00 00 12 D4 00 0A 08 C3 1D EE CF E8 02 C8 E7 DE 00 FF F6 D7
+						39 01 00 00 00 00 02 b0 49
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4A
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4B
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4C
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4D
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 03 f0 A5 A5
+					];
+					qcom,mdss-dsi-panel-dci-p3-off-command = [
+					39 01 00 00 00 00 03 F0 5A 5A
+					39 01 00 00 00 00 03 E2 00 40
+					39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-dci-p3-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-dci-p3-off-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-night-mode-on-command = [
+						39 01 00 00 00 00 03 f0 5A 5A
+						39 01 00 00 00 00 03 E2 00 85
+						39 01 00 00 00 00 02 B0 2C
+						39 01 00 00 00 00 16 E2 B1 07 06 3E CD 14 07 08 B0 4D E6 C9 C1 0B B9 E5 DA 18 FE FD F5
+						39 01 00 00 00 00 02 b0 49
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 03 f0 A5 A5
+					];
+					qcom,mdss-dsi-panel-night-mode-off-command = [
+						39 01 00 00 00 00 03 F0 5A 5A
+						39 01 00 00 00 00 03 E2 00 40
+						39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-night-mode-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-night-mode-off-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-oneplus-mode-on-command = [
+						39 01 00 00 00 00 03 f0 5A 5A
+						39 01 00 00 00 00 03 E2 00 85
+						39 01 00 00 00 00 02 B0 2C
+						39 01 00 00 00 00 16 E2 b4
+						02 04 05 ff 02 00 00 ff 00
+						ff ff f0 00 f0 e0 e1 18 ff fe fB
+						39 01 00 00 00 00 02 b0 49
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4A
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 02 b0 4B
+						39 01 00 00 00 00 02 E2 01
+						39 01 00 00 00 00 02 b0 4C
+						39 01 00 00 00 00 02 E2 01
+						39 01 00 00 00 00 03 f0 a5 a5
+					];
+					qcom,mdss-dsi-panel-oneplus-mode-off-command = [
+						39 01 00 00 00 00 03 F0 5A 5A
+						39 01 00 00 00 00 03 E2 00 40
+						39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-panel-oneplus-mode-on-command-state = "dsi_lp_mode";
+					qcom,mdss-dsi-panel-oneplus-mode-off-command-state = "dsi_lp_mode";
+	
+					qcom,mdss-dsi-panel-adaption-mode-on-command = [
+						39 01 00 00 00 00 03 f0 5A 5A
+						39 01 00 00 00 00 03 E2 00 85
+						39 01 00 00 00 00 02 B0 2C
+						39 01 00 00 00 00 16 E2 B4 02 04 05 FF 02 00 00 FF 00 FF FF F0 00 F0 E0 E1 18 FE FD F1
+						39 01 00 00 00 00 02 b0 49
+						39 01 00 00 00 00 02 E2 00
+						39 01 00 00 00 00 03 f0 A5 A5
+					];
+					qcom,mdss-dsi-panel-adaption-mode-off-command = [
+						39 01 00 00 00 00 03 F0 5A 5A
+						39 01 00 00 00 00 03 E2 00 40
+						39 01 00 00 00 00 03 F0 A5 A5
+					];
+					qcom,mdss-dsi-adaption-mode-on-command-state =
+					"dsi_lp_mode";
+					qcom,mdss-dsi-adaption-mode-off-command-state =
+					"dsi_lp_mode";
+	
+				qcom,mdss-dsi-panel-status-command =
+				[06 01 00 01 05 00 02 0a 08];
+				qcom,mdss-dsi-panel-status-command-state = "dsi_lp_mode";
+	
+				qcom,mdss-dsi-panel-id-command = [06 01 00 01 05 00 02 dc 08];
+				qcom,mdss-dsi-panel-id-command-state = "dsi_lp_mode";
+					};
+			};
+		};
+	};
+
+	
+&dsi_samsung_sofef00_m_cmd {
+
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_sofef00_m_cmd_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_sofef00_m_cmd {
+	qcom,mdss-dsi-display-timings {
+		timing@0{
+			qcom,mdss-dsi-panel-phy-timings = [00 22 09 09 25 23
+				09 09 06 03 04 00 1C 19];
+			qcom,display-topology = <1 0 1>;
+			qcom,default-topology-index = <0>;
+		};
+	};
+};
+
+
diff --git a/arch/arm64/boot/dts/qcom/dsi_samsung_oneplus_fhd_dsc.dtsi b/arch/arm64/boot/dts/qcom/dsi_samsung_oneplus_fhd_dsc.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..6bb60bc40ff336414bdc5bf83a11805a20e20d60
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/dsi_samsung_oneplus_fhd_dsc.dtsi
@@ -0,0 +1,270 @@
+/* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+&mdss_mdp {
+	dsi_samsung_oneplus_fhd_dsc_cmd: qcom,mdss_dsi_samsung_oneplus_fhd_dsc_cmd {
+		qcom,mdss-dsi-panel-name = "samsung oneplus dsc fhd cmd mode dsi panel";
+		qcom,mdss-dsi-panel-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-version = "DSC";
+		qcom,mdss-dsi-backlight-version = "SAMSUNG";
+		qcom,mdss-dsi-backlight-manufacture = "SAMSUNG";
+		qcom,mdss-dsi-panel-type = "dsi_cmd_mode";
+		qcom,mdss-dsi-virtual-channel-id = <0>;
+		qcom,mdss-dsi-stream = <0>;
+		qcom,mdss-dsi-bpp = <24>;
+		qcom,mdss-dsi-underflow-color = <0xff>;
+		qcom,mdss-dsi-border-color = <0>;
+		qcom,mdss-dsi-reset-sequence = <1 5>, <0 2>, <1 10>;
+		qcom,mdss-pan-physical-width-dimension = <68>;
+		qcom,mdss-pan-physical-height-dimension = <145>;
+		qcom,mdss-dsi-traffic-mode = "burst_mode";
+		qcom,mdss-dsi-bllp-eof-power-mode;
+		qcom,mdss-dsi-bllp-power-mode;
+		qcom,mdss-dsi-lane-0-state;
+		qcom,mdss-dsi-lane-1-state;
+		qcom,mdss-dsi-lane-2-state;
+		qcom,mdss-dsi-lane-3-state;
+		qcom,mdss-dsi-dma-trigger = "trigger_sw";
+		qcom,mdss-dsi-mdp-trigger = "none";
+		qcom,mdss-dsi-te-pin-select = <1>;
+		qcom,mdss-dsi-wr-mem-start = <0x2c>;
+		qcom,mdss-dsi-wr-mem-continue = <0x3c>;
+		qcom,mdss-dsi-te-dcs-command = <1>;
+		qcom,mdss-dsi-te-check-enable;
+		qcom,mdss-dsi-te-using-te-pin;
+		qcom,mdss-dsi-lp11-init;
+	    qcom,mdss-dsi-high-brightness-panel;
+		qcom,mdss-dsi-acl-cmd-index = <0>;
+		qcom,mdss-dsi-acl-mode-index = <1>;
+		qcom,mdss-bl-high2bit;		
+		qcom,mdss-dsi-panel-seria-num-year-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-mon-index = <12>;
+		qcom,mdss-dsi-panel-seria-num-day-index = <13>;
+		qcom,mdss-dsi-panel-seria-num-hour-index = <14>;
+		qcom,mdss-dsi-panel-seria-num-min-index = <15>;
+		qcom,ulps-enabled;
+		
+		qcom,mdss-dsi-display-timings {
+			timing@0{
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			qcom,mdss-dsi-panel-framerate = <60>;
+			qcom,mdss-dsi-panel-width = <1080>;
+			qcom,mdss-dsi-panel-height = <2336>;				
+			qcom,mdss-dsi-h-front-porch = <116>;
+			qcom,mdss-dsi-h-back-porch = <120>;
+			qcom,mdss-dsi-h-pulse-width = <44>;
+			qcom,mdss-dsi-h-sync-skew = <0>;
+			qcom,mdss-dsi-v-back-porch = <124>;
+			qcom,mdss-dsi-v-front-porch = <120>;
+			qcom,mdss-dsi-v-pulse-width = <80>;
+			qcom,mdss-dsi-h-right-border = <0>;
+			qcom,mdss-dsi-v-top-border = <0>;
+			qcom,mdss-dsi-v-bottom-border = <0>;
+			qcom,mdss-dsi-panel-jitter = <0x8 0xa>; 		
+			qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+			qcom,mdss-dsi-panel-clockrate = <1100000000>;
+			qcom,mdss-dsi-timing-switch-command = [ 
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01
+				//29 01 00 00 00 00 02 C3 01
+				29 01 00 00 00 00 05 2A 00 00 04 37 	
+				29 01 00 00 00 00 05 2B 00 00 09 1F 	
+				29 01 00 00 00 00 02 53 20		
+				29 01 00 00 00 00 03 F0 A5 A5
+
+			
+			];
+		qcom,mdss-dsi-panel-phy-timings = [00 16 05 05 20 1f 06 06 03 03 04 00 13 15];
+		qcom,mdss-dsi-t-clk-pre = <0x13>;
+		qcom,mdss-dsi-t-clk-post = <0x15>;
+		qcom,mdss-dsi-on-command = [	
+			29 01 00 00 00 00 03 F0 5A 5A		
+			07 01 00 00 00 00 01 01
+			29 01 00 00 00 00 02 C3 01
+			29 01 00 00 00 00 05 2A 00 00 04 37 	
+			29 01 00 00 00 00 05 2B 00 00 09 1F 	
+			29 01 00 00 00 00 5A 0A 11 00 00 89 30 80 09 20 04 38 00
+			49 02 1C 02 1C 02 00 02 0E 00 20
+			07 16 00 07 00 0C 01 56 01 65 18
+			00 10 F0 03 0C 20 00 06 0B 0B 33
+			0E 1C 2A 38 46 54 62 69 70 77 79
+			7B 7D 7E 01 02 01 00 09 40 09 BE
+			19 FC 19 FA 19 F8 1A 38 1A 78 1A
+			B6 2A F6 2B 34 2B 74 3B 74 6B F4 
+			00
+			39 01 00 00 00 00 02 53 20
+			29 01 00 00 00 00 03 F0 A5 A5
+			05 01 00 00 0A 00 01 11 	
+			15 01 00 00 00 00 02 35 00	
+			29 01 00 00 00 00 05 2A 00 00 04 37 	
+			29 01 00 00 00 00 05 2B 00 00 09 1F  
+			39 01 00 00 00 00 03 F0 5A 5A
+			39 01 00 00 00 00 0a B9 01 B0 81 09 00 00 00 11 03
+			39 01 00 00 00 00 03 F0 A5 A5					
+			29 01 00 00 00 00 03 F0 5A 5A
+			15 01 00 00 00 00 02 B0 05
+			15 01 00 00 00 00 02 B1 01
+			15 01 00 00 00 00 02 B0 02
+			15 01 00 00 00 00 02 B5 d3
+			29 01 00 00 00 00 03 F0 A5 A5
+			39 01 00 00 00 00 02 53 20				
+			05 01 00 00 00 00 01 29 	
+			];
+			qcom,mdss-dsi-off-command = [
+			
+			/*Display off Delay 20ms*/
+			05 01 00 00 14 00 02 28 00
+			/*Sleep in*/
+			05 01 00 00 00 00 02 10 00
+	
+			];
+			qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+			qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+			qcom,mdss-dsi-timing-switch-command-state = "dsi_lp_mode";
+			qcom,mdss-dsi-h-sync-pulse = <0>;					
+
+			qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+			qcom,compression-mode = "dsc";
+			qcom,lm-split = <540 540>;
+			qcom,mdss-dsc-encoders = <2>;
+			qcom,mdss-dsc-slice-height = <73>;
+			qcom,mdss-dsc-slice-width = <540>;
+			qcom,mdss-dsc-slice-per-pkt = <2>;
+			qcom,mdss-dsc-bit-per-component = <8>;
+			qcom,mdss-dsc-bit-per-pixel = <8>;
+			qcom,mdss-dsc-block-prediction-enable;
+			};
+timing@1{
+				qcom,display-topology = <1 1 1>,<2 2 1>;
+				qcom,default-topology-index = <1>;
+				qcom,mdss-dsi-panel-framerate = <90>;
+				qcom,mdss-dsi-panel-width = <1080>;
+				qcom,mdss-dsi-panel-height = <2336>;				
+				qcom,mdss-dsi-h-front-porch = <116>;
+				qcom,mdss-dsi-h-back-porch = <120>;
+				qcom,mdss-dsi-h-pulse-width = <44>;
+				qcom,mdss-dsi-h-sync-skew = <0>;
+				qcom,mdss-dsi-v-back-porch = <124>;
+				qcom,mdss-dsi-v-front-porch = <120>;
+				qcom,mdss-dsi-v-pulse-width = <80>;
+				qcom,mdss-dsi-h-right-border = <0>;
+				qcom,mdss-dsi-v-top-border = <0>;
+				qcom,mdss-dsi-v-bottom-border = <0>;
+				qcom,mdss-dsi-panel-jitter = <0x8 0xa>; 		
+				qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+				qcom,mdss-dsi-panel-clockrate = <1100000000>;
+				qcom,mdss-dsi-timing-switch-command = [ 
+				29 01 00 00 00 00 03 F0 5A 5A
+				07 01 00 00 00 00 01 01
+				//29 01 00 00 00 00 02 C3 01
+				29 01 00 00 00 00 05 2A 00 00 04 37 	
+				29 01 00 00 00 00 05 2B 00 00 09 1F 	
+				29 01 00 00 00 00 02 53 30		
+				29 01 00 00 00 00 03 F0 A5 A5
+				
+				];
+			qcom,mdss-dsi-panel-phy-timings = [00 1F 08 08 24 22 08 08 05 03 04 00 1A 18];
+			qcom,mdss-dsi-t-clk-pre = <0x1A>;
+			qcom,mdss-dsi-t-clk-post = <0x18>;
+			qcom,mdss-dsi-on-command = [	
+				29 01 00 00 00 00 03 F0 5A 5A		
+				07 01 00 00 00 00 01 01
+				29 01 00 00 00 00 02 C3 01
+				29 01 00 00 00 00 05 2A 00 00 04 37 	
+				29 01 00 00 00 00 05 2B 00 00 09 1F 	
+				29 01 00 00 00 00 5A 0A 11 00 00 89 30 80 09 20 04 38 00
+				49 02 1C 02 1C 02 00 02 0E 00 20
+				07 16 00 07 00 0C 01 56 01 65 18
+				00 10 F0 03 0C 20 00 06 0B 0B 33
+				0E 1C 2A 38 46 54 62 69 70 77 79
+				7B 7D 7E 01 02 01 00 09 40 09 BE
+				19 FC 19 FA 19 F8 1A 38 1A 78 1A
+				B6 2A F6 2B 34 2B 74 3B 74 6B F4 
+				00
+				29 01 00 00 00 00 03 F0 A5 A5
+				05 01 00 00 0A 00 01 11 	
+				15 01 00 00 00 00 02 35 00	
+				29 01 00 00 00 00 05 2A 00 00 04 37 	
+				29 01 00 00 00 00 05 2B 00 00 09 1F  
+				39 01 00 00 00 00 03 F0 5A 5A
+				39 01 00 00 00 00 0a B9 01 B0 81 09 00 00 00 11 03
+				39 01 00 00 00 00 03 F0 A5 A5					
+				29 01 00 00 00 00 03 F0 5A 5A
+				15 01 00 00 00 00 02 B0 05
+				15 01 00 00 00 00 02 B1 01
+				15 01 00 00 00 00 02 B0 02
+				15 01 00 00 00 00 02 B5 d3
+				29 01 00 00 00 00 03 F0 A5 A5
+				39 01 00 00 00 00 02 53 30				
+				05 01 00 00 00 00 01 29 	
+				];
+				qcom,mdss-dsi-off-command = [
+				
+				/*Display off Delay 20ms*/
+				05 01 00 00 14 00 02 28 00
+				/*Sleep in*/
+				05 01 00 00 00 00 02 10 00			
+				];
+				qcom,mdss-dsi-on-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-off-command-state = "dsi_hs_mode";
+				qcom,mdss-dsi-timing-switch-command-state = "dsi_lp_mode";
+				qcom,mdss-dsi-h-sync-pulse = <0>;		
+				qcom,panel-roi-alignment=<540 73 540 73 540 73>;
+				qcom,compression-mode = "dsc";
+				qcom,lm-split = <540 540>;
+				qcom,mdss-dsc-encoders = <2>;
+				qcom,mdss-dsc-slice-height = <73>;
+				qcom,mdss-dsc-slice-width = <540>;
+				qcom,mdss-dsc-slice-per-pkt = <2>;
+				qcom,mdss-dsc-bit-per-component = <8>;
+				qcom,mdss-dsc-bit-per-pixel = <8>;
+				qcom,mdss-dsc-block-prediction-enable;
+			
+			};
+
+			
+		};
+	};
+};
+
+&dsi_samsung_oneplus_fhd_dsc_cmd {
+
+	qcom,panel-supply-entries = <&dsi_panel_pwr_supply>;
+	qcom,mdss-dsi-bl-pmic-control-type = "bl_ctrl_dcs";
+	qcom,mdss-dsi-bl-min-level = <1>;
+	qcom,mdss-dsi-bl-max-level = <1023>;
+	qcom,platform-te-gpio = <&tlmm 8 0>;
+	qcom,platform-reset-gpio = <&tlmm 6 0>;
+};
+
+&soc {
+	dsi_samsung_oneplus_fhd_dsc_cmd_display {
+		qcom,dsi-display-active;
+	};
+};
+
+&dsi_samsung_oneplus_fhd_dsc_cmd{
+	qcom,mdss-dsi-display-timings {
+		timing@0{
+			qcom,mdss-dsi-panel-phy-timings = [00 16 05 05 20 1f 06 06 03 03 04 00 13 15];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			};
+		timing@1{
+			qcom,mdss-dsi-panel-phy-timings = [00 1F 08 08 24 22 08 08 05 03 04 00 1A 18];
+			qcom,display-topology = <1 1 1>,<2 2 1>;
+			qcom,default-topology-index = <1>;
+			};
+	};
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-dvt.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-dvt.dts
new file mode 100644
index 0000000000000000000000000000000000000000..e273cc611f3f47474508b6b03e82996c89ea217e
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-dvt.dts
@@ -0,0 +1,43 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+#include "guacamole_evt2.dtsi"
+#include "guacamole_evt3.dtsi"
+#include "guacamole_dvt.dtsi"
+
+/ {
+	model = "MTP 18821 18831 15";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0 >;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <15>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-evt1.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt1.dts
new file mode 100644
index 0000000000000000000000000000000000000000..68749dd8d7956f6dfa2f6508e82e15fb2d3588bc
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt1.dts
@@ -0,0 +1,39 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+/ {
+	model = "MTP 18821 18831 12";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0>;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <12>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2-second.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2-second.dts
new file mode 100644
index 0000000000000000000000000000000000000000..a6e084d6c298056c3730d1314f01ac76f6b56195
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2-second.dts
@@ -0,0 +1,75 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+#include "guacamole_evt2.dtsi"
+/ {
+	model = "MTP 18821 18831 second 55";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0>;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <55>;
+};
+
+&qupv3_se8_i2c {
+	oneplus_fastchg@26{
+		status = "disable";
+	};
+
+	oneplus_fastchg@52{
+		status = "ok";
+		compatible = "microchip,oneplus_fastchg";
+		reg = <0x52>;
+		microchip,mcu-en-gpio = <&tlmm 10 0x00>;
+		microchip,usb-sw-1-gpio = <&tlmm 94 0x00>;
+		microchip,usb-sw-2-gpio = <&tlmm 59 0x00>;
+		microchip,ap-clk = <&tlmm 92 0x00>;
+		microchip,ap-data = <&tlmm 93 0x00>;
+		op,fw-erase-count = <959>;
+		op,fw-addr-low = <0>;
+		op,fw-addr-high = <0>;
+		op,n76e_support;
+		op,mcl_verion;
+
+		pinctrl-names = "mux_fastchg_active",
+		"mux_fastchg_suspend",
+		"mcu_data_active",
+		"mcu_data_suspend";
+		pinctrl-0 = <&fastchg_active
+		&usb_sw_active
+		&ap_clk_active >;
+		pinctrl-1 = <&usb_sw_suspend
+		&fastchg_suspend
+		&ap_clk_suspend>;
+		pinctrl-2 =<&ap_data_active>;
+		pinctrl-3 =<&ap_data_suspend>;
+	};
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2.dts
new file mode 100644
index 0000000000000000000000000000000000000000..d75754eb4b0f771d1b4af104c7832506065e15f5
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt2.dts
@@ -0,0 +1,40 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+#include "guacamole_evt2.dtsi"
+/ {
+	model = "MTP 18821 18831 13 54 evt2";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0>;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <13 54>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-evt3.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt3.dts
new file mode 100644
index 0000000000000000000000000000000000000000..070ed1c5453c17fe8c3646109a982765dfe9a756
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-evt3.dts
@@ -0,0 +1,41 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+#include "guacamole_evt2.dtsi"
+#include "guacamole_evt3.dtsi"
+/ {
+	model = "MTP 18821 18831 14 52 53";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0>;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <14 52 53>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-pvt.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-pvt.dts
new file mode 100644
index 0000000000000000000000000000000000000000..1a3299e5dfed8706b05294b4037a4e1751cc8734
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-pvt.dts
@@ -0,0 +1,44 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+#include "guacamole_evt1.dtsi"
+#include "guacamole_evt2.dtsi"
+#include "guacamole_evt3.dtsi"
+#include "guacamole_dvt.dtsi"
+#include "guacamole_pvt.dtsi"
+
+/ {
+	model = "MTP 18821 18831 21 22";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0 >;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <21 22>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole-overlay-t0.dts b/arch/arm64/boot/dts/qcom/guacamole-overlay-t0.dts
new file mode 100644
index 0000000000000000000000000000000000000000..ef389e47a2751975099ae13ccb2800e0d140699c
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole-overlay-t0.dts
@@ -0,0 +1,39 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+/dts-v1/;
+/plugin/;
+
+#include <dt-bindings/clock/qcom,gcc-sm8150.h>
+#include <dt-bindings/clock/qcom,camcc-sm8150.h>
+#include <dt-bindings/clock/qcom,rpmh.h>
+#include <dt-bindings/interrupt-controller/arm-gic.h>
+
+#include "sm8150-mtp.dtsi"
+#include "sm8150-mtp-audio-overlay.dtsi"
+
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-t0.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_sm8150.dtsi"
+#include "guacamole_t0.dtsi"
+
+/ {
+	model = "MTP 18821 18831 T0 11";
+	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
+	qcom,board-id = <8 0>;
+	/*we can add project id to this array,uefi can auto read it,if new project,we add to this array */
+	oem,project-id = <18821 18831>;
+	/*we can add hw id to this array,uefi can auto read it,if new hw,we add to this array  */
+	oem,hw-id = <11>;
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole.dtsi b/arch/arm64/boot/dts/qcom/guacamole.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..0e3a5bf663875884d0138935c1804f66ffb47398
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole.dtsi
@@ -0,0 +1,189 @@
+
+&pm8150_adc_tm {
+	skin_therm {
+		reg = <ADC_AMUX_THM1_PU2>;
+		qcom,ratiometric;
+		qcom,hw-settle-time = <200>;
+	};
+
+	pa_therm1 {
+		reg = <ADC_AMUX_THM2_PU2>;
+		qcom,ratiometric;
+		qcom,hw-settle-time = <200>;
+	};
+};
+
+&thermal_zones {
+	skin-therm {
+		polling-delay-passive = <2000>;
+		polling-delay = <0>;
+		thermal-governor = "step_wise";
+		thermal-sensors = <&pm8150_adc_tm ADC_AMUX_THM1_PU2>;
+		trips {
+			freq_config1: freq_config1 {
+				temperature = <52000>;
+				hysteresis = <2000>;
+				type = "passive";
+			};
+			freq_config2: freq_config2 {
+				temperature = <54000>;
+				hysteresis = <2000>;
+				type = "passive";
+			};
+		};
+		cooling-maps {
+			freq_dev0 {
+				trip = <&freq_config1>;
+				cooling-device =
+					<&msm_gpu THERMAL_NO_LIMIT
+						(THERMAL_MAX_LIMIT-1)>;/*345*/
+			};
+			freq_dev1 {
+				trip = <&freq_config1>;
+				cooling-device =
+					<&CPU0 9 9>;/*1036*/
+			};
+			freq_dev2 {
+				trip = <&freq_config1>;
+				cooling-device =
+					<&CPU4 13 13>;/*1056*/
+			};
+			freq_dev3 {
+				trip = <&freq_config1>;
+				cooling-device =
+					<&CPU7 16 16>;/*1171*/
+			};
+			freq_dev4 {
+				trip = <&freq_config2>;
+				cooling-device =
+					<&CPU0 11 11>;/*844*/
+			};
+			freq_dev5 {
+				trip = <&freq_config2>;
+				cooling-device =
+					<&CPU4 THERMAL_MAX_LIMIT
+					THERMAL_MAX_LIMIT>;
+			};
+			freq_dev6 {
+				trip = <&freq_config2>;
+				cooling-device =
+					<&CPU5 THERMAL_MAX_LIMIT
+					THERMAL_MAX_LIMIT>;
+			};
+			freq_dev7 {
+				trip = <&freq_config2>;
+				cooling-device =
+					<&CPU6 THERMAL_MAX_LIMIT
+					THERMAL_MAX_LIMIT>;
+			};
+			freq_dev8 {
+				trip = <&freq_config2>;
+				cooling-device =
+					<&CPU7 THERMAL_MAX_LIMIT
+					THERMAL_MAX_LIMIT>;
+			};
+		};
+	};
+
+	pa-therm1 {
+		polling-delay-passive = <0>;
+		polling-delay = <0>;
+		thermal-governor = "user_space";
+		thermal-sensors = <&pm8150_adc_tm ADC_AMUX_THM2_PU2>;
+		trips {
+			active-config0 {
+				temperature = <125000>;
+				hysteresis = <1000>;
+				type = "passive";
+			};
+		};
+	};
+
+	skin-msm-therm {
+		trips {
+			freq_config3: freq_config3 {
+				temperature = <62000>;
+				hysteresis = <2000>;
+				type = "passive";
+			};
+			freq_config4: freq_config4 {
+				temperature = <64000>;
+				hysteresis = <2000>;
+				type = "passive";
+			};
+			freq_config5: freq_config5 {
+				temperature = <66000>;
+				hysteresis = <2000>;
+				type = "passive";
+			};
+		};
+		cooling-maps {
+			freq_dev0 {
+				trip = <&freq_config3>;
+				cooling-device =
+					<&CPU0 2 2>;/*1632 18*/
+			};
+			freq_dev1 {
+				trip = <&freq_config3>;
+				cooling-device =
+					<&CPU4 8 8>;/*1612 17*/
+			};
+			freq_dev2 {
+				trip = <&freq_config3>;
+				cooling-device =
+					<&CPU7 9 9>;/*1920 20*/
+			};
+			freq_dev3 {
+				trip = <&freq_config4>;
+				cooling-device =
+					<&CPU0 4 4>;/*1478*/
+			};
+			freq_dev4 {
+				trip = <&freq_config4>;
+				cooling-device =
+					<&CPU4 11 11>;/*1286*/
+			};
+			freq_dev5 {
+				trip = <&freq_config4>;
+				cooling-device =
+					<&CPU7 13 13>;/*1497*/
+			};
+			freq_dev6 {
+				trip = <&freq_config4>;
+				cooling-device =
+					<&msm_gpu THERMAL_NO_LIMIT
+						(THERMAL_MAX_LIMIT-3)>;/*499*/
+			};
+			freq_dev7 {
+				trip = <&freq_config5>;
+				cooling-device =
+					<&msm_gpu THERMAL_NO_LIMIT
+						(THERMAL_MAX_LIMIT-2)>;/*427*/
+			};
+		};
+	};
+};
+
+&pm8150b_charger {
+	/* for verify test adjust 530->500 */
+	hot-bat-decidegc = <500>;
+};
+
+&vendor {
+	haptics_boost_vreg {
+		status = "disabled";
+	};
+};
+
+&pm8150b_haptics {
+	status = "disabled";
+	vdd-supply = <&haptics_boost_vreg>;
+};
+
+&mtp_batterydata {
+	#include "OP-fg-batterydata-4000mah.dtsi"
+};
+
+&wdog{
+	qcom,bark-time = <15000>;
+};
diff --git a/arch/arm64/boot/dts/qcom/guacamole_dvt.dtsi b/arch/arm64/boot/dts/qcom/guacamole_dvt.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..18b79ae52abaee1b2905554c37a4abb1f2b35a21
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_dvt.dtsi
@@ -0,0 +1 @@
+/*this is for one project different hw version */
\ No newline at end of file
diff --git a/arch/arm64/boot/dts/qcom/guacamole_evt1.dtsi b/arch/arm64/boot/dts/qcom/guacamole_evt1.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..09b750d1e74da338197aadb3c88734b8a8ce9c54
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_evt1.dtsi
@@ -0,0 +1,4 @@
+/*this is for one project different hw version */
+&motor_pl {
+	structure,id = <2>;//EVT1
+};
diff --git a/arch/arm64/boot/dts/qcom/guacamole_evt2.dtsi b/arch/arm64/boot/dts/qcom/guacamole_evt2.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..fb46b0abdd74229c7b7321578076210829aef6be
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_evt2.dtsi
@@ -0,0 +1,6 @@
+/*this is for one project different hw version */
+
+&motor_pl {
+	structure,id = <3>;//EVT2
+};
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole_evt3.dtsi b/arch/arm64/boot/dts/qcom/guacamole_evt3.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..8f699bb7f92226a6738f092d41e20a7f5bec7f1e
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_evt3.dtsi
@@ -0,0 +1,2 @@
+/*this is for one project different hw version */
+
diff --git a/arch/arm64/boot/dts/qcom/guacamole_pvt.dtsi b/arch/arm64/boot/dts/qcom/guacamole_pvt.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..18b79ae52abaee1b2905554c37a4abb1f2b35a21
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_pvt.dtsi
@@ -0,0 +1 @@
+/*this is for one project different hw version */
\ No newline at end of file
diff --git a/arch/arm64/boot/dts/qcom/guacamole_sm8150.dtsi b/arch/arm64/boot/dts/qcom/guacamole_sm8150.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..5ae1c7029a3bd9ed2126c145320d3d73787cc013
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_sm8150.dtsi
@@ -0,0 +1,8 @@
+/*this is for sm8150 version */
+
+&ois_rear_0 {
+   ois_gyro,id = <1>;//18821
+};
+&ois_rear_1 {
+   ois_gyro,id = <1>;//18821
+};
diff --git a/arch/arm64/boot/dts/qcom/guacamole_t0.dtsi b/arch/arm64/boot/dts/qcom/guacamole_t0.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..69eda8ced7fed84fd48c8ba84f3d05f98c9ed3db
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/guacamole_t0.dtsi
@@ -0,0 +1,293 @@
+/*this is for one project different hw version */
+
+/*tp 1.8v power change to gpio119 for T0 hw*/
+&qupv3_se17_i2c {
+	sec-s6sy761@48 {
+		//enable1v8_gpio = <&tlmm 119 0x00>;
+		pinctrl-0 = <&tp_irq_active &tp_rst_active &tp_1v8_t0_active>;
+		pinctrl-1 = <&tp_rst_suspend &tp_1v8_t0_suspend>;
+	};
+};
+
+&qupv3_se17_i2c {
+        st_fts@49 {
+                //enable1v8_gpio = <&tlmm 119 0x00>;
+		pinctrl-0 = <&tp_irq_active &tp_rst_active &tp_1v8_t0_active>;
+		pinctrl-1 = <&tp_rst_suspend &tp_1v8_t0_suspend>;
+        };
+};
+
+/*fingerprint reset gpio change to gpio131 on T0*/
+&soc {
+	fingerprint_detect {
+		compatible = "oneplus,fpdetect";
+		fp-gpio-id0 = <&tlmm 90 0>;
+		fp-gpio-id1 = <&pm8150_gpios 3 0>;
+		pinctrl-names = "fp_id_init";
+		pinctrl-0 = <&fp_id0_init &fp_id1_init>;
+	};
+
+	silead_fp {
+		compatible = "sil,fingerprint";
+		interrupt-parent = <&tlmm>;
+		//avdd-supply = <&pm8150_l17>;
+		avdd-gpios = <&tlmm 101 0x00>;
+		irq-gpios = <&tlmm 118 0x00>;
+		rst-gpios = <&tlmm 131 0x00>;
+		pinctrl-names = "fp_en_init";
+		pinctrl-0 = <&fp_reset_init &fp_irq_init &fp_vdd_init>;
+		status = "okay";
+	};
+
+	goodix_fp {
+		compatible = "goodix,fingerprint";
+		interrupt-parent = <&tlmm>;
+		//vdd-3v2-supply = <&pm8998_l22>;
+		//vdd-voltage = <3200000 3200000>;
+		//vdd-current = <50000>;
+		fp-gpio-irq = <&tlmm 118 0x00>;
+		fp-gpio-reset = <&tlmm 131 0x00>;
+		fp-gpio-enable = <&tlmm 101 0x00>;
+		pinctrl-names = "fp_en_init", "fp_dis_init";
+		pinctrl-0 = <&fp_vdd_init &fp_irq_init>;
+		pinctrl-1 = <&fp_vdd_dis_init>;
+		status = "okay";
+	};
+};
+&tlmm {
+		aw_irq: aw_irq {
+			mux {
+				pins = "gpio116";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio116";
+				drive-strength = <2>;
+			};
+		};
+
+		aw_reset: aw_reset {
+			mux {
+				pins = "gpio24";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio24";
+				drive-strength = <2>;
+				bias-disable;
+			};
+		};
+
+		fp_id0_init: fp_id0_init {
+			mux {
+				pins = "gpio90";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio90";
+				drive-strength = <2>;
+				bias-disable; /* No Pull */
+				input-enable;
+			};
+		};
+	
+		tp_1v8_t0_active: tp_1v8_t0_active {
+                	mux {
+                        	pins = "gpio119";
+                        	function = "gpio";
+                	};
+                	config {
+                       		pins = "gpio119";
+                        	drive-strength = <8>;
+                        	bias-pull-up;
+               		};
+        	};
+
+		tp_1v8_t0_suspend: tp_1v8_t0_suspend {
+                	mux {
+                        	pins = "gpio119";
+                        	function = "gpio";
+                	};
+                	config {
+                        	pins = "gpio119";
+                        	drive-strength = <8>;
+                        	bias-pull-down;
+                	};
+        	};
+};
+
+/*for aw haptic start*/
+&qupv3_se7_i2c {
+		status = "ok";
+		aw8697_haptic@5A {
+		compatible = "awinic,aw8697_haptic";
+		reg = <0x5A>;
+		reset-gpio = <&tlmm 116 0x00>;
+		irq-gpio = <&tlmm 24 0x00>;
+		pinctrl-names = "default";
+		pinctrl-0 = <&aw_irq &aw_reset>;
+		status = "okay";
+	};
+};
+/*for aw haptic end*/
+
+
+/* for Battery & Charging  STRAT */
+&qupv3_se8_i2c {
+	oneplus_fastchg@26{
+		microchip,mcu-en-gpio = <&tlmm 10 0x00>;
+		microchip,usb-sw-2-gpio = <&tlmm 59 0x00>;
+		op,mcl_verion;
+	};
+
+};
+
+&pm8150b_charger {
+	/* for external ship mode suppot */
+	op,stm-ctrl-gpio = <&tlmm 21 0x00>;
+	op,vbus-ctrl-gpio = <&pm8150_gpios 9 GPIO_ACTIVE_LOW>;
+};
+
+/* for Battery & Charging  END */
+
+/* @bsp,step motor START*/
+&pm8150b_gpios {
+	motor_mode0_gpio: motor_mode0_gpio {
+		pins = "gpio5"; /* GPIO 5 */
+		function = "normal"; /* normal */
+		output-high;
+		bias-disable; /* No Pull */
+	};
+	motor_mode0_hi_impedance: motor_mode0_hi_impedance {
+		pins = "gpio5"; /* GPIO 5 */
+		function = "normal"; /* normal */
+		bias-high-impedance;
+	};
+	motor_boost_en: motor_boost_en {
+		pins = "gpio12"; /* GPIO 12 */
+		function = "normal"; /* normal */
+		output-low;
+		bias-disable; /* No Pull */
+	};
+};
+
+&pm8150l_gpios {
+	motor_pwm_config: motor_pwm_config {
+		pins = "gpio10";
+		function = "func1";
+		bias-disable;
+		power-source = <0>;
+		output-low;
+		qcom,drive-strength = <3>;
+		drive-push-pull;
+	};
+	motor_mode1_gpio: motor_mode1_gpio {
+		pins = "gpio8";
+		function = "normal";
+		power-source = <0>; /* 3.6V */
+		bias-disable; /* No Pull */
+		output-low; /* digital output, no invert */
+		qcom,drive-strength = <3>; /* LOW strength */
+	};
+	motor_dir_gpio: motor_dir_gpio {
+		pins = "gpio11";
+		function = "normal";
+		bias-disable; /* No Pull */
+		power-source = <0>; /* VIN0 3.6V*/
+		output-low; /* digital output, no invert */
+		qcom,drive-strength = <3>; /* LOW strength */
+	};
+};
+
+&pm8150_gpios {
+	motor_sleep_gpio: motor_sleep_gpio {
+		pins = "gpio10";
+		function = "normal";
+		power-source = <0>;
+		bias-disable;
+		output-low;
+	};
+
+	fp_id1_init: fp_id1_init {
+		pins = "gpio3";
+		function = "normal";
+		power-source = <0>;
+		bias-disable;
+		input-enable;
+	};
+};
+
+&vendor  {
+	step_motor {
+		compatible = "oneplus,step-motor";
+		status = "okay";
+
+		pwms = <&pm8150l_pwm 1 20000000>;
+		op,boost-en-pin = <&pm8150b_gpios 12 GPIO_ACTIVE_LOW>;
+		op,mode0-pin = <&pm8150b_gpios 5 GPIO_ACTIVE_LOW>;
+		op,mode1-pin = <&pm8150l_gpios 8 GPIO_ACTIVE_LOW>;
+		op,nsleep-pin = <&pm8150_gpios 10 GPIO_ACTIVE_LOW>;
+		op,dir-pin = <&pm8150l_gpios 11 GPIO_ACTIVE_LOW>;
+		op,step-pin = <&pm8150l_gpios 10 GPIO_ACTIVE_LOW>;
+		pinctrl-names = "boost",
+				"m0_gpio",
+				"m0_high_impedance",
+				"m1_gpio",
+				"sleep_gpio",
+				"dir_gpio",
+				"pwm_config";
+		pinctrl-0 = <&motor_boost_en>;
+		pinctrl-1 = <&motor_mode0_gpio>;
+		pinctrl-2 = <&motor_mode0_hi_impedance>;
+		pinctrl-3 = <&motor_mode1_gpio>;
+		pinctrl-4 = <&motor_sleep_gpio>;
+		pinctrl-5 = <&motor_dir_gpio>;
+		pinctrl-6 = <&motor_pwm_config>;
+	};
+};
+/* @bsp, step motor END*/
+
+/* @bsp, usb config START*/
+&usb2_phy0 {
+	qcom,param-override-seq =
+		<0x67 0x6c/*Disconnection voltage +21.56%*/
+		 0x06 0x70/*Pre-emphasis:4x DC voltage level:+6.50%*/
+		 0x28 0x74>;
+};
+
+&extcon_usb1 {
+	status = "disabled";
+};
+
+&usb1 {
+	status = "disabled";
+};
+
+/* @bsp, As QRD-DVT have this config, keep the same config
+ * for ldo18 power suspend
+ */
+&usb_qmp_dp_phy {
+	vdd-supply = <&pm8150_l18>;
+	qcom,vdd-voltage-level = <0 912000 912000>;
+};
+
+&sde_dp {
+	vdda-0p9-supply = <&pm8150_l18>;
+	qcom,phy-supply-entries {
+		qcom,phy-supply-entry@0 {
+			qcom,supply-min-voltage = <880000>;
+			qcom,supply-max-voltage = <912000>;
+		};
+	};
+};
+/* @bsp, usb config END*/
+
+&motor_pl {
+	structure,id = <1>;//T0
+};
+
+
+
diff --git a/arch/arm64/boot/dts/qcom/pm8150.dtsi b/arch/arm64/boot/dts/qcom/pm8150.dtsi
index 412b73e697f845babcbcb5940f06bd59625113ae..9cc532981ad64ed7464aa23d0d0224678491c674 100644
--- a/arch/arm64/boot/dts/qcom/pm8150.dtsi
+++ b/arch/arm64/boot/dts/qcom/pm8150.dtsi
@@ -91,14 +91,15 @@
 					<0x0 0xc2 0 IRQ_TYPE_NONE>,
 					<0x0 0xc3 0 IRQ_TYPE_NONE>,
 					<0x0 0xc5 0 IRQ_TYPE_NONE>,
+					<0x0 0xc6 0 IRQ_TYPE_NONE>,
 					<0x0 0xc8 0 IRQ_TYPE_NONE>,
 					<0x0 0xc9 0 IRQ_TYPE_NONE>;
 			interrupt-names = "pm8150_gpio1", "pm8150_gpio3",
 					"pm8150_gpio4", "pm8150_gpio6",
-					"pm8150_gpio9", "pm8150_gpio10";
+					"pm8150_gpio7","pm8150_gpio9", "pm8150_gpio10";
 			gpio-controller;
 			#gpio-cells = <2>;
-			qcom,gpios-disallowed = <2 5 7 8>;
+			qcom,gpios-disallowed = <2 5 8>;
 		};
 
 		pm8150_sdam_2: sdam@b100 {
diff --git a/arch/arm64/boot/dts/qcom/pm8150b.dtsi b/arch/arm64/boot/dts/qcom/pm8150b.dtsi
index 826ba938880105017d761e83afe09524fddefae7..bb303374a93991d206340a784f2cfa0f1e10c610 100644
--- a/arch/arm64/boot/dts/qcom/pm8150b.dtsi
+++ b/arch/arm64/boot/dts/qcom/pm8150b.dtsi
@@ -544,6 +544,7 @@
 				qcom,wf-brake-pattern = [03 00 00 00];
 				qcom,lra-auto-resonance-disable;
 			};
+
 		};
 	};
 };
@@ -667,7 +668,7 @@
 	};
 
 	soc {
-		polling-delay-passive = <100>;
+		polling-delay-passive = <1000>;
 		polling-delay = <0>;
 		thermal-governor = "low_limits_cap";
 		thermal-sensors = <&bcl_soc>;
@@ -675,7 +676,12 @@
 
 		trips {
 			soc_trip:soc-trip {
-				temperature = <10>;
+				temperature = <5>;
+				hysteresis = <0>;
+				type = "passive";
+			};
+			soc_trip2:soc-trip2 {
+				temperature = <15>;
 				hysteresis = <0>;
 				type = "passive";
 			};
diff --git a/arch/arm64/boot/dts/qcom/pm8150l.dtsi b/arch/arm64/boot/dts/qcom/pm8150l.dtsi
index 4ff7b0c35d36439d75e0ad3c2982f32eb1004cf9..78b9847f66f5bd7edf9781395bb99fd36eeba627 100644
--- a/arch/arm64/boot/dts/qcom/pm8150l.dtsi
+++ b/arch/arm64/boot/dts/qcom/pm8150l.dtsi
@@ -363,6 +363,14 @@
 			};
 		};
 
+		pm8150l_pwm: qcom,pwms@bc00 {
+				compatible = "qcom,pwm-lpg";
+				reg = <0xbc00 0x200>;
+				reg-names = "lpg-base";
+				#pwm-cells = <2>;
+				qcom,num-lpg-channels = <2>;
+		};
+
 		pm8150l_rgb_led: qcom,leds@d000 {
 			compatible = "qcom,tri-led";
 			reg = <0xd000 0x100>;
diff --git a/arch/arm64/boot/dts/qcom/sdmmagpie-sde-display.dtsi b/arch/arm64/boot/dts/qcom/sdmmagpie-sde-display.dtsi
index 5c40e69040045b0c37681a6b8fbb28c792b06b5d..5f610c63e67c2ab9ec32787332ae16941e756a65 100644
--- a/arch/arm64/boot/dts/qcom/sdmmagpie-sde-display.dtsi
+++ b/arch/arm64/boot/dts/qcom/sdmmagpie-sde-display.dtsi
@@ -1,4 +1,4 @@
-/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -104,7 +104,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_video>;
 	};
@@ -115,7 +115,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_cmd>;
 	};
@@ -126,7 +126,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_fhd_plus_cmd>;
 	};
@@ -137,7 +137,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_vid>;
 	};
@@ -148,7 +148,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_vid>;
 	};
@@ -159,7 +159,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_cmd>;
 	};
@@ -170,7 +170,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_cmd>;
 	};
@@ -181,7 +181,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_dsc_375_cmd>;
 	};
@@ -192,7 +192,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_dsc_375_cmd>;
 	};
@@ -203,7 +203,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sharp_wqhd_video>;
 	};
@@ -214,7 +214,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sharp_wqhd_cmd>;
 	};
@@ -225,7 +225,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_rm69298_truly_amoled_video>;
 	};
@@ -236,7 +236,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_rm69298_truly_amoled_cmd>;
 	};
@@ -247,7 +247,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_video>;
 	};
@@ -258,7 +258,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_cmd>;
 	};
@@ -269,7 +269,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_video>;
 	};
@@ -280,7 +280,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_cmd>;
 	};
@@ -295,8 +295,8 @@
 			 <&mdss_dsi0_pll PCLK_MUX_0_CLK>,
 			 <&mdss_dsi1_pll BYTECLK_MUX_1_CLK>,
 			 <&mdss_dsi1_pll PCLK_MUX_1_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0",
-				"src_byte_clk1", "src_pixel_clk1";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0",
+				"mux_byte_clk1", "mux_pixel_clk1";
 
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_te_active &disp_pins_default>;
@@ -341,8 +341,8 @@
 			<&mdss_dsi0_pll PCLK_MUX_0_CLK>,
 			<&mdss_dsi1_pll BYTECLK_MUX_1_CLK>,
 			<&mdss_dsi1_pll PCLK_MUX_1_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0",
-			"src_byte_clk1", "src_pixel_clk1";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0",
+			"mux_byte_clk1", "mux_pixel_clk1";
 
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_te1_active>;
@@ -386,8 +386,7 @@
 	qcom,mdss-dsi-panel-status-value = <0x9c>;
 	qcom,mdss-dsi-panel-on-check-value = <0x9c>;
 	qcom,mdss-dsi-panel-status-read-length = <1>;
-	qcom,mdss-dsi-min-refresh-rate = <55>;
-	qcom,mdss-dsi-max-refresh-rate = <60>;
+	qcom,dsi-supported-dfps-list = <60 57 55>;
 	qcom,mdss-dsi-pan-enable-dynamic-fps;
 	qcom,mdss-dsi-pan-fps-update = "dfps_immediate_porch_mode_hfp";
 	qcom,mdss-dsi-display-timings {
@@ -456,8 +455,7 @@
 	qcom,mdss-dsi-panel-status-value = <0x9c>;
 	qcom,mdss-dsi-panel-on-check-value = <0x9c>;
 	qcom,mdss-dsi-panel-status-read-length = <1>;
-	qcom,mdss-dsi-min-refresh-rate = <55>;
-	qcom,mdss-dsi-max-refresh-rate = <60>;
+	qcom,dsi-supported-dfps-list = <60 57 55>;
 	qcom,mdss-dsi-pan-enable-dynamic-fps;
 	qcom,mdss-dsi-pan-fps-update = "dfps_immediate_porch_mode_hfp";
 	qcom,mdss-dsi-display-timings {
@@ -666,9 +664,7 @@
 	qcom,mdss-dsi-panel-status-value = <0x9c>;
 	qcom,mdss-dsi-panel-on-check-value = <0x9c>;
 	qcom,mdss-dsi-panel-status-read-length = <1>;
-
-	qcom,mdss-dsi-min-refresh-rate = <48>;
-	qcom,mdss-dsi-max-refresh-rate = <60>;
+	qcom,dsi-supported-dfps-list = <60 55 48>;
 	qcom,mdss-dsi-pan-enable-dynamic-fps;
 	qcom,mdss-dsi-pan-fps-update = "dfps_immediate_porch_mode_vfp";
 
diff --git a/arch/arm64/boot/dts/qcom/sdmshrike-sde-display.dtsi b/arch/arm64/boot/dts/qcom/sdmshrike-sde-display.dtsi
index 97ed20b4afbf1a1abd0ae493c377531a6f3e28dd..4687aa1a5dc6720b4dd4ab74de58d0dbd217f1f8 100644
--- a/arch/arm64/boot/dts/qcom/sdmshrike-sde-display.dtsi
+++ b/arch/arm64/boot/dts/qcom/sdmshrike-sde-display.dtsi
@@ -1,4 +1,4 @@
-/* Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -111,7 +111,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_4k_dsc_video>;
 	};
@@ -122,7 +122,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_4k_dsc_cmd>;
 	};
@@ -133,7 +133,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_1080_cmd>;
 	};
@@ -144,7 +144,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sharp_1080_120hz_cmd>;
 	};
@@ -155,7 +155,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_nt35597_truly_video>;
 	};
@@ -166,7 +166,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_nt35597_truly_cmd>;
 	};
@@ -177,7 +177,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35597_truly_dsc_cmd>;
 	};
@@ -188,7 +188,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35597_truly_dsc_video>;
 	};
@@ -199,7 +199,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_vid>;
 	};
@@ -210,7 +210,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_vid>;
 	};
@@ -221,7 +221,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_cmd>;
 	};
@@ -232,7 +232,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_cmd>;
 	};
@@ -243,7 +243,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_dsc_375_cmd>;
 	};
@@ -254,7 +254,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_dsc_375_cmd>;
 	};
@@ -265,7 +265,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_cmd>;
 	};
@@ -276,7 +276,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_cmd>;
 
@@ -288,7 +288,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_video>;
 	};
@@ -303,8 +303,8 @@
 			 <&mdss_dsi0_pll PCLK_MUX_0_CLK>,
 			 <&mdss_dsi1_pll BYTECLK_MUX_1_CLK>,
 			 <&mdss_dsi1_pll PCLK_MUX_1_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0",
-			      "src_byte_clk1", "src_pixel_clk1";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0",
+			      "mux_byte_clk1", "mux_pixel_clk1";
 
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_dsi_active &sde_te_active>;
diff --git a/arch/arm64/boot/dts/qcom/sm6150-sde-display.dtsi b/arch/arm64/boot/dts/qcom/sm6150-sde-display.dtsi
index 068f9892ad2c2fdc3848b208b95268d3a7b61174..cb27472d675b512189f6f6693aa29b04e40eb349 100644
--- a/arch/arm64/boot/dts/qcom/sm6150-sde-display.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm6150-sde-display.dtsi
@@ -1,4 +1,4 @@
-/* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -100,7 +100,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_vid>;
 	};
@@ -111,7 +111,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_cmd>;
 	};
@@ -122,7 +122,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_hx83112a_truly_video>;
 	};
@@ -133,7 +133,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_td4328_truly_video>;
 	};
@@ -144,7 +144,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_td4328_truly_cmd>;
 	};
@@ -155,7 +155,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_rm69298_truly_amoled_video>;
 	};
@@ -166,7 +166,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_rm69298_truly_amoled_cmd>;
 	};
@@ -177,7 +177,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_split_link_wuxga_video>;
 	};
@@ -190,7 +190,7 @@
 
 		clocks = <&mdss_dsi0_pll BYTE0_MUX_CLK>,
 			 <&mdss_dsi0_pll PIX0_MUX_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0";
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_dsi_active &sde_te_active>;
 		pinctrl-1 = <&sde_dsi_suspend &sde_te_suspend>;
@@ -321,8 +321,9 @@
 &dsi_hx83112a_truly_video {
 	qcom,mdss-dsi-t-clk-post = <0x0e>;
 	qcom,mdss-dsi-t-clk-pre = <0x31>;
-	qcom,mdss-dsi-min-refresh-rate = <48>;
-	qcom,mdss-dsi-max-refresh-rate = <60>;
+//	qcom,mdss-dsi-min-refresh-rate = <48>;
+//	qcom,mdss-dsi-max-refresh-rate = <60>;
+	qcom,dsi-supported-dfps-list = <60 55 53 43>;
 	qcom,mdss-dsi-pan-enable-dynamic-fps;
 	qcom,mdss-dsi-pan-fps-update =
 		"dfps_immediate_porch_mode_vfp";
diff --git a/arch/arm64/boot/dts/qcom/sm8150-audio.dtsi b/arch/arm64/boot/dts/qcom/sm8150-audio.dtsi
index 61b45d2c279d730b7f6b8b1cb87df700cbf575e7..04dc1f1d22fd955a41c01a9bb6c3da96671263b7 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-audio.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-audio.dtsi
@@ -155,9 +155,9 @@
 
 &qupv3_se4_i2c {
 	status = "ok";
-	fsa4480: fsa4480@43 {
+	fsa4480: fsa4480@42 {
 		compatible = "qcom,fsa4480-i2c";
-		reg = <0x43>;
+		reg = <0x42>;
 		pinctrl-names = "default";
 		pinctrl-0 = <&fsa_usbc_ana_en>;
 	};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-camera-sensor-mtp.dtsi b/arch/arm64/boot/dts/qcom/sm8150-camera-sensor-mtp.dtsi
index 0803db1bce62be7bfbcb659695e86b7151ade9f8..83fe2e613aeae60b52a102e8a3cc787c4a6f3880 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-camera-sensor-mtp.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-camera-sensor-mtp.dtsi
@@ -109,6 +109,7 @@
 
 	actuator_triple_rear_aux2_regulator: gpio-regulator@6 {
 		compatible = "regulator-fixed";
+		status = "disable";
 		reg = <0x06 0x00>;
 		regulator-name = "actuator_triple_rear_aux2_regulator";
 		regulator-min-microvolt = <3300000>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-cdp.dtsi b/arch/arm64/boot/dts/qcom/sm8150-cdp.dtsi
index 84c11b5540db0b9b4c9f931c2b770177257d1184..417730a9295903e8b0ca9529ad5c385637425642 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-cdp.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-cdp.dtsi
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -41,13 +41,13 @@
 	extcon_usb1: extcon_usb1 {
 		compatible = "linux,extcon-usb-gpio";
 		vbus-gpio = <&pm8150_gpios 10 GPIO_ACTIVE_HIGH>;
-		id-gpio = <&tlmm 101 GPIO_ACTIVE_HIGH>;
+		/*id-gpio = <&tlmm 101 GPIO_ACTIVE_HIGH>; GPIO 101 for fingerprint VDD enable*/
 		vbus-out-gpio = <&pm8150_gpios 9 GPIO_ACTIVE_HIGH>;
 
-		pinctrl-names = "default";
+		/*pinctrl-names = "default";
 		pinctrl-0 = <&usb2_vbus_det_default
 			     &usb2_id_det_default
-			     &usb2_vbus_boost_default>;
+			     &usb2_vbus_boost_default>; GPIO 101 for fingerprint VDD enable*/
 	};
 };
 
@@ -290,6 +290,7 @@
 	compatible = "qcom,ufs-phy-qmp-v4";
 
 	vdda-phy-supply = <&pm8150_l5>;
+	vdda-phy-always-on;
 	vdda-pll-supply = <&pm8150l_l3>;
 	vdda-phy-max-microamp = <90200>;
 	vdda-pll-max-microamp = <19000>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-mtp-overlay.dts b/arch/arm64/boot/dts/qcom/sm8150-mtp-overlay.dts
index 2f454362dfa6fa34f84ec889d8fc1ad667957ab6..aa13607213a47be80279e82a22eba0e15f6a6dba 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-mtp-overlay.dts
+++ b/arch/arm64/boot/dts/qcom/sm8150-mtp-overlay.dts
@@ -21,6 +21,11 @@
 #include "sm8150-mtp.dtsi"
 #include "sm8150-mtp-audio-overlay.dtsi"
 
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-v2.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_t0.dtsi"
+
 / {
 	model = "MTP";
 	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
diff --git a/arch/arm64/boot/dts/qcom/sm8150-mtp.dtsi b/arch/arm64/boot/dts/qcom/sm8150-mtp.dtsi
index ae56d903b41aa196366b91d2f91acbd929f299ca..a2b1e5ac74654001b8d90ff2ca48b6552f42ddaa 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-mtp.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-mtp.dtsi
@@ -50,14 +50,15 @@
 
 	extcon_usb1: extcon_usb1 {
 		compatible = "linux,extcon-usb-gpio";
-		vbus-gpio = <&pm8150_gpios 10 GPIO_ACTIVE_HIGH>;
-		id-gpio = <&tlmm 101 GPIO_ACTIVE_HIGH>;
+		/*pm8150_gpios 10 is for step motor, use the dummy gpio 165 for driver probe */
+		vbus-gpio = <&tlmm 165 GPIO_ACTIVE_HIGH>;
+		/*id-gpio = <&tlmm 101 GPIO_ACTIVE_HIGH>; GPIO 101 for fingerprint VDD enable */
 		vbus-out-gpio = <&pm8150_gpios 9 GPIO_ACTIVE_HIGH>;
 
-		pinctrl-names = "default";
+		/*pinctrl-names = "default";
 		pinctrl-0 = <&usb2_vbus_det_default
 			     &usb2_id_det_default
-			     &usb2_vbus_boost_default>;
+			     &usb2_vbus_boost_default>; GPIO 101 for fingerprint VDD enable*/
 	};
 };
 
@@ -92,7 +93,7 @@
 		};
 	};
 
-	qcom,qbt1000 {
+	qcomqbt1000:qcom,qbt1000 {
 		compatible = "qcom,qbt1000";
 		clock-names = "core", "iface";
 		clock-frequency = <25000000>;
@@ -265,6 +266,7 @@
 	compatible = "qcom,ufs-phy-qmp-v4";
 
 	vdda-phy-supply = <&pm8150_l5>;
+	vdda-phy-always-on;
 	vdda-pll-supply = <&pm8150l_l3>;
 	vdda-phy-max-microamp = <90200>;
 	vdda-pll-max-microamp = <19000>;
@@ -314,8 +316,9 @@
 	qcom,fg-esr-timer-dischg-fast = <0 7>;
 	qcom,fg-esr-timer-chg-slow = <0 96>;
 	qcom,fg-esr-timer-dischg-slow = <0 96>;
-	qcom,fg-esr-cal-soc-thresh = <26 230>;
-	qcom,fg-esr-cal-temp-thresh = <10 40>;
+	/*op disable ers calibration*/
+	/*qcom,fg-esr-cal-soc-thresh = <26 230>;*/
+	/*qcom,fg-esr-cal-temp-thresh = <10 40>;*/
 };
 
 &sdhc_2 {
@@ -588,17 +591,10 @@
 	};
 
 	skin-msm-therm {
-		polling-delay-passive = <0>;
+		polling-delay-passive = <2000>;
 		polling-delay = <0>;
-		thermal-governor = "user_space";
+		thermal-governor = "step_wise";
 		thermal-sensors = <&pm8150l_adc_tm ADC_AMUX_THM2_PU2>;
-		trips {
-			active-config0 {
-				temperature = <125000>;
-				hysteresis = <1000>;
-				type = "passive";
-			};
-		};
 	};
 
 	pa-therm2 {
diff --git a/arch/arm64/boot/dts/qcom/sm8150-oem-camera-t0.dtsi b/arch/arm64/boot/dts/qcom/sm8150-oem-camera-t0.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..49c13398685db62d4d568f7438d87698b2ec7a63
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/sm8150-oem-camera-t0.dtsi
@@ -0,0 +1,1044 @@
+&pm8150_gpios{
+	cam_sensor_laser {
+		cam_sensor_laser_xsdn_active: cam_sensor_laser_xsdn_active {
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_laser_xsdn_suspend: cam_sensor_laser_xsdn_suspend{
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+	};
+};
+
+&pm8150b_gpios{
+	cam_sensor_laser {
+		cam_sensor_laser_intr_active: cam_sensor_laser_intr_active {
+			pins = "gpio10";
+			function = "normal";
+			power-source = <0>;
+			//bias-pull-up;
+			bias-disable;
+			output-high;
+			input-enable;
+		};
+
+		cam_sensor_laser_intr_suspend: cam_sensor_laser_intr_suspend{
+			pins = "gpio10";
+			function = "normal";
+			power-source = <0>;
+			//bias-pull-down;
+			bias-disable;
+			output-low;
+			input-enable;
+		};
+	};
+};
+
+&pm8150l_gpios{
+	cam_sensor_pmi_gpio {
+		cam_sensor_rear_0_dvdd_active: cam_sensor_rear_0_dvdd_active {
+			pins = "gpio1";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_0_dvdd_suspend: cam_sensor_rear_0_dvdd_suspend {
+			pins = "gpio1";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_ana_active: cam_sensor_rear_2_ana_active {
+			pins = "gpio2";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_ana_suspend: cam_sensor_rear_2_ana_suspend {
+			pins = "gpio2";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_af_active: cam_sensor_rear_2_af_active {
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_af_suspend: cam_sensor_rear_2_af_suspend {
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+	};
+
+	cam_sensor_front_0_ana {
+		cam_sensor_front_0_ana_active: cam_sensor_front_0_ana_active {
+			pins = "gpio12";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_front_0_ana_suspend: cam_sensor_front_0_ana_suspend {
+			pins = "gpio12";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+	};
+};
+
+&soc {
+//laser start
+    stmvl53l1: st,stmvl53l1@0 {
+        compatible = "st,stmvl53l1";
+        //reg = <0x29>;
+        //avdd-supply = <&pm8150l_bob>;
+        laser_vdd-supply = <&pm8150l_l1>;
+        pinctrl-names = "laser_default", "laser_suspend";
+        pinctrl-0 = <&cam_sensor_laser_xsdn_active
+                     &cam_sensor_laser_pwren_active
+                     &cam_sensor_laser_intr_active>;
+        pinctrl-1 = <&cam_sensor_laser_xsdn_suspend
+                     &cam_sensor_laser_pwren_suspend
+                     &cam_sensor_laser_intr_suspend>;
+        xsdn-gpio = <&pm8150_gpios 4 GPIO_ACTIVE_HIGH>;
+        pwren-gpio = <&tlmm 26 0>;
+        intr-gpio = <&pm8150b_gpios 10 GPIO_ACTIVE_HIGH>;
+        interrupt-parent = <&spmi_bus>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+    };
+//laser end
+
+	led_flash_rear_0: qcom,camera-flash@7 {
+		cell-index = <7>;
+		reg = <0x07 0x00>;
+		compatible = "qcom,camera-flash";
+		flash-source = <&pm8150l_flash0 &pm8150l_flash1>;
+		torch-source = <&pm8150l_torch0 &pm8150l_torch1>;
+		switch-source = <&pm8150l_switch2>;
+		status = "ok";
+	};
+
+	led_flash_rear_1: qcom,camera-flash@8 {
+		cell-index = <8>;
+		reg = <0x08 0x00>;
+		compatible = "qcom,camera-flash";
+		flash-source = <&pm8150l_flash0 &pm8150l_flash1>;
+		torch-source = <&pm8150l_torch0 &pm8150l_torch1>;
+		switch-source = <&pm8150l_switch2>;
+		status = "ok";
+	};
+};
+
+&cam_cci0 {
+    qcom,cam-res-mgr {
+        compatible = "qcom,cam-res-mgr";
+        shared-gpios = <14 13>;
+        pinctrl-names = "cam_res_mgr_default", "cam_res_mgr_suspend";
+        status = "ok";
+        pinctrl-0 = <&cam_sensor_rear_0_mclk_active
+            &cam_sensor_rear_1_mclk_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_mclk_suspend
+            &cam_sensor_rear_1_mclk_suspend>;
+    };
+
+    actuator_rear_0: qcom,actuator@7 {
+        cell-index = <7>;
+        reg = <0x7>;
+        compatible = "qcom,actuator";
+        cci-device = <0>;
+        cci-master = <1>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_vaf_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_vaf_suspend>;
+        gpios = <&tlmm 25 0>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_0";
+    };
+
+    actuator_rear_1: qcom,actuator@8 {
+        cell-index = <8>;
+        reg = <0x8>;
+        compatible = "qcom,actuator";
+        cci-device = <0>;
+        cci-master = <0>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_vaf_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_vaf_suspend>;
+        gpios = <&tlmm 35 0>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_1";
+    };
+
+    actuator_rear_2: qcom,actuator@9 {
+        cell-index = <9>;
+        reg = <0x9>;
+        compatible = "qcom,actuator";
+        cci-device = <1>;
+        cci-master = <1>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_af_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_af_suspend>;
+        gpios = <&pm8150l_gpios 4 GPIO_ACTIVE_HIGH>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_1";
+    };
+
+    ois_rear_0: qcom,ois@02{
+        cell-index = <2>;
+        reg = <2>;
+        compatible = "qcom,ois";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vdig-supply = <&pm8009_l6>;//s5k3m5 ois
+        cam_vaf-supply = <&pm8009_l5>;
+        regulator-names = "cam_vio", "cam_vdig", "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 2856000 2800000>;
+        rgltr-max-voltage = <0 2856000 2800000>;
+        rgltr-load-current = <0 80000 0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+    };
+
+    ois_rear_1: qcom,ois@3 {
+        cell-index = <3>;
+        reg = <3>;
+        compatible = "qcom,ois";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vdig-supply = <&pm8009_l5>;//imx586 ois
+        cam_vaf-supply = <&pm8009_l6>;
+        regulator-names = "cam_vio", "cam_vdig", "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 2800000 2856000>;
+        rgltr-max-voltage = <0 2800000 2856000>;
+        rgltr-load-current = <0 80000 0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+    };
+
+    eeprom_rear_0: qcom,eeprom@7 {
+        cell-index = <7>;
+        reg = <7>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l1>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1104000 0>;
+        rgltr-max-voltage = <0 3300000 1104000 0>;
+        rgltr-load-current = <0 80000 1100000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_rest_active
+            &cam_sensor_rear_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_rest_suspend
+            &cam_sensor_rear_0_ana_suspend>;
+        gpios = <&tlmm 14 0>,
+            <&tlmm 30 0>,
+            <&tlmm 11 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK1",
+            "CAM_RESET0",
+            "CAM_VANA_0";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK1_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_rear_1: qcom,eeprom@8 {
+        cell-index = <8>;
+        reg = <8>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l2>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_rest_active
+            &cam_sensor_rear_1_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_rest_suspend
+            &cam_sensor_rear_1_ana_suspend>;
+        gpios = <&tlmm 13 0>,
+            <&tlmm 28 0>,
+            <&tlmm 148 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK0",
+            "CAM_RESET1",
+            "CAM_VANA_1";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK0_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_front_0: qcom,eeprom@9 {
+        cell-index = <9>;
+        reg = <9>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l3>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_front_0_mclk_active
+            &cam_sensor_front_0_rest_active
+            &cam_sensor_front_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_front_0_mclk_suspend
+            &cam_sensor_front_0_rest_suspend
+            &cam_sensor_front_0_ana_suspend>;
+        gpios = <&tlmm 15 0>,
+            <&tlmm 12 0>,
+            <&pm8150l_gpios 12 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK2",
+            "CAM_RESET2",
+            "CAM_VANA_2";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK2_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_rear_2: qcom,eeprom@10 {
+        cell-index = <10>;
+        reg = <0xA>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l4>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_mclk_active
+            &cam_sensor_rear_2_rest_active
+            &cam_sensor_rear_2_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_mclk_suspend
+            &cam_sensor_rear_2_rest_suspend
+            &cam_sensor_rear_2_ana_suspend>;
+        gpios = <&tlmm 16 0>,
+            <&tlmm 23 0>,
+            <&pm8150l_gpios 2 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2 >;
+        gpio-req-tbl-flags = <1 0 0 >;
+        gpio-req-tbl-label = "CAMIF_MCLK3",
+            "CAM_RESET3",
+            "CAM_VANA_3";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK3_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@0 {
+        cell-index = <0>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x0>;
+        csiphy-sd-index = <1>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <180>;
+        led-flash-src = <&led_flash_rear_0>;
+        actuator-src = <&actuator_rear_0>;
+        ois-src = <&ois_rear_0>;
+        eeprom-src = <&eeprom_rear_0>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l1>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1104000 0>;
+        rgltr-max-voltage = <0 3300000 1104000 0>;
+        rgltr-load-current = <0 80000 1100000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_rest_active
+            &cam_sensor_rear_0_ana_active
+            &cam_sensor_rear_0_ana2_active
+            &cam_sensor_rear_0_dvdd_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_rest_suspend
+            &cam_sensor_rear_0_ana_suspend
+            &cam_sensor_rear_0_ana2_suspend
+            &cam_sensor_rear_0_dvdd_suspend>;
+        gpios = <&tlmm 14 0>,
+            <&tlmm 30 0>,
+            <&tlmm 11 0>,
+            <&tlmm 29 0>,
+            <&pm8150l_gpios 1 GPIO_ACTIVE_HIGH>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-custom1 = <3>;
+        gpio-custom2 = <4>;
+        gpio-req-tbl-num = <0 1 2 3 4>;
+        gpio-req-tbl-flags = <1 0 0 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK1",
+            "CAM_RESET0",
+            "CAM_VANA_0",
+            "CAM_VANA2_0",
+            "CAM_PVDD";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK1_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@1 {
+        cell-index = <1>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x1>;
+        csiphy-sd-index = <0>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <180>;
+        actuator-src = <&actuator_rear_1>;
+        led-flash-src = <&led_flash_rear_1>;
+        eeprom-src = <&eeprom_rear_0>;//for imx586&s5k3m5 use same eeprom located on master imx586
+        ois-src = <&ois_rear_1>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l2>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_rest_active
+            &cam_sensor_rear_1_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_rest_suspend
+            &cam_sensor_rear_1_ana_suspend>;
+        gpios = <&tlmm 13 0>,
+            <&tlmm 28 0>,
+            <&tlmm 148 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK0",
+            "CAM_RESET1",
+            "CAM_VANA_1";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK0_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@2 {
+        cell-index = <2>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x02>;
+        csiphy-sd-index = <2>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <0>;
+        eeprom-src = <&eeprom_front_0>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l3>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_front_0_mclk_active
+            &cam_sensor_front_0_rest_active
+            &cam_sensor_front_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_front_0_mclk_suspend
+            &cam_sensor_front_0_rest_suspend
+            &cam_sensor_front_0_ana_suspend>;
+        gpios = <&tlmm 15 0>,
+            <&tlmm 12 0>,
+            <&pm8150l_gpios 12 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK2",
+            "CAM_RESET2",
+            "CAM_VANA_2";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK2_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@3 {
+        cell-index = <3>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x03>;
+        csiphy-sd-index = <3>;
+        sensor-position-roll = <270>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <0>;
+        eeprom-src = <&eeprom_rear_2>;
+        actuator-src = <&actuator_rear_2>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l4>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_mclk_active
+            &cam_sensor_rear_2_rest_active
+            &cam_sensor_rear_2_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_mclk_suspend
+            &cam_sensor_rear_2_rest_suspend
+            &cam_sensor_rear_2_ana_suspend>;
+        gpios = <&tlmm 16 0>,
+            <&tlmm 23 0>,
+            <&pm8150l_gpios 2 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2 >;
+        gpio-req-tbl-flags = <1 0 0 >;
+        gpio-req-tbl-label = "CAMIF_MCLK3",
+            "CAM_RESET3",
+            "CAM_VANA_3";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK3_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+};
+
+&tlmm {
+    cam_sensor_rear_0_mclk_active: cam_sensor_rear_0_mclk_active {
+        /* MCLK0 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio14";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio14";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_mclk_suspend: cam_sensor_rear_0_mclk_suspend {
+        /* MCLK0 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio14";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio14";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_rest_active: cam_sensor_rear_0_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio30";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio30";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_rest_suspend: cam_sensor_rear_0_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio30";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio30";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana_active: cam_sensor_rear_0_ana_active {
+        /* VANA */
+        mux {
+            pins = "gpio11";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio11";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana_suspend: cam_sensor_rear_0_ana_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio11";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio11";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana2_active: cam_sensor_rear_0_ana2_active {
+        /* VANA */
+        mux {
+            pins = "gpio29";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio29";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana2_suspend: cam_sensor_rear_0_ana2_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio29";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio29";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_vaf_active: cam_sensor_rear_0_vaf_active {
+        /* AF */
+        mux {
+            pins = "gpio25";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio25";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_vaf_suspend: cam_sensor_rear_0_vaf_suspend {
+        /* AF */
+        mux {
+            pins = "gpio25";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio25";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_mclk_active: cam_sensor_rear_1_mclk_active {
+        /* MCLK1 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio13";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio13";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_mclk_suspend: cam_sensor_rear_1_mclk_suspend {
+        /* MCLK1 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio13";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio13";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_rest_active: cam_sensor_rear_1_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio28";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio28";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_rest_suspend: cam_sensor_rear_1_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio28";
+            function = "gpio";
+        };
+        config {
+            pins = "gpio28";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_ana_active: cam_sensor_rear_1_ana_active {
+        /* VANA */
+        mux {
+            pins = "gpio148";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio148";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_ana_suspend: cam_sensor_rear_1_ana_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio148";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio148";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_vaf_active: cam_sensor_rear_1_vaf_active {
+        /* ACTUATOR POWER */
+        mux {
+            pins = "gpio35";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio35";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_vaf_suspend: cam_sensor_rear_1_vaf_suspend {
+        /* ACTUATOR POWER */
+        mux {
+            pins = "gpio35";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio35";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_mclk_active: cam_sensor_front_0_mclk_active {
+        /* MCLK2 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio15";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio15";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_mclk_suspend: cam_sensor_front_0_mclk_suspend {
+        /* MCLK2 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio15";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio15";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_rest_active:	cam_sensor_front_0_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio12";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio12";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_rest_suspend: cam_sensor_front_0_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio12";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio12";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_mclk_active: cam_sensor_rear_2_mclk_active {
+        /* MCLK3 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio16";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio16";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_mclk_suspend: cam_sensor_rear_2_mclk_suspend {
+        /* MCLK3 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio16";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio16";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_rest_active:	cam_sensor_rear_2_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio23";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio23";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_rest_suspend: cam_sensor_rear_2_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio23";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio23";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_pwren_active:	cam_sensor_laser_pwren_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio26";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio26";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_pwren_suspend: cam_sensor_laser_pwren_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio26";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio26";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-oem-camera-v2.dtsi b/arch/arm64/boot/dts/qcom/sm8150-oem-camera-v2.dtsi
new file mode 100644
index 0000000000000000000000000000000000000000..e80107dee1c10dbca329b7305dce8f95d5cb1395
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/sm8150-oem-camera-v2.dtsi
@@ -0,0 +1,1035 @@
+&pm8150l_gpios{
+	cam_sensor_pmi_gpio {
+		cam_sensor_rear_0_dvdd_active: cam_sensor_rear_0_dvdd_active {
+			pins = "gpio1";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_0_dvdd_suspend: cam_sensor_rear_0_dvdd_suspend {
+			pins = "gpio1";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_ana_active: cam_sensor_rear_2_ana_active {
+			pins = "gpio2";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_ana_suspend: cam_sensor_rear_2_ana_suspend {
+			pins = "gpio2";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_af_active: cam_sensor_rear_2_af_active {
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_rear_2_af_suspend: cam_sensor_rear_2_af_suspend {
+			pins = "gpio4";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+	};
+
+	cam_sensor_front_0_ana {
+		cam_sensor_front_0_ana_active: cam_sensor_front_0_ana_active {
+			pins = "gpio12";
+			function = "normal";
+			power-source = <0>;
+			output-low;
+			input-disable;
+		};
+
+		cam_sensor_front_0_ana_suspend: cam_sensor_front_0_ana_suspend {
+			pins = "gpio12";
+			function = "normal";
+			power-source = <0>;
+			bias-pull-down;
+			input-disable;
+		};
+	};
+};
+
+&soc {
+//laser start
+    stmvl53l1: st,stmvl53l1@0 {
+        compatible = "st,stmvl53l1";
+        //reg = <0x29>;
+        //avdd-supply = <&pm8150l_bob>;
+        laser_vdd-supply = <&pm8150l_l1>;
+        pinctrl-names = "laser_default", "laser_suspend";
+        pinctrl-0 = <&cam_sensor_laser_xsdn_active
+                     &cam_sensor_laser_pwren_active
+                     &cam_sensor_laser_intr_active>;
+        pinctrl-1 = <&cam_sensor_laser_xsdn_suspend
+                     &cam_sensor_laser_pwren_suspend
+                     &cam_sensor_laser_intr_suspend>;
+        xsdn-gpio = <&tlmm 24 0>;
+        pwren-gpio = <&tlmm 26 0>;
+        intr-gpio = <&tlmm 131 0>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+    };
+//laser end
+};
+
+&cam_cci0 {
+    qcom,cam-res-mgr {
+        compatible = "qcom,cam-res-mgr";
+        shared-gpios = <14 13>;
+        pinctrl-names = "cam_res_mgr_default", "cam_res_mgr_suspend";
+        status = "ok";
+        pinctrl-0 = <&cam_sensor_rear_0_mclk_active
+            &cam_sensor_rear_1_mclk_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_mclk_suspend
+            &cam_sensor_rear_1_mclk_suspend>;
+    };
+
+    actuator_rear_0: qcom,actuator@7 {
+        cell-index = <7>;
+        reg = <0x7>;
+        compatible = "qcom,actuator";
+        cci-device = <0>;
+        cci-master = <1>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_vaf_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_vaf_suspend>;
+        gpios = <&tlmm 25 0>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_0";
+    };
+
+    actuator_rear_1: qcom,actuator@8 {
+        cell-index = <8>;
+        reg = <0x8>;
+        compatible = "qcom,actuator";
+        cci-device = <0>;
+        cci-master = <0>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_vaf_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_vaf_suspend>;
+        gpios = <&tlmm 35 0>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_1";
+    };
+
+    actuator_rear_2: qcom,actuator@9 {
+        cell-index = <9>;
+        reg = <0x9>;
+        compatible = "qcom,actuator";
+        cci-device = <1>;
+        cci-master = <1>;
+        cam_vaf-supply = <&pm8150l_bob>;
+        regulator-names = "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <3300000>;
+        rgltr-max-voltage = <3300000>;
+        rgltr-load-current = <0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_af_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_af_suspend>;
+        gpios = <&pm8150l_gpios 4 GPIO_ACTIVE_HIGH>;
+        gpio-vaf = <0>;
+        gpio-req-tbl-num = <0>;
+        gpio-req-tbl-flags = <0>;
+        gpio-req-tbl-label = "CAM_VAF_1";
+    };
+
+    ois_rear_0: qcom,ois@2 {
+        cell-index = <2>;
+        reg = <2>;
+        compatible = "qcom,ois";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vdig-supply = <&pm8009_l6>;//s5k3m5 ois
+        cam_vaf-supply = <&pm8009_l5>;
+        regulator-names = "cam_vio", "cam_vdig", "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 2856000 2800000>;
+        rgltr-max-voltage = <0 2856000 2800000>;
+        rgltr-load-current = <0 80000 0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+    };
+
+    ois_rear_1: qcom,ois@3 {
+        cell-index = <3>;
+        reg = <3>;
+        compatible = "qcom,ois";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vdig-supply = <&pm8009_l5>;//imx586 ois
+        cam_vaf-supply = <&pm8009_l6>;
+        regulator-names = "cam_vio", "cam_vdig", "cam_vaf";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 2800000 2856000>;
+        rgltr-max-voltage = <0 2800000 2856000>;
+        rgltr-load-current = <0 80000 0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+    };
+
+    eeprom_rear_0: qcom,eeprom@7 {
+        cell-index = <7>;
+        reg = <7>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l1>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1104000 0>;
+        rgltr-max-voltage = <0 3300000 1104000 0>;
+        rgltr-load-current = <0 80000 1100000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_rest_active
+            &cam_sensor_rear_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_rest_suspend
+            &cam_sensor_rear_0_ana_suspend>;
+        gpios = <&tlmm 14 0>,
+            <&tlmm 30 0>,
+            <&tlmm 11 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK1",
+            "CAM_RESET0",
+            "CAM_VANA_0";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK1_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_rear_1: qcom,eeprom@8 {
+        cell-index = <8>;
+        reg = <8>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l2>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1050000 0>;
+        rgltr-max-voltage = <0 3300000 1050000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_rest_active
+            &cam_sensor_rear_1_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_rest_suspend
+            &cam_sensor_rear_1_ana_suspend>;
+        gpios = <&tlmm 13 0>,
+            <&tlmm 28 0>,
+            <&tlmm 148 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK0",
+            "CAM_RESET1",
+            "CAM_VANA_1";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK0_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_front_0: qcom,eeprom@9 {
+        cell-index = <9>;
+        reg = <9>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l3>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_front_0_mclk_active
+            &cam_sensor_front_0_rest_active
+            &cam_sensor_front_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_front_0_mclk_suspend
+            &cam_sensor_front_0_rest_suspend
+            &cam_sensor_front_0_ana_suspend>;
+        gpios = <&tlmm 15 0>,
+            <&tlmm 12 0>,
+            <&pm8150l_gpios 12 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK2",
+            "CAM_RESET2",
+            "CAM_VANA_2";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK2_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    eeprom_rear_2: qcom,eeprom@10 {
+        cell-index = <10>;
+        reg = <0xA>;
+        compatible = "qcom,eeprom";
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l4>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1050000 0>;
+        rgltr-max-voltage = <0 3300000 1050000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_mclk_active
+            &cam_sensor_rear_2_rest_active
+            &cam_sensor_rear_2_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_mclk_suspend
+            &cam_sensor_rear_2_rest_suspend
+            &cam_sensor_rear_2_ana_suspend>;
+        gpios = <&tlmm 16 0>,
+            <&tlmm 23 0>,
+            <&pm8150l_gpios 2 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2 >;
+        gpio-req-tbl-flags = <1 0 0 >;
+        gpio-req-tbl-label = "CAMIF_MCLK3",
+            "CAM_RESET3",
+            "CAM_VANA_3";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK3_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@0 {
+        cell-index = <0>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x0>;
+        csiphy-sd-index = <1>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <180>;
+        led-flash-src = <&led_flash_rear>;
+        actuator-src = <&actuator_rear_0>;
+        ois-src = <&ois_rear_0>;
+        eeprom-src = <&eeprom_rear_1>;//for imx586&s5k3m5 use same eeprom located on slave s5k3m5
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l1>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1104000 0>;
+        rgltr-max-voltage = <0 3300000 1104000 0>;
+        rgltr-load-current = <0 80000 1100000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_0_rest_active
+            &cam_sensor_rear_0_ana_active
+            &cam_sensor_rear_0_ana2_active
+            &cam_sensor_rear_0_dvdd_active>;
+        pinctrl-1 = <&cam_sensor_rear_0_rest_suspend
+            &cam_sensor_rear_0_ana_suspend
+            &cam_sensor_rear_0_ana2_suspend
+            &cam_sensor_rear_0_dvdd_suspend>;
+        gpios = <&tlmm 14 0>,
+            <&tlmm 30 0>,
+            <&tlmm 11 0>,
+            <&tlmm 29 0>,
+            <&pm8150l_gpios 1 GPIO_ACTIVE_HIGH>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-custom1 = <3>;
+        gpio-custom2 = <4>;
+        gpio-req-tbl-num = <0 1 2 3 4>;
+        gpio-req-tbl-flags = <1 0 0 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK1",
+            "CAM_RESET0",
+            "CAM_VANA_0",
+            "CAM_VANA2_0",
+            "CAM_PVDD";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK1_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@1 {
+        cell-index = <1>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x1>;
+        csiphy-sd-index = <0>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <180>;
+        actuator-src = <&actuator_rear_1>;
+        led-flash-src = <&led_flash_rear_aux>;
+        eeprom-src = <&eeprom_rear_1>;
+        ois-src = <&ois_rear_1>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l2>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1050000 0>;
+        rgltr-max-voltage = <0 3300000 1050000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_1_rest_active
+            &cam_sensor_rear_1_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_1_rest_suspend
+            &cam_sensor_rear_1_ana_suspend>;
+        gpios = <&tlmm 13 0>,
+            <&tlmm 28 0>,
+            <&tlmm 148 0>;
+        use-shared-clk;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK0",
+            "CAM_RESET1",
+            "CAM_VANA_1";
+        sensor-mode = <0>;
+        cci-device = <0>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK0_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@2 {
+        cell-index = <2>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x02>;
+        csiphy-sd-index = <2>;
+        sensor-position-roll = <90>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <0>;
+        eeprom-src = <&eeprom_front_0>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l3>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1056000 0>;
+        rgltr-max-voltage = <0 3300000 1056000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_front_0_mclk_active
+            &cam_sensor_front_0_rest_active
+            &cam_sensor_front_0_ana_active>;
+        pinctrl-1 = <&cam_sensor_front_0_mclk_suspend
+            &cam_sensor_front_0_rest_suspend
+            &cam_sensor_front_0_ana_suspend>;
+        gpios = <&tlmm 15 0>,
+            <&tlmm 12 0>,
+            <&pm8150l_gpios 12 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2>;
+        gpio-req-tbl-flags = <1 0 0>;
+        gpio-req-tbl-label = "CAMIF_MCLK2",
+            "CAM_RESET2",
+            "CAM_VANA_2";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <0>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK2_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+
+    qcom,cam-sensor@3 {
+        cell-index = <3>;
+        compatible = "qcom,cam-sensor";
+        reg = <0x03>;
+        csiphy-sd-index = <3>;
+        sensor-position-roll = <270>;
+        sensor-position-pitch = <0>;
+        sensor-position-yaw = <0>;
+        eeprom-src = <&eeprom_rear_2>;
+        actuator-src = <&actuator_rear_2>;
+        cam_vio-supply = <&pm8150l_l1>;
+        cam_vana-supply = <&pm8150l_bob>;
+        cam_vdig-supply = <&pm8009_l4>;
+        cam_clk-supply = <&titan_top_gdsc>;
+        regulator-names = "cam_vio", "cam_vana", "cam_vdig",
+            "cam_clk";
+        rgltr-cntrl-support;
+        rgltr-min-voltage = <0 3300000 1050000 0>;
+        rgltr-max-voltage = <0 3300000 1050000 0>;
+        rgltr-load-current = <0 80000 1050000 0>;
+        gpio-no-mux = <0>;
+        pinctrl-names = "cam_default", "cam_suspend";
+        pinctrl-0 = <&cam_sensor_rear_2_mclk_active
+            &cam_sensor_rear_2_rest_active
+            &cam_sensor_rear_2_ana_active>;
+        pinctrl-1 = <&cam_sensor_rear_2_mclk_suspend
+            &cam_sensor_rear_2_rest_suspend
+            &cam_sensor_rear_2_ana_suspend>;
+        gpios = <&tlmm 16 0>,
+            <&tlmm 23 0>,
+            <&pm8150l_gpios 2 GPIO_ACTIVE_HIGH>;
+        gpio-reset = <1>;
+        gpio-vana = <2>;
+        gpio-req-tbl-num = <0 1 2 >;
+        gpio-req-tbl-flags = <1 0 0 >;
+        gpio-req-tbl-label = "CAMIF_MCLK3",
+            "CAM_RESET3",
+            "CAM_VANA_3";
+        sensor-mode = <0>;
+        cci-device = <1>;
+        cci-master = <1>;
+        status = "ok";
+        clocks = <&clock_camcc CAM_CC_MCLK3_CLK>;
+        clock-names = "cam_clk";
+        clock-cntl-level = "turbo";
+        clock-rates = <19200000>;
+    };
+};
+
+&tlmm {
+    cam_sensor_rear_0_mclk_active: cam_sensor_rear_0_mclk_active {
+        /* MCLK0 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio14";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio14";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_mclk_suspend: cam_sensor_rear_0_mclk_suspend {
+        /* MCLK0 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio14";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio14";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_rest_active: cam_sensor_rear_0_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio30";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio30";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_rest_suspend: cam_sensor_rear_0_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio30";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio30";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana_active: cam_sensor_rear_0_ana_active {
+        /* VANA */
+        mux {
+            pins = "gpio11";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio11";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana_suspend: cam_sensor_rear_0_ana_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio11";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio11";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana2_active: cam_sensor_rear_0_ana2_active {
+        /* VANA */
+        mux {
+            pins = "gpio29";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio29";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_ana2_suspend: cam_sensor_rear_0_ana2_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio29";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio29";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_vaf_active: cam_sensor_rear_0_vaf_active {
+        /* AF */
+        mux {
+            pins = "gpio25";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio25";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_0_vaf_suspend: cam_sensor_rear_0_vaf_suspend {
+        /* AF */
+        mux {
+            pins = "gpio25";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio25";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_mclk_active: cam_sensor_rear_1_mclk_active {
+        /* MCLK1 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio13";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio13";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_mclk_suspend: cam_sensor_rear_1_mclk_suspend {
+        /* MCLK1 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio13";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio13";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_rest_active: cam_sensor_rear_1_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio28";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio28";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_rest_suspend: cam_sensor_rear_1_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio28";
+            function = "gpio";
+        };
+        config {
+            pins = "gpio28";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_ana_active: cam_sensor_rear_1_ana_active {
+        /* VANA */
+        mux {
+            pins = "gpio148";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio148";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_ana_suspend: cam_sensor_rear_1_ana_suspend {
+        /* VANA */
+        mux {
+            pins = "gpio148";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio148";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_vaf_active: cam_sensor_rear_1_vaf_active {
+        /* ACTUATOR POWER */
+        mux {
+            pins = "gpio35";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio35";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_1_vaf_suspend: cam_sensor_rear_1_vaf_suspend {
+        /* ACTUATOR POWER */
+        mux {
+            pins = "gpio35";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio35";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_mclk_active: cam_sensor_front_0_mclk_active {
+        /* MCLK2 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio15";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio15";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_mclk_suspend: cam_sensor_front_0_mclk_suspend {
+        /* MCLK2 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio15";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio15";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_rest_active:	cam_sensor_front_0_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio12";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio12";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_front_0_rest_suspend: cam_sensor_front_0_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio12";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio12";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_mclk_active: cam_sensor_rear_2_mclk_active {
+        /* MCLK3 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio16";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio16";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_mclk_suspend: cam_sensor_rear_2_mclk_suspend {
+        /* MCLK3 */
+        mux {
+            /* CLK, DATA */
+            pins = "gpio16";
+            function = "cam_mclk";
+        };
+
+        config {
+            pins = "gpio16";
+            bias-pull-down; /* PULL DOWN */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_rest_active:	cam_sensor_rear_2_rest_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio23";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio23";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_rear_2_rest_suspend: cam_sensor_rear_2_rest_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio23";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio23";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_xsdn_active:	cam_sensor_laser_xsdn_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio24";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio24";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_xsdn_suspend: cam_sensor_laser_xsdn_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio24";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio24";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_pwren_active:	cam_sensor_laser_pwren_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio26";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio26";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_pwren_suspend: cam_sensor_laser_pwren_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio26";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio26";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_intr_active:	cam_sensor_laser_intr_active {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio131";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio131";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+
+    cam_sensor_laser_intr_suspend: cam_sensor_laser_intr_suspend {
+        /* RESET, STANDBY */
+        mux {
+            pins = "gpio131";
+            function = "gpio";
+        };
+
+        config {
+            pins = "gpio131";
+            bias-disable; /* No PULL */
+            drive-strength = <2>; /* 2 MA */
+        };
+    };
+};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-oem.dtsi b/arch/arm64/boot/dts/qcom/sm8150-oem.dtsi
new file mode 100755
index 0000000000000000000000000000000000000000..1b36b1a853fb8a868da5996b56dc0f1bba3d0fa2
--- /dev/null
+++ b/arch/arm64/boot/dts/qcom/sm8150-oem.dtsi
@@ -0,0 +1,1183 @@
+/*recommand add our code to this dtsi this part is oem code*/
+&soc {
+	dsi_samsung_sofef00_m_cmd_display: qcom,dsi-display@23 {
+		label = "dsi_samsung_sofef00_m_cmd_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_sofef00_m_cmd>;
+	};
+
+	dsi_samsung_s6e3fc2x01_cmd_display: qcom,dsi-display@24 {
+		label = "dsi_samsung_s6e3fc2x01_cmd_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_s6e3fc2x01_cmd>;
+	};
+
+	dsi_samsung_sofef00_m_video_display: qcom,dsi-display@26 {
+		label = "dsi_samsung_sofef00_m_video_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_sofef00_m_video>;
+	};
+
+	dsi_samsung_oneplus_dsc_cmd_display: qcom,dsi-display@28 {
+		label = "dsi_samsung_oneplus_dsc_cmd_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_oneplus_dsc_cmd>;
+	};
+
+	dsi_samsung_s6e3fc2x01_ed173_cmd_display: qcom,dsi-display@29 {
+		label = "dsi_samsung_s6e3fc2x01_ed173_cmd_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_s6e3fc2x01_ed173_cmd>;
+	};
+
+	dsi_samsung_oneplus_fhd_dsc_cmd_display: qcom,dsi-display@31 {
+		label = "dsi_samsung_oneplus_fhd_dsc_cmd_display";
+		qcom,display-type = "primary";
+		qcom,dsi-ctrl-num = <0>;
+		qcom,dsi-phy-num = <0>;
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
+		qcom,dsi-panel = <&dsi_samsung_oneplus_fhd_dsc_cmd>;
+	};
+
+	fingerprint_detect {
+		compatible = "oneplus,fpdetect";
+		fp-gpio-id0 = <&tlmm 90 0>;
+		fp-gpio-id1 = <&tlmm 21 0>;
+	};
+
+	silead_fp {
+		compatible = "sil,fingerprint";
+		interrupt-parent = <&tlmm>;
+		//avdd-supply = <&pm8150_l17>;
+		avdd-gpios = <&tlmm 101 0x00>;
+		irq-gpios = <&tlmm 118 0x00>;
+		rst-gpios = <&tlmm 131 0x00>;
+		pinctrl-names = "fp_en_init";
+		pinctrl-0 = <&fp_reset_init &fp_irq_init &fp_vdd_init>;
+		status = "okay";
+	};
+
+	goodix_fp {
+		compatible = "goodix,fingerprint";
+		interrupt-parent = <&tlmm>;
+		//vdd-3v2-supply = <&pm8998_l22>;
+		//vdd-voltage = <3200000 3200000>;
+		//vdd-current = <50000>;
+		fp-gpio-irq = <&tlmm 118 0x00>;
+		fp-gpio-reset = <&tlmm 9 0x00>;
+		fp-gpio-enable = <&tlmm 101 0x00>;
+		pinctrl-names = "fp_en_init", "fp_dis_init";
+		pinctrl-0 = <&fp_vdd_init &fp_irq_init>;
+		pinctrl-1 = <&fp_vdd_dis_init>;
+		status = "okay";
+	};
+
+	tri_state_key:tri_state_key {
+		compatible = "oneplus, tri-state-key";
+		status = "okay";
+		interrupt-parent = <&tlmm>;
+		tristate,gpio_key1 = <&tlmm 27 0x00>;
+		tristate,gpio_key2 = <&tlmm 134 0x00>;
+		tristate,gpio_key3 = <&tlmm 125 0x00>;
+		pinctrl-names =
+				"pmx_tri_state_key_active",
+				"pmx_tri_state_key_suspend";
+		pinctrl-0 = <&tri_state_key_active>;
+		pinctrl-1 = <&tri_state_key_suspend>;
+	};
+};
+
+&qcomqbt1000{
+		/delete-property/ pinctrl-names;
+		/delete-property/ pinctrl-0;
+		qfp-int2 = <&tlmm 131 0x00>;
+		qcom,finger-detect-gpio = <&tlmm 101 0>;
+};
+
+&sde_dsi {
+	pinctrl-names = "panel_active", "panel_suspend","default";
+	pinctrl-0 = <&sde_dsi_active &sde_te_active &display_panel_avdd_eldo_default>;
+	pinctrl-1 = <&sde_dsi_suspend &sde_te_suspend &display_panel_avdd_eldo_off>;
+	/delete-property/ lab-supply;
+	/delete-property/ ibb-supply;
+	/delete-property/ vdd-supply;
+	qcom,dsi-display-list =
+		<&dsi_samsung_sofef00_m_cmd_display
+		&dsi_samsung_s6e3fc2x01_cmd_display
+		&dsi_samsung_s6e3fc2x01_ed173_cmd_display
+		&dsi_samsung_sofef00_m_video_display
+		&dsi_samsung_oneplus_dsc_cmd_display
+		&dsi_samsung_oneplus_fhd_dsc_cmd_display>;
+};
+
+&tlmm {
+	display_panel_avdd_eldo_off: display_panel_avdd_eldo_off {
+		mux {
+			pins = "gpio130";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio130";
+			drive-strength = <8>;
+			bias-disable = <0>;
+			output-low;
+		};
+	};
+
+	tri_state_key_active: tri_state_key_active {
+		mux {
+			pins = "gpio125", "gpio134", "gpio27";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio125", "gpio134", "gpio27";
+			drive-strength = <2>;
+			bias-disable;
+			};
+		};
+
+	tri_state_key_suspend: tri_state_key_suspend {
+		mux {
+			pins = "gpio125", "gpio134", "gpio27";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio125", "gpio134", "gpio27";
+			drive-strength = <2>;
+			bias-disable;
+			};
+	};
+};
+
+&snd_9360 {
+	status = "disabled";
+};
+&wcd9360_cdc {
+	status = "disabled";
+};
+&clock_audio {
+	status = "disabled";
+};
+
+&snd_934x {
+	qcom,audio-routing =
+		"AIF4 VI", "MCLK",
+		"RX_BIAS", "MCLK",
+		"MADINPUT", "MCLK",
+		"hifi amp", "LINEOUT1",
+		"hifi amp", "LINEOUT2",
+		"AMIC1", "MIC BIAS1",
+		"AMIC2", "MIC BIAS2",
+		"MIC BIAS2", "Headset Mic",
+		"AMIC3", "MIC BIAS4",
+		"MIC BIAS4", "ANCRight Headset Mic",
+		"AMIC4", "MIC BIAS1",
+		"MIC BIAS1", "ANCLeft Headset Mic",
+		"AMIC5", "MIC BIAS1",
+		"MIC BIAS1", "Handset Mic",
+		"DMIC0", "MIC BIAS1",
+		"MIC BIAS1", "Digital Mic0",
+		"DMIC1", "MIC BIAS1",
+		"MIC BIAS1", "Digital Mic1",
+		"DMIC2", "MIC BIAS3",
+		"MIC BIAS3", "Digital Mic2",
+		"DMIC3", "MIC BIAS3",
+		"MIC BIAS3", "Digital Mic3",
+		"DMIC4", "MIC BIAS4",
+		"MIC BIAS4", "Digital Mic4",
+		"DMIC5", "MIC BIAS4",
+		"MIC BIAS4", "Digital Mic5",
+		"SpkrLeft IN", "SPK1 OUT",
+		"SpkrRight IN", "SPK2 OUT";
+
+	qcom,wsa-max-devs = <0>;
+	qcom,msm-mbhc-usbc-audio-supported = <1>;
+	pinctrl-names = "quat_mi2s_enable","quat_mi2s_disable",
+		"quat_tdm_enable","quat_tdm_disable";
+	pinctrl-0 = <&quat_mi2s_active
+		&quat_mi2s_sd0_active &quat_mi2s_sd1_active>;
+	pinctrl-1 = <&quat_mi2s_sleep
+		&quat_mi2s_sd0_sleep &quat_mi2s_sd1_sleep>;
+	pinctrl-2 = <&quat_tdm_active
+		&quat_tdm_din_active &quat_tdm_dout_active>;
+	pinctrl-3 = <&quat_tdm_sleep
+		&quat_tdm_din_sleep &quat_tdm_dout_sleep>;
+};
+
+&wcd934x_cdc {
+	qcom,cdc-micbias1-mv = <2700>;
+	qcom,cdc-micbias2-mv = <2700>;
+	qcom,cdc-micbias4-mv = <2700>;
+};
+
+&wsa881x_70211{
+	status = "disabled";
+};
+
+&wsa881x_70212{
+	status = "disabled";
+};
+
+&wsa881x_70213{
+	status = "disabled";
+};
+
+&wsa881x_70214{
+	status = "disabled";
+};
+
+//quentin.lin add 2018/11/07
+&vendor {
+	motor_pl: motor_pl {
+			compatible = "oneplus-motor";
+			interrupt-parent = <&tlmm>;
+			interrupts = <163 0x2>; 
+			motor,irq-gpio = <&tlmm 163 0x2008>;
+			pinctrl-names = "free_fall_input";
+			pinctrl-0 = <&free_fall_input>;
+			structure,id = <0>;
+	};
+};
+
+&tlmm {
+	free_fall_input: free_fall_input {
+		mux {
+			pins = "gpio163";
+			function = "gpio";
+		};
+	config {
+			pins = "gpio163";
+			drive-strength = <2>;
+			input-enable;
+			bias-disable; //No Pull
+		};
+	};
+
+};
+
+
+&qupv3_se1_i2c {
+   status = "ok";
+   magnachip@0C {
+               compatible = "magnachip,mxm1120,up";
+               reg = <0x0C>;
+               vdd-supply = <&pm8150l_l7>;
+               vio-supply = <&pm8150l_l8>;
+               magnachip,init-interval = <200>;
+			   interrupt-parent = <&tlmm>;
+			   interrupts = <120 0x2>;
+			   dhall,irq-gpio = <&tlmm 120 0x2008>;
+               mxm,id = <1>;
+             };
+   magnachip@0D {
+               compatible = "magnachip,mxm1120,down";
+               reg = <0x0D>;
+               vdd-supply = <&pm8150l_l7>;
+               vio-supply = <&pm8150l_l8>;
+               magnachip,init-interval = <200>;
+               interrupt-parent = <&tlmm>;
+               interrupts = <121 0x2>;
+               dhall,irq-gpio = <&tlmm 121 0x2008>;
+               mxm,id = <2>;
+             };
+};
+
+&qupv3_se4_i2c {
+	//liuhaituo@MM.Audio add begain
+tfa98xx_right: tfa98xx_right@34 {
+				   compatible = "nxp,tfa98xx";
+				   reg = <0x34>;
+				   reset-gpio = <&tlmm 37 0>;
+				   status = "ok";
+			   };
+
+tfa98xx_left: tfa98xx_left@35 {
+				  compatible = "nxp,tfa98xx";
+				  reg = <0x35>;
+				  reset-gpio = <&tlmm 37 0>;
+				  status = "ok";
+			  };
+			  //liuhaituo@MM.Audio add end
+};
+
+//liuhaituo@MM.Audio add begain
+&dai_mi2s3 {
+	qcom,msm-mi2s-rx-lines = <2>;
+	qcom,msm-mi2s-tx-lines = <1>;
+};
+//wangdongdong@AudioDrv, add for 4M memory increase of adsp begain
+&pil_adsp_mem {
+	reg = <0x0 0x8be00000 0x0 0x1e00000>;
+};
+
+&pil_modem_mem {
+	reg = <0x0 0x8dc00000 0x0 0x9600000>;
+};
+
+&pil_video_mem {
+	reg = <0x0 0x97200000 0x0 0x500000>;
+};
+
+&pil_slpi_mem {
+	reg = <0x0 0x97700000 0x0 0x1400000>;
+};
+
+&pil_ipa_fw_mem {
+	reg = <0x0 0x98b00000 0x0 0x10000>;
+};
+
+&pil_ipa_gsi_mem {
+	reg = <0x0 0x98b10000 0x0 0x5000>;
+};
+
+&pil_gpu_mem {
+	reg = <0x0 0x98b15000 0x0 0x2000>;
+};
+
+&pil_spss_mem {
+	reg = <0x0 0x98c00000  0x0 0x100000>;
+};
+
+&pil_cdsp_mem {
+	reg = <0x0 0x98d00000 0x0 0x1400000>;
+};
+
+//wangdongdong@AudioDrv, add for 4M memory increase of adsp end
+
+//Because pcie0 wakeup-gpio is same pa-gpio, so disabled it
+&pcie0 {
+	status = "disabled";
+};
+//liuhaituo@MM.Audio add end
+
+&display_panel_avdd_eldo {
+
+    compatible = "qcom,dsi-display";
+    pinctrl-names = "default", "poweroff";
+    status = "ok";
+    pintctrl-0 = <&display_panel_avdd_eldo_default>;
+    pintctrl-1 = <&display_panel_avdd_eldo_off>;
+};
+
+&sde_dsi_active {
+    mux {
+        pins = "gpio6";
+        function = "gpio";
+    };
+
+    config {
+        pins = "gpio6";
+        drive-strength = <8>;
+        bias-disable = <0>;
+    };
+};
+&sde_dsi_suspend {
+    mux {
+        pins = "gpio6";
+        function = "gpio";
+    };
+
+    config {
+        pins = "gpio6";
+        drive-strength = <2>;
+        bias-pull-down;
+    };
+};
+
+&qupv3_se17_i2c {
+	status = "ok";
+	sec-s6sy761@48 {
+		compatible = "sec-s6sy761";
+		reg = <0x48>;
+		project-name = "18821";
+		chip-name = "SY761";
+		module_id = <7>;
+		reset-gpio = <&tlmm 54 0x00>;
+		irq-gpio = <&tlmm 122 0x2008>;
+		vdd_2v8-supply = <&pm8150_l17>;                 //set 3.3 by ldo
+		vdd_2v8_volt = <3008000>;
+		//enable1v8_gpio = <&tlmm 59 0x00>;               //set 1.8v by gpio
+		touchpanel,display-coords = <1439 3119>;
+		touchpanel,panel-coords = <1439 3119>;
+		touchpanel,tx-rx-num = <17 37>;
+		//edge_limit_support = <1>;
+		//spurious_fingerprint_support = <1>;
+		//charger_pump_support = <1>;
+		black_gesture_support = <1>;
+		//black_gesture_test_support = <1>;
+		//game_switch_support = <1>;
+		face_detect_support = <1>;
+		lcd_refresh_rate_switch = <1>;
+		touch_hold_support = <1>;
+		//lcd_trigger_fp_check = <1>;
+		module_id_support = <1>;
+		pinctrl-names = "pin_set_high", "pin_set_low";
+		pinctrl-0 = <&tp_irq_active &tp_rst_active &tp_1v8_active>;
+		pinctrl-1 = <&tp_rst_suspend &tp_1v8_suspend>;
+	};
+};
+
+&qupv3_se17_i2c {
+	status = "ok";
+	synaptics-s3706@20 {
+		compatible = "synaptics-s3706";
+		reg = <0x20>;
+		project-name = "18857";
+		chip-name = "S3706";
+		reset-gpio = <&tlmm 54 0x00>;
+		irq-gpio = <&tlmm 122 0x2008>;
+		vdd_2v8-supply = <&pm8150_l17>;                 //set 3.3 by ldo
+		vdd_2v8_volt = <3008000>;
+		//enable1v8_gpio = <&tlmm 59 0x00>;               //set 1.8v by gpio
+		touchpanel,display-coords = <1080 2340>;
+		touchpanel,panel-coords = <1080 2340>;
+		touchpanel,tx-rx-num = <16 33>;
+		black_gesture_support = <1>;
+		face_detect_support = <1>;
+		touch_hold_support = <1>;
+		charge_detect_support = <1>;
+		module_id = <7>;
+		pinctrl-names = "pin_set_high", "pin_set_low";
+		pinctrl-0 = <&tp_irq_active &tp_rst_active &tp_1v8_active>;
+		pinctrl-1 = <&tp_rst_suspend &tp_1v8_suspend>;
+	};
+};
+
+&qupv3_se17_i2c {
+        status = "ok";
+        st_fts@49 {
+		compatible = "st,fts";
+		reg = <0x49>;
+		project-name = "18821";
+		chip-name = "ST_ALIX";
+		module_id = <7>;
+		reset-gpio = <&tlmm 54 0x00>;
+		irq-gpio = <&tlmm 122 0x2008>;
+		vdd_2v8-supply = <&pm8150_l17>;                 //set 3.3 by ldo
+		vdd_2v8_volt = <3008000>;
+		//enable1v8_gpio = <&tlmm 59 0x00>;               //set 1.8v by gpio
+		touchpanel,display-coords = <1439 3119>;
+		touchpanel,panel-coords = <1439 3119>;
+		touchpanel,tx-rx-num = <17 37>;
+		black_gesture_support = <1>;
+		face_detect_support = <1>;
+		lcd_refresh_rate_switch = <1>;
+		touch_hold_support = <1>;
+		//lcd_trigger_fp_check = <1>;
+		pinctrl-names = "pin_set_high", "pin_set_low";
+		pinctrl-0 = <&tp_irq_active &tp_rst_active &tp_1v8_active>;
+		pinctrl-1 = <&tp_rst_suspend &tp_1v8_suspend>;
+	};
+};
+
+
+/* @bsp, 2018/07/20 Battery & Charging porting STRAT */
+&qupv3_se8_i2c {
+	qcom,clk-freq-out = <100000>;
+	status = "ok";
+	bq27541-battery@55 {
+		status = "ok";
+		compatible = "ti,bq27541-battery";
+		reg = <0x55>;
+		qcom,modify-soc-smooth;
+	};
+
+	oneplus_fastchg@26{
+		status = "ok";
+		compatible = "microchip,oneplus_fastchg";
+		reg = <0x26>;
+		microchip,mcu-en-gpio = <&tlmm 82 0x00>;
+		microchip,usb-sw-1-gpio = <&tlmm 94 0x00>;
+		microchip,usb-sw-2-gpio = <&tlmm 119 0x00>;
+		microchip,ap-clk = <&tlmm 92 0x00>;
+		microchip,ap-data = <&tlmm 93 0x00>;
+
+		pinctrl-names = "mux_fastchg_active",
+		"mux_fastchg_suspend",
+		"mcu_data_active",
+		"mcu_data_suspend";
+		pinctrl-0 = <&fastchg_active
+		&usb_sw_active
+		&ap_clk_active>;
+		pinctrl-1 = <&usb_sw_suspend
+		&fastchg_suspend
+		&ap_clk_suspend>;
+		pinctrl-2 =<&ap_data_active>;
+		pinctrl-3 =<&ap_data_suspend>;
+		op,fw-erase-count = <384>;
+		op,fw-addr-low = <0x88>;
+		op,fw-addr-high = <0>;
+	};
+};
+
+&pm8150b_gpios {
+	gpio1_adc {
+		gpio1_adc_default: gpio1_adc_default {
+			pins = "gpio1"; /* GPIO 1 */
+			function = "normal"; /* normal */
+			bias-pull-up;
+			bias-high-impedance; /* DISABLE GPIO1 for ADC*/
+		};
+	};
+
+	gpio12_adc {
+		gpio12_adc_default: gpio12_adc_default {
+			pins = "gpio12"; /* GPIO 12 */
+			function = "normal"; /* normal */
+			bias-pull-up;
+			bias-high-impedance; /* DISABLE GPIO12 for ADC*/
+		};
+	};
+    ab_id2 {
+        ab_id2_default: ab_id2_default {
+            pins = "gpio2";
+            function = "normal";
+            input-enable;
+            bias-disable;
+            power-source = <0>;
+        };
+    };
+};
+
+&pm8150b_vadc {
+	gpio12_v {
+		reg = <ADC_GPIO2_PU1>;
+		label = "gpio12_v";
+		qcom,pre-scaling = <1 1>;
+	};
+	gpio1_v {
+		reg = <ADC_AMUX_THM4_PU1>;/* 0x30*/
+		label = "gpio1_v";
+		qcom,ratiometric;
+		qcom,hw-settle-time = <800>;
+		qcom,pre-scaling = <1 1>;
+	};
+};
+
+&pm8150b_charger {
+	qcom,dc-icl-ua = <1200000>;
+	qcom,fcc-max-ua = <500000>;
+	qcom,usb-icl-ua = <1800000>;
+	qcom,fv-max-uv = <4365000>;
+	/* ibatmax setting for different temp regions */
+	ibatmax-little-cold-ma = <350>;
+	ibatmax-cool-ma = <2000>;
+	ibatmax-little-cool-ma = <2100>;
+	ibatmax-pre-normal-ma = <2100>;
+	ibatmax-normal-ma = <3000>;
+	ibatmax-warm-ma = <1100>;
+	ibatmax-little-cool-thr-ma = <1900>;
+	ibatmax-cool-thr-ma = <1100>;
+	/* vbatmax setting for different temp regions */
+	vbatmax-little-cold-mv = <3975>;
+	vbatmax-cool-mv = <4390>;
+	vbatmax-little-cool-mv = <4390>;
+	vbatmax-pre-normal-mv = <4390>;
+	vbatmax-normal-mv = <4390>;
+	vbatmax-warm-mv = <4130>;
+	little-cool-vbat-thr-mv = <4180>;
+	cool-vbat-thr-mv = <4180>;
+	/* vbatdet setting for different temp regions */
+	vbatdet-little-cold-mv = <3700>;
+	vbatdet-cool-mv = <4150>;
+	vbatdet-little-cool-mv = <4270>;
+	vbatdet-pre-normal-mv = <4270>;
+	vbatdet-normal-mv = <4270>;
+	vbatdet-warm-mv = <3980>;
+	/* temp region settings */
+	cold-bat-decidegc = <20>;
+	little-cold-bat-decidegc = <0>;
+	cool-bat-decidegc = <50>;
+	little-cool-bat-decidegc = <120>;
+	pre-normal-bat-decidegc = <160>;
+	warm-bat-decidegc = <450>;
+	hot-bat-decidegc = <500>;
+	qcom,otg-cl-ua = <1500000>;
+	op,sw-iterm-ma = <310>;
+	op,sw-check-full-enable;
+
+	/*otg low battery current limit*/
+	op,otg-icl-ctrl-enable;
+	otg-low-battery-thr = <15>;
+	otg-low-bat-icl-thr = <1000000>;
+	otg-normal-bat-icl-thr = <1500000>;
+	disable-pd;
+	/*usb connector hw auto detection*/
+	op,usb-check = <&tlmm 91 0x00>;
+	/* other settings */
+	qcom,cutoff-voltage-with-charger = <3250>;
+	qcom,msm-bus,name = "dash_clk_vote";
+	qcom,msm-bus,num-cases = <2>;
+	qcom,msm-bus,num-paths = <1>;
+	qcom,msm-bus,vectors-KBps = <1 731 0 300000000>,
+					<1 731 0 0>;
+	/*ffc temp region*/
+	ffc-pre-normal-decidegc = <160>;
+	ffc-normal-decidegc = <350>;
+	ffc-warm-decidegc = <400>;
+	ffc-normal-fcc-ma = <650>;
+	ffc-warm-fcc-ma = <750>;
+	ffc-normal-cutoff-ma = <550>;
+	ffc-warm-cutoff-ma = <650>;
+	ffc-full-vbat-mv = <4430>;
+
+	/* for external ship mode suppot */
+	pinctrl-names = "op_ship_mode_default","op_usb_temp_adc_default";
+	pinctrl-0 = <&ship_mode_default>;
+	pinctrl-1= <&gpio1_adc_default>;
+
+	op,stm-ctrl-gpio = <&tlmm 49 0x00>;
+	/* for usb connector temp protect */
+	op,low-voltage-charger;
+	io-channels = <&pm8150b_vadc ADC_MID_CHG_DIV6>,
+				<&pm8150b_vadc ADC_USB_IN_V_16>,
+				<&pm8150b_vadc ADC_USB_IN_I>,
+				<&pm8150b_vadc ADC_CHG_TEMP>,
+				<&pm8150b_vadc ADC_AMUX_THM4_PU1>,
+				<&pm8150b_vadc ADC_VPH_PWR>,
+				<&pm8150b_vadc ADC_SBUx>;
+	io-channel-names = "mid_voltage",
+				"usb_in_voltage",
+				"usb_in_current",
+				"chg_temp",
+				"gpio1_voltage",
+				"vph_voltage",
+				"sbux_res";
+	op,vbus-ctrl-gpio = <&pm8150l_gpios 8 GPIO_ACTIVE_LOW>;
+};
+
+&pm8150b_fg {
+	qcom,fg-force-load-profile;
+	oem,use_external_fg;
+	qcom,fg-rsense-sel = <0>;
+	qcom,fg-sys-term-current = <180>;
+	qcom,fg-chg-term-current = <165>;
+};
+
+&tlmm {
+	pm8150b_charger {
+		ship_mode_default: ship_mode_default {
+			mux {
+				pins = "gpio49";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio49";
+				drive-strength = <8>;
+				bias-pull-down;
+			};
+		};
+	};
+
+	oneplus_fastchg {
+		usb_sw_active: usb_sw_active {
+			mux {
+				pins = "gpio94", "gpio119";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio94", "gpio119";
+				drive-strength = <16>;
+				bias-pull-down;
+			};
+		};
+
+		usb_sw_suspend: usb_sw_suspend {
+			mux {
+				pins = "gpio94", "gpio119";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio94", "gpio119";
+				drive-strength = <2>;
+				bias-disable;
+			};
+		};
+
+		fastchg_active: fastchg_active {
+			mux {
+				pins = "gpio82";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio82";
+				drive-strength = <16>;
+				bias-pull-up;
+			};
+		};
+
+		fastchg_suspend: fastchg_suspend {
+			mux {
+				pins = "gpio82";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio82";
+				drive-strength = <2>;
+				bias-disable;
+			};
+		};
+
+		ap_clk_active: ap_clk_active {
+			mux {
+				pins = "gpio92";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio92";
+				drive-strength = <16>;
+				bias-pull-up;
+			};
+		};
+
+		ap_clk_suspend: ap_clk_suspend {
+			mux {
+				pins = "gpio92";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio92";
+				drive-strength = <2>;
+				bias-disable;
+			};
+		};
+
+		ap_data_active: ap_data_active {
+			mux {
+				pins = "gpio93";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio93";
+				drive-strength = <16>;
+				bias-pull-up;
+			};
+		};
+
+		ap_data_suspend: ap_data_suspend {
+			mux {
+				pins = "gpio93";
+				function = "gpio";
+			};
+
+			config {
+				pins = "gpio93";
+				drive-strength = <2>;
+				bias-disable;
+			};
+		};
+	};
+	tp_irq_active: tp_irq_active {
+		mux {
+			pins = "gpio122";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio122";
+			drive-strength = <8>;
+			bias-disable;
+			input-enable;
+		};
+	};
+	tp_rst_active: tp_rst_active {
+		mux {
+			pins = "gpio54";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio54";
+			drive-strength = <8>;
+			bias-pull-up;
+		};
+	};
+	tp_1v8_active: tp_1v8_active {
+		mux {
+			pins = "gpio59";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio59";
+			drive-strength = <8>;
+			bias-pull-up;
+		};
+	};
+	tp_rst_suspend: tp_rst_suspend {
+		mux {
+			pins = "gpio54";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio54";
+			drive-strength = <8>;
+			bias-pull-down;
+		};
+	};
+	tp_1v8_suspend: tp_1v8_suspend {
+		mux {
+			pins = "gpio59";
+			function = "gpio";
+		};
+		config {
+			pins = "gpio59";
+			drive-strength = <8>;
+			bias-pull-down;
+		};
+	};
+	fp_irq_init: fp_irq_init {
+		mux {
+			pins = "gpio118";
+			function = "gpio";
+		};
+
+		config {
+			pins = "gpio118";
+			drive-strength = <2>;
+			bias-disable;
+			input-enable;
+		};
+	};
+
+	fp_reset_init: fp_reset_init {
+		mux {
+			pins = "gpio131";
+			function = "gpio";
+		};
+
+		config {
+			pins = "gpio131";
+			drive-strength = <8>;
+			bias-pull-up;
+		};
+	};
+
+	fp_vdd_init: fp_vdd_init {
+		mux {
+			pins = "gpio101";
+			function = "gpio";
+		};
+
+		config {
+			pins = "gpio101";
+			drive-strength = <8>;
+			bias-pull-up;
+			output-high;
+		};
+	};
+
+	fp_vdd_dis_init: fp_vdd_dis_init {
+		mux {
+			pins = "gpio101";
+			function = "gpio";
+		};
+
+		config {
+			pins = "gpio101";
+			drive-strength = <8>;
+			bias-pull-down;
+			output-low;
+		};
+	};
+};
+/* @bsp, 2018/07/20 Battery & Charging porting END */
+
+&spmi_bus {
+    qcom,pm8009@10 {
+        compatible = "qcom,spmi-pmic";
+        reg = <0xa SPMI_USID>;
+        #address-cells = <2>;
+        #size-cells = <0>;
+
+        pm8009_gpios: pinctrl@c000 {
+            compatible = "qcom,spmi-gpio";
+            reg = <0xc000 0x400>;
+            interrupts = <0xa 0xc0 0 IRQ_TYPE_NONE>,
+                         <0xa 0xc1 0 IRQ_TYPE_NONE>,
+                         <0xa 0xc2 0 IRQ_TYPE_NONE>,
+                         <0xa 0xc3 0 IRQ_TYPE_NONE>;
+            interrupt-names = "pm8009_gpio1", "pm8009_gpio2",
+                              "pm8009_gpio3", "pm8009_gpio4";
+            gpio-controller;
+            #gpio-cells = <2>;
+      };
+
+        pm8009_pon: qcom,power-on@800 {
+			compatible = "qcom,qpnp-power-on";
+			reg = <0x800 0x100>;
+		};
+   };
+   qcom,pm8009@b {
+        compatible = "qcom,spmi-pmic";
+        reg = <0xb SPMI_USID>;
+        #address-cells = <2>;
+        #size-cells = <0>;
+
+   };
+   /*power key + vol down long press hard reset*/
+   qcom,pm8150@0 {
+        qcom,power-on@800 {
+            interrupts = <0x0 0x8 0x0 IRQ_TYPE_NONE>,
+                         <0x0 0x8 0x1 IRQ_TYPE_NONE>,
+                         <0x0 0x8 0x5 IRQ_TYPE_NONE>;
+            interrupt-names = "kpdpwr", "resin", "kpdpwr-resin-bark";
+            qcom,s3-src = "kpdpwr-and-resin";
+            qcom,pon_1 {
+                qcom,support-reset = <0>;
+                qcom,s1-timer = <6720>;
+                qcom,s2-timer = <2000>;
+                qcom,s2-type = <PON_POWER_OFF_TYPE_HARD_RESET>;
+                qcom,pull-up;
+            };
+
+            qcom,pon_2 {
+                qcom,support-reset = <0>;
+                qcom,s1-timer = <6720>;
+                qcom,s2-timer = <2000>;
+                qcom,s2-type = <PON_POWER_OFF_TYPE_HARD_RESET>;
+                qcom,pull-up;
+            };
+
+            qcom,pon_3 {
+                qcom,pon-type = <PON_POWER_ON_TYPE_KPDPWR_RESIN>;
+                qcom,support-reset = <0>;
+                qcom,s1-timer = <6720>;
+                qcom,s2-timer = <2000>;
+                qcom,s2-type = <PON_POWER_OFF_TYPE_HARD_RESET>;
+                qcom,pull-up;
+            };
+       };
+   };
+};
+&pm8150_gpios {
+	key_vol_down {
+		key_vol_down_default: key_vol_down_default {
+			pins = "gpio7";
+			function = "normal";
+			input-enable;
+			bias-pull-up;
+			power-source = <1>;
+		};
+	};
+    ab_id1 {
+        ab_id1_default: ab_id1_default {
+            pins = "gpio1";
+            function = "normal";
+            input-enable;
+            bias-disable;
+            power-source = <0>;
+        };
+    };
+};
+
+&soc {
+	gpio_keys {
+		pinctrl-0 = <&key_vol_up_default &key_vol_down_default>;
+		vol_down {
+			label = "volume_down";
+			gpios = <&pm8150_gpios 7 GPIO_ACTIVE_LOW>;
+			linux,input-type = <1>;
+			linux,code = <KEY_VOLUMEDOWN>;
+			gpio-key,wakeup;
+			debounce-interval = <15>;
+			linux,can-disable;
+		};
+	};
+
+	bootloader_log {
+		compatible = "bootloader_log";
+		linux,contiguous-region = <&bootloader_log_mem>;
+	};
+};
+
+&reserved_memory {
+
+	bootloader_log_mem: bootloader_log_mem@0x9FFF7000 {
+		reg = <0 0x9FFF7000 0 0x00009000>;
+		label = "bootloader_log_mem";
+	};
+
+	param_mem: param_mem@ac200000 {
+		reg = <0 0xAC200000 0 0x00100000>;
+		label = "param_mem";
+	};
+
+	//after cdsp_sec_mem
+	ramoops: ramoops@0xA9800000 {
+		compatible = "ramoops";
+		reg = <0 0xA9800000 0 0x00400000>;
+		record-size =  <0x40000>; //256x1024
+		console-size = <0x40000>;
+		ftrace-size =  <0x40000>;
+		pmsg-size=	   <0x200000>;
+		devinfo-size=  <0x01000>;
+		ecc-size=	   <0x0>;
+	};
+
+	mtp_mem: mtp_mem@ac300000 {
+		reg = <0 0xAC300000 0 0x00B00000>;
+		label = "mtp_mem";
+	};
+};
+&pm8009_gpios {
+    pm8009_gpios_pinctl: pm8009_gpios_pinctl {
+
+        rf_cable_ant1: rf_cable_ant1{
+            pins = "gpio3";
+            function = "normal";
+            power-source = <1>;
+            bias-pull-up;
+            qcom,pull-up-strength = <0>; /* 30uA pull up */
+            input-enable;  /* digital input */ 
+        };
+        rf_cable_ant3: rf_cable_ant3 {
+            pins = "gpio4";
+            function = "normal";
+            power-source = <1>;
+            bias-pull-up;
+            qcom,pull-up-strength = <0>; /* 30uA pull up */
+            input-enable;  /* digital input */ 
+        };
+    };
+};
+
+&soc {
+	oem_aboard_check:oem_aboard_check {
+		compatible = "oem,aboard";
+		interrupt-parent = <&tlmm>;
+		oem,aboard-gpio-0 = <&pm8150_gpios 1 0>;
+		oem,aboard-gpio-1 = <&pm8150b_gpios 2 0>;
+		pinctrl-names = "oem_aboard_active";
+		pinctrl-0 = <&ab_id1_default &ab_id2_default>;
+	};
+
+     oem_serial_pinctrl {
+        compatible = "oem,oem_serial_pinctrl";
+        pinctrl-names = "uart_pinctrl_active","uart_pinctrl_deactive";
+        pinctrl-0 = <&qupv3_se12_2uart_active>;
+        pinctrl-1 = <&qupv3_se12_2uart_oem_sleep>;
+    };
+
+	oem_rf_cable:oem_rf_cable {
+		compatible = "oem,rf_cable";
+		interrupt-parent = <&tlmm>;
+		rf,cable-gpio-0 = <&tlmm 36 0>;
+		rf,cable-gpio-1 = <&pm8009_gpios 4 0>;
+		rf,cable-support-timer = <0>;
+		pinctrl-names = "oem_rf_cable_active";
+		pinctrl-0 = <&rf_cable_ant0_active &rf_cable_ant1 &rf_cable_ant3 >;
+	};
+};
+&tlmm {
+    rf_cable_ant0_active: rf_cable_ant0_active {
+        mux {
+            pins = "36";
+            function = "gpio";
+        };
+        config {
+            pins = "36";
+            drive-strength = <2>;
+            bias-pull-up;
+        };
+    };
+
+    qupv3_se12_2uart_oem_sleep: qupv3_se12_2uart_oem_sleep {
+        mux {
+            pins = "gpio85", "gpio86";
+            function = "gpio";
+        };
+        config {
+            pins = "gpio85", "gpio86";
+            drive-strength = <2>;
+            bias-pull-down;
+        };
+    };
+};
+
+&qupv3_se12_2uart {
+    compatible = "qcom,msm-geni-console-oem";
+};
+
+/* Add for NXP NFCC */
+&qupv3_se9_i2c {
+    nq@28 {
+        status = "disabled";
+    };
+
+    pn5xx@28 {
+        compatible = "nxp,pn544";
+        reg = <0x28>;
+        nxp,pn544-irq = <&tlmm 47 0x00>;
+        nxp,pn544-ven = <&tlmm 41 0x00>;
+        nxp,pn544-fw-dwnld = <&tlmm 48 0x00>;
+        nxp,pn544-clk-gpio = <&tlmm 113 0x00>;
+        nxp,pn544-ese-pwr = <&tlmm 49 0x00>;
+        nfc_voltage_s4-supply = <&pm8150_s4>;
+        interrupt-parent = <&tlmm>;
+        qcom,clk-src = "BBCLK3";
+        interrupts = <47 0>;
+        interrupt-names = "nfc_irq";
+        pinctrl-names = "nfc_active", "nfc_suspend";
+        pinctrl-0 = <&nfc_int_active &nfc_enable_active>;
+        pinctrl-1 = <&nfc_int_suspend &nfc_enable_suspend>;
+    };
+};
+
+/* Add for NXP eSE */
+&qupv3_se0_spi {
+    status = "ok";
+
+    ese@0 {
+        compatible = "nxp,p61";
+        reg = <0>;
+        spi-max-frequency = <8000000>;
+    };
+};
+
+/* add for disabling wil6210 config */
+&wil6210 {
+    status = "disabled";
+};
+
+/*disable smb3190 config */
+&smb1390 {
+	status = "disabled";
+};
+&smb1390_charger {
+	status = "disabled";
+};
+&smb1355 {
+	status = "disabled";
+};
+&smb1355_charger {
+	status = "disabled";
+};
+
+&ipa_smmu_wlan {
+	qcom,smmu-s1-bypass;
+};
+
+&icnss {
+	qcom,smmu-s1-bypass;
+};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-pinctrl.dtsi b/arch/arm64/boot/dts/qcom/sm8150-pinctrl.dtsi
index 6af0687eed0cfa3b49655296a79f5d7f7878bee0..7f17daf5375a3f27698b5f76bff7d8b6f5f81718 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-pinctrl.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-pinctrl.dtsi
@@ -69,14 +69,14 @@
 
 		storage_cd: storage_cd {
 			mux {
-				pins = "gpio96";
-				function = "gpio";
+				/*pins = "gpio96";
+				function = "gpio";*/
 			};
 
 			config {
-				pins = "gpio96";
-				bias-pull-up;           /* pull up */
-				drive-strength = <2>;   /* 2 MA */
+				/*pins = "gpio96";*/
+				/*bias-pull-up;*/           /* pull up */
+				/*drive-strength = <2>;*/   /* 2 MA */
 			};
 		};
 
@@ -448,14 +448,14 @@
 
 		wil6210_refclk3_en_pin: wil6210_refclk3_en_pin {
 			mux {
-				pins = "gpio87";
-				function = "gpio";
+				/*pins = "gpio87";
+				function = "gpio";*/
 			};
 
 			config {
-				pins = "gpio87";
-				bias-pull-down;		/* PULL DOWN */
-				drive-strength = <2>;	/* 2 MA */
+				/*pins = "gpio87";*/
+				/*bias-pull-down;*/		/* PULL DOWN */
+				/*drive-strength = <2>;*/	/* 2 MA */
 			};
 		};
 
@@ -985,6 +985,18 @@
 					bias-pull-up;
 				};
 			};
+			qupv3_se8_i2c_reset: qupv3_se8_i2c_reset {
+				mux {
+					pins = "gpio88", "gpio89";
+					function = "gpio";
+				};
+
+				config {
+					pins = "gpio88", "gpio89";
+					drive-strength = <2>;
+					bias-pull-down;
+				};
+			};
 		};
 
 		qupv3_se8_spi_pins: qupv3_se8_spi_pins {
@@ -1624,7 +1636,8 @@
 				config {
 					pins = "gpio55", "gpio56";
 					drive-strength = <2>;
-					bias-pull-up;
+					bias-disable;
+					input-enable;
 				};
 			};
 		};
@@ -4211,14 +4224,14 @@
 			};
 		};
 
-		usb2_id_det_default: usb2_id_det_default {
+		/*usb2_id_det_default: usb2_id_det_default {
 			config {
 				pins = "gpio101";
 				function = "gpio";
 				input-enable;
 				bias-pull-up;
 			};
-		};
+		 };GPIO 101 for fingerprint VDD enable */
 
 		emac {
 			emac_mdc: emac_mdc {
diff --git a/arch/arm64/boot/dts/qcom/sm8150-pmic-overlay.dtsi b/arch/arm64/boot/dts/qcom/sm8150-pmic-overlay.dtsi
index 43cebaaba21952cb42591c5f6326cb700b2058e3..db5573be3eb0b5e605153270013132a24ca1f851 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-pmic-overlay.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-pmic-overlay.dtsi
@@ -99,12 +99,37 @@
 			power-source = <0>;
 		};
 	};
+
+		haptics_boost {
+			haptics_boost_default: haptics_boost_default {
+				pins = "gpio5";
+				function = "normal";
+				output-enable;
+				input-disable;
+				bias-disable;
+				qcom,drive-strength = <3>; /* high */
+				power-source = <0>; /* VPH_PWR */
+			};
+		};
 };
 
 &usb0 {
 	extcon = <&pm8150b_pdphy>, <&eud>;
 };
 
+&vendor {
+	haptics_boost_vreg: haptics_boost_vreg {
+		compatible = "regulator-fixed";
+		regulator-name = "haptics_boost";
+		gpio = <&pm8150b_gpios 5 GPIO_ACTIVE_HIGH>;
+		enable-active-high;
+		regulator-enable-ramp-delay = <300>;
+		pinctrl-names = "default";
+		pinctrl-0 = <&haptics_boost_default>;
+		status = "disabled";
+	};
+};
+
 &usb_qmp_dp_phy {
 	extcon = <&pm8150b_pdphy>;
 };
diff --git a/arch/arm64/boot/dts/qcom/sm8150-qrd.dtsi b/arch/arm64/boot/dts/qcom/sm8150-qrd.dtsi
index 31900f80fd19509812b4632616d377c414576ff3..927dd6863154598d159c9053f91b2b975f6b4786 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-qrd.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-qrd.dtsi
@@ -225,6 +225,7 @@
 	compatible = "qcom,ufs-phy-qmp-v4";
 
 	vdda-phy-supply = <&pm8150_l5>;
+	vdda-phy-always-on;
 	vdda-pll-supply = <&pm8150l_l3>;
 	vdda-phy-max-microamp = <90200>;
 	vdda-pll-max-microamp = <19000>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-qupv3.dtsi b/arch/arm64/boot/dts/qcom/sm8150-qupv3.dtsi
index 4ef1873e2aefc7c34c1858ede4f863241eebff97..245be7cd541b43094faab7766e8570894a8eb499 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-qupv3.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-qupv3.dtsi
@@ -446,9 +446,10 @@
 		dmas = <&gpi_dma1 0 0 3 64 0>,
 			<&gpi_dma1 1 0 3 64 0>;
 		dma-names = "tx", "rx";
-		pinctrl-names = "default", "sleep";
+		pinctrl-names = "default", "sleep","reset";
 		pinctrl-0 = <&qupv3_se8_i2c_active>;
 		pinctrl-1 = <&qupv3_se8_i2c_sleep>;
+		pinctrl-2 = <&qupv3_se8_i2c_reset>;
 		qcom,wrapper-core = <&qupv3_1>;
 		status = "disabled";
 	};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-regulator.dtsi b/arch/arm64/boot/dts/qcom/sm8150-regulator.dtsi
index 40a4ab37f02a850e4d4fb08cf1d7d1eff3147da5..e12333e4bc0979d1f71336fbf000f3eaea19cf17 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-regulator.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-regulator.dtsi
@@ -909,13 +909,13 @@
 	};
 
 	rpmh-regulator-ldof2 {
-		compatible = "qcom,rpmh-xob-regulator";
+		compatible = "qcom,rpmh-vrm-regulator";
 		mboxes = <&apps_rsc 0>;
 		qcom,resource-name = "ldof2";
 		L2F: pm8009_l2: regulator-pm8009-l2 {
 			regulator-name = "pm8009_l2";
 			qcom,set = <RPMH_REGULATOR_SET_ALL>;
-			regulator-min-microvolt = <1200000>;
+			regulator-min-microvolt = <1000000>;
 			regulator-max-microvolt = <1200000>;
 		};
 	};
@@ -944,6 +944,54 @@
 		};
 	};
 
+	rpmh-regulator-ldof1 {
+		compatible = "qcom,rpmh-vrm-regulator";
+		mboxes = <&apps_rsc 0>;
+		qcom,resource-name = "ldof1";
+		L1F: pm8009_l1: regulator-pm8009-l1 {
+			regulator-name = "pm8009_l1";
+			qcom,set = <RPMH_REGULATOR_SET_ALL>;
+			regulator-min-microvolt = <1000000>;
+			regulator-max-microvolt = <1200000>;
+		};
+	};
+
+	rpmh-regulator-ldof3 {
+		compatible = "qcom,rpmh-vrm-regulator";
+		mboxes = <&apps_rsc 0>;
+		qcom,resource-name = "ldof3";
+		L3F: pm8009_l3: regulator-pm8009-l3 {
+			regulator-name = "pm8009_l3";
+			qcom,set = <RPMH_REGULATOR_SET_ALL>;
+			regulator-min-microvolt = <1000000>;
+			regulator-max-microvolt = <1200000>;
+		};
+	};
+
+	rpmh-regulator-ldof4 {
+		compatible = "qcom,rpmh-vrm-regulator";
+		mboxes = <&apps_rsc 0>;
+		qcom,resource-name = "ldof4";
+		L4F: pm8009_l4: regulator-pm8009-l4 {
+			regulator-name = "pm8009_l4";
+			qcom,set = <RPMH_REGULATOR_SET_ALL>;
+			regulator-min-microvolt = <1000000>;
+			regulator-max-microvolt = <1200000>;
+		};
+	};
+
+	rpmh-regulator-ldof7 {
+		compatible = "qcom,rpmh-xob-regulator";
+		mboxes = <&apps_rsc 0>;
+		qcom,resource-name = "ldof7";
+		L7F: pm8009_l7: regulator-pm8009-l7 {
+			regulator-name = "pm8009_l7";
+			qcom,set = <RPMH_REGULATOR_SET_ALL>;
+			regulator-min-microvolt = <1800000>;
+			regulator-max-microvolt = <1800000>;
+		};
+	};
+
 	refgen: refgen-regulator@88e7000 {
 		compatible = "qcom,refgen-regulator";
 		reg = <0x88e7000 0x60>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-sde-display.dtsi b/arch/arm64/boot/dts/qcom/sm8150-sde-display.dtsi
old mode 100644
new mode 100755
index fb477aa76987436e68a4556e212ebcb6970283ec..df86e39498e6cfaa06720ce068f480cae475419d
--- a/arch/arm64/boot/dts/qcom/sm8150-sde-display.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-sde-display.dtsi
@@ -1,4 +1,4 @@
-/* Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -33,7 +33,12 @@
 #include "dsi-panel-sw43404-amoled-dsc-fhd-plus-cmd.dtsi"
 #include "dsi-panel-nt36850-truly-dualmipi-wqhd-cmd.dtsi"
 #include <dt-bindings/clock/mdss-10nm-pll-clk.h>
-
+#include "dsi-panel-samsung_sofef00_m_cmd.dtsi"
+#include "dsi-panel-samsung_s6e3fc2x01.dtsi"
+#include "dsi-panel-samsung-sofef00_m-fhd-video.dtsi"
+#include "dsi-panel-samsung_oneplus_dsc.dtsi"
+#include "dsi-panel-samsung_s6e3fc2x01_ed173.dtsi"
+#include "dsi_samsung_oneplus_fhd_dsc.dtsi"
 &tlmm {
 	display_panel_avdd_eldo_default: display_panel_avdd_eldo_default {
 		mux {
@@ -57,13 +62,13 @@
 		qcom,panel-supply-entry@0 {
 			reg = <0>;
 			qcom,supply-name = "vddio";
-			qcom,supply-min-voltage = <1800000>;
-			qcom,supply-max-voltage = <1800000>;
+			qcom,supply-min-voltage = <1850000>;
+			qcom,supply-max-voltage = <1850000>;
 			qcom,supply-enable-load = <62000>;
 			qcom,supply-disable-load = <80>;
-			qcom,supply-post-on-sleep = <20>;
+			qcom,supply-post-on-sleep = <6>;
 		};
-
+      /*
 		qcom,panel-supply-entry@1 {
 			reg = <1>;
 			qcom,supply-name = "lab";
@@ -82,6 +87,7 @@
 			qcom,supply-disable-load = <100>;
 			qcom,supply-post-on-sleep = <20>;
 		};
+		*/
 	};
 
 	dsi_panel_pwr_supply_no_labibb: dsi_panel_pwr_supply_no_labibb {
@@ -143,7 +149,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_4k_dsc_video>;
 	};
@@ -154,7 +160,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_4k_dsc_cmd>;
 	};
@@ -165,7 +171,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sharp_1080_cmd>;
 	};
@@ -176,7 +182,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sharp_1080_120hz_cmd>;
 	};
@@ -187,7 +193,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_nt35597_truly_video>;
 	};
@@ -198,7 +204,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_nt35597_truly_cmd>;
 	};
@@ -209,7 +215,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35597_truly_dsc_cmd>;
 	};
@@ -220,7 +226,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35597_truly_dsc_video>;
 	};
@@ -231,7 +237,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_vid>;
 	};
@@ -242,7 +248,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_vid>;
 	};
@@ -253,7 +259,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_cmd>;
 	};
@@ -264,7 +270,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_cmd>;
 	};
@@ -275,7 +281,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sim_dsc_375_cmd>;
 	};
@@ -286,7 +292,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_sim_dsc_375_cmd>;
 	};
@@ -297,7 +303,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_cmd>;
 	};
@@ -308,7 +314,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_cmd>;
 
@@ -320,7 +326,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_video>;
 	};
@@ -331,7 +337,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_video>;
 	};
@@ -342,7 +348,7 @@
 
 		qcom,dsi-ctrl-num = <0>;
 		qcom,dsi-phy-num = <0>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_sw43404_amoled_fhd_plus_cmd>;
 	};
@@ -353,7 +359,7 @@
 
 		qcom,dsi-ctrl-num = <0 1>;
 		qcom,dsi-phy-num = <0 1>;
-		qcom,dsi-select-clocks = "src_byte_clk0", "src_pixel_clk0";
+		qcom,dsi-select-clocks = "mux_byte_clk0", "mux_pixel_clk0";
 
 		qcom,dsi-panel = <&dsi_dual_nt36850_truly_cmd>;
 	};
@@ -364,7 +370,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_cmd>;
 
@@ -376,7 +382,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_nt35695b_truly_fhd_video>;
 	};
@@ -388,7 +394,7 @@
 
 		qcom,dsi-ctrl-num = <1>;
 		qcom,dsi-phy-num = <1>;
-		qcom,dsi-select-clocks = "src_byte_clk1", "src_pixel_clk1";
+		qcom,dsi-select-clocks = "mux_byte_clk1", "mux_pixel_clk1";
 
 		qcom,dsi-panel = <&dsi_sim_sec_hd_cmd>;
 	};
@@ -404,8 +410,8 @@
 			 <&mdss_dsi0_pll PCLK_MUX_0_CLK>,
 			 <&mdss_dsi1_pll BYTECLK_MUX_1_CLK>,
 			 <&mdss_dsi1_pll PCLK_MUX_1_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0",
-			      "src_byte_clk1", "src_pixel_clk1";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0",
+			      "mux_byte_clk1", "mux_pixel_clk1";
 
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_dsi_active &sde_te_active>;
@@ -413,6 +419,7 @@
 
 		qcom,platform-te-gpio = <&tlmm 8 0>;
 		qcom,panel-te-source = <0>;
+		enable1v8_gpio = <&tlmm 119 0x00>;
 
 		vddio-supply = <&pm8150_l14>;
 		lab-supply = <&lcdb_ldo_vreg>;
@@ -453,8 +460,8 @@
 			 <&mdss_dsi0_pll PCLK_MUX_0_CLK>,
 			 <&mdss_dsi1_pll BYTECLK_MUX_1_CLK>,
 			 <&mdss_dsi1_pll PCLK_MUX_1_CLK>;
-		clock-names = "src_byte_clk0", "src_pixel_clk0",
-			      "src_byte_clk1", "src_pixel_clk1";
+		clock-names = "mux_byte_clk0", "mux_pixel_clk0",
+			      "mux_byte_clk1", "mux_pixel_clk1";
 
 		pinctrl-names = "panel_active", "panel_suspend";
 		pinctrl-0 = <&sde_dsi1_active &sde_te1_active>;
@@ -507,8 +514,7 @@
 
 /* PHY TIMINGS REVISION T */
 &dsi_dual_nt35597_truly_video {
-	qcom,mdss-dsi-min-refresh-rate = <53>;
-	qcom,mdss-dsi-max-refresh-rate = <60>;
+	qcom,dsi-supported-dfps-list = <60 55 53>;
 	qcom,mdss-dsi-pan-enable-dynamic-fps;
 	qcom,mdss-dsi-pan-fps-update = "dfps_immediate_porch_mode_vfp";
 	qcom,esd-check-enabled;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-sde.dtsi b/arch/arm64/boot/dts/qcom/sm8150-sde.dtsi
index eff9ec22d83bc3d0068313addf89564c4d276c05..5d9633b3a66a1653d92667303e48ac49e826d065 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-sde.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-sde.dtsi
@@ -641,7 +641,7 @@
 
 		qcom,max-pclk-frequency-khz = <675000>;
 
-		qcom,mst-enable;
+		//qcom,mst-enable;
 		qcom,dsc-feature-enable;
 		qcom,fec-feature-enable;
 		qcom,max-dp-dsc-blks = <2>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-sdx50m-mtp-overlay.dts b/arch/arm64/boot/dts/qcom/sm8150-sdx50m-mtp-overlay.dts
index fb74f162754f93c1e76e1f3e6e4a7e28932f2b07..b2f06e81cdd192e1f76541e806285247673d920d 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-sdx50m-mtp-overlay.dts
+++ b/arch/arm64/boot/dts/qcom/sm8150-sdx50m-mtp-overlay.dts
@@ -24,8 +24,15 @@
 #include "sm8150-sdx50m.dtsi"
 #include "sm8150-mtp-audio-overlay.dtsi"
 
+#include "sm8150-oem.dtsi"
+#include "sm8150-oem-camera-v2.dtsi"
+#include "guacamole.dtsi"
+#include "guacamole_t0.dtsi"
+
+
 / {
-	model = "SDX50M MTP";
+	model = "SDX50M MTP ref";
 	compatible = "qcom,sm8150-mtp", "qcom,sm8150", "qcom,mtp";
 	qcom,board-id = <0x01010008 0x1>;
+
 };
diff --git a/arch/arm64/boot/dts/qcom/sm8150-sdx50m.dtsi b/arch/arm64/boot/dts/qcom/sm8150-sdx50m.dtsi
index 86fcb7b67c6782c935f76928b960938d6c7097c8..a6621fb8b8e754e5e7c4d8e6918d40fd26959862 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-sdx50m.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-sdx50m.dtsi
@@ -254,6 +254,7 @@
 			qcom,instance-id = <100>;
 			qcom,qmi-sensor-names = "pa",
 						"pa_1",
+						"pa_2",
 						"qfe_pa0",
 						"qfe_wtr0",
 						"modem_tsens",
@@ -325,7 +326,7 @@
 		};
 	};
 
-	modem1-qfe-pa-usr {
+	modem1-pa2-usr {
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
@@ -343,7 +344,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 103>;
+		thermal-sensors = <&qmi_sensor 104>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -357,7 +358,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 104>;
+		thermal-sensors = <&qmi_sensor 105>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -371,7 +372,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 105>;
+		thermal-sensors = <&qmi_sensor 106>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -385,7 +386,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 106>;
+		thermal-sensors = <&qmi_sensor 107>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -399,7 +400,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 107>;
+		thermal-sensors = <&qmi_sensor 108>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -413,7 +414,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 108>;
+		thermal-sensors = <&qmi_sensor 109>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -427,7 +428,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 109>;
+		thermal-sensors = <&qmi_sensor 110>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -441,7 +442,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 110>;
+		thermal-sensors = <&qmi_sensor 111>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
@@ -455,7 +456,7 @@
 		polling-delay-passive = <0>;
 		polling-delay = <0>;
 		thermal-governor = "user_space";
-		thermal-sensors = <&qmi_sensor 111>;
+		thermal-sensors = <&qmi_sensor 112>;
 		trips {
 			active-config0 {
 				temperature = <125000>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-thermal-overlay.dtsi b/arch/arm64/boot/dts/qcom/sm8150-thermal-overlay.dtsi
index 9c8b8ea200f73f3311674729b77dbee6b244012c..87e75cf559e7e8a66071513f59a39210e615d65e 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-thermal-overlay.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-thermal-overlay.dtsi
@@ -127,29 +127,22 @@
 
 	soc {
 		cooling-maps {
-			soc_cpu4 {
-				trip = <&soc_trip>;
+			soctrip_cpu4 {
+				trip = <&soc_trip2>;
 				cooling-device =
-					<&CPU4 THERMAL_MAX_LIMIT
-						THERMAL_MAX_LIMIT>;
+					<&CPU4 6 6>;
 			};
-			soc_cpu5 {
-				trip = <&soc_trip>;
+			soctrip_cpu7 {
+				trip = <&soc_trip2>;
 				cooling-device =
-					<&CPU5 THERMAL_MAX_LIMIT
-						THERMAL_MAX_LIMIT>;
+					<&CPU7 THERMAL_MAX_LIMIT
+					THERMAL_MAX_LIMIT>;
 			};
-			soc_cpu6 {
+			soctrip_cpu6 {
 				trip = <&soc_trip>;
 				cooling-device =
 					<&CPU6 THERMAL_MAX_LIMIT
-						THERMAL_MAX_LIMIT>;
-			};
-			soc_cpu7 {
-				trip = <&soc_trip>;
-				cooling-device =
-					<&CPU7 THERMAL_MAX_LIMIT
-						THERMAL_MAX_LIMIT>;
+					THERMAL_MAX_LIMIT>;
 			};
 		};
 	};
diff --git a/arch/arm64/boot/dts/qcom/sm8150-thermal.dtsi b/arch/arm64/boot/dts/qcom/sm8150-thermal.dtsi
index 99a9d461a02f3a9058d0c393ac0f07b137f16a4a..3f40e46a188f8eaaf968b09bba5c54c94eb910af 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-thermal.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-thermal.dtsi
@@ -742,8 +742,8 @@
 	};
 
 	gpuss-max-step {
-		polling-delay-passive = <10>;
-		polling-delay = <100>;
+		polling-delay-passive = <0>;
+		polling-delay = <0>;
 		thermal-governor = "step_wise";
 		trips {
 			gpu_trip0: gpu-trip0 {
diff --git a/arch/arm64/boot/dts/qcom/sm8150-usb.dtsi b/arch/arm64/boot/dts/qcom/sm8150-usb.dtsi
index ec42091e8d01f7d2e41f86c4bc0a1c49229161e6..38fba614ff22cc97c144715e6b541c0b8583ade3 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-usb.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-usb.dtsi
@@ -61,6 +61,7 @@
 			 0x144 /* GSI_RING_BASE_ADDR_H */
 			 0x1a4>; /* GSI_IF_STS */
 		qcom,dwc-usb3-msm-tx-fifo-size = <27696>;
+		qcom,pm-qos-latency = <44>;
 
 		qcom,msm-bus,name = "usb0";
 		qcom,msm-bus,num-cases = <4>;
@@ -98,10 +99,11 @@
 			snps,has-lpm-erratum;
 			snps,hird-threshold = /bits/ 8 <0x10>;
 			snps,ssp-u3-u0-quirk;
-			snps,usb3-u1u2-disable;
+			//snps,usb3-u1u2-disable;
 			usb-core-id = <0>;
 			tx-fifo-resize;
-			maximum-speed = "super-speed-plus";
+			maximum-speed = "super-speed";
+			//maximum-speed = "super-speed-plus";
 			dr_mode = "otg";
 		};
 
@@ -386,6 +388,7 @@
 			 0x1a4>; /* GSI_IF_STS */
 		qcom,dwc-usb3-msm-tx-fifo-size = <27696>;
 		qcom,charging-disabled;
+		qcom,pm-qos-latency = <44>;
 
 		qcom,msm-bus,name = "usb1";
 		qcom,msm-bus,num-cases = <3>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-v2-camera.dtsi b/arch/arm64/boot/dts/qcom/sm8150-v2-camera.dtsi
index e92fd1b7c180e826a9c75c491f98e4599d962c45..6cdfb798bbfcc13a7db94a87a7eb4d72fc6567c7 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-v2-camera.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-v2-camera.dtsi
@@ -235,10 +235,10 @@
 				};
 
 				iova-mem-region-shared {
-					/* Shared region is 100MB long */
+					/* Shared region is 150MB long */
 					iova-region-name = "shared";
 					iova-region-start = <0x7400000>;
-					iova-region-len = <0x6400000>;
+					iova-region-len = <0x9600000>;
 					iova-region-id = <0x1>;
 					status = "ok";
 				};
@@ -246,7 +246,7 @@
 				iova-mem-region-secondary-heap {
 					/* Secondary heap region is 1MB long */
 					iova-region-name = "secheap";
-					iova-region-start = <0xd800000>;
+					iova-region-start = <0x10A00000>;
 					iova-region-len = <0x100000>;
 					iova-region-id = <0x4>;
 					status = "ok";
@@ -255,8 +255,8 @@
 				iova-mem-region-io {
 					/* IO region is approximately 3.3 GB */
 					iova-region-name = "io";
-					iova-region-start = <0xda00000>;
-					iova-region-len = <0xd2500000>;
+					iova-region-start = <0x10C00000>;
+					iova-region-len = <0xCF300000>;
 					iova-region-id = <0x3>;
 					status = "ok";
 				};
@@ -264,7 +264,7 @@
 				iova-mem-qdss-region {
 					/* QDSS region is appropriate 1MB */
 					iova-region-name = "qdss";
-					iova-region-start = <0xd900000>;
+					iova-region-start = <0x10B00000>;
 					iova-region-len = <0x100000>;
 					iova-region-id = <0x5>;
 					qdss-phy-addr = <0x16790000>;
diff --git a/arch/arm64/boot/dts/qcom/sm8150-v2.dtsi b/arch/arm64/boot/dts/qcom/sm8150-v2.dtsi
index 5a779486d300f9f226487f54b19f3bc012e35752..c4e65ca39f1e80ef89b76ec3475524c94a358035 100644
--- a/arch/arm64/boot/dts/qcom/sm8150-v2.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150-v2.dtsi
@@ -1040,6 +1040,12 @@
 	     USB3_DP_QSERDES_TXA_RCV_DETECT_LVL_2 0x12 0
 	     USB3_DP_QSERDES_TXA_RES_CODE_LANE_TX 0x00 0
 	     USB3_DP_QSERDES_TXA_RES_CODE_LANE_RX 0x00 0
+	     /*op do optimize A/B side 0x1214/0x1614:0x06 0x1308/0x1708:0x0c
+	      *0x120C/0x160C:0x06
+	      */
+	     USB3_DP_QSERDES_TXA_TX_DRV_LVL 0x06 0
+	     USB3_DP_QSERDES_TXA_PRE_EMPH 0x0c 0
+	     USB3_DP_QSERDES_TXA_TX_EMP_POST1_LVL 0x06 0
 	     USB3_DP_QSERDES_TXA_RES_CODE_LANE_OFFSET_TX 0x16 0
 	     USB3_DP_QSERDES_TXA_RES_CODE_LANE_OFFSET_RX 0x05 0
 	     USB3_DP_QSERDES_TXA_PI_QEC_CTRL 0x20 0
@@ -1083,6 +1089,12 @@
 	     USB3_DP_QSERDES_TXB_RCV_DETECT_LVL_2 0x12 0
 	     USB3_DP_QSERDES_TXB_RES_CODE_LANE_TX 0x00 0
 	     USB3_DP_QSERDES_TXB_RES_CODE_LANE_RX 0x00 0
+	     /*op do optimize A/B side 0x1214/0x1614:0x06 0x1308/0x1708:0x0c
+	      *0x120C/0x160C:0x06
+	      */
+	     USB3_DP_QSERDES_TXB_TX_DRV_LVL 0x06 0
+	     USB3_DP_QSERDES_TXB_PRE_EMPH 0x0c 0
+	     USB3_DP_QSERDES_TXB_TX_EMP_POST1_LVL 0x06 0
 	     USB3_DP_QSERDES_TXB_RES_CODE_LANE_OFFSET_TX 0x16 0
 	     USB3_DP_QSERDES_TXB_RES_CODE_LANE_OFFSET_RX 0x05 0
 	     USB3_DP_QSERDES_TXB_PI_QEC_CTRL 0x01 0
diff --git a/arch/arm64/boot/dts/qcom/sm8150.dtsi b/arch/arm64/boot/dts/qcom/sm8150.dtsi
index 742c82c483d80e77a936def74cce734455b5d5f1..8c087a766bb4e4b248abbf0b068fdaf6a72e6356 100644
--- a/arch/arm64/boot/dts/qcom/sm8150.dtsi
+++ b/arch/arm64/boot/dts/qcom/sm8150.dtsi
@@ -576,25 +576,25 @@
 			compatible = "android,firmware";
 			vbmeta {
 				compatible = "android,vbmeta";
-				parts = "vbmeta,boot,system,vendor,dtbo,vm-linux";
+				parts = "vbmeta,boot,system,vendor,dtbo";
 			};
 			fstab {
 				compatible = "android,fstab";
 				vendor {
 					compatible = "android,vendor";
-					dev = "/dev/block/platform/soc/8804000.sdhci/by-name/vendor";
+					dev = "/dev/block/platform/soc/1d84000.sdhci/by-name/vendor";
 					type = "ext4";
 					mnt_flags = "ro,barrier=1,discard";
 					fsmgr_flags = "wait,slotselect,avb";
 					status = "ok";
 				};
-				vm-linux {
-					compatible = "android,vm-linux";
-					dev = "/dev/block/platform/soc/8804000.sdhci/by-name/vm-linux";
-					type = "emmc";
+				odm {
+					compatible = "android,odm";
+					dev = "/dev/block/platform/soc/1d84000.ufshc/by-name/odm";
+					type = "ext4";
 					mnt_flags = "ro";
 					fsmgr_flags = "wait,slotselect";
-					status = "";
+					status = "ok";
 				};
 			};
 		};
@@ -2990,7 +2990,7 @@
 
 	qcom_seecom: qseecom@87900000 {
 		compatible = "qcom,qseecom";
-		reg = <0x87900000 0x2200000>;
+		reg = <0x87900000 0x3E00000>; /* enlarge TA memory size from 34M to 62M on 2018/11/22 */
 		reg-names = "secapp-region";
 		memory-region = <&qseecom_mem>;
 		qcom,hlos-num-ce-hw-instances = <1>;
@@ -3007,7 +3007,7 @@
 
 	qcom_smcinvoke: smcinvoke@87900000 {
 		compatible = "qcom,smcinvoke";
-		reg = <0x87900000 0x2200000>;
+		reg = <0x87900000 0x3E00000>; /* enlarge TA memory size from 34M to 62M on 2018/11/22 */
 		reg-names = "secapp-region";
 	};
 
diff --git a/arch/arm64/configs/vendor/sm8150-perf_defconfig b/arch/arm64/configs/vendor/sm8150-perf_defconfig
index 485894d2cafb744c7e88cfa86fde8b01e27fd28a..0922e4bf461d000a2640ab71839f6497ab9754ce 100644
--- a/arch/arm64/configs/vendor/sm8150-perf_defconfig
+++ b/arch/arm64/configs/vendor/sm8150-perf_defconfig
@@ -1,4 +1,4 @@
-CONFIG_HOTPLUG_SIZE_BITS=29
+# CONFIG_HOTPLUG_SIZE_BITS is not set
 CONFIG_LOCALVERSION="-perf"
 # CONFIG_LOCALVERSION_AUTO is not set
 # CONFIG_FHANDLE is not set
@@ -65,10 +65,10 @@ CONFIG_SCHED_MC=y
 CONFIG_NR_CPUS=8
 CONFIG_PREEMPT=y
 CONFIG_HZ_100=y
-CONFIG_MEMORY_HOTPLUG=y
-CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE=y
-CONFIG_MEMORY_HOTPLUG_MOVABLE_NODE=y
-CONFIG_MEMORY_HOTREMOVE=y
+# CONFIG_MEMORY_HOTPLUG is not set
+# CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE is not set
+# CONFIG_MEMORY_HOTPLUG_MOVABLE_NODE is not set
+# CONFIG_MEMORY_HOTREMOVE is not set
 CONFIG_CMA=y
 CONFIG_ZSMALLOC=y
 CONFIG_BALANCE_ANON_FILE_RECLAIM=y
@@ -94,6 +94,7 @@ CONFIG_PM_WAKELOCKS_LIMIT=0
 CONFIG_CPU_IDLE=y
 CONFIG_ARM_CPUIDLE=y
 CONFIG_CPU_FREQ=y
+CONFIG_CPU_FREQ_STAT=y
 CONFIG_CPU_FREQ_GOV_POWERSAVE=y
 CONFIG_CPU_FREQ_GOV_USERSPACE=y
 CONFIG_CPU_FREQ_GOV_ONDEMAND=y
@@ -253,7 +254,9 @@ CONFIG_CFG80211_CERTIFICATION_ONUS=y
 CONFIG_CFG80211_REG_CELLULAR_HINTS=y
 CONFIG_CFG80211_INTERNAL_REGDB=y
 CONFIG_RFKILL=y
-CONFIG_NFC_NQ=y
+# CONFIG_NFC_NQ=y
+CONFIG_NFC_PN5XX=y
+CONFIG_NFC_PN80T=y
 CONFIG_FW_LOADER_USER_HELPER_FALLBACK=y
 CONFIG_REGMAP_ALLOW_WRITE_DEBUGFS=y
 CONFIG_DMA_CMA=y
@@ -261,7 +264,7 @@ CONFIG_MHI_BUS=y
 CONFIG_MHI_QCOM=y
 CONFIG_MHI_NETDEV=y
 CONFIG_MHI_UCI=y
-CONFIG_ZRAM=y
+# CONFIG_ZRAM is not set
 CONFIG_BLK_DEV_LOOP=y
 CONFIG_BLK_DEV_RAM=y
 CONFIG_BLK_DEV_RAM_SIZE=8192
@@ -293,6 +296,7 @@ CONFIG_TUN=y
 CONFIG_SKY2=y
 CONFIG_RMNET=y
 CONFIG_SMSC911X=y
+CONFIG_SENSOR_HALL_MXM1120=y
 CONFIG_PPP=y
 CONFIG_PPP_BSDCOMP=y
 CONFIG_PPP_DEFLATE=y
@@ -312,11 +316,32 @@ CONFIG_CLD_LL_CORE=y
 CONFIG_CNSS_GENL=y
 CONFIG_INPUT_EVDEV=y
 CONFIG_KEYBOARD_GPIO=y
+CONFIG_TRI_STATE_KEY=y
+CONFIG_HALL_TRI_STATE_KEY=y
 # CONFIG_INPUT_MOUSE is not set
+CONFIG_INPUT_JOYSTICK=y
 CONFIG_INPUT_TOUCHSCREEN=y
-CONFIG_TOUCHSCREEN_ST=y
+CONFIG_INPUT_FINGERPRINT=y
+CONFIG_FINGERPRINT_DETECT=y
+#CONFIG_FINGERPRINT_FPC=y
+CONFIG_FINGERPRINT_GOODIX=y
+CONFIG_FINGERPRINT_SILEAD=y
+CONFIG_TOUCHPANEL_ONEPLUS=y
+CONFIG_TOUCHPANEL_SAMSUNG=y
+CONFIG_TOUCHPANEL_SAMSUNG_S6SY761=y
+CONFIG_TOUCHPANEL_SYNAPTICS=y
+CONFIG_TOUCHPANEL_SYNAPTICS_S3706=y
+CONFIG_TOUCHPANEL_ST=y
+CONFIG_TOUCHPANEL_ST_FST1BA90A=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_CORE=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_RMI_DEV=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_FW_UPDATE=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_FW_UPDATE_EXTRA_SYSFS=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_TEST_REPORTING=y
+#CONFIG_TOUCHSCREEN_ST=y
 CONFIG_INPUT_MISC=y
-CONFIG_INPUT_HBTP_INPUT=y
+# CONFIG_INPUT_HBTP_INPUT is not set
 CONFIG_INPUT_QPNP_POWER_ON=y
 CONFIG_INPUT_QTI_HAPTICS=y
 CONFIG_INPUT_UINPUT=y
@@ -325,6 +350,7 @@ CONFIG_INPUT_UINPUT=y
 # CONFIG_LEGACY_PTYS is not set
 # CONFIG_DEVMEM is not set
 CONFIG_SERIAL_MSM_GENI=y
+CONFIG_SERIAL_MSM_GENI_CONSOLE=y
 CONFIG_HW_RANDOM=y
 CONFIG_HW_RANDOM_MSM_LEGACY=y
 # CONFIG_DEVPORT is not set
@@ -355,6 +381,11 @@ CONFIG_QPNP_FG_GEN4=y
 CONFIG_SMB1355_SLAVE_CHARGER=y
 CONFIG_QPNP_SMB5=y
 CONFIG_QPNP_QNOVO5=y
+CONFIG_FG_BQ27541=y
+CONFIG_ONEPLUS_FASTCHG=y
+CONFIG_JOYSTICK_XPAD=y
+CONFIG_HID_SONY=y
+CONFIG_SONY_FF=y
 CONFIG_SMB1390_CHARGE_PUMP=y
 CONFIG_THERMAL=y
 CONFIG_THERMAL_WRITABLE_TRIPS=y
@@ -535,8 +566,8 @@ CONFIG_RPMSG_CHAR=y
 CONFIG_RPMSG_QCOM_GLINK_SMEM=y
 CONFIG_RPMSG_QCOM_GLINK_SPSS=y
 CONFIG_RPMSG_QCOM_GLINK_SPI=y
-CONFIG_QCOM_MEM_OFFLINE=y
-CONFIG_OVERRIDE_MEMORY_LIMIT=y
+# CONFIG_QCOM_MEM_OFFLINE is not set
+# CONFIG_OVERRIDE_MEMORY_LIMIT is not set
 CONFIG_QCOM_CPUSS_DUMP=y
 CONFIG_QCOM_RUN_QUEUE_STATS=y
 CONFIG_QCOM_LLCC=y
@@ -629,12 +660,17 @@ CONFIG_EXT4_FS_SECURITY=y
 CONFIG_EXT4_ENCRYPTION=y
 CONFIG_EXT4_FS_ENCRYPTION=y
 CONFIG_EXT4_FS_ICE_ENCRYPTION=y
+CONFIG_F2FS_FS=y
+CONFIG_F2FS_FS_SECURITY=y
+CONFIG_F2FS_FS_ENCRYPTION=y
 CONFIG_QUOTA=y
 CONFIG_QUOTA_NETLINK_INTERFACE=y
 CONFIG_QFMT_V2=y
 CONFIG_FUSE_FS=y
 CONFIG_MSDOS_FS=y
 CONFIG_VFAT_FS=y
+CONFIG_EXFAT_FS=y
+CONFIG_NTFS_FS=y
 CONFIG_TMPFS_POSIX_ACL=y
 CONFIG_ECRYPT_FS=y
 CONFIG_ECRYPT_FS_MESSAGING=y
@@ -688,3 +724,33 @@ CONFIG_CRYPTO_AES_ARM64_CE_CCM=y
 CONFIG_CRYPTO_AES_ARM64_CE_BLK=y
 CONFIG_CRYPTO_AES_ARM64_NEON_BLK=y
 CONFIG_STACK_HASH_ORDER_SHIFT=12
+CONFIG_PSTORE=y
+CONFIG_PSTORE_CONSOLE=y
+CONFIG_PSTORE_RAM=y
+CONFIG_PSTORE_DEVICE_INFO=y
+CONFIG_PSTORE_PMSG=y
+CONFIG_BOOTLOADER_LOG=y
+CONFIG_PROJECT_INFO=y
+CONFIG_OEM_BOOT_MODE=y
+CONFIG_AW8697_HAPTIC=y
+CONFIG_INPUT_KEYCHORD=y
+CONFIG_DIGITAL_HALL_M1120=y
+CONFIG_STEP_MOTOR=y
+CONFIG_RF_CABLE_DETECT=y
+CONFIG_NET_CLS_CGROUP=y
+CONFIG_ADJ_CHAIN=y
+CONFIG_DEFRAG_HELPER=y
+CONFIG_FSC=y
+# zhongbin, 2019/1/4, add for memory plus project
+CONFIG_MEMPLUS=y
+CONFIG_SWAP=y
+CONFIG_ZRAM=y
+CONFIG_ZRAM_LZ4_COMPRESS=y
+CONFIG_LZ4_DECOMPRESS=y
+CONFIG_LZ4_COMPRESS=y
+CONFIG_CRYPTO_LZ4=y
+# end
+CONFIG_OPCHAIN=y
+CONFIG_SMART_BOOST=y
+# dylanchang,2019/4/1, add for kernel log reserve
+CONFIG_WB_KERNEL_LOG=y
diff --git a/arch/arm64/configs/vendor/sm8150_defconfig b/arch/arm64/configs/vendor/sm8150_defconfig
index fe0ff6c35645ccf8965fe6dd49455e39c8a543ea..33aa07d5c9e561dbbc4df830e3ff5151f7ed16a1 100644
--- a/arch/arm64/configs/vendor/sm8150_defconfig
+++ b/arch/arm64/configs/vendor/sm8150_defconfig
@@ -1,4 +1,4 @@
-CONFIG_HOTPLUG_SIZE_BITS=29
+# CONFIG_HOTPLUG_SIZE_BITS is not set
 # CONFIG_LOCALVERSION_AUTO is not set
 # CONFIG_FHANDLE is not set
 CONFIG_AUDIT=y
@@ -69,10 +69,10 @@ CONFIG_SCHED_MC=y
 CONFIG_NR_CPUS=8
 CONFIG_PREEMPT=y
 CONFIG_HZ_100=y
-CONFIG_MEMORY_HOTPLUG=y
-CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE=y
-CONFIG_MEMORY_HOTPLUG_MOVABLE_NODE=y
-CONFIG_MEMORY_HOTREMOVE=y
+# CONFIG_MEMORY_HOTPLUG is not set
+# CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE is not set
+# CONFIG_MEMORY_HOTPLUG_MOVABLE_NODE is not set
+# CONFIG_MEMORY_HOTREMOVE is not set
 CONFIG_CLEANCACHE=y
 CONFIG_CMA=y
 CONFIG_CMA_DEBUGFS=y
@@ -101,6 +101,7 @@ CONFIG_PM_DEBUG=y
 CONFIG_CPU_IDLE=y
 CONFIG_ARM_CPUIDLE=y
 CONFIG_CPU_FREQ=y
+CONFIG_CPU_FREQ_STAT=y
 CONFIG_CPU_FREQ_GOV_POWERSAVE=y
 CONFIG_CPU_FREQ_GOV_USERSPACE=y
 CONFIG_CPU_FREQ_GOV_ONDEMAND=y
@@ -263,7 +264,9 @@ CONFIG_CFG80211_REG_CELLULAR_HINTS=y
 CONFIG_CFG80211_INTERNAL_REGDB=y
 # CONFIG_CFG80211_CRDA_SUPPORT is not set
 CONFIG_RFKILL=y
-CONFIG_NFC_NQ=y
+# CONFIG_NFC_NQ=y
+CONFIG_NFC_PN5XX=y
+CONFIG_NFC_PN80T=y
 CONFIG_FW_LOADER_USER_HELPER_FALLBACK=y
 CONFIG_REGMAP_ALLOW_WRITE_DEBUGFS=y
 CONFIG_DMA_CMA=y
@@ -272,7 +275,7 @@ CONFIG_MHI_DEBUG=y
 CONFIG_MHI_QCOM=y
 CONFIG_MHI_NETDEV=y
 CONFIG_MHI_UCI=y
-CONFIG_ZRAM=y
+# CONFIG_ZRAM is not set
 CONFIG_BLK_DEV_LOOP=y
 CONFIG_BLK_DEV_RAM=y
 CONFIG_BLK_DEV_RAM_SIZE=8192
@@ -304,6 +307,7 @@ CONFIG_BONDING=y
 CONFIG_DUMMY=y
 CONFIG_TUN=y
 CONFIG_RMNET=y
+CONFIG_SENSOR_HALL_MXM1120=y
 CONFIG_PPP=y
 CONFIG_PPP_BSDCOMP=y
 CONFIG_PPP_DEFLATE=y
@@ -323,12 +327,32 @@ CONFIG_CLD_LL_CORE=y
 CONFIG_CNSS_GENL=y
 CONFIG_INPUT_EVDEV=y
 CONFIG_KEYBOARD_GPIO=y
+CONFIG_TRI_STATE_KEY=y
+CONFIG_HALL_TRI_STATE_KEY=y
 # CONFIG_INPUT_MOUSE is not set
 CONFIG_INPUT_JOYSTICK=y
 CONFIG_INPUT_TOUCHSCREEN=y
-CONFIG_TOUCHSCREEN_ST=y
+CONFIG_INPUT_FINGERPRINT=y
+CONFIG_FINGERPRINT_DETECT=y
+#CONFIG_FINGERPRINT_FPC=y
+CONFIG_FINGERPRINT_GOODIX=y
+CONFIG_FINGERPRINT_SILEAD=y
+CONFIG_TOUCHPANEL_ONEPLUS=y
+CONFIG_TOUCHPANEL_SAMSUNG=y
+CONFIG_TOUCHPANEL_SAMSUNG_S6SY761=y
+CONFIG_TOUCHPANEL_SYNAPTICS=y
+CONFIG_TOUCHPANEL_SYNAPTICS_S3706=y
+CONFIG_TOUCHPANEL_ST=y
+CONFIG_TOUCHPANEL_ST_FST1BA90A=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_CORE=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_RMI_DEV=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_FW_UPDATE=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_FW_UPDATE_EXTRA_SYSFS=y
+#CONFIG_TOUCHSCREEN_SYNAPTICS_DSX_TEST_REPORTING=y
+#CONFIG_TOUCHSCREEN_ST=y
 CONFIG_INPUT_MISC=y
-CONFIG_INPUT_HBTP_INPUT=y
+# CONFIG_INPUT_HBTP_INPUT is not set
 CONFIG_INPUT_QPNP_POWER_ON=y
 CONFIG_INPUT_QTI_HAPTICS=y
 CONFIG_INPUT_UINPUT=y
@@ -370,6 +394,11 @@ CONFIG_QPNP_FG_GEN4=y
 CONFIG_SMB1355_SLAVE_CHARGER=y
 CONFIG_QPNP_SMB5=y
 CONFIG_QPNP_QNOVO5=y
+CONFIG_FG_BQ27541=y
+CONFIG_ONEPLUS_FASTCHG=y
+CONFIG_JOYSTICK_XPAD=y
+CONFIG_HID_SONY=y
+CONFIG_SONY_FF=y
 CONFIG_SMB1390_CHARGE_PUMP=y
 CONFIG_THERMAL=y
 CONFIG_THERMAL_WRITABLE_TRIPS=y
@@ -558,8 +587,8 @@ CONFIG_RPMSG_CHAR=y
 CONFIG_RPMSG_QCOM_GLINK_SMEM=y
 CONFIG_RPMSG_QCOM_GLINK_SPSS=y
 CONFIG_RPMSG_QCOM_GLINK_SPI=y
-CONFIG_QCOM_MEM_OFFLINE=y
-CONFIG_OVERRIDE_MEMORY_LIMIT=y
+# CONFIG_QCOM_MEM_OFFLINE is not set
+# CONFIG_OVERRIDE_MEMORY_LIMIT is not set
 CONFIG_QCOM_CPUSS_DUMP=y
 CONFIG_QCOM_RUN_QUEUE_STATS=y
 CONFIG_QCOM_LLCC=y
@@ -658,12 +687,17 @@ CONFIG_EXT4_FS_SECURITY=y
 CONFIG_EXT4_ENCRYPTION=y
 CONFIG_EXT4_FS_ENCRYPTION=y
 CONFIG_EXT4_FS_ICE_ENCRYPTION=y
+CONFIG_F2FS_FS=y
+CONFIG_F2FS_FS_SECURITY=y
+CONFIG_F2FS_FS_ENCRYPTION=y
 CONFIG_QUOTA=y
 CONFIG_QUOTA_NETLINK_INTERFACE=y
 CONFIG_QFMT_V2=y
 CONFIG_FUSE_FS=y
 CONFIG_MSDOS_FS=y
 CONFIG_VFAT_FS=y
+CONFIG_EXFAT_FS=y
+CONFIG_NTFS_FS=y
 CONFIG_TMPFS_POSIX_ACL=y
 CONFIG_EFIVAR_FS=y
 CONFIG_ECRYPT_FS=y
@@ -682,7 +716,7 @@ CONFIG_DEBUG_SECTION_MISMATCH=y
 # CONFIG_SECTION_MISMATCH_WARN_ONLY is not set
 CONFIG_MAGIC_SYSRQ=y
 CONFIG_DEBUG_PAGEALLOC=y
-CONFIG_SLUB_DEBUG_PANIC_ON=y
+# CONFIG_SLUB_DEBUG_PANIC_ON is not set
 CONFIG_DEBUG_PAGEALLOC_ENABLE_DEFAULT=y
 CONFIG_PAGE_POISONING=y
 CONFIG_PAGE_POISONING_ENABLE_DEFAULT=y
@@ -691,9 +725,10 @@ CONFIG_DEBUG_OBJECTS_FREE=y
 CONFIG_DEBUG_OBJECTS_TIMERS=y
 CONFIG_DEBUG_OBJECTS_WORK=y
 CONFIG_DEBUG_OBJECTS_PERCPU_COUNTER=y
-CONFIG_SLUB_DEBUG_ON=y
+# CONFIG_SLUB_DEBUG is not set
+# CONFIG_SLUB_DEBUG_ON is not set
 CONFIG_DEBUG_KMEMLEAK=y
-CONFIG_DEBUG_KMEMLEAK_EARLY_LOG_SIZE=4000
+CONFIG_DEBUG_KMEMLEAK_EARLY_LOG_SIZE=8192
 CONFIG_DEBUG_KMEMLEAK_DEFAULT_OFF=y
 CONFIG_DEBUG_STACK_USAGE=y
 CONFIG_DEBUG_MEMORY_INIT=y
@@ -773,3 +808,35 @@ CONFIG_CRYPTO_AES_ARM64_CE_CCM=y
 CONFIG_CRYPTO_AES_ARM64_CE_BLK=y
 CONFIG_CRYPTO_AES_ARM64_NEON_BLK=y
 CONFIG_XZ_DEC=y
+# yangfb,2018/1/26, add for aging test get log and limmit current
+CONFIG_OP_DEBUG_CHG=y
+CONFIG_PSTORE=y
+CONFIG_PSTORE_CONSOLE=y
+CONFIG_PSTORE_RAM=y
+CONFIG_PSTORE_DEVICE_INFO=y
+CONFIG_PSTORE_PMSG=y
+CONFIG_BOOTLOADER_LOG=y
+CONFIG_PROJECT_INFO=y
+CONFIG_OEM_BOOT_MODE=y
+CONFIG_AW8697_HAPTIC=y
+CONFIG_INPUT_KEYCHORD=y
+CONFIG_DIGITAL_HALL_M1120=y
+CONFIG_STEP_MOTOR=y
+CONFIG_RF_CABLE_DETECT=y
+CONFIG_NET_CLS_CGROUP=y
+CONFIG_ADJ_CHAIN=y
+CONFIG_DEFRAG_HELPER=y
+CONFIG_FSC=y
+# zhongbin, 2019/1/4, add for memory plus project
+CONFIG_MEMPLUS=y
+CONFIG_SWAP=y
+CONFIG_ZRAM=y
+CONFIG_ZRAM_LZ4_COMPRESS=y
+CONFIG_LZ4_DECOMPRESS=y
+CONFIG_LZ4_COMPRESS=y
+CONFIG_CRYPTO_LZ4=y
+# end
+CONFIG_OPCHAIN=y
+CONFIG_SMART_BOOST=y
+# dylanchang,2019/4/1, add for kernel log reserve
+CONFIG_WB_KERNEL_LOG=y
diff --git a/arch/arm64/include/uapi/asm/setup.h b/arch/arm64/include/uapi/asm/setup.h
index 5d703888f35110d2a7a15ec1836bffcffae3c8bb..9f583cb9e76ecf4ce937fc93f41d0d4dcff8927a 100644
--- a/arch/arm64/include/uapi/asm/setup.h
+++ b/arch/arm64/include/uapi/asm/setup.h
@@ -22,6 +22,6 @@
 
 #include <linux/types.h>
 
-#define COMMAND_LINE_SIZE	2048
+#define COMMAND_LINE_SIZE	3072
 
 #endif
diff --git a/arch/arm64/kernel/cpu_errata.c b/arch/arm64/kernel/cpu_errata.c
index 92800fe7c5a052c97c09365ba8cf0c5256387e72..1f658e433ccf9ead8218231057700d92c358b890 100644
--- a/arch/arm64/kernel/cpu_errata.c
+++ b/arch/arm64/kernel/cpu_errata.c
@@ -524,12 +524,6 @@ const struct arm64_cpu_capabilities arm64_errata[] = {
 			   MIDR_CPU_VAR_REV(0, 0),
 			   MIDR_CPU_VAR_REV(3, 0)),
 	},
-	{
-		.capability = ARM64_WORKAROUND_REPEAT_TLBI,
-		MIDR_RANGE(MIDR_KRYO4G,
-			   MIDR_CPU_VAR_REV(12, 14),
-			   MIDR_CPU_VAR_REV(13, 14)),
-	},
 #endif
 #ifdef CONFIG_ARM64_ERRATUM_858921
 	{
diff --git a/arch/arm64/kernel/perf_event.c b/arch/arm64/kernel/perf_event.c
index 3e7958f8293b960fd339cce00ddcd7d505c5ec71..51e072e30d602b35a470268a8e167a975d0a9e5f 100644
--- a/arch/arm64/kernel/perf_event.c
+++ b/arch/arm64/kernel/perf_event.c
@@ -1001,7 +1001,7 @@ static void armv8pmu_idle_update(struct arm_pmu *cpu_pmu)
 	struct perf_event *event;
 	int idx;
 
-	if (!cpu_pmu)
+	if (!cpu_pmu || !(cpu_pmu->hw_events))
 		return;
 
 	if (__this_cpu_read(is_hotplugging))
diff --git a/arch/arm64/mm/fault.c b/arch/arm64/mm/fault.c
index 7d8c7ab56bfd2621d1b5e0c4317708bb3e9583c9..d5410b91d07af9c75aa5edf509bea672ebe80198 100644
--- a/arch/arm64/mm/fault.c
+++ b/arch/arm64/mm/fault.c
@@ -897,7 +897,7 @@ asmlinkage int __exception do_debug_exception(unsigned long addr,
 	if (!inf->fn(addr, esr, regs)) {
 		rv = 1;
 	} else {
-		pr_alert("Unhandled debug exception: %s (0x%08x) at 0x%016lx\n",
+		pr_info_ratelimited("Unhandled debug exception: %s (0x%08x) at 0x%016lx\n",
 			 inf->name, esr, addr);
 
 		info.si_signo = inf->sig;
diff --git a/drivers/Kconfig b/drivers/Kconfig
index 29096a4caa440f04eb17c53a671eeaefb9156760..3bb5ee07b1aa0bb6221d41956e0e8d72d86ce92e 100644
--- a/drivers/Kconfig
+++ b/drivers/Kconfig
@@ -219,4 +219,8 @@ source "drivers/sensors/Kconfig"
 
 source "drivers/esoc/Kconfig"
 
+source "drivers/oneplus/Kconfig"
+
+source "drivers/param_read_write/Kconfig"
+source "drivers/oem_debug/Kconfig"
 endmenu
diff --git a/drivers/Makefile b/drivers/Makefile
index f409e6ddf143b813a2de6326dd3bd05c9c0bb40b..7d62aba241270231eb9fb8e82fb546bd83eaf258 100644
--- a/drivers/Makefile
+++ b/drivers/Makefile
@@ -188,3 +188,6 @@ obj-$(CONFIG_TEE)		+= tee/
 obj-$(CONFIG_MULTIPLEXER)	+= mux/
 obj-$(CONFIG_SENSORS_SSC)	+= sensors/
 obj-$(CONFIG_ESOC)              += esoc/
+obj-y              += oneplus/
+obj-y  += param_read_write/
+obj-y 	+= oem_debug/
diff --git a/drivers/android/binder.c b/drivers/android/binder.c
index 9c06e7f46d7f0f1037b6c36bccfa4a939f926946..df367aa95eff980714c6128e45d88efe554aeba5 100644
--- a/drivers/android/binder.c
+++ b/drivers/android/binder.c
@@ -72,10 +72,14 @@
 #include <linux/security.h>
 #include <linux/spinlock.h>
 
+#include <linux/proc_fs.h>
 #include <uapi/linux/android/binder.h>
 #include <uapi/linux/sched/types.h>
 #include "binder_alloc.h"
 #include "binder_trace.h"
+#ifdef CONFIG_OPCHAIN
+#include <../drivers/oneplus/coretech/opchain/opchain_binder.h>
+#endif
 
 static HLIST_HEAD(binder_deferred_list);
 static DEFINE_MUTEX(binder_deferred_lock);
@@ -3136,7 +3140,6 @@ static void binder_transaction(struct binder_proc *proc,
 		t->buffer = NULL;
 		goto err_binder_alloc_buf_failed;
 	}
-	t->buffer->allow_user_free = 0;
 	t->buffer->debug_id = t->debug_id;
 	t->buffer->transaction = t;
 	t->buffer->target_node = target_node;
@@ -3184,6 +3187,11 @@ static void binder_transaction(struct binder_proc *proc,
 	sg_bufp = (u8 *)(PTR_ALIGN(off_end, sizeof(void *)));
 	sg_buf_end = sg_bufp + extra_buffers_size;
 	off_min = 0;
+#ifdef CONFIG_OPCHAIN
+	opc_binder_pass(
+		t->buffer->data_size,
+		(uint32_t *)t->buffer->data, 1);
+#endif
 	for (; offp < off_end; offp++) {
 		struct binder_object_header *hdr;
 		size_t object_size = binder_validate_object(t->buffer, *offp);
@@ -3632,14 +3640,18 @@ static int binder_thread_write(struct binder_proc *proc,
 
 			buffer = binder_alloc_prepare_to_free(&proc->alloc,
 							      data_ptr);
-			if (buffer == NULL) {
-				binder_user_error("%d:%d BC_FREE_BUFFER u%016llx no match\n",
-					proc->pid, thread->pid, (u64)data_ptr);
-				break;
-			}
-			if (!buffer->allow_user_free) {
-				binder_user_error("%d:%d BC_FREE_BUFFER u%016llx matched unreturned buffer\n",
-					proc->pid, thread->pid, (u64)data_ptr);
+			if (IS_ERR_OR_NULL(buffer)) {
+				if (PTR_ERR(buffer) == -EPERM) {
+					binder_user_error(
+						"%d:%d BC_FREE_BUFFER u%016llx matched unreturned or currently freeing buffer\n",
+						proc->pid, thread->pid,
+						(u64)data_ptr);
+				} else {
+					binder_user_error(
+						"%d:%d BC_FREE_BUFFER u%016llx no match\n",
+						proc->pid, thread->pid,
+						(u64)data_ptr);
+				}
 				break;
 			}
 			binder_debug(BINDER_DEBUG_FREE_BUFFER,
@@ -5793,6 +5805,55 @@ static int __init init_binder_device(const char *name)
 	return ret;
 }
 
+static int proc_state_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, binder_state_show, NULL);
+}
+
+static int proc_transactions_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, binder_transactions_show, NULL);
+}
+
+static int proc_transaction_log_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, binder_transaction_log_show,
+		&binder_transaction_log);
+}
+
+
+static const struct file_operations proc_state_operations = {
+	.open       = proc_state_open,
+	.read       = seq_read,
+	.llseek     = seq_lseek,
+	.release    = single_release,
+};
+
+static const struct file_operations proc_transactions_operations = {
+	.open       = proc_transactions_open,
+	.read       = seq_read,
+	.llseek     = seq_lseek,
+	.release    = single_release,
+};
+
+static const struct file_operations proc_transaction_log_operations = {
+	.open       = proc_transaction_log_open,
+	.read       = seq_read,
+	.llseek     = seq_lseek,
+	.release    = single_release,
+};
+
+static int binder_proc_init(void)
+{
+	proc_create("proc_state", 0444, NULL,
+			&proc_state_operations);
+	proc_create("proc_transactions", 0444, NULL,
+			&proc_transactions_operations);
+	proc_create("proc_transaction_log", 0444, NULL,
+			&proc_transaction_log_operations);
+	return 0;
+}
+
 static int __init binder_init(void)
 {
 	int ret;
@@ -5857,6 +5918,7 @@ static int __init binder_init(void)
 		if (ret)
 			goto err_init_binder_device_failed;
 	}
+		binder_proc_init();
 
 	return ret;
 
diff --git a/drivers/android/binder_alloc.c b/drivers/android/binder_alloc.c
index 54debce30ee079a4a6925d3aa625769b911697c8..e00d4d13810a004d61821fe9ccec31651645be8b 100644
--- a/drivers/android/binder_alloc.c
+++ b/drivers/android/binder_alloc.c
@@ -149,14 +149,12 @@ static struct binder_buffer *binder_alloc_prepare_to_free_locked(
 		else {
 			/*
 			 * Guard against user threads attempting to
-			 * free the buffer twice
+			 * free the buffer when in use by kernel or
+			 * after it's already been freed.
 			 */
-			if (buffer->free_in_progress) {
-				pr_err("%d:%d FREE_BUFFER u%016llx user freed buffer twice\n",
-				       alloc->pid, current->pid, (u64)user_ptr);
-				return NULL;
-			}
-			buffer->free_in_progress = 1;
+			if (!buffer->allow_user_free)
+				return ERR_PTR(-EPERM);
+			buffer->allow_user_free = 0;
 			return buffer;
 		}
 	}
@@ -490,7 +488,7 @@ static struct binder_buffer *binder_alloc_new_buf_locked(
 
 	rb_erase(best_fit, &alloc->free_buffers);
 	buffer->free = 0;
-	buffer->free_in_progress = 0;
+	buffer->allow_user_free = 0;
 	binder_insert_allocated_buffer_locked(alloc, buffer);
 	binder_alloc_debug(BINDER_DEBUG_BUFFER_ALLOC,
 		     "%d: binder_alloc_buf size %zd got %pK\n",
diff --git a/drivers/android/binder_alloc.h b/drivers/android/binder_alloc.h
index 9ef64e56385667a53abeab2f41f67b198a8ce86e..fb3238c74c8a8671282cf9a428febaf182880821 100644
--- a/drivers/android/binder_alloc.h
+++ b/drivers/android/binder_alloc.h
@@ -50,8 +50,7 @@ struct binder_buffer {
 	unsigned free:1;
 	unsigned allow_user_free:1;
 	unsigned async_transaction:1;
-	unsigned free_in_progress:1;
-	unsigned debug_id:28;
+	unsigned debug_id:29;
 
 	struct binder_transaction *transaction;
 
diff --git a/drivers/base/power/wakeup.c b/drivers/base/power/wakeup.c
index 50cb3da3a13c7063022778d7eb0fab5fea91ef0a..2c2a1ce90d4b55f7c6f1006b9f041841adbc81db 100644
--- a/drivers/base/power/wakeup.c
+++ b/drivers/base/power/wakeup.c
@@ -22,6 +22,8 @@
 #include <linux/irqdesc.h>
 
 #include "power.h"
+#include <linux/wakeup_reason.h>
+#include <linux/pm_wakeup.h>
 
 /*
  * If set, the suspend/hibernate code will abort transitions to a sleep state
@@ -71,6 +73,10 @@ static struct wakeup_source deleted_ws = {
 	.lock =  __SPIN_LOCK_UNLOCKED(deleted_ws.lock),
 };
 
+#define WORK_TIMEOUT	(60*1000)
+static void ws_printk(struct work_struct *work);
+static DECLARE_DELAYED_WORK(ws_printk_work, ws_printk);
+
 /**
  * wakeup_source_prepare - Prepare a new wakeup source for initialization.
  * @ws: Wakeup source to prepare.
@@ -850,7 +856,7 @@ void pm_print_active_wakeup_sources(void)
 	srcuidx = srcu_read_lock(&wakeup_srcu);
 	list_for_each_entry_rcu(ws, &wakeup_sources, entry) {
 		if (ws->active) {
-			pr_debug("active wakeup source: %s\n", ws->name);
+			pr_info("active wakeup source: %s\n", ws->name);
 			active = 1;
 		} else if (!active &&
 			   (!last_activity_ws ||
@@ -861,12 +867,30 @@ void pm_print_active_wakeup_sources(void)
 	}
 
 	if (!active && last_activity_ws)
-		pr_debug("last active wakeup source: %s\n",
+		pr_info("last active wakeup source: %s\n",
 			last_activity_ws->name);
 	srcu_read_unlock(&wakeup_srcu, srcuidx);
 }
 EXPORT_SYMBOL_GPL(pm_print_active_wakeup_sources);
 
+static void ws_printk(struct work_struct *work)
+{
+		pm_print_active_wakeup_sources();
+		queue_delayed_work(system_freezable_wq,
+		&ws_printk_work, msecs_to_jiffies(WORK_TIMEOUT));
+}
+
+void pm_print_active_wakeup_sources_queue(bool on)
+{
+	if (on) {
+		queue_delayed_work(system_freezable_wq, &ws_printk_work,
+		msecs_to_jiffies(WORK_TIMEOUT));
+	} else {
+		cancel_delayed_work(&ws_printk_work);
+	}
+}
+EXPORT_SYMBOL_GPL(pm_print_active_wakeup_sources_queue);
+
 /**
  * pm_wakeup_pending - Check if power transition in progress should be aborted.
  *
@@ -930,6 +954,7 @@ void pm_system_irq_wakeup(unsigned int irq_number)
 			else if (desc->action && desc->action->name)
 				name = desc->action->name;
 
+			log_wakeup_reason(irq_number);
 			pr_warn("%s: %d triggered %s\n", __func__,
 					irq_number, name);
 
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c
index 8fd08023c0f5fae351800ab27d30a8a244eabaaa..cc60ddfd971fa90766cba4bc6e88391d4312a620 100644
--- a/drivers/base/regmap/regmap.c
+++ b/drivers/base/regmap/regmap.c
@@ -1651,6 +1651,9 @@ int _regmap_write(struct regmap *map, unsigned int reg,
 		dev_info(map->dev, "%x <= %x\n", reg, val);
 #endif
 
+	if ( reg == 0x88E || reg == 0x88d)
+		dev_info(map->dev, "w:%x <= %x[%s],\n", reg, val,dev_name(map->dev));
+
 	trace_regmap_reg_write(map, reg, val);
 
 	return map->reg_write(context, reg, val);
@@ -2379,6 +2382,8 @@ static int _regmap_read(struct regmap *map, unsigned int reg,
 		if (map->dev && strcmp(dev_name(map->dev), LOG_DEVICE) == 0)
 			dev_info(map->dev, "%x => %x\n", reg, *val);
 #endif
+		if ( reg == 0x88E || reg == 0x88d)
+			dev_info(map->dev, "r:%x <= %x[%s],\n", reg, val,dev_name(map->dev));
 
 		trace_regmap_reg_read(map, reg, *val);
 
diff --git a/drivers/char/diag/diagfwd_cntl.c b/drivers/char/diag/diagfwd_cntl.c
index caf833ce42b3207a4c28f6a4d186d9334f2714cd..7d88965da5598e9bdb4d6581e6e9eb8d649af6de 100644
--- a/drivers/char/diag/diagfwd_cntl.c
+++ b/drivers/char/diag/diagfwd_cntl.c
@@ -64,6 +64,10 @@ void diag_cntl_channel_close(struct diagfwd_info *p_info)
 	if (peripheral >= NUM_PERIPHERALS)
 		return;
 
+	pr_debug("diag: ETS: %s: peripheral=%d (+)\n",
+			__func__, peripheral);
+
+
 	driver->feature[peripheral].sent_feature_mask = 0;
 	driver->feature[peripheral].rcvd_feature_mask = 0;
 	reg_dirty[peripheral] = 1;
@@ -75,6 +79,10 @@ void diag_cntl_channel_close(struct diagfwd_info *p_info)
 	driver->stm_state_requested[peripheral] = DISABLE_STM;
 	reg_dirty[peripheral] = 0;
 	diag_notify_md_client(peripheral, DIAG_STATUS_CLOSED);
+
+	pr_debug("diag: ETS: %s: peripheral=%d (-)\n",
+			__func__, peripheral);
+
 }
 
 static void diag_stm_update_work_fn(struct work_struct *work)
@@ -1136,8 +1144,13 @@ void diag_real_time_work_fn(struct work_struct *work)
 		if (peripheral == APPS_DATA)
 			continue;
 
-		if (peripheral > NUM_PERIPHERALS)
+		if (peripheral > NUM_PERIPHERALS) {
 			peripheral = diag_search_peripheral_by_pd(i);
+			if (peripheral > NUM_PERIPHERALS) {
+				pr_warn("invalid peripheral for pd %d\n", i);
+				continue;
+			}
+		}
 
 		if (!driver->feature[peripheral].peripheral_buffering)
 			continue;
diff --git a/drivers/char/misc.c b/drivers/char/misc.c
index 1bb9e7cc82e306a34c970540e58301d0ca2a60ac..b4c4312ab6d2eb072f410853df6fdaa44b2aa697 100644
--- a/drivers/char/misc.c
+++ b/drivers/char/misc.c
@@ -60,7 +60,7 @@ static DEFINE_MUTEX(misc_mtx);
 /*
  * Assigned numbers, used for dynamic minors
  */
-#define DYNAMIC_MINORS 64 /* like dynamic majors */
+#define DYNAMIC_MINORS 128 /* like dynamic majors */
 static DECLARE_BITMAP(misc_minors, DYNAMIC_MINORS);
 
 #ifdef CONFIG_PROC_FS
diff --git a/drivers/clk/clk.c b/drivers/clk/clk.c
index e562c92b63c9a5836075044e95364f4444387d7c..854013b5884ea2d941a8d4b8de07c21104b99994 100644
--- a/drivers/clk/clk.c
+++ b/drivers/clk/clk.c
@@ -1,7 +1,7 @@
 /*
  * Copyright (C) 2010-2011 Canonical Ltd <jeremy.kerr@canonical.com>
  * Copyright (C) 2011-2012 Linaro Ltd <mturquette@linaro.org>
- * Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * 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
@@ -49,6 +49,17 @@ struct clk_handoff_vdd {
 };
 
 static LIST_HEAD(clk_handoff_vdd_list);
+static bool vdd_class_handoff_completed;
+static DEFINE_MUTEX(vdd_class_list_lock);
+/*
+ * clk_rate_change_list is used during clk_core_set_rate_nolock() calls to
+ * handle vdd_class vote tracking.  core->rate_change_node is added to
+ * clk_rate_change_list when core->new_rate requires a different voltage level
+ * (core->new_vdd_class_vote) than core->vdd_class_vote.  Elements are removed
+ * from the list after unvoting core->vdd_class_vote immediately before
+ * returning from clk_core_set_rate_nolock().
+ */
+static LIST_HEAD(clk_rate_change_list);
 
 /***    private data structures    ***/
 
@@ -88,6 +99,9 @@ struct clk_core {
 #endif
 	struct kref		ref;
 	struct clk_vdd_class	*vdd_class;
+	int			vdd_class_vote;
+	int			new_vdd_class_vote;
+	struct list_head	rate_change_node;
 	unsigned long		*rate_max;
 	int			num_rate_max;
 };
@@ -632,9 +646,11 @@ static int clk_unvote_vdd_level(struct clk_vdd_class *vdd_class, int level)
 	mutex_lock(&vdd_class->lock);
 
 	if (WARN(!vdd_class->level_votes[level],
-				"Reference counts are incorrect for %s level %d\n",
-				vdd_class->class_name, level))
+			"Reference counts are incorrect for %s level %d\n",
+			vdd_class->class_name, level)) {
+		rc = -EINVAL;
 		goto out;
+	}
 
 	vdd_class->level_votes[level]--;
 
@@ -698,29 +714,43 @@ static bool clk_is_rate_level_valid(struct clk_core *core, unsigned long rate)
 static int clk_vdd_class_init(struct clk_vdd_class *vdd)
 {
 	struct clk_handoff_vdd *v;
+	int ret = 0;
 
 	if (vdd->skip_handoff)
 		return 0;
 
+	mutex_lock(&vdd_class_list_lock);
+
 	list_for_each_entry(v, &clk_handoff_vdd_list, list) {
 		if (v->vdd_class == vdd)
-			return 0;
+			goto done;
 	}
 
-	pr_debug("voting for vdd_class %s\n", vdd->class_name);
+	if (!vdd_class_handoff_completed) {
+		pr_debug("voting for vdd_class %s\n", vdd->class_name);
 
-	if (clk_vote_vdd_level(vdd, vdd->num_levels - 1))
-		pr_err("failed to vote for %s\n", vdd->class_name);
+		ret = clk_vote_vdd_level(vdd, vdd->num_levels - 1);
+		if (ret) {
+			pr_err("failed to vote for %s, ret=%d\n",
+				vdd->class_name, ret);
+			goto done;
+		}
+	}
 
 	v = kmalloc(sizeof(*v), GFP_KERNEL);
-	if (!v)
-		return -ENOMEM;
+	if (!v) {
+		ret = -ENOMEM;
+		goto done;
+	}
 
 	v->vdd_class = vdd;
 
 	list_add_tail(&v->list, &clk_handoff_vdd_list);
 
-	return 0;
+done:
+	mutex_unlock(&vdd_class_list_lock);
+
+	return ret;
 }
 
 /***        clk api        ***/
@@ -750,7 +780,11 @@ static void clk_core_unprepare(struct clk_core *core)
 
 	trace_clk_unprepare_complete(core);
 
-	clk_unvote_rate_vdd(core, core->rate);
+	if (core->vdd_class) {
+		clk_unvote_vdd_level(core->vdd_class, core->vdd_class_vote);
+		core->vdd_class_vote = 0;
+		core->new_vdd_class_vote = 0;
+	}
 
 	clk_core_unprepare(core->parent);
 }
@@ -803,6 +837,11 @@ static int clk_core_prepare(struct clk_core *core)
 			clk_core_unprepare(core->parent);
 			return ret;
 		}
+		if (core->vdd_class) {
+			core->vdd_class_vote
+				= clk_find_vdd_level(core, core->rate);
+			core->new_vdd_class_vote = core->vdd_class_vote;
+		}
 
 		if (core->ops->prepare)
 			ret = core->ops->prepare(core->hw);
@@ -811,6 +850,8 @@ static int clk_core_prepare(struct clk_core *core)
 
 		if (ret) {
 			clk_unvote_rate_vdd(core, core->rate);
+			core->vdd_class_vote = 0;
+			core->new_vdd_class_vote = 0;
 			clk_core_unprepare(core->parent);
 			return ret;
 		}
@@ -1125,12 +1166,15 @@ static int clk_disable_unused(void)
 	hlist_for_each_entry(core, &clk_orphan_list, child_node)
 		clk_unprepare_unused_subtree(core);
 
+	mutex_lock(&vdd_class_list_lock);
 	list_for_each_entry_safe(v, v_temp, &clk_handoff_vdd_list, list) {
 		clk_unvote_vdd_level(v->vdd_class,
 				v->vdd_class->num_levels - 1);
 		list_del(&v->list);
 		kfree(v);
 	};
+	vdd_class_handoff_completed = true;
+	mutex_unlock(&vdd_class_list_lock);
 
 	clk_prepare_unlock();
 
@@ -1614,12 +1658,59 @@ static int __clk_speculate_rates(struct clk_core *core,
 	return ret;
 }
 
-static void clk_calc_subtree(struct clk_core *core, unsigned long new_rate,
+/*
+ * Vote for the voltage level required for core->new_rate.  Keep track of all
+ * clocks with a changed voltage level in clk_rate_change_list.
+ */
+static int clk_vote_new_rate_vdd(struct clk_core *core)
+{
+	int cur_level, next_level;
+	int ret;
+
+	if (IS_ERR_OR_NULL(core) || !core->vdd_class)
+		return 0;
+
+	if (!clk_core_is_prepared(core))
+		return 0;
+
+	cur_level = core->new_vdd_class_vote;
+	next_level = clk_find_vdd_level(core, core->new_rate);
+	if (cur_level == next_level)
+		return 0;
+
+	ret = clk_vote_vdd_level(core->vdd_class, next_level);
+	if (ret)
+		return ret;
+
+	core->new_vdd_class_vote = next_level;
+
+	if (list_empty(&core->rate_change_node)) {
+		list_add(&core->rate_change_node, &clk_rate_change_list);
+	} else {
+		/*
+		 * A different new_rate has been determined for a clock that
+		 * was already encountered in the clock tree traversal so the
+		 * level that was previously voted for it should be removed.
+		 */
+		ret = clk_unvote_vdd_level(core->vdd_class, cur_level);
+		if (ret)
+			return ret;
+	}
+
+	return 0;
+}
+
+static int clk_calc_subtree(struct clk_core *core, unsigned long new_rate,
 			     struct clk_core *new_parent, u8 p_index)
 {
 	struct clk_core *child;
+	int ret;
 
 	core->new_rate = new_rate;
+	ret = clk_vote_new_rate_vdd(core);
+	if (ret)
+		return ret;
+
 	core->new_parent = new_parent;
 	core->new_parent_index = p_index;
 	/* include clk in new parent's PRE_RATE_CHANGE notifications */
@@ -1629,8 +1720,12 @@ static void clk_calc_subtree(struct clk_core *core, unsigned long new_rate,
 
 	hlist_for_each_entry(child, &core->children, child_node) {
 		child->new_rate = clk_recalc(child, new_rate);
-		clk_calc_subtree(child, child->new_rate, NULL, 0);
+		ret = clk_calc_subtree(child, child->new_rate, NULL, 0);
+		if (ret)
+			return ret;
 	}
+
+	return 0;
 }
 
 /*
@@ -1734,7 +1829,9 @@ static struct clk_core *clk_calc_new_rates(struct clk_core *core,
 	if (!clk_is_rate_level_valid(core, rate))
 		return NULL;
 
-	clk_calc_subtree(core, new_rate, parent, p_index);
+	ret = clk_calc_subtree(core, new_rate, parent, p_index);
+	if (ret)
+		return NULL;
 
 	return top;
 }
@@ -1814,13 +1911,6 @@ static int clk_change_rate(struct clk_core *core)
 
 	trace_clk_set_rate(core, core->new_rate);
 
-	/* Enforce vdd requirements for new frequency. */
-	if (core->prepare_count) {
-		rc = clk_vote_rate_vdd(core, core->new_rate);
-		if (rc)
-			goto out;
-	}
-
 	if (core->new_parent && core->new_parent != core->parent) {
 		old_parent = __clk_set_parent_before(core, core->new_parent);
 		trace_clk_set_parent(core, core->new_parent);
@@ -1850,10 +1940,6 @@ static int clk_change_rate(struct clk_core *core)
 
 	trace_clk_set_rate_complete(core, core->new_rate);
 
-	/* Release vdd requirements for old frequency. */
-	if (core->prepare_count)
-		clk_unvote_rate_vdd(core, old_rate);
-
 	core->rate = clk_recalc(core, best_parent_rate);
 
 	if (core->flags & CLK_SET_RATE_UNGATE) {
@@ -1894,20 +1980,89 @@ static int clk_change_rate(struct clk_core *core)
 	return rc;
 
 err_set_rate:
-	if (core->prepare_count)
-		clk_unvote_rate_vdd(core, core->new_rate);
-out:
 	trace_clk_set_rate_complete(core, core->new_rate);
 
 	return rc;
 }
 
+/*
+ * Unvote for the voltage level required for each core->new_vdd_class_vote in
+ * clk_rate_change_list.  This is used when undoing voltage requests after an
+ * error is encountered before any physical rate changing.
+ */
+static void clk_unvote_new_rate_vdd(void)
+{
+	struct clk_core *core;
+
+	list_for_each_entry(core, &clk_rate_change_list, rate_change_node) {
+		clk_unvote_vdd_level(core->vdd_class, core->new_vdd_class_vote);
+		core->new_vdd_class_vote = core->vdd_class_vote;
+	}
+}
+
+/*
+ * Unvote for the voltage level required for each core->vdd_class_vote in
+ * clk_rate_change_list.
+ */
+static int clk_unvote_old_rate_vdd(void)
+{
+	struct clk_core *core;
+	int ret;
+
+	list_for_each_entry(core, &clk_rate_change_list, rate_change_node) {
+		ret = clk_unvote_vdd_level(core->vdd_class,
+					   core->vdd_class_vote);
+		if (ret)
+			return ret;
+	}
+
+	return 0;
+}
+
+/*
+ * In the case that rate setting fails, apply the max voltage level needed
+ * by either the old or new rate for each changed clock.
+ */
+static void clk_vote_safe_vdd(void)
+{
+	struct clk_core *core;
+
+	list_for_each_entry(core, &clk_rate_change_list, rate_change_node) {
+		if (core->vdd_class_vote > core->new_vdd_class_vote) {
+			clk_vote_vdd_level(core->vdd_class,
+						core->vdd_class_vote);
+			clk_unvote_vdd_level(core->vdd_class,
+						core->new_vdd_class_vote);
+			core->new_vdd_class_vote = core->vdd_class_vote;
+		}
+	}
+}
+
+static void clk_cleanup_vdd_votes(void)
+{
+	struct clk_core *core, *temp;
+
+	list_for_each_entry_safe(core, temp, &clk_rate_change_list,
+				 rate_change_node) {
+		core->vdd_class_vote = core->new_vdd_class_vote;
+		list_del_init(&core->rate_change_node);
+	}
+}
 static int clk_core_set_rate_nolock(struct clk_core *core,
 				    unsigned long req_rate)
 {
 	struct clk_core *top, *fail_clk;
 	unsigned long rate = req_rate;
 	int ret = 0;
+	/*
+	 * The prepare lock ensures mutual exclusion with other tasks.
+	 * set_rate_nesting_count is a static so that it can be incremented in
+	 * the case of reentrancy caused by a set_rate() ops callback itself
+	 * calling clk_set_rate().  That way, the voltage level votes for the
+	 * old rates are safely removed when the original invocation of this
+	 * function completes.
+	 */
+	static unsigned int set_rate_nesting_count;
 
 	if (!core)
 		return 0;
@@ -1921,8 +2076,10 @@ static int clk_core_set_rate_nolock(struct clk_core *core,
 
 	/* calculate new rates and get the topmost changed clock */
 	top = clk_calc_new_rates(core, rate);
-	if (!top)
-		return -EINVAL;
+	if (!top) {
+		ret = -EINVAL;
+		goto pre_rate_change_err;
+	}
 
 	/* notify that we are about to change rates */
 	fail_clk = clk_propagate_rate_change(top, PRE_RATE_CHANGE);
@@ -1930,20 +2087,43 @@ static int clk_core_set_rate_nolock(struct clk_core *core,
 		pr_debug("%s: failed to set %s clock to run at %lu\n", __func__,
 				fail_clk->name, req_rate);
 		clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
-		return -EBUSY;
+		ret = -EBUSY;
+		goto pre_rate_change_err;
 	}
 
+
 	/* change the rates */
+	set_rate_nesting_count++;
 	ret = clk_change_rate(top);
+	set_rate_nesting_count--;
 	if (ret) {
 		pr_err("%s: failed to set %s clock to run at %lu\n", __func__,
 				top->name, req_rate);
 		clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
-		return ret;
+		clk_vote_safe_vdd();
+		goto post_rate_change_err;
 	}
 
 	core->req_rate = req_rate;
 
+post_rate_change_err:
+	/*
+	 * Only remove vdd_class level votes for old clock rates after all
+	 * nested clk_set_rate() calls have completed.
+	 */
+	if (set_rate_nesting_count == 0) {
+		ret |= clk_unvote_old_rate_vdd();
+		clk_cleanup_vdd_votes();
+	}
+
+	return ret;
+
+pre_rate_change_err:
+	if (set_rate_nesting_count == 0) {
+		clk_unvote_new_rate_vdd();
+		clk_cleanup_vdd_votes();
+	}
+
 	return ret;
 }
 
@@ -3688,6 +3868,7 @@ struct clk *clk_register(struct device *dev, struct clk_hw *hw)
 	};
 
 	INIT_HLIST_HEAD(&core->clks);
+	INIT_LIST_HEAD(&core->rate_change_node);
 
 	hw->clk = __clk_create_clk(hw, NULL, NULL);
 	if (IS_ERR(hw->clk)) {
diff --git a/drivers/clk/qcom/clk-cpu-osm.c b/drivers/clk/qcom/clk-cpu-osm.c
index 874a6f07b96e95c519278d1d43895301025534d6..7fe046cd25752ce282c7408d04a336da5650c85b 100644
--- a/drivers/clk/qcom/clk-cpu-osm.c
+++ b/drivers/clk/qcom/clk-cpu-osm.c
@@ -79,6 +79,7 @@ struct clk_osm {
 	u64 total_cycle_counter;
 	u32 prev_cycle_counter;
 	unsigned long rate;
+	cpumask_t related_cpus;
 };
 
 static bool is_sdmshrike;
@@ -560,7 +561,8 @@ static struct clk_osm *osm_configure_policy(struct cpufreq_policy *policy)
 		if (parent != c_parent)
 			continue;
 
-		cpumask_set_cpu(cpu, policy->cpus);
+		/* cpumask_set_cpu(cpu, policy->cpus); */
+		cpumask_set_cpu(cpu, &c->related_cpus);
 		if (n->core_num == 0)
 			first = n;
 	}
@@ -688,6 +690,9 @@ static int osm_cpufreq_cpu_init(struct cpufreq_policy *policy)
 	policy->dvfs_possible_from_any_cpu = true;
 	policy->fast_switch_possible = true;
 	policy->driver_data = c;
+
+	cpumask_copy(policy->cpus, &c->related_cpus);
+
 	return 0;
 
 err:
diff --git a/drivers/clk/qcom/clk-rcg2.c b/drivers/clk/qcom/clk-rcg2.c
index 01e82010f7e4b50dc863ae1155ccb04c9653b6b6..83b90a7305abbb4ebae896e73582b29af905573b 100644
--- a/drivers/clk/qcom/clk-rcg2.c
+++ b/drivers/clk/qcom/clk-rcg2.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2013, 2016-2019, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2013, 2016-2018, The Linux Foundation. All rights reserved.
  *
  * This software is licensed under the terms of the GNU General Public
  * License version 2, as published by the Free Software Foundation, and
@@ -391,6 +391,39 @@ static int clk_rcg2_determine_floor_rate(struct clk_hw *hw,
 	return _freq_tbl_determine_rate(hw, rcg->freq_tbl, req, FLOOR);
 }
 
+static bool clk_rcg2_current_config(struct clk_rcg2 *rcg,
+		const struct freq_tbl *f)
+{
+	struct clk_hw *hw = &rcg->clkr.hw;
+	u32 cfg, mask, new_cfg;
+	int index;
+
+	if (rcg->mnd_width) {
+	mask = BIT(rcg->mnd_width) - 1;
+	regmap_read(rcg->clkr.regmap, rcg->cmd_rcgr + M_REG, &cfg);
+	if ((cfg & mask) != (f->m & mask))
+		return false;
+
+	regmap_read(rcg->clkr.regmap, rcg->cmd_rcgr + N_REG, &cfg);
+	if ((cfg & mask) != (~(f->n - f->m) & mask))
+	return false;
+	}
+
+	mask = (BIT(rcg->hid_width) - 1) | CFG_SRC_SEL_MASK;
+
+	index = qcom_find_src_index(hw, rcg->parent_map, f->src);
+
+	new_cfg = ((f->pre_div << CFG_SRC_DIV_SHIFT) |
+	(rcg->parent_map[index].cfg << CFG_SRC_SEL_SHIFT)) & mask;
+
+	regmap_read(rcg->clkr.regmap, rcg->cmd_rcgr + CFG_REG, &cfg);
+
+	if (new_cfg != (cfg & mask))
+		 return false;
+
+	return true;
+}
+
 static int clk_rcg2_configure(struct clk_rcg2 *rcg, const struct freq_tbl *f)
 {
 	u32 cfg, mask, old_cfg;
@@ -1034,6 +1067,8 @@ static int clk_byte2_set_rate(struct clk_hw *hw, unsigned long rate,
 	for (i = 0; i < num_parents; i++) {
 		if (cfg == rcg->parent_map[i].cfg) {
 			f.src = rcg->parent_map[i].src;
+			if (clk_rcg2_current_config(rcg, &f))
+				return 0;
 			return clk_rcg2_configure(rcg, &f);
 		}
 	}
@@ -1130,6 +1165,9 @@ static int clk_pixel_set_rate(struct clk_hw *hw, unsigned long rate,
 		f.m = frac->num;
 		f.n = frac->den;
 
+		if (clk_rcg2_current_config(rcg, &f))
+		return 0;
+
 		return clk_rcg2_configure(rcg, &f);
 	}
 	return -EINVAL;
diff --git a/drivers/cpufreq/cpufreq.c b/drivers/cpufreq/cpufreq.c
index 93893c3aae16c0c468177742771dda67fa78069b..93cb5c93bc76a24cb7994d380d6cf9b8614b2ffd 100644
--- a/drivers/cpufreq/cpufreq.c
+++ b/drivers/cpufreq/cpufreq.c
@@ -32,7 +32,10 @@
 #include <linux/tick.h>
 #include <linux/sched/topology.h>
 
+#include <linux/pm_qos.h>
 #include <trace/events/power.h>
+#define GOLD_CPU_NUMBER 4
+#define GOLD_PLUS_CPU_NUMBER 7
 
 static LIST_HEAD(cpufreq_policy_list);
 
@@ -59,6 +62,29 @@ static LIST_HEAD(cpufreq_governor_list);
 #define for_each_governor(__governor)				\
 	list_for_each_entry(__governor, &cpufreq_governor_list, governor_list)
 
+struct qos_request_value {
+	bool flag;
+	unsigned int max_cpufreq;
+	unsigned int min_cpufreq;
+};
+static struct qos_request_value c0_qos_request_value = {
+	.flag = false,
+	.max_cpufreq = INT_MAX,
+	.min_cpufreq = MIN_CPUFREQ,
+};
+static struct qos_request_value c1_qos_request_value = {
+	.flag = false,
+	.max_cpufreq = INT_MAX,
+	.min_cpufreq = MIN_CPUFREQ,
+};
+static struct qos_request_value c2_qos_request_value = {
+	.flag = false,
+	.max_cpufreq = INT_MAX,
+	.min_cpufreq = MIN_CPUFREQ,
+};
+unsigned int cluster1_first_cpu = GOLD_CPU_NUMBER;
+unsigned int cluster2_first_cpu = GOLD_PLUS_CPU_NUMBER;
+
 /**
  * The "cpufreq driver" - the arch- or hardware-dependent low
  * level driver of CPUFreq support, and its spinlock. This lock
@@ -341,7 +367,8 @@ static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
 		pr_debug("FREQ: %lu - CPU: %lu\n",
 			 (unsigned long)freqs->new, (unsigned long)freqs->cpu);
 		trace_cpu_frequency(freqs->new, freqs->cpu);
-		cpufreq_stats_record_transition(policy, freqs->new);
+		if (freqs->new != policy->cur)
+			cpufreq_stats_record_transition(policy, freqs->new);
 		cpufreq_times_record_transition(freqs);
 		srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
 				CPUFREQ_POSTCHANGE, freqs);
@@ -1862,7 +1889,17 @@ EXPORT_SYMBOL(cpufreq_unregister_notifier);
 unsigned int cpufreq_driver_fast_switch(struct cpufreq_policy *policy,
 					unsigned int target_freq)
 {
+	struct qos_request_value *qos;
+
 	target_freq = clamp_val(target_freq, policy->min, policy->max);
+	if (policy->cpu >= cluster2_first_cpu)
+		qos = &c2_qos_request_value;
+	else {
+		qos = policy->cpu >= cluster1_first_cpu ?
+		&c1_qos_request_value : &c0_qos_request_value;
+	}
+	target_freq = clamp_val(target_freq, qos->min_cpufreq,
+				qos->max_cpufreq);
 
 	return cpufreq_driver->fast_switch(policy, target_freq);
 }
@@ -2619,3 +2656,285 @@ static int __init cpufreq_core_init(void)
 }
 module_param(off, int, 0444);
 core_initcall(cpufreq_core_init);
+
+static int get_c0_available_cpufreq(struct cpufreq_policy *policy)
+{
+	int max_cpufreq_index = -1, min_cpufreq_index = -1;
+	int max_index = -1;
+	int index_max = 0, index_min = 0;
+	struct cpufreq_frequency_table *table, *pos;
+
+	table = policy->freq_table;
+	if (!table) {
+		pr_err("cpufreq:Failed to get frequency table for CPU%u\n", 0);
+		return -EINVAL;
+	}
+
+	max_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C0_CPUFREQ_MAX);
+	min_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C0_CPUFREQ_MIN);
+
+	/* you can limit the min cpufreq*/
+	if (min_cpufreq_index > max_cpufreq_index)
+		max_cpufreq_index = min_cpufreq_index;
+
+	/* get the available cpufreq
+	 * lock for the max available cpufreq
+	 */
+	cpufreq_for_each_valid_entry(pos, table) {
+		max_index = pos - table;
+	}
+	if (max_cpufreq_index & MASK_CPUFREQ) {
+		index_max = MAX_CPUFREQ - max_cpufreq_index;
+		if (index_max > max_index)
+			index_max = 0;
+		index_max = max_index - index_max;
+	} else {
+		if (max_cpufreq_index > max_index)
+			index_max = max_index;
+	}
+	if (min_cpufreq_index & MASK_CPUFREQ) {
+		index_min = MAX_CPUFREQ - min_cpufreq_index;
+		if (index_min > max_index)
+			index_min = 0;
+		index_min = max_index - index_min;
+	} else {
+		if (min_cpufreq_index > max_index)
+			index_min = max_index;
+	}
+	c0_qos_request_value.max_cpufreq = table[index_max].frequency;
+	c0_qos_request_value.min_cpufreq = table[index_min].frequency;
+	pr_debug("c0::: m:%d, ii:%d-, mm:%d-", max_index, index_min, index_max);
+
+	return 0;
+}
+
+static int get_c1_available_cpufreq(struct cpufreq_policy *policy)
+{
+	int max_cpufreq_index = -1, min_cpufreq_index = -1;
+	int max_index = -1;
+	int index_max = 0, index_min = 0;
+	struct cpufreq_frequency_table *table, *pos;
+
+	table = policy->freq_table;
+	if (!table) {
+		pr_err("cpufreq: Failed to get frequency table for CPU\n");
+		return -EINVAL;
+	}
+
+	max_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C1_CPUFREQ_MAX);
+	min_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C1_CPUFREQ_MIN);
+
+	/* you can limit the min cpufreq*/
+	if (min_cpufreq_index > max_cpufreq_index)
+		max_cpufreq_index = min_cpufreq_index;
+
+	/* get the available cpufreq
+	 * lock for the max available cpufreq
+	 */
+	cpufreq_for_each_valid_entry(pos, table) {
+		max_index = pos - table;
+	}
+
+	/* add limits */
+	if (max_cpufreq_index & MASK_CPUFREQ) {
+		index_max = MAX_CPUFREQ - max_cpufreq_index;
+		if (index_max > max_index)
+			index_max = 0;
+		index_max = max_index - index_max;
+	} else {
+		if (max_cpufreq_index > max_index)
+			index_max = max_index;
+	}
+	if (min_cpufreq_index & MASK_CPUFREQ) {
+		index_min = MAX_CPUFREQ - min_cpufreq_index;
+		if (index_min > max_index)
+			index_min = 0;
+		index_min = max_index - index_min;
+	} else {
+		if (min_cpufreq_index > max_index)
+			index_min = max_index;
+	}
+	c1_qos_request_value.max_cpufreq = table[index_max].frequency;
+	c1_qos_request_value.min_cpufreq = table[index_min].frequency;
+	pr_debug("c1::: m:%d, ii:%d-, mm:%d-", max_index, index_min, index_max);
+
+	return 0;
+}
+
+static int get_c2_available_cpufreq(struct cpufreq_policy *policy)
+{
+	int max_cpufreq_index = -1, min_cpufreq_index = -1;
+	int max_index = -1;
+	int index_max = 0, index_min = 0;
+	struct cpufreq_frequency_table *table, *pos;
+
+	table = policy->freq_table;
+	if (!table) {
+		pr_err("cpufreq: Failed to get frequency table for CPU\n");
+		return -EINVAL;
+	}
+
+	max_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C2_CPUFREQ_MAX);
+	min_cpufreq_index = (unsigned int)pm_qos_request(PM_QOS_C2_CPUFREQ_MIN);
+
+	/* you can limit the min cpufreq*/
+	if (min_cpufreq_index > max_cpufreq_index)
+		max_cpufreq_index = min_cpufreq_index;
+
+	/* get the available cpufreq
+	 * lock for the max available cpufreq
+	 */
+	cpufreq_for_each_valid_entry(pos, table) {
+		max_index = pos - table;
+	}
+
+	/* add limits */
+	if (max_cpufreq_index & MASK_CPUFREQ) {
+		index_max = MAX_CPUFREQ - max_cpufreq_index;
+		if (index_max > max_index)
+			index_max = 0;
+		index_max = max_index - index_max;
+	} else {
+		if (max_cpufreq_index > max_index)
+			index_max = max_index;
+	}
+	if (min_cpufreq_index & MASK_CPUFREQ) {
+		index_min = MAX_CPUFREQ - min_cpufreq_index;
+		if (index_min > max_index)
+			index_min = 0;
+		index_min = max_index - index_min;
+	} else {
+		if (min_cpufreq_index > max_index)
+			index_min = max_index;
+	}
+	c2_qos_request_value.max_cpufreq = table[index_max].frequency;
+	c2_qos_request_value.min_cpufreq = table[index_min].frequency;
+	pr_debug("c2::: m:%d, ii:%d-, mm:%d-", max_index, index_min, index_max);
+
+	return 0;
+}
+
+static int c0_cpufreq_qos_handler(struct notifier_block *b,
+				unsigned long val, void *v)
+{
+	struct cpufreq_policy *policy;
+	int ret = -1;
+
+	policy = cpufreq_cpu_get(0);
+
+	if (!policy)
+		return NOTIFY_BAD;
+
+	if (!policy->governor) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+
+	if (strcmp(policy->governor->name, "schedutil")) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_OK;
+	}
+
+	ret = get_c0_available_cpufreq(policy);
+	if (ret) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+	cpufreq_driver_fast_switch(policy, c0_qos_request_value.min_cpufreq);
+
+	cpufreq_cpu_put(policy);
+	return NOTIFY_OK;
+}
+
+static struct notifier_block c0_cpufreq_qos_notifier = {
+	.notifier_call = c0_cpufreq_qos_handler,
+};
+
+static int c1_cpufreq_qos_handler(struct notifier_block *b,
+				unsigned long val, void *v)
+{
+	struct cpufreq_policy *policy;
+	int ret = -1;
+
+	policy = cpufreq_cpu_get(cluster1_first_cpu);
+
+	if (!policy)
+		return NOTIFY_BAD;
+
+	if (!policy->governor) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+
+	if (strcmp(policy->governor->name, "schedutil")) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_OK;
+	}
+
+	ret = get_c1_available_cpufreq(policy);
+	if (ret) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+
+	cpufreq_driver_fast_switch(policy, c1_qos_request_value.min_cpufreq);
+
+	cpufreq_cpu_put(policy);
+
+	return NOTIFY_OK;
+}
+
+static struct notifier_block c1_cpufreq_qos_notifier = {
+	.notifier_call = c1_cpufreq_qos_handler,
+};
+
+static int c2_cpufreq_qos_handler(struct notifier_block *b,
+				unsigned long val, void *v)
+{
+	struct cpufreq_policy *policy;
+	int ret = -1;
+
+	policy = cpufreq_cpu_get(cluster2_first_cpu);
+
+	if (!policy)
+		return NOTIFY_BAD;
+
+	if (!policy->governor) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+
+	if (strcmp(policy->governor->name, "schedutil")) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_OK;
+	}
+
+	ret = get_c2_available_cpufreq(policy);
+	if (ret) {
+		cpufreq_cpu_put(policy);
+		return NOTIFY_BAD;
+	}
+
+	cpufreq_driver_fast_switch(policy, c2_qos_request_value.min_cpufreq);
+
+	cpufreq_cpu_put(policy);
+
+	return NOTIFY_OK;
+}
+
+static struct notifier_block c2_cpufreq_qos_notifier = {
+	.notifier_call = c2_cpufreq_qos_handler,
+};
+
+static int __init pm_qos_notifier_init(void)
+{
+	/* add cpufreq qos notify */
+	pm_qos_add_notifier(PM_QOS_C0_CPUFREQ_MAX, &c0_cpufreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_C0_CPUFREQ_MIN, &c0_cpufreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_C1_CPUFREQ_MAX, &c1_cpufreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_C1_CPUFREQ_MIN, &c1_cpufreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_C2_CPUFREQ_MAX, &c2_cpufreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_C2_CPUFREQ_MIN, &c2_cpufreq_qos_notifier);
+	return 0;
+}
+subsys_initcall(pm_qos_notifier_init);
diff --git a/drivers/cpufreq/cpufreq_performance.c b/drivers/cpufreq/cpufreq_performance.c
index dafb679adc589ed533ef6dd02c186fb5ed03f4cc..3674faffe8d18ee53c3e72829d28a3a4b336b8cf 100644
--- a/drivers/cpufreq/cpufreq_performance.c
+++ b/drivers/cpufreq/cpufreq_performance.c
@@ -15,11 +15,45 @@
 #include <linux/cpufreq.h>
 #include <linux/init.h>
 #include <linux/module.h>
+#include <linux/oneplus/boot_mode.h>
+
+#define CPUFREQ_INDEX 5
 
 static void cpufreq_gov_performance_limits(struct cpufreq_policy *policy)
 {
+	unsigned int index = 0;
+	unsigned int valid_freq;
+	struct cpufreq_frequency_table *table, *pos;
+	static unsigned int first_cpu = 1010;
+
 	pr_debug("setting to %u kHz\n", policy->max);
-	__cpufreq_driver_target(policy, policy->max, CPUFREQ_RELATION_H);
+	if (get_boot_mode() ==  MSM_BOOT_MODE__WLAN
+		|| (get_boot_mode() ==  MSM_BOOT_MODE__RF)
+		|| (get_boot_mode() ==  MSM_BOOT_MODE__FACTORY)) {
+		if (first_cpu != cpumask_first(policy->related_cpus))
+			first_cpu = cpumask_first(policy->related_cpus);
+			table = policy->freq_table;
+			if (!table) {
+				pr_err("Failed to get freqtable\n");
+			} else {
+				for (pos = table; pos->frequency
+					!= CPUFREQ_TABLE_END; pos++)
+					index++;
+				if (index > CPUFREQ_INDEX)
+					index = index - CPUFREQ_INDEX;
+				valid_freq = table[index].frequency;
+				if (valid_freq)
+					__cpufreq_driver_target(policy,
+						valid_freq,
+						CPUFREQ_RELATION_H);
+				else
+					__cpufreq_driver_target(policy,
+						policy->max,
+						CPUFREQ_RELATION_H);
+			}
+	} else
+		__cpufreq_driver_target(policy, policy->max,
+						CPUFREQ_RELATION_H);
 }
 
 static struct cpufreq_governor cpufreq_gov_performance = {
diff --git a/drivers/cpufreq/cpufreq_stats.c b/drivers/cpufreq/cpufreq_stats.c
index e75880eb037d3b358b8afcfa80fa5d8b41353610..994e630ed91085033e4e737b927c8fcae24b34a2 100644
--- a/drivers/cpufreq/cpufreq_stats.c
+++ b/drivers/cpufreq/cpufreq_stats.c
@@ -29,12 +29,13 @@ struct cpufreq_stats {
 
 static int cpufreq_stats_update(struct cpufreq_stats *stats)
 {
+	unsigned long flags;
 	unsigned long long cur_time = get_jiffies_64();
 
-	spin_lock(&cpufreq_stats_lock);
+	spin_lock_irqsave(&cpufreq_stats_lock, flags);
 	stats->time_in_state[stats->last_index] += cur_time - stats->last_time;
 	stats->last_time = cur_time;
-	spin_unlock(&cpufreq_stats_lock);
+	spin_unlock_irqrestore(&cpufreq_stats_lock, flags);
 	return 0;
 }
 
@@ -59,8 +60,6 @@ static ssize_t show_time_in_state(struct cpufreq_policy *policy, char *buf)
 	ssize_t len = 0;
 	int i;
 
-	if (policy->fast_switch_enabled)
-		return 0;
 
 	cpufreq_stats_update(stats);
 	for (i = 0; i < stats->state_num; i++) {
@@ -85,8 +84,6 @@ static ssize_t show_trans_table(struct cpufreq_policy *policy, char *buf)
 	ssize_t len = 0;
 	int i, j;
 
-	if (policy->fast_switch_enabled)
-		return 0;
 
 	len += snprintf(buf + len, PAGE_SIZE - len, "   From  :    To\n");
 	len += snprintf(buf + len, PAGE_SIZE - len, "         : ");
@@ -235,7 +232,7 @@ void cpufreq_stats_record_transition(struct cpufreq_policy *policy,
 	new_index = freq_table_get_index(stats, new_freq);
 
 	/* We can't do stats->time_in_state[-1]= .. */
-	if (old_index == -1 || new_index == -1 || old_index == new_index)
+	if (new_index == -1)
 		return;
 
 	cpufreq_stats_update(stats);
diff --git a/drivers/cpuidle/lpm-levels.c b/drivers/cpuidle/lpm-levels.c
index 7553ee21b6f97a376c26bdaefe7e2e25d535ec7e..953d99f8f2d5aa556d55a6a00bd889cee719881b 100644
--- a/drivers/cpuidle/lpm-levels.c
+++ b/drivers/cpuidle/lpm-levels.c
@@ -126,6 +126,12 @@ module_param_named(print_parsed_dt, print_parsed_dt, bool, 0664);
 static bool sleep_disabled;
 module_param_named(sleep_disabled, sleep_disabled, bool, 0664);
 
+void msm_cpuidle_set_sleep_disable(bool disable)
+{
+	sleep_disabled = disable;
+	pr_info("%s:sleep_disabled=%d\n", __func__, disable);
+}
+
 /**
  * msm_cpuidle_get_deep_idle_latency - Get deep idle latency value
  *
diff --git a/drivers/devfreq/devfreq.c b/drivers/devfreq/devfreq.c
index 586691521ec2377a20a90871b74b637fd45cde2b..9e79d52e0b01af7c978c1f8adff93cb77e002843 100644
--- a/drivers/devfreq/devfreq.c
+++ b/drivers/devfreq/devfreq.c
@@ -464,7 +464,9 @@ void devfreq_interval_update(struct devfreq *devfreq, unsigned int *delay)
 		mutex_unlock(&devfreq->lock);
 		cancel_delayed_work_sync(&devfreq->work);
 		mutex_lock(&devfreq->lock);
-		if (!devfreq->stop_polling)
+
+		if (!devfreq->stop_polling
+			&& !delayed_work_pending(&devfreq->work))
 			queue_delayed_work(devfreq_wq, &devfreq->work,
 			      msecs_to_jiffies(devfreq->profile->polling_ms));
 	}
diff --git a/drivers/devfreq/devfreq_devbw.c b/drivers/devfreq/devfreq_devbw.c
index e7fcc11a2c08cf291cd95bbe420a0806b788a6a6..ed46634cb244e695fb90e6cbd9afef1030e83720 100644
--- a/drivers/devfreq/devfreq_devbw.c
+++ b/drivers/devfreq/devfreq_devbw.c
@@ -35,6 +35,19 @@
 #define MAX_PATHS	2
 #define DBL_BUF		2
 
+#include <linux/pm_qos.h>
+struct qos_request_v {
+	int max_state;
+	int max_devfreq;
+	int min_devfreq;
+};
+
+static bool cpubw_flag;
+static struct qos_request_v qos_request_value = {
+	.max_state = 0,
+	.max_devfreq = INT_MAX,
+	.min_devfreq = 0,
+};
 struct dev_data {
 	struct msm_bus_vectors vectors[MAX_PATHS * DBL_BUF];
 	struct msm_bus_paths bw_levels[DBL_BUF];
@@ -78,6 +91,50 @@ static int set_bw(struct device *dev, int new_ib, int new_ab)
 	return ret;
 }
 
+static void find_freq_cpubw(struct devfreq_dev_profile *p, unsigned long *freq,
+				u32 flags)
+{
+	int i;
+	unsigned long atmost, atleast, f;
+	int min_index, max_index;
+
+	min_index = qos_request_value.min_devfreq;
+	if (p->max_state > qos_request_value.max_devfreq)
+		max_index = qos_request_value.max_devfreq;
+	else
+		max_index = p->max_state;
+
+	atmost = p->freq_table[min_index];
+	atleast = p->freq_table[max_index-1];
+
+	for (i = min_index; i < max_index; i++) {
+		f = p->freq_table[i];
+		if (f <= *freq)
+			atmost = max(f, atmost);
+		if (f >= *freq)
+			atleast = min(f, atleast);
+	}
+
+	if (flags & DEVFREQ_FLAG_LEAST_UPPER_BOUND)
+		*freq = atmost;
+	else
+		*freq = atleast;
+}
+
+static int devbw_target_cpubw(struct device *dev, unsigned long *freq,
+				u32 flags)
+{
+	struct dev_data *d = dev_get_drvdata(dev);
+	struct dev_pm_opp *opp;
+
+	opp = devfreq_recommended_opp(dev, freq, flags);
+	if (!IS_ERR(opp))
+		dev_pm_opp_put(opp);
+	find_freq_cpubw(&d->dp, freq, flags);
+
+	return set_bw(dev, *freq, d->gov_ab);
+}
+
 static int devbw_target(struct device *dev, unsigned long *freq, u32 flags)
 {
 	struct dev_data *d = dev_get_drvdata(dev);
@@ -99,6 +156,44 @@ static int devbw_get_dev_status(struct device *dev,
 	return 0;
 }
 
+static int devfreq_qos_handler(struct notifier_block *b, unsigned long val,
+				void *v)
+{
+	unsigned int max_devfreq_index, min_devfreq_index;
+	unsigned int index_max = 0, index_min = 0;
+
+	max_devfreq_index = (unsigned int)pm_qos_request(PM_QOS_DEVFREQ_MAX);
+	min_devfreq_index = (unsigned int)pm_qos_request(PM_QOS_DEVFREQ_MIN);
+
+	/* add limit */
+	if (max_devfreq_index & MASK_CPUFREQ) {
+		index_max = MAX_CPUFREQ - max_devfreq_index;
+		if (index_max > qos_request_value.max_state)
+			index_max = 0;
+		index_max = qos_request_value.max_state - index_max;
+	} else {
+		if (max_devfreq_index > qos_request_value.max_state)
+			index_max = qos_request_value.max_state;
+	}
+	if (min_devfreq_index & MASK_CPUFREQ) {
+		index_min = MAX_CPUFREQ - min_devfreq_index;
+		if (index_min > (qos_request_value.max_state-1))
+			index_min = 0;
+		index_min = qos_request_value.max_state - 1 - index_min;
+	} else {
+		if (min_devfreq_index > qos_request_value.max_state)
+			index_min = qos_request_value.max_state - 1;
+	}
+
+	qos_request_value.min_devfreq = index_min;
+	qos_request_value.max_devfreq = index_max;
+
+	return NOTIFY_OK;
+}
+static struct notifier_block devfreq_qos_notifier = {
+	.notifier_call = devfreq_qos_handler,
+};
+
 #define PROP_PORTS "qcom,src-dst-ports"
 #define PROP_ACTIVE "qcom,active-only"
 
@@ -152,7 +247,13 @@ int devfreq_add_devbw(struct device *dev)
 
 	p = &d->dp;
 	p->polling_ms = 50;
-	p->target = devbw_target;
+
+	if (strnstr(d->bw_data.name, "soc:qcom,cpu-cpu-llcc-bw",
+				strlen(d->bw_data.name)) != NULL) {
+		p->target = devbw_target_cpubw;
+		cpubw_flag = true;
+	} else
+		p->target = devbw_target;
 	p->get_dev_status = devbw_get_dev_status;
 
 	ret = dev_pm_opp_of_add_table(dev);
@@ -174,6 +275,12 @@ int devfreq_add_devbw(struct device *dev)
 		return PTR_ERR(d->df);
 	}
 
+	if (cpubw_flag) {
+		cpubw_flag = false;
+		qos_request_value.max_state = p->max_state;
+		qos_request_value.min_devfreq = 0;
+		qos_request_value.max_devfreq = p->max_state;
+	}
 	return 0;
 }
 
@@ -221,10 +328,20 @@ static struct platform_driver devbw_driver = {
 	.driver = {
 		.name = "devbw",
 		.of_match_table = devbw_match_table,
+		.owner = THIS_MODULE,
 		.suppress_bind_attrs = true,
 	},
 };
 
-module_platform_driver(devbw_driver);
+static int __init devbw_init(void)
+{
+	/* add cpufreq qos notify */
+	cpubw_flag = false;
+	pm_qos_add_notifier(PM_QOS_DEVFREQ_MAX, &devfreq_qos_notifier);
+	pm_qos_add_notifier(PM_QOS_DEVFREQ_MIN, &devfreq_qos_notifier);
+	platform_driver_register(&devbw_driver);
+	return 0;
+}
+device_initcall(devbw_init);
 MODULE_DESCRIPTION("Device DDR bandwidth voting driver MSM SoCs");
 MODULE_LICENSE("GPL v2");
diff --git a/drivers/esoc/esoc-mdm-drv.c b/drivers/esoc/esoc-mdm-drv.c
index 6b343fa57846a6832707a7cc2e1f094be29cfc68..3c64a2fb452e113cb0109fc692e30ea174cd376c 100644
--- a/drivers/esoc/esoc-mdm-drv.c
+++ b/drivers/esoc/esoc-mdm-drv.c
@@ -18,6 +18,7 @@
 #include "esoc.h"
 #include "esoc-mdm.h"
 #include "mdm-dbg.h"
+#include <linux/oneplus/boot_mode.h>
 
 /* Default number of powerup trial requests per session */
 #define ESOC_DEF_PON_REQ	2
@@ -39,6 +40,8 @@ module_param(boot_fail_action, uint, 0644);
 MODULE_PARM_DESC(boot_fail_action,
 "Actions: 0:Retry PON; 1:Cold reset; 2:Power-down; 3:APQ Panic; 4:No action");
 
+bool modem_5G_panic;
+
 enum esoc_pon_state {
 	PON_INIT,
 	PON_SUCCESS,
@@ -343,7 +346,10 @@ static int mdm_handle_boot_fail(struct esoc_clink *esoc_clink, u8 *pon_trial)
 		break;
 	case BOOT_FAIL_ACTION_PANIC:
 		esoc_mdm_log("Calling panic!!\n");
-		panic("Panic requested on external modem boot failure\n");
+		if (get_second_board_absent() == 0)
+		  panic("Panic requested on external modem boot failure\n");
+		else
+		  pr_err("Panic requested on external modem boot failure\n");
 		break;
 	case BOOT_FAIL_ACTION_NOP:
 		esoc_mdm_log("Leaving the modem in its curent state\n");
@@ -367,8 +373,10 @@ static int mdm_subsys_powerup(const struct subsys_desc *crashed_subsys)
 								subsys);
 	struct mdm_drv *mdm_drv = esoc_get_drv_data(esoc_clink);
 	const struct esoc_clink_ops * const clink_ops = esoc_clink->clink_ops;
+	struct mdm_ctrl *mdm = get_esoc_clink_data(mdm_drv->esoc_clink);
 	int timeout = INT_MAX;
 	u8 pon_trial = 1;
+	modem_5G_panic = false;
 
 	esoc_mdm_log("Powerup request from SSR\n");
 
@@ -438,11 +446,29 @@ static int mdm_subsys_powerup(const struct subsys_desc *crashed_subsys)
 			"Boot failed. Doing cleanup and attempting to retry\n");
 			pon_trial++;
 			mdm_subsys_retry_powerup_cleanup(esoc_clink);
+			if (!oem_get_download_mode()) {
+				pr_err("[MDM] DumpMode is disabled. Skip trigger 5G dump\n");
+			} else {
+				pr_err("[MDM] Crash Trigger\n");
+				modem_5G_panic = true;
+			}
 		} else if (mdm_drv->pon_state == PON_SUCCESS) {
 			break;
 		}
 	} while (pon_trial <= n_pon_tries);
 
+	//because two times powerup flow, make sure SDX50 is ready
+	pr_err("[MDM] Roland: check 5G dump gpio\n");
+	if (gpio_get_value(MDM_GPIO(mdm, MDM2AP_STATUS)) == 1) {
+		pr_err("[MDM] gpio check pass, 5g flag [%d]\n", modem_5G_panic);
+		if (modem_5G_panic == true) {
+			pr_err("[MDM] Power done SDX50 and wait 5s\n");
+			msleep(5000);
+			mdm_power_down(mdm);
+			panic("get the SDX50 dump"); // warm reset device
+		}
+	}
+
 	return 0;
 }
 
diff --git a/drivers/extcon/Kconfig b/drivers/extcon/Kconfig
index a7bca4207f447a72caf33edd96327d0ecd811c0f..c844dd6637ef951d2fadfcea3fedc16a6b380a57 100644
--- a/drivers/extcon/Kconfig
+++ b/drivers/extcon/Kconfig
@@ -157,4 +157,17 @@ config EXTCON_USBC_CROS_EC
 	  Say Y here to enable USB Type C cable detection extcon support when
 	  using Chrome OS EC based USB Type-C ports.
 
+config TRI_STATE_KEY
+        default n
+        tristate "switch Profiles by this triple key"
+        help
+        Say Y here if you want to enable the feature.
+
+config HALL_TRI_STATE_KEY
+        default n
+        tristate "switch Profiles by this triple key"
+        help
+        Say Y here if you want to enable the feature.
 endif
+
+source "drivers/extcon/hall_ic/Kconfig"
diff --git a/drivers/extcon/Makefile b/drivers/extcon/Makefile
index 0888fdeded7230de9ca368e4af3efa3529451211..ad346e6a1a2e35e465cae299ecefda4f35d84c67 100644
--- a/drivers/extcon/Makefile
+++ b/drivers/extcon/Makefile
@@ -22,3 +22,6 @@ obj-$(CONFIG_EXTCON_RT8973A)	+= extcon-rt8973a.o
 obj-$(CONFIG_EXTCON_SM5502)	+= extcon-sm5502.o
 obj-$(CONFIG_EXTCON_USB_GPIO)	+= extcon-usb-gpio.o
 obj-$(CONFIG_EXTCON_USBC_CROS_EC) += extcon-usbc-cros-ec.o
+obj-$(CONFIG_SENSOR_HALL_MXM1120)	+=hall_ic/
+obj-$(CONFIG_TRI_STATE_KEY)     += tri_state_key.o
+obj-$(CONFIG_HALL_TRI_STATE_KEY)		+= oneplus_tri_key.o
\ No newline at end of file
diff --git a/drivers/extcon/hall_ic/Kconfig b/drivers/extcon/hall_ic/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..b6ce56cad6cebaef688e11875913bede08c8f271
--- /dev/null
+++ b/drivers/extcon/hall_ic/Kconfig
@@ -0,0 +1,5 @@
+config SENSOR_HALL_MXM1120
+	tristate "digital hall m1120 Controler"
+	default n
+	help
+		Say Y here to enable m1120.
\ No newline at end of file
diff --git a/drivers/extcon/hall_ic/Makefile b/drivers/extcon/hall_ic/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..9f6752810ab3ab6841c541ffca56779fac71ff1d
--- /dev/null
+++ b/drivers/extcon/hall_ic/Makefile
@@ -0,0 +1,14 @@
+# SPDX-License-Identifier: GPL-2.0
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_SENSOR_HALL_MXM1120)	+=  hall_mxm1120_up.o hall_mxm1120_down.o 
+
+#obj-y 	+= mxm1120_up.o mxm1120_down.o
+#mxm1120_down.o
+
+
+
diff --git a/drivers/extcon/hall_ic/hall_mxm1120.h b/drivers/extcon/hall_ic/hall_mxm1120.h
new file mode 100644
index 0000000000000000000000000000000000000000..8cf4509e69eb9a6cbf9276e094b3a4f4cf089441
--- /dev/null
+++ b/drivers/extcon/hall_ic/hall_mxm1120.h
@@ -0,0 +1,307 @@
+#ifndef __MXM1120_H__
+#define __MXM1120_H__
+
+#include <linux/ioctl.h>
+#include <linux/mutex.h>
+
+/* ********************************************************* */
+/* feature of ic revision */
+/* ********************************************************* */
+#define M1120_REV_0_2                       (0x02)
+#define M1120_REV_1_0                       (0x10)
+#define M1120_REV                           M1120_REV_1_0
+#define M1120_DRIVER_VERSION                "Ver1.04-140226"
+/* ********************************************************* */
+
+/* ********************************************************* */
+/* property of driver */
+/* ********************************************************* */
+#define M1120_DRIVER_NAME_UP                   "hall_m1120_up"
+#define M1120_DRIVER_NAME_MIDDLE                 "m1120_middle"
+#define M1120_DRIVER_NAME_DOWN                 "hall_m1120_down"
+#define M1120_IRQ_NAME                      "m1120-irq"
+#define M1120_PATH                          "/dev/m1120"
+
+/*
+SAD1 SAD0 == 00  0001100 R/W   (7bits)0x0C  (8bits)0x18
+SAD1 SAD0 == 01  0001101 R/W   (7bits)0x0D  (8bits)0x1A
+SAD1 SAD0 == 10  0001110 R/W   (7bits)0x0E  (8bits)0x1C
+SAD1 SAD0 == 11  0001111 R/W   (7bits)0x0F  (8bits)0x1E
+*/
+#define M1120_SLAVE_ADDR                    (0x18)
+/* ********************************************************* */
+
+/* ********************************************************* */
+/* register map */
+/* ********************************************************* */
+#define M1120_REG_PERSINT                   (0x00)
+#define M1120_VAL_PERSINT_COUNT(n)          (n<<4)
+#define M1120_VAL_PERSINT_INTCLR            (0x01)
+    /*
+        [7:4]   PERS        : interrupt persistence count
+        [0]     INTCLR  = 1 : interrupt clear
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_INTSRS                    (0x01)
+#define M1120_VAL_INTSRS_INT_ON             (0x80)
+#define M1120_DETECTION_MODE_INTERRUPT      M1120_VAL_INTSRS_INT_ON
+#define M1120_VAL_INTSRS_INT_OFF            (0x00)
+#define M1120_DETECTION_MODE_POLLING        M1120_VAL_INTSRS_INT_OFF
+#define M1120_VAL_INTSRS_INTTYPE_BESIDE     (0x00)
+#define M1120_VAL_INTSRS_INTTYPE_WITHIN     (0x10)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_068mT  (0x00)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_034mT  (0x01)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_017mT  (0x02)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_009mT  (0x03)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_004mT  (0x04)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_272mT   (0x00)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_136mT   (0x01)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_068mT   (0x02)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_036mT   (0x03)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_016mT   (0x04)
+    /*
+        [7]     INTON   = 0 : disable interrupt
+        [7]     INTON   = 1 : enable interrupt
+        [4]     INT_TYP  = 0 : generate interrupt when raw data is beside range of threshold
+        [4]     INT_TYP  = 1 : generate interrupt when raw data is within range of threshold
+        [2:0]   SRS         : select sensitivity type when M1120_VAL_OPF_BIT_10
+                    000     : 0.068 (mT/LSB)
+                    001     : 0.034 (mT/LSB)
+                    010     : 0.017 (mT/LSB)
+                    011     : 0.009 (mT/LSB)
+                    100     : 0.004 (mT/LSB)
+                    101     : 0.017 (mT/LSB)
+                    110     : 0.017 (mT/LSB)
+                    111     : 0.017 (mT/LSB)
+        [2:0]   SRS         : select sensitivity type when M1120_VAL_OPF_BIT_8
+                    000     : 0.272 (mT/LSB)
+                    001     : 0.136 (mT/LSB)
+                    010     : 0.068 (mT/LSB)
+                    011     : 0.036 (mT/LSB)
+                    100     : 0.016 (mT/LSB)
+                    101     : 0.068 (mT/LSB)
+                    110     : 0.068 (mT/LSB)
+                    111     : 0.068 (mT/LSB)
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_LTHL                      (0x02)
+    /*
+        [7:0]   LTHL        : low byte of low threshold value
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_LTHH                      (0x03)
+    /*
+        [7:6]   LTHH        : high 2bits of low threshold value with sign
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_HTHL                      (0x04)
+    /*
+        [7:0]   HTHL        : low byte of high threshold value
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_HTHH                      (0x05)
+    /*
+        [7:6]   HTHH        : high 2bits of high threshold value with sign
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_I2CDIS                    (0x06)
+#define M1120_VAL_I2CDISABLE                (0x37)
+    /*
+        [7:0]   I2CDIS      : disable i2c
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_SRST                      (0x07)
+#define M1120_VAL_SRST_RESET                (0x01)
+    /*
+        [0]     SRST    = 1 : soft reset
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_OPF                       (0x08)
+#define M1120_VAL_OPF_FREQ_20HZ             (0x00)
+#define M1120_VAL_OPF_FREQ_10HZ             (0x10)
+#define M1120_VAL_OPF_FREQ_6_7HZ            (0x20)
+#define M1120_VAL_OPF_FREQ_5HZ              (0x30)
+#define M1120_VAL_OPF_FREQ_80HZ             (0x40)
+#define M1120_VAL_OPF_FREQ_40HZ             (0x50)
+#define M1120_VAL_OPF_FREQ_26_7HZ           (0x60)
+#define M1120_VAL_OPF_EFRD_ON               (0x08)
+#define M1120_VAL_OPF_BIT_8                 (0x02)
+#define M1120_VAL_OPF_BIT_10                (0x00)
+#define M1120_VAL_OPF_HSSON_ON              (0x01)
+#define M1120_VAL_OPF_HSSON_OFF             (0x00)
+    /*
+        [6:4]   OPF         : operation frequency
+                    000     : 20    (Hz)
+                    001     : 10    (Hz)
+                    010     : 6.7   (Hz)
+                    011     : 5     (Hz)
+                    100     : 80    (Hz)
+                    101     : 40    (Hz)
+                    110     : 26.7  (Hz)
+                    111     : 20    (Hz)
+        [3]     EFRD    = 0 : keep data without accessing eFuse
+        [3]     EFRD    = 1 : update data after accessing eFuse
+        [1]     BIT     = 0 : 10 bit resolution
+        [1]     BIT     = 1 : 8 bit resolution
+        [0]     HSSON   = 0 : Off power down mode
+        [0]     HSSON   = 1 : On power down mode
+
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_DID                       (0x09)
+#define M1120_VAL_DID                       (0x9C)
+    /*
+        [7:0]   DID         : Device ID
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_INFO                      (0x0A)
+    /*
+        [7:0]   INFO        : Information about IC
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_ASA                       (0x0B)
+    /*
+        [7:0]   ASA         : Hall Sensor sensitivity adjustment
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_ST1                       (0x10)
+#define M1120_VAL_ST1_DRDY                  (0x01)
+    /*
+        [4] INTM            : status of interrupt mode
+        [1] BITM            : status of resolution
+        [0] DRDY            : status of data ready
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_HSL                       (0x11)
+    /*
+        [7:0]   HSL         : low byte of hall sensor measurement data
+    */
+/* --------------------------------------------------------- */
+#define M1120_REG_HSH                       (0x12)
+    /*
+        [7:6]   HSL         : high 2bits of hall sensor measurement data with sign
+    */
+/* ********************************************************* */
+
+
+/* ********************************************************* */
+
+
+/* ********************************************************* */
+/* ioctl command */
+/* ********************************************************* */
+#define M1120_IOCTL_BASE                    (0x80)
+#define M1120_IOCTL_SET_ENABLE              _IOW(M1120_IOCTL_BASE, 0x00, int)
+#define M1120_IOCTL_GET_ENABLE              _IOR(M1120_IOCTL_BASE, 0x01, int)
+#define M1120_IOCTL_SET_DELAY               _IOW(M1120_IOCTL_BASE, 0x02, int)
+#define M1120_IOCTL_GET_DELAY               _IOR(M1120_IOCTL_BASE, 0x03, int)
+#define M1120_IOCTL_SET_CALIBRATION         _IOW(M1120_IOCTL_BASE, 0x04, int*)
+#define M1120_IOCTL_GET_CALIBRATED_DATA     _IOR(M1120_IOCTL_BASE, 0x05, int*)
+#define M1120_IOCTL_SET_INTERRUPT           _IOW(M1120_IOCTL_BASE, 0x06, unsigned int)
+#define M1120_IOCTL_GET_INTERRUPT           _IOR(M1120_IOCTL_BASE, 0x07, unsigned int*)
+#define M1120_IOCTL_SET_THRESHOLD_HIGH      _IOW(M1120_IOCTL_BASE, 0x08, unsigned int)
+#define M1120_IOCTL_GET_THRESHOLD_HIGH      _IOR(M1120_IOCTL_BASE, 0x09, unsigned int*)
+#define M1120_IOCTL_SET_THRESHOLD_LOW       _IOW(M1120_IOCTL_BASE, 0x0A, unsigned int)
+#define M1120_IOCTL_GET_THRESHOLD_LOW       _IOR(M1120_IOCTL_BASE, 0x0B, unsigned int*)
+#define M1120_IOCTL_SET_REG                 _IOW(M1120_IOCTL_BASE, 0x0C, int)
+#define M1120_IOCTL_GET_REG                 _IOR(M1120_IOCTL_BASE, 0x0D, int)
+/* ********************************************************* */
+
+
+/* ********************************************************* */
+/* event property */
+/* ********************************************************* */
+#define DEFAULT_EVENT_TYPE                  EV_ABS
+#define DEFAULT_EVENT_CODE                  ABS_X
+#define DEFAULT_EVENT_DATA_CAPABILITY_MIN   (-32768)
+#define DEFAULT_EVENT_DATA_CAPABILITY_MAX   (32767)
+/* ********************************************************* */
+/* delay property */
+/* ********************************************************* */
+#define M1120_DELAY_MAX                     (200)   // ms
+#define M1120_DELAY_MIN                     (20)    // ms
+#define M1120_DELAY_FOR_READY               (10)    // ms
+/* ********************************************************* */
+
+
+/* ********************************************************* */
+/* data type for driver */
+/* ********************************************************* */
+
+enum {
+    OPERATION_MODE_POWERDOWN,
+    OPERATION_MODE_MEASUREMENT,
+    OPERATION_MODE_FUSEROMACCESS
+};
+
+#define M1120_REG_NUM                       (15)
+typedef union {
+    struct {
+        unsigned char persint;
+        unsigned char intsrs;
+        unsigned char lthl;
+        unsigned char lthh;
+        unsigned char hthl;
+        unsigned char hthh;
+        unsigned char i2cdis;
+        unsigned char srst;
+        unsigned char opf;
+        unsigned char did;
+        unsigned char info;
+        unsigned char asa;
+        unsigned char st1;
+        unsigned char hsl;
+        unsigned char hsh;
+    } map;
+    unsigned char array[M1120_REG_NUM];
+} m1120_reg_t;
+
+typedef struct {
+    struct mutex    enable;
+    struct mutex    data;
+} m1120_mutex_t;
+
+typedef struct {
+    atomic_t enable;
+    atomic_t delay;
+    atomic_t debug;
+} m1120_atomic_t;
+
+typedef struct {
+    int                 power_vi2c;
+    int                 power_vdd;
+    int                 interrupt_gpio;
+    int                 interrupt_irq;
+} m1120_platform_data_t;
+
+typedef struct {
+    struct i2c_client   *client;
+    struct input_dev    *input_dev;
+    m1120_mutex_t       mtx;
+    m1120_atomic_t      atm;
+    m1120_reg_t         reg;
+    bool                irq_enabled;
+    int                 calibrated_data;
+    int                 last_data;
+    short               thrhigh;
+    short               thrlow;
+    bool                irq_first;
+
+    struct delayed_work work;
+
+    int                 power_vi2c;
+    int                 power_vdd;
+    int                 igpio;
+    int                 int_en;
+    int                 irq;
+    int                 irq_gpio;
+    int                 use_hrtimer;
+    struct regulator    *vdd;
+    struct regulator    *vio;
+    int    power_enabled;
+
+} m1120_data_t;
+/* ********************************************************* */
+
+#endif // __MXM1120_H__
+
diff --git a/drivers/extcon/hall_ic/hall_mxm1120_down.c b/drivers/extcon/hall_ic/hall_mxm1120_down.c
new file mode 100644
index 0000000000000000000000000000000000000000..42c24b656fd1d86bb5740ae3a9098af7970115be
--- /dev/null
+++ b/drivers/extcon/hall_ic/hall_mxm1120_down.c
@@ -0,0 +1,1473 @@
+/*
+  * m1120.c - Linux kernel modules for hall switch
+ *
+  * Copyright (C) 2013 Seunghwan Park <seunghwan.park@magnachip.com>
+  * Copyright (C) 2014 MagnaChip Semiconductor.
+ *
+  * This program is free software; you can redistribute it and/or modify
+  * it under the terms of the GNU General Public License as published by
+  * the Free Software Foundation; either version 2 of the License, or
+  * (at your option) any later version.
+ *
+  * This program is distributed in the hope that it will be useful,
+  * but WITHOUT ANY WARRANTY; without even the implied warranty of
+  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+  * GNU General Public License for more details.
+*/
+
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+#include <linux/workqueue.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include <linux/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include "hall_mxm1120.h"
+#include "../oneplus_tri_key.h"
+
+//i2c address : 0X0D
+
+/***********************************************************/
+/*customer config*/
+/***********************************************************/
+#define M1120_DBG_ENABLE                    // for debugging
+#define M1120_DETECTION_MODE                M1120_DETECTION_MODE_INTERRUPT/*M1120_DETECTION_MODE_POLLING /James*/
+#define M1120_INTERRUPT_TYPE                M1120_VAL_INTSRS_INTTYPE_BESIDE
+//#define M1120_INTERRUPT_TYPE                M1120_VAL_INTSRS_INTTYPE_WITHIN
+#define M1120_SENSITIVITY_TYPE            M1120_VAL_INTSRS_SRS_10BIT_0_068mT
+#define M1120_PERSISTENCE_COUNT          M1120_VAL_PERSINT_COUNT(15)
+#define M1120_OPERATION_FREQUENCY          M1120_VAL_OPF_FREQ_80HZ
+#define M1120_OPERATION_RESOLUTION        M1120_VAL_OPF_BIT_10
+#define M1120_DETECT_RANGE_HIGH          (60)/*Need change via test.*/
+#define M1120_DETECT_RANGE_LOW            (50)/*Need change via test.*/
+#define M1120_RESULT_STATUS_A              (0x01)  // result status A ----> ==180Degree.
+#define M1120_RESULT_STATUS_B              (0x02)  // result status B ----> != 180Degree.
+#define M1120_EVENT_TYPE                    EV_ABS  // EV_KEY
+#define M1120_EVENT_CODE                    ABS_X   // KEY_F1
+#define M1120_EVENT_DATA_CAPABILITY_MIN  (-32768)
+#define M1120_EVENT_DATA_CAPABILITY_MAX  (32767)
+
+/*MagnaChip Hall Sensor power supply VDD 2.7V~3.6V, VIO 1.65~VDD*/
+#define M1120_VDD_MIN_UV       2700000
+#define M1120_VDD_MAX_UV       3600000
+#define M1120_VIO_MIN_UV       1650000
+#define M1120_VIO_MAX_UV       3600000
+
+/***********************************************************/
+/*debug macro*/
+/***********************************************************/
+#ifdef M1120_DBG_ENABLE
+#define dbg(fmt, args...)  printk("[M1120-DBG] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+#define dbgn(fmt, args...)  printk(fmt, ##args)
+#else
+#define dbg(fmt, args...)
+#define dbgn(fmt, args...)
+#endif // M1120_DBG_ENABLE
+#define dbg_func_in()      dbg("[M1120-DBG-F.IN] %s", __func__)
+#define dbg_func_out()    dbg("[M1120-DBG-F.OUT] %s", __func__)
+#define dbg_line()        dbg("[LINE] %d(%s)", __LINE__, __func__)
+/***********************************************************/
+
+
+/***********************************************************/
+/*error display macro*/
+/***********************************************************/
+#define mxerr(pdev, fmt, args...)          \
+    dev_err(pdev, "[M1120-ERR] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+#define mxinfo(pdev, fmt, args...)        \
+    dev_info(pdev, "[M1120-INFO] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+/***********************************************************/
+
+/***********************************************************/
+/*static variable*/
+/***********************************************************/
+static m1120_data_t *p_m1120_data;
+/***********************************************************/
+
+
+/***********************************************************/
+/*function protyps*/
+/***********************************************************/
+/*i2c interface*/
+static int m1120_i2c_read_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len);
+static int m1120_i2c_write_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len);
+static void m1120_short_to_2byte(m1120_data_t* m1120_data, short x, u8 *hbyte, u8 *lbyte);
+static short m1120_2byte_to_short(m1120_data_t* m1120_data, u8 hbyte, u8 lbyte);
+/*vdd / vid power control*/
+static int m1120_set_power(struct device *dev, bool on);
+
+
+static int  m1120_get_enable(struct device *dev);
+static void m1120_set_enable(struct device *dev, int enable);
+static int  m1120_get_delay(struct device *dev);
+static void m1120_set_delay(struct device *dev, int delay);
+static int  m1120_get_debug(struct device *dev);
+static void m1120_set_debug(struct device *dev, int debug);
+static int  m1120_clear_interrupt(struct device *dev);
+static int  m1120_set_operation_mode(struct device *dev, int mode);
+static int  m1120_init_device(struct device *dev);
+static int  m1120_reset_device(struct device *dev);
+static int  m1120_power_ctl(m1120_data_t *data, bool on);
+static int m1120_get_data( short *data);
+/***********************************************************/
+
+
+/***********************************************************/
+/*functions for i2c interface*/
+/***********************************************************/
+#define M1120_I2C_BUF_SIZE                (17)
+
+
+static int m1120_i2c_read_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len)
+{
+	u8 reg_addr = addr;
+	int err = 0;
+	struct i2c_client *client = NULL;
+	struct i2c_msg msgs[2]={{0},{0}};
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+    client = m1120_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+	//mutex_lock(&m1120_i2c_mutex); Ëø¾ßÌåÔõôÀ´ÓÃ,µÈºóÃæÔÙ¿´,ÏÈ×¢Ê͵ô
+
+	msgs[0].addr = client->addr;
+	msgs[0].flags = 0;
+ 	msgs[0].len =1;
+ 	msgs[0].buf = &reg_addr;
+
+ 	msgs[1].addr = client->addr;
+ 	msgs[1].flags = I2C_M_RD;
+ 	msgs[1].len =len;
+ 	msgs[1].buf = data;
+
+ 	err = i2c_transfer(client->adapter, msgs, (sizeof(msgs) / sizeof(msgs[0])));
+
+ 	if (err < 0) {
+ 		MOTOR_ERR("i2c_transfer error: (%d %p %d) %d\n",addr, data, len, err);
+ 		err = -EIO;
+ 	} else  {
+ 		err = 0;
+ 	}
+ 	//mutex_unlock(&m1120_i2c_mutex);
+
+ 	return err;
+
+}
+
+static int m1120_i2c_write_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len)
+{
+	int err = 0;
+	int idx = 0;
+	int num = 0;
+	char buf[M1120_I2C_BUF_SIZE] ={0};
+	struct i2c_client *client = NULL;
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+    client = m1120_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+
+	//mutex_lock(&m1120_i2c_mutex);
+
+	buf[num++] = addr;
+	for (idx = 0; idx < len; idx++) {
+		buf[num++] = data[idx];
+	}
+
+	err = i2c_master_send(client, buf, num);
+	if (err < 0) {
+		MOTOR_ERR("send command error!! %d\n",err);
+	}
+
+	//store reg written
+	if (len == 1) {
+		switch(addr){
+		case M1120_REG_PERSINT:
+			m1120_data->reg.map.persint = data[0];
+			break;
+		case M1120_REG_INTSRS:
+			m1120_data->reg.map.intsrs = data[0];
+			break;
+		case M1120_REG_LTHL:
+			m1120_data->reg.map.lthl = data[0];
+			break;
+		case M1120_REG_LTHH:
+			m1120_data->reg.map.lthh = data[0];
+			break;
+		case M1120_REG_HTHL:
+			m1120_data->reg.map.hthl = data[0];
+			break;
+		case M1120_REG_HTHH:
+			m1120_data->reg.map.hthh = data[0];
+			break;
+		case M1120_REG_I2CDIS:
+			m1120_data->reg.map.i2cdis = data[0];
+			break;
+		case M1120_REG_SRST:
+			m1120_data->reg.map.srst = data[0];
+			break;
+		case M1120_REG_OPF:
+			m1120_data->reg.map.opf = data[0];
+			break;
+		}
+	}
+
+	//mutex_unlock(&m1120_i2c_mutex);
+	return err;
+}
+
+static void m1120_short_to_2byte(m1120_data_t* m1120_data, short x, u8 *hbyte, u8 *lbyte)
+{
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return ;
+    }
+
+	if ((m1120_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		/* 8 bit resolution */
+		if (x < -128) {
+			x = -128;
+		} else if(x > 127) {
+			x = 127;
+		}
+
+		if (x >= 0) {
+			*lbyte = x & 0x7F;
+		} else {
+			*lbyte = ( (0x80 - (x*(-1))) & 0x7F ) | 0x80;
+		}
+		*hbyte = 0x00;
+	} else {
+		/* 10 bit resolution */
+		if (x < -512) {
+			x = -512;
+		} else if (x > 511) {
+			x = 511;
+		}
+
+		if (x >=0 ) {
+			*lbyte = x & 0xFF;
+			*hbyte = (((x & 0x100) >> 8) & 0x01) << 6;
+		} else {
+			*lbyte = (0x0200 - (x*(-1))) & 0xFF;
+			*hbyte = ((((0x0200 - (x*(-1))) & 0x100) >> 8) << 6) | 0x80;
+		}
+	}
+}
+
+
+static short m1120_2byte_to_short(m1120_data_t* m1120_data, u8 hbyte, u8 lbyte)
+{
+	short x = 0;
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+
+	if( (m1120_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		/* 8 bit resolution */
+		x = lbyte & 0x7F;
+		if (lbyte & 0x80) {
+			x -= 0x80;
+		}
+	} else {
+		/* 10 bit resolution */
+		x = ( ( (hbyte & 0x40) >> 6) << 8 ) | lbyte;
+		if (hbyte & 0x80) {
+			x -= 0x200;
+		}
+	}
+
+	return x;
+}
+
+/***********************************************************/
+
+
+
+/***********************************************************/
+/*vdd / vid power control*/
+/***********************************************************/
+static int m1120_set_power(struct device *dev, bool on)
+{
+    m1120_power_ctl(p_m1120_data, on);
+
+    return 0;
+}
+/***********************************************************/
+
+
+static irqreturn_t m1120_down_irq_handler(int irq, void *dev_id)
+{
+	MOTOR_LOG("call \n");
+
+	if (!p_m1120_data) {
+		MOTOR_LOG("p_m1120_data NULL \n");
+		return -EINVAL;
+	}
+
+	disable_irq_nosync(p_m1120_data->irq);
+	oneplus_hall_irq_handler(1);//DHALL_1  DHALL_DOWN
+
+	return IRQ_HANDLED;
+}
+
+
+static int m1120_get_enable(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    return atomic_read(&p_data->atm.enable);
+}
+
+
+static void m1120_set_enable(struct device *dev, int enable)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+//    int delay = m1120_get_delay(dev);
+
+    mutex_lock(&p_data->mtx.enable);
+    MOTOR_LOG("enable : %d\n", enable);
+    if (enable) {                  /*enable if state will be changed*/
+        if (!atomic_cmpxchg(&p_data->atm.enable, 0, 1)) {
+            //m1120_set_detection_mode(dev, p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT);
+            //m1120_set_detection_mode(dev, p_data->reg.map.intsrs & M1120_DETECTION_MODE_POLLING);
+            m1120_set_operation_mode(&p_m1120_data->client->dev, OPERATION_MODE_MEASUREMENT);
+            /*if(!(p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT))*/
+            // if (0) {
+            //     schedule_delayed_work(&p_data->work, msecs_to_jiffies(delay));
+            // }
+        }
+    } else {                        /*disable if state will be changed*/
+        if (atomic_cmpxchg(&p_data->atm.enable, 1, 0)) {
+            //cancel_delayed_work_sync(&p_data->work);
+            m1120_set_operation_mode(&p_m1120_data->client->dev, OPERATION_MODE_POWERDOWN);
+        }
+    }
+    atomic_set(&p_data->atm.enable, enable);
+
+    mutex_unlock(&p_data->mtx.enable);
+}
+
+static int m1120_get_delay(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    int delay = 0;
+
+    delay = atomic_read(&p_data->atm.delay);
+
+    return delay;
+}
+
+static void m1120_set_delay(struct device *dev, int delay)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    if (delay < M1120_DELAY_MIN)
+        delay = M1120_DELAY_MIN;
+    atomic_set(&p_data->atm.delay, delay);
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(dev)) {
+        if (!(p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT)) {
+            cancel_delayed_work_sync(&p_data->work);
+            schedule_delayed_work(&p_data->work, msecs_to_jiffies(delay));
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+}
+
+static int m1120_get_debug(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    return atomic_read(&p_data->atm.debug);
+}
+
+static void m1120_set_debug(struct device *dev, int debug)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    atomic_set(&p_data->atm.debug, debug);
+}
+
+static int m1120_clear_interrupt(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    int ret = 0;
+    u8 data = 0x00;
+
+    data = p_data->reg.map.persint | 0x01;
+    ret =  m1120_i2c_write_block(p_data, M1120_REG_PERSINT, &data,1);
+
+    return ret;
+}
+
+static int m1120_set_operation_mode(struct device *dev, int mode)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    u8 opf = p_data->reg.map.opf;
+    int err = -1;
+
+    switch (mode) {
+    case OPERATION_MODE_POWERDOWN:
+        opf &= (0xFF - M1120_VAL_OPF_HSSON_ON);
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_POWERDOWN");
+        break;
+    case OPERATION_MODE_MEASUREMENT:
+        opf &= (0xFF - M1120_VAL_OPF_EFRD_ON);
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_MEASUREMENT");
+        break;
+    case OPERATION_MODE_FUSEROMACCESS:
+        opf |= M1120_VAL_OPF_EFRD_ON;
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_FUSEROMACCESS");
+        break;
+    }
+    mxinfo(&client->dev, "opf = ox%x \n", opf);
+    return err;
+}
+
+static int m1120_init_device(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    int err = -1;
+
+    /*(1) vdd and vid power up*/
+    err = m1120_set_power(dev, 1);
+    if (err) {
+        mxerr(&client->dev, "m1120 power-on was failed (%d)", err);
+        return err;
+    }
+
+    /*(2) init variables*/
+    atomic_set(&p_data->atm.enable, 0);
+    atomic_set(&p_data->atm.delay, M1120_DELAY_MIN);
+#ifdef M1120_DBG_ENABLE
+    atomic_set(&p_data->atm.debug, 1);
+#else
+    atomic_set(&p_data->atm.debug, 0);
+#endif
+    p_data->calibrated_data = 0;
+    p_data->last_data = 0;
+    p_data->irq_enabled = 0;
+    p_data->irq_first = 1;
+    p_data->thrhigh = M1120_DETECT_RANGE_HIGH;
+    p_data->thrlow = M1120_DETECT_RANGE_LOW;
+    m1120_set_delay(&client->dev, M1120_DELAY_MAX);
+    m1120_set_debug(&client->dev, 0);
+
+    /*(3) reset registers*/
+    err = m1120_reset_device(dev);
+    if (err < 0) {
+        mxerr(&client->dev, "m1120_reset_device was failed (%d)", err);
+        return err;
+    }
+
+    mxinfo(&client->dev, "initializing device was success");
+
+    return 0;
+}
+
+static int m1120_reset_device(struct device *dev)
+{
+    int err = 0;
+    u8  id = 0xFF, data = 0x00;
+
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    if ((p_data == NULL) || (p_data->client == NULL))
+        return -ENODEV;
+
+    /*(1) sw reset*/
+    data = M1120_VAL_SRST_RESET;
+    err = m1120_i2c_write_block(p_data, M1120_REG_SRST, &data,1);
+    if (err < 0) {
+        mxerr(&client->dev, "sw-reset was failed(%d)", err);
+        return err;
+    }
+    msleep(5);
+    dbg("wait 5ms after vdd power up");
+
+    /*(2) check id*/
+    err = 	m1120_i2c_read_block(p_data, M1120_REG_DID, &id, 1);
+    if (err < 0)
+        return err;
+    if (id != M1120_VAL_DID) {
+        mxerr(&client->dev, "current device id(0x%02X) is not M1120 device id(0x%02X)", id, M1120_VAL_DID);
+        return -ENXIO;
+    }
+
+    /*(3) init variables*/
+    /*(3-1) persint*/
+    data = M1120_PERSISTENCE_COUNT;
+    err =   m1120_i2c_write_block(p_data, M1120_REG_PERSINT, &data,1);
+    if (err <0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+    /*(3-2) intsrs*/
+    data = M1120_DETECTION_MODE | M1120_SENSITIVITY_TYPE;
+    if (data & M1120_DETECTION_MODE_INTERRUPT) {
+        data |= M1120_INTERRUPT_TYPE;
+    }
+    err = m1120_i2c_write_block(p_data, M1120_REG_INTSRS, &data, 1);
+    if (err < 0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+    /*(3-3) opf*/
+    data = M1120_OPERATION_FREQUENCY | M1120_OPERATION_RESOLUTION;
+    err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &data, 1);
+    if (err < 0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+
+    /*(4) write variable to register*/
+    // err = m1120_set_detection_mode(dev, M1120_DETECTION_MODE);
+    // if (err) {
+    //     mxerr(&client->dev, "m1120_set_detection_mode was failed(%d)", err);
+    //     return err;
+    // }
+
+
+    /*(5) set power-on mode*/
+    err = m1120_set_operation_mode(dev, OPERATION_MODE_MEASUREMENT);
+    if (err < 0) {
+        mxerr(&client->dev, "m1120_set_detection_mode was failed(%d)", err);
+        return err;
+    }
+
+    return err;
+}
+
+/**************************************************
+   input device interface
+   **************************************************/
+static int m1120_input_dev_init(m1120_data_t *p_data)
+{
+    struct input_dev *dev;
+    int err;
+
+    dev = input_allocate_device();
+    if (!dev) {
+        return -ENOMEM;
+    }
+    dev->name = M1120_DRIVER_NAME_DOWN;
+    dev->id.bustype = BUS_I2C;
+
+#if (M1120_EVENT_TYPE == EV_ABS)
+    input_set_drvdata(dev, p_data);
+    input_set_capability(dev, M1120_EVENT_TYPE, ABS_MISC);
+    input_set_abs_params(dev, M1120_EVENT_CODE, M1120_EVENT_DATA_CAPABILITY_MIN, M1120_EVENT_DATA_CAPABILITY_MAX, 0, 0);
+#elif (M1120_EVENT_TYPE == EV_KEY)
+    input_set_drvdata(dev, p_data);
+    input_set_capability(dev, M1120_EVENT_TYPE, M1120_EVENT_CODE);
+#else
+#error ("[ERR] M1120_EVENT_TYPE is not defined.")
+#endif
+
+    err = input_register_device(dev);
+    if (err < 0) {
+        input_free_device(dev);
+        return err;
+    }
+
+    p_data->input_dev = dev;
+
+    return 0;
+}
+
+static void m1120_input_dev_terminate(m1120_data_t *p_data)
+{
+    struct input_dev *dev = p_data->input_dev;
+
+    input_unregister_device(dev);
+    input_free_device(dev);
+}
+
+/**************************************************
+   sysfs attributes
+   **************************************************/
+static ssize_t m1120_enable_show(struct device *dev,
+                  struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_enable(dev));
+}
+
+static ssize_t m1120_enable_store(struct device *dev,
+                   struct device_attribute *attr,
+                   const char *buf, size_t count)
+{
+    unsigned long enable = simple_strtoul(buf, NULL, 10);
+
+    if ((enable == 0) || (enable == 1)) {
+        m1120_set_enable(dev, enable);
+    }
+
+    return count;
+}
+
+static ssize_t m1120_delay_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_delay(dev));
+}
+
+static ssize_t m1120_delay_store(struct device *dev,
+                  struct device_attribute *attr,
+                  const char *buf, size_t count)
+{
+    unsigned long delay = simple_strtoul(buf, NULL, 10);
+
+    if (delay > M1120_DELAY_MAX) {
+        delay = M1120_DELAY_MAX;
+    }
+
+    m1120_set_delay(dev, delay);
+
+    return count;
+}
+
+static ssize_t m1120_debug_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_debug(dev));
+}
+
+static ssize_t m1120_debug_store(struct device *dev,
+                  struct device_attribute *attr,
+                  const char *buf, size_t count)
+{
+    unsigned long debug = simple_strtoul(buf, NULL, 10);
+
+    m1120_set_debug(dev, debug);
+
+    return count;
+}
+
+static ssize_t m1120_wake_store(struct device *dev,
+                 struct device_attribute *attr,
+                 const char *buf, size_t count)
+{
+    return 0;
+}
+
+static ssize_t m1120_data_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    //struct i2c_client *client = to_i2c_client(dev);
+    //m1120_data_t *p_data = i2c_get_clientdata(client);
+    short raw = 0;
+    m1120_get_data(&raw);
+    return snprintf(buf, 10, "%d\n", raw);
+}
+
+ static int m1120_i2c_read(struct i2c_client *client, u8 reg, u8 *rdata, u8 len)
+{
+#if 0////add by James.
+	int rc;
+	struct i2c_msg msg[] = {
+	{
+		.addr = client->addr,
+		.flags = 0,
+		.len = 1,
+		.buf = &reg,
+	},
+	{
+		.addr = client->addr,
+		.flags = I2C_M_RD,
+		.len = len,
+		.buf = rdata,
+	},
+	};
+	if (client == NULL) {
+		mxerr(&client->dev, "client is NULL");
+		return -ENODEV;
+	}
+	rc = i2c_transfer(client->adapter, msg, 2);
+	if (rc < 0) {
+		mxerr(&client->dev, "i2c_transfer was failed(%d)", rc);
+		return rc;
+	}
+#else 
+/*Add By James for i2c_smbus_read_i2c_block_data */
+	i2c_smbus_read_i2c_block_data(client, reg, len, rdata);
+#endif
+	return 0;
+}
+
+static int  m1120_i2c_get_reg(struct i2c_client *client, u8 reg, u8 *rdata)
+{
+	return m1120_i2c_read(client, reg, rdata, 1);
+}
+
+static void m1120_get_reg(struct device *dev, int *regdata)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	int err;
+	u8 rega = (((*regdata) >> 8) & 0xFF);
+	u8 regd = 0;
+	err = m1120_i2c_get_reg(client, rega, &regd);
+	*regdata = 0;
+	*regdata |= (err == 0) ? 0x0000 : 0xFF00;
+	*regdata |= regd;
+}
+
+static ssize_t m1120_dump_show(struct device *dev,struct device_attribute *attr, char *buf)
+{
+	int reg = 0;
+	int reg_l = M1120_REG_HSL;
+	int reg_h = M1120_REG_HSH;
+	int i = 0;
+	for (i = 0; i < 11; i++) {
+		reg = i<<8;
+		m1120_get_reg(&p_m1120_data->client->dev, &reg);
+		printk(KERN_ERR"dkk: the reg 0x%02X value: 0x%02X\n", i, reg);
+	}
+	m1120_get_reg(&p_m1120_data->client->dev, &reg_l);
+	printk(KERN_ERR"dkk: the reg_l is 0x%02X\n", (u8)(reg_l&0xFF));
+	m1120_get_reg(&p_m1120_data->client->dev, &reg_h);
+	printk(KERN_ERR"dkk: the reg_h is 0x%02X", (u8)(reg_h&0xFF));
+	reg = ((reg_h&0xC0) << 2)|reg_l;
+	printk(KERN_ERR"dkk: the down hall reg measure is 0x%02X\n", reg);
+	return snprintf(buf, 10, "%d\n", reg);
+	//return 0;
+}
+
+
+static DEVICE_ATTR(enable,  S_IRUGO|S_IWUSR|S_IWGRP, m1120_enable_show, m1120_enable_store);
+static DEVICE_ATTR(delay,   S_IRUGO|S_IWUSR|S_IWGRP, m1120_delay_show,  m1120_delay_store);
+static DEVICE_ATTR(debug,   S_IRUGO|S_IWUSR|S_IWGRP, m1120_debug_show,  m1120_debug_store);
+static DEVICE_ATTR(wake,    S_IWUSR|S_IWGRP,         NULL,            m1120_wake_store);
+static DEVICE_ATTR(rawdata, S_IRUGO|S_IWUSR|S_IWGRP, m1120_data_show,   NULL);
+static DEVICE_ATTR(dump,    S_IRUGO|S_IWUSR|S_IWGRP, m1120_dump_show,   NULL);
+
+static struct attribute *m1120_attributes[] = {
+    &dev_attr_enable.attr,
+    &dev_attr_delay.attr,
+    &dev_attr_debug.attr,
+    &dev_attr_wake.attr,
+    &dev_attr_rawdata.attr,
+    &dev_attr_dump.attr,
+    NULL
+};
+
+static struct attribute_group m1120_attribute_group = {
+    .attrs = m1120_attributes
+};
+
+static int m1120_power_ctl(m1120_data_t *data, bool on)
+{
+    int ret = 0;   
+    int err = 0;    
+    if (!on && data->power_enabled) {
+        ret = regulator_disable(data->vdd);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vdd disable failed ret=%d\n", ret);
+            return ret;
+        }
+
+        ret = regulator_disable(data->vio);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vio disable failed ret=%d\n", ret);
+            err = regulator_enable(data->vdd);
+            return ret;
+        }
+        data->power_enabled = on;
+    } else if (on && !data->power_enabled) {
+        ret = regulator_enable(data->vdd);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vdd enable failed ret=%d\n", ret);
+            return ret;
+        }
+              msleep(8);////>=5ms OK.
+        ret = regulator_enable(data->vio);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vio enable failed ret=%d\n", ret);
+            err = regulator_disable(data->vdd);
+            return ret;
+        }
+        msleep(10); // wait 10ms
+        data->power_enabled = on;
+    } else {
+        dev_info(&data->client->dev,
+                "Power on=%d. enabled=%d\n",
+                on, data->power_enabled);
+    }
+
+    return ret;
+}
+
+static int m1120_power_init(m1120_data_t *data)
+{
+    int ret;
+
+    data->vdd = regulator_get(&data->client->dev, "vdd");
+    if (IS_ERR(data->vdd)) {
+        ret = PTR_ERR(data->vdd);
+        dev_err(&data->client->dev,
+            "Regulator get failed vdd ret=%d\n", ret);
+        return ret;
+    }
+
+    if (regulator_count_voltages(data->vdd) > 0) {
+        ret = regulator_set_voltage(data->vdd,
+                M1120_VDD_MIN_UV,
+                M1120_VDD_MAX_UV);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator set failed vdd ret=%d\n",
+                ret);
+            goto reg_vdd_put;
+        }
+    }
+
+    data->vio = regulator_get(&data->client->dev, "vio");
+    if (IS_ERR(data->vio)) {
+        ret = PTR_ERR(data->vio);
+        dev_err(&data->client->dev,
+            "Regulator get failed vio ret=%d\n", ret);
+        goto reg_vdd_set;
+    }
+
+    if (regulator_count_voltages(data->vio) > 0) {
+        ret = regulator_set_voltage(data->vio,
+                M1120_VIO_MIN_UV,
+                M1120_VIO_MAX_UV);
+        if (ret) {
+            dev_err(&data->client->dev,
+            "Regulator set failed vio ret=%d\n", ret);
+            goto reg_vio_put;
+        }
+    }
+
+    return 0;
+
+reg_vio_put:
+    regulator_put(data->vio);
+reg_vdd_set:
+    if (regulator_count_voltages(data->vdd) > 0)
+        regulator_set_voltage(data->vdd, 0, M1120_VDD_MAX_UV);
+reg_vdd_put:
+    regulator_put(data->vdd);
+    return ret;
+}
+
+
+static int tri_key_m1120_parse_dt(struct device *dev,
+            m1120_data_t *pdata)
+{
+    struct device_node *np = dev->of_node;
+	struct pinctrl *key_pinctrl;
+	struct pinctrl_state *set_state;
+    u32 temp_val;
+    int rc;
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dev_err(dev, "  %s", __func__); 
+    rc = of_property_read_u32(np, "magnachip,init-interval", &temp_val);
+    if (rc && (rc != -EINVAL)) {
+        dev_err(dev, "Unable to read init-interval\n");
+        return rc;
+    } else {
+        if (temp_val < M1120_DELAY_MIN)
+            temp_val = M1120_DELAY_MIN;
+        atomic_set(&p_data->atm.delay, temp_val);
+    }
+
+    p_data->int_en = of_property_read_bool(np, "magnachip,use-interrupt");
+
+    p_data->igpio = of_get_named_gpio_flags(dev->of_node,
+                "magnachip,gpio-int", 0, NULL);
+
+    p_data->irq_gpio =  of_get_named_gpio(np, "dhall,irq-gpio", 0);
+    dev_err(dev, "irq_gpio : %d", p_data->irq_gpio);
+
+    p_data->use_hrtimer = of_property_read_bool(np, "magnachip,use-hrtimer");
+		key_pinctrl = devm_pinctrl_get(dev);
+
+	if (IS_ERR_OR_NULL(key_pinctrl)) {
+		dev_err(dev, "Failed to get pinctrl\n");
+	}
+	set_state = pinctrl_lookup_state(key_pinctrl,
+		"downhall_tri_state_key_active");
+	if (IS_ERR_OR_NULL(set_state)) {
+		dev_err(dev, "Failed to lookup_state\n");
+	}
+
+	 pinctrl_select_state(key_pinctrl,set_state);
+
+    return 0;
+}
+
+//interface implement for op_motor.c
+
+static int m1120_get_data( short *data)
+{ 
+    int err = 0;
+	u8 buf[3] = {0};
+	short value = 0;
+
+    printk(KERN_INFO "  %s", __func__);
+    if(!p_m1120_data) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -1;
+    }
+	// (1) read data
+	err = m1120_i2c_read_block(p_m1120_data, M1120_REG_ST1, buf, sizeof(buf));
+	if (err < 0) {
+		MOTOR_LOG(" fail %d \n",err);
+		return err;
+	}
+
+	// (2) collect data
+	if (buf[0] & 0x01) {
+		value = m1120_2byte_to_short(p_m1120_data, buf[2], buf[1]);
+	} else {
+		MOTOR_LOG("m1120: st1(0x%02X) is not DRDY.\n", buf[0]);
+		return err;
+	}
+    MOTOR_LOG("down, value : %d\n", value);
+	*data = value;
+
+	return 0;
+}
+
+static int m1120_enable_irq(bool enable)
+{
+    printk(KERN_INFO "  %s", __func__);
+
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	if (enable) {
+		enable_irq(p_m1120_data->irq);
+	} else {
+		disable_irq_nosync(p_m1120_data->irq);
+	}
+
+    return 0;
+}
+
+static int m1120_clear_irq()
+{
+    printk(KERN_INFO "  %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_clear_interrupt(&p_m1120_data->client->dev);
+    return 0;
+}
+
+static int m1120_get_irq_state()
+{
+    printk(KERN_INFO "  %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+    return ((p_m1120_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) ? 1 : 0);   
+}
+
+static bool m1120_update_threshold(int position, short lowthd, short highthd)
+{
+    
+    u8 lthh, lthl, hthh, hthl;
+	int err = 0;
+
+    printk(KERN_INFO "  %s", __func__);
+	if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("m1120_down ,low:%d, high:%d  \n",lowthd, highthd);
+
+	err = m1120_clear_interrupt(&p_m1120_data->client->dev);
+
+	//if (p_m1120_data->reg.map.intsrs & M1120_VAL_INTSRS_INTTYPE_BESIDE) {
+	if (p_m1120_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+        printk("dn hall m1120_update_threshold, lowthd=%d, highthd=%d.\n", lowthd, highthd);
+		m1120_short_to_2byte(p_m1120_data, highthd, &hthh, &hthl);
+		m1120_short_to_2byte(p_m1120_data, lowthd, &lthh, &lthl);
+
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_HTHH,&hthh, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_HTHL,&hthl, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_LTHH,&lthh, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_LTHL,&lthl, 1);
+	}
+
+	if (err < 0) {
+		MOTOR_ERR("tri_key:fail %d\n",err);
+		return false;
+	} else {
+		return true;
+	}
+
+    return true;  
+}
+
+static void m1120_dump_reg(u8* buf)
+{
+    int i, err;
+	u8 val;
+	u8 buffer[512] = {0};
+	u8 _buf[20] = {0};
+
+    printk(KERN_INFO "  %s", __func__);
+	if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return ;
+	}
+
+	for (i = 0; i <= 0x12; i++) {
+		memset(_buf, 0, sizeof(_buf));
+
+		err = m1120_i2c_read_block(p_m1120_data, i, &val, 1);
+		if (err < 0) {
+			snprintf(buf, PAGE_SIZE, "read reg error!\n");
+			return;
+		}
+
+		snprintf(_buf, sizeof(_buf), "reg 0x%x:0x%x\n", i, val);
+		strcat(buffer, _buf);
+	}
+	snprintf(buf, PAGE_SIZE, "%s\n", buffer);
+	MOTOR_LOG("%s \n",buf);
+	return;
+}
+
+static bool m1120_is_power_on()
+{
+    printk(KERN_INFO "  %s", __func__);
+    if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return false;
+	}
+
+    return p_m1120_data->power_enabled > 0 ? true : false;
+}
+
+static int m1120_set_detection_mode_1(u8 mode)
+{
+	u8 data = 0;
+	int err = 0;
+
+    printk(KERN_INFO "  %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	MOTOR_LOG("m1120 down detection mode : %s\n", (mode == 0)? "POLLING":"INTERRUPT");
+
+	if(mode & DETECTION_MODE_INTERRUPT) { //interrupt mode
+		if (!p_m1120_data->irq_enabled) {
+			data = p_m1120_data->reg.map.intsrs | M1120_DETECTION_MODE_INTERRUPT;
+
+			err = m1120_i2c_write_block(p_m1120_data, M1120_REG_INTSRS, &data, 1);//
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail %d \n",err);
+				return err;
+			}
+
+			err = m1120_clear_interrupt(&p_m1120_data->client->dev);
+			if (err < 0) {
+				MOTOR_ERR("clear interupt fail %d \n",err);
+				return err;
+			}
+
+			/* requst irq */
+			MOTOR_LOG("m1120 down enter irq handler \n");
+            if (request_irq(p_m1120_data->irq, &m1120_down_irq_handler, IRQ_TYPE_LEVEL_LOW, "hall_m1120_down",(void *)p_m1120_data->client)) {
+				MOTOR_ERR("IRQ LINE NOT AVAILABLE!!\n");
+				return -EINVAL;
+			}
+			irq_set_irq_wake(p_m1120_data->irq, 1);
+
+			p_m1120_data->irq_enabled = 1;
+		}
+	} else { // polling mode
+		if (p_m1120_data->irq_enabled) {
+			data = p_m1120_data->reg.map.intsrs & (0xFF - M1120_DETECTION_MODE_INTERRUPT);
+
+			err = m1120_i2c_write_block(p_m1120_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail %d \n",err);
+				return err;
+			}
+
+			disable_irq(p_m1120_data->irq);
+			free_irq(p_m1120_data->irq, NULL);
+
+			p_m1120_data->irq_enabled = 0;
+		}
+	}
+
+    return 0;    
+}
+
+static int m1120_set_reg_1(int reg, int val)
+{
+
+    u8 data = (u8)val;
+
+    printk(KERN_INFO "%s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_i2c_write_block(p_m1120_data, (u8)reg, &data,1);
+    return 0;  
+}
+
+struct dhall_operations  m1120_downs_ops = {
+	.get_data  = m1120_get_data,
+	.enable_irq = m1120_enable_irq,
+	.clear_irq = m1120_clear_irq,
+	.get_irq_state = m1120_get_irq_state,
+	.set_detection_mode = m1120_set_detection_mode_1,
+	.update_threshold = m1120_update_threshold,
+	.dump_regs = m1120_dump_reg,
+	.set_reg = m1120_set_reg_1,
+	.is_power_on = m1120_is_power_on
+};
+/**************************************************
+   i2c client
+   **************************************************/
+
+static int tri_key_m1120_i2c_drv_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    m1120_platform_data_t   *p_platform;
+    m1120_data_t            *p_data;
+    int                  err = 0;
+
+    dbg_func_in();
+
+
+    printk(KERN_INFO "  allocation memory for p_m1120_data down %s\n", __func__);
+    /*(1) allocation memory for p_m1120_data*/
+    p_data = kzalloc(sizeof(m1120_data_t), GFP_KERNEL);
+    if (!p_data) {
+        mxerr(&client->dev, "kernel memory alocation was failed");
+        err = -ENOMEM;
+        goto error_0;
+    }
+
+    printk(KERN_INFO "   init mutex variable \n");
+    /*(2) init mutex variable*/
+    mutex_init(&p_data->mtx.enable);
+    mutex_init(&p_data->mtx.data);
+    p_data->power_enabled = false;
+
+    printk(KERN_INFO "   config i2c client %s\n", __func__);
+    /*(3) config i2c client*/
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        mxerr(&client->dev, "i2c_check_functionality was failed");
+        err = -ENODEV;
+        goto error_1;
+    }
+    i2c_set_clientdata(client, p_data);
+    p_data->client = client;
+    p_m1120_data = p_data;
+
+    if (client->dev.of_node) {
+        dev_err(&client->dev, "Use client->dev.of_node\n");
+        err = tri_key_m1120_parse_dt(&client->dev, p_data);
+        if (err) {
+            dev_err(&client->dev, "Failed to parse device tree \n");
+            err = -EINVAL;
+            goto error_1;
+        }
+    } else {
+        p_platform = client->dev.platform_data;
+        dev_err(&client->dev, "Use platform data \n");
+    }
+    /*(5) setup interrupt gpio*/
+    /*if (p_data->igpio != -1) {
+        err = gpio_request(p_data->igpio, "m1120_irq");
+        if (err) {
+            mxerr(&client->dev, "gpio_request was failed(%d)", err);
+            goto error_1;
+        }
+        mxinfo(&client->dev, "gpio_request was success");
+        err = gpio_direction_input(p_data->igpio);
+        if (err < 0) {
+            mxerr(&client->dev, "gpio_direction_input was failed(%d)", err);
+            goto error_2;
+        }
+        mxinfo(&client->dev, "gpio_direction_input was success");
+    }*/
+
+    //pull pm8150 gpio_04 down
+    // err = set_gpio_state(&client->dev);
+    // if (err) {
+    //     dev_err(&client->dev, "Failed to set gpio state\n");
+    // }
+    //gpio irq request 
+    if (gpio_is_valid(p_data->irq_gpio)) {
+        err = gpio_request(p_data->irq_gpio, "m1120_down_irq");
+        if (err) {
+            mxerr(&client->dev, "unable to request gpio [%d]", p_data->irq_gpio);
+        } else {
+            err = gpio_direction_input(p_data->irq_gpio);
+            msleep(50);
+            p_data->irq = gpio_to_irq(p_data->irq_gpio);
+            mxerr(&client->dev, "  irq : %d", p_data->irq);
+        }
+
+    }
+
+    err = m1120_power_init(p_data);
+    if (err) {
+        dev_err(&client->dev, "Failed to get sensor regulators\n");
+        err = -EINVAL;
+        goto error_1;
+    }
+    err = m1120_power_ctl(p_data, true);
+    if (err) {
+        dev_err(&client->dev, "Failed to enable sensor power\n");
+        err = -EINVAL;
+        goto error_1;
+    }
+
+    printk(KERN_INFO "   reset and init device %s\n", __func__);
+    /*(6) reset and init device*/
+    err = m1120_init_device(&p_data->client->dev);
+    if (err) {
+        mxerr(&client->dev, "m1120_init_device was failed(%d)", err);
+        goto error_1;
+    }
+    mxinfo(&client->dev, "%s was found", id->name);
+
+    printk(KERN_INFO "   config work function\n", __func__);
+    /*(7) config work function*/
+    //INIT_DELAYED_WORK(&p_data->work, m1120_work_func);
+
+    printk(KERN_INFO "   init input device\n", __func__);
+    /*(8) init input device*/
+    err = m1120_input_dev_init(p_data);
+    if (err) {
+        mxerr(&client->dev, "m1120_input_dev_init was failed(%d)", err);
+        goto error_1;
+    }
+    mxinfo(&client->dev, "%s was initialized", M1120_DRIVER_NAME_DOWN);
+
+    printk(KERN_INFO "   create sysfs group\n", __func__);
+    /*(9) create sysfs group*/
+    err = sysfs_create_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+    if (err) {
+        mxerr(&client->dev, "sysfs_create_group was failed(%d)", err);
+        goto error_3;
+    }
+
+    /*(10) register misc device*/
+    // err = misc_register(&m1120_misc_dev);
+    // if (err) {
+    //     mxerr(&client->dev, "misc_register was failed(%d)", err);
+    //     goto error_4;
+    // }
+
+    /*(11) register ops to abstrace level*/
+    oneplus_register_hall("hall_m1120_down", &m1120_downs_ops);//ÍùÆäÀï±ß×¢²áhall
+
+    printk(KERN_INFO "  i2c addr : %d\n", client->addr);
+
+
+
+    /*(12) imigrate p_data to p_m1120_data*/
+    dbg("%s : %s was probed.\n", __func__, M1120_DRIVER_NAME_DOWN);
+
+    return 0;
+
+//error_4:
+ //   sysfs_remove_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+
+error_3:
+    m1120_input_dev_terminate(p_data);
+
+
+
+error_1:
+    kfree(p_data);
+
+error_0:
+       p_m1120_data = NULL;
+    return err;
+}
+
+static int m1120_i2c_drv_remove(struct i2c_client *client)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    m1120_set_enable(&client->dev, 0);
+   // misc_deregister(&m1120_misc_dev);
+    sysfs_remove_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+    m1120_input_dev_terminate(p_data);
+    if (p_data->igpio != -1) {
+        gpio_free(p_data->igpio);
+    }
+    kfree(p_data);
+
+    return 0;
+}
+
+/*
+static int m1120_i2c_drv_suspend(struct i2c_client *client, pm_message_t mesg)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dbg_func_in();
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(&client->dev)) {
+        if (p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+            m1120_set_operation_mode(&client->dev, OPERATION_MODE_MEASUREMENT);
+        } else {
+            cancel_delayed_work_sync(&p_data->work);
+            m1120_set_detection_mode(&client->dev, M1120_DETECTION_MODE_INTERRUPT);
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+
+    dbg_func_out();
+
+    return 0;
+}
+
+static int m1120_i2c_drv_resume(struct i2c_client *client)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dbg_func_in();
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(&client->dev)) {
+        if (p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+            m1120_set_detection_mode(&client->dev, M1120_DETECTION_MODE_POLLING);
+            schedule_delayed_work(&p_data->work, msecs_to_jiffies(m1120_get_delay(&client->dev)));
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+
+    dbg_func_out();
+
+    return 0;
+}
+*/
+
+static const struct i2c_device_id m1120_i2c_drv_id_table[] = {
+    {"hall_m1120_down", 0 },
+    { }
+};
+
+
+static const struct of_device_id m1120_of_match[] = {
+    { .compatible = "tri_key_magnachip,tk_mxm1120,down", },
+    { },
+};
+
+static struct i2c_driver m1120_driver = {
+    .driver = {
+        .owner  = THIS_MODULE,
+        .name   = M1120_DRIVER_NAME_DOWN,
+        .of_match_table = m1120_of_match,
+    },
+    .probe    = tri_key_m1120_i2c_drv_probe,
+    .remove  = m1120_i2c_drv_remove,
+    .id_table   = m1120_i2c_drv_id_table,
+    //.suspend  = m1120_i2c_drv_suspend,
+    //.resume      = m1120_i2c_drv_resume,
+};
+
+static int __init tri_key_m1120_driver_init_down(void)
+{
+    int res = 0;
+    printk(KERN_INFO " log %s\n", __func__);
+    res = i2c_add_driver(&m1120_driver);
+    printk(KERN_INFO " log %s, res : %d\n", __func__, res);
+    return res;//i2c_add_driver(&m1120_driver);
+}
+module_init(tri_key_m1120_driver_init_down);
+
+static void __exit m1120_driver_exit_down(void)
+{
+    printk(KERN_INFO "%s\n", __func__);
+    i2c_del_driver(&m1120_driver);
+}
+module_exit(m1120_driver_exit_down);
+
+MODULE_AUTHOR("shpark <seunghwan.park@magnachip.com>");
+MODULE_VERSION(M1120_DRIVER_VERSION);
+MODULE_DESCRIPTION("M1120 hallswitch driver");
+MODULE_LICENSE("GPL");
+
diff --git a/drivers/extcon/hall_ic/hall_mxm1120_up.c b/drivers/extcon/hall_ic/hall_mxm1120_up.c
new file mode 100644
index 0000000000000000000000000000000000000000..91946a6e38fdbce57b1682a2ec077f95100250fe
--- /dev/null
+++ b/drivers/extcon/hall_ic/hall_mxm1120_up.c
@@ -0,0 +1,1461 @@
+/*
+  * m1120.c - Linux kernel modules for hall switch
+ *
+  * Copyright (C) 2013 Seunghwan Park <seunghwan.park@magnachip.com>
+  * Copyright (C) 2014 MagnaChip Semiconductor.
+ *
+  * This program is free software; you can redistribute it and/or modify
+  * it under the terms of the GNU General Public License as published by
+  * the Free Software Foundation; either version 2 of the License, or
+  * (at your option) any later version.
+ *
+  * This program is distributed in the hope that it will be useful,
+  * but WITHOUT ANY WARRANTY; without even the implied warranty of
+  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+  * GNU General Public License for more details.
+*/
+
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+#include <linux/workqueue.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include <linux/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include "hall_mxm1120.h"
+#include "../oneplus_tri_key.h"
+
+/***********************************************************/
+/*customer config*/
+/***********************************************************/
+#define M1120_DBG_ENABLE                    // for debugging
+#define M1120_DETECTION_MODE                M1120_DETECTION_MODE_INTERRUPT/*M1120_DETECTION_MODE_POLLING /James*/
+#define M1120_INTERRUPT_TYPE                M1120_VAL_INTSRS_INTTYPE_BESIDE
+//#define M1120_INTERRUPT_TYPE                M1120_VAL_INTSRS_INTTYPE_WITHIN
+#define M1120_SENSITIVITY_TYPE            M1120_VAL_INTSRS_SRS_10BIT_0_068mT
+#define M1120_PERSISTENCE_COUNT          M1120_VAL_PERSINT_COUNT(15)
+#define M1120_OPERATION_FREQUENCY          M1120_VAL_OPF_FREQ_80HZ
+#define M1120_OPERATION_RESOLUTION        M1120_VAL_OPF_BIT_10
+#define M1120_DETECT_RANGE_HIGH          (60)/*Need change via test.*/
+#define M1120_DETECT_RANGE_LOW            (50)/*Need change via test.*/
+#define M1120_RESULT_STATUS_A              (0x01)  // result status A ----> ==180Degree.
+#define M1120_RESULT_STATUS_B              (0x02)  // result status B ----> != 180Degree.
+#define M1120_EVENT_TYPE                    EV_ABS  // EV_KEY
+#define M1120_EVENT_CODE                    ABS_X   // KEY_F1
+#define M1120_EVENT_DATA_CAPABILITY_MIN  (-32768)
+#define M1120_EVENT_DATA_CAPABILITY_MAX  (32767)
+
+/*MagnaChip Hall Sensor power supply VDD 2.7V~3.6V, VIO 1.65~VDD*/
+#define M1120_VDD_MIN_UV       2700000
+#define M1120_VDD_MAX_UV       3600000
+#define M1120_VIO_MIN_UV       1650000
+#define M1120_VIO_MAX_UV       3600000
+
+/***********************************************************/
+/*debug macro*/
+/***********************************************************/
+#ifdef M1120_DBG_ENABLE
+#define dbg(fmt, args...)  printk("[M1120-DBG] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+#define dbgn(fmt, args...)  printk(fmt, ##args)
+#else
+#define dbg(fmt, args...)
+#define dbgn(fmt, args...)
+#endif // M1120_DBG_ENABLE
+#define dbg_func_in()      dbg("[M1120-DBG-F.IN] %s", __func__)
+#define dbg_func_out()    dbg("[M1120-DBG-F.OUT] %s", __func__)
+#define dbg_line()        dbg("[LINE] %d(%s)", __LINE__, __func__)
+/***********************************************************/
+
+
+/***********************************************************/
+/*error display macro*/
+/***********************************************************/
+#define mxerr(pdev, fmt, args...)          \
+    dev_err(pdev, "[M1120-ERR] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+#define mxinfo(pdev, fmt, args...)        \
+    dev_info(pdev, "[M1120-INFO] %s(L%04d) : " fmt "\n", __func__, __LINE__, ##args)
+/***********************************************************/
+
+/***********************************************************/
+/*static variable*/
+/***********************************************************/
+static m1120_data_t *p_m1120_data;
+/***********************************************************/
+
+
+/***********************************************************/
+/*function protyps*/
+/***********************************************************/
+/*i2c interface*/
+static int m1120_i2c_read_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len);
+static int m1120_i2c_write_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len);
+static void m1120_short_to_2byte(m1120_data_t* m1120_data, short x, u8 *hbyte, u8 *lbyte);
+static short m1120_2byte_to_short(m1120_data_t* m1120_data, u8 hbyte, u8 lbyte);
+/*vdd / vid power control*/
+static int m1120_set_power(struct device *dev, bool on);
+
+
+static int  m1120_get_enable(struct device *dev);
+static void m1120_set_enable(struct device *dev, int enable);
+static int  m1120_get_delay(struct device *dev);
+static void m1120_set_delay(struct device *dev, int delay);
+static int  m1120_get_debug(struct device *dev);
+static void m1120_set_debug(struct device *dev, int debug);
+static int  m1120_clear_interrupt(struct device *dev);
+static int  m1120_set_operation_mode(struct device *dev, int mode);
+static int  m1120_init_device(struct device *dev);
+static int  m1120_reset_device(struct device *dev);
+static int  m1120_power_ctl(m1120_data_t *data, bool on);
+static int m1120_get_data( short *data);
+/***********************************************************/
+
+
+/***********************************************************/
+/*functions for i2c interface*/
+/***********************************************************/
+#define M1120_I2C_BUF_SIZE                (17)
+
+
+static int m1120_i2c_read_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len)
+{
+	u8 reg_addr = addr;
+	int err = 0;
+	struct i2c_client *client = NULL;
+	struct i2c_msg msgs[2]={{0},{0}};
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+    client = m1120_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+	//mutex_lock(&m1120_i2c_mutex); Ëø¾ßÌåÔõôÀ´ÓÃ,µÈºóÃæÔÙ¿´,ÏÈ×¢Ê͵ô
+
+	msgs[0].addr = client->addr;
+	msgs[0].flags = 0;
+ 	msgs[0].len =1;
+ 	msgs[0].buf = &reg_addr;
+
+ 	msgs[1].addr = client->addr;
+ 	msgs[1].flags = I2C_M_RD;
+ 	msgs[1].len =len;
+ 	msgs[1].buf = data;
+
+ 	err = i2c_transfer(client->adapter, msgs, (sizeof(msgs) / sizeof(msgs[0])));
+
+ 	if (err < 0) {
+ 		MOTOR_ERR("i2c_transfer error: (%d %p %d) %d\n",addr, data, len, err);
+ 		err = -EIO;
+ 	} else  {
+ 		err = 0;
+ 	}
+ 	//mutex_unlock(&m1120_i2c_mutex);
+
+ 	return err;
+
+}
+
+static int m1120_i2c_write_block(m1120_data_t* m1120_data, u8 addr, u8 *data, u8 len)
+{
+	int err = 0;
+	int idx = 0;
+	int num = 0;
+	char buf[M1120_I2C_BUF_SIZE] ={0};
+	struct i2c_client *client = NULL;
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+    client = m1120_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+
+	//mutex_lock(&m1120_i2c_mutex);
+
+	buf[num++] = addr;
+	for (idx = 0; idx < len; idx++) {
+		buf[num++] = data[idx];
+	}
+
+	err = i2c_master_send(client, buf, num);
+	if (err < 0) {
+		MOTOR_ERR("send command error!! %d\n",err);
+	}
+
+	//store reg written
+	if (len == 1) {
+		switch(addr){
+		case M1120_REG_PERSINT:
+			m1120_data->reg.map.persint = data[0];
+			break;
+		case M1120_REG_INTSRS:
+			m1120_data->reg.map.intsrs = data[0];
+			break;
+		case M1120_REG_LTHL:
+			m1120_data->reg.map.lthl = data[0];
+			break;
+		case M1120_REG_LTHH:
+			m1120_data->reg.map.lthh = data[0];
+			break;
+		case M1120_REG_HTHL:
+			m1120_data->reg.map.hthl = data[0];
+			break;
+		case M1120_REG_HTHH:
+			m1120_data->reg.map.hthh = data[0];
+			break;
+		case M1120_REG_I2CDIS:
+			m1120_data->reg.map.i2cdis = data[0];
+			break;
+		case M1120_REG_SRST:
+			m1120_data->reg.map.srst = data[0];
+			break;
+		case M1120_REG_OPF:
+			m1120_data->reg.map.opf = data[0];
+			break;
+		}
+	}
+
+	//mutex_unlock(&m1120_i2c_mutex);
+	return err;
+}
+
+static void m1120_short_to_2byte(m1120_data_t* m1120_data, short x, u8 *hbyte, u8 *lbyte)
+{
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return ;
+    }
+
+	if ((m1120_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		/* 8 bit resolution */
+		if (x < -128) {
+			x = -128;
+		} else if(x > 127) {
+			x = 127;
+		}
+
+		if (x >= 0) {
+			*lbyte = x & 0x7F;
+		} else {
+			*lbyte = ( (0x80 - (x*(-1))) & 0x7F ) | 0x80;
+		}
+		*hbyte = 0x00;
+	} else {
+		/* 10 bit resolution */
+		if (x < -512) {
+			x = -512;
+		} else if (x > 511) {
+			x = 511;
+		}
+
+		if (x >=0 ) {
+			*lbyte = x & 0xFF;
+			*hbyte = (((x & 0x100) >> 8) & 0x01) << 6;
+		} else {
+			*lbyte = (0x0200 - (x*(-1))) & 0xFF;
+			*hbyte = ((((0x0200 - (x*(-1))) & 0x100) >> 8) << 6) | 0x80;
+		}
+	}
+}
+/***********************************************************/
+
+
+static short m1120_2byte_to_short(m1120_data_t* m1120_data, u8 hbyte, u8 lbyte)
+{
+	short x = 0;
+
+    if (!m1120_data) {
+		MOTOR_ERR("m1120_data == NULL\n");
+		return -EINVAL;
+    }
+
+	if( (m1120_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		/* 8 bit resolution */
+		x = lbyte & 0x7F;
+		if (lbyte & 0x80) {
+			x -= 0x80;
+		}
+	} else {
+		/* 10 bit resolution */
+		x = ( ( (hbyte & 0x40) >> 6) << 8 ) | lbyte;
+		if (hbyte & 0x80) {
+			x -= 0x200;
+		}
+	}
+
+	return x;
+}
+
+/***********************************************************/
+/*vdd / vid power control*/
+/***********************************************************/
+static int m1120_set_power(struct device *dev, bool on)
+{
+    m1120_power_ctl(p_m1120_data, on);
+
+    return 0;
+}
+/***********************************************************/
+
+
+static irqreturn_t m1120_up_irq_handler(int irq, void *dev_id)
+{
+	MOTOR_LOG("call \n");
+
+	if (!p_m1120_data) {
+		MOTOR_LOG("p_m1120_data NULL \n");
+		return -EINVAL;
+	}
+
+	disable_irq_nosync(p_m1120_data->irq);
+	oneplus_hall_irq_handler(0);//DHALL_UP
+
+	return IRQ_HANDLED;
+}
+
+
+static int m1120_get_enable(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    return atomic_read(&p_data->atm.enable);
+}
+
+
+static void m1120_set_enable(struct device *dev, int enable)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+//    int delay = m1120_get_delay(dev);
+
+    mutex_lock(&p_data->mtx.enable);
+    MOTOR_LOG("enable : %d\n", enable);
+    if (enable) {                  /*enable if state will be changed*/
+        if (!atomic_cmpxchg(&p_data->atm.enable, 0, 1)) {
+            //m1120_set_detection_mode(dev, p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT);
+            //m1120_set_detection_mode(dev, p_data->reg.map.intsrs & M1120_DETECTION_MODE_POLLING);
+            m1120_set_operation_mode(&p_m1120_data->client->dev, OPERATION_MODE_MEASUREMENT);
+            /*if(!(p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT))*/
+            // if (0) {
+            //     schedule_delayed_work(&p_data->work, msecs_to_jiffies(delay));
+            // }
+        }
+    } else {                        /*disable if state will be changed*/
+        if (atomic_cmpxchg(&p_data->atm.enable, 1, 0)) {
+            //cancel_delayed_work_sync(&p_data->work);
+            m1120_set_operation_mode(&p_m1120_data->client->dev, OPERATION_MODE_POWERDOWN);
+        }
+    }
+    atomic_set(&p_data->atm.enable, enable);
+
+    mutex_unlock(&p_data->mtx.enable);
+}
+
+static int m1120_get_delay(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    int delay = 0;
+
+    delay = atomic_read(&p_data->atm.delay);
+
+    return delay;
+}
+
+static void m1120_set_delay(struct device *dev, int delay)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    if (delay < M1120_DELAY_MIN)
+        delay = M1120_DELAY_MIN;
+    atomic_set(&p_data->atm.delay, delay);
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(dev)) {
+        if (!(p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT)) {
+            cancel_delayed_work_sync(&p_data->work);
+            schedule_delayed_work(&p_data->work, msecs_to_jiffies(delay));
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+}
+
+static int m1120_get_debug(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    return atomic_read(&p_data->atm.debug);
+}
+
+static void m1120_set_debug(struct device *dev, int debug)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    atomic_set(&p_data->atm.debug, debug);
+}
+
+static int m1120_clear_interrupt(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    int ret = 0;
+    u8 data = 0x00;
+
+    data = p_data->reg.map.persint | 0x01;
+    ret =  m1120_i2c_write_block(p_data, M1120_REG_PERSINT, &data,1);
+
+    return ret;
+}
+
+static int m1120_set_operation_mode(struct device *dev, int mode)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    u8 opf = p_data->reg.map.opf;
+    int err = -1;
+
+    switch (mode) {
+    case OPERATION_MODE_POWERDOWN:
+        opf &= (0xFF - M1120_VAL_OPF_HSSON_ON);
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_POWERDOWN");
+        break;
+    case OPERATION_MODE_MEASUREMENT:
+        opf &= (0xFF - M1120_VAL_OPF_EFRD_ON);
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_MEASUREMENT");
+        break;
+    case OPERATION_MODE_FUSEROMACCESS:
+        opf |= M1120_VAL_OPF_EFRD_ON;
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &opf, 1);
+        mxinfo(&client->dev, "operation mode was chnaged to OPERATION_MODE_FUSEROMACCESS");
+        break;
+    }
+    mxinfo(&client->dev, "opf = ox%x \n", opf);
+    return err;
+}
+
+static int m1120_init_device(struct device *dev)
+{
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+    int err = -1;
+
+    /*(1) vdd and vid power up*/
+    err = m1120_set_power(dev, 1);
+    if (err) {
+        mxerr(&client->dev, "m1120 power-on was failed (%d)", err);
+        return err;
+    }
+
+    /*(2) init variables*/
+    atomic_set(&p_data->atm.enable, 0);
+    atomic_set(&p_data->atm.delay, M1120_DELAY_MIN);
+#ifdef M1120_DBG_ENABLE
+    atomic_set(&p_data->atm.debug, 1);
+#else
+    atomic_set(&p_data->atm.debug, 0);
+#endif
+    p_data->calibrated_data = 0;
+    p_data->last_data = 0;
+    p_data->irq_enabled = 0;
+    p_data->irq_first = 1;
+    p_data->thrhigh = M1120_DETECT_RANGE_HIGH;
+    p_data->thrlow = M1120_DETECT_RANGE_LOW;
+    m1120_set_delay(&client->dev, M1120_DELAY_MAX);
+    m1120_set_debug(&client->dev, 0);
+
+    /*(3) reset registers*/
+    err = m1120_reset_device(dev);
+    if (err < 0) {
+        mxerr(&client->dev, "m1120_reset_device was failed (%d)", err);
+        return err;
+    }
+
+    mxinfo(&client->dev, "initializing device was success");
+
+    return 0;
+}
+
+static int m1120_reset_device(struct device *dev)
+{
+    int err = 0;
+    u8  id = 0xFF, data = 0x00;
+
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    if ((p_data == NULL) || (p_data->client == NULL))
+        return -ENODEV;
+
+    /*(1) sw reset*/
+    data = M1120_VAL_SRST_RESET;
+    err = m1120_i2c_write_block(p_data, M1120_REG_SRST, &data,1);
+    if (err < 0) {
+        mxerr(&client->dev, "sw-reset was failed(%d)", err);
+        return err;
+    }
+    msleep(5);
+    dbg("wait 5ms after vdd power up");
+
+    /*(2) check id*/
+    err = 	m1120_i2c_read_block(p_data, M1120_REG_DID, &id, 1);
+    if (err < 0)
+        return err;
+    if (id != M1120_VAL_DID) {
+        mxerr(&client->dev, "current device id(0x%02X) is not M1120 device id(0x%02X)", id, M1120_VAL_DID);
+        return -ENXIO;
+    }
+
+    /*(3) init variables*/
+    /*(3-1) persint*/
+    data = M1120_PERSISTENCE_COUNT;
+    err =   m1120_i2c_write_block(p_data, M1120_REG_PERSINT, &data,1);
+    if (err <0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+    /*(3-2) intsrs*/
+    data = M1120_DETECTION_MODE | M1120_SENSITIVITY_TYPE;
+    if (data & M1120_DETECTION_MODE_INTERRUPT) {
+        data |= M1120_INTERRUPT_TYPE;
+    }
+    err = m1120_i2c_write_block(p_data, M1120_REG_INTSRS, &data, 1);
+    if (err < 0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+    /*(3-3) opf*/
+    data = M1120_OPERATION_FREQUENCY | M1120_OPERATION_RESOLUTION;
+    err = m1120_i2c_write_block(p_data, M1120_REG_OPF, &data, 1);
+    if (err < 0) {
+        mxerr(&client->dev, "cm1120_i2c_write_block error, data : %d", data);
+        return err;
+    }
+
+    /*(4) write variable to register*/
+    // err = m1120_set_detection_mode(dev, M1120_DETECTION_MODE);
+    // if (err) {
+    //     mxerr(&client->dev, "m1120_set_detection_mode was failed(%d)", err);
+    //     return err;
+    // }
+
+
+    /*(5) set power-on mode*/
+    err = m1120_set_operation_mode(dev, OPERATION_MODE_MEASUREMENT);
+    if (err < 0) {
+        mxerr(&client->dev, "m1120_set_detection_mode was failed(%d)", err);
+        return err;
+    }
+
+    return err;
+}
+
+/**************************************************
+   input device interface
+   **************************************************/
+static int m1120_input_dev_init(m1120_data_t *p_data)
+{
+    struct input_dev *dev;
+    int err;
+
+    dev = input_allocate_device();
+    if (!dev) {
+        return -ENOMEM;
+    }
+    dev->name = M1120_DRIVER_NAME_UP;
+    dev->id.bustype = BUS_I2C;
+
+#if (M1120_EVENT_TYPE == EV_ABS)
+    input_set_drvdata(dev, p_data);
+    input_set_capability(dev, M1120_EVENT_TYPE, ABS_MISC);
+    input_set_abs_params(dev, M1120_EVENT_CODE, M1120_EVENT_DATA_CAPABILITY_MIN, M1120_EVENT_DATA_CAPABILITY_MAX, 0, 0);
+#elif (M1120_EVENT_TYPE == EV_KEY)
+    input_set_drvdata(dev, p_data);
+    input_set_capability(dev, M1120_EVENT_TYPE, M1120_EVENT_CODE);
+#else
+#error ("[ERR] M1120_EVENT_TYPE is not defined.")
+#endif
+
+    err = input_register_device(dev);
+    if (err < 0) {
+        input_free_device(dev);
+        return err;
+    }
+
+    p_data->input_dev = dev;
+
+    return 0;
+}
+
+static void m1120_input_dev_terminate(m1120_data_t *p_data)
+{
+    struct input_dev *dev = p_data->input_dev;
+
+    input_unregister_device(dev);
+    input_free_device(dev);
+}
+
+/**************************************************
+   sysfs attributes
+   **************************************************/
+static ssize_t m1120_enable_show(struct device *dev,
+                  struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_enable(dev));
+}
+
+static ssize_t m1120_enable_store(struct device *dev,
+                   struct device_attribute *attr,
+                   const char *buf, size_t count)
+{
+    unsigned long enable = simple_strtoul(buf, NULL, 10);
+
+    if ((enable == 0) || (enable == 1)) {
+        m1120_set_enable(dev, enable);
+    }
+
+    return count;
+}
+
+static ssize_t m1120_delay_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_delay(dev));
+}
+
+static ssize_t m1120_delay_store(struct device *dev,
+                  struct device_attribute *attr,
+                  const char *buf, size_t count)
+{
+    unsigned long delay = simple_strtoul(buf, NULL, 10);
+
+    if (delay > M1120_DELAY_MAX) {
+        delay = M1120_DELAY_MAX;
+    }
+
+    m1120_set_delay(dev, delay);
+
+    return count;
+}
+
+static ssize_t m1120_debug_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    return snprintf(buf, 20, "%d\n", m1120_get_debug(dev)); 
+}
+
+static ssize_t m1120_debug_store(struct device *dev,
+                  struct device_attribute *attr,
+                  const char *buf, size_t count)
+{
+    unsigned long debug = simple_strtoul(buf, NULL, 10);
+
+    m1120_set_debug(dev, debug);
+
+    return count;
+}
+
+static ssize_t m1120_wake_store(struct device *dev,
+                 struct device_attribute *attr,
+                 const char *buf, size_t count)
+{
+    return 0;
+}
+
+static ssize_t m1120_data_show(struct device *dev,
+                 struct device_attribute *attr, char *buf)
+{
+    //struct i2c_client *client = to_i2c_client(dev);
+    //m1120_data_t *p_data = i2c_get_clientdata(client);
+    short raw = 0;
+    m1120_get_data(&raw);
+    return snprintf(buf, 10, "%d\n", raw);
+}
+
+static int m1120_i2c_read(struct i2c_client *client, u8 reg, u8 *rdata, u8 len)
+{
+#if 0////add by James.
+	int rc;
+	struct i2c_msg msg[] = {
+	{
+		.addr = client->addr,
+		.flags = 0,
+		.len = 1,
+		.buf = &reg,
+	},
+	{
+		.addr = client->addr,
+		.flags = I2C_M_RD,
+		.len = len,
+		.buf = rdata,
+	},
+	};
+	if (client == NULL) {
+	mxerr(&client->dev, "client is NULL");
+	return -ENODEV;
+	}
+	rc = i2c_transfer(client->adapter, msg, 2);
+	if (rc < 0) {
+		mxerr(&client->dev, "i2c_transfer was failed(%d)", rc);
+		return rc;
+	}
+#else 
+	/*Add By James for i2c_smbus_read_i2c_block_data */
+	i2c_smbus_read_i2c_block_data(client, reg, len, rdata);
+#endif
+	return 0;
+}
+
+static int  m1120_i2c_get_reg(struct i2c_client *client, u8 reg, u8 *rdata)
+{
+    return m1120_i2c_read(client, reg, rdata, 1);
+}
+
+static void m1120_get_reg(struct device *dev, int *regdata)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	int err;
+	u8 rega = (((*regdata) >> 8) & 0xFF);
+	u8 regd = 0;
+	err = m1120_i2c_get_reg(client, rega, &regd);
+	*regdata = 0;
+	*regdata |= (err == 0) ? 0x0000 : 0xFF00;
+	*regdata |= regd;
+}
+
+static ssize_t m1120_dump_show(struct device *dev,struct device_attribute *attr, char *buf)
+{
+	int reg = 0;
+	int reg_l = M1120_REG_HSL;
+	int reg_h = M1120_REG_HSH;
+	int i = 0;
+	for (i = 0; i < 11; i++) {
+		reg = i<<8;
+		m1120_get_reg(&p_m1120_data->client->dev, &reg);
+		printk(KERN_ERR"dkk: the reg 0x%02X value: 0x%02X\n", i, reg);
+	}
+	m1120_get_reg(&p_m1120_data->client->dev, &reg_l);
+	printk(KERN_ERR"dkk: the reg_l is 0x%02X\n", (u8)(reg_l&0xFF));
+	m1120_get_reg(&p_m1120_data->client->dev, &reg_h);
+	printk(KERN_ERR"dkk: the reg_h is 0x%02X", (u8)(reg_h&0xFF));
+	reg = ((reg_h&0xC0) << 2)|reg_l;
+	printk(KERN_ERR"dkk: the down hall reg measure is 0x%02X\n", reg);
+	return snprintf(buf, 10, "%d\n", reg);
+//return 0;
+	}
+
+
+static DEVICE_ATTR(enable,  S_IRUGO|S_IWUSR|S_IWGRP, m1120_enable_show, m1120_enable_store);
+static DEVICE_ATTR(delay,   S_IRUGO|S_IWUSR|S_IWGRP, m1120_delay_show,  m1120_delay_store);
+static DEVICE_ATTR(debug,   S_IRUGO|S_IWUSR|S_IWGRP, m1120_debug_show,  m1120_debug_store);
+static DEVICE_ATTR(wake,    S_IWUSR|S_IWGRP,         NULL,            m1120_wake_store);
+static DEVICE_ATTR(rawdata, S_IRUGO|S_IWUSR|S_IWGRP, m1120_data_show,   NULL);
+static DEVICE_ATTR(dump,    S_IRUGO|S_IWUSR|S_IWGRP, m1120_dump_show,   NULL);
+
+static struct attribute *m1120_attributes[] = {
+    &dev_attr_enable.attr,
+    &dev_attr_delay.attr,
+    &dev_attr_debug.attr,
+    &dev_attr_wake.attr,
+    &dev_attr_rawdata.attr,
+    &dev_attr_dump.attr,
+    NULL
+};
+
+static struct attribute_group m1120_attribute_group = {
+    .attrs = m1120_attributes
+};
+
+static int m1120_power_ctl(m1120_data_t *data, bool on)
+{
+    int ret = 0;
+    int err = 0;
+
+    if (!on && data->power_enabled) {
+        ret = regulator_disable(data->vdd);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vdd disable failed ret=%d\n", ret);
+            return ret;
+        }
+
+        ret = regulator_disable(data->vio);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vio disable failed ret=%d\n", ret);
+            err = regulator_enable(data->vdd);
+            return ret;
+        }
+        data->power_enabled = on;
+    } else if (on && !data->power_enabled) {
+        ret = regulator_enable(data->vdd);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vdd enable failed ret=%d\n", ret);
+            return ret;
+        }
+              msleep(8);////>=5ms OK.
+        ret = regulator_enable(data->vio);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator vio enable failed ret=%d\n", ret);
+            err = regulator_disable(data->vdd);
+            return ret;
+        }
+        msleep(10); // wait 10ms
+        data->power_enabled = on;
+    } else {
+        dev_info(&data->client->dev,
+                "Power on=%d. enabled=%d\n",
+                on, data->power_enabled);
+    }
+
+    return ret;
+}
+
+static int m1120_power_init(m1120_data_t *data)
+{
+    int ret;
+
+    data->vdd = regulator_get(&data->client->dev, "vdd");
+    if (IS_ERR(data->vdd)) {
+        ret = PTR_ERR(data->vdd);
+        dev_err(&data->client->dev,
+            "Regulator get failed vdd ret=%d\n", ret);
+        return ret;
+    }
+
+    if (regulator_count_voltages(data->vdd) > 0) {
+        ret = regulator_set_voltage(data->vdd,
+                M1120_VDD_MIN_UV,
+                M1120_VDD_MAX_UV);
+        if (ret) {
+            dev_err(&data->client->dev,
+                "Regulator set failed vdd ret=%d\n",
+                ret);
+            goto reg_vdd_put;
+        }
+    }
+
+    data->vio = regulator_get(&data->client->dev, "vio");
+    if (IS_ERR(data->vio)) {
+        ret = PTR_ERR(data->vio);
+        dev_err(&data->client->dev,
+            "Regulator get failed vio ret=%d\n", ret);
+        goto reg_vdd_set;
+    }
+
+    if (regulator_count_voltages(data->vio) > 0) {
+        ret = regulator_set_voltage(data->vio,
+                M1120_VIO_MIN_UV,
+                M1120_VIO_MAX_UV);
+        if (ret) {
+            dev_err(&data->client->dev,
+            "Regulator set failed vio ret=%d\n", ret);
+            goto reg_vio_put;
+        }
+    }
+
+    return 0;
+
+reg_vio_put:
+    regulator_put(data->vio);
+reg_vdd_set:
+    if (regulator_count_voltages(data->vdd) > 0)
+        regulator_set_voltage(data->vdd, 0, M1120_VDD_MAX_UV);
+reg_vdd_put:
+    regulator_put(data->vdd);
+    return ret;
+}
+
+
+static int tri_key_m1120_parse_dt(struct device *dev,
+            m1120_data_t *pdata)
+{
+    struct device_node *np = dev->of_node;
+	struct pinctrl *key_pinctrl;
+	struct pinctrl_state *set_state;
+    u32 temp_val;
+    int rc;
+    struct i2c_client *client = to_i2c_client(dev);
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dev_err(dev, "======> %s", __func__); 
+    rc = of_property_read_u32(np, "magnachip,init-interval", &temp_val);
+    if (rc && (rc != -EINVAL)) {
+        dev_err(dev, "Unable to read init-interval\n");
+        return rc;
+    } else {
+        if (temp_val < M1120_DELAY_MIN)
+            temp_val = M1120_DELAY_MIN;
+        atomic_set(&p_data->atm.delay, temp_val);
+    }
+
+    p_data->int_en = of_property_read_bool(np, "magnachip,use-interrupt");
+
+    p_data->igpio = of_get_named_gpio_flags(dev->of_node,
+                "magnachip,gpio-int", 0, NULL);
+
+    p_data->irq_gpio =  of_get_named_gpio(np, "dhall,irq-gpio", 0);
+    dev_err(dev, "irq_gpio : %d", p_data->irq_gpio);
+
+    p_data->use_hrtimer = of_property_read_bool(np, "magnachip,use-hrtimer");
+
+	key_pinctrl = devm_pinctrl_get(dev);
+
+	if (IS_ERR_OR_NULL(key_pinctrl)) {
+		dev_err(dev, "Failed to get pinctrl\n");
+	}
+	set_state = pinctrl_lookup_state(key_pinctrl,
+		"uphall_tri_state_key_active");
+	if (IS_ERR_OR_NULL(set_state)) {
+		dev_err(dev, "Failed to lookup_state\n");
+	}
+
+	pinctrl_select_state(key_pinctrl,set_state);
+
+
+    return 0;
+}
+
+//interface implement for op_motor.c
+
+static int m1120_get_data( short *data)
+{ 
+    int err = 0;
+	u8 buf[3] = {0};
+	short value = 0;
+
+    printk(KERN_INFO "======> %s", __func__);
+    if(!p_m1120_data) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -1;
+    }
+	// (1) read data
+	err = m1120_i2c_read_block(p_m1120_data, M1120_REG_ST1, buf, sizeof(buf));
+	if (err < 0) {
+		MOTOR_LOG(" fail %d \n",err);
+		return err;
+	}
+
+	// (2) collect data
+	if (buf[0] & 0x01) {
+		value = m1120_2byte_to_short(p_m1120_data, buf[2], buf[1]);
+	} else {
+		MOTOR_LOG("m1120: st1(0x%02X) is not DRDY.\n", buf[0]);
+		return err;
+	}
+	*data = value;
+    MOTOR_LOG("up, value : %d\n", value);
+	return 0;
+}
+
+static int m1120_enable_irq(bool enable)
+{
+    printk(KERN_INFO "======> %s", __func__);
+
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	if (enable) {
+		enable_irq(p_m1120_data->irq);
+	} else {
+		disable_irq_nosync(p_m1120_data->irq);
+	}
+
+    return 0;
+}
+
+static int m1120_clear_irq()
+{
+    printk(KERN_INFO "======> %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_clear_interrupt(&p_m1120_data->client->dev);
+    return 0;
+}
+
+static int m1120_get_irq_state()
+{
+    printk(KERN_INFO "======> %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+    return ((p_m1120_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) ? 1 : 0);   
+}
+
+static bool m1120_update_threshold(int position, short lowthd, short highthd)
+{
+    
+    u8 lthh, lthl, hthh, hthl;
+	int err = 0;
+
+    printk(KERN_INFO "======> %s", __func__);
+	if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("m1120_up ,low:%d, high:%d  \n",lowthd, highthd);
+
+	err = m1120_clear_interrupt(&p_m1120_data->client->dev);
+
+	//if (p_m1120_data->reg.map.intsrs & M1120_VAL_INTSRS_INTTYPE_BESIDE) {
+	if (p_m1120_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+        printk("up hall m1120_update_threshold, lowthd=%d, highthd=%d.\n", lowthd, highthd);
+		m1120_short_to_2byte(p_m1120_data, highthd, &hthh, &hthl);
+		m1120_short_to_2byte(p_m1120_data, lowthd, &lthh, &lthl);
+
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_HTHH,&hthh, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_HTHL,&hthl, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_LTHH,&lthh, 1);
+		err |= m1120_i2c_write_block(p_m1120_data, M1120_REG_LTHL,&lthl, 1);
+	}
+
+	if (err < 0) {
+		MOTOR_ERR("tri_key:fail %d\n",err);
+		return false;
+	} else {
+		return true;
+	}
+
+    return true;  
+}
+
+static void m1120_dump_reg(u8* buf)
+{
+    int i, err;
+	u8 val;
+	u8 buffer[512] = {0};
+	u8 _buf[20] = {0};
+
+    printk(KERN_INFO "======> %s", __func__);
+	if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return ;
+	}
+
+	for (i = 0; i <= 0x12; i++) {
+		memset(_buf, 0, sizeof(_buf));
+
+		err = m1120_i2c_read_block(p_m1120_data, i, &val, 1);
+		if (err < 0) {
+			snprintf(buf, PAGE_SIZE, "read reg error!\n");
+			return;
+		}
+
+		snprintf(_buf, sizeof(_buf), "reg 0x%x:0x%x\n", i, val);
+		strcat(buffer, _buf);
+	}
+	snprintf(buf, PAGE_SIZE, "%s\n", buffer);
+	MOTOR_LOG("%s \n",buf);
+	return;
+}
+
+static bool m1120_is_power_on()
+{
+    printk(KERN_INFO "======> %s", __func__);
+    if (p_m1120_data == NULL) {
+		MOTOR_LOG("p_m1120_data == NULL \n");
+		return false;
+	}
+
+    return p_m1120_data->power_enabled > 0 ? true : false;
+}
+
+static int m1120_set_detection_mode_1(u8 mode)
+{
+	u8 data = 0;
+	int err = 0;
+
+    printk(KERN_INFO "======> %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	MOTOR_LOG("m1120 up detection mode : %s\n", (mode == 0)? "POLLING":"INTERRUPT");
+
+	if(mode & DETECTION_MODE_INTERRUPT) { //interrupt mode
+		if (!p_m1120_data->irq_enabled) {
+			data = p_m1120_data->reg.map.intsrs | M1120_DETECTION_MODE_INTERRUPT;
+
+			err = m1120_i2c_write_block(p_m1120_data, M1120_REG_INTSRS, &data, 1);//
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail %d \n",err);
+				return err;
+			}
+
+			err = m1120_clear_interrupt(&p_m1120_data->client->dev);
+			if (err < 0) {
+				MOTOR_ERR("clear interupt fail %d \n",err);
+				return err;
+			}
+
+			/* requst irq */
+			MOTOR_LOG("m1120 down enter irq handler\n");
+            if (request_irq(p_m1120_data->irq, &m1120_up_irq_handler, IRQ_TYPE_LEVEL_LOW, "hall_m1120_up",(void *)p_m1120_data->client)) {
+				MOTOR_ERR("IRQ LINE NOT AVAILABLE!!\n");
+				return -EINVAL;
+			}
+			irq_set_irq_wake(p_m1120_data->irq, 1);
+
+			p_m1120_data->irq_enabled = 1;
+		}
+	} else { // polling mode
+		if (p_m1120_data->irq_enabled) {
+			data = p_m1120_data->reg.map.intsrs & (0xFF - M1120_DETECTION_MODE_INTERRUPT);
+
+			err = m1120_i2c_write_block(p_m1120_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail %d \n",err);
+				return err;
+			}
+
+			disable_irq(p_m1120_data->irq);
+			free_irq(p_m1120_data->irq, NULL);
+
+			p_m1120_data->irq_enabled = 0;
+		}
+	}
+
+    return 0;    
+}
+
+static int m1120_set_reg_1(int reg, int val)
+{
+
+    u8 data = (u8)val;
+
+    printk(KERN_INFO "======> %s", __func__);
+    if(p_m1120_data == NULL) {
+        MOTOR_ERR("p_m1120_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_i2c_write_block(p_m1120_data, (u8)reg, &data,1);
+    return 0;  
+}
+
+struct dhall_operations  m1120_ups_ops = {
+	.get_data  = m1120_get_data,
+	.enable_irq = m1120_enable_irq,
+	.clear_irq = m1120_clear_irq,
+	.get_irq_state = m1120_get_irq_state,
+	.set_detection_mode = m1120_set_detection_mode_1,
+	.update_threshold = m1120_update_threshold,
+	.dump_regs = m1120_dump_reg,
+	.set_reg = m1120_set_reg_1,
+	.is_power_on = m1120_is_power_on
+};
+
+/**************************************************
+   i2c client
+   **************************************************/
+
+static int tri_key_m1120_i2c_drv_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    m1120_platform_data_t   *p_platform;
+    m1120_data_t            *p_data;
+    int                  err = 0;
+
+    dbg_func_in();
+
+    printk(KERN_INFO "======> allocation memory for p_m1120_data up %s\n", __func__);
+    /*(1) allocation memory for p_m1120_data*/
+    p_data = kzalloc(sizeof(m1120_data_t), GFP_KERNEL);
+    if (!p_data) {
+        mxerr(&client->dev, "kernel memory alocation was failed");
+        err = -ENOMEM;
+        goto error_0;
+    }
+
+    /*(2) init mutex variable*/
+    mutex_init(&p_data->mtx.enable);
+    mutex_init(&p_data->mtx.data);
+    p_data->power_enabled = false;
+    printk(KERN_INFO "======>  init mutex variable \n");
+    /*(3) config i2c client*/
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        mxerr(&client->dev, "i2c_check_functionality was failed");
+        err = -ENODEV;
+        goto error_1;
+    }
+    i2c_set_clientdata(client, p_data);
+    p_data->client = client;
+    p_m1120_data = p_data;
+
+    if (client->dev.of_node) {
+        dev_err(&client->dev, "Use client->dev.of_node\n");
+        err = tri_key_m1120_parse_dt(&client->dev, p_data);
+        if (err) {
+            dev_err(&client->dev, "Failed to parse device tree\n");
+            err = -EINVAL;
+            goto error_1;
+        }
+    } else {
+        p_platform = client->dev.platform_data;
+        dev_err(&client->dev, "Use platform data\n");
+    }
+    /*(5) setup interrupt gpio*/
+    /*if (p_data->igpio != -1) {
+        err = gpio_request(p_data->igpio, "m1120_irq");
+        if (err) {
+            mxerr(&client->dev, "gpio_request was failed(%d)", err);
+            goto error_1;
+        }
+        mxinfo(&client->dev, "gpio_request was success");
+        err = gpio_direction_input(p_data->igpio);
+        if (err < 0) {
+            mxerr(&client->dev, "gpio_direction_input was failed(%d)", err);
+            goto error_2;
+        }
+        mxinfo(&client->dev, "gpio_direction_input was success");
+    }*/
+
+    //pull pm8150 gpio_04 down
+    // err = set_gpio_state(&client->dev);
+    // if (err) {
+    //     dev_err(&client->dev, "Failed to set gpio state\n");
+    // }
+    //gpio irq request 
+    if (gpio_is_valid(p_data->irq_gpio)) {
+        err = gpio_request(p_data->irq_gpio, "m1120_up_irq");
+        if (err) {
+            mxerr(&client->dev, "unable to request gpio [%d]", p_data->irq_gpio);
+        } else {
+            err = gpio_direction_input(p_data->irq_gpio);
+            msleep(50);
+            p_data->irq = gpio_to_irq(p_data->irq_gpio);
+            mxerr(&client->dev, "======> irq : %d", p_data->irq);
+        }
+
+    }
+
+    err = m1120_power_init(p_data);
+    if (err) {
+        dev_err(&client->dev, "Failed to get sensor regulators\n");
+        err = -EINVAL;
+        goto error_1;
+    }
+    err = m1120_power_ctl(p_data, true);
+    if (err) {
+        dev_err(&client->dev, "Failed to enable sensor power\n");
+        err = -EINVAL;
+        goto error_1;
+    }
+
+
+    /*(6) reset and init device*/
+    err = m1120_init_device(&p_data->client->dev);
+    if (err) {
+        mxerr(&client->dev, "m1120_init_device was failed(%d)", err);
+        goto error_1;
+    }
+    mxinfo(&client->dev, "%s was found", id->name);
+
+    /*(7) config work function*/
+    //INIT_DELAYED_WORK(&p_data->work, m1120_work_func);
+
+    /*(8) init input device*/
+    err = m1120_input_dev_init(p_data);
+    if (err) {
+        mxerr(&client->dev, "m1120_input_dev_init was failed(%d)", err);
+        goto error_1;
+    }
+    mxinfo(&client->dev, "%s was initialized", M1120_DRIVER_NAME_UP);
+
+    /*(9) create sysfs group*/
+    err = sysfs_create_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+    if (err) {
+        mxerr(&client->dev, "sysfs_create_group was failed(%d)", err);
+        goto error_3;
+    }
+
+    /*(10) register misc device*/
+    // err = misc_register(&m1120_misc_dev);
+    // if (err) {
+    //     mxerr(&client->dev, "misc_register was failed(%d)", err);
+    //     goto error_4;
+    // }
+
+    /*(11) register ops to abstrace level*/
+    oneplus_register_hall("hall_m1120_up",&m1120_ups_ops);
+
+    printk(KERN_INFO "======> i2c addr : %d\n", client->addr);
+    /*(12) imigrate p_data to p_m1120_data*/
+    dbg("%s : %s was probed.\n", __func__, M1120_DRIVER_NAME_UP);
+
+    return 0;
+
+//error_4:
+ //   sysfs_remove_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+
+error_3:
+    m1120_input_dev_terminate(p_data);
+
+
+error_1:
+    kfree(p_data);
+
+error_0:
+       p_m1120_data = NULL;
+    return err;
+}
+
+static int m1120_i2c_drv_remove(struct i2c_client *client)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    m1120_set_enable(&client->dev, 0);
+   // misc_deregister(&m1120_misc_dev);
+    sysfs_remove_group(&p_data->input_dev->dev.kobj, &m1120_attribute_group);
+    m1120_input_dev_terminate(p_data);
+    if (p_data->igpio != -1) {
+        gpio_free(p_data->igpio);
+    }
+    kfree(p_data);
+
+    return 0;
+}
+
+/*
+static int m1120_i2c_drv_suspend(struct i2c_client *client, pm_message_t mesg)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dbg_func_in();
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(&client->dev)) {
+        if (p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+            m1120_set_operation_mode(&client->dev, OPERATION_MODE_MEASUREMENT);
+        } else {
+            cancel_delayed_work_sync(&p_data->work);
+            m1120_set_detection_mode(&client->dev, M1120_DETECTION_MODE_INTERRUPT);
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+
+    dbg_func_out();
+
+    return 0;
+}
+
+static int m1120_i2c_drv_resume(struct i2c_client *client)
+{
+    m1120_data_t *p_data = i2c_get_clientdata(client);
+
+    dbg_func_in();
+
+    mutex_lock(&p_data->mtx.enable);
+
+    if (m1120_get_enable(&client->dev)) {
+        if (p_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) {
+            m1120_set_detection_mode(&client->dev, M1120_DETECTION_MODE_POLLING);
+            schedule_delayed_work(&p_data->work, msecs_to_jiffies(m1120_get_delay(&client->dev)));
+        }
+    }
+
+    mutex_unlock(&p_data->mtx.enable);
+
+    dbg_func_out();
+
+    return 0;
+}
+*/
+
+static const struct i2c_device_id m1120_i2c_drv_id_table[] = {
+    {"hall_m1120_up", 0 },
+    { }
+};
+
+
+static const struct of_device_id m1120_of_match[] = {
+    { .compatible = "tri_key_magnachip,tk_mxm1120,up", },
+    { },
+};
+
+static struct i2c_driver m1120_driver = {
+    .driver = {
+        .owner  = THIS_MODULE,
+        .name   = M1120_DRIVER_NAME_UP,
+        .of_match_table = m1120_of_match,
+    },
+    .probe    = tri_key_m1120_i2c_drv_probe,
+    .remove  = m1120_i2c_drv_remove,
+    .id_table   = m1120_i2c_drv_id_table,
+    //.suspend  = m1120_i2c_drv_suspend,
+    //.resume      = m1120_i2c_drv_resume,
+};
+
+static int __init tri_key_m1120_driver_init_up(void)
+{
+    int res = 0;
+    printk(KERN_INFO "======>log %s\n", __func__);
+    res = i2c_add_driver(&m1120_driver);
+    printk(KERN_INFO "======>log %s, res : %d\n", __func__, res);
+    return res;
+}
+module_init(tri_key_m1120_driver_init_up);
+
+static void __exit m1120_driver_exit_up(void)
+{
+    printk(KERN_INFO "%s\n", __func__);
+    i2c_del_driver(&m1120_driver);
+}
+module_exit(m1120_driver_exit_up);
+
+MODULE_AUTHOR("shpark <seunghwan.park@magnachip.com>");
+MODULE_VERSION(M1120_DRIVER_VERSION);
+MODULE_DESCRIPTION("M1120 hallswitch driver");
+MODULE_LICENSE("GPL");
+
diff --git a/drivers/extcon/oneplus_tri_key.c b/drivers/extcon/oneplus_tri_key.c
new file mode 100644
index 0000000000000000000000000000000000000000..b4d6fa4e5b93c9bfd5a42980789d0fe6ca1d8ae5
--- /dev/null
+++ b/drivers/extcon/oneplus_tri_key.c
@@ -0,0 +1,1277 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, Oneplus Mobile Comm Corp., Ltd
+** File: oneplus_tri_key.c
+**
+** Description:
+**      Definitions for m1120 tri_state_key data process.
+**
+** Version: 1.0
+**************************************************************************************/
+
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/miscdevice.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/proc_fs.h>
+#include <linux/hrtimer.h>
+#include <linux/alarmtimer.h>
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/input.h>
+#include <linux/ioport.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/gpio_keys.h>
+#include <linux/of_platform.h>
+#include <linux/of_gpio.h>
+#include <linux/extcon.h>
+#include <linux/workqueue.h>
+#include <linux/interrupt.h>
+#include <linux/uaccess.h>
+#include <linux/regulator/consumer.h>
+#include <linux/timer.h>
+#include <linux/delay.h>
+#include <linux/time.h>
+
+
+#include <linux/string.h>
+#include <linux/version.h>
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+#include <linux/wakelock.h>
+#endif
+#include "oneplus_tri_key.h"
+#include "extcon.h"
+
+enum {
+	MODE_UNKNOWN,
+	MODE_MUTE,
+	MODE_DO_NOT_DISTURB,
+	MODE_NORMAL,
+	MODE_MAX_NUM
+	} tri_mode;
+
+
+unsigned int tristate_extcon_tab[] = {
+		MODE_MUTE,
+		MODE_DO_NOT_DISTURB,
+		MODE_NORMAL,
+	};
+
+static struct hrtimer tri_key_timer;
+struct work_struct tri_key_timeout_work;
+
+static struct extcon_dev_data *g_the_chip = NULL;
+static int last_d0 = 0;
+static int last_d1 = 0;
+static int last_position = -1;
+static int last_interf = -1;
+static int interf_count;
+static int time = 1;
+//static int up_buf[20] = {0};
+//static int down_buf[20] = {0};
+
+//static short tol0 = 10;
+static short tol1 = 15;
+static short tol2 = 22;
+static short calib_UpValueSum = 0, calib_MdValueSum = 0, calib_DnValueSum = 0;
+static short calib_UpValueMin = 0, calib_MdValueMin = 0, calib_DnValueMin = 0;
+static short calib_dnHall_UM_distance = 0, calib_dnHall_MD_distance = 0;
+static short calib_upHall_UM_distance = 0, calib_upHall_MD_distance = 0;
+static short calib_upHall_UD_distance = 0, calib_dnHall_UD_distance = 0;
+
+
+
+
+int oneplus_register_hall(const char *name, struct dhall_operations *ops)
+{
+	if (!name || !ops) {
+		MOTOR_ERR("name is NULL or ops is NULL, would not register digital hall \n");
+		return -EINVAL;
+	}
+
+	if (!g_the_chip) {
+		struct extcon_dev_data *chip = kzalloc(sizeof(struct extcon_dev_data), GFP_KERNEL);
+		if (!chip) {
+			MOTOR_ERR("kzalloc err \n");
+			return -ENOMEM;
+		}
+		g_the_chip = chip;
+	}
+	MOTOR_LOG("name : %s\n", name);
+	if (strcmp(name, "hall_m1120_down") == 0) {
+		MOTOR_LOG("name == hall_m1120_down");
+		if (!g_the_chip->dhall_down_ops) {
+			if (ops) {
+				g_the_chip->dhall_down_ops = ops;
+				g_the_chip->d_name = name;
+			} else {
+				MOTOR_ERR("dhall_down_ops NULL \n");
+				return -EINVAL;
+			}
+		} else {
+			MOTOR_ERR("dhall_down_ops has been register \n");
+			return -EINVAL;
+		}
+	}
+	if (strcmp(name, "hall_m1120_up") == 0) {
+		MOTOR_LOG("name == hall_m1120_up");
+		if (!g_the_chip->dhall_up_ops) {
+			if (ops) {
+				g_the_chip->dhall_up_ops = ops;
+				g_the_chip->d_name = name;
+			}  else {
+				MOTOR_ERR("dhall_up_ops NULL \n");
+				return -EINVAL;
+			}
+		} else {
+			MOTOR_ERR("dhall_up_ops has been register \n");
+			return -EINVAL;
+		}
+	}
+
+	return 0;
+}
+
+int oneplus_hall_enable_irq (unsigned int id, bool enable)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->enable_irq) {
+			return -EINVAL;
+		} else {
+			oneplus_hall_clear_irq(DHALL_0);
+			oneplus_hall_clear_irq(DHALL_1);
+			return g_the_chip->dhall_down_ops->enable_irq(enable);
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->enable_irq) {
+			return -EINVAL;
+		} else {
+			oneplus_hall_clear_irq(DHALL_0);
+			oneplus_hall_clear_irq(DHALL_1);
+			return g_the_chip->dhall_up_ops->enable_irq(enable);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_hall_clear_irq (unsigned int id)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	MOTOR_ERR("dhall_clear_irq\n");
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->enable_irq) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_down_ops->clear_irq();
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->enable_irq) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_up_ops->clear_irq();
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_hall_get_data(unsigned int id)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->get_data) {
+			return -EINVAL;
+		} else {
+				return g_the_chip->dhall_down_ops->get_data(&g_the_chip->dhall_data0);
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->get_data) {
+			return -EINVAL;
+		} else {
+				return g_the_chip->dhall_up_ops->get_data(&g_the_chip->dhall_data1);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+}
+
+bool oneplus_hall_update_threshold(unsigned int id, int position, short lowthd, short highthd)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->update_threshold) {
+			return false;
+		} else {
+			return g_the_chip->dhall_down_ops->update_threshold(position, lowthd, highthd);
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->update_threshold) {
+			return false;
+		} else {
+			return g_the_chip->dhall_up_ops->update_threshold(position, lowthd, highthd);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+}
+
+int oneplus_hall_set_detection_mode(unsigned int id, u8 mode)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->set_detection_mode) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_down_ops->set_detection_mode(mode);
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->set_detection_mode) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_up_ops->set_detection_mode(mode);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+}
+
+int oneplus_hall_get_irq_state(unsigned int id)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->get_irq_state) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_down_ops->get_irq_state();
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->get_irq_state) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_up_ops->get_irq_state();
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+}
+
+
+
+void oneplus_hall_dump_regs(unsigned int id, u8 *buf)
+{
+	if (!g_the_chip)
+		return;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->dump_regs) {
+			return;
+		} else {
+			g_the_chip->dhall_down_ops->dump_regs(buf);
+		}
+		break;
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->dump_regs) {
+			return;
+		} else {
+			g_the_chip->dhall_up_ops->dump_regs(buf);
+		}
+		break;
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return;
+	}
+}
+
+int oneplus_hall_set_reg(unsigned int id, int reg, int val)
+{
+	if (!g_the_chip)
+		return -EINVAL;
+
+	switch (id) {
+	case DHALL_0:
+		if (!g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->set_reg) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_down_ops->set_reg(reg, val);
+		}
+	case DHALL_1:
+		if (!g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->set_reg) {
+			return -EINVAL;
+		} else {
+			return g_the_chip->dhall_up_ops->set_reg(reg, val);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct\n", id);
+		return -EINVAL;
+	}
+
+}
+
+bool oneplus_hall_is_power_on(void)
+{
+	if (!g_the_chip || !g_the_chip->dhall_down_ops || !g_the_chip->dhall_down_ops->is_power_on
+					|| !g_the_chip->dhall_up_ops || !g_the_chip->dhall_up_ops->is_power_on) {
+		return false;
+	} else {
+		if (g_the_chip->dhall_down_ops->is_power_on() || g_the_chip->dhall_up_ops->is_power_on())
+			return true;
+		else
+			return false;
+	}
+
+}
+static void reboot_get_position(struct extcon_dev_data *chip)
+{
+	short delta;
+	short up_data1;
+	short down_data1;
+	if (chip->dhall_data1 < 0 || chip->dhall_data0 < 0) {
+		up_data1 = -chip->dhall_data1;
+		down_data1 = -chip->dhall_data0;
+		delta = up_data1 - down_data1;
+	} else
+		delta = chip->dhall_data1 - chip->dhall_data0;
+	if (delta > 30)
+		chip->position = UP_STATE;
+	else if (-delta > 30)
+		chip->position = DOWN_STATE;
+	else
+		chip->position = MID_STATE;
+}
+
+static int interf_get_position(struct extcon_dev_data *chip)
+{
+	short delta0;
+	short delta1;
+	delta0 = chip->dhall_data0 - last_d0;
+	delta1 = chip->dhall_data1 - last_d1;
+	MOTOR_LOG("tri_key: delta0 is %d ,delta1 is %d,last_postion is %d\n",
+			delta0, delta1, last_position);
+	if ((delta1 > calib_upHall_UM_distance - tol1 &&
+			delta1 < calib_upHall_UM_distance + tol1) &&
+			(delta0 > calib_dnHall_UM_distance - tol1 &&
+			delta0 < calib_dnHall_UM_distance + tol1)) {
+		if (last_position == MID_STATE)
+			return UP_STATE;
+			}
+	if ((delta1 > calib_upHall_UD_distance - tol1 &&
+		delta1 < calib_upHall_UD_distance + tol1) &&
+		(delta0 > calib_dnHall_UD_distance - tol1 &&
+		delta0 < calib_dnHall_UD_distance + tol1))
+		return UP_STATE;
+	if ((delta1 > -calib_upHall_MD_distance - tol1 &&
+		delta1 < -calib_upHall_MD_distance + tol1) &&
+		(delta0 > -calib_dnHall_MD_distance - tol1 &&
+		delta0 < -calib_dnHall_MD_distance + tol1)) {
+		if (last_position == MID_STATE)
+			return DOWN_STATE;
+			}
+	if ((delta1 > -calib_upHall_UD_distance - tol1 &&
+		delta1 < -calib_upHall_UD_distance + tol1) &&
+		(delta0 > -calib_dnHall_UD_distance - tol1 &&
+		delta0 < -calib_dnHall_UD_distance + tol1))
+		return DOWN_STATE;
+	if ((delta1 > -calib_upHall_UM_distance - tol1 &&
+		delta1 < -calib_upHall_UM_distance + tol1) &&
+		(delta0 > -calib_dnHall_UM_distance - tol1 &&
+		delta0 < -calib_dnHall_UM_distance + tol1)) {
+		if (last_position == UP_STATE)
+			return MID_STATE;
+			}
+	if ((delta1 > calib_upHall_MD_distance - tol1 &&
+		delta1 < calib_upHall_MD_distance + tol1) &&
+		(delta0 > calib_dnHall_MD_distance - tol1 &&
+		delta0 < calib_dnHall_MD_distance + tol1)) {
+		if (last_position == DOWN_STATE)
+			return MID_STATE;
+			}
+	return -EINVAL;
+
+}
+
+static int get_position(struct extcon_dev_data *chip)
+{
+	short diff;
+	diff = chip->dhall_data1 - chip->dhall_data0;
+	if (chip->dhall_data0 > 0) {
+		if (diff > calib_UpValueMin - tol1 &&
+			diff < calib_UpValueMin + tol2)
+			chip->position = UP_STATE;
+		if (calib_MdValueMin < 0) {
+			if (diff > calib_MdValueMin - tol1 &&
+				diff < calib_MdValueMin + tol1)
+				chip->position = MID_STATE;
+			}
+		if (calib_MdValueMin > 0 || calib_MdValueMin == 0) {
+			if (diff > calib_MdValueMin - tol1 &&
+				diff < calib_MdValueMin + tol1)
+				chip->position = MID_STATE;
+			}
+		if (diff > calib_DnValueMin - tol2 &&
+				diff < calib_DnValueMin + tol1)
+			chip->position = DOWN_STATE;
+	} else {
+		if (diff > calib_UpValueMin - tol2 &&
+				diff < calib_UpValueMin + tol1)
+			chip->position = UP_STATE;
+		if (calib_MdValueMin < 0) {
+			if (diff > calib_MdValueMin - tol1 &&
+				diff < calib_MdValueMin + tol1)
+				chip->position = MID_STATE;
+			}
+		if (calib_MdValueMin > 0 || calib_MdValueMin == 0) {
+			if (diff > calib_MdValueMin - tol1 &&
+				diff < calib_MdValueMin + tol1)
+				chip->position = MID_STATE;
+			}
+		if (diff > calib_DnValueMin - tol1 &&
+			diff < calib_DnValueMin + tol2)
+			chip->position = DOWN_STATE;
+	}
+	return 0;
+}
+
+static int judge_interference(struct extcon_dev_data *chip)
+{
+	short delta;
+	short sum;
+	delta = chip->dhall_data1 - chip->dhall_data0;
+	MOTOR_LOG("tri_key:delta is %d\n", delta);
+	sum = chip->dhall_data0 + chip->dhall_data1;
+	MOTOR_LOG("tri_key:sum is %d\n", sum);
+	if (chip->dhall_data1 > 0) {//the hall data is positive number
+		if (delta > calib_UpValueMin - tol1 &&
+			delta < calib_UpValueMin + tol2) {
+			MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+				calib_UpValueMin, calib_UpValueSum);
+			if (sum < calib_UpValueSum - tol1 ||
+				sum > calib_UpValueSum + tol2) {
+				chip->interf = 1;
+				chip->state = 1;
+			} else {
+				chip->interf = 0;
+				chip->state = 1;
+			}
+			return 0;
+		}
+		if (calib_MdValueMin < 0) {
+			if (delta > calib_MdValueMin - tol1 &&
+				delta < calib_MdValueMin + tol1) {
+				MOTOR_LOG("tri_key:calibMin:%d,calib_Sum:%d\n",
+					calib_MdValueMin, calib_MdValueSum);
+
+				if (sum > calib_MdValueSum + tol2 ||
+					sum < calib_MdValueSum - tol1) {
+					chip->interf = 1;
+					chip->state = 2;
+				} else {
+					chip->interf = 0;
+					chip->state = 2;
+				}
+				return 0;
+			}
+		}
+		if (calib_MdValueMin > 0 || calib_MdValueMin == 0) {
+			if (delta > calib_MdValueMin - tol1 &&
+				delta < calib_MdValueMin + tol1) {
+				MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+					calib_MdValueMin, calib_MdValueSum);
+
+				if (sum > calib_MdValueSum + tol2 ||
+					sum < calib_MdValueSum - tol1) {
+					chip->interf = 1;
+					chip->state = 2;
+				} else {
+					chip->interf = 0;
+					chip->state = 2;
+					}
+				return 0;
+				}
+			}
+		if (delta > calib_DnValueMin - tol2 &&
+				delta < calib_DnValueMin + tol1) {
+			MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+				calib_DnValueMin, calib_DnValueSum);
+
+			if (sum < calib_DnValueSum - tol1 ||
+				sum > calib_DnValueSum + tol2) {
+				chip->interf = 1;
+				chip->state = 3;
+			} else {
+				chip->interf = 0;
+				chip->state = 3;
+			}
+			return 0;
+		}
+		chip->interf = 1;
+		chip->state = 0;
+	} else {//the hall data is negative number
+		if (delta > calib_UpValueMin - tol2 &&
+			delta < calib_UpValueMin + tol1) {
+			MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+				calib_UpValueMin, calib_UpValueSum);
+
+			if (sum < calib_UpValueSum - tol2 ||
+				sum > calib_UpValueSum + tol1) {
+				chip->interf = 1;
+				chip->state = 1;
+			} else {
+				chip->interf = 0;
+				chip->state = 1;
+			}
+			return 0;
+		}
+		if (calib_MdValueMin < 0) {
+			if (delta > calib_MdValueMin - tol1 &&
+				delta < calib_MdValueMin + tol1) {
+				MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+					calib_MdValueMin, calib_MdValueSum);
+
+				if (sum > calib_MdValueSum + tol1 ||
+					sum < calib_MdValueSum - tol2) {
+					chip->interf = 1;
+					chip->state = 2;
+				} else {
+					chip->interf = 0;
+					chip->state = 2;
+				}
+				return 0;
+			}
+		}
+		if (calib_MdValueMin > 0 || calib_MdValueMin == 0) {
+			if (delta > calib_MdValueMin - tol1 &&
+				delta < calib_MdValueMin + tol1) {
+				MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+					calib_MdValueMin, calib_MdValueSum);
+
+				if (sum > calib_MdValueSum + tol1 ||
+					sum < calib_MdValueSum - tol2) {
+					chip->interf = 1;
+					chip->state = 2;
+				} else {
+					chip->interf = 0;
+					chip->state = 2;
+					}
+				return 0;
+				}
+			}
+		if (delta > calib_DnValueMin - tol1 &&
+				delta < calib_DnValueMin + tol2) {
+			MOTOR_LOG("tri_key:calib_Min:%d,calib_Sum:%d\n",
+				calib_DnValueMin, calib_DnValueSum);
+
+			if (sum < calib_DnValueSum - tol2 ||
+				sum > calib_DnValueSum + tol1) {
+				chip->interf = 1;
+				chip->state = 3;
+			} else {
+				chip->interf = 0;
+				chip->state = 3;
+			}
+			return 0;
+		}
+		chip->interf = 1;
+		chip->state = 0;
+	}
+	return -EINVAL;
+
+}
+
+
+static int oneplus_get_data(struct extcon_dev_data *chip)
+{
+	int res = 0;
+	mutex_lock(&chip->mtx);
+	res = oneplus_hall_get_data(DHALL_0);
+	if (res < 0)
+		MOTOR_LOG("tri_key:get DHALL_0 data failed,res =%d\n", res);
+	res = oneplus_hall_get_data(DHALL_1);
+	if (res < 0) {
+		MOTOR_LOG("tri_key:get DHALL_1 data failed,res =%d\n", res);
+	}
+	mutex_unlock(&chip->mtx);
+	return res;
+}
+
+static int reupdata_threshold(struct extcon_dev_data *chip)
+{
+	int res = 0;
+	int tolen = 22;
+	switch (chip->position) {
+	case UP_STATE:
+		if (chip->dhall_data0 < 0 || chip->dhall_data1 < 0) {
+			res = oneplus_hall_update_threshold(DHALL_1, UP_STATE,
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold up:low:%d,high: %d\n",
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+		} else {
+			res = oneplus_hall_update_threshold(DHALL_1, UP_STATE,
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold up:low:%d,high: %d\n",
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+		}
+		oneplus_hall_clear_irq(DHALL_1);
+		res = oneplus_hall_update_threshold(DHALL_0, UP_STATE, -500, 500);
+		if (res < 0) {
+			MOTOR_LOG("updata_threshold fail:%d\n", res);
+			goto fail;
+		}
+		break;
+	case MID_STATE:
+		if (chip->dhall_data0 < 0 || chip->dhall_data1 < 0) {
+			res = oneplus_hall_update_threshold(DHALL_1, MID_STATE,
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold up:low:%d,high:%d\n",
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+		} else {
+			res = oneplus_hall_update_threshold(DHALL_1, MID_STATE,
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold up:low:%d,high:%d\n",
+			chip->dhall_data1-tolen, chip->dhall_data1+tolen);
+		}
+		oneplus_hall_clear_irq(DHALL_1);
+		if (chip->dhall_data0 < 0 || chip->dhall_data1 < 0) {
+			res = oneplus_hall_update_threshold(DHALL_0, MID_STATE,
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold down:low:%d,high:%d\n",
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+		} else {
+			res = oneplus_hall_update_threshold(DHALL_0, MID_STATE,
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold down:low:%d,high:%d\n",
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+		}
+		oneplus_hall_clear_irq(DHALL_0);
+		break;
+	case DOWN_STATE:
+		res = oneplus_hall_update_threshold(DHALL_1, DOWN_STATE, -500, 500);
+		if (res < 0) {
+			MOTOR_LOG("updata_threshold fail:%d\n", res);
+			goto fail;
+		}
+		if (chip->dhall_data0 < 0 || chip->dhall_data1 < 0) {
+			res = oneplus_hall_update_threshold(DHALL_0, DOWN_STATE,
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold down:low:%d,high:%d\n",
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+		} else {
+			res = oneplus_hall_update_threshold(DHALL_0, DOWN_STATE,
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+			if (res < 0) {
+				MOTOR_LOG("updata_threshold fail:%d\n", res);
+				goto fail;
+			}
+		MOTOR_LOG("tri_key:updata_threshold down:low:%d,high:%d\n",
+			chip->dhall_data0-tolen, chip->dhall_data0+tolen);
+		}
+		oneplus_hall_clear_irq(DHALL_0);
+		break;
+		}
+fail:
+	last_d0 = chip->dhall_data0;
+	last_d1 = chip->dhall_data1;
+	last_interf = chip->interf;
+	MOTOR_LOG("tri_key:last_d0 is %d ,last_d1 is %d\n", last_d0, last_d1);
+	oneplus_hall_clear_irq(DHALL_0);
+	oneplus_hall_clear_irq(DHALL_1);
+	return res;
+}
+
+static void report_key_value(struct extcon_dev_data *chip)
+{
+	if (chip->position == DOWN_STATE) {
+		extcon_set_state_sync(chip->edev, 1, 0);
+		extcon_set_state_sync(chip->edev, 2, 1);
+		extcon_set_state_sync(chip->edev, 3, 1);
+		chip->state = 3;
+		MOTOR_LOG("tri_key: report down key successful!\n");
+	}
+	if (chip->position == UP_STATE) { //near up hall
+		extcon_set_state_sync(chip->edev, 1, 1);
+		extcon_set_state_sync(chip->edev, 2, 1);
+		extcon_set_state_sync(chip->edev, 3, 0);
+		chip->state = 1;
+		MOTOR_LOG("tri_key: report up key successful!\n");
+	}
+	if (chip->position == MID_STATE) {
+		extcon_set_state_sync(chip->edev, 1, 1);
+		extcon_set_state_sync(chip->edev, 2, 0);
+		extcon_set_state_sync(chip->edev, 3, 1);
+		chip->state = 2;
+		MOTOR_LOG("tri_key: report mid key successful!\n");
+	} else
+		MOTOR_LOG("no report\n");
+}
+
+//note:work in irq context
+int oneplus_hall_irq_handler(unsigned int id)
+{
+	MOTOR_LOG("%d tri_key:call :%s\n", id, __func__);
+	if (!g_the_chip) {
+		MOTOR_LOG("g_the_chip null\n ");
+		return -EINVAL;
+	} else {
+		schedule_work(&g_the_chip->dwork);
+	}
+	return IRQ_HANDLED;
+}
+
+
+static void tri_key_dev_work(struct work_struct *work)
+{
+	struct extcon_dev_data *chip = container_of(work,
+			struct extcon_dev_data, dwork);
+	int res = 0;
+	int position = -1;
+	int diff0 = 0;
+	int diff1 = 0;
+	int count = 0;
+	int dhall0_sum = 0;
+	int dhall1_sum = 0;
+	int aver0 = 0;
+	int aver1 = 0;
+	ktime_t starttime, endtime;
+	u64 usecs64;
+	int usecs;
+
+	starttime = ktime_get();
+//	msleep(50);
+//get data
+	res = oneplus_get_data(chip);
+	if (res < 0) {
+		MOTOR_LOG("tri_key:get hall data failed!\n");
+		goto fail;
+	}
+	MOTOR_LOG("tri_key:data1 is %d, data0 is %d\n",
+				chip->dhall_data1, chip->dhall_data0);
+
+//judge interference
+	res = judge_interference(chip);
+	MOTOR_LOG("tri_key:chip->interf is %d ,chip->state is %d\n",
+					chip->interf, chip->state);
+	if (!last_interf && chip->interf) {
+		msleep(500);
+		oneplus_get_data(chip);
+		MOTOR_LOG("tri_key:data1 is %d, data0 is %d\n",
+					chip->dhall_data1, chip->dhall_data0);
+
+		judge_interference(chip);
+	}
+//get position
+	if (!chip->interf) {
+		hrtimer_cancel(&tri_key_timer);
+		time = 1;
+		if (!last_interf) {
+			interf_count = 0;
+			get_position(chip);
+		MOTOR_LOG("tri_key:the position is %d\n", chip->position);
+		} else {
+			msleep(50);
+			oneplus_get_data(chip);
+			judge_interference(chip);
+			if (chip->interf)
+				goto FINAL;
+			else
+				get_position(chip);
+			}
+		}
+	else {
+		hrtimer_cancel(&tri_key_timer);
+		MOTOR_LOG("tri_key:time0 is %d\n", time);
+		hrtimer_start(&tri_key_timer, ktime_set(time, 0),
+			HRTIMER_MODE_REL);
+		while (count < 4) {
+			msleep(35);
+			oneplus_hall_get_data(DHALL_0);
+			oneplus_hall_get_data(DHALL_1);
+			dhall0_sum += chip->dhall_data0;
+			dhall1_sum += chip->dhall_data1;
+			count++;
+		}
+		aver0 = dhall0_sum / 4;
+		aver1 = dhall1_sum / 4;
+		if (!last_interf) {//from no interference to constant interference
+			diff0 = aver0 - chip->dhall_data0;
+			diff1 = aver1 - chip->dhall_data1;
+			MOTOR_LOG("tri_key:diff0 is %d,diff1 is %d\n",
+				diff0, diff1);
+			if ((diff0 > -10 && diff0 < 10) && (diff1 > -10 && diff1 < 10)) {
+				chip->position = last_position;
+				goto UPDATA_HTRES;
+			} else {//inconstant interference
+				last_interf = chip->interf;
+				goto FINAL;
+			}
+		}
+		diff0 = aver0 - chip->dhall_data0;
+		diff1 = aver1 - chip->dhall_data1;
+		MOTOR_LOG("tri_key:diff0 is %d,diff1 is %d\n",
+			diff0, diff1);
+
+//inconstantly interference
+		if ((diff0 < -10 || diff0 > 10) &&
+				(diff1 < -10 || diff1 > 10)) {
+			interf_count++;
+			if (interf_count == 15) {
+				MOTOR_LOG("tri_key:count = 15,msleep 5s\n");
+				msleep(5000);
+				interf_count = 0;
+				goto FINAL;
+			}
+			MOTOR_LOG("tri_key:inconstantlt interference\n");
+			//last_interf = chip->interf;
+			reupdata_threshold(chip);
+			goto FINAL;
+		}
+
+		chip->dhall_data0 = aver0;
+		chip->dhall_data1 = aver1;
+		position = interf_get_position(chip);
+		if (position == -22) {
+			MOTOR_LOG("tri_key:get position failed\n");
+			}
+		else
+			chip->position = position;
+	}
+	MOTOR_LOG("tri_key:t_diff0 is %d,t_diff1 is %d\n",
+	chip->dhall_data0 - last_d0, chip->dhall_data1 - last_d1);
+//updata threshold
+UPDATA_HTRES:
+	res = reupdata_threshold(chip);
+	if (res < 0) {
+		MOTOR_LOG("tri_key:updata_threshold failed!\n");
+		goto fail;
+		}
+	mutex_lock(&chip->mtx);
+// report key value
+	if (chip->position == last_position)
+		goto FINAL;
+	else {
+		report_key_value(chip);
+		last_position = chip->position;
+		endtime = ktime_get();
+		usecs64 = ktime_to_ns(ktime_sub(endtime, starttime));
+		do_div(usecs64, NSEC_PER_USEC);
+		usecs = usecs64;
+		if (usecs == 0)
+			usecs = 1;
+		MOTOR_LOG("report key after %ld.%03ld msecs\n",
+			usecs / USEC_PER_MSEC, usecs % USEC_PER_MSEC);
+	}
+fail:
+	if (res < 0)
+		MOTOR_LOG("tri_key:dev_work failed,res =%d\n", res);
+FINAL:
+	oneplus_hall_enable_irq(DHALL_0, 1);
+	oneplus_hall_enable_irq(DHALL_1, 1);
+	MOTOR_LOG("%s achieve\n", __func__);
+	mutex_unlock(&chip->mtx);
+}
+
+static ssize_t dhall_data_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	//int fb = -1;
+	//short hall_up_data[128] = {0};
+	//short hall_down_data[128] = {0};
+	//char hall_data_bufs[512] = {0};
+	//char hall_data_buf[16] = {0};
+	//int data_count = 0;
+	//int i = 0;
+	//int up_sum = 0;
+	//int down_sum = 0;
+	if (!g_the_chip) {
+		MOTOR_ERR("g_the_chip null\n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+
+	oneplus_hall_get_data(DHALL_0);
+	oneplus_hall_get_data(DHALL_1);
+//save hall data
+/*	hall_up_data[data_count] = g_the_chip->dhall_data0;
+	hall_down_data[data_count] = g_the_chip->dhall_data1;
+	data_count++;
+	fd = sys_open("/sdcard/trikey_hall_data.csv",  O_WRONLY | O_CREAT | O_APPEND, 0);
+	if (fd < 0) {
+		MOTOR_ERR("open log file /sdcard/hall_data.csv failed.\n");
+	}
+	if (fd >= 0) {
+//		if (g_the_chip->state)
+//			sys_write(fd, "1\n", 2);
+//		else //interference
+//			sys_write(fd, "0\n", 2);
+		for (i = 0; i < data_count; i++) {
+			memset(hall_data_buf, 0, sizeof(hall_data_buf));
+			sprintf(hall_data_buf, "%d, ", hall_up_data[i]);
+			strcat(hall_data_bufs, hall_data_buf);
+		}
+		strcat(hall_data_bufs, "\n");
+		sys_write(fd, hall_data_bufs, strlen(hall_data_bufs));
+		memset(hall_data_bufs, 0 , sizeof(hall_data_bufs));
+
+		for (i = 0; i < data_count; i++) {
+			memset(hall_data_buf, 0, sizeof(hall_data_buf));
+			sprintf(hall_data_buf, "%d,", hall_down_data[i]);
+			strcat(hall_data_bufs, hall_data_buf);
+		}
+		strcat(hall_data_bufs, "\n");
+		sys_write(fd, hall_data_bufs, strlen(hall_data_bufs));
+		sys_write(fd, "\n", 1);
+		sys_close(fd);
+	}
+*/
+
+	return snprintf(buf, PAGE_SIZE, "%d, %d\n",
+		g_the_chip->dhall_data0, g_the_chip->dhall_data1);
+}
+
+
+static ssize_t tri_state_show(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	//int position =-1;
+	if (!g_the_chip) {
+		MOTOR_ERR("g_the_chip null\n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+	oneplus_hall_get_data(DHALL_0);
+	oneplus_hall_get_data(DHALL_1);
+//	judge_interference(g_the_chip);
+	//position = get_position(g_the_chip);
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->state);
+}
+
+static enum hrtimer_restart tri_key_status_timeout(struct hrtimer *timer)
+{
+	schedule_work(&tri_key_timeout_work);
+	return HRTIMER_NORESTART;
+}
+
+static void tri_key_timeout_work_func(struct work_struct *work)
+{
+	oneplus_get_data(g_the_chip);
+	judge_interference(g_the_chip);
+	if (g_the_chip->interf) {
+		time = time * 2;
+		MOTOR_LOG("tri_key:time1 is %d\n", time);
+		if (time > 2)
+			time = 2;
+		}
+	else {
+		get_position(g_the_chip);
+		if (g_the_chip->position == last_position)
+			return;
+		reupdata_threshold(g_the_chip);
+		report_key_value(g_the_chip);
+		last_position = g_the_chip->position;
+		time = 1;
+		}
+	return;
+}
+
+
+static short Sum(short value0, short value1)
+{
+    short sum = 0;
+	sum = value0 + value1;
+	return sum;
+}
+static short Minus(short value0, short value1)
+{
+	short minus = 0;
+	minus = value0 - value1;
+	return minus;
+}
+
+void initialCalibValue(short calib_dnHall_UpV, short calib_dnHall_MdV,
+			short calib_dnHall_DnV, short calib_upHall_UpV,
+			short calib_upHall_MdV, short calib_upHall_DnV)
+{
+	calib_UpValueSum = Sum(calib_dnHall_UpV,calib_upHall_UpV);
+	calib_MdValueSum = Sum(calib_dnHall_MdV,calib_upHall_MdV);
+	calib_DnValueSum = Sum(calib_dnHall_DnV,calib_upHall_DnV);
+	calib_UpValueMin = Minus(calib_upHall_UpV,calib_dnHall_UpV);
+	calib_MdValueMin = Minus(calib_upHall_MdV,calib_dnHall_MdV);
+	calib_DnValueMin = Minus(calib_upHall_DnV,calib_dnHall_DnV);
+	calib_upHall_UM_distance = Minus(calib_upHall_UpV, calib_upHall_MdV);
+	calib_upHall_MD_distance = Minus(calib_upHall_MdV, calib_upHall_DnV);
+	calib_dnHall_UM_distance = Minus(calib_dnHall_UpV, calib_dnHall_MdV);
+	calib_dnHall_MD_distance = Minus(calib_dnHall_MdV, calib_dnHall_DnV);
+	calib_upHall_UD_distance = Minus(calib_upHall_UpV, calib_upHall_DnV);
+	calib_dnHall_UD_distance = Minus(calib_dnHall_UpV, calib_dnHall_DnV);
+}
+
+
+static ssize_t hall_data_calib_show(struct device *dev,
+			struct device_attribute *attr, char *buf)
+{
+	if (!g_the_chip) {
+		MOTOR_ERR("g_the_chip null\n");
+		return snprintf(buf, PAGE_SIZE, "%d\n%d\n",-1,-1);
+	}
+	return snprintf(buf, PAGE_SIZE, "%d,%d,%d,%d,%d,%d\n",
+		g_the_chip->dnHall_UpV, g_the_chip->upHall_UpV,
+		g_the_chip->dnHall_MdV, g_the_chip->upHall_MdV,
+		g_the_chip->dnHall_DnV, g_the_chip->upHall_DnV);
+}
+
+static ssize_t hall_data_calib_store(struct device *pdev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	int data[6] = {0};
+	char temp[35] = {0};
+	if (!g_the_chip) {
+		MOTOR_ERR("g_the_chip null\n");
+		return count;
+	}
+	strlcpy(temp, buf, sizeof(temp));
+	MOTOR_LOG("temp is %s:\n", temp);
+	if (sscanf(temp, "%d,%d,%d,%d,%d,%d", &data[0], &data[1], &data[2],
+		&data[3], &data[4], &data[5]) == 6) {
+		g_the_chip->dnHall_UpV = data[0];
+		g_the_chip->upHall_UpV = data[1];
+		g_the_chip->dnHall_MdV = data[2];
+		g_the_chip->upHall_MdV = data[3];
+		g_the_chip->dnHall_DnV = data[4];
+		g_the_chip->upHall_DnV = data[5];
+		MOTOR_ERR("data[%d %d %d %d %d %d]\n", data[0], data[1],
+				data[2], data[3], data[4], data[5]);
+	} else {
+		MOTOR_ERR("fail\n");
+	}
+	initialCalibValue(g_the_chip->dnHall_UpV, g_the_chip->dnHall_MdV,
+			g_the_chip->dnHall_DnV, g_the_chip->upHall_UpV,
+			g_the_chip->upHall_MdV, g_the_chip->upHall_DnV);
+	return count;
+}
+
+static DEVICE_ATTR(hall_data, S_IRUGO | S_IWUSR, dhall_data_show, NULL);
+static DEVICE_ATTR(tri_state, S_IRUGO | S_IWUSR, tri_state_show, NULL);
+static DEVICE_ATTR(hall_data_calib, 0644,
+		hall_data_calib_show, hall_data_calib_store);
+
+static struct attribute *tri_key_attributes[] = {
+	&dev_attr_tri_state.attr,
+	&dev_attr_hall_data.attr,
+	&dev_attr_hall_data_calib.attr,
+	NULL
+};
+
+
+static struct attribute_group tri_key_attribute_group = {
+	.attrs = tri_key_attributes
+};
+
+static int tri_key_platform_probe(struct platform_device *pdev)
+{
+	struct extcon_dev_data *chip = NULL;
+	int err = 0;
+	int res = 0;
+	//int hall_value_min = 0;
+
+	MOTOR_LOG("call %s\n", __func__);
+
+	if (!g_the_chip) {
+		chip = kzalloc(sizeof(struct extcon_dev_data), GFP_KERNEL);
+		if (!chip) {
+			MOTOR_ERR("kzalloc err\n");
+			return -ENOMEM;
+		}
+		g_the_chip = chip;
+	} else {
+		chip = g_the_chip;
+	}
+	mutex_init(&chip->mtx);
+	chip->dev = &pdev->dev;
+	err = sysfs_create_group(&pdev->dev.kobj, &tri_key_attribute_group);
+	if (err) {
+		MOTOR_ERR("tri_key:sysfs_create_group was failed(%d)\n", err);
+		goto sysfs_create_fail;
+	}
+
+	if (0 && (!chip->dhall_up_ops || !chip->dhall_down_ops)) {
+		MOTOR_ERR("no dhall available\n");
+		goto fail;
+	}
+// extcon registration
+	chip->edev = devm_extcon_dev_allocate(chip->dev, tristate_extcon_tab);
+	chip->edev->name = "tri_state_key";
+	err = devm_extcon_dev_register(chip->dev, chip->edev);
+
+	if (err < 0) {
+		MOTOR_ERR("%s register extcon dev failed\n", __func__);
+		goto err_extcon_dev_register;
+	}
+
+	INIT_WORK(&chip->dwork, tri_key_dev_work);
+	hrtimer_init(&tri_key_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+	tri_key_timer.function = tri_key_status_timeout;
+	INIT_WORK(&tri_key_timeout_work, tri_key_timeout_work_func);
+//get data when reboot
+	res = oneplus_get_data(chip);
+	if (res < 0) {
+		MOTOR_LOG("tri_key:get hall data failed!\n");
+		goto fail;
+	}
+	MOTOR_LOG("tri_key:data1 is %d, data0 is %d\n",
+				chip->dhall_data1, chip->dhall_data0);
+
+//get position when reboot
+	reboot_get_position(chip);
+//set threshold when reboot;
+	err = reupdata_threshold(chip);
+	if (err < 1) {
+		MOTOR_ERR("%s reupdata_threshold failed\n", __func__);
+		goto fail;
+	}
+//report key value
+	report_key_value(chip);
+	last_position = chip->position;
+	err = oneplus_hall_set_detection_mode(DHALL_0, DETECTION_MODE_INTERRUPT);
+	MOTOR_LOG("tri_key:set 0 detection mode\n");
+	if (err < 0) {
+		MOTOR_ERR("%s set HALL0 detection mode failed %d\n",
+			__func__, err);
+		goto fail;
+	}
+	err = oneplus_hall_set_detection_mode(DHALL_1, DETECTION_MODE_INTERRUPT);
+	MOTOR_LOG("tri_key:set 1 detection mode\n");
+	if (err < 0) {
+		MOTOR_ERR("%s set HALL1 detection mode failed %d\n", __func__, err);
+		goto fail;
+	}
+	MOTOR_LOG("%s probe success.\n", __func__);
+	return 0;
+
+fail:
+	kfree(chip);
+	g_the_chip = NULL;
+	MOTOR_LOG("fail\n");
+	return -EINVAL;
+sysfs_create_fail:
+	sysfs_remove_group(&pdev->dev.kobj, &tri_key_attribute_group);
+
+err_extcon_dev_register:
+	devm_extcon_dev_unregister(chip->dev, chip->edev);
+	MOTOR_LOG("fail\n");
+	return -EINVAL;
+
+}
+
+static int tri_key_platform_remove(struct platform_device *pdev)
+{
+	if (g_the_chip) {
+		cancel_work_sync(&g_the_chip->dwork);
+		extcon_dev_unregister(g_the_chip->edev);
+		kfree(g_the_chip);
+		g_the_chip = NULL;
+	}
+	return 0;
+}
+
+static const struct of_device_id tristate_dev_of_match[] = {
+	{ .compatible = "oneplus,hall_tri_state_key"},
+	{},
+};
+MODULE_DEVICE_TABLE(of, of_motor_match);
+
+static struct platform_driver tri_key_platform_driver = {
+	.probe		= tri_key_platform_probe,
+	.remove		= tri_key_platform_remove,
+	.driver		= {
+		.name	= "tri_state_key",
+		.of_match_table = tristate_dev_of_match,
+	},
+};
+
+static int __init tri_key_platform_init(void)
+{
+	int res = 0;
+	MOTOR_LOG("call : %s\n", __func__);
+	res = platform_driver_register(&tri_key_platform_driver);
+	if (res < 0)
+		MOTOR_LOG("%s failed\n", __func__);
+	return res;
+}
+
+module_init(tri_key_platform_init);
+
+static void __exit tri_key_platform_exit(void)
+{
+	platform_driver_unregister(&tri_key_platform_driver);
+}
+module_exit(tri_key_platform_exit);
+MODULE_DESCRIPTION("oem tri_state_key driver");
+MODULE_LICENSE("GPL v2");
+
diff --git a/drivers/extcon/oneplus_tri_key.h b/drivers/extcon/oneplus_tri_key.h
new file mode 100644
index 0000000000000000000000000000000000000000..879a060d7f49853f0d9de586d58e5dfc43a4f044
--- /dev/null
+++ b/drivers/extcon/oneplus_tri_key.h
@@ -0,0 +1,126 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, Oneplus Mobile Comm Corp., Ltd
+** File: oneplus_tri_key.h
+**
+** Description:
+**      Definitions for m1120 tri_state_key data process.
+**
+** Version: 1.0
+**************************************************************************************/
+
+#include <linux/alarmtimer.h>
+#include <linux/version.h>
+
+#define MOTOR_TAG                  "[tri_state_key] "
+#define MOTOR_ERR(fmt, args...)    printk(KERN_ERR MOTOR_TAG" %s : "fmt, __FUNCTION__, ##args)
+#define MOTOR_LOG(fmt, args...)    printk(KERN_INFO MOTOR_TAG" %s : "fmt, __FUNCTION__, ##args)
+
+/*
+#define MODE_MUTE 1
+#define MODE_DO_NOT_DISTURB 2
+#define MODE_NORMAL 3
+*/
+enum dhall_id {
+	DHALL_0 = 0,
+	DHALL_1,
+};
+// enum dhall_id {
+// 	DHALL_DOWN = 0,
+// 	DHALL_UP,
+// };
+
+enum dhall_detection_mode {
+	DETECTION_MODE_POLLING = 0,
+	DETECTION_MODE_INTERRUPT,
+	DETECTION_MODE_INVALID,
+};
+
+enum motor_direction {
+	MOTOR_DOWN = 0,
+	MOTOR_UPWARD,
+};
+
+enum tri_key_position {
+	UP_STATE,
+	DOWN_STATE,
+	MID_STATE,
+};
+
+extern unsigned int tristate_extcon_tab[];
+
+
+typedef struct {
+	short data0;
+	short data1;
+} dhall_data_t;
+
+struct dhall_operations {
+	int (*get_data) (short *data);
+	int (*set_detection_mode) (u8 mode);
+	int (*enable_irq) (bool enable);
+	int (*clear_irq) (void);
+	int (*get_irq_state) (void);
+	bool (*update_threshold) (int position, short lowthd, short highthd);
+	void (*dump_regs) (u8 *buf);
+	int (*set_reg) (int reg, int val);
+	bool (*is_power_on) (void);
+};
+
+ struct extcon_dev_data {
+
+	struct work_struct dwork;
+	struct extcon_dev *edev; //change 1
+	struct device *dev;
+	struct timer_list s_timer;
+	struct pinctrl *key_pinctrl;
+	struct pinctrl_state *set_state;
+	struct delayed_work	up_work;
+	struct delayed_work	down_work;
+	struct dhall_operations *dhall_up_ops;
+	struct dhall_operations *dhall_down_ops;
+	struct mutex mtx;
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+	//struct wake_lock        suspend_lock;
+#else
+	//struct wakeup_source	*suspend_ws;
+#endif
+	const char *d_name;
+	const char *m_name;
+	int		position;
+	int		last_position;
+	int		interf;//interference
+	short		state;
+	short		dhall_data0;
+	short		dhall_data1;
+	short		dnHall_UpV;
+	short		dnHall_MdV;
+	short		dnHall_DnV;
+	short		upHall_UpV;
+	short		upHall_MdV;
+	short		upHall_DnV;
+	//short		dnHall_UpV_pre;
+	//short		dnHall_MdV_pre;
+	//short		dnHall_DnV_pre;
+	//short		upHall_UpV_pre;
+	//short		upHall_MdV_pre;
+	//short		upHall_DnV_pre;
+	int        	manual2auto_up_switch;
+	int        	manual2auto_down_switch;
+	int			irq;
+	//bool        irq_monitor_started;
+	//bool        is_irq_abnormal;
+};
+
+extern int oneplus_register_hall(const char *name, struct dhall_operations *ops);
+//dhall control api
+extern int oneplus_hall_get_data(unsigned int id);
+extern int oneplus_hall_set_detection_mode(unsigned int id, u8 mode);
+extern int oneplus_hall_enable_irq (unsigned int id, bool enable);
+extern int oneplus_hall_clear_irq (unsigned int id);
+extern int oneplus_hall_irq_handler(unsigned int id);
+extern int oneplus_hall_get_irq_state(unsigned int id);
+extern void oneplus_hall_dump_regs(unsigned int id, u8 *buf);
+extern int oneplus_hall_set_reg(unsigned int id, int reg, int val);
+extern bool oneplus_hall_update_threshold(unsigned int id, int position, short lowthd, short highthd);
+extern bool oneplus_hall_is_power_on(void);
+
diff --git a/drivers/extcon/tri_state_key.c b/drivers/extcon/tri_state_key.c
new file mode 100644
index 0000000000000000000000000000000000000000..eb48d6e3054b7ab361fb8e2bb87fe8c4ba25a794
--- /dev/null
+++ b/drivers/extcon/tri_state_key.c
@@ -0,0 +1,393 @@
+/*
+ *
+ *  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/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/input.h>
+#include <linux/ioport.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/gpio_keys.h>
+#include <linux/of_platform.h>
+#include <linux/of_gpio.h>
+
+#include <linux/extcon.h>
+#include <linux/workqueue.h>
+#include <linux/interrupt.h>
+#include <linux/uaccess.h>
+
+#include <linux/regulator/consumer.h>
+
+#include <linux/timer.h>
+#include <linux/delay.h>
+#include "extcon.h"
+//#include <linux/project_info.h>
+
+#define DRV_NAME	"tri-state-key"
+
+/*
+ *
+ *					KEY1(GPIO1)	KEY2(GPIO92)
+ *	pin1 connect to pin4	0	            1         | MUTE
+ *	pin2 connect to pin5	1	            1         | Do Not Disturb
+ *	pin4 connect to pin3	1	            0         | Normal
+ */
+enum  {
+	MODE_UNKNOWN,
+	MODE_MUTE,
+	MODE_DO_NOT_DISTURB,
+	MODE_NORMAL,
+	MODE_MAX_NUM
+	} tri_mode_t;
+
+static const unsigned int tristate_extcon_tab[] = {
+	MODE_MUTE,
+	MODE_DO_NOT_DISTURB,
+	MODE_NORMAL,
+	EXTCON_NONE,
+};
+
+struct extcon_dev_data {
+	int irq_key3;
+	int irq_key2;
+	int irq_key1;
+	int key1_gpio;
+	int key2_gpio;
+	int key3_gpio;
+
+	struct regulator *vdd_io;
+
+	struct work_struct work;
+	struct extcon_dev *edev; //change 1
+	struct device *dev;
+
+	struct timer_list s_timer;
+	struct pinctrl *key_pinctrl;
+	struct pinctrl_state *set_state;
+
+};
+
+static struct extcon_dev_data *extcon_data;
+static DEFINE_MUTEX(sem);
+static int set_gpio_by_pinctrl(void)
+{
+	return pinctrl_select_state(extcon_data->key_pinctrl,
+		extcon_data->set_state);
+}
+/*op add to fix GCE-7551 begin*/
+extern int aw8697_op_haptic_stop(void);
+/*op add to fix GCE-7551 end*/
+
+static void extcon_dev_work(struct work_struct *work)
+{
+	int key[3] = {0, 0, 0};
+	int hw_version = 0;
+	/*op add to fix ISTRACKING-34823 begin*/
+	static int pre_key0, pre_key1, pre_key2;
+	/*op add to fix ISTRACKING-34823 end*/
+	/*hw 13 use special tri state key no use key2*/
+	//hw_version=get_hw_version();
+	pr_err("%s, hw_version=%d\n",
+			__func__, hw_version);
+	if (hw_version == 13) {
+		key[0] = gpio_get_value(extcon_data->key1_gpio);
+		key[2] = gpio_get_value(extcon_data->key3_gpio);
+
+		pr_err("%s ,key[0]=%d,key[1]=%d,key[2]=%d\n",
+			__func__, key[0], key[1], key[2]);
+		if (key[0] == 1 && key[2] == 1) {
+			extcon_set_state_sync(extcon_data->edev, 1, 1);
+			extcon_set_state_sync(extcon_data->edev, 2, 0);
+			extcon_set_state_sync(extcon_data->edev, 3, 1);
+		} else if (key[0] == 0 && key[2] == 1) {
+			extcon_set_state_sync(extcon_data->edev, 1, 0);
+			extcon_set_state_sync(extcon_data->edev, 2, 1);
+			extcon_set_state_sync(extcon_data->edev, 3, 1);
+		} else if (key[0] == 1 && key[2] == 0) {
+			extcon_set_state_sync(extcon_data->edev, 1, 1);
+			extcon_set_state_sync(extcon_data->edev, 2, 1);
+			extcon_set_state_sync(extcon_data->edev, 3, 0);
+		}
+	} else {
+		key[0] = gpio_get_value(extcon_data->key1_gpio);
+		key[1] = gpio_get_value(extcon_data->key2_gpio);
+		key[2] = gpio_get_value(extcon_data->key3_gpio);
+		pr_err("%s ,key[0]=%d,key[1]=%d,key[2]=%d\n",
+			__func__, key[0], key[1], key[2]);
+		/*op add to fix ISTRACKING-34823 begin*/
+		if (!key[0] || !key[1] || !key[2]) {
+			if (pre_key0 == key[0] && pre_key1 == key[1]
+					&& pre_key2 == key[2]) {
+				pre_key0 = key[0];
+				pre_key1 = key[1];
+				pre_key2 = key[2];
+				return;
+			}
+		}
+		/*op add to fix ISTRACKING-34823 end*/
+		/*op add to fix GCE-7551 begin*/
+		if (key[0] && key[1] && key[2])
+			return;
+		if (!key[0] && !key[1] && !key[2])
+			return;
+		if (!key[0] && !key[1] && key[2])
+			return;
+		if (!key[0] && key[1] && !key[2])
+			return;
+		if (key[0] && !key[1] && !key[2])
+			return;
+		/*op add to fix GCE-7551 end*/
+		extcon_set_state_sync(
+				extcon_data->edev, 1, key[0]);
+		extcon_set_state_sync(
+				extcon_data->edev, 2, key[1]);
+		extcon_set_state_sync(
+				extcon_data->edev, 3, key[2]);
+		/*op add to fix GCE-7551 begin*/
+		if (!key[2] ||  !key[1])
+			aw8697_op_haptic_stop();
+		/*op add to fix GCE-7551 end*/
+		/*op add to fix ISTRACKING-34823 begin*/
+		if (!key[0] || !key[1] || !key[2]) {
+			pre_key0 = key[0];
+			pre_key1 = key[1];
+			pre_key2 = key[2];
+		}
+		/*op add to fix ISTRACKING-34823 end*/
+	}
+}
+
+
+static irqreturn_t extcon_dev_interrupt(int irq, void *_dev)
+{
+	schedule_work(&extcon_data->work);
+	return IRQ_HANDLED;
+}
+
+static void timer_handle(unsigned long arg)
+{
+	schedule_work(&extcon_data->work);
+}
+
+#ifdef CONFIG_OF
+static int extcon_dev_get_devtree_pdata(struct device *dev)
+{
+	struct device_node *node;
+
+	node = dev->of_node;
+	if (!node)
+		return -EINVAL;
+
+	extcon_data->key3_gpio =
+	of_get_named_gpio(node, "tristate,gpio_key3", 0);
+	if ((!gpio_is_valid(extcon_data->key3_gpio)))
+		return -EINVAL;
+	pr_err("extcon_data->key3_gpio=%d\n", extcon_data->key3_gpio);
+
+	extcon_data->key2_gpio =
+		of_get_named_gpio(node, "tristate,gpio_key2", 0);
+	if ((!gpio_is_valid(extcon_data->key2_gpio)))
+		return -EINVAL;
+	pr_err("extcon_data->key2_gpio=%d\n", extcon_data->key2_gpio);
+
+	extcon_data->key1_gpio =
+		of_get_named_gpio(node, "tristate,gpio_key1", 0);
+	if ((!gpio_is_valid(extcon_data->key1_gpio)))
+		return -EINVAL;
+	pr_err("extcon_data->key1_gpio=%d\n", extcon_data->key1_gpio);
+
+	return 0;
+}
+#else
+static inline int
+extcon_dev_get_devtree_pdata(struct device *dev)
+{
+	pr_info("%s inline function", __func__);
+	return 0;
+}
+#endif
+
+static int tristate_dev_probe(struct platform_device *pdev)
+{
+	struct device *dev;
+	int ret = 0;
+
+	dev = &pdev->dev;
+
+	extcon_data = kzalloc(sizeof(struct extcon_dev_data), GFP_KERNEL);
+	if (!extcon_data)
+		return -ENOMEM;
+
+	extcon_data->dev = dev;
+
+
+	extcon_data->key_pinctrl = devm_pinctrl_get(extcon_data->dev);
+
+	if (IS_ERR_OR_NULL(extcon_data->key_pinctrl)) {
+		dev_err(extcon_data->dev, "Failed to get pinctrl\n");
+		goto err_extcon_dev_register;
+	}
+	extcon_data->set_state = pinctrl_lookup_state(extcon_data->key_pinctrl,
+		"pmx_tri_state_key_active");
+	if (IS_ERR_OR_NULL(extcon_data->set_state)) {
+		dev_err(extcon_data->dev, "Failed to lookup_state\n");
+		goto err_extcon_dev_register;
+	}
+
+	set_gpio_by_pinctrl();
+
+	ret = extcon_dev_get_devtree_pdata(dev);
+	if (ret) {
+		dev_err(dev, "parse device tree fail!!!\n");
+		goto err_extcon_dev_register;
+	}
+
+
+	/* extcon registration */
+	extcon_data->edev =
+	devm_extcon_dev_allocate(extcon_data->dev, tristate_extcon_tab);
+	extcon_data->edev->name = DRV_NAME;
+
+	ret = devm_extcon_dev_register(extcon_data->dev, extcon_data->edev);
+	if (ret < 0)
+		goto err_extcon_dev_register;
+
+	//config irq gpio and request irq
+	ret = gpio_request(extcon_data->key1_gpio, "tristate_key1");
+	if (ret < 0)
+		goto err_request_gpio;
+
+	ret = gpio_direction_input(extcon_data->key1_gpio);
+	if (ret < 0)
+		goto err_set_gpio_input;
+
+	extcon_data->irq_key1 = gpio_to_irq(extcon_data->key1_gpio);
+	if (extcon_data->irq_key1 < 0) {
+		ret = extcon_data->irq_key1;
+		goto err_detect_irq_num_failed;
+	}
+
+	ret = request_irq(extcon_data->irq_key1, extcon_dev_interrupt,
+		IRQF_TRIGGER_FALLING|IRQF_TRIGGER_RISING,
+		"tristate_key1", extcon_data);
+	if (ret < 0)
+		goto err_request_irq;
+
+	ret = gpio_request(extcon_data->key2_gpio,
+		"tristate_key2");
+	if (ret < 0)
+		goto err_request_gpio;
+
+	ret = gpio_direction_input(extcon_data->key2_gpio);
+	if (ret < 0)
+		goto err_set_gpio_input;
+
+	extcon_data->irq_key2 = gpio_to_irq(extcon_data->key2_gpio);
+	if (extcon_data->irq_key2 < 0) {
+		ret = extcon_data->irq_key2;
+		goto err_detect_irq_num_failed;
+	}
+
+	ret = request_irq(extcon_data->irq_key2, extcon_dev_interrupt,
+		IRQF_TRIGGER_FALLING|IRQF_TRIGGER_RISING,
+		"tristate_key2", extcon_data);
+	if (ret < 0)
+		goto err_request_irq;
+
+	ret = gpio_request(extcon_data->key3_gpio,
+		"tristate_key3");
+	if (ret < 0)
+		goto err_request_gpio;
+
+	ret = gpio_direction_input(extcon_data->key3_gpio);
+	if (ret < 0)
+		goto err_set_gpio_input;
+
+	extcon_data->irq_key3 = gpio_to_irq(extcon_data->key3_gpio);
+	if (extcon_data->irq_key3 < 0) {
+		ret = extcon_data->irq_key3;
+		goto err_detect_irq_num_failed;
+	}
+
+	ret = request_irq(extcon_data->irq_key3, extcon_dev_interrupt,
+		IRQF_TRIGGER_FALLING|IRQF_TRIGGER_RISING,
+		"tristate_key3", extcon_data);
+	if (ret < 0)
+		goto err_request_irq;
+
+	INIT_WORK(&extcon_data->work, extcon_dev_work);
+
+	init_timer(&extcon_data->s_timer);
+	extcon_data->s_timer.function = &timer_handle;
+	extcon_data->s_timer.expires = jiffies + 5*HZ;
+
+	add_timer(&extcon_data->s_timer);
+
+	enable_irq_wake(extcon_data->irq_key1);
+	enable_irq_wake(extcon_data->irq_key2);
+	enable_irq_wake(extcon_data->irq_key3);
+
+	return 0;
+
+err_request_gpio:
+	devm_extcon_dev_unregister(extcon_data->dev, extcon_data->edev);
+err_request_irq:
+err_detect_irq_num_failed:
+err_set_gpio_input:
+	gpio_free(extcon_data->key2_gpio);
+	gpio_free(extcon_data->key1_gpio);
+	gpio_free(extcon_data->key3_gpio);
+err_extcon_dev_register:
+	kfree(extcon_data);
+
+	return ret;
+}
+
+static int tristate_dev_remove(struct platform_device *pdev)
+{
+	cancel_work_sync(&extcon_data->work);
+	gpio_free(extcon_data->key1_gpio);
+	gpio_free(extcon_data->key2_gpio);
+	gpio_free(extcon_data->key3_gpio);
+	extcon_dev_unregister(extcon_data->edev);
+	kfree(extcon_data);
+
+	return 0;
+}
+#ifdef CONFIG_OF
+static const struct of_device_id tristate_dev_of_match[] = {
+	{ .compatible = "oneplus, tri-state-key", },
+	{ },
+};
+MODULE_DEVICE_TABLE(of, tristate_dev_of_match);
+#endif
+
+static struct platform_driver tristate_dev_driver = {
+	.probe		= tristate_dev_probe,
+	.remove		= tristate_dev_remove,
+	.driver		= {
+		.name	= DRV_NAME,
+		.owner	= THIS_MODULE,
+		.of_match_table = tristate_dev_of_match,
+	},
+};
+static int __init oem_tristate_init(void)
+{
+	return platform_driver_register(&tristate_dev_driver);
+}
+module_init(oem_tristate_init);
+
+static void __exit oem_tristate_exit(void)
+{
+	platform_driver_unregister(&tristate_dev_driver);
+}
+module_exit(oem_tristate_exit);
+MODULE_DESCRIPTION("oem tri_state_key driver");
+MODULE_LICENSE("GPL v2");
+
diff --git a/drivers/firmware/qcom/tz_log.c b/drivers/firmware/qcom/tz_log.c
index 8909b31e142f8fc529668e5e43ccab96e812c9a6..57088eca1b64ea9a22b256b520ee829bbbbfdd31 100644
--- a/drivers/firmware/qcom/tz_log.c
+++ b/drivers/firmware/qcom/tz_log.c
@@ -25,6 +25,7 @@
 #include <linux/of.h>
 #include <linux/dma-buf.h>
 #include <linux/ion_kernel.h>
+#include <linux/proc_fs.h>
 
 #include <soc/qcom/scm.h>
 #include <soc/qcom/qseecomi.h>
@@ -904,6 +905,96 @@ static void tzdbg_register_qsee_log_buf(struct platform_device *pdev)
 	return;
 }
 
+//add tz and qsee log to logkit
+static ssize_t proc_qsee_log_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int len = 0;
+	memcpy_fromio((void *)tzdbg.diag_buf, tzdbg.virt_iobase,
+						debug_rw_buf_size);
+	memcpy_fromio((void *)tzdbg.hyp_diag_buf, tzdbg.hyp_virt_iobase,
+					tzdbg.hyp_debug_rw_buf_size);
+	len = _disp_qsee_log_stats(count);
+	*ppos = 0;
+
+	if (len > count)
+		len = count;
+
+	return simple_read_from_buffer(user_buf, len, ppos, tzdbg.stat[6].data, len);
+}
+
+
+static const struct file_operations proc_qsee_log_fops = {
+	.read =  proc_qsee_log_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static ssize_t proc_tz_log_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int len = 0;
+	memcpy_fromio((void *)tzdbg.diag_buf, tzdbg.virt_iobase,
+						debug_rw_buf_size);
+	memcpy_fromio((void *)tzdbg.hyp_diag_buf, tzdbg.hyp_virt_iobase,
+					tzdbg.hyp_debug_rw_buf_size);
+
+    if (TZBSP_DIAG_MAJOR_VERSION_LEGACY <
+			(tzdbg.diag_buf->version >> 16)) {
+		len = _disp_tz_log_stats(count);
+		*ppos = 0;
+	} else {
+		len = _disp_tz_log_stats_legacy();
+	}
+
+	if (len > count)
+		len = count;
+
+	return simple_read_from_buffer(user_buf, len, ppos, tzdbg.stat[5].data, len);
+}
+
+static const struct file_operations proc_tz_log_fops = {
+	.read =  proc_tz_log_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static int tzprocfs_init(struct platform_device *pdev)
+{
+
+    int rc = 0;
+	struct proc_dir_entry *prEntry_tmp  = NULL;
+	struct proc_dir_entry *prEntry_dir  = NULL;
+
+	prEntry_dir = proc_mkdir("tzdbg", NULL);
+
+	if (prEntry_dir == NULL) {
+		dev_err(&pdev->dev, "tzdbg procfs_create_dir failed\n");
+		return -ENOMEM;
+	}
+
+	prEntry_tmp = proc_create("qsee_log", 0666, prEntry_dir, &proc_qsee_log_fops);
+
+	if (prEntry_tmp  == NULL) {
+		dev_err(&pdev->dev, "TZ procfs_create_file qsee_log failed\n");
+		rc = -ENOMEM;
+		goto err;
+	}
+
+	prEntry_tmp = proc_create("tz_log", 0666, prEntry_dir, &proc_tz_log_fops);
+
+	if (prEntry_tmp  == NULL) {
+		dev_err(&pdev->dev, "TZ procfs_create_file tz_log failed\n");
+		rc = -ENOMEM;
+		goto err;
+	}
+
+	return 0;
+err:
+	proc_remove(prEntry_dir);
+
+	return rc;
+}
+
+
 static int  tzdbgfs_init(struct platform_device *pdev)
 {
 	int rc = 0;
@@ -1099,6 +1190,11 @@ static int tz_log_probe(struct platform_device *pdev)
 	if (tzdbgfs_init(pdev))
 		goto err;
 
+	//add tz and qsee log to logkit
+	if (tzprocfs_init(pdev))
+		goto err;
+
+
 	tzdbg_register_qsee_log_buf(pdev);
 
 	tzdbg_get_tz_version();
diff --git a/drivers/gpu/drm/drm_internal.h b/drivers/gpu/drm/drm_internal.h
index fbc3f308fa1997ab5889f3f25fb7357106ea5909..cd92c20783ec60364021e4a17794e2251456569c 100644
--- a/drivers/gpu/drm/drm_internal.h
+++ b/drivers/gpu/drm/drm_internal.h
@@ -106,6 +106,60 @@ int drm_gem_open_ioctl(struct drm_device *dev, void *data,
 		       struct drm_file *file_priv);
 void drm_gem_open(struct drm_device *dev, struct drm_file *file_private);
 void drm_gem_release(struct drm_device *dev, struct drm_file *file_private);
+int dsi_display_set_hbm_mode(struct drm_connector *connector, int level);
+int dsi_display_get_hbm_mode(struct drm_connector *connector);
+
+
+int dsi_display_get_serial_number(struct drm_connector *connector);
+int dsi_display_get_serial_number_year(struct drm_connector *connector);
+int dsi_display_get_serial_number_mon(struct drm_connector *connector);
+int dsi_display_get_serial_number_day(struct drm_connector *connector);
+int dsi_display_get_serial_number_hour(struct drm_connector *connector);
+int dsi_display_get_serial_number_min(struct drm_connector *connector);
+int dsi_display_set_acl_mode(struct drm_connector *connector, int level);
+int dsi_display_get_acl_mode(struct drm_connector *connector);
+int dsi_display_set_hbm_mode(struct drm_connector *connector, int level);
+int dsi_display_get_hbm_mode(struct drm_connector *connector);
+int dsi_display_set_hbm_brightness(struct drm_connector *connector, int level);
+int dsi_display_get_hbm_brightness(struct drm_connector *connector);
+int dsi_display_set_aod_mode(struct drm_connector *connector, int level);
+int dsi_display_get_aod_mode(struct drm_connector *connector);
+int dsi_display_set_dci_p3_mode(struct drm_connector *connector, int level);
+int dsi_display_get_dci_p3_mode(struct drm_connector *connector);
+int dsi_display_set_night_mode(struct drm_connector *connector, int level);
+int dsi_display_get_night_mode(struct drm_connector *connector);
+int dsi_display_get_serial_number(struct drm_connector *connector);
+int dsi_display_get_serial_number_year(struct drm_connector *connector);
+int dsi_display_get_serial_number_mon(struct drm_connector *connector);
+int dsi_display_get_serial_number_day(struct drm_connector *connector);
+int dsi_display_get_serial_number_hour(struct drm_connector *connector);
+int dsi_display_get_serial_number_min(struct drm_connector *connector);
+int dsi_display_get_serial_number_sec(struct drm_connector *connector);
+uint64_t dsi_display_get_serial_number_id(uint64_t serial_number);
+int dsi_display_get_stage_info(struct drm_connector *connector);
+int dsi_display_get_production_info(struct drm_connector *connector);
+int dsi_display_panel_mismatch_check(struct drm_connector *connector);
+int dsi_display_panel_mismatch(struct drm_connector *connector);
+int dsi_display_set_aod_disable(struct drm_connector *connector, int disable);
+int dsi_display_get_aod_disable(struct drm_connector *connector);
+int dsi_display_set_fp_hbm_mode(struct drm_connector *connector, int level);
+int dsi_display_get_fp_hbm_mode(struct drm_connector *connector);
+int dsi_display_update_dsi_on_command(struct drm_connector *connector, const char *buf, size_t count);
+int dsi_display_get_dsi_on_command(struct drm_connector *connector, char *buf);
+int dsi_display_set_native_display_p3_mode(struct drm_connector *connector, int level);
+int dsi_display_get_native_display_p3_mode(struct drm_connector *connector);
+int dsi_display_set_native_display_wide_color_mode(struct drm_connector *connector, int level);
+int dsi_display_get_native_display_wide_color_mode(struct drm_connector *connector);
+int dsi_display_set_native_display_srgb_color_mode(struct drm_connector *connector, int level);
+int dsi_display_get_native_display_srgb_color_mode(struct drm_connector *connector);
+int dsi_display_set_native_loading_effect_mode(struct drm_connector *connector, int level);
+int dsi_display_get_native_display_loading_effect_mode(struct drm_connector *connector);
+int dsi_display_set_customer_srgb_mode(struct drm_connector *connector, int level);
+int dsi_display_set_customer_p3_mode(struct drm_connector *connector, int level);
+int dsi_display_get_customer_srgb_mode(struct drm_connector *connector);
+int dsi_display_get_customer_p3_mode(struct drm_connector *connector);
+int dsi_display_update_panel_id_and_gamma_para(struct drm_connector *connector);
+
 
 /* drm_debugfs.c drm_debugfs_crc.c */
 #if defined(CONFIG_DEBUG_FS)
diff --git a/drivers/gpu/drm/drm_mipi_dsi.c b/drivers/gpu/drm/drm_mipi_dsi.c
index 0746ac89fcc59672bd8f15b78f318ce36c11c876..c82db8c5ce6350418189d6de86d01003af1e4674 100644
--- a/drivers/gpu/drm/drm_mipi_dsi.c
+++ b/drivers/gpu/drm/drm_mipi_dsi.c
@@ -561,8 +561,10 @@ EXPORT_SYMBOL(mipi_dsi_set_maximum_return_packet_size);
  * Return: The number of bytes transmitted on success or a negative error code
  * on failure.
  */
-ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
-			       size_t size)
+//ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
+//			       size_t size)
+ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, void *payload,
+			       size_t size)	
 {
 	struct mipi_dsi_msg msg = {
 		.channel = dsi->channel,
@@ -606,8 +608,10 @@ EXPORT_SYMBOL(mipi_dsi_generic_write);
  * Return: The number of bytes successfully read or a negative error code on
  * failure.
  */
-ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
-			      size_t num_params, void *data, size_t size)
+ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, void *params,
+				  size_t num_params, void *data, size_t size)
+//ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
+//			      size_t num_params, void *data, size_t size)
 {
 	struct mipi_dsi_msg msg = {
 		.channel = dsi->channel,
@@ -650,8 +654,10 @@ EXPORT_SYMBOL(mipi_dsi_generic_read);
  * Return: The number of bytes successfully transmitted or a negative error
  * code on failure.
  */
+//ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
+//				  const void *data, size_t len)
 ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
-				  const void *data, size_t len)
+				  void *data, size_t len)
 {
 	struct mipi_dsi_msg msg = {
 		.channel = dsi->channel,
@@ -1092,6 +1098,42 @@ int mipi_dsi_dcs_get_display_brightness(struct mipi_dsi_device *dsi,
 	return 0;
 }
 EXPORT_SYMBOL(mipi_dsi_dcs_get_display_brightness);
+/**
+ * mipi_dsi_dcs_set_display_brightness_samsung() - sets the brightness value of the
+ *    display
+ * @dsi: DSI peripheral device
+ * @brightness: brightness value
+ *
+ * Return: 0 on success or a negative error code on failure.
+ */
+int mipi_dsi_dcs_set_display_brightness_samsung(struct mipi_dsi_device *dsi,
+					u16 brightness)
+{
+	u8 payload[2] = {brightness >> 8, brightness & 0xff};
+	ssize_t err;
+
+	err = mipi_dsi_dcs_write(dsi, MIPI_DCS_SET_DISPLAY_BRIGHTNESS,
+				 payload, sizeof(payload));
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+EXPORT_SYMBOL(mipi_dsi_dcs_set_display_brightness_samsung);
+
+int mipi_dsi_dcs_write_c1(struct mipi_dsi_device *dsi,
+						u16 read_number)
+{
+		u8 payload[3] = {0x0A, read_number >> 8, read_number & 0xff};
+		ssize_t err;
+
+		err = mipi_dsi_dcs_write(dsi, 0xC1,payload, sizeof(payload));
+		if (err < 0)
+			return err;
+
+		return 0;
+}
+EXPORT_SYMBOL(mipi_dsi_dcs_write_c1);
 
 static int mipi_dsi_drv_probe(struct device *dev)
 {
diff --git a/drivers/gpu/drm/drm_modes.c b/drivers/gpu/drm/drm_modes.c
index 4a3f68a33844589ad25a7f02f59c6470c0d2e891..aa927c0fec6d3b0defe6e33c05309e3c67a9bb84 100644
--- a/drivers/gpu/drm/drm_modes.c
+++ b/drivers/gpu/drm/drm_modes.c
@@ -730,8 +730,8 @@ void drm_mode_set_name(struct drm_display_mode *mode)
 {
 	bool interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
 
-	snprintf(mode->name, DRM_DISPLAY_MODE_LEN, "%dx%d%s",
-		 mode->hdisplay, mode->vdisplay,
+	snprintf(mode->name, DRM_DISPLAY_MODE_LEN, "%dx%d-%d%s",
+		 mode->hdisplay, mode->vdisplay,mode->vrefresh,
 		 interlaced ? "i" : "");
 }
 EXPORT_SYMBOL(drm_mode_set_name);
diff --git a/drivers/gpu/drm/drm_sysfs.c b/drivers/gpu/drm/drm_sysfs.c
old mode 100644
new mode 100755
index 1c5b5ce1fd7f4861f40064cfcaf73963ebd0fcee..a8645545eba503e66720deb165cc4b4e7d21d950
--- a/drivers/gpu/drm/drm_sysfs.c
+++ b/drivers/gpu/drm/drm_sysfs.c
@@ -21,10 +21,20 @@
 #include <drm/drm_sysfs.h>
 #include <drm/drmP.h>
 #include "drm_internal.h"
+#include <linux/list.h>
+#include <linux/of.h>
+#include <linux/kobject.h>
+#include <linux/string.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <drm/drm_mipi_dsi.h>
 
 #define to_drm_minor(d) dev_get_drvdata(d)
 #define to_drm_connector(d) dev_get_drvdata(d)
 
+#define DSI_PANEL_SAMSUNG_S6E3HC2 0
+extern char gamma_para[2][413];
+extern char dsi_panel_name;
 /**
  * DOC: overview
  *
@@ -228,17 +238,864 @@ static ssize_t modes_show(struct device *device,
 
 	return written;
 }
+static ssize_t acl_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int acl_mode = 0;
+
+	acl_mode = dsi_display_get_acl_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "acl mode = %d\n"
+											"0--acl mode(off)\n"
+											"1--acl mode(5)\n"
+											"2--acl mode(10)\n"
+											"3--acl mode(15)\n",
+											acl_mode);
+	return ret;
+}
+
+static ssize_t acl_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int acl_mode = 0;
+
+	ret = kstrtoint(buf, 10, &acl_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_acl_mode(connector, acl_mode);
+	if (ret)
+		pr_err("set acl mode(%d) fail\n", acl_mode);
+
+	return count;
+}
+static ssize_t hbm_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int hbm_mode = 0;
+
+	hbm_mode = dsi_display_get_hbm_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "hbm mode = %d\n"
+											"0--hbm mode(off)\n"
+											"1--hbm mode(XX)\n"
+											"2--hbm mode(XX)\n"
+											"3--hbm mode(XX)\n"
+											"4--hbm mode(XX)\n"
+											"5--hbm mode(670)\n",
+											hbm_mode);
+	return ret;
+}
+
+static ssize_t hbm_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int hbm_mode = 0;
+
+	ret = kstrtoint(buf, 10, &hbm_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_hbm_mode(connector, hbm_mode);
+	if (ret)
+		pr_err("set hbm mode(%d) fail\n", hbm_mode);
+
+	return count;
+}
+
+static ssize_t hbm_brightness_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int hbm_brightness = 0;
+
+	hbm_brightness = dsi_display_get_hbm_brightness(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "%d\n", hbm_brightness);
+	return ret;
+}
+
+static ssize_t hbm_brightness_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int hbm_brightness = 0;
+
+	ret = kstrtoint(buf, 10, &hbm_brightness);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+	ret = dsi_display_set_hbm_brightness(connector, hbm_brightness);
+	if (ret)
+		pr_err("set hbm brightness (%d) failed\n", hbm_brightness);
+	return count;
+}
+
+static ssize_t op_friginer_print_hbm_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int op_hbm_mode = 0;
+
+	op_hbm_mode = dsi_display_get_fp_hbm_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "OP_FP mode = %d\n"
+											"0--finger-hbm mode(off)\n"
+											"1--finger-hbm mode(600)\n",
+											op_hbm_mode);
+	return ret;
+}
+
+static ssize_t op_friginer_print_hbm_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int op_hbm_mode = 0;
+
+	ret = kstrtoint(buf, 10, &op_hbm_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_fp_hbm_mode(connector, op_hbm_mode);
+	if (ret)
+		pr_err("set hbm mode(%d) fail\n", op_hbm_mode);
+
+	return count;
+}
+
+static ssize_t aod_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int aod_mode = 0;
+
+	aod_mode = dsi_display_get_aod_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "%d\n", aod_mode);
+	return ret;
+}
+
+static ssize_t aod_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int aod_mode = 0;
+
+	ret = kstrtoint(buf, 10, &aod_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+	ret = dsi_display_set_aod_mode(connector, aod_mode);
+	if (ret)
+		pr_err("set AOD mode(%d) fail\n", aod_mode);
+	return count;
+}
+
+static ssize_t aod_disable_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int aod_disable = 0;
+
+	aod_disable = dsi_display_get_aod_disable(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "AOD disable = %d\n"
+											"0--AOD enable\n"
+											"1--AOD disable\n",
+											aod_disable);
+	return ret;
+}
+
+static ssize_t aod_disable_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int aod_disable = 0;
+
+	ret = kstrtoint(buf, 10, &aod_disable);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_aod_disable(connector, aod_disable);
+	if (ret)
+		pr_err("set AOD disable(%d) fail\n", aod_disable);
+
+	return count;
+}
+
+static ssize_t DCI_P3_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int dci_p3_mode = 0;
+
+	dci_p3_mode = dsi_display_get_dci_p3_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "dci-p3 mode = %d\n"
+											"0--dci-p3 mode Off\n"
+											"1--dci-p3 mode On\n",
+											dci_p3_mode);
+	return ret;
+}
+
+static ssize_t DCI_P3_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int dci_p3_mode = 0;
+
+	ret = kstrtoint(buf, 10, &dci_p3_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_dci_p3_mode(connector, dci_p3_mode);
+	if (ret) {
+		pr_err("set dci-p3 mode(%d) fail\n", dci_p3_mode);
+	}
+	return count;
+}
+
+static ssize_t night_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int night_mode = 0;
+
+	night_mode = dsi_display_get_night_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "night mode = %d\n"
+											"0--night mode Off\n"
+											"1--night mode On\n",
+											night_mode);
+	return ret;
+}
+
+static ssize_t night_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int night_mode = 0;
+
+	ret = kstrtoint(buf, 10, &night_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_night_mode(connector, night_mode);
+	if (ret) {
+		pr_err("set night mode(%d) fail\n", night_mode);
+	}
+	return count;
+}
+
+static ssize_t native_display_p3_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_p3_mode = 0;
+
+	native_display_p3_mode = dsi_display_get_native_display_p3_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display p3 mode = %d\n"
+											"0--native display p3 mode Off\n"
+											"1--native display p3 mode On\n",
+											native_display_p3_mode);
+	return ret;
+}
+
+static ssize_t native_display_p3_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_p3_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_p3_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_native_display_p3_mode(connector, native_display_p3_mode);
+	if (ret) {
+		pr_err("set native_display_p3  mode(%d) fail\n", native_display_p3_mode);
+	}
+	return count;
+}
+static ssize_t native_display_wide_color_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_wide_color_mode = 0;
+
+	native_display_wide_color_mode = dsi_display_get_native_display_wide_color_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display wide color mode = %d\n"
+											"0--native display wide color mode Off\n"
+											"1--native display wide color mode On\n",
+											native_display_wide_color_mode);
+	return ret;
+}
+
+static ssize_t native_display_loading_effect_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_loading_effect_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_loading_effect_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_native_loading_effect_mode(connector, native_display_loading_effect_mode);
+	if (ret) {
+		pr_err("set loading effect  mode(%d) fail\n", native_display_loading_effect_mode);
+	}
+	return count;
+}
+
+static ssize_t native_display_loading_effect_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_loading_effect_mode = 0;
+
+	native_display_loading_effect_mode = dsi_display_get_native_display_loading_effect_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display loading effect mode = %d\n"
+											"0--native display loading effect mode Off\n"
+											"1--native display loading effect mode On\n",
+											native_display_loading_effect_mode);
+	return ret;
+}
+
+static ssize_t native_display_customer_p3_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_customer_p3_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_customer_p3_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_customer_p3_mode(connector, native_display_customer_p3_mode);
+	if (ret) {
+		pr_err("set customer p3  mode(%d) fail\n", native_display_customer_p3_mode);
+	}
+	return count;
+}
+
+static ssize_t native_display_customer_p3_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_customer_p3_mode = 0;
+
+	native_display_customer_p3_mode = dsi_display_get_customer_p3_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display customer p3 mode = %d\n"
+											"0--native display customer p3 mode Off\n"
+											"1--native display customer p3 mode On\n",
+											native_display_customer_p3_mode);
+	return ret;
+}
+static ssize_t native_display_customer_srgb_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_customer_srgb_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_customer_srgb_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_customer_srgb_mode(connector, native_display_customer_srgb_mode);
+	if (ret) {
+		pr_err("set customer srgb  mode(%d) fail\n", native_display_customer_srgb_mode);
+	}
+	return count;
+}
+
+static ssize_t native_display_customer_srgb_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_customer_srgb_mode = 0;
+
+	native_display_customer_srgb_mode = dsi_display_get_customer_srgb_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display customer srgb mode = %d\n"
+											"0--native display customer srgb mode Off\n"
+											"1--native display customer srgb mode On\n",
+											native_display_customer_srgb_mode);
+	return ret;
+}
+
+
+static ssize_t native_display_wide_color_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_wide_color_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_wide_color_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_native_display_wide_color_mode(connector, native_display_wide_color_mode);
+	if (ret) {
+		pr_err("set native_display_p3  mode(%d) fail\n", native_display_wide_color_mode);
+	}
+	return count;
+}
+
+static ssize_t native_display_srgb_color_mode_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_srgb_color_mode = 0;
+
+	native_display_srgb_color_mode = dsi_display_get_native_display_srgb_color_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "native display srgb color mode = %d\n"
+											"0--native display srgb color mode Off\n"
+											"1--native display srgb color mode On\n",
+											native_display_srgb_color_mode);
+	return ret;
+}
+
+static ssize_t native_display_srgb_color_mode_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int native_display_srgb_color_mode = 0;
+
+	ret = kstrtoint(buf, 10, &native_display_srgb_color_mode);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_native_display_srgb_color_mode(connector, native_display_srgb_color_mode);
+	if (ret) {
+		pr_err("set native_display_srgb  mode(%d) fail\n", native_display_srgb_color_mode);
+	}
+	return count;
+}
+
+static ssize_t gamma_test_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int gamma_test_flag = 0;
+	int panel_stage_info = 0;
+	int pvt_mp_panel_flag = 0;
+
+	ret = dsi_display_update_panel_id_and_gamma_para(connector);
+	if (ret) {
+		pr_err("Failed to update panel id and gamma para!\n");
+	}
+
+	if (dsi_panel_name == DSI_PANEL_SAMSUNG_S6E3HC2) {
+		if ((gamma_para[0][18] == 0xFF) && (gamma_para[0][19] == 0xFF) && (gamma_para[0][20] == 0xFF)) {
+			gamma_test_flag = 0;
+		}
+		else {
+			gamma_test_flag = 1;
+		}
+
+		panel_stage_info = dsi_display_get_stage_info(connector);
+		if ((0x07 == panel_stage_info) || (0x10 == panel_stage_info) || (0x11 == panel_stage_info)) {
+			pvt_mp_panel_flag = 1;
+		}
+		else {
+			pvt_mp_panel_flag = 0;
+		}
+
+		ret = scnprintf(buf, PAGE_SIZE, "%d\n", (gamma_test_flag << 1) + pvt_mp_panel_flag);
+		return ret;
+	}
+	else {
+		ret = scnprintf(buf, PAGE_SIZE, "%d\n", 3);
+		pr_err("It is not S6E3HC2 panel!\n");
+		return ret;
+	}
+}
+
+static ssize_t panel_serial_number_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int panel_year = 0;
+	int panel_mon = 0;
+	int panel_day = 0;
+	int panel_hour = 0;
+	int panel_min = 0;
+	int panel_sec = 0;
+	int panel_stage_info = 0;
+	int panel_production_info = 0;
+	char * production_string_info = NULL;
+	char * stage_string_info = NULL;
+	int ret = 0;
+
+
+	dsi_display_get_serial_number(connector);
+
+	panel_year = dsi_display_get_serial_number_year(connector);
+	panel_mon = dsi_display_get_serial_number_mon(connector);
+	panel_day = dsi_display_get_serial_number_day(connector);
+	panel_hour = dsi_display_get_serial_number_hour(connector);
+	panel_min = dsi_display_get_serial_number_min(connector);
+	panel_sec = dsi_display_get_serial_number_sec(connector);
+	panel_stage_info = dsi_display_get_stage_info(connector);
+	panel_production_info = dsi_display_get_production_info(connector);
+
+	if (0x02 == panel_stage_info) {
+		stage_string_info = "STAGE: EVT2";
+	}
+	else if (0x03 == panel_stage_info) {
+		stage_string_info = "STAGE: EVT2(NEW_DIMMING_SET)";
+	}
+	else if (0x99 == panel_stage_info) {
+		stage_string_info = "STAGE: EVT2(113MHZ_OSC)";
+	}
+	else if (0x04 == panel_stage_info) {
+		stage_string_info = "STAGE: DVT1";
+	}
+	else if (0x05 == panel_stage_info) {
+		stage_string_info = "STAGE: DVT2";
+	}
+	else if (0x06 == panel_stage_info) {
+		stage_string_info = "STAGE: DVT3";
+	}
+	else if (0x07 == panel_stage_info) {
+		stage_string_info = "STAGE: PVT(112MHZ_OSC)";
+	}
+	else if (0x10 == panel_stage_info) {
+		stage_string_info = "STAGE: PVT(113MHZ_OSC)";
+	}
+	else if (0x11 == panel_stage_info) {
+		stage_string_info = "STAGE: PVT(113MHZ_OSC+X_TALK_IMPROVEMENT)";
+	}
+	else {
+		stage_string_info = "STAGE: UNKNOWN";
+	}
+
+	if (0x0C == panel_production_info) {
+		production_string_info = "TPIC: LSI\nCOVER: JNTC\nOTP_GAMMA: 90HZ";
+	}
+	else if (0x0E == panel_production_info) {
+		production_string_info = "TPIC: LSI\nCOVER: LENS\nOTP_GAMMA: 90HZ";
+	}
+	else if (0x1C == panel_production_info) {
+		production_string_info = "TPIC: STM\nCOVER: JNTC\nOTP_GAMMA: 90HZ";
+	}
+	else if (0x6C == panel_production_info) {
+		production_string_info = "TPIC: LSI\nCOVER: JNTC\nOTP_GAMMA: 60HZ";
+	}
+	else if (0x6E == panel_production_info) {
+		production_string_info = "TPIC: LSI\nCOVER: LENS\nOTP_GAMMA: 60HZ";
+	}
+	else if (0x1E == panel_production_info) {
+		production_string_info = "TPIC: STM\nCOVER: LENS\nOTP_GAMMA: 90HZ";
+	}
+	else if (0x0D == panel_production_info) {
+		production_string_info = "TPIC: LSI\nID3: 0x0D\nOTP_GAMMA: 90HZ";
+	}
+	else {
+		production_string_info = "TPIC: UNKNOWN\nCOVER: UNKNOWN\nOTP_GAMMA: UNKNOWN";
+	}
+
+	if((0xff ==panel_stage_info) && (0xff == panel_production_info))
+	ret = scnprintf(buf, PAGE_SIZE, "%04d/%02d/%02d %02d:%02d:%02d\n",
+														panel_year,
+														panel_mon,
+														panel_day,
+														panel_hour,
+														panel_min,
+														panel_sec);
+	else
+	ret = scnprintf(buf, PAGE_SIZE, "%04d/%02d/%02d %02d:%02d:%02d\n%s\n%s\n",
+														panel_year,
+														panel_mon,
+														panel_day,
+														panel_hour,
+														panel_min,
+														panel_sec,
+														stage_string_info,
+														production_string_info);
+
+	pr_err("panel year = %d, mon = %d, day = %d, hour = %d, min = %d\n",
+           panel_year, panel_mon, panel_day, panel_hour, panel_min);
+
+	return ret;
+}
+
+static ssize_t panel_serial_number_AT_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+
+	int ret = 0;
+	uint64_t serial_number = 0;
+
+	ret = scnprintf(buf, PAGE_SIZE, "%llu\n",dsi_display_get_serial_number_id(serial_number));
+
+	return ret;
+}
+
+static ssize_t dsi_on_command_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+
+	ret = dsi_display_get_dsi_on_command(connector, buf);
+
+	return ret;
+}
+
+static ssize_t dsi_on_command_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+
+	ret = dsi_display_update_dsi_on_command(connector, buf, count);
+	if (ret)
+		pr_err("Failed to update dsi on command, ret=%d\n", ret);
+
+	return count;
+}
+
+int current_freq = 0;
+static ssize_t dynamic_dsitiming_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int ret = 0;
+
+	ret = scnprintf(buf, PAGE_SIZE, "current_freq = %d\n",
+											current_freq);
+	return ret;
+}
+
+static ssize_t dynamic_dsitiming_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	int ret = 0;
+	int freq_value = 0;
+
+	ret = kstrtoint(buf, 10, &freq_value);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+    current_freq = freq_value;
+
+    pr_err("freq setting=%d\n", current_freq);
+
+	if (ret) {
+		pr_err("set dsi freq (%d) fail\n", current_freq);
+	}
+	return count;
+}
+
+static ssize_t panel_mismatch_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	int wrong_panel = 0;
+
+	dsi_display_panel_mismatch_check(connector);
+
+	wrong_panel = dsi_display_panel_mismatch(connector);
+	ret = scnprintf(buf, PAGE_SIZE, "panel mismatch = %d\n"
+										    "0--(panel match)\n"
+											"1--(panel mismatch)\n",
+											wrong_panel);
+	return ret;
+}
+
+int oneplus_panel_alpha =0;
+int oneplus_force_screenfp = 0;
+extern int oneplus_get_panel_brightness_to_alpha(void);
+
+static ssize_t oneplus_display_get_dim_alpha(struct device *dev,
+                                struct device_attribute *attr, char *buf)
+{
+	return sprintf(buf, "%d\n", oneplus_get_panel_brightness_to_alpha());
+}
+
+static ssize_t oneplus_display_set_dim_alpha(struct device *dev,
+                               struct device_attribute *attr,
+                               const char *buf, size_t count)
+{
+	sscanf(buf, "%d", &oneplus_panel_alpha);
+	return count;
+}
+
+static ssize_t oneplus_display_get_forcescreenfp(struct device *dev,
+                                struct device_attribute *attr, char *buf)
+{
+
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	oneplus_force_screenfp = dsi_display_get_fp_hbm_mode(connector);
+
+	ret = scnprintf(buf, PAGE_SIZE, "OP_FP mode = %d\n"
+											"0--finger-hbm mode(off)\n"
+											"1--finger-hbm mode(600)\n",
+											oneplus_force_screenfp);
+	return sprintf(buf, "%d\n", oneplus_force_screenfp);
+	
+}
+
+static ssize_t oneplus_display_set_forcescreenfp(struct device *dev,
+                               struct device_attribute *attr,
+                               const char *buf, size_t count)
+{
+	//sscanf(buf, "%x", &oneplus_force_screenfp);
+	struct drm_connector *connector = to_drm_connector(dev);
+	int ret = 0;
+	ret = kstrtoint(buf, 10, &oneplus_force_screenfp);
+	if (ret) {
+		pr_err("kstrtoint failed. ret=%d\n", ret);
+		return ret;
+	}
+
+	ret = dsi_display_set_fp_hbm_mode(connector, oneplus_force_screenfp);
+	if (ret)
+		pr_err("set hbm mode(%d) fail\n", oneplus_force_screenfp);
+	return count;
+}
+
+extern  ssize_t oneplus_display_notify_fp_press(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count);
+
+extern  ssize_t oneplus_display_notify_dim(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count);
+
+extern  ssize_t oneplus_display_notify_aod_hid(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count);
 
 static DEVICE_ATTR_RW(status);
 static DEVICE_ATTR_RO(enabled);
 static DEVICE_ATTR_RO(dpms);
 static DEVICE_ATTR_RO(modes);
+static DEVICE_ATTR_RW(acl);
+static DEVICE_ATTR_RW(hbm);
+static DEVICE_ATTR_RW(hbm_brightness);
+static DEVICE_ATTR_RW(op_friginer_print_hbm);
+static DEVICE_ATTR_RW(aod);
+static DEVICE_ATTR_RW(aod_disable);
+static DEVICE_ATTR_RW(DCI_P3);
+static DEVICE_ATTR_RW(night_mode);
+static DEVICE_ATTR_RW(native_display_p3_mode);
+static DEVICE_ATTR_RW(native_display_wide_color_mode);
+static DEVICE_ATTR_RW(native_display_loading_effect_mode);
+static DEVICE_ATTR_RW(native_display_srgb_color_mode);
+static DEVICE_ATTR_RW(native_display_customer_p3_mode);
+static DEVICE_ATTR_RW(native_display_customer_srgb_mode);
+static DEVICE_ATTR_RO(gamma_test);
+static DEVICE_ATTR_RO(panel_serial_number);
+static DEVICE_ATTR_RO(panel_serial_number_AT);
+static DEVICE_ATTR_RW(dsi_on_command);
+static DEVICE_ATTR_RW(dynamic_dsitiming);
+static DEVICE_ATTR_RO(panel_mismatch);
+static DEVICE_ATTR(dim_alpha, S_IRUGO|S_IWUSR, oneplus_display_get_dim_alpha, oneplus_display_set_dim_alpha);
+static DEVICE_ATTR(force_screenfp, S_IRUGO|S_IWUSR, oneplus_display_get_forcescreenfp, oneplus_display_set_forcescreenfp);
+static DEVICE_ATTR(notify_fppress, S_IRUGO|S_IWUSR, NULL, oneplus_display_notify_fp_press);
+static DEVICE_ATTR(notify_dim, S_IRUGO|S_IWUSR, NULL, oneplus_display_notify_dim);
+static DEVICE_ATTR(notify_aod, S_IRUGO|S_IWUSR, NULL, oneplus_display_notify_aod_hid);
 
 static struct attribute *connector_dev_attrs[] = {
 	&dev_attr_status.attr,
 	&dev_attr_enabled.attr,
 	&dev_attr_dpms.attr,
 	&dev_attr_modes.attr,
+	&dev_attr_acl.attr,
+	&dev_attr_hbm.attr,
+	&dev_attr_hbm_brightness.attr,
+	&dev_attr_op_friginer_print_hbm.attr,
+	&dev_attr_aod.attr,
+	&dev_attr_aod_disable.attr,
+	&dev_attr_DCI_P3.attr,
+	&dev_attr_night_mode.attr,
+	&dev_attr_native_display_p3_mode.attr,
+	&dev_attr_native_display_wide_color_mode.attr,
+	&dev_attr_native_display_loading_effect_mode.attr,
+	&dev_attr_native_display_srgb_color_mode.attr,
+	&dev_attr_native_display_customer_p3_mode.attr,
+	&dev_attr_native_display_customer_srgb_mode.attr,
+	&dev_attr_gamma_test.attr,
+	&dev_attr_panel_serial_number.attr,
+	&dev_attr_panel_serial_number_AT.attr,
+	&dev_attr_dsi_on_command.attr,
+	&dev_attr_dynamic_dsitiming.attr,
+	&dev_attr_panel_mismatch.attr,
+	&dev_attr_force_screenfp.attr,
+	&dev_attr_dim_alpha.attr,
+	&dev_attr_notify_fppress.attr,
+	&dev_attr_notify_dim.attr,
+	&dev_attr_notify_aod.attr,
 	NULL
 };
 
diff --git a/drivers/gpu/drm/msm/dp/dp_parser.c b/drivers/gpu/drm/msm/dp/dp_parser.c
index 3219628f95a7dae58df78e11220993dcfb39d623..709935a39ac526bf6133f0175cfb0390354795e8 100644
--- a/drivers/gpu/drm/msm/dp/dp_parser.c
+++ b/drivers/gpu/drm/msm/dp/dp_parser.c
@@ -711,7 +711,7 @@ static int dp_parser_mst(struct dp_parser *parser)
 			"qcom,mst-enable");
 	parser->has_mst_sideband = parser->has_mst;
 
-	pr_debug("mst parsing successful. mst:%d\n", parser->has_mst);
+	pr_err("mst parsing successful. mst:%d\n", parser->has_mst);
 
 	return 0;
 }
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.c b/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.c
index b03e46a136b684cfd73572818d862726f1b91887..33afaa047bc9e4caa73e3f33eed05ab2862b6b36 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -71,6 +71,8 @@ static void dsi_catalog_cmn_init(struct dsi_ctrl_hw *ctrl,
 		dsi_ctrl_hw_cmn_wait_for_cmd_mode_mdp_idle;
 	ctrl->ops.setup_avr = dsi_ctrl_hw_cmn_setup_avr;
 	ctrl->ops.set_continuous_clk = dsi_ctrl_hw_cmn_set_continuous_clk;
+	ctrl->ops.wait4dynamic_refresh_done =
+		dsi_ctrl_hw_cmn_wait4dynamic_refresh_done;
 
 	switch (version) {
 	case DSI_CTRL_VERSION_1_4:
@@ -226,6 +228,14 @@ static void dsi_catalog_phy_3_0_init(struct dsi_phy_hw *phy)
 	phy->ops.clamp_ctrl = dsi_phy_hw_v3_0_clamp_ctrl;
 	phy->ops.phy_lane_reset = dsi_phy_hw_v3_0_lane_reset;
 	phy->ops.toggle_resync_fifo = dsi_phy_hw_v3_0_toggle_resync_fifo;
+	phy->ops.dyn_refresh_ops.dyn_refresh_config =
+		dsi_phy_hw_v3_0_dyn_refresh_config;
+	phy->ops.dyn_refresh_ops.dyn_refresh_pipe_delay =
+		dsi_phy_hw_v3_0_dyn_refresh_pipe_delay;
+	phy->ops.dyn_refresh_ops.dyn_refresh_helper =
+		dsi_phy_hw_v3_0_dyn_refresh_helper;
+	phy->ops.dyn_refresh_ops.cache_phy_timings =
+		dsi_phy_hw_v3_0_cache_phy_timings;
 }
 
 /**
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.h b/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.h
index e6c148ba12d45861660af1715a115370d8e685dc..5e8921faa058687ab1e8c7b67afc8882beb77570 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_catalog.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -66,15 +66,17 @@ int dsi_phy_timing_calc_init(struct dsi_phy_hw *phy,
  * @mode:       DSI mode information.
  * @host:       DSI host configuration.
  * @timing:     DSI phy lane configurations.
+ * @use_mode_bit_clk: Boolean to indicate whether to recalculate bit clk.
  *
  * This function setups the catalog information in the dsi_phy_hw object.
  *
  * return: error code for failure and 0 for success.
  */
 int dsi_phy_hw_calculate_timing_params(struct dsi_phy_hw *phy,
-					    struct dsi_mode_info *mode,
-	struct dsi_host_common_cfg *host,
-	struct dsi_phy_per_lane_cfgs *timing);
+				       struct dsi_mode_info *mode,
+				       struct dsi_host_common_cfg *host,
+				       struct dsi_phy_per_lane_cfgs *timing,
+				       bool use_mode_bit_clk);
 
 /* Definitions for 14nm PHY hardware driver */
 void dsi_phy_hw_v2_0_regulator_enable(struct dsi_phy_hw *phy,
@@ -248,4 +250,14 @@ void dsi_ctrl_hw_22_config_clk_gating(struct dsi_ctrl_hw *ctrl, bool enable,
 
 void dsi_ctrl_hw_cmn_set_continuous_clk(struct dsi_ctrl_hw *ctrl, bool enable);
 
+/* dynamic refresh specific functions */
+void dsi_phy_hw_v3_0_dyn_refresh_helper(struct dsi_phy_hw *phy, u32 offset);
+void dsi_phy_hw_v3_0_dyn_refresh_config(struct dsi_phy_hw *phy,
+				struct dsi_phy_cfg *cfg, bool is_master);
+void dsi_phy_hw_v3_0_dyn_refresh_pipe_delay(struct dsi_phy_hw *phy,
+					    struct dsi_dyn_clk_delay *delay);
+
+int dsi_ctrl_hw_cmn_wait4dynamic_refresh_done(struct dsi_ctrl_hw *ctrl);
+int dsi_phy_hw_v3_0_cache_phy_timings(struct dsi_phy_per_lane_cfgs *timings,
+				      u32 *dst, u32 size);
 #endif /* _DSI_CATALOG_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_clk.h b/drivers/gpu/drm/msm/dsi-staging/dsi_clk.h
index 721a71705a7182f045d1bda9ec1c49ce8463e779..7c2461bb46c1e93e5304a2bc8f94c44a64d318ef 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_clk.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_clk.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -261,13 +261,13 @@ void *dsi_register_clk_handle(void *clk_mngr, char *client);
 int dsi_deregister_clk_handle(void *client);
 
 /**
- * dsi_display_link_clk_force_update_ctrl() - force to set link clks
+ * dsi_display_link_clk_force_update() - force to set link clks
  * @handle:     Handle of desired DSI clock client.
  *
  * return: error code in case of failure or 0 for success.
  */
 
-int dsi_display_link_clk_force_update_ctrl(void *handle);
+int dsi_display_link_clk_force_update(void *handle);
 
 /**
  * dsi_display_clk_ctrl() - set frequencies for link clks
@@ -318,4 +318,28 @@ int dsi_clk_set_byte_clk_rate(void *client, u64 byte_clk, u32 index);
  */
 int dsi_clk_update_parent(struct dsi_clk_link_set *parent,
 			  struct dsi_clk_link_set *child);
+/**
+ * dsi_clk_req_state() - request to change dsi clock state
+ * @client:       DSI clocl client pointer.
+ * @clk:          DSI clock list.
+ * @state:        Requested state of the clock.
+ */
+ /**
+ * dsi_clk_prepare_enable() - prepare and enable dsi src clocks
+ * @clk:       list of src clocks.
+ *
+ * @return:	Zero on success and err no on failure
+ */
+int dsi_clk_prepare_enable(struct dsi_clk_link_set *clk);
+
+/**
+ * dsi_clk_disable_unprepare() - disable and unprepare dsi src clocks
+ * @clk:       list of src clocks.
+ */
+void dsi_clk_disable_unprepare(struct dsi_clk_link_set *clk);
+
+int dsi_clk_req_state(void *client, enum dsi_clk_type clk,
+	enum dsi_clk_state state);
+
+
 #endif /* _DSI_CLK_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_clk_manager.c b/drivers/gpu/drm/msm/dsi-staging/dsi_clk_manager.c
index 5d6808bf1b1652361771b638ca23721f5b5e08dc..2faccadd829c83a7844deb4aa35f9e6f72b122da 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_clk_manager.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_clk_manager.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -113,8 +113,9 @@ int dsi_clk_set_link_frequencies(void *client, struct link_clk_freq freq,
 
 /**
  * dsi_clk_set_pixel_clk_rate() - set frequency for pixel clock
- * @clks:      DSI link clock information.
- * @pixel_clk: Pixel clock rate in KHz.
+ * @clks:	DSI link clock information.
+ * @pixel_clk:	Pixel clock rate in KHz.
+ * @index:	Index of the DSI controller.
  *
  * return: error code in case of failure or 0 for success.
  */
@@ -136,9 +137,9 @@ int dsi_clk_set_pixel_clk_rate(void *client, u64 pixel_clk, u32 index)
 
 /**
  * dsi_clk_set_byte_clk_rate() - set frequency for byte clock
- * @client:       DSI clock client pointer.
- * @byte_clk: Pixel clock rate in Hz.
- * @index:      Index of the DSI controller.
+ * @client:	DSI clock client pointer.
+ * @byte_clk:	Byte clock rate in Hz.
+ * @index:	Index of the DSI controller.
  * return: error code in case of failure or 0 for success.
  */
 int dsi_clk_set_byte_clk_rate(void *client, u64 byte_clk, u32 index)
@@ -146,6 +147,7 @@ int dsi_clk_set_byte_clk_rate(void *client, u64 byte_clk, u32 index)
 	int rc = 0;
 	struct dsi_clk_client_info *c = client;
 	struct dsi_clk_mngr *mngr;
+	u64 byte_intf_rate;
 
 	mngr = c->mngr;
 	rc = clk_set_rate(mngr->link_clks[index].hs_clks.byte_clk, byte_clk);
@@ -154,8 +156,16 @@ int dsi_clk_set_byte_clk_rate(void *client, u64 byte_clk, u32 index)
 	else
 		mngr->link_clks[index].freq.byte_clk_rate = byte_clk;
 
-	return rc;
+	if (mngr->link_clks[index].hs_clks.byte_intf_clk) {
+		byte_intf_rate = mngr->link_clks[index].freq.byte_clk_rate / 2;
+		rc = clk_set_rate(mngr->link_clks[index].hs_clks.byte_intf_clk,
+				  byte_intf_rate);
+		if (rc)
+			pr_err("failed to set clk rate for byte intf clk=%d\n",
+			       rc);
+	}
 
+	return rc;
 }
 
 /**
@@ -183,6 +193,41 @@ int dsi_clk_update_parent(struct dsi_clk_link_set *parent,
 	return rc;
 }
 
+/**
+ * dsi_clk_prepare_enable() - prepare and enable dsi src clocks
+ * @clk:       list of src clocks.
+ *
+ * @return:	Zero on success and err no on failure.
+ */
+int dsi_clk_prepare_enable(struct dsi_clk_link_set *clk)
+{
+	int rc;
+
+	rc = clk_prepare_enable(clk->byte_clk);
+	if (rc) {
+		pr_err("failed to enable byte src clk %d\n", rc);
+		return rc;
+	}
+
+	rc = clk_prepare_enable(clk->pixel_clk);
+	if (rc) {
+		pr_err("failed to enable pixel src clk %d\n", rc);
+		return rc;
+	}
+
+	return 0;
+}
+
+/**
+ * dsi_clk_disable_unprepare() - disable and unprepare dsi src clocks
+ * @clk:       list of src clocks.
+ */
+void dsi_clk_disable_unprepare(struct dsi_clk_link_set *clk)
+{
+	clk_disable_unprepare(clk->pixel_clk);
+	clk_disable_unprepare(clk->byte_clk);
+}
+
 int dsi_core_clk_start(struct dsi_core_clks *c_clks)
 {
 	int rc = 0;
@@ -1210,9 +1255,7 @@ int dsi_clk_req_state(void *client, enum dsi_clk_type clk,
 	return rc;
 }
 
-DEFINE_MUTEX(dsi_mngr_clk_mutex);
-
-static int dsi_display_link_clk_force_update(void *client)
+int dsi_display_link_clk_force_update(void *client)
 {
 	int rc = 0;
 	struct dsi_clk_client_info *c = client;
@@ -1259,43 +1302,6 @@ static int dsi_display_link_clk_force_update(void *client)
 
 }
 
-int dsi_display_link_clk_force_update_ctrl(void *handle)
-{
-	int rc = 0;
-
-	if (!handle) {
-		pr_err("%s: Invalid arg\n", __func__);
-		return -EINVAL;
-	}
-
-	mutex_lock(&dsi_mngr_clk_mutex);
-
-	rc = dsi_display_link_clk_force_update(handle);
-
-	mutex_unlock(&dsi_mngr_clk_mutex);
-
-	return rc;
-}
-
-int dsi_display_clk_ctrl(void *handle,
-	enum dsi_clk_type clk_type, enum dsi_clk_state clk_state)
-{
-	int rc = 0;
-
-	if (!handle) {
-		pr_err("%s: Invalid arg\n", __func__);
-		return -EINVAL;
-	}
-
-	mutex_lock(&dsi_mngr_clk_mutex);
-	rc = dsi_clk_req_state(handle, clk_type, clk_state);
-	if (rc)
-		pr_err("%s: failed set clk state, rc = %d\n", __func__, rc);
-	mutex_unlock(&dsi_mngr_clk_mutex);
-
-	return rc;
-}
-
 void *dsi_register_clk_handle(void *clk_mngr, char *client)
 {
 	void *handle = NULL;
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.c b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.c
old mode 100644
new mode 100755
index 948a662bc11e4b74302205be3243f7a177c72532..dde8151fb9b04a44c7455762109869175e183e3f
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -32,6 +32,7 @@
 #include "dsi_catalog.h"
 
 #include "sde_dbg.h"
+#include "sde_trace.h"
 
 #define DSI_CTRL_DEFAULT_LABEL "MDSS DSI CTRL"
 
@@ -1105,6 +1106,37 @@ int dsi_message_validate_tx_mode(struct dsi_ctrl *dsi_ctrl,
 
 	return rc;
 }
+#if 0
+static void print_cmd_desc(const struct mipi_dsi_msg *msg)
+{
+
+	char buf[1024];
+	int len = 0;
+	size_t i;
+
+	/* Packet Info */
+	len += snprintf(buf, sizeof(buf) - len,  "%02x ", msg->type);
+	len += snprintf(buf + len, sizeof(buf) - len, "%02x ",
+		(msg->flags & MIPI_DSI_MSG_LASTCOMMAND) ? 1 : 0); /* Last bit */
+	len += snprintf(buf + len, sizeof(buf) - len, "%02x ", msg->channel);
+	len += snprintf(buf + len, sizeof(buf) - len, "%02x ",
+						(unsigned int)msg->flags);
+	len += snprintf(buf + len, sizeof(buf) - len, "%02x ", 0); /* Delay */
+	len += snprintf(buf + len, sizeof(buf) - len, "%02x ",
+						(unsigned int)msg->tx_len);
+
+	/* Packet Payload */
+	for (i = 0 ; i < msg->tx_len ; i++) {
+		len += snprintf(buf + len, sizeof(buf) - len,
+						"%02x ", msg->tx_buf[i]);
+		/* Break to prevent show too long command */
+		if (i > 250)
+			break;
+	}
+
+	printk(KERN_ERR"(%02d) %s\n", (unsigned int)msg->tx_len, buf);
+}
+#endif
 
 static int dsi_message_tx(struct dsi_ctrl *dsi_ctrl,
 			  const struct mipi_dsi_msg *msg,
@@ -1121,6 +1153,7 @@ static int dsi_message_tx(struct dsi_ctrl *dsi_ctrl,
 	u8 *cmdbuf;
 	struct dsi_mode_info *timing;
 	struct dsi_ctrl_hw_ops dsi_hw_ops = dsi_ctrl->hw.ops;
+	//print_cmd_desc(msg);
 
 	/* Select the tx mode to transfer the command */
 	dsi_message_setup_tx_mode(dsi_ctrl, msg->tx_len, &flags);
@@ -2493,7 +2526,7 @@ static int _dsi_ctrl_setup_isr(struct dsi_ctrl *dsi_ctrl)
 		return -EINVAL;
 	if (dsi_ctrl->irq_info.irq_num != -1)
 		return 0;
-
+	SDE_ATRACE_BEGIN("_dsi_ctrl_setup_isr");
 	init_completion(&dsi_ctrl->irq_info.cmd_dma_done);
 	init_completion(&dsi_ctrl->irq_info.vid_frame_done);
 	init_completion(&dsi_ctrl->irq_info.cmd_frame_done);
@@ -2518,6 +2551,7 @@ static int _dsi_ctrl_setup_isr(struct dsi_ctrl *dsi_ctrl)
 					dsi_ctrl->cell_index, irq_num);
 		}
 	}
+	SDE_ATRACE_END("_dsi_ctrl_setup_isr");
 	return rc;
 }
 
@@ -2880,7 +2914,12 @@ int dsi_ctrl_update_host_config(struct dsi_ctrl *ctrl,
 		goto error;
 	}
 
-	if (!(flags & (DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR))) {
+	if (!(flags & (DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR |
+		       DSI_MODE_FLAG_DYN_CLK))) {
+		/*
+		 * for dynamic clk switch case link frequence would
+		 * be updated dsi_display_dynamic_clk_switch().
+		 */
 		rc = dsi_ctrl_update_link_freqs(ctrl, config, clk_handle);
 		if (rc) {
 			pr_err("[%s] failed to update link frequencies, rc=%d\n",
@@ -3595,6 +3634,27 @@ void dsi_ctrl_irq_update(struct dsi_ctrl *dsi_ctrl, bool enable)
 	mutex_unlock(&dsi_ctrl->ctrl_lock);
 }
 
+/**
+ * dsi_ctrl_wait4dynamic_refresh_done() - Poll for dynamci refresh
+ *				done interrupt.
+ * @dsi_ctrl:              DSI controller handle.
+ */
+int dsi_ctrl_wait4dynamic_refresh_done(struct dsi_ctrl *ctrl)
+{
+	int rc = 0;
+
+	if (!ctrl)
+		return 0;
+
+	mutex_lock(&ctrl->ctrl_lock);
+
+	if (ctrl->hw.ops.wait4dynamic_refresh_done)
+		rc = ctrl->hw.ops.wait4dynamic_refresh_done(&ctrl->hw);
+
+	mutex_unlock(&ctrl->ctrl_lock);
+	return rc;
+}
+
 /**
  * dsi_ctrl_drv_register() - register platform driver for dsi controller
  */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.h b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.h
index 75f43abfbc7f4706c734b5dec7f98ab97595aa29..f49772dace7ad3f552eabd45ef8a255b76945929 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -805,4 +805,11 @@ int dsi_ctrl_pixel_format_to_bpp(enum dsi_pixel_format dst_format);
  * @enable:			   variable to control continuous clock.
  */
 void dsi_ctrl_set_continuous_clk(struct dsi_ctrl *dsi_ctrl, bool enable);
+
+/**
+ * dsi_ctrl_wait4dynamic_refresh_done() - Poll for dynamic refresh done
+ *					interrupt.
+ * @dsi_ctrl:                      DSI controller handle.
+ */
+int dsi_ctrl_wait4dynamic_refresh_done(struct dsi_ctrl *ctrl);
 #endif /* _DSI_CTRL_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw.h b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw.h
index 458d865c2cf4451a98f4e6df0dea727691d09bb0..848dea5b2f0c4fc2aa7e63376293afe9e5ecfa23 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -829,6 +829,12 @@ struct dsi_ctrl_hw_ops {
 	 * @enable:	  Bool to control continuous clock request.
 	 */
 	void (*set_continuous_clk)(struct dsi_ctrl_hw *ctrl, bool enable);
+
+	/**
+	 * hw.ops.wait4dynamic_refresh_done() - Wait for dynamic refresh done
+	 * @ctrl:         Pointer to the controller host hardware.
+	 */
+	int (*wait4dynamic_refresh_done)(struct dsi_ctrl_hw *ctrl);
 };
 
 /*
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw_cmn.c b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw_cmn.c
index 64d56d77a12e284ca396fb58de87c569258bfe4e..273c7e0f1650d22af641dba0c26a78c7c730fd2c 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw_cmn.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_hw_cmn.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -23,6 +23,7 @@
 #include "dsi_panel.h"
 #include "dsi_catalog.h"
 #include "sde_dbg.h"
+#include "sde_trace.h"
 
 #define MMSS_MISC_CLAMP_REG_OFF           0x0014
 #define DSI_CTRL_DYNAMIC_FORCE_ON         (0x23F|BIT(8)|BIT(9)|BIT(11)|BIT(21))
@@ -1516,6 +1517,13 @@ void dsi_ctrl_hw_cmn_mask_error_intr(struct dsi_ctrl_hw *ctrl, u32 idx, bool en)
 		}
 	}
 
+	if (idx & BIT(DSI_PLL_UNLOCK_ERR)) {
+		if (en)
+			reg |= BIT(28);
+		else
+			reg &= ~BIT(28);
+	}
+
 	DSI_W32(ctrl, 0x10c, reg);
 	wmb(); /* ensure error is masked */
 }
@@ -1562,8 +1570,10 @@ int dsi_ctrl_hw_cmn_wait_for_cmd_mode_mdp_idle(struct dsi_ctrl_hw *ctrl)
 	u32 const sleep_us = 2 * 1000;
 	u32 const timeout_us = 200 * 1000;
 
+	SDE_ATRACE_BEGIN("readl_poll_timeout");
 	rc = readl_poll_timeout(ctrl->base + DSI_STATUS, val,
 			!(val & cmd_mode_mdp_busy_mask), sleep_us, timeout_us);
+	SDE_ATRACE_END("readl_poll_timeout");
 	if (rc)
 		pr_err("%s: timed out waiting for idle\n", __func__);
 
@@ -1582,3 +1592,25 @@ void dsi_ctrl_hw_cmn_set_continuous_clk(struct dsi_ctrl_hw *ctrl, bool enable)
 	DSI_W32(ctrl, DSI_LANE_CTRL, reg);
 	wmb(); /* make sure request is set */
 }
+
+int dsi_ctrl_hw_cmn_wait4dynamic_refresh_done(struct dsi_ctrl_hw *ctrl)
+{
+	int rc;
+	u32 const sleep_us = 1000;
+	u32 const timeout_us = 84000; /* approximately 5 vsyncs */
+	u32 reg = 0, dyn_refresh_done = BIT(28);
+
+	rc = readl_poll_timeout(ctrl->base + DSI_INT_CTRL, reg,
+				(reg & dyn_refresh_done), sleep_us, timeout_us);
+	if (rc) {
+		pr_err("wait4dynamic refresh timedout %d\n", rc);
+		return rc;
+	}
+
+	/* ack dynamic refresh done status */
+	reg = DSI_R32(ctrl, DSI_INT_CTRL);
+	reg |= dyn_refresh_done;
+	DSI_W32(ctrl, DSI_INT_CTRL, reg);
+
+	return 0;
+}
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_reg.h b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_reg.h
index 6bf147bb00cb20e6e3b56d8791422736bd9cf988..72ac12dfd4b6beb714444d5890eec2ff2694cffe 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_reg.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_ctrl_reg.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -138,44 +138,7 @@
 #define DSI_SCRATCH_REGISTER_1                     (0x01F8)
 #define DSI_SCRATCH_REGISTER_2                     (0x01FC)
 #define DSI_DYNAMIC_REFRESH_CTRL                   (0x0200)
-#define DSI_DYNAMIC_REFRESH_PIPE_DELAY             (0x0204)
-#define DSI_DYNAMIC_REFRESH_PIPE_DELAY2            (0x0208)
-#define DSI_DYNAMIC_REFRESH_PLL_DELAY              (0x020C)
 #define DSI_DYNAMIC_REFRESH_STATUS                 (0x0210)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL0              (0x0214)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL1              (0x0218)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL2              (0x021C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL3              (0x0220)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL4              (0x0224)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL5              (0x0228)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL6              (0x022C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL7              (0x0230)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL8              (0x0234)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL9              (0x0238)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL10             (0x023C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL11             (0x0240)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL12             (0x0244)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL13             (0x0248)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL14             (0x024C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL15             (0x0250)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL16             (0x0254)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL17             (0x0258)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL18             (0x025C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL19             (0x0260)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL20             (0x0264)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL21             (0x0268)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL22             (0x026C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL23             (0x0270)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL24             (0x0274)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL25             (0x0278)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL26             (0x027C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL27             (0x0280)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL28             (0x0284)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL29             (0x0288)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL30             (0x028C)
-#define DSI_DYNAMIC_REFRESH_PLL_CTRL31             (0x0290)
-#define DSI_DYNAMIC_REFRESH_PLL_UPPER_ADDR         (0x0294)
-#define DSI_DYNAMIC_REFRESH_PLL_UPPER_ADDR2        (0x0298)
 #define DSI_VIDEO_COMPRESSION_MODE_CTRL            (0x02A0)
 #define DSI_VIDEO_COMPRESSION_MODE_CTRL2           (0x02A4)
 #define DSI_COMMAND_COMPRESSION_MODE_CTRL          (0x02A8)
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_defs.h b/drivers/gpu/drm/msm/dsi-staging/dsi_defs.h
old mode 100644
new mode 100755
index c57f8b17eb3ee54cc42af5019eec2ae26b7d2b58..b83cc74165bc2fb8248da54077f81ea93a6a674e
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_defs.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_defs.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -82,6 +82,7 @@ enum dsi_op_mode {
  * @DSI_MODE_FLAG_DMS: Seamless transition is dynamic mode switch
  * @DSI_MODE_FLAG_VRR: Seamless transition is DynamicFPS.
  *                     New timing values are sent from DAL.
+ * @DSI_MODE_FLAG_DYN_CLK: Seamless transition is dynamic clock change
  */
 enum dsi_mode_flags {
 	DSI_MODE_FLAG_SEAMLESS			= BIT(0),
@@ -89,6 +90,7 @@ enum dsi_mode_flags {
 	DSI_MODE_FLAG_VBLANK_PRE_MODESET	= BIT(2),
 	DSI_MODE_FLAG_DMS			= BIT(3),
 	DSI_MODE_FLAG_VRR			= BIT(4),
+	DSI_MODE_FLAG_DYN_CLK			= BIT(5),
 };
 
 /**
@@ -273,7 +275,71 @@ enum dsi_cmd_set_type {
 	DSI_CMD_SET_POST_TIMING_SWITCH,
 	DSI_CMD_SET_QSYNC_ON,
 	DSI_CMD_SET_QSYNC_OFF,
+	DSI_CMD_SET_HBM_BRIGHTNESS_ON,
+	DSI_CMD_SET_HBM_BRIGHTNESS_OFF,
+	DSI_CMD_SET_HBM_ON_1,
+	DSI_CMD_SET_HBM_ON_2,
+	DSI_CMD_SET_HBM_ON_3,
+	DSI_CMD_SET_HBM_ON_4,
+	DSI_CMD_SET_HBM_ON_5,
+	DSI_CMD_SET_HBM_OFF,
+	DSI_CMD_SET_PANEL_SERIAL_NUMBER,
+	DSI_CMD_SET_AOD_ON_1,
+	DSI_CMD_SET_AOD_ON_2,
+	DSI_CMD_SET_AOD_OFF,
+	DSI_CMD_AOD_OFF_HBM_ON_SETTING,
+	DSI_CMD_SET_AOD_OFF_NEW,
+	DSI_CMD_HBM_OFF_AOD_ON_SETTING,
+	DSI_CMD_SET_AOD_OFF_SAMSUNG,
+//	DSI_CMD_SET_SRGB_ON,
+//	DSI_CMD_SET_SRGB_OFF,
+	DSI_CMD_SET_DCI_P3_ON,
+	DSI_CMD_SET_DCI_P3_OFF,
+	DSI_CMD_SET_NIGHT_ON,
+	DSI_CMD_SET_NIGHT_OFF,
+	DSI_CMD_SET_PANEL_ID,
+	DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON,
+	DSI_CMD_SET_PANEL_ID1,
+	DSI_CMD_SET_PANEL_ID2,
+	DSI_CMD_SET_PANEL_ID3,
+	DSI_CMD_SET_PANEL_ID4,
+	DSI_CMD_SET_PANEL_ID5,
+	DSI_CMD_SET_PANEL_ID6,
+	DSI_CMD_SET_PANEL_ID7,
+	DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF,
+	DSI_CMD_SET_ACL_MODE,
+	DSI_CMD_SET_LCDINFO_PRE,
+	DSI_CMD_SET_LCDINFO_POST,
+	DSI_CMD_SET_STAGE_INFO,
+	DSI_CMD_SET_PRODUCTION_INFO,
+	DSI_CMD_SET_ESD_LOGREAD_PREREAD,
+	DSI_CMD_SET_GAMMA_FLASH_PRE_READ_1,
+	DSI_CMD_SET_GAMMA_FLASH_PRE_READ_2,
+	DSI_CMD_SET_GAMMA_FLASH_READ_FB,
+	DSI_CMD_SET_LEVEL2_KEY_ENABLE,
+	DSI_CMD_SET_GAMMA_OTP_READ_C8_SMRPS,
+	DSI_CMD_SET_GAMMA_OTP_READ_C8,
+	DSI_CMD_SET_GAMMA_OTP_READ_C9_SMRPS,
+	DSI_CMD_SET_GAMMA_OTP_READ_C9,
+	DSI_CMD_SET_GAMMA_OTP_READ_B3_SMRPS,
+	DSI_CMD_SET_GAMMA_OTP_READ_B3,
+	DSI_CMD_SET_LEVEL2_KEY_DISABLE,
+	DSI_CMD_SET_NATIVE_DISPLAY_P3_ON,
+	DSI_CMD_SET_NATIVE_DISPLAY_P3_OFF,
+	DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON,
+	DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_OFF,
+	DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON,
+	DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_OFF,
+	DSI_CMD_SET_113MHZ_OSC_ON,
+	DSI_CMD_POST_ON_BACKLIGHT,
+	DSI_CMD_LOADING_EFFECT_ON,
+	DSI_CMD_LOADING_EFFECT_OFF,
+	DSI_CMD_LOADING_CUSTOMER_RGB_ON,
+	DSI_CMD_LOADING_CUSTOMER_RGB_OFF,
+	DSI_CMD_LOADING_CUSTOMER_P3_ON,
+	DSI_CMD_LOADING_CUSTOMER_P3_OFF,
 	DSI_CMD_SET_MAX
+
 };
 
 /**
@@ -635,12 +701,50 @@ struct dsi_event_cb_info {
  * @DSI_FIFO_OVERFLOW:     DSI FIFO Overflow error
  * @DSI_FIFO_UNDERFLOW:    DSI FIFO Underflow error
  * @DSI_LP_Rx_TIMEOUT:     DSI LP/RX Timeout error
+ * @DSI_PLL_UNLOCK_ERR:	   DSI PLL unlock error
  */
 enum dsi_error_status {
 	DSI_FIFO_OVERFLOW = 1,
 	DSI_FIFO_UNDERFLOW,
 	DSI_LP_Rx_TIMEOUT,
+	DSI_PLL_UNLOCK_ERR,
 	DSI_ERR_INTR_ALL,
 };
 
+/* structure containing the delays required for dynamic clk */
+struct dsi_dyn_clk_delay {
+	u32 pipe_delay;
+	u32 pipe_delay2;
+	u32 pll_delay;
+};
+
+/* dynamic refresh control bits */
+enum dsi_dyn_clk_control_bits {
+	DYN_REFRESH_INTF_SEL = 1,
+	DYN_REFRESH_SYNC_MODE,
+	DYN_REFRESH_SW_TRIGGER,
+	DYN_REFRESH_SWI_CTRL,
+};
+
+/* convert dsi pixel format into bits per pixel */
+static inline int dsi_pixel_format_to_bpp(enum dsi_pixel_format fmt)
+{
+	switch (fmt) {
+	case DSI_PIXEL_FORMAT_RGB888:
+	case DSI_PIXEL_FORMAT_MAX:
+		return 24;
+	case DSI_PIXEL_FORMAT_RGB666:
+	case DSI_PIXEL_FORMAT_RGB666_LOOSE:
+		return 18;
+	case DSI_PIXEL_FORMAT_RGB565:
+		return 16;
+	case DSI_PIXEL_FORMAT_RGB111:
+		return 3;
+	case DSI_PIXEL_FORMAT_RGB332:
+		return 8;
+	case DSI_PIXEL_FORMAT_RGB444:
+		return 12;
+	}
+	return 24;
+}
 #endif /* _DSI_DEFS_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_display.c b/drivers/gpu/drm/msm/dsi-staging/dsi_display.c
old mode 100644
new mode 100755
index 862254c369d79299a8dfe449b73e725d42391c87..596b8f6a063e19f422ccfce91fa21f29956c1b4e
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_display.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_display.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -18,6 +18,8 @@
 #include <linux/of.h>
 #include <linux/of_gpio.h>
 #include <linux/err.h>
+#include <linux/input.h>
+#include <linux/proc_fs.h>
 
 #include "msm_drv.h"
 #include "sde_connector.h"
@@ -31,6 +33,14 @@
 #include "dsi_pwr.h"
 #include "sde_dbg.h"
 #include "dsi_parser.h"
+#include <linux/msm_drm_notify.h>
+#include <linux/notifier.h>
+#include <linux/sched.h>
+#include <linux/pm_qos.h>
+#include <linux/cpufreq.h>
+#include <linux/pm_wakeup.h>
+#include "../sde/sde_trace.h"
+#include "dsi_parser.h"
 
 #define to_dsi_display(x) container_of(x, struct dsi_display, host)
 #define INT_BASE_10 10
@@ -44,8 +54,14 @@
 #define DSI_CLOCK_BITRATE_RADIX 10
 #define MAX_TE_SOURCE_ID  2
 
+DEFINE_MUTEX(dsi_display_clk_mutex);
+
 static char dsi_display_primary[MAX_CMDLINE_PARAM_LEN];
 static char dsi_display_secondary[MAX_CMDLINE_PARAM_LEN];
+static char SERIAL_NUMBER_flag = 0;
+
+
+
 static struct dsi_display_boot_param boot_displays[MAX_DSI_ACTIVE_DISPLAY] = {
 	{.boot_param = dsi_display_primary},
 	{.boot_param = dsi_display_secondary},
@@ -55,6 +71,13 @@ static const struct of_device_id dsi_display_dt_match[] = {
 	{.compatible = "qcom,dsi-display"},
 	{}
 };
+static struct dsi_display *primary_display;
+static struct input_dev* brightness_input_dev = NULL;
+static struct proc_dir_entry *prEntry_tp = NULL;
+static int    screen_state_enable = 0;
+static int    screen_state;
+static int    screen_last_state = 3;
+#define to_dsi_bridge(x)  container_of((x), struct dsi_bridge, base)
 
 static void dsi_display_mask_ctrl_error_interrupts(struct dsi_display *display,
 			u32 mask, bool enable)
@@ -176,6 +199,7 @@ void dsi_rect_intersect(const struct dsi_rect *r1,
 	}
 }
 
+extern int aod_layer_hide;
 int dsi_display_set_backlight(struct drm_connector *connector,
 		void *display, u32 bl_lvl)
 {
@@ -184,18 +208,117 @@ int dsi_display_set_backlight(struct drm_connector *connector,
 	u32 bl_scale, bl_scale_ad;
 	u64 bl_temp;
 	int rc = 0;
-
+    static char gamma_read_flag = 0;
 	if (dsi_display == NULL || dsi_display->panel == NULL)
 		return -EINVAL;
 
 	panel = dsi_display->panel;
-
 	mutex_lock(&panel->panel_lock);
 	if (!dsi_panel_initialized(panel)) {
+		panel->hbm_backlight = bl_lvl;
+		panel->bl_config.bl_level = bl_lvl;
+		pr_err("HBM_backight =%d\n",panel->hbm_backlight);
 		rc = -EINVAL;
 		goto error;
 	}
 
+
+if (strcmp(dsi_display->panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") == 0){
+
+		if (bl_lvl != 0 && panel->bl_config.bl_level == 0) {
+			if (panel->naive_display_p3_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_P3_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_P3_ON);
+			}
+			if (panel->naive_display_wide_color_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON);
+			}
+			if (panel->naive_display_srgb_color_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON);
+			}
+			if (panel->naive_display_loading_effect_mode) {
+				pr_err("Send DSI_CMD_LOADING_EFFECT_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_ON);
+			}
+			else {
+				pr_err("Send DSI_CMD_LOADING_EFFECT_OFF cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_OFF);
+			}
+
+			if (panel->naive_display_customer_srgb_mode) {
+				pr_err("Send DSI_CMD_LOADING_CUSTOMER_RGB_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_ON);
+			}
+			else {
+				pr_err("Send DSI_CMD_LOADING_CUSTOMER_RGB_OFF cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_OFF);
+			}
+
+			if (panel->naive_display_customer_p3_mode) {
+					pr_err("Send DSI_CMD_LOADING_CUSTOMER_P3_ON cmds\n");
+					rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_ON);
+			}
+			else {
+					pr_err("Send DSI_CMD_LOADING_CUSTOMER_P3_OFF cmds\n");
+					rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_OFF);
+			}
+
+		}
+
+}
+
+	if (strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) {
+		if (bl_lvl != 0 && panel->bl_config.bl_level == 0) {
+			if (panel->naive_display_p3_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_P3_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_P3_ON);
+			}
+			if (panel->naive_display_wide_color_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON);
+			}
+			if (panel->naive_display_srgb_color_mode) {
+				mdelay(20);
+				pr_err("Send DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON);
+			}
+			if (panel->naive_display_loading_effect_mode) {
+				pr_err("Send DSI_CMD_LOADING_EFFECT_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_ON);
+			}
+			else {
+				pr_err("Send DSI_CMD_LOADING_EFFECT_OFF cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_OFF);
+			}
+
+			if (panel->naive_display_customer_srgb_mode) {
+				pr_err("Send DSI_CMD_LOADING_CUSTOMER_RGB_ON cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_ON);
+			}
+			else {
+				pr_err("Send DSI_CMD_LOADING_CUSTOMER_RGB_OFF cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_OFF);
+			}
+
+			if (panel->naive_display_customer_p3_mode) {
+					pr_err("Send DSI_CMD_LOADING_CUSTOMER_P3_ON cmds\n");
+					rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_ON);
+			}
+			else {
+					pr_err("Send DSI_CMD_LOADING_CUSTOMER_P3_OFF cmds\n");
+					rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_OFF);
+			}
+
+		}
+	}
+
 	panel->bl_config.bl_level = bl_lvl;
 
 	/* scale backlight */
@@ -219,7 +342,6 @@ int dsi_display_set_backlight(struct drm_connector *connector,
 	rc = dsi_panel_set_backlight(panel, (u32)bl_temp);
 	if (rc)
 		pr_err("unable to set backlight\n");
-
 	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
 			DSI_CORE_CLK, DSI_CLK_OFF);
 	if (rc) {
@@ -230,7 +352,27 @@ int dsi_display_set_backlight(struct drm_connector *connector,
 
 error:
 	mutex_unlock(&panel->panel_lock);
-	return rc;
+
+	if((strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0
+		|| strcmp(panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") == 0) && (0 == SERIAL_NUMBER_flag)) {
+		dsi_display_get_serial_number_AT(connector);
+	}
+
+	if ((gamma_read_flag < 2) && (strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0)) {
+		if (gamma_read_flag < 1) {
+			gamma_read_flag++;
+		}
+		else {
+//			dsi_display_get_serial_number_AT(connector);
+			if (((panel->panel_production_info & 0x0F) == 0x0C) || ((panel->panel_production_info & 0x0F) == 0x0E)
+					|| ((panel->panel_production_info & 0x0F) == 0x0D)) {
+				dsi_display_gamma_read(dsi_display);
+			}
+			dsi_panel_parse_gamma_cmd_sets();
+			gamma_read_flag ++;
+		}
+	}
+    return rc;
 }
 
 static int dsi_display_cmd_engine_enable(struct dsi_display *display)
@@ -698,15 +840,86 @@ static int dsi_display_validate_status(struct dsi_display_ctrl *ctrl,
 	return rc;
 }
 
+static int dsi_panel_tx_cmd_set_op(struct dsi_panel *panel,
+				enum dsi_cmd_set_type type)
+{
+	int rc = 0, i = 0;
+	ssize_t len;
+	struct dsi_cmd_desc *cmds;
+	u32 count;
+	enum dsi_cmd_set_state state;
+	struct dsi_display_mode *mode;
+	const struct mipi_dsi_host_ops *ops = panel->host->ops;
+	if (!panel || !panel->cur_mode)
+		return -EINVAL;
+
+
+	mode = panel->cur_mode;
+
+	cmds = mode->priv_info->cmd_sets[type].cmds;
+	count = mode->priv_info->cmd_sets[type].count;
+	state = mode->priv_info->cmd_sets[type].state;
+
+	if (count == 0) {
+		pr_debug("[%s] No commands to be sent for state(%d)\n",
+			 panel->name, type);
+		goto error;
+	}
+	for (i = 0; i < count; i++) {
+		if (state == DSI_CMD_SET_STATE_LP)
+			cmds->msg.flags |= MIPI_DSI_MSG_USE_LPM;
+
+		if (cmds->last_command)
+			cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+
+		len = ops->transfer(panel->host, &cmds->msg);
+		if (len < 0) {
+			rc = len;
+			pr_err("failed to set cmds(%d), rc=%d\n", type, rc);
+			goto error;
+		}
+		if (cmds->post_wait_ms)
+			usleep_range(cmds->post_wait_ms*1000,
+					((cmds->post_wait_ms*1000)+10));
+		cmds++;
+	}
+error:
+	return rc;
+}
+
 static int dsi_display_status_reg_read(struct dsi_display *display)
 {
 	int rc = 0, i;
 	struct dsi_display_ctrl *m_ctrl, *ctrl;
-
-	pr_debug(" ++\n");
-
+	struct dsi_display_mode *mode;
+	u32 flags = 0;
+	u32 count =0;
+	struct dsi_panel *panel = NULL;
+	struct dsi_cmd_desc *cmds1;
+	struct dsi_cmd_desc *cmds2;
+	struct dsi_cmd_desc *cmds3;
+	struct dsi_cmd_desc *cmds4;
+	struct dsi_cmd_desc *cmds5;
+	struct dsi_cmd_desc *cmds6;
+	struct dsi_cmd_desc *cmds7;
+	u8 temp_buffer_1[1] = {0};
+	u8 temp_buffer_2[1] = {0};
+	u8 temp_buffer_3[1] = {0};
+	u8 temp_buffer_4[1] = {0};
+	u8 temp_buffer_5[2] = {0,};
+	u8 temp_buffer_6[16] = {0,};
+	u8 temp_buffer_7[34] = {0,};
+	u8 buf[48];
+	//u8 ESD_TEST1=0;
+	//u8 ESD_TEST2=0;
+	//u8 ESD_TEST3=0;
+	//u8 ESD_TEST4=0;
+	//u8 ESD_TEST5=0;
+	//u8 ESD_TEST6=0;
+	//u8 ESD_TEST7=0;
+    memset(buf, 0, sizeof(buf));
+	//printk(KERN_ERR"dsi_display_status_reg_read start\n");
 	m_ctrl = &display->ctrl[display->cmd_master_idx];
-
 	if (display->tx_cmd_buf == NULL) {
 		rc = dsi_host_alloc_cmd_tx_buffer(display);
 		if (rc) {
@@ -714,14 +927,219 @@ static int dsi_display_status_reg_read(struct dsi_display *display)
 			goto done;
 		}
 	}
-
 	rc = dsi_display_cmd_engine_enable(display);
 	if (rc) {
 		pr_err("cmd engine enable failed\n");
 		return -EPERM;
 	}
+	mode = display->panel->cur_mode;
+	panel = display->panel;
+	if (strcmp(panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0){
+		count = mode->priv_info->cmd_sets[DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON].count;
+		if (!count) {
+			pr_err("This panel does not read register\n");
+		} else {
+
+			rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		}
+		cmds1 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID1].cmds;
+		if (cmds1->last_command) {
+			cmds1->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds1->msg.rx_buf = buf;
+		cmds1->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds1->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+
+		memcpy(temp_buffer_1, cmds1->msg.rx_buf, 1);
+		memset(buf, 0, sizeof(buf));
+
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		cmds2 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID2].cmds;
+		if (cmds2->last_command) {
+			cmds2->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds2->msg.rx_buf = buf;
+		cmds2->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds2->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+		
+		memcpy(temp_buffer_2, cmds2->msg.rx_buf, 1);
+		memset(buf, 0, sizeof(buf));
+
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		cmds3 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID3].cmds;
+		if (cmds3->last_command) {
+			cmds3->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds3->msg.rx_buf = buf;
+		cmds3->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds3->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+				
+		memcpy(temp_buffer_3, cmds3->msg.rx_buf, 1);
+
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		cmds4 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID4].cmds;
+		if (cmds4->last_command) {
+			cmds4->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds4->msg.rx_buf = buf;
+		cmds4->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds4->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+				
+		memcpy(temp_buffer_4, cmds4->msg.rx_buf, 1);
+		memset(buf, 0, sizeof(buf));
+		
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		cmds5 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID5].cmds;
+		if (cmds5->last_command) {
+			cmds5->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds5->msg.rx_buf = buf;
+		cmds5->msg.rx_len = 2;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds5->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+						
+		memcpy(temp_buffer_5, cmds5->msg.rx_buf, 2);
+		memset(buf, 0, sizeof(buf));
+
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		cmds6 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID6].cmds;
+		if (cmds6->last_command) {
+			cmds6->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds6->msg.rx_buf = buf;
+		cmds6->msg.rx_len = 16;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds6->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+						
+		memcpy(temp_buffer_6, cmds6->msg.rx_buf, 16);
+		memset(buf, 0, sizeof(buf));
+
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_SET_ESD_LOGREAD_PREREAD);
+
+		cmds7 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID7].cmds;
+		if (cmds7->last_command) {
+			cmds7->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds7->msg.rx_buf = buf;
+		cmds7->msg.rx_len = 34;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds7->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+								
+		memcpy(temp_buffer_7, cmds7->msg.rx_buf, 34);
+/**********************************************************************************/
+
+		//printk(KERN_ERR"Read LCD register 0A = %x\n",temp_buffer_1[0]);
+		//printk(KERN_ERR"Read LCD register 0E = %x\n",temp_buffer_2[0]);
+		//printk(KERN_ERR"Read LCD register 0F = %x\n",temp_buffer_3[0]);
+		//printk(KERN_ERR"Read LCD register C4 = %x\n",temp_buffer_4[0]);
+		//printk(KERN_ERR"Read LCD register E7 = %x,%x\n",temp_buffer_5[0],temp_buffer_5[1]);
+		//printk(KERN_ERR"Read MIPI register EA(1-16)  = %x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x\n",temp_buffer_6[0],temp_buffer_6[1],temp_buffer_6[2],temp_buffer_6[3],temp_buffer_6[4],temp_buffer_6[5],temp_buffer_6[6],temp_buffer_6[7],temp_buffer_6[8],temp_buffer_6[9],temp_buffer_6[10],temp_buffer_6[11],temp_buffer_6[12],temp_buffer_6[13],temp_buffer_6[14],temp_buffer_6[15]);
+		//printk(KERN_ERR"Read MIPI register FB(1-16)  = %x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x\n", temp_buffer_7[0], temp_buffer_7[1], temp_buffer_7[2], temp_buffer_7[3], temp_buffer_7[4], temp_buffer_7[5], temp_buffer_7[6], temp_buffer_7[7], temp_buffer_7[8], temp_buffer_7[9], temp_buffer_7[10], temp_buffer_7[11], temp_buffer_7[12], temp_buffer_7[13], temp_buffer_7[14], temp_buffer_7[15]);
+		//printk(KERN_ERR"Read MIPI register FB(17-33) = %x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x\n", temp_buffer_7[16], temp_buffer_7[17], temp_buffer_7[18], temp_buffer_7[19], temp_buffer_7[20], temp_buffer_7[21], temp_buffer_7[22], temp_buffer_7[23], temp_buffer_7[24], temp_buffer_7[25], temp_buffer_7[26], temp_buffer_7[27], temp_buffer_7[28], temp_buffer_7[29], temp_buffer_7[30], temp_buffer_7[31], temp_buffer_7[32]);
+        if((temp_buffer_6[0] !=0x80) && (temp_buffer_2[0] != 0x80)) {
+            rc = -1;
+        }
+        else {
+            rc = 1;
+        }
+}else if(strcmp(panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") == 0){
+
+		count = mode->priv_info->cmd_sets[DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON].count;
+		if (!count) {
+			pr_err("This panel does not read register\n");
+		} else {
+
+			rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		}
+		cmds1 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID1].cmds;
+		if (cmds1->last_command) {
+			cmds1->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds1->msg.rx_buf = buf;
+		cmds1->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds1->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		memcpy(temp_buffer_1, cmds1->msg.rx_buf, 1);
+		count = mode->priv_info->cmd_sets[DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON].count;
+		if (!count) {
+			pr_err("This panel does not read register\n");
+		} else {
+			rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_ON);
+		}
+		cmds2 = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID6].cmds;
+		if (cmds2->last_command) {
+			cmds2->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		cmds2->msg.rx_buf = buf;
+		cmds2->msg.rx_len = 2;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds2->msg, flags);
+		if (rc <= 0)
+			pr_err("rx cmd transfer failed rc=%d\n", rc);
+		memcpy(temp_buffer_6, cmds2->msg.rx_buf, 2);
+		count = mode->priv_info->cmd_sets[DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF].count;
+		if (!count) {
+			pr_err("This panel does not read register\n");
+		} else {
+			rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_READ_SAMSUNG_PANEL_REGISTER_OFF);
+		}
+/*
+		ESD_TEST1=temp_buffer_6[0];
+		ESD_TEST2=temp_buffer_6[1];
+		ESD_TEST3=temp_buffer_1[0];
+*/
+	//	printk(KERN_ERR"Read LCD register 0A = %x\n",temp_buffer_1[0]);
+	//	printk(KERN_ERR"Read LCD register E5 = %x,%x\n",temp_buffer_6[0],temp_buffer_6[1]);
+		if(((temp_buffer_6[0] == 132) && (temp_buffer_6[1] == 0))||(temp_buffer_1[0] != 159))
+			 rc=-1;
+		else
+			rc=1;
+
+
+
+
+}else{
 
 	rc = dsi_display_validate_status(m_ctrl, display->panel);
+
+}
 	if (rc <= 0) {
 		pr_err("[%s] read status failed on master,rc=%d\n",
 		       display->name, rc);
@@ -746,9 +1164,10 @@ static int dsi_display_status_reg_read(struct dsi_display *display)
 exit:
 	dsi_display_cmd_engine_disable(display);
 done:
+
+	//printk(KERN_ERR"GZM dsi_display_status_reg_read---\n");
 	return rc;
 }
-
 static int dsi_display_status_bta_request(struct dsi_display *display)
 {
 	int rc = 0;
@@ -1043,17 +1462,38 @@ static bool dsi_display_get_cont_splash_status(struct dsi_display *display)
 	}
 	return true;
 }
+extern int dsi_panel_set_aod_mode(struct dsi_panel *panel, int level);
 
 int dsi_display_set_power(struct drm_connector *connector,
 		int power_mode, void *disp)
 {
 	struct dsi_display *display = disp;
 	int rc = 0;
+	struct msm_drm_notifier notifier_data;
+	int blank;
 
 	if (!display || !display->panel) {
 		pr_err("invalid display/panel\n");
 		return -EINVAL;
 	}
+	printk(KERN_ERR"power_mode= %d\n",power_mode);
+
+	if (power_mode == 1) 
+		screen_state = 2;//aod 
+	else if (power_mode == 0)
+		screen_state = 1;//on
+	else
+		screen_state = 0;//off
+
+	printk(KERN_INFO"screen_state= %d, screen_last_state : %d \n", screen_state, screen_last_state);
+
+	if (screen_state != screen_last_state) {
+		screen_last_state = screen_state;
+		if (screen_state_enable) {
+			input_event(brightness_input_dev, EV_MSC, MSC_RAW, screen_state);
+			input_sync(brightness_input_dev);
+		}
+	}
 
 	switch (power_mode) {
 	case SDE_MODE_DPMS_LP1:
@@ -1064,8 +1504,34 @@ int dsi_display_set_power(struct drm_connector *connector,
 		break;
 	default:
 		rc = dsi_panel_set_nolp(display->panel);
+	   if ((power_mode == SDE_MODE_DPMS_ON) && display->panel->aod_status){
+		    dsi_panel_set_aod_mode(display->panel, 0);
+		} else if ((power_mode == SDE_MODE_DPMS_OFF)
+		        && display->panel->aod_status){
+            display->panel->aod_status = 0;
+            display->panel->aod_curr_mode = 0;
+		}
 		break;
 	}
+	if (power_mode == SDE_MODE_DPMS_ON) {
+		blank = MSM_DRM_BLANK_UNBLANK_CUST;
+		notifier_data.data = &blank;
+		notifier_data.id = connector_state_crtc_index;
+		msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,
+					    &notifier_data);
+	} else if (power_mode == SDE_MODE_DPMS_LP1) {
+		blank = MSM_DRM_BLANK_NORMAL;
+		notifier_data.data = &blank;
+		notifier_data.id = connector_state_crtc_index;
+		msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,
+					    &notifier_data);
+	} else if (power_mode == SDE_MODE_DPMS_OFF) {
+		blank = MSM_DRM_BLANK_POWERDOWN_CUST;
+		notifier_data.data = &blank;
+		notifier_data.id = connector_state_crtc_index;
+		msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,
+					    &notifier_data);
+	}
 	return rc;
 }
 
@@ -1628,7 +2094,7 @@ static void adjust_timing_by_ctrl_count(const struct dsi_display *display,
 		mode->timing.h_back_porch /= sublinks_count;
 		mode->timing.h_skew /= sublinks_count;
 		mode->pixel_clk_khz /= sublinks_count;
-	} else if (display->ctrl_count > 1) {
+	} else {
 		mode->timing.h_active /= display->ctrl_count;
 		mode->timing.h_front_porch /= display->ctrl_count;
 		mode->timing.h_sync_width /= display->ctrl_count;
@@ -2255,7 +2721,7 @@ static int dsi_display_set_clk_src(struct dsi_display *display)
 	m_ctrl = &display->ctrl[display->clk_master_idx];
 
 	rc = dsi_ctrl_set_clock_source(m_ctrl->ctrl,
-		   &display->clock_info.src_clks);
+		   &display->clock_info.mux_clks);
 	if (rc) {
 		pr_err("[%s] failed to set source clocks for master, rc=%d\n",
 			   display->name, rc);
@@ -2269,7 +2735,7 @@ static int dsi_display_set_clk_src(struct dsi_display *display)
 			continue;
 
 		rc = dsi_ctrl_set_clock_source(ctrl->ctrl,
-			   &display->clock_info.src_clks);
+			   &display->clock_info.mux_clks);
 		if (rc) {
 			pr_err("[%s] failed to set source clocks, rc=%d\n",
 				   display->name, rc);
@@ -2938,6 +3404,7 @@ static int dsi_display_clocks_init(struct dsi_display *display)
 	struct dsi_clk_link_set *src = &display->clock_info.src_clks;
 	struct dsi_clk_link_set *mux = &display->clock_info.mux_clks;
 	struct dsi_clk_link_set *shadow = &display->clock_info.shadow_clks;
+	struct dsi_dyn_clk_caps *dyn_clk_caps = &(display->panel->dyn_clk_caps);
 
 	num_clk = dsi_display_get_clocks_count(display);
 
@@ -2953,7 +3420,34 @@ static int dsi_display_clocks_init(struct dsi_display *display)
 			rc = PTR_ERR(dsi_clk);
 
 			pr_err("failed to get %s, rc=%d\n", clk_name, rc);
-			goto error;
+
+			if (dsi_display_check_prefix(mux_byte, clk_name)) {
+				mux->byte_clk = NULL;
+				goto error;
+			}
+			if (dsi_display_check_prefix(mux_pixel, clk_name)) {
+				mux->pixel_clk = NULL;
+				goto error;
+			}
+
+			if (dyn_clk_caps->dyn_clk_support &&
+				(display->panel->panel_mode ==
+					 DSI_OP_VIDEO_MODE)) {
+				if (dsi_display_check_prefix(src_byte,
+							clk_name))
+					src->byte_clk = NULL;
+				if (dsi_display_check_prefix(src_pixel,
+							clk_name))
+					src->pixel_clk = NULL;
+				if (dsi_display_check_prefix(shadow_byte,
+							clk_name))
+					shadow->byte_clk = NULL;
+				if (dsi_display_check_prefix(shadow_pixel,
+							clk_name))
+					shadow->pixel_clk = NULL;
+
+				dyn_clk_caps->dyn_clk_support = false;
+			}
 		}
 
 		if (dsi_display_check_prefix(src_byte, clk_name)) {
@@ -3746,119 +4240,452 @@ static bool dsi_display_is_seamless_dfps_possible(
 	return true;
 }
 
-static int dsi_display_dfps_update(struct dsi_display *display,
-				   struct dsi_display_mode *dsi_mode)
+static int dsi_display_update_dsi_bitrate(struct dsi_display *display,
+			u32 bit_clk_rate)
 {
-	struct dsi_mode_info *timing;
-	struct dsi_display_ctrl *m_ctrl, *ctrl;
-	struct dsi_display_mode *panel_mode;
-	struct dsi_dfps_capabilities dfps_caps;
 	int rc = 0;
-	int i = 0;
+	int i;
 
-	if (!display || !dsi_mode || !display->panel) {
-		pr_err("Invalid params\n");
-		return -EINVAL;
+	pr_debug("%s:bit rate:%d\n", __func__, bit_clk_rate);
+	if (!display->panel) {
+	pr_err("Invalid params\n");
+	return -EINVAL;
 	}
-	timing = &dsi_mode->timing;
 
-	dsi_panel_get_dfps_caps(display->panel, &dfps_caps);
-	if (!dfps_caps.dfps_support) {
-		pr_err("dfps not supported\n");
-		return -ENOTSUPP;
+	if (bit_clk_rate == 0) {
+	pr_err("Invalid bit clock rate\n");
+	return -EINVAL;
 	}
 
-	if (dfps_caps.type == DSI_DFPS_IMMEDIATE_CLK) {
-		pr_err("dfps clock method not supported\n");
-		return -ENOTSUPP;
+	display->config.bit_clk_rate_hz = bit_clk_rate;
+
+	for (i = 0; i < display->ctrl_count; i++) {
+	struct dsi_display_ctrl *dsi_disp_ctrl = &display->ctrl[i];
+	struct dsi_ctrl *ctrl = dsi_disp_ctrl->ctrl;
+	u32 num_of_lanes = 0, bpp;
+	u64 bit_rate, pclk_rate, bit_rate_per_lane, byte_clk_rate;
+	struct dsi_host_common_cfg *host_cfg;
+
+	mutex_lock(&ctrl->ctrl_lock);
+
+	host_cfg = &display->panel->host_config;
+	if (host_cfg->data_lanes & DSI_DATA_LANE_0)
+		num_of_lanes++;
+	if (host_cfg->data_lanes & DSI_DATA_LANE_1)
+		num_of_lanes++;
+	if (host_cfg->data_lanes & DSI_DATA_LANE_2)
+		num_of_lanes++;
+	if (host_cfg->data_lanes & DSI_DATA_LANE_3)
+		num_of_lanes++;
+
+	if (num_of_lanes == 0) {
+		pr_err("Invalid lane count\n");
+		rc = -EINVAL;
+		goto error;
 	}
 
-	/* For split DSI, update the clock master first */
+	bpp = dsi_pixel_format_to_bpp(host_cfg->dst_format);
 
-	pr_debug("configuring seamless dynamic fps\n\n");
-	SDE_EVT32(SDE_EVTLOG_FUNC_ENTRY);
+	bit_rate = display->config.bit_clk_rate_hz * num_of_lanes;
+	bit_rate_per_lane = bit_rate;
+	do_div(bit_rate_per_lane, num_of_lanes);
+	pclk_rate = bit_rate;
+	do_div(pclk_rate, bpp);
+	byte_clk_rate = bit_rate_per_lane;
+	do_div(byte_clk_rate, 8);
+	pr_debug("bit_clk_rate = %llu, bit_clk_rate_per_lane = %llu\n",
+	bit_rate, bit_rate_per_lane);
+	pr_debug("byte_clk_rate = %llu, pclk_rate = %llu\n",
+	byte_clk_rate, pclk_rate);
 
-	m_ctrl = &display->ctrl[display->clk_master_idx];
-	rc = dsi_ctrl_async_timing_update(m_ctrl->ctrl, timing);
+	ctrl->clk_freq.byte_clk_rate = byte_clk_rate;
+	ctrl->clk_freq.pix_clk_rate = pclk_rate;
+	rc = dsi_clk_set_link_frequencies(display->dsi_clk_handle,
+			ctrl->clk_freq, ctrl->cell_index);
 	if (rc) {
-		pr_err("[%s] failed to dfps update host_%d, rc=%d\n",
-				display->name, i, rc);
+	pr_err("Failed to update link frequencies\n");
 		goto error;
 	}
 
-	/* Update the rest of the controllers */
-	display_for_each_ctrl(i, display) {
-		ctrl = &display->ctrl[i];
-		if (!ctrl->ctrl || (ctrl == m_ctrl))
-			continue;
+	ctrl->host_config.bit_clk_rate_hz = bit_clk_rate;
+error:
+	mutex_unlock(&ctrl->ctrl_lock);
 
-		rc = dsi_ctrl_async_timing_update(ctrl->ctrl, timing);
-		if (rc) {
-			pr_err("[%s] failed to dfps update host_%d, rc=%d\n",
-					display->name, i, rc);
-			goto error;
-		}
+	/* TODO: recover ctrl->clk_freq in case of failure */
+	if (rc)
+	return rc;
 	}
 
-	panel_mode = display->panel->cur_mode;
-	memcpy(panel_mode, dsi_mode, sizeof(*panel_mode));
-	/*
-	 * dsi_mode_flags flags are used to communicate with other drm driver
-	 * components, and are transient. They aren't inherently part of the
-	 * display panel's mode and shouldn't be saved into the cached currently
-	 * active mode.
-	 */
-	panel_mode->dsi_mode_flags = 0;
-
-error:
-	SDE_EVT32(SDE_EVTLOG_FUNC_EXIT);
-	return rc;
+	return 0;
 }
 
-static int dsi_display_dfps_calc_front_porch(
-		u32 old_fps,
-		u32 new_fps,
-		u32 a_total,
-		u32 b_total,
-		u32 b_fp,
-		u32 *b_fp_out)
+static int dsi_display_dynamic_clk_configure_cmd(struct dsi_display *display,
+		int clk_rate)
 {
-	s32 b_fp_new;
-	int add_porches, diff;
+	int rc = 0;
 
-	if (!b_fp_out) {
-		pr_err("Invalid params");
+	if (clk_rate <= 0) {
+		pr_err("%s: bitrate should be greater than 0\n", __func__);
 		return -EINVAL;
 	}
 
-	if (!a_total || !new_fps) {
-		pr_err("Invalid pixel total or new fps in mode request\n");
-		return -EINVAL;
+	if (clk_rate == display->cached_clk_rate) {
+		pr_info("%s: ignore duplicated DSI clk setting\n", __func__);
+		return rc;
 	}
 
-	/*
-	 * Keep clock, other porches constant, use new fps, calc front porch
-	 * new_vtotal = old_vtotal * (old_fps / new_fps )
-	 * new_vfp - old_vfp = new_vtotal - old_vtotal
-	 * new_vfp = old_vfp + old_vtotal * ((old_fps - new_fps)/ new_fps)
-	 */
-	diff = abs(old_fps - new_fps);
-	add_porches = mult_frac(b_total, diff, new_fps);
-
-	if (old_fps > new_fps)
-		b_fp_new = b_fp + add_porches;
-	else
-		b_fp_new = b_fp - add_porches;
-
-	pr_debug("fps %u a %u b %u b_fp %u new_fp %d\n",
-			new_fps, a_total, b_total, b_fp, b_fp_new);
+	display->cached_clk_rate = clk_rate;
 
-	if (b_fp_new < 0) {
-		pr_err("Invalid new_hfp calcluated%d\n", b_fp_new);
-		return -EINVAL;
+	rc = dsi_display_update_dsi_bitrate(display, clk_rate);
+	if (!rc) {
+		pr_info("%s: bit clk is ready to be configured to '%d'\n",
+				__func__, clk_rate);
+		atomic_set(&display->clkrate_change_pending, 1);
+	} else {
+		pr_err("%s: Failed to prepare to configure '%d'. rc = %d\n",
+				__func__, clk_rate, rc);
+		/* Caching clock failed, so don't go on doing so. */
+		atomic_set(&display->clkrate_change_pending, 0);
+		display->cached_clk_rate = 0;
 	}
 
-	/**
+	return rc;
+}
+
+
+static void _dsi_display_calc_pipe_delay(struct dsi_display *display,
+				    struct dsi_dyn_clk_delay *delay,
+				    struct dsi_display_mode *mode)
+{
+	u32 esc_clk_rate_hz;
+	u32 pclk_to_esc_ratio, byte_to_esc_ratio, hr_bit_to_esc_ratio;
+	u32 hsync_period = 0;
+	struct dsi_display_ctrl *m_ctrl;
+	struct dsi_ctrl *dsi_ctrl;
+	struct dsi_phy_cfg *cfg;
+
+	m_ctrl = &display->ctrl[display->clk_master_idx];
+	dsi_ctrl = m_ctrl->ctrl;
+
+	cfg = &(m_ctrl->phy->cfg);
+
+	esc_clk_rate_hz = dsi_ctrl->clk_freq.esc_clk_rate * 1000;
+	pclk_to_esc_ratio = ((dsi_ctrl->clk_freq.pix_clk_rate * 1000) /
+			     esc_clk_rate_hz);
+	byte_to_esc_ratio = ((dsi_ctrl->clk_freq.byte_clk_rate * 1000) /
+			     esc_clk_rate_hz);
+	hr_bit_to_esc_ratio = ((dsi_ctrl->clk_freq.byte_clk_rate * 4 * 1000) /
+					esc_clk_rate_hz);
+
+	hsync_period = DSI_H_TOTAL_DSC(&mode->timing);
+	delay->pipe_delay = (hsync_period + 1) / pclk_to_esc_ratio;
+	if (!display->panel->video_config.eof_bllp_lp11_en)
+		delay->pipe_delay += (17 / pclk_to_esc_ratio) +
+			((21 + (display->config.common_config.t_clk_pre + 1) +
+			  (display->config.common_config.t_clk_post + 1)) /
+			 byte_to_esc_ratio) +
+			((((cfg->timing.lane_v3[8] >> 1) + 1) +
+			((cfg->timing.lane_v3[6] >> 1) + 1) +
+			((cfg->timing.lane_v3[3] * 4) +
+			 (cfg->timing.lane_v3[5] >> 1) + 1) +
+			((cfg->timing.lane_v3[7] >> 1) + 1) +
+			((cfg->timing.lane_v3[1] >> 1) + 1) +
+			((cfg->timing.lane_v3[4] >> 1) + 1)) /
+			 hr_bit_to_esc_ratio);
+
+	delay->pipe_delay2 = 0;
+	if (display->panel->host_config.force_hs_clk_lane)
+		delay->pipe_delay2 = (6 / byte_to_esc_ratio) +
+			((((cfg->timing.lane_v3[1] >> 1) + 1) +
+			  ((cfg->timing.lane_v3[4] >> 1) + 1)) /
+			 hr_bit_to_esc_ratio);
+
+	/* 130 us pll delay recommended by h/w doc */
+	delay->pll_delay = ((130 * esc_clk_rate_hz) / 1000000) * 2;
+}
+
+static int _dsi_display_dyn_update_clks(struct dsi_display *display,
+					struct link_clk_freq *bkp_freq)
+{
+	int rc = 0, i;
+	struct dsi_display_ctrl *m_ctrl, *ctrl;
+
+	m_ctrl = &display->ctrl[display->clk_master_idx];
+
+	dsi_clk_prepare_enable(&display->clock_info.src_clks);
+
+	rc = dsi_clk_update_parent(&display->clock_info.shadow_clks,
+			      &display->clock_info.mux_clks);
+	if (rc) {
+		pr_err("failed update mux parent to shadow\n");
+		goto exit;
+	}
+
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		if (!ctrl->ctrl)
+			continue;
+		rc = dsi_clk_set_byte_clk_rate(display->dsi_clk_handle,
+				   ctrl->ctrl->clk_freq.byte_clk_rate, i);
+		if (rc) {
+			pr_err("failed to set byte rate for index:%d\n", i);
+			goto recover_byte_clk;
+		}
+		rc = dsi_clk_set_pixel_clk_rate(display->dsi_clk_handle,
+				   ctrl->ctrl->clk_freq.pix_clk_rate, i);
+		if (rc) {
+			pr_err("failed to set pix rate for index:%d\n", i);
+			goto recover_pix_clk;
+		}
+	}
+
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		if (ctrl == m_ctrl)
+			continue;
+		dsi_phy_dynamic_refresh_trigger(ctrl->phy, false);
+	}
+	dsi_phy_dynamic_refresh_trigger(m_ctrl->phy, true);
+
+	/* wait for dynamic refresh done */
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		rc = dsi_ctrl_wait4dynamic_refresh_done(ctrl->ctrl);
+		if (rc) {
+			pr_err("wait4dynamic refresh failed for dsi:%d\n", i);
+			goto recover_pix_clk;
+		} else {
+			pr_info("dynamic refresh done on dsi: %s\n",
+				i ? "slave" : "master");
+		}
+	}
+
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		dsi_phy_dynamic_refresh_clear(ctrl->phy);
+	}
+
+	rc = dsi_clk_update_parent(&display->clock_info.src_clks,
+			      &display->clock_info.mux_clks);
+	if (rc)
+		pr_err("could not switch back to src clks %d\n", rc);
+
+	dsi_clk_disable_unprepare(&display->clock_info.src_clks);
+
+	return rc;
+
+recover_pix_clk:
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		if (!ctrl->ctrl)
+			continue;
+		dsi_clk_set_pixel_clk_rate(display->dsi_clk_handle,
+					   bkp_freq->pix_clk_rate, i);
+	}
+
+recover_byte_clk:
+	for (i = 0; (i < display->ctrl_count) &&
+	     (i < MAX_DSI_CTRLS_PER_DISPLAY); i++) {
+		ctrl = &display->ctrl[i];
+		if (!ctrl->ctrl)
+			continue;
+		dsi_clk_set_byte_clk_rate(display->dsi_clk_handle,
+					  bkp_freq->byte_clk_rate, i);
+	}
+
+exit:
+	dsi_clk_disable_unprepare(&display->clock_info.src_clks);
+
+	return rc;
+}
+
+static int dsi_display_dynamic_clk_switch_vid(struct dsi_display *display,
+					  struct dsi_display_mode *mode)
+{
+	int rc = 0, mask, i;
+	struct dsi_display_ctrl *m_ctrl, *ctrl;
+	struct dsi_dyn_clk_delay delay;
+	struct link_clk_freq bkp_freq;
+
+	dsi_panel_acquire_panel_lock(display->panel);
+
+	m_ctrl = &display->ctrl[display->clk_master_idx];
+
+	dsi_display_clk_ctrl(display->dsi_clk_handle, DSI_ALL_CLKS, DSI_CLK_ON);
+
+	/* mask PLL unlock, FIFO overflow and underflow errors */
+	mask = BIT(DSI_PLL_UNLOCK_ERR) | BIT(DSI_FIFO_UNDERFLOW) |
+		BIT(DSI_FIFO_OVERFLOW);
+	dsi_display_mask_ctrl_error_interrupts(display, mask, true);
+
+	/* update the phy timings based on new mode */
+	for (i = 0; i < display->ctrl_count; i++) {
+		ctrl = &display->ctrl[i];
+		dsi_phy_update_phy_timings(ctrl->phy, &display->config);
+	}
+
+	/* back up existing rates to handle failure case */
+	bkp_freq.byte_clk_rate = m_ctrl->ctrl->clk_freq.byte_clk_rate;
+	bkp_freq.pix_clk_rate = m_ctrl->ctrl->clk_freq.pix_clk_rate;
+	bkp_freq.esc_clk_rate = m_ctrl->ctrl->clk_freq.esc_clk_rate;
+
+	rc = dsi_display_update_dsi_bitrate(display, mode->timing.clk_rate_hz);
+	if (rc) {
+		pr_err("failed set link frequencies %d\n", rc);
+		goto exit;
+	}
+
+	/* calculate pipe delays */
+	_dsi_display_calc_pipe_delay(display, &delay, mode);
+
+	/* configure dynamic refresh ctrl registers */
+	for (i = 0; i < display->ctrl_count; i++) {
+		ctrl = &display->ctrl[i];
+		if (!ctrl->phy)
+			continue;
+		if (ctrl == m_ctrl)
+			dsi_phy_config_dynamic_refresh(ctrl->phy, &delay, true);
+		else
+			dsi_phy_config_dynamic_refresh(ctrl->phy, &delay,
+						       false);
+	}
+
+	rc = _dsi_display_dyn_update_clks(display, &bkp_freq);
+
+exit:
+	dsi_display_mask_ctrl_error_interrupts(display, mask, false);
+
+	dsi_display_clk_ctrl(display->dsi_clk_handle, DSI_ALL_CLKS,
+			     DSI_CLK_OFF);
+
+	/* store newly calculated phy timings in mode private info */
+	dsi_phy_dyn_refresh_cache_phy_timings(m_ctrl->phy,
+					      mode->priv_info->phy_timing_val,
+					      mode->priv_info->phy_timing_len);
+
+	dsi_panel_release_panel_lock(display->panel);
+
+	return rc;
+}
+
+static int dsi_display_dfps_update(struct dsi_display *display,
+				   struct dsi_display_mode *dsi_mode)
+{
+	struct dsi_mode_info *timing;
+	struct dsi_display_ctrl *m_ctrl, *ctrl;
+	struct dsi_display_mode *panel_mode;
+	struct dsi_dfps_capabilities dfps_caps;
+	int rc = 0;
+	int i = 0;
+
+	if (!display || !dsi_mode || !display->panel) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+	timing = &dsi_mode->timing;
+
+	dsi_panel_get_dfps_caps(display->panel, &dfps_caps);
+	if (!dfps_caps.dfps_support) {
+		pr_err("dfps not supported\n");
+		return -ENOTSUPP;
+	}
+
+	if (dfps_caps.type == DSI_DFPS_IMMEDIATE_CLK) {
+		pr_err("dfps clock method not supported\n");
+		return -ENOTSUPP;
+	}
+
+	/* For split DSI, update the clock master first */
+
+	pr_debug("configuring seamless dynamic fps\n\n");
+	SDE_EVT32(SDE_EVTLOG_FUNC_ENTRY);
+
+	m_ctrl = &display->ctrl[display->clk_master_idx];
+	rc = dsi_ctrl_async_timing_update(m_ctrl->ctrl, timing);
+	if (rc) {
+		pr_err("[%s] failed to dfps update host_%d, rc=%d\n",
+				display->name, i, rc);
+		goto error;
+	}
+
+	/* Update the rest of the controllers */
+	display_for_each_ctrl(i, display) {
+		ctrl = &display->ctrl[i];
+		if (!ctrl->ctrl || (ctrl == m_ctrl))
+			continue;
+
+		rc = dsi_ctrl_async_timing_update(ctrl->ctrl, timing);
+		if (rc) {
+			pr_err("[%s] failed to dfps update host_%d, rc=%d\n",
+					display->name, i, rc);
+			goto error;
+		}
+	}
+
+	panel_mode = display->panel->cur_mode;
+	memcpy(panel_mode, dsi_mode, sizeof(*panel_mode));
+	/*
+	 * dsi_mode_flags flags are used to communicate with other drm driver
+	 * components, and are transient. They aren't inherently part of the
+	 * display panel's mode and shouldn't be saved into the cached currently
+	 * active mode.
+	 */
+	panel_mode->dsi_mode_flags = 0;
+
+error:
+	SDE_EVT32(SDE_EVTLOG_FUNC_EXIT);
+	return rc;
+}
+
+static int dsi_display_dfps_calc_front_porch(
+		u32 old_fps,
+		u32 new_fps,
+		u32 a_total,
+		u32 b_total,
+		u32 b_fp,
+		u32 *b_fp_out)
+{
+	s32 b_fp_new;
+	int add_porches, diff;
+
+	if (!b_fp_out) {
+		pr_err("Invalid params");
+		return -EINVAL;
+	}
+
+	if (!a_total || !new_fps) {
+		pr_err("Invalid pixel total or new fps in mode request\n");
+		return -EINVAL;
+	}
+
+	/*
+	 * Keep clock, other porches constant, use new fps, calc front porch
+	 * new_vtotal = old_vtotal * (old_fps / new_fps )
+	 * new_vfp - old_vfp = new_vtotal - old_vtotal
+	 * new_vfp = old_vfp + old_vtotal * ((old_fps - new_fps)/ new_fps)
+	 */
+	diff = abs(old_fps - new_fps);
+	add_porches = mult_frac(b_total, diff, new_fps);
+
+	if (old_fps > new_fps)
+		b_fp_new = b_fp + add_porches;
+	else
+		b_fp_new = b_fp - add_porches;
+
+	pr_debug("fps %u a %u b %u b_fp %u new_fp %d\n",
+			new_fps, a_total, b_total, b_fp, b_fp_new);
+
+	if (b_fp_new < 0) {
+		pr_err("Invalid new_hfp calcluated%d\n", b_fp_new);
+		return -EINVAL;
+	}
+
+	/**
 	 * TODO: To differentiate from clock method when communicating to the
 	 * other components, perhaps we should set clk here to original value
 	 */
@@ -3897,7 +4724,7 @@ static int dsi_display_get_dfps_timing(struct dsi_display *display,
 
 	dsi_panel_get_dfps_caps(display->panel, &dfps_caps);
 	if (!dfps_caps.dfps_support) {
-		pr_err("dfps not supported by panel\n");
+		//pr_err("dfps not supported by panel\n");
 		return -EINVAL;
 	}
 
@@ -3979,7 +4806,7 @@ static int dsi_display_set_mode_sub(struct dsi_display *display,
 				    struct dsi_display_mode *mode,
 				    u32 flags)
 {
-	int rc = 0;
+	int rc = 0, clk_rate = 0;
 	int i;
 	struct dsi_display_ctrl *ctrl;
 	struct dsi_display_mode_priv_info *priv_info;
@@ -4011,6 +4838,26 @@ static int dsi_display_set_mode_sub(struct dsi_display *display,
 					display->name, rc);
 			goto error;
 		}
+	} else if (mode->dsi_mode_flags & DSI_MODE_FLAG_DYN_CLK) {
+		if (display->panel->panel_mode == DSI_OP_VIDEO_MODE) {
+			rc = dsi_display_dynamic_clk_switch_vid(display, mode);
+			if (rc)
+			pr_err("dynamic clk change failed %d\n", rc);
+		/*
+		 * skip rest of the opearations since
+		 * dsi_display_dynamic_clk_switch_vid() already takes
+		 * care of them.
+		 */
+			return rc;
+		} else if (display->panel->panel_mode == DSI_OP_CMD_MODE) {
+			clk_rate = mode->timing.clk_rate_hz;
+			rc = dsi_display_dynamic_clk_configure_cmd(display,
+				clk_rate);
+		if (rc) {
+			pr_err("Failed to configure dynamic clk\n");
+			return rc;
+		}
+		}
 	}
 
 	display_for_each_ctrl(i, display) {
@@ -4236,6 +5083,43 @@ int dsi_display_splash_res_cleanup(struct  dsi_display *display)
 	return rc;
 }
 
+static int dsi_display_link_clk_force_update_ctrl(void *handle)
+{
+	int rc = 0;
+
+	if (!handle) {
+		pr_err("%s: Invalid arg\n", __func__);
+		return -EINVAL;
+	}
+
+	mutex_lock(&dsi_display_clk_mutex);
+
+	rc = dsi_display_link_clk_force_update(handle);
+
+	mutex_unlock(&dsi_display_clk_mutex);
+
+	return rc;
+}
+
+int dsi_display_clk_ctrl(void *handle,
+	enum dsi_clk_type clk_type, enum dsi_clk_state clk_state)
+{
+	int rc = 0;
+
+	if (!handle) {
+		pr_err("%s: Invalid arg\n", __func__);
+		return -EINVAL;
+	}
+
+	mutex_lock(&dsi_display_clk_mutex);
+	rc = dsi_clk_req_state(handle, clk_type, clk_state);
+	if (rc)
+		pr_err("%s: failed set clk state, rc = %d\n", __func__, rc);
+	mutex_unlock(&dsi_display_clk_mutex);
+
+	return rc;
+}
+
 static int dsi_display_force_update_dsi_clk(struct dsi_display *display)
 {
 	int rc = 0;
@@ -4254,93 +5138,13 @@ static int dsi_display_force_update_dsi_clk(struct dsi_display *display)
 
 	return rc;
 }
-
-static int dsi_display_request_update_dsi_bitrate(struct dsi_display *display,
-					u32 bit_clk_rate)
+static ssize_t sysfs_dynamic_dsi_clk_read(struct device *dev,
+	struct device_attribute *attr, char *buf)
 {
 	int rc = 0;
-	int i;
-
-	pr_debug("%s:bit rate:%d\n", __func__, bit_clk_rate);
-	if (!display->panel) {
-		pr_err("Invalid params\n");
-		return -EINVAL;
-	}
-
-	if (bit_clk_rate == 0) {
-		pr_err("Invalid bit clock rate\n");
-		return -EINVAL;
-	}
-
-	display->config.bit_clk_rate_hz_override = bit_clk_rate;
-
-	display_for_each_ctrl(i, display) {
-		struct dsi_display_ctrl *dsi_disp_ctrl = &display->ctrl[i];
-		struct dsi_ctrl *ctrl = dsi_disp_ctrl->ctrl;
-		u32 num_of_lanes = 0;
-		u32 bpp = 3;
-		u64 bit_rate, pclk_rate, bit_rate_per_lane, byte_clk_rate;
-		struct dsi_host_common_cfg *host_cfg;
-
-		mutex_lock(&ctrl->ctrl_lock);
-
-		host_cfg = &display->panel->host_config;
-		if (host_cfg->data_lanes & DSI_DATA_LANE_0)
-			num_of_lanes++;
-		if (host_cfg->data_lanes & DSI_DATA_LANE_1)
-			num_of_lanes++;
-		if (host_cfg->data_lanes & DSI_DATA_LANE_2)
-			num_of_lanes++;
-		if (host_cfg->data_lanes & DSI_DATA_LANE_3)
-			num_of_lanes++;
-
-		if (num_of_lanes == 0) {
-			pr_err("Invalid lane count\n");
-			rc = -EINVAL;
-			goto error;
-		}
-
-		bit_rate = display->config.bit_clk_rate_hz_override *
-						num_of_lanes;
-		bit_rate_per_lane = bit_rate;
-		do_div(bit_rate_per_lane, num_of_lanes);
-		pclk_rate = bit_rate;
-		do_div(pclk_rate, (8 * bpp));
-		byte_clk_rate = bit_rate_per_lane;
-		do_div(byte_clk_rate, 8);
-		pr_debug("bit_clk_rate = %llu, bit_clk_rate_per_lane = %llu\n",
-			 bit_rate, bit_rate_per_lane);
-		pr_debug("byte_clk_rate = %llu, pclk_rate = %llu\n",
-			  byte_clk_rate, pclk_rate);
-
-		ctrl->clk_freq.byte_clk_rate = byte_clk_rate;
-		ctrl->clk_freq.pix_clk_rate = pclk_rate;
-		rc = dsi_clk_set_link_frequencies(display->dsi_clk_handle,
-			ctrl->clk_freq, ctrl->cell_index);
-		if (rc) {
-			pr_err("Failed to update link frequencies\n");
-			goto error;
-		}
-
-		ctrl->host_config.bit_clk_rate_hz_override = bit_clk_rate;
-error:
-		mutex_unlock(&ctrl->ctrl_lock);
-
-		/* TODO: recover ctrl->clk_freq in case of failure */
-		if (rc)
-			return rc;
-	}
-
-	return 0;
-}
-
-static ssize_t sysfs_dynamic_dsi_clk_read(struct device *dev,
-	struct device_attribute *attr, char *buf)
-{
-	int rc = 0;
-	struct dsi_display *display;
-	struct dsi_display_ctrl *m_ctrl;
-	struct dsi_ctrl *ctrl;
+	struct dsi_display *display;
+	struct dsi_display_ctrl *m_ctrl;
+	struct dsi_ctrl *ctrl;
 
 	display = dev_get_drvdata(dev);
 	if (!display) {
@@ -4368,7 +5172,7 @@ static ssize_t sysfs_dynamic_dsi_clk_read(struct device *dev,
 static ssize_t sysfs_dynamic_dsi_clk_write(struct device *dev,
 	struct device_attribute *attr, const char *buf, size_t count)
 {
-	int rc = 0;
+	int rc = count;
 	int clk_rate;
 	struct dsi_display *display;
 
@@ -4384,44 +5188,29 @@ static ssize_t sysfs_dynamic_dsi_clk_write(struct device *dev,
 		return rc;
 	}
 
-	if (clk_rate <= 0) {
-		pr_err("%s: bitrate should be greater than 0\n", __func__);
-		return -EINVAL;
-	}
-
-	if (clk_rate == display->cached_clk_rate) {
-		pr_info("%s: ignore duplicated DSI clk setting\n", __func__);
-		return count;
+	if (display->panel->panel_mode != DSI_OP_CMD_MODE) {
+		pr_err("only supported for command mode\n");
+		return -ENOTSUPP;
 	}
 
 	pr_info("%s: bitrate param value: '%d'\n", __func__, clk_rate);
 
 	mutex_lock(&display->display_lock);
+	mutex_lock(&dsi_display_clk_mutex);
 
-	display->cached_clk_rate = clk_rate;
-	rc = dsi_display_request_update_dsi_bitrate(display, clk_rate);
-	if (!rc) {
-		pr_info("%s: bit clk is ready to be configured to '%d'\n",
-			__func__, clk_rate);
-	} else {
-		pr_err("%s: Failed to prepare to configure '%d'. rc = %d\n",
-			__func__, clk_rate, rc);
-		/*Caching clock failed, so don't go on doing so.*/
-		atomic_set(&display->clkrate_change_pending, 0);
-		display->cached_clk_rate = 0;
-
-		mutex_unlock(&display->display_lock);
-
-		return rc;
-	}
-	atomic_set(&display->clkrate_change_pending, 1);
+	rc = dsi_display_dynamic_clk_configure_cmd(display, clk_rate);
+	if (rc)
+		pr_err("Failed to configure dynamic clk\n");
 
+	mutex_unlock(&dsi_display_clk_mutex);
 	mutex_unlock(&display->display_lock);
 
+//	return rc;
 	return count;
 
 }
 
+
 static DEVICE_ATTR(dynamic_dsi_clock, 0644,
 			sysfs_dynamic_dsi_clk_read,
 			sysfs_dynamic_dsi_clk_write);
@@ -4495,6 +5284,75 @@ static int dsi_display_sysfs_deinit(struct dsi_display *display)
 
 }
 
+static ssize_t bitghtness_event_num_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    const char *devname = NULL;
+    struct input_handle *handle;
+    
+
+    if (!brightness_input_dev)
+        return count;
+    list_for_each_entry(handle, &(brightness_input_dev->h_list), d_node) {
+        if (strncmp(handle->name, "event", 5) == 0) {
+            devname = handle->name;
+            break;
+        }
+    } 
+
+    ret = simple_read_from_buffer(user_buf, count, ppos, devname, strlen(devname));
+    return ret;
+}
+
+static const struct file_operations bitghtness_event_num_fops = {
+    .read  = bitghtness_event_num_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t screen_state_enable_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{	
+	ssize_t ret =0;
+	char page[4];
+
+	pr_info("the screen_state_enable is: %d\n", screen_state_enable);
+	ret = sprintf(page, "%d\n", screen_state_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+
+}
+
+static ssize_t screen_state_enable_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	char buf[8]={0};
+
+	if( count > 2)
+		count = 2;
+	if(copy_from_user(buf, buffer, count)){
+		pr_err("%s: read proc input error.\n", __func__);
+		return count;
+	}	
+	if('0' == buf[0]) {
+		screen_state_enable = 0;
+	} else if('1' == buf[0]){
+		screen_state_enable = 1;
+	}
+
+	//if (!screen_state_enable) {
+	//	//notify to epoll thread
+	//	input_event(brightness_input_dev, EV_MSC, MSC_RAW, 2);
+	//	input_sync(brightness_input_dev);
+	//}
+	return count;
+}
+
+static const struct file_operations screen_state_enable_fops = {
+    .read  = screen_state_enable_read,
+	.write = screen_state_enable_write,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
 /**
  * dsi_display_bind - bind dsi device with controlling device
  * @dev:        Pointer to base of platform device
@@ -4848,6 +5706,12 @@ int dsi_display_dev_probe(struct platform_device *pdev)
 	int i, count, rc = 0, index;
 	bool firm_req = false;
 	struct dsi_display_boot_param *boot_disp;
+	struct proc_dir_entry *prEntry_tmp  = NULL;
+
+	prEntry_tp = proc_mkdir("sensor", NULL);
+	if( prEntry_tp == NULL ){
+		pr_err("Couldn't create sensor directory\n");
+	}
 
 	if (!pdev || !pdev->dev.of_node) {
 		pr_err("pdev not found\n");
@@ -4937,6 +5801,36 @@ int dsi_display_dev_probe(struct platform_device *pdev)
 			goto end;
 	}
 
+	//create brightness_event_num
+	prEntry_tmp = proc_create("brightness_event_num", 0664, prEntry_tp, &bitghtness_event_num_fops);
+	if (prEntry_tmp == NULL) {
+		pr_err("Couldn't create tp_event_num_fops\n");
+		return 0;
+	}
+	//create screen_state_enable
+	prEntry_tmp = proc_create("screen_state_enable", 0666, prEntry_tp, &screen_state_enable_fops);
+	if (prEntry_tmp == NULL) {
+		pr_err("Couldn't create screen_state_enable_fops\n");
+		return 0;
+	}
+
+	//create input event	
+	brightness_input_dev  = input_allocate_device();
+	if (brightness_input_dev == NULL) {
+		pr_err("Failed to allocate ps input device\n");
+		return 0;
+    }
+    brightness_input_dev->name = "oneplus,brightness";
+
+	set_bit(EV_MSC,  brightness_input_dev->evbit);
+	set_bit(MSC_RAW, brightness_input_dev->mscbit);
+
+	if (input_register_device(brightness_input_dev)) {
+		pr_err("%s: Failed to register brightness input device\n", __func__);
+		input_free_device(brightness_input_dev);
+		return 0;
+	}
+
 	return 0;
 end:
 	if (display)
@@ -4955,6 +5849,10 @@ int dsi_display_dev_remove(struct platform_device *pdev)
 		return -EINVAL;
 	}
 
+	printk(KERN_ERR"unregister_device brightness_input_dev...\n");
+	input_unregister_device(brightness_input_dev);
+	input_free_device(brightness_input_dev);
+
 	display = platform_get_drvdata(pdev);
 
 	/* decrement ref count */
@@ -5554,7 +6452,8 @@ static int dsi_display_get_mode_count_no_lock(struct dsi_display *display,
 			u32 *count)
 {
 	struct dsi_dfps_capabilities dfps_caps;
-	int num_dfps_rates, rc = 0;
+	struct dsi_dyn_clk_caps *dyn_clk_caps;
+	int num_dfps_rates, num_bit_clks, rc = 0;
 
 	if (!display || !display->panel) {
 		pr_err("invalid display:%d panel:%d\n", display != NULL,
@@ -5571,12 +6470,16 @@ static int dsi_display_get_mode_count_no_lock(struct dsi_display *display,
 		return rc;
 	}
 
-	num_dfps_rates = !dfps_caps.dfps_support ? 1 :
-			dfps_caps.max_refresh_rate -
-			dfps_caps.min_refresh_rate + 1;
+	num_dfps_rates = !dfps_caps.dfps_support ? 1 : dfps_caps.dfps_list_len;
+
+	dyn_clk_caps = &(display->panel->dyn_clk_caps);
 
-	/* Inflate num_of_modes by fps in dfps */
-	*count = display->panel->num_timing_nodes * num_dfps_rates;
+	num_bit_clks = !dyn_clk_caps->dyn_clk_support ? 1 :
+					dyn_clk_caps->bit_clk_list_len;
+
+	/* Inflate num_of_modes by fps and bit clks in dfps */
+	*count = display->panel->num_timing_nodes *
+				num_dfps_rates * num_bit_clks;
 
 	return 0;
 }
@@ -5599,6 +6502,73 @@ int dsi_display_get_mode_count(struct dsi_display *display,
 	return 0;
 }
 
+static void _dsi_display_populate_bit_clks(struct dsi_display *display,
+					   int start, int end, u32 *mode_idx)
+{
+	struct dsi_dyn_clk_caps *dyn_clk_caps;
+	struct dsi_display_mode *src, *dst;
+	struct dsi_host_common_cfg *cfg;
+	int i, j, total_modes, bpp, lanes = 0;
+
+	if (!display || !mode_idx)
+		return;
+
+	dyn_clk_caps = &(display->panel->dyn_clk_caps);
+	if (!dyn_clk_caps->dyn_clk_support)
+		return;
+
+	cfg = &(display->panel->host_config);
+	bpp = dsi_pixel_format_to_bpp(cfg->dst_format);
+
+	if (cfg->data_lanes & DSI_DATA_LANE_0)
+		lanes++;
+	if (cfg->data_lanes & DSI_DATA_LANE_1)
+		lanes++;
+	if (cfg->data_lanes & DSI_DATA_LANE_2)
+		lanes++;
+	if (cfg->data_lanes & DSI_DATA_LANE_3)
+		lanes++;
+
+	dsi_display_get_mode_count_no_lock(display, &total_modes);
+
+	for (i = start; i < end; i++) {
+		src = &display->modes[i];
+		if (!src)
+			return;
+		/*
+		 * TODO: currently setting the first bit rate in
+		 * the list as preferred rate. But ideally should
+		 * be based on user or device tree preferrence.
+		 */
+		src->timing.clk_rate_hz = dyn_clk_caps->bit_clk_list[0];
+		src->pixel_clk_khz =
+			div_u64(src->timing.clk_rate_hz * lanes, bpp);
+		src->pixel_clk_khz /= 1000;
+		src->pixel_clk_khz *= display->ctrl_count;
+	}
+
+	for (i = 1; i < dyn_clk_caps->bit_clk_list_len; i++) {
+		if (*mode_idx >= total_modes)
+			return;
+		for (j = start; j < end; j++) {
+			src = &display->modes[j];
+			dst = &display->modes[*mode_idx];
+
+			if (!src || !dst) {
+				pr_err("invalid mode index\n");
+				return;
+			}
+			memcpy(dst, src, sizeof(struct dsi_display_mode));
+			dst->timing.clk_rate_hz = dyn_clk_caps->bit_clk_list[i];
+			dst->pixel_clk_khz =
+				div_u64(dst->timing.clk_rate_hz * lanes, bpp);
+			dst->pixel_clk_khz /= 1000;
+			dst->pixel_clk_khz *= display->ctrl_count;
+			(*mode_idx)++;
+		}
+	}
+}
+
 void dsi_display_put_mode(struct dsi_display *display,
 	struct dsi_display_mode *mode)
 {
@@ -5613,7 +6583,8 @@ int dsi_display_get_modes(struct dsi_display *display,
 	bool is_split_link;
 	u32 num_dfps_rates, panel_mode_count, total_mode_count;
 	u32 sublinks_count, mode_idx, array_idx = 0;
-	int i, rc = -EINVAL;
+	struct dsi_dyn_clk_caps *dyn_clk_caps;
+	int i, start, end, rc = -EINVAL;
 
 	if (!display || !out_modes) {
 		pr_err("Invalid params\n");
@@ -5622,6 +6593,8 @@ int dsi_display_get_modes(struct dsi_display *display,
 
 	*out_modes = NULL;
 
+	pr_err("%s start\n", __func__);
+
 	mutex_lock(&display->display_lock);
 
 	if (display->modes)
@@ -5645,10 +6618,12 @@ int dsi_display_get_modes(struct dsi_display *display,
 		goto error;
 	}
 
-	num_dfps_rates = !dfps_caps.dfps_support ? 1 :
-			dfps_caps.max_refresh_rate -
-			dfps_caps.min_refresh_rate + 1;
+	dyn_clk_caps = &(display->panel->dyn_clk_caps);
+
+//	num_dfps_rates = !dfps_caps.dfps_support ? 1 : dfps_caps.dfps_list_len;
+	dyn_clk_caps = &(display->panel->dyn_clk_caps);
 
+	num_dfps_rates = !dfps_caps.dfps_support ? 1 : dfps_caps.dfps_list_len;
 	panel_mode_count = display->panel->num_timing_nodes;
 
 	for (mode_idx = 0; mode_idx < panel_mode_count; mode_idx++) {
@@ -5677,7 +6652,7 @@ int dsi_display_get_modes(struct dsi_display *display,
 			panel_mode.timing.h_back_porch *= sublinks_count;
 			panel_mode.timing.h_skew *= sublinks_count;
 			panel_mode.pixel_clk_khz *= sublinks_count;
-		} else if (display->ctrl_count > 1) {
+		} else {
 			panel_mode.timing.h_active *= display->ctrl_count;
 			panel_mode.timing.h_front_porch *= display->ctrl_count;
 			panel_mode.timing.h_sync_width *= display->ctrl_count;
@@ -5686,6 +6661,8 @@ int dsi_display_get_modes(struct dsi_display *display,
 			panel_mode.pixel_clk_khz *= display->ctrl_count;
 		}
 
+		start = array_idx;
+
 		for (i = 0; i < num_dfps_rates; i++) {
 			struct dsi_display_mode *sub_mode =
 					&display->modes[array_idx];
@@ -5698,28 +6675,28 @@ int dsi_display_get_modes(struct dsi_display *display,
 			}
 
 			memcpy(sub_mode, &panel_mode, sizeof(panel_mode));
+			array_idx++;
 
-			if (dfps_caps.dfps_support) {
-				curr_refresh_rate =
-					sub_mode->timing.refresh_rate;
-				sub_mode->timing.refresh_rate =
-					dfps_caps.min_refresh_rate +
-					(i % num_dfps_rates);
+			if (!dfps_caps.dfps_support)
+				continue;
 
-				dsi_display_get_dfps_timing(display,
-					sub_mode, curr_refresh_rate);
+			curr_refresh_rate = sub_mode->timing.refresh_rate;
+			sub_mode->timing.refresh_rate = dfps_caps.dfps_list[i];
 
-				sub_mode->pixel_clk_khz =
-					(DSI_H_TOTAL_DSC(&sub_mode->timing) *
-					DSI_V_TOTAL(&sub_mode->timing) *
-					sub_mode->timing.refresh_rate) / 1000;
-			}
-			array_idx++;
+			dsi_display_get_dfps_timing(display, sub_mode,
+					curr_refresh_rate);
 		}
+		end = array_idx;
+		/*
+		 * if dynamic clk switch is supported then update all the bit
+		 * clk rates.
+		 */
+		_dsi_display_populate_bit_clks(display, start, end, &array_idx);
 	}
 
 exit:
 	*out_modes = display->modes;
+	primary_display = display;
 	rc = 0;
 
 error:
@@ -5727,6 +6704,8 @@ int dsi_display_get_modes(struct dsi_display *display,
 		kfree(display->modes);
 
 	mutex_unlock(&display->display_lock);
+
+	pr_err("%s end\n", __func__);
 	return rc;
 }
 
@@ -5812,7 +6791,8 @@ int dsi_display_find_mode(struct dsi_display *display,
 
 		if (cmp->timing.v_active == m->timing.v_active &&
 			cmp->timing.h_active == m->timing.h_active &&
-			cmp->timing.refresh_rate == m->timing.refresh_rate) {
+			cmp->timing.refresh_rate == m->timing.refresh_rate &&
+			cmp->pixel_clk_khz == m->pixel_clk_khz) {
 			*out_mode = m;
 			rc = 0;
 			break;
@@ -5821,9 +6801,10 @@ int dsi_display_find_mode(struct dsi_display *display,
 	mutex_unlock(&display->display_lock);
 
 	if (!*out_mode) {
-		pr_err("[%s] failed to find mode for v_active %u h_active %u rate %u\n",
+		pr_err("[%s] failed to find mode for v_active %u h_active %u fps %u pclk %u\n",
 				display->name, cmp->timing.v_active,
-				cmp->timing.h_active, cmp->timing.refresh_rate);
+				cmp->timing.h_active, cmp->timing.refresh_rate,
+				cmp->pixel_clk_khz);
 		rc = -ENOENT;
 	}
 
@@ -5831,7 +6812,7 @@ int dsi_display_find_mode(struct dsi_display *display,
 }
 
 /**
- * dsi_display_validate_mode_vrr() - Validate if varaible refresh case.
+ * dsi_display_validate_mode_change() - Validate if varaible refresh case.
  * @display:     DSI display handle.
  * @cur_dsi_mode:   Current DSI mode.
  * @mode:        Mode value structure to be validated.
@@ -5839,16 +6820,20 @@ int dsi_display_find_mode(struct dsi_display *display,
  *               is change in fps but vactive and hactive are same.
  * Return: error code.
  */
-int dsi_display_validate_mode_vrr(struct dsi_display *display,
-			struct dsi_display_mode *cur_dsi_mode,
-			struct dsi_display_mode *mode)
+u32 mode_fps = 90;
+EXPORT_SYMBOL(mode_fps);
+int dsi_display_validate_mode_change(struct dsi_display *display,
+			struct dsi_display_mode *cur_mode,
+			struct dsi_display_mode *adj_mode)
 {
 	int rc = 0;
-	struct dsi_display_mode adj_mode, cur_mode;
 	struct dsi_dfps_capabilities dfps_caps;
-	u32 curr_refresh_rate;
+	struct dsi_dyn_clk_caps *dyn_clk_caps;
 
-	if (!display || !mode) {
+	struct msm_drm_notifier notifier_data;
+	int dynamic_fps;
+
+	if (!display || !adj_mode) {
 		pr_err("Invalid params\n");
 		return -EINVAL;
 	}
@@ -5860,65 +6845,53 @@ int dsi_display_validate_mode_vrr(struct dsi_display *display,
 
 	mutex_lock(&display->display_lock);
 
-	adj_mode = *mode;
-	cur_mode = *cur_dsi_mode;
-
-	if ((cur_mode.timing.refresh_rate != adj_mode.timing.refresh_rate) &&
-		(cur_mode.timing.v_active == adj_mode.timing.v_active) &&
-		(cur_mode.timing.h_active == adj_mode.timing.h_active)) {
-
-		curr_refresh_rate = cur_mode.timing.refresh_rate;
-		rc = dsi_panel_get_dfps_caps(display->panel, &dfps_caps);
-		if (rc) {
-			pr_err("[%s] failed to get dfps caps from panel\n",
-					display->name);
-			goto error;
-		}
-
-		cur_mode.timing.refresh_rate =
-			adj_mode.timing.refresh_rate;
+	if ((cur_mode->timing.v_active == adj_mode->timing.v_active) &&
+	    (cur_mode->timing.h_active == adj_mode->timing.h_active)) {
+		/* dfps change use case */
+		if (cur_mode->timing.refresh_rate !=
+		    adj_mode->timing.refresh_rate) {
+			dsi_panel_get_dfps_caps(display->panel, &dfps_caps);
+
+			if (mode_fps != adj_mode->timing.refresh_rate) {
+				mode_fps = adj_mode->timing.refresh_rate;
+				dynamic_fps = mode_fps;
+				notifier_data.data = &dynamic_fps;
+				notifier_data.id = MSM_DRM_PRIMARY_DISPLAY;
+				pr_err("set fps: %d\n", dynamic_fps);
+				msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK, &notifier_data);
+			}
 
-		rc = dsi_display_get_dfps_timing(display,
-			&cur_mode, curr_refresh_rate);
-		if (rc) {
-			pr_err("[%s] seamless vrr not possible rc=%d\n",
-			display->name, rc);
-			goto error;
+			if (!dfps_caps.dfps_support) {
+				pr_err("invalid mode dfps not supported\n");
+				rc = -ENOTSUPP;
+				goto error;
+			}
+			pr_debug("Mode switch is seamless variable refresh\n");
+			adj_mode->dsi_mode_flags |= DSI_MODE_FLAG_VRR;
+			SDE_EVT32(cur_mode->timing.refresh_rate,
+				  adj_mode->timing.refresh_rate,
+				  cur_mode->timing.h_front_porch,
+				  adj_mode->timing.h_front_porch);
 		}
-		switch (dfps_caps.type) {
-		/*
-		 * Ignore any round off factors in porch calculation.
-		 * Worse case is set to 5.
-		 */
-		case DSI_DFPS_IMMEDIATE_VFP:
-			if (abs(DSI_V_TOTAL(&cur_mode.timing) -
-				DSI_V_TOTAL(&adj_mode.timing)) > 5)
-				pr_err("Mismatch vfp fps:%d new:%d given:%d\n",
-				adj_mode.timing.refresh_rate,
-				cur_mode.timing.v_front_porch,
-				adj_mode.timing.v_front_porch);
-			break;
-
-		case DSI_DFPS_IMMEDIATE_HFP:
-			if (abs(DSI_H_TOTAL_DSC(&cur_mode.timing) -
-				DSI_H_TOTAL_DSC(&adj_mode.timing)) > 5)
-				pr_err("Mismatch hfp fps:%d new:%d given:%d\n",
-				adj_mode.timing.refresh_rate,
-				cur_mode.timing.h_front_porch,
-				adj_mode.timing.h_front_porch);
-			break;
 
-		default:
-			pr_err("Unsupported DFPS mode %d\n",
-				dfps_caps.type);
-			rc = -ENOTSUPP;
+		/* dynamic clk change use case */
+		if (cur_mode->pixel_clk_khz != adj_mode->pixel_clk_khz) {
+			dyn_clk_caps = &(display->panel->dyn_clk_caps);
+			if (!dyn_clk_caps->dyn_clk_support) {
+				pr_err("dyn clk change not supported\n");
+				rc = -ENOTSUPP;
+				goto error;
+			}
+			if (adj_mode->dsi_mode_flags & DSI_MODE_FLAG_VRR) {
+				pr_err("dfps and dyn clk not supported in same commit\n");
+				rc = -ENOTSUPP;
+				goto error;
+			}
+		pr_debug("dynamic clk change detected\n");
+		adj_mode->dsi_mode_flags |= DSI_MODE_FLAG_DYN_CLK;
+		SDE_EVT32(cur_mode->pixel_clk_khz,
+				adj_mode->pixel_clk_khz);
 		}
-
-		pr_debug("Mode switch is seamless variable refresh\n");
-		mode->dsi_mode_flags |= DSI_MODE_FLAG_VRR;
-		SDE_EVT32(curr_refresh_rate, adj_mode.timing.refresh_rate,
-				cur_mode.timing.h_front_porch,
-				adj_mode.timing.h_front_porch);
 	}
 
 error:
@@ -5995,7 +6968,6 @@ int dsi_display_set_mode(struct dsi_display *display,
 		pr_err("Invalid params\n");
 		return -EINVAL;
 	}
-
 	mutex_lock(&display->display_lock);
 
 	adj_mode = *mode;
@@ -6010,7 +6982,6 @@ int dsi_display_set_mode(struct dsi_display *display,
 		pr_err("[%s] mode cannot be set\n", display->name);
 		goto error;
 	}
-
 	rc = dsi_display_set_mode_sub(display, &adj_mode, flags);
 	if (rc) {
 		pr_err("[%s] failed to set mode\n", display->name);
@@ -6027,6 +6998,7 @@ int dsi_display_set_mode(struct dsi_display *display,
 	}
 
 	memcpy(display->panel->cur_mode, &adj_mode, sizeof(adj_mode));
+
 error:
 	mutex_unlock(&display->display_lock);
 	return rc;
@@ -6407,9 +7379,6 @@ int dsi_display_prepare(struct dsi_display *display)
 
 	dsi_display_set_ctrl_esd_check_flag(display, false);
 
-	/* Set up ctrl isr before enabling core clk */
-	dsi_display_ctrl_isr_configure(display, true);
-
 	if (mode->dsi_mode_flags & DSI_MODE_FLAG_DMS) {
 		if (display->is_cont_splash_enabled) {
 			pr_err("DMS is not supposed to be set on first frame\n");
@@ -6437,6 +7406,9 @@ int dsi_display_prepare(struct dsi_display *display)
 		}
 	}
 
+	/* Set up ctrl isr before enabling core clk */
+	dsi_display_ctrl_isr_configure(display, true);
+
 	rc = dsi_display_clk_ctrl(display->dsi_clk_handle,
 			DSI_CORE_CLK, DSI_CLK_ON);
 	if (rc) {
@@ -6698,6 +7670,7 @@ int dsi_display_pre_kickoff(struct drm_connector *connector,
 	int i;
 	bool enable;
 
+	SDE_ATRACE_BEGIN("dsi_display_pre_kickoff");
 	/* check and setup MISR */
 	if (display->misr_enable)
 		_dsi_display_setup_misr(display);
@@ -6748,6 +7721,7 @@ int dsi_display_pre_kickoff(struct drm_connector *connector,
 		mutex_unlock(&display->display_lock);
 	}
 
+	SDE_ATRACE_END("dsi_display_pre_kickoff");
 	return rc;
 }
 
@@ -6800,7 +7774,6 @@ int dsi_display_enable(struct dsi_display *display)
 		pr_err("Invalid params\n");
 		return -EINVAL;
 	}
-
 	if (!display->panel->cur_mode) {
 		pr_err("no valid mode set for the display");
 		return -EINVAL;
@@ -6810,6 +7783,8 @@ int dsi_display_enable(struct dsi_display *display)
 	/* Engine states and panel states are populated during splash
 	 * resource init and hence we return early
 	 */
+	SDE_ATRACE_BEGIN("dsi_display_enable");
+
 	if (display->is_cont_splash_enabled) {
 
 		dsi_display_config_ctrl_for_cont_splash(display);
@@ -6892,6 +7867,8 @@ int dsi_display_enable(struct dsi_display *display)
 error:
 	mutex_unlock(&display->display_lock);
 	SDE_EVT32(SDE_EVTLOG_FUNC_EXIT);
+
+	SDE_ATRACE_END("dsi_display_enable");
 	return rc;
 }
 
@@ -7004,73 +7981,2088 @@ int dsi_display_update_pps(char *pps_cmd, void *disp)
 	return 0;
 }
 
-int dsi_display_unprepare(struct dsi_display *display)
+int dsi_display_set_acl_mode(struct drm_connector *connector, int level)
 {
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
 	int rc = 0;
 
-	if (!display) {
-		pr_err("Invalid params\n");
-		return -EINVAL;
-	}
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
 
-	SDE_EVT32(SDE_EVTLOG_FUNC_ENTRY);
-	mutex_lock(&display->display_lock);
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
 
-	rc = dsi_display_wake_up(display);
-	if (rc)
-		pr_err("[%s] display wake up failed, rc=%d\n",
-		       display->name, rc);
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
 
-	rc = dsi_panel_unprepare(display->panel);
-	if (rc)
-		pr_err("[%s] panel unprepare failed, rc=%d\n",
-		       display->name, rc);
+	panel = dsi_display->panel;
 
-	rc = dsi_display_ctrl_host_disable(display);
-	if (rc)
-		pr_err("[%s] failed to disable DSI host, rc=%d\n",
-		       display->name, rc);
+	mutex_lock(&dsi_display->display_lock);
 
-	rc = dsi_display_clk_ctrl(display->dsi_clk_handle,
-			DSI_LINK_CLK, DSI_CLK_OFF);
-	if (rc)
-		pr_err("[%s] failed to disable Link clocks, rc=%d\n",
-		       display->name, rc);
+	panel->acl_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+    }
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
 
-	rc = dsi_display_ctrl_deinit(display);
+	rc = dsi_panel_set_acl_mode(panel, level);
 	if (rc)
-		pr_err("[%s] failed to deinit controller, rc=%d\n",
-		       display->name, rc);
+		pr_err("unable to set acl mode\n");
 
-	if (!display->panel->ulps_suspend_enabled) {
-		rc = dsi_display_phy_disable(display);
-		if (rc)
-			pr_err("[%s] failed to disable DSI PHY, rc=%d\n",
-			       display->name, rc);
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
 	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
 
-	rc = dsi_display_clk_ctrl(display->dsi_clk_handle,
-			DSI_CORE_CLK, DSI_CLK_OFF);
-	if (rc)
-		pr_err("[%s] failed to disable DSI clocks, rc=%d\n",
-		       display->name, rc);
+int dsi_display_get_acl_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
 
-	/* destrory dsi isr set up */
-	dsi_display_ctrl_isr_configure(display, false);
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
 
-	rc = dsi_panel_post_unprepare(display->panel);
-	if (rc)
-		pr_err("[%s] panel post-unprepare failed, rc=%d\n",
-		       display->name, rc);
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
 
-	mutex_unlock(&display->display_lock);
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
 
-	/* Free up DSI ERROR event callback */
-	dsi_display_unregister_error_handler(display);
+	return dsi_display->panel->acl_mode;
+}
+
+int dsi_display_get_gamma_para(struct dsi_display *dsi_display, struct dsi_panel *panel)
+{
+    int i = 0;
+    int j = 0;
+    int rc = 0;
+    int flags = 0;
+    char fb[13] = {0};
+  //char c8[135] = {0};
+  //char c9[180] = {0};
+    char b3[47] = {0};
+    char fb_temp[13] = {0};
+    char c8_temp[135] = {0};
+    char c9_temp[180] = {0};
+    char b3_temp[47] = {0};
+    char gamma_para_60hz[452] = {0};
+    int check_sum_60hz = 0;
+
+    struct dsi_cmd_desc *cmds;
+    struct dsi_display_mode *mode;
+    struct dsi_display_ctrl *m_ctrl;
+
+    pr_err("%s start\n", __func__);
+
+    m_ctrl = &dsi_display->ctrl[dsi_display->cmd_master_idx];
+    if (!panel || !m_ctrl)
+        return -EINVAL;
+
+    rc = dsi_display_cmd_engine_enable(dsi_display);
+    if (rc) {
+        pr_err("cmd engine enable failed\n");
+        return -EINVAL;
+    }
+
+    dsi_panel_acquire_panel_lock(panel);
+    mode = panel->cur_mode;
+
+/* Read 60hz gamma para */
+    do {
+        check_sum_60hz = 0;
+        if (j > 0) {
+            pr_err("Failed to read the 60hz gamma parameters %d!", j);
+            for (i = 0; i < 52; i++) {
+                if (i != 51) {
+                    pr_err("[60hz][%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X",
+                        i*8, gamma_para[0][i*8], i*8+1, gamma_para[0][i*8+1], i*8+2, gamma_para[0][i*8+2], i*8+3, gamma_para[0][i*8+3], i*8+4, gamma_para[0][i*8+4],
+                            i*8+5, gamma_para[0][i*8+5], i*8+6, gamma_para[0][i*8+6], i*8+7, gamma_para[0][i*8+7]);
+                }
+                else {
+                    pr_err("[60hz][%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X,[%d]0x%02X",
+                        i*8, gamma_para[0][i*8], i*8+1, gamma_para[0][i*8+1], i*8+2, gamma_para[0][i*8+2], i*8+3, gamma_para[0][i*8+3], i*8+4, gamma_para[0][i*8+4]);
+                }
+            }
+            mdelay(100);
+        }
+        for(i = 0; i < 452; i++)
+        {
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_GAMMA_FLASH_PRE_READ_1);
+            if (rc) {
+                pr_err("Failed to send DSI_CMD_SET_GAMMA_FLASH_PRE_READ_1 command\n");
+                goto error;
+            }
+
+            rc = dsi_panel_gamma_read_address_setting(panel, i);
+            if (rc) {
+                pr_err("Failed to set gamma read address\n");
+                goto error;
+            }
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_GAMMA_FLASH_PRE_READ_2);
+            if (rc) {
+                pr_err("Failed to send DSI_CMD_SET_GAMMA_FLASH_PRE_READ_2 command\n");
+                goto error;
+            }
+
+            flags = 0;
+            cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_GAMMA_FLASH_READ_FB].cmds;
+            if (cmds->last_command) {
+                cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+                flags |= DSI_CTRL_CMD_LAST_COMMAND;
+            }
+            flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+            if (!m_ctrl->ctrl->vaddr)
+                goto error;
+            cmds->msg.rx_buf = fb_temp;
+            cmds->msg.rx_len = 13;
+            rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+            if (rc <= 0) {
+                pr_err("Failed to read DSI_CMD_SET_GAMMA_FLASH_READ_FB\n");
+                goto error;
+            }
+            memcpy(fb, cmds->msg.rx_buf, 13);
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_LEVEL2_KEY_DISABLE);
+            if (rc) {
+                pr_err("Failed to send DSI_CMD_SET_LEVEL2_KEY_DISABLE command\n");
+                goto error;
+            }
+
+            if (i < 135) {
+                gamma_para[0][i+18] = fb[12];
+            }
+            else if (i < 315) {
+                gamma_para[0][i+26] = fb[12];
+            }
+            else if (i < 360) {
+                gamma_para[0][i+43] = fb[12];
+            }
+
+            gamma_para_60hz[i] = fb[12];
+            if (i < 449) {
+                check_sum_60hz = gamma_para_60hz[i] + check_sum_60hz;
+            }
+        }
+        j++;
+    }
+    while ((check_sum_60hz != (gamma_para_60hz[450] << 8) + gamma_para_60hz[451]) && (j < 5));
+
+    if (check_sum_60hz == (gamma_para_60hz[450] << 8) + gamma_para_60hz[451]) {
+        pr_err("Read 60hz gamma done\n");
+    }
+    else {
+        pr_err("Failed to read 60hz gamma, use 90hz gamma.\n");
+        gamma_read_flag = GAMMA_READ_ERROR;
+    }
+
+/* Read 90hz gamma para */
+    rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_LEVEL2_KEY_ENABLE);
+    if (rc) {
+        pr_err("Failed to send DSI_CMD_SET_LEVEL2_KEY_ENABLE command\n");
+        goto error;
+    }
+
+    rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_GAMMA_OTP_READ_C8_SMRPS);
+    if (rc) {
+        pr_err("Failed to send DSI_CMD_SET_GAMMA_OTP_READ_C8_SMRPS command\n");
+        goto error;
+    }
+
+    flags = 0;
+    cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_GAMMA_OTP_READ_C8].cmds;
+    if (cmds->last_command) {
+        cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+        flags |= DSI_CTRL_CMD_LAST_COMMAND;
+    }
+    flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+    cmds->msg.rx_buf = c8_temp;
+    cmds->msg.rx_len = 135;
+    rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+    if (rc <= 0) {
+        pr_err("Failed to read DSI_CMD_SET_GAMMA_OTP_READ_C8\n");
+        goto error;
+    }
+    memcpy(&gamma_para[1][18], cmds->msg.rx_buf, 135);
+
+    rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_GAMMA_OTP_READ_C9_SMRPS);
+    if (rc) {
+        pr_err("Failed to send DSI_CMD_SET_GAMMA_OTP_READ_C9_SMRPS command\n");
+        goto error;
+    }
+
+    flags = 0;
+    cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_GAMMA_OTP_READ_C9].cmds;
+    if (cmds->last_command) {
+        cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+        flags |= DSI_CTRL_CMD_LAST_COMMAND;
+    }
+    flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+    cmds->msg.rx_buf = c9_temp;
+    cmds->msg.rx_len = 180;
+    rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+    if (rc <= 0) {
+        pr_err("Failed to read DSI_CMD_SET_GAMMA_OTP_READ_C9\n");
+        goto error;
+    }
+    memcpy(&gamma_para[1][161], cmds->msg.rx_buf, 180);
+
+    rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_GAMMA_OTP_READ_B3_SMRPS);
+    if (rc) {
+        pr_err("Failed to send DSI_CMD_SET_GAMMA_OTP_READ_C9_SMRPS command\n");
+        goto error;
+    }
+
+    flags = 0;
+    cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_GAMMA_OTP_READ_B3].cmds;
+    if (cmds->last_command) {
+        cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+        flags |= DSI_CTRL_CMD_LAST_COMMAND;
+    }
+    flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+    cmds->msg.rx_buf = b3_temp;
+    cmds->msg.rx_len = 47;
+    rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+    if (rc <= 0) {
+        pr_err("Failed to read DSI_CMD_SET_GAMMA_OTP_READ_B3\n");
+        goto error;
+    }
+    memcpy(b3, cmds->msg.rx_buf, 47);
+    memcpy(&gamma_para[1][358], &b3[2], 45);
+
+    rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_LEVEL2_KEY_DISABLE);
+    if (rc) {
+        pr_err("Failed to send DSI_CMD_SET_GAMMA_OTP_READ_C9_SMRPS command\n");
+        goto error;
+    }
+    pr_err("Read 90hz gamma done\n");
 
-	SDE_EVT32(SDE_EVTLOG_FUNC_EXIT);
-	return rc;
+error:
+    dsi_panel_release_panel_lock(panel);
+    dsi_display_cmd_engine_disable(dsi_display);
+    pr_err("%s end\n", __func__);
+    return rc;
+}
+
+int dsi_display_gamma_read(struct dsi_display *dsi_display)
+{
+    int rc = 0;
+    struct dsi_panel *panel = NULL;
+
+    pr_err("%s start\n", __func__);
+    if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+        return -EINVAL;
+
+    panel = dsi_display->panel;
+    mutex_lock(&dsi_display->display_lock);
+
+    rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle, DSI_ALL_CLKS, DSI_CLK_ON);
+    if (rc) {
+        pr_err("[%s] failed to enable DSI clocks, rc=%d\n", dsi_display->name, rc);
+        goto error;
+    }
+
+    dsi_display_get_gamma_para(dsi_display, panel);
+
+    rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle, DSI_ALL_CLKS, DSI_CLK_OFF);
+    if (rc) {
+        pr_err("[%s] failed to disable DSI clocks, rc=%d\n", dsi_display->name, rc);
+        goto error;
+    }
+
+error:
+    mutex_unlock(&dsi_display->display_lock);
+    pr_err("%s end\n", __func__);
+    return rc;
+}
+
+int dsi_display_read_serial_number(struct dsi_display *dsi_display,
+		struct dsi_panel *panel, char *buf, int len)
+{
+	int rc = 0;
+	u32 flags = 0;
+	struct dsi_cmd_desc *cmds;
+	struct dsi_display_mode *mode;
+	struct dsi_display_ctrl *m_ctrl;
+	int stage_info = 0;
+	int prodution_info = 0;
+
+	pr_err("%s start\n", __func__);
+
+	m_ctrl = &dsi_display->ctrl[dsi_display->cmd_master_idx];
+
+	if (!panel || !m_ctrl)
+		return -EINVAL;
+
+	rc = dsi_display_cmd_engine_enable(dsi_display);
+	if (rc) {
+		pr_err("cmd engine enable failed\n");
+		return -EINVAL;
+	}
+
+	dsi_panel_acquire_panel_lock(panel);
+
+	mode = panel->cur_mode;
+
+	if(strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) {
+		rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_SET_LCDINFO_PRE);
+	}
+
+	cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_SERIAL_NUMBER].cmds;
+	if (cmds->last_command) {
+		 cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+		 flags |= DSI_CTRL_CMD_LAST_COMMAND;
+	}
+	flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+	if (!m_ctrl->ctrl->vaddr)
+		goto error;
+	cmds->msg.rx_buf = buf;
+	cmds->msg.rx_len = len;
+	rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+	if (rc <= 0)
+		pr_err("Failed to get panel serial number, rc=%d\n", rc);
+
+	if(strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) {
+		flags = 0;
+		cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_STAGE_INFO].cmds;
+		if (cmds->last_command) {
+			 cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			 flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		if (!m_ctrl->ctrl->vaddr)
+			goto error;
+		cmds->msg.rx_buf = &stage_info;
+		cmds->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+		if (rc <= 0)
+			pr_err("Failed to get stage info, rc=%d\n", rc);
+
+		panel->panel_stage_info = stage_info & 0xff;
+		pr_err("Stage info is 0x%X\n", panel->panel_stage_info);
+
+		flags = 0;
+		cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_PRODUCTION_INFO].cmds;
+		if (cmds->last_command) {
+			 cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+			 flags |= DSI_CTRL_CMD_LAST_COMMAND;
+		}
+		flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+		if (!m_ctrl->ctrl->vaddr)
+			goto error;
+		cmds->msg.rx_buf = &prodution_info;
+		cmds->msg.rx_len = 1;
+		rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+		if (rc <= 0)
+			pr_err("Failed to get production info, rc=%d\n", rc);
+
+		panel->panel_production_info = prodution_info & 0xff;
+		pr_err("Production info is 0x%X\n", panel->panel_production_info);
+
+		// memcpy(temp_buffer, cmds->msg.rx_buf, len);
+		 rc = dsi_panel_tx_cmd_set_op(panel, DSI_CMD_SET_LCDINFO_POST);
+		// for(test =0; test < 16; test++){
+		// printk(KERN_ERR"OLED manufacture= %x\n",temp_buffer[test]);
+		// }
+	}
+
+ error:
+	dsi_panel_release_panel_lock(panel);
+
+	dsi_display_cmd_engine_disable(dsi_display);
+	pr_err("%s end\n", __func__);
+
+	return rc;
+}
+
+int dsi_display_get_serial_number(struct drm_connector *connector)
+{
+    struct dsi_display_mode *mode;
+	struct dsi_panel *panel = NULL;
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	char buf[32];
+	int panel_year = 0;
+	int panel_mon = 0;
+	int panel_day = 0;
+	int panel_hour = 0;
+	int panel_min = 0;
+	int panel_sec = 0;
+	int len = 0;
+	u32 count;
+	int rc = 0;
+
+	pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+	mutex_lock(&dsi_display->display_lock);
+
+    if (!dsi_panel_initialized(panel) || !panel->cur_mode) {
+		goto error;
+	}
+    mode = panel->cur_mode;
+	count = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_SERIAL_NUMBER].count;
+
+    if (count) {
+
+       len = panel->panel_min_index;
+       if (len > sizeof(buf)) {
+           pr_err("len is large than buf size!!!\n" );
+          goto error;
+       }
+
+       if ((panel->panel_year_index > len) || (panel->panel_mon_index > len)
+            || (panel->panel_day_index > len) || (panel->panel_hour_index > len)
+                || (panel->panel_min_index > len)) {
+           pr_err("Panel serial number index not corrected.\n");
+           goto error;
+        }
+
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+                DSI_ALL_CLKS, DSI_CLK_ON);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+        memset(buf, 0, sizeof(buf));
+        dsi_display_read_serial_number(dsi_display, panel, buf, len);
+		memcpy(panel->buf_id, buf, 32);
+        panel_year = 2011 + ((buf[panel->panel_year_index-1] >> 4) & 0x0f);
+        if (panel_year == 2011){
+            panel_year = 0;
+        }
+        panel_mon = buf[panel->panel_mon_index-1] & 0x0f;
+        if ((panel_mon > 12) || (panel_mon < 1)){
+            pr_err("Panel Mon not corrected.\n");
+            panel_mon = 0;
+        }
+        panel_day = buf[panel->panel_day_index-1] & 0x3f;
+        if ((panel_day > 31) || (panel_day < 1)){
+            pr_err("Panel Day not corrected.\n");
+            panel_day = 0;
+        }
+        panel_hour = buf[panel->panel_hour_index-1] & 0x3f;
+        if ((panel_hour > 23) || (panel_hour < 0)){
+            pr_err("Panel Hour not corrected.\n");
+            panel_hour = 0;
+        }
+        panel_min = buf[panel->panel_min_index-1] & 0x3f;
+        if ((panel_min > 59) || (panel_min < 0)){
+            pr_err("Panel Min not corrected.\n");
+            panel_min = 0;
+        }
+		panel_sec = buf[panel->panel_sec_index-1] & 0x3f;
+        if ((panel_sec > 59) || (panel_sec < 0)){
+            pr_err("Panel sec not corrected.\n");
+            panel_sec = 0;
+        }
+		panel->panel_year = panel_year;
+		panel->panel_mon = panel_mon;
+		panel->panel_day = panel_day;
+		panel->panel_hour = panel_hour;
+		panel->panel_min = panel_min;
+		panel->panel_sec = panel_sec;
+
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+            DSI_ALL_CLKS, DSI_CLK_OFF);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+    } else{
+        pr_err("This panel not support serial number.\n");
+    }
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	pr_err("%s start\n", __func__);
+	return 0;
+}
+
+int dsi_display_update_panel_id_and_gamma_para(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return -EINVAL;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	dsi_display_get_serial_number(connector);
+	rc = dsi_display_gamma_read(dsi_display);
+	if (rc) {
+		pr_err("Failed to read gamma para, rc=%d\n", rc);
+	}
+
+	return rc;
+}
+
+int dsi_display_get_serial_number_year(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+	
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_year;
+}
+
+int dsi_display_get_serial_number_mon(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+	
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_mon;
+}
+
+int dsi_display_get_serial_number_day(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_day;
+}
+
+int dsi_display_get_serial_number_hour(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+	
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_hour;
+}
+
+int dsi_display_get_serial_number_min(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_min;
+}
+
+int dsi_display_get_serial_number_sec(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	
+		pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+		pr_err("%s end\n", __func__);
+
+	return dsi_display->panel->panel_sec;
+}
+
+int dsi_display_get_stage_info(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+	pr_err("%s start\n", __func__);
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	pr_err("%s end\n", __func__);
+
+	if(strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0){
+		return dsi_display->panel->panel_stage_info;
+	}
+	else
+		return 0xFF;
+}
+
+int dsi_display_get_production_info(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+	pr_err("%s start\n", __func__);
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	pr_err("%s end\n", __func__);
+
+	if(strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0){
+		return dsi_display->panel->panel_production_info;
+	}
+	else
+		return 0xFF;
+}
+
+int dsi_display_get_serial_number_AT(struct drm_connector *connector)
+{
+    struct dsi_display_mode *mode;
+	struct dsi_panel *panel = NULL;
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	char buf[32];
+	int panel_year = 0;
+	int panel_mon = 0;
+	int panel_day = 0;
+	int panel_hour = 0;
+	int panel_min = 0;
+	int panel_sec = 0;
+	int len = 0;
+	u32 count;
+	int rc = 0;
+	uint64_t  serial_number;
+	pr_err("%s start\n", __func__);
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+				return 0;
+
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+	mutex_lock(&dsi_display->display_lock);
+
+    if (!dsi_panel_initialized(panel) || !panel->cur_mode) {
+		goto error;
+	}
+    mode = panel->cur_mode;
+	count = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_SERIAL_NUMBER].count;
+
+    if (count) {
+
+       len = panel->panel_min_index;
+       if (len > sizeof(buf)) {
+           pr_err("len is large than buf size!!!\n" );
+          goto error;
+       }
+
+       if ((panel->panel_year_index > len) || (panel->panel_mon_index > len)
+            || (panel->panel_day_index > len) || (panel->panel_hour_index > len)
+                || (panel->panel_min_index > len)) {
+           pr_err("Panel serial number index not corrected.\n");
+           goto error;
+        }
+
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+                DSI_ALL_CLKS, DSI_CLK_ON);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+        memset(buf, 0, sizeof(buf));
+        dsi_display_read_serial_number(dsi_display, panel, buf, len);
+	memcpy(panel->buf_id, buf, 32);
+
+	  panel_year = 2011 + ((buf[panel->panel_year_index-1] >> 4) & 0x0f);
+      if (panel_year == 2011){
+          panel_year = 0;
+      }
+		panel_mon = buf[panel->panel_mon_index-1] & 0x0f;
+		if ((panel_mon > 12) || (panel_mon < 1)){
+			pr_err("Panel Mon not corrected.\n");
+			panel_mon = 0;
+		}
+		panel_day = buf[panel->panel_day_index-1] & 0x3f;
+		if ((panel_day > 31) || (panel_day < 1)){
+			pr_err("Panel Day not corrected.\n");
+			panel_day = 0;
+		}
+		panel_hour = buf[panel->panel_hour_index-1] & 0x3f;
+		if ((panel_hour > 23) || (panel_hour < 0)){
+			pr_err("Panel Hour not corrected.\n");
+			panel_hour = 0;
+		}
+		panel_min = buf[panel->panel_min_index-1] & 0x3f;
+		if ((panel_min > 59) || (panel_min < 0)){
+			pr_err("Panel Min not corrected.\n");
+			panel_min = 0;
+		}
+		panel_sec = buf[panel->panel_sec_index-1] & 0x3f;
+		if ((panel_sec > 59) || (panel_sec < 0)){
+			pr_err("Panel sec not corrected.\n");
+			panel_sec = 0;
+		}
+/*
+		serial_number  =      ((uint64_t)panel_year << 56)
+							+ ((uint64_t)panel_mon  << 48)
+							+ ((uint64_t)panel_day  << 40)
+							+ ((uint64_t)panel_hour << 32)
+							+ ((uint64_t)panel_min  << 24)
+							+ ((uint64_t)panel_sec  << 16)
+							+ ((uint64_t)0 << 8)
+							+ ((uint64_t)0);
+*/
+		serial_number = (uint64_t)panel_year * 10000000000 + (uint64_t)panel_mon * 100000000 + (uint64_t)panel_day * 1000000
+											 + (uint64_t)panel_hour * 10000 + (uint64_t)panel_min * 100 + (uint64_t)panel_sec;
+
+		dsi_display_get_serial_number_id(serial_number);
+
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+            DSI_ALL_CLKS, DSI_CLK_OFF);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+    } else{
+        pr_err("This panel not support serial number.\n");
+    }
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	pr_err("%s END\n", __func__);
+	return 0;
+}
+
+uint64_t dsi_display_get_serial_number_id(uint64_t serial_number)
+{
+
+	static uint64_t serial_number_at;
+
+	pr_err("%s start\n",__func__);
+	if(0 == SERIAL_NUMBER_flag)
+		{
+		serial_number_at = serial_number;
+		if(0 == serial_number_at)
+			SERIAL_NUMBER_flag = 0;
+		else
+			SERIAL_NUMBER_flag = 1;
+		}
+
+	return serial_number_at;
+}
+
+
+int dsi_display_set_hbm_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->hbm_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_hbm_mode(panel, level);
+	if (rc)
+		pr_err("unable to set hbm mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_hbm_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->hbm_mode;
+}
+
+int dsi_display_set_hbm_brightness(struct drm_connector *connector, int level)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return -EINVAL;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	if ((strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") != 0) && (strcmp(dsi_display->panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") != 0)) {
+		dsi_display->panel->hbm_brightness = 0;
+		return 0;
+	}
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->hbm_brightness = level;
+
+	if (!dsi_panel_initialized(panel))
+		goto error;
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+			dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_hbm_brightness(panel, level);
+	if (rc)
+		pr_err("Failed to set hbm brightness mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+			dsi_display->name, rc);
+		goto error;
+	}
+
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_hbm_brightness(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->hbm_brightness;
+}
+
+extern int oneplus_force_screenfp;
+
+int dsi_display_set_fp_hbm_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->op_force_screenfp = level;
+	oneplus_force_screenfp=panel->op_force_screenfp;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_op_set_hbm_mode(panel, level);
+	if (rc)
+		pr_err("unable to set hbm mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+
+int dsi_display_get_fp_hbm_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->op_force_screenfp;
+}
+
+int dsi_display_set_dci_p3_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->dci_p3_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_dci_p3_mode(panel, level);
+	if (rc)
+		pr_err("unable to set dci_p3 mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_dci_p3_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->dci_p3_mode;
+}
+
+int dsi_display_set_night_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->night_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_night_mode(panel, level);
+	if (rc)
+		pr_err("unable to set night mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_night_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->night_mode;
+}
+int dsi_display_set_native_display_p3_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_p3_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_native_display_p3_mode(panel, level);
+	if (rc)
+		pr_err("unable to set native display p3 mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_native_display_p3_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_p3_mode;
+}
+
+int dsi_display_set_native_display_wide_color_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_wide_color_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_native_display_wide_color_mode(panel, level);
+	if (rc)
+		pr_err("unable to set native display p3 mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_set_native_loading_effect_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_loading_effect_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_native_loading_effect_mode(panel, level);
+	if (rc)
+		pr_err("unable to set loading effect mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_set_customer_srgb_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_customer_srgb_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_customer_srgb_mode(panel, level);
+	if (rc)
+		pr_err("unable to set customer srgb mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_set_customer_p3_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_customer_p3_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_customer_p3_mode(panel, level);
+	if (rc)
+		pr_err("unable to set customer srgb mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+int dsi_display_set_native_display_srgb_color_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	panel->naive_display_srgb_color_mode = level;
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+
+	rc = dsi_panel_set_native_display_srgb_color_mode(panel, level);
+	if (rc)
+		pr_err("unable to set native display p3 mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return rc;
+}
+
+int dsi_display_get_native_display_srgb_color_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_srgb_color_mode;
+}
+
+int dsi_display_get_native_display_wide_color_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_wide_color_mode;
+}
+
+int dsi_display_get_native_display_loading_effect_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_loading_effect_mode;
+}
+int dsi_display_get_customer_srgb_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_customer_srgb_mode;
+}
+int dsi_display_get_customer_p3_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->naive_display_customer_p3_mode;
+}
+
+int dsi_display_set_aod_mode(struct drm_connector *connector, int level)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+	panel->aod_mode = level;
+	if (strcmp(dsi_display->panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") == 0){
+		printk(KERN_ERR"dsi_display_set_aod_mode\n");
+	}
+	else if(strcmp(dsi_display->panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0){
+		printk(KERN_ERR"oneplus SDC 2K OLED dsi_display_set_aod_mode\n");
+		}
+	else
+	{
+		dsi_display->panel->aod_mode=0;
+		return 0;
+	}	
+	mutex_lock(&dsi_display->display_lock);
+	if (!dsi_panel_initialized(panel)) {
+		goto error;
+	}
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_ON);
+	if (rc) {
+		pr_err("[%s] failed to enable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+	rc = dsi_panel_set_aod_mode(panel, level);
+	if (rc)
+		pr_err("unable to set aod mode\n");
+
+	rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc) {
+		pr_err("[%s] failed to disable DSI core clocks, rc=%d\n",
+		       dsi_display->name, rc);
+		goto error;
+	}
+error:
+	mutex_unlock(&dsi_display->display_lock);
+
+	return rc;
+}
+
+int dsi_display_get_aod_mode(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->aod_mode;
+}
+
+int dsi_display_set_aod_disable(struct drm_connector *connector, int disable)
+{
+    struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+	mutex_lock(&dsi_display->display_lock);
+	panel->aod_disable = disable;
+	mutex_unlock(&dsi_display->display_lock);
+
+	return rc;
+}
+
+int dsi_display_get_aod_disable(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->aod_disable;
+}
+int dsi_display_read_panel_id(struct dsi_display *dsi_display,
+		struct dsi_panel *panel, char* buf, int len)
+{
+	int rc = 0;
+	u32 flags = 0;
+	struct dsi_cmd_desc *cmds;
+    struct dsi_display_mode *mode;
+    struct dsi_display_ctrl *m_ctrl;
+    int retry_times;
+
+    m_ctrl = &dsi_display->ctrl[dsi_display->cmd_master_idx];
+
+	if (!panel || !m_ctrl)
+		return -EINVAL;
+
+    rc = dsi_display_cmd_engine_enable(dsi_display);
+    if (rc) {
+        pr_err("cmd engine enable failed\n");
+        return -EINVAL;
+    }
+
+	dsi_panel_acquire_panel_lock(panel);
+
+    mode = panel->cur_mode;
+	cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID].cmds;;
+	if (cmds->last_command) {
+		cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+		flags |= DSI_CTRL_CMD_LAST_COMMAND;
+	}
+	flags |= (DSI_CTRL_CMD_FETCH_MEMORY | DSI_CTRL_CMD_READ);
+    if (!m_ctrl->ctrl->vaddr)
+        goto error;
+
+	cmds->msg.rx_buf = buf;
+	cmds->msg.rx_len = len;
+	retry_times = 0;
+    do {
+	    rc = dsi_ctrl_cmd_transfer(m_ctrl->ctrl, &cmds->msg, flags);
+	    retry_times++;
+	} while ((rc <= 0) && (retry_times < 3));
+
+	if (rc <= 0)
+		pr_err("rx cmd transfer failed rc=%d\n", rc);
+
+ error:
+	dsi_panel_release_panel_lock(panel);
+
+	dsi_display_cmd_engine_disable(dsi_display);
+
+	return rc;
+}
+
+char dsi_display_ascii_to_int(char ascii)
+{
+	char int_value;
+
+	if ((ascii >= 48) && (ascii <= 57)){
+		int_value = ascii - 48;
+	}
+	else if ((ascii >= 65) && (ascii <= 70)) {
+		int_value = ascii - 65 + 10;
+	}
+	else if ((ascii >= 97) && (ascii <= 102)) {
+		int_value = ascii - 97 + 10;
+	}
+	else {
+		int_value = 0;
+		pr_err("Bad para: %d , please enter the right value!", ascii);
+	}
+
+	return int_value;
+}
+
+int dsi_display_update_dsi_on_command(struct drm_connector *connector, const char *buf, size_t count)
+{
+	int i = 0;
+	int j = 0;
+	unsigned int length;
+	char *data;
+	struct dsi_panel_cmd_set *set;
+
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_panel *panel = NULL;
+	struct dsi_bridge *c_bridge;
+	int rc = 0;
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return -EINVAL;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+
+	mutex_lock(&dsi_display->display_lock);
+
+	length = count / 3;
+	data = kzalloc(length + 1, GFP_KERNEL);
+
+	for (i = 0; buf[i+2] != 10; i = i+3) {
+		data[j] = dsi_display_ascii_to_int(buf[i]) << 4;
+		data[j] += dsi_display_ascii_to_int(buf[i+1]);
+		j++;
+	}
+	data[j] = dsi_display_ascii_to_int(buf[i]) << 4;
+	data[j] += dsi_display_ascii_to_int(buf[i+1]);
+
+	set = &panel->cur_mode->priv_info->cmd_sets[DSI_CMD_SET_ON];
+
+	rc = dsi_panel_update_cmd_sets_sub(set, DSI_CMD_SET_ON, data, length);
+	if (rc)
+		pr_err("Failed to update_cmd_sets_sub, rc=%d\n", rc);
+
+	mutex_unlock(&dsi_display->display_lock);
+
+	return rc;
+}
+
+static int dsi_display_get_mipi_dsi_msg(const struct mipi_dsi_msg *msg, char* buf)
+{
+	int len = 0;
+	size_t i;
+	char *tx_buf = (char*)msg->tx_buf;
+	/* Packet Info */
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", msg->type);
+	/* Last bit */
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", (msg->flags & MIPI_DSI_MSG_LASTCOMMAND) ? 1 : 0);
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", msg->channel);
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", (unsigned int)msg->flags);
+	/* Delay */
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", msg->wait_ms);
+	len += snprintf(buf + len, PAGE_SIZE - len, "%02X %02X ", msg->tx_len >> 8, msg->tx_len & 0x00FF);
+
+	/* Packet Payload */
+	for (i = 0 ; i < msg->tx_len ; i++) {
+		len += snprintf(buf + len, PAGE_SIZE - len, "%02X ", tx_buf[i]);
+	}
+	len += snprintf(buf + len, PAGE_SIZE - len, "\n");
+
+	return len;
+}
+
+int dsi_display_get_dsi_on_command(struct drm_connector *connector, char *buf)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	struct dsi_panel_cmd_set *cmd;
+	int i = 0;
+	int count = 0;
+
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	cmd = &dsi_display->panel->cur_mode->priv_info->cmd_sets[DSI_CMD_SET_ON];
+
+	for (i = 0; i < cmd->count; i++) {
+		count += dsi_display_get_mipi_dsi_msg(&cmd->cmds[i].msg, &buf[count]);
+	}
+
+	return count;
+}
+
+int dsi_display_panel_mismatch_check(struct drm_connector *connector)
+{
+    struct dsi_display_mode *mode;
+	struct dsi_panel *panel = NULL;
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	char buf[32];
+	int panel_id;
+	u32 count;
+	int rc = 0;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+
+	panel = dsi_display->panel;
+	mutex_lock(&dsi_display->display_lock);
+
+    if (!dsi_panel_initialized(panel) || !panel->cur_mode) {
+        panel->panel_mismatch = 0;
+		goto error;
+	}
+
+	if (!panel->panel_mismatch_check) {
+	    panel->panel_mismatch = 0;
+	    pr_err("This hw not support panel mismatch check(dvt-mp)\n");
+		goto error;
+	}
+
+    mode = panel->cur_mode;
+	count = mode->priv_info->cmd_sets[DSI_CMD_SET_PANEL_ID].count;
+    if (count) {
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+                DSI_ALL_CLKS, DSI_CLK_ON);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+
+        memset(buf, 0, sizeof(buf));
+        dsi_display_read_panel_id(dsi_display, panel, buf, 1);
+
+        panel_id = buf[0];
+        panel->panel_mismatch = (panel_id == 0x03)? 1 : 0;
+
+        rc = dsi_display_clk_ctrl(dsi_display->dsi_clk_handle,
+            DSI_ALL_CLKS, DSI_CLK_OFF);
+        if (rc) {
+            pr_err("[%s] failed to enable DSI clocks, rc=%d\n",
+                dsi_display->name, rc);
+            goto error;
+        }
+    } else{
+        panel->panel_mismatch = 0;
+        pr_err("This panel not support panel mismatch check.\n");
+    }
+error:
+	mutex_unlock(&dsi_display->display_lock);
+	return 0;
+}
+
+int dsi_display_panel_mismatch(struct drm_connector *connector)
+{
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+
+    if ((connector == NULL) || (connector->encoder == NULL)
+            || (connector->encoder->bridge == NULL))
+        return 0;
+
+    c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+    dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return 0;
+
+	return dsi_display->panel->panel_mismatch;
+}
+
+int dsi_display_unprepare(struct dsi_display *display)
+{
+	int rc = 0;
+
+	if (!display) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+
+	SDE_EVT32(SDE_EVTLOG_FUNC_ENTRY);
+	mutex_lock(&display->display_lock);
+
+	rc = dsi_display_wake_up(display);
+	if (rc)
+		pr_err("[%s] display wake up failed, rc=%d\n",
+		       display->name, rc);
+
+	rc = dsi_panel_unprepare(display->panel);
+	if (rc)
+		pr_err("[%s] panel unprepare failed, rc=%d\n",
+		       display->name, rc);
+
+	rc = dsi_display_ctrl_host_disable(display);
+	if (rc)
+		pr_err("[%s] failed to disable DSI host, rc=%d\n",
+		       display->name, rc);
+
+	rc = dsi_display_clk_ctrl(display->dsi_clk_handle,
+			DSI_LINK_CLK, DSI_CLK_OFF);
+	if (rc)
+		pr_err("[%s] failed to disable Link clocks, rc=%d\n",
+		       display->name, rc);
+
+	rc = dsi_display_ctrl_deinit(display);
+	if (rc)
+		pr_err("[%s] failed to deinit controller, rc=%d\n",
+		       display->name, rc);
+
+	if (!display->panel->ulps_suspend_enabled) {
+		rc = dsi_display_phy_disable(display);
+		if (rc)
+			pr_err("[%s] failed to disable DSI PHY, rc=%d\n",
+			       display->name, rc);
+	}
+
+	rc = dsi_display_clk_ctrl(display->dsi_clk_handle,
+			DSI_CORE_CLK, DSI_CLK_OFF);
+	if (rc)
+		pr_err("[%s] failed to disable DSI clocks, rc=%d\n",
+		       display->name, rc);
+
+	/* destrory dsi isr set up */
+	dsi_display_ctrl_isr_configure(display, false);
+
+	rc = dsi_panel_post_unprepare(display->panel);
+	if (rc)
+		pr_err("[%s] panel post-unprepare failed, rc=%d\n",
+		       display->name, rc);
+
+	mutex_unlock(&display->display_lock);
+
+	/* Free up DSI ERROR event callback */
+	dsi_display_unregister_error_handler(display);
+
+	SDE_EVT32(SDE_EVTLOG_FUNC_EXIT);
+	return rc;
+}
+//*mark.yao@PSW.MM.Display.LCD.Stability,2018/4/28,add for support aod,hbm,seed*/
+struct dsi_display *get_main_display(void) {
+		return primary_display;
 }
+EXPORT_SYMBOL(get_main_display);
 
 static int __init dsi_display_register(void)
 {
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_display.h b/drivers/gpu/drm/msm/dsi-staging/dsi_display.h
index 807699604198fe94eeeecab3ea3af266b139a5b8..5bcd4d455391c9aff520c08d7beec56ebffea451 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_display.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_display.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation.All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation.All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -22,6 +22,7 @@
 #include <linux/firmware.h>
 #include <drm/drmP.h>
 #include <drm/drm_crtc.h>
+#include <linux/oneplus/boot_mode.h>
 
 #include "msm_drv.h"
 #include "dsi_defs.h"
@@ -409,16 +410,18 @@ int dsi_display_validate_mode(struct dsi_display *display,
 			      u32 flags);
 
 /**
- * dsi_display_validate_mode_vrr() - validates mode if variable refresh case
+ * dsi_display_validate_mode_change() - validates mode if variable refresh case
+ *				or dynamic clk change case
  * @display:             Handle to display.
  * @mode:                Mode to be validated..
  *
  * Return: 0 if  error code.
  */
-int dsi_display_validate_mode_vrr(struct dsi_display *display,
+int dsi_display_validate_mode_change(struct dsi_display *display,
 			struct dsi_display_mode *cur_dsi_mode,
 			struct dsi_display_mode *mode);
 
+extern int msm_drm_notifier_call_chain(unsigned long val, void *v);
 /**
  * dsi_display_set_mode() - Set mode on the display.
  * @display:           Handle to display.
@@ -582,6 +585,9 @@ int dsi_display_set_tpg_state(struct dsi_display *display, bool enable);
 
 int dsi_display_clock_gate(struct dsi_display *display, bool enable);
 int dsi_dispaly_static_frame(struct dsi_display *display, bool enable);
+uint64_t dsi_display_get_serial_number_id(uint64_t serial_number);
+
+int dsi_display_get_serial_number_AT(struct drm_connector *connector);
 
 /**
  * dsi_display_enable_event() - enable interrupt based connector event
@@ -696,4 +702,11 @@ int dsi_display_cont_splash_config(void *display);
 int dsi_display_get_panel_vfp(void *display,
 	int h_active, int v_active);
 
+extern int connector_state_crtc_index;
+extern int msm_drm_notifier_call_chain(unsigned long val, void *v);
+
+struct dsi_display *get_main_display(void);
+extern char gamma_para[2][413];
+int dsi_display_gamma_read(struct dsi_display *dsi_display);
+
 #endif /* _DSI_DISPLAY_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_drm.c b/drivers/gpu/drm/msm/dsi-staging/dsi_drm.c
index d81d57a56318cbfccb67a11e56ee6850a4be52ca..187fc7b08c5217f31497ae013063a260311ad3fa 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_drm.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_drm.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -80,6 +80,8 @@ static void convert_to_dsi_mode(const struct drm_display_mode *drm_mode,
 		dsi_mode->dsi_mode_flags |= DSI_MODE_FLAG_DMS;
 	if (msm_is_mode_seamless_vrr(drm_mode))
 		dsi_mode->dsi_mode_flags |= DSI_MODE_FLAG_VRR;
+	if (msm_is_mode_seamless_dyn_clk(drm_mode))
+		dsi_mode->dsi_mode_flags |= DSI_MODE_FLAG_DYN_CLK;
 
 	dsi_mode->timing.h_sync_polarity =
 			!!(drm_mode->flags & DRM_MODE_FLAG_PHSYNC);
@@ -122,13 +124,18 @@ void dsi_convert_to_drm_mode(const struct dsi_display_mode *dsi_mode,
 		drm_mode->private_flags |= MSM_MODE_FLAG_SEAMLESS_DMS;
 	if (dsi_mode->dsi_mode_flags & DSI_MODE_FLAG_VRR)
 		drm_mode->private_flags |= MSM_MODE_FLAG_SEAMLESS_VRR;
+	if (dsi_mode->dsi_mode_flags & DSI_MODE_FLAG_DYN_CLK)
+		drm_mode->private_flags |= MSM_MODE_FLAG_SEAMLESS_DYN_CLK;
 
 	if (dsi_mode->timing.h_sync_polarity)
 		drm_mode->flags |= DRM_MODE_FLAG_PHSYNC;
 	if (dsi_mode->timing.v_sync_polarity)
 		drm_mode->flags |= DRM_MODE_FLAG_PVSYNC;
 
-	drm_mode_set_name(drm_mode);
+	/* set mode name */
+	snprintf(drm_mode->name, DRM_DISPLAY_MODE_LEN, "%dx%dx%dx%d",
+			drm_mode->hdisplay, drm_mode->vdisplay,
+			drm_mode->vrefresh, drm_mode->clock);
 }
 
 static int dsi_bridge_attach(struct drm_bridge *bridge)
@@ -173,7 +180,8 @@ static void dsi_bridge_pre_enable(struct drm_bridge *bridge)
 	}
 
 	if (c_bridge->dsi_mode.dsi_mode_flags &
-		(DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR)) {
+		(DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR |
+		 DSI_MODE_FLAG_DYN_CLK)) {
 		pr_debug("[%d] seamless pre-enable\n", c_bridge->id);
 		return;
 	}
@@ -215,7 +223,8 @@ static void dsi_bridge_enable(struct drm_bridge *bridge)
 	}
 
 	if (c_bridge->dsi_mode.dsi_mode_flags &
-			(DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR)) {
+			(DSI_MODE_FLAG_SEAMLESS | DSI_MODE_FLAG_VRR |
+			 DSI_MODE_FLAG_DYN_CLK)) {
 		pr_debug("[%d] seamless enable\n", c_bridge->id);
 		return;
 	}
@@ -296,6 +305,12 @@ static void dsi_bridge_mode_set(struct drm_bridge *bridge,
 
 	memset(&(c_bridge->dsi_mode), 0x0, sizeof(struct dsi_display_mode));
 	convert_to_dsi_mode(adjusted_mode, &(c_bridge->dsi_mode));
+
+	/* restore bit_clk_rate also for dynamic clk use cases */
+	c_bridge->dsi_mode.timing.clk_rate_hz =
+		dsi_drm_find_bit_clk_rate(c_bridge->display, adjusted_mode);
+
+	pr_debug("clk_rate: %llu\n", c_bridge->dsi_mode.timing.clk_rate_hz);
 }
 
 static bool dsi_bridge_mode_fixup(struct drm_bridge *bridge,
@@ -364,17 +379,20 @@ static bool dsi_bridge_mode_fixup(struct drm_bridge *bridge,
 		cur_dsi_mode.timing.dsc_enabled =
 				dsi_mode.priv_info->dsc_enabled;
 		cur_dsi_mode.timing.dsc = &dsi_mode.priv_info->dsc;
-		rc = dsi_display_validate_mode_vrr(c_bridge->display,
+		rc = dsi_display_validate_mode_change(c_bridge->display,
 					&cur_dsi_mode, &dsi_mode);
-		if (rc)
-			pr_debug("[%s] vrr mode mismatch failure rc=%d\n",
+		if (rc) {
+			pr_err("[%s] seamless mode mismatch failure rc=%d\n",
 				c_bridge->display->name, rc);
+//			return false;
+		}
 
 		cur_mode = crtc_state->crtc->mode;
 
 		/* No DMS/VRR when drm pipeline is changing */
 		if (!drm_mode_equal(&cur_mode, adjusted_mode) &&
 			(!(dsi_mode.dsi_mode_flags & DSI_MODE_FLAG_VRR)) &&
+			(!(dsi_mode.dsi_mode_flags & DSI_MODE_FLAG_DYN_CLK)) &&
 			(!crtc_state->active_changed ||
 			 display->is_cont_splash_enabled))
 			dsi_mode.dsi_mode_flags |= DSI_MODE_FLAG_DMS;
@@ -386,6 +404,33 @@ static bool dsi_bridge_mode_fixup(struct drm_bridge *bridge,
 	return true;
 }
 
+u64 dsi_drm_find_bit_clk_rate(void *display,
+			      const struct drm_display_mode *drm_mode)
+{
+	int i = 0, count = 0;
+	struct dsi_display *dsi_display = display;
+	struct dsi_display_mode *dsi_mode;
+	u64 bit_clk_rate = 0;
+
+	if (!dsi_display || !drm_mode)
+		return 0;
+
+	dsi_display_get_mode_count(dsi_display, &count);
+
+	for (i = 0; i < count; i++) {
+		dsi_mode = &dsi_display->modes[i];
+		if ((dsi_mode->timing.v_active == drm_mode->vdisplay) &&
+		    (dsi_mode->timing.h_active == drm_mode->hdisplay) &&
+		    (dsi_mode->pixel_clk_khz == drm_mode->clock) &&
+		    (dsi_mode->timing.refresh_rate == drm_mode->vrefresh)) {
+			bit_clk_rate = dsi_mode->timing.clk_rate_hz;
+			break;
+		}
+	}
+
+	return bit_clk_rate;
+}
+
 int dsi_conn_get_mode_info(struct drm_connector *connector,
 		const struct drm_display_mode *drm_mode,
 		struct msm_mode_info *mode_info,
@@ -410,7 +455,7 @@ int dsi_conn_get_mode_info(struct drm_connector *connector,
 	mode_info->prefill_lines = dsi_mode.priv_info->panel_prefill_lines;
 	mode_info->jitter_numer = dsi_mode.priv_info->panel_jitter_numer;
 	mode_info->jitter_denom = dsi_mode.priv_info->panel_jitter_denom;
-	mode_info->clk_rate = dsi_mode.priv_info->clk_rate_hz;
+	mode_info->clk_rate = dsi_drm_find_bit_clk_rate(display, drm_mode);
 	mode_info->mdp_transfer_time_us =
 		dsi_mode.priv_info->mdp_transfer_time_us;
 
@@ -516,6 +561,9 @@ int dsi_conn_set_info_blob(struct drm_connector *connector,
 			panel->dfps_caps.max_refresh_rate);
 	}
 
+	sde_kms_info_add_keystr(info, "dyn bitclk support",
+			panel->dyn_clk_caps.dyn_clk_support ? "true" : "false");
+
 	switch (panel->phy_props.rotation) {
 	case DSI_PANEL_ROTATE_NONE:
 		sde_kms_info_add_keystr(info, "panel orientation", "none");
@@ -676,6 +724,9 @@ int dsi_connector_get_modes(struct drm_connector *connector,
 		}
 		m->width_mm = connector->display_info.width_mm;
 		m->height_mm = connector->display_info.height_mm;
+		/* set the first mode in list as preferred */
+		if (i == 0)
+			m->type |= DRM_MODE_TYPE_PREFERRED;
 		drm_mode_probed_add(connector, m);
 	}
 end:
@@ -783,6 +834,9 @@ int dsi_conn_post_kickoff(struct drm_connector *connector)
 		c_bridge->dsi_mode.dsi_mode_flags &= ~DSI_MODE_FLAG_VRR;
 	}
 
+	/* ensure dynamic clk switch flag is reset */
+	c_bridge->dsi_mode.dsi_mode_flags &= ~DSI_MODE_FLAG_DYN_CLK;
+
 	return 0;
 }
 
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_drm.h b/drivers/gpu/drm/msm/dsi-staging/dsi_drm.h
index 7ec55485cfab2a2d3168de6da89faba53c9469a7..1af30e1d8090b3be96f4ebb7d930febee8ef605e 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_drm.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_drm.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -139,4 +139,6 @@ int dsi_conn_post_kickoff(struct drm_connector *connector);
 void dsi_convert_to_drm_mode(const struct dsi_display_mode *dsi_mode,
 				struct drm_display_mode *drm_mode);
 
+u64 dsi_drm_find_bit_clk_rate(void *display,
+			      const struct drm_display_mode *drm_mode);
 #endif /* _DSI_DRM_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_hw.h b/drivers/gpu/drm/msm/dsi-staging/dsi_hw.h
index ec44e4b3f48724ecfe5b192419857a9d839c2626..77c6694fd13e6194a36cc15ee296861b6c274e06 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_hw.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_hw.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -53,4 +53,14 @@
 #define DSI_R64(dsi_hw, off) readq_relaxed((dsi_hw)->base + (off))
 #define DSI_W64(dsi_hw, off, val) writeq_relaxed((val), (dsi_hw)->base + (off))
 
+#define PLL_CALC_DATA(addr0, addr1, data0, data1)      \
+	(((data1) << 24) | ((((addr1)/4) & 0xFF) << 16) | \
+	 ((data0) << 8) | (((addr0)/4) & 0xFF))
+
+#define DSI_DYN_REF_REG_W(base, offset, addr0, addr1, data0, data1)   \
+	writel_relaxed(PLL_CALC_DATA(addr0, addr1, data0, data1), \
+			(base) + (offset))
+
+#define DSI_GEN_R32(base, offset) readl_relaxed(base + (offset))
+#define DSI_GEN_W32(base, offset, val) writel_relaxed((val), base + (offset))
 #endif /* _DSI_HW_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_panel.c b/drivers/gpu/drm/msm/dsi-staging/dsi_panel.c
old mode 100644
new mode 100755
index cf73ffce17d8435e8344f60529ba686ca50ae338..b943a0391c1ab4d2119213ba7c44de5b979b1590
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_panel.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_panel.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -18,11 +18,19 @@
 #include <linux/gpio.h>
 #include <linux/of_gpio.h>
 #include <video/mipi_display.h>
-
 #include "dsi_panel.h"
 #include "dsi_ctrl_hw.h"
 #include "dsi_parser.h"
-
+#include <linux/pm_wakeup.h>
+#include <linux/project_info.h>
+#include <linux/msm_drm_notify.h>
+#include <linux/notifier.h>
+#include <linux/string.h>
+#include "dsi_drm.h"
+#include "dsi_display.h"
+#include "sde_crtc.h"
+#include "sde_rm.h"
+#include "sde_trace.h"
 /**
  * topology is currently defined by a set of following 3 values:
  * 1. num of layer mixers
@@ -32,6 +40,8 @@
 #define TOPOLOGY_SET_LEN 3
 #define MAX_TOPOLOGY 5
 
+#define DSI_PANEL_SAMSUNG_S6E3HC2 0
+#define DSI_PANEL_SAMSUNG_S6E3FC2X01 1
 #define DSI_PANEL_DEFAULT_LABEL  "Default dsi panel"
 
 #define DEFAULT_MDP_TRANSFER_TIME 14000
@@ -41,6 +51,7 @@
 #define DEFAULT_PANEL_JITTER_ARRAY_SIZE		2
 #define MAX_PANEL_JITTER		10
 #define DEFAULT_PANEL_PREFILL_LINES	25
+extern int tp_1v8_power;
 
 enum dsi_dsc_ratio_type {
 	DSC_8BPC_8BPP,
@@ -99,6 +110,148 @@ static char dsi_dsc_rc_range_max_qp_1_1_scr1[][15] = {
 static char dsi_dsc_rc_range_bpg_offset[] = {2, 0, 0, -2, -4, -6, -8, -8,
 		-8, -10, -10, -12, -12, -12, -12};
 
+static bool   hbm_finger_print = false;
+static int    hbm_brightness_flag = 0;
+static int    cur_backlight = -1;
+static int    cur_fps = 60;
+static int    cur_h = 1440;
+static struct dsi_panel_cmd_set gamma_cmd_set[2];
+char gamma_para[2][413] = {
+{
+/* Level2 key Enable */
+0x39,0x01,0x00,0x00,0x00,0x00,0x03,0xF0,0x5A,0x5A,
+/* 135 parameter read value (60Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0x88,0xC8,
+0xAA,0xA9,0x95,0x97,0x44,0xD8,0x52,0x08,
+0x91,0x09,0xC7,0x44,0xA2,0x6B,0xDB,0x55,
+0x10,0x40,0x55,0x25,0x89,0x28,0xFC,0x59,
+0xFD,0xD7,0x29,0xBC,0xA0,0xDF,0x00,0x00,
+0x00,0x9C,0x8F,0xB6,0x71,0x79,0x86,0x37,
+0x37,0x37,0x00,0x00,0x00,0xAA,0xA9,0x95,
+0x52,0x08,0x90,0x52,0x08,0x90,0x12,0xCF,
+0x4F,0xAA,0x72,0xE4,0x55,0x54,0x40,0x5B,
+0x29,0x8F,0x2E,0x01,0x5D,0x04,0xDD,0x30,
+0xC8,0xAF,0xEF,0x00,0x00,0x00,0xAF,0x96,
+0xC4,0x9F,0x85,0xA9,0x37,0x37,0x37,0x00,
+0x00,0x00,0xAA,0xA9,0x95,0x52,0x08,0x90,
+0x52,0x08,0x90,0x14,0xD0,0x51,0xAB,0x73,
+0xE5,0x55,0x54,0x40,0x5E,0x2E,0x92,0x32,
+0x04,0x5F,0x09,0xE3,0x35,0xD5,0xB9,0xFA,
+0x00,0x00,0x00,0xC9,0xA9,0xDD,0xB6,0x9F,
+0xBC,0x37,0x37,0x37,0x00,0x00,0x00,
+/* 180 parameter read value (60Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0xB5,0xC9,
+0xAA,0xA9,0x95,0x52,0x08,0x90,0x52,0x08,
+0x90,0x15,0xD2,0x53,0xAD,0x74,0xE8,0x55,
+0x54,0x41,0x63,0x35,0x9B,0x3F,0x14,0x71,
+0x18,0xF1,0x46,0xE0,0xC6,0x06,0x00,0x00,
+0x00,0xCE,0xC1,0xF0,0xBE,0xB5,0xBF,0x37,
+0x37,0x37,0x00,0x00,0x00,0xAA,0xA9,0x95,
+0x52,0x08,0x90,0x52,0x08,0x90,0x18,0xD4,
+0x56,0xB1,0x78,0xEC,0x55,0x54,0x41,0x66,
+0x38,0x9E,0x42,0x17,0x75,0x1A,0xF5,0x4D,
+0xEE,0xD3,0x1C,0x04,0x00,0x00,0xDF,0xD7,
+0x03,0xC8,0xC3,0xCF,0x37,0x37,0x37,0x00,
+0x00,0x00,0xAA,0xA9,0x95,0x52,0x08,0x90,
+0x52,0x08,0x90,0x0D,0xCB,0x4B,0xA8,0x73,
+0xE4,0x55,0x55,0x51,0x61,0x35,0x97,0x3B,
+0x17,0x70,0x20,0x00,0x53,0x01,0xE6,0x2F,
+0x04,0x00,0x00,0xDD,0xE1,0x10,0xD2,0xCE,
+0xF0,0x37,0x37,0x37,0x00,0x00,0x00,0xAA,
+0xA9,0x95,0x52,0x08,0x90,0x52,0x08,0x90,
+0x0A,0xCB,0x49,0xAE,0x7A,0xEA,0x55,0x55,
+0x45,0x70,0x45,0xA4,0x4C,0x2D,0x82,0x30,
+0x13,0x64,0xFF,0x04,0x3B,0x04,0x10,0x00,
+0xFF,0xFD,0x36,0xF4,0xC5,0x1A,0x37,0x37,
+0x37,0x00,0x00,0x00,
+/*0xB0 0x02*/
+0x15,0x01,0x00,0x00,0x00,0x00,0x02,0xB0,0x02,
+/* 45 parameter read value (60Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0x2E,0xB3,
+0xAE,0xA9,0x95,0xC7,0x68,0x08,0x77,0x28,
+0xB6,0x27,0xE1,0x63,0xB6,0x7D,0xF1,0x55,
+0x54,0x40,0x64,0x31,0x98,0x34,0x07,0x67,
+0x06,0xDF,0x33,0xC7,0xA3,0xE5,0x00,0x00,
+0x00,0xA3,0x93,0xC6,0x0A,0x01,0x01,0x37,
+0x37,0x37,0x00,0x00,0x00,
+/* level2_key Disable */
+0x39,0x01,0x00,0x00,0x00,0x00,0x03,0xF0,0xA5,0xA5
+},
+
+{
+/* Level2 key Enable */
+0x39,0x01,0x00,0x00,0x00,0x00,0x03,0xF0,0x5A,0x5A,
+/* 135 parameter read value (90Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0x88,0xC8,
+0xAA,0xA9,0x95,0x97,0x44,0xD8,0x52,0x08,
+0x90,0x09,0xC7,0x45,0xA2,0x6B,0xDB,0x55,
+0x10,0x40,0x55,0x26,0x89,0x29,0xFF,0x59,
+0xFE,0xDA,0x29,0xC6,0xAF,0xE5,0x00,0x00,
+0x00,0xA6,0x97,0xBC,0x84,0x85,0x94,0x37,
+0x37,0x37,0x00,0x00,0x00,0xAA,0xA9,0x95,
+0x5A,0x21,0x9B,0x5A,0x21,0x9B,0x17,0xD3,
+0x54,0xAB,0x73,0xE4,0x55,0x54,0x40,0x5F,
+0x30,0x94,0x32,0x08,0x63,0x09,0xE6,0x35,
+0xD9,0xC4,0xFD,0x00,0x00,0x00,0xCD,0xB9,
+0xE7,0xAE,0x9F,0xB2,0x37,0x37,0x37,0x00,
+0x00,0x00,0xAA,0xA9,0x95,0x5A,0x21,0x9B,
+0x5A,0x21,0x9B,0x18,0xD4,0x55,0xAE,0x76,
+0xE7,0x55,0x54,0x41,0x63,0x35,0x98,0x39,
+0x11,0x68,0x16,0xF3,0x3E,0xF4,0xDD,0x1A,
+0x04,0x00,0x00,0xEF,0xCF,0x06,0xD6,0xC4,
+0xE5,0x37,0x37,0x37,0x00,0x00,0x00,
+/* 180 parameter read value (90Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0xB5,0xC9,
+0xAA,0xA9,0x95,0x5A,0x21,0x9B,0x5A,0x21,
+0x9B,0x18,0xD3,0x54,0xB0,0x78,0xE9,0x55,
+0x55,0x51,0x67,0x3A,0x9C,0x43,0x1A,0x6F,
+0x24,0x00,0x4D,0x0A,0xEB,0x31,0x44,0x10,
+0x00,0x07,0xE0,0x23,0xF1,0xD5,0x05,0x37,
+0x37,0x37,0x00,0x00,0x00,0xAA,0xA9,0x95,
+0x5A,0x21,0x9B,0x5A,0x21,0x9B,0x18,0xD4,
+0x55,0xB3,0x7B,0xEB,0x55,0x55,0x51,0x6E,
+0x42,0x9F,0x47,0x23,0x75,0x30,0x0E,0x55,
+0x1B,0xFA,0x3C,0x44,0x10,0x00,0x0E,0xEF,
+0x2D,0xF8,0xD8,0x0C,0x37,0x37,0x37,0x00,
+0x00,0x00,0xAA,0xA9,0x95,0x5A,0x21,0x9B,
+0x5A,0x21,0x9B,0x0D,0xCB,0x49,0xAF,0x7B,
+0xE8,0x55,0x55,0x55,0x72,0x48,0xA2,0x51,
+0x2C,0x79,0x3C,0x1A,0x5E,0x2C,0x08,0x46,
+0x45,0x10,0x00,0x15,0xF4,0x40,0x05,0xDE,
+0x24,0x37,0x37,0x37,0x00,0x00,0x00,0xAA,
+0xA9,0x95,0x5A,0x21,0x9B,0x5A,0x21,0x9B,
+0x09,0xCC,0x44,0xB7,0x89,0xED,0x55,0x55,
+0x55,0x87,0x5F,0xAE,0x6F,0x4C,0x8D,0x63,
+0x3F,0x7D,0x56,0x30,0x6C,0x55,0x50,0x00,
+0x3B,0x1B,0x62,0x2B,0x03,0x45,0x37,0x37,
+0x37,0x00,0x00,0x00,
+/*0xB0 0x02*/
+0x15,0x01,0x00,0x00,0x00,0x00,0x02,0xB0,0x02,
+/* 45 parameter read value (90Hz) */
+0x39,0x01,0x00,0x00,0x00,0x00,0x2E,0xB3,
+0xAE,0xA9,0x95,0xC7,0x68,0x08,0x74,0x26,
+0xB3,0x22,0xDC,0x5F,0xB5,0x7C,0xF0,0x55,
+0x54,0x40,0x62,0x31,0x98,0x34,0x07,0x66,
+0x06,0xDF,0x32,0xC9,0xA9,0xE9,0x00,0x00,
+0x00,0xAD,0x9D,0xCE,0x0D,0x01,0x01,0x37,
+0x37,0x37,0x00,0x00,0x00,
+/* level2_key Disable */
+0x39,0x01,0x00,0x00,0x00,0x00,0x03,0xF0,0xA5,0xA5
+}
+
+};
+EXPORT_SYMBOL(gamma_para);
+
+const char *gamma_cmd_set_map[DSI_GAMMA_CMD_SET_MAX] = {
+	"dsi-gamma-cmd-set-switch-60hz",
+	"dsi-gamma-cmd-set-switch-90hz",
+};
+
+int gamma_read_flag = GAMMA_READ_SUCCESS;
+
+char dsi_panel_name = DSI_PANEL_SAMSUNG_S6E3FC2X01;
+EXPORT_SYMBOL(dsi_panel_name);
+
 int dsi_dsc_create_pps_buf_cmd(struct msm_display_dsc_info *dsc, char *buf,
 				int pps_id)
 {
@@ -445,11 +598,13 @@ static int dsi_panel_power_on(struct dsi_panel *panel)
 		goto error_disable_vregs;
 	}
 
-	rc = dsi_panel_reset(panel);
-	if (rc) {
-		pr_err("[%s] failed to reset panel, rc=%d\n", panel->name, rc);
-		goto error_disable_gpio;
-	}
+    if (!panel->lp11_init){
+		rc = dsi_panel_reset(panel);
+		if (rc) {
+			pr_err("[%s] failed to reset panel, rc=%d\n", panel->name, rc);
+			goto error_disable_gpio;
+		}
+    }
 
 	goto exit;
 
@@ -481,6 +636,7 @@ static int dsi_panel_power_off(struct dsi_panel *panel)
 
 	if (gpio_is_valid(panel->reset_config.lcd_mode_sel_gpio))
 		gpio_set_value(panel->reset_config.lcd_mode_sel_gpio, 0);
+	msleep(30);
 
 	rc = dsi_panel_set_pinctrl_state(panel, false);
 	if (rc) {
@@ -494,7 +650,7 @@ static int dsi_panel_power_off(struct dsi_panel *panel)
 
 	return rc;
 }
-static int dsi_panel_tx_cmd_set(struct dsi_panel *panel,
+int dsi_panel_tx_cmd_set(struct dsi_panel *panel,
 				enum dsi_cmd_set_type type)
 {
 	int rc = 0, i = 0;
@@ -606,23 +762,137 @@ static int dsi_panel_wled_register(struct dsi_panel *panel,
 	return rc;
 }
 
+bool HBM_flag =false;
+
+int dsi_panel_gamma_read_address_setting(struct dsi_panel *panel, u16 read_number)
+{
+	int rc = 0;
+	struct mipi_dsi_device *dsi;
+
+	if (!panel || (read_number > 0xffff)) {
+		pr_err("invalid params\n");
+		return -EINVAL;
+	}
+
+	dsi = &panel->mipi_device;
+
+	rc = mipi_dsi_dcs_write_c1(dsi, read_number);
+
+	return rc;
+}
+
 static int dsi_panel_update_backlight(struct dsi_panel *panel,
 	u32 bl_lvl)
 {
 	int rc = 0;
+	u32 count;
 	struct mipi_dsi_device *dsi;
+	struct dsi_display_mode *mode;
 
-	if (!panel || (bl_lvl > 0xffff)) {
+	if (!panel || (bl_lvl > 0xffff) || !panel->cur_mode) {
 		pr_err("invalid params\n");
 		return -EINVAL;
 	}
 
 	dsi = &panel->mipi_device;
+	mode = panel->cur_mode;
+
+	if (panel->is_hbm_enabled) {
+		hbm_finger_print = true;
+		pr_err("HBM is enabled\n");
+		return 0;
+	}
+
+	if (panel->bl_config.bl_high2bit) {
+		if (HBM_flag == true)
+			return 0;
+
+		if (cur_backlight == bl_lvl && (mode_fps != cur_fps ||
+				 cur_h != panel->cur_mode->timing.h_active) && !hbm_finger_print) {
+			cur_fps = mode_fps;
+			cur_h = panel->cur_mode->timing.h_active;
+			return 0;
+		}
+
+		if (hbm_brightness_flag == 1) {
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_BRIGHTNESS_OFF].count;
+			if (!count) {
+				pr_err("This panel does not support HBM brightness off mode.\n");
+				goto error;
+			}
+			else {
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_BRIGHTNESS_OFF);
+				pr_err("Send DSI_CMD_SET_HBM_BRIGHTNESS_OFF cmds.\n");
+				hbm_brightness_flag = 0;
+			}
+		}
 
-	rc = mipi_dsi_dcs_set_display_brightness(dsi, bl_lvl);
+		rc = mipi_dsi_dcs_set_display_brightness_samsung(dsi, bl_lvl);
+		pr_err("backlight = %d\n", bl_lvl);
+		cur_backlight = bl_lvl;
+		cur_fps = mode_fps;
+		cur_h = panel->cur_mode->timing.h_active;
+		hbm_finger_print = false;
+	}
+	else
+		rc = mipi_dsi_dcs_set_display_brightness(dsi,
+			bl_lvl);
 	if (rc < 0)
 		pr_err("failed to update dcs backlight:%d\n", bl_lvl);
 
+error:
+	return rc;
+}
+
+int dsi_panel_op_set_hbm_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+
+	mutex_lock(&panel->panel_lock);
+
+    mode = panel->cur_mode;
+    switch (level) {
+    case 0:
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_OFF].count;
+        if (!count) {
+            pr_err("This panel does not support HBM mode off.\n");
+            goto error;
+        } else {
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_OFF);
+			printk(KERN_ERR"When HBM OFF -->hbm_backight = %d panel->bl_config.bl_level =%d\n",panel->hbm_backlight,panel->bl_config.bl_level);
+			rc= dsi_panel_update_backlight(panel,panel->hbm_backlight);
+        }
+    break;
+
+    case 1:
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_5].count;
+        if (!count) {
+            pr_err("This panel does not support HBM mode.\n");
+            goto error;
+        } else {
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_5);
+        }
+    break;
+    default:
+    break;
+
+    }
+    pr_err("Set HBM Mode = %d\n", level);
+	if(level==5)
+	{
+		pr_err("HBM == 5 for fingerprint\n");
+	}
+
+error:
+	mutex_unlock(&panel->panel_lock);
+
 	return rc;
 }
 
@@ -631,15 +901,14 @@ int dsi_panel_set_backlight(struct dsi_panel *panel, u32 bl_lvl)
 	int rc = 0;
 	struct dsi_backlight_config *bl = &panel->bl_config;
 
-	if (panel->host_config.ext_bridge_mode)
-		return 0;
-
 	pr_debug("backlight type:%d lvl:%d\n", bl->type, bl_lvl);
+
 	switch (bl->type) {
 	case DSI_BACKLIGHT_WLED:
 		rc = backlight_device_set_brightness(bl->raw_bd, bl_lvl);
 		break;
 	case DSI_BACKLIGHT_DCS:
+		panel->hbm_backlight = bl_lvl;
 		rc = dsi_panel_update_backlight(panel, bl_lvl);
 		break;
 	case DSI_BACKLIGHT_EXTERNAL:
@@ -1186,6 +1455,48 @@ static int dsi_panel_parse_qsync_caps(struct dsi_panel *panel,
 	return rc;
 }
 
+static int dsi_panel_parse_dyn_clk_caps(struct dsi_panel *panel)
+{
+	int rc = 0;
+	bool supported = false;
+	struct dsi_dyn_clk_caps *dyn_clk_caps = &panel->dyn_clk_caps;
+	struct dsi_parser_utils *utils = &panel->utils;
+	const char *name = panel->name;
+
+	supported = utils->read_bool(utils->data, "qcom,dsi-dyn-clk-enable");
+
+	if (!supported) {
+		dyn_clk_caps->dyn_clk_support = false;
+		return rc;
+	}
+
+	dyn_clk_caps->bit_clk_list_len = utils->count_u32_elems(utils->data,
+			"qcom,dsi-dyn-clk-list");
+
+	if (dyn_clk_caps->bit_clk_list_len < 1) {
+		pr_err("[%s] failed to get supported bit clk list\n", name);
+		return -EINVAL;
+	}
+
+	dyn_clk_caps->bit_clk_list = kcalloc(dyn_clk_caps->bit_clk_list_len,
+			sizeof(u32), GFP_KERNEL);
+	if (!dyn_clk_caps->bit_clk_list)
+		return -ENOMEM;
+
+	rc = utils->read_u32_array(utils->data, "qcom,dsi-dyn-clk-list",
+			dyn_clk_caps->bit_clk_list,
+			dyn_clk_caps->bit_clk_list_len);
+
+	if (rc) {
+		pr_err("[%s] failed to parse supported bit clk list\n", name);
+		return -EINVAL;
+	}
+
+	dyn_clk_caps->dyn_clk_support = true;
+
+	return 0;
+}
+
 static int dsi_panel_parse_dfps_caps(struct dsi_panel *panel)
 {
 	int rc = 0;
@@ -1194,7 +1505,7 @@ static int dsi_panel_parse_dfps_caps(struct dsi_panel *panel)
 	struct dsi_parser_utils *utils = &panel->utils;
 	const char *name = panel->name;
 	const char *type;
-	u32 val = 0;
+	u32 i;
 
 	supported = utils->read_bool(utils->data,
 			"qcom,mdss-dsi-pan-enable-dynamic-fps");
@@ -1202,66 +1513,64 @@ static int dsi_panel_parse_dfps_caps(struct dsi_panel *panel)
 	if (!supported) {
 		pr_debug("[%s] DFPS is not supported\n", name);
 		dfps_caps->dfps_support = false;
+		return rc;
+	}
+
+	type = utils->get_property(utils->data,
+			"qcom,mdss-dsi-pan-fps-update", NULL);
+	if (!type) {
+		pr_err("[%s] dfps type not defined\n", name);
+		rc = -EINVAL;
+		goto error;
+	} else if (!strcmp(type, "dfps_suspend_resume_mode")) {
+		dfps_caps->type = DSI_DFPS_SUSPEND_RESUME;
+	} else if (!strcmp(type, "dfps_immediate_clk_mode")) {
+		dfps_caps->type = DSI_DFPS_IMMEDIATE_CLK;
+	} else if (!strcmp(type, "dfps_immediate_porch_mode_hfp")) {
+		dfps_caps->type = DSI_DFPS_IMMEDIATE_HFP;
+	} else if (!strcmp(type, "dfps_immediate_porch_mode_vfp")) {
+		dfps_caps->type = DSI_DFPS_IMMEDIATE_VFP;
 	} else {
+		pr_err("[%s] dfps type is not recognized\n", name);
+		rc = -EINVAL;
+		goto error;
+	}
 
-		type = utils->get_property(utils->data,
-				       "qcom,mdss-dsi-pan-fps-update",
-				       NULL);
-		if (!type) {
-			pr_err("[%s] dfps type not defined\n", name);
-			rc = -EINVAL;
-			goto error;
-		} else if (!strcmp(type, "dfps_suspend_resume_mode")) {
-			dfps_caps->type = DSI_DFPS_SUSPEND_RESUME;
-		} else if (!strcmp(type, "dfps_immediate_clk_mode")) {
-			dfps_caps->type = DSI_DFPS_IMMEDIATE_CLK;
-		} else if (!strcmp(type, "dfps_immediate_porch_mode_hfp")) {
-			dfps_caps->type = DSI_DFPS_IMMEDIATE_HFP;
-		} else if (!strcmp(type, "dfps_immediate_porch_mode_vfp")) {
-			dfps_caps->type = DSI_DFPS_IMMEDIATE_VFP;
-		} else {
-			pr_err("[%s] dfps type is not recognized\n", name);
-			rc = -EINVAL;
-			goto error;
-		}
+	dfps_caps->dfps_list_len = utils->count_u32_elems(utils->data,
+				  "qcom,dsi-supported-dfps-list");
+	if (dfps_caps->dfps_list_len < 1) {
+		pr_err("[%s] dfps refresh list not present\n", name);
+		rc = -EINVAL;
+		goto error;
+	}
 
-		rc = utils->read_u32(utils->data,
-					  "qcom,mdss-dsi-min-refresh-rate",
-					  &val);
-		if (rc) {
-			pr_err("[%s] Min refresh rate is not defined\n", name);
-			rc = -EINVAL;
-			goto error;
-		}
-		dfps_caps->min_refresh_rate = val;
+	dfps_caps->dfps_list = kcalloc(dfps_caps->dfps_list_len, sizeof(u32),
+			GFP_KERNEL);
+	if (!dfps_caps->dfps_list) {
+		rc = -ENOMEM;
+		goto error;
+	}
 
-		rc = utils->read_u32(utils->data,
-					  "qcom,mdss-dsi-max-refresh-rate",
-					  &val);
-		if (rc) {
-			pr_debug("[%s] Using default refresh rate\n", name);
-			rc = utils->read_u32(utils->data,
-						"qcom,mdss-dsi-panel-framerate",
-						&val);
-			if (rc) {
-				pr_err("[%s] max refresh rate is not defined\n",
-				       name);
-				rc = -EINVAL;
-				goto error;
-			}
-		}
-		dfps_caps->max_refresh_rate = val;
+	rc = utils->read_u32_array(utils->data,
+			"qcom,dsi-supported-dfps-list",
+			dfps_caps->dfps_list,
+			dfps_caps->dfps_list_len);
+	if (rc) {
+		pr_err("[%s] dfps refresh rate list parse failed\n", name);
+		rc = -EINVAL;
+		goto error;
+	}
+	dfps_caps->dfps_support = true;
 
-		if (dfps_caps->min_refresh_rate > dfps_caps->max_refresh_rate) {
-			pr_err("[%s] min rate > max rate\n", name);
-			rc = -EINVAL;
-		}
+	/* calculate max and min fps */
+	dfps_caps->max_refresh_rate = dfps_caps->dfps_list[0];
+	dfps_caps->min_refresh_rate = dfps_caps->dfps_list[0];
 
-		pr_debug("[%s] DFPS is supported %d-%d, mode %d\n", name,
-				dfps_caps->min_refresh_rate,
-				dfps_caps->max_refresh_rate,
-				dfps_caps->type);
-		dfps_caps->dfps_support = true;
+	for (i = 1; i < dfps_caps->dfps_list_len; i++) {
+		if (dfps_caps->dfps_list[i] < dfps_caps->min_refresh_rate)
+			dfps_caps->min_refresh_rate = dfps_caps->dfps_list[i];
+		else if (dfps_caps->dfps_list[i] > dfps_caps->max_refresh_rate)
+			dfps_caps->max_refresh_rate = dfps_caps->dfps_list[i];
 	}
 
 error:
@@ -1524,6 +1833,67 @@ const char *cmd_set_prop_map[DSI_CMD_SET_MAX] = {
 	"qcom,mdss-dsi-post-mode-switch-on-command",
 	"qcom,mdss-dsi-qsync-on-commands",
 	"qcom,mdss-dsi-qsync-off-commands",
+	"qcom,mdss-dsi-panel-hbm-brightness-on-command",
+	"qcom,mdss-dsi-panel-hbm-brightness-off-command",
+	"qcom,mdss-dsi-panel-hbm-on-command-1",
+	"qcom,mdss-dsi-panel-hbm-on-command-2",
+	"qcom,mdss-dsi-panel-hbm-on-command-3",
+	"qcom,mdss-dsi-panel-hbm-on-command-4",
+	"qcom,mdss-dsi-panel-hbm-on-command-5",
+	"qcom,mdss-dsi-panel-hbm-off-command",
+	"qcom,mdss-dsi-panel-serial-num-command",
+	"qcom,mdss-dsi-panel-aod-on-command-1",
+	"qcom,mdss-dsi-panel-aod-on-command-2",
+	"qcom,mdss-dsi-panel-aod-off-command",
+	"qcom,mdss-dsi-panel-aod-off-hbm-on-command",
+	"qcom,mdss-dsi-panel-aod-off-new-command",
+	"qcom,mdss-dsi-panel-hbm-off-aod-on-command",
+	"qcom,mdss-dsi-panel-aod-off-samsung-command",
+	"qcom,mdss-dsi-panel-dci-p3-on-command",
+	"qcom,mdss-dsi-panel-dci-p3-off-command",
+	"qcom,mdss-dsi-panel-night-mode-on-command",
+	"qcom,mdss-dsi-panel-night-mode-off-command",
+	"qcom,mdss-dsi-panel-id-command",
+	"qcom,mdss-dsi-panel-read-register-open-command",
+	"qcom,mdss-dsi-panel-id1-command",
+	"qcom,mdss-dsi-panel-id2-command",
+	"qcom,mdss-dsi-panel-id3-command",
+	"qcom,mdss-dsi-panel-id4-command",
+	"qcom,mdss-dsi-panel-id5-command",
+	"qcom,mdss-dsi-panel-id6-command",
+	"qcom,mdss-dsi-panel-id7-command",
+	"qcom,mdss-dsi-panel-read-register-close-command",
+	"qcom,mdss-dsi-acl-command",
+	"qcom,mdss-dsi-panel-serial-num-pre-command",
+	"qcom,mdss-dsi-panel-serial-num-post-command",
+	"qcom,mdss-dsi-panel-stage-info-command",
+	"qcom,mdss-dsi-panel-production-info-command",
+	"qcom,mdss-dsi-panel-read-esd-registed-longread-command",
+	"qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command",
+	"qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command",
+	"qcom,mdss-dsi-panel-gamma-flash-read-fb-command",
+	"qcom,mdss-dsi-panel-level2-key-enable-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c8-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c9-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command",
+	"qcom,mdss-dsi-panel-gamma-otp-read-b3-command",
+	"qcom,mdss-dsi-panel-level2-key-disable-command",
+	"qcom,mdss-dsi-panel-display-p3-mode-on-command",
+	"qcom,mdss-dsi-panel-display-p3-mode-off-command",
+	"qcom,mdss-dsi-panel-display-wide-color-mode-on-command",
+	"qcom,mdss-dsi-panel-display-wide-color-mode-off-command",
+	"qcom,mdss-dsi-panel-display-srgb-color-mode-on-command",
+	"qcom,mdss-dsi-panel-display-srgb-color-mode-off-command",
+	"qcom,mdss-113mhz-osc-dsi-on-command",
+	"qcom,mdss-dsi-post-on-backlight",
+	"qcom,mdss-dsi-laoding-effect-enable-command",
+	"qcom,mdss-dsi-laoding-effect-disable-command",
+	"qcom,mdss-dsi-customer-srgb-enable-command",
+	"qcom,mdss-dsi-customer-srgb-disable-command",
+	"qcom,mdss-dsi-customer-p3-enable-command",
+	"qcom,mdss-dsi-customer-p3-disable-command",
 };
 
 const char *cmd_set_state_map[DSI_CMD_SET_MAX] = {
@@ -1550,6 +1920,68 @@ const char *cmd_set_state_map[DSI_CMD_SET_MAX] = {
 	"qcom,mdss-dsi-post-mode-switch-on-command-state",
 	"qcom,mdss-dsi-qsync-on-commands-state",
 	"qcom,mdss-dsi-qsync-off-commands-state",
+	"qcom,mdss-dsi-panel-hbm-brightness-on-command-state",
+	"qcom,mdss-dsi-panel-hbm-brightness-off-command-state",
+	"qcom,mdss-dsi-panel-hbm-on-command-1-state",
+	"qcom,mdss-dsi-panel-hbm-on-command-2-state",
+	"qcom,mdss-dsi-panel-hbm-on-command-3-state",
+	"qcom,mdss-dsi-panel-hbm-on-command-4-state",
+	"qcom,mdss-dsi-panel-hbm-on-command-5-state",
+	"qcom,mdss-dsi-panel-hbm-off-command-state",
+	"qcom,mdss-dsi-panel-serial-num-command-state",
+	"qcom,mdss-dsi-panel-aod-on-command-1-state",
+	"qcom,mdss-dsi-panel-aod-on-command-2-state",
+	"qcom,mdss-dsi-panel-aod-off-command-state",
+	"qcom,mdss-dsi-panel-aod-off-hbm-on-command-state",
+	"qcom,mdss-dsi-panel-aod-off-new-command-state",
+	"qcom,mdss-dsi-panel-hbm-off-aod-on-command-state",
+	"qcom,mdss-dsi-panel-aod-off-samsung-command-state",
+	"qcom,mdss-dsi-panel-dci-p3-on-command-state",
+	"qcom,mdss-dsi-panel-dci-p3-off-command-state",
+	"qcom,mdss-dsi-panel-night-mode-on-command-state",
+	"qcom,mdss-dsi-panel-night-mode-off-command-state",
+	"qcom,mdss-dsi-panel-id-command-state",
+	"qcom,mdss-dsi-panel-read-register-open-command-state",
+	"qcom,mdss-dsi-panel-id1-command-state",
+	"qcom,mdss-dsi-panel-id2-command-state",
+	"qcom,mdss-dsi-panel-id3-command-state",
+	"qcom,mdss-dsi-panel-id4-command-state",
+	"qcom,mdss-dsi-panel-id5-command-state",
+	"qcom,mdss-dsi-panel-id6-command-state",
+	"qcom,mdss-dsi-panel-id7-command-state",
+	"qcom,mdss-dsi-panel-read-register-close-command-state",
+	"qcom,mdss-dsi-acl-command-state",
+	"qcom,mdss-dsi-panel-serial-num-pre-command-state",
+	"qcom,mdss-dsi-panel-serial-num-post-command-state",
+	"qcom,mdss-dsi-panel-stage-info-command-state",
+	"qcom,mdss-dsi-panel-production-info-command-state",
+	"qcom,mdss-dsi-panel-read-esd-registed-longread-command-state",
+	"qcom,mdss-dsi-panel-gamma-flash-pre-read-1-command-state",
+	"qcom,mdss-dsi-panel-gamma-flash-pre-read-2-command-state",
+	"qcom,mdss-dsi-panel-gamma-flash-read-fb-command-state",
+	"qcom,mdss-dsi-panel-level2-key-enable-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c8-smrps-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c8-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c9-smrps-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-c9-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-b3-smrps-command-state",
+	"qcom,mdss-dsi-panel-gamma-otp-read-b3-command-state",
+	"qcom,mdss-dsi-panel-level2-key-disable-command-state",
+	"qcom,mdss-dsi-panel-display-p3-mode-on-command-state",
+	"qcom,mdss-dsi-panel-display-p3-mode-off-command-state",
+	"qcom,mdss-dsi-panel-display-wide-color-mode-on-command-state",
+	"qcom,mdss-dsi-panel-display-wide-color-mode-off-command-state",
+	"qcom,mdss-dsi-panel-display-srgb-color-mode-on-command-state",
+	"qcom,mdss-dsi-panel-display-srgb-color-mode-off-command-state",
+	"qcom,mdss-113mhz-osc-dsi-on-command-state",
+	"qcom,mdss-dsi-post-on-backlight-state",
+	"qcom,mdss-dsi-laoding-effect-enable-command-state",
+	"qcom,mdss-dsi-laoding-effect-disable-command-state",
+	"qcom,mdss-dsi-customer-srgb-enable-command-state",
+	"qcom,mdss-dsi-customer-srgb-disable-command-state",
+	"qcom,mdss-dsi-customer-p3-enable-command-state",
+	"qcom,mdss-dsi-customer-p3-disable-command-state",
+
 };
 
 static int dsi_panel_get_cmd_pkt_count(const char *data, u32 length, u32 *cnt)
@@ -1660,7 +2092,6 @@ static int dsi_panel_parse_cmd_sets_sub(struct dsi_panel_cmd_set *cmd,
 	const char *data;
 	const char *state;
 	u32 packet_count = 0;
-
 	data = utils->get_property(utils->data, cmd_set_prop_map[type],
 			&length);
 	if (!data) {
@@ -1706,7 +2137,6 @@ static int dsi_panel_parse_cmd_sets_sub(struct dsi_panel_cmd_set *cmd,
 		       cmd_set_state_map[type], state);
 		goto error_free_mem;
 	}
-
 	return rc;
 error_free_mem:
 	kfree(cmd->cmds);
@@ -1739,7 +2169,7 @@ static int dsi_panel_parse_cmd_sets(
 			if (rc)
 				pr_err("failed to allocate cmd set %d, rc = %d\n",
 					i, rc);
-			set->state = DSI_CMD_SET_STATE_LP;
+			set->state = DSI_CMD_SET_STATE_HS;
 		} else {
 			rc = dsi_panel_parse_cmd_sets_sub(set, i, utils);
 			if (rc)
@@ -2098,6 +2528,16 @@ static int dsi_panel_parse_bl_config(struct dsi_panel *panel)
 		panel->bl_config.bl_max_level = val;
 	}
 
+	rc = utils->read_u32(utils->data, "qcom,mdss-brightness-default-val", &val);
+	if (rc) {
+		pr_debug("[%s] brightness-default-val unspecified, defaulting to val\n",
+			 panel->name);
+		panel->bl_config.bl_def_val = 200;
+	} else {
+		panel->bl_config.bl_def_val = val;
+	}
+	pr_err("default backlight bl_def_val= %d\n",panel->bl_config.bl_def_val);
+
 	rc = utils->read_u32(utils->data, "qcom,mdss-brightness-max-level",
 		&val);
 	if (rc) {
@@ -2725,6 +3165,94 @@ static int dsi_panel_parse_dms_info(struct dsi_panel *panel)
 	return 0;
 };
 
+static int dsi_panel_parse_oem_config(struct dsi_panel *panel,
+				     struct device_node *of_node)
+{
+    u32 tmp;
+    int rc;
+    static const char *panel_manufacture;
+    static const char *panel_version;
+    static const char *backlight_manufacture;
+    static const char *backlight_version;
+
+		pr_err("%s start\n", __func__);
+
+	panel_manufacture = of_get_property(of_node,
+	    "qcom,mdss-dsi-panel-manufacture", NULL);
+    if (!panel_manufacture)
+		pr_info("%s:%d, panel manufacture not specified\n",
+                __func__, __LINE__);
+	panel_version = of_get_property(of_node,
+	    "qcom,mdss-dsi-panel-version", NULL);
+	if (!panel_version)
+		pr_info("%s:%d, panel version not specified\n",
+                __func__, __LINE__);
+
+	push_component_info(LCD, (char *)panel_version,(char *)panel_manufacture);
+
+	backlight_manufacture = of_get_property(of_node,
+                    "qcom,mdss-dsi-backlight-manufacture", NULL);
+	if (!backlight_manufacture)
+		pr_info("%s:%d, backlight manufacture not specified\n",
+                    __func__, __LINE__);
+	backlight_version = of_get_property(of_node,
+	                    "qcom,mdss-dsi-backlight-version", NULL);
+	if (!backlight_version)
+		pr_info("%s:%d, backlight version not specified\n",
+                    __func__, __LINE__);
+
+	push_component_info(BACKLIGHT, (char *)backlight_version,
+	                    (char *)backlight_manufacture);
+
+	panel->lp11_init =
+		of_property_read_bool(of_node, "qcom,mdss-dsi-lp11-init");
+	if (panel->lp11_init)
+		pr_info("lp11_init:%d\n", panel->lp11_init);
+
+	panel->bl_config.bl_high2bit =
+	    of_property_read_bool(of_node, "qcom,mdss-bl-high2bit");
+	if (panel->bl_config.bl_high2bit) {
+		pr_info("bl_high2bit:%d\n", panel->bl_config.bl_high2bit);
+	}
+
+    tmp = 0;
+	rc = of_property_read_u32(of_node, "qcom,mdss-dsi-acl-cmd-index", &tmp);
+	panel->acl_cmd_index = (!rc ? tmp : 0);
+
+	tmp = 0;
+	rc = of_property_read_u32(of_node, "qcom,mdss-dsi-acl-mode-index", &tmp);
+	panel->acl_mode_index = (!rc ? tmp : 0);
+
+    rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-year-index", &tmp);
+	panel->panel_year_index = (!rc ? tmp : 0);
+
+    rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-mon-index", &tmp);
+	panel->panel_mon_index = (!rc ? tmp : 0);
+
+    rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-day-index", &tmp);
+	panel->panel_day_index = (!rc ? tmp : 0);
+
+    rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-hour-index", &tmp);
+	panel->panel_hour_index = (!rc ? tmp : 0);
+
+	rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-min-index", &tmp);
+	panel->panel_min_index = (!rc ? tmp : 0);
+
+	rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-seria-num-sec-index", &tmp);
+	panel->panel_sec_index = (!rc ? tmp : 0);
+
+    tmp = 0;
+	rc = of_property_read_u32(of_node, "qcom,mdss-dsi-panel-status-value-2", &tmp);
+	panel->status_value = (!rc ? tmp : 0);
+
+	panel->panel_mismatch_check =
+		of_property_read_bool(of_node, "qcom,mdss-panel-mismatch-check");
+
+			pr_err("%s end\n", __func__);
+
+	return 0;
+}
+
 /*
  * The length of all the valid values to be checked should not be greater
  * than the length of returned data from read command.
@@ -3015,7 +3543,15 @@ struct dsi_panel *dsi_panel_get(struct device *parent,
 
 	panel->name = utils->get_property(utils->data,
 				"qcom,mdss-dsi-panel-name", NULL);
-	if (!panel->name)
+	if (strcmp(panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) {
+		dsi_panel_name = DSI_PANEL_SAMSUNG_S6E3HC2;
+		pr_err("Dsi panel name is DSI_PANEL_SAMSUNG_S6E3HC2");
+	}
+	else if (strcmp(panel->name, "samsung s6e3fc2x01 cmd mode dsi panel") == 0) {
+		dsi_panel_name = DSI_PANEL_SAMSUNG_S6E3FC2X01;
+		pr_err("Dsi panel name is DSI_PANEL_SAMSUNG_S6E3FC2X01");
+	}
+	else if (!panel->name)
 		panel->name = DSI_PANEL_DEFAULT_LABEL;
 
 	rc = dsi_panel_parse_host_config(panel);
@@ -3040,6 +3576,17 @@ struct dsi_panel *dsi_panel_get(struct device *parent,
 		if (rc)
 			pr_err("failed to parse qsync features, rc=%d\n", rc);
 	}
+/*
+	if (panel->panel_mode == DSI_OP_VIDEO_MODE) {
+		rc = dsi_panel_parse_dyn_clk_caps(panel);
+		if (rc)
+			pr_err("failed to parse dynamic clk config, rc=%d\n",
+					rc);
+	}
+*/
+	rc = dsi_panel_parse_dyn_clk_caps(panel);
+	if (rc)
+	pr_err("failed to parse dynamic clk config, rc=%d\n", rc);
 
 	rc = dsi_panel_parse_phy_props(panel);
 	if (rc) {
@@ -3069,6 +3616,9 @@ struct dsi_panel *dsi_panel_get(struct device *parent,
 	rc = dsi_panel_parse_hdr_config(panel);
 	if (rc)
 		pr_err("failed to parse hdr config, rc=%d\n", rc);
+		rc = dsi_panel_parse_oem_config(panel, of_node);
+		if (rc)
+			pr_debug("failed to get oem config, rc=%d\n", rc);
 
 	rc = dsi_panel_get_mode_count(panel);
 	if (rc) {
@@ -3311,6 +3861,7 @@ int dsi_panel_get_mode(struct dsi_panel *panel,
 		pr_err("invalid params\n");
 		return -EINVAL;
 	}
+	pr_err("%s start\n", __func__);
 
 	mutex_lock(&panel->panel_lock);
 	utils = &panel->utils;
@@ -3389,6 +3940,8 @@ int dsi_panel_get_mode(struct dsi_panel *panel,
 	}
 	goto done;
 
+		pr_err("%s end\n", __func__);
+
 parse_fail:
 	kfree(mode->priv_info);
 	mode->priv_info = NULL;
@@ -3403,6 +3956,7 @@ int dsi_panel_get_host_cfg_for_mode(struct dsi_panel *panel,
 				    struct dsi_host_config *config)
 {
 	int rc = 0;
+	struct dsi_dyn_clk_caps *dyn_clk_caps = &panel->dyn_clk_caps;
 
 	if (!panel || !mode || !config) {
 		pr_err("invalid params\n");
@@ -3430,7 +3984,12 @@ int dsi_panel_get_host_cfg_for_mode(struct dsi_panel *panel,
 	config->video_timing.dsc_enabled = mode->priv_info->dsc_enabled;
 	config->video_timing.dsc = &mode->priv_info->dsc;
 
+//	config->bit_clk_rate_hz_override = mode->timing.clk_rate_hz;
+	if (dyn_clk_caps->dyn_clk_support)
+	config->bit_clk_rate_hz_override = mode->timing.clk_rate_hz;
+	else
 	config->bit_clk_rate_hz_override = mode->priv_info->clk_rate_hz;
+
 	config->esc_clk_rate_hz = 19200000;
 	mutex_unlock(&panel->panel_lock);
 	return rc;
@@ -3439,6 +3998,9 @@ int dsi_panel_get_host_cfg_for_mode(struct dsi_panel *panel,
 int dsi_panel_pre_prepare(struct dsi_panel *panel)
 {
 	int rc = 0;
+	int ret = 0;
+	struct device_node *np;
+	np = panel->parent->of_node;
 
 	if (!panel) {
 		pr_err("invalid params\n");
@@ -3448,8 +4010,30 @@ int dsi_panel_pre_prepare(struct dsi_panel *panel)
 	mutex_lock(&panel->panel_lock);
 
 	/* If LP11_INIT is set, panel will be powered up during prepare() */
-	if (panel->lp11_init)
-		goto error;
+	//	if (panel->lp11_init)
+	//		goto error;
+
+	panel->tp_enable1v8_gpio = of_get_named_gpio(np, "enable1v8_gpio", 0);
+	if (panel->tp_enable1v8_gpio < 0) {
+		pr_err("panel->tp_enable1v8_gpio not specified\n");
+	}
+	else {
+		if (gpio_is_valid(panel->tp_enable1v8_gpio)) {
+			rc = gpio_request(panel->tp_enable1v8_gpio, "tpvcc1v8-gpio");
+			if (rc) {
+				pr_err("unable to request gpio [%d], %d\n", panel->tp_enable1v8_gpio, rc);
+			}
+		}
+	}
+
+	if (panel->tp_enable1v8_gpio > 0) {
+		pr_err("enable tp 1v8 gpio\n");
+		ret = gpio_direction_output(panel->tp_enable1v8_gpio, 1);
+		if (ret) {
+			pr_err("enable the enable1v8_gpio failed.\n");
+			return ret;
+		}
+	}
 
 	rc = dsi_panel_power_on(panel);
 	if (rc) {
@@ -3513,6 +4097,9 @@ int dsi_panel_set_lp1(struct dsi_panel *panel)
 	if (rc)
 		pr_err("[%s] failed to send DSI_CMD_SET_LP1 cmd, rc=%d\n",
 		       panel->name, rc);
+	
+	panel->need_power_on_backlight = true;
+
 	mutex_unlock(&panel->panel_lock);
 	return rc;
 }
@@ -3564,15 +4151,16 @@ int dsi_panel_prepare(struct dsi_panel *panel)
 
 	mutex_lock(&panel->panel_lock);
 
-	if (panel->lp11_init) {
-		rc = dsi_panel_power_on(panel);
-		if (rc) {
-			pr_err("[%s] panel power on failed, rc=%d\n",
-			       panel->name, rc);
-			goto error;
-		}
-	}
-
+    if (panel->lp11_init){
+        rc = dsi_panel_set_pinctrl_state(panel, true);
+        if (rc) {
+            pr_err("[%s] failed to set pinctrl, rc=%d\n", panel->name, rc);
+        }
+        rc = dsi_panel_reset(panel);
+        if (rc) {
+            pr_err("[%s] failed to reset panel, rc=%d\n", panel->name, rc);
+        }
+    }
 	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_PRE_ON);
 	if (rc) {
 		pr_err("[%s] failed to send DSI_CMD_SET_PRE_ON cmds, rc=%d\n",
@@ -3752,14 +4340,33 @@ int dsi_panel_switch(struct dsi_panel *panel)
 		pr_err("Invalid params\n");
 		return -EINVAL;
 	}
-
+	if (strcmp(panel->name, "samsung dsc cmd mode oneplus dsi panel") != 0) {
+		return rc;
+	}
 	mutex_lock(&panel->panel_lock);
 
 	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_TIMING_SWITCH);
 	if (rc)
-		pr_err("[%s] failed to send DSI_CMD_SET_TIMING_SWITCH cmds, rc=%d\n",
+		pr_err("[%s] Failed to send DSI_CMD_SET_TIMING_SWITCH cmds, rc=%d\n",
 		       panel->name, rc);
-
+	pr_err("Send DSI_CMD_SET_TIMING_SWITCH cmds\n");
+	pr_err("panel->cur_mode->timing->h_active = %d\n", panel->cur_mode->timing.h_active);
+	if((strcmp(panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) && (gamma_read_flag == GAMMA_READ_SUCCESS)) {
+		if (mode_fps == 90) {
+			rc = dsi_panel_tx_gamma_cmd_set(panel, DSI_GAMMA_CMD_SET_SWITCH_90HZ);
+			pr_err("Send DSI_GAMMA_CMD_SET_SWITCH_90HZ cmds\n");
+			if (rc)
+				pr_err("[%s] Failed to send DSI_GAMMA_CMD_SET_SWITCH_90HZ cmds, rc=%d\n",
+					panel->name, rc);
+		}
+		else {
+			rc = dsi_panel_tx_gamma_cmd_set(panel, DSI_GAMMA_CMD_SET_SWITCH_60HZ);
+			pr_err("Send DSI_GAMMA_CMD_SET_SWITCH_60HZ cmds\n");
+			if (rc)
+				pr_err("[%s] Failed to send DSI_GAMMA_CMD_SET_SWITCH_60HZ cmds, rc=%d\n",
+					panel->name, rc);
+		}
+	}
 	mutex_unlock(&panel->panel_lock);
 	return rc;
 }
@@ -3774,7 +4381,7 @@ int dsi_panel_post_switch(struct dsi_panel *panel)
 	}
 
 	mutex_lock(&panel->panel_lock);
-
+    pr_err("%s: Send the command DSI_CMD_SET_POST_TIMING_SWITCH \n", __func__);
 	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_POST_TIMING_SWITCH);
 	if (rc)
 		pr_err("[%s] failed to send DSI_CMD_SET_POST_TIMING_SWITCH cmds, rc=%d\n",
@@ -3792,16 +4399,68 @@ int dsi_panel_enable(struct dsi_panel *panel)
 		pr_err("Invalid params\n");
 		return -EINVAL;
 	}
+	pr_err("start\n");
+	SDE_ATRACE_BEGIN("dsi_panel_enable");
 
+	SDE_ATRACE_BEGIN("mutex_lock");
 	mutex_lock(&panel->panel_lock);
+	SDE_ATRACE_END("mutex_lock");
 
-	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_ON);
+	SDE_ATRACE_BEGIN("dsi_panel_tx_cmd_set");
+	if ((EVT2_113MHZ_OSC == panel->panel_stage_info) || (PVT_113MHZ_OSC == panel->panel_stage_info) || (PVT_113MHZ_OSC_XTALK == panel->panel_stage_info)) {
+		rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_113MHZ_OSC_ON);
+		pr_err("Send DSI_CMD_SET_113MHZ_OSC_ON cmds\n");
+	}
+	else {
+		rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_ON);
+		pr_err("Send DSI_CMD_SET_ON cmds\n");
+	}
+		SDE_ATRACE_END("dsi_panel_tx_cmd_set");
 	if (rc) {
-		pr_err("[%s] failed to send DSI_CMD_SET_ON cmds, rc=%d\n",
-		       panel->name, rc);
+		pr_err("[%s] Failed to send DSI_CMD_SET_ON cmds, rc=%d\n",
+			panel->name, rc);
+	}
+	panel->need_power_on_backlight = true;
+	
+	SDE_ATRACE_BEGIN("gamma");
+	if ((strcmp(panel->name, "samsung dsc cmd mode oneplus dsi panel") == 0) && (gamma_read_flag == GAMMA_READ_SUCCESS)) {
+		if (mode_fps == 60) {
+			rc = dsi_panel_tx_gamma_cmd_set(panel, DSI_GAMMA_CMD_SET_SWITCH_60HZ);
+			pr_err("Send DSI_GAMMA_CMD_SET_SWITCH_60HZ cmds\n");
+			if (rc)
+				pr_err("[%s] Failed to send DSI_GAMMA_CMD_SET_SWITCH_60HZ cmds, rc=%d\n",
+					panel->name, rc);
+		}
 	}
+	SDE_ATRACE_END("gamma");
+
 	panel->panel_initialized = true;
+	pr_err("dsi_panel_enable aod_mode =%d\n",panel->aod_mode);
+
+	SDE_ATRACE_BEGIN("mutex_unlock");
 	mutex_unlock(&panel->panel_lock);
+	SDE_ATRACE_END("mutex_unlock");
+
+	SDE_ATRACE_BEGIN("dsi_panel_set_aod_mode");
+	if(panel->aod_mode==2){
+			rc = dsi_panel_set_aod_mode(panel, 2);
+			}
+		if(panel->aod_mode==2){
+			panel->aod_status=1;
+			}
+		if(panel->aod_mode==0){
+		rc = dsi_panel_set_aod_mode(panel, 0);
+			panel->aod_status=0;
+			}
+	SDE_ATRACE_END("dsi_panel_set_aod_mode");
+	pr_err("end\n");
+
+	/* remove print actvie ws */
+	pm_print_active_wakeup_sources_queue(false);
+	SDE_ATRACE_END("dsi_panel_enable");
+
+
+
 	return rc;
 }
 
@@ -3813,7 +4472,7 @@ int dsi_panel_post_enable(struct dsi_panel *panel)
 		pr_err("invalid params\n");
 		return -EINVAL;
 	}
-
+	SDE_ATRACE_BEGIN("dsi_panel_post_enable");
 	mutex_lock(&panel->panel_lock);
 
 	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_POST_ON);
@@ -3824,6 +4483,7 @@ int dsi_panel_post_enable(struct dsi_panel *panel)
 	}
 error:
 	mutex_unlock(&panel->panel_lock);
+	SDE_ATRACE_END("dsi_panel_post_enable");
 	return rc;
 }
 
@@ -3858,11 +4518,20 @@ int dsi_panel_disable(struct dsi_panel *panel)
 		pr_err("invalid params\n");
 		return -EINVAL;
 	}
-
+	pr_err("dsi_panel_disable aod_mode =%d\n",panel->aod_mode);
+	printk(KERN_ERR"dsi_panel_disable ++\n");
 	mutex_lock(&panel->panel_lock);
 
 	/* Avoid sending panel off commands when ESD recovery is underway */
 	if (!atomic_read(&panel->esd_recovery_pending)) {
+		HBM_flag = false;
+	if(panel->aod_mode==2){
+			panel->aod_status=1;
+			}
+	if(panel->aod_mode==0){
+		panel->aod_status=0;
+		}
+
 		rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_OFF);
 		if (rc) {
 			/*
@@ -3879,6 +4548,10 @@ int dsi_panel_disable(struct dsi_panel *panel)
 	panel->panel_initialized = false;
 
 	mutex_unlock(&panel->panel_lock);
+
+	/* add print actvie ws */
+	pm_print_active_wakeup_sources_queue(true);
+	printk(KERN_ERR"dsi_panel_disable --\n");
 	return rc;
 }
 
@@ -3908,6 +4581,7 @@ int dsi_panel_unprepare(struct dsi_panel *panel)
 int dsi_panel_post_unprepare(struct dsi_panel *panel)
 {
 	int rc = 0;
+	int ret = 0;
 
 	if (!panel) {
 		pr_err("invalid params\n");
@@ -3919,10 +4593,664 @@ int dsi_panel_post_unprepare(struct dsi_panel *panel)
 	rc = dsi_panel_power_off(panel);
 	if (rc) {
 		pr_err("[%s] panel power_Off failed, rc=%d\n",
-		       panel->name, rc);
+			   panel->name, rc);
 		goto error;
 	}
+	if (!tp_1v8_power) {
+		if (panel->tp_enable1v8_gpio > 0) {
+			pr_err("disable tp 1v8 gpio\n");
+			ret = gpio_direction_output(panel->tp_enable1v8_gpio, 0);
+			if (ret) {
+				pr_err("disable the enable1v8_gpio failed.\n");
+				return ret;
+			}
+		}
+	}
+
 error:
 	mutex_unlock(&panel->panel_lock);
 	return rc;
 }
+int dsi_panel_set_hbm_mode(struct dsi_panel *panel, int level)
+	{
+		int rc = 0;
+		u32 count;
+		struct dsi_display_mode *mode;
+
+		if (!panel || !panel->cur_mode) {
+			pr_err("Invalid params\n");
+			return -EINVAL;
+		}
+
+		mutex_lock(&panel->panel_lock);
+		mode = panel->cur_mode;
+
+		switch (level) {
+		case 0:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_OFF].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode off.\n");
+				goto error;
+			}
+			else {
+				HBM_flag = false;
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_OFF);
+				pr_err("Send DSI_CMD_SET_HBM_OFF cmds.\n");
+				pr_err("hbm_backight = %d, panel->bl_config.bl_level = %d\n",panel->hbm_backlight, panel->bl_config.bl_level);
+				rc= dsi_panel_update_backlight(panel,panel->hbm_backlight);
+			}
+			break;
+
+		case 1:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_1].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode 1.\n");
+				goto error;
+			}
+			else {
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_1);
+				pr_err("Send DSI_CMD_SET_HBM_ON_1 cmds.\n");
+			}
+			break;
+
+		case 2:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_2].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode 2.\n");
+				goto error;
+			}
+			else {
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_2);
+				pr_err("Send DSI_CMD_SET_HBM_ON_2 cmds.\n");
+			}
+			break;
+
+		case 3:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_3].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode 3.\n");
+				goto error;
+			}
+			else {
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_3);
+				pr_err("Send DSI_CMD_SET_HBM_ON_3 cmds.\n");
+			}
+			break;
+
+		case 4:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_4].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode 4.\n");
+				goto error;
+			}
+			else {
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_4);
+				pr_err("Send DSI_CMD_SET_HBM_ON_4 cmds.\n");
+			}
+			break;
+
+		case 5:
+			count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_ON_5].count;
+			if (!count) {
+				pr_err("This panel does not support HBM mode 5.\n");
+				goto error;
+			}
+			else {
+				HBM_flag = true;
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_ON_5);
+				pr_err("Send DSI_CMD_SET_HBM_ON_5 cmds.\n");
+			}
+			break;
+
+		default:
+			break;
+		}
+
+		pr_err("Set HBM Mode = %d\n", level);
+		if(level == 5){
+			pr_err("HBM == 5 for fingerprint\n");
+		}
+
+	error:
+		mutex_unlock(&panel->panel_lock);
+		return rc;
+	}
+
+int dsi_panel_set_hbm_brightness(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+	struct mipi_dsi_device *dsi;
+	struct dsi_display_mode *mode;
+
+	if (!panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+
+	dsi = &panel->mipi_device;
+	mode = panel->cur_mode;
+
+	if (hbm_brightness_flag == 0) {
+		count = mode->priv_info->cmd_sets[DSI_CMD_SET_HBM_BRIGHTNESS_ON].count;
+		if (!count) {
+			pr_err("This panel does not support HBM brightness on mode.\n");
+			goto error;
+		}
+		else {
+			pr_err("Send DSI_CMD_SET_HBM_BRIGHTNESS_ON cmds.\n");
+			rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_HBM_BRIGHTNESS_ON);
+			hbm_brightness_flag = 1;
+		}
+	}
+
+	rc= mipi_dsi_dcs_set_display_brightness_samsung(dsi, level);
+	pr_err("hbm backlight = %d\n", level);
+
+error:
+	return rc;
+}
+
+int dsi_panel_set_acl_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_cmd_desc *cmds;
+    struct dsi_display_mode *mode;
+    u8 *tx = NULL;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+	mutex_lock(&panel->panel_lock);
+
+    mode = panel->cur_mode;
+
+    count = mode->priv_info->cmd_sets[DSI_CMD_SET_ACL_MODE].count;
+    cmds = mode->priv_info->cmd_sets[DSI_CMD_SET_ACL_MODE].cmds;
+
+	if (count == 0) {
+		pr_err("This panel does not support acl mode\n");
+		goto error;
+	}
+
+    tx = (u8 *)cmds[panel->acl_cmd_index].msg.tx_buf;
+    if (tx != NULL) {
+	    tx[panel->acl_mode_index] = level;
+	}
+	rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_ACL_MODE);
+
+    pr_err("Set ACL Mode = %d\n", level);
+
+error:
+	mutex_unlock(&panel->panel_lock);
+
+	return rc;
+}
+
+bool aod_real_flag = false;
+
+int dsi_panel_set_dci_p3_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+	if(aod_real_flag==true)
+	return rc;	
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_DCI_P3_ON].count;
+
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_DCI_P3_ON);
+            pr_err("DCI-P3 Mode On.\n");
+    } else {   
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_DCI_P3_OFF);
+            pr_err("DCI-P3 Mode Off.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+	return rc;
+}
+
+int dsi_panel_set_night_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NIGHT_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NIGHT_ON);
+            pr_err("night Mode On.\n");
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NIGHT_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NIGHT_OFF);
+            pr_err("night Mode Off.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+	return rc;
+}
+int dsi_panel_set_native_display_p3_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_P3_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_P3_ON);
+            pr_err("Native Display p3 Mode On.\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_P3_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_P3_OFF);
+            pr_err("Native Display p3 Mode Off.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+int dsi_panel_set_native_display_wide_color_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_ON);
+            pr_err("Native wide color Mode On.\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_WIDE_COLOR_OFF);
+            pr_err("Native wide color Mode Off.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+int dsi_panel_set_native_display_srgb_color_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_ON);
+            pr_err("Native srgb color Mode On.\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_NATIVE_DISPLAY_SRGB_COLOR_OFF);
+            pr_err("Native  srgb color Mode Off.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+
+int dsi_panel_set_native_loading_effect_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_EFFECT_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_ON);
+            pr_err("turn on loading effect\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_EFFECT_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_EFFECT_OFF);
+            pr_err("turn off loading effect.\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+int dsi_panel_set_customer_srgb_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_CUSTOMER_RGB_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_ON);
+            pr_err("turn on customer srgb\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_CUSTOMER_RGB_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_RGB_OFF);
+            pr_err("turn off customer srgb\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+int dsi_panel_set_customer_p3_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+	u32 count;
+    struct dsi_display_mode *mode;
+
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    mode = panel->cur_mode;
+	mutex_lock(&panel->panel_lock);
+
+    if (level) {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_CUSTOMER_P3_ON].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_ON);
+            pr_err("turn on customer P3\n");    
+    } else {
+        count = mode->priv_info->cmd_sets[DSI_CMD_LOADING_CUSTOMER_P3_OFF].count;
+
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_LOADING_CUSTOMER_P3_OFF);
+            pr_err("turn off customer P3\n");
+    }
+	mutex_unlock(&panel->panel_lock);
+return rc;
+}
+
+int dsi_panel_set_aod_mode(struct dsi_panel *panel, int level)
+{
+	int rc = 0;
+    struct dsi_display_mode *mode;
+	struct msm_drm_notifier notifier_data;
+	int tp_aod_flag;
+	if (!panel || !panel->cur_mode) {
+		pr_err("Invalid params\n");
+		return -EINVAL;
+	}
+    if (panel->aod_disable) {
+        return 0;
+    }
+	printk(KERN_ERR"panel->aod_status ==%d\n",panel->aod_status);
+    mode = panel->cur_mode;
+    if (level == 1) {
+        if (panel->aod_status == 0) {
+			printk(KERN_ERR"send AOD ON commd mode 1 start \n");
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_AOD_ON_1);
+			printk(KERN_ERR"send AOD ON commd mode 1 end \n");
+            panel->aod_status = 1;
+        }
+    } else if (level == 2) {
+        if (panel->aod_status == 0) {
+			panel->aod_status = 1;
+			printk(KERN_ERR"send AOD ON commd mode 2 start \n");
+            rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_AOD_ON_2);		
+			if (level==2) {
+				tp_aod_flag=100;
+				notifier_data.data = &tp_aod_flag;
+				notifier_data.id = MSM_DRM_PRIMARY_DISPLAY;
+				pr_err("set aod state TP flag: %d\n", tp_aod_flag);
+				msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,&notifier_data);
+				}	
+			aod_real_flag=false;
+			printk(KERN_ERR"send AOD ON commd mode 2 end   \n");
+		}
+	} 
+	else {
+		if (panel->aod_status) {
+			panel->aod_status = 0;
+			pr_err("send AOD OFF cmds start\n");
+			if(aod_real_flag == true) {
+				pr_err("Send DSI_CMD_SET_AOD_OFF cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_AOD_OFF);
+			}
+			if(aod_real_flag == false) {
+				pr_err("Send DSI_CMD_SET_AOD_OFF_NEW cmds\n");
+				rc = dsi_panel_tx_cmd_set(panel, DSI_CMD_SET_AOD_OFF_NEW);
+				if (level == 0) {
+					tp_aod_flag = 200;
+					notifier_data.data = &tp_aod_flag;
+					notifier_data.id = MSM_DRM_PRIMARY_DISPLAY;
+					pr_err("set aod state TP flag: %d\n", tp_aod_flag);
+					msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,&notifier_data);
+				}
+			}
+			pr_err("Send AOD OFF cmds end \n");
+		}
+	}
+
+	panel->aod_curr_mode = level;
+	pr_err("AOD MODE = %d\n", level);
+return rc;
+}
+
+static int dsi_panel_parse_gamma_cmd_sets_sub(struct dsi_panel_cmd_set *cmd, const char *data, unsigned int length, enum dsi_cmd_set_state state, enum dsi_gamma_cmd_set_type type)
+{
+	int rc = 0;
+	u32 packet_count = 0;
+
+	if (!data) {
+		pr_debug("[%s] data not found\n", gamma_cmd_set_map[type]);
+		rc = -ENOTSUPP;
+		goto error;
+	}
+
+	pr_debug("type=%d, name=%s, length=%d\n", type,
+		gamma_cmd_set_map[type], length);
+
+	print_hex_dump_debug("", DUMP_PREFIX_NONE,
+		       8, 1, data, length, false);
+
+	rc = dsi_panel_get_cmd_pkt_count(data, length, &packet_count);
+	if (rc) {
+		pr_err("commands failed, rc=%d\n", rc);
+		goto error;
+	}
+	pr_debug("[%s] packet-count=%d, %d\n", gamma_cmd_set_map[type],
+		packet_count, length);
+
+	rc = dsi_panel_alloc_cmd_packets(cmd, packet_count);
+	if (rc) {
+		pr_err("failed to allocate cmd packets, rc=%d\n", rc);
+		goto error;
+	}
+
+	rc = dsi_panel_create_cmd_packets(data, length, packet_count,
+					  cmd->cmds);
+	if (rc) {
+		pr_err("failed to create cmd packets, rc=%d\n", rc);
+		goto error_free_mem;
+	}
+
+	cmd->state = state;
+
+	return rc;
+
+error_free_mem:
+	kfree(cmd->cmds);
+	cmd->cmds = NULL;
+
+error:
+	return rc;
+
+}
+
+int dsi_panel_parse_gamma_cmd_sets(void)
+{
+    int rc = 0;
+    int i = 0;
+
+    memset(gamma_cmd_set, 0, 2*sizeof(struct dsi_panel_cmd_set));
+
+    for (i = 0; i < 2; i++) {
+        rc = dsi_panel_parse_gamma_cmd_sets_sub(&gamma_cmd_set[i], (char *)&gamma_para[i], sizeof(gamma_para)/2, DSI_CMD_SET_STATE_HS, i);
+        if (rc) {
+            pr_err("Failed to parse gamma cmd sets %d, rc=%d\n", i, rc);
+        }
+    }
+
+    return rc;
+}
+
+int dsi_panel_tx_gamma_cmd_set(struct dsi_panel *panel,
+				enum dsi_gamma_cmd_set_type type)
+{
+	int rc = 0, i = 0;
+	ssize_t len;
+	struct dsi_cmd_desc *cmds;
+	u32 count;
+	enum dsi_cmd_set_state state;
+	const struct mipi_dsi_host_ops *ops = panel->host->ops;
+
+	if (!panel)
+		return -EINVAL;
+
+	cmds = gamma_cmd_set[type].cmds;
+	count = gamma_cmd_set[type].count;
+	state = gamma_cmd_set[type].state;
+
+	if (count == 0) {
+		pr_debug("[%s] No commands to be sent for gamma state(%d)\n",
+			 panel->name, type);
+		goto error;
+	}
+
+	for (i = 0; i < count; i++) {
+		if (state == DSI_CMD_SET_STATE_LP)
+			cmds->msg.flags |= MIPI_DSI_MSG_USE_LPM;
+
+		if (cmds->last_command)
+			cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+
+		len = ops->transfer(panel->host, &cmds->msg);
+		if (len < 0) {
+			rc = len;
+			pr_err("failed to set cmds(%d), rc=%d\n", type, rc);
+			goto error;
+		}
+		if (cmds->post_wait_ms)
+			usleep_range(cmds->post_wait_ms*1000,
+					((cmds->post_wait_ms*1000)+10));
+		cmds++;
+	}
+error:
+	return rc;
+}
+
+int dsi_panel_update_cmd_sets_sub(struct dsi_panel_cmd_set *cmd,
+					enum dsi_cmd_set_type type, const char *data, unsigned int length)
+{
+	int i = 0;
+	int rc = 0;
+	u32 packet_count = 0;
+
+	if (!data) {
+		pr_err("%s commands not defined\n", cmd_set_prop_map[type]);
+		rc = -ENOTSUPP;
+		goto error;
+	}
+
+	pr_err("type=%d, name=%s, length=%d\n", type,
+		cmd_set_prop_map[type], length);
+
+	print_hex_dump_debug("", DUMP_PREFIX_NONE,
+		       8, 1, data, length, false);
+
+	for (i = 0; i < length; i++) {
+		pr_err("data[%d]=%02X", i, data[i]);
+	}
+	rc = dsi_panel_get_cmd_pkt_count(data, length, &packet_count);
+	if (rc) {
+		pr_err("commands failed, rc=%d\n", rc);
+		goto error;
+	}
+	pr_err("[%s] packet-count=%d, %d\n", cmd_set_prop_map[type],
+		packet_count, length);
+
+	for (i = 0; i < cmd->count; i++) {
+		kfree(cmd->cmds[i].msg.tx_buf);
+	}
+	kfree(cmd->cmds);
+	cmd->cmds = NULL;
+	pr_err("Free tx_buf and dsi_cmd_desc struct pointers done.");
+
+	rc = dsi_panel_alloc_cmd_packets(cmd, packet_count);
+	if (rc) {
+		pr_err("failed to allocate cmd packets, rc=%d\n", rc);
+		goto error;
+	}
+
+	rc = dsi_panel_create_cmd_packets(data, length, packet_count,
+					  cmd->cmds);
+	if (rc) {
+		pr_err("failed to create cmd packets, rc=%d\n", rc);
+		goto error_free_mem;
+	}
+
+	return rc;
+
+error_free_mem:
+	kfree(cmd->cmds);
+	cmd->cmds = NULL;
+
+error:
+	return rc;
+
+}
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_panel.h b/drivers/gpu/drm/msm/dsi-staging/dsi_panel.h
index 1f0c5588250841851b349229aa12a57a0d8596b9..8c2f7492d0aa1a13fd7e9488e559baa43140f808 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_panel.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_panel.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -37,6 +37,22 @@
 
 #define DSI_MODE_MAX 5
 
+#define EVT2_113MHZ_OSC 0x99
+#define PVT_113MHZ_OSC 0x10
+#define PVT_113MHZ_OSC_XTALK 0x11
+
+#define GAMMA_READ_SUCCESS 1
+#define GAMMA_READ_ERROR 0
+
+extern u32 mode_fps;
+extern int gamma_read_flag;
+
+enum dsi_gamma_cmd_set_type {
+	DSI_GAMMA_CMD_SET_SWITCH_60HZ = 0,
+	DSI_GAMMA_CMD_SET_SWITCH_90HZ,
+	DSI_GAMMA_CMD_SET_MAX
+};
+
 enum dsi_panel_rotation {
 	DSI_PANEL_ROTATE_NONE = 0,
 	DSI_PANEL_ROTATE_HV_FLIP,
@@ -72,10 +88,18 @@ enum dsi_dms_mode {
 };
 
 struct dsi_dfps_capabilities {
-	bool dfps_support;
 	enum dsi_dfps_type type;
 	u32 min_refresh_rate;
 	u32 max_refresh_rate;
+	u32 *dfps_list;
+	u32 dfps_list_len;
+	bool dfps_support;
+};
+
+struct dsi_dyn_clk_caps {
+	bool dyn_clk_support;
+	u32 *bit_clk_list;
+	u32 bit_clk_list_len;
 };
 
 struct dsi_pinctrl_info {
@@ -107,6 +131,8 @@ struct dsi_backlight_config {
 	u32 pwm_pmic_bank;
 	u32 pwm_period_usecs;
 	int pwm_gpio;
+	bool bl_high2bit;
+	u32 bl_def_val;
 
 	/* WLED params */
 	struct led_trigger *wled;
@@ -167,6 +193,7 @@ struct dsi_panel {
 	enum dsi_op_mode panel_mode;
 
 	struct dsi_dfps_capabilities dfps_caps;
+	struct dsi_dyn_clk_caps dyn_clk_caps;
 	struct dsi_panel_phy_props phy_props;
 
 	struct dsi_display_mode *cur_mode;
@@ -180,7 +207,50 @@ struct dsi_panel {
 	struct drm_panel_esd_config esd_config;
 
 	struct dsi_parser_utils utils;
-
+	char buf_id[32];
+	int panel_year;
+	int panel_mon;
+	int panel_day;
+	int panel_hour;
+	int panel_min;
+	int panel_sec;
+	int panel_year_index;
+	int panel_mon_index;
+	int panel_day_index;
+	int panel_hour_index;
+	int panel_min_index;
+	int panel_sec_index;
+	int panel_stage_info;
+	int panel_production_info;
+	int acl_mode;
+	int acl_cmd_index;
+	int acl_mode_index;
+	int hbm_mode;
+	int hbm_brightness;
+	int aod_mode;
+	int aod_status;
+	int aod_curr_mode;
+	int aod_disable;
+	int srgb_mode;
+	int dci_p3_mode;
+	int night_mode;
+	int oneplus_mode;
+	int adaption_mode;
+	int status_value;
+	int panel_mismatch_check;
+	int panel_mismatch;
+	int hbm_backlight;
+	int naive_display_p3_mode;
+	int naive_display_wide_color_mode;
+	int naive_display_srgb_color_mode;
+	int naive_display_loading_effect_mode;
+	int naive_display_customer_srgb_mode;
+	int naive_display_customer_p3_mode;
+	bool need_power_on_backlight;
+	int tp_enable1v8_gpio;
+	bool is_hbm_enabled;
+	int  op_force_screenfp;
+	bool dim_status;
 	bool lp11_init;
 	bool ulps_feature_enabled;
 	bool ulps_suspend_enabled;
@@ -301,5 +371,26 @@ struct dsi_panel *dsi_panel_ext_bridge_get(struct device *parent,
 int dsi_panel_parse_esd_reg_read_configs(struct dsi_panel *panel);
 
 void dsi_panel_ext_bridge_put(struct dsi_panel *panel);
+int dsi_panel_set_hbm_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_acl_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_hbm_brightness(struct dsi_panel *panel, int level);
+int dsi_panel_op_set_hbm_mode(struct dsi_panel *panel, int level);
+extern int msm_drm_notifier_call_chain(unsigned long val, void *v);
+int dsi_panel_set_aod_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_dci_p3_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_night_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_native_display_p3_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_native_display_wide_color_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_native_display_srgb_color_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_native_loading_effect_mode(struct dsi_panel *panel, int level);
+int dsi_panel_gamma_read_address_setting(struct dsi_panel *panel, u16 read_number);
+int dsi_panel_tx_cmd_set(struct dsi_panel *panel, enum dsi_cmd_set_type type);
+int dsi_panel_parse_gamma_cmd_sets(void);
+int dsi_panel_tx_gamma_cmd_set(struct dsi_panel *panel, enum dsi_gamma_cmd_set_type type);
+extern int mipi_dsi_dcs_write_c1(struct mipi_dsi_device *dsi, u16 read_number);
+int dsi_panel_update_cmd_sets_sub(struct dsi_panel_cmd_set *cmd,
+					enum dsi_cmd_set_type type, const char *data, unsigned int length);
+int dsi_panel_set_customer_srgb_mode(struct dsi_panel *panel, int level);
+int dsi_panel_set_customer_p3_mode(struct dsi_panel *panel, int level);
 
 #endif /* _DSI_PANEL_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_phy.c b/drivers/gpu/drm/msm/dsi-staging/dsi_phy.c
index e86d03cac6a10d980e22f683970c49951a45a2b8..6c1fef2d929829b3ec89b8425d23cdd11d78c310 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_phy.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_phy.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -117,6 +117,9 @@ static int dsi_phy_regmap_init(struct platform_device *pdev,
 
 	phy->hw.base = ptr;
 
+	ptr = msm_ioremap(pdev, "dyn_refresh_base", phy->name);
+	phy->hw.dyn_pll_base = ptr;
+
 	pr_debug("[%s] map dsi_phy registers to %pK\n",
 		phy->name, phy->hw.base);
 
@@ -639,11 +642,8 @@ int dsi_phy_validate_mode(struct msm_dsi_phy *dsi_phy,
 		return -EINVAL;
 	}
 
-	mutex_lock(&dsi_phy->phy_lock);
-
 	pr_debug("[PHY_%d] Skipping validation\n", dsi_phy->index);
 
-	mutex_unlock(&dsi_phy->phy_lock);
 	return rc;
 }
 
@@ -885,7 +885,7 @@ int dsi_phy_enable(struct msm_dsi_phy *phy,
 		rc = phy->hw.ops.calculate_timing_params(&phy->hw,
 						 &phy->mode,
 						 &config->common_config,
-						 &phy->cfg.timing);
+						 &phy->cfg.timing, false);
 	if (rc) {
 		pr_err("[%s] failed to set timing, rc=%d\n", phy->name, rc);
 		goto error;
@@ -903,6 +903,27 @@ int dsi_phy_enable(struct msm_dsi_phy *phy,
 	return rc;
 }
 
+/* update dsi phy timings for dynamic clk switch use case */
+int dsi_phy_update_phy_timings(struct msm_dsi_phy *phy,
+			       struct dsi_host_config *config)
+{
+	int rc = 0;
+
+	if (!phy || !config) {
+		pr_err("invalid argument\n");
+		return -EINVAL;
+	}
+
+	memcpy(&phy->mode, &config->video_timing, sizeof(phy->mode));
+	rc = phy->hw.ops.calculate_timing_params(&phy->hw, &phy->mode,
+						 &config->common_config,
+						 &phy->cfg.timing, true);
+	if (rc)
+		pr_err("failed to calculate phy timings %d\n", rc);
+
+	return rc;
+}
+
 int dsi_phy_lane_reset(struct msm_dsi_phy *phy)
 {
 	int ret = 0;
@@ -1115,6 +1136,106 @@ int dsi_phy_conv_logical_to_phy_lane(
 	return i;
 }
 
+
+/**
+ * dsi_phy_config_dynamic_refresh() - Configure dynamic refresh registers
+ * @phy:	DSI PHY handle
+ * @delay:	pipe delays for dynamic refresh
+ * @is_master:	Boolean to indicate if for master or slave.
+ */
+void dsi_phy_config_dynamic_refresh(struct msm_dsi_phy *phy,
+		struct dsi_dyn_clk_delay *delay,
+		bool is_master)
+{
+	struct dsi_phy_cfg *cfg;
+
+	if (!phy)
+		return;
+
+	mutex_lock(&phy->phy_lock);
+
+	cfg = &phy->cfg;
+	if (phy->hw.ops.dyn_refresh_ops.dyn_refresh_config)
+		phy->hw.ops.dyn_refresh_ops.dyn_refresh_config(&phy->hw, cfg,
+				is_master);
+	if (phy->hw.ops.dyn_refresh_ops.dyn_refresh_pipe_delay)
+		phy->hw.ops.dyn_refresh_ops.dyn_refresh_pipe_delay(
+				&phy->hw, delay);
+
+	mutex_unlock(&phy->phy_lock);
+}
+
+/**
+ * dsi_phy_dynamic_refresh_trigger() - trigger dynamic refresh
+ * @phy:	DSI PHY handle
+ * @is_master:	Boolean to indicate if for master or slave.
+ */
+void dsi_phy_dynamic_refresh_trigger(struct msm_dsi_phy *phy, bool is_master)
+{
+	u32 off;
+
+	if (!phy)
+		return;
+
+	mutex_lock(&phy->phy_lock);
+	/*
+	 * program PLL_SWI_INTF_SEL and SW_TRIGGER bit only for
+	 * master and program SYNC_MODE bit only for slave.
+	 */
+	if (is_master)
+		off = BIT(DYN_REFRESH_INTF_SEL) | BIT(DYN_REFRESH_SWI_CTRL) |
+			BIT(DYN_REFRESH_SW_TRIGGER);
+	else
+		off = BIT(DYN_REFRESH_SYNC_MODE) | BIT(DYN_REFRESH_SWI_CTRL);
+
+	if (phy->hw.ops.dyn_refresh_ops.dyn_refresh_helper)
+		phy->hw.ops.dyn_refresh_ops.dyn_refresh_helper(&phy->hw, off);
+
+	mutex_unlock(&phy->phy_lock);
+}
+
+/**
+ * dsi_phy_cache_phy_timings - cache the phy timings calculated as part of
+ *				dynamic refresh.
+ * @phy:	   DSI PHY Handle.
+ * @dst:	   Pointer to cache location.
+ * @size:	   Number of phy lane settings.
+ */
+int dsi_phy_dyn_refresh_cache_phy_timings(struct msm_dsi_phy *phy, u32 *dst,
+		u32 size)
+{
+	int rc = 0;
+
+	if (!phy || !dst || !size)
+		return -EINVAL;
+
+	if (phy->hw.ops.dyn_refresh_ops.cache_phy_timings)
+		rc = phy->hw.ops.dyn_refresh_ops.cache_phy_timings(
+				&phy->cfg.timing, dst, size);
+
+		if (rc)
+			pr_err("failed to cache phy timings %d\n", rc);
+
+		return rc;
+}
+
+/**
+ * dsi_phy_dynamic_refresh_clear() - clear dynamic refresh config
+ * @phy:	DSI PHY handle
+ */
+void dsi_phy_dynamic_refresh_clear(struct msm_dsi_phy *phy)
+{
+	if (!phy)
+		return;
+
+	mutex_lock(&phy->phy_lock);
+
+	if (phy->hw.ops.dyn_refresh_ops.dyn_refresh_helper)
+		phy->hw.ops.dyn_refresh_ops.dyn_refresh_helper(&phy->hw, 0);
+
+	mutex_unlock(&phy->phy_lock);
+}
+
 void dsi_phy_drv_register(void)
 {
 	platform_driver_register(&dsi_phy_platform_driver);
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_phy.h b/drivers/gpu/drm/msm/dsi-staging/dsi_phy.h
index e54b42fdd2dfab77a83dc66a749f243d7123c49c..ba317db5b27915d302941bccb627958b69cb5932 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_phy.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_phy.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -298,4 +298,45 @@ void dsi_phy_drv_register(void);
  */
 void dsi_phy_drv_unregister(void);
 
+/**
+ * dsi_phy_update_phy_timings() - Update dsi phy timings
+ * @phy:	DSI PHY handle
+ * @config:	DSI Host config parameters
+ *
+ * Return: error code.
+ */
+int dsi_phy_update_phy_timings(struct msm_dsi_phy *phy,
+			       struct dsi_host_config *config);
+
+/**
+ * dsi_phy_config_dynamic_refresh() - Configure dynamic refresh registers
+ * @phy:	DSI PHY handle
+ * @delay:	pipe delays for dynamic refresh
+ * @is_master:	Boolean to indicate if for master or slave
+ */
+void dsi_phy_config_dynamic_refresh(struct msm_dsi_phy *phy,
+				    struct dsi_dyn_clk_delay *delay,
+				    bool is_master);
+/**
+ * dsi_phy_dynamic_refresh_trigger() - trigger dynamic refresh
+ * @phy:	DSI PHY handle
+ * @is_master:	Boolean to indicate if for master or slave.
+ */
+void dsi_phy_dynamic_refresh_trigger(struct msm_dsi_phy *phy, bool is_master);
+
+/**
+ * dsi_phy_dynamic_refresh_clear() - clear dynamic refresh config
+ * @phy:	DSI PHY handle
+ */
+void dsi_phy_dynamic_refresh_clear(struct msm_dsi_phy *phy);
+
+/**
+ * dsi_phy_dyn_refresh_cache_phy_timings - cache the phy timings calculated
+ *				as part of dynamic refresh.
+ * @phy:	   DSI PHY Handle.
+ * @dst:	   Pointer to cache location.
+ * @size:	   Number of phy lane settings.
+ */
+int dsi_phy_dyn_refresh_cache_phy_timings(struct msm_dsi_phy *phy,
+					  u32 *dst, u32 size);
 #endif /* _DSI_PHY_H_ */
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw.h b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw.h
index df72005d9f548336656e22ae8a3fe3a9a3d63bf0..2101e6b8b4848384e59ced6d16797317c50f1b3e 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw.h
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -169,6 +169,43 @@ struct phy_ulps_config_ops {
 	bool (*is_lanes_in_ulps)(u32 ulps, u32 ulps_lanes);
 };
 
+struct phy_dyn_refresh_ops {
+	/**
+	 * dyn_refresh_helper - helper function to config particular registers
+	 * @phy:           Pointer to DSI PHY hardware instance.
+	 * @offset:         register offset to program.
+	 */
+	void (*dyn_refresh_helper)(struct dsi_phy_hw *phy, u32 offset);
+
+	/**
+	 * dyn_refresh_config - configure dynamic refresh ctrl registers
+	 * @phy:           Pointer to DSI PHY hardware instance.
+	 * @cfg:	   Pointer to DSI PHY timings.
+	 * @is_master:	   Boolean to indicate whether for master or slave.
+	 */
+	void (*dyn_refresh_config)(struct dsi_phy_hw *phy,
+				   struct dsi_phy_cfg *cfg, bool is_master);
+
+	/**
+	 * dyn_refresh_pipe_delay - configure pipe delay registers for dynamic
+	 *				refresh.
+	 * @phy:           Pointer to DSI PHY hardware instance.
+	 * @delay:	   structure containing all the delays to be programed.
+	 */
+	void (*dyn_refresh_pipe_delay)(struct dsi_phy_hw *phy,
+				      struct dsi_dyn_clk_delay *delay);
+
+	/**
+	 * cache_phy_timings - cache the phy timings calculated as part of
+	 *				dynamic refresh.
+	 * @timings:       Pointer to calculated phy timing parameters.
+	 * @dst:	   Pointer to cache location.
+	 * @size:	   Number of phy lane settings.
+	 */
+	int (*cache_phy_timings)(struct dsi_phy_per_lane_cfgs *timings,
+				  u32 *dst, u32 size);
+};
+
 /**
  * struct dsi_phy_hw_ops - Operations for DSI PHY hardware.
  * @regulator_enable:          Enable PHY regulators.
@@ -228,11 +265,14 @@ struct dsi_phy_hw_ops {
 	 * @mode:     Mode information for which timing has to be calculated.
 	 * @config:   DSI host configuration for this mode.
 	 * @timing:   Timing parameters for each lane which will be returned.
+	 * @use_mode_bit_clk: Boolean to indicate whether reacalculate dsi
+	 *		bitclk or use the existing bitclk(for dynamic clk case).
 	 */
 	int (*calculate_timing_params)(struct dsi_phy_hw *phy,
 				       struct dsi_mode_info *mode,
 				       struct dsi_host_common_cfg *config,
-				       struct dsi_phy_per_lane_cfgs *timing);
+				       struct dsi_phy_per_lane_cfgs *timing,
+				       bool use_mode_bit_clk);
 
 	/**
 	 * phy_timing_val() - Gets PHY timing values.
@@ -273,12 +313,15 @@ struct dsi_phy_hw_ops {
 
 	void *timing_ops;
 	struct phy_ulps_config_ops ulps_ops;
+	struct phy_dyn_refresh_ops dyn_refresh_ops;
 };
 
 /**
  * struct dsi_phy_hw - DSI phy hardware object specific to an instance
  * @base:                  VA for the DSI PHY base address.
  * @length:                Length of the DSI PHY register base map.
+ * @dyn_pll_base:      VA for the DSI dynamic refresh base address.
+ * @length:                Length of the DSI dynamic refresh register base map.
  * @index:                 Instance ID of the controller.
  * @version:               DSI PHY version.
  * @phy_clamp_base:        Base address of phy clamp register map.
@@ -288,6 +331,8 @@ struct dsi_phy_hw_ops {
 struct dsi_phy_hw {
 	void __iomem *base;
 	u32 length;
+	void __iomem *dyn_pll_base;
+	u32 dyn_refresh_len;
 	u32 index;
 
 	enum dsi_phy_version version;
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw_v3_0.c b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw_v3_0.c
index 8f375d717bc2c6dd0c1f98ce8c136e4e7357a3f0..556c01911a682825af130608b2024e6ba4a22bf4 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw_v3_0.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_hw_v3_0.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -66,6 +66,47 @@
 #define DSIPHY_LNX_LPRX_CTRL(n)                    (0x228 + (0x80 * (n)))
 #define DSIPHY_LNX_TX_DCTRL(n)                     (0x22C + (0x80 * (n)))
 
+/* dynamic refresh control registers */
+#define DSI_DYN_REFRESH_CTRL                   (0x000)
+#define DSI_DYN_REFRESH_PIPE_DELAY             (0x004)
+#define DSI_DYN_REFRESH_PIPE_DELAY2            (0x008)
+#define DSI_DYN_REFRESH_PLL_DELAY              (0x00C)
+#define DSI_DYN_REFRESH_STATUS                 (0x010)
+#define DSI_DYN_REFRESH_PLL_CTRL0              (0x014)
+#define DSI_DYN_REFRESH_PLL_CTRL1              (0x018)
+#define DSI_DYN_REFRESH_PLL_CTRL2              (0x01C)
+#define DSI_DYN_REFRESH_PLL_CTRL3              (0x020)
+#define DSI_DYN_REFRESH_PLL_CTRL4              (0x024)
+#define DSI_DYN_REFRESH_PLL_CTRL5              (0x028)
+#define DSI_DYN_REFRESH_PLL_CTRL6              (0x02C)
+#define DSI_DYN_REFRESH_PLL_CTRL7              (0x030)
+#define DSI_DYN_REFRESH_PLL_CTRL8              (0x034)
+#define DSI_DYN_REFRESH_PLL_CTRL9              (0x038)
+#define DSI_DYN_REFRESH_PLL_CTRL10             (0x03C)
+#define DSI_DYN_REFRESH_PLL_CTRL11             (0x040)
+#define DSI_DYN_REFRESH_PLL_CTRL12             (0x044)
+#define DSI_DYN_REFRESH_PLL_CTRL13             (0x048)
+#define DSI_DYN_REFRESH_PLL_CTRL14             (0x04C)
+#define DSI_DYN_REFRESH_PLL_CTRL15             (0x050)
+#define DSI_DYN_REFRESH_PLL_CTRL16             (0x054)
+#define DSI_DYN_REFRESH_PLL_CTRL17             (0x058)
+#define DSI_DYN_REFRESH_PLL_CTRL18             (0x05C)
+#define DSI_DYN_REFRESH_PLL_CTRL19             (0x060)
+#define DSI_DYN_REFRESH_PLL_CTRL20             (0x064)
+#define DSI_DYN_REFRESH_PLL_CTRL21             (0x068)
+#define DSI_DYN_REFRESH_PLL_CTRL22             (0x06C)
+#define DSI_DYN_REFRESH_PLL_CTRL23             (0x070)
+#define DSI_DYN_REFRESH_PLL_CTRL24             (0x074)
+#define DSI_DYN_REFRESH_PLL_CTRL25             (0x078)
+#define DSI_DYN_REFRESH_PLL_CTRL26             (0x07C)
+#define DSI_DYN_REFRESH_PLL_CTRL27             (0x080)
+#define DSI_DYN_REFRESH_PLL_CTRL28             (0x084)
+#define DSI_DYN_REFRESH_PLL_CTRL29             (0x088)
+#define DSI_DYN_REFRESH_PLL_CTRL30             (0x08C)
+#define DSI_DYN_REFRESH_PLL_CTRL31             (0x090)
+#define DSI_DYN_REFRESH_PLL_UPPER_ADDR         (0x094)
+#define DSI_DYN_REFRESH_PLL_UPPER_ADDR2        (0x098)
+
 /**
  * regulator_enable() - enable regulators for DSI PHY
  * @phy:      Pointer to DSI PHY hardware object.
@@ -470,3 +511,163 @@ int dsi_phy_hw_timing_val_v3_0(struct dsi_phy_per_lane_cfgs *timing_cfg,
 		timing_cfg->lane_v3[i] = timing_val[i];
 	return 0;
 }
+
+void dsi_phy_hw_v3_0_dyn_refresh_config(struct dsi_phy_hw *phy,
+					struct dsi_phy_cfg *cfg, bool is_master)
+{
+	u32 reg;
+
+	if (is_master) {
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL9,
+			  DSIPHY_CMN_GLBL_CTRL, DSIPHY_CMN_VREG_CTRL,
+			  0x10, 0x59);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL10,
+			  DSIPHY_CMN_TIMING_CTRL_0, DSIPHY_CMN_TIMING_CTRL_1,
+			  cfg->timing.lane_v3[0], cfg->timing.lane_v3[1]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL11,
+			  DSIPHY_CMN_TIMING_CTRL_2, DSIPHY_CMN_TIMING_CTRL_3,
+			  cfg->timing.lane_v3[2], cfg->timing.lane_v3[3]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL12,
+			  DSIPHY_CMN_TIMING_CTRL_4, DSIPHY_CMN_TIMING_CTRL_5,
+			  cfg->timing.lane_v3[4], cfg->timing.lane_v3[5]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL13,
+			  DSIPHY_CMN_TIMING_CTRL_6, DSIPHY_CMN_TIMING_CTRL_7,
+			  cfg->timing.lane_v3[6], cfg->timing.lane_v3[7]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL14,
+			  DSIPHY_CMN_TIMING_CTRL_8, DSIPHY_CMN_TIMING_CTRL_9,
+			  cfg->timing.lane_v3[8], cfg->timing.lane_v3[9]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL15,
+			  DSIPHY_CMN_TIMING_CTRL_10, DSIPHY_CMN_TIMING_CTRL_11,
+			  cfg->timing.lane_v3[10], cfg->timing.lane_v3[11]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL16,
+			  DSIPHY_CMN_CTRL_0, DSIPHY_CMN_LANE_CTRL0,
+			  0x7f, 0x1f);
+	} else {
+		reg = DSI_R32(phy, DSIPHY_CMN_CLK_CFG0);
+		reg &= ~BIT(5);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL0,
+			  DSIPHY_CMN_CLK_CFG0, DSIPHY_CMN_PLL_CNTRL,
+			  reg, 0x0);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL1,
+			  DSIPHY_CMN_RBUF_CTRL, DSIPHY_CMN_GLBL_CTRL,
+			  0x0, 0x10);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL2,
+			  DSIPHY_CMN_VREG_CTRL, DSIPHY_CMN_TIMING_CTRL_0,
+			  0x59, cfg->timing.lane_v3[0]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL3,
+			  DSIPHY_CMN_TIMING_CTRL_1, DSIPHY_CMN_TIMING_CTRL_2,
+			  cfg->timing.lane_v3[1], cfg->timing.lane_v3[2]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL4,
+			  DSIPHY_CMN_TIMING_CTRL_3, DSIPHY_CMN_TIMING_CTRL_4,
+			  cfg->timing.lane_v3[3], cfg->timing.lane_v3[4]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL5,
+			  DSIPHY_CMN_TIMING_CTRL_5, DSIPHY_CMN_TIMING_CTRL_6,
+			  cfg->timing.lane_v3[5], cfg->timing.lane_v3[6]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL6,
+			  DSIPHY_CMN_TIMING_CTRL_7, DSIPHY_CMN_TIMING_CTRL_8,
+			  cfg->timing.lane_v3[7], cfg->timing.lane_v3[8]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL7,
+			  DSIPHY_CMN_TIMING_CTRL_9, DSIPHY_CMN_TIMING_CTRL_10,
+			  cfg->timing.lane_v3[9], cfg->timing.lane_v3[10]);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL8,
+			  DSIPHY_CMN_TIMING_CTRL_11, DSIPHY_CMN_CTRL_0,
+			  cfg->timing.lane_v3[11], 0x7f);
+		DSI_DYN_REF_REG_W(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_CTRL9,
+			  DSIPHY_CMN_LANE_CTRL0, DSIPHY_CMN_CTRL_2,
+			  0x1f, 0x40);
+		/*
+		 * fill with dummy register writes since controller will blindly
+		 * send these values to DSI PHY.
+		 */
+		reg = DSI_DYN_REFRESH_PLL_CTRL11;
+		while (reg <= DSI_DYN_REFRESH_PLL_CTRL29) {
+			DSI_DYN_REF_REG_W(phy->dyn_pll_base, reg,
+				  DSIPHY_CMN_LANE_CTRL0, DSIPHY_CMN_CTRL_0,
+				  0x1f, 0x7f);
+			reg += 0x4;
+		}
+
+		DSI_GEN_W32(phy->dyn_pll_base,
+			    DSI_DYN_REFRESH_PLL_UPPER_ADDR, 0);
+		DSI_GEN_W32(phy->dyn_pll_base,
+			    DSI_DYN_REFRESH_PLL_UPPER_ADDR2, 0);
+	}
+
+	wmb(); /* make sure all registers are updated */
+}
+
+void dsi_phy_hw_v3_0_dyn_refresh_pipe_delay(struct dsi_phy_hw *phy,
+					    struct dsi_dyn_clk_delay *delay)
+{
+	if (!delay)
+		return;
+
+	DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_PIPE_DELAY,
+		    delay->pipe_delay);
+	DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_PIPE_DELAY2,
+		    delay->pipe_delay2);
+	DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_PLL_DELAY,
+		    delay->pll_delay);
+}
+
+void dsi_phy_hw_v3_0_dyn_refresh_helper(struct dsi_phy_hw *phy, u32 offset)
+{
+	u32 reg;
+
+	/*
+	 * if no offset is mentioned then this means we want to clear
+	 * the dynamic refresh ctrl register which is the last step
+	 * of dynamic refresh sequence.
+	 */
+	if (!offset) {
+		reg = DSI_GEN_R32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL);
+		reg &= ~(BIT(0) | BIT(8));
+		DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL, reg);
+		wmb(); /* ensure dynamic fps is cleared */
+		return;
+	}
+
+	if (offset & BIT(DYN_REFRESH_INTF_SEL)) {
+		reg = DSI_GEN_R32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL);
+		reg |= BIT(13);
+		DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL, reg);
+	}
+
+	if (offset & BIT(DYN_REFRESH_SYNC_MODE)) {
+		reg = DSI_GEN_R32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL);
+		reg |= BIT(16);
+		DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL, reg);
+	}
+
+	if (offset & BIT(DYN_REFRESH_SWI_CTRL)) {
+		reg = DSI_GEN_R32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL);
+		reg |= BIT(0);
+		DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL, reg);
+	}
+
+	if (offset & BIT(DYN_REFRESH_SW_TRIGGER)) {
+		reg = DSI_GEN_R32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL);
+		reg |= BIT(8);
+		DSI_GEN_W32(phy->dyn_pll_base, DSI_DYN_REFRESH_CTRL, reg);
+		wmb(); /* ensure dynamic fps is triggered */
+	}
+}
+
+int dsi_phy_hw_v3_0_cache_phy_timings(struct dsi_phy_per_lane_cfgs *timings,
+				      u32 *dst, u32 size)
+{
+	int i;
+
+	if (!timings || !dst || !size)
+		return -EINVAL;
+
+	if (size != DSI_PHY_TIMING_V3_SIZE) {
+		pr_err("size mis-match\n");
+		return -EINVAL;
+	}
+
+	for (i = 0; i < size; i++)
+		dst[i] = timings->lane_v3[i];
+
+	return 0;
+}
diff --git a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_timing_calc.c b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_timing_calc.c
index bb8c4a1c4ff5a325872152071384c9f0322a715d..1a41fbee8c7da89de4a2cadaff588f100209167e 100644
--- a/drivers/gpu/drm/msm/dsi-staging/dsi_phy_timing_calc.c
+++ b/drivers/gpu/drm/msm/dsi-staging/dsi_phy_timing_calc.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -638,11 +638,14 @@ static int dsi_phy_cmn_calc_timing_params(struct dsi_phy_hw *phy,
  * @mode:     Mode information for which timing has to be calculated.
  * @config:   DSI host configuration for this mode.
  * @timing:   Timing parameters for each lane which will be returned.
+ * @use_mode_bit_clk: Boolean to indicate whether reacalculate dsi
+ *		bit clk or use the existing bit clk(for dynamic clk case).
  */
 int dsi_phy_hw_calculate_timing_params(struct dsi_phy_hw *phy,
-					    struct dsi_mode_info *mode,
-					    struct dsi_host_common_cfg *host,
-					   struct dsi_phy_per_lane_cfgs *timing)
+				       struct dsi_mode_info *mode,
+				       struct dsi_host_common_cfg *host,
+				       struct dsi_phy_per_lane_cfgs *timing,
+				       bool use_mode_bit_clk)
 {
 	/* constants */
 	u32 const esc_clk_mhz = 192; /* TODO: esc clock is hardcoded */
@@ -685,7 +688,10 @@ int dsi_phy_hw_calculate_timing_params(struct dsi_phy_hw *phy,
 		num_of_lanes++;
 
 
-	x = mult_frac(v_total * h_total, inter_num, num_of_lanes);
+	if (use_mode_bit_clk)
+		x = mode->clk_rate_hz;
+	else
+		x = mult_frac(v_total * h_total, inter_num, num_of_lanes);
 	y = rounddown(x, 1);
 
 	clk_params.bitclk_mbps = rounddown(DIV_ROUND_UP_ULL(y, 1000000), 1);
diff --git a/drivers/gpu/drm/msm/msm_atomic.c b/drivers/gpu/drm/msm/msm_atomic.c
index 0ee45712be11e9e6a45a9bf812f00a3e2a2452e8..ac882ff9e4e5b6e5e1495492557e82b02453c6ca 100644
--- a/drivers/gpu/drm/msm/msm_atomic.c
+++ b/drivers/gpu/drm/msm/msm_atomic.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  * Copyright (C) 2014 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -36,6 +36,7 @@ struct msm_commit {
 };
 
 static BLOCKING_NOTIFIER_HEAD(msm_drm_notifier_list);
+int connector_state_crtc_index;
 
 /**
  * msm_drm_register_client - register a client notifier
@@ -72,11 +73,12 @@ EXPORT_SYMBOL(msm_drm_unregister_client);
  * @v: notifier data, inculde display id and display blank
  *     event(unblank or power down).
  */
-static int msm_drm_notifier_call_chain(unsigned long val, void *v)
+int msm_drm_notifier_call_chain(unsigned long val, void *v)
 {
 	return blocking_notifier_call_chain(&msm_drm_notifier_list, val,
 					    v);
 }
+EXPORT_SYMBOL(msm_drm_notifier_call_chain);
 
 /* block until specified crtcs are no longer pending update, and
  * atomically mark them as pending update
@@ -124,7 +126,8 @@ static inline bool _msm_seamless_for_crtc(struct drm_atomic_state *state,
 	int conn_cnt = 0;
 
 	if (msm_is_mode_seamless(&crtc_state->mode) ||
-		msm_is_mode_seamless_vrr(&crtc_state->adjusted_mode))
+		msm_is_mode_seamless_vrr(&crtc_state->adjusted_mode) ||
+		msm_is_mode_seamless_dyn_clk(&crtc_state->adjusted_mode))
 		return true;
 
 	if (msm_is_mode_seamless_dms(&crtc_state->adjusted_mode) && !enable)
@@ -168,6 +171,10 @@ static inline bool _msm_seamless_for_conn(struct drm_connector *connector,
 			&connector->encoder->crtc->state->adjusted_mode))
 		return true;
 
+	if (msm_is_mode_seamless_dyn_clk(
+			 &connector->encoder->crtc->state->adjusted_mode))
+		return true;
+
 	if (msm_is_mode_seamless_dms(
 			&connector->encoder->crtc->state->adjusted_mode))
 		return true;
@@ -246,6 +253,7 @@ msm_disable_outputs(struct drm_device *dev, struct drm_atomic_state *old_state)
 			blank = MSM_DRM_BLANK_POWERDOWN;
 			notifier_data.data = &blank;
 			notifier_data.id = crtc_idx;
+			connector_state_crtc_index = crtc_idx;
 			msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,
 						     &notifier_data);
 		}
@@ -485,6 +493,8 @@ static void msm_atomic_helper_commit_modeset_enables(struct drm_device *dev,
 			notifier_data.id =
 				connector->state->crtc->index;
 			DRM_DEBUG_ATOMIC("Notify early unblank\n");
+			connector_state_crtc_index =
+				connector->state->crtc->index;
 			msm_drm_notifier_call_chain(MSM_DRM_EARLY_EVENT_BLANK,
 					    &notifier_data);
 		}
@@ -587,6 +597,8 @@ static void complete_commit(struct msm_commit *c)
 	kms->funcs->complete_commit(kms, state);
 
 	drm_atomic_state_put(state);
+	
+	priv->commit_end_time =  ktime_get(); //commit end time
 
 	commit_destroy(c);
 }
diff --git a/drivers/gpu/drm/msm/msm_drv.c b/drivers/gpu/drm/msm/msm_drv.c
index cfeea6462077cb1175e92de83188e9c86da90201..fdae703cac15f2ea87c5a45c8a4217f59486b762 100644
--- a/drivers/gpu/drm/msm/msm_drv.c
+++ b/drivers/gpu/drm/msm/msm_drv.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -47,6 +47,7 @@
 #include "msm_gpu.h"
 #include "msm_kms.h"
 #include "sde_wb.h"
+#include "sde_dbg.h"
 
 /*
  * MSM driver version:
@@ -823,6 +824,8 @@ static int msm_open(struct drm_device *dev, struct drm_file *file)
 	if (!ctx)
 		return -ENOMEM;
 
+	mutex_init(&ctx->power_lock);
+
 	file->driver_priv = ctx;
 
 	if (dev && dev->dev_private) {
@@ -859,6 +862,14 @@ static void msm_postclose(struct drm_device *dev, struct drm_file *file)
 		priv->lastctx = NULL;
 	mutex_unlock(&dev->struct_mutex);
 
+	mutex_lock(&ctx->power_lock);
+	if (ctx->enable_refcnt) {
+		SDE_EVT32(ctx->enable_refcnt);
+		sde_power_resource_enable(&priv->phandle,
+				priv->pclient, false);
+	}
+	mutex_unlock(&ctx->power_lock);
+
 	kfree(ctx);
 }
 
@@ -1573,6 +1584,62 @@ int msm_ioctl_rmfb2(struct drm_device *dev, void *data,
 }
 EXPORT_SYMBOL(msm_ioctl_rmfb2);
 
+/**
+ * msm_ioctl_power_ctrl - enable/disable power vote on MDSS Hw
+ * @dev: drm device for the ioctl
+ * @data: data pointer for the ioctl
+ * @file_priv: drm file for the ioctl call
+ *
+ */
+int msm_ioctl_power_ctrl(struct drm_device *dev, void *data,
+			struct drm_file *file_priv)
+{
+	struct msm_file_private *ctx = file_priv->driver_priv;
+	struct msm_drm_private *priv;
+	struct drm_msm_power_ctrl *power_ctrl = data;
+	bool vote_req = false;
+	int old_cnt;
+	int rc = 0;
+
+	if (unlikely(!power_ctrl)) {
+		DRM_ERROR("invalid ioctl data\n");
+		return -EINVAL;
+	}
+
+	priv = dev->dev_private;
+
+	mutex_lock(&ctx->power_lock);
+
+	old_cnt = ctx->enable_refcnt;
+	if (power_ctrl->enable) {
+		if (!ctx->enable_refcnt)
+			vote_req = true;
+		ctx->enable_refcnt++;
+	} else if (ctx->enable_refcnt) {
+		ctx->enable_refcnt--;
+		if (!ctx->enable_refcnt)
+			vote_req = true;
+	} else {
+		pr_err("ignoring, unbalanced disable\n");
+	}
+
+	if (vote_req) {
+		rc = sde_power_resource_enable(&priv->phandle,
+				priv->pclient, power_ctrl->enable);
+
+		if (rc)
+			ctx->enable_refcnt = old_cnt;
+	}
+
+	pr_debug("pid %d enable %d, refcnt %d, vote_req %d\n",
+			current->pid, power_ctrl->enable, ctx->enable_refcnt,
+			vote_req);
+	SDE_EVT32(current->pid, power_ctrl->enable, ctx->enable_refcnt,
+			vote_req);
+	mutex_unlock(&ctx->power_lock);
+	return rc;
+}
+
 static const struct drm_ioctl_desc msm_ioctls[] = {
 	DRM_IOCTL_DEF_DRV(MSM_GET_PARAM,    msm_ioctl_get_param,    DRM_AUTH|DRM_RENDER_ALLOW),
 	DRM_IOCTL_DEF_DRV(MSM_GEM_NEW,      msm_ioctl_gem_new,      DRM_AUTH|DRM_RENDER_ALLOW),
@@ -1589,6 +1656,8 @@ static const struct drm_ioctl_desc msm_ioctls[] = {
 			  DRM_UNLOCKED|DRM_CONTROL_ALLOW),
 	DRM_IOCTL_DEF_DRV(MSM_RMFB2, msm_ioctl_rmfb2,
 			  DRM_CONTROL_ALLOW|DRM_UNLOCKED),
+	DRM_IOCTL_DEF_DRV(MSM_POWER_CTRL, msm_ioctl_power_ctrl,
+			DRM_RENDER_ALLOW),
 };
 
 static const struct vm_operations_struct vm_ops = {
diff --git a/drivers/gpu/drm/msm/msm_drv.h b/drivers/gpu/drm/msm/msm_drv.h
index 1c2892938fb998c7f0908f5a81c071eb86ea3984..c84329330ad43fe2b59b01818b0e2da871ef3e3a 100644
--- a/drivers/gpu/drm/msm/msm_drv.h
+++ b/drivers/gpu/drm/msm/msm_drv.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -74,11 +74,11 @@ struct msm_gem_vma;
 #define TEARDOWN_DEADLOCK_RETRY_MAX 5
 
 struct msm_file_private {
-	/* currently we don't do anything useful with this.. but when
-	 * per-context address spaces are supported we'd keep track of
-	 * the context's page-tables here.
-	 */
-	int dummy;
+	/* update the refcount when user driver calls power_ctrl IOCTL */
+	unsigned short enable_refcnt;
+
+	/* protects enable_refcnt */
+	struct mutex power_lock;
 };
 
 enum msm_mdp_plane_property {
@@ -103,6 +103,8 @@ enum msm_mdp_plane_property {
 
 	/* range properties */
 	PLANE_PROP_ZPOS = PLANE_PROP_BLOBCOUNT,
+
+    PLANE_PROP_CUSTOM,
 	PLANE_PROP_ALPHA,
 	PLANE_PROP_COLOR_FILL,
 	PLANE_PROP_H_DECIMATE,
@@ -166,6 +168,7 @@ enum msm_mdp_crtc_property {
 	CRTC_PROP_IDLE_PC_STATE,
 
 	/* total # of properties */
+	CRTC_PROP_CUSTOM,
 	CRTC_PROP_COUNT
 };
 
@@ -199,6 +202,7 @@ enum msm_mdp_conn_property {
 	CONNECTOR_PROP_LP,
 	CONNECTOR_PROP_FB_TRANSLATION_MODE,
 	CONNECTOR_PROP_QSYNC_MODE,
+	CONNECTOR_PROP_CUSTOM,
 
 	/* total # of properties */
 	CONNECTOR_PROP_COUNT
@@ -661,6 +665,7 @@ struct msm_drm_private {
 
 	/* update the flag when msm driver receives shutdown notification */
 	bool shutdown_in_progress;
+	ktime_t  commit_end_time;
 };
 
 /* get struct msm_kms * from drm_device * */
diff --git a/drivers/gpu/drm/msm/msm_kms.h b/drivers/gpu/drm/msm/msm_kms.h
index 48bcffcdbbea71c65ab7683a4994d62bac322094..0330eb0023dbfbd7e9a787b971b706f2e6a14ab1 100644
--- a/drivers/gpu/drm/msm/msm_kms.h
+++ b/drivers/gpu/drm/msm/msm_kms.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -38,6 +38,8 @@
 #define MSM_MODE_FLAG_SEAMLESS_DMS			(1<<2)
 /* Request to switch the fps */
 #define MSM_MODE_FLAG_SEAMLESS_VRR			(1<<3)
+/* Request to switch the bit clk */
+#define MSM_MODE_FLAG_SEAMLESS_DYN_CLK			(1<<4)
 
 /* As there are different display controller blocks depending on the
  * snapdragon version, the kms support is split out and the appropriate
@@ -211,6 +213,13 @@ static inline bool msm_is_mode_seamless_vrr(const struct drm_display_mode *mode)
 		: false;
 }
 
+static inline bool msm_is_mode_seamless_dyn_clk(
+					const struct drm_display_mode *mode)
+{
+	return mode ? (mode->private_flags & MSM_MODE_FLAG_SEAMLESS_DYN_CLK)
+		: false;
+}
+
 static inline bool msm_needs_vblank_pre_modeset(
 		const struct drm_display_mode *mode)
 {
diff --git a/drivers/gpu/drm/msm/sde/sde_connector.c b/drivers/gpu/drm/msm/sde/sde_connector.c
old mode 100644
new mode 100755
index a33dc35c65d4f4187eba77c570f8f0a476c0e835..77341d08433ab352aaf8fdb8bf3c3cbc2ee093a0
--- a/drivers/gpu/drm/msm/sde/sde_connector.c
+++ b/drivers/gpu/drm/msm/sde/sde_connector.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2016-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -23,7 +23,7 @@
 #include "dsi_display.h"
 #include "sde_crtc.h"
 #include "sde_rm.h"
-
+#include "sde_trace.h"
 #define BL_NODE_NAME_SIZE 32
 
 /* Autorefresh will occur after FRAME_CNT frames. Large values are unlikely */
@@ -146,7 +146,9 @@ static int sde_backlight_setup(struct sde_connector *c_conn,
 	display = (struct dsi_display *) c_conn->display;
 	bl_config = &display->panel->bl_config;
 	props.max_brightness = bl_config->brightness_max_level;
-	props.brightness = bl_config->brightness_max_level;
+//	props.brightness = bl_config->brightness_max_level;
+	props.brightness = bl_config->bl_def_val;
+	SDE_ERROR("props.brightness = %d\n",props.brightness);
 	snprintf(bl_node_name, BL_NODE_NAME_SIZE, "panel%u-backlight",
 							display_count);
 	c_conn->bl_device = backlight_device_register(bl_node_name, dev->dev,
@@ -562,6 +564,193 @@ static int _sde_connector_update_bl_scale(struct sde_connector *c_conn)
 	return rc;
 }
 
+extern bool sde_crtc_get_fingerprint_mode(struct drm_crtc_state *crtc_state);
+extern bool sde_crtc_get_fingerprint_pressed(struct drm_crtc_state *crtc_state);
+extern int dsi_display_set_hbm_mode(struct drm_connector *connector, int level);
+static int dsi_panel_tx_cmd_set_op(struct dsi_panel *panel,
+				enum dsi_cmd_set_type type)
+{
+	int rc = 0, i = 0;
+	ssize_t len;
+	struct dsi_cmd_desc *cmds;
+	u32 count;
+	enum dsi_cmd_set_state state;
+	struct dsi_display_mode *mode;
+	const struct mipi_dsi_host_ops *ops = panel->host->ops;
+
+	if (!panel || !panel->cur_mode)
+		return -EINVAL;
+
+//	if (panel->type == EXT_BRIDGE)
+//		return 0;
+
+	mode = panel->cur_mode;
+
+	cmds = mode->priv_info->cmd_sets[type].cmds;
+	count = mode->priv_info->cmd_sets[type].count;
+	state = mode->priv_info->cmd_sets[type].state;
+
+	if (count == 0) {
+		pr_debug("[%s] No commands to be sent for state(%d)\n",
+			 panel->name, type);
+		goto error;
+	}
+
+	for (i = 0; i < count; i++) {
+		if (state == DSI_CMD_SET_STATE_LP)
+			cmds->msg.flags |= MIPI_DSI_MSG_USE_LPM;
+
+		if (cmds->last_command)
+			cmds->msg.flags |= MIPI_DSI_MSG_LASTCOMMAND;
+
+		len = ops->transfer(panel->host, &cmds->msg);
+		if (len < 0) {
+			rc = len;
+			pr_err("failed to set cmds(%d), rc=%d\n", type, rc);
+			goto error;
+		}
+		if (cmds->post_wait_ms)
+			usleep_range(cmds->post_wait_ms*1000,
+					((cmds->post_wait_ms*1000)+10));
+		cmds++;
+	}
+error:
+	return rc;
+}
+int aod_layer_hide = 0;
+extern bool HBM_flag ;
+extern int oneplus_dim_status;
+extern bool aod_real_flag;
+extern bool finger_type;
+
+static int _sde_connector_update_hbm(struct sde_connector *c_conn)
+{
+	struct drm_connector *connector = &c_conn->base;
+	struct dsi_display *dsi_display;
+	struct sde_connector_state *c_state;
+	int rc = 0;
+	int fingerprint_mode;
+
+	if (!c_conn) {
+		SDE_ERROR("Invalid params sde_connector null\n");
+		return -EINVAL;
+	}
+
+	if (c_conn->connector_type != DRM_MODE_CONNECTOR_DSI)
+		return 0;
+
+	c_state = to_sde_connector_state(connector->state);
+
+	dsi_display = c_conn->display;
+	if (!dsi_display || !dsi_display->panel) {
+		SDE_ERROR("Invalid params(s) dsi_display %pK, panel %pK\n",
+			dsi_display,
+			((dsi_display) ? dsi_display->panel : NULL));
+		return -EINVAL;
+	}
+
+	if (!c_conn->encoder || !c_conn->encoder->crtc ||
+	    !c_conn->encoder->crtc->state) {
+		return 0;
+	}
+    if(!finger_type){
+        if(dsi_display->panel->aod_status==1) {
+            if(!(sde_crtc_get_fingerprint_mode(c_conn->encoder->crtc->state)))
+                fingerprint_mode = false;
+            else{
+                fingerprint_mode = sde_crtc_get_fingerprint_mode(c_conn->encoder->crtc->state);
+            }
+        }else {
+        if(!(sde_crtc_get_fingerprint_mode(c_conn->encoder->crtc->state)))
+            fingerprint_mode = false;
+        else if(oneplus_dim_status == 1)
+            fingerprint_mode = !!oneplus_dim_status;
+        else
+            fingerprint_mode = sde_crtc_get_fingerprint_mode(c_conn->encoder->crtc->state);
+        }
+    }else{
+        if(dsi_display->panel->aod_status==1) {
+            if(oneplus_dim_status==5)
+                fingerprint_mode = false;
+            else if(oneplus_dim_status==2)
+                fingerprint_mode = !!oneplus_dim_status;
+        }else{
+            return 0;
+        }
+    }
+
+	if (fingerprint_mode != dsi_display->panel->is_hbm_enabled) {
+		//struct drm_encoder *drm_enc = c_conn->encoder;
+		dsi_display->panel->is_hbm_enabled = fingerprint_mode;
+		if (fingerprint_mode) {
+			SDE_ATRACE_BEGIN("set_hbm_on");
+			HBM_flag=true;
+			mutex_lock(&dsi_display->panel->panel_lock);
+			if (dsi_display->panel->aod_status==1 && !finger_type) {
+				pr_err("Send DSI_CMD_AOD_OFF_HBM_ON_SETTING cmds\n");
+				rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_AOD_OFF_HBM_ON_SETTING);
+				aod_real_flag = true;
+			}
+			else if (dsi_display->panel->aod_status == 1 && finger_type) {
+				rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_SET_AOD_OFF_NEW);
+				pr_err("qdt aod off\n");
+			}
+			else {
+				//sde_encoder_poll_line_counts(drm_enc);
+				rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_SET_HBM_ON_5);
+				pr_err("Send DSI_CMD_SET_HBM_ON_5 cmds\n");
+			}
+			SDE_ATRACE_END("set_hbm_on");
+			mutex_unlock(&dsi_display->panel->panel_lock);
+			if (rc) {
+				pr_err("failed to send DSI_GAMMA_CMD_SET_HBM_ON cmds, rc=%d\n", rc);
+				return rc;
+			}
+		}
+		else {
+			SDE_ATRACE_BEGIN("set_hbm_off");
+			HBM_flag = false;
+			//_sde_connector_update_bl_scale(c_conn);
+			mutex_lock(&dsi_display->panel->panel_lock);
+			if (dsi_display->panel->aod_status == 1 && !finger_type) {
+				if(oneplus_dim_status == 5){
+					rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_SET_HBM_OFF);
+					pr_err("Send DSI_CMD_SET_HBM_OFF cmds\n");
+					aod_real_flag = true;
+					oneplus_dim_status = 0;
+					aod_layer_hide = 1;
+				}
+				else {
+					rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_HBM_OFF_AOD_ON_SETTING);
+					pr_err("Send DSI_CMD_HBM_OFF_AOD_ON_SETTING cmds\n");
+				}
+			}
+			else if (dsi_display->panel->aod_status == 1 && finger_type) {
+				if(oneplus_dim_status == 5) {
+					pr_err("qdt aod off dim 5\n");
+				} else {
+					rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_SET_AOD_ON_2);
+					pr_err("qdt aod on dim 0\n");
+				}
+			}
+			else {
+				HBM_flag = false;
+				//sde_encoder_poll_line_counts(drm_enc);
+				rc = dsi_panel_tx_cmd_set_op(dsi_display->panel, DSI_CMD_SET_HBM_OFF);
+				pr_err("Send DSI_CMD_SET_HBM_OFF cmds\n");
+			}
+			SDE_ATRACE_END("set_hbm_off");
+			mutex_unlock(&dsi_display->panel->panel_lock);
+			_sde_connector_update_bl_scale(c_conn);	
+			if (rc) {
+				pr_err("failed to send DSI_CMD_HBM_OFF cmds, rc=%d\n", rc);
+				return rc;
+			}
+		}
+	}
+	return 0;
+}
+
 void sde_connector_set_qsync_params(struct drm_connector *connector)
 {
 	struct sde_connector *c_conn = to_sde_connector(connector);
@@ -647,8 +836,14 @@ int sde_connector_pre_kickoff(struct drm_connector *connector)
 		SDE_ERROR("invalid connector display\n");
 		return -EINVAL;
 	}
-
+	SDE_ATRACE_BEGIN("_sde_connector_update_dirty_properties");
 	rc = _sde_connector_update_dirty_properties(connector);
+	SDE_ATRACE_END("_sde_connector_update_dirty_properties");
+	if (rc) {
+		SDE_EVT32(connector->base.id, SDE_EVTLOG_ERROR);
+		goto end;
+	}
+	rc = _sde_connector_update_hbm(c_conn);
 	if (rc) {
 		SDE_EVT32(connector->base.id, SDE_EVTLOG_ERROR);
 		goto end;
@@ -668,9 +863,9 @@ int sde_connector_pre_kickoff(struct drm_connector *connector)
 	}
 
 	SDE_EVT32_VERBOSE(connector->base.id);
-
+	SDE_ATRACE_BEGIN("ops.pre_kickoff");
 	rc = c_conn->ops.pre_kickoff(connector, c_conn->display, &params);
-
+	SDE_ATRACE_END("ops.pre_kickoff");
 end:
 	return rc;
 }
@@ -1206,8 +1401,8 @@ static int sde_connector_atomic_set_property(struct drm_connector *connector,
 		c_conn->bl_scale_dirty = true;
 		break;
 	case CONNECTOR_PROP_AD_BL_SCALE:
-		c_conn->bl_scale_ad = val;
-		c_conn->bl_scale_dirty = true;
+		//c_conn->bl_scale_ad = val;
+		//c_conn->bl_scale_dirty = true;
 		break;
 	default:
 		break;
@@ -1980,6 +2175,9 @@ static int sde_connector_populate_mode_info(struct drm_connector *conn,
 
 		sde_kms_info_add_keystr(info, "mode_name", mode->name);
 
+		sde_kms_info_add_keyint(info, "bit_clk_rate",
+					mode_info.clk_rate);
+
 		topology_idx = (int)sde_rm_get_topology_name(
 							mode_info.topology);
 		if (topology_idx < SDE_RM_TOPOLOGY_MAX) {
@@ -2310,6 +2508,9 @@ struct drm_connector *sde_connector_init(struct drm_device *dev,
 		0x0, 0, MAX_AD_BL_SCALE_LEVEL, MAX_AD_BL_SCALE_LEVEL,
 		CONNECTOR_PROP_AD_BL_SCALE);
 
+	msm_property_install_range(&c_conn->property_info,"CONNECTOR_CUST",
+			0x0, 0, INT_MAX, 0, CONNECTOR_PROP_CUSTOM);
+
 	c_conn->bl_scale_dirty = false;
 	c_conn->bl_scale = MAX_BL_SCALE_LEVEL;
 	c_conn->bl_scale_ad = MAX_AD_BL_SCALE_LEVEL;
diff --git a/drivers/gpu/drm/msm/sde/sde_crtc.c b/drivers/gpu/drm/msm/sde/sde_crtc.c
old mode 100644
new mode 100755
index 7bd47aa80ef0ec78b2eee7330f09b50755ff202b..b8cff1597003d150f692dd289644d4c806046561
--- a/drivers/gpu/drm/msm/sde/sde_crtc.c
+++ b/drivers/gpu/drm/msm/sde/sde_crtc.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2014-2018 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2014-2019 The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -42,9 +42,41 @@
 #include "sde_core_perf.h"
 #include "sde_trace.h"
 
+#include <linux/msm_drm_notify.h>
+#include <linux/notifier.h>
+
+
+#include <linux/err.h>
+#include <linux/list.h>
+#include <linux/of.h>
+#include <linux/err.h>
+#include "msm_drv.h"
+#include "sde_connector.h"
+#include "msm_mmu.h"
+#include "dsi_display.h"
+#include "dsi_panel.h"
+#include "dsi_ctrl.h"
+#include "dsi_ctrl_hw.h"
+#include "dsi_drm.h"
+#include "dsi_clk.h"
+#include "dsi_pwr.h"
+#include "sde_dbg.h"
+#include <linux/kobject.h>
+#include <linux/string.h>
+#include <linux/sysfs.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <drm/drm_mipi_dsi.h>
+extern int msm_drm_notifier_call_chain(unsigned long val, void *v);
+
 #define SDE_PSTATES_MAX (SDE_STAGE_MAX * 4)
 #define SDE_MULTIRECT_PLANE_MAX (SDE_STAGE_MAX * 2)
 
+#include <drm/drm_sysfs.h>
+#include <drm/drmP.h>
+#define to_drm_connector(d) dev_get_drvdata(d)
+#define to_dsi_bridge(x)  container_of((x), struct dsi_bridge, base)
+
 struct sde_crtc_custom_events {
 	u32 event;
 	int (*func)(struct drm_crtc *crtc, bool en,
@@ -927,8 +959,9 @@ static bool sde_crtc_mode_fixup(struct drm_crtc *crtc,
 	SDE_DEBUG("\n");
 
 	if ((msm_is_mode_seamless(adjusted_mode) ||
-			msm_is_mode_seamless_vrr(adjusted_mode)) &&
-		(!crtc->enabled)) {
+	     (msm_is_mode_seamless_vrr(adjusted_mode) ||
+	      msm_is_mode_seamless_dyn_clk(adjusted_mode))) &&
+	    (!crtc->enabled)) {
 		SDE_ERROR("crtc state prevents seamless transition\n");
 		return false;
 	}
@@ -2003,6 +2036,12 @@ static void _sde_crtc_blend_setup_mixer(struct drm_crtc *crtc,
 		for (i = 0; i < cstate->num_dim_layers; i++)
 			_sde_crtc_setup_dim_layer_cfg(crtc, sde_crtc,
 					mixer, &cstate->dim_layer[i]);
+
+	if (cstate->fingerprint_dim_layer)
+		{
+		_sde_crtc_setup_dim_layer_cfg(crtc, sde_crtc,
+					mixer, cstate->fingerprint_dim_layer);
+		}
 	}
 
 	_sde_crtc_program_lm_output_roi(crtc);
@@ -2931,6 +2970,32 @@ void sde_crtc_complete_commit(struct drm_crtc *crtc,
 	SDE_EVT32_VERBOSE(DRMID(crtc));
 
 	sde_core_perf_crtc_update(crtc, 0, false);
+
+	{
+		struct sde_crtc_state *old_cstate;
+		struct sde_crtc_state *cstate;
+		struct msm_drm_notifier notifier_data;
+		int blank;
+
+		if (!old_state) {
+			SDE_ERROR("failed to find old cstate");
+			return;
+		}
+		old_cstate = to_sde_crtc_state(old_state);
+		cstate = to_sde_crtc_state(crtc->state);
+
+		if (old_cstate->fingerprint_pressed != cstate->fingerprint_pressed) {
+			blank = cstate->fingerprint_pressed;
+			notifier_data.data = &blank;
+			notifier_data.id = MSM_DRM_PRIMARY_DISPLAY;
+			pr_err("fingerprint status: %s",
+			       blank ? "pressed" : "up");
+			SDE_ATRACE_BEGIN("press_event_notify");
+			msm_drm_notifier_call_chain(MSM_DRM_ONSCREENFINGERPRINT_EVENT,
+					&notifier_data);
+			SDE_ATRACE_END("press_event_notify");
+		}
+	}
 }
 
 /**
@@ -3034,6 +3099,315 @@ static void _sde_crtc_set_dim_layer_v1(struct sde_crtc_state *cstate,
 	}
 }
 
+bool sde_crtc_get_fingerprint_mode(struct drm_crtc_state *crtc_state)
+{
+	struct sde_crtc_state *cstate;
+
+	if (!crtc_state)
+		return false;
+
+	cstate = to_sde_crtc_state(crtc_state);
+	return !!cstate->fingerprint_dim_layer;
+}
+
+bool sde_crtc_get_fingerprint_pressed(struct drm_crtc_state *crtc_state)
+{
+	struct sde_crtc_state *cstate;
+
+	if (!crtc_state)
+		return false;
+
+	cstate = to_sde_crtc_state(crtc_state);
+	return cstate->fingerprint_pressed;
+}
+
+/*******************************************************************/
+
+extern int oneplus_force_screenfp;
+extern int oneplus_panel_alpha;
+struct ba {
+	u32 brightness;
+	u32 alpha;
+};
+
+struct ba brightness_alpha_lut[] = {
+	{0, 0xff},
+	{1, 0xf1},
+	{2, 0xf0},
+	{3, 0xee},
+	{4, 0xec},
+	{6, 0xeb},
+	{10, 0xe7},
+	{20, 0xdf},
+	{30, 0xd8},
+	{45, 0xd0},
+	{70, 0xc5},
+	{100, 0xb9},
+	{150, 0xaf},
+	{227, 0x99},
+	{300, 0x88},
+	{400, 0x76},
+	{500, 0x66},
+	{600, 0x59},
+	{800, 0x42},
+	{1023, 0x2a},
+	{2000, 0x83},
+};
+
+static int interpolate(int x, int xa, int xb, int ya, int yb)
+{
+	int bf, factor, plus;
+	int sub = 0;
+
+	bf = 2 * (yb - ya) * (x - xa) / (xb - xa);
+	factor = bf / 2;
+	plus = bf % 2;
+	if ((xa - xb) && (yb - ya))
+		sub = 2 * (x - xa) * (x - xb) / (yb - ya) / (xa - xb);
+
+	return ya + factor + plus + sub;
+}
+
+int brightness_to_alpha(int brightness)
+{
+	int level = ARRAY_SIZE(brightness_alpha_lut);
+	int i = 0;
+
+	for (i = 0; i < ARRAY_SIZE(brightness_alpha_lut); i++){
+		if (brightness_alpha_lut[i].brightness >= brightness)
+			break;
+	}
+
+	if (i == 0)
+		return brightness_alpha_lut[0].alpha;
+	else if (i == level)
+		return brightness_alpha_lut[level - 1].alpha;
+
+	return interpolate(brightness,
+			brightness_alpha_lut[i-1].brightness,
+			brightness_alpha_lut[i].brightness,
+			brightness_alpha_lut[i-1].alpha,
+			brightness_alpha_lut[i].alpha);
+}
+
+int oneplus_get_panel_brightness_to_alpha(void)
+{
+	struct dsi_display *display = get_main_display();
+
+	if (!display)
+		return 0;
+	if (oneplus_panel_alpha)
+		return oneplus_panel_alpha;
+		return brightness_to_alpha(display->panel->hbm_backlight);
+}
+
+int oneplus_onscreenaod_hid = 0;
+int oneplus_aod_hid = 0;
+ssize_t oneplus_display_notify_aod_hid(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+	int onscreenaod_hid = 0;
+	SDE_ATRACE_BEGIN("aod_hid_node");
+	sscanf(buf, "%du", &onscreenaod_hid);
+	oneplus_onscreenaod_hid = !!onscreenaod_hid;
+	if (onscreenaod_hid == oneplus_onscreenaod_hid)
+		{
+		SDE_ATRACE_END("oneplus_display_notify_fp_press");
+		return count;
+		}
+
+	pr_err("notify aod hid %d\n", onscreenaod_hid );
+	oneplus_onscreenaod_hid = onscreenaod_hid;
+	SDE_ATRACE_END("aod_hid_node");
+	return count;
+}
+
+int oneplus_onscreenfp_status = 0;
+ssize_t oneplus_display_notify_fp_press(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	struct drm_device *drm_dev;
+	struct drm_connector *dsi_connector;
+	struct drm_mode_config *mode_config;
+	struct drm_atomic_state *state;
+	struct drm_crtc_state *crtc_state;
+	struct drm_crtc *crtc;
+	struct msm_drm_private *priv;
+	int err;
+	ktime_t now;
+	bool need_commit = false;
+	int onscreenfp_status = 0;
+	SDE_ATRACE_BEGIN("oneplus_display_notify_fp_press");
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+
+	c_bridge =  to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+	drm_dev = dsi_display->drm_dev;
+	dsi_connector = dsi_display->drm_conn;
+	mode_config = &drm_dev->mode_config;
+	sscanf(buf, "%du", &onscreenfp_status);
+	onscreenfp_status = !!onscreenfp_status;
+	if (onscreenfp_status == oneplus_onscreenfp_status)
+		{
+		SDE_ATRACE_END("oneplus_display_notify_fp_press");
+		return count;
+		}
+
+	pr_err("notify fingerpress %d\n", onscreenfp_status );
+	oneplus_onscreenfp_status = onscreenfp_status;
+
+	drm_modeset_lock_all(drm_dev);
+	state = drm_atomic_state_alloc(drm_dev);
+	state->acquire_ctx = mode_config->acquire_ctx;
+	crtc = dsi_connector->state->crtc;
+	crtc_state = drm_atomic_get_crtc_state(state, crtc);
+	priv = drm_dev->dev_private;
+	now = ktime_get();
+	need_commit = (((now- priv->commit_end_time) > 20000000 ? true:false)&&dsi_display->panel->aod_status==0);
+	if(need_commit){
+	err = drm_atomic_commit(state);
+		if (err < 0)
+			drm_atomic_state_clear(state);
+	}
+	drm_modeset_unlock_all(drm_dev);
+	SDE_ATRACE_END("oneplus_display_notify_fp_press");
+	return count;
+}
+extern int aod_layer_hide;
+extern bool HBM_flag;
+int oneplus_dim_status = 0;
+ ssize_t oneplus_display_notify_dim(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+	struct drm_connector *connector = to_drm_connector(dev);
+	struct dsi_display *dsi_display = NULL;
+	struct dsi_bridge *c_bridge;
+	struct drm_device *drm_dev;
+	struct drm_connector *dsi_connector;
+	struct drm_mode_config *mode_config;
+	struct drm_atomic_state *state;
+	struct drm_crtc_state *crtc_state;
+	struct drm_crtc *crtc;
+	int err;
+	int dim_status = 0;
+
+    SDE_ATRACE_BEGIN("oneplus_display_notify_dim");
+	if ((connector == NULL) || (connector->encoder == NULL)
+			|| (connector->encoder->bridge == NULL))
+		return 0;
+	c_bridge =	to_dsi_bridge(connector->encoder->bridge);
+	dsi_display = c_bridge->display;
+
+	if ((dsi_display == NULL) || (dsi_display->panel == NULL))
+		return -EINVAL;
+	drm_dev = dsi_display->drm_dev;
+	dsi_connector = dsi_display->drm_conn;
+	mode_config = &drm_dev->mode_config;
+	sscanf(buf, "%du", &dim_status);
+	pr_err("notify dim %d\n", dim_status);
+
+	if(dsi_display->panel->aod_status==0 && (dim_status == 2)){
+		pr_err("fp set it in normal status\n");
+		if (dim_status == oneplus_dim_status)
+			return count;
+		oneplus_dim_status = dim_status;
+		SDE_ATRACE_END("oneplus_display_notify_dim");
+		return count;
+	}else if(dsi_display->panel->aod_status==1&& dim_status == 2){
+		oneplus_onscreenfp_status = 1;
+	}else if(dsi_display->panel->aod_status==1&& dim_status == 0){
+		oneplus_onscreenfp_status = 0;
+    }
+    if(dim_status == 0)
+        oneplus_onscreenfp_status = 0;
+    if (dim_status == oneplus_dim_status)
+		return count;
+	oneplus_dim_status = dim_status;
+	drm_modeset_lock_all(drm_dev);
+
+	state = drm_atomic_state_alloc(drm_dev);
+	state->acquire_ctx = mode_config->acquire_ctx;
+	crtc = dsi_connector->state->crtc;
+	crtc_state = drm_atomic_get_crtc_state(state, crtc);
+	if((oneplus_dim_status !=0) && (oneplus_dim_status != 5)){
+		err = drm_atomic_commit(state);
+		if (err < 0)
+			drm_atomic_state_clear(state);
+	}
+	drm_modeset_unlock_all(drm_dev);
+	SDE_ATRACE_END("oneplus_display_notify_dim");
+	return count;
+}
+/***************************************************************************/
+static int sde_crtc_config_fingerprint_dim_layer(struct drm_crtc_state *crtc_state, int stage)
+{
+	struct sde_crtc_state *cstate;
+	struct drm_display_mode *mode = &crtc_state->adjusted_mode;
+	struct sde_hw_dim_layer *fingerprint_dim_layer;
+	int alpha = oneplus_get_panel_brightness_to_alpha();
+	struct sde_kms *kms;
+    struct dsi_display *display = get_main_display();
+
+    if(display == NULL || display->panel == NULL){
+        SDE_ERROR("display  panel is null\n");
+		return 0;
+    }
+
+    if(display->panel->aod_status==1){
+        if(oneplus_dim_status == 2){
+            alpha = 255;
+        }
+	}
+
+	kms = _sde_crtc_get_kms(crtc_state->crtc);
+	if (!kms || !kms->catalog) {
+		SDE_ERROR("invalid kms\n");
+		return -EINVAL;
+	}
+	SDE_ATRACE_BEGIN("set_dim_layer");
+
+	cstate = to_sde_crtc_state(crtc_state);
+
+	if (cstate->num_dim_layers == SDE_MAX_DIM_LAYERS - 1) {
+		pr_err("failed to get available dim layer for custom\n");
+		return -EINVAL;
+	}
+
+	if (!alpha) {
+		cstate->fingerprint_dim_layer = NULL;
+		return 0;
+	}
+
+	if ((stage + SDE_STAGE_0) >= kms->catalog->mixer[0].sblk->maxblendstages) {
+		return -EINVAL;
+	}
+
+	fingerprint_dim_layer = &cstate->dim_layer[cstate->num_dim_layers];
+	fingerprint_dim_layer->flags = SDE_DRM_DIM_LAYER_INCLUSIVE;
+	fingerprint_dim_layer->stage = stage + SDE_STAGE_0;
+
+	fingerprint_dim_layer->rect.x = 0;
+	fingerprint_dim_layer->rect.y = 0;
+	fingerprint_dim_layer->rect.w = mode->hdisplay;
+	fingerprint_dim_layer->rect.h = mode->vdisplay;
+	fingerprint_dim_layer->color_fill = (struct sde_mdss_color) {0, 0, 0, alpha};
+	cstate->fingerprint_dim_layer = fingerprint_dim_layer;
+	SDE_ATRACE_END("set_dim_layer");
+
+	return 0;
+}
+
 /**
  * _sde_crtc_set_dest_scaler - copy dest scaler settings from userspace
  * @sde_crtc   :  Pointer to sde crtc
@@ -4804,7 +5178,9 @@ static void sde_crtc_enable(struct drm_crtc *crtc,
 
 	/* return early if crtc is already enabled */
 	if (sde_crtc->enabled) {
-		if (msm_is_mode_seamless_dms(&crtc->state->adjusted_mode))
+		if (msm_is_mode_seamless_dms(&crtc->state->adjusted_mode) ||
+		msm_is_mode_seamless_dyn_clk(&crtc->state->adjusted_mode))
+
 			SDE_DEBUG("%s extra crtc enable expected during DMS\n",
 					sde_crtc->name);
 		else
@@ -5080,6 +5456,156 @@ static int _sde_crtc_check_secure_state(struct drm_crtc *crtc,
 	return 0;
 }
 
+extern bool finger_type;
+//extern int aod_layer_hide;
+extern int sde_plane_check_fingerprint_layer(const struct drm_plane_state *drm_state);
+static int sde_crtc_onscreenfinger_atomic_check(struct sde_crtc_state *cstate,
+		struct plane_state *pstates, int cnt)
+{
+	int fp_index = -1;
+	int fppressed_index = -1;
+    int aod_index = -1;
+	int zpos = INT_MAX;
+	int mode;
+	int fp_mode = oneplus_onscreenfp_status;
+	int dim_mode = oneplus_dim_status;
+    int aod_mode = -1;
+	int i;
+    struct dsi_display *display = get_main_display();
+
+    if(display == NULL || display->panel == NULL){
+        SDE_ERROR("display  panel is null\n");
+		return 0;
+    }
+
+    if(display->panel->aod_status==1){
+        if(oneplus_dim_status == 2 && oneplus_onscreenfp_status ==1){
+            fp_mode = 1;
+            //dim_mode = 0;
+        }else if(oneplus_dim_status == 2 && oneplus_onscreenfp_status == 0){
+            fp_mode = 0;
+            dim_mode = 0;
+        }
+	}
+	if(/*oneplus_onscreenaod_hid && */(oneplus_dim_status == 5||aod_layer_hide ==1)){
+		oneplus_aod_hid = 1;
+		dim_mode = 0;
+    }
+    aod_mode = oneplus_aod_hid;
+	if(( oneplus_dim_status == 5) && display->panel->aod_status==0)
+		dim_mode = 0;
+
+	for (i = 0; i < cnt; i++) {
+		mode = sde_plane_check_fingerprint_layer(pstates[i].drm_pstate);
+		if (mode == 1)
+			fp_index = i;
+		if (mode == 2)
+		    fppressed_index = i;
+        if (mode ==3)
+            aod_index = i;
+	}
+	if(fp_index >=0)
+		display->panel->dim_status = true;
+	else
+		display->panel->dim_status = false;
+
+	if(aod_index <0){
+		oneplus_aod_hid = 0;
+		aod_layer_hide = 0;
+    }
+
+    if(finger_type){
+        if (aod_index >= 0) {
+			if (aod_mode == 1) {
+				SDE_ATRACE_BEGIN("aod_layer_qbt_hid");
+				pstates[aod_index].sde_pstate->property_values[PLANE_PROP_ALPHA].value = 0;
+				aod_index = -1;
+				SDE_ATRACE_END("aod_layer_qbt_hid");
+			}
+		}
+        return 0;
+    }
+
+	if (fp_index >= 0 || fppressed_index >= 0 || oneplus_force_screenfp) {
+		if (fp_index >= 0 && fppressed_index >= 0) {
+			if (pstates[fp_index].stage >= pstates[fppressed_index].stage) {
+				SDE_ERROR("Bug!!@@@@: fp layer top of fppressed layer\n");
+				return -EINVAL;
+			}
+		}
+		if (fppressed_index >= 0) {
+			if (zpos > pstates[fppressed_index].stage)
+				zpos = pstates[fppressed_index].stage;
+			pstates[fppressed_index].stage++;
+		}
+
+		if (fp_index >= 0) {
+			if (zpos > pstates[fp_index].stage)
+				zpos = pstates[fp_index].stage;
+			pstates[fp_index].stage++;
+		}
+		for (i = 0; i < cnt; i++) {
+				if (i == fp_index || i == fppressed_index)
+					{
+					continue;
+					}
+				if (pstates[i].stage >= zpos) {
+				//	SDE_ERROR("Warn!!: the fp layer not on top");
+				pstates[i].stage++;
+				}
+			}
+		if (zpos == INT_MAX) {
+			zpos = 0;
+			for (i = 0; i < cnt; i++) {
+				if (pstates[i].stage > zpos)
+					zpos = pstates[i].stage;
+			}
+			zpos++;
+		}
+
+		if (fp_index >= 0) {
+			if (dim_mode == 0) {
+				//pstates[fp_index].sde_pstate->property_values[PLANE_PROP_ALPHA].value = 0xff;
+				fp_index = -1;
+			}
+		}
+        if (fppressed_index >= 0) {
+			if (fp_mode == 0) {
+				pstates[fppressed_index].sde_pstate->property_values[PLANE_PROP_ALPHA].value = 0;
+				fppressed_index = -1;
+			} else {
+				pstates[fppressed_index].sde_pstate->property_values[PLANE_PROP_ALPHA].value = 0xff;
+			}
+		}
+
+         if (aod_index >= 0) {
+			if (aod_mode == 1) {
+                SDE_ATRACE_BEGIN("aod_layer_hid");
+				pstates[aod_index].sde_pstate->property_values[PLANE_PROP_ALPHA].value = 0;
+				aod_index = -1;
+                SDE_ATRACE_END("aod_layer_hid");
+			}
+		}
+
+		if (fp_index >= 0 && sde_crtc_config_fingerprint_dim_layer(&cstate->base, zpos)) {
+			SDE_ERROR("Failed to config dim layer\n");
+			return -EINVAL;
+		}
+		if (fppressed_index >= 0)
+			cstate->fingerprint_pressed = true;
+		else {
+			cstate->fingerprint_pressed = false;
+		}
+	}
+	if (fp_index < 0) {
+		cstate->fingerprint_dim_layer = NULL;
+	}
+	if (fppressed_index < 0)
+		cstate->fingerprint_pressed = false;
+
+	return 0;
+}
+
 static int sde_crtc_atomic_check(struct drm_crtc *crtc,
 		struct drm_crtc_state *state)
 {
@@ -5247,7 +5773,9 @@ static int sde_crtc_atomic_check(struct drm_crtc *crtc,
 			sde_plane_clear_multirect(pipe_staged[i]);
 		}
 	}
-
+	rc = sde_crtc_onscreenfinger_atomic_check(cstate, pstates, cnt);
+	if (rc)
+		goto end;
 	/* assign mixer stages based on sorted zpos property */
 	sort(pstates, cnt, sizeof(pstates[0]), pstate_cmp, NULL);
 
@@ -5472,6 +6000,9 @@ static void sde_crtc_install_properties(struct drm_crtc *crtc,
 		"idle_time", 0, 0, U64_MAX, 0,
 		CRTC_PROP_IDLE_TIMEOUT);
 
+		msm_property_install_range(&sde_crtc->property_info,"CRTC_CUST",
+			0x0, 0, INT_MAX, 0, CRTC_PROP_CUSTOM);
+
 	if (catalog->has_idle_pc)
 		msm_property_install_enum(&sde_crtc->property_info,
 			"idle_pc_state", 0x0, 0, e_idle_pc_state,
diff --git a/drivers/gpu/drm/msm/sde/sde_crtc.h b/drivers/gpu/drm/msm/sde/sde_crtc.h
old mode 100644
new mode 100755
index 9e9d4995b8b83295a9964066e6e01e867e77404c..26a8e99038568d3149a00f261009ba80d1fd77cb
--- a/drivers/gpu/drm/msm/sde/sde_crtc.h
+++ b/drivers/gpu/drm/msm/sde/sde_crtc.h
@@ -426,6 +426,8 @@ struct sde_crtc_state {
 	u32 sbuf_prefill_line;
 	u64 sbuf_clk_rate[2];
 	bool sbuf_clk_shifted;
+	bool fingerprint_pressed;
+	struct sde_hw_dim_layer *fingerprint_dim_layer;
 
 	struct sde_crtc_respool rp;
 };
diff --git a/drivers/gpu/drm/msm/sde/sde_encoder.c b/drivers/gpu/drm/msm/sde/sde_encoder.c
old mode 100644
new mode 100755
index 6ef182805dcb23bef999846ab2144a82f74d1eee..9e18e611918831eaf8cbcfe41f1923d0a77bd985
--- a/drivers/gpu/drm/msm/sde/sde_encoder.c
+++ b/drivers/gpu/drm/msm/sde/sde_encoder.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2014-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark@gmail.com>
  *
@@ -82,6 +82,10 @@
 		((x) == SDE_RM_TOPOLOGY_DUALPIPE_3DMERGE) || \
 		((x) == SDE_RM_TOPOLOGY_DUALPIPE_3DMERGE_DSC))
 
+#define DSI_PANEL_SAMSUNG_S6E3HC2 0
+#define DSI_PANEL_SAMSUNG_S6E3FC2X01 1
+extern char dsi_panel_name;
+
 /**
  * enum sde_enc_rc_events - events for resource control state machine
  * @SDE_ENC_RC_EVENT_KICKOFF:
@@ -1896,7 +1900,12 @@ static int _sde_encoder_update_rsc_client(
 	    (rsc_config->prefill_lines != prefill_lines) ||
 	    (rsc_config->jitter_numer != mode_info.jitter_numer) ||
 	    (rsc_config->jitter_denom != mode_info.jitter_denom)) {
-		rsc_config->fps = mode_info.frame_rate;
+		if (dsi_panel_name == DSI_PANEL_SAMSUNG_S6E3HC2) {
+			rsc_config->fps = 90;
+		}
+		else {
+			rsc_config->fps = mode_info.frame_rate;
+		}
 		rsc_config->vtotal = mode_info.vtotal;
 		rsc_config->prefill_lines = prefill_lines;
 		rsc_config->jitter_numer = mode_info.jitter_numer;
@@ -2732,7 +2741,8 @@ static void sde_encoder_virt_mode_set(struct drm_encoder *drm_enc,
 	}
 
 	/* release resources before seamless mode change */
-	if (msm_is_mode_seamless_dms(adj_mode)) {
+	if (msm_is_mode_seamless_dms(adj_mode) ||
+			msm_is_mode_seamless_dyn_clk(adj_mode)) {
 		/* restore resource state before releasing them */
 		ret = sde_encoder_resource_control(drm_enc,
 				SDE_ENC_RC_EVENT_PRE_MODESET);
@@ -2806,7 +2816,8 @@ static void sde_encoder_virt_mode_set(struct drm_encoder *drm_enc,
 	}
 
 	/* update resources after seamless mode change */
-	if (msm_is_mode_seamless_dms(adj_mode))
+	if (msm_is_mode_seamless_dms(adj_mode) ||
+			msm_is_mode_seamless_dyn_clk(adj_mode))
 		sde_encoder_resource_control(&sde_enc->base,
 						SDE_ENC_RC_EVENT_POST_MODESET);
 }
@@ -3091,7 +3102,8 @@ static void sde_encoder_virt_enable(struct drm_encoder *drm_enc)
 	}
 
 	/* register input handler if not already registered */
-	if (sde_enc->input_handler && !msm_is_mode_seamless_dms(cur_mode)) {
+	if (sde_enc->input_handler && !msm_is_mode_seamless_dms(cur_mode) &&
+			!msm_is_mode_seamless_dyn_clk(cur_mode)) {
 		ret = _sde_encoder_input_handler_register(
 				sde_enc->input_handler);
 		if (ret)
@@ -3100,7 +3112,8 @@ static void sde_encoder_virt_enable(struct drm_encoder *drm_enc)
 	}
 
 	if (!(msm_is_mode_seamless_vrr(cur_mode)
-			|| msm_is_mode_seamless_dms(cur_mode)))
+			|| msm_is_mode_seamless_dms(cur_mode)
+			|| msm_is_mode_seamless_dyn_clk(cur_mode)))
 		kthread_init_delayed_work(&sde_enc->delayed_off_work,
 			sde_encoder_off_work);
 
@@ -3137,7 +3150,8 @@ static void sde_encoder_virt_enable(struct drm_encoder *drm_enc)
 			 * already. Invoke restore to reconfigure the
 			 * new mode.
 			 */
-			if (msm_is_mode_seamless_dms(cur_mode) &&
+			if ((msm_is_mode_seamless_dms(cur_mode) ||
+				msm_is_mode_seamless_dyn_clk(cur_mode)) &&
 					phys->ops.restore)
 				phys->ops.restore(phys);
 			else if (phys->ops.enable)
@@ -3150,7 +3164,8 @@ static void sde_encoder_virt_enable(struct drm_encoder *drm_enc)
 						sde_enc->misr_frame_count);
 	}
 
-	if (msm_is_mode_seamless_dms(cur_mode) &&
+	if ((msm_is_mode_seamless_dms(cur_mode) ||
+			msm_is_mode_seamless_dyn_clk(cur_mode)) &&
 			sde_enc->cur_master->ops.restore)
 		sde_enc->cur_master->ops.restore(sde_enc->cur_master);
 	else if (sde_enc->cur_master->ops.enable)
@@ -4022,6 +4037,35 @@ void sde_encoder_trigger_kickoff_pending(struct drm_encoder *drm_enc)
 	sde_enc->idle_pc_restore = false;
 }
 
+extern bool sde_crtc_get_fingerprint_mode(struct drm_crtc_state *crtc_state);
+static bool
+_sde_encoder_setup_dither_for_onscreenfingerprint(struct sde_encoder_phys *phys,struct sde_hw_pingpong *hw_pp,
+ void *dither_cfg, int len)
+{
+ struct drm_encoder *drm_enc = phys->parent;
+ struct drm_msm_dither dither;
+
+ if (!drm_enc || !drm_enc->crtc)
+ return -EFAULT;
+
+ if (!sde_crtc_get_fingerprint_mode(drm_enc->crtc->state))
+ return -EINVAL;
+
+ if (len != sizeof(dither))
+ return -EINVAL;
+
+ memcpy(&dither, dither_cfg, len);
+ dither.c0_bitdepth = 6;
+ dither.c1_bitdepth = 6;
+ dither.c2_bitdepth = 6;
+ dither.c3_bitdepth = 6;
+ dither.temporal_en = 1;
+
+ phys->hw_pp->ops.setup_dither(hw_pp, &dither, len);
+
+ return 0;
+}
+
 static void _sde_encoder_setup_dither(struct sde_encoder_phys *phys)
 {
 	void *dither_cfg;
@@ -4067,6 +4111,7 @@ static void _sde_encoder_setup_dither(struct sde_encoder_phys *phys)
 		for (i = 0; i < MAX_CHANNELS_PER_ENC; i++) {
 			hw_pp = sde_enc->hw_pp[i];
 			if (hw_pp) {
+            if (_sde_encoder_setup_dither_for_onscreenfingerprint(phys,hw_pp, dither_cfg, len))
 				phys->hw_pp->ops.setup_dither(hw_pp, dither_cfg,
 								len);
 			}
@@ -4477,8 +4522,10 @@ int sde_encoder_prepare_for_kickoff(struct drm_encoder *drm_enc,
 			}
 		}
 	}
-
+	SDE_ATRACE_BEGIN("sde_encoder_resource_control");
 	rc = sde_encoder_resource_control(drm_enc, SDE_ENC_RC_EVENT_KICKOFF);
+	SDE_ATRACE_END("sde_encoder_resource_control");
+
 	if (rc) {
 		SDE_ERROR_ENC(sde_enc, "resource kickoff failed rc %d\n", rc);
 		ret = rc;
@@ -4503,13 +4550,18 @@ int sde_encoder_prepare_for_kickoff(struct drm_encoder *drm_enc,
 				phys->ops.hw_reset(phys);
 		}
 	}
-
+	SDE_ATRACE_BEGIN("_sde_encoder_update_master");
 	_sde_encoder_update_master(drm_enc, params);
+	SDE_ATRACE_END("_sde_encoder_update_master");
 
+	SDE_ATRACE_BEGIN("_sde_encoder_update_roi");
 	_sde_encoder_update_roi(drm_enc);
+	SDE_ATRACE_END("_sde_encoder_update_roi");
 
 	if (sde_enc->cur_master && sde_enc->cur_master->connector) {
+		SDE_ATRACE_BEGIN("sde_connector_pre_kickoff");
 		rc = sde_connector_pre_kickoff(sde_enc->cur_master->connector);
+		SDE_ATRACE_END("sde_connector_pre_kickoff");
 		if (rc) {
 			SDE_ERROR_ENC(sde_enc, "kickoff conn%d failed rc %d\n",
 					sde_enc->cur_master->connector->base.id,
diff --git a/drivers/gpu/drm/msm/sde/sde_hw_dsc.c b/drivers/gpu/drm/msm/sde/sde_hw_dsc.c
index dd0a7e055b356eb23080eb50201b55b4cd90da28..1e9ef8ab9b832e987ba6f29b5d41fcdeb08f3e6f 100644
--- a/drivers/gpu/drm/msm/sde/sde_hw_dsc.c
+++ b/drivers/gpu/drm/msm/sde/sde_hw_dsc.c
@@ -146,6 +146,11 @@ static void sde_hw_dsc_config_thresh(struct sde_hw_dsc *hw_dsc,
 	struct sde_hw_blk_reg_map *dsc_c = &hw_dsc->hw;
 	u32 off = 0x0;
 
+	if (!dsc->buf_thresh) {
+		SDE_ERROR("dsc->buf_thresh is NULL pointer");
+		return;
+	}
+
 	lp = dsc->buf_thresh;
 	off = DSC_RC_BUF_THRESH;
 	for (i = 0; i < 14; i++) {
diff --git a/drivers/gpu/drm/msm/sde/sde_hw_mdss.h b/drivers/gpu/drm/msm/sde/sde_hw_mdss.h
index 22eb6ae9b67d53d13f7cb0614f8b2f813ae93bc9..fda957c139b746cf5a59c07bdf7fc1ee051a5beb 100644
--- a/drivers/gpu/drm/msm/sde/sde_hw_mdss.h
+++ b/drivers/gpu/drm/msm/sde/sde_hw_mdss.h
@@ -551,6 +551,13 @@ struct sde_hw_dim_layer {
 	struct sde_rect rect;
 };
 
+struct fingerprint_dim_layer {
+	uint32_t flags;
+	uint32_t stage;
+	struct sde_mdss_color color_fill;
+	struct sde_rect rect;
+};
+
 /**
  * struct sde_splash_mem - Struct contains splah memory info
  * @splash_buf_size: Indicates the size of the memory region
diff --git a/drivers/gpu/drm/msm/sde/sde_plane.c b/drivers/gpu/drm/msm/sde/sde_plane.c
index d0335bf8dfddfa89cff023f6bc17914b92ddd439..b1f73c48ddf5b88564ac144f2cb9822876bf5eaa 100644
--- a/drivers/gpu/drm/msm/sde/sde_plane.c
+++ b/drivers/gpu/drm/msm/sde/sde_plane.c
@@ -2897,6 +2897,18 @@ void sde_plane_clear_multirect(const struct drm_plane_state *drm_state)
 	pstate->multirect_mode = SDE_SSPP_MULTIRECT_NONE;
 }
 
+int sde_plane_check_fingerprint_layer(const struct drm_plane_state *drm_state)
+{
+	struct sde_plane_state *pstate;
+
+	if (!drm_state)
+		return 0;
+
+	pstate = to_sde_plane_state(drm_state);
+
+	return sde_plane_get_property(pstate, PLANE_PROP_CUSTOM);
+}
+
 /**
  * multi_rect validate API allows to validate only R0 and R1 RECT
  * passing for each plane. Client of this API must not pass multiple
@@ -3903,6 +3915,7 @@ static int sde_plane_sspp_atomic_update(struct drm_plane *plane,
 		case PLANE_PROP_ALPHA:
 		case PLANE_PROP_INPUT_FENCE:
 		case PLANE_PROP_BLEND_OP:
+		case PLANE_PROP_CUSTOM:
 			/* no special action required */
 			break;
 		case PLANE_PROP_FB_TRANSLATION_MODE:
@@ -4331,7 +4344,8 @@ static void _sde_plane_install_properties(struct drm_plane *plane,
 
 	msm_property_install_range(&psde->property_info, "zpos",
 		0x0, 0, zpos_max, zpos_def, PLANE_PROP_ZPOS);
-
+	msm_property_install_range(&psde->property_info, "PLANE_CUST",
+			0x0, 0, INT_MAX, 0, PLANE_PROP_CUSTOM);
 	msm_property_install_range(&psde->property_info, "alpha",
 		0x0, 0, 255, 255, PLANE_PROP_ALPHA);
 
diff --git a/drivers/gpu/drm/msm/sde_dbg.c b/drivers/gpu/drm/msm/sde_dbg.c
index 01e1fbbc1b82a167322fb10c96935963b215d8dd..4a5950ebe9d7f6289e63b30881fc67d6f8e65961 100644
--- a/drivers/gpu/drm/msm/sde_dbg.c
+++ b/drivers/gpu/drm/msm/sde_dbg.c
@@ -26,7 +26,7 @@
 
 #define SDE_DBG_BASE_MAX		10
 
-#define DEFAULT_PANIC		1
+#define DEFAULT_PANIC		0
 #define DEFAULT_REGDUMP		SDE_DBG_DUMP_IN_MEM
 #define DEFAULT_DBGBUS_SDE	SDE_DBG_DUMP_IN_MEM
 #define DEFAULT_DBGBUS_VBIFRT	SDE_DBG_DUMP_IN_MEM
diff --git a/drivers/gpu/msm/kgsl_debugfs.c b/drivers/gpu/msm/kgsl_debugfs.c
index 834706a973d230e8e989acf8f7f6b1eb62431c7b..1ee95c54234894b3a47955af3e306ff11bce964b 100644
--- a/drivers/gpu/msm/kgsl_debugfs.c
+++ b/drivers/gpu/msm/kgsl_debugfs.c
@@ -410,8 +410,8 @@ void kgsl_process_init_debugfs(struct kgsl_process_private *private)
 	 */
 
 	if (IS_ERR_OR_NULL(private->debug_root)) {
-		WARN((private->debug_root == NULL),
-			"Unable to create debugfs dir for %s\n", name);
+		pr_warn("%s:Unable to create debugfs dir for %s\n",
+			__func__, name);
 		private->debug_root = NULL;
 		return;
 	}
diff --git a/drivers/i2c/busses/i2c-qcom-geni.c b/drivers/i2c/busses/i2c-qcom-geni.c
index 68f1db3cb0b2b88f75f79b06d4c0377e6faceefe..f5086ae2712802cbc199fe7fbf311a0632c7cec5 100644
--- a/drivers/i2c/busses/i2c-qcom-geni.c
+++ b/drivers/i2c/busses/i2c-qcom-geni.c
@@ -29,6 +29,10 @@
 #include <linux/dmaengine.h>
 #include <linux/msm_gpi.h>
 
+#include <linux/gpio.h>
+#define AP_BAT_SCL 89
+#define AP_BAT_SDA 88
+
 #define SE_I2C_TX_TRANS_LEN		(0x26C)
 #define SE_I2C_RX_TRANS_LEN		(0x270)
 #define SE_I2C_SCL_COUNTERS		(0x278)
@@ -121,6 +125,7 @@ struct geni_i2c_dev {
 	struct msm_gpi_dma_async_tx_cb_param tx_cb;
 	struct msm_gpi_dma_async_tx_cb_param rx_cb;
 	enum i2c_se_mode se_mode;
+	int reset_support;
 };
 
 struct geni_i2c_err_log {
@@ -753,6 +758,26 @@ static int geni_i2c_xfer(struct i2c_adapter *adap,
 		}
 		ret = gi2c->err;
 		if (gi2c->err) {
+			if ((gi2c->err == -ETIMEDOUT || gi2c->err == -EBUSY)
+				&& gi2c->reset_support) {
+				pinctrl_select_state(gi2c->i2c_rsc.geni_pinctrl,
+						gi2c->i2c_rsc.geni_gpio_reset);
+				gpio_direction_output(AP_BAT_SDA, 0);
+				gpio_direction_output(AP_BAT_SCL, 0);
+				msleep(3000);
+				dev_err(gi2c->dev, "b clk:%d,data:%d\n",
+				gpio_get_value(AP_BAT_SCL),
+				gpio_get_value(AP_BAT_SDA));
+				gpio_direction_output(AP_BAT_SDA, 1);
+				gpio_direction_output(AP_BAT_SCL, 1);
+				dev_err(gi2c->dev, "c clk:%d,data:%d\n",
+				gpio_get_value(AP_BAT_SCL),
+			    gpio_get_value(AP_BAT_SDA));
+				gpio_direction_input(AP_BAT_SDA);
+				gpio_direction_input(AP_BAT_SCL);
+				pinctrl_select_state(gi2c->i2c_rsc.geni_pinctrl,
+				gi2c->i2c_rsc.geni_gpio_active);
+			}
 			dev_err(gi2c->dev, "i2c error :%d\n", gi2c->err);
 			break;
 		}
@@ -868,6 +893,27 @@ static int geni_i2c_probe(struct platform_device *pdev)
 		ret = PTR_ERR(gi2c->i2c_rsc.geni_gpio_sleep);
 		return ret;
 	}
+	gi2c->i2c_rsc.geni_gpio_reset =
+		pinctrl_lookup_state(gi2c->i2c_rsc.geni_pinctrl,
+							PINCTRL_RESET);
+	if (IS_ERR_OR_NULL(gi2c->i2c_rsc.geni_gpio_reset)) {
+		dev_err(&pdev->dev, "No reset config specified\n");
+		ret = PTR_ERR(gi2c->i2c_rsc.geni_gpio_reset);
+	} else {
+		if (gpio_is_valid(AP_BAT_SCL)
+			&& gpio_is_valid(AP_BAT_SDA)) {
+			ret = gpio_request(AP_BAT_SCL, "bat_scl");
+			if (ret)
+				pr_err("gpio_request failed for %d ret=%d\n",
+				AP_BAT_SCL, ret);
+			ret = gpio_request(AP_BAT_SDA, "bat_sda");
+			if (ret)
+				pr_err("gpio_request failed for %d ret=%d\n",
+				AP_BAT_SDA, ret);
+		}
+		gi2c->reset_support = true;
+		dev_err(&pdev->dev, "reset config specified\n");
+	}
 
 	if (of_property_read_u32(pdev->dev.of_node, "qcom,clk-freq-out",
 				&gi2c->i2c_rsc.clk_freq_out)) {
diff --git a/drivers/iio/adc/qcom-spmi-adc5.c b/drivers/iio/adc/qcom-spmi-adc5.c
index 7171f49eac71d48c66578fe4eb64b5237db550ec..730ee053afe39bdce48bf0734427261f6857b8c7 100644
--- a/drivers/iio/adc/qcom-spmi-adc5.c
+++ b/drivers/iio/adc/qcom-spmi-adc5.c
@@ -293,14 +293,55 @@ static int adc_poll_wait_eoc(struct adc_chip *adc)
 	return -ETIMEDOUT;
 }
 
+#undef pr_debug
+#define pr_debug pr_err
+
+#define QPNP_VADC_OFFSET_DUMP	8
+static int32_t vadc_print_extra_reg(struct adc_chip *adc)
+{
+	int rc = 0, i = 0;
+	u8 buf[8], offset = 0;
+
+	pr_err("Printing for 3100\n");
+	for (i = 0; i < 31; i++) {
+	rc = regmap_bulk_read(adc->regmap, (0x3100 + offset), buf, 8);
+	if (rc < 0) {
+		pr_err("adc read reg 3100 failed with %d\n", rc);
+		return rc;
+	}
+	offset += QPNP_VADC_OFFSET_DUMP;
+	pr_err("row%d: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n",
+			i, buf[0], buf[1], buf[2], buf[3], buf[4],
+			buf[5], buf[6], buf[7]);
+	}
+
+	offset = 0;
+	pr_err("Printing for 3700\n");
+	for (i = 0; i < 31; i++) {
+
+		rc = regmap_bulk_read(adc->regmap, (0x3700 + offset), buf, 8);
+		if (rc < 0) {
+		pr_err("qpnp adc read reg 3700 failed with %d\n", rc);
+		return rc;
+	}
+	 offset += QPNP_VADC_OFFSET_DUMP;
+	 pr_err("row%d: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n",
+		i, buf[0], buf[1], buf[2], buf[3], buf[4],
+		buf[5], buf[6], buf[7]);
+	}
+	return 0;
+}
+
 static int adc_wait_eoc(struct adc_chip *adc)
 {
 	int ret;
 
 	if (adc->poll_eoc) {
+		pr_err("adc: poll_eoc is true!\n");
 		ret = adc_poll_wait_eoc(adc);
 		if (ret < 0) {
-			pr_err("EOC bit not set\n");
+			pr_err("EOC bit not set, ret = %d\n", ret);
+			vadc_print_extra_reg(adc);
 			return ret;
 		}
 	} else {
@@ -310,7 +351,8 @@ static int adc_wait_eoc(struct adc_chip *adc)
 			pr_debug("Did not get completion timeout.\n");
 			ret = adc_poll_wait_eoc(adc);
 			if (ret < 0) {
-				pr_err("EOC bit not set\n");
+				pr_err("EOC bit not set, ret = %d\n", ret);
+				vadc_print_extra_reg(adc);
 				return ret;
 			}
 		}
@@ -733,6 +775,10 @@ static const struct adc_channels adc_chans_pmic5[ADC_MAX_CHANNEL] = {
 					SCALE_HW_CALIB_CUR)
 	[ADC_AMUX_THM2]			= ADC_CHAN_TEMP("amux_thm2", 1,
 					SCALE_HW_CALIB_PM5_SMB_TEMP)
+	[ADC_GPIO2_PU1]			= ADC_CHAN_VOLT("gpio12_v", 1,
+					SCALE_HW_CALIB_DEFAULT)
+	[ADC_AMUX_THM4_PU1]		= ADC_CHAN_VOLT("gpio1_v", 1,
+					SCALE_HW_CALIB_DEFAULT)
 	[ADC_AMUX_THM3]			= ADC_CHAN_TEMP("amux_thm3", 1,
 					SCALE_HW_CALIB_PM5_SMB_TEMP)
 	[ADC_GPIO1_PU2]	= ADC_CHAN_TEMP("gpio1_pu2", 1,
diff --git a/drivers/input/Kconfig b/drivers/input/Kconfig
old mode 100644
new mode 100755
index 724715e4f8bc58113bec5b106c6959c177018332..95dc4e5e79261f8be16d456dae922d37536bda64
--- a/drivers/input/Kconfig
+++ b/drivers/input/Kconfig
@@ -209,6 +209,8 @@ source "drivers/input/tablet/Kconfig"
 
 source "drivers/input/touchscreen/Kconfig"
 
+source "drivers/input/fingerprint/Kconfig"
+
 source "drivers/input/misc/Kconfig"
 
 source "drivers/input/rmi4/Kconfig"
diff --git a/drivers/input/Makefile b/drivers/input/Makefile
old mode 100644
new mode 100755
index f0351af763bd58cb5653731440258214f1f31111..3f0cdace0fa46a351e4cbf074795217cdfa54925
--- a/drivers/input/Makefile
+++ b/drivers/input/Makefile
@@ -24,6 +24,7 @@ obj-$(CONFIG_INPUT_MOUSE)	+= mouse/
 obj-$(CONFIG_INPUT_JOYSTICK)	+= joystick/
 obj-$(CONFIG_INPUT_TABLET)	+= tablet/
 obj-$(CONFIG_INPUT_TOUCHSCREEN)	+= touchscreen/
+obj-$(CONFIG_INPUT_FINGERPRINT)	+= fingerprint/
 obj-$(CONFIG_INPUT_MISC)	+= misc/
 
 obj-$(CONFIG_INPUT_APMPOWER)	+= apm-power.o
diff --git a/drivers/input/fingerprint/Kconfig b/drivers/input/fingerprint/Kconfig
new file mode 100755
index 0000000000000000000000000000000000000000..45ae3d6b13ba230b34d4e633a506bcd97930998e
--- /dev/null
+++ b/drivers/input/fingerprint/Kconfig
@@ -0,0 +1,36 @@
+menuconfig INPUT_FINGERPRINT
+	bool "Fingerprint"
+	default y
+	help
+	  Say Y here, and a list of supported fingerprint will be displayed.
+	  This option doesn't affect the kernel.
+
+	  If unsure, say Y.
+
+if INPUT_FINGERPRINT
+
+config FINGERPRINT_DETECT
+	tristate "fingerprint detect support"
+	depends on SPI_MASTER
+
+config FINGERPRINT_FPC
+   tristate "fpc fingerprint sensor support"
+   depends on SPI_MASTER
+
+config FINGERPRINT_GOODIX
+	tristate "goodix fingerprint sensor support"
+	depends on SPI_MASTER
+
+config FINGERPRINT_SILEAD
+	tristate "silead fingerprint sensor support"
+	depends on SPI_MASTER
+
+config MSM_QBT1000
+    bool "QBT1000 Ultrasonic Fingerprint Sensor"
+    help
+      This driver provides services for configuring the fingerprint
+      sensor hardware and for communicating with the trusted app which
+      uses it. It enables clocks and provides commands for loading
+      trusted apps, unloading them and marshalling buffers to the
+      trusted fingerprint app.
+endif
diff --git a/drivers/input/fingerprint/Makefile b/drivers/input/fingerprint/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..2d9610641cab3b3bb479d9505b2a6d6e50e74867
--- /dev/null
+++ b/drivers/input/fingerprint/Makefile
@@ -0,0 +1,6 @@
+#fingerprint_detect should before fpc1022
+obj-$(CONFIG_FINGERPRINT_DETECT)    += fingerprint_detect/
+obj-$(CONFIG_FINGERPRINT_FPC)	    += fpc/
+obj-$(CONFIG_FINGERPRINT_GOODIX)	+= goodix/
+obj-$(CONFIG_FINGERPRINT_SILEAD)	+= silead/
+obj-$(CONFIG_MSM_QBT1000) += qbt1000/
\ No newline at end of file
diff --git a/drivers/input/fingerprint/fingerprint_detect/Makefile b/drivers/input/fingerprint/fingerprint_detect/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..c9846540e94f29a3afea615b119a310c9a127ff8
--- /dev/null
+++ b/drivers/input/fingerprint/fingerprint_detect/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_FINGERPRINT_DETECT) += fingerprint_detect.o
\ No newline at end of file
diff --git a/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.c b/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.c
new file mode 100644
index 0000000000000000000000000000000000000000..1efe8bde996444ed7155383bdf2a5e7f6e3d578b
--- /dev/null
+++ b/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.c
@@ -0,0 +1,194 @@
+
+#include <linux/delay.h>
+#include <linux/gpio.h>
+#include <linux/kernel.h>
+#include <linux/platform_device.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/of_gpio.h>
+#include <linux/project_info.h>
+
+#include "fingerprint_detect.h"
+int fp_version;
+
+static int fingerprint_detect_request_named_gpio(
+		struct fingerprint_detect_data *fp_detect,
+		const char *label, int *gpio)
+{
+	struct device *dev = fp_detect->dev;
+	struct device_node *np = dev->of_node;
+	int rc = of_get_named_gpio(np, label, 0);
+
+	if (rc < 0) {
+		dev_err(dev, "failed to get '%s'\n", label);
+		*gpio = rc;
+		return rc;
+	}
+	*gpio = rc;
+	rc = devm_gpio_request(dev, *gpio, label);
+	if (rc) {
+		dev_err(dev, "failed to request gpio %d\n", *gpio);
+		return rc;
+	}
+	dev_info(dev, "%s - gpio: %d\n", label, *gpio);
+	return 0;
+}
+
+static ssize_t sensor_version_get(struct device *device,
+			     struct device_attribute *attribute,
+			     char *buffer)
+{
+	struct fingerprint_detect_data *fp_detect = dev_get_drvdata(device);
+
+	return scnprintf(buffer, PAGE_SIZE, "%i\n", fp_detect->sensor_version);
+}
+
+static DEVICE_ATTR(sensor_version, S_IRUSR, sensor_version_get, NULL);
+
+static struct attribute *attributes[] = {
+	&dev_attr_sensor_version.attr,
+	NULL
+};
+
+static const struct attribute_group attribute_group = {
+	.attrs = attributes,
+};
+
+int fp_pinctrl_init(struct fingerprint_detect_data *fp_dev)
+{
+	int ret = 0;
+	struct device *dev = fp_dev->dev;
+
+	fp_dev->fp_pinctrl = devm_pinctrl_get(dev);
+	if (IS_ERR_OR_NULL(fp_dev->fp_pinctrl)) {
+		dev_err(dev, "Target does not use pinctrl\n");
+		ret = PTR_ERR(fp_dev->fp_pinctrl);
+		goto err;
+	}
+
+	fp_dev->id_state_init =
+		pinctrl_lookup_state(fp_dev->fp_pinctrl, "fp_id_init");
+	if (IS_ERR_OR_NULL(fp_dev->id_state_init)) {
+		dev_err(dev, "Cannot get id active pinstate\n");
+		ret = PTR_ERR(fp_dev->id_state_init);
+		goto err;
+	}
+
+	ret = pinctrl_select_state(fp_dev->fp_pinctrl, fp_dev->id_state_init);
+	if (ret) {
+		dev_err(dev, "can not set %s pins\n", "fp_id_init");
+		goto err;
+	}
+
+	return ret;
+
+err:
+	fp_dev->fp_pinctrl = NULL;
+	fp_dev->id_state_init = NULL;
+	return ret;
+}
+
+static int fingerprint_detect_probe(struct platform_device *pdev)
+{
+	int id0 = 0, id1 = 0;
+	int rc = 0;
+	struct device *dev = &pdev->dev;
+	struct device_node *np = dev->of_node;
+
+	struct fingerprint_detect_data *fp_detect =
+		devm_kzalloc(dev, sizeof(*fp_detect),
+			GFP_KERNEL);
+	if (!fp_detect) {
+		dev_err(dev,
+			"failed to allocate memory for struct fingerprint_detect_data\n");
+		rc = -ENOMEM;
+		goto exit;
+	}
+
+	pr_info("%s\n", __func__);
+
+	fp_detect->dev = dev;
+	dev_set_drvdata(dev, fp_detect);
+
+	if (!np) {
+		dev_err(dev, "no of node found\n");
+		rc = -EINVAL;
+		goto exit;
+	}
+
+	rc = fp_pinctrl_init(fp_detect);
+		if (rc)
+		goto exit;
+
+	rc = fingerprint_detect_request_named_gpio(fp_detect, "fp-gpio-id0", &fp_detect->id0_gpio);
+	if (gpio_is_valid(fp_detect->id0_gpio)) {
+	dev_err(dev, "%s: gpio_is_valid(fp_detect->id0_gpio=%d)\n",
+		__func__, fp_detect->id0_gpio);
+	}
+
+	rc = fingerprint_detect_request_named_gpio(fp_detect,"fp-gpio-id1", &fp_detect->id1_gpio);
+	if (gpio_is_valid(fp_detect->id1_gpio)) {
+		dev_err(dev, "%s: gpio_is_valid(fp_detect->id1_gpio=%d)\n",
+			__func__, fp_detect->id1_gpio);
+	}
+
+	rc = sysfs_create_group(&dev->kobj, &attribute_group);
+	if (rc) {
+		dev_err(dev, "could not create sysfs\n");
+		goto exit;
+	}
+
+	id0 = gpio_get_value(fp_detect->id0_gpio);
+	id1 = gpio_get_value(fp_detect->id1_gpio);
+
+	/**
+	*				ID0(GPIO90)	ID1(GPIO21)
+	*	goodix9508		1			0
+	*	sileadgsl7000	0			1
+	*	qualcomm8*8		0			0
+	*	qualcomm4*9		1			1
+	*/
+
+	pr_info("%s: %d%d\n", __func__, id0, id1);
+
+	if (id0 && !id1) {
+		push_component_info(FINGERPRINTS,
+			"goodix9508", "goodix");
+		fp_detect->sensor_version = 0x04;
+	} else if (!id0 && id1) {
+		push_component_info(FINGERPRINTS,
+			"sileadgsl7000", "silead");
+		fp_detect->sensor_version = 0x05;
+	} else if (!id0 && !id1) {
+		push_component_info(FINGERPRINTS,
+			"qbt1000", "qualcomm");
+		fp_detect->sensor_version = 0x06;
+	}
+
+	fp_detect->sensor_version = 0x04;
+	fp_version = fp_detect->sensor_version;
+	dev_info(dev, "%s: ok\n", __func__);
+exit:
+	return rc;
+}
+
+
+static const struct of_device_id fingerprint_detect_of_match[] = {
+	{ .compatible = "oneplus,fpdetect", },
+	{}
+};
+MODULE_DEVICE_TABLE(op, fingerprint_detect_of_match);
+
+static struct platform_driver fingerprint_detect_driver = {
+	.driver = {
+		.name		= "fingerprint_detect",
+		.owner		= THIS_MODULE,
+		.of_match_table = fingerprint_detect_of_match,
+	},
+	.probe = fingerprint_detect_probe,
+};
+module_platform_driver(fingerprint_detect_driver);
+
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("yale liu");
+MODULE_DESCRIPTION("Fingerprint detect device driver.");
diff --git a/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.h b/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.h
new file mode 100644
index 0000000000000000000000000000000000000000..2f5491694fdf21cab7ccc4b4a1436b4a1b72ca65
--- /dev/null
+++ b/drivers/input/fingerprint/fingerprint_detect/fingerprint_detect.h
@@ -0,0 +1,14 @@
+#ifndef __FINGERPRINT_DETETC_H_
+#define __FINGERPRINT_DETETC_H_
+
+struct fingerprint_detect_data {
+	struct device *dev;
+	int id0_gpio;
+	int id1_gpio;
+	struct pinctrl         *fp_pinctrl;
+	struct pinctrl_state   *id_state_init;
+	int sensor_version;
+};
+extern int fp_version;
+#endif
+
diff --git a/drivers/input/fingerprint/fpc/Makefile b/drivers/input/fingerprint/fpc/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..43c12d18eb3e92f8670b3378af2e7957f48cd564
--- /dev/null
+++ b/drivers/input/fingerprint/fpc/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_FINGERPRINT_FPC)	+= fpc1020_tee.o
diff --git a/drivers/input/fingerprint/fpc/fpc1020_tee.c b/drivers/input/fingerprint/fpc/fpc1020_tee.c
new file mode 100755
index 0000000000000000000000000000000000000000..de61f1ba141d602c1c632e4dd5d1a6e9a7f7ce19
--- /dev/null
+++ b/drivers/input/fingerprint/fpc/fpc1020_tee.c
@@ -0,0 +1,559 @@
+/*
+ * FPC1020 Fingerprint sensor device driver
+ *
+ * This driver will control the platform resources that the FPC fingerprint
+ * sensor needs to operate. The major things are probing the sensor to check
+ * that it is actually connected and let the Kernel know this and with that also
+ * enabling and disabling of regulators, controlling GPIOs such as sensor reset
+ * line, sensor IRQ line.
+ *
+ * The driver will expose most of its available functionality in sysfs which
+ * enables dynamic control of these features from eg. a user space process.
+ *
+ * The sensor's IRQ events will be pushed to Kernel's event handling system and
+ * are exposed in the drivers event node.
+ *
+ * This driver will NOT send any commands to the sensor it only controls the
+ * electrical parts.
+ *
+ *
+ * Copyright (c) 2015 Fingerprint Cards AB <tech@fingerprints.com>
+ *
+ * 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/atomic.h>
+#include <linux/delay.h>
+#include <linux/gpio.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/of.h>
+#include <linux/of_gpio.h>
+#include <linux/platform_device.h>
+#include <linux/regulator/consumer.h>
+#include <linux/input.h>
+//#include <linux/wakelock.h>
+#include "../fingerprint_detect/fingerprint_detect.h"
+
+#define FPC_TTW_HOLD_TIME 1000
+
+#define RESET_LOW_SLEEP_MIN_US 5000
+#define RESET_LOW_SLEEP_MAX_US (RESET_LOW_SLEEP_MIN_US + 100)
+#define RESET_HIGH_SLEEP1_MIN_US 100
+#define RESET_HIGH_SLEEP1_MAX_US (RESET_HIGH_SLEEP1_MIN_US + 100)
+#define RESET_HIGH_SLEEP2_MIN_US 5000
+#define RESET_HIGH_SLEEP2_MAX_US (RESET_HIGH_SLEEP2_MIN_US + 100)
+#define PWR_ON_SLEEP_MIN_US 100
+#define PWR_ON_SLEEP_MAX_US (PWR_ON_SLEEP_MIN_US + 900)
+
+#define NUM_PARAMS_REG_ENABLE_SET 2
+
+static const char * const pctl_names[] = {
+	"fp_reset_low",
+	"fp_reset_high",
+	//"fpc1020_irq_active",
+};
+
+struct vreg_config {
+	char *name;
+	unsigned long vmin;
+	unsigned long vmax;
+	int ua_load;
+};
+
+static const struct vreg_config const vreg_conf[] = {
+	{ "vdd_ana", 1800000UL, 1800000UL, 6000, },
+	{ "vcc_spi", 1800000UL, 1800000UL, 10, },
+	{ "vdd_io", 1800000UL, 1800000UL, 6000, },
+};
+
+struct fpc1020_data {
+	struct device *dev;
+
+	struct pinctrl *fingerprint_pinctrl;
+	struct pinctrl_state *pinctrl_state[ARRAY_SIZE(pctl_names)];
+	struct regulator *vreg[ARRAY_SIZE(vreg_conf)];
+
+	struct wakeup_source ttw_wl;
+	int irq_gpio;
+	int rst_gpio;
+	struct mutex lock; /* To set/get exported values in sysfs */
+	bool prepared;
+	atomic_t wakeup_enabled; /* Used both in ISR and non-ISR */
+	struct input_dev *input_dev;
+};
+
+/**
+ * sysfs node for controlling clocks.
+ *
+ * This is disabled in platform variant of this driver but kept for
+ * backwards compatibility. Only prints a debug print that it is
+ * disabled.
+ */
+static ssize_t clk_enable_set(struct device *dev,
+	struct device_attribute *attr,
+	const char *buf, size_t count)
+{
+	dev_dbg(dev,
+		"clk_enable sysfs node not enabled in platform driver\n");
+
+	return count;
+}
+static DEVICE_ATTR(clk_enable, S_IWUSR, NULL, clk_enable_set);
+
+/**
+ * Will try to select the set of pins (GPIOS) defined in a pin control node of
+ * the device tree named @p name.
+ *
+ * The node can contain several eg. GPIOs that is controlled when selecting it.
+ * The node may activate or deactivate the pins it contains, the action is
+ * defined in the device tree node itself and not here. The states used
+ * internally is fetched at probe time.
+ *
+ * @see pctl_names
+ * @see fpc1020_probe
+ */
+static int select_pin_ctl(struct fpc1020_data *fpc1020, const char *name)
+{
+	size_t i;
+	int rc;
+	struct device *dev = fpc1020->dev;
+
+	for (i = 0; i < ARRAY_SIZE(fpc1020->pinctrl_state); i++) {
+		const char *n = pctl_names[i];
+
+		if (!strncmp(n, name, strlen(n))) {
+			rc = pinctrl_select_state(fpc1020->fingerprint_pinctrl,
+					fpc1020->pinctrl_state[i]);
+			if (rc)
+				dev_err(dev, "cannot select '%s'\n", name);
+			else
+				dev_dbg(dev, "Selected '%s'\n", name);
+			goto exit;
+		}
+	}
+
+	rc = -EINVAL;
+	dev_err(dev, "%s:'%s' not found\n", __func__, name);
+
+exit:
+	return rc;
+}
+
+static ssize_t pinctl_set(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+	int rc;
+
+	mutex_lock(&fpc1020->lock);
+	rc = select_pin_ctl(fpc1020, buf);
+	mutex_unlock(&fpc1020->lock);
+
+	return rc ? rc : count;
+}
+static DEVICE_ATTR(pinctl_set, S_IWUSR, NULL, pinctl_set);
+
+static int hw_reset(struct fpc1020_data *fpc1020)
+{
+	int irq_gpio;
+	struct device *dev = fpc1020->dev;
+	int rc = select_pin_ctl(fpc1020, "fp_reset_high");
+
+	if (rc)
+		goto exit;
+	usleep_range(RESET_HIGH_SLEEP1_MIN_US, RESET_HIGH_SLEEP1_MAX_US);
+
+	rc = select_pin_ctl(fpc1020, "fp_reset_low");
+	if (rc)
+		goto exit;
+	usleep_range(RESET_LOW_SLEEP_MIN_US, RESET_LOW_SLEEP_MAX_US);
+
+	rc = select_pin_ctl(fpc1020, "fp_reset_high");
+	if (rc)
+		goto exit;
+	usleep_range(RESET_HIGH_SLEEP2_MIN_US, RESET_HIGH_SLEEP2_MAX_US);
+
+	irq_gpio = gpio_get_value(fpc1020->irq_gpio);
+	dev_info(dev, "IRQ after reset %d\n", irq_gpio);
+
+exit:
+	return rc;
+}
+
+static ssize_t hw_reset_set(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	int rc;
+	struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+
+	if (!strncmp(buf, "reset", strlen("reset"))) {
+		mutex_lock(&fpc1020->lock);
+		rc = hw_reset(fpc1020);
+		mutex_unlock(&fpc1020->lock);
+	} else {
+		return -EINVAL;
+	}
+
+	return rc ? rc : count;
+}
+static DEVICE_ATTR(hw_reset, S_IWUSR, NULL, hw_reset_set);
+
+/**
+ * sysfs node for controlling whether the driver is allowed
+ * to wake up the platform on interrupt.
+ */
+static ssize_t wakeup_enable_set(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+	ssize_t ret = count;
+
+	mutex_lock(&fpc1020->lock);
+	if (!strncmp(buf, "enable", strlen("enable")))
+		atomic_set(&fpc1020->wakeup_enabled, 1);
+	else if (!strncmp(buf, "disable", strlen("disable")))
+		atomic_set(&fpc1020->wakeup_enabled, 0);
+	else
+		ret = -EINVAL;
+	mutex_unlock(&fpc1020->lock);
+
+	return ret;
+}
+static DEVICE_ATTR(wakeup_enable, S_IWUSR, NULL, wakeup_enable_set);
+
+/**
+ * sysf node to check the interrupt status of the sensor, the interrupt
+ * handler should perform sysf_notify to allow userland to poll the node.
+ */
+static ssize_t irq_get(struct device *dev,
+	struct device_attribute *attr,
+	char *buf)
+{
+	struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+	int irq = gpio_get_value(fpc1020->irq_gpio);
+
+	return scnprintf(buf, PAGE_SIZE, "%i\n", irq);
+}
+
+/**
+ * writing to the irq node will just drop a printk message
+ * and return success, used for latency measurement.
+ */
+static ssize_t irq_ack(struct device *dev,
+	struct device_attribute *attr,
+	const char *buf, size_t count)
+{
+	struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+
+	dev_dbg(fpc1020->dev, "%s\n", __func__);
+
+	return count;
+}
+static DEVICE_ATTR(irq, S_IRUSR | S_IWUSR, irq_get, irq_ack);
+
+
+static ssize_t report_key_set(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct input_event *ev = (struct input_event *)buf;
+	struct  fpc1020_data *fpc1020 = dev_get_drvdata(dev);
+
+	input_event(fpc1020->input_dev, ev->type, ev->code, ev->value);
+	return count;
+}
+static DEVICE_ATTR(report_key, S_IWUSR, NULL, report_key_set);
+
+
+static struct attribute *attributes[] = {
+	&dev_attr_pinctl_set.attr,
+	&dev_attr_hw_reset.attr,
+	&dev_attr_wakeup_enable.attr,
+	&dev_attr_clk_enable.attr,
+	&dev_attr_irq.attr,
+	&dev_attr_report_key.attr,
+	NULL
+};
+
+static const struct attribute_group attribute_group = {
+	.attrs = attributes,
+};
+
+int fpc1020_input_init(struct fpc1020_data *fpc1020)
+{
+	int error = 0;
+
+
+	dev_dbg(fpc1020->dev, "%s\n", __func__);
+
+	fpc1020->input_dev = input_allocate_device();
+
+	if (!fpc1020->input_dev) {
+		dev_err(fpc1020->dev, "Input_allocate_device failed.\n");
+		error  = -ENOMEM;
+	}
+
+	if (!error) {
+		fpc1020->input_dev->name = "fpc1020";
+
+		/* Set event bits according to what events we are generating */
+		set_bit(EV_KEY, fpc1020->input_dev->evbit);
+		set_bit(EV_SYN, fpc1020->input_dev->evbit);
+		set_bit(EV_ABS, fpc1020->input_dev->evbit);
+
+		set_bit(KEY_POWER, fpc1020->input_dev->keybit);
+		set_bit(KEY_F2, fpc1020->input_dev->keybit);
+		set_bit(KEY_HOME, fpc1020->input_dev->keybit);
+		/*
+		set_bit(BTN_A, fpc1020->input_dev->keybit);
+		set_bit(BTN_C, fpc1020->input_dev->keybit);
+		*/
+		set_bit(BTN_B, fpc1020->input_dev->keybit);
+		set_bit(ABS_Z, fpc1020->input_dev->keybit);
+		set_bit(KEY_UP, fpc1020->input_dev->keybit);
+		set_bit(KEY_DOWN, fpc1020->input_dev->keybit);
+		/*
+		set_bit(KEY_LEFT, fpc1020->input_dev->keybit);
+		set_bit(KEY_RIGHT, fpc1020->input_dev->keybit);
+		*/
+
+		/* Register the input device */
+		error = input_register_device(fpc1020->input_dev);
+
+
+		if (error) {
+			dev_err(fpc1020->dev, "Input_register_device failed.\n");
+			input_free_device(fpc1020->input_dev);
+			fpc1020->input_dev = NULL;
+		}
+	}
+
+	return error;
+}
+
+
+static irqreturn_t fpc1020_irq_handler(int irq, void *handle)
+{
+	struct fpc1020_data *fpc1020 = handle;
+
+	dev_dbg(fpc1020->dev, "%s\n", __func__);
+
+	if (atomic_read(&fpc1020->wakeup_enabled)) {
+		__pm_wakeup_event(&fpc1020->ttw_wl, FPC_TTW_HOLD_TIME);
+	}
+
+	sysfs_notify(&fpc1020->dev->kobj, NULL, dev_attr_irq.attr.name);
+
+	return IRQ_HANDLED;
+}
+
+static int fpc1020_request_named_gpio(struct fpc1020_data *fpc1020,
+	const char *label, int *gpio)
+{
+	struct device *dev = fpc1020->dev;
+	struct device_node *np = dev->of_node;
+	int rc = of_get_named_gpio(np, label, 0);
+
+	if (rc < 0) {
+		dev_err(dev, "failed to get '%s'\n", label);
+		return rc;
+	}
+	*gpio = rc;
+
+	rc = devm_gpio_request(dev, *gpio, label);
+	if (rc) {
+		dev_err(dev, "failed to request gpio %d\n", *gpio);
+		return rc;
+	}
+	dev_dbg(dev, "%s %d\n", label, *gpio);
+
+	return 0;
+}
+
+static int fpc1020_probe(struct platform_device *pdev)
+{
+	struct device *dev = &pdev->dev;
+	int rc = 0;
+	size_t i;
+	int irqf;
+	struct device_node *np;
+	struct fpc1020_data *fpc1020;
+
+	pr_info("%s: fp version %x\n", __func__, fp_version);
+	if ((fp_version != 0x01) && (fp_version != 0x02))
+		return 0;
+
+	np = dev->of_node;
+	fpc1020 = devm_kzalloc(dev, sizeof(*fpc1020),
+			GFP_KERNEL);
+
+	if (!fpc1020) {
+		dev_err(dev,
+			"failed to allocate memory for struct fpc1020_data\n");
+		rc = -ENOMEM;
+		goto exit;
+	}
+
+	fpc1020->dev = dev;
+	platform_set_drvdata(pdev, fpc1020);
+
+	if (!np) {
+		dev_err(dev, "no of node found\n");
+		rc = -EINVAL;
+		goto exit;
+	}
+
+	rc = fpc1020_request_named_gpio(fpc1020, "fpc,irq-gpio",
+			&fpc1020->irq_gpio);
+	if (rc)
+		goto exit;
+	rc = fpc1020_request_named_gpio(fpc1020, "fpc,reset-gpio",
+			&fpc1020->rst_gpio);
+	if (rc)
+		goto exit;
+
+	fpc1020->fingerprint_pinctrl = devm_pinctrl_get(dev);
+	if (IS_ERR(fpc1020->fingerprint_pinctrl)) {
+		if (PTR_ERR(fpc1020->fingerprint_pinctrl) == -EPROBE_DEFER) {
+			dev_info(dev, "pinctrl not ready\n");
+			rc = -EPROBE_DEFER;
+			goto exit;
+		}
+		dev_err(dev, "Target does not use pinctrl\n");
+		fpc1020->fingerprint_pinctrl = NULL;
+		rc = -EINVAL;
+		goto exit;
+	}
+
+	for (i = 0; i < ARRAY_SIZE(fpc1020->pinctrl_state); i++) {
+		const char *n = pctl_names[i];
+		struct pinctrl_state *state =
+			pinctrl_lookup_state(fpc1020->fingerprint_pinctrl, n);
+		if (IS_ERR(state)) {
+			dev_err(dev, "cannot find '%s'\n", n);
+			rc = -EINVAL;
+			goto exit;
+		}
+		dev_info(dev, "found pin control %s\n", n);
+		fpc1020->pinctrl_state[i] = state;
+	}
+
+	rc = select_pin_ctl(fpc1020, "fp_reset_low");
+	if (rc)
+		goto exit;
+	
+	//rc = select_pin_ctl(fpc1020, "fpc1020_irq_active");
+	//if (rc)
+	//	goto exit;
+
+	rc = gpio_direction_input(fpc1020->irq_gpio);
+	
+	if (rc) {
+		dev_err(fpc1020->dev,
+			"gpio_direction_input (irq) failed.\n");
+		goto exit;
+	}
+
+
+	atomic_set(&fpc1020->wakeup_enabled, 0);
+
+	irqf = IRQF_TRIGGER_RISING | IRQF_ONESHOT;
+	if (of_property_read_bool(dev->of_node, "fpc,enable-wakeup")) {
+		irqf |= IRQF_NO_SUSPEND;
+		device_init_wakeup(dev, 1);
+	}
+
+	mutex_init(&fpc1020->lock);
+	rc = devm_request_threaded_irq(dev, gpio_to_irq(fpc1020->irq_gpio),
+			NULL, fpc1020_irq_handler, irqf,
+			dev_name(dev), fpc1020);
+	if (rc) {
+		dev_err(dev, "could not request irq %d\n",
+				gpio_to_irq(fpc1020->irq_gpio));
+		goto exit;
+	}
+
+	dev_dbg(dev, "requested irq %d\n", gpio_to_irq(fpc1020->irq_gpio));
+
+	/* Request that the interrupt should be wakeable */
+	enable_irq_wake(gpio_to_irq(fpc1020->irq_gpio));
+
+	wakeup_source_init(&fpc1020->ttw_wl, "fpc_ttw_wl");
+
+	rc = fpc1020_input_init(fpc1020);
+    if (rc){
+	    dev_err(dev, "could not init fpc1020 input device\n");
+		goto exit;
+    }
+
+	rc = sysfs_create_group(&dev->kobj, &attribute_group);
+	if (rc) {
+		dev_err(dev, "could not create sysfs\n");
+		goto exit;
+	}
+
+	rc = hw_reset(fpc1020);
+
+	dev_info(dev, "%s: ok\n", __func__);
+
+exit:
+	return rc;
+}
+
+static int fpc1020_remove(struct platform_device *pdev)
+{
+	struct fpc1020_data *fpc1020 = platform_get_drvdata(pdev);
+
+	sysfs_remove_group(&pdev->dev.kobj, &attribute_group);
+	mutex_destroy(&fpc1020->lock);
+	wakeup_source_trash(&fpc1020->ttw_wl);
+	dev_info(&pdev->dev, "%s\n", __func__);
+
+	return 0;
+}
+
+static struct of_device_id fpc1020_of_match[] = {
+	{ .compatible = "fpc,fpc1020", },
+	{}
+};
+MODULE_DEVICE_TABLE(of, fpc1020_of_match);
+
+static struct platform_driver fpc1020_driver = {
+	.driver = {
+		.name	= "fpc1020",
+		.owner	= THIS_MODULE,
+		.of_match_table = fpc1020_of_match,
+	},
+	.probe	= fpc1020_probe,
+	.remove	= fpc1020_remove,
+};
+
+static int __init fpc1020_init(void)
+{
+	int rc = platform_driver_register(&fpc1020_driver);
+
+	if (!rc)
+		pr_info("%s OK\n", __func__);
+	else
+		pr_err("%s %d\n", __func__, rc);
+
+	return rc;
+}
+
+static void __exit fpc1020_exit(void)
+{
+	pr_info("%s\n", __func__);
+	platform_driver_unregister(&fpc1020_driver);
+}
+
+module_init(fpc1020_init);
+module_exit(fpc1020_exit);
+
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("Aleksej Makarov");
+MODULE_AUTHOR("Henrik Tillman <henrik.tillman@fingerprints.com>");
+MODULE_DESCRIPTION("FPC1020 Fingerprint sensor device driver.");
diff --git a/drivers/input/fingerprint/goodix/Makefile b/drivers/input/fingerprint/goodix/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..9faa4a64360412ae3c2684a04a892832da2a617e
--- /dev/null
+++ b/drivers/input/fingerprint/goodix/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_FINGERPRINT_GOODIX)	+= gf_spi.o platform.o netlink.o
diff --git a/drivers/input/fingerprint/goodix/gf_spi.c b/drivers/input/fingerprint/goodix/gf_spi.c
new file mode 100644
index 0000000000000000000000000000000000000000..883c92ab5a3b10e04316c3e60eff0d603067d1a1
--- /dev/null
+++ b/drivers/input/fingerprint/goodix/gf_spi.c
@@ -0,0 +1,1102 @@
+/*
+ * TEE driver for goodix fingerprint sensor
+ * Copyright (C) 2016 Goodix
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+#define pr_fmt(fmt)		KBUILD_MODNAME ": " fmt
+
+#define CONFIG_MSM_RDM_NOTIFY
+#undef CONFIG_FB
+
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/ioctl.h>
+#include <linux/fs.h>
+#include <linux/device.h>
+#include <linux/input.h>
+#include <linux/clk.h>
+#include <linux/err.h>
+#include <linux/list.h>
+#include <linux/errno.h>
+#include <linux/mutex.h>
+#include <linux/slab.h>
+#include <linux/compat.h>
+#include <linux/delay.h>
+#include <asm/uaccess.h>
+#include <linux/uaccess.h>
+#include <linux/ktime.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
+#include <linux/of_gpio.h>
+#include <linux/timer.h>
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#include <linux/pm_qos.h>
+#include <linux/cpufreq.h>
+//#include <linux/wakelock.h>
+#include <linux/oneplus/boot_mode.h>
+#include "gf_spi.h"
+
+#if defined(USE_SPI_BUS)
+#include <linux/spi/spi.h>
+#include <linux/spi/spidev.h>
+#elif defined(USE_PLATFORM_BUS)
+#include <linux/platform_device.h>
+#endif
+
+#include "../fingerprint_detect/fingerprint_detect.h"
+
+#define VER_MAJOR   1
+#define VER_MINOR   2
+#define PATCH_LEVEL 8
+
+#define WAKELOCK_HOLD_TIME 500 /* in ms */
+
+#define GF_SPIDEV_NAME     "goodix,fingerprint"
+/*device name after register in charater*/
+#define GF_DEV_NAME            "goodix_fp"
+#define	GF_INPUT_NAME	    "gf_input"	/*"goodix_fp" */
+
+#define	CHRD_DRIVER_NAME	"goodix_fp_spi"
+#define	CLASS_NAME		    "goodix_fp"
+
+#define N_SPI_MINORS		32	/* ... up to 256 */
+static int SPIDEV_MAJOR;
+
+static DECLARE_BITMAP(minors, N_SPI_MINORS);
+static LIST_HEAD(device_list);
+static DEFINE_MUTEX(device_list_lock);
+static struct wakeup_source fp_wakelock;
+static struct gf_dev gf;
+
+struct gf_key_map maps[] = {
+	{ EV_KEY, GF_KEY_INPUT_HOME },
+	{ EV_KEY, GF_KEY_INPUT_MENU },
+	{ EV_KEY, GF_KEY_INPUT_BACK },
+	{ EV_KEY, GF_KEY_INPUT_POWER },
+#if defined(SUPPORT_NAV_EVENT)
+	{ EV_KEY, GF_NAV_INPUT_UP },
+	{ EV_KEY, GF_NAV_INPUT_DOWN },
+	{ EV_KEY, GF_NAV_INPUT_RIGHT },
+	{ EV_KEY, GF_NAV_INPUT_LEFT },
+	{ EV_KEY, GF_NAV_INPUT_LONG_PRESS },
+	{ EV_KEY, GF_NAV_INPUT_F2},
+#endif
+};
+
+static void gf_enable_irq(struct gf_dev *gf_dev)
+{
+	if (gf_dev->irq_enabled) {
+		pr_warn("IRQ has been enabled.\n");
+	} else {
+		enable_irq(gf_dev->irq);
+		gf_dev->irq_enabled = 1;
+	}
+}
+
+static void gf_disable_irq(struct gf_dev *gf_dev)
+{
+	if (gf_dev->irq_enabled) {
+		gf_dev->irq_enabled = 0;
+		disable_irq(gf_dev->irq);
+	} else {
+		pr_warn("IRQ has been disabled.\n");
+	}
+}
+
+#ifdef AP_CONTROL_CLK
+static long spi_clk_max_rate(struct clk *clk, unsigned long rate)
+{
+	long lowest_available, nearest_low, step_size, cur;
+	long step_direction = -1;
+	long guess = rate;
+	int max_steps = 10;
+
+	cur = clk_round_rate(clk, rate);
+	if (cur == rate)
+		return rate;
+
+	/* if we got here then: cur > rate */
+	lowest_available = clk_round_rate(clk, 0);
+	if (lowest_available > rate)
+		return -EINVAL;
+
+	step_size = (rate - lowest_available) >> 1;
+	nearest_low = lowest_available;
+
+	while (max_steps-- && step_size) {
+		guess += step_size * step_direction;
+		cur = clk_round_rate(clk, guess);
+
+		if ((cur < rate) && (cur > nearest_low))
+			nearest_low = cur;
+		/*
+		 * if we stepped too far, then start stepping in the other
+		 * direction with half the step size
+		 */
+		if (((cur > rate) && (step_direction > 0))
+				|| ((cur < rate) && (step_direction < 0))) {
+			step_direction = -step_direction;
+			step_size >>= 1;
+		}
+	}
+	return nearest_low;
+}
+
+static void spi_clock_set(struct gf_dev *gf_dev, int speed)
+{
+	long rate;
+	int rc;
+
+	rate = spi_clk_max_rate(gf_dev->core_clk, speed);
+	if (rate < 0) {
+		pr_info("%s: no match found for requested clock frequency:%d",
+				__func__, speed);
+		return;
+	}
+
+	rc = clk_set_rate(gf_dev->core_clk, rate);
+}
+
+static int gfspi_ioctl_clk_init(struct gf_dev *data)
+{
+	pr_debug("%s: enter\n", __func__);
+
+	data->clk_enabled = 0;
+	data->core_clk = clk_get(&data->spi->dev, "core_clk");
+	if (IS_ERR_OR_NULL(data->core_clk)) {
+		pr_err("%s: fail to get core_clk\n", __func__);
+		return -EPERM;
+	}
+	data->iface_clk = clk_get(&data->spi->dev, "iface_clk");
+	if (IS_ERR_OR_NULL(data->iface_clk)) {
+		pr_err("%s: fail to get iface_clk\n", __func__);
+		clk_put(data->core_clk);
+		data->core_clk = NULL;
+		return -ENOENT;
+	}
+	return 0;
+}
+
+static int gfspi_ioctl_clk_enable(struct gf_dev *data)
+{
+	int err;
+
+	pr_debug("%s: enter\n", __func__);
+
+	if (data->clk_enabled)
+		return 0;
+
+	err = clk_prepare_enable(data->core_clk);
+	if (err) {
+		pr_err("%s: fail to enable core_clk\n", __func__);
+		return -EPERM;
+	}
+
+	err = clk_prepare_enable(data->iface_clk);
+	if (err) {
+		pr_err("%s: fail to enable iface_clk\n", __func__);
+		clk_disable_unprepare(data->core_clk);
+		return -ENOENT;
+	}
+
+	data->clk_enabled = 1;
+
+	return 0;
+}
+
+static int gfspi_ioctl_clk_disable(struct gf_dev *data)
+{
+	pr_debug("%s: enter\n", __func__);
+
+	if (!data->clk_enabled)
+		return 0;
+
+	clk_disable_unprepare(data->core_clk);
+	clk_disable_unprepare(data->iface_clk);
+	data->clk_enabled = 0;
+
+	return 0;
+}
+
+static int gfspi_ioctl_clk_uninit(struct gf_dev *data)
+{
+	pr_debug("%s: enter\n", __func__);
+
+	if (data->clk_enabled)
+		gfspi_ioctl_clk_disable(data);
+
+	if (!IS_ERR_OR_NULL(data->core_clk)) {
+		clk_put(data->core_clk);
+		data->core_clk = NULL;
+	}
+
+	if (!IS_ERR_OR_NULL(data->iface_clk)) {
+		clk_put(data->iface_clk);
+		data->iface_clk = NULL;
+	}
+
+	return 0;
+}
+#endif
+
+static void nav_event_input(struct gf_dev *gf_dev, gf_nav_event_t nav_event)
+{
+	uint32_t nav_input = 0;
+
+	switch (nav_event) {
+	case GF_NAV_FINGER_DOWN:
+		pr_debug("%s nav finger down\n", __func__);
+		break;
+
+	case GF_NAV_FINGER_UP:
+		pr_debug("%s nav finger up\n", __func__);
+		break;
+
+	case GF_NAV_DOWN:
+		nav_input = GF_NAV_INPUT_DOWN;
+		pr_debug("%s nav down\n", __func__);
+		break;
+
+	case GF_NAV_UP:
+		nav_input = GF_NAV_INPUT_UP;
+		pr_debug("%s nav up\n", __func__);
+		break;
+
+	case GF_NAV_LEFT:
+		nav_input = GF_NAV_INPUT_LEFT;
+		pr_debug("%s nav left\n", __func__);
+		break;
+
+	case GF_NAV_RIGHT:
+		nav_input = GF_NAV_INPUT_RIGHT;
+		pr_debug("%s nav right\n", __func__);
+		break;
+
+	case GF_NAV_CLICK:
+		nav_input = GF_NAV_INPUT_CLICK;
+		pr_debug("%s nav click\n", __func__);
+		break;
+
+	case GF_NAV_HEAVY:
+		nav_input = GF_NAV_INPUT_HEAVY;
+		pr_debug("%s nav heavy\n", __func__);
+		break;
+
+	case GF_NAV_LONG_PRESS:
+		nav_input = GF_NAV_INPUT_LONG_PRESS;
+		pr_debug("%s nav long press\n", __func__);
+		break;
+
+	case GF_NAV_DOUBLE_CLICK:
+		nav_input = GF_NAV_INPUT_DOUBLE_CLICK;
+		pr_debug("%s nav double click\n", __func__);
+		break;
+	case GF_NAV_F2:
+		nav_input = GF_NAV_INPUT_F2;
+		pr_debug("%s nav f2\n", __func__);
+		break;
+	default:
+		pr_warn("%s unknown nav event: %d\n", __func__, nav_event);
+		break;
+	}
+
+	if ((nav_event != GF_NAV_FINGER_DOWN) && (nav_event != GF_NAV_FINGER_UP)) {
+		input_report_key(gf_dev->input, nav_input, 1);
+		input_sync(gf_dev->input);
+		input_report_key(gf_dev->input, nav_input, 0);
+		input_sync(gf_dev->input);
+	}
+}
+
+static irqreturn_t gf_irq(int irq, void *handle)
+{
+#if defined(GF_NETLINK_ENABLE)
+	char msg = GF_NET_EVENT_IRQ;
+	//wake_lock_timeout(&fp_wakelock, msecs_to_jiffies(WAKELOCK_HOLD_TIME));
+	__pm_wakeup_event(&fp_wakelock, WAKELOCK_HOLD_TIME);
+	sendnlmsg(&msg);
+#elif defined (GF_FASYNC)
+	struct gf_dev *gf_dev = &gf;
+	if (gf_dev->async)
+		kill_fasync(&gf_dev->async, SIGIO, POLL_IN);
+#endif
+	return IRQ_HANDLED;
+}
+
+static int irq_setup(struct gf_dev *gf_dev)
+{
+	int status;
+
+	gf_dev->irq = gf_irq_num(gf_dev);
+	status = request_threaded_irq(gf_dev->irq, NULL, gf_irq,
+			IRQF_TRIGGER_RISING | IRQF_ONESHOT,
+			"gf", gf_dev);
+
+	if (status) {
+		pr_err("failed to request IRQ:%d\n", gf_dev->irq);
+		return status;
+	}
+	enable_irq_wake(gf_dev->irq);
+	gf_dev->irq_enabled = 1;
+
+	return status;
+}
+
+/*static void irq_cleanup(struct gf_dev *gf_dev)
+{
+	gf_dev->irq_enabled = 0;
+	disable_irq(gf_dev->irq);
+	disable_irq_wake(gf_dev->irq);
+	free_irq(gf_dev->irq, gf_dev);
+}*/
+
+static void gf_kernel_key_input(struct gf_dev *gf_dev, struct gf_key *gf_key)
+{
+	uint32_t key_input = 0;
+	if (GF_KEY_HOME == gf_key->key) {
+		key_input = GF_KEY_INPUT_HOME;
+	} else if (GF_KEY_POWER == gf_key->key) {
+		key_input = GF_KEY_INPUT_POWER;
+	} else if (GF_KEY_CAMERA == gf_key->key) {
+		key_input = GF_KEY_INPUT_CAMERA;
+	} else if (GF_KEY_LONGPRESS == gf_key->key) {
+		key_input = GF_KEY_INPUT_LONG_PRESS;
+	} else {
+		/* add special key define */
+		key_input = gf_key->key;
+	}
+	pr_info("%s: received key event[%d], key=%d, value=%d\n",
+			__func__, key_input, gf_key->key, gf_key->value);
+
+	if ((GF_KEY_POWER == gf_key->key || GF_KEY_LONGPRESS == gf_key->key)
+			&& (gf_key->value == 1)) {
+		input_report_key(gf_dev->input, key_input, 1);
+		input_sync(gf_dev->input);
+		input_report_key(gf_dev->input, key_input, 0);
+		input_sync(gf_dev->input);
+	}
+
+	if (GF_KEY_HOME == gf_key->key) {
+		input_report_key(gf_dev->input, key_input, gf_key->value);
+		input_sync(gf_dev->input);
+	}
+}
+
+static long gf_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+	struct gf_dev *gf_dev = &gf;
+	struct gf_key gf_key;
+#if defined(SUPPORT_NAV_EVENT)
+	gf_nav_event_t nav_event = GF_NAV_NONE;
+#endif
+	int retval = 0;
+	u8 netlink_route = NETLINK_TEST;
+	struct gf_ioc_chip_info info;
+
+	if (_IOC_TYPE(cmd) != GF_IOC_MAGIC)
+		return -ENODEV;
+
+	if (_IOC_DIR(cmd) & _IOC_READ)
+		retval = !access_ok(VERIFY_WRITE, (void __user *)arg, _IOC_SIZE(cmd));
+	else if (_IOC_DIR(cmd) & _IOC_WRITE)
+		retval = !access_ok(VERIFY_READ, (void __user *)arg, _IOC_SIZE(cmd));
+	if (retval)
+		return -EFAULT;
+
+	if (gf_dev->device_available == 0) {
+		if ((cmd == GF_IOC_ENABLE_POWER) || (cmd == GF_IOC_DISABLE_POWER)) {
+			pr_info("power cmd\n");
+		} else {
+			pr_info("Sensor is power off currently. \n");
+			//return -ENODEV;
+		}
+	}
+
+	switch (cmd) {
+	case GF_IOC_INIT:
+		pr_debug("%s GF_IOC_INIT\n", __func__);
+		if (copy_to_user((void __user *)arg, (void *)&netlink_route, sizeof(u8))) {
+			retval = -EFAULT;
+			break;
+		}
+		break;
+	case GF_IOC_EXIT:
+		pr_debug("%s GF_IOC_EXIT\n", __func__);
+		break;
+	case GF_IOC_DISABLE_IRQ:
+		pr_debug("%s GF_IOC_DISABEL_IRQ\n", __func__);
+		gf_disable_irq(gf_dev);
+		break;
+	case GF_IOC_ENABLE_IRQ:
+		pr_debug("%s GF_IOC_ENABLE_IRQ\n", __func__);
+		gf_enable_irq(gf_dev);
+		break;
+	case GF_IOC_RESET:
+		pr_info("%s GF_IOC_RESET. \n", __func__);
+		gf_hw_reset(gf_dev, 0);
+		break;
+	case GF_IOC_INPUT_KEY_EVENT:
+		if (copy_from_user(&gf_key, (struct gf_key *)arg, sizeof(struct gf_key))) {
+			pr_info("Failed to copy input key event from user to kernel\n");
+			retval = -EFAULT;
+			break;
+		}
+
+		gf_kernel_key_input(gf_dev, &gf_key);
+		break;
+#if defined(SUPPORT_NAV_EVENT)
+	case GF_IOC_NAV_EVENT:
+		pr_debug("%s GF_IOC_NAV_EVENT\n", __func__);
+		if (copy_from_user(&nav_event, (gf_nav_event_t *)arg, sizeof(gf_nav_event_t))) {
+			pr_info("Failed to copy nav event from user to kernel\n");
+			retval = -EFAULT;
+			break;
+		}
+
+		nav_event_input(gf_dev, nav_event);
+		break;
+#endif
+
+	case GF_IOC_ENABLE_SPI_CLK:
+		pr_debug("%s GF_IOC_ENABLE_SPI_CLK\n", __func__);
+#ifdef AP_CONTROL_CLK
+		gfspi_ioctl_clk_enable(gf_dev);
+#else
+		pr_debug("Doesn't support control clock.\n");
+#endif
+		break;
+	case GF_IOC_DISABLE_SPI_CLK:
+		pr_debug("%s GF_IOC_DISABLE_SPI_CLK\n", __func__);
+#ifdef AP_CONTROL_CLK
+		gfspi_ioctl_clk_disable(gf_dev);
+#else
+		pr_debug("Doesn't support control clock\n");
+#endif
+		break;
+	case GF_IOC_ENABLE_POWER:
+		pr_debug("%s GF_IOC_ENABLE_POWER\n", __func__);
+		if (gf_dev->device_available == 1)
+			pr_info("Sensor has already powered-on.\n");
+		else
+			gf_power_on(gf_dev);
+		gf_dev->device_available = 1;
+		break;
+	case GF_IOC_DISABLE_POWER:
+		pr_debug("%s GF_IOC_DISABLE_POWER\n", __func__);
+		if (gf_dev->device_available == 0)
+			pr_info("Sensor has already powered-off.\n");
+		else
+			gf_power_off(gf_dev);
+		gf_dev->device_available = 0;
+		break;
+	case GF_IOC_ENTER_SLEEP_MODE:
+		pr_debug("%s GF_IOC_ENTER_SLEEP_MODE\n", __func__);
+		break;
+	case GF_IOC_GET_FW_INFO:
+		pr_debug("%s GF_IOC_GET_FW_INFO\n", __func__);
+		break;
+
+	case GF_IOC_REMOVE:
+		//irq_cleanup(gf_dev);
+		//gf_cleanup(gf_dev);
+		pr_debug("%s GF_IOC_REMOVE\n", __func__);
+		break;
+
+	case GF_IOC_CHIP_INFO:
+		pr_debug("%s GF_IOC_CHIP_INFO\n", __func__);
+		if (copy_from_user(&info, (struct gf_ioc_chip_info *)arg, sizeof(struct gf_ioc_chip_info))) {
+			retval = -EFAULT;
+			break;
+		}
+		pr_info("vendor_id : 0x%x\n", info.vendor_id);
+		pr_info("mode : 0x%x\n", info.mode);
+		pr_info("operation: 0x%x\n", info.operation);
+		break;
+	default:
+		pr_warn("unsupport cmd:0x%x\n", cmd);
+		break;
+	}
+
+	return retval;
+}
+
+#ifdef CONFIG_COMPAT
+static long gf_compat_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+	return gf_ioctl(filp, cmd, (unsigned long)compat_ptr(arg));
+}
+#endif /*CONFIG_COMPAT*/
+
+
+static int gf_open(struct inode *inode, struct file *filp)
+{
+	struct gf_dev *gf_dev = &gf;
+	int status = -ENXIO;
+
+	mutex_lock(&device_list_lock);
+
+	list_for_each_entry(gf_dev, &device_list, device_entry) {
+		if (gf_dev->devt == inode->i_rdev) {
+			pr_info("Found\n");
+			status = 0;
+			break;
+		}
+	}
+
+	if (status == 0) {
+		if (status == 0) {
+			gf_dev->users++;
+			filp->private_data = gf_dev;
+			nonseekable_open(inode, filp);
+			pr_info("Succeed to open device. irq = %d\n",
+					gf_dev->irq);
+            #if 0  //zoulian@20170727 parse dts move to probe
+			if (gf_dev->users == 1) {
+				status = gf_parse_dts(gf_dev);
+				if (status)
+					goto err_parse_dt;
+
+				status = irq_setup(gf_dev);
+				if (status)
+					goto err_irq;
+			}
+            #endif
+			//gf_hw_reset(gf_dev, 5);
+			gf_dev->device_available = 1;
+		}
+	} else {
+		pr_info("No device for minor %d\n", iminor(inode));
+	}
+	mutex_unlock(&device_list_lock);
+
+	return status;
+#if 0    //zoulian@20170727 parse dts move to probe
+err_irq:
+	gf_cleanup(gf_dev);
+err_parse_dt:
+	return status;
+#endif
+}
+
+#ifdef GF_FASYNC
+static int gf_fasync(int fd, struct file *filp, int mode)
+{
+	struct gf_dev *gf_dev = filp->private_data;
+	int ret;
+
+	ret = fasync_helper(fd, filp, mode, &gf_dev->async);
+	pr_info("ret = %d\n", ret);
+	return ret;
+}
+#endif
+
+static int gf_release(struct inode *inode, struct file *filp)
+{
+	struct gf_dev *gf_dev = &gf;
+	int status = 0;
+
+	mutex_lock(&device_list_lock);
+	gf_dev = filp->private_data;
+	filp->private_data = NULL;
+
+	/*last close?? */
+	gf_dev->users--;
+	if (!gf_dev->users) {
+
+		pr_info("disble_irq. irq = %d\n", gf_dev->irq);
+		gf_disable_irq(gf_dev);
+		/*power off the sensor*/
+		gf_dev->device_available = 0;
+		gf_power_off(gf_dev);
+	}
+	mutex_unlock(&device_list_lock);
+	return status;
+}
+
+static const struct file_operations gf_fops = {
+	.owner = THIS_MODULE,
+	/* REVISIT switch to aio primitives, so that userspace
+	 * gets more complete API coverage.  It'll simplify things
+	 * too, except for the locking.
+	 */
+	.unlocked_ioctl = gf_ioctl,
+#ifdef CONFIG_COMPAT
+	.compat_ioctl = gf_compat_ioctl,
+#endif /*CONFIG_COMPAT*/
+	.open = gf_open,
+	.release = gf_release,
+#ifdef GF_FASYNC
+	.fasync = gf_fasync,
+#endif
+};
+
+static ssize_t screen_state_get(struct device *device,
+			     struct device_attribute *attribute,
+			     char *buffer)
+{
+	struct gf_dev *gfDev = dev_get_drvdata(device);
+
+	return scnprintf(buffer, PAGE_SIZE, "%i\n", gfDev->screen_state);
+}
+
+static DEVICE_ATTR(screen_state, 0400, screen_state_get, NULL);
+
+static struct attribute *gf_attributes[] = {
+	&dev_attr_screen_state.attr,
+	NULL
+};
+
+static const struct attribute_group gf_attribute_group = {
+	.attrs = gf_attributes,
+};
+
+int gf_opticalfp_irq_handler(int event)
+{
+	char msg = 0;
+
+	pr_info("[info]:%s, event %d", __func__, event);
+
+	if (gf.spi == NULL) {
+		return 0;
+	}
+	if (event == 1) {
+		msg = GF_NET_EVENT_TP_TOUCHDOWN;
+		sendnlmsg(&msg);
+	} else if (event == 0) {
+		msg = GF_NET_EVENT_TP_TOUCHUP;
+		sendnlmsg(&msg);
+	}
+
+	__pm_wakeup_event(&fp_wakelock, 10*HZ);
+
+	return 0;
+}
+EXPORT_SYMBOL(gf_opticalfp_irq_handler);
+
+#if defined(CONFIG_FB)
+static int goodix_fb_state_chg_callback(struct notifier_block *nb,
+		unsigned long val, void *data)
+{
+	struct gf_dev *gf_dev;
+	struct fb_event *evdata = data;
+	unsigned int blank;
+	char msg = 0;
+
+	if (val != FB_EARLY_EVENT_BLANK)
+		return 0;
+	pr_info("[info] %s go to the goodix_fb_state_chg_callback value = %d\n",
+			__func__, (int)val);
+	gf_dev = container_of(nb, struct gf_dev, notifier);
+
+	if (evdata && evdata->data && val == FB_EARLY_EVENT_BLANK && gf_dev) {
+		blank = *(int *)(evdata->data);
+		switch (blank) {
+		case FB_BLANK_POWERDOWN:
+			if (gf_dev->device_available == 1) {
+				gf_dev->fb_black = 1;
+#if defined(GF_NETLINK_ENABLE)
+				msg = GF_NET_EVENT_FB_BLACK;
+				sendnlmsg(&msg);
+#elif defined (GF_FASYNC)
+				if (gf_dev->async) {
+					kill_fasync(&gf_dev->async, SIGIO, POLL_IN);
+				}
+#endif
+			}
+			break;
+		case FB_BLANK_UNBLANK:
+			if (gf_dev->device_available == 1) {
+				gf_dev->fb_black = 0;
+#if defined(GF_NETLINK_ENABLE)
+				msg = GF_NET_EVENT_FB_UNBLACK;
+				sendnlmsg(&msg);
+#elif defined (GF_FASYNC)
+				if (gf_dev->async) {
+					kill_fasync(&gf_dev->async, SIGIO, POLL_IN);
+				}
+#endif
+			}
+			break;
+		default:
+			pr_info("%s defalut\n", __func__);
+			break;
+		}
+	}
+	return NOTIFY_OK;
+}
+
+static struct notifier_block goodix_noti_block = {
+	.notifier_call = goodix_fb_state_chg_callback,
+};
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+static int goodix_fb_state_chg_callback(
+	struct notifier_block *nb, unsigned long val, void *data)
+{
+	struct gf_dev *gf_dev;
+	struct msm_drm_notifier *evdata = data;
+	unsigned int blank;
+	char msg = 0;
+
+	if (val != MSM_DRM_EARLY_EVENT_BLANK &&
+		val != MSM_DRM_ONSCREENFINGERPRINT_EVENT)
+		return 0;
+
+	if (evdata->id != MSM_DRM_PRIMARY_DISPLAY)
+	    return 0;
+
+	pr_info("[info] %s go to the msm_drm_notifier_callback value = %d\n",
+			__func__, (int)val);
+	blank = *(int *)(evdata->data);
+	if (val == MSM_DRM_ONSCREENFINGERPRINT_EVENT) {
+		pr_info("[%s] UI ready enter\n", __func__);
+
+		switch (blank) {
+		case 0:
+			pr_info("[%s] UI disappear\n", __func__);
+			msg = GF_NET_EVENT_UI_DISAPPEAR;
+			sendnlmsg(&msg);
+			break;
+		case 1:
+			pr_info("[%s] UI ready\n", __func__);
+			msg = GF_NET_EVENT_UI_READY;
+			sendnlmsg(&msg);
+			break;
+		default:
+			pr_info("[%s] Unknown EVENT\n", __func__);
+			break;
+		}
+		return 0;
+	}
+	gf_dev = container_of(nb, struct gf_dev, msm_drm_notif);
+	if (evdata && evdata->data && val ==
+		MSM_DRM_EARLY_EVENT_BLANK && gf_dev) {
+		blank = *(int *)(evdata->data);
+		switch (blank) {
+		case MSM_DRM_BLANK_POWERDOWN:
+			if (gf_dev->device_available == 1) {
+				gf_dev->fb_black = 1;
+#if defined(GF_NETLINK_ENABLE)
+				msg = GF_NET_EVENT_FB_BLACK;
+				sendnlmsg(&msg);
+#elif defined(GF_FASYNC)
+				if (gf_dev->async) {
+					kill_fasync(&gf_dev->async,
+						SIGIO, POLL_IN);
+				}
+#endif
+			}
+			gf_dev->screen_state = 0;
+			sysfs_notify(&gf_dev->spi->dev.kobj,
+				NULL, dev_attr_screen_state.attr.name);
+			break;
+		case MSM_DRM_BLANK_UNBLANK:
+			if (gf_dev->device_available == 1) {
+				gf_dev->fb_black = 0;
+#if defined(GF_NETLINK_ENABLE)
+				msg = GF_NET_EVENT_FB_UNBLACK;
+				sendnlmsg(&msg);
+#elif defined(GF_FASYNC)
+				if (gf_dev->async)
+					kill_fasync(&gf_dev->async,
+						SIGIO, POLL_IN);
+#endif
+			}
+			gf_dev->screen_state = 1;
+			sysfs_notify(&gf_dev->spi->dev.kobj,
+				NULL, dev_attr_screen_state.attr.name);
+			break;
+		default:
+			pr_info("%s defalut\n", __func__);
+			break;
+		}
+	}
+	return NOTIFY_OK;
+}
+#endif
+
+static struct class *gf_class;
+#if defined(USE_SPI_BUS)
+static int gf_probe(struct spi_device *spi)
+#elif defined(USE_PLATFORM_BUS)
+static int gf_probe(struct platform_device *pdev)
+#endif
+{
+	struct gf_dev *gf_dev = &gf;
+	int status = -EINVAL;
+	unsigned long minor;
+	int i;
+
+	/* Initialize the driver data */
+	INIT_LIST_HEAD(&gf_dev->device_entry);
+#if defined(USE_SPI_BUS)
+	gf_dev->spi = spi;
+#elif defined(USE_PLATFORM_BUS)
+	gf_dev->spi = pdev;
+#endif
+	gf_dev->irq_gpio = -EINVAL;
+	gf_dev->reset_gpio = -EINVAL;
+	gf_dev->pwr_gpio = -EINVAL;
+	gf_dev->device_available = 0;
+	gf_dev->fb_black = 0;
+
+	/* If we can allocate a minor number, hook up this device.
+	 * Reusing minors is fine so long as udev or mdev is working.
+	 */
+	mutex_lock(&device_list_lock);
+	minor = find_first_zero_bit(minors, N_SPI_MINORS);
+	if (minor < N_SPI_MINORS) {
+		struct device *dev;
+
+		gf_dev->devt = MKDEV(SPIDEV_MAJOR, minor);
+		dev = device_create(gf_class, &gf_dev->spi->dev, gf_dev->devt,
+				gf_dev, GF_DEV_NAME);
+		status = IS_ERR(dev) ? PTR_ERR(dev) : 0;
+	} else {
+		dev_dbg(&gf_dev->spi->dev, "no minor number available!\n");
+		status = -ENODEV;
+		mutex_unlock(&device_list_lock);
+		goto error_hw;
+	}
+
+	if (status == 0) {
+		set_bit(minor, minors);
+		list_add(&gf_dev->device_entry, &device_list);
+	} else {
+		gf_dev->devt = 0;
+	}
+	mutex_unlock(&device_list_lock);
+	status = gf_parse_dts(gf_dev);
+	if (status)
+		goto err_parse_dt;
+	/*
+	 * liuyan mv wakelock here
+	 * it should before irq
+	 */
+	wakeup_source_init(&fp_wakelock, "fp_wakelock");
+	status = irq_setup(gf_dev);
+	if (status)
+		goto err_irq;
+
+	status = gf_pinctrl_init(gf_dev);
+	if (status)
+		goto err_irq;
+	if (get_boot_mode() !=  MSM_BOOT_MODE__FACTORY) {
+		status = pinctrl_select_state(gf_dev->gf_pinctrl,
+			gf_dev->gpio_state_enable);
+		if (status) {
+			pr_err("can not set %s pins\n", "fp_en_init");
+			goto error_hw;
+		}
+	} else {
+		status = pinctrl_select_state(gf_dev->gf_pinctrl,
+			gf_dev->gpio_state_disable);
+		if (status) {
+			pr_err("can not set %s pins\n", "fp_dis_init");
+			goto error_hw;
+		}
+	}
+	if (status == 0) {
+		/*input device subsystem */
+		gf_dev->input = input_allocate_device();
+		if (gf_dev->input == NULL) {
+			pr_err("%s, failed to allocate input device\n", __func__);
+			status = -ENOMEM;
+			goto error_dev;
+		}
+		for (i = 0; i < ARRAY_SIZE(maps); i++)
+			input_set_capability(gf_dev->input, maps[i].type, maps[i].code);
+
+		gf_dev->input->name = GF_INPUT_NAME;
+		status = input_register_device(gf_dev->input);
+		if (status) {
+			pr_err("failed to register input device\n");
+			goto error_input;
+		}
+	}
+#ifdef AP_CONTROL_CLK
+	pr_info("Get the clk resource.\n");
+	/* Enable spi clock */
+	if (gfspi_ioctl_clk_init(gf_dev))
+		goto gfspi_probe_clk_init_failed:
+
+	if (gfspi_ioctl_clk_enable(gf_dev))
+		goto gfspi_probe_clk_enable_failed;
+
+	spi_clock_set(gf_dev, 1000000);
+#endif
+
+#if defined(CONFIG_FB)
+	gf_dev->notifier = goodix_noti_block;
+	fb_register_client(&gf_dev->notifier);
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	gf_dev->msm_drm_notif.notifier_call = goodix_fb_state_chg_callback;
+	status = msm_drm_register_client(&gf_dev->msm_drm_notif);
+	if (status)
+		pr_err("Unable to register msm_drm_notifier: %d\n", status);
+#endif
+
+	#ifdef USE_SPI_BUS
+		spi_set_drvdata(spi, gf_dev);
+	#else
+		platform_set_drvdata(pdev, gf_dev);
+	#endif
+	status = sysfs_create_group(&gf_dev->spi->dev.kobj,
+			&gf_attribute_group);
+	if (status) {
+		pr_err("%s:could not create sysfs\n", __func__);
+		goto error_input;
+	}
+	pr_info("version V%d.%d.%02d\n", VER_MAJOR, VER_MINOR, PATCH_LEVEL);
+
+	return status;
+
+#ifdef AP_CONTROL_CLK
+gfspi_probe_clk_enable_failed:
+	gfspi_ioctl_clk_uninit(gf_dev);
+gfspi_probe_clk_init_failed:
+#endif
+
+error_input:
+	if (gf_dev->input != NULL)
+		input_free_device(gf_dev->input);
+error_dev:
+	if (gf_dev->devt != 0) {
+		pr_info("Err: status = %d\n", status);
+		mutex_lock(&device_list_lock);
+		list_del(&gf_dev->device_entry);
+		device_destroy(gf_class, gf_dev->devt);
+		clear_bit(MINOR(gf_dev->devt), minors);
+		mutex_unlock(&device_list_lock);
+	}
+err_irq:
+	gf_cleanup(gf_dev);
+err_parse_dt:
+error_hw:
+	gf_dev->device_available = 0;
+
+	return status;
+}
+
+#if defined(USE_SPI_BUS)
+static int gf_remove(struct spi_device *spi)
+#elif defined(USE_PLATFORM_BUS)
+static int gf_remove(struct platform_device *pdev)
+#endif
+{
+	struct gf_dev *gf_dev = &gf;
+
+	wakeup_source_trash(&fp_wakelock);
+
+#if defined(CONFIG_FB)
+	fb_unregister_client(&gf_dev->notifier);
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	if (msm_drm_unregister_client(&gf_dev->msm_drm_notif))
+		pr_err("Error occurred while unregistering msm_drm_notifier.\n");
+#endif
+	if (gf_dev->input)
+		input_unregister_device(gf_dev->input);
+	input_free_device(gf_dev->input);
+
+	/* prevent new opens */
+	mutex_lock(&device_list_lock);
+	list_del(&gf_dev->device_entry);
+	device_destroy(gf_class, gf_dev->devt);
+	clear_bit(MINOR(gf_dev->devt), minors);
+	mutex_unlock(&device_list_lock);
+
+	return 0;
+}
+
+static struct of_device_id gx_match_table[] = {
+	{ .compatible = GF_SPIDEV_NAME },
+	{},
+};
+
+#if defined(USE_SPI_BUS)
+static struct spi_driver gf_driver = {
+#elif defined(USE_PLATFORM_BUS)
+static struct platform_driver gf_driver = {
+#endif
+	.driver = {
+		.name = GF_DEV_NAME,
+		.owner = THIS_MODULE,
+		.of_match_table = gx_match_table,
+	},
+	.probe = gf_probe,
+	.remove = gf_remove,
+};
+
+static int __init gf_init(void)
+{
+	int status;
+
+	/* Claim our 256 reserved device numbers.  Then register a class
+	 * that will key udev/mdev to add/remove /dev nodes.  Last, register
+	 * the driver which manages those device numbers.
+	 */
+	pr_info("%s:fp version %x\n", __func__, fp_version);
+	if ((fp_version != 0x03) && (fp_version != 0x04))
+		return 0;
+	BUILD_BUG_ON(N_SPI_MINORS > 256);
+	status = register_chrdev(SPIDEV_MAJOR, CHRD_DRIVER_NAME, &gf_fops);
+	if (status < 0) {
+		pr_warn("Failed to register char device!\n");
+		return status;
+	}
+	SPIDEV_MAJOR = status;
+	gf_class = class_create(THIS_MODULE, CLASS_NAME);
+	if (IS_ERR(gf_class)) {
+		unregister_chrdev(SPIDEV_MAJOR, gf_driver.driver.name);
+		pr_warn("Failed to create class.\n");
+		return PTR_ERR(gf_class);
+	}
+#if defined(USE_PLATFORM_BUS)
+	status = platform_driver_register(&gf_driver);
+#elif defined(USE_SPI_BUS)
+	status = spi_register_driver(&gf_driver);
+#endif
+	if (status < 0) {
+		class_destroy(gf_class);
+		unregister_chrdev(SPIDEV_MAJOR, gf_driver.driver.name);
+		pr_warn("Failed to register SPI driver.\n");
+	}
+
+#ifdef GF_NETLINK_ENABLE
+	netlink_init();
+#endif
+	pr_info("status = 0x%x\n", status);
+	return 0;
+}
+module_init(gf_init);
+
+static void __exit gf_exit(void)
+{
+#ifdef GF_NETLINK_ENABLE
+	netlink_exit();
+#endif
+#if defined(USE_PLATFORM_BUS)
+	platform_driver_unregister(&gf_driver);
+#elif defined(USE_SPI_BUS)
+	spi_unregister_driver(&gf_driver);
+#endif
+	class_destroy(gf_class);
+	unregister_chrdev(SPIDEV_MAJOR, gf_driver.driver.name);
+}
+module_exit(gf_exit);
+
+MODULE_AUTHOR("Jiangtao Yi, <yijiangtao@goodix.com>");
+MODULE_AUTHOR("Jandy Gou, <gouqingsong@goodix.com>");
+MODULE_DESCRIPTION("goodix fingerprint sensor device driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/fingerprint/goodix/gf_spi.h b/drivers/input/fingerprint/goodix/gf_spi.h
new file mode 100755
index 0000000000000000000000000000000000000000..4b0d762a5f38f296eeed249df05c5b0d9917310c
--- /dev/null
+++ b/drivers/input/fingerprint/goodix/gf_spi.h
@@ -0,0 +1,185 @@
+/*
+ * driver definition for sensor driver
+ *
+ * Coypright (c) 2017 Goodix
+ */
+#ifndef __GF_SPI_H
+#define __GF_SPI_H
+
+#define CONFIG_MSM_RDM_NOTIFY
+#undef CONFIG_FB
+#if defined(CONFIG_MSM_RDM_NOTIFY)
+#include <linux/msm_drm_notify.h>
+#endif
+
+#include <linux/types.h>
+#include <linux/notifier.h>
+/**********************************************************/
+enum FP_MODE{
+	GF_IMAGE_MODE = 0,
+	GF_KEY_MODE,
+	GF_SLEEP_MODE,
+	GF_FF_MODE,
+	GF_DEBUG_MODE = 0x56
+};
+
+#define SUPPORT_NAV_EVENT
+
+#if defined(SUPPORT_NAV_EVENT)
+#define GF_NAV_INPUT_UP			KEY_UP
+#define GF_NAV_INPUT_DOWN		KEY_DOWN
+#define GF_NAV_INPUT_LEFT		KEY_LEFT
+#define GF_NAV_INPUT_RIGHT		KEY_RIGHT
+#define GF_NAV_INPUT_CLICK		KEY_VOLUMEDOWN
+#define GF_NAV_INPUT_DOUBLE_CLICK	KEY_VOLUMEUP
+#define GF_NAV_INPUT_LONG_PRESS BTN_B
+#define GF_NAV_INPUT_F2 KEY_F2
+#define GF_NAV_INPUT_HEAVY		KEY_CHAT
+#endif
+
+#define GF_KEY_INPUT_HOME		KEY_HOME
+#define GF_KEY_INPUT_MENU		KEY_MENU
+#define GF_KEY_INPUT_BACK		KEY_BACK
+#define GF_KEY_INPUT_POWER		KEY_POWER
+#define GF_KEY_INPUT_CAMERA		KEY_CAMERA
+#define GF_KEY_INPUT_LONG_PRESS		BTN_B
+
+
+#if defined(SUPPORT_NAV_EVENT)
+typedef enum gf_nav_event {
+	GF_NAV_NONE = 0,
+	GF_NAV_FINGER_UP,
+	GF_NAV_FINGER_DOWN,
+	GF_NAV_UP,
+	GF_NAV_DOWN,
+	GF_NAV_LEFT,
+	GF_NAV_RIGHT,
+	GF_NAV_CLICK,
+	GF_NAV_HEAVY,
+	GF_NAV_LONG_PRESS,
+	GF_NAV_DOUBLE_CLICK,
+	GF_NAV_F2,
+} gf_nav_event_t;
+#endif
+
+typedef enum gf_key_event {
+	GF_KEY_NONE = 0,
+	GF_KEY_HOME,
+	GF_KEY_POWER,
+	GF_KEY_MENU,
+	GF_KEY_BACK,
+	GF_KEY_CAMERA,
+	GF_KEY_LONGPRESS,
+} gf_key_event_t;
+
+struct gf_key {
+	enum gf_key_event key;
+	uint32_t value;   /* key down = 1, key up = 0 */
+};
+
+struct gf_key_map {
+	unsigned int type;
+	unsigned int code;
+};
+
+struct gf_ioc_chip_info {
+	unsigned char vendor_id;
+	unsigned char mode;
+	unsigned char operation;
+	unsigned char reserved[5];
+};
+
+#define GF_IOC_MAGIC    'g'     //define magic number
+#define GF_IOC_INIT             _IOR(GF_IOC_MAGIC, 0, uint8_t)
+#define GF_IOC_EXIT             _IO(GF_IOC_MAGIC, 1)
+#define GF_IOC_RESET            _IO(GF_IOC_MAGIC, 2)
+#define GF_IOC_ENABLE_IRQ       _IO(GF_IOC_MAGIC, 3)
+#define GF_IOC_DISABLE_IRQ      _IO(GF_IOC_MAGIC, 4)
+#define GF_IOC_ENABLE_SPI_CLK   _IOW(GF_IOC_MAGIC, 5, uint32_t)
+#define GF_IOC_DISABLE_SPI_CLK  _IO(GF_IOC_MAGIC, 6)
+#define GF_IOC_ENABLE_POWER     _IO(GF_IOC_MAGIC, 7)
+#define GF_IOC_DISABLE_POWER    _IO(GF_IOC_MAGIC, 8)
+#define GF_IOC_INPUT_KEY_EVENT  _IOW(GF_IOC_MAGIC, 9, struct gf_key)
+#define GF_IOC_ENTER_SLEEP_MODE _IO(GF_IOC_MAGIC, 10)
+#define GF_IOC_GET_FW_INFO      _IOR(GF_IOC_MAGIC, 11, uint8_t)
+#define GF_IOC_REMOVE           _IO(GF_IOC_MAGIC, 12)
+#define GF_IOC_CHIP_INFO        _IOW(GF_IOC_MAGIC, 13, struct gf_ioc_chip_info)
+
+#if defined(SUPPORT_NAV_EVENT)
+#define GF_IOC_NAV_EVENT	_IOW(GF_IOC_MAGIC, 14, gf_nav_event_t)
+#define  GF_IOC_MAXNR    15  /* THIS MACRO IS NOT USED NOW... */
+#else
+#define  GF_IOC_MAXNR    14  /* THIS MACRO IS NOT USED NOW... */
+#endif
+
+//#define AP_CONTROL_CLK       1
+#define  USE_PLATFORM_BUS     1
+//#define  USE_SPI_BUS	1
+//#define GF_FASYNC   1	/*If support fasync mechanism.*/
+#define GF_NETLINK_ENABLE 1
+#define GF_NET_EVENT_IRQ 1
+#define GF_NET_EVENT_FB_BLACK 2
+#define GF_NET_EVENT_FB_UNBLACK 3
+#define GF_NET_EVENT_TP_TOUCHDOWN 4
+#define GF_NET_EVENT_TP_TOUCHUP 5
+#define GF_NET_EVENT_UI_READY 6
+#define GF_NET_EVENT_UI_DISAPPEAR 7
+#define NETLINK_TEST 25
+
+struct gf_dev {
+	dev_t devt;
+	struct list_head device_entry;
+#if defined(USE_SPI_BUS)
+	struct spi_device *spi;
+#elif defined(USE_PLATFORM_BUS)
+	struct platform_device *spi;
+#endif
+	struct clk *core_clk;
+	struct clk *iface_clk;
+
+	struct input_dev *input;
+	/* buffer is NULL unless this device is open (users > 0) */
+	unsigned users;
+	signed irq_gpio;
+	signed reset_gpio;
+	signed pwr_gpio;
+	int irq;
+	int irq_enabled;
+	int clk_enabled;
+
+	struct regulator *vdd_3v2;
+	int regulator_vdd_vmin;
+	int regulator_vdd_vmax;
+	int regulator_vdd_current;
+
+#ifdef GF_FASYNC
+	struct fasync_struct *async;
+#endif
+#if defined(CONFIG_FB)
+	struct notifier_block notifier;
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	struct notifier_block msm_drm_notif;
+#endif
+	char device_available;
+	char fb_black;
+	struct pinctrl         *gf_pinctrl;
+	struct pinctrl_state   *gpio_state_enable;
+	struct pinctrl_state   *gpio_state_disable;
+	signed enable_gpio;
+	int screen_state;
+};
+int gf_pinctrl_init(struct gf_dev* gf_dev);
+int gf_parse_dts(struct gf_dev* gf_dev);
+void gf_cleanup(struct gf_dev *gf_dev);
+
+int gf_power_on(struct gf_dev *gf_dev);
+int gf_power_off(struct gf_dev *gf_dev);
+
+int gf_hw_reset(struct gf_dev *gf_dev, unsigned int delay_ms);
+int gf_irq_num(struct gf_dev *gf_dev);
+
+void sendnlmsg(char *msg);
+int netlink_init(void);
+void netlink_exit(void);
+extern int gf_opticalfp_irq_handler(int event);
+#endif /*__GF_SPI_H*/
diff --git a/drivers/input/fingerprint/goodix/netlink.c b/drivers/input/fingerprint/goodix/netlink.c
new file mode 100755
index 0000000000000000000000000000000000000000..112536dfce091946f9a7ddd422045b6b8e355c3d
--- /dev/null
+++ b/drivers/input/fingerprint/goodix/netlink.c
@@ -0,0 +1,100 @@
+/*
+ * netlink interface
+ *
+ * Copyright (c) 2017 Goodix
+ */
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+#include <linux/types.h>
+#include <net/sock.h>
+#include <net/netlink.h>
+#include "gf_spi.h"
+
+#define NETLINK_TEST 25
+#define MAX_MSGSIZE 32
+
+static int pid = -1;
+struct sock *gf_nl_sk = NULL;
+
+void sendnlmsg(char *msg)
+{
+	struct sk_buff *skb_1;
+	struct nlmsghdr *nlh;
+	int len = NLMSG_SPACE(MAX_MSGSIZE);
+	int ret = 0;
+	if (!msg || !gf_nl_sk || !pid) {
+		return ;
+	}
+	skb_1 = alloc_skb(len, GFP_KERNEL);
+	if (!skb_1) {
+		pr_err("alloc_skb error\n");
+		return;
+	}
+
+	nlh = nlmsg_put(skb_1, 0, 0, 0, MAX_MSGSIZE, 0);
+
+	NETLINK_CB(skb_1).portid = 0;
+	NETLINK_CB(skb_1).dst_group = 0;
+
+	memcpy(NLMSG_DATA(nlh), msg, sizeof(char));
+	pr_debug("send message: %d\n", *(char *)NLMSG_DATA(nlh));
+
+	ret = netlink_unicast(gf_nl_sk, skb_1, pid, MSG_DONTWAIT);
+	if (!ret) {
+		//kfree_skb(skb_1);
+		pr_err("send msg from kernel to usespace failed ret 0x%x\n", ret);
+	}
+}
+
+void nl_data_ready(struct sk_buff *__skb)
+{
+	struct sk_buff *skb;
+	struct nlmsghdr *nlh;
+	char str[100];
+	skb = skb_get (__skb);
+	if(skb->len >= NLMSG_SPACE(0))
+	{
+		nlh = nlmsg_hdr(skb);
+
+		memcpy(str, NLMSG_DATA(nlh), sizeof(str));
+		pid = nlh->nlmsg_pid;
+
+		kfree_skb(skb);
+	}
+
+}
+
+
+int netlink_init(void)
+{
+	struct netlink_kernel_cfg netlink_cfg;
+	memset(&netlink_cfg, 0, sizeof(struct netlink_kernel_cfg));
+
+	netlink_cfg.groups = 0;
+	netlink_cfg.flags = 0;
+	netlink_cfg.input = nl_data_ready;
+	netlink_cfg.cb_mutex = NULL;
+
+	gf_nl_sk = netlink_kernel_create(&init_net, NETLINK_TEST,
+			&netlink_cfg);
+
+	if(!gf_nl_sk){
+		pr_err("create netlink socket error\n");
+		return 1;
+	}
+
+	return 0;
+}
+
+void netlink_exit(void)
+{
+	if(gf_nl_sk != NULL){
+		netlink_kernel_release(gf_nl_sk);
+		gf_nl_sk = NULL;
+	}
+
+	pr_info("self module exited\n");
+}
+
diff --git a/drivers/input/fingerprint/goodix/platform.c b/drivers/input/fingerprint/goodix/platform.c
new file mode 100644
index 0000000000000000000000000000000000000000..3dc28346277e6f2929fde627da10281d75715aa8
--- /dev/null
+++ b/drivers/input/fingerprint/goodix/platform.c
@@ -0,0 +1,157 @@
+/*
+ * platform indepent driver interface
+ *
+ * Coypritht (c) 2017 Goodix
+ */
+#include <linux/delay.h>
+#include <linux/workqueue.h>
+#include <linux/of_gpio.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
+#include <linux/timer.h>
+#include <linux/err.h>
+
+#include "gf_spi.h"
+
+#if defined(USE_SPI_BUS)
+#include <linux/spi/spi.h>
+#include <linux/spi/spidev.h>
+#elif defined(USE_PLATFORM_BUS)
+#include <linux/platform_device.h>
+#endif
+#include <linux/oneplus/boot_mode.h>
+
+int gf_pinctrl_init(struct gf_dev* gf_dev)
+{
+	int ret = 0;
+	struct device *dev = &gf_dev->spi->dev;
+
+	gf_dev->gf_pinctrl = devm_pinctrl_get(dev);
+	if (IS_ERR_OR_NULL(gf_dev->gf_pinctrl)) {
+		dev_err(dev, "Target does not use pinctrl\n");
+		ret = PTR_ERR(gf_dev->gf_pinctrl);
+		goto err;
+	}
+
+	gf_dev->gpio_state_enable =
+		pinctrl_lookup_state(gf_dev->gf_pinctrl, "fp_en_init");
+	if (IS_ERR_OR_NULL(gf_dev->gpio_state_enable)) {
+		dev_err(dev, "Cannot get active pinstate\n");
+		ret = PTR_ERR(gf_dev->gpio_state_enable);
+		goto err;
+	}
+
+	gf_dev->gpio_state_disable =
+		pinctrl_lookup_state(gf_dev->gf_pinctrl, "fp_dis_init");
+	if (IS_ERR_OR_NULL(gf_dev->gpio_state_disable)) {
+		dev_err(dev, "Cannot get active pinstate\n");
+		ret = PTR_ERR(gf_dev->gpio_state_disable);
+		goto err;
+	}
+
+	return 0;
+err:
+	gf_dev->gf_pinctrl = NULL;
+	gf_dev->gpio_state_enable = NULL;
+	gf_dev->gpio_state_disable = NULL;
+	return ret;
+}
+int gf_parse_dts(struct gf_dev* gf_dev)
+{
+	int rc = 0;
+	struct device *dev = &gf_dev->spi->dev;
+	struct device_node *np = dev->of_node;
+	//u32 voltage_supply[2];
+	//u32 current_supply;
+
+	gf_dev->reset_gpio = of_get_named_gpio(np, "fp-gpio-reset", 0);
+	if (gf_dev->reset_gpio < 0) {
+		pr_err("falied to get reset gpio!\n");
+		return gf_dev->reset_gpio;
+	}
+
+	rc = devm_gpio_request(dev, gf_dev->reset_gpio, "goodix_reset");
+	if (rc) {
+		pr_err("failed to request reset gpio, rc = %d\n", rc);
+		goto err_reset;
+	}
+	gpio_direction_output(gf_dev->reset_gpio, 0);
+
+	gf_dev->irq_gpio = of_get_named_gpio(np, "fp-gpio-irq", 0);
+	if (gf_dev->irq_gpio < 0) {
+		pr_err("falied to get irq gpio!\n");
+		return gf_dev->irq_gpio;
+	}
+
+	rc = devm_gpio_request(dev, gf_dev->irq_gpio, "goodix_irq");
+	if (rc) {
+		pr_err("failed to request irq gpio, rc = %d\n", rc);
+		goto err_irq;
+	}
+	gpio_direction_input(gf_dev->irq_gpio);
+
+	return rc;
+err_irq:
+	devm_gpio_free(dev, gf_dev->irq_gpio);
+err_reset:
+	devm_gpio_free(dev, gf_dev->reset_gpio);
+	return rc;
+}
+
+void gf_cleanup(struct gf_dev *gf_dev)
+{
+	pr_info("[info] %s\n",__func__);
+	if (gpio_is_valid(gf_dev->irq_gpio))
+	{
+		gpio_free(gf_dev->irq_gpio);
+		pr_info("remove irq_gpio success\n");
+	}
+	if (gpio_is_valid(gf_dev->reset_gpio))
+	{
+		gpio_free(gf_dev->reset_gpio);
+		pr_info("remove reset_gpio success\n");
+	}
+}
+
+int gf_power_on(struct gf_dev* gf_dev)
+{
+	int rc = 0;
+
+	pr_info("---- power on ok ----\n");
+
+	return rc;
+}
+
+int gf_power_off(struct gf_dev* gf_dev)
+{
+    int rc = 0;
+
+    pr_info("---- power off ----\n");
+
+	return rc;
+}
+
+int gf_hw_reset(struct gf_dev *gf_dev, unsigned int delay_ms)
+{
+	if(gf_dev == NULL) {
+		pr_info("Input buff is NULL.\n");
+		return -1;
+	}
+	gpio_direction_output(gf_dev->reset_gpio, 1);
+	gpio_set_value(gf_dev->reset_gpio, 0);
+	mdelay(3);
+	gpio_set_value(gf_dev->reset_gpio, 1);
+	mdelay(delay_ms);
+	return 0;
+}
+
+int gf_irq_num(struct gf_dev *gf_dev)
+{
+	if(gf_dev == NULL) {
+		pr_info("Input buff is NULL.\n");
+		return -1;
+	} else {
+		return gpio_to_irq(gf_dev->irq_gpio);
+	}
+}
+
diff --git a/drivers/input/fingerprint/qbt1000/Makefile b/drivers/input/fingerprint/qbt1000/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..d5ccc1e7e91db4f4b22213c651a7f8ce4c8259c5
--- /dev/null
+++ b/drivers/input/fingerprint/qbt1000/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_MSM_QBT1000) += qbt1000.o
diff --git a/drivers/soc/qcom/qbt1000.c b/drivers/input/fingerprint/qbt1000/qbt1000.c
similarity index 80%
rename from drivers/soc/qcom/qbt1000.c
rename to drivers/input/fingerprint/qbt1000/qbt1000.c
index 84ec2e05ed74803232259f9db143d7aef4da614d..b1153ac2bac2950c5964a481f08b1f82849346f1 100644
--- a/drivers/soc/qcom/qbt1000.c
+++ b/drivers/input/fingerprint/qbt1000/qbt1000.c
@@ -36,7 +36,9 @@
 #include <linux/poll.h>
 #include <uapi/linux/qbt1000.h>
 #include <soc/qcom/scm.h>
-#include "../../misc/qseecom_kernel.h"
+#include "../../../misc/qseecom_kernel.h"
+#include "../fingerprint_detect/fingerprint_detect.h"
+
 
 #define QBT1000_DEV "qbt1000"
 #define QBT1000_IN_DEV_NAME "qbt1000_key_input"
@@ -45,6 +47,7 @@
 #define FW_MAX_IPC_MSG_DATA_SIZE 0x500
 #define SEND_TZ_CMD_RETRY_CNT 10
 #define SEND_TZ_CMD_DELAY 50
+#define MAX_TOUCHES 10
 
 /*
  * shared buffer size - init with max value,
@@ -52,6 +55,9 @@
  */
 static uint32_t g_app_buf_size = SZ_256K;
 static char const *const FP_APP_NAME = "fingerpr";
+//static bool is_probed = false;
+static struct qbt1000_drvdata *ts_cb_drvdata = NULL;
+static signed qbt1000_int2 = 0;
 
 enum fp_app_cmd {
 	FP_APP_CMD_RX_IPC = 132,
@@ -82,7 +88,6 @@ struct finger_detect_gpio {
 	unsigned int key_code;
 	int power_key_enabled;
 	int last_gpio_state;
-	int event_reported;
 };
 
 struct fw_event_desc {
@@ -94,6 +99,17 @@ struct fw_ipc_info {
 	int irq;
 };
 
+struct qbt1000_touch_status {
+	int x;
+	int y;
+};
+
+struct qbt1000_mt_status {
+	bool is_registered;
+	int slot;
+	struct qbt1000_touch_status touches[MAX_TOUCHES];
+};
+
 struct qbt1000_drvdata {
 	struct class	*qbt1000_class;
 	struct cdev	qbt1000_cdev;
@@ -106,7 +122,7 @@ struct qbt1000_drvdata {
 	unsigned int	frequency;
 	atomic_t	available;
 	struct mutex	mutex;
-	struct mutex	fw_events_mutex;
+	spinlock_t	fw_events_lock;
 	struct input_dev	*in_dev;
 	struct fw_ipc_info	fw_ipc;
 	struct finger_detect_gpio	fd_gpio;
@@ -117,12 +133,14 @@ struct qbt1000_drvdata {
 	enum fd_indication_mode fd_ind_mode;
 	bool ipc_is_stale;
 	bool gestures_enabled;
+	struct qbt1000_sensor_pos sensor_pos;
+	struct qbt1000_mt_status mt;
 };
 
 /*
  * struct fw_ipc_cmd -
  *      used to store IPC commands to/from firmware
- * @status - indicates whether sending/getting the IPC message was successful
+ * @status - indicates if sending/getting the IPC message was successful
  * @msg_type - the type of IPC message
  * @msg_len - the length of the message data
  * @resp_needed - whether a response is needed for this message
@@ -158,6 +176,31 @@ struct ipc_msg_type_to_fw_event g_msg_to_event[] = {
 		{IPC_MSG_ID_FINGER_OFF_SENSOR, FW_EVENT_FINGER_UP},
 };
 
+static void gpio_report_event(struct qbt1000_drvdata *drvdata, int state);
+
+int qbt1000_int2_callback(int event)
+{
+	//if (!is_probed)
+	//	return -1;
+	if (ts_cb_drvdata == NULL) {
+		pr_err("ts_cb_drvata is NULL");
+		return -1;
+	}
+
+	pr_info("%s: event %d", __func__, event);
+
+	if (event == 1) {
+		//gpio_set_value(qbt1000_int2, 1);
+		gpio_report_event(ts_cb_drvdata,1);
+	} else if (event == 0) {
+		//gpio_set_value(qbt1000_int2, 0);
+		gpio_report_event(ts_cb_drvdata,0);
+	}
+
+	return 0;
+}
+EXPORT_SYMBOL(qbt1000_int2_callback);
+
 /**
  * get_cmd_rsp_buffers() - Function sets cmd & rsp buffer pointers and
  *                         aligns buffer lengths
@@ -265,6 +308,225 @@ static int send_tz_cmd(struct qbt1000_drvdata *drvdata,
 	return rc;
 }
 
+static void purge_finger_events(struct qbt1000_drvdata *drvdata)
+{
+	int i, fifo_len;
+	struct fw_event_desc fw_event;
+
+	fifo_len = kfifo_len(&drvdata->fw_events);
+
+	for (i = 0; i < fifo_len; i++) {
+		if (!kfifo_get(&drvdata->fw_events, &fw_event))
+			pr_err("fw events fifo: could not remove oldest item\n");
+		else if (fw_event.ev != FW_EVENT_FINGER_DOWN
+					&& fw_event.ev != FW_EVENT_FINGER_UP)
+			kfifo_put(&drvdata->fw_events, fw_event);
+	}
+}
+
+static void gpio_report_event(struct qbt1000_drvdata *drvdata, int state)
+{
+	struct fw_event_desc fw_event;
+
+	pr_debug("gpio %d: last state %d, new state %d\n",
+			drvdata->fd_gpio.gpio,
+			drvdata->fd_gpio.last_gpio_state,
+			state);
+
+	//if (state == drvdata->fd_gpio.last_gpio_state)
+	//	return;
+
+	drvdata->fd_gpio.last_gpio_state = state;
+
+	if (drvdata->fd_ind_mode == FD_IND_MODE_GESTURES) {
+		pr_debug("tap detected\n");
+		/*
+		 * If a gesture IPC was sent but not yet decrypted and
+		 * dealt with mark it as stale and don't report it
+		 */
+		drvdata->ipc_is_stale = true;
+		input_event(drvdata->in_dev,
+				EV_KEY, KEY_FP_GESTURE_TAP, 1);
+		input_sync(drvdata->in_dev);
+		input_event(drvdata->in_dev,
+				EV_KEY, KEY_FP_GESTURE_TAP, 0);
+		input_sync(drvdata->in_dev);
+	} else if (drvdata->fd_ind_mode == FD_IND_MODE_BIOMETRIC) {
+		if (state && drvdata->fd_gpio.power_key_enabled) {
+			input_event(drvdata->in_dev, EV_KEY, KEY_POWER, 1);
+			input_sync(drvdata->in_dev);
+			input_event(drvdata->in_dev, EV_KEY, KEY_POWER, 0);
+			input_sync(drvdata->in_dev);
+		} else if (!drvdata->gestures_enabled) {
+			input_event(drvdata->in_dev, EV_KEY,
+				drvdata->fd_gpio.key_code, !!state);
+			input_sync(drvdata->in_dev);
+		}
+		fw_event.ev = state ? FW_EVENT_FINGER_DOWN : FW_EVENT_FINGER_UP;
+
+		spin_lock(&drvdata->fw_events_lock);
+		if (kfifo_is_full(&drvdata->fw_events)) {
+			struct fw_event_desc dummy_fw_event;
+
+			pr_warn("fw events fifo: full, dropping oldest item\n");
+			if (!kfifo_get(&drvdata->fw_events, &dummy_fw_event))
+				pr_err("fw events fifo: could not remove oldest item\n");
+		}
+
+		purge_finger_events(drvdata);
+
+		if (!kfifo_put(&drvdata->fw_events, fw_event))
+			pr_err("fw events fifo: error adding item\n");
+		spin_unlock(&drvdata->fw_events_lock);
+
+		wake_up_interruptible(&drvdata->read_wait_queue);
+	} else {
+		pr_err("invalid mode %d\n", drvdata->fd_ind_mode);
+	}
+}
+
+/* Clear touch status */
+static void qbt1000_touch_clear_mt_status(struct qbt1000_mt_status *m)
+{
+	int i;
+
+	m->slot = 0;
+	for (i = 0; i < MAX_TOUCHES; i++) {
+		m->touches[i].x = -1;
+		m->touches[i].y = -1;
+	}
+}
+
+static bool qbt1000_touch_get_state(struct qbt1000_drvdata *drvdata)
+{
+	int i, state = 0;
+	struct qbt1000_mt_status *m = &drvdata->mt;
+
+	if (unlikely(!drvdata->sensor_pos.enable))
+		goto end;
+
+	for (i = 0; i < MAX_TOUCHES; i++) {
+		if (m->touches[i].x >= drvdata->sensor_pos.left   &&
+		    m->touches[i].x <= drvdata->sensor_pos.right  &&
+		    m->touches[i].y >= drvdata->sensor_pos.top    &&
+		    m->touches[i].y <= drvdata->sensor_pos.bottom)
+			state = 1;
+
+		if (m->touches[i].x >= 0 || m->touches[i].y >= 0)
+			pr_debug("slot: %d, x: %d, y: %d, state: %d",
+					i,
+					m->touches[i].x,
+					m->touches[i].y,
+					state);
+	}
+
+end:
+	return state;
+}
+
+static void qbt1000_touch_event(struct input_handle *handle,
+	unsigned int type, unsigned int code, int value)
+{
+	struct qbt1000_drvdata *drvdata = handle->handler->private;
+	struct qbt1000_mt_status *m = &drvdata->mt;
+	struct qbt1000_touch_status *t = &m->touches[m->slot];
+
+	if (likely(!drvdata->sensor_pos.enable ||
+	    (type != EV_SYN && type != EV_ABS)))
+		goto end;
+
+	switch (code) {
+	case ABS_MT_SLOT:
+		m->slot = value;
+		break;
+	case ABS_MT_TRACKING_ID:
+		if (value < 0) {
+			t->x = -1;
+			t->y = -1;
+		}
+		break;
+	case ABS_MT_POSITION_X:
+		t->x = value;
+		break;
+	case ABS_MT_POSITION_Y:
+		t->y = value;
+		break;
+	case SYN_REPORT:
+		gpio_report_event(drvdata,
+			qbt1000_touch_get_state(drvdata));
+		break;
+	default:
+		break;
+	}
+
+end:
+	return;
+}
+
+static int qbt1000_touch_connect(struct input_handler *handler,
+	struct input_dev *dev, const struct input_device_id *id)
+{
+	struct input_handle *handle;
+	int error;
+
+	handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
+	if (!handle)
+		return -ENOMEM;
+
+	handle->dev = dev;
+	handle->handler = handler;
+	handle->name = "qbt1000_touch";
+
+	error = input_register_handle(handle);
+	if (error)
+		goto err_free_handle;
+
+	error = input_open_device(handle);
+	if (error)
+		goto err_unregister_handle;
+
+	pr_info("Connected device: %s (%s at %s)\n",
+	       dev_name(&dev->dev),
+	       dev->name ?: "unknown",
+	       dev->phys ?: "unknown");
+
+	return 0;
+
+ err_unregister_handle:
+	input_unregister_handle(handle);
+ err_free_handle:
+	kfree(handle);
+	return error;
+}
+
+static void qbt1000_touch_disconnect(struct input_handle *handle)
+{
+	pr_info("Disconnected device: %s\n",
+		dev_name(&handle->dev->dev));
+
+	input_close_device(handle);
+	input_unregister_handle(handle);
+	kfree(handle);
+}
+
+static const struct input_device_id qbt1000_touch_ids[] = {
+	{
+		.flags = INPUT_DEVICE_ID_MATCH_EVBIT,
+		.evbit = {BIT_MASK(EV_ABS)},
+	},
+	{},
+};
+
+MODULE_DEVICE_TABLE(input, qbt1000_touch_ids);
+
+static struct input_handler qbt1000_touch_handler = {
+	.event =        qbt1000_touch_event,
+	.connect =	qbt1000_touch_connect,
+	.disconnect =	qbt1000_touch_disconnect,
+	.name =		"qbt1000_touch",
+	.id_table =	qbt1000_touch_ids,
+};
+
 /**
  * qbt1000_open() - Function called when user space opens device.
  * Successful if driver not currently open.
@@ -589,6 +851,54 @@ static long qbt1000_ioctl(
 		}
 		break;
 	}
+	case QBT1000_SET_SENSOR_POSITION:
+	{
+		struct qbt1000_sensor_pos sensor_pos;
+
+		if (copy_from_user(&sensor_pos, priv_arg,
+					sizeof(sensor_pos)) != 0) {
+			rc = -EFAULT;
+			pr_err("failed copy from user space %d\n", rc);
+			goto end;
+		}
+
+		if (sensor_pos.enable && !drvdata->sensor_pos.enable) {
+			pr_debug("enable: %d, top: %d, bottom: %d, left %d, right: %d)",
+					sensor_pos.enable,
+					sensor_pos.top,
+					sensor_pos.bottom,
+					sensor_pos.left,
+					sensor_pos.right);
+
+			if (!drvdata->mt.is_registered) {
+				qbt1000_touch_handler.private = drvdata;
+				rc = input_register_handler(
+						&qbt1000_touch_handler);
+				drvdata->mt.is_registered = true;
+			}
+			qbt1000_touch_clear_mt_status(&drvdata->mt);
+			drvdata->fd_gpio.last_gpio_state = 0;
+			drvdata->sensor_pos.top = sensor_pos.top;
+			drvdata->sensor_pos.bottom = sensor_pos.bottom;
+			drvdata->sensor_pos.left = sensor_pos.left;
+			drvdata->sensor_pos.right = sensor_pos.right;
+			drvdata->sensor_pos.enable = sensor_pos.enable;
+		} else if (!sensor_pos.enable && drvdata->sensor_pos.enable) {
+			pr_debug("disable: %d, top: %d, bottom: %d, left %d, right: %d)",
+					sensor_pos.enable,
+					sensor_pos.top,
+					sensor_pos.bottom,
+					sensor_pos.left,
+					sensor_pos.right);
+
+			drvdata->sensor_pos.enable = sensor_pos.enable;
+			drvdata->sensor_pos.top = 0;
+			drvdata->sensor_pos.bottom = 0;
+			drvdata->sensor_pos.left = 0;
+			drvdata->sensor_pos.right = 0;
+		}
+		break;
+	}
 	default:
 		pr_err("invalid cmd %d\n", cmd);
 		rc = -ENOIOCTLCMD;
@@ -603,10 +913,11 @@ static long qbt1000_ioctl(
 static int get_events_fifo_len_locked(struct qbt1000_drvdata *drvdata)
 {
 	int len;
+	unsigned long flags;
 
-	mutex_lock(&drvdata->fw_events_mutex);
+	spin_lock_irqsave(&drvdata->fw_events_lock, flags);
 	len = kfifo_len(&drvdata->fw_events);
-	mutex_unlock(&drvdata->fw_events_mutex);
+	spin_unlock_irqrestore(&drvdata->fw_events_lock, flags);
 
 	return len;
 }
@@ -616,14 +927,14 @@ static ssize_t qbt1000_read(struct file *filp, char __user *ubuf,
 {
 	struct fw_event_desc fw_event;
 	struct qbt1000_drvdata *drvdata = filp->private_data;
+	unsigned long flags;
 
 	if (cnt < sizeof(fw_event.ev))
 		return -EINVAL;
 
-	mutex_lock(&drvdata->fw_events_mutex);
-
+	spin_lock_irqsave(&drvdata->fw_events_lock, flags);
 	while (kfifo_len(&drvdata->fw_events) == 0) {
-		mutex_unlock(&drvdata->fw_events_mutex);
+		spin_unlock_irqrestore(&drvdata->fw_events_lock, flags);
 
 		if (filp->f_flags & O_NONBLOCK)
 			return -EAGAIN;
@@ -634,17 +945,17 @@ static ssize_t qbt1000_read(struct file *filp, char __user *ubuf,
 			  (get_events_fifo_len_locked(drvdata) > 0)))
 			return -ERESTARTSYS;
 
-		mutex_lock(&drvdata->fw_events_mutex);
+		spin_lock_irqsave(&drvdata->fw_events_lock, flags);
 	}
 
 	if (!kfifo_get(&drvdata->fw_events, &fw_event)) {
-		pr_debug("fw_events fifo: unexpectedly empty\n");
+		spin_unlock_irqrestore(&drvdata->fw_events_lock, flags);
 
-		mutex_unlock(&drvdata->fw_events_mutex);
+		pr_debug("fw_events fifo: unexpectedly empty\n");
 		return -EINVAL;
 	}
 
-	mutex_unlock(&drvdata->fw_events_mutex);
+	spin_unlock_irqrestore(&drvdata->fw_events_lock, flags);
 
 	pr_debug("fw_event: %d\n", (int)fw_event.ev);
 	return copy_to_user(ubuf, &fw_event.ev, sizeof(fw_event.ev));
@@ -808,83 +1119,6 @@ static int qbt1000_create_input_device(struct qbt1000_drvdata *drvdata)
 	return rc;
 }
 
-static void purge_finger_events(struct qbt1000_drvdata *drvdata)
-{
-	int i, fifo_len;
-	struct fw_event_desc fw_event;
-
-	fifo_len = kfifo_len(&drvdata->fw_events);
-
-	for (i = 0; i < fifo_len; i++) {
-		if (!kfifo_get(&drvdata->fw_events, &fw_event))
-			pr_err("fw events fifo: could not remove oldest item\n");
-		else if (fw_event.ev != FW_EVENT_FINGER_DOWN
-					&& fw_event.ev != FW_EVENT_FINGER_UP)
-			kfifo_put(&drvdata->fw_events, fw_event);
-	}
-}
-
-static void gpio_report_event(struct qbt1000_drvdata *drvdata, int state)
-{
-	struct fw_event_desc fw_event;
-
-	if (drvdata->fd_gpio.event_reported
-		  && state == drvdata->fd_gpio.last_gpio_state)
-		return;
-
-	pr_debug("gpio %d: report state %d\n", drvdata->fd_gpio.gpio, state);
-
-	drvdata->fd_gpio.event_reported = 1;
-	drvdata->fd_gpio.last_gpio_state = state;
-
-	if (drvdata->fd_ind_mode == FD_IND_MODE_GESTURES) {
-		pr_debug("tap detected\n");
-		/*
-		 * If a gesture IPC was sent but not yet decrypted and
-		 * dealt with mark it as stale and don't report it
-		 */
-		drvdata->ipc_is_stale = true;
-		input_event(drvdata->in_dev,
-				EV_KEY, KEY_FP_GESTURE_TAP, 1);
-		input_sync(drvdata->in_dev);
-		input_event(drvdata->in_dev,
-				EV_KEY, KEY_FP_GESTURE_TAP, 0);
-		input_sync(drvdata->in_dev);
-	} else if (drvdata->fd_ind_mode == FD_IND_MODE_BIOMETRIC) {
-		if (state && drvdata->fd_gpio.power_key_enabled) {
-			input_event(drvdata->in_dev, EV_KEY, KEY_POWER, 1);
-			input_sync(drvdata->in_dev);
-			input_event(drvdata->in_dev, EV_KEY, KEY_POWER, 0);
-			input_sync(drvdata->in_dev);
-		} else if (!drvdata->gestures_enabled) {
-			input_event(drvdata->in_dev, EV_KEY,
-				drvdata->fd_gpio.key_code, !!state);
-			input_sync(drvdata->in_dev);
-		}
-		fw_event.ev = state ? FW_EVENT_FINGER_DOWN : FW_EVENT_FINGER_UP;
-
-		mutex_lock(&drvdata->fw_events_mutex);
-
-		if (kfifo_is_full(&drvdata->fw_events)) {
-			struct fw_event_desc dummy_fw_event;
-
-			pr_warn("fw events fifo: full, dropping oldest item\n");
-			if (!kfifo_get(&drvdata->fw_events, &dummy_fw_event))
-				pr_err("fw events fifo: could not remove oldest item\n");
-		}
-
-		purge_finger_events(drvdata);
-
-		if (!kfifo_put(&drvdata->fw_events, fw_event))
-			pr_err("fw events fifo: error adding item\n");
-
-		mutex_unlock(&drvdata->fw_events_mutex);
-		wake_up_interruptible(&drvdata->read_wait_queue);
-	} else {
-		pr_err("invalid mode %d\n", drvdata->fd_ind_mode);
-	}
-}
-
 static void qbt1000_gpio_report_event(struct qbt1000_drvdata *drvdata)
 {
 	int state;
@@ -893,6 +1127,7 @@ static void qbt1000_gpio_report_event(struct qbt1000_drvdata *drvdata)
 		^ drvdata->fd_gpio.active_low;
 	gpio_report_event(drvdata, state);
 }
+
 static void qbt1000_gpio_work_func(struct work_struct *work)
 {
 	struct qbt1000_drvdata *drvdata =
@@ -937,6 +1172,7 @@ static irqreturn_t qbt1000_ipc_irq_handler(int irq, void *dev_id)
 	struct qbt1000_drvdata *drvdata = (struct qbt1000_drvdata *)dev_id;
 	int rc = 0;
 	uint32_t retry_count = SEND_TZ_CMD_RETRY_CNT;
+	unsigned long flags;
 
 	pm_stay_awake(drvdata->dev);
 
@@ -1045,20 +1281,25 @@ static irqreturn_t qbt1000_ipc_irq_handler(int irq, void *dev_id)
 						g_msg_to_event[i].fw_event;
 					struct fw_event_desc fw_ev_desc;
 
-					mutex_lock(&drvdata->fw_events_mutex);
 					pr_debug("fw events: add %d\n",
 						(int) ev);
 					fw_ev_desc.ev = ev;
 
+					spin_lock_irqsave(
+						&drvdata->fw_events_lock,
+						flags);
 					purge_finger_events(drvdata);
 
 					if (!kfifo_put(&drvdata->fw_events,
-							fw_ev_desc))
+							fw_ev_desc)) {
 						pr_err("fw events: fifo full");
-						pr_err(", drop event %d\n",
-							(int) ev);
+						pr_err("drop event %d\n",
+							(int)ev);
+					}
 
-					mutex_unlock(&drvdata->fw_events_mutex);
+					spin_unlock_irqrestore(
+						&drvdata->fw_events_lock,
+						flags);
 					break;
 				}
 			}
@@ -1205,10 +1446,21 @@ static int qbt1000_read_device_tree(struct platform_device *pdev,
 	drvdata->fd_gpio.gpio = gpio;
 	drvdata->fd_gpio.active_low = flags & OF_GPIO_ACTIVE_LOW;
 
+	/*****************************************************/
+	// read QFP_Int2 gpio
+	qbt1000_int2 = of_get_named_gpio(pdev->dev.of_node,
+			"qfp-int2", 0);
+	if (qbt1000_int2 < 0) {
+		rc = qbt1000_int2;
+		pr_err("qfp-int2 gpio not found, error=%d\n", rc);
+		goto end;
+	}
+	pr_debug("get qfp-int2 success\n");
+
 end:
 	return rc;
 }
-
+bool finger_type = false;
 /**
  * qbt1000_probe() - Function loads hardware config from device tree
  * @pdev:	ptr to platform device object
@@ -1220,7 +1472,11 @@ static int qbt1000_probe(struct platform_device *pdev)
 	struct device *dev = &pdev->dev;
 	struct qbt1000_drvdata *drvdata;
 	int rc = 0;
+	const char *desc = "qbt1000_int2";
 
+	pr_info("%s:fp version %x\n", __func__, fp_version);
+	if ((fp_version != 0x06))
+		return -ENODEV;
 	pr_debug("%s begin\n", __func__);
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
@@ -1233,10 +1489,15 @@ static int qbt1000_probe(struct platform_device *pdev)
 	if (rc < 0)
 		goto end;
 
+	rc = devm_gpio_request_one(&pdev->dev, qbt1000_int2,
+		GPIOF_OUT_INIT_LOW, desc);
+	if (rc < 0)
+		goto end;
+
 	atomic_set(&drvdata->available, 1);
 
 	mutex_init(&drvdata->mutex);
-	mutex_init(&drvdata->fw_events_mutex);
+	spin_lock_init(&drvdata->fw_events_lock);
 
 	rc = qbt1000_dev_register(drvdata);
 	if (rc < 0)
@@ -1261,9 +1522,9 @@ static int qbt1000_probe(struct platform_device *pdev)
 	if (rc < 0)
 		goto end;
 
-	drvdata->fd_ind_mode = FD_IND_MODE_BIOMETRIC;
-	drvdata->ipc_is_stale = false;
-	drvdata->gestures_enabled = false;
+    finger_type = true;
+	//is_probed = true;
+	ts_cb_drvdata = drvdata;
 
 end:
 	pr_debug("%s : %d\n", __func__, rc);
@@ -1274,10 +1535,12 @@ static int qbt1000_remove(struct platform_device *pdev)
 {
 	struct qbt1000_drvdata *drvdata = platform_get_drvdata(pdev);
 
+	if (drvdata->mt.is_registered)
+		input_unregister_handler(&qbt1000_touch_handler);
+
 	input_unregister_device(drvdata->in_dev);
 
 	mutex_destroy(&drvdata->mutex);
-	mutex_destroy(&drvdata->fw_events_mutex);
 
 	device_destroy(drvdata->qbt1000_class, drvdata->qbt1000_cdev.dev);
 	class_destroy(drvdata->qbt1000_class);
@@ -1286,10 +1549,13 @@ static int qbt1000_remove(struct platform_device *pdev)
 
 	device_init_wakeup(&pdev->dev, 0);
 
+	ts_cb_drvdata = NULL;
+
 	return 0;
 }
 
-static int qbt1000_suspend(struct platform_device *pdev, pm_message_t state)
+static int qbt1000_suspend(struct platform_device *pdev,
+	pm_message_t state)
 {
 	int rc = 0;
 	struct qbt1000_drvdata *drvdata = platform_get_drvdata(pdev);
diff --git a/drivers/input/fingerprint/silead/Makefile b/drivers/input/fingerprint/silead/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..076d71b55b19db9c5cce4f1a3a710ab4dbd04917
--- /dev/null
+++ b/drivers/input/fingerprint/silead/Makefile
@@ -0,0 +1,3 @@
+ccflags-$(CONFIG_FINGERPRINT_SILEAD) += -DBSP_SIL_PLAT_QCOM
+ccflags-$(CONFIG_FINGERPRINT_SILEAD) += -DBSP_SIL_POWER_SUPPLY_REGULATOR
+obj-$(CONFIG_FINGERPRINT_SILEAD)	+= silead_fp_platform.o
\ No newline at end of file
diff --git a/drivers/input/fingerprint/silead/silead_fp.h b/drivers/input/fingerprint/silead/silead_fp.h
new file mode 100755
index 0000000000000000000000000000000000000000..402f03556d5fd7d950a8c4778d452be5d7dee73e
--- /dev/null
+++ b/drivers/input/fingerprint/silead/silead_fp.h
@@ -0,0 +1,240 @@
+/*
+ * @file   silead_fp.h
+ * @brief  Contains silead_fp device head file.
+ *
+ *
+ * Copyright 2016-2018 Slead Inc.
+ *
+ * The code contained herein is licensed under the GNU General Public
+ * License. You may obtain a copy of the GNU General Public License
+ * Version 2 or later at the following locations:
+ *
+ * http://www.opensource.org/licenses/gpl-license.html
+ * http://www.gnu.org/copyleft/gpl.html
+ *
+ * ------------------- Revision History ------------------------------
+ * <author>    <date>   <version>     <desc>
+ * Bill Yu    2018/5/2    0.1.0      Init version
+ * Bill Yu    2018/5/28   0.1.1      Disable netlink if netlink id = 0
+ * Bill Yu    2018/6/1    0.1.2      Support wakelock
+ * Bill Yu    2018/6/5    0.1.3      Support chip enter power down
+ * Bill Yu    2018/6/7    0.1.4      Support create proc node
+ *
+ */
+
+#ifndef __SILEAD_FP_H__
+#define __SILEAD_FP_H__
+
+#ifndef _LINUX_WAKELOCK_H
+enum {
+    WAKE_LOCK_SUSPEND, /* Prevent suspend */
+    WAKE_LOCK_TYPE_COUNT
+};
+
+struct wake_lock {
+    struct wakeup_source ws;
+};
+
+static inline void wake_lock_init(struct wake_lock *lock, int type,
+                                  const char *name)
+{
+    wakeup_source_init(&lock->ws, name);
+}
+
+static inline void wake_lock_destroy(struct wake_lock *lock)
+{
+    wakeup_source_trash(&lock->ws);
+}
+
+static inline void wake_lock(struct wake_lock *lock)
+{
+    __pm_stay_awake(&lock->ws);
+}
+
+static inline void wake_lock_timeout(struct wake_lock *lock, long timeout)
+{
+    __pm_wakeup_event(&lock->ws, jiffies_to_msecs(timeout));
+}
+
+static inline void wake_unlock(struct wake_lock *lock)
+{
+    __pm_relax(&lock->ws);
+}
+#endif /* _LINUX_WAKELOCK_H */
+
+enum _pwdn_mode_t {
+	SIFP_PWDN_NONE = 0,
+	SIFP_PWDN_POWEROFF = 1, /* shutdown the avdd power supply */
+	SIFP_PWDN_FLASH = 2, /* shutdown avdd 200ms for H/W full reset */
+	SIFP_PWDN_MAX,
+};
+enum _netlink_cmd_t {
+	SIFP_NETLINK_START = 0,
+	SIFP_NETLINK_IRQ = 1,
+	SIFP_NETLINK_SCR_OFF,
+	SIFP_NETLINK_SCR_ON,
+	SIFP_NETLINK_CONNECT,
+	SIFP_NETLINK_DISCONNECT,
+	SIFP_NETLINK_UI_READY,
+	SIFP_NETLINK_TP_TOUCHDOWN,
+	SIFP_NETLINK_TP_TOUCHUP,
+	SIFP_NETLINK_MAX,
+};
+
+enum _fp_nav_key_v_t {
+    NAV_KEY_UNKNOWN = 0,
+    NAV_KEY_START = 1,
+    NAV_KEY_UP = NAV_KEY_START,
+    NAV_KEY_DOWN,
+    NAV_KEY_RIGHT,
+    NAV_KEY_LEFT,
+    NAV_KEY_CLICK,
+    NAV_KEY_DCLICK,
+    NAV_KEY_LONGPRESS,
+    NAV_KEY_CLICK_DOWN,
+    NAV_KEY_CLICK_UP,
+    NAV_KEY_MAX,
+    NAV_KEY_WAITMORE = 1000,
+};
+
+#define IS_KEY_VALID(k) ((k) > NAV_KEY_UNKNOWN && (k) < NAV_KEY_MAX)
+
+enum _fp_nav_key_f_t {
+	NAV_KEY_FLAG_UP = 0,
+	NAV_KEY_FLAG_DOWN,
+	NAV_KEY_FLAG_CLICK,
+};
+
+struct fp_dev_key_t {
+	int value;
+	uint32_t flag;   /* key down = 1, key up = 0, key down+up = 2 */
+};
+
+#define DEVNAME_LEN  16
+struct fp_dev_init_t {
+	uint8_t mode;
+	uint8_t bits;
+	uint16_t delay;
+	uint32_t speed;
+	char dev[DEVNAME_LEN];
+	uint8_t nl_id;
+	uint8_t dev_id;
+	uint16_t reserve;
+	uint32_t reg;
+	char ta[DEVNAME_LEN];
+};
+
+struct fp_underscreen_info {
+    uint8_t touch_state;
+    uint8_t area_rate;
+    uint16_t x;
+    uint16_t y;
+};
+
+struct fp_dev_debug_t {
+	uint8_t cmd[4];
+};
+
+struct fp_dev_kmap_t {
+	uint16_t k[NAV_KEY_MAX-NAV_KEY_START];  /* Up/Down/Right/Left/Click/Double Click/Longpress */
+};
+
+#define PROC_VND_ID_LEN   32
+
+#define SIFP_IOC_MAGIC	's'
+
+#define SIFP_IOC_RESET        _IOW(SIFP_IOC_MAGIC, 10, u8)
+
+#define SIFP_IOC_ENABLE_IRQ   _IO(SIFP_IOC_MAGIC,  11)
+#define SIFP_IOC_DISABLE_IRQ  _IO(SIFP_IOC_MAGIC,  12)
+#define SIFP_IOC_WAIT_IRQ     _IOR(SIFP_IOC_MAGIC, 13, u8)
+#define SIFP_IOC_CLR_IRQ      _IO(SIFP_IOC_MAGIC,  14)
+//#define SPFP_IOC_EXIT       _IOR(SIFP_IOC_MAGIC, 1, u8)
+
+#define SIFP_IOC_KEY_EVENT    _IOW(SIFP_IOC_MAGIC, 15, struct fp_dev_key_t)
+#define SIFP_IOC_INIT         _IOR(SIFP_IOC_MAGIC, 16, struct fp_dev_init_t)
+#define SIFP_IOC_DEINIT       _IO(SIFP_IOC_MAGIC,  17)
+#define SIFP_IOC_IRQ_STATUS   _IOR(SIFP_IOC_MAGIC, 18, u8)
+#define SIFP_IOC_DEBUG        _IOR(SIFP_IOC_MAGIC, 19, struct fp_dev_debug_t)
+#define SIFP_IOC_SCR_STATUS   _IOR(SIFP_IOC_MAGIC, 20, u8)
+#define SIFP_IOC_GET_VER      _IOR(SIFP_IOC_MAGIC, 21, char[10])
+#define SIFP_IOC_SET_KMAP     _IOW(SIFP_IOC_MAGIC, 22, uint16_t[7])
+#define SIFP_IOC_ACQ_SPI      _IO(SIFP_IOC_MAGIC,  23)
+#define SIFP_IOC_RLS_SPI      _IO(SIFP_IOC_MAGIC,  24)
+#define SIFP_IOC_PKG_SIZE     _IOR(SIFP_IOC_MAGIC, 25, u8)
+#define SIFP_IOC_DBG_LEVEL    _IOWR(SIFP_IOC_MAGIC,26, u8)
+#define SIFP_IOC_WAKELOCK     _IOW(SIFP_IOC_MAGIC, 27, u8)
+#define SIFP_IOC_PWDN         _IOW(SIFP_IOC_MAGIC,  28, u8)
+#define SIFP_IOC_PROC_NODE    _IOW(SIFP_IOC_MAGIC, 29, char[PROC_VND_ID_LEN])
+#define SIFP_IOC_GET_TP_TOUCH_INFO          _IOR(SIFP_IOC_MAGIC, 30, struct fp_underscreen_info)
+#define SIFP_IOC_SET_TP_MSG_REPORT_MODE          _IOW(SIFP_IOC_MAGIC, 31, u8)
+
+#define SIFP_IOC_REPORT_KEY          _IOW(SIFP_IOC_MAGIC, 32, uint8_t)
+
+#define RESET_TIME            1	/* Default chip reset wait time(ms) */
+#define RESET_TIME_MULTIPLE   1 /* Multiple for reset time multiple*wait_time */
+#define SIFP_NETLINK_ROUTE    30
+#define NL_MSG_LEN            16
+
+//#define PROC_DIR		"fp"      /* if defined, create node under /proc/fp/xxx */
+//#define PROC_NODE		"fp_id"   /* proc node name */ //remove by chenran
+
+#if (SIFP_NETLINK_ROUTE > 0)
+    #define BSP_SIL_NETLINK
+#endif
+
+#if !defined(BSP_SIL_PLAT_MTK) && !defined(BSP_SIL_PLAT_QCOM)
+  #define BSP_SIL_PLAT_COMM
+#endif /* ! BSP_SIL_PLAT_MTK & ! BSP_SIL_PLAT_QCOM */
+
+/* Todo: enable correct power supply mode */
+#if !defined(BSP_SIL_POWER_SUPPLY_REGULATOR)
+//#define BSP_SIL_POWER_SUPPLY_REGULATOR
+//#define BSP_SIL_POWER_SUPPLY_PINCTRL
+#define BSP_SIL_POWER_SUPPLY_GPIO
+#endif
+
+/* AVDD voltage range 2.8v ~ 3.3v */
+#define AVDD_MAX  3000000
+#define AVDD_MIN  3000000
+
+/* VDDIO voltage range 1.8v ~ AVDD */
+#define VDDIO_MAX 1800000
+#define VDDIO_MIN 1800000
+
+#define CURRENT 50000
+
+#if defined(BSP_SIL_POWER_SUPPLY_REGULATOR) && defined(BSP_SIL_POWER_SUPPLY_PINCTRL) || defined(BSP_SIL_POWER_SUPPLY_REGULATOR) && defined(BSP_SIL_POWER_SUPPLY_GPIO) || defined(BSP_SIL_POWER_SUPPLY_GPIO) && defined(BSP_SIL_POWER_SUPPLY_PINCTRL)
+  #error "Don't define multiple power supply mode!"
+#endif
+
+#ifdef BSP_SIL_PLAT_MTK
+  #include "silead_fp_mtk.h"
+  #define PLAT_H "silead_fp_mtk.c"
+
+  #define DEVICE "/dev/spidev1.0"
+  //#define BSP_SIL_IRQ_CONFIRM
+  #define PKG_SIZE 1
+#elif defined(BSP_SIL_PLAT_QCOM)
+  #define QSEE_V4  /* Enable it if QSEE v4 or higher */
+  #include "silead_fp_qcom.h"
+  #define PLAT_H "silead_fp_qcom.c"
+
+  #define DEVICE "/dev/spidev0.0"
+  #define BSP_SIL_IRQ_CONFIRM
+  #define PKG_SIZE 4
+  #define TANAME "sileadta"
+#else
+  #include "silead_fp_comm.h"
+  #define PLAT_H "silead_fp_comm.c"
+
+  #define DEVICE "/dev/spidev0.0"
+  #define BSP_SIL_IRQ_CONFIRM
+  #define PKG_SIZE 4
+  #define TANAME ""
+#endif /* BSP_SIL_PLAT_XXX */
+
+extern int opticalfp_irq_handler(struct fp_underscreen_info* tp_info);
+#endif /* __SILEAD_FP_H__ */
+
+/* End of file silead_fp.h */
diff --git a/drivers/input/fingerprint/silead/silead_fp_platform.c b/drivers/input/fingerprint/silead/silead_fp_platform.c
new file mode 100755
index 0000000000000000000000000000000000000000..3d8d2c4d060e34c9b144a34f5b72a0ad9bcba23f
--- /dev/null
+++ b/drivers/input/fingerprint/silead/silead_fp_platform.c
@@ -0,0 +1,1555 @@
+/************************************************************************************
+ * @file   silead_fp_platform.c
+ * @brief  Contains silead_fp device implementation.
+ *
+ *
+ * Copyright 2016-2018 Slead Inc.
+ *
+ * The code contained herein is licensed under the GNU General Public
+ * License. You may obtain a copy of the GNU General Public License
+ * Version 2 or later at the following locations:
+ *
+ * http://www.opensource.org/licenses/gpl-license.html
+ * http://www.gnu.org/copyleft/gpl.html
+ *
+ * ------------------- Revision History ------------------------------
+ * <author>    <date>   <version>     <desc>
+ * Bill Yu    2018/4/2    0.1.6      Init version
+ * Bill Yu    2018/5/2    0.1.7      Fix compile error for some platform
+ * Bill Yu    2018/5/20   0.1.8      Default wait 3ms after reset
+ * Bill Yu    2018/5/28   0.1.9      Support poll/read if netlink id = 0
+ * Bill Yu    2018/6/1    0.2.0      Support wakelock
+ * Bill Yu    2018/6/5    0.2.1      Support chip enter power down
+ * Bill Yu    2018/6/7    0.2.2      Support create proc node
+ *
+ *             2018/06/24                  add fix for coverity 63621 63600 
+ *             2018/06/26                  add silead power_on and power_offf for deep_sleep
+ *             2018/06/30                  add for modify kernel warning (power on)
+ *             2018/07/07                  add for tp irq and lcd notify
+ *             2018/07/21                  add for get tp info
+ ***********************************************************************************/
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/ioctl.h>
+#include <linux/fs.h>
+#include <linux/device.h>
+#include <linux/err.h>
+#include <linux/list.h>
+#include <linux/errno.h>
+#include <linux/mutex.h>
+#include <linux/slab.h>
+#include <linux/compat.h>
+#include <linux/of.h>
+#include <linux/of_device.h>
+#include <linux/of_gpio.h>
+#include <linux/of_platform.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/regulator/consumer.h>
+#include <linux/gpio.h>
+#include <linux/input.h>
+#include <linux/netlink.h>
+#include <linux/cdev.h>
+#include <linux/version.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+
+#include <net/sock.h>
+#include <linux/uaccess.h>
+
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+
+#include <linux/delay.h>
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0))
+#include <linux/wakelock.h>
+#endif
+#include <linux/fb.h>
+#ifdef CONFIG_HAS_EARLYSUSPEND
+#include <linux/earlysuspend.h>
+#else
+#include <linux/notifier.h>
+#endif
+
+#include "silead_fp.h"
+#include <linux/msm_drm_notify.h>
+#include <linux/oneplus/boot_mode.h>
+#include "../fingerprint_detect/fingerprint_detect.h"
+#include "../../../gpu/drm/msm/sde/sde_trace.h"
+
+#define FP_DEV_NAME "silead_fp"
+#define FP_DEV_MAJOR 0	/* assigned */
+
+#define FP_CLASS_NAME "silead_fp"
+#define FP_INPUT_NAME "fp-keys"
+
+#define FP_DEV_VERSION "v0.2.3"
+#define LOG_TAG "[+silead_fp-] "
+
+#define BSP_SIL_IRQ_ASYNC  /* IRQ use asynchrous mode. */
+static struct silfp_data *optical_fp;
+static struct fp_underscreen_info fp_tpinfo;
+static unsigned int lasttouchmode = 0;
+
+#ifndef BSP_SIL_NETLINK
+struct silfp_msg_list {
+    unsigned char msg;
+    struct list_head list;
+};
+#endif /* !BSP_SIL_NETLINK */
+
+struct silfp_data {
+    dev_t			devt;
+    struct cdev cdev;
+    spinlock_t  spi_lock;
+    struct platform_device	*spi;
+    struct list_head  device_entry;
+
+    unsigned		users;
+
+    struct device *dev;
+    int ref;
+
+    struct input_dev *input;
+
+    spinlock_t		irq_lock;
+    int		int_port;
+    int		irq;
+    s32 irq_is_disable;
+    int   irq_ignore;
+    s32 power_is_off;
+    int		rst_port;
+    struct work_struct  work;
+    struct completion done;
+    struct wake_lock wakelock;
+    struct wake_lock wakelock_hal;
+
+#ifdef BSP_SIL_NETLINK
+    /* for netlink use */
+    struct sock *nl_sk;
+#else
+    spinlock_t  read_lock;
+    wait_queue_head_t read_queue;
+    struct list_head msg_q;
+#endif
+    struct fp_dev_kmap_t keymap_cust;
+
+    int scr_off;
+#ifdef CONFIG_HAS_EARLYSUSPEND
+    struct early_suspend es;
+#else
+	struct notifier_block msm_drm_notif;
+#endif /* CONFIG_HAS_EARLYSUSPEND */
+
+    /* for power supply */
+#ifdef BSP_SIL_POWER_SUPPLY_REGULATOR
+    struct regulator *avdd_ldo;
+    struct regulator *vddio_ldo;
+#endif /* BSP_SIL_POWER_SUPPLY_REGULATOR */
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    int avdd_port;
+    int vddio_port;
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+#ifdef PROC_NODE
+    struct proc_dir_entry *proc_root;
+    struct proc_dir_entry *proc_entry;
+#endif /* PROC_NODE */
+
+    /* for spi enable/disable */
+    atomic_t  spionoff_count;
+
+    struct fp_plat_t pin;
+
+    atomic_t  init;
+	struct pinctrl *sl_pinctrl;
+	struct pinctrl_state *gpio_state_enable;
+};
+
+typedef enum _fp_spi_speet_t {
+    SPEED_1M=1*1000*1000,
+    SPEED_LOW = SPEED_1M,
+    SPEED_5M=5*1000*1000,
+    SPEED_MEDIUM = SPEED_5M,
+    SPEED_8M=8*1000*1000,
+    SPEED_9M=9*1000*1000,
+    SPEED_HIGH=SPEED_8M,
+    SPEED_10M=10*1000*1000,
+} fp_spi_speet_t ;
+
+static struct fp_dev_init_t silfp_dev_init_d = {
+    .mode = 0,
+    .bits = 8,
+    .speed = SPEED_HIGH,
+    .delay = 100,
+    .dev = DEVICE,
+    .nl_id = SIFP_NETLINK_ROUTE,
+    .dev_id = 0,
+};
+
+/* on some platform, home key has been redefine to KEY_HOMEPAGE! */
+/* double check the define on customer board!!!
+   out/target/product/.../system/usr/keylayout/Generic.kl
+   kernel/include/uapi/linux/input.h
+
+	KEY_HOMEPAGE
+	KEY_HOME
+	KEY_MENU
+	KEY_BACK
+	KEY_POWER
+	KEY_CAMERA
+	KEY_VOLUMEUP
+	KEY_VOLUMEDOWN */
+
+typedef struct _key_map {
+    int key_orig;
+    int key_new;
+} nav_keymap_t;
+
+static nav_keymap_t keymap[] = {
+    { NAV_KEY_UP,       KEY_UP,         }, /* KEY_RESERVED, ignore this key */
+    { NAV_KEY_DOWN,     KEY_DOWN,       },
+    { NAV_KEY_RIGHT,    KEY_RIGHT,      },
+    { NAV_KEY_LEFT,     KEY_LEFT,       },
+    { NAV_KEY_CLICK,    KEY_HOMEPAGE,   },
+    { NAV_KEY_DCLICK,   KEY_HOMEPAGE,   },
+    { NAV_KEY_LONGPRESS,KEY_HOMEPAGE,   },
+};
+
+static LIST_HEAD(device_list);
+static DEFINE_MUTEX(device_list_lock);
+
+#ifdef BSP_SIL_NETLINK
+static int pid;
+#endif /* BSP_SIL_NETLINK */
+
+#ifdef PROC_NODE
+static char vendor_name[PROC_VND_ID_LEN];
+#endif /* PROC_NODE */
+
+
+struct class *silfp_class;
+
+static struct workqueue_struct *silfp_wq;
+
+static void silfp_hw_reset(struct silfp_data *fp_dev, u8 delay);
+static void silfp_irq_disable(struct silfp_data *fp_dev);
+static void silfp_irq_enable(struct silfp_data *fp_dev);
+static int silfp_wait_irq(struct silfp_data *fp_dev);
+static int silfp_irq_status(struct silfp_data *fp_dev);
+static int silfp_resource_init(struct silfp_data *fp_dev, struct fp_dev_init_t *dev_info);
+static int silfp_resource_deinit(struct silfp_data *fp_dev);
+static void silfp_power_deinit(struct silfp_data *fp_dev);
+static void silfp_pwdn(struct silfp_data *fp_dev, u8 flag_avdd);
+static void silfp_hw_poweron(struct silfp_data *fp_dev);
+
+/* -------------------------------------------------------------------- */
+/*                            debug settings                            */
+/* -------------------------------------------------------------------- */
+typedef enum {
+    ERR_LOG=0,
+    DBG_LOG,
+    INFO_LOG,
+    ALL_LOG,
+} fp_debug_level_t;
+
+/* debug log level */
+static fp_debug_level_t debug_level = DBG_LOG;
+
+#define LOG_MSG_DEBUG(level, fmt, args...) do { \
+			if (debug_level >= level) {\
+				pr_warn(LOG_TAG fmt, ##args); \
+			} \
+		} while (0)
+
+#include PLAT_H
+
+/* -------------------------------------------------------------------- */
+/*                            netlink functions                         */
+/* -------------------------------------------------------------------- */
+#ifdef BSP_SIL_NETLINK
+static void silfp_netlink_send(struct silfp_data *fp_dev, const int cmd)
+{
+    struct nlmsghdr *nlh = NULL;
+    struct sk_buff *skb = NULL;
+    int ret;
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] send cmd %d\n", __func__, cmd);
+    if ( !fp_dev->nl_sk) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] invalid socket\n", __func__);
+        return;
+    }
+
+    if (! pid) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] invalid PID\n", __func__);
+        return;
+    }
+
+    /*alloc data buffer for sending to native*/
+    /*malloc data space at least 1500 bytes, which is ethernet data length*/
+    skb = alloc_skb(NL_MSG_LEN, GFP_ATOMIC);
+    if (skb == NULL) {
+        return;
+    }
+
+    nlh = nlmsg_put(skb, 0, 0, 0, NL_MSG_LEN, 0);
+    if (!nlh) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] nlmsg_put() failed\n", __func__);
+        kfree_skb(skb);
+        return;
+    }
+
+    NETLINK_CB(skb).portid = 0;
+    NETLINK_CB(skb).dst_group = 0;
+
+    *(char *)NLMSG_DATA(nlh) = cmd;
+    ret = netlink_unicast(fp_dev->nl_sk, skb, pid, MSG_DONTWAIT);
+    if (ret == 0) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] send failed\n", __func__);
+        kfree_skb(skb);
+        return;
+    }
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] sent, len=%d\n", __func__, ret);
+}
+
+static void silfp_netlink_recv(struct sk_buff *__skb)
+{
+    struct sk_buff *skb = NULL;
+    struct nlmsghdr *nlh = NULL;
+    char str[128];
+
+    skb = skb_get(__skb);
+    if (!skb ) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] skb NULL\n", __func__);
+        return;
+    }
+
+    /* presume there is 5byte payload at leaset */
+    if (skb->len >= NLMSG_SPACE(0)) {
+        nlh = nlmsg_hdr(skb);
+        memcpy(str, NLMSG_DATA(nlh), sizeof(str));
+        pid = nlh->nlmsg_pid;
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] PID=%d, msg=%s\n", __func__, pid, str);
+    } else {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] data len incorrect\n", __func__);
+    }
+
+    kfree_skb(skb);
+}
+
+static int silfp_netlink_init(struct silfp_data *fp_dev)
+{
+    struct netlink_kernel_cfg cfg;
+
+    memset(&cfg, 0, sizeof(struct netlink_kernel_cfg));
+    cfg.input = silfp_netlink_recv;
+
+    fp_dev->nl_sk = netlink_kernel_create(&init_net, SIFP_NETLINK_ROUTE, &cfg);
+    if (fp_dev->nl_sk == NULL) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] netlink create failed\n", __func__);
+        return -1;
+    }
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] netlink create success\n", __func__);
+    return 0;
+}
+
+static int silfp_netlink_destroy(struct silfp_data *fp_dev)
+{
+    if (fp_dev->nl_sk != NULL) {
+        netlink_kernel_release(fp_dev->nl_sk);
+        fp_dev->nl_sk = NULL;
+        return 0;
+    }
+
+    LOG_MSG_DEBUG(ERR_LOG, "[%s] no netlink socket\n", __func__);
+    return -1;
+}
+#else
+static void silfp_netlink_send(struct silfp_data *fp_dev, const int cmd)
+{
+    unsigned long flags;
+    struct silfp_msg_list *list;
+
+    list = kzalloc(sizeof(*list), GFP_ATOMIC);
+    if (!list) {
+        return;
+    }
+
+    list->msg = (unsigned char)cmd;
+
+    LOG_MSG_DEBUG(INFO_LOG, "silfp_poll cmd %d\n", cmd);
+    spin_lock_irqsave(&fp_dev->read_lock, flags);
+    list_add_tail(&list->list, &fp_dev->msg_q);
+    spin_unlock_irqrestore(&fp_dev->read_lock, flags);
+
+    wake_up_interruptible(&fp_dev->read_queue);
+}
+
+static int silfp_netlink_init(struct silfp_data *fp_dev)
+{
+    spin_lock_init(&fp_dev->read_lock);
+    init_waitqueue_head(&fp_dev->read_queue);
+    INIT_LIST_HEAD(&fp_dev->msg_q);
+
+    return 0;
+}
+
+static int silfp_netlink_destroy(struct silfp_data *fp_dev)
+{
+    struct silfp_msg_list *list, *next;
+    unsigned long flags;
+
+    if (fp_dev && (&fp_dev->msg_q)) {
+        spin_lock_irqsave(&fp_dev->read_lock, flags);
+        list_for_each_entry_safe(list, next, &fp_dev->msg_q, list) {
+            list_del(&list->list);
+            kfree(list);
+        }
+        spin_unlock_irqrestore(&fp_dev->read_lock, flags);
+    }
+    return 0;
+}
+
+static unsigned int silfp_poll(struct file *fd, poll_table *wait)
+{
+    struct silfp_data *fp_dev;
+    unsigned int  mask = 0;
+
+    if (!fd) {
+        return -EINVAL;
+    }
+
+    fp_dev = fd->private_data;
+    poll_wait(fd, &fp_dev->read_queue, wait);
+
+    if(!list_empty(&fp_dev->msg_q)) {
+        mask |= POLLIN | POLLRDNORM;
+    }
+
+    return mask;
+}
+
+static ssize_t silfp_read(struct file *fd, char __user *buf, size_t len,loff_t *ptr)
+{
+    struct silfp_data *fp_dev;
+    struct silfp_msg_list *list;
+    unsigned long flags;
+    int32_t msglen = sizeof(char);
+
+    if (!fd || !buf || (len < msglen)) {
+        return -EINVAL;
+    }
+
+    fp_dev = fd->private_data;
+    if (!&fp_dev->msg_q) {
+        return -EINVAL;
+    }
+
+    spin_lock_irqsave(&fp_dev->read_lock, flags);
+    while(list_empty(&fp_dev->msg_q)) {
+        spin_unlock_irqrestore(&fp_dev->read_lock, flags);
+        if (wait_event_interruptible(fp_dev->read_queue, !list_empty(&fp_dev->msg_q))) {
+            return -EINVAL;
+        }
+        spin_lock_irqsave(&fp_dev->read_lock, flags);
+    }
+    /* pick the first one */
+    list = list_first_entry(&fp_dev->msg_q,
+                            struct silfp_msg_list, list);
+    spin_unlock_irqrestore(&fp_dev->read_lock, flags);
+
+    if (!list) {
+        return -EFAULT;
+    }
+
+    if (copy_to_user(buf, &list->msg, msglen)) {
+        LOG_MSG_DEBUG(ERR_LOG, "copy_to fail\n");
+        msglen = -EFAULT;
+    } else {
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] %d\n", __func__, list->msg);
+    }
+    spin_lock_irqsave(&fp_dev->read_lock, flags);
+    list_del(&list->list);
+    kfree(list);
+    spin_unlock_irqrestore(&fp_dev->read_lock, flags);
+
+    return msglen;
+}
+#endif /* BSP_SIL_NETLINK */
+
+/*liuyan 2017/12/7 add for detect screen state*/
+static ssize_t screen_state_get(struct device *device,
+			     struct device_attribute *attribute,
+			     char *buffer)
+{
+	struct silfp_data *fp_dev = dev_get_drvdata(device);
+
+	return scnprintf(buffer, PAGE_SIZE, "%i\n", !fp_dev->scr_off);
+}
+
+static DEVICE_ATTR(screen_state, 0400, screen_state_get, NULL);
+
+static struct attribute *sl_attributes[] = {
+	&dev_attr_screen_state.attr,
+	NULL
+};
+
+static const struct attribute_group sl_attribute_group = {
+	.attrs = sl_attributes,
+};
+
+
+#ifdef CONFIG_HAS_EARLYSUSPEND
+static void silfp_early_suspend(struct early_suspend *es)
+{
+    struct silfp_data *fp_dev = container_of(es, struct silfp_data, es);
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter\n", __func__);
+    fp_dev->scr_off = 1;
+    silfp_netlink_send(fp_dev, SIFP_NETLINK_SCR_OFF);
+}
+
+static void silfp_late_resume(struct early_suspend *es)
+{
+    struct silfp_data *fp_dev = container_of(es, struct silfp_data, es);
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter\n", __func__);
+    fp_dev->scr_off = 0;
+    silfp_netlink_send(fp_dev, SIFP_NETLINK_SCR_ON);
+}
+#else
+static int silfp_fb_callback(struct notifier_block *notif,
+                             unsigned long event, void *data)
+{
+    struct silfp_data *fp_dev = container_of(notif, struct silfp_data, msm_drm_notif);
+    struct msm_drm_notifier *evdata = data;
+    unsigned int blank;
+    int retval = 0;
+
+    /* If we aren't interested in this event, skip it immediately ... */
+	if (event == MSM_DRM_EARLY_EVENT_BLANK || event == MSM_DRM_ONSCREENFINGERPRINT_EVENT){
+	
+
+	if (evdata->id != MSM_DRM_PRIMARY_DISPLAY)
+	   return 0;
+
+
+
+
+    blank = *(int *)evdata->data;
+	//printk(KERN_ERR"GZM FP1 blank = %d\n",blank);
+	//printk(KERN_ERR"GZM FP1 event = %ld\n",event);
+	//printk(KERN_ERR"GZM FP1 evdata->id = %d\n",evdata->id);
+
+    if (event == MSM_DRM_ONSCREENFINGERPRINT_EVENT ) {
+		LOG_MSG_DEBUG(INFO_LOG, "[%s] UI ready enter\n", __func__);
+	//printk(KERN_ERR"GZM FP2 blank =%d\n",blank);	
+
+		switch (blank) {
+		case 0:
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] UI disappear\n", __func__);
+			//printk(KERN_ERR"GZM FP3\n");
+            //silfp_netlink_send(fp_dev, SIFP_NETLINK_UI_OFF);//SIFP_NETLINK_UI_OFF donothing now
+            break;
+		case 1:
+			//printk(KERN_ERR"GZM FP4\n");
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] UI ready \n", __func__);
+            SDE_ATRACE_BEGIN("fb_ui_ready");
+            silfp_netlink_send(fp_dev, SIFP_NETLINK_UI_READY);
+            SDE_ATRACE_END("fb_ui_ready");
+            break;
+		default:
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] Unknown MSM_DRM_ONSCREENFINGERPRINT_EVENT\n", __func__);
+            break;
+		}
+		return retval;
+    }
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter, blank=0x%x\n", __func__, blank);
+
+    switch (blank) {
+    case MSM_DRM_BLANK_UNBLANK:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] LCD ON\n", __func__);
+        fp_dev->scr_off = 0;
+        silfp_netlink_send(fp_dev, SIFP_NETLINK_SCR_ON);
+               sysfs_notify(&fp_dev->spi->dev.kobj,
+                               NULL, dev_attr_screen_state.attr.name);
+        break;
+
+    case MSM_DRM_BLANK_POWERDOWN:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] LCD OFF\n", __func__);
+        fp_dev->scr_off = 1;
+        silfp_netlink_send(fp_dev, SIFP_NETLINK_SCR_OFF);
+               sysfs_notify(&fp_dev->spi->dev.kobj,
+                               NULL, dev_attr_screen_state.attr.name);
+        break;
+
+    default:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] Unknown notifier\n", __func__);
+        break;
+    }
+    return retval;
+       }
+       else
+               return 0;
+}
+#endif /* CONFIG_HAS_EARLYSUSPEND */
+
+/* -------------------------------------------------------------------- */
+/*                            IRQ related functions                     */
+/* -------------------------------------------------------------------- */
+static void silfp_irq_disable(struct silfp_data *fp_dev)
+{
+    unsigned long irqflags;
+
+    spin_lock_irqsave(&fp_dev->irq_lock, irqflags);
+    if (!fp_dev->irq_is_disable) {
+        fp_dev->irq_is_disable = 1;
+        disable_irq_nosync(fp_dev->irq);
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] irq disabled\n", __func__);
+    }
+    spin_unlock_irqrestore(&fp_dev->irq_lock, irqflags);
+}
+
+static void silfp_irq_enable(struct silfp_data *fp_dev)
+{
+    unsigned long irqflags = 0;
+
+    spin_lock_irqsave(&fp_dev->irq_lock, irqflags);
+    if (fp_dev->irq_is_disable) {
+        enable_irq(fp_dev->irq);
+        fp_dev->irq_is_disable = 0;
+        reinit_completion(&fp_dev->done);
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] irq enabled\n", __func__);
+    }
+    spin_unlock_irqrestore(&fp_dev->irq_lock, irqflags);
+}
+
+static int silfp_wait_irq(struct silfp_data *fp_dev)
+{
+    // this function is obsolete, for test purpose only.
+    wait_for_completion(&fp_dev->done);
+    //return wait_for_completion_timeout(&fp_dev->done, msecs_to_jiffies(3000));
+    return 1;
+}
+
+static int silfp_irq_status(struct silfp_data *fp_dev)
+{
+    // this function is obsolete, for test purpose only.
+    if (fp_dev->int_port) {
+        return gpio_get_value(fp_dev->int_port);
+    }
+    return -1;
+}
+
+static irqreturn_t silfp_irq_handler(int irq, void *dev_id)
+{
+    struct silfp_data *fp_dev = (struct silfp_data *)dev_id;
+
+    if (fp_dev->irq_ignore) {
+        return IRQ_HANDLED;
+    }
+
+#ifdef BSP_SIL_IRQ_CONFIRM
+    if (gpio_get_value(fp_dev->int_port)) {
+#else
+    if (true) {
+#endif /* BSP_SIL_IRQ_CONFIRM */
+        wake_lock_timeout(&fp_dev->wakelock, 10*HZ); /* set a little long for a poor MCU */
+#ifdef BSP_SIL_IRQ_ASYNC
+        queue_work(silfp_wq, &fp_dev->work);
+#else
+        silfp_netlink_send(fp_dev, SIFP_NETLINK_IRQ);
+#endif /* BSP_SIL_IRQ_ASYNC */
+        complete(&fp_dev->done);
+    } else {
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] irq ignore\n", __func__);
+    }
+
+    return IRQ_HANDLED;
+}
+
+int opticalfp_irq_handler(struct fp_underscreen_info* tp_info)
+{
+
+   // wake_lock_timeout(&fp_dev->wakelock, 10*HZ); /* set a little long for a poor MCU */
+
+    //silfp_netlink_send(fp_dev, SIFP_NETLINK_IRQ);
+    //static unsigned int lasttouchmode = 0;
+
+    if (optical_fp == NULL)
+    	return 0;
+    fp_tpinfo = *tp_info;
+    LOG_MSG_DEBUG(INFO_LOG, "fp_tpinfo %d, %d, %d, %d \n" ,
+    fp_tpinfo.touch_state, fp_tpinfo.area_rate, fp_tpinfo.x, fp_tpinfo.y);
+
+    //complete(&fp_dev->done);
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] touchmode = %d, lasttouchmode =%d \n", __func__, tp_info->touch_state, lasttouchmode);
+    if(tp_info->touch_state== lasttouchmode){
+        return 0;
+    }
+    if(1 == tp_info->touch_state){
+        silfp_netlink_send(optical_fp, SIFP_NETLINK_TP_TOUCHDOWN);
+        lasttouchmode = tp_info->touch_state;
+    }else{
+        silfp_netlink_send(optical_fp, SIFP_NETLINK_TP_TOUCHUP);
+        lasttouchmode = tp_info->touch_state;
+    }
+
+    wake_lock_timeout(&optical_fp->wakelock, 10*HZ);
+
+    return 0;
+}
+
+EXPORT_SYMBOL(opticalfp_irq_handler);
+
+static void silfp_work_func(struct work_struct *work)
+{
+    struct silfp_data *fp_dev = container_of(work, struct silfp_data, work);
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] running\n", __func__);
+    silfp_netlink_send(fp_dev, SIFP_NETLINK_IRQ);
+}
+
+/* -------------------------------------------------------------------- */
+/*                          key event functions                         */
+/* -------------------------------------------------------------------- */
+static int silfp_keyevent(struct silfp_data	*fp_dev, struct fp_dev_key_t *pkey)
+{
+    int ret = -EFAULT;
+    int i;
+
+    //LOG_MSG_DEBUG(INFO_LOG, "[%s] key %d, flag %d\n", __func__,pkey->value,pkey->flag);
+    if (!fp_dev->input) {
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] invalid input device\n",__func__);
+        return -1;
+    }
+    if ( IS_KEY_VALID(pkey->value) ) {
+        /* Translate Click Down/Up key to Click key. */
+        switch( pkey->value ) {
+        case NAV_KEY_CLICK_DOWN:
+            pkey->value = NAV_KEY_CLICK;
+            pkey->flag = NAV_KEY_FLAG_DOWN;
+            break;
+        case NAV_KEY_CLICK_UP:
+            pkey->value = NAV_KEY_CLICK;
+            pkey->flag = NAV_KEY_FLAG_UP;
+            break;
+        default:
+            break;
+        }
+
+        /* Check the custom define keymap */
+        if ( fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START] ) {
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] custom-key %d\n", __func__,fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START]);
+            if ( KEY_RESERVED != fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START] ) {
+                if ( NAV_KEY_FLAG_CLICK == pkey->flag ) {
+                    input_report_key(fp_dev->input, fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START], NAV_KEY_FLAG_DOWN);
+                    input_sync(fp_dev->input);
+                    input_report_key(fp_dev->input, fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START], NAV_KEY_FLAG_UP);
+                    input_sync(fp_dev->input);
+                } else {
+                    input_report_key(fp_dev->input, fp_dev->keymap_cust.k[pkey->value - NAV_KEY_START], pkey->flag);
+                    input_sync(fp_dev->input);
+                }
+            } else {
+                // Here means this key is not set, simply ignore it.
+            }
+            ret = 0;
+        }
+    }
+
+    for ( i = 0; ret && i < ARRAY_SIZE(keymap); i++ ) {
+        if ( keymap[i].key_orig == pkey->value ) {
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] key %d\n", __func__,keymap[i].key_new);
+            if ( KEY_RESERVED != keymap[i].key_new ) {
+                if ( NAV_KEY_FLAG_CLICK == pkey->flag ) {
+                    input_report_key(fp_dev->input, keymap[i].key_new, NAV_KEY_FLAG_DOWN);
+                    input_sync(fp_dev->input);
+                    input_report_key(fp_dev->input, keymap[i].key_new, NAV_KEY_FLAG_UP);
+                    input_sync(fp_dev->input);
+                } else {
+                    input_report_key(fp_dev->input, keymap[i].key_new, pkey->flag);
+                    input_sync(fp_dev->input);
+                }
+            } else {
+                // Here means this key is not set, simply ignore it.
+            }
+            ret = 0;
+        }
+    }
+
+    if ( ret ) {
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] unregister custom-key %d\n", __func__,pkey->value);
+        input_report_key(fp_dev->input, pkey->value, pkey->flag);
+        input_sync(fp_dev->input);
+        ret = 0;
+    }
+    return ret;
+}
+
+/* -------------------------------------------------------------------- */
+/*                          proc node functions                         */
+/* -------------------------------------------------------------------- */
+#ifdef PROC_NODE
+static int silfp_proc_show(struct seq_file *m, void *v)
+{
+    seq_printf(m, "%s\n", vendor_name);
+    return 0;
+}
+
+static int silfp_proc_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, silfp_proc_show, NULL);
+}
+
+static const struct file_operations silfp_proc_fops = {
+    .owner = THIS_MODULE,
+    .read  = seq_read,
+    .open  = silfp_proc_open,
+    .release = single_release,
+};
+
+static int silfp_proc_create_node(struct silfp_data *fp_dev)
+{
+    if (fp_dev->proc_entry == NULL) {
+        fp_dev->proc_root = NULL;
+#ifdef PROC_DIR
+        fp_dev->proc_root = proc_mkdir(PROC_DIR, NULL);
+        if (fp_dev->proc_root == NULL) {
+            LOG_MSG_DEBUG(ERR_LOG, "Create dir %s under /proc error!\n", PROC_DIR);
+            goto err_out;
+        }
+#endif /* PROC_DIR */
+        fp_dev->proc_entry = proc_create(PROC_NODE, 0666, fp_dev->proc_root, &silfp_proc_fops);
+        if (fp_dev->proc_entry == NULL) {
+            LOG_MSG_DEBUG(ERR_LOG, "Create entry %s under /proc/ error!\n", PROC_NODE);
+            goto err_out1;
+        }
+    }
+
+    return 0;
+
+err_out1:
+    remove_proc_entry(PROC_NODE, fp_dev->proc_root);
+#ifdef PROC_DIR
+    remove_proc_entry(PROC_DIR, NULL);
+err_out:
+#endif /* PROC_DIR */
+    fp_dev->proc_root = NULL;
+    fp_dev->proc_entry = NULL;
+    return -ENOMEM;
+}
+
+static int silfp_proc_init(struct silfp_data *fp_dev)
+{
+    if (fp_dev) {
+        fp_dev->proc_root = NULL;
+        fp_dev->proc_entry = NULL;
+    }
+    return 0;
+
+}
+
+static void silfp_proc_deinit(struct silfp_data *fp_dev)
+{
+    if (fp_dev) {
+        if (fp_dev->proc_entry) {
+            remove_proc_entry(PROC_NODE, fp_dev->proc_root);
+        }
+#ifdef PROC_DIR
+        if (fp_dev->proc_root) {
+            remove_proc_entry(PROC_DIR, NULL);
+        }
+#endif /* PROC_DIR */
+        fp_dev->proc_root = NULL;
+        fp_dev->proc_entry = NULL;
+    }
+}
+#endif /* PROC_NODE */
+
+/* -------------------------------------------------------------------- */
+/*                         init/deinit functions                        */
+/* -------------------------------------------------------------------- */
+static int silfp_input_init(struct silfp_data *fp_dev)
+{
+    int i, status = 0;
+
+    /*register device within input system.*/
+    fp_dev->input = input_allocate_device();
+    if (!fp_dev->input) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] input_allocate_device() fail!\n", __func__);
+        status = -ENOMEM;
+        return status;
+    }
+
+    __set_bit(EV_KEY, fp_dev->input->evbit);
+    //__set_bit(KEY_Q, fp_dev->input->keybit); // it will cause Android think this is a physical keyboard.
+    __set_bit(KEY_HOME, fp_dev->input->keybit);
+    __set_bit(KEY_HOMEPAGE, fp_dev->input->keybit);
+
+    __set_bit(KEY_MENU, fp_dev->input->keybit);
+    __set_bit(KEY_BACK, fp_dev->input->keybit);
+    __set_bit(KEY_CAMERA, fp_dev->input->keybit);
+
+	__set_bit(KEY_F2, fp_dev->input->keybit);
+
+    for ( i = 0; i < ARRAY_SIZE(keymap); i++ ) {
+        if ( keymap[i].key_new != KEY_RESERVED ) {
+            __set_bit(keymap[i].key_new, fp_dev->input->keybit);
+        }
+    }
+
+    for ( i = 0; i < ARRAY_SIZE(fp_dev->keymap_cust.k); i++ ) {
+        if (fp_dev->keymap_cust.k[i] && (fp_dev->keymap_cust.k[i] != KEY_RESERVED)) {
+            __set_bit(fp_dev->keymap_cust.k[i], fp_dev->input->keybit);
+        }
+    }
+
+    fp_dev->input->name = FP_INPUT_NAME;
+    if (input_register_device(fp_dev->input)) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] input_register_device() fail!\n", __func__);
+        input_free_device(fp_dev->input);
+        fp_dev->input = NULL;
+        status = -ENODEV;
+    }
+    return status;
+}
+
+static int silfp_input_deinit(struct silfp_data *fp_dev)
+{
+    if (fp_dev->input) {
+        input_unregister_device(fp_dev->input);
+        fp_dev->input = NULL;
+    }
+    return 0;
+}
+
+static int silfp_input_reinit(struct silfp_data *fp_dev)
+{
+    if (fp_dev->input) {
+        silfp_input_deinit(fp_dev);
+    }
+    return silfp_input_init(fp_dev);
+}
+
+static int silfp_init(struct silfp_data *fp_dev)
+{
+    int status = 0;
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter\n", __func__);
+    init_completion(&fp_dev->done);
+    spin_lock_init(&fp_dev->irq_lock);
+    INIT_WORK(&fp_dev->work, silfp_work_func);
+
+    /* netlink interface init */
+    status = silfp_netlink_init(fp_dev);
+    if (status == -1) {
+        return status;
+    }
+
+#if defined(CONFIG_HAS_EARLYSUSPEND)
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] register_early_suspend\n", __func__);
+    fp_dev->es.level = (EARLY_SUSPEND_LEVEL_DISABLE_FB - 1);
+    fp_dev->es.suspend = silfp_early_suspend;
+    fp_dev->es.resume = silfp_late_resume;
+    register_early_suspend(&fp_dev->es);
+#else
+	fp_dev->msm_drm_notif.notifier_call = silfp_fb_callback;
+	status = msm_drm_register_client(&fp_dev->msm_drm_notif);
+	if (status)
+		LOG_MSG_DEBUG(INFO_LOG,"Unable to register msm_drm_notifier: %d\n", status);
+	else
+		LOG_MSG_DEBUG(INFO_LOG,"register msm_drm_notifier: %d\n", status);
+#endif /* CONFIG_HAS_EARLYSUSPEND */
+
+    atomic_set(&fp_dev->spionoff_count,0);
+
+    return status;
+}
+
+static int silfp_resource_deinit(struct silfp_data *fp_dev)
+{
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter\n", __func__);
+
+    if (atomic_read(&fp_dev->init)) {
+        atomic_dec(&fp_dev->init);
+
+        if (!atomic_read(&fp_dev->init)) {
+            LOG_MSG_DEBUG(INFO_LOG, "[%s] no more users, free GPIOs\n", __func__);
+            silfp_irq_disable(fp_dev);
+            free_irq(fp_dev->irq, fp_dev);
+
+            gpio_direction_input(fp_dev->int_port);
+#if !defined(BSP_SIL_PLAT_MTK)
+            gpio_free(fp_dev->int_port);
+            if (fp_dev->rst_port > 0 ) {
+                gpio_free(fp_dev->rst_port);
+            }
+#endif /* !BSP_SIL_PLAT_MTK */
+            fp_dev->int_port = 0;
+            fp_dev->rst_port = 0;
+
+            silfp_input_deinit(fp_dev);
+            silfp_power_deinit(fp_dev);
+#ifdef PROC_NODE
+            silfp_proc_deinit(fp_dev);
+#endif /* PROC_NODE */
+        }
+        silfp_netlink_send(fp_dev, SIFP_NETLINK_DISCONNECT);
+    }
+    return 0;
+}
+
+static void silfp_exit(struct silfp_data *fp_dev)
+{
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter\n", __func__);
+
+#ifdef CONFIG_HAS_EARLYSUSPEND
+    if (fp_dev->es.suspend) {
+        unregister_early_suspend(&fp_dev->es);
+    }
+#else
+	if (msm_drm_unregister_client(&fp_dev->msm_drm_notif))
+		pr_err("Error occurred while unregistering msm_drm_notifier.\n");
+#endif /* CONFIG_HAS_EARLYSUSPEND */
+
+    silfp_set_spi(fp_dev, false); /* release SPI resources */
+
+    if (silfp_wq) {
+        destroy_workqueue(silfp_wq);
+        silfp_wq = NULL;
+    }
+    silfp_netlink_destroy(fp_dev);
+#ifdef PROC_NODE
+    silfp_proc_deinit(fp_dev);
+#endif /* PROC_NODE */
+}
+
+static void silfp_wakelock_ctl(struct silfp_data *fp_dev, unsigned char lock)
+{
+    if (lock) {
+        wake_lock_timeout(&fp_dev->wakelock_hal, 10*HZ);
+    } else {
+        wake_unlock(&fp_dev->wakelock_hal);
+    }
+}
+/*-------------------------------------------------------------------------*/
+
+static long
+silfp_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+    int			err = 0;
+    int			retval = 0;
+    struct silfp_data	*fp_dev;
+    struct fp_dev_key_t key;
+
+    /* Check type and command number */
+    if (_IOC_TYPE(cmd) != SIFP_IOC_MAGIC)
+        return -ENOTTY;
+
+    /* Check access direction once here; don't repeat below.
+     * IOC_DIR is from the user perspective, while access_ok is
+     * from the kernel perspective; so they look reversed.
+     */
+    if (_IOC_DIR(cmd) & _IOC_READ) {
+        err = !access_ok(VERIFY_WRITE,
+                         (void __user *)arg, _IOC_SIZE(cmd));
+    }
+    if (err == 0 && _IOC_DIR(cmd) & _IOC_WRITE) {
+        err = !access_ok(VERIFY_READ,
+                         (void __user *)arg, _IOC_SIZE(cmd));
+    }
+    if (err) {
+        return -EFAULT;
+    }
+
+    /* guard against device removal before, or while,
+     * we issue this ioctl.
+     */
+    fp_dev = filp->private_data;
+
+    switch (cmd) {
+    case SIFP_IOC_INIT:
+        silfp_resource_init(fp_dev,&silfp_dev_init_d);
+        if (copy_to_user((void __user *)arg, (void *)&silfp_dev_init_d, sizeof(struct fp_dev_init_t))) {
+            retval = -EFAULT;
+        }
+
+        break;
+    case SIFP_IOC_DEINIT:
+        silfp_resource_deinit(fp_dev);
+        break;
+
+    case SIFP_IOC_RESET: {
+        unsigned char delay = RESET_TIME;
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] chip reset\n", __func__);
+        if (arg) {
+            if (copy_from_user(&delay, (void __user *)arg, sizeof(char))) {
+                retval = -EFAULT;
+                break;
+            }
+        }
+
+        if (fp_dev->power_is_off) {
+            silfp_hw_poweron(fp_dev);
+			mdelay(5);
+		}
+        fp_dev->irq_ignore = 1;
+        if (fp_dev->irq_is_disable) {
+            silfp_irq_enable(fp_dev);
+            silfp_hw_reset(fp_dev, delay);
+            silfp_irq_disable(fp_dev);
+        } else {
+            silfp_hw_reset(fp_dev, delay);
+        }
+        fp_dev->irq_ignore = 0;
+    }
+    break;
+
+    case SIFP_IOC_ENABLE_IRQ:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] enable irq\n", __func__);
+        silfp_irq_enable(fp_dev);
+        break;
+
+    case SIFP_IOC_DISABLE_IRQ:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] disable irq\n", __func__);
+        silfp_irq_disable(fp_dev);
+        break;
+
+    case SIFP_IOC_CLR_IRQ:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] clear irq\n", __func__);
+        reinit_completion(&fp_dev->done);
+        break;
+
+    case SIFP_IOC_WAIT_IRQ:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] wait irq\n", __func__);
+        retval = __put_user(silfp_wait_irq(fp_dev)?1:0, (__u8 __user *)arg);
+        break;
+
+    case SIFP_IOC_IRQ_STATUS:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] irq status\n", __func__);
+        retval = __put_user((char)silfp_irq_status(fp_dev), (__u8 __user *)arg);
+        break;
+
+    case SIFP_IOC_KEY_EVENT:
+        if (copy_from_user(&key, (struct fp_dev_key_t *)arg, sizeof(struct fp_dev_key_t))) {
+            LOG_MSG_DEBUG(ERR_LOG, "[%s] copy key fail?\n",__func__);
+            retval = -EFAULT;
+        } else {
+            retval = silfp_keyevent(fp_dev,&key);
+        }
+        break;
+
+    case SIFP_IOC_SCR_STATUS:
+        if (arg) {
+            LOG_MSG_DEBUG(INFO_LOG, "[IOC_SCR_STATUS] put v = %d\n",(u8)(!fp_dev->scr_off));
+            retval = __put_user((u8)(!fp_dev->scr_off), (__u8 __user *)arg);
+        } else {
+            LOG_MSG_DEBUG(INFO_LOG, "[IOC_SCR_STATUS] send v = %d\n",(u8)(!fp_dev->scr_off));
+            silfp_netlink_send(fp_dev, fp_dev->scr_off?SIFP_NETLINK_SCR_OFF:SIFP_NETLINK_SCR_ON);
+        }
+        break;
+
+    case SIFP_IOC_GET_VER:
+        if ( copy_to_user((void __user *)arg, (void *)FP_DEV_VERSION, sizeof(char)*7)) {
+            LOG_MSG_DEBUG(ERR_LOG, "[IOC_GET_VER] copy_to fail\n");
+            retval = -EFAULT;
+        }
+        break;
+
+    case SIFP_IOC_SET_KMAP:
+        if (!arg) {
+            retval = -EFAULT;
+            break;
+        }
+        if (copy_from_user(&fp_dev->keymap_cust.k, (void __user *)arg, sizeof(struct fp_dev_kmap_t))) {
+            LOG_MSG_DEBUG(ERR_LOG, "[IOC_SET_KMAP] copy_from fail\n");
+            retval = -EFAULT;
+            break;
+        }
+
+        if (silfp_input_reinit(fp_dev)) {
+            retval = -EFAULT;
+        }
+        break;
+
+    case SIFP_IOC_ACQ_SPI:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] acq spi\n", __func__);
+        retval = silfp_set_spi(fp_dev,true);
+        break;
+
+    case SIFP_IOC_RLS_SPI:
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] release spi\n", __func__);
+        retval = silfp_set_spi(fp_dev,false);
+        break;
+
+    case SIFP_IOC_PKG_SIZE:
+        if (arg) {
+            LOG_MSG_DEBUG(DBG_LOG, "[IOC_PKG_SIZE] %d\n",(u8)(PKG_SIZE));
+            retval = __put_user((u8)(PKG_SIZE), (__u8 __user *)arg);
+        }
+        break;
+
+    case SIFP_IOC_DBG_LEVEL:
+        if (arg) {
+            unsigned char level = 0;
+            if (copy_from_user(&level, (void __user *)arg, sizeof(char)) || level > (uint8_t)ALL_LOG ) {
+                retval = -EFAULT;
+                break;
+            }
+            LOG_MSG_DEBUG(ERR_LOG, "debug level %d-->%d\n",debug_level,level);
+            retval = __put_user((u8)(debug_level), (__u8 __user *)arg);
+            debug_level = (fp_debug_level_t)level;
+        }
+        break;
+
+    case SIFP_IOC_WAKELOCK:
+        if (arg) {
+            unsigned char lock = 0;
+            if (copy_from_user(&lock, (void __user *)arg, sizeof(char))) {
+                LOG_MSG_DEBUG(ERR_LOG, "[SIFP_IOC_WAKELOCK] copy_from fail\n");
+                retval = -EFAULT;
+                break;
+            }
+            silfp_wakelock_ctl(fp_dev, lock);
+        }
+        break;
+
+    case SIFP_IOC_PWDN:
+        if (arg) {
+            unsigned char flag_avdd = 0;
+            if (copy_from_user(&flag_avdd, (void __user *)arg, sizeof(char))) {
+                LOG_MSG_DEBUG(ERR_LOG, "[SIFP_IOC_PWDN] copy_from fail\n");
+                retval = -EFAULT;
+                break;
+            }
+            silfp_pwdn(fp_dev, flag_avdd);
+        } else {
+            silfp_pwdn(fp_dev, SIFP_PWDN_NONE);
+        }
+
+        break;
+
+#ifdef PROC_NODE
+    case SIFP_IOC_PROC_NODE:
+        if (arg) {
+            if (copy_from_user(vendor_name, (void __user *)arg, PROC_VND_ID_LEN)) {
+                LOG_MSG_DEBUG(ERR_LOG, "[SIFP_IOC_PROC_NODE] copy_from fail\n");
+                retval = -EFAULT;
+                break;
+            }
+            retval = silfp_proc_create_node(fp_dev);
+        }
+        break;
+#endif /* PROC_NODE */
+
+    case SIFP_IOC_GET_TP_TOUCH_INFO:
+        LOG_MSG_DEBUG(ERR_LOG, "[SIFP_IOC_GET_TP_TOUCH_INFO]enter\n");
+        if (arg) {
+            if (copy_to_user((void __user *)arg, (void *)&fp_tpinfo, sizeof(fp_tpinfo))) {
+                LOG_MSG_DEBUG(ERR_LOG, "[SIFP_IOC_GET_TP_TOUCH_INFO] copy_to fail\n");
+                retval = -EFAULT;
+            }
+        }
+        break;
+    case SIFP_IOC_SET_TP_MSG_REPORT_MODE:
+        LOG_MSG_DEBUG(INFO_LOG, "[SET_TP_MSG_REPORT_MODE]enter,arg =%d,lasttouchmode=%d\n", (int)arg, (int)lasttouchmode);
+        if(1 == lasttouchmode) {
+            lasttouchmode = arg;//arg =0
+            LOG_MSG_DEBUG(INFO_LOG, " success lasttouchmode = %d\n", lasttouchmode);
+        } else {
+            LOG_MSG_DEBUG(ERR_LOG, "arg null,or mode is 0, do nothing!\n");
+	}
+        break;
+
+    case SIFP_IOC_REPORT_KEY:
+        LOG_MSG_DEBUG(INFO_LOG, "[SIFP_IOC_REPORT_KEY]enter,arg =%d\n", (int)arg);
+        input_report_key(fp_dev->input, KEY_F2, 1);
+		input_sync(fp_dev->input);
+		input_report_key(fp_dev->input, KEY_F2, 0);
+		input_sync(fp_dev->input);
+        break;
+    default:
+        retval = -ENOTTY;
+        break;
+    }
+
+    return retval;
+}
+
+#ifdef CONFIG_COMPAT
+static long
+silfp_compat_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+    return silfp_ioctl(filp, cmd, (unsigned long)compat_ptr(arg));
+}
+#else
+#define silfp_compat_ioctl NULL
+#endif /* CONFIG_COMPAT */
+
+static int silfp_open(struct inode *inode, struct file *filp)
+{
+    struct silfp_data	*fp_dev;
+    int			status = -ENXIO;
+
+    mutex_lock(&device_list_lock);
+
+    list_for_each_entry(fp_dev, &device_list, device_entry) {
+        if (fp_dev->devt == inode->i_rdev) {
+            status = 0;
+            break;
+        }
+    }
+    if (status == 0) {
+        fp_dev->users++;
+        filp->private_data = fp_dev;
+        nonseekable_open(inode, filp);
+    } else {
+        LOG_MSG_DEBUG(ERR_LOG, "silfp: nothing for minor %d\n", iminor(inode));
+    }
+
+    mutex_unlock(&device_list_lock);
+
+    return status;
+}
+
+static int silfp_release(struct inode *inode, struct file *filp)
+{
+    struct silfp_data	*fp_dev;
+    int			status = 0;
+
+    mutex_lock(&device_list_lock);
+    fp_dev = filp->private_data;
+    filp->private_data = NULL;
+
+    /* last close? */
+    fp_dev->users--;
+    if (!fp_dev->users) {
+        int		dofree = 0;
+
+        if (dofree)
+            kfree(fp_dev);
+    }
+    mutex_unlock(&device_list_lock);
+
+    return status;
+}
+
+static const struct file_operations silfp_dev_fops = {
+    .owner =	THIS_MODULE,
+    /* REVISIT switch to aio primitives, so that userspace
+     * gets more complete API coverage.  It'll simplify things
+     * too, except for the locking.
+     */
+    .unlocked_ioctl = silfp_ioctl,
+    .compat_ioctl   = silfp_compat_ioctl,
+    .open           = silfp_open,
+    .release        = silfp_release,
+#ifndef BSP_SIL_NETLINK
+    .read           = silfp_read,
+    .poll           = silfp_poll,
+#endif /* !BSP_SIL_NETLINK */
+};
+
+/*-------------------------------------------------------------------------*/
+
+/* The main reason to have this class is to make mdev/udev create the
+ * /dev/spidevB.C character device nodes exposing our userspace API.
+ * It also simplifies memory management.
+ */
+
+/*-------------------------------------------------------------------------*/
+
+static int silfp_probe(struct platform_device *spi)
+{
+    struct silfp_data	*fp_dev;
+    int			status = 0;
+    //unsigned long		minor;
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter.\n", __func__);
+
+	LOG_MSG_DEBUG(INFO_LOG, "[%s] find silfp fingerprint.\n", __func__);
+	
+    /* Allocate driver data */
+    fp_dev = kzalloc(sizeof(*fp_dev), GFP_KERNEL);
+    if (!fp_dev) {
+        return -ENOMEM;
+    }
+
+    /* Initialize the driver data */
+    fp_dev->spi = spi;
+    spin_lock_init(&fp_dev->spi_lock);
+
+    wake_lock_init(&fp_dev->wakelock,WAKE_LOCK_SUSPEND,"silfp_wakelock");
+    wake_lock_init(&fp_dev->wakelock_hal,WAKE_LOCK_SUSPEND,"silfp_wakelock_hal");
+    INIT_LIST_HEAD(&fp_dev->device_entry);
+
+    /* If we can allocate a minor number, hook up this device.
+     * Reusing minors is fine so long as udev or mdev is working.
+     */
+
+    if (FP_DEV_MAJOR > 0) {
+        fp_dev->devt = MKDEV(FP_DEV_MAJOR, fp_dev->ref++);
+        status = register_chrdev_region(fp_dev->devt, 1, FP_DEV_NAME);
+    } else {
+        status = alloc_chrdev_region(&fp_dev->devt, fp_dev->ref++, 1, FP_DEV_NAME);
+    }
+    if (status < 0) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] request devt fail, ret=%d.\n", __func__, status);
+        goto err_devt;
+    } else {
+        LOG_MSG_DEBUG(INFO_LOG, "[%s], major=%d, minor=%d\n", __func__, MAJOR(fp_dev->devt), MINOR(fp_dev->devt));
+    }
+
+    fp_dev->dev = device_create(silfp_class, &fp_dev->spi->dev, fp_dev->devt, fp_dev, FP_DEV_NAME);
+    if (IS_ERR(fp_dev->dev)) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] device_create() fail.\n", __func__);
+        status = -ENODEV;
+        goto err_dev;
+    } else {
+        mutex_lock(&device_list_lock);
+        list_add(&fp_dev->device_entry, &device_list);
+        mutex_unlock(&device_list_lock);
+        LOG_MSG_DEBUG(INFO_LOG, "[%s] device create success.\n", __func__);
+    }
+
+    cdev_init(&fp_dev->cdev, &silfp_dev_fops);
+    fp_dev->cdev.owner = THIS_MODULE;
+    status = cdev_add(&fp_dev->cdev, fp_dev->devt, 1);
+    if (status) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] cdev_add() fail, ret=%d.\n", __func__, status);
+        goto err_cdev;
+    }
+
+    atomic_set(&fp_dev->init,0);
+    status = silfp_init(fp_dev);
+    if (status) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] silfp_init fail ret=%d.\n", __func__, status);
+        goto err_cdev;
+    }
+#ifdef PROC_NODE
+    silfp_proc_init(fp_dev);
+#endif /* PROC_NODE */
+    platform_set_drvdata(spi, fp_dev);
+	optical_fp = fp_dev;
+
+	status = sysfs_create_group(&spi->dev.kobj,
+			&sl_attribute_group);
+	if (status)
+		pr_err("%s:could not create sysfs\n", __func__);
+    return status;
+
+err_cdev:
+    list_del(&fp_dev->device_entry);
+
+err_dev:
+    unregister_chrdev_region(fp_dev->devt, 1);
+
+err_devt:
+    platform_set_drvdata(spi, NULL);
+    fp_dev->spi = NULL;
+    kfree(fp_dev);
+    fp_dev = NULL;
+
+    return status;
+}
+
+static int silfp_remove(struct platform_device *spi)
+{
+    struct silfp_data	*fp_dev = platform_get_drvdata(spi);
+
+    wake_lock_destroy(&fp_dev->wakelock);
+    wake_lock_destroy(&fp_dev->wakelock_hal);
+    /* make sure ops on existing fds can abort cleanly */
+    spin_lock_irq(&fp_dev->spi_lock);
+    fp_dev->spi = NULL;
+    spin_unlock_irq(&fp_dev->spi_lock);
+
+    silfp_exit(fp_dev);
+    /* prevent new opens */
+    mutex_lock(&device_list_lock);
+    list_del(&fp_dev->device_entry);
+    device_destroy(silfp_class, fp_dev->devt);
+    if (fp_dev->users == 0)
+        kfree(fp_dev);
+    mutex_unlock(&device_list_lock);
+
+    return 0;
+}
+
+static const struct of_device_id sildev_dt_ids[] = {
+    { .compatible = "sil,silead_fp" },
+    { .compatible = "sil,silead-fp" },
+    { .compatible = "sil,fingerprint" },
+    { .compatible = "sil,silead_fp-pins" },
+    {},
+};
+
+MODULE_DEVICE_TABLE(of, sildev_dt_ids);
+
+static struct platform_driver silfp_driver = {
+    .driver = {
+        .name  = "silead_fp",
+        .owner = THIS_MODULE,
+        .of_match_table = of_match_ptr(sildev_dt_ids),
+    },
+    .probe  = silfp_probe,
+    .remove = silfp_remove,
+
+    /* NOTE:  suspend/resume methods are not necessary here.
+     * We don't do anything except pass the requests to/from
+     * the underlying controller.  The refrigerator handles
+     * most issues; the controller driver handles the rest.
+     */
+};
+
+/*-------------------------------------------------------------------------*/
+
+static int __init silfp_dev_init(void)
+{
+    int status = 0;
+
+    LOG_MSG_DEBUG(ERR_LOG, "SILEAD_FP Driver, Version: %s.\n", FP_DEV_VERSION);
+    /* Claim our 256 reserved device numbers.  Then register a class
+     * that will key udev/mdev to add/remove /dev nodes.  Last, register
+     * the driver which manages those device numbers.
+     */
+	pr_info("%s:fp version %x\n", __func__, fp_version);
+	if ((fp_version != 0x05))
+		return 0;
+    status = register_chrdev(FP_DEV_MAJOR, "sil", &silfp_dev_fops);
+    if (status < 0) {
+        return status;
+    }
+
+    silfp_class = class_create(THIS_MODULE, "silead_fp");
+    if (IS_ERR(silfp_class)) {
+        unregister_chrdev(FP_DEV_MAJOR, silfp_driver.driver.name);
+        return PTR_ERR(silfp_class);
+    }
+
+    status = platform_driver_register(&silfp_driver);
+    if (status < 0) {
+        class_destroy(silfp_class);
+        unregister_chrdev(FP_DEV_MAJOR, silfp_driver.driver.name);
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] spi_register_driver fail ret=%d.\n", __func__, status);
+        return status;
+    }
+    silfp_wq = create_singlethread_workqueue("silfp_wq");
+    return status;
+}
+module_init(silfp_dev_init);
+
+static void __exit silfp_dev_exit(void)
+{
+    platform_driver_unregister(&silfp_driver);
+    class_destroy(silfp_class);
+    unregister_chrdev(FP_DEV_MAJOR, silfp_driver.driver.name);
+}
+
+module_exit(silfp_dev_exit);
+
+MODULE_AUTHOR("Bill Yu <billyu@silead.com>");
+MODULE_DESCRIPTION("Silead Fingerprint driver for GSL61XX/GSL62XX series.");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("sil:silead_fp");
diff --git a/drivers/input/fingerprint/silead/silead_fp_qcom.c b/drivers/input/fingerprint/silead/silead_fp_qcom.c
new file mode 100755
index 0000000000000000000000000000000000000000..78880057d8c9e8a3053c394b99d2c0cd216f4729
--- /dev/null
+++ b/drivers/input/fingerprint/silead/silead_fp_qcom.c
@@ -0,0 +1,606 @@
+/*
+ * @file   silead_fp_qcom.c
+ * @brief  Contains silead_fp device implements for Qualcomm platform.
+ *
+ *
+ * Copyright 2016-2018 Slead Inc.
+ *
+ * The code contained herein is licensed under the GNU General Public
+ * License. You may obtain a copy of the GNU General Public License
+ * Version 2 or later at the following locations:
+ *
+ * http://www.opensource.org/licenses/gpl-license.html
+ * http://www.gnu.org/copyleft/gpl.html
+ *
+ * ------------------- Revision History ------------------------------
+ * <author>    <date>   <version>     <desc>
+ * Bill Yu    2018/5/2    0.1.0      Init version
+ * Bill Yu    2018/5/20   0.1.1      Default wait 3ms after reset
+ * Bill Yu    2018/6/5    0.1.2      Support chip enter power down
+ *
+ */
+
+#ifdef BSP_SIL_PLAT_QCOM
+
+#ifndef __SILEAD_FP_QCOM__
+#define __SILEAD_FP_QCOM__
+
+#include <linux/of_irq.h>
+
+#ifndef INIT_COMPLETION
+#define INIT_COMPLETION(x)  ((x).done = 0)
+#endif /* INIT_COMPLETION */
+/* Qualcomm MNC platform, need define this. */
+#define reinit_completion(x) INIT_COMPLETION(*(x))
+
+#define SPI_PINCTRL_STATE_DEFAULT   "spi_default"
+#define SPI_PINCTRL_STATE_SLEEP     "spi_sleep"
+
+static irqreturn_t silfp_irq_handler(int irq, void *dev_id);
+static void silfp_work_func(struct work_struct *work);
+static int silfp_input_init(struct silfp_data *fp_dev);
+
+int sl_pinctrl_init(struct silfp_data *fp_dev)
+{
+	int ret = 0;
+	struct device *dev = &fp_dev->spi->dev;
+
+	fp_dev->sl_pinctrl = devm_pinctrl_get(dev);
+	if (IS_ERR_OR_NULL(fp_dev->sl_pinctrl)) {
+		dev_err(dev, "Target does not use pinctrl\n");
+		ret = PTR_ERR(fp_dev->sl_pinctrl);
+		goto err;
+	}
+
+	fp_dev->gpio_state_enable =
+		pinctrl_lookup_state(fp_dev->sl_pinctrl, "fp_en_init");
+	if (IS_ERR_OR_NULL(fp_dev->gpio_state_enable)) {
+		dev_err(dev, "Cannot get active pinstate\n");
+		ret = PTR_ERR(fp_dev->gpio_state_enable);
+		goto err;
+	}
+
+	ret = pinctrl_select_state(fp_dev->sl_pinctrl,
+		fp_dev->gpio_state_enable);
+	if (ret) {
+		pr_err("can not set %s pins\n", "fp_en_init");
+		goto err;
+	}
+
+	return 0;
+err:
+	fp_dev->sl_pinctrl = NULL;
+	fp_dev->gpio_state_enable = NULL;
+	return ret;
+}
+
+/* -------------------------------------------------------------------- */
+/*                            power supply                              */
+/* -------------------------------------------------------------------- */
+static void silfp_hw_poweron(struct silfp_data *fp_dev)
+{
+    int err = 0;
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter.\n", __func__);
+
+#ifdef BSP_SIL_POWER_SUPPLY_REGULATOR
+    /* Power control by Regulators(LDO) */
+    if ( fp_dev->avdd_ldo ) {
+	err = regulator_set_voltage(fp_dev->avdd_ldo,
+		AVDD_MIN, AVDD_MAX);	/*set 2.8v*/
+ 		err = regulator_set_load(fp_dev->avdd_ldo, CURRENT);
+		if (err < 0)
+			LOG_MSG_DEBUG(INFO_LOG,
+				"poweron: vreg mode(err:%d)\n", err);
+	err = regulator_enable(fp_dev->avdd_ldo);	/*enable regulator*/
+	//pmic_set_register_value(PMIC_RG_VCAMA_CAL,0x0A);
+	}
+	if (fp_dev->vddio_ldo) {
+	err = regulator_set_voltage(fp_dev->vddio_ldo,
+		VDDIO_MIN, VDDIO_MAX);	/*set 1.8v*/
+		err = regulator_set_load(fp_dev->vddio_ldo, 200000);//100ma
+		if (err < 0)
+			LOG_MSG_DEBUG(INFO_LOG,
+			"poweron: vreg mode(err:%d)\n", err);
+	err = regulator_enable(fp_dev->vddio_ldo);	/*enable regulator*/
+	//pmic_set_register_value(PMIC_RG_VCAMA_CAL,0x0A);
+	}
+#endif /* BSP_SIL_POWER_SUPPLY_REGULATOR */
+
+#ifdef BSP_SIL_POWER_SUPPLY_PINCTRL
+    /* Power control by GPIOs */
+    if ( fp_dev->pin.pins_avdd_h ) {
+        err = pinctrl_select_state(fp_dev->pin.pinctrl, fp_dev->pin.pins_avdd_h);
+    }
+    if ( fp_dev->pin.pins_vddio_h ) {
+        err = pinctrl_select_state(fp_dev->pin.pinctrl, fp_dev->pin.pins_vddio_h);
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_PINCTRL */
+
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    if ( fp_dev->avdd_port > 0 ) {
+        err = gpio_direction_output(fp_dev->avdd_port, 1);
+    }
+    if ( fp_dev->vddio_port > 0 ) {
+        err = gpio_direction_output(fp_dev->vddio_port, 1);
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+    fp_dev->power_is_off = 0;
+    LOG_MSG_DEBUG(INFO_LOG, "%s: power supply ret:%d \n", __func__, err);
+}
+
+static void silfp_hw_poweroff(struct silfp_data *fp_dev) 
+{
+	int err = 0;
+
+	LOG_MSG_DEBUG(INFO_LOG, "[%s] enter.\n", __func__);
+#ifdef BSP_SIL_POWER_SUPPLY_REGULATOR
+	/* Power control by Regulators(LDO) */
+	if ((fp_dev->power_is_off == 0) &&
+		fp_dev->avdd_ldo &&
+		(regulator_is_enabled(fp_dev->avdd_ldo) > 0)) {
+		regulator_disable(fp_dev->avdd_ldo);    /*disable regulator*/
+		err = regulator_set_load(fp_dev->avdd_ldo, 0);
+			if (err < 0)
+				LOG_MSG_DEBUG(INFO_LOG,
+					"poweroff: vreg mode(err:%d)\n", err);
+	}
+	if ((fp_dev->power_is_off == 0) &&
+		fp_dev->vddio_ldo &&
+		(regulator_is_enabled(fp_dev->vddio_ldo) > 0)) {
+		regulator_disable(fp_dev->vddio_ldo);   /*disable regulator*/
+		err = regulator_set_load(fp_dev->vddio_ldo, 0);
+		if (err < 0)
+			LOG_MSG_DEBUG(INFO_LOG,
+				"poweroff: vreg mode(err:%d)\n", err);
+	}
+#endif /* BSP_SIL_POWER_SUPPLY_REGULATOR */
+
+#ifdef BSP_SIL_POWER_SUPPLY_PINCTRL
+    /* Power control by GPIOs */
+    //fp_dev->pin.pins_avdd_h = NULL;
+    //fp_dev->pin.pins_vddio_h = NULL;
+#endif /* BSP_SIL_POWER_SUPPLY_PINCTRL */
+
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    if ( fp_dev->avdd_port > 0 ) {
+        gpio_direction_output(fp_dev->avdd_port, 0);
+    }
+    if ( fp_dev->vddio_port > 0 ) {
+        gpio_direction_output(fp_dev->vddio_port, 0);
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+    fp_dev->power_is_off = 1;
+}
+
+static void silfp_power_deinit(struct silfp_data *fp_dev)
+{
+	int err = 0;
+
+	LOG_MSG_DEBUG(INFO_LOG, "[%s] enter.\n", __func__);
+#ifdef BSP_SIL_POWER_SUPPLY_REGULATOR
+	/* Power control by Regulators(LDO) */
+	if (fp_dev->avdd_ldo) {
+	regulator_disable(fp_dev->avdd_ldo);	/*disable regulator*/
+		err = regulator_set_load(fp_dev->avdd_ldo, 0);
+		if (err < 0)
+			LOG_MSG_DEBUG(INFO_LOG,
+			"deinit: vreg mode(err:%d)\n", err);
+	regulator_put(fp_dev->avdd_ldo);
+	fp_dev->avdd_ldo = NULL;
+	}
+	if (fp_dev->vddio_ldo) {
+	regulator_disable(fp_dev->vddio_ldo);	/*disable regulator*/
+		err = regulator_set_load(fp_dev->vddio_ldo, 0);
+		if (err < 0)
+			LOG_MSG_DEBUG(INFO_LOG,
+			"deinit: Failed vreg mode(err:%d)\n", err);
+	regulator_put(fp_dev->vddio_ldo);
+	fp_dev->vddio_ldo = NULL;
+	}
+#endif /* BSP_SIL_POWER_SUPPLY_REGULATOR */
+
+#ifdef BSP_SIL_POWER_SUPPLY_PINCTRL
+    /* Power control by GPIOs */
+    fp_dev->pin.pins_avdd_h = NULL;
+    fp_dev->pin.pins_vddio_h = NULL;
+#endif /* BSP_SIL_POWER_SUPPLY_PINCTRL */
+
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    if ( fp_dev->avdd_port > 0 ) {
+        gpio_direction_output(fp_dev->avdd_port, 0);
+        gpio_free(fp_dev->avdd_port);
+        fp_dev->avdd_port = 0;
+    }
+    if ( fp_dev->vddio_port > 0 ) {
+        gpio_direction_output(fp_dev->vddio_port, 0);
+        gpio_free(fp_dev->vddio_port);
+        fp_dev->vddio_port = 0;
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+}
+
+/* -------------------------------------------------------------------- */
+/*                            hardware reset                            */
+/* -------------------------------------------------------------------- */
+static void silfp_hw_reset(struct silfp_data *fp_dev, u8 delay)
+{
+	LOG_MSG_DEBUG(INFO_LOG,
+		"[%s] enter, port=%d\n", __func__, fp_dev->rst_port);
+
+	if (fp_dev->rst_port > 0) {
+	gpio_direction_output(fp_dev->rst_port, 0);
+	mdelay((delay?delay:1)*RESET_TIME_MULTIPLE);
+	gpio_direction_output(fp_dev->rst_port, 1);
+
+	mdelay((delay?delay:1)*RESET_TIME_MULTIPLE);
+	}
+}
+
+/* -------------------------------------------------------------------- */
+/*                            power  down                               */
+/* -------------------------------------------------------------------- */
+static void silfp_pwdn(struct silfp_data *fp_dev, u8 flag_avdd)
+{
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] enter, port=%d\n", __func__, fp_dev->rst_port);
+
+    if (SIFP_PWDN_FLASH == flag_avdd) {
+        silfp_hw_poweroff(fp_dev);
+        msleep(200*RESET_TIME_MULTIPLE);
+        silfp_hw_poweron(fp_dev);
+    }
+    if ( fp_dev->rst_port > 0 ) {
+        gpio_direction_output(fp_dev->rst_port, 0);
+    }
+
+    if (SIFP_PWDN_POWEROFF == flag_avdd) {
+        silfp_hw_poweroff(fp_dev);
+    }
+}
+
+/* -------------------------------------------------------------------- */
+/*                         init/deinit functions                        */
+/* -------------------------------------------------------------------- */
+static int silfp_parse_dts(struct silfp_data* fp_dev)
+{
+    int ret;
+#ifndef QSEE_V4
+    /* Get the pinctrl node */
+    fp_dev->pin.pinctrl = devm_pinctrl_get(&fp_dev->spi->dev);
+    if (IS_ERR_OR_NULL(fp_dev->pin.pinctrl)) {
+        LOG_MSG_DEBUG(ERR_LOG, "%s: Failed to get pinctrl\n", __func__);
+        return PTR_ERR(fp_dev->pin.pinctrl);
+    }
+
+    /* Get the active setting */
+    fp_dev->pin.active = pinctrl_lookup_state(fp_dev->pin.pinctrl, SPI_PINCTRL_STATE_DEFAULT);
+    if (IS_ERR_OR_NULL(fp_dev->pin.active)) {
+        fp_dev->pin.active = NULL;
+        fp_dev->pin.pinctrl = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s: Failed to get pinctrl state active\n",__func__);
+        return PTR_ERR(fp_dev->pin.active);
+    }
+
+    /* Get power settings */
+#ifdef BSP_SIL_POWER_SUPPLY_PINCTRL
+    fp_dev->pin.pins_avdd_h = pinctrl_lookup_state(fp_dev->pin.pinctrl, "avdd-enable");
+    if (IS_ERR_OR_NULL(fp_dev->pin.pins_avdd_h)) {
+        fp_dev->pin.pins_avdd_h = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s can't find silfp avdd-enable\n", __func__);
+        // Ignore error
+    }
+
+    fp_dev->pin.pins_vddio_h = pinctrl_lookup_state(fp_dev->pin.pinctrl, "vddio-enable");
+    if (IS_ERR_OR_NULL(fp_dev->pin.pins_vddio_h)) {
+        fp_dev->pin.pins_vddio_h = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s can't find silfp vddio-enable\n", __func__);
+        // Ignore error
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_PINCTRL */
+#endif /* QSEE_V4 */
+
+#ifdef BSP_SIL_POWER_SUPPLY_REGULATOR
+    // Todo: use correct settings.
+    fp_dev->avdd_ldo = regulator_get(&fp_dev->spi->dev, "avdd");
+   // fp_dev->vddio_ldo= regulator_get(&fp_dev->spi->dev, "vddio");
+#endif /* BSP_SIL_POWER_SUPPLY_REGULATOR */
+
+#ifndef QSEE_V4
+    /* Get sleep settings */
+    fp_dev->pin.sleep = pinctrl_lookup_state(fp_dev->pin.pinctrl, SPI_PINCTRL_STATE_SLEEP);
+    if (IS_ERR_OR_NULL(fp_dev->pin.sleep)) {
+        fp_dev->pin.active = NULL;
+        fp_dev->pin.pinctrl = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s: Failed to get pinctrl state sleep\n",__func__);
+        return PTR_ERR(fp_dev->pin.sleep);
+    }
+
+    /* Get iface_clk info */
+    fp_dev->pin.iface_clk = clk_get(&fp_dev->spi->dev, "iface_clk");
+    if (IS_ERR(fp_dev->pin.iface_clk)) {
+        fp_dev->pin.active = NULL;
+        fp_dev->pin.pinctrl = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s: Failed to get iface_clk %ld\n", __func__, PTR_ERR(fp_dev->pin.iface_clk));
+        return PTR_ERR(fp_dev->pin.iface_clk);
+    }
+
+    /* Get core_clk info */
+    fp_dev->pin.core_clk = clk_get(&fp_dev->spi->dev, "core_clk");
+    if (IS_ERR(fp_dev->pin.core_clk)) {
+        fp_dev->pin.active = NULL;
+        fp_dev->pin.pinctrl = NULL;
+        LOG_MSG_DEBUG(ERR_LOG, "%s: Failed to get core_clk %p\n", __func__, fp_dev->pin.core_clk);
+        return PTR_ERR(fp_dev->pin.core_clk);
+    }
+#else
+    /* Get the SPI Max speed */
+    ret = of_property_read_u32(fp_dev->spi->dev.of_node,"spi-max-frequency", &fp_dev->pin.max_speed_hz);
+    if (ret) {
+        fp_dev->pin.max_speed_hz = 0;
+        LOG_MSG_DEBUG(ERR_LOG, "Error getting spi max speed\n");
+    }
+#endif /* QSEE_V4 */
+
+    /* Get the QUP ID (#1-12) */
+    ret = of_property_read_u32(fp_dev->spi->dev.of_node,"qcom,qup-id", &fp_dev->pin.qup_id);
+    if (ret) {
+        fp_dev->pin.qup_id = 0;
+        LOG_MSG_DEBUG(ERR_LOG, "Error getting qup_id\n");
+    }
+
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] done (%d).\n",__func__,ret);
+    /*
+       Grab SPI master lock for exclusive access
+       call spi_bus_unlock to unlock the lock.
+     */
+    //spi_bus_lock(fp_dev->spi->master);
+    return ret;
+}
+
+#ifndef QSEE_V4
+static int spi_set_pinctrl(struct silfp_data* fp_dev, bool active)
+{
+    int ret = -1;
+
+    if ( IS_ERR_OR_NULL(fp_dev->pin.pinctrl) || IS_ERR_OR_NULL(fp_dev->pin.active)) {
+        LOG_MSG_DEBUG(ERR_LOG, "%s: not support\n", __func__);
+        return ret;
+    }
+    if (active) { /* Change to active settings */
+        ret = pinctrl_select_state(fp_dev->pin.pinctrl, fp_dev->pin.active);
+    } else {
+        ret = pinctrl_select_state(fp_dev->pin.pinctrl, fp_dev->pin.sleep);
+    }
+
+    LOG_MSG_DEBUG(INFO_LOG, "%s: pinctrl_select_state ret:%d Setting:%d\n", __func__, ret, active);
+    return ret;
+}
+
+static int spi_set_clks(struct silfp_data* fp_dev, bool enable)
+{
+    int ret = -1;
+    int clk = 19200000;
+
+    if ( IS_ERR_OR_NULL(fp_dev->pin.pinctrl) || IS_ERR_OR_NULL(fp_dev->pin.active)) {
+        LOG_MSG_DEBUG(INFO_LOG, "%s: not support\n", __func__);
+        return ret;
+    }
+    if (enable) {
+        /* Enable the spi clocks */
+        ret = clk_set_rate(fp_dev->pin.core_clk, fp_dev->spi->max_speed_hz);
+        if (ret) {
+            while ( clk > fp_dev->spi->max_speed_hz ) {
+                clk >>= 1;
+            }
+            if ( clk < 4800000 ) {
+                clk = 4800000;
+            }
+            ret = clk_set_rate(fp_dev->pin.core_clk, clk);
+            if ( ret ) {
+                LOG_MSG_DEBUG(ERR_LOG, "%s: Error setting clk_rate:%d, ret=%d\n",__func__, clk,ret);
+            } else {
+                fp_dev->spi->max_speed_hz = clk;
+            }
+        }
+        ret = clk_prepare_enable(fp_dev->pin.core_clk);
+        if (ret) {
+            LOG_MSG_DEBUG(ERR_LOG, "%s: Error enabling core clk, ret=%d\n",__func__,ret);
+        }
+        ret = clk_prepare_enable(fp_dev->pin.iface_clk);
+        if (ret) {
+            LOG_MSG_DEBUG(ERR_LOG, "%s: Error enabling iface clk, ret=%d\n",__func__,ret);
+        }
+    } else {
+        /* Disable the clocks */
+        clk_disable_unprepare(fp_dev->pin.iface_clk);
+        clk_disable_unprepare(fp_dev->pin.core_clk);
+        ret = 0;
+    }
+
+    LOG_MSG_DEBUG(DBG_LOG, "[%s] done (%d), speed = %d.\n",__func__,ret,fp_dev->spi->max_speed_hz );
+    return ret;
+}
+
+static int spi_set_fabric(struct silfp_data* fp_dev, bool active)
+{
+    int ret;
+    struct spi_master *master = fp_dev->spi->master;
+
+    if (active) {
+        ret = master->prepare_transfer_hardware(master);
+    } else {
+        ret = master->unprepare_transfer_hardware(master);
+    }
+    LOG_MSG_DEBUG(DBG_LOG, "[%s] done (%d).\n",__func__,ret);
+    return ret;
+}
+#endif /* !QSEE_V4 */
+
+static int silfp_set_spi(struct silfp_data *fp_dev, bool enable)
+{
+    int ret = -ENOENT;
+#ifndef QSEE_V4
+    if ( IS_ERR_OR_NULL(fp_dev->pin.pinctrl) || IS_ERR_OR_NULL(fp_dev->pin.active) || !fp_dev->pin.qup_id ) {
+        LOG_MSG_DEBUG(ERR_LOG, "%s: not support!\n", __func__);
+        return ret;
+    }
+
+    if ( enable && !atomic_read(&fp_dev->spionoff_count) ) {
+        atomic_inc(&fp_dev->spionoff_count);
+        ret = spi_set_pinctrl(fp_dev, enable);
+        ret |= spi_set_fabric(fp_dev, enable);
+        ret |= spi_set_clks(fp_dev, enable);
+    } else if (atomic_read(&fp_dev->spionoff_count)) {
+        atomic_dec(&fp_dev->spionoff_count);
+        //spi_change_pipe_owner(false);
+        ret = spi_set_clks(fp_dev, enable);
+        ret |= spi_set_fabric(fp_dev, enable);
+        ret |= spi_set_pinctrl(fp_dev, enable);
+    }
+#else
+    LOG_MSG_DEBUG(ERR_LOG, "%s: qsee4 no needed!\n", __func__);
+#endif /* !QSEE_V4 */
+    return ret;
+}
+
+static int silfp_resource_init(struct silfp_data *fp_dev, struct fp_dev_init_t *dev_info)
+{
+    int status = 0;
+    int ret;
+
+    if (atomic_read(&fp_dev->init)) {
+        atomic_inc(&fp_dev->init);
+        LOG_MSG_DEBUG(DBG_LOG, "[%s] dev already init(%d).\n",__func__,atomic_read(&fp_dev->init));
+        return status;
+    }
+
+    silfp_parse_dts(fp_dev);
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    fp_dev->avdd_port = of_get_named_gpio(fp_dev->spi->dev.of_node, "avdd-gpios", 0);
+    fp_dev->vddio_port = of_get_named_gpio(fp_dev->spi->dev.of_node, "vddio-gpios", 0);
+    if (fp_dev->avdd_port > 0 ) {
+        gpio_free(fp_dev->avdd_port);
+        ret = gpio_request(fp_dev->avdd_port, "SILFP_AVDD_PIN");
+        if (ret < 0) {
+            LOG_MSG_DEBUG(ERR_LOG, "[%s] Failed to request GPIO=%d, ret=%d",__func__,(s32)fp_dev->avdd_port, ret);
+            status = -ENODEV;
+            goto err_avdd;
+        }
+    }
+
+    if (fp_dev->vddio_port > 0 ) {
+        gpio_free(fp_dev->vddio_port);
+        ret = gpio_request(fp_dev->vddio_port, "SILFP_VDDIO_PIN");
+        if (ret < 0) {
+            LOG_MSG_DEBUG(ERR_LOG, "[%s] Failed to request GPIO=%d, ret=%d",__func__,(s32)fp_dev->vddio_port, ret);
+            status = -ENODEV;
+            goto err_vddio;
+        }
+    }
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+    silfp_hw_poweron(fp_dev);
+    fp_dev->int_port = of_get_named_gpio(fp_dev->spi->dev.of_node, "irq-gpios", 0);
+    fp_dev->rst_port = of_get_named_gpio(fp_dev->spi->dev.of_node, "rst-gpios", 0);
+    LOG_MSG_DEBUG(INFO_LOG, "[%s] int_port %d, rst_port %d.\n",__func__,fp_dev->int_port,fp_dev->rst_port);
+    if (fp_dev->int_port > 0 ) {
+        gpio_free(fp_dev->int_port);
+    }
+
+    if (fp_dev->rst_port > 0 ) {
+        gpio_free(fp_dev->rst_port);
+    }
+
+    ret = gpio_request(fp_dev->int_port, "SILFP_INT_IRQ");
+    if (ret < 0) {
+        LOG_MSG_DEBUG(ERR_LOG, "[%s] Failed to request GPIO=%d, ret=%d",__func__,(s32)fp_dev->int_port, ret);
+        status = -ENODEV;
+        goto err;
+    } else {
+        gpio_direction_input(fp_dev->int_port);
+        fp_dev->irq = gpio_to_irq(fp_dev->int_port);
+        fp_dev->irq_is_disable = 0;
+
+        ret  = request_irq(fp_dev->irq,
+                           silfp_irq_handler,
+                           IRQ_TYPE_EDGE_RISING, //IRQ_TYPE_LEVEL_HIGH, //irq_table[ts->int_trigger_type],
+                           "silfp",
+                           fp_dev);
+        if ( ret < 0 ) {
+            LOG_MSG_DEBUG(ERR_LOG, "[%s] Filed to request_irq (%d), ert=%d",__func__,fp_dev->irq, ret);
+            status = -ENODEV;
+            goto err_irq;
+        } else {
+            LOG_MSG_DEBUG(INFO_LOG,"[%s] Enable_irq_wake.\n",__func__);
+            enable_irq_wake(fp_dev->irq);
+            silfp_irq_disable(fp_dev);
+        }
+    }
+
+    if (fp_dev->rst_port > 0 ) {
+        ret = gpio_request(fp_dev->rst_port, "SILFP_RST_PIN");
+        if (ret < 0) {
+            LOG_MSG_DEBUG(ERR_LOG, "[%s] Failed to request GPIO=%d, ret=%d",__func__,(s32)fp_dev->rst_port, ret);
+            status = -ENODEV;
+            goto err_rst;
+        } else {
+            gpio_direction_output(fp_dev->rst_port, 0);
+        }
+    }
+
+    if (!ret) {
+        if (silfp_input_init(fp_dev)) {
+            goto err_input;
+        }
+        atomic_set(&fp_dev->init,1);
+    }
+    dev_info->reserve = PKG_SIZE;
+    dev_info->reserve <<= 12;
+#ifdef QSEE_V4
+    if (fp_dev->pin.max_speed_hz) {
+        dev_info->speed = fp_dev->pin.max_speed_hz;
+    }
+#endif /* QSEE_V4 */
+
+    if (dev_info && fp_dev->pin.qup_id && (fp_dev->pin.qup_id < 16)) {
+        dev_info->dev_id = fp_dev->pin.qup_id;
+        strncpy(dev_info->ta,TANAME,sizeof(dev_info->ta));
+    }
+	status = sl_pinctrl_init(fp_dev);
+	if (status < 0)
+		LOG_MSG_DEBUG(ERR_LOG, "[%s] Failed init gpio %d",
+			__func__, status);
+    return status;
+
+err_input:
+    if (fp_dev->rst_port > 0 ) {
+        gpio_free(fp_dev->rst_port);
+    }
+
+err_rst:
+    free_irq(fp_dev->irq, fp_dev);
+    gpio_direction_input(fp_dev->int_port);
+
+err_irq:
+    gpio_free(fp_dev->int_port);
+
+#ifdef BSP_SIL_POWER_SUPPLY_GPIO
+    gpio_free(fp_dev->vddio_port);
+err_vddio:
+    gpio_free(fp_dev->avdd_port);
+
+err_avdd:
+    fp_dev->avdd_port = 0;
+    fp_dev->vddio_port = 0;
+#endif /* BSP_SIL_POWER_SUPPLY_GPIO */
+
+err:
+    fp_dev->int_port = 0;
+    fp_dev->rst_port = 0;
+
+    return status;
+}
+
+#endif /* __SILEAD_FP_QCOM__ */
+
+#endif /* BSP_SIL_PLAT_QCOM */
+
+/* End of file spilead_fp_qcom.c */
diff --git a/drivers/input/fingerprint/silead/silead_fp_qcom.h b/drivers/input/fingerprint/silead/silead_fp_qcom.h
new file mode 100755
index 0000000000000000000000000000000000000000..c1e02f0a1bf3ebfa19217ff4ddea97b3f8cc6231
--- /dev/null
+++ b/drivers/input/fingerprint/silead/silead_fp_qcom.h
@@ -0,0 +1,48 @@
+/*
+ * @file   silead_fp_qcom.h
+ * @brief  Contains silead_fp Qualcomm platform specific head file.
+ *
+ *
+ * Copyright 2016-2018 Slead Inc.
+ *
+ * The code contained herein is licensed under the GNU General Public
+ * License. You may obtain a copy of the GNU General Public License
+ * Version 2 or later at the following locations:
+ *
+ * http://www.opensource.org/licenses/gpl-license.html
+ * http://www.gnu.org/copyleft/gpl.html
+ *
+ * ------------------- Revision History ------------------------------
+ * <author>    <date>   <version>     <desc>
+ * Bill Yu    2018/5/2    0.1.0      Init version
+ *
+ */
+
+#ifndef __SILEAD_FP_QCOM_H__
+#define __SILEAD_FP_QCOM_H__
+
+#include <linux/pinctrl/consumer.h>
+#include <linux/clk.h>
+#include <soc/qcom/scm.h>
+
+struct fp_plat_t {
+    u32 qup_id;
+#ifdef QSEE_V4
+    u32 max_speed_hz;
+#else
+    /* pinctrl info */
+    struct pinctrl  *pinctrl;
+    struct pinctrl_state  *active;
+    struct pinctrl_state  *sleep;
+#ifdef BSP_SIL_POWER_SUPPLY_PINCTRL
+    struct pinctrl_state *pins_avdd_h, *pins_vddio_h;
+#endif /* BSP_SIL_POWER_SUPPLY_PINCTRL */
+    /* clock info */
+    struct clk    *core_clk;
+    struct clk    *iface_clk;
+#endif /* QSEE_V4 */
+};
+
+#endif /* __SILEAD_FP_QCOM_H__ */
+
+/* End of file silead_fp_qcom.h */
diff --git a/drivers/input/keyboard/gpio_keys.c b/drivers/input/keyboard/gpio_keys.c
index e9f0ebf3267add21d8c372a7853312fa1998a7e6..34de29ce18040bcd58ce9b5e4be985c2b56167c7 100644
--- a/drivers/input/keyboard/gpio_keys.c
+++ b/drivers/input/keyboard/gpio_keys.c
@@ -30,6 +30,7 @@
 #include <linux/of.h>
 #include <linux/of_irq.h>
 #include <linux/spinlock.h>
+#include <linux/oem_force_dump.h>
 
 struct gpio_button_data {
 	const struct gpio_keys_button *button;
@@ -371,6 +372,8 @@ static void gpio_keys_gpio_report_event(struct gpio_button_data *bdata)
 		return;
 	}
 
+	oem_check_force_dump_key(button->code, state);
+
 	if (type == EV_ABS) {
 		if (state)
 			input_event(input, type, button->code, button->value);
diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig
index d853373162c764412e54c5e29b1a034bb19ff786..54d7e97d46337ff32ec4ce49266e288c801cf82e 100644
--- a/drivers/input/misc/Kconfig
+++ b/drivers/input/misc/Kconfig
@@ -900,4 +900,14 @@ config INPUT_HISI_POWERKEY
 	  To compile this driver as a module, choose M here: the
 	  module will be called hisi_powerkey.
 
+config STMVL53L1
+	tristate "STM VL53L1 Proximity support"
+	depends on I2C=y
+	default y
+	help
+	  Say Y here if you want to use STMicroelectronics's vl53L1 TOF AF sensor
+	  through I2C interface.
+
+	  To compile this driver as a module, choose M here: the
+	  module will be called stmvl53l1.
 endif
diff --git a/drivers/input/misc/Makefile b/drivers/input/misc/Makefile
index 137aee4ee2e31a98c8cfa30bf2115164549bf4bc..dcdfb67c73bac06ad7a1de0119875f7e7b8787e2 100644
--- a/drivers/input/misc/Makefile
+++ b/drivers/input/misc/Makefile
@@ -86,3 +86,4 @@ obj-$(CONFIG_INPUT_WM831X_ON)		+= wm831x-on.o
 obj-$(CONFIG_INPUT_XEN_KBDDEV_FRONTEND)	+= xen-kbdfront.o
 obj-$(CONFIG_INPUT_YEALINK)		+= yealink.o
 obj-$(CONFIG_INPUT_IDEAPAD_SLIDEBAR)	+= ideapad_slidebar.o
+obj-$(CONFIG_STMVL53L1)			+= vl53L1/
\ No newline at end of file
diff --git a/drivers/input/misc/qpnp-power-on.c b/drivers/input/misc/qpnp-power-on.c
index 8f25279903ec6040f948d0e8bfc0b05eb980f899..d46bb64cc88f5617f107767aabc038f5d5bedb7b 100644
--- a/drivers/input/misc/qpnp-power-on.c
+++ b/drivers/input/misc/qpnp-power-on.c
@@ -33,6 +33,14 @@
 #include <linux/regulator/machine.h>
 #include <linux/regulator/of_regulator.h>
 
+#include <linux/power/oem_external_fg.h>
+#include <linux/syscalls.h>
+#include <linux/atomic.h>
+#include <linux/oem_force_dump.h>
+#include <linux/param_rw.h>
+#include <linux/oneplus/boot_mode.h>
+#include <linux/oem_force_dump.h>
+
 #define PMIC_VER_8941				0x01
 #define PMIC_VERSION_REG			0x0105
 #define PMIC_VERSION_REV4_REG			0x0103
@@ -193,42 +201,6 @@ struct pon_regulator {
 	bool			enabled;
 };
 
-struct qpnp_pon {
-	struct device		*dev;
-	struct regmap		*regmap;
-	struct input_dev	*pon_input;
-	struct qpnp_pon_config	*pon_cfg;
-	struct pon_regulator	*pon_reg_cfg;
-	struct list_head	list;
-	struct delayed_work	bark_work;
-	struct dentry		*debugfs;
-	u16			base;
-	u8			subtype;
-	u8			pon_ver;
-	u8			warm_reset_reason1;
-	u8			warm_reset_reason2;
-	int			num_pon_config;
-	int			num_pon_reg;
-	int			pon_trigger_reason;
-	int			pon_power_off_reason;
-	u32			dbc_time_us;
-	u32			uvlo;
-	int			warm_reset_poff_type;
-	int			hard_reset_poff_type;
-	int			shutdown_poff_type;
-	int			resin_warm_reset_type;
-	int			resin_hard_reset_type;
-	int			resin_shutdown_type;
-	bool			is_spon;
-	bool			store_hard_reset_reason;
-	bool			resin_hard_reset_disable;
-	bool			resin_shutdown_disable;
-	bool			ps_hold_hard_reset_disable;
-	bool			ps_hold_shutdown_disable;
-	bool			kpdpwr_dbc_enable;
-	bool			resin_pon_reset;
-	ktime_t			kpdpwr_last_release_time;
-};
 
 static int pon_ship_mode_en;
 module_param_named(
@@ -885,6 +857,14 @@ static int qpnp_pon_input_dispatch(struct qpnp_pon *pon, u32 pon_type)
 	switch (cfg->pon_type) {
 	case PON_KPDPWR:
 		pon_rt_bit = QPNP_PON_KPDPWR_N_SET;
+		if ((pon_rt_sts & pon_rt_bit) == 0) {
+			pr_info("Power-Key UP\n");
+			schedule_work(&pon->up_work);
+			cancel_delayed_work(&pon->press_work);
+		} else {
+			pr_info("Power-Key DOWN\n");
+			schedule_delayed_work(&pon->press_work, msecs_to_jiffies(3000));
+		}
 		break;
 	case PON_RESIN:
 		pon_rt_bit = QPNP_PON_RESIN_N_SET;
@@ -921,6 +901,7 @@ static int qpnp_pon_input_dispatch(struct qpnp_pon *pon, u32 pon_type)
 	input_sync(pon->pon_input);
 
 	cfg->old_state = !!key_status;
+	oem_check_force_dump_key(cfg->key_code, key_status);
 
 	return 0;
 }
@@ -1070,6 +1051,87 @@ static void bark_work_func(struct work_struct *work)
 	}
 }
 
+int check_powerkey_count(int press)
+{
+    int ret=0;
+    int param_poweroff_count=0;
+
+    ret = get_param_by_index_and_offset(13, 0x30, &param_poweroff_count,
+        sizeof(param_poweroff_count));
+
+    if(press)
+        param_poweroff_count ++ ;
+    else
+        param_poweroff_count -- ;
+
+    ret = set_param_by_index_and_offset(13, 0x30, &param_poweroff_count,
+        sizeof(param_poweroff_count));
+    pr_info("param_poweroff_count=%d \n",param_poweroff_count);
+    return 0;
+}
+
+int qpnp_powerkey_state_check(struct qpnp_pon *pon,int up)
+{
+    int rc =0;
+
+    if (get_boot_mode() !=  MSM_BOOT_MODE__NORMAL)
+        return 0;
+
+    if ( up ) {
+        rc = atomic_read(&pon->press_count);
+        if (rc < 1) {
+            atomic_inc(&pon->press_count);
+            check_powerkey_count(1);
+        }
+    }
+    else {
+        rc = atomic_read(&pon->press_count);
+        if(rc > 0) {
+            atomic_dec(&pon->press_count);
+            check_powerkey_count(0);
+        }
+    }
+    return 0;
+}
+
+static void up_work_func(struct work_struct *work)
+{
+    struct qpnp_pon *pon =
+        container_of(work, struct qpnp_pon, up_work);
+
+    qpnp_powerkey_state_check(pon,0);
+    return;
+}
+
+static void press_work_func(struct work_struct *work)
+{
+       int rc;
+       uint pon_rt_sts = 0;
+       struct qpnp_pon_config *cfg;
+       struct qpnp_pon *pon =
+               container_of(work, struct qpnp_pon, press_work.work);
+
+       cfg = qpnp_get_cfg(pon, PON_KPDPWR);
+       if (!cfg) {
+               dev_err(pon->dev, "Invalid config pointer\n");
+               goto err_return;
+       }
+       /* check the RT status to get the current status of the line */
+       rc = regmap_read(pon->regmap, QPNP_PON_RT_STS(pon), &pon_rt_sts);
+       if (rc) {
+               dev_err(pon->dev, "Unable to read PON RT status\n");
+               goto err_return;
+       }
+       if ((pon_rt_sts & QPNP_PON_KPDPWR_N_SET) == 1) {
+               qpnp_powerkey_state_check(pon,1);
+               dev_err(pon->dev, "after 3s Power-Key is still DOWN\n");
+        }
+       msleep(20);
+       sys_sync();
+err_return:
+       return;
+}
+
 static irqreturn_t qpnp_resin_bark_irq(int irq, void *_pon)
 {
 	struct qpnp_pon *pon = _pon;
@@ -1100,6 +1162,94 @@ static irqreturn_t qpnp_resin_bark_irq(int irq, void *_pon)
 
 	return IRQ_HANDLED;
 }
+static int qpnp_config_reset(struct qpnp_pon *pon, struct qpnp_pon_config *cfg);
+
+static unsigned int pwr_dump_enabled = -1;
+static unsigned int long_pwr_dump_enabled = -1;
+
+static  int param_set_pwr_dump_enabled(const char *val, const struct kernel_param *kp)
+{
+	unsigned long enable;
+	struct qpnp_pon *pon = sys_reset_dev;
+	struct qpnp_pon_config *cfg = NULL;
+	int rc;
+
+	if (!val || kstrtoul(val, 0, &enable) || enable > 1)
+		return -EINVAL;
+
+	cfg = qpnp_get_cfg(pon, 0); /*0 means pwr key */
+	if (!cfg)
+		return -EINVAL;
+	pr_info("pwr_dump_enabled = %d and request enable = %d\n",
+			pwr_dump_enabled, (unsigned int)enable);
+	if (pwr_dump_enabled != enable) {
+		cfg->s1_timer = 1352; /*reduce this time */
+		cfg->s2_type = 1;/*change s2 type to warm reset*/
+		rc = qpnp_config_reset(pon, cfg);
+
+		/*if we need enable this feature, */
+		/*we should disable wakeup capability */
+		if (enable)
+			disable_irq_wake(cfg->state_irq);
+		else
+			enable_irq_wake(cfg->state_irq);
+		pwr_dump_enabled = enable;
+	}
+	return 0;
+}
+
+static  int param_set_long_press_pwr_dump_enabled
+(const char *val,const struct kernel_param *kp)
+{
+	unsigned long enable;
+	struct qpnp_pon *pon = sys_reset_dev;
+	struct qpnp_pon_config *cfg = NULL;
+	int rc;
+
+	if (!val || kstrtoul(val, 0, &enable) || enable > 1)
+		return -EINVAL;
+
+	cfg = qpnp_get_cfg(pon, PON_KPDPWR); /*0 means pwr key*/
+	if (!cfg)
+		return -EINVAL;
+
+	pr_info("long_pwr_dump_enabled = %d enable = %d s1_timer =%d\n",
+			long_pwr_dump_enabled,
+			(unsigned int)enable, cfg->s1_timer);
+
+	if (long_pwr_dump_enabled != enable) {
+		cfg->support_reset = !!enable;
+		if (enable) {
+			cfg->s1_timer = 10256; /*reduce this time */
+			cfg->s2_timer = 2000;
+			cfg->s2_type = PON_POWER_OFF_TYPE_WARM_RESET; /*change s2 type warm reset*/
+			rc = qpnp_config_reset(pon, cfg);
+
+		} else {
+			/* Disable S2 reset */
+			rc = qpnp_pon_masked_write(pon, cfg->s2_cntl2_addr, QPNP_PON_S2_CNTL_EN,0);
+		}
+		long_pwr_dump_enabled = enable;
+	}
+	return 0;
+}
+static int param_get_long_press_pwr_dump_enabled(char *val, const struct kernel_param *kp)
+{
+	struct qpnp_pon *pon = sys_reset_dev;
+	struct qpnp_pon_config *cfg = NULL;
+
+	cfg = qpnp_get_cfg(pon, PON_KPDPWR); /*0 means pwr key*/
+	if (!cfg)
+		return -EINVAL;
+	return snprintf(val, sizeof(cfg->support_reset), "%d", cfg->support_reset); ;
+}
+
+module_param_call(pwr_dump_enabled,
+param_set_pwr_dump_enabled, param_get_uint, &pwr_dump_enabled, 0644);
+
+module_param_call(long_pwr_dump_enabled,
+param_set_long_press_pwr_dump_enabled,
+param_get_long_press_pwr_dump_enabled, &long_pwr_dump_enabled, 0644);
 
 static int qpnp_config_pull(struct qpnp_pon *pon, struct qpnp_pon_config *cfg)
 {
@@ -1949,6 +2099,191 @@ static int qpnp_pon_read_gen2_pon_off_reason(struct qpnp_pon *pon, u16 *reason,
 	return 0;
 }
 
+static bool created_pwr_on_off_obj;
+
+#define PMIC_SID_NUM 3
+#define QPNP_PON_POFF_BUFFER_SIZE 128
+
+static struct qpnp_pon *g_pon[PMIC_SID_NUM];
+static bool g_is_cold_boot[PMIC_SID_NUM];
+
+static ssize_t pwron_reason_show(struct kobject *kobj,
+		struct kobj_attribute *attr,
+		char *buf)
+{
+	int i;
+	int index;
+	u32 pon_sts = 0;
+	int rc;
+	char *pbuf = buf;
+	int ret = 0;
+
+	snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE, "qpnp_pon_reason :\n");
+	ret += strlen(pbuf);
+	pbuf += strlen(pbuf);
+
+	for (i = 0 ; i < ARRAY_SIZE(qpnp_pon_reason) ; i++) {
+		snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+		"[%d] : %s\n", i, qpnp_pon_reason[i]);
+		ret += strlen(pbuf);
+		pbuf += strlen(pbuf);
+	}
+
+	for (i = 0 ; i < PMIC_SID_NUM ; i++) {
+		 /* PON reason */
+		if (g_pon[i] == NULL || g_pon[i]->regmap == NULL)
+		continue;
+
+		/* PON reason */
+		rc = regmap_read(g_pon[i]->regmap,
+			QPNP_PON_REASON1(g_pon[i]), &pon_sts);
+		if (rc) {
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+				"PMIC@SID%d Unable to read PON_RESASON1 reg and rc: %d\n",
+			to_spmi_device(g_pon[i]->dev)->usid,
+			rc);
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+			continue;
+		}
+
+		index = ffs(pon_sts) - 1;
+		cold_boot = !qpnp_pon_is_warm_reset();
+		if (index >= ARRAY_SIZE(qpnp_pon_reason) || index < 0) {
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"PMIC@SID%d PON_REASON1 regs :[0x%x] and Power-on reason: Unknown and '%s' boot\n",
+			to_spmi_device(g_pon[i]->dev)->usid,
+			pon_sts,
+			cold_boot ? "cold" : "warm");
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+			continue;
+		} else {
+			g_pon[i]->pon_trigger_reason = index;
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"PMIC@SID%d PON_REASON1 regs :[0x%x] and Power-on reason: '%s' boot and ",
+			to_spmi_device(g_pon[i]->dev)->usid,
+			pon_sts,
+			cold_boot ? "cold" : "warm");
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+		}
+
+		for_each_set_bit(index, (unsigned long *)&pon_sts,
+			ARRAY_SIZE(qpnp_pon_reason)) {
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"[%d] ", index);
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+		}
+		snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE, "\n");
+		ret += strlen(pbuf);
+		pbuf += strlen(pbuf);
+	}
+
+	if (ret)
+		*(buf+ret-1) = '\n';
+
+	return ret;
+}
+
+static ssize_t pwroff_reason_show(struct kobject *kobj,
+	struct kobj_attribute *attr,
+	char *buf)
+{
+	int i;
+	int j;
+	int index;
+	int rc;
+	u8 temp_buf[2];
+	u16 poff_sts = 0;
+	char *pbuf = buf;
+	int ret = 0;
+	int reason_index_offset = 0;
+
+	snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE, "qpnp_poff_reason :\n");
+	ret += strlen(pbuf);
+	pbuf += strlen(pbuf);
+
+	for	(j = 0; j < ARRAY_SIZE(qpnp_poff_reason); j++) {
+		snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+		"[%d] : %s\n", j, qpnp_poff_reason[j]);
+		ret += strlen(pbuf);
+		pbuf += strlen(pbuf);
+	}
+
+	for	(i = 0; i < PMIC_SID_NUM; i++) {
+		/* POFF reason */
+		if	(g_pon[i] == NULL || g_pon[i]->regmap == NULL)
+			continue;
+
+		/* POFF reason */
+		if (!is_pon_gen1(g_pon[i]) && g_pon[i]->subtype != PON_1REG) {
+			rc = qpnp_pon_read_gen2_pon_off_reason(g_pon[i], &poff_sts,
+							&reason_index_offset);
+			if (rc)
+				return rc;
+		} else {
+		rc = regmap_bulk_read(g_pon[i]->regmap,
+		QPNP_POFF_REASON1(g_pon[i]),
+		temp_buf, 2);
+			if (rc) {
+				dev_err(g_pon[i]->dev, "Unable to read POFF_REASON regs rc:%d\n",
+					rc);
+				return rc;
+			}
+			poff_sts = temp_buf[0] | (temp_buf[1] << 8);
+		}
+		index = ffs(poff_sts) - 1 + reason_index_offset;
+		if (index >= ARRAY_SIZE(qpnp_poff_reason) || index < 0) {
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"PMIC@SID%d POFF_REASON regs :[0x%x] and Power-off reason: Unknown\n",
+			to_spmi_device(g_pon[i]->dev)->usid,
+			poff_sts);
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+			continue;
+		} else {
+			snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"PMIC@SID%d POFF_REASON regs :[0x%x] and Power-off reason: ",
+			to_spmi_device(g_pon[i]->dev)->usid,
+			poff_sts);
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+		}
+		if (index < ARRAY_SIZE(qpnp_poff_reason) && index >= 0) {
+		snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE,
+			"[%d] ", index);
+			ret += strlen(pbuf);
+			pbuf += strlen(pbuf);
+		}
+		snprintf(pbuf, QPNP_PON_POFF_BUFFER_SIZE, "\n");
+		ret += strlen(pbuf);
+		pbuf += strlen(pbuf);
+	}
+
+	if (ret)
+		*(buf+ret-1) = '\n';
+
+	return ret;
+}
+
+static struct kobj_attribute pwron_reason_attribute =
+	__ATTR(pwron_reason, 0444, pwron_reason_show, NULL);
+static struct kobj_attribute pwroff_reason_attribute =
+	__ATTR(pwroff_reason, 0444, pwroff_reason_show, NULL);
+
+static struct attribute *pwr_on_off_attrs[] = {
+		&pwron_reason_attribute.attr,
+		&pwroff_reason_attribute.attr,
+		NULL,
+};
+
+static struct attribute_group pwr_on_off_attrs_group = {
+		.attrs = pwr_on_off_attrs,
+};
+static struct kobject *pwr_on_off_kobj;
+
 static int qpnp_pon_configure_s3_reset(struct qpnp_pon *pon)
 {
 	struct device *dev = pon->dev;
@@ -2020,8 +2355,18 @@ static int qpnp_pon_read_hardware_info(struct qpnp_pon *pon, bool sys_reset)
 	int reason_index_offset = 0;
 	unsigned int pon_sts = 0;
 	u16 poff_sts = 0;
-	int rc, index;
+	int rc, index, i;
 
+	for (i = 0; i < 16; i++) {
+		rc = regmap_read(pon->regmap, ((pon)->base + 0xC0+i), &reg);
+		dev_info(pon->dev, "(0x%x:0x%x)\n",
+			((pon)->base + 0xC0+i), reg);
+		if (rc) {
+			dev_err(pon->dev, "Unable to read addr=0x%x, rc(%d)\n",
+			((pon)->base + 0xC0+i), rc);
+			return rc;
+		}
+	}
 	/* Read PON_PERPH_SUBTYPE register to get PON type */
 	rc = qpnp_pon_read(pon, QPNP_PON_PERPH_SUBTYPE(pon), &reg);
 	if (rc)
@@ -2064,18 +2409,24 @@ static int qpnp_pon_read_hardware_info(struct qpnp_pon *pon, bool sys_reset)
 		boot_reason = ffs(pon_sts);
 
 	index = ffs(pon_sts) - 1;
-	cold_boot = sys_reset_dev ? !_qpnp_pon_is_warm_reset(sys_reset_dev)
-				  : !_qpnp_pon_is_warm_reset(pon);
-	if (index >= ARRAY_SIZE(qpnp_pon_reason) || index < 0) {
-		dev_info(dev, "PMIC@SID%d Power-on reason: Unknown and '%s' boot\n",
-			 to_spmi_device(dev->parent)->usid,
-			 cold_boot ? "cold" : "warm");
-	} else {
-		pon->pon_trigger_reason = index;
-		dev_info(dev, "PMIC@SID%d Power-on reason: %s and '%s' boot\n",
-			 to_spmi_device(dev->parent)->usid,
-			 qpnp_pon_reason[index],
-			 cold_boot ? "cold" : "warm");
+	cold_boot = !qpnp_pon_is_warm_reset();
+	for_each_set_bit(index, (unsigned long *)&pon_sts,
+		ARRAY_SIZE(qpnp_pon_reason)) {
+		if (index >= ARRAY_SIZE(qpnp_pon_reason) || index < 0) {
+			dev_info(pon->dev,
+				"PMIC@SID%d PON_REASON1 regs :[0x%x] and Power-on reason: Unknown and '%s' boot\n",
+				to_spmi_device(pon->dev)->usid,
+				pon_sts,
+				cold_boot ? "cold" : "warm");
+		} else {
+			pon->pon_trigger_reason = index;
+			dev_info(pon->dev,
+				"PMIC@SID%d PON_REASON1 regs :[0x%x] and Power-on reason: %s and '%s' boot\n",
+				to_spmi_device(pon->dev)->usid,
+				pon_sts,
+				qpnp_pon_reason[index],
+				cold_boot ? "cold" : "warm");
+		}
 	}
 
 	/* POFF reason */
@@ -2094,15 +2445,29 @@ static int qpnp_pon_read_hardware_info(struct qpnp_pon *pon, bool sys_reset)
 		}
 		poff_sts = buf[0] | (buf[1] << 8);
 	}
+
+
 	index = ffs(poff_sts) - 1 + reason_index_offset;
 	if (index >= ARRAY_SIZE(qpnp_poff_reason) || index < 0) {
-		dev_info(dev, "PMIC@SID%d: Unknown power-off reason\n",
-			 to_spmi_device(dev->parent)->usid);
+		dev_info(pon->dev,
+			"PMIC@SID%d: POFF_REASON regs :[0x%x] and Unknown Power-off reason\n",
+			to_spmi_device(pon->dev)->usid,
+			poff_sts);
 	} else {
 		pon->pon_power_off_reason = index;
-		dev_info(dev, "PMIC@SID%d: Power-off reason: %s\n",
-			 to_spmi_device(dev->parent)->usid,
-			 qpnp_poff_reason[index]);
+		dev_info(pon->dev,
+			"PMIC@SID%d: POFF_REASON regs :[0x%x] and Power-off reason: %s\n",
+			to_spmi_device(pon->dev)->usid,
+			poff_sts,
+			qpnp_poff_reason[index]);
+	}
+
+
+	if (to_spmi_device(pon->dev)->usid < PMIC_SID_NUM) {
+		g_pon[to_spmi_device(pon->dev)->usid] = pon;
+		g_is_cold_boot[to_spmi_device(pon->dev)->usid] =
+			cold_boot;
+
 	}
 
 	if ((pon->pon_trigger_reason == PON_SMPL ||
@@ -2110,7 +2475,6 @@ static int qpnp_pon_read_hardware_info(struct qpnp_pon *pon, bool sys_reset)
 	    of_property_read_bool(dev->of_node, "qcom,uvlo-panic")) {
 		panic("UVLO occurred");
 	}
-
 	return 0;
 }
 
@@ -2235,10 +2599,11 @@ static int qpnp_pon_probe(struct platform_device *pdev)
 			return -EINVAL;
 		}
 	}
-	dev_dbg(dev, "PON@SID%d: num_pon_config=%d, num_pon_reg=%d\n",
+	dev_err(dev, "PON@SID%d: num_pon_config=%d, num_pon_reg=%d\n",
 		to_spmi_device(dev->parent)->usid, pon->num_pon_config,
 		pon->num_pon_reg);
-
+	if (to_spmi_device(dev->parent)->usid == 0)
+		op_pm8998_regmap_register(pon->regmap);
 	rc = qpnp_pon_read_hardware_info(pon, sys_reset);
 	if (rc)
 		return rc;
@@ -2255,6 +2620,9 @@ static int qpnp_pon_probe(struct platform_device *pdev)
 
 	INIT_DELAYED_WORK(&pon->bark_work, bark_work_func);
 
+	INIT_DELAYED_WORK(&pon->press_work, press_work_func);
+	INIT_WORK(&pon->up_work, up_work_func);
+
 	rc = qpnp_pon_parse_dt_power_off_config(pon);
 	if (rc)
 		return rc;
@@ -2295,6 +2663,19 @@ static int qpnp_pon_probe(struct platform_device *pdev)
 	if (rc)
 		return rc;
 
+	if (!created_pwr_on_off_obj) {
+		pwr_on_off_kobj = kobject_create_and_add("pwr_on_off_reason",
+		NULL);
+		if (!pwr_on_off_kobj)
+			dev_err(&pdev->dev, "kobject_create_and_add for pwr_on_off_reason failed.\n");
+		else if (sysfs_create_group(pwr_on_off_kobj,
+			&pwr_on_off_attrs_group)) {
+			dev_err(&pdev->dev, "sysfs_create_group for pwr_on_off_reason failed.\n");
+			kobject_put(pwr_on_off_kobj);
+		}
+		created_pwr_on_off_obj = true;
+	}
+
 	rc = device_create_file(dev, &dev_attr_debounce_us);
 	if (rc) {
 		dev_err(dev, "sysfs debounce file creation failed, rc=%d\n",
diff --git a/drivers/input/misc/qti-haptics.c b/drivers/input/misc/qti-haptics.c
index c9b4997dd80a0ee271882b0c99e478b5cf629479..39c60ef98a80335d09a71a8489db80e4c693748e 100644
--- a/drivers/input/misc/qti-haptics.c
+++ b/drivers/input/misc/qti-haptics.c
@@ -29,6 +29,9 @@
 #include <linux/slab.h>
 #include <linux/types.h>
 #include <linux/uaccess.h>
+#include <linux/proc_fs.h>
+
+struct qti_hap_chip *g_qti_chip;
 
 enum actutor_type {
 	ACT_LRA,
@@ -59,6 +62,8 @@ enum haptics_custom_effect_param {
 	CUSTOM_DATA_LEN,
 };
 
+#define REG_HAP_LRA_AUTO_RES	0x0B
+
 /* common definitions */
 #define HAP_BRAKE_PATTERN_MAX		4
 #define HAP_WAVEFORM_BUFFER_MAX		8
@@ -72,6 +77,7 @@ enum haptics_custom_effect_param {
 #define HAP_SC_DET_TIME_US		1000000
 #define FF_EFFECT_COUNT_MAX		32
 #define HAP_DISABLE_DELAY_USEC		1000
+#define HAP_VMAX_MV_WAEK		1000 /*OP set weak vibraton vmax*/
 
 /* haptics module register definitions */
 #define REG_HAP_STATUS1			0x0A
@@ -231,8 +237,11 @@ struct qti_hap_chip {
 	bool				perm_disable;
 	bool				play_irq_en;
 	bool				vdd_enabled;
+	bool				test_mode;
+	int				resonant_frequency;
 };
 
+
 static int wf_repeat[8] = {1, 2, 4, 8, 16, 32, 64, 128};
 static int wf_s_repeat[4] = {1, 2, 4, 8};
 
@@ -484,7 +493,10 @@ static int qti_haptics_config_vmax(struct qti_hap_chip *chip, int vmax_mv)
 
 	addr = REG_HAP_VMAX_CFG;
 	mask = HAP_VMAX_MV_MASK;
-	val = (vmax_mv / HAP_VMAX_MV_LSB) << HAP_VMAX_MV_SHIFT;
+	if (chip->test_mode)/*op for factory test*/
+		val = (2820 / HAP_VMAX_MV_LSB) << HAP_VMAX_MV_SHIFT;
+	else
+		val = (vmax_mv / HAP_VMAX_MV_LSB) << HAP_VMAX_MV_SHIFT;
 	rc = qti_haptics_masked_write(chip, addr, mask, val);
 	if (rc < 0)
 		dev_err(chip->dev, "write VMAX_CFG failed, rc=%d\n",
@@ -516,16 +528,27 @@ static int qti_haptics_config_play_rate_us(struct qti_hap_chip *chip,
 						int play_rate_us)
 {
 	u8 addr, val[2];
-	int tmp, rc;
+	int tmp, rc ;
 
 	addr = REG_HAP_RATE_CFG1;
 	tmp = play_rate_us / HAP_PLAY_RATE_US_LSB;
 	val[0] = tmp & 0xff;
 	val[1] = (tmp >> 8) & 0xf;
-	rc = qti_haptics_write(chip, addr, val, 2);
-	if (rc < 0)
-		dev_err(chip->dev, "write play_rate failed, rc=%d\n", rc);
 
+	if (true){/*op for use check rf*/
+		rc = qti_haptics_read(chip, REG_HAP_LRA_AUTO_RES, val, 2);
+		if (rc < 0)
+			dev_err(chip->dev, "read lra_auto_res failed, rc=%d\n", rc);
+		dev_info(chip->dev, "haptic val[0]=0x%x,val[1]=0x%x",val[0],val[1]);
+		val[1] = ((val[1] & 0xF0) >> 4);
+		rc = qti_haptics_write(chip, addr, val, 2);
+		if (rc < 0)
+			dev_err(chip->dev, "write play_rate failed, rc=%d\n", rc);
+	} else {
+		rc = qti_haptics_write(chip, addr, val, 2);
+		if (rc < 0)
+			dev_err(chip->dev, "write play_rate failed, rc=%d\n", rc);
+	}
 	return rc;
 }
 
@@ -576,6 +599,7 @@ static int qti_haptics_lra_auto_res_enable(struct qti_hap_chip *chip, bool en)
 	addr = REG_HAP_AUTO_RES_CTRL;
 	mask = HAP_AUTO_RES_EN_BIT;
 	val = en ? HAP_AUTO_RES_EN_BIT : 0;
+	val = 0;/*op force disable AUTIO RES*/
 	rc = qti_haptics_masked_write(chip, addr, mask, val);
 	if (rc < 0)
 		dev_err(chip->dev, "set AUTO_RES_CTRL failed, rc=%d\n", rc);
@@ -600,12 +624,15 @@ static int qti_haptics_clear_settings(struct qti_hap_chip *chip)
 	rc = qti_haptics_config_play_rate_us(chip, HAP_CLEAR_PLAYING_RATE_US);
 	if (rc < 0)
 		return rc;
-
 	rc = qti_haptics_write(chip, REG_HAP_WF_S1, pattern,
 			HAP_WAVEFORM_BUFFER_MAX);
 	if (rc < 0)
 		return rc;
-
+/*GCEB-243 abnormal vibration begin*/
+	rc = qti_haptics_config_vmax(chip, HAP_VMAX_MV_WAEK);
+	if (rc < 0)
+		return rc;
+/*GCEB-243 abnormal vibration end*/
 	rc = qti_haptics_play(chip, true);
 	if (rc < 0)
 		return rc;
@@ -849,7 +876,7 @@ static int qti_haptics_upload_effect(struct input_dev *dev,
 		level = effect->u.constant.level;
 		tmp = level * config->vmax_mv;
 		play->vmax_mv = tmp / 0x7fff;
-		dev_dbg(chip->dev, "upload constant effect, length = %dus, vmax_mv=%d\n",
+		dev_info(chip->dev, "upload constant effect, length = %dus, vmax_mv=%d\n",
 				play->length_us, play->vmax_mv);
 
 		rc = qti_haptics_load_constant_waveform(chip);
@@ -888,7 +915,7 @@ static int qti_haptics_upload_effect(struct input_dev *dev,
 		tmp = level * chip->predefined[i].vmax_mv;
 		play->vmax_mv = tmp / 0x7fff;
 
-		dev_dbg(chip->dev, "upload effect %d, vmax_mv=%d\n",
+		dev_info(chip->dev, "upload effect %d, vmax_mv=%d\n",
 				chip->predefined[i].id, play->vmax_mv);
 		rc = qti_haptics_load_predefined_effect(chip, i);
 		if (rc < 0) {
@@ -940,7 +967,7 @@ static int qti_haptics_playback(struct input_dev *dev, int effect_id, int val)
 	unsigned long nsecs;
 	int rc = 0;
 
-	dev_dbg(chip->dev, "playback, val = %d\n", val);
+	dev_info(chip->dev, "playback, val = %d\n", val);
 	if (!!val) {
 		rc = qti_haptics_module_en(chip, true);
 		if (rc < 0)
@@ -1835,6 +1862,94 @@ static int qti_haptics_add_debugfs(struct qti_hap_chip *chip)
 }
 #endif
 
+#define PAGESIZE 512
+
+static ssize_t op_haptic_read(struct file *file,
+			char __user *user_buf, size_t count, loff_t *ppos)
+{
+	return 0;
+}
+
+static ssize_t op_haptic_write(struct file *file,
+			const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char buf[4] = {0};
+
+	if (!g_qti_chip)
+		return ret;
+	if (count > 2)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		pr_err("%s: write proc haptic error.\n", __func__);
+		return count;
+	}
+
+	if (-1 == sscanf(buf, "%d", &ret)) {
+		pr_err("%s sscanf error\n", __func__);
+		return count;
+	}
+
+	if ((ret == 0) || (ret == 1))
+		g_qti_chip->test_mode = ret;
+	pr_info("%s:haptic g_qti_chip->test_mode is = %d\n",
+			__func__,g_qti_chip->test_mode);
+	return count;
+}
+
+static const struct file_operations qit_haptic_operations = {
+	.read = op_haptic_read,
+	.write = op_haptic_write,
+};
+
+static void init_op_haptic_node(void)
+{
+	if (!proc_create("qti_haptic", 0644, NULL,
+			 &qit_haptic_operations))
+		pr_err("Failed to register haptic  node\n");
+}
+
+static ssize_t op_haptic_rf_read(struct file *file,
+			char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0, tmp = 0;
+	char page[PAGESIZE];
+	u8 val[2];
+
+	if (!g_qti_chip)
+		return ret;
+	ret= qti_haptics_read(g_qti_chip, REG_HAP_LRA_AUTO_RES, val, 2);
+	if (ret < 0)
+		dev_err(g_qti_chip->dev, "read lra_auto_res failed, rc=%d\n", ret);
+	val[1] = ((val[1] & 0xF0) >> 4);
+	tmp = (val[1] << 8) | (val[0] & 0xFF);
+	g_qti_chip->resonant_frequency = ((19200/96)*1000)/tmp;
+	dev_info(g_qti_chip->dev, "resonant_frequency=%d\n", g_qti_chip->resonant_frequency);
+	ret = snprintf(page, 255, "%d", g_qti_chip->resonant_frequency);
+	ret = simple_read_from_buffer(user_buf,
+			count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t op_haptic_rf_write(struct file *file,
+			const char __user *buffer, size_t count, loff_t *ppos)
+{
+	return 0;
+}
+
+static const struct file_operations qit_haptic_rf_operations = {
+	.read = op_haptic_rf_read,
+	.write = op_haptic_rf_write,
+};
+
+static void init_op_haptic_rf_node(void)
+{
+	if (!proc_create("qti_haptic_rf", 0644, NULL,
+			 &qit_haptic_rf_operations))
+		pr_err("Failed to register haptic  node\n");
+}
+
 static int qti_haptics_probe(struct platform_device *pdev)
 {
 	struct qti_hap_chip *chip;
@@ -1857,7 +1972,7 @@ static int qti_haptics_probe(struct platform_device *pdev)
 		dev_err(chip->dev, "Failed to get regmap handle\n");
 		return -ENXIO;
 	}
-
+	g_qti_chip = chip;
 	rc = qti_haptics_parse_dt(chip);
 	if (rc < 0) {
 		dev_err(chip->dev, "parse device-tree failed, rc=%d\n", rc);
@@ -1937,6 +2052,10 @@ static int qti_haptics_probe(struct platform_device *pdev)
 	if (rc < 0)
 		dev_dbg(chip->dev, "create debugfs failed, rc=%d\n", rc);
 #endif
+	init_op_haptic_node();
+	init_op_haptic_rf_node();
+	pr_info("qti_haptics_probe done\n");
+
 	return 0;
 
 destroy_ff:
diff --git a/drivers/input/misc/vl53L1/Kbuild b/drivers/input/misc/vl53L1/Kbuild
new file mode 100644
index 0000000000000000000000000000000000000000..034707c47683e0bc19345210128b6a139f1bb0b4
--- /dev/null
+++ b/drivers/input/misc/vl53L1/Kbuild
@@ -0,0 +1,30 @@
+#
+# Kbuild for the vl53L1 drivers.
+#
+
+ccflags-y	+= -I$(src)/inc -I$(src)/ipp -I$(src)
+ccflags-y += -Idrivers/media/platform/msm/camera/cam_sensor_module/cam_cci
+
+# define this environment variable if you want to compile driver for an old
+# kernel
+ifdef OLD_NETLINK_API
+ccflags-y	+= -DOLD_NETLINK_API
+endif
+
+ifdef VL53L1_LOG_ENABLE
+ccflags-y	+= -DVL53L1_LOG_ENABLE
+endif
+
+obj-$(CONFIG_STMVL53L1)	+= stmvl53l1.o
+stmvl53l1-objs		:= stmvl53l1_module.o stmvl53l1_module-i2c.o stmvl53l1_module-cci.o
+stmvl53l1-objs		+= stmvl53l1_i2c.o stmvl53l1_ipp_nl.o stmvl53l1_log.o
+stmvl53l1-objs		+= src/vl53l1_api.o src/vl53l1_api_core.o
+stmvl53l1-objs		+= src/vl53l1_api_strings.o src/vl53l1_error_strings.o
+stmvl53l1-objs		+= src/vl53l1_core.o src/vl53l1_register_funcs.o
+stmvl53l1-objs		+= src/vl53l1_api_preset_modes.o
+stmvl53l1-objs		+= src/vl53l1_api_calibration.o
+stmvl53l1-objs		+= src/vl53l1_silicon_core.o
+stmvl53l1-objs		+= src/vl53l1_zone_presets.o src/vl53l1_nvm.o
+stmvl53l1-objs		+= src/vl53l1_api_debug.o src/vl53l1_core_support.o
+stmvl53l1-objs		+= src/vl53l1_wait.o ipp/ipp_linux.o
+stmvl53l1-objs		+= src/vl53l1_nvm_debug.o
diff --git a/drivers/input/misc/vl53L1/Makefile b/drivers/input/misc/vl53L1/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..4dd06f8d49f8d39e9d778e00425c29a30a2eee56
--- /dev/null
+++ b/drivers/input/misc/vl53L1/Makefile
@@ -0,0 +1,12 @@
+ifneq ($(KERNELRELEASE),)
+include Kbuild
+
+else
+KDIR ?= /lib/modules/`uname -r`/build
+
+default:
+	CONFIG_STMVL53L1=m $(MAKE) -C $(KDIR) M=$$PWD
+clean:
+	CONFIG_STMVL53L1=m $(MAKE) -C $(KDIR) M=$$PWD clean
+
+endif
\ No newline at end of file
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api.h b/drivers/input/misc/vl53L1/inc/vl53l1_api.h
new file mode 100644
index 0000000000000000000000000000000000000000..fb24dfb0baaadc9d788cdee16824b8a8710759af
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api.h
@@ -0,0 +1,1432 @@
+
+/******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+ ******************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+ *******************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+ *******************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones mentioned above :
+
+ *******************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+ *******************************************************************************
+ */
+
+#ifndef _VL53L1_API_H_
+#define _VL53L1_API_H_
+
+#include "vl53l1_api_strings.h"
+#include "vl53l1_api_core.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#if !defined(VL53L1DevDataGet)
+#warning "PALDevDataGet is deprecated define VL53L1DevDataGet instead"
+#define VL53L1DevDataGet(Dev, field) (Dev->Data.field)
+#endif
+
+#if !defined(VL53L1DevDataSet)
+#warning "PALDevDataSet is deprecated define VL53L1DevDataSet instead"
+#define VL53L1DevDataSet(Dev, field, data) ((Dev->Data.field) = (data))
+#endif
+
+/** @defgroup VL53L1_cut11_group VL53L1 cut1.1 Function Definition
+ *  @brief    VL53L1 cut1.1 Function Definition
+ *  @{
+ */
+
+/** @defgroup VL53L1_general_group VL53L1 General Functions
+ *  @brief    General functions and definitions
+ *  @{
+ */
+
+/**
+ * @brief Return the VL53L1 driver Version
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   pVersion              Rer to current driver Version
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetVersion(VL53L1_Version_t *pVersion);
+
+/**
+ * @brief Reads the Product Revision for a for given Device
+ * This function can be used to distinguish cut1.0 from cut1.1.
+ *
+ * @param   Dev                 Device Handle
+ * @param   pProductRevisionMajor  Pointer to Product Revision Major
+ * for a given Device
+ * @param   pProductRevisionMinor  Pointer to Product Revision Minor
+ * for a given Device
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetProductRevision(VL53L1_DEV Dev,
+	uint8_t *pProductRevisionMajor, uint8_t *pProductRevisionMinor);
+
+/**
+ * @brief Reads the Device information for given Device
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                 Device Handle
+ * @param   pVL53L1_DeviceInfo  Pointer to current device info for a given
+ *  Device
+ * @return  VL53L1_ERROR_NONE   Success
+ * @return  "Other error code"  See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetDeviceInfo(VL53L1_DEV Dev,
+	VL53L1_DeviceInfo_t *pVL53L1_DeviceInfo);
+
+/**
+ * @brief Human readable Range Status string for a given RangeStatus
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   RangeStatus         The RangeStatus code as stored on
+ * @a VL53L1_RangingMeasurementData_t
+ * @param   pRangeStatusString  The returned RangeStatus string. Shall be
+ * defined as char buf[VL53L1_MAX_STRING_LENGTH]
+ * @return  VL53L1_ERROR_NONE   Success
+ * @return  "Other error code"  See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetRangeStatusString(uint8_t RangeStatus,
+	char *pRangeStatusString);
+
+/**
+ * @brief Human readable error string for driver error status
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   PalErrorCode       The error code as stored on @a VL53L1_Error
+ * @param   pPalErrorString    The error string corresponding to the
+ * PalErrorCode. Shall be defined as char buf[VL53L1_MAX_STRING_LENGTH]
+ * @return  VL53L1_ERROR_NONE  Success
+ * @return  "Other error code" See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetPalErrorString(VL53L1_Error PalErrorCode,
+	char *pPalErrorString);
+
+/**
+ * @brief Human readable driver State string
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   PalStateCode          The State code as stored on @a VL53L1_State
+ * @param   pPalStateString       The State string corresponding to the
+ * PalStateCode. Shall be defined as char buf[VL53L1_MAX_STRING_LENGTH]
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetPalStateString(VL53L1_State PalStateCode,
+	char *pPalStateString);
+
+/**
+ * @brief Reads the internal state of the driver for a given Device
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   Dev                   Device Handle
+ * @param   pPalState             Pointer to current state of the PAL for a
+ * given Device
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetPalState(VL53L1_DEV Dev,
+	VL53L1_State *pPalState);
+
+
+
+/** @} VL53L1_general_group */
+
+/** @defgroup VL53L1_init_group VL53L1 Init Functions
+ *  @brief    VL53L1 Init Functions
+ *  @{
+ */
+
+/**
+ * @brief Set new device address
+ *
+ * After completion the device will answer to the new address programmed.
+ * This function should be called when several devices are used in parallel
+ * before start programming the sensor.
+ * When a single device us used, there is no need to call this function.
+ *
+ * When it is requested for multi devices system this function MUST be called
+ * prior to VL53L1_DataInit()
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                   Device Handle
+ * @param   DeviceAddress         The new Device address
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetDeviceAddress(VL53L1_DEV Dev,
+	uint8_t DeviceAddress);
+
+/**
+ *
+ * @brief One time device initialization
+ *
+ * To be called once and only once after device is brought out of reset
+ * (Chip enable) and booted see @a VL53L1_WaitDeviceBooted()
+ *
+ * @par Function Description
+ * When not used after a fresh device "power up" or reset, it may return
+ * @a #VL53L1_ERROR_CALIBRATION_WARNING meaning wrong calibration data
+ * may have been fetched from device that can result in ranging offset error\n
+ * If application cannot execute device reset or need to run VL53L1_DataInit
+ * multiple time then it  must ensure proper offset calibration saving and
+ * restore on its own by using @a VL53L1_GetOffsetCalibrationData() on first
+ * power up and then @a VL53L1_SetOffsetCalibrationData() in all subsequent init
+ * This function will change the VL53L1_State from VL53L1_STATE_POWERDOWN to
+ * VL53L1_STATE_WAIT_STATICINIT.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                   Device Handle
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_DataInit(VL53L1_DEV Dev);
+
+
+/**
+ * @brief Do basic device init (and eventually patch loading)
+ * This function will change the VL53L1_State from
+ * VL53L1_STATE_WAIT_STATICINIT to VL53L1_STATE_IDLE.
+ * In this stage all default setting will be applied.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                   Device Handle
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_StaticInit(VL53L1_DEV Dev);
+
+/**
+ * @brief Wait for device booted after chip enable (hardware standby)
+ * This function can be run only when VL53L1_State is VL53L1_STATE_POWERDOWN.
+ *
+ * @param   Dev      Device Handle
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ *
+ */
+VL53L1_Error VL53L1_WaitDeviceBooted(VL53L1_DEV Dev);
+
+
+/** @} VL53L1_init_group */
+
+/** @defgroup VL53L1_parameters_group VL53L1 Parameters Functions
+ *  @brief    Functions used to prepare and setup the device
+ *  @{
+ */
+
+/**
+ * @brief  Set a new Preset Mode
+ * @par Function Description
+ * Set device to a new Operating Mode (High speed ranging, Multi objects ...)
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @warning This function change the timing budget to 16 ms and the inter-
+ * measurement period to 1000 ms. Also the VL53L1_DISTANCEMODE_LONG is used.
+ *
+ * @param   Dev                   Device Handle
+ * @param   PresetMode            New Preset mode to apply
+ * <br>Valid values are:
+ */
+/**
+ * @li VL53L1_PRESETMODE_MULTIZONES_SCANNING
+ * @li VL53L1_PRESETMODE_RANGING
+ * @li VL53L1_PRESETMODE_AUTONOMOUS
+ * @li VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS
+ * @li VL53L1_PRESETMODE_LITE_RANGING
+ * @li VL53L1_PRESETMODE_OLT
+ */
+/**
+ *
+ * @return  VL53L1_ERROR_NONE               Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED This error occurs when PresetMode is
+ *                                          not in the supported list
+ */
+VL53L1_Error VL53L1_SetPresetMode(VL53L1_DEV Dev,
+		VL53L1_PresetModes PresetMode);
+
+/**
+ * @brief  Get current Preset Mode
+ * @par Function Description
+ * Get actual mode of the device(ranging, histogram ...)
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @param   Dev                   Device Handle
+ * @param   pPresetMode           Pointer to current apply mode value
+ *
+ * @return  VL53L1_ERROR_NONE                   Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED     This error occurs when
+ * DeviceMode is not in the supported list
+ */
+VL53L1_Error VL53L1_GetPresetMode(VL53L1_DEV Dev,
+		VL53L1_PresetModes *pPresetMode);
+
+
+/**
+ * @brief  Set the distance mode
+ * @par Function Description
+ * Set the distance mode to be used for the next ranging.<br>
+ * The modes Short, Medium and Long are used to optimize the ranging accuracy
+ * in a specific range of distance.<br> The user select one of these modes to
+ * select the distance range. <br>
+ * Two additional modes are supported: AUTO and AUTO_LITE the difference between
+ * these modes is the following.<br>
+ * The mode AUTO take into account both the ranging distance (RangeMilliMeter)
+ * and the dmax distance (DmaxMilliMeter).<br> The algorithm uses the ranging
+ * distance when the range status is ok and uses the dmax distance when the
+ * range status is not ok.<br>
+ * The AUTO_LITE take into account only the ranging distance, so nothing is done
+ * in case of range error i.e. the distance mode will not be changed.
+ * @note This function doesn't Access to the device
+ *
+ * @warning This function should be called after @a VL53L1_SetPresetMode().
+
+ * @param   Dev                   Device Handle
+ * @param   DistanceMode          Distance mode to apply valid values are:
+ * @li VL53L1_DISTANCEMODE_SHORT
+ * @li VL53L1_DISTANCEMODE_MEDIUM
+ * @li VL53L1_DISTANCEMODE_LONG
+ * @li VL53L1_DISTANCEMODE_AUTO_LITE
+ * @li VL53L1_DISTANCEMODE_AUTO
+ * @return  VL53L1_ERROR_NONE               Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED This error occurs when DistanceMode
+ *                                          is not in the supported list
+ * @return  "Other error code"              See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetDistanceMode(VL53L1_DEV Dev,
+		VL53L1_DistanceModes DistanceMode);
+
+/**
+ * @brief  Get the distance mode
+ * @par Function Description
+ * Get the distance mode used for the next ranging.
+ *
+ * @param   Dev                   Device Handle
+ * @param   *pDistanceMode        Pointer to Distance mode
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetDistanceMode(VL53L1_DEV Dev,
+		VL53L1_DistanceModes *pDistanceMode);
+
+
+/**
+ * @brief  Set the output mode
+ * @par Function Description
+ * Set the output mode to be used for the next ranging. The output mode is used
+ * to select, in case of multiple objects, which one will be used in
+ * function @a VL53L1_GetRangingMeasurementData().
+ * VL53L1_SetOutputMode also sets the object used by automatic
+ * distance mode algorithm when @a VL53L1_SetDistanceMode() is
+ * set to automatic mode.
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @warning This function should be called after @a VL53L1_SetPresetMode().
+
+ * @param   Dev                   Device Handle
+ * @param   OutputMode            Output mode to apply valid values are:
+ * @li VL53L1_OUTPUTMODE_NEAREST
+ * @li VL53L1_OUTPUTMODE_STRONGEST
+ *
+ * @return  VL53L1_ERROR_NONE               Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED This error occurs when OutputMode
+ *                                          is not in the supported list
+ * @return  "Other error code"              See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetOutputMode(VL53L1_DEV Dev,
+		VL53L1_OutputModes OutputMode);
+
+/**
+ * @brief  Get the output mode
+ * @par Function Description
+ * Get the output mode used for the next ranging.
+ *
+ * @param   Dev                   Device Handle
+ * @param   *pOutputMode          Pointer to Output mode
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetOutputMode(VL53L1_DEV Dev,
+		VL53L1_OutputModes *pOutputMode);
+
+
+/**
+ * @brief Set Ranging Timing Budget in microseconds
+ *
+ * @par Function Description
+ * Defines the maximum time allowed by the user to the device to run a
+ * full ranging sequence for the current mode (ranging, histogram, ASL ...)
+ *
+ * @param   Dev                                Device Handle
+ * @param MeasurementTimingBudgetMicroSeconds  Max measurement time in
+ * microseconds.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS  Error timing parameter not
+ *                                       supported.
+ *                                       The maximum accepted value for the
+ *                                       computed timing budget is 10 seconds
+ *                                       the minimum value depends on the preset
+ *                                       mode selected.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetMeasurementTimingBudgetMicroSeconds(
+	VL53L1_DEV Dev, uint32_t MeasurementTimingBudgetMicroSeconds);
+
+/**
+ * @brief Get Ranging Timing Budget in microseconds
+ *
+ * @par Function Description
+ * Returns the programmed the maximum time allowed by the user to the
+ * device to run a full ranging sequence for the current mode
+ * (ranging, histogram, ASL ...)
+ *
+ * @param   Dev                                    Device Handle
+ * @param   pMeasurementTimingBudgetMicroSeconds   Max measurement time in
+ * microseconds.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetMeasurementTimingBudgetMicroSeconds(
+	VL53L1_DEV Dev, uint32_t *pMeasurementTimingBudgetMicroSeconds);
+
+
+/**
+ * Program continuous mode Inter-Measurement period in milliseconds
+ *
+ * @par Function Description
+ * When trying to set too short time return  INVALID_PARAMS minimal value
+ *
+ * @param   Dev                                  Device Handle
+ * @param   InterMeasurementPeriodMilliSeconds   Inter-Measurement Period in ms.
+ *  this value should be greater than the duration set in
+ *  @a VL53L1_SetMeasurementTimingBudgetMicroSeconds() to ensure smooth ranging
+ *  operation.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetInterMeasurementPeriodMilliSeconds(
+	VL53L1_DEV Dev, uint32_t InterMeasurementPeriodMilliSeconds);
+
+/**
+ * Get continuous mode Inter-Measurement period in milliseconds
+ *
+ * @par Function Description
+ *
+ * @param   Dev                                  Device Handle
+ * @param   pInterMeasurementPeriodMilliSeconds  Pointer to programmed
+ *  Inter-Measurement Period in milliseconds.
+ * @return  VL53L1_ERROR_NONE
+ */
+VL53L1_Error VL53L1_GetInterMeasurementPeriodMilliSeconds(
+	VL53L1_DEV Dev, uint32_t *pInterMeasurementPeriodMilliSeconds);
+
+/**
+ * @brief  target reflectance for Dmax setting
+ * @par Function Description
+ * Allow user to set the value for target reflectance @ 940nm to calculate the
+ * ambient DMAX values for. Set to 50% by default by @a VL53L1_DataInit()
+ *
+ * @param   Dev                   Device Handle
+ * @param   DmaxReflectance       Reflectance % in 16.16 fixed point
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS     in case input value is not in range
+ * from 0 to 100. Note that this is a fix point value so the max value is
+ * 100 * 65536.
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetDmaxReflectance(VL53L1_DEV Dev,
+		FixPoint1616_t DmaxReflectance);
+
+/**
+ * @brief  Get target reflectance for Dmax
+ * @par Function Description
+ * Retrieves the value for target reflectance @ 940nm to calculate the
+ * ambient DMAX values for. Set to 50% by default by @a VL53L1_DataInit()
+ *
+ * @param   Dev                   Device Handle
+ * @param   pDmaxReflectance      pointer to Reflectance % in 16.16 fixed point
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetDmaxReflectance(VL53L1_DEV Dev,
+		FixPoint1616_t *pDmaxReflectance);
+/**
+ * @brief Set function for ambient Dmax mode
+ *
+ *
+ * @param    Dev                  Device Handle
+ * @param    DmaxMode             DMAX mode to be used in ranging
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+
+VL53L1_Error VL53L1_SetDmaxMode(VL53L1_DEV Dev,
+		VL53L1_DeviceDmaxModes DmaxMode);
+
+/**
+ * @brief Get function for ambient Dmax mode
+ *
+ * @param	Dev              Device Handle
+ * @param	pDmaxMode        output pointer to DMAX mode currently in use
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GetDmaxMode(VL53L1_DEV Dev,
+	VL53L1_DeviceDmaxModes *pDmaxMode);
+
+/** @} VL53L1_parameters_group */
+
+
+/** @defgroup VL53L1_limitcheck_group VL53L1 Limit Check Functions
+ *  @brief    Functions used for the Limit checks
+ *  @{
+ */
+
+
+
+/**
+ * @brief  Get the number of the check limit managed by a given Device
+ *
+ * @par Function Description
+ * This function give the number of the check limit managed by the Device
+ *
+ * @param   pNumberOfLimitCheck           Pointer to the number of check limit.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetNumberOfLimitCheck(
+	uint16_t *pNumberOfLimitCheck);
+
+/**
+ * @brief  Return a description string for a given limit check number
+ *
+ * @par Function Description
+ * This function returns a description string for a given limit check number.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @param   LimitCheckId                  Limit Check ID
+ * (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   pLimitCheckString             Pointer to the description string of
+ * the given check limit. Shall be defined as char buf[VL53L1_MAX_STRING_LENGTH]
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetLimitCheckInfo(uint16_t LimitCheckId,
+	char *pLimitCheckString);
+
+/**
+ * @brief  Return a the Status of the specified check limit
+ *
+ * @par Function Description
+ * This function returns the Status of the specified check limit.
+ * The value indicate if the check is fail or not.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   pLimitCheckStatus             Pointer to the
+ Limit Check Status of the given check limit.
+ * LimitCheckStatus :
+ * 0 the check is not fail or not enabled
+ * 1 the check if fail
+ *
+ * <p><ul>
+ *    <li>VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE: the sigma indicate the quality
+ *    of the measure. The more it is little the better it is.
+ *    The status is 1 when current sigma is greater then the limit.</li>
+ *    <li>VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE: the signal rate indicate
+ *    the strength of the returned signal. The more it is big the better it is.
+ *    The status is 1 when current signal is lower then the limit.</li>
+ * </ul></p>
+ *
+ *
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetLimitCheckStatus(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, uint8_t *pLimitCheckStatus);
+
+/**
+ * @brief  Enable/Disable a specific limit check
+ *
+ * @par Function Description
+ * This function Enable/Disable a specific limit check.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ *  (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   LimitCheckEnable
+ * @li set LimitCheckEnable=1 enables the LimitCheckId limit
+ * @li set LimitCheckEnable=0 disables the LimitCheckId limit
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS   This error is returned
+ *  when LimitCheckId value is out of range.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetLimitCheckEnable(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, uint8_t LimitCheckEnable);
+
+/**
+ * @brief  Get specific limit check enable state
+ *
+ * @par Function Description
+ * This function get the enable state of a specific limit check.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ *  (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   pLimitCheckEnable             Pointer to the check limit enable
+ * value.
+ * @li if 1 the check limit corresponding to LimitCheckId is Enabled
+ * @li if 0 the check limit corresponding to LimitCheckId is disabled
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS   This error is returned
+ *  when LimitCheckId value is out of range.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetLimitCheckEnable(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, uint8_t *pLimitCheckEnable);
+
+/**
+ * @brief  Set a specific limit check value
+ *
+ * @par Function Description
+ * This function set a specific limit check value.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @note Note that the value written with that function will not be applied if
+ * the limit is not enabled. In other words this function will not enable the
+ * limit but change only the value. In case the limit is not enabled the value
+ * is saved internally and applied with VL53L1_SetLimitCheckEnable.
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ *  (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   LimitCheckValue               Limit check Value for a given
+ * LimitCheckId
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetLimitCheckValue(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, FixPoint1616_t LimitCheckValue);
+
+/**
+ * @brief  Get a specific limit check value
+ *
+ * @par Function Description
+ * This function get a specific limit check value from device then it updates
+ * internal values and check enables.
+ * The limit check is identified with the LimitCheckId.
+ *
+ * @note This function get the current value from device if zero then the value
+ * returned is the one stored by the user, but in that case the check is store
+ * as disabled. If the value from device is not zero, this is returned and set
+ * into the memory at the same way that user call VL53L1_SetLimitCheckValue()
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ *  (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   pLimitCheckValue              Pointer to Limit
+ *  check Value for a given LimitCheckId.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetLimitCheckValue(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, FixPoint1616_t *pLimitCheckValue);
+
+/**
+ * @brief  Get the current value of the signal used for the limit check
+ *
+ * @par Function Description
+ * This function get a the current value of the signal used for the limit check.
+ * To obtain the latest value you should run a valid ranging before.
+ * The value reported is linked to the limit check identified with the
+ * LimitCheckId.
+ *
+ * @param   Dev                           Device Handle
+ * @param   LimitCheckId                  Limit Check ID
+ *  (0<= LimitCheckId < VL53L1_GetNumberOfLimitCheck() ).
+ * @param   pLimitCheckCurrent            Pointer to current Value for a
+ * given LimitCheckId.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetLimitCheckCurrent(VL53L1_DEV Dev,
+	uint16_t LimitCheckId, FixPoint1616_t *pLimitCheckCurrent);
+
+/** @} VL53L1_limitcheck_group */
+
+
+
+/** @defgroup VL53L1_ROI_group VL53L1 ROI Functions
+ *  @brief    Functions used to select ROIs
+ *  @{
+ */
+
+/**
+ * @brief Get the Maximum number of ROI Zones managed by the Device
+ *
+ * @par Function Description
+ * Get Maximum number of ROI Zones managed by the Device.
+ *
+ * @note The number of Zone depends on the preset mode used so to have the
+ * right number this function should be call after @a VL53L1_SetPresetMode()
+ * @note This function doesn't Access to the device
+ *
+ * @param   Dev                    Device Handle
+ * @param   pMaxNumberOfROI   Pointer to the Maximum Number
+ *  of ROI Zones value.
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetMaxNumberOfROI(VL53L1_DEV Dev,
+	uint8_t *pMaxNumberOfROI);
+/**
+ * @brief Set the ROI  to be used for ranging
+ *
+ * @par Function Description
+ * The user defined ROIs are rectangles described as per the following system
+ * from the Top Left corner to the Bottom Right corner.
+ * <br>Minimal ROI size is 4x4 spads
+ * @image html roi_coord.png
+ *
+ * @param   Dev                      Device Handle
+ * @param   pRoiConfig               Pointer to the Structure containing all the
+ * ROI to be used.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetROI(VL53L1_DEV Dev,
+		VL53L1_RoiConfig_t *pRoiConfig);
+
+/**
+ * @brief Get the ROI managed by the Device
+ *
+ * @par Function Description
+ * Get the ROI managed by the Device
+ *
+ * @param   Dev                   Device Handle
+ * @param   pRoiConfig            Pointer to the Structure containing all the
+ * ROI to be used.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetROI(VL53L1_DEV Dev,
+		VL53L1_RoiConfig_t *pRoiConfig);
+
+/** @} VL53L1_ROI_group */
+
+/* \internal */
+/** @defgroup VL53L1_sequencestep_group VL53L1 Sequence Step Functions
+ *  @brief    Functions used to select Steps done on each ranging
+ *  @{
+ */
+
+/**
+ * @brief Gets number of sequence steps managed by the API.
+ *
+ * @par Function Description
+ * This function retrieves the number of sequence steps currently managed
+ * by the API
+ *
+ * @note This function Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   pNumberOfSequenceSteps       Out parameter reporting the number of
+ *                                       sequence steps.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetNumberOfSequenceSteps(VL53L1_DEV Dev,
+	uint8_t *pNumberOfSequenceSteps);
+
+/**
+ * @brief Gets the name of a given sequence step.
+ *
+ * @par Function Description
+ * This function retrieves the name of sequence steps corresponding to
+ * SequenceStepId.
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   SequenceStepId               Sequence step identifier.
+ * @param   pSequenceStepsString         Pointer to Info string. Shall be
+ * defined as char buf[VL53L1_MAX_STRING_LENGTH]
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetSequenceStepsInfo(
+	VL53L1_SequenceStepId SequenceStepId, char *pSequenceStepsString);
+
+
+
+/**
+ * @brief Sets the (on/off) state of a requested sequence step.
+ *
+ * @par Function Description
+ * This function enables/disables a requested sequence step.
+ *
+ * @note This function Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   SequenceStepId	         Sequence step identifier.
+ * @param   SequenceStepEnabled          Demanded state {0=Off,1=On}
+ *                                       is enabled.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS  Error SequenceStepId parameter not
+ *                                       supported.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetSequenceStepEnable(VL53L1_DEV Dev,
+	VL53L1_SequenceStepId SequenceStepId, uint8_t SequenceStepEnabled);
+
+/**
+ * @brief Gets the (on/off) state of a requested sequence step.
+ *
+ * @par Function Description
+ * This function retrieves the state of a requested sequence step, i.e. on/off.
+ *
+ * @note This function Accesses the device
+ *
+ * @param   Dev                    Device Handle
+ * @param   SequenceStepId         Sequence step identifier.
+ * @param   pSequenceStepEnabled   Out parameter reporting if the sequence step
+ *                                 is enabled {0=Off,1=On}.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS  Error SequenceStepId parameter not
+ *                                       supported.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetSequenceStepEnable(VL53L1_DEV Dev,
+	VL53L1_SequenceStepId SequenceStepId, uint8_t *pSequenceStepEnabled);
+
+
+/** @} VL53L1_sequencestep_group */
+/* \endinternal */
+
+
+
+/** @defgroup VL53L1_measurement_group VL53L1 Measurement Functions
+ *  @brief    Functions used for the measurements
+ *  @{
+ */
+
+/**
+ * @brief Start device measurement
+ *
+ * @details Started measurement will depend on preset parameters set through
+ * @a VL53L1_SetPreseMode()
+ * This function will change the VL53L1_State from VL53L1_STATE_IDLE to
+ * VL53L1_STATE_RUNNING.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @return  VL53L1_ERROR_NONE                  Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED    This error occurs when
+ * PresetMode programmed with @a VL53L1_SetPresetMode
+ * @return  VL53L1_ERROR_TIME_OUT    Time out on start measurement
+ * @return  VL53L1_ERROR_INVALID_PARAMS This error might occur in timed mode
+ * when inter measurement period is smaller or too close to the timing budget.
+ * In such case measurements are not started and user must correct the timings
+ * passed to @a VL53L1_SetMeasurementTimingBudgetMicroSeconds() and
+ * @a VL53L1_SetInterMeasurementPeriodMilliSeconds() functions.
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_StartMeasurement(VL53L1_DEV Dev);
+
+/**
+ * @brief Stop device measurement
+ *
+ * @details Will set the device in standby mode at end of current measurement\n
+ *          Not necessary in single mode as device shall return automatically
+ *          in standby mode at end of measurement.
+ *          This function will change the VL53L1_State from VL53L1_STATE_RUNNING
+ *          to VL53L1_STATE_IDLE.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @return  VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_StopMeasurement(VL53L1_DEV Dev);
+
+/**
+ * @brief Clear the Interrupt flag and start new measurement
+ * *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @return  VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_ClearInterruptAndStartMeasurement(VL53L1_DEV Dev);
+
+/**
+ * @brief Return Measurement Data Ready
+ *
+ * @par Function Description
+ * This function indicate that a measurement data is ready.
+ * This function is used for non-blocking capture.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                    Device Handle
+ * @param   pMeasurementDataReady  Pointer to Measurement Data Ready.
+ * 0 = data not ready, 1 = data ready
+ * @return  VL53L1_ERROR_NONE      Success
+ * @return  "Other error code"     See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetMeasurementDataReady(VL53L1_DEV Dev,
+	uint8_t *pMeasurementDataReady);
+
+/**
+ * @brief Wait for measurement data ready.
+ * Blocking function.
+ * Note that the timeout is given by:
+ * VL53L1_RANGE_COMPLETION_POLLING_TIMEOUT_MS defined in def.h
+ *
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev      Device Handle
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  VL53L1_ERROR_TIME_OUT In case of timeout
+ */
+VL53L1_Error VL53L1_WaitMeasurementDataReady(VL53L1_DEV Dev);
+
+
+/**
+ * @brief Retrieve the measurements from device for a given setup
+ *
+ * @par Function Description
+ * Get data from last successful Ranging measurement
+ */
+/**
+ * @warning this function will return only the first ROI data and only the
+ * first object. For multi objects or multi ROI use:
+ * @a Vl53L1_GetMultiRangingData.
+ * In case of RANGING only one output is given, this can
+ * be selected with the help of @a VL53L1_SetOutputMode()
+ * In case of MULTIZONES_SCANNING and error will be raised because not
+ * supported in that function.
+ */
+/**
+ *
+ * @warning USER must call @a VL53L1_ClearInterruptAndStartMeasurement() prior
+ * to call again this function
+ *
+ * @note This function Access to the device
+ *
+ * @note The first valid value returned by this function will have a range
+ * status equal to VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK which means that
+ * the data is valid but no wrap around check have been done. User should take
+ * care about that.
+ *
+ * @param   Dev                      Device Handle
+ * @param   pRangingMeasurementData  Pointer to the data structure to fill up.
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  VL53L1_ERROR_MODE_NOT_SUPPORTED    in case of MULTIZONES_SCANNING
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetRangingMeasurementData(VL53L1_DEV Dev,
+	VL53L1_RangingMeasurementData_t *pRangingMeasurementData);
+
+/**
+ * @brief Retrieve all ROI's measurements from device for a given setup
+ *
+ * @par Function Description
+ * Get data from last successful Ranging measurement
+ * @warning USER should take care about  @a VL53L1_GetNumberOfROI()
+ * before get data.
+ * Bare driver will fill a NumberOfROI times the corresponding data
+ * structure used in the measurement function.
+ *
+ * @warning USER must call @a VL53L1_ClearInterruptAndStartMeasurement() prior
+ * to call again this function
+ *
+ * @note This function Access to the device
+ *
+ * @note The first valid value returned by this function will have a range
+ * status equal to VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK which means that
+ * the data is valid but no wrap around check have been done. User should take
+ * care about that.
+ *
+ * @param   Dev                      Device Handle
+ * @param   pMultiRangingData        Pointer to the data structure to fill up.
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetMultiRangingData(VL53L1_DEV Dev,
+		VL53L1_MultiRangingData_t *pMultiRangingData);
+
+/**
+ * @brief Get Additional Data
+ *
+ * @par Function Description
+ * This function is used to get lld debugging data on the last histogram
+ * measurement. shall be called when a new measurement is ready (interrupt or
+ * positive VL53L1_GetMeasurementDataReady() polling) and before a call to
+ * VL53L1_ClearInterruptAndStartMeasurement(). Depending on the PresetMode
+ * currently set parts of the returned data structure may be not relevant.
+ *
+ * @param   Dev                      Device Handle
+ * @param   pAdditionalData          Pointer to Additional data
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetAdditionalData(VL53L1_DEV Dev,
+		VL53L1_AdditionalData_t *pAdditionalData);
+
+
+/** @} VL53L1_measurement_group */
+
+/** @defgroup VL53L1_Calibration_group VL53L1 Calibration Functions
+ *  @brief    Functions used for Calibration
+ *  @{
+ */
+
+
+/**
+ * @brief Set Tuning Parameter value for a given parameter ID
+ *
+ * @par Function Description
+ * This function is used to improve the performance of the device. It permit to
+ * change a particular value used for a timeout or a threshold or a constant
+ * in an algorithm. The function will change the value of the parameter
+ * identified by an unique ID.
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   TuningParameterId            Tuning Parameter ID
+ * @param   TuningParameterValue         Tuning Parameter Value
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetTuningParameter(VL53L1_DEV Dev,
+		uint16_t TuningParameterId, int32_t TuningParameterValue);
+
+/**
+ * @brief Get Tuning Parameter value for a given parameter ID
+ *
+ * @par Function Description
+ * This function is used to get the value of the parameter
+ * identified by an unique ID.
+ *
+ * @note This function doesn't Access to the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   TuningParameterId            Tuning Parameter ID
+ * @param   pTuningParameterValue        Pointer to Tuning Parameter Value
+ * for a given TuningParameterId.
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetTuningParameter(VL53L1_DEV Dev,
+		uint16_t TuningParameterId, int32_t *pTuningParameterValue);
+
+/**
+ * @brief Performs Reference Spad Management
+ *
+ * @par Function Description
+ * The reference SPAD initialization procedure determines the minimum amount
+ * of reference spads to be enables to achieve a target reference signal rate
+ * and should be performed once during initialization.
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                          Device Handle
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_PerformRefSpadManagement(VL53L1_DEV Dev);
+
+/**
+ * @brief Enable/Disable dynamic Xtalk compensation feature
+ *
+ * Enable/Disable dynamic Xtalk compensation (aka smudge correction).
+ *
+ * @param   Dev    Device Handle
+ * @param   Mode   Set the smudge correction mode
+ * See ::VL53L1_SmudgeCorrectionModes
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SmudgeCorrectionEnable(VL53L1_DEV Dev,
+		VL53L1_SmudgeCorrectionModes Mode);
+
+/**
+ * @brief Enable/Disable Cross talk compensation feature
+ *
+ * Enable/Disable Cross Talk correction.
+ *
+ * @param   Dev                       Device Handle
+ * @param   XTalkCompensationEnable   Cross talk compensation
+ *  to be set 0 = disabled or 1 = enabled.
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetXTalkCompensationEnable(VL53L1_DEV Dev,
+uint8_t XTalkCompensationEnable);
+
+/**
+ * @brief Get Cross talk compensation rate enable
+ *
+ * Get if the Cross Talk is Enabled or Disabled.
+ *
+ * @note This function doesn't access to the device
+ *
+ * @param   Dev                        Device Handle
+ * @param   pXTalkCompensationEnable   Pointer to the Cross talk compensation
+ *  state 0=disabled or 1 = enabled
+ * @return  VL53L1_ERROR_NONE        Success
+ * @return  "Other error code"       See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetXTalkCompensationEnable(VL53L1_DEV Dev,
+	uint8_t *pXTalkCompensationEnable);
+
+
+/**
+ * @brief Perform XTalk Calibration
+ *
+ * @details Perform a XTalk calibration of the Device.
+ * This function will launch a ranging measurement, if interrupts
+ * are enabled an interrupt will be done.
+ * This function will clear the interrupt generated automatically.
+ * This function will program a new value for the XTalk compensation
+ * and it will enable the cross talk before exit.
+ *
+ * @warning This function is a blocking function
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @param   CalibrationOption    Select the Calibration to be run :
+ * @param                        CalibrationOption
+ * @li VL53L1_XTALKCALIBRATIONMODE_SINGLE_TARGET the calibration uses current
+ * preset and distance mode without altering them.<br>
+ * User must call @a VL53L1_SetPresetMode() with VL53L1_PRESETMODE_AUTONOMOUS,
+ * VL53L1_PRESETMODE_LITE_RANGING or VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS
+ * parameter prior to launch calibration
+ * @li VL53L1_XTALKCALIBRATIONMODE_NO_TARGET the calibration sets appropriate
+ * preset and distance mode and thus override existing ones<br>
+ * User must call @a VL53L1_SetPresetMode() again after calibration to set the
+ * desired one. during this calibration mode no object must be put below a 80cm
+ * distance from the target
+ * @li VL53L1_XTALKCALIBRATIONMODE_FULL_ROI the calibration sets appropriate
+ * preset and distance mode and thus override existing ones<br>
+ * User must call @a VL53L1_SetPresetMode() again after calibration to set the
+ * desired one.
+ * The ROI settings must define a single 16x16 ROI before to launch this
+ * function.
+ * The calibration uses a target which should be located at least @60cm from the
+ * device. The actual location of the target shall be passed
+ * through the bare driver tuning parameters table
+ *
+ * @return  VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_PerformXTalkCalibration(VL53L1_DEV Dev,
+		uint8_t CalibrationOption);
+
+/**
+ * @brief Define the mode to be used for the offset calibration
+ *
+ * Define the mode to be used for the offset calibration. This function should
+ * be called before run the @a VL53L1_PerformOffsetCalibration()
+ *
+ * @param   Dev                       Device Handle
+ * @param   OffsetCalibrationMode     Offset Calibration Mode valid values are:
+ * @li                                VL53L1_OFFSETCALIBRATIONMODE_STANDARD
+ * @li                                VL53L1_OFFSETCALIBRATIONMODE_PRERANGE_ONLY
+ * @li                                VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE
+ *
+ * @return  VL53L1_ERROR_NONE         Success
+ * @return  "Other error code"        See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetOffsetCalibrationMode(VL53L1_DEV Dev,
+		VL53L1_OffsetCalibrationModes OffsetCalibrationMode);
+
+/**
+ * @brief Define the mode to be used for the offset correction
+ *
+ * Define the mode to be used for the offset correction.
+ *
+ * @param   Dev                       Device Handle
+ * @param   OffsetCorrectionMode      Offset Correction Mode valid values are:
+ * @li                                VL53L1_OFFSETCORRECTIONMODE_STANDARD
+ * @li                                VL53L1_OFFSETCORRECTIONMODE_PERZONE
+ *
+ * @return  VL53L1_ERROR_NONE         Success
+ * @return  "Other error code"        See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetOffsetCorrectionMode(VL53L1_DEV Dev,
+		VL53L1_OffsetCorrectionModes OffsetCorrectionMode);
+
+
+/**
+ * @brief Perform Offset Calibration
+ *
+ * @details Perform a Offset calibration of the Device.
+ * This function will launch a ranging measurement, if interrupts are
+ * enabled interrupts will be done.
+ * This function will program a new value for the Offset calibration value
+ *
+ * @warning This function is a blocking function
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @param   CalDistanceMilliMeter     Calibration distance value used for the
+ * offset compensation.
+ * @param   CalReflectancePercent     Calibration Target reflectance @ 940nm
+ * in percentage.
+ *
+ * @return  VL53L1_ERROR_NONE
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_PerformOffsetCalibration(VL53L1_DEV Dev,
+	int32_t CalDistanceMilliMeter,
+	FixPoint1616_t CalReflectancePercent);
+
+/**
+ * @brief Perform Offset simple Calibration
+ *
+ * @details Perform a very simple offset calibration of the Device.
+ * This function will launch few ranging measurements and computes offset
+ * calibration. The preset mode and the distance mode MUST be set by the
+ * application before to call this function.
+ *
+ * @warning This function is a blocking function
+ *
+ * @note This function Access to the device
+ *
+ * @param   Dev                  Device Handle
+ * @param   CalDistanceMilliMeter     Calibration distance value used for the
+ * offset compensation.
+ *
+ * @return  VL53L1_ERROR_NONE
+ * @return  VL53L1_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL the calibration failed by
+ * lack of valid measurements
+ * @return  VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH means that the target
+ * distance combined to the number of loops performed in the calibration lead to
+ * an internal overflow. Try to reduce the distance of the target (140 mm)
+ * @return  "Other error code"   See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_PerformOffsetSimpleCalibration(VL53L1_DEV Dev,
+		int32_t CalDistanceMilliMeter);
+
+/**
+ * @brief Sets the Calibration Data.
+ *
+ * @par Function Description
+ * This function set all the Calibration Data issued from the functions
+ * @a VL53L1_PerformRefSpadManagement(), @a VL53L1_PerformXTalkCalibration,
+ * @a VL53L1_PerformOffsetCalibration()
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   *pCalibrationData            Pointer to Calibration data to be set.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  VL53L1_ERROR_INVALID_PARAMS  pCalibrationData points to an older
+ * version of the inner structure. Need for support to convert its content.
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetCalibrationData(VL53L1_DEV Dev,
+		VL53L1_CalibrationData_t *pCalibrationData);
+
+/**
+ * @brief Gets the Calibration Data.
+ *
+ * @par Function Description
+ * This function get all the Calibration Data issued from the functions
+ * @a VL53L1_PerformRefSpadManagement(), @a VL53L1_PerformXTalkCalibration,
+ * @a VL53L1_PerformOffsetCalibration()
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   *pCalibrationData            pointer where to store Calibration
+ *  data.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetCalibrationData(VL53L1_DEV Dev,
+		VL53L1_CalibrationData_t  *pCalibrationData);
+
+/**
+ * @brief Sets the Zone Calibration Data.
+ *
+ * @par Function Description
+ * This function set all the Zone nCalibration Data issued from the functions
+ * @a VL53L1_PerformOffsetCalibration() in multi zone
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   *pZoneCalibrationData        Pointer to Zone Calibration data to be
+ *  set.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_SetZoneCalibrationData(VL53L1_DEV Dev,
+		VL53L1_ZoneCalibrationData_t *pZoneCalibrationData);
+
+/**
+ * @brief Gets the Zone Calibration Data.
+ *
+ * @par Function Description
+ * This function get all the Zone Calibration Data issued from the functions
+ * @a VL53L1_PerformOffsetCalibration()
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   *pZoneCalibrationData        pointer where to store Zone Calibration
+ *  data.
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetZoneCalibrationData(VL53L1_DEV Dev,
+		VL53L1_ZoneCalibrationData_t *pZoneCalibrationData);
+/**
+ * @brief Gets the optical center.
+ *
+ * @par Function Description
+ * This function get the optical center issued from the nvm set at FTM stage
+ * expressed in the same coordinate system as the ROI are
+ *
+ * @note This function doesn't Accesses the device
+ *
+ * @param   Dev                          Device Handle
+ * @param   pOpticalCenterX              pointer to the X position of center
+ * in 16.16 fix point
+ * @param   pOpticalCenterY              pointer to the Y position of center
+ * in 16.16 fix point
+ * @return  VL53L1_ERROR_NONE            Success
+ * @return  "Other error code"           See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_GetOpticalCenter(VL53L1_DEV Dev,
+		FixPoint1616_t *pOpticalCenterX,
+		FixPoint1616_t *pOpticalCenterY);
+
+/** @} VL53L1_Calibration_group */
+
+/** @defgroup VL53L1_Thresholds_group VL53L1 IRQ Triggered events Functions
+ *  @brief    Functions used to configure interrupt to be triggered only when
+ *  a measurement satisfies some thresholds parameters
+ *  @{
+ */
+
+/**
+ * @brief Configure the interrupt config, from the given structure
+ *
+ * @param[in]    Dev     : Device Handle
+ * @param[in]    pConfig : pointer to configuration structure
+ */
+
+VL53L1_Error VL53L1_SetThresholdConfig(VL53L1_DEV Dev,
+		VL53L1_DetectionConfig_t *pConfig);
+
+/**
+ * @brief Retrieves the interrupt config structure currently programmed
+ *                             into the API
+ *
+ * @param[in]    Dev     : Device Handle
+ * @param[out]   pConfig : pointer to configuration structure
+ */
+
+VL53L1_Error VL53L1_GetThresholdConfig(VL53L1_DEV Dev,
+		VL53L1_DetectionConfig_t *pConfig);
+
+
+/** @} VL53L1_Thresholds_group */
+
+
+/** @} VL53L1_cut11_group */
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* _VL53L1_API_H_ */
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api_calibration.h b/drivers/input/misc/vl53L1/inc/vl53l1_api_calibration.h
new file mode 100644
index 0000000000000000000000000000000000000000..01c9aeb2b8a2c7be10c0b39282554183c43cefa1
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api_calibration.h
@@ -0,0 +1,596 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_API_CALIBRATION_H_
+#define _VL53L1_API_CALIBRATION_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_run_ref_spad_char(VL53L1_DEV Dev,
+		VL53L1_Error           * pcal_status);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_run_device_test(
+	VL53L1_DEV                 Dev,
+	VL53L1_DeviceTestMode      device_test_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_run_spad_rate_map(
+	VL53L1_DEV                 Dev,
+	VL53L1_DeviceTestMode      device_test_mode,
+	VL53L1_DeviceSscArray      array_select,
+	uint32_t                   ssc_config_timeout_us,
+	VL53L1_spad_rate_data_t   *pspad_rate_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error   VL53L1_run_xtalk_extraction(
+	VL53L1_DEV	                        Dev,
+	VL53L1_Error                       *pcal_status);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_and_avg_xtalk_samples(
+		VL53L1_DEV	                  Dev,
+		uint8_t                       num_of_samples,
+		uint8_t                       measurement_mode,
+		int16_t                       xtalk_filter_thresh_max_mm,
+		int16_t                       xtalk_filter_thresh_min_mm,
+		uint16_t                      xtalk_max_valid_rate_kcps,
+		uint8_t                       xtalk_result_id,
+		uint8_t                       xtalk_histo_id,
+		VL53L1_xtalk_range_results_t *pxtalk_results,
+		VL53L1_histogram_bin_data_t  *psum_histo,
+		VL53L1_histogram_bin_data_t  *pavg_histo);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error   VL53L1_run_offset_calibration(
+	VL53L1_DEV	                  Dev,
+	int16_t                       cal_distance_mm,
+	uint16_t                      cal_reflectance_pc,
+	VL53L1_Error                 *pcal_status);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error   VL53L1_run_phasecal_average(
+	VL53L1_DEV	            Dev,
+	uint8_t                 measurement_mode,
+	uint8_t                 phasecal_result__vcsel_start,
+	uint16_t                phasecal_num_of_samples,
+	VL53L1_range_results_t *prange_results,
+	uint16_t               *pphasecal_result__reference_phase,
+	uint16_t               *pzero_distance_phase);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_run_zone_calibration(
+	VL53L1_DEV	                  Dev,
+	VL53L1_DevicePresetModes      device_preset_mode,
+	VL53L1_DeviceZonePreset       zone_preset,
+	VL53L1_zone_config_t         *pzone_cfg,
+	int16_t                       cal_distance_mm,
+	uint16_t                      cal_reflectance_pc,
+	VL53L1_Error                 *pcal_status);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_xtalk_extract_data_init(
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_update(
+	int16_t                             target_distance_mm,
+	uint16_t                            target_width_oversize,
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_fini(
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data,
+	VL53L1_xtalk_calibration_results_t *pxtalk_cal,
+	VL53L1_xtalk_histogram_shape_t     *pxtalk_shape);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error   VL53L1_run_hist_xtalk_extraction(
+	VL53L1_DEV	                  Dev,
+	int16_t                       cal_distance_mm,
+	VL53L1_Error                 *pcal_status);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api_core.h b/drivers/input/misc/vl53L1/inc/vl53l1_api_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..eb3122cb05169194d2ec6e9322c0d0e0f5e94d3c
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api_core.h
@@ -0,0 +1,1941 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_API_CORE_H_
+#define _VL53L1_API_CORE_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_version(
+	VL53L1_DEV            Dev,
+	VL53L1_ll_version_t  *pversion);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_device_firmware_version(
+	VL53L1_DEV         Dev,
+	uint16_t          *pfw_version);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_data_init(
+	VL53L1_DEV         Dev,
+	uint8_t            read_p2p_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_p2p_data(
+	VL53L1_DEV      Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_software_reset(
+	VL53L1_DEV      Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_part_to_part_data(
+	VL53L1_DEV                            Dev,
+	VL53L1_calibration_data_t            *pcal_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_part_to_part_data(
+	VL53L1_DEV                            Dev,
+	VL53L1_calibration_data_t            *pcal_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_tuning_debug_data(
+	VL53L1_DEV                            Dev,
+	VL53L1_tuning_parameters_t            *ptun_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_inter_measurement_period_ms(
+	VL53L1_DEV          Dev,
+	uint32_t            inter_measurement_period_ms);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_inter_measurement_period_ms(
+	VL53L1_DEV          Dev,
+	uint32_t           *pinter_measurement_period_ms);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_timeouts_us(
+	VL53L1_DEV          Dev,
+	uint32_t            phasecal_config_timeout_us,
+	uint32_t            mm_config_timeout_us,
+	uint32_t            range_config_timeout_us);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_timeouts_us(
+	VL53L1_DEV          Dev,
+	uint32_t           *pphasecal_config_timeout_us,
+	uint32_t           *pmm_config_timeout_us,
+	uint32_t           *prange_config_timeout_us);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_calibration_repeat_period(
+	VL53L1_DEV          Dev,
+	uint16_t            cal_config__repeat_period);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_calibration_repeat_period(
+	VL53L1_DEV          Dev,
+	uint16_t           *pcal_config__repeat_period);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_sequence_config_bit(
+	VL53L1_DEV                   Dev,
+	VL53L1_DeviceSequenceConfig  bit_id,
+	uint8_t                      value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_sequence_config_bit(
+	VL53L1_DEV                   Dev,
+	VL53L1_DeviceSequenceConfig  bit_id,
+	uint8_t                     *pvalue);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_interrupt_polarity(
+	VL53L1_DEV                       Dev,
+	VL53L1_DeviceInterruptPolarity  interrupt_polarity);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_interrupt_polarity(
+	VL53L1_DEV                      Dev,
+	VL53L1_DeviceInterruptPolarity  *pinterrupt_polarity);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_refspadchar_config_struct(
+	VL53L1_DEV                     Dev,
+	VL53L1_refspadchar_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_refspadchar_config_struct(
+	VL53L1_DEV                     Dev,
+	VL53L1_refspadchar_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_range_ignore_threshold(
+	VL53L1_DEV              Dev,
+	uint8_t                 range_ignore_thresh_mult,
+	uint16_t                range_ignore_threshold_mcps);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_range_ignore_threshold(
+	VL53L1_DEV              Dev,
+	uint8_t                *prange_ignore_thresh_mult,
+	uint16_t               *prange_ignore_threshold_mcps_internal,
+	uint16_t               *prange_ignore_threshold_mcps_current);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_user_zone(
+	VL53L1_DEV          Dev,
+	VL53L1_user_zone_t *puser_zone);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_user_zone(
+	VL53L1_DEV          Dev,
+	VL53L1_user_zone_t *puser_zone);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_mode_mitigation_roi(
+	VL53L1_DEV          Dev,
+	VL53L1_user_zone_t *pmm_roi);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_zone_config(
+	VL53L1_DEV             Dev,
+	VL53L1_zone_config_t  *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_zone_config(
+	VL53L1_DEV             Dev,
+	VL53L1_zone_config_t  *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_preset_mode(
+	VL53L1_DEV                   Dev,
+	VL53L1_DevicePresetModes     device_preset_mode,
+	uint16_t                     dss_config__target_total_rate_mcps,
+	uint32_t                     phasecal_config_timeout_us,
+	uint32_t                     mm_config_timeout_us,
+	uint32_t                     range_config_timeout_us,
+	uint32_t                     inter_measurement_period_ms);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_preset_mode_timing_cfg(
+	VL53L1_DEV                   Dev,
+	VL53L1_DevicePresetModes     device_preset_mode,
+	uint16_t                    *pdss_config__target_total_rate_mcps,
+	uint32_t                    *pphasecal_config_timeout_us,
+	uint32_t                    *pmm_config_timeout_us,
+	uint32_t                    *prange_config_timeout_us);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_zone_preset(
+	VL53L1_DEV               Dev,
+	VL53L1_DeviceZonePreset  zone_preset);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_enable_xtalk_compensation(
+	VL53L1_DEV                 Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_disable_xtalk_compensation(
+	VL53L1_DEV                 Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_get_xtalk_compensation_enable(
+	VL53L1_DEV    Dev,
+	uint8_t       *pcrosstalk_compensation_enable);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_and_start_range(
+	VL53L1_DEV                      Dev,
+	uint8_t                         measurement_mode,
+	VL53L1_DeviceConfigLevel        device_config_level);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_stop_range(
+	VL53L1_DEV  Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_measurement_results(
+	VL53L1_DEV                  Dev,
+	VL53L1_DeviceResultsLevel   device_result_level);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_device_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_DeviceResultsLevel  device_result_level,
+	VL53L1_range_results_t    *prange_results);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_clear_interrupt_and_enable_next_range(
+	VL53L1_DEV       Dev,
+	uint8_t          measurement_mode);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_bin_data(
+	VL53L1_DEV                   Dev,
+	VL53L1_histogram_bin_data_t *phist_data);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_copy_sys_and_core_results_to_range_results(
+	int32_t                           gain_factor,
+	VL53L1_system_results_t          *psys,
+	VL53L1_core_results_t            *pcore,
+	VL53L1_range_results_t           *presults);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_zone_dss_config(
+	  VL53L1_DEV                      Dev,
+	  VL53L1_zone_private_dyn_cfg_t  *pzone_dyn_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_calc_ambient_dmax(
+	VL53L1_DEV    Dev,
+	uint16_t      target_reflectance,
+	int16_t      *pambient_dmax_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_interrupt_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_distance,
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_rate,
+	uint8_t				intr_new_measure_ready,
+	uint8_t				intr_no_target,
+	uint8_t				intr_combined_mode,
+	uint16_t			thresh_distance_high,
+	uint16_t			thresh_distance_low,
+	uint16_t			thresh_rate_high,
+	uint16_t			thresh_rate_low
+	);
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_interrupt_config_struct(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t	intconf);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_GPIO_interrupt_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t	*pintconf);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_dmax_mode(
+	VL53L1_DEV              Dev,
+	VL53L1_DeviceDmaxMode   dmax_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_dmax_mode(
+	VL53L1_DEV               Dev,
+	VL53L1_DeviceDmaxMode   *pdmax_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_dmax_calibration_data(
+	VL53L1_DEV                      Dev,
+	VL53L1_DeviceDmaxMode           dmax_mode,
+	uint8_t                         zone_id,
+	VL53L1_dmax_calibration_data_t *pdmax_cal);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_hist_dmax_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_hist_gen3_dmax_config_t *pdmax_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_hist_dmax_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_hist_gen3_dmax_config_t *pdmax_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_offset_calibration_mode(
+	VL53L1_DEV                      Dev,
+	VL53L1_OffsetCalibrationMode   offset_cal_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_offset_calibration_mode(
+	VL53L1_DEV                      Dev,
+	VL53L1_OffsetCalibrationMode  *poffset_cal_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_offset_correction_mode(
+	VL53L1_DEV                     Dev,
+	VL53L1_OffsetCalibrationMode   offset_cor_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_offset_correction_mode(
+	VL53L1_DEV                    Dev,
+	VL53L1_OffsetCorrectionMode  *poffset_cor_mode);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_zone_calibration_data(
+	VL53L1_DEV                         Dev,
+	VL53L1_zone_calibration_results_t *pzone_cal);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_zone_calibration_data(
+	VL53L1_DEV                         Dev,
+	VL53L1_zone_calibration_results_t *pzone_cal);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_lite_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                           *pxtalk_margin);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_lite_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                             xtalk_margin);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                           *pxtalk_margin);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                             xtalk_margin);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_phase_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pphase_consistency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_phase_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                             phase_consistency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_event_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pevent_consistency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_event_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                             event_consistency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_ambient_threshold_sigma(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pamb_thresh_sigma);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_ambient_threshold_sigma(
+	VL53L1_DEV                          Dev,
+	uint8_t                             amb_thresh_sigma);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_lite_min_count_rate(
+	VL53L1_DEV                          Dev,
+	uint16_t                           *plite_mincountrate);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_lite_min_count_rate(
+	VL53L1_DEV                          Dev,
+	uint16_t                            lite_mincountrate);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_lite_sigma_threshold(
+	VL53L1_DEV                          Dev,
+	uint16_t                           *plite_sigma);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_lite_sigma_threshold(
+	VL53L1_DEV                          Dev,
+	uint16_t                            lite_sigma);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_restore_xtalk_nvm_default(
+	VL53L1_DEV                     Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_xtalk_detect_config(
+	VL53L1_DEV                          Dev,
+	int16_t                            *pmax_valid_range_mm,
+	int16_t                            *pmin_valid_range_mm,
+	uint16_t                           *pmax_valid_rate_kcps,
+	uint16_t                           *pmax_sigma_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_xtalk_detect_config(
+	VL53L1_DEV                          Dev,
+	int16_t                             max_valid_range_mm,
+	int16_t                             min_valid_range_mm,
+	uint16_t                            max_valid_rate_kcps,
+	uint16_t                            max_sigma_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_target_order_mode(
+	VL53L1_DEV                          Dev,
+	VL53L1_HistTargetOrder             *phist_target_order);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_target_order_mode(
+	VL53L1_DEV                          Dev,
+	VL53L1_HistTargetOrder              hist_target_order);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_dmax_reflectance_values(
+	VL53L1_DEV                          Dev,
+	VL53L1_dmax_reflectance_array_t    *pdmax_reflectances);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_dmax_reflectance_values(
+	VL53L1_DEV                          Dev,
+	VL53L1_dmax_reflectance_array_t    *pdmax_reflectances);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_vhv_config(
+	VL53L1_DEV                   Dev,
+	uint8_t                      vhv_init_en,
+	uint8_t                      vhv_init_value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_vhv_config(
+	VL53L1_DEV                   Dev,
+	uint8_t                     *pvhv_init_en,
+	uint8_t                     *pvhv_init_value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_vhv_loopbound(
+	VL53L1_DEV                   Dev,
+	uint8_t                      vhv_loopbound);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_vhv_loopbound(
+	VL53L1_DEV                   Dev,
+	uint8_t                     *pvhv_loopbound);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_tuning_parm(
+	VL53L1_DEV                     Dev,
+	VL53L1_TuningParms             tuning_parm_key,
+	int32_t                       *ptuning_parm_value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_tuning_parm(
+	VL53L1_DEV                     Dev,
+	VL53L1_TuningParms             tuning_parm_key,
+	int32_t                        tuning_parm_value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_enable(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_disable(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_apply_enable(
+	VL53L1_DEV                          Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_apply_disable(
+	VL53L1_DEV                          Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_single_apply_enable(
+	VL53L1_DEV                          Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_single_apply_disable(
+	VL53L1_DEV                          Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_set_scalers(
+	VL53L1_DEV	Dev,
+	int16_t		x_scaler_in,
+	int16_t		y_scaler_in,
+	uint8_t		user_scaler_set_in
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_current_xtalk_settings(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_calibration_results_t *pxtalk
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_current_xtalk_settings(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_calibration_results_t *pxtalk
+	);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api_debug.h b/drivers/input/misc/vl53L1/inc/vl53l1_api_debug.h
new file mode 100644
index 0000000000000000000000000000000000000000..46239a784864b141e57223661fc7bcf8a5bcb791
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api_debug.h
@@ -0,0 +1,756 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_API_DEBUG_H_
+#define _VL53L1_API_DEBUG_H_
+
+#include "vl53l1_platform.h"
+#include "vl53l1_nvm_structs.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_decode_calibration_data_buffer(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_calibration_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_nvm_debug_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_decoded_nvm_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_histogram_debug_data(
+	VL53L1_DEV                   Dev,
+	VL53L1_histogram_bin_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_additional_data(
+	VL53L1_DEV                Dev,
+	VL53L1_additional_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_xtalk_debug_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_xtalk_debug_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_offset_debug_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_offset_debug_data_t *pdata);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+
+
+
+
+
+
+
+
+void  VL53L1_signed_fixed_point_sprintf(
+	int32_t    fp_value,
+	uint8_t    frac_bits,
+	uint16_t   buf_size,
+	char      *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_static_nvm_managed(
+	VL53L1_static_nvm_managed_t   *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_customer_nvm_managed(
+	VL53L1_customer_nvm_managed_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_nvm_copy_data(
+	VL53L1_nvm_copy_data_t        *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_histogram_bin_data(
+	VL53L1_histogram_bin_data_t *pdata,
+	char                        *pprefix,
+	uint32_t                     trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_histogram_data(
+	VL53L1_xtalk_histogram_data_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_histogram_shape_data(
+	VL53L1_xtalk_histogram_shape_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_range_results(
+	VL53L1_range_results_t *pdata,
+	char                   *pprefix,
+	uint32_t                trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_range_data(
+	VL53L1_range_data_t *pdata,
+	char                *pprefix,
+	uint32_t             trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_offset_range_results(
+	VL53L1_offset_range_results_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_offset_range_data(
+	VL53L1_offset_range_data_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_cal_peak_rate_map(
+	VL53L1_cal_peak_rate_map_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_additional_offset_cal_data(
+	VL53L1_additional_offset_cal_data_t *pdata,
+	char                                *pprefix,
+	uint32_t                             trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_additional_data(
+	VL53L1_additional_data_t *pdata,
+	char                     *pprefix,
+	uint32_t                 trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_gain_calibration_data(
+	VL53L1_gain_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_zone_calibration_data(
+	VL53L1_zone_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_zone_calibration_results(
+	VL53L1_zone_calibration_results_t *pdata,
+	char                              *pprefix,
+	uint32_t                           trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_range_results(
+	VL53L1_xtalk_range_results_t *pdata,
+	char                         *pprefix,
+	uint32_t                      trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_range_data(
+	VL53L1_xtalk_range_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_calibration_results(
+	VL53L1_xtalk_calibration_results_t *pdata,
+	char                               *pprefix,
+	uint32_t                            trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_config(
+	VL53L1_xtalk_config_t *pdata,
+	char                  *pprefix,
+	uint32_t               trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_extract_config(
+	VL53L1_xtalkextract_config_t *pdata,
+	char                         *pprefix,
+	uint32_t                      trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_zone_cal_config(
+	VL53L1_zonecal_config_t *pdata,
+	char                    *pprefix,
+	uint32_t                 trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_offset_cal_config(
+	VL53L1_offsetcal_config_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_dmax_calibration_data(
+	VL53L1_dmax_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_calibration_data(
+	VL53L1_calibration_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_xtalk_debug_data(
+	VL53L1_xtalk_debug_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_offset_debug_data(
+	VL53L1_offset_debug_data_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_optical_centre(
+	VL53L1_optical_centre_t   *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_user_zone(
+	VL53L1_user_zone_t   *pdata,
+	char                 *pprefix,
+	uint32_t              trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_zone_config(
+	VL53L1_zone_config_t *pdata,
+	char                 *pprefix,
+	uint32_t              trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_spad_rate_data(
+	VL53L1_spad_rate_data_t  *pspad_rates,
+	char                     *pprefix,
+	uint32_t                  trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_spad_rate_map(
+	VL53L1_spad_rate_data_t  *pspad_rates,
+	char                     *pprefix,
+	uint32_t                  trace_flags);
+
+
+#endif
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api_preset_modes.h b/drivers/input/misc/vl53L1/inc/vl53l1_api_preset_modes.h
new file mode 100644
index 0000000000000000000000000000000000000000..e5e166aa221460da71db144c798f6efafe7ebfdc
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api_preset_modes.h
@@ -0,0 +1,1637 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_API_PRESET_MODES_H_
+#define _VL53L1_API_PRESET_MODES_H_
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_dmax_structs.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_refspadchar_config_struct(
+	VL53L1_refspadchar_config_t     *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_ssc_config_struct(
+	VL53L1_ssc_config_t     *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_xtalk_config_struct(
+		VL53L1_customer_nvm_managed_t *pnvm,
+		VL53L1_xtalk_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_xtalk_extract_config_struct(
+		VL53L1_xtalkextract_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_offset_cal_config_struct(
+	VL53L1_offsetcal_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_zone_cal_config_struct(
+	VL53L1_zonecal_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_hist_post_process_config_struct(
+	uint8_t                              xtalk_compensation_enable,
+	VL53L1_hist_post_process_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_dmax_calibration_data_struct(
+	VL53L1_dmax_calibration_data_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_tuning_parm_storage_struct(
+	VL53L1_tuning_parm_storage_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_hist_gen3_dmax_config_struct(
+	VL53L1_hist_gen3_dmax_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_short_range(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_long_range(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_mm1_cal(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_mm2_cal(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging_short_range(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging_long_range(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_short_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_long_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_with_mm1(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_with_mm2(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_mm1_cal(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_mm2_cal(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_ref(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_characterisation(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_planar(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_mm1(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_mm2(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone_short_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone_long_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_short_timing(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_special_histogram_short_range(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range_mm1(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range_mm2(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range_mm1(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range_mm2(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range_mm1(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range_mm2(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_static_config_t            *pstatic,
+	VL53L1_histogram_config_t         *phistogram,
+	VL53L1_general_config_t           *pgeneral,
+	VL53L1_timing_config_t            *ptiming,
+	VL53L1_dynamic_config_t           *pdynamic,
+	VL53L1_system_control_t           *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t              *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_olt(
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic,
+	VL53L1_system_control_t    *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t       *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_singleshot_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_copy_hist_cfg_to_static_cfg(
+	VL53L1_histogram_config_t  *phistogram,
+	VL53L1_static_config_t     *pstatic,
+	VL53L1_general_config_t    *pgeneral,
+	VL53L1_timing_config_t     *ptiming,
+	VL53L1_dynamic_config_t    *pdynamic);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_copy_hist_bins_to_static_cfg(
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_timing_config_t    *ptiming);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_api_strings.h b/drivers/input/misc/vl53L1/inc/vl53l1_api_strings.h
new file mode 100644
index 0000000000000000000000000000000000000000..051fcb2b000cf8868e6dd3ec5e1940024a2a6a06
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_api_strings.h
@@ -0,0 +1,210 @@
+
+/******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+ ******************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+ *******************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+ *******************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones mentioned above :
+
+ *******************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+ *******************************************************************************
+ */
+
+/**
+ * @file   vl53l1_api_strings.h
+ * @brief  VL53L1 API function declarations for decoding error codes to a
+ *         text strings
+ */
+
+
+#ifndef VL53L1_API_STRINGS_H_
+#define VL53L1_API_STRINGS_H_
+
+#include "vl53l1_def.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+/**
+ * @brief Generates a string for the input device range status code
+ *
+ * @param[in]   RangeStatus           : Device Range AStatus Code
+ * @param[out]  pRangeStatusString    : pointer to character buffer
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_get_range_status_string(
+	uint8_t   RangeStatus,
+	char    *pRangeStatusString);
+
+/**
+ * @brief Generates an error string for the input PAL error code
+ *
+ * @param[in]   PalErrorCode         : PAL Error Code
+ * @param[out]  pPalErrorString      : pointer to character buffer
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_get_pal_error_string(
+	VL53L1_Error   PalErrorCode,
+	char         *pPalErrorString);
+
+/**
+ * @brief Generates a string for the input PAL State code
+ *
+ * @param[in]   PalStateCode         : PAL State Code
+ * @param[out]  pPalStateString      : pointer to character buffer
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_get_pal_state_string(
+	VL53L1_State   PalStateCode,
+	char         *pPalStateString);
+
+
+/**
+ * @brief Generates a string for the sequence step Id
+ *
+ * @param[in]   SequenceStepId            : Sequence Step Id
+ * @param[out]  pSequenceStepsString      : pointer to character buffer
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_get_sequence_steps_info(
+		VL53L1_SequenceStepId SequenceStepId,
+		char *pSequenceStepsString);
+
+/**
+ * @brief Generates a string for the limit check Id
+ *
+ * @param[in]   LimitCheckId            : Limit check Id
+ * @param[out]  pLimitCheckString       : pointer to character buffer
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_get_limit_check_info(uint16_t LimitCheckId,
+	char *pLimitCheckString);
+
+#ifndef VL53L1_USE_EMPTY_STRING
+	#define  VL53L1_STRING_DEVICE_INFO_NAME0          "VL53L1 cut1.0"
+	#define  VL53L1_STRING_DEVICE_INFO_NAME1          "VL53L1 cut1.1"
+	#define  VL53L1_STRING_DEVICE_INFO_TYPE          "VL53L1"
+
+	/* Range Status */
+	#define  VL53L1_STRING_RANGESTATUS_NONE                 "No Update"
+	#define  VL53L1_STRING_RANGESTATUS_RANGEVALID           "Range Valid"
+	#define  VL53L1_STRING_RANGESTATUS_SIGMA                "Sigma Fail"
+	#define  VL53L1_STRING_RANGESTATUS_SIGNAL               "Signal Fail"
+	#define  VL53L1_STRING_RANGESTATUS_MINRANGE             "Min Range Fail"
+	#define  VL53L1_STRING_RANGESTATUS_PHASE                "Phase Fail"
+	#define  VL53L1_STRING_RANGESTATUS_HW                   "Hardware Fail"
+
+
+	/* Range Status */
+	#define  VL53L1_STRING_STATE_POWERDOWN               "POWERDOWN State"
+	#define  VL53L1_STRING_STATE_WAIT_STATICINIT \
+			"Wait for staticinit State"
+	#define  VL53L1_STRING_STATE_STANDBY                 "STANDBY State"
+	#define  VL53L1_STRING_STATE_IDLE                    "IDLE State"
+	#define  VL53L1_STRING_STATE_RUNNING                 "RUNNING State"
+	#define  VL53L1_STRING_STATE_RESET                   "RESET State"
+	#define  VL53L1_STRING_STATE_UNKNOWN                 "UNKNOWN State"
+	#define  VL53L1_STRING_STATE_ERROR                   "ERROR State"
+
+
+
+	/* Check Enable */
+	#define  VL53L1_STRING_CHECKENABLE_SIGMA_FINAL_RANGE \
+			"SIGMA FINAL RANGE"
+	#define  VL53L1_STRING_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE \
+			"SIGNAL RATE FINAL RANGE"
+	#define  VL53L1_STRING_CHECKENABLE_SIGNAL_MIN_CLIP \
+			"SIGNAL MIN CLIP"
+	#define  VL53L1_STRING_CHECKENABLE_RANGE_IGNORE_THRESHOLD \
+			"RANGE IGNORE THRESHOLD"
+	#define  VL53L1_STRING_CHECKENABLE_RANGE_PHASE_HIGH \
+			"RANGE PHASE HIGH"
+	#define  VL53L1_STRING_CHECKENABLE_RANGE_PHASE_LOW \
+			"RANGE PHASE LOW"
+	#define  VL53L1_STRING_CHECKENABLE_RANGE_PHASE_CONSISTENCY \
+			"RANGE PHASE CONSISTENCY"
+
+	/* Sequence Step */
+	#define  VL53L1_STRING_SEQUENCESTEP_VHV         "VHV"
+	#define  VL53L1_STRING_SEQUENCESTEP_PHASECAL    "PHASE CAL"
+	#define  VL53L1_STRING_SEQUENCESTEP_REFPHASE    "REF PHASE"
+	#define  VL53L1_STRING_SEQUENCESTEP_DSS1        "DSS1"
+	#define  VL53L1_STRING_SEQUENCESTEP_DSS2        "DSS2"
+	#define  VL53L1_STRING_SEQUENCESTEP_MM1         "MM1"
+	#define  VL53L1_STRING_SEQUENCESTEP_MM2         "MM2"
+	#define  VL53L1_STRING_SEQUENCESTEP_RANGE       "RANGE"
+#endif /* VL53L1_USE_EMPTY_STRING */
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_core.h b/drivers/input/misc/vl53L1/inc/vl53l1_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..fa6dc8925a558371e0132f3aa2ad4854310dfe73
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_core.h
@@ -0,0 +1,1919 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_CORE_H_
+#define _VL53L1_CORE_H_
+
+#include "vl53l1_platform.h"
+#include "vl53l1_core_support.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+void VL53L1_init_version(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_ll_driver_state(
+	VL53L1_DEV         Dev,
+	VL53L1_DeviceState ll_state);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_update_ll_driver_rd_state(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_check_ll_driver_rd_state(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_update_ll_driver_cfg_state(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+void VL53L1_copy_rtn_good_spads_to_buffer(
+	VL53L1_nvm_copy_data_t  *pdata,
+	uint8_t                 *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_system_results(
+	VL53L1_system_results_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+void V53L1_init_zone_results_structure(
+	uint8_t                 active_zones,
+	VL53L1_zone_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+void V53L1_init_zone_dss_configs(
+	VL53L1_DEV              Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_histogram_config_structure(
+	uint8_t   even_bin0,
+	uint8_t   even_bin1,
+	uint8_t   even_bin2,
+	uint8_t   even_bin3,
+	uint8_t   even_bin4,
+	uint8_t   even_bin5,
+	uint8_t   odd_bin0,
+	uint8_t   odd_bin1,
+	uint8_t   odd_bin2,
+	uint8_t   odd_bin3,
+	uint8_t   odd_bin4,
+	uint8_t   odd_bin5,
+	VL53L1_histogram_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_histogram_multizone_config_structure(
+	uint8_t   even_bin0,
+	uint8_t   even_bin1,
+	uint8_t   even_bin2,
+	uint8_t   even_bin3,
+	uint8_t   even_bin4,
+	uint8_t   even_bin5,
+	uint8_t   odd_bin0,
+	uint8_t   odd_bin1,
+	uint8_t   odd_bin2,
+	uint8_t   odd_bin3,
+	uint8_t   odd_bin4,
+	uint8_t   odd_bin5,
+	VL53L1_histogram_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_xtalk_bin_data_struct(
+	uint32_t                        bin_value,
+	uint16_t                        VL53L1_p_024,
+	VL53L1_xtalk_histogram_shape_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_i2c_encode_uint16_t(
+	uint16_t    ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_i2c_decode_uint16_t(
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_i2c_encode_int16_t(
+	int16_t     ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+int16_t VL53L1_i2c_decode_int16_t(
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_i2c_encode_uint32_t(
+	uint32_t    ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_i2c_decode_uint32_t(
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_i2c_decode_with_mask(
+	uint16_t    count,
+	uint8_t    *pbuffer,
+	uint32_t    bit_mask,
+	uint32_t    down_shift,
+	uint32_t    offset);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_i2c_encode_int32_t(
+	int32_t     ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+int32_t VL53L1_i2c_decode_int32_t(
+	uint16_t    count,
+	uint8_t    *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_start_test(
+	VL53L1_DEV     Dev,
+	uint8_t        test_mode__ctrl);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_firmware_enable_register(
+	VL53L1_DEV         Dev,
+	uint8_t            value);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_enable_firmware(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_disable_firmware(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_powerforce_register(
+	VL53L1_DEV         Dev,
+	uint8_t            value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_enable_powerforce(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_disable_powerforce(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_clear_interrupt(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_force_shadow_stream_count_to_zero(
+	VL53L1_DEV         Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_macro_period_us(
+	uint16_t fast_osc_frequency,
+	uint8_t  VL53L1_p_009);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_calc_range_ignore_threshold(
+	uint32_t central_rate,
+	int16_t  x_gradient,
+	int16_t  y_gradient,
+	uint8_t  rate_mult);
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_timeout_mclks(
+	uint32_t  timeout_us,
+	uint32_t  macro_period_us);
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_calc_encoded_timeout(
+	uint32_t  timeout_us,
+	uint32_t  macro_period_us);
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_timeout_us(
+	uint32_t  timeout_mclks,
+	uint32_t  macro_period_us);
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_decoded_timeout_us(
+	uint16_t  timeout_encoded,
+	uint32_t  macro_period_us);
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_encode_timeout(
+	uint32_t timeout_mclks);
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_decode_timeout(
+	uint16_t encoded_timeout);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_calc_timeout_register_values(
+	uint32_t                 phasecal_config_timeout_us,
+	uint32_t                 mm_config_timeout_us,
+	uint32_t                 range_config_timeout_us,
+	uint16_t                 fast_osc_frequency,
+	VL53L1_general_config_t *pgeneral,
+	VL53L1_timing_config_t  *ptiming);
+
+
+
+
+
+
+
+
+
+
+
+
+uint8_t VL53L1_encode_vcsel_period(
+	uint8_t VL53L1_p_031);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_decode_unsigned_integer(
+	uint8_t  *pbuffer,
+	uint8_t   no_of_bytes);
+
+
+
+
+
+
+
+
+
+
+
+
+void   VL53L1_encode_unsigned_integer(
+	uint32_t  ip_value,
+	uint8_t   no_of_bytes,
+	uint8_t  *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_copy_and_scale_ambient_info(
+	VL53L1_zone_hist_info_t        *pidata,
+	VL53L1_histogram_bin_data_t    *podata);
+
+
+
+
+
+
+
+
+
+
+
+
+void  VL53L1_hist_get_bin_sequence_config(
+	VL53L1_DEV                     Dev,
+	VL53L1_histogram_bin_data_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_phase_consistency_check(
+	VL53L1_DEV                   Dev,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_zone_objects_t       *prange_prev,
+	VL53L1_range_results_t      *prange_curr);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_events_consistency_check(
+	uint8_t                      event_sigma,
+	uint16_t                     min_effective_spad_count,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_object_data_t        *prange_prev,
+	VL53L1_range_data_t         *prange_curr,
+	int32_t                     *pevents_tolerance,
+	int32_t                     *pevents_delta,
+	VL53L1_DeviceError          *prange_status);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_merged_pulse_check(
+	int16_t                      min_max_tolerance_mm,
+	VL53L1_range_data_t         *pdata,
+	VL53L1_DeviceError          *prange_status);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_xmonitor_consistency_check(
+	VL53L1_DEV                   Dev,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_zone_objects_t       *prange_prev,
+	VL53L1_range_data_t         *prange_curr);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_wrap_dmax(
+	VL53L1_hist_post_process_config_t *phistpostprocess,
+	VL53L1_histogram_bin_data_t       *pcurrent,
+	int16_t                           *pwrap_dmax_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_combine_mm1_mm2_offsets(
+	int16_t                              mm1_offset_mm,
+	int16_t                              mm2_offset_mm,
+	uint8_t                              encoded_mm_roi_centre,
+	uint8_t                              encoded_mm_roi_size,
+	uint8_t                              encoded_zone_centre,
+	uint8_t                              encoded_zone_size,
+	VL53L1_additional_offset_cal_data_t *pcal_data,
+	uint8_t                             *pgood_spads,
+	uint16_t                             aperture_attenuation,
+	int16_t                             *prange_offset_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_window(
+	int16_t                             target_distance_mm,
+	uint16_t                            target_width_oversize,
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_event_sums(
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_rate_per_spad(
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_shape(
+	VL53L1_hist_xtalk_extract_data_t  *pxtalk_data,
+	VL53L1_xtalk_histogram_shape_t    *pxtalk_shape);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_hist_xtalk_shape_model(
+	uint16_t                         events_per_bin,
+	uint16_t                         pulse_centre,
+	uint16_t                         pulse_width,
+	VL53L1_xtalk_histogram_shape_t  *pxtalk_shape);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_hist_xtalk_shape_model_interp(
+	uint16_t      events_per_bin,
+	uint32_t      phase_delta);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_spad_number_to_byte_bit_index(
+	uint8_t  spad_number,
+	uint8_t *pbyte_index,
+	uint8_t *pbit_index,
+	uint8_t *pbit_mask);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_encode_row_col(
+	uint8_t  row,
+	uint8_t  col,
+	uint8_t *pspad_number);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_decode_zone_size(
+	uint8_t   encoded_xy_size,
+	uint8_t  *pwidth,
+	uint8_t  *pheight);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_encode_zone_size(
+	uint8_t  width,
+	uint8_t  height,
+	uint8_t *pencoded_xy_size);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_decode_zone_limits(
+	uint8_t   encoded_xy_centre,
+	uint8_t   encoded_xy_size,
+	int16_t  *px_ll,
+	int16_t  *py_ll,
+	int16_t  *px_ur,
+	int16_t  *py_ur);
+
+
+
+
+
+
+
+
+
+
+
+
+uint8_t VL53L1_is_aperture_location(
+	uint8_t   row,
+	uint8_t   col);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_calc_max_effective_spads(
+	uint8_t     encoded_zone_centre,
+	uint8_t     encoded_zone_size,
+	uint8_t    *pgood_spads,
+	uint16_t    aperture_attenuation,
+	uint16_t   *pmax_effective_spads);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_calc_mm_effective_spads(
+	uint8_t     encoded_mm_roi_centre,
+	uint8_t     encoded_mm_roi_size,
+	uint8_t     encoded_zone_centre,
+	uint8_t     encoded_zone_size,
+	uint8_t    *pgood_spads,
+	uint16_t    aperture_attenuation,
+	uint16_t   *pmm_inner_effective_spads,
+	uint16_t   *pmm_outer_effective_spads);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_copy_results_to_sys_and_core(
+	VL53L1_histogram_bin_data_t      *pbins,
+	VL53L1_range_results_t           *phist,
+	VL53L1_system_results_t          *psys,
+	VL53L1_core_results_t            *pcore);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_sum_histogram_data(
+		VL53L1_histogram_bin_data_t *phist_input,
+		VL53L1_histogram_bin_data_t *phist_output);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_avg_histogram_data(
+		uint8_t no_of_samples,
+		VL53L1_histogram_bin_data_t *phist_sum,
+		VL53L1_histogram_bin_data_t *phist_avg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_save_cfg_data(
+	VL53L1_DEV  Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_zone_update(
+	VL53L1_DEV  Dev,
+	VL53L1_range_results_t *presults);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_update_internal_stream_counters(
+	VL53L1_DEV  Dev,
+	uint8_t     external_stream_count,
+	uint8_t     *pinternal_stream_count,
+	uint8_t     *pinternal_stream_count_val
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_multizone_hist_bins_update(
+	VL53L1_DEV  Dev);
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_multizone_initial_bin_config(
+	VL53L1_zone_config_t           *pzone_cfg,
+	VL53L1_histogram_config_t      *phist_cfg,
+	VL53L1_histogram_config_t      *pmulti_hist
+	);
+
+
+
+
+
+
+
+
+
+uint8_t	VL53L1_encode_GPIO_interrupt_config(
+	VL53L1_GPIO_interrupt_config_t	*pintconf);
+
+
+
+
+
+
+
+
+
+VL53L1_GPIO_interrupt_config_t VL53L1_decode_GPIO_interrupt_config(
+	uint8_t		system__interrupt_config);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_distance_threshold(
+	VL53L1_DEV                      Dev,
+	uint16_t			threshold_high,
+	uint16_t			threshold_low);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_rate_threshold(
+	VL53L1_DEV                      Dev,
+	uint16_t			threshold_high,
+	uint16_t			threshold_low);
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_thresholds_from_struct(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t *pintconf);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_ref_spad_char_config(
+	VL53L1_DEV    Dev,
+	uint8_t       vcsel_period_a,
+	uint32_t      phasecal_timeout_us,
+	uint16_t      total_rate_target_mcps,
+	uint16_t      max_count_rate_rtn_limit_mcps,
+	uint16_t      min_count_rate_rtn_limit_mcps,
+	uint16_t      fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_ssc_config(
+	VL53L1_DEV           Dev,
+	VL53L1_ssc_config_t *pssc_cfg,
+	uint16_t             fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_spad_rate_data(
+	VL53L1_DEV                Dev,
+	VL53L1_spad_rate_data_t  *pspad_rates);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_crosstalk_plane_offset_with_margin(
+		uint32_t     plane_offset_kcps,
+		int16_t      margin_offset_kcps);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_low_power_auto_data_init(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_low_power_auto_data_stop_range(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_calc_required_samples(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+	VL53L1_DEV				Dev,
+	uint32_t				xtalk_offset_out,
+	VL53L1_smudge_corrector_config_t	*pconfig,
+	VL53L1_smudge_corrector_data_t		*pout,
+	uint8_t					add_smudge,
+	uint8_t					soft_update
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_corrector(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_data_init(
+	VL53L1_DEV                     Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_output_init(
+	VL53L1_LLDriverResults_t *pres
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_xtalk_cal_data_init(
+	VL53L1_DEV                          Dev
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_config_low_power_auto_mode(
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_low_power_auto_data_t *plpadata
+	);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_low_power_auto_setup_manual_calibration(
+	VL53L1_DEV        Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_low_power_auto_update_DSS(
+	VL53L1_DEV        Dev);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_core_support.h b/drivers/input/misc/vl53L1/inc/vl53l1_core_support.h
new file mode 100644
index 0000000000000000000000000000000000000000..0b117491d6ce54ecd46d0e7ee299f021bc0b6021
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_core_support.h
@@ -0,0 +1,414 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_CORE_SUPPORT_H_
+#define _VL53L1_CORE_SUPPORT_H_
+
+#include "vl53l1_types.h"
+#include "vl53l1_hist_structs.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_pll_period_us(
+	uint16_t fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_duration_maths(
+	uint32_t  pll_period_us,
+	uint32_t  vcsel_parm_pclks,
+	uint32_t  window_vclks,
+	uint32_t  periods_elapsed_mclks);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_events_per_spad_maths(
+	int32_t   VL53L1_p_013,
+	uint16_t  num_spads,
+	uint32_t  duration);
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_isqrt(
+	uint32_t  num);
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_calc_zero_distance_phase(
+	VL53L1_histogram_bin_data_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_estimate_ambient_from_thresholded_bins(
+	int32_t                      ambient_threshold_sigma,
+	VL53L1_histogram_bin_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_remove_ambient_bins(
+	VL53L1_histogram_bin_data_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint32_t VL53L1_calc_pll_period_mm(
+	uint16_t fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_rate_maths(
+	int32_t   VL53L1_p_008,
+	uint32_t  time_us);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+uint16_t VL53L1_rate_per_spad_maths(
+	uint32_t  frac_bits,
+	uint32_t  peak_count_rate,
+	uint16_t  num_spads,
+	uint32_t  max_output_value);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+int32_t VL53L1_range_maths(
+	uint16_t  fast_osc_frequency,
+	uint16_t  VL53L1_p_017,
+	uint16_t  zero_distance_phase,
+	uint8_t   fractional_bits,
+	int32_t   gain_factor,
+	int32_t   range_offset_mm);
+
+
+
+
+
+
+
+
+
+
+
+
+uint8_t VL53L1_decode_vcsel_period(
+	uint8_t vcsel_period_reg);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_copy_xtalk_bin_data_to_histogram_data_struct(
+		VL53L1_xtalk_histogram_shape_t *pxtalk,
+		VL53L1_histogram_bin_data_t    *phist);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_init_histogram_bin_data_struct(
+	int32_t                      bin_value,
+	uint16_t                     VL53L1_p_024,
+	VL53L1_histogram_bin_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_decode_row_col(
+	uint8_t   spad_number,
+	uint8_t  *prow,
+	uint8_t  *pcol);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_find_min_max_bin_values(
+	VL53L1_histogram_bin_data_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_hist_estimate_ambient_from_ambient_bins(
+	VL53L1_histogram_bin_data_t    *pdata);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_def.h b/drivers/input/misc/vl53L1/inc/vl53l1_def.h
new file mode 100644
index 0000000000000000000000000000000000000000..abdd4a83ca8a537240d579bb573ff0c121a26fca
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_def.h
@@ -0,0 +1,848 @@
+/******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+ ******************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+ *******************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+ *******************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones mentioned above :
+
+ *******************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+ *******************************************************************************
+ */
+
+/**
+ * @file vl53l1_def.h
+ *
+ * @brief Type definitions for VL53L1 API.
+ *
+ */
+
+
+#ifndef _VL53L1_DEF_H_
+#define _VL53L1_DEF_H_
+
+#include "vl53l1_ll_def.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/** @defgroup VL53L1_globaldefine_group VL53L1 Defines
+ *  @brief    VL53L1 Defines
+ *  @{
+ */
+
+
+/** VL53L1 IMPLEMENTATION major version */
+#define VL53L1_IMPLEMENTATION_VER_MAJOR       6
+/** VL53L1 IMPLEMENTATION minor version */
+#define VL53L1_IMPLEMENTATION_VER_MINOR       0
+/** VL53L1 IMPLEMENTATION sub version */
+#define VL53L1_IMPLEMENTATION_VER_SUB         1
+/** VL53L1 IMPLEMENTATION sub version */
+#define VL53L1_IMPLEMENTATION_VER_REVISION  2003
+
+/****************************************
+ * PRIVATE define do not edit
+ ****************************************/
+
+/** @brief Defines the parameters of the Get Version Functions
+ */
+typedef struct {
+	uint32_t     revision; /*!< revision number */
+	uint8_t      major;    /*!< major number */
+	uint8_t      minor;    /*!< minor number */
+	uint8_t      build;    /*!< build number */
+} VL53L1_Version_t;
+
+
+#define VL53L1_DEVINFO_STRLEN 32
+
+/** @brief Defines the parameters of the Get Device Info Functions
+ */
+typedef struct {
+	char Name[VL53L1_DEVINFO_STRLEN];
+		/*!< Name of the Device e.g. Left_Distance */
+	char Type[VL53L1_DEVINFO_STRLEN];
+		/*!< Type of the Device e.g VL53L1 */
+	char ProductId[VL53L1_DEVINFO_STRLEN];
+		/*!< Product Identifier String
+		 * @warning Not yet implemented
+		 */
+	uint8_t ProductType;
+		/*!< Product Type, VL53L1 = 1, VL53L1 = 2*/
+	uint8_t ProductRevisionMajor;
+		/*!< Product revision major */
+	uint8_t ProductRevisionMinor;
+		/*!< Product revision minor */
+} VL53L1_DeviceInfo_t;
+
+
+
+/** @defgroup VL53L1_define_PresetModes_group Defines Preset modes
+ *  Defines all possible preset modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_PresetModes;
+
+#define VL53L1_PRESETMODE_RANGING                   ((VL53L1_PresetModes)  1)
+#define VL53L1_PRESETMODE_MULTIZONES_SCANNING       ((VL53L1_PresetModes)  2)
+#define VL53L1_PRESETMODE_AUTONOMOUS                ((VL53L1_PresetModes)  3)
+#define VL53L1_PRESETMODE_LITE_RANGING              ((VL53L1_PresetModes)  4)
+#define VL53L1_PRESETMODE_OLT                       ((VL53L1_PresetModes)  7)
+#define VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS       ((VL53L1_PresetModes)  8)
+#define VL53L1_PRESETMODE_PROXY_RANGING_MODE        ((VL53L1_PresetModes)  9)
+
+/** default preset ranging mode */
+//songyt test replace VL53L1_PRESETMODE_RANGING
+#define STMVL53L1_CFG_DEFAULT_MODE VL53L1_PRESETMODE_RANGING
+
+	/* ... Modes to be added depending on device */
+/** @} VL53L1_define_PresetModes_group */
+
+
+/** @defgroup VL53L1_define_DistanceModes_group Defines Distance modes
+ *  Defines all possible Distance modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_DistanceModes;
+
+#define VL53L1_DISTANCEMODE_SHORT             ((VL53L1_DistanceModes)  1)
+#define VL53L1_DISTANCEMODE_MEDIUM            ((VL53L1_DistanceModes)  2)
+#define VL53L1_DISTANCEMODE_LONG              ((VL53L1_DistanceModes)  3)
+/** @} VL53L1_define_DistanceModes_group */
+
+/** @defgroup VL53L1_define_OutputModes_group Defines Output modes
+ *  Defines all possible Output modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_OutputModes;
+
+#define VL53L1_OUTPUTMODE_NEAREST          ((VL53L1_OutputModes)  1)
+#define VL53L1_OUTPUTMODE_STRONGEST        ((VL53L1_OutputModes)  2)
+
+/** @} VL53L1_define_OutputModes_group */
+
+/** @defgroup VL53L1_define_XtalkCal_group Defines Xtalk Calibration modes
+ *  Defines all possible Offset Calibration modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_XtalkCalibrationModes;
+
+#define VL53L1_XTALKCALIBRATIONMODE_NO_TARGET \
+	((VL53L1_OffsetCalibrationModes) 0)
+/*!< To perform Xtalk calibration with no target below 80 cm */
+#define VL53L1_XTALKCALIBRATIONMODE_SINGLE_TARGET \
+	((VL53L1_OffsetCalibrationModes)  1)
+/*!< To perform Xtalk calibration with one target */
+#define VL53L1_XTALKCALIBRATIONMODE_FULL_ROI \
+	((VL53L1_OffsetCalibrationModes)  2)
+/*!< To perform Xtalk calibration based on histogram with full ROI */
+
+/** @} VL53L1_define_XtalkCal_group */
+
+/** @defgroup VL53L1_define_OffsetCal_group Defines Offset Calibration modes
+ *  Defines all possible Offset Calibration modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_OffsetCalibrationModes;
+
+#define VL53L1_OFFSETCALIBRATIONMODE_STANDARD \
+	((VL53L1_OffsetCalibrationModes)  1)
+#define VL53L1_OFFSETCALIBRATIONMODE_PRERANGE_ONLY  \
+	((VL53L1_OffsetCalibrationModes)  2)
+#define VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE    \
+	((VL53L1_OffsetCalibrationModes)  3)
+
+/** @} VL53L1_define_OffsetCal_group */
+
+/** @defgroup VL53L1_define_DeviceDmaxModes_group Defines Dmax source modes
+ *  Defines all possible sources for Dmax calibration for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_DeviceDmaxModes;
+
+#define VL53L1_DMAXMODE_FMT_CAL_DATA      ((VL53L1_DeviceDmaxModes)  1)
+#define VL53L1_DMAXMODE_CUSTCAL_DATA      ((VL53L1_DeviceDmaxModes)  2)
+#define VL53L1_DMAXMODE_PER_ZONE_CAL_DATA ((VL53L1_DeviceDmaxModes)  3)
+
+/** @} VL53L1_define_DeviceDmaxModes_group */
+
+/** @defgroup VL53L1_define_OffsetCorrectionModesBD_group
+ *  Device Offset Correction Mode
+ *
+ *  @brief Defines all possible offset correction modes for the device
+ *  @{
+ */
+typedef uint8_t VL53L1_OffsetCorrectionModes;
+
+#define VL53L1_OFFSETCORRECTIONMODE_STANDARD ((VL53L1_OffsetCorrectionMode)  1)
+#define VL53L1_OFFSETCORRECTIONMODE_PERZONE  ((VL53L1_OffsetCorrectionMode)  2)
+
+/** @} VL53L1_define_OffsetCorrectionModesBD_group */
+
+/** @defgroup VL53L1_define_RoiStatus_group Defines Roi Status
+ *  Defines the read status mode
+ *  @{
+ */
+typedef uint8_t VL53L1_RoiStatus;
+
+#define VL53L1_ROISTATUS_NOT_VALID                 ((VL53L1_RoiStatus)  0)
+#define VL53L1_ROISTATUS_VALID_NOT_LAST            ((VL53L1_RoiStatus)  1)
+#define VL53L1_ROISTATUS_VALID_LAST                ((VL53L1_RoiStatus)  2)
+/** @} VL53L1_define_RoiStatus_group */
+
+
+/** @defgroup VL53L1_CheckEnable_group Check Enable list
+ *  @brief Check Enable code
+ *
+ *  Define used to specify the LimitCheckId.
+ *  Use @a VL53L1_GetLimitCheckInfo() to get the string.
+ *  @{
+ */
+
+#define VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE           0
+#define VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE     1
+
+#define VL53L1_CHECKENABLE_NUMBER_OF_CHECKS            2
+
+/** @}  end of VL53L1_CheckEnable_group */
+
+
+/** @defgroup VL53L1_ThresholdMode_gropup Detection Functionality
+ *  @brief Defines the different functionalities for the detection feature
+ *  @{
+ */
+typedef uint8_t VL53L1_ThresholdMode;
+
+#define VL53L1_THRESHOLD_CROSSED_LOW   \
+	((VL53L1_ThresholdMode)  0)
+	/*!< Trigger interrupt if value < thresh_low */
+#define VL53L1_THRESHOLD_CROSSED_HIGH   \
+	((VL53L1_ThresholdMode)  1)
+	/*!< Trigger interrupt if value > thresh_high */
+#define VL53L1_THRESHOLD_OUT_OF_WINDOW    \
+	((VL53L1_ThresholdMode)  2)
+	/*!< Trigger interrupt if value < thresh_low OR value > thresh_high */
+#define VL53L1_THRESHOLD_IN_WINDOW        \
+	((VL53L1_ThresholdMode)  3)
+	/*!< Trigger interrupt if value > thresh_low AND value < thresh_high */
+
+/** @} end of VL53L1_ThresholdMode_gropup */
+
+/** @brief Defines parameters for Distance detection Thresholds configuration
+ */
+typedef struct {
+	VL53L1_ThresholdMode CrossMode;
+	uint16_t High; /*!< Distance threshold high limit in mm */
+	uint16_t Low;  /*!< Distance threshold low limit  in mm */
+} VL53L1_DistanceThreshold_t;
+
+/** @brief Defines parameters for Signal rate detection Thresholds configuration
+ */
+typedef struct {
+	VL53L1_ThresholdMode CrossMode;
+	FixPoint1616_t High; /*!< Signal rate threshold high limit */
+	FixPoint1616_t Low;  /*!< Signal rate threshold low limit */
+} VL53L1_RateThreshold_t;
+
+/** @defgroup VL53L1_DetectionMode_group Gpio Functionality
+ *  @brief Defines conditions leading to device's IT on GPIO
+ *  @{
+ */
+typedef uint8_t VL53L1_DetectionMode;
+
+#define VL53L1_DETECTION_NORMAL_RUN   \
+	((VL53L1_DetectionMode)  0)
+	/*!< Trigger interrupt on new measurement regardless of threshold
+	 * just like after a VL53L1_SetPresetMode() call
+	 */
+#define VL53L1_DETECTION_DISTANCE_ONLY   \
+	((VL53L1_DetectionMode)  1)
+	/*!< Trigger interrupt if "threshold event" occurs on distance */
+#define VL53L1_DETECTION_RATE_ONLY   \
+	((VL53L1_DetectionMode)  2)
+	/*!< Trigger interrupt if "threshold event" occurs on signal rate */
+#define VL53L1_DETECTION_DISTANCE_AND_RATE   \
+	((VL53L1_DetectionMode)  3)
+	/*!< Trigger interrupt if "threshold event" occurs on distance AND rate
+	 */
+#define VL53L1_DETECTION_DISTANCE_OR_RATE   \
+	((VL53L1_DetectionMode)  4)
+	/*!< Trigger interrupt if "threshold event" occurs on distance OR rate
+	 */
+
+/** @} end of VL53L1_DetectionMode_group */
+
+/** @brief Defines parameters for User/object Detection configuration
+ */
+typedef struct {
+	VL53L1_DetectionMode DetectionMode;	/*!< See #VL53L1_DetectionMode*/
+	uint8_t IntrNoTarget; /*!< 1 to trigger IT in case of no target found */
+	VL53L1_DistanceThreshold_t Distance; /*!< limits in mm */
+	VL53L1_RateThreshold_t Rate;/*!< limits in FixPoint1616_t */
+} VL53L1_DetectionConfig_t;
+
+
+/** @brief Defines all parameters for the device
+ */
+typedef struct {
+	VL53L1_PresetModes PresetMode;
+	/*!< Defines the operating mode to be used for the next measure */
+	VL53L1_OutputModes OutputMode;
+	/*!< Defines the Output mode to be used for the next measure */
+	VL53L1_DistanceModes DistanceMode;
+	/*!< Defines the operating mode to be used for the next measure */
+	uint32_t MeasurementTimingBudgetMicroSeconds;
+	/*!< Defines the allowed total time for a single measurement */
+	uint8_t LimitChecksEnable[VL53L1_CHECKENABLE_NUMBER_OF_CHECKS];
+	/*!< This Array store all the Limit Check enable for this device. */
+	uint8_t LimitChecksStatus[VL53L1_CHECKENABLE_NUMBER_OF_CHECKS];
+	/*!< This Array stores all the Status of the check linked to last
+	 * measurement.
+	 */
+	FixPoint1616_t LimitChecksValue[VL53L1_CHECKENABLE_NUMBER_OF_CHECKS];
+	/*!< This Array stores all the Limit Check value for this device */
+	FixPoint1616_t LimitChecksCurrent[VL53L1_CHECKENABLE_NUMBER_OF_CHECKS];
+	/*!< This Array stores all the Limit Check current value from latest
+	 * ranging
+	 */
+} VL53L1_DeviceParameters_t;
+
+
+/** @defgroup VL53L1_define_State_group Defines the current status of the device
+ *  Defines the current status of the device
+ *  @{
+ */
+
+typedef uint8_t VL53L1_State;
+
+#define VL53L1_STATE_POWERDOWN       ((VL53L1_State)  0)
+	/*!< Device is in HW reset  */
+#define VL53L1_STATE_WAIT_STATICINIT ((VL53L1_State)  1)
+	/*!< Device is initialized and wait for static initialization  */
+#define VL53L1_STATE_STANDBY         ((VL53L1_State)  2)
+	/*!< Device is in Low power Standby mode   */
+#define VL53L1_STATE_IDLE            ((VL53L1_State)  3)
+	/*!< Device has been initialized and ready to do measurements  */
+#define VL53L1_STATE_RUNNING         ((VL53L1_State)  4)
+	/*!< Device is performing measurement */
+#define VL53L1_STATE_RESET           ((VL53L1_State)  5)
+	/*!< Soft reset has been run on Device */
+#define VL53L1_STATE_UNKNOWN         ((VL53L1_State)  98)
+	/*!< Device is in unknown state and need to be rebooted  */
+#define VL53L1_STATE_ERROR           ((VL53L1_State)  99)
+	/*!< Device is in error state and need to be rebooted  */
+
+/** @} VL53L1_define_State_group */
+
+/** @defgroup VL53L1_define_Smudge_Mode_group Defines smudge correction modes
+ *  Defines the smudge correction modes
+ *  @{
+ */
+
+typedef uint8_t VL53L1_SmudgeCorrectionModes;
+
+#define VL53L1_SMUDGE_CORRECTION_NONE       ((VL53L1_SmudgeCorrectionModes)  0)
+	/*!< Smudge correction is applied continously accross the rangings */
+#define VL53L1_SMUDGE_CORRECTION_CONTINUOUS ((VL53L1_SmudgeCorrectionModes)  1)
+	/*!< Smudge correction is applied continously accross the rangings */
+#define VL53L1_SMUDGE_CORRECTION_SINGLE     ((VL53L1_SmudgeCorrectionModes)  2)
+	/*!< Smudge correction is applied only once accross the rangings */
+#define VL53L1_SMUDGE_CORRECTION_DEBUG      ((VL53L1_SmudgeCorrectionModes)  3)
+	/*!< Smudge detection is applied continously but Xtalk values are not
+	 * updated automatically within the driver
+	 */
+
+/** @} VL53L1_define_Smudge_Correction_Mode_group */
+
+
+/**
+ * @struct VL53L1_RangingMeasurementData_t
+ * @brief Single Range measurement data.
+ */
+typedef struct {
+	uint32_t TimeStamp;
+		/*!< 32-bit time stamp.
+		 * @warning Not yet implemented
+		 */
+
+	uint8_t StreamCount;
+		/*!< 8-bit Stream Count. */
+
+	uint8_t RangeQualityLevel;
+		/*!< indicate a quality level in percentage from 0 to 100
+		 * @warning Not yet implemented
+		 */
+
+	FixPoint1616_t SignalRateRtnMegaCps;
+		/*!< Return signal rate (MCPS)\n these is a 16.16 fix point
+		 *  value, which is effectively a measure of target
+		 *   reflectance.
+		 */
+
+	FixPoint1616_t AmbientRateRtnMegaCps;
+		/*!< Return ambient rate (MCPS)\n these is a 16.16 fix point
+		 *  value, which is effectively a measure of the ambien
+		 *  t light.
+		 */
+
+	uint16_t EffectiveSpadRtnCount;
+		/*!< Return the effective SPAD count for the return signal.
+		 *  To obtain Real value it should be divided by 256
+		 */
+
+	FixPoint1616_t SigmaMilliMeter;
+		/*!< Return the Sigma value in millimeter */
+
+	int16_t RangeMilliMeter;
+		/*!< range distance in millimeter. This should be between
+		 *  RangeMinMilliMeter and RangeMaxMilliMeter
+		 */
+
+	uint8_t RangeFractionalPart;
+		/*!< Fractional part of range distance. Final value is a
+		 *  RangeMilliMeter + RangeFractionalPart/256.
+		 *  @warning Not yet implemented
+		 */
+
+	uint8_t RangeStatus;
+		/*!< Range Status for the current measurement. This is device
+		 *  dependent. Value = 0 means value is valid.
+		 */
+} VL53L1_RangingMeasurementData_t;
+
+/**
+ * @struct VL53L1_TargetRangeData_t
+ * @brief One Range measurement data for each target.
+ */
+typedef struct {
+	uint8_t RangeQualityLevel;
+		/*!< indicate a quality level in percentage from 0 to 100
+		 * @warning Not yet implemented
+		 */
+
+	int16_t RangeMaxMilliMeter;
+		/*!< Tells what is the maximum detection distance of the object
+		 * in current setup and environment conditions (Filled when
+		 *  applicable)
+		 */
+
+	int16_t RangeMinMilliMeter;
+		/*!< Tells what is the minimum detection distance of the object
+		 * in current setup and environment conditions (Filled when
+		 *  applicable)
+		 */
+
+	FixPoint1616_t SignalRateRtnMegaCps;
+		/*!< Return signal rate (MCPS)\n these is a 16.16 fix point
+		 *  value, which is effectively a measure of target
+		 *   reflectance.
+		 */
+
+	FixPoint1616_t AmbientRateRtnMegaCps;
+		/*!< Return ambient rate (MCPS)\n these is a 16.16 fix point
+		 *  value, which is effectively a measure of the ambien
+		 *  t light.
+		 */
+
+	FixPoint1616_t SigmaMilliMeter;
+		/*!< Return the Sigma value in millimeter */
+
+	int16_t RangeMilliMeter;
+		/*!< range distance in millimeter. This should be between
+		 *  RangeMinMilliMeter and RangeMaxMilliMeter
+		 */
+
+	uint8_t RangeFractionalPart;
+		/*!< Fractional part of range distance. Final value is a
+		 *  RangeMilliMeter + RangeFractionalPart/256.
+		 *  @warning Not yet implemented
+		 */
+
+	uint8_t RangeStatus;
+		/*!< Range Status for the current measurement. This is device
+		 *  dependent. Value = 0 means value is valid.
+		 */
+} VL53L1_TargetRangeData_t;
+/**
+ * @struct  VL53L1_MultiRangingData_t
+ * @brief   Structure for storing the set of range results for a single ROI
+ *
+ */
+typedef struct {
+	uint32_t TimeStamp;
+		/*!< 32-bit time stamp.
+		 * @warning Not yet implemented
+		 */
+
+	uint8_t StreamCount;
+		/*!< 8-bit Stream Count. */
+
+	uint8_t RoiNumber;
+		/*!< Denotes on which ROI the range data is related to. */
+	uint8_t NumberOfObjectsFound;
+		/*!< Indicate the number of objects found in the current ROI.
+		 * This is used to know how many ranging data should be get.
+		 * NumberOfObjectsFound is in the range 0 to
+		 * VL53L1_MAX_RANGE_RESULTS.
+		 */
+	VL53L1_RoiStatus RoiStatus;
+		/*!< Indicate if the data read is valid or not or if this is
+		 * the last valid data in the ROI.
+		 */
+	VL53L1_TargetRangeData_t RangeData[VL53L1_MAX_RANGE_RESULTS];
+		/*!< Range data each target distance */
+	uint8_t HasXtalkValueChanged;
+		/*!< set to 1 if a new Xtalk value has been computed whilst
+		 * smudge correction mode enable by with
+		 * VL53L1_SmudgeCorrectionEnable() function is either
+		 * VL53L1_SMUDGE_CORRECTION_CONTINUOUS or
+		 * VL53L1_SMUDGE_CORRECTION_SINGLE.
+		 */
+	uint16_t EffectiveSpadRtnCount;
+		/*!< Return the effective SPAD count for the return signal.
+		 *  To obtain Real value it should be divided by 256
+		 */
+	int16_t DmaxMilliMeter;
+		/*!< range Dmax distance in millimeter.
+		 */
+	VL53L1_DistanceModes RecommendedDistanceMode;
+		/*!< suggestion for a better distance mode choice to improve
+		 *  range accuracy.
+		 */
+} VL53L1_MultiRangingData_t;
+
+
+/** @brief Defines User Zone(ROI) parameters
+ *
+ */
+typedef struct {
+
+	uint8_t   TopLeftX;   /*!< Top Left x coordinate:  0-15 range */
+	uint8_t   TopLeftY;   /*!< Top Left y coordinate:  0-15 range */
+	uint8_t   BotRightX;  /*!< Bot Right x coordinate: 0-15 range */
+	uint8_t   BotRightY;  /*!< Bot Right y coordinate: 0-15 range */
+
+} VL53L1_UserRoi_t;
+
+
+/** @brief Defines ROI configuration parameters
+ *
+ *  Support up a max of 16 zones, Each Zone has the same size
+ *
+ */
+typedef struct {
+
+	uint8_t             NumberOfRoi;   /*!< Number of Rois defined*/
+
+	VL53L1_UserRoi_t    UserRois[VL53L1_MAX_USER_ZONES];
+		/*!< List of Rois */
+
+} VL53L1_RoiConfig_t;
+
+/**
+ * @struct VL53L1_CustomerNvmManaged_t
+ *
+ */
+
+typedef struct {
+	uint8_t   global_config__spad_enables_ref_0;
+	uint8_t   global_config__spad_enables_ref_1;
+	uint8_t   global_config__spad_enables_ref_2;
+	uint8_t   global_config__spad_enables_ref_3;
+	uint8_t   global_config__spad_enables_ref_4;
+	uint8_t   global_config__spad_enables_ref_5;
+	uint8_t   global_config__ref_en_start_select;
+	uint8_t   ref_spad_man__num_requested_ref_spads;
+	uint8_t   ref_spad_man__ref_location;
+	uint32_t  algo__crosstalk_compensation_plane_offset_kcps;
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+	uint16_t  ref_spad_char__total_rate_target_mcps;
+	int16_t   algo__part_to_part_range_offset_mm;
+	int16_t   mm_config__inner_offset_mm;
+	int16_t   mm_config__outer_offset_mm;
+} VL53L1_CustomerNvmManaged_t;
+
+/**
+ * @struct  VL53L1_CalibrationData_t
+ * @brief   Structure for storing the Calibration Data
+ *
+ */
+
+typedef struct {
+
+	uint32_t                             struct_version;
+	VL53L1_CustomerNvmManaged_t          customer;
+	VL53L1_dmax_calibration_data_t       fmt_dmax_cal;
+	VL53L1_dmax_calibration_data_t       cust_dmax_cal;
+	VL53L1_additional_offset_cal_data_t  add_off_cal_data;
+	VL53L1_optical_centre_t              optical_centre;
+	VL53L1_xtalk_histogram_data_t        xtalkhisto;
+	VL53L1_gain_calibration_data_t       gain_cal;
+	VL53L1_cal_peak_rate_map_t           cal_peak_rate_map;
+
+} VL53L1_CalibrationData_t;
+
+#define VL53L1_ADDITIONAL_CALIBRATION_DATA_STRUCT_VERSION  0x10
+/** VL53L1 additional Calibration Data struct version final struct version
+ * is given by adding it to  VL53L1_LL_CALIBRATION_DATA_STRUCT_VERSION
+ */
+
+#define VL53L1_CALIBRATION_DATA_STRUCT_VERSION \
+		(VL53L1_LL_CALIBRATION_DATA_STRUCT_VERSION + \
+		VL53L1_ADDITIONAL_CALIBRATION_DATA_STRUCT_VERSION)
+/* VL53L1 Calibration Data struct version */
+
+/**
+ * @struct  VL53L1_AdditionalData_t
+ * @brief   Structure for storing the Additional Data
+ *
+ */
+typedef VL53L1_additional_data_t VL53L1_AdditionalData_t;
+
+/**
+ * @struct  VL53L1_ZoneCalibrationData_t
+ * @brief   Structure for storing the Zone Calibration Data
+ *
+ */
+typedef VL53L1_zone_calibration_results_t VL53L1_ZoneCalibrationData_t;
+
+/** @defgroup VL53L1_define_SequenceStepId_group Defines the SequenceStep
+ *	Defines the the sequence steps performed during ranging..
+ *	@{
+ */
+typedef uint8_t VL53L1_SequenceStepId;
+
+#define	 VL53L1_SEQUENCESTEP_VHV		 ((VL53L1_SequenceStepId) 0)
+/*!<VHV. */
+#define	 VL53L1_SEQUENCESTEP_PHASECAL		 ((VL53L1_SequenceStepId) 1)
+/*!<Phase Calibration. */
+#define	 VL53L1_SEQUENCESTEP_REFPHASE		 ((VL53L1_SequenceStepId) 2)
+/*!<Reference Phase. */
+#define	 VL53L1_SEQUENCESTEP_DSS1		 ((VL53L1_SequenceStepId) 3)
+/*!<DSS1. */
+#define	 VL53L1_SEQUENCESTEP_DSS2		 ((VL53L1_SequenceStepId) 4)
+/*!<DSS2. */
+#define	 VL53L1_SEQUENCESTEP_MM1		 ((VL53L1_SequenceStepId) 5)
+/*!<Mode Mitigation 1. */
+#define	 VL53L1_SEQUENCESTEP_MM2		 ((VL53L1_SequenceStepId) 6)
+/*!<Mode Mitigation 2. */
+#define	 VL53L1_SEQUENCESTEP_RANGE		 ((VL53L1_SequenceStepId) 7)
+/*!<Final Range step. */
+
+#define	 VL53L1_SEQUENCESTEP_NUMBER_OF_ITEMS			 8
+/*!<Number of Sequence Step Managed by the API. */
+
+/** @} VL53L1_define_SequenceStepId_group */
+
+/** @defgroup VL53L1_define_RangeStatus_group Defines the Range Status
+ *	@{
+ */
+#define	 VL53L1_RANGESTATUS_RANGE_VALID				0
+/*!<The Range is valid. */
+#define	 VL53L1_RANGESTATUS_SIGMA_FAIL				1
+/*!<Sigma Fail. */
+#define	 VL53L1_RANGESTATUS_SIGNAL_FAIL				2
+/*!<Signal fail. */
+#define	 VL53L1_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED	3
+/*!<Target is below minimum detection threshold. */
+#define	 VL53L1_RANGESTATUS_OUTOFBOUNDS_FAIL			4
+/*!<Phase out of valid limits -  different to a wrap exit. */
+#define	 VL53L1_RANGESTATUS_HARDWARE_FAIL			5
+/*!<Hardware fail. */
+#define	 VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL	6
+/*!<The Range is valid but the wraparound check has not been done. */
+#define	VL53L1_RANGESTATUS_WRAP_TARGET_FAIL			7
+/*!<Wrapped target - no matching phase in other VCSEL period timing. */
+#define	VL53L1_RANGESTATUS_PROCESSING_FAIL			8
+/*!<Internal algo underflow or overflow in lite ranging. */
+#define	VL53L1_RANGESTATUS_XTALK_SIGNAL_FAIL			9
+/*!<Specific to lite ranging. */
+#define	VL53L1_RANGESTATUS_SYNCRONISATION_INT			10
+/*!<1st interrupt when starting ranging in back to back mode. Ignore data. */
+#define	VL53L1_RANGESTATUS_RANGE_VALID_MERGED_PULSE		11
+/*!<All Range ok but object is result of multiple pulses merging together.
+ * Used by RQL for merged pulse detection
+ */
+#define	VL53L1_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL	12
+/*!<Used  by RQL  as different to phase fail. */
+#define	VL53L1_RANGESTATUS_MIN_RANGE_FAIL			13
+/*!<User ROI input is not valid e.g. beyond SPAD Array.*/
+#define	VL53L1_RANGESTATUS_RANGE_INVALID			14
+/*!<lld returned valid range but negative value ! */
+#define	 VL53L1_RANGESTATUS_NONE				255
+/*!<No Update. */
+
+/** @} VL53L1_define_RangeStatus_group */
+
+
+/** @brief  Contains the Internal data of the Bare Driver
+ */
+
+typedef struct {
+	VL53L1_LLDriverData_t   LLData;
+	/*!< Low Level Driver data structure */
+
+	VL53L1_LLDriverResults_t llresults;
+	/*!< Low Level Driver data structure */
+
+	VL53L1_State      PalState; /* Store the pal state */
+	VL53L1_DeviceParameters_t CurrentParameters;
+	/*!< Current Device Parameter */
+
+} VL53L1_DevData_t;
+
+
+/* MACRO Definitions */
+/** @defgroup VL53L1_define_GeneralMacro_group General Macro Defines
+ *  General Macro Defines
+ *  @{
+ */
+
+/* Defines */
+#define VL53L1_SETPARAMETERFIELD(Dev, field, value) \
+	(VL53L1DevDataSet(Dev, CurrentParameters.field, value))
+
+#define VL53L1_GETPARAMETERFIELD(Dev, field, variable) \
+	(variable = VL53L1DevDataGet(Dev, CurrentParameters).field)
+
+
+#define VL53L1_SETARRAYPARAMETERFIELD(Dev, field, index, value) \
+	(VL53L1DevDataSet(Dev, CurrentParameters.field[index], value))
+
+#define VL53L1_GETARRAYPARAMETERFIELD(Dev, field, index, variable) \
+	(variable = VL53L1DevDataGet(Dev, CurrentParameters).field[index])
+
+
+#define VL53L1_SETDEVICESPECIFICPARAMETER(Dev, field, value) \
+	(VL53L1DevDataSet(Dev, DeviceSpecificParameters.field, value))
+
+#define VL53L1_GETDEVICESPECIFICPARAMETER(Dev, field) \
+	(VL53L1DevDataGet(Dev, DeviceSpecificParameters).field)
+
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT44(Value) \
+	(uint16_t)((Value>>12)&0xFFFF)
+#define VL53L1_FIXPOINT44TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<12)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT72(Value) \
+	(uint16_t)((Value>>14)&0xFFFF)
+#define VL53L1_FIXPOINT72TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<14)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT97(Value) \
+	(uint16_t)((Value>>9)&0xFFFF)
+#define VL53L1_FIXPOINT97TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<9)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT88(Value) \
+	(uint16_t)((Value>>8)&0xFFFF)
+#define VL53L1_FIXPOINT88TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<8)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT412(Value) \
+	(uint16_t)((Value>>4)&0xFFFF)
+#define VL53L1_FIXPOINT412TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<4)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT313(Value) \
+	(uint16_t)((Value>>3)&0xFFFF)
+#define VL53L1_FIXPOINT313TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<3)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT08(Value) \
+	(uint8_t)((Value>>8)&0x00FF)
+#define VL53L1_FIXPOINT08TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<8)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT53(Value) \
+	(uint8_t)((Value>>13)&0x00FF)
+#define VL53L1_FIXPOINT53TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<13)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT102(Value) \
+	(uint16_t)((Value>>14)&0x0FFF)
+#define VL53L1_FIXPOINT102TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<14)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT142(Value) \
+	(uint16_t)((Value>>14)&0xFFFF)
+#define VL53L1_FIXPOINT142TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<14)
+
+#define VL53L1_FIXPOINT1616TOFIXPOINT160(Value) \
+	(uint16_t)((Value>>16)&0xFFFF)
+#define VL53L1_FIXPOINT160TOFIXPOINT1616(Value) \
+	(FixPoint1616_t)((uint32_t)Value<<16)
+
+#define VL53L1_MAKEUINT16(lsb, msb) (uint16_t)((((uint16_t)msb)<<8) + \
+		(uint16_t)lsb)
+
+#ifndef SUPPRESS_UNUSED_WARNING
+#define SUPPRESS_UNUSED_WARNING(x) ((void) (x))
+#endif
+
+/** @} VL53L1_define_GeneralMacro_group */
+
+/** @} VL53L1_globaldefine_group */
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+
+#endif /* _VL53L1_DEF_H_ */
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_dmax_structs.h b/drivers/input/misc/vl53L1/inc/vl53l1_dmax_structs.h
new file mode 100644
index 0000000000000000000000000000000000000000..5b4d9b7f20e369f90058189d98e8d586f32655c2
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_dmax_structs.h
@@ -0,0 +1,210 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_DMAX_STRUCTS_H_
+#define _VL53L1_DMAX_STRUCTS_H_
+
+#include "vl53l1_types.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+#define VL53L1_MAX_AMBIENT_DMAX_VALUES        5
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+
+	uint16_t  ref__actual_effective_spads;
+
+
+	uint16_t  ref__peak_signal_count_rate_mcps;
+
+
+	uint16_t  ref__distance_mm;
+
+
+	uint16_t   ref_reflectance_pc;
+
+
+
+
+
+
+	uint16_t   coverglass_transmission;
+
+
+
+} VL53L1_dmax_calibration_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+
+	uint8_t   signal_thresh_sigma;
+
+
+	uint8_t   ambient_thresh_sigma;
+
+
+	int32_t   min_ambient_thresh_events;
+
+
+	int32_t   signal_total_events_limit;
+
+
+
+	uint16_t  target_reflectance_for_dmax_calc[
+			VL53L1_MAX_AMBIENT_DMAX_VALUES];
+
+
+	uint16_t  max_effective_spads;
+
+
+
+
+
+
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+	uint8_t   dss_config__aperture_attenuation;
+
+
+
+} VL53L1_hist_gen3_dmax_config_t;
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_error_codes.h b/drivers/input/misc/vl53L1/inc/vl53l1_error_codes.h
new file mode 100644
index 0000000000000000000000000000000000000000..1bf727eaf5609c469983f387de6fcadf923437e2
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_error_codes.h
@@ -0,0 +1,273 @@
+/******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+ ******************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+ *******************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+ *******************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones mentioned above :
+
+ *******************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+ *******************************************************************************
+ */
+
+/**
+ * @file vl53l1_error_codes.h
+ *
+ * @brief Error Code definitions for VL53L1 API.
+ *
+ */
+
+#ifndef _VL53L1_ERROR_CODES_H_
+#define _VL53L1_ERROR_CODES_H_
+
+#include "vl53l1_types.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+/*
+ ****************************************
+ * PRIVATE define do not edit
+ ***************************************
+ */
+
+/*
+ * @defgroup VL53L1_define_Error_group Error and Warning code returned by API
+ *  The following DEFINE are used to identify the PAL ERROR
+ *  @{
+ */
+
+typedef int8_t VL53L1_Error;
+
+#define VL53L1_ERROR_NONE                              ((VL53L1_Error)  0)
+#define VL53L1_ERROR_CALIBRATION_WARNING               ((VL53L1_Error) - 1)
+	/*!< Warning invalid calibration data may be in used
+	 *	\a  VL53L1_InitData()
+	 *	\a VL53L1_GetOffsetCalibrationData
+	 *	\a VL53L1_SetOffsetCalibrationData
+	 */
+#define VL53L1_ERROR_MIN_CLIPPED                       ((VL53L1_Error) - 2)
+	/*!< Warning parameter passed was clipped to min before to be applied */
+
+#define VL53L1_ERROR_UNDEFINED                         ((VL53L1_Error) - 3)
+	/*!< Unqualified error */
+#define VL53L1_ERROR_INVALID_PARAMS                    ((VL53L1_Error) - 4)
+	/*!< Parameter passed is invalid or out of range */
+#define VL53L1_ERROR_NOT_SUPPORTED                     ((VL53L1_Error) - 5)
+	/*!< Function is not supported in current mode or configuration */
+#define VL53L1_ERROR_RANGE_ERROR                       ((VL53L1_Error) - 6)
+	/*!< Device report a ranging error interrupt status */
+#define VL53L1_ERROR_TIME_OUT                          ((VL53L1_Error) - 7)
+	/*!< Aborted due to time out */
+#define VL53L1_ERROR_MODE_NOT_SUPPORTED                ((VL53L1_Error) - 8)
+	/*!< Asked mode is not supported by the device */
+#define VL53L1_ERROR_BUFFER_TOO_SMALL                  ((VL53L1_Error) - 9)
+	/*!< ... */
+#define VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL            ((VL53L1_Error) - 10)
+	/*!< Supplied buffer is larger than I2C supports */
+#define VL53L1_ERROR_GPIO_NOT_EXISTING                 ((VL53L1_Error) - 11)
+	/*!< User tried to setup a non-existing GPIO pin */
+#define VL53L1_ERROR_GPIO_FUNCTIONALITY_NOT_SUPPORTED  ((VL53L1_Error) - 12)
+	/*!< unsupported GPIO functionality */
+#define VL53L1_ERROR_CONTROL_INTERFACE                 ((VL53L1_Error) - 13)
+	/*!< error reported from IO functions */
+#define VL53L1_ERROR_INVALID_COMMAND                   ((VL53L1_Error) - 14)
+	/*!< The command is not allowed in the current device state
+	 *  (power down)
+	 */
+#define VL53L1_ERROR_DIVISION_BY_ZERO                  ((VL53L1_Error) - 15)
+	/*!< In the function a division by zero occurs */
+#define VL53L1_ERROR_REF_SPAD_INIT                     ((VL53L1_Error) - 16)
+	/*!< Error during reference SPAD initialization */
+#define VL53L1_ERROR_GPH_SYNC_CHECK_FAIL               ((VL53L1_Error) - 17)
+	/*!<  GPH sync interrupt check fail - API out of sync with device*/
+#define VL53L1_ERROR_STREAM_COUNT_CHECK_FAIL           ((VL53L1_Error) - 18)
+	/*!<  Stream count check fail - API out of sync with device */
+#define VL53L1_ERROR_GPH_ID_CHECK_FAIL                 ((VL53L1_Error) - 19)
+	/*!<  GPH ID check fail - API out of sync with device */
+#define VL53L1_ERROR_ZONE_STREAM_COUNT_CHECK_FAIL      ((VL53L1_Error) - 20)
+	/*!<  Zone dynamic config stream count check failed - API out of sync */
+#define VL53L1_ERROR_ZONE_GPH_ID_CHECK_FAIL            ((VL53L1_Error) - 21)
+	/*!<  Zone dynamic config GPH ID check failed - API out of sync */
+
+#define VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL   ((VL53L1_Error) - 22)
+	/*!<  Thrown when run_xtalk_extraction fn has 0 succesful samples
+	 * when using the full array to sample the xtalk. In this case there is
+	 * not enough information to generate new Xtalk parm info. The function
+	 * will exit and leave the current xtalk parameters unaltered
+	 */
+#define VL53L1_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL ((VL53L1_Error) - 23)
+	/*!<  Thrown when run_xtalk_extraction fn has found that the
+	 * avg sigma estimate of the full array xtalk sample is > than the
+	 * maximal limit allowed. In this case the xtalk sample is too noisy for
+	 * measurement. The function will exit and leave the current xtalk
+	 * parameters unaltered.
+	 */
+
+
+#define VL53L1_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL           ((VL53L1_Error) - 24)
+	/*!<  Thrown if there one of stages has no valid offset calibration
+	 *    samples. A fatal error calibration not valid
+	 */
+#define VL53L1_ERROR_OFFSET_CAL_NO_SPADS_ENABLED_FAIL    ((VL53L1_Error) - 25)
+	/*!<  Thrown if there one of stages has zero effective SPADS
+	 *    Traps the case when MM1 SPADs is zero.
+	 *    A fatal error calibration not valid
+	 */
+#define VL53L1_ERROR_ZONE_CAL_NO_SAMPLE_FAIL             ((VL53L1_Error) - 26)
+	/*!<  Thrown if then some of the zones have no valid samples
+	 *    A fatal error calibration not valid
+	 */
+
+#define VL53L1_ERROR_TUNING_PARM_KEY_MISMATCH             ((VL53L1_Error) - 27)
+	/*!<  Thrown if the tuning file key table version does not match with
+	 * expected value. The driver expects the key table version to match
+	 * the compiled default version number in the define
+	 * #VL53L1_TUNINGPARM_KEY_TABLE_VERSION_DEFAULT
+	 */
+
+#define VL53L1_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS   ((VL53L1_Error) - 28)
+	/*!<  Thrown if there are less than 5 good SPADs are available. */
+#define VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH      ((VL53L1_Error) - 29)
+	/*!<  Thrown if the final reference rate is greater than
+	 * the upper reference rate limit - default is 40 Mcps.
+	 * Implies a minimum Q3 (x10) SPAD (5) selected
+	 */
+#define VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW       ((VL53L1_Error) - 30)
+	/*!<  Thrown if the final reference rate is less than
+	 * the lower reference rate limit - default is 10 Mcps.
+	 * Implies maximum Q1 (x1) SPADs selected
+	 */
+
+
+#define VL53L1_WARNING_OFFSET_CAL_MISSING_SAMPLES       ((VL53L1_Error) - 31)
+	/*!<  Thrown if there is less than the requested number of
+	 *    valid samples.
+	 */
+#define VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH        ((VL53L1_Error) - 32)
+	/*!<  Thrown if the offset calibration range sigma estimate is greater
+	 *    than 8.0 mm. This is the recommended min value to yield a stable
+	 *    offset measurement
+	 */
+#define VL53L1_WARNING_OFFSET_CAL_RATE_TOO_HIGH         ((VL53L1_Error) - 33)
+	/*!< Thrown when VL53L1_run_offset_calibration()  peak rate is greater
+	 * than that 50.0Mcps. This is the recommended  max rate to avoid
+	 * pile-up influencing the offset measurement
+	 */
+#define VL53L1_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW    ((VL53L1_Error) - 34)
+	/*!< Thrown when VL53L1_run_offset_calibration() when one of stages
+	 * range has less that 5.0 effective SPADS. This is the recommended
+	 * min value to yield a stable offset
+	 */
+
+
+#define VL53L1_WARNING_ZONE_CAL_MISSING_SAMPLES       ((VL53L1_Error) - 35)
+	/*!<  Thrown if one of more of the zones have less than
+	 * the requested number of valid samples
+	 */
+#define VL53L1_WARNING_ZONE_CAL_SIGMA_TOO_HIGH        ((VL53L1_Error) - 36)
+	/*!<  Thrown if one or more zones have sigma estimate value greater
+	 *    than 8.0 mm. This is the recommended min value to yield a stable
+	 *    offset measurement
+	 */
+#define VL53L1_WARNING_ZONE_CAL_RATE_TOO_HIGH         ((VL53L1_Error) - 37)
+	/*!< Thrown if one of more zones have  peak rate higher than
+	 * that 50.0Mcps. This is the recommended  max rate to avoid
+	 * pile-up influencing the offset measurement
+	 */
+
+
+#define VL53L1_WARNING_XTALK_MISSING_SAMPLES             ((VL53L1_Error) - 38)
+	/*!< Thrown to notify that some of the xtalk samples did not yield
+	 * valid ranging pulse data while attempting to measure
+	 * the xtalk signal in vl53l1_run_xtalk_extract(). This can signify any
+	 * of the zones are missing samples, for further debug information the
+	 * xtalk_results struct should be referred to. This warning is for
+	 * notification only, xtalk pulse and shape have still been generated
+	 */
+#define VL53L1_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT     ((VL53L1_Error) - 39)
+	/*!< Thrown to notify that some of teh xtalk samples used for gradient
+	 * generation did not yield valid ranging pulse data while attempting to
+	 * measure the xtalk signal in vl53l1_run_xtalk_extract(). This can
+	 * signify that any one of the zones 0-3 yielded no successful samples.
+	 * xtalk_results struct should be referred to for further debug info.
+	 * This warning is for notification only, the xtalk pulse and shape
+	 * have still been generated.
+	 */
+#define VL53L1_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT    ((VL53L1_Error) - 40)
+	/*!< Thrown to notify that some of the xtalk samples used for gradient
+	 * generation did not pass the sigma limit check  while attempting to
+	 * measure the xtalk signal in vl53l1_run_xtalk_extract(). This can
+	 * signify that any one of the zones 0-3 yielded an avg sigma_mm
+	 * value > the limit. The xtalk_results struct should be referred to for
+	 * further debug info.
+	 * This warning is for notification only, the xtalk pulse and shape
+	 * have still been generated.
+	 */
+
+#define VL53L1_ERROR_NOT_IMPLEMENTED                   ((VL53L1_Error) - 41)
+	/*!< Tells requested functionality has not been implemented yet or
+	 * not compatible with the device
+	 */
+#define VL53L1_ERROR_PLATFORM_SPECIFIC_START           ((VL53L1_Error) - 60)
+	/*!< Tells the starting code for platform */
+/** @} VL53L1_define_Error_group */
+
+
+#ifdef __cplusplus
+}
+#endif
+
+
+#endif /* _VL53L1_ERROR_CODES_H_ */
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_error_exceptions.h b/drivers/input/misc/vl53L1/inc/vl53l1_error_exceptions.h
new file mode 100644
index 0000000000000000000000000000000000000000..0b2db2ba0e280d02a49800f34a12854724ce8519
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_error_exceptions.h
@@ -0,0 +1,126 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_ERROR_EXCEPTIONS_H_
+#define _VL53L1_ERROR_EXCEPTIONS_H_
+
+#define IGNORE_DIVISION_BY_ZERO                                0
+
+#define IGNORE_XTALK_EXTRACTION_NO_SAMPLE_FAIL                 0
+#define IGNORE_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL               0
+#define IGNORE_XTALK_EXTRACTION_NO_SAMPLE_FOR_GRADIENT_WARN    0
+#define IGNORE_XTALK_EXTRACTION_SIGMA_LIMIT_FOR_GRADIENT_WARN  0
+#define IGNORE_XTALK_EXTRACTION_MISSING_SAMPLES_WARN           0
+
+#define IGNORE_REF_SPAD_CHAR_NOT_ENOUGH_SPADS                  0
+#define IGNORE_REF_SPAD_CHAR_RATE_TOO_HIGH                     0
+#define IGNORE_REF_SPAD_CHAR_RATE_TOO_LOW                      0
+
+#define IGNORE_OFFSET_CAL_MISSING_SAMPLES                      0
+#define IGNORE_OFFSET_CAL_SIGMA_TOO_HIGH                       0
+#define IGNORE_OFFSET_CAL_RATE_TOO_HIGH                        0
+#define IGNORE_OFFSET_CAL_SPAD_COUNT_TOO_LOW				   0
+
+#define IGNORE_ZONE_CAL_MISSING_SAMPLES                        0
+#define IGNORE_ZONE_CAL_SIGMA_TOO_HIGH                         0
+#define IGNORE_ZONE_CAL_RATE_TOO_HIGH                          0
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_error_strings.h b/drivers/input/misc/vl53L1/inc/vl53l1_error_strings.h
new file mode 100644
index 0000000000000000000000000000000000000000..02cba46adb534697db669c3e294ff1133f8fa870
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_error_strings.h
@@ -0,0 +1,244 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef VL53L1_ERROR_STRINGS_H_
+#define VL53L1_ERROR_STRINGS_H_
+
+#include "vl53l1_error_codes.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_pal_error_string(
+	VL53L1_Error   PalErrorCode,
+	char         *pPalErrorString);
+
+
+#ifndef VL53L1_USE_EMPTY_STRING
+
+
+
+	#define  VL53L1_STRING_ERROR_NONE \
+			"No Error"
+	#define  VL53L1_STRING_ERROR_CALIBRATION_WARNING \
+			"Calibration Warning Error"
+	#define  VL53L1_STRING_ERROR_MIN_CLIPPED \
+			"Min clipped error"
+	#define  VL53L1_STRING_ERROR_UNDEFINED \
+			"Undefined error"
+	#define  VL53L1_STRING_ERROR_INVALID_PARAMS \
+			"Invalid parameters error"
+	#define  VL53L1_STRING_ERROR_NOT_SUPPORTED \
+			"Not supported error"
+	#define  VL53L1_STRING_ERROR_RANGE_ERROR \
+			"Range error"
+	#define  VL53L1_STRING_ERROR_TIME_OUT \
+			"Time out error"
+	#define  VL53L1_STRING_ERROR_MODE_NOT_SUPPORTED \
+			"Mode not supported error"
+	#define  VL53L1_STRING_ERROR_BUFFER_TOO_SMALL \
+			"Buffer too small"
+	#define  VL53L1_STRING_ERROR_COMMS_BUFFER_TOO_SMALL \
+			"Comms Buffer too small"
+	#define  VL53L1_STRING_ERROR_GPIO_NOT_EXISTING \
+			"GPIO not existing"
+	#define  VL53L1_STRING_ERROR_GPIO_FUNCTIONALITY_NOT_SUPPORTED \
+			"GPIO funct not supported"
+	#define  VL53L1_STRING_ERROR_CONTROL_INTERFACE \
+			"Control Interface Error"
+	#define  VL53L1_STRING_ERROR_INVALID_COMMAND \
+			"Invalid Command Error"
+	#define  VL53L1_STRING_ERROR_DIVISION_BY_ZERO \
+			"Division by zero Error"
+	#define  VL53L1_STRING_ERROR_REF_SPAD_INIT \
+			"Reference Spad Init Error"
+	#define  VL53L1_STRING_ERROR_GPH_SYNC_CHECK_FAIL \
+			"GPH Sync Check Fail - API out of sync"
+	#define  VL53L1_STRING_ERROR_STREAM_COUNT_CHECK_FAIL \
+			"Stream Count Check Fail - API out of sync"
+	#define  VL53L1_STRING_ERROR_GPH_ID_CHECK_FAIL \
+			"GPH ID Check Fail - API out of sync"
+	#define  VL53L1_STRING_ERROR_ZONE_STREAM_COUNT_CHECK_FAIL \
+			"Zone Stream Count Check Fail - API out of sync"
+	#define  VL53L1_STRING_ERROR_ZONE_GPH_ID_CHECK_FAIL \
+			"Zone GPH ID Check Fail - API out of sync"
+
+	#define  VL53L1_STRING_ERROR_XTALK_EXTRACTION_NO_SAMPLES_FAIL \
+			"No Xtalk using full array - Xtalk Extract Fail"
+	#define  VL53L1_STRING_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL \
+			"Xtalk does not meet required VL53L1_p_011 limit - Xtalk Extract Fail"
+
+	#define  VL53L1_STRING_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL \
+		"Offset Cal - one of more stages with no valid samples - fatal"
+	#define  VL53L1_STRING_ERROR_OFFSET_CAL_NO_SPADS_ENABLED_FAIL \
+		"Offset Cal - one of more stages with no SPADS enables - fatal"
+	#define  VL53L1_STRING_ERROR_ZONE_CAL_NO_SAMPLE_FAIL \
+		"Zone Cal - one of more zones with no valid samples - fatal"
+
+	#define  VL53L1_STRING_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS \
+		"Ref SPAD Char - Not Enough Good SPADs"
+	#define  VL53L1_STRING_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH \
+		"Ref SPAD Char - Final Ref Rate too high"
+	#define  VL53L1_STRING_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW \
+		"Ref SPAD Char - Final Ref Rate too low"
+
+	#define  VL53L1_STRING_WARNING_OFFSET_CAL_MISSING_SAMPLES \
+		"Offset Cal - Less than the requested number of valid samples"
+	#define  VL53L1_STRING_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH \
+		"Offset Cal - Sigma estimate value too high - offset not stable"
+	#define  VL53L1_STRING_WARNING_OFFSET_CAL_RATE_TOO_HIGH \
+		"Offset Cal - Rate too high - in pile up"
+	#define  VL53L1_STRING_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW \
+		"Offset Cal - Insufficient SPADs - offset may not be stable"
+
+	#define  VL53L1_STRING_WARNING_ZONE_CAL_MISSING_SAMPLES \
+		"Zone Cal - One or more zone with less than requested valid samples"
+	#define  VL53L1_STRING_WARNING_ZONE_CAL_SIGMA_TOO_HIGH \
+		"Zone Cal - One of more zones the VL53L1_p_011 estimate too high"
+	#define  VL53L1_STRING_WARNING_ZONE_CAL_RATE_TOO_HIGH \
+		"Zone Cal - One of more zones with rate too high - in pile up"
+
+	#define  VL53L1_STRING_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT \
+			"Xtalk - Gradient sample num = 0"
+	#define  VL53L1_STRING_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT \
+			"Xtalk - Gradient Sigma > Limit"
+	#define  VL53L1_STRING_WARNING_XTALK_MISSING_SAMPLES \
+			"Xtalk - Some missing and invalid samples"
+
+	#define  VL53L1_STRING_ERROR_DEVICE_FIRMWARE_TOO_OLD \
+			"Device Firmware too old"
+	#define  VL53L1_STRING_ERROR_DEVICE_FIRMWARE_TOO_NEW \
+			"Device Firmware too new"
+	#define  VL53L1_STRING_ERROR_UNIT_TEST_FAIL \
+			"Unit Test Fail"
+	#define  VL53L1_STRING_ERROR_FILE_READ_FAIL \
+			"File Read Fail"
+	#define  VL53L1_STRING_ERROR_FILE_WRITE_FAIL \
+			"File Write Fail"
+
+	#define  VL53L1_STRING_ERROR_NOT_IMPLEMENTED \
+			"Not implemented error"
+	#define  VL53L1_STRING_UNKNOW_ERROR_CODE \
+			"Unknown Error Code"
+
+#endif
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_hist_char.h b/drivers/input/misc/vl53L1/inc/vl53l1_hist_char.h
new file mode 100644
index 0000000000000000000000000000000000000000..25d84d16240a575864e61aae632df90c983ecc1a
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_hist_char.h
@@ -0,0 +1,176 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_HIST_CHAR_H_
+#define _VL53L1_HIST_CHAR_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_calib_config(
+	VL53L1_DEV      Dev,
+	uint8_t         vcsel_delay__a0,
+	uint8_t         calib_1,
+	uint8_t         calib_2,
+	uint8_t         calib_3,
+	uint8_t         calib_2__a0,
+	uint8_t         spad_readout);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_hist_calib_pulse_delay(
+	VL53L1_DEV      Dev,
+	uint8_t         calib_delay);
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_disable_calib_pulse_delay(
+	VL53L1_DEV      Dev);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_hist_map.h b/drivers/input/misc/vl53L1/inc/vl53l1_hist_map.h
new file mode 100644
index 0000000000000000000000000000000000000000..952dd16d601991598d2f247a3562536a98a99e1c
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_hist_map.h
@@ -0,0 +1,156 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_HIST_MAP_H_
+#define _VL53L1_HIST_MAP_H_
+
+#include "vl53l1_register_map.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+
+
+
+#define VL53L1_HISTOGRAM_CONFIG__OPCODE_SEQUENCE_0 \
+			VL53L1_SIGMA_ESTIMATOR__EFFECTIVE_PULSE_WIDTH_NS
+
+#define VL53L1_HISTOGRAM_CONFIG__OPCODE_SEQUENCE_1 \
+		    VL53L1_SIGMA_ESTIMATOR__EFFECTIVE_AMBIENT_WIDTH_NS
+
+#define VL53L1_HISTOGRAM_CONFIG__OPCODE_SEQUENCE_2 \
+		    VL53L1_SIGMA_ESTIMATOR__SIGMA_REF_MM
+
+#define VL53L1_HISTOGRAM_CONFIG__AMB_THRESH_HIGH \
+		    VL53L1_ALGO__RANGE_IGNORE_THRESHOLD_MCPS
+
+
+
+
+
+#define VL53L1_RESULT__HISTOGRAM_BIN_0_2                               0x008E
+#define VL53L1_RESULT__HISTOGRAM_BIN_0_1                               0x008F
+#define VL53L1_RESULT__HISTOGRAM_BIN_0_0                               0x0090
+
+#define VL53L1_RESULT__HISTOGRAM_BIN_23_2                              0x00D3
+#define VL53L1_RESULT__HISTOGRAM_BIN_23_1                              0x00D4
+#define VL53L1_RESULT__HISTOGRAM_BIN_23_0                              0x00D5
+
+#define VL53L1_RESULT__HISTOGRAM_BIN_23_0_MSB                          0x00D9
+#define VL53L1_RESULT__HISTOGRAM_BIN_23_0_LSB                          0x00DA
+
+
+
+
+#define VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX       \
+	VL53L1_RESULT__INTERRUPT_STATUS
+#define VL53L1_HISTOGRAM_BIN_DATA_I2C_SIZE_BYTES  \
+	(VL53L1_RESULT__HISTOGRAM_BIN_23_0_LSB - \
+		VL53L1_RESULT__INTERRUPT_STATUS + 1)
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_hist_structs.h b/drivers/input/misc/vl53L1/inc/vl53l1_hist_structs.h
new file mode 100644
index 0000000000000000000000000000000000000000..48909e091ec3a5c7083e5ba9ee5207aff3f00a30
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_hist_structs.h
@@ -0,0 +1,515 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_HIST_STRUCTS_H_
+#define _VL53L1_HIST_STRUCTS_H_
+
+#include "vl53l1_ll_device.h"
+#include "vl53l1_dmax_structs.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#define  VL53L1_MAX_BIN_SEQUENCE_LENGTH  6
+#define  VL53L1_MAX_BIN_SEQUENCE_CODE   15
+#define  VL53L1_HISTOGRAM_BUFFER_SIZE   24
+#define  VL53L1_XTALK_HISTO_BINS        12
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t                          histogram_config__spad_array_selection;
+
+	uint8_t                          histogram_config__low_amb_even_bin_0_1;
+	uint8_t                          histogram_config__low_amb_even_bin_2_3;
+	uint8_t                          histogram_config__low_amb_even_bin_4_5;
+
+	uint8_t                          histogram_config__low_amb_odd_bin_0_1;
+	uint8_t                          histogram_config__low_amb_odd_bin_2_3;
+	uint8_t                          histogram_config__low_amb_odd_bin_4_5;
+
+	uint8_t                          histogram_config__mid_amb_even_bin_0_1;
+	uint8_t                          histogram_config__mid_amb_even_bin_2_3;
+	uint8_t                          histogram_config__mid_amb_even_bin_4_5;
+
+	uint8_t                          histogram_config__mid_amb_odd_bin_0_1;
+	uint8_t                          histogram_config__mid_amb_odd_bin_2;
+	uint8_t                          histogram_config__mid_amb_odd_bin_3_4;
+	uint8_t                          histogram_config__mid_amb_odd_bin_5;
+
+	uint8_t                          histogram_config__user_bin_offset;
+
+	uint8_t                     histogram_config__high_amb_even_bin_0_1;
+	uint8_t                     histogram_config__high_amb_even_bin_2_3;
+	uint8_t                     histogram_config__high_amb_even_bin_4_5;
+
+	uint8_t                  histogram_config__high_amb_odd_bin_0_1;
+	uint8_t                  histogram_config__high_amb_odd_bin_2_3;
+	uint8_t                  histogram_config__high_amb_odd_bin_4_5;
+
+	uint16_t                         histogram_config__amb_thresh_low;
+
+
+
+	uint16_t                         histogram_config__amb_thresh_high;
+
+
+
+
+} VL53L1_histogram_config_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_HistAlgoSelect  hist_algo_select;
+
+
+
+	VL53L1_HistTargetOrder hist_target_order;
+
+
+
+
+
+	uint8_t   filter_woi0;
+
+
+
+	uint8_t   filter_woi1;
+
+
+
+
+	VL53L1_HistAmbEstMethod hist_amb_est_method;
+
+
+	uint8_t   ambient_thresh_sigma0;
+
+
+
+	uint8_t   ambient_thresh_sigma1;
+
+
+
+
+
+	uint16_t  ambient_thresh_events_scaler;
+
+
+
+
+
+
+	int32_t   min_ambient_thresh_events;
+
+
+	uint16_t  noise_threshold;
+
+
+
+	int32_t   signal_total_events_limit;
+
+
+	uint8_t	  sigma_estimator__sigma_ref_mm;
+
+
+	uint16_t  sigma_thresh;
+
+
+	int16_t   range_offset_mm;
+
+
+	uint16_t  gain_factor;
+
+
+
+	uint8_t   valid_phase_low;
+
+
+
+	uint8_t   valid_phase_high;
+
+
+
+	uint8_t   algo__consistency_check__phase_tolerance;
+
+
+
+	uint8_t   algo__consistency_check__event_sigma;
+
+
+
+
+
+
+	uint16_t  algo__consistency_check__event_min_spad_count;
+
+
+
+
+
+
+	uint16_t  algo__consistency_check__min_max_tolerance;
+
+
+
+	uint8_t   algo__crosstalk_compensation_enable;
+
+
+	uint32_t  algo__crosstalk_compensation_plane_offset_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+	int16_t   algo__crosstalk_detect_min_valid_range_mm;
+
+
+	int16_t   algo__crosstalk_detect_max_valid_range_mm;
+
+
+	uint16_t  algo__crosstalk_detect_max_valid_rate_kcps;
+
+
+
+	uint16_t  algo__crosstalk_detect_max_sigma_mm;
+
+
+
+
+
+
+	uint8_t   algo__crosstalk_detect_event_sigma;
+
+
+
+
+
+
+	uint16_t  algo__crosstalk_detect_min_max_tolerance;
+
+
+
+
+} VL53L1_hist_post_process_config_t;
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	VL53L1_DeviceState     cfg_device_state;
+
+
+	VL53L1_DeviceState     rd_device_state;
+
+
+
+	uint8_t  zone_id;
+
+
+	uint32_t time_stamp;
+
+
+
+	uint8_t  VL53L1_p_022;
+
+
+	uint8_t  VL53L1_p_023;
+
+
+	uint8_t  VL53L1_p_024;
+
+
+
+	uint8_t  number_of_ambient_bins;
+
+
+
+	uint8_t  bin_seq[VL53L1_MAX_BIN_SEQUENCE_LENGTH];
+
+
+	uint8_t  bin_rep[VL53L1_MAX_BIN_SEQUENCE_LENGTH];
+
+
+
+
+	int32_t  bin_data[VL53L1_HISTOGRAM_BUFFER_SIZE];
+
+
+
+	uint8_t  result__interrupt_status;
+
+
+	uint8_t  result__range_status;
+
+
+	uint8_t  result__report_status;
+
+
+	uint8_t  result__stream_count;
+
+
+	uint16_t result__dss_actual_effective_spads;
+
+
+
+	uint16_t phasecal_result__reference_phase;
+
+
+	uint8_t  phasecal_result__vcsel_start;
+
+
+	uint8_t  cal_config__vcsel_start;
+
+
+	uint16_t vcsel_width;
+
+
+	uint8_t  VL53L1_p_009;
+
+
+	uint16_t VL53L1_p_019;
+
+
+	uint32_t  total_periods_elapsed;
+
+
+
+	uint32_t peak_duration_us;
+
+
+	uint32_t woi_duration_us;
+
+
+
+	int32_t  min_bin_value;
+
+
+	int32_t  max_bin_value;
+
+
+
+	uint16_t zero_distance_phase;
+
+
+	uint8_t  number_of_ambient_samples;
+
+
+	int32_t  ambient_events_sum;
+
+
+	int32_t  VL53L1_p_004;
+
+
+
+	uint8_t  roi_config__user_roi_centre_spad;
+
+
+	uint8_t  roi_config__user_roi_requested_global_xy_size;
+
+
+
+} VL53L1_histogram_bin_data_t;
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	uint8_t  zone_id;
+
+
+	uint32_t time_stamp;
+
+
+
+	uint8_t  VL53L1_p_022;
+
+
+	uint8_t  VL53L1_p_023;
+
+
+	uint8_t  VL53L1_p_024;
+
+
+	uint32_t bin_data[VL53L1_XTALK_HISTO_BINS];
+
+
+
+
+	uint16_t phasecal_result__reference_phase;
+
+
+	uint8_t  phasecal_result__vcsel_start;
+
+
+	uint8_t  cal_config__vcsel_start;
+
+
+	uint16_t vcsel_width;
+
+
+	uint16_t VL53L1_p_019;
+
+
+	uint16_t zero_distance_phase;
+
+
+
+} VL53L1_xtalk_histogram_shape_t;
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	VL53L1_xtalk_histogram_shape_t  xtalk_shape;
+
+
+	VL53L1_histogram_bin_data_t     xtalk_hist_removed;
+
+} VL53L1_xtalk_histogram_data_t;
+
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_ll_def.h b/drivers/input/misc/vl53L1/inc/vl53l1_ll_def.h
new file mode 100644
index 0000000000000000000000000000000000000000..7e599ca26e0f50c4a71d89ac9a14e851ed7b0c05
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_ll_def.h
@@ -0,0 +1,2715 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_LL_DEF_H_
+#define _VL53L1_LL_DEF_H_
+
+#include "vl53l1_error_codes.h"
+#include "vl53l1_register_structs.h"
+#include "vl53l1_platform_user_config.h"
+#include "vl53l1_platform_user_defines.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_dmax_structs.h"
+#include "vl53l1_error_exceptions.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+#define VL53L1_LL_API_IMPLEMENTATION_VER_MAJOR       1
+
+
+#define VL53L1_LL_API_IMPLEMENTATION_VER_MINOR       1
+
+
+#define VL53L1_LL_API_IMPLEMENTATION_VER_SUB         48
+
+
+#define VL53L1_LL_API_IMPLEMENTATION_VER_REVISION   12221
+
+#define VL53L1_LL_API_IMPLEMENTATION_VER_STRING "1.1.48.12221"
+
+
+
+#define VL53L1_FIRMWARE_VER_MINIMUM         398
+#define VL53L1_FIRMWARE_VER_MAXIMUM         400
+
+
+
+
+
+
+
+#define VL53L1_LL_CALIBRATION_DATA_STRUCT_VERSION       0xECAB0102
+
+
+
+
+
+
+#define VL53L1_LL_ZONE_CALIBRATION_DATA_STRUCT_VERSION  0xECAE0101
+
+
+
+
+
+
+#define VL53L1_MAX_XTALK_RANGE_RESULTS        5
+
+
+
+
+
+
+#define VL53L1_MAX_OFFSET_RANGE_RESULTS       3
+
+
+
+
+
+#define VL53L1_NVM_MAX_FMT_RANGE_DATA         4
+
+
+
+#define VL53L1_NVM_PEAK_RATE_MAP_SAMPLES  25
+
+
+#define VL53L1_NVM_PEAK_RATE_MAP_WIDTH     5
+
+
+#define VL53L1_NVM_PEAK_RATE_MAP_HEIGHT     5
+
+
+
+
+
+
+
+
+
+#define VL53L1_ERROR_DEVICE_FIRMWARE_TOO_OLD           ((VL53L1_Error) - 80)
+
+
+#define VL53L1_ERROR_DEVICE_FIRMWARE_TOO_NEW           ((VL53L1_Error) - 85)
+
+
+#define VL53L1_ERROR_UNIT_TEST_FAIL                    ((VL53L1_Error) - 90)
+
+
+#define VL53L1_ERROR_FILE_READ_FAIL                    ((VL53L1_Error) - 95)
+
+
+#define VL53L1_ERROR_FILE_WRITE_FAIL                   ((VL53L1_Error) - 96)
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint32_t     ll_revision;
+
+	uint8_t      ll_major;
+
+	uint8_t      ll_minor;
+
+	uint8_t      ll_build;
+
+} VL53L1_ll_version_t;
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t    device_test_mode;
+
+	uint8_t    VL53L1_p_009;
+
+	uint32_t   timeout_us;
+
+	uint16_t   target_count_rate_mcps;
+
+
+	uint16_t   min_count_rate_limit_mcps;
+
+
+	uint16_t   max_count_rate_limit_mcps;
+
+
+
+} VL53L1_refspadchar_config_t;
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+	uint32_t  phasecal_config_timeout_us;
+
+
+	uint32_t  mm_config_timeout_us;
+
+
+	uint32_t  range_config_timeout_us;
+
+
+	uint8_t   num_of_samples;
+
+
+	int16_t   algo__crosstalk_extract_min_valid_range_mm;
+
+
+	int16_t   algo__crosstalk_extract_max_valid_range_mm;
+
+
+	uint16_t  algo__crosstalk_extract_max_valid_rate_kcps;
+
+
+
+	uint16_t  algo__crosstalk_extract_max_sigma_mm;
+
+
+
+
+
+} VL53L1_xtalkextract_config_t;
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+
+	uint32_t  phasecal_config_timeout_us;
+
+
+
+	uint32_t  range_config_timeout_us;
+
+
+
+	uint32_t  mm_config_timeout_us;
+
+
+
+
+	uint8_t   pre_num_of_samples;
+
+
+
+	uint8_t   mm1_num_of_samples;
+
+
+
+	uint8_t   mm2_num_of_samples;
+
+
+
+
+} VL53L1_offsetcal_config_t;
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t   dss_config__target_total_rate_mcps;
+
+
+
+	uint32_t   phasecal_config_timeout_us;
+
+
+
+	uint32_t   mm_config_timeout_us;
+
+
+
+	uint32_t   range_config_timeout_us;
+
+
+
+	uint16_t   phasecal_num_of_samples;
+
+
+
+	uint16_t   zone_num_of_samples;
+
+
+
+
+} VL53L1_zonecal_config_t;
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DeviceSscArray  array_select;
+
+
+
+
+	uint8_t    VL53L1_p_009;
+
+
+	uint8_t    vcsel_start;
+
+
+	uint8_t    vcsel_width;
+
+
+	uint32_t   timeout_us;
+
+
+	uint16_t   rate_limit_mcps;
+
+
+
+
+
+} VL53L1_ssc_config_t;
+
+
+
+
+
+
+typedef struct {
+
+
+	uint32_t  algo__crosstalk_compensation_plane_offset_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+	uint32_t  nvm_default__crosstalk_compensation_plane_offset_kcps;
+
+
+	int16_t   nvm_default__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+	int16_t   nvm_default__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+	uint8_t   global_crosstalk_compensation_enable;
+
+
+	int16_t   histogram_mode_crosstalk_margin_kcps;
+
+
+
+
+
+
+	int16_t   lite_mode_crosstalk_margin_kcps;
+
+
+
+
+
+
+	uint8_t   crosstalk_range_ignore_threshold_mult;
+
+
+	uint16_t  crosstalk_range_ignore_threshold_rate_mcps;
+
+
+
+
+	int16_t   algo__crosstalk_detect_min_valid_range_mm;
+
+
+	int16_t   algo__crosstalk_detect_max_valid_range_mm;
+
+
+	uint16_t  algo__crosstalk_detect_max_valid_rate_kcps;
+
+
+
+	uint16_t  algo__crosstalk_detect_max_sigma_mm;
+
+
+
+
+
+
+} VL53L1_xtalk_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+	uint16_t  tp_tuning_parm_version;
+
+
+
+	uint16_t  tp_tuning_parm_key_table_version;
+
+
+
+
+	uint16_t  tp_tuning_parm_lld_version;
+
+
+
+
+	uint8_t   tp_init_phase_rtn_lite_long;
+
+
+
+
+	uint8_t   tp_init_phase_rtn_lite_med;
+
+
+
+
+	uint8_t   tp_init_phase_rtn_lite_short;
+
+
+
+
+	uint8_t   tp_init_phase_ref_lite_long;
+
+
+
+
+	uint8_t   tp_init_phase_ref_lite_med;
+
+
+
+
+	uint8_t   tp_init_phase_ref_lite_short;
+
+
+
+
+
+	uint8_t   tp_init_phase_rtn_hist_long;
+
+
+
+
+	uint8_t   tp_init_phase_rtn_hist_med;
+
+
+
+
+	uint8_t   tp_init_phase_rtn_hist_short;
+
+
+
+
+	uint8_t   tp_init_phase_ref_hist_long;
+
+
+
+
+	uint8_t   tp_init_phase_ref_hist_med;
+
+
+
+
+	uint8_t   tp_init_phase_ref_hist_short;
+
+
+
+
+
+	uint8_t   tp_consistency_lite_phase_tolerance;
+
+
+
+
+	uint8_t   tp_phasecal_target;
+
+
+
+
+	uint16_t  tp_cal_repeat_rate;
+
+
+
+
+	uint8_t   tp_lite_min_clip;
+
+
+
+
+
+	uint16_t  tp_lite_long_sigma_thresh_mm;
+
+
+
+
+	uint16_t  tp_lite_med_sigma_thresh_mm;
+
+
+
+
+	uint16_t  tp_lite_short_sigma_thresh_mm;
+
+
+
+
+
+	uint16_t  tp_lite_long_min_count_rate_rtn_mcps;
+
+
+
+
+	uint16_t  tp_lite_med_min_count_rate_rtn_mcps;
+
+
+
+
+	uint16_t  tp_lite_short_min_count_rate_rtn_mcps;
+
+
+
+
+
+	uint8_t   tp_lite_sigma_est_pulse_width_ns;
+
+
+
+	uint8_t   tp_lite_sigma_est_amb_width_ns;
+
+
+
+	uint8_t   tp_lite_sigma_ref_mm;
+
+
+
+	uint8_t   tp_lite_seed_cfg;
+
+
+
+	uint8_t   tp_timed_seed_cfg;
+
+
+
+
+	uint8_t   tp_lite_quantifier;
+
+
+
+	uint8_t   tp_lite_first_order_select;
+
+
+
+
+	uint16_t  tp_dss_target_lite_mcps;
+
+
+
+	uint16_t  tp_dss_target_histo_mcps;
+
+
+
+	uint16_t  tp_dss_target_histo_mz_mcps;
+
+
+
+	uint16_t  tp_dss_target_timed_mcps;
+
+
+
+	uint16_t  tp_dss_target_very_short_mcps;
+
+
+
+
+	uint32_t  tp_phasecal_timeout_lite_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_hist_long_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_hist_med_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_hist_short_us;
+
+
+
+
+	uint32_t  tp_phasecal_timeout_mz_long_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_mz_med_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_mz_short_us;
+
+
+
+	uint32_t  tp_phasecal_timeout_timed_us;
+
+
+
+
+	uint32_t  tp_mm_timeout_lite_us;
+
+
+
+	uint32_t  tp_mm_timeout_histo_us;
+
+
+
+	uint32_t  tp_mm_timeout_mz_us;
+
+
+
+	uint32_t  tp_mm_timeout_timed_us;
+
+
+
+	uint32_t  tp_mm_timeout_lpa_us;
+
+
+
+
+	uint32_t  tp_range_timeout_lite_us;
+
+
+
+	uint32_t  tp_range_timeout_histo_us;
+
+
+
+	uint32_t  tp_range_timeout_mz_us;
+
+
+
+	uint32_t  tp_range_timeout_timed_us;
+
+
+
+	uint32_t  tp_range_timeout_lpa_us;
+
+
+
+
+} VL53L1_tuning_parm_storage_t;
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t   x_centre;
+
+	uint8_t   y_centre;
+
+
+} VL53L1_optical_centre_t;
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t   x_centre;
+
+	uint8_t   y_centre;
+
+	uint8_t   width;
+
+	uint8_t   height;
+
+
+} VL53L1_user_zone_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t             max_zones;
+
+	uint8_t             active_zones;
+
+
+
+
+
+
+
+
+
+VL53L1_histogram_config_t multizone_hist_cfg;
+
+	VL53L1_user_zone_t user_zones[VL53L1_MAX_USER_ZONES];
+
+
+
+	uint8_t bin_config[VL53L1_MAX_USER_ZONES];
+
+
+
+} VL53L1_zone_config_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_distance;
+
+
+
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_rate;
+
+
+
+
+
+	uint8_t				intr_new_measure_ready;
+
+
+
+	uint8_t				intr_no_target;
+
+
+
+
+
+
+	uint8_t				intr_combined_mode;
+
+
+
+
+
+
+
+
+
+
+	uint16_t			threshold_distance_high;
+
+
+
+	uint16_t			threshold_distance_low;
+
+
+
+	uint16_t			threshold_rate_high;
+
+
+
+	uint16_t			threshold_rate_low;
+
+} VL53L1_GPIO_interrupt_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+
+
+
+	uint8_t		vhv_loop_bound;
+
+
+
+	uint8_t		is_low_power_auto_mode;
+
+
+
+
+	uint8_t		low_power_auto_range_count;
+
+
+
+	uint8_t		saved_interrupt_config;
+
+
+
+	uint8_t		saved_vhv_init;
+
+
+
+	uint8_t		saved_vhv_timeout;
+
+
+
+	uint8_t		first_run_phasecal_result;
+
+
+
+	uint32_t	dss__total_rate_per_spad_mcps;
+
+
+
+	uint16_t	dss__required_spads;
+
+} VL53L1_low_power_auto_data_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	uint8_t	smudge_corr_enabled;
+
+
+
+	uint8_t	smudge_corr_apply_enabled;
+
+
+
+	uint8_t	smudge_corr_single_apply;
+
+
+
+
+
+
+	uint16_t	smudge_margin;
+
+
+
+	uint32_t	noise_margin;
+
+
+
+
+	uint32_t	user_xtalk_offset_limit;
+
+
+
+
+	uint8_t	user_xtalk_offset_limit_hi;
+
+
+
+
+	uint32_t	sample_limit;
+
+
+
+
+	uint32_t	single_xtalk_delta;
+
+
+
+
+	uint32_t	averaged_xtalk_delta;
+
+
+
+
+	uint32_t	smudge_corr_clip_limit;
+
+
+
+
+	uint32_t	smudge_corr_ambient_threshold;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t	scaler_calc_method;
+
+
+
+
+
+
+	int16_t	x_gradient_scaler;
+
+
+
+
+
+
+	int16_t	y_gradient_scaler;
+
+
+
+
+
+
+	uint8_t	user_scaler_set;
+
+
+
+
+	uint32_t nodetect_ambient_threshold;
+
+
+
+
+	uint32_t nodetect_sample_limit;
+
+
+
+
+	uint32_t nodetect_xtalk_offset;
+
+
+
+
+	uint16_t nodetect_min_range_mm;
+
+
+} VL53L1_smudge_corrector_config_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	uint32_t	current_samples;
+
+
+
+	uint32_t	required_samples;
+
+
+
+	uint64_t	accumulator;
+
+
+
+	uint32_t	nodetect_counter;
+
+} VL53L1_smudge_corrector_internals_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+
+
+
+
+
+	uint8_t	smudge_corr_valid;
+
+
+
+	uint8_t	smudge_corr_clipped;
+
+
+
+
+
+
+
+
+	uint8_t	single_xtalk_delta_flag;
+
+
+
+
+
+
+
+
+	uint8_t	averaged_xtalk_delta_flag;
+
+
+
+	uint8_t	sample_limit_exceeded_flag;
+
+
+
+
+
+
+	uint8_t gradient_zero_flag;
+
+
+
+	uint8_t new_xtalk_applied_flag;
+
+
+
+	uint32_t  algo__crosstalk_compensation_plane_offset_kcps;
+
+
+
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+} VL53L1_smudge_corrector_data_t;
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+
+	uint8_t  range_id;
+
+
+	uint32_t time_stamp;
+
+
+	uint8_t  VL53L1_p_015;
+
+
+	uint8_t  VL53L1_p_022;
+
+
+	uint8_t  VL53L1_p_025;
+
+
+	uint8_t  VL53L1_p_026;
+
+
+	uint8_t  VL53L1_p_016;
+
+
+	uint8_t  VL53L1_p_027;
+
+
+
+	uint16_t   width;
+
+
+	uint8_t    VL53L1_p_030;
+
+
+
+
+	uint16_t   fast_osc_frequency;
+
+
+	uint16_t   zero_distance_phase;
+
+
+	uint16_t   VL53L1_p_006;
+
+
+
+	uint32_t   total_periods_elapsed;
+
+
+
+	uint32_t   peak_duration_us;
+
+
+
+	uint32_t   woi_duration_us;
+
+
+
+
+
+
+
+	uint32_t   VL53L1_p_020;
+
+
+	uint32_t   VL53L1_p_021;
+
+
+
+	int32_t    VL53L1_p_013;
+
+
+
+
+
+
+
+	uint16_t    peak_signal_count_rate_mcps;
+
+
+	uint16_t    avg_signal_count_rate_mcps;
+
+
+	uint16_t    ambient_count_rate_mcps;
+
+
+	uint16_t    total_rate_per_spad_mcps;
+
+
+	uint32_t    VL53L1_p_012;
+
+
+
+
+
+
+	uint16_t   VL53L1_p_005;
+
+
+
+
+
+
+	uint16_t   VL53L1_p_028;
+
+
+
+	uint16_t   VL53L1_p_014;
+
+
+	uint16_t   VL53L1_p_029;
+
+
+
+
+
+
+
+	int16_t    min_range_mm;
+
+
+
+
+
+	int16_t    median_range_mm;
+
+
+
+
+	int16_t    max_range_mm;
+
+
+
+
+
+
+
+
+
+	uint8_t    range_status;
+
+} VL53L1_range_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DeviceState     cfg_device_state;
+
+
+	VL53L1_DeviceState     rd_device_state;
+
+
+	uint8_t                zone_id;
+
+
+	uint8_t                stream_count;
+
+
+
+	int16_t                VL53L1_p_007[VL53L1_MAX_AMBIENT_DMAX_VALUES];
+
+
+
+
+	int16_t                wrap_dmax_mm;
+
+
+
+	uint8_t                device_status;
+
+
+
+	uint8_t                max_results;
+
+
+
+	uint8_t                active_results;
+
+
+	VL53L1_range_data_t    VL53L1_p_002[VL53L1_MAX_RANGE_RESULTS];
+
+
+	VL53L1_range_data_t    xmonitor;
+
+
+	VL53L1_smudge_corrector_data_t smudge_corrector_data;
+
+
+
+
+} VL53L1_range_results_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t    no_of_samples;
+
+
+	uint32_t   rate_per_spad_kcps_sum;
+
+
+
+	uint32_t   rate_per_spad_kcps_avg;
+
+
+	int32_t    signal_total_events_sum;
+
+
+
+	int32_t    signal_total_events_avg;
+
+
+
+	uint32_t   sigma_mm_sum;
+
+
+
+	uint32_t   sigma_mm_avg;
+
+
+	uint32_t   median_phase_sum;
+
+
+
+
+	uint32_t   median_phase_avg;
+
+
+
+
+} VL53L1_xtalk_range_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_Error                cal_status;
+
+
+	uint8_t                     num_of_samples_status;
+
+
+
+
+
+
+
+
+	uint8_t                     zero_samples_status;
+
+
+
+
+
+
+
+
+	uint8_t                     max_sigma_status;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t                     max_results;
+
+
+
+	uint8_t                     active_results;
+
+
+
+	VL53L1_xtalk_range_data_t
+		VL53L1_p_002[VL53L1_MAX_XTALK_RANGE_RESULTS];
+
+
+	VL53L1_histogram_bin_data_t central_histogram_sum;
+
+
+
+	VL53L1_histogram_bin_data_t central_histogram_avg;
+
+
+
+	uint8_t central_histogram__window_start;
+
+
+
+	uint8_t central_histogram__window_end;
+
+
+
+	VL53L1_histogram_bin_data_t
+		histogram_avg_1[VL53L1_MAX_XTALK_RANGE_RESULTS];
+
+
+
+	VL53L1_histogram_bin_data_t
+		histogram_avg_2[VL53L1_MAX_XTALK_RANGE_RESULTS];
+
+
+
+	VL53L1_histogram_bin_data_t
+		xtalk_avg[VL53L1_MAX_XTALK_RANGE_RESULTS];
+
+
+
+
+} VL53L1_xtalk_range_results_t;
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t    preset_mode;
+
+
+	uint8_t    dss_config__roi_mode_control;
+
+
+	uint16_t   dss_config__manual_effective_spads_select;
+
+
+	uint8_t    no_of_samples;
+
+
+	uint32_t   effective_spads;
+
+
+	uint32_t   peak_rate_mcps;
+
+
+	uint32_t   VL53L1_p_005;
+
+
+	int32_t    median_range_mm;
+
+
+
+	int32_t    range_mm_offset;
+
+
+
+} VL53L1_offset_range_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	int16_t      cal_distance_mm;
+
+
+	uint16_t     cal_reflectance_pc;
+
+
+	VL53L1_Error cal_status;
+
+
+	uint8_t      cal_report;
+
+
+	uint8_t      max_results;
+
+
+
+	uint8_t      active_results;
+
+
+	VL53L1_offset_range_data_t
+		VL53L1_p_002[VL53L1_MAX_OFFSET_RANGE_RESULTS];
+
+
+
+} VL53L1_offset_range_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t  result__mm_inner_actual_effective_spads;
+
+
+	uint16_t  result__mm_outer_actual_effective_spads;
+
+
+	uint16_t  result__mm_inner_peak_signal_count_rtn_mcps;
+
+
+	uint16_t  result__mm_outer_peak_signal_count_rtn_mcps;
+
+
+
+} VL53L1_additional_offset_cal_data_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint32_t   VL53L1_p_020;
+
+
+	uint32_t   VL53L1_p_021;
+
+
+
+	uint16_t   VL53L1_p_014;
+
+
+	uint8_t    range_status;
+
+
+
+} VL53L1_object_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DeviceState     cfg_device_state;
+
+
+	VL53L1_DeviceState     rd_device_state;
+
+
+	uint8_t                zone_id;
+
+
+	uint8_t                stream_count;
+
+
+	uint8_t                max_objects;
+
+
+
+	uint8_t                active_objects;
+
+
+	VL53L1_object_data_t   VL53L1_p_002[VL53L1_MAX_RANGE_RESULTS];
+
+
+
+	VL53L1_object_data_t   xmonitor;
+
+
+
+} VL53L1_zone_objects_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t                max_zones;
+
+
+
+	uint8_t                active_zones;
+
+
+	VL53L1_zone_objects_t VL53L1_p_002[VL53L1_MAX_USER_ZONES];
+
+
+
+} VL53L1_zone_results_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DeviceState     rd_device_state;
+
+
+
+	uint8_t  number_of_ambient_bins;
+
+
+
+
+	uint16_t result__dss_actual_effective_spads;
+
+
+	uint8_t  VL53L1_p_009;
+
+
+	uint32_t total_periods_elapsed;
+
+
+
+	int32_t  ambient_events_sum;
+
+
+
+} VL53L1_zone_hist_info_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t                     max_zones;
+
+
+
+	uint8_t                     active_zones;
+
+
+	VL53L1_zone_hist_info_t     VL53L1_p_002[VL53L1_MAX_USER_ZONES];
+
+
+
+} VL53L1_zone_histograms_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint32_t   no_of_samples;
+
+
+	uint32_t   effective_spads;
+
+
+	uint32_t   peak_rate_mcps;
+
+
+	uint32_t   VL53L1_p_014;
+
+
+	uint32_t   VL53L1_p_005;
+
+
+
+	int32_t    median_range_mm;
+
+
+
+	int32_t    range_mm_offset;
+
+
+
+} VL53L1_zone_calibration_data_t;
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint32_t                         struct_version;
+
+
+	VL53L1_DevicePresetModes         preset_mode;
+
+
+	VL53L1_DeviceZonePreset          zone_preset;
+
+
+	int16_t                          cal_distance_mm;
+
+
+	uint16_t                         cal_reflectance_pc;
+
+
+	uint16_t                         phasecal_result__reference_phase;
+
+
+	uint16_t                         zero_distance_phase;
+
+
+	VL53L1_Error                     cal_status;
+
+
+	uint8_t                          max_zones;
+
+
+
+	uint8_t                          active_zones;
+
+
+	VL53L1_zone_calibration_data_t   VL53L1_p_002[VL53L1_MAX_USER_ZONES];
+
+
+
+} VL53L1_zone_calibration_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	int16_t     cal_distance_mm;
+
+
+	uint16_t    cal_reflectance_pc;
+
+
+	uint16_t    max_samples;
+
+
+	uint16_t    width;
+
+
+	uint16_t    height;
+
+
+	uint16_t    peak_rate_mcps[VL53L1_NVM_PEAK_RATE_MAP_SAMPLES];
+
+
+
+} VL53L1_cal_peak_rate_map_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t      expected_stream_count;
+
+
+	uint8_t      expected_gph_id;
+
+
+	uint8_t      dss_mode;
+
+
+	uint16_t     dss_requested_effective_spad_count;
+
+
+
+	uint8_t      seed_cfg;
+
+
+	uint8_t      initial_phase_seed;
+
+
+
+	uint8_t  roi_config__user_roi_centre_spad;
+
+
+	uint8_t  roi_config__user_roi_requested_global_xy_size;
+
+
+
+} VL53L1_zone_private_dyn_cfg_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t                     max_zones;
+
+
+
+	uint8_t                     active_zones;
+
+
+	VL53L1_zone_private_dyn_cfg_t VL53L1_p_002[VL53L1_MAX_USER_ZONES];
+
+
+
+} VL53L1_zone_private_dyn_cfgs_t;
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint32_t  algo__crosstalk_compensation_plane_offset_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+} VL53L1_xtalk_calibration_results_t;
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	uint32_t   sample_count;
+
+
+
+	uint32_t   pll_period_mm;
+
+
+
+	uint32_t   peak_duration_us_sum;
+
+
+
+	uint32_t   effective_spad_count_sum;
+
+
+
+	uint32_t   zero_distance_phase_sum;
+
+
+
+	uint32_t   zero_distance_phase_avg;
+
+
+
+	int32_t    event_scaler_sum;
+
+
+
+	int32_t    event_scaler_avg;
+
+
+
+	int32_t   signal_events_sum;
+
+
+
+	uint32_t  xtalk_rate_kcps_per_spad;
+
+
+
+	int32_t   xtalk_start_phase;
+
+
+
+	int32_t   xtalk_end_phase;
+
+
+
+	int32_t   xtalk_width_phase;
+
+
+
+	int32_t   target_start_phase;
+
+
+
+	int32_t   target_end_phase;
+
+
+
+	int32_t   target_width_phase;
+
+
+
+	int32_t   effective_width;
+
+
+
+	int32_t   event_scaler;
+
+
+
+	uint8_t   VL53L1_p_015;
+
+
+
+	uint8_t   VL53L1_p_016;
+
+
+
+	uint8_t   target_start;
+
+
+
+	int32_t   max_shape_value;
+
+
+
+	int32_t   bin_data_sums[VL53L1_XTALK_HISTO_BINS];
+
+} VL53L1_hist_xtalk_extract_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t   standard_ranging_gain_factor;
+
+
+	uint16_t   histogram_ranging_gain_factor;
+
+
+
+} VL53L1_gain_calibration_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DeviceState   cfg_device_state;
+
+
+	uint8_t   cfg_stream_count;
+
+
+
+	uint8_t   cfg_internal_stream_count;
+
+
+	uint8_t   cfg_internal_stream_count_val;
+
+
+	uint8_t   cfg_gph_id;
+
+
+	uint8_t   cfg_timing_status;
+
+
+	uint8_t   cfg_zone_id;
+
+
+
+	VL53L1_DeviceState   rd_device_state;
+
+
+	uint8_t   rd_stream_count;
+
+
+	uint8_t   rd_internal_stream_count;
+
+
+	uint8_t   rd_internal_stream_count_val;
+
+
+	uint8_t   rd_gph_id;
+
+
+	uint8_t   rd_timing_status;
+
+
+	uint8_t   rd_zone_id;
+
+
+
+} VL53L1_ll_driver_state_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t   wait_method;
+
+
+	VL53L1_DevicePresetModes        preset_mode;
+
+
+	VL53L1_DeviceZonePreset         zone_preset;
+
+
+	VL53L1_DeviceMeasurementModes   measurement_mode;
+
+
+	VL53L1_OffsetCalibrationMode    offset_calibration_mode;
+
+
+	VL53L1_OffsetCorrectionMode     offset_correction_mode;
+
+
+	VL53L1_DeviceDmaxMode           dmax_mode;
+
+
+	uint32_t  phasecal_config_timeout_us;
+
+
+	uint32_t  mm_config_timeout_us;
+
+
+	uint32_t  range_config_timeout_us;
+
+
+	uint32_t  inter_measurement_period_ms;
+
+
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+
+	uint32_t  fw_ready_poll_duration_ms;
+
+
+	uint8_t   fw_ready;
+
+
+	uint8_t   debug_mode;
+
+
+
+
+
+	VL53L1_ll_version_t                 version;
+
+
+
+	VL53L1_ll_driver_state_t            ll_state;
+
+
+
+	VL53L1_GPIO_interrupt_config_t	    gpio_interrupt_config;
+
+
+
+	VL53L1_customer_nvm_managed_t       customer;
+	VL53L1_cal_peak_rate_map_t          cal_peak_rate_map;
+	VL53L1_additional_offset_cal_data_t add_off_cal_data;
+	VL53L1_dmax_calibration_data_t      fmt_dmax_cal;
+	VL53L1_dmax_calibration_data_t      cust_dmax_cal;
+	VL53L1_gain_calibration_data_t      gain_cal;
+	VL53L1_user_zone_t                  mm_roi;
+	VL53L1_optical_centre_t             optical_centre;
+	VL53L1_zone_config_t                zone_cfg;
+
+
+
+	VL53L1_tuning_parm_storage_t        tuning_parms;
+
+
+
+	uint8_t rtn_good_spads[VL53L1_RTN_SPAD_BUFFER_SIZE];
+
+
+
+	VL53L1_refspadchar_config_t         refspadchar;
+	VL53L1_ssc_config_t                 ssc_cfg;
+	VL53L1_hist_post_process_config_t   histpostprocess;
+	VL53L1_hist_gen3_dmax_config_t      dmax_cfg;
+	VL53L1_xtalkextract_config_t        xtalk_extract_cfg;
+	VL53L1_xtalk_config_t               xtalk_cfg;
+	VL53L1_offsetcal_config_t           offsetcal_cfg;
+	VL53L1_zonecal_config_t             zonecal_cfg;
+
+
+
+	VL53L1_static_nvm_managed_t         stat_nvm;
+	VL53L1_histogram_config_t           hist_cfg;
+	VL53L1_static_config_t              stat_cfg;
+	VL53L1_general_config_t             gen_cfg;
+	VL53L1_timing_config_t              tim_cfg;
+	VL53L1_dynamic_config_t             dyn_cfg;
+	VL53L1_system_control_t             sys_ctrl;
+	VL53L1_system_results_t             sys_results;
+	VL53L1_nvm_copy_data_t              nvm_copy_data;
+
+
+
+	VL53L1_histogram_bin_data_t         hist_data;
+	VL53L1_histogram_bin_data_t         hist_xtalk;
+
+
+
+	VL53L1_xtalk_histogram_data_t       xtalk_shapes;
+	VL53L1_xtalk_range_results_t        xtalk_results;
+	VL53L1_xtalk_calibration_results_t  xtalk_cal;
+	VL53L1_hist_xtalk_extract_data_t    xtalk_extract;
+
+
+
+	VL53L1_offset_range_results_t       offset_results;
+
+
+
+	VL53L1_core_results_t               core_results;
+	VL53L1_debug_results_t              dbg_results;
+
+	VL53L1_smudge_corrector_config_t	smudge_correct_config;
+
+
+	VL53L1_smudge_corrector_internals_t smudge_corrector_internals;
+
+
+
+
+
+
+
+	VL53L1_low_power_auto_data_t		low_power_auto_data;
+
+
+
+#ifdef PAL_EXTENDED
+
+
+	VL53L1_patch_results_t                patch_results;
+	VL53L1_shadow_core_results_t          shadow_core_results;
+	VL53L1_shadow_system_results_t        shadow_sys_results;
+	VL53L1_prev_shadow_core_results_t     prev_shadow_core_results;
+	VL53L1_prev_shadow_system_results_t   prev_shadow_sys_results;
+#endif
+
+} VL53L1_LLDriverData_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+
+
+	VL53L1_range_results_t             range_results;
+
+
+
+	VL53L1_zone_private_dyn_cfgs_t     zone_dyn_cfgs;
+
+
+
+	VL53L1_zone_results_t              zone_results;
+	VL53L1_zone_histograms_t           zone_hists;
+	VL53L1_zone_calibration_results_t  zone_cal;
+
+} VL53L1_LLDriverResults_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint32_t                             struct_version;
+	VL53L1_customer_nvm_managed_t        customer;
+	VL53L1_dmax_calibration_data_t       fmt_dmax_cal;
+	VL53L1_dmax_calibration_data_t       cust_dmax_cal;
+	VL53L1_additional_offset_cal_data_t  add_off_cal_data;
+	VL53L1_optical_centre_t              optical_centre;
+	VL53L1_xtalk_histogram_data_t        xtalkhisto;
+	VL53L1_gain_calibration_data_t       gain_cal;
+	VL53L1_cal_peak_rate_map_t           cal_peak_rate_map;
+
+} VL53L1_calibration_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_customer_nvm_managed_t        customer;
+	VL53L1_xtalkextract_config_t         xtalk_extract_cfg;
+	VL53L1_xtalk_config_t                xtalk_cfg;
+	VL53L1_histogram_bin_data_t          hist_data;
+	VL53L1_xtalk_histogram_data_t        xtalk_shapes;
+	VL53L1_xtalk_range_results_t         xtalk_results;
+
+} VL53L1_xtalk_debug_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_customer_nvm_managed_t        customer;
+	VL53L1_dmax_calibration_data_t       fmt_dmax_cal;
+	VL53L1_dmax_calibration_data_t       cust_dmax_cal;
+	VL53L1_additional_offset_cal_data_t  add_off_cal_data;
+	VL53L1_offset_range_results_t        offset_results;
+
+} VL53L1_offset_debug_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint16_t        vl53l1_tuningparm_version;
+	uint16_t        vl53l1_tuningparm_key_table_version;
+	uint16_t        vl53l1_tuningparm_lld_version;
+	uint8_t        vl53l1_tuningparm_hist_algo_select;
+	uint8_t        vl53l1_tuningparm_hist_target_order;
+	uint8_t        vl53l1_tuningparm_hist_filter_woi_0;
+	uint8_t        vl53l1_tuningparm_hist_filter_woi_1;
+	uint8_t        vl53l1_tuningparm_hist_amb_est_method;
+	uint8_t        vl53l1_tuningparm_hist_amb_thresh_sigma_0;
+	uint8_t        vl53l1_tuningparm_hist_amb_thresh_sigma_1;
+	int32_t        vl53l1_tuningparm_hist_min_amb_thresh_events;
+	uint16_t        vl53l1_tuningparm_hist_amb_events_scaler;
+	uint16_t        vl53l1_tuningparm_hist_noise_threshold;
+	int32_t        vl53l1_tuningparm_hist_signal_total_events_limit;
+	uint8_t        vl53l1_tuningparm_hist_sigma_est_ref_mm;
+	uint16_t        vl53l1_tuningparm_hist_sigma_thresh_mm;
+	uint16_t        vl53l1_tuningparm_hist_gain_factor;
+	uint8_t        vl53l1_tuningparm_consistency_hist_phase_tolerance;
+	uint16_t  vl53l1_tuningparm_consistency_hist_min_max_tolerance_mm;
+	uint8_t        vl53l1_tuningparm_consistency_hist_event_sigma;
+	uint16_t  vl53l1_tuningparm_consistency_hist_event_sigma_min_spad_limit;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_histo_long_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_histo_med_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_histo_short_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_histo_long_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_histo_med_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_histo_short_range;
+	int16_t        vl53l1_tuningparm_xtalk_detect_min_valid_range_mm;
+	int16_t        vl53l1_tuningparm_xtalk_detect_max_valid_range_mm;
+	uint16_t        vl53l1_tuningparm_xtalk_detect_max_sigma_mm;
+	uint16_t        vl53l1_tuningparm_xtalk_detect_min_max_tolerance;
+	uint16_t        vl53l1_tuningparm_xtalk_detect_max_valid_rate_kcps;
+	uint8_t        vl53l1_tuningparm_xtalk_detect_event_sigma;
+	int16_t        vl53l1_tuningparm_hist_xtalk_margin_kcps;
+	uint8_t        vl53l1_tuningparm_consistency_lite_phase_tolerance;
+	uint8_t        vl53l1_tuningparm_phasecal_target;
+	uint16_t        vl53l1_tuningparm_lite_cal_repeat_rate;
+	uint16_t        vl53l1_tuningparm_lite_ranging_gain_factor;
+	uint8_t        vl53l1_tuningparm_lite_min_clip_mm;
+	uint16_t        vl53l1_tuningparm_lite_long_sigma_thresh_mm;
+	uint16_t        vl53l1_tuningparm_lite_med_sigma_thresh_mm;
+	uint16_t        vl53l1_tuningparm_lite_short_sigma_thresh_mm;
+	uint16_t        vl53l1_tuningparm_lite_long_min_count_rate_rtn_mcps;
+	uint16_t        vl53l1_tuningparm_lite_med_min_count_rate_rtn_mcps;
+	uint16_t        vl53l1_tuningparm_lite_short_min_count_rate_rtn_mcps;
+	uint8_t        vl53l1_tuningparm_lite_sigma_est_pulse_width;
+	uint8_t        vl53l1_tuningparm_lite_sigma_est_amb_width_ns;
+	uint8_t        vl53l1_tuningparm_lite_sigma_ref_mm;
+	uint8_t        vl53l1_tuningparm_lite_rit_mult;
+	uint8_t        vl53l1_tuningparm_lite_seed_config;
+	uint8_t        vl53l1_tuningparm_lite_quantifier;
+	uint8_t        vl53l1_tuningparm_lite_first_order_select;
+	int16_t        vl53l1_tuningparm_lite_xtalk_margin_kcps;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_lite_long_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_lite_med_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_rtn_lite_short_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_lite_long_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_lite_med_range;
+	uint8_t        vl53l1_tuningparm_initial_phase_ref_lite_short_range;
+	uint8_t        vl53l1_tuningparm_timed_seed_config;
+	uint8_t        vl53l1_tuningparm_dmax_cfg_signal_thresh_sigma;
+	uint16_t        vl53l1_tuningparm_dmax_cfg_reflectance_array_0;
+	uint16_t        vl53l1_tuningparm_dmax_cfg_reflectance_array_1;
+	uint16_t        vl53l1_tuningparm_dmax_cfg_reflectance_array_2;
+	uint16_t        vl53l1_tuningparm_dmax_cfg_reflectance_array_3;
+	uint16_t        vl53l1_tuningparm_dmax_cfg_reflectance_array_4;
+	uint8_t        vl53l1_tuningparm_vhv_loopbound;
+	uint8_t        vl53l1_tuningparm_refspadchar_device_test_mode;
+	uint8_t        vl53l1_tuningparm_refspadchar_vcsel_period;
+	uint32_t        vl53l1_tuningparm_refspadchar_phasecal_timeout_us;
+	uint16_t        vl53l1_tuningparm_refspadchar_target_count_rate_mcps;
+	uint16_t        vl53l1_tuningparm_refspadchar_min_countrate_limit_mcps;
+	uint16_t        vl53l1_tuningparm_refspadchar_max_countrate_limit_mcps;
+	uint8_t        vl53l1_tuningparm_xtalk_extract_num_of_samples;
+	int16_t        vl53l1_tuningparm_xtalk_extract_min_filter_thresh_mm;
+	int16_t        vl53l1_tuningparm_xtalk_extract_max_filter_thresh_mm;
+	uint16_t        vl53l1_tuningparm_xtalk_extract_dss_rate_mcps;
+	uint32_t        vl53l1_tuningparm_xtalk_extract_phasecal_timeout_us;
+	uint16_t        vl53l1_tuningparm_xtalk_extract_max_valid_rate_kcps;
+	uint16_t        vl53l1_tuningparm_xtalk_extract_sigma_threshold_mm;
+	uint32_t        vl53l1_tuningparm_xtalk_extract_dss_timeout_us;
+	uint32_t        vl53l1_tuningparm_xtalk_extract_bin_timeout_us;
+	uint16_t        vl53l1_tuningparm_offset_cal_dss_rate_mcps;
+	uint32_t        vl53l1_tuningparm_offset_cal_phasecal_timeout_us;
+	uint32_t        vl53l1_tuningparm_offset_cal_mm_timeout_us;
+	uint32_t        vl53l1_tuningparm_offset_cal_range_timeout_us;
+	uint8_t        vl53l1_tuningparm_offset_cal_pre_samples;
+	uint8_t        vl53l1_tuningparm_offset_cal_mm1_samples;
+	uint8_t        vl53l1_tuningparm_offset_cal_mm2_samples;
+	uint16_t        vl53l1_tuningparm_zone_cal_dss_rate_mcps;
+	uint32_t        vl53l1_tuningparm_zone_cal_phasecal_timeout_us;
+	uint32_t        vl53l1_tuningparm_zone_cal_dss_timeout_us;
+	uint16_t        vl53l1_tuningparm_zone_cal_phasecal_num_samples;
+	uint32_t        vl53l1_tuningparm_zone_cal_range_timeout_us;
+	uint16_t        vl53l1_tuningparm_zone_cal_zone_num_samples;
+	uint8_t        vl53l1_tuningparm_spadmap_vcsel_period;
+	uint8_t        vl53l1_tuningparm_spadmap_vcsel_start;
+	uint16_t        vl53l1_tuningparm_spadmap_rate_limit_mcps;
+	uint16_t  vl53l1_tuningparm_lite_dss_config_target_total_rate_mcps;
+	uint16_t   vl53l1_tuningparm_ranging_dss_config_target_total_rate_mcps;
+	uint16_t        vl53l1_tuningparm_mz_dss_config_target_total_rate_mcps;
+	uint16_t     vl53l1_tuningparm_timed_dss_config_target_total_rate_mcps;
+	uint32_t        vl53l1_tuningparm_lite_phasecal_config_timeout_us;
+	uint32_t     vl53l1_tuningparm_ranging_long_phasecal_config_timeout_us;
+	uint32_t      vl53l1_tuningparm_ranging_med_phasecal_config_timeout_us;
+	uint32_t    vl53l1_tuningparm_ranging_short_phasecal_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_mz_long_phasecal_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_mz_med_phasecal_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_mz_short_phasecal_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_timed_phasecal_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_lite_mm_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_ranging_mm_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_mz_mm_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_timed_mm_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_lite_range_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_ranging_range_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_mz_range_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_timed_range_config_timeout_us;
+	uint16_t        vl53l1_tuningparm_dynxtalk_smudge_margin;
+	uint32_t        vl53l1_tuningparm_dynxtalk_noise_margin;
+	uint32_t        vl53l1_tuningparm_dynxtalk_xtalk_offset_limit;
+	uint8_t        vl53l1_tuningparm_dynxtalk_xtalk_offset_limit_hi;
+	uint32_t        vl53l1_tuningparm_dynxtalk_sample_limit;
+	uint32_t        vl53l1_tuningparm_dynxtalk_single_xtalk_delta;
+	uint32_t        vl53l1_tuningparm_dynxtalk_averaged_xtalk_delta;
+	uint32_t        vl53l1_tuningparm_dynxtalk_clip_limit;
+	uint8_t        vl53l1_tuningparm_dynxtalk_scaler_calc_method;
+	int16_t        vl53l1_tuningparm_dynxtalk_xgradient_scaler;
+	int16_t        vl53l1_tuningparm_dynxtalk_ygradient_scaler;
+	uint8_t        vl53l1_tuningparm_dynxtalk_user_scaler_set;
+	uint8_t        vl53l1_tuningparm_dynxtalk_smudge_cor_single_apply;
+	uint32_t        vl53l1_tuningparm_dynxtalk_xtalk_amb_threshold;
+	uint32_t        vl53l1_tuningparm_dynxtalk_nodetect_amb_threshold_kcps;
+	uint32_t        vl53l1_tuningparm_dynxtalk_nodetect_sample_limit;
+	uint32_t        vl53l1_tuningparm_dynxtalk_nodetect_xtalk_offset_kcps;
+	uint16_t        vl53l1_tuningparm_dynxtalk_nodetect_min_range_mm;
+	uint8_t        vl53l1_tuningparm_lowpowerauto_vhv_loop_bound;
+	uint32_t        vl53l1_tuningparm_lowpowerauto_mm_config_timeout_us;
+	uint32_t        vl53l1_tuningparm_lowpowerauto_range_config_timeout_us;
+	uint16_t        vl53l1_tuningparm_very_short_dss_rate_mcps;
+} VL53L1_tuning_parameters_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t  target_reflectance_for_dmax[VL53L1_MAX_AMBIENT_DMAX_VALUES];
+
+} VL53L1_dmax_reflectance_array_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t    spad_type;
+
+
+	uint16_t   VL53L1_p_023;
+
+
+	uint16_t   rate_data[VL53L1_NO_OF_SPAD_ENABLES];
+
+
+	uint16_t    no_of_values;
+
+
+	uint8_t    fractional_bits;
+
+
+	uint8_t    error_status;
+
+
+
+} VL53L1_spad_rate_data_t;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	VL53L1_DevicePresetModes        preset_mode;
+
+
+	VL53L1_DeviceZonePreset         zone_preset;
+
+
+	VL53L1_DeviceMeasurementModes   measurement_mode;
+
+
+	VL53L1_OffsetCalibrationMode    offset_calibration_mode;
+
+
+	VL53L1_OffsetCorrectionMode     offset_correction_mode;
+
+
+	VL53L1_DeviceDmaxMode           dmax_mode;
+
+
+
+	uint32_t  phasecal_config_timeout_us;
+
+
+	uint32_t  mm_config_timeout_us;
+
+
+	uint32_t  range_config_timeout_us;
+
+
+	uint32_t  inter_measurement_period_ms;
+
+
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+
+	VL53L1_histogram_bin_data_t    VL53L1_p_010;
+
+
+
+} VL53L1_additional_data_t;
+
+
+
+
+
+
+
+
+
+
+#define SUPPRESS_UNUSED_WARNING(x) \
+	((void) (x))
+
+
+#define IGNORE_STATUS(__FUNCTION_ID__, __ERROR_STATUS_CHECK__, __STATUS__) \
+	do { \
+		DISABLE_WARNINGS(); \
+		if (__FUNCTION_ID__) { \
+			if (__STATUS__ == __ERROR_STATUS_CHECK__) { \
+				__STATUS__ = VL53L1_ERROR_NONE; \
+				WARN_OVERRIDE_STATUS(__FUNCTION_ID__); \
+			} \
+		} \
+		ENABLE_WARNINGS(); \
+	} \
+	while (0)
+
+#define VL53L1_COPYSTRING(str, ...) \
+	(strncpy(str, ##__VA_ARGS__, VL53L1_MAX_STRING_LENGTH-1))
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_ll_device.h b/drivers/input/misc/vl53L1/inc/vl53l1_ll_device.h
new file mode 100644
index 0000000000000000000000000000000000000000..900c7df606cb23ad81df928c93aef92162b131dd
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_ll_device.h
@@ -0,0 +1,1286 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_LL_DEVICE_H_
+#define _VL53L1_LL_DEVICE_H_
+
+#include "vl53l1_types.h"
+#include "vl53l1_platform_user_config.h"
+
+#define   VL53L1_I2C                      0x01
+#define   VL53L1_SPI                      0x00
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_WaitMethod;
+
+#define VL53L1_WAIT_METHOD_BLOCKING               ((VL53L1_WaitMethod)  0)
+#define VL53L1_WAIT_METHOD_NON_BLOCKING           ((VL53L1_WaitMethod)  1)
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceState;
+
+#define VL53L1_DEVICESTATE_POWERDOWN              ((VL53L1_DeviceState)  0)
+#define VL53L1_DEVICESTATE_HW_STANDBY             ((VL53L1_DeviceState)  1)
+#define VL53L1_DEVICESTATE_FW_COLDBOOT            ((VL53L1_DeviceState)  2)
+#define VL53L1_DEVICESTATE_SW_STANDBY             ((VL53L1_DeviceState)  3)
+#define VL53L1_DEVICESTATE_RANGING_DSS_AUTO       ((VL53L1_DeviceState)  4)
+#define VL53L1_DEVICESTATE_RANGING_DSS_MANUAL     ((VL53L1_DeviceState)  5)
+#define VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC  ((VL53L1_DeviceState)  6)
+#define VL53L1_DEVICESTATE_RANGING_GATHER_DATA    ((VL53L1_DeviceState)  7)
+#define VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA    ((VL53L1_DeviceState)  8)
+
+#define VL53L1_DEVICESTATE_UNKNOWN               ((VL53L1_DeviceState) 98)
+#define VL53L1_DEVICESTATE_ERROR                 ((VL53L1_DeviceState) 99)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceZonePreset;
+
+#define VL53L1_DEVICEZONEPRESET_NONE            \
+	((VL53L1_DeviceZonePreset)   0)
+
+#define VL53L1_DEVICEZONEPRESET_XTALK_PLANAR     \
+	((VL53L1_DeviceZonePreset)   1)
+#define VL53L1_DEVICEZONEPRESET_1X1_SIZE_16X16    \
+	((VL53L1_DeviceZonePreset)   2)
+#define VL53L1_DEVICEZONEPRESET_1X2_SIZE_16X8      \
+	((VL53L1_DeviceZonePreset)   3)
+#define VL53L1_DEVICEZONEPRESET_2X1_SIZE_8X16     \
+	((VL53L1_DeviceZonePreset)   4)
+#define VL53L1_DEVICEZONEPRESET_2X2_SIZE_8X8      \
+	((VL53L1_DeviceZonePreset)   5)
+#define VL53L1_DEVICEZONEPRESET_3X3_SIZE_5X5      \
+	((VL53L1_DeviceZonePreset)   6)
+#define VL53L1_DEVICEZONEPRESET_4X4_SIZE_4X4       \
+	((VL53L1_DeviceZonePreset)   7)
+#define VL53L1_DEVICEZONEPRESET_5X5_SIZE_4X4       \
+	((VL53L1_DeviceZonePreset)   8)
+#define VL53L1_DEVICEZONEPRESET_11X11_SIZE_5X5     \
+	((VL53L1_DeviceZonePreset)   9)
+#define VL53L1_DEVICEZONEPRESET_13X13_SIZE_4X4     \
+	((VL53L1_DeviceZonePreset)  10)
+
+#define VL53L1_DEVICEZONEPRESET_1X1_SIZE_4X4_POS_8X8 \
+	((VL53L1_DeviceZonePreset)  11)
+
+#define VL53L1_DEVICEZONEPRESET_CUSTOM             \
+	((VL53L1_DeviceZonePreset) 255)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DevicePresetModes;
+
+#define VL53L1_DEVICEPRESETMODE_NONE                            \
+	((VL53L1_DevicePresetModes)  0)
+#define VL53L1_DEVICEPRESETMODE_STANDARD_RANGING                \
+	((VL53L1_DevicePresetModes)  1)
+#define VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_SHORT_RANGE    \
+	((VL53L1_DevicePresetModes)  2)
+#define VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_LONG_RANGE     \
+	((VL53L1_DevicePresetModes)  3)
+#define VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM1_CAL        \
+	((VL53L1_DevicePresetModes)  4)
+#define VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM2_CAL        \
+	((VL53L1_DevicePresetModes)  5)
+#define VL53L1_DEVICEPRESETMODE_TIMED_RANGING                   \
+	((VL53L1_DevicePresetModes)  6)
+#define VL53L1_DEVICEPRESETMODE_TIMED_RANGING_SHORT_RANGE       \
+	((VL53L1_DevicePresetModes)  7)
+#define VL53L1_DEVICEPRESETMODE_TIMED_RANGING_LONG_RANGE        \
+	((VL53L1_DevicePresetModes)  8)
+#define VL53L1_DEVICEPRESETMODE_NEAR_FARRANGING                 \
+	((VL53L1_DevicePresetModes)  9)
+#define VL53L1_DEVICEPRESETMODE_QUADRANT_RANGING                \
+	((VL53L1_DevicePresetModes) 10)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING               \
+	((VL53L1_DevicePresetModes) 11)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_SHORT_TIMING  \
+	((VL53L1_DevicePresetModes) 12)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_CHARACTERISATION      \
+	((VL53L1_DevicePresetModes) 13)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_PLANAR          \
+	((VL53L1_DevicePresetModes) 14)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_MM1             \
+	((VL53L1_DevicePresetModes) 15)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_MM2             \
+	((VL53L1_DevicePresetModes) 16)
+#define VL53L1_DEVICEPRESETMODE_OLT                             \
+	((VL53L1_DevicePresetModes) 17)
+#define VL53L1_DEVICEPRESETMODE_SINGLESHOT_RANGING              \
+	((VL53L1_DevicePresetModes) 18)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_REF_ARRAY             \
+	((VL53L1_DevicePresetModes) 19)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM1      \
+	((VL53L1_DevicePresetModes) 20)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM2      \
+	((VL53L1_DevicePresetModes) 21)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM1_CAL       \
+	((VL53L1_DevicePresetModes) 22)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM2_CAL       \
+	((VL53L1_DevicePresetModes) 23)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE             \
+	((VL53L1_DevicePresetModes) 24)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_SHORT_RANGE \
+	((VL53L1_DevicePresetModes) 25)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_LONG_RANGE	\
+	((VL53L1_DevicePresetModes) 26)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE            \
+	((VL53L1_DevicePresetModes) 27)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM1        \
+	((VL53L1_DevicePresetModes) 28)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM2        \
+	((VL53L1_DevicePresetModes) 29)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE          \
+	((VL53L1_DevicePresetModes) 30)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM1      \
+	((VL53L1_DevicePresetModes) 31)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM2      \
+	((VL53L1_DevicePresetModes) 32)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE           \
+	((VL53L1_DevicePresetModes) 33)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM1       \
+	((VL53L1_DevicePresetModes) 34)
+#define VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM2       \
+	((VL53L1_DevicePresetModes) 35)
+#define VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_SHORT_RANGE	\
+	((VL53L1_DevicePresetModes) 36)
+#define VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_MEDIUM_RANGE	\
+	((VL53L1_DevicePresetModes) 37)
+#define VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_LONG_RANGE		\
+	((VL53L1_DevicePresetModes) 38)
+#define VL53L1_DEVICEPRESETMODE_SPECIAL_HISTOGRAM_SHORT_RANGE \
+	((VL53L1_DevicePresetModes) 39)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceMeasurementModes;
+
+#define VL53L1_DEVICEMEASUREMENTMODE_STOP          \
+	((VL53L1_DeviceMeasurementModes)  0x00)
+#define VL53L1_DEVICEMEASUREMENTMODE_SINGLESHOT     \
+	((VL53L1_DeviceMeasurementModes)  0x10)
+#define VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK      \
+	((VL53L1_DeviceMeasurementModes)  0x20)
+#define VL53L1_DEVICEMEASUREMENTMODE_TIMED          \
+	((VL53L1_DeviceMeasurementModes)  0x40)
+#define VL53L1_DEVICEMEASUREMENTMODE_ABORT          \
+	((VL53L1_DeviceMeasurementModes)  0x80)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_OffsetCalibrationMode;
+
+#define VL53L1_OFFSETCALIBRATIONMODE__NONE                \
+	((VL53L1_OffsetCalibrationMode)  0)
+#define VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD    \
+	((VL53L1_OffsetCalibrationMode)  1)
+#define VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM    \
+	((VL53L1_OffsetCalibrationMode)  2)
+#define VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD_PRE_RANGE_ONLY \
+	((VL53L1_OffsetCalibrationMode)  3)
+#define VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM_PRE_RANGE_ONLY \
+	((VL53L1_OffsetCalibrationMode)  4)
+#define VL53L1_OFFSETCALIBRATIONMODE__PER_ZONE                       \
+	((VL53L1_OffsetCalibrationMode)  5)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_OffsetCorrectionMode;
+
+#define VL53L1_OFFSETCORRECTIONMODE__NONE             \
+	((VL53L1_OffsetCorrectionMode)  0)
+#define VL53L1_OFFSETCORRECTIONMODE__MM1_MM2_OFFSETS  \
+	((VL53L1_OffsetCorrectionMode)  1)
+#define VL53L1_OFFSETCORRECTIONMODE__PER_ZONE_OFFSETS  \
+	((VL53L1_OffsetCorrectionMode)  2)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceDmaxMode;
+
+#define VL53L1_DEVICEDMAXMODE__NONE                 \
+	((VL53L1_DeviceDmaxMode)  0)
+#define VL53L1_DEVICEDMAXMODE__FMT_CAL_DATA          \
+	((VL53L1_DeviceDmaxMode)  1)
+#define VL53L1_DEVICEDMAXMODE__CUST_CAL_DATA         \
+	((VL53L1_DeviceDmaxMode)  2)
+#define VL53L1_DEVICEDMAXMODE__PER_ZONE_CAL_DATA     \
+	((VL53L1_DeviceDmaxMode)  3)
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceSequenceConfig;
+
+#define VL53L1_DEVICESEQUENCECONFIG_VHV		\
+	((VL53L1_DeviceSequenceConfig) 0)
+#define VL53L1_DEVICESEQUENCECONFIG_PHASECAL     \
+	((VL53L1_DeviceSequenceConfig) 1)
+#define VL53L1_DEVICESEQUENCECONFIG_REFERENCE_PHASE \
+	((VL53L1_DeviceSequenceConfig) 2)
+#define VL53L1_DEVICESEQUENCECONFIG_DSS1           \
+	((VL53L1_DeviceSequenceConfig) 3)
+#define VL53L1_DEVICESEQUENCECONFIG_DSS2           \
+	((VL53L1_DeviceSequenceConfig) 4)
+#define VL53L1_DEVICESEQUENCECONFIG_MM1            \
+	((VL53L1_DeviceSequenceConfig) 5)
+#define VL53L1_DEVICESEQUENCECONFIG_MM2            \
+	((VL53L1_DeviceSequenceConfig) 6)
+#define VL53L1_DEVICESEQUENCECONFIG_RANGE          \
+	((VL53L1_DeviceSequenceConfig) 7)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceInterruptPolarity;
+
+#define VL53L1_DEVICEINTERRUPTPOLARITY_ACTIVE_HIGH        \
+	((VL53L1_DeviceInterruptPolarity)  0x00)
+#define VL53L1_DEVICEINTERRUPTPOLARITY_ACTIVE_LOW         \
+	((VL53L1_DeviceInterruptPolarity)  0x10)
+#define VL53L1_DEVICEINTERRUPTPOLARITY_BIT_MASK           \
+	((VL53L1_DeviceInterruptPolarity)  0x10)
+#define VL53L1_DEVICEINTERRUPTPOLARITY_CLEAR_MASK          \
+	((VL53L1_DeviceInterruptPolarity)  0xEF)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceGpioMode;
+
+#define VL53L1_DEVICEGPIOMODE_OUTPUT_CONSTANT_ZERO                \
+	((VL53L1_DeviceGpioMode)  0x00)
+#define VL53L1_DEVICEGPIOMODE_OUTPUT_RANGE_AND_ERROR_INTERRUPTS    \
+	((VL53L1_DeviceGpioMode)  0x01)
+#define VL53L1_DEVICEGPIOMODE_OUTPUT_TIMIER_INTERRUPTS             \
+	((VL53L1_DeviceGpioMode)  0x02)
+#define VL53L1_DEVICEGPIOMODE_OUTPUT_RANGE_MODE_INTERRUPT_STATUS  \
+	((VL53L1_DeviceGpioMode)  0x03)
+#define VL53L1_DEVICEGPIOMODE_OUTPUT_SLOW_OSCILLATOR_CLOCK        \
+	((VL53L1_DeviceGpioMode)  0x04)
+#define VL53L1_DEVICEGPIOMODE_BIT_MASK                           \
+	((VL53L1_DeviceGpioMode)  0x0F)
+#define VL53L1_DEVICEGPIOMODE_CLEAR_MASK                        \
+	((VL53L1_DeviceGpioMode)  0xF0)
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceError;
+
+#define VL53L1_DEVICEERROR_NOUPDATE                   \
+	((VL53L1_DeviceError) 0)
+
+
+#define VL53L1_DEVICEERROR_VCSELCONTINUITYTESTFAILURE \
+	((VL53L1_DeviceError) 1)
+#define VL53L1_DEVICEERROR_VCSELWATCHDOGTESTFAILURE   \
+	((VL53L1_DeviceError) 2)
+#define VL53L1_DEVICEERROR_NOVHVVALUEFOUND            \
+	((VL53L1_DeviceError) 3)
+#define VL53L1_DEVICEERROR_MSRCNOTARGET               \
+	((VL53L1_DeviceError) 4)
+#define VL53L1_DEVICEERROR_RANGEPHASECHECK            \
+	((VL53L1_DeviceError) 5)
+#define VL53L1_DEVICEERROR_SIGMATHRESHOLDCHECK        \
+	((VL53L1_DeviceError) 6)
+#define VL53L1_DEVICEERROR_PHASECONSISTENCY           \
+	((VL53L1_DeviceError) 7)
+#define VL53L1_DEVICEERROR_MINCLIP                    \
+	((VL53L1_DeviceError) 8)
+#define VL53L1_DEVICEERROR_RANGECOMPLETE               \
+	((VL53L1_DeviceError) 9)
+#define VL53L1_DEVICEERROR_ALGOUNDERFLOW               \
+	((VL53L1_DeviceError) 10)
+#define VL53L1_DEVICEERROR_ALGOOVERFLOW                \
+	((VL53L1_DeviceError) 11)
+#define VL53L1_DEVICEERROR_RANGEIGNORETHRESHOLD       \
+	((VL53L1_DeviceError) 12)
+#define VL53L1_DEVICEERROR_USERROICLIP                \
+	((VL53L1_DeviceError) 13)
+#define VL53L1_DEVICEERROR_REFSPADCHARNOTENOUGHDPADS   \
+	((VL53L1_DeviceError) 14)
+#define VL53L1_DEVICEERROR_REFSPADCHARMORETHANTARGET  \
+	((VL53L1_DeviceError) 15)
+#define VL53L1_DEVICEERROR_REFSPADCHARLESSTHANTARGET  \
+	((VL53L1_DeviceError) 16)
+#define VL53L1_DEVICEERROR_MULTCLIPFAIL                \
+	((VL53L1_DeviceError) 17)
+#define VL53L1_DEVICEERROR_GPHSTREAMCOUNT0READY        \
+	((VL53L1_DeviceError) 18)
+#define VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK \
+	((VL53L1_DeviceError) 19)
+#define VL53L1_DEVICEERROR_EVENTCONSISTENCY           \
+	((VL53L1_DeviceError) 20)
+#define VL53L1_DEVICEERROR_MINSIGNALEVENTCHECK        \
+	((VL53L1_DeviceError) 21)
+#define VL53L1_DEVICEERROR_RANGECOMPLETE_MERGED_PULSE \
+	((VL53L1_DeviceError) 22)
+
+
+
+#define VL53L1_DEVICEERROR_PREV_RANGE_NO_TARGETS      \
+	((VL53L1_DeviceError) 23)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceReportStatus;
+
+#define VL53L1_DEVICEREPORTSTATUS_NOUPDATE                 \
+	((VL53L1_DeviceReportStatus) 0)
+
+
+#define VL53L1_DEVICEREPORTSTATUS_ROI_SETUP               \
+	((VL53L1_DeviceReportStatus)  1)
+#define VL53L1_DEVICEREPORTSTATUS_VHV                     \
+	((VL53L1_DeviceReportStatus)  2)
+#define VL53L1_DEVICEREPORTSTATUS_PHASECAL                \
+	((VL53L1_DeviceReportStatus)  3)
+#define VL53L1_DEVICEREPORTSTATUS_REFERENCE_PHASE         \
+	((VL53L1_DeviceReportStatus)  4)
+#define VL53L1_DEVICEREPORTSTATUS_DSS1                    \
+	((VL53L1_DeviceReportStatus)  5)
+#define VL53L1_DEVICEREPORTSTATUS_DSS2                    \
+	((VL53L1_DeviceReportStatus)  6)
+#define VL53L1_DEVICEREPORTSTATUS_MM1                     \
+	((VL53L1_DeviceReportStatus)  7)
+#define VL53L1_DEVICEREPORTSTATUS_MM2                     \
+	((VL53L1_DeviceReportStatus)  8)
+#define VL53L1_DEVICEREPORTSTATUS_RANGE                   \
+	((VL53L1_DeviceReportStatus)  9)
+#define VL53L1_DEVICEREPORTSTATUS_HISTOGRAM               \
+	((VL53L1_DeviceReportStatus) 10)
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceDssMode;
+
+#define VL53L1_DEVICEDSSMODE__DISABLED \
+	((VL53L1_DeviceDssMode) 0)
+#define VL53L1_DEVICEDSSMODE__TARGET_RATE \
+	((VL53L1_DeviceDssMode) 1)
+#define VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS \
+	((VL53L1_DeviceDssMode) 2)
+#define VL53L1_DEVICEDSSMODE__BLOCK_SELECT \
+	((VL53L1_DeviceDssMode) 3)
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_HistAlgoSelect;
+
+#define VL53L1_HIST_ALGO_SELECT__PW_HIST_GEN1 \
+	((VL53L1_HistAlgoSelect) 1)
+#define VL53L1_HIST_ALGO_SELECT__PW_HIST_GEN2 \
+	((VL53L1_HistAlgoSelect) 2)
+#define VL53L1_HIST_ALGO_SELECT__PW_HIST_GEN3 \
+	((VL53L1_HistAlgoSelect) 3)
+#define VL53L1_HIST_ALGO_SELECT__PW_HIST_GEN4 \
+	((VL53L1_HistAlgoSelect) 4)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_HistTargetOrder;
+
+#define VL53L1_HIST_TARGET_ORDER__INCREASING_DISTANCE \
+	((VL53L1_HistTargetOrder) 1)
+#define VL53L1_HIST_TARGET_ORDER__STRONGEST_FIRST \
+	((VL53L1_HistTargetOrder) 2)
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_HistAmbEstMethod;
+
+#define VL53L1_HIST_AMB_EST_METHOD__AMBIENT_BINS \
+	((VL53L1_HistAmbEstMethod) 1)
+#define VL53L1_HIST_AMB_EST_METHOD__THRESHOLDED_BINS  \
+	((VL53L1_HistAmbEstMethod) 2)
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_HistXtalkCompEnable;
+
+#define VL53L1_HIST_XTALK_COMP__DIS \
+	((VL53L1_HistXtalkCompEnable) 0)
+#define VL53L1_HIST_XTALK_COMP__EN \
+	((VL53L1_HistXtalkCompEnable) 1)
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceConfigLevel;
+
+#define VL53L1_DEVICECONFIGLEVEL_SYSTEM_CONTROL  \
+	((VL53L1_DeviceConfigLevel)  0)
+
+
+#define VL53L1_DEVICECONFIGLEVEL_DYNAMIC_ONWARDS \
+	((VL53L1_DeviceConfigLevel)  1)
+
+
+#define VL53L1_DEVICECONFIGLEVEL_TIMING_ONWARDS \
+	((VL53L1_DeviceConfigLevel)  2)
+
+
+
+#define VL53L1_DEVICECONFIGLEVEL_GENERAL_ONWARDS \
+	((VL53L1_DeviceConfigLevel)  3)
+
+
+
+#define VL53L1_DEVICECONFIGLEVEL_STATIC_ONWARDS  \
+	((VL53L1_DeviceConfigLevel)  4)
+
+
+
+#define VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS  \
+	((VL53L1_DeviceConfigLevel)  5)
+
+
+
+#define VL53L1_DEVICECONFIGLEVEL_FULL  \
+	((VL53L1_DeviceConfigLevel)  6)
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceResultsLevel;
+
+#define VL53L1_DEVICERESULTSLEVEL_SYSTEM_RESULTS  \
+	((VL53L1_DeviceResultsLevel)  0)
+
+
+#define VL53L1_DEVICERESULTSLEVEL_UPTO_CORE  \
+	((VL53L1_DeviceResultsLevel)  1)
+
+
+#define VL53L1_DEVICERESULTSLEVEL_FULL  \
+	((VL53L1_DeviceResultsLevel)  2)
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceTestMode;
+
+#define VL53L1_DEVICETESTMODE_NONE \
+	((VL53L1_DeviceTestMode) 0x00)
+
+
+#define VL53L1_DEVICETESTMODE_NVM_ZERO \
+	((VL53L1_DeviceTestMode) 0x01)
+
+
+#define VL53L1_DEVICETESTMODE_NVM_COPY \
+	((VL53L1_DeviceTestMode) 0x02)
+
+
+#define VL53L1_DEVICETESTMODE_PATCH \
+	((VL53L1_DeviceTestMode) 0x03)
+
+
+#define VL53L1_DEVICETESTMODE_DCR \
+	((VL53L1_DeviceTestMode) 0x04)
+
+
+#define VL53L1_DEVICETESTMODE_LCR_VCSEL_OFF \
+	((VL53L1_DeviceTestMode) 0x05)
+
+
+
+#define VL53L1_DEVICETESTMODE_LCR_VCSEL_ON \
+	((VL53L1_DeviceTestMode) 0x06)
+
+
+
+#define VL53L1_DEVICETESTMODE_SPOT_CENTRE_LOCATE \
+	((VL53L1_DeviceTestMode) 0x07)
+
+
+#define VL53L1_DEVICETESTMODE_REF_SPAD_CHAR_WITH_PRE_VHV \
+	((VL53L1_DeviceTestMode) 0x08)
+
+
+#define VL53L1_DEVICETESTMODE_REF_SPAD_CHAR_ONLY \
+	((VL53L1_DeviceTestMode) 0x09)
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_DeviceSscArray;
+
+#define VL53L1_DEVICESSCARRAY_RTN ((VL53L1_DeviceSscArray) 0x00)
+
+
+#define VL53L1_DEVICETESTMODE_REF ((VL53L1_DeviceSscArray) 0x01)
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RETURN_ARRAY_ONLY                   0x01
+
+
+#define VL53L1_REFERENCE_ARRAY_ONLY                0x10
+
+
+#define VL53L1_BOTH_RETURN_AND_REFERENCE_ARRAYS    0x11
+
+
+#define VL53L1_NEITHER_RETURN_AND_REFERENCE_ARRAYS 0x00
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_HIGH               0x00
+
+
+#define VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_LOW                0x10
+
+
+#define VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_MASK               0x10
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_POLLING_DELAY_US                     1000
+
+
+#define VL53L1_SOFTWARE_RESET_DURATION_US            100
+
+
+#define VL53L1_FIRMWARE_BOOT_TIME_US                1200
+
+
+
+#define VL53L1_ENABLE_POWERFORCE_SETTLING_TIME_US    250
+
+
+
+
+#define VL53L1_SPAD_ARRAY_WIDTH                       16
+
+
+#define VL53L1_SPAD_ARRAY_HEIGHT                      16
+
+
+#define VL53L1_NVM_SIZE_IN_BYTES                     512
+
+
+#define VL53L1_NO_OF_SPAD_ENABLES                    256
+
+
+#define VL53L1_RTN_SPAD_BUFFER_SIZE                   32
+
+
+#define VL53L1_REF_SPAD_BUFFER_SIZE                    6
+
+
+#define VL53L1_AMBIENT_WINDOW_VCSEL_PERIODS          256
+
+
+#define VL53L1_RANGING_WINDOW_VCSEL_PERIODS         2048
+
+
+#define VL53L1_MACRO_PERIOD_VCSEL_PERIODS \
+	(VL53L1_AMBIENT_WINDOW_VCSEL_PERIODS + \
+		VL53L1_RANGING_WINDOW_VCSEL_PERIODS)
+
+
+#define VL53L1_MAX_ALLOWED_PHASE                    0xFFFF
+
+
+
+#define VL53L1_RTN_SPAD_UNITY_TRANSMISSION      0x0100
+
+
+#define VL53L1_RTN_SPAD_APERTURE_TRANSMISSION   0x0038
+
+
+
+
+
+#define VL53L1_SPAD_TOTAL_COUNT_MAX                 ((0x01 << 29) - 1)
+
+
+#define VL53L1_SPAD_TOTAL_COUNT_RES_THRES            (0x01 << 24)
+
+
+#define VL53L1_COUNT_RATE_INTERNAL_MAX              ((0x01 << 24) - 1)
+
+
+#define VL53L1_SPEED_OF_LIGHT_IN_AIR                299704
+
+
+#define VL53L1_SPEED_OF_LIGHT_IN_AIR_DIV_8          (299704 >> 3)
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_ZoneConfig_BinConfig_select;
+
+#define VL53L1_ZONECONFIG_BINCONFIG__LOWAMB \
+	((VL53L1_ZoneConfig_BinConfig_select) 1)
+#define VL53L1_ZONECONFIG_BINCONFIG__MIDAMB \
+	((VL53L1_ZoneConfig_BinConfig_select) 2)
+#define VL53L1_ZONECONFIG_BINCONFIG__HIGHAMB \
+	((VL53L1_ZoneConfig_BinConfig_select) 3)
+
+
+
+
+
+
+
+
+
+
+typedef uint8_t VL53L1_GPIO_Interrupt_Mode;
+
+#define VL53L1_GPIOINTMODE_LEVEL_LOW \
+	((VL53L1_GPIO_Interrupt_Mode) 0)
+
+
+#define VL53L1_GPIOINTMODE_LEVEL_HIGH \
+	((VL53L1_GPIO_Interrupt_Mode) 1)
+
+
+#define VL53L1_GPIOINTMODE_OUT_OF_WINDOW \
+	((VL53L1_GPIO_Interrupt_Mode) 2)
+
+
+#define VL53L1_GPIOINTMODE_IN_WINDOW \
+	((VL53L1_GPIO_Interrupt_Mode) 3)
+
+
+
+
+
+
+
+
+
+
+
+
+
+typedef uint16_t VL53L1_TuningParms;
+
+#define VL53L1_TUNINGPARMS_LLD_PUBLIC_MIN_ADDRESS \
+	((VL53L1_TuningParms) VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS)
+#define VL53L1_TUNINGPARMS_LLD_PUBLIC_MAX_ADDRESS \
+	((VL53L1_TuningParms) VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS)
+
+#define VL53L1_TUNINGPARMS_LLD_PRIVATE_MIN_ADDRESS \
+	((VL53L1_TuningParms) VL53L1_TUNINGPARM_PRIVATE_PAGE_BASE_ADDRESS)
+#define VL53L1_TUNINGPARMS_LLD_PRIVATE_MAX_ADDRESS \
+	((VL53L1_TuningParms) VL53L1_TUNINGPARMS_LLD_PRIVATE_MIN_ADDRESS)
+
+#define VL53L1_TUNINGPARM_VERSION \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 0))
+#define VL53L1_TUNINGPARM_KEY_TABLE_VERSION \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 1))
+#define VL53L1_TUNINGPARM_LLD_VERSION \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 2))
+#define VL53L1_TUNINGPARM_HIST_ALGO_SELECT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 3))
+#define VL53L1_TUNINGPARM_HIST_TARGET_ORDER \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 4))
+#define VL53L1_TUNINGPARM_HIST_FILTER_WOI_0 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 5))
+#define VL53L1_TUNINGPARM_HIST_FILTER_WOI_1 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 6))
+#define VL53L1_TUNINGPARM_HIST_AMB_EST_METHOD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 7))
+#define VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_0 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 8))
+#define VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_1 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 9))
+#define VL53L1_TUNINGPARM_HIST_MIN_AMB_THRESH_EVENTS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 10))
+#define VL53L1_TUNINGPARM_HIST_AMB_EVENTS_SCALER \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 11))
+#define VL53L1_TUNINGPARM_HIST_NOISE_THRESHOLD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 12))
+#define VL53L1_TUNINGPARM_HIST_SIGNAL_TOTAL_EVENTS_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 13))
+#define VL53L1_TUNINGPARM_HIST_SIGMA_EST_REF_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 14))
+#define VL53L1_TUNINGPARM_HIST_SIGMA_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 15))
+#define VL53L1_TUNINGPARM_HIST_GAIN_FACTOR \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 16))
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_PHASE_TOLERANCE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 17))
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_MIN_MAX_TOLERANCE_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 18))
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 19))
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_MIN_SPAD_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 20))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_LONG_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 21))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_MED_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 22))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_SHORT_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 23))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_LONG_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 24))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_MED_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 25))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_SHORT_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 26))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 27))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 28))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 29))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MIN_MAX_TOLERANCE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 30))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 31))
+#define VL53L1_TUNINGPARM_XTALK_DETECT_EVENT_SIGMA \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 32))
+#define VL53L1_TUNINGPARM_HIST_XTALK_MARGIN_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 33))
+#define VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 34))
+#define VL53L1_TUNINGPARM_PHASECAL_TARGET \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 35))
+#define VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 36))
+#define VL53L1_TUNINGPARM_LITE_RANGING_GAIN_FACTOR \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 37))
+#define VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 38))
+#define VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 39))
+#define VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 40))
+#define VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 41))
+#define VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 42))
+#define VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 43))
+#define VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 44))
+#define VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 45))
+#define VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 46))
+#define VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 47))
+#define VL53L1_TUNINGPARM_LITE_RIT_MULT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 48))
+#define VL53L1_TUNINGPARM_LITE_SEED_CONFIG \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 49))
+#define VL53L1_TUNINGPARM_LITE_QUANTIFIER \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 50))
+#define VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 51))
+#define VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 52))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 53))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 54))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 55))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 56))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 57))
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 58))
+#define VL53L1_TUNINGPARM_TIMED_SEED_CONFIG \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 59))
+#define VL53L1_TUNINGPARM_DMAX_CFG_SIGNAL_THRESH_SIGMA \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 60))
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_0 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 61))
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_1 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 62))
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_2 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 63))
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_3 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 64))
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_4 \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 65))
+#define VL53L1_TUNINGPARM_VHV_LOOPBOUND \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 66))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 67))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 68))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 69))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 70))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 71))
+#define VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 72))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_NUM_OF_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 73))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MIN_FILTER_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 74))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_FILTER_THRESH_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 75))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 76))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_PHASECAL_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 77))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_VALID_RATE_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 78))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_SIGMA_THRESHOLD_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 79))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 80))
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_BIN_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 81))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 82))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 83))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 84))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 85))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 86))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 87))
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 88))
+#define VL53L1_TUNINGPARM_ZONE_CAL_DSS_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 89))
+#define VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 90))
+#define VL53L1_TUNINGPARM_ZONE_CAL_DSS_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 91))
+#define VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_NUM_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 92))
+#define VL53L1_TUNINGPARM_ZONE_CAL_RANGE_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 93))
+#define VL53L1_TUNINGPARM_ZONE_CAL_ZONE_NUM_SAMPLES \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 94))
+#define VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 95))
+#define VL53L1_TUNINGPARM_SPADMAP_VCSEL_START \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 96))
+#define VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 97))
+#define VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 98))
+#define VL53L1_TUNINGPARM_RANGING_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 99))
+#define VL53L1_TUNINGPARM_MZ_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 100))
+#define VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 101))
+#define VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 102))
+#define VL53L1_TUNINGPARM_RANGING_LONG_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 103))
+#define VL53L1_TUNINGPARM_RANGING_MED_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 104))
+#define VL53L1_TUNINGPARM_RANGING_SHORT_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 105))
+#define VL53L1_TUNINGPARM_MZ_LONG_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 106))
+#define VL53L1_TUNINGPARM_MZ_MED_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 107))
+#define VL53L1_TUNINGPARM_MZ_SHORT_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 108))
+#define VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 109))
+#define VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 110))
+#define VL53L1_TUNINGPARM_RANGING_MM_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 111))
+#define VL53L1_TUNINGPARM_MZ_MM_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 112))
+#define VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 113))
+#define VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 114))
+#define VL53L1_TUNINGPARM_RANGING_RANGE_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 115))
+#define VL53L1_TUNINGPARM_MZ_RANGE_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 116))
+#define VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 117))
+#define VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_MARGIN \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 118))
+#define VL53L1_TUNINGPARM_DYNXTALK_NOISE_MARGIN \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 119))
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 120))
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_HI \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 121))
+#define VL53L1_TUNINGPARM_DYNXTALK_SAMPLE_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 122))
+#define VL53L1_TUNINGPARM_DYNXTALK_SINGLE_XTALK_DELTA \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 123))
+#define VL53L1_TUNINGPARM_DYNXTALK_AVERAGED_XTALK_DELTA \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 124))
+#define VL53L1_TUNINGPARM_DYNXTALK_CLIP_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 125))
+#define VL53L1_TUNINGPARM_DYNXTALK_SCALER_CALC_METHOD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 126))
+#define VL53L1_TUNINGPARM_DYNXTALK_XGRADIENT_SCALER \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 127))
+#define VL53L1_TUNINGPARM_DYNXTALK_YGRADIENT_SCALER \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 128))
+#define VL53L1_TUNINGPARM_DYNXTALK_USER_SCALER_SET \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 129))
+#define VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_COR_SINGLE_APPLY \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 130))
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_AMB_THRESHOLD \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 131))
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_AMB_THRESHOLD_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 132))
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_SAMPLE_LIMIT \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 133))
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 134))
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_MIN_RANGE_MM \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 135))
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 136))
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 137))
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 138))
+#define VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS \
+((VL53L1_TuningParms) (VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS + 139))
+
+
+
+
+
+
+#endif
+
+
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_nvm.h b/drivers/input/misc/vl53L1/inc/vl53l1_nvm.h
new file mode 100644
index 0000000000000000000000000000000000000000..53ccad1c112e60749c282d5c166ef013e93b9604
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_nvm.h
@@ -0,0 +1,459 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_NVM_H_
+#define _VL53L1_NVM_H_
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#define VL53L1_NVM_POWER_UP_DELAY_US             50
+#define VL53L1_NVM_READ_TRIGGER_DELAY_US          5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_enable(
+	VL53L1_DEV     Dev,
+	uint16_t       nvm_ctrl_pulse_width,
+	int32_t        nvm_power_up_delay_us);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_read(
+	VL53L1_DEV     Dev,
+	uint8_t        start_address,
+	uint8_t        count,
+	uint8_t       *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_disable(
+	VL53L1_DEV     Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_format_decode(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_decoded_nvm_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_optical_centre(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_optical_centre_t             *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_cal_peak_rate_map(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_cal_peak_rate_map_t          *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_additional_offset_cal_data(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_additional_offset_cal_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_fmt_range_results_data(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_decoded_nvm_fmt_range_data_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_fmt_info(
+	uint16_t                       buf_size,
+	uint8_t                       *pbuffer,
+	VL53L1_decoded_nvm_fmt_info_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_nvm_decode_ews_info(
+	uint16_t                       buf_size,
+	uint8_t                       *pbuffer,
+	VL53L1_decoded_nvm_ews_info_t *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_nvm_format_encode(
+	VL53L1_decoded_nvm_data_t *pnvm_info,
+	uint8_t                   *pnvm_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm_raw_data(
+	VL53L1_DEV     Dev,
+	uint8_t        start_address,
+	uint8_t        count,
+	uint8_t       *pnvm_raw_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm(
+	VL53L1_DEV                 Dev,
+	uint8_t                    nvm_format,
+	VL53L1_decoded_nvm_data_t *pnvm_info);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm_optical_centre(
+	VL53L1_DEV                           Dev,
+	VL53L1_optical_centre_t             *pcentre);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm_cal_peak_rate_map(
+	VL53L1_DEV                           Dev,
+	VL53L1_cal_peak_rate_map_t          *pcal_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm_additional_offset_cal_data(
+	VL53L1_DEV                           Dev,
+	VL53L1_additional_offset_cal_data_t *pcal_data);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_read_nvm_fmt_range_results_data(
+	VL53L1_DEV                           Dev,
+	uint16_t                             range_results_select,
+	VL53L1_decoded_nvm_fmt_range_data_t *prange_data);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_nvm_debug.h b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_debug.h
new file mode 100644
index 0000000000000000000000000000000000000000..0524c0c169f52e72d3e47d83b13a93fa3e9bfc53
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_debug.h
@@ -0,0 +1,202 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_NVM_DEBUG_H_
+#define _VL53L1_NVM_DEBUG_H_
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_nvm_structs.h"
+
+
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_nvm_raw_data(
+	uint8_t                       *pnvm_raw_data,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_decoded_nvm_data(
+	VL53L1_decoded_nvm_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_decoded_nvm_fmt_range_data(
+	VL53L1_decoded_nvm_fmt_range_data_t *pdata,
+	char                                *pprefix,
+	uint32_t                             trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_decoded_nvm_fmt_info(
+	VL53L1_decoded_nvm_fmt_info_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+
+
+
+
+
+
+
+
+
+
+void VL53L1_print_decoded_nvm_ews_info(
+	VL53L1_decoded_nvm_ews_info_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags);
+
+#endif
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_nvm_map.h b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_map.h
new file mode 100644
index 0000000000000000000000000000000000000000..15b5e12766654d549f8e5ab830acaa0f4f6f9295
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_map.h
@@ -0,0 +1,3254 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_NVM_MAP_H_
+#define _VL53L1_NVM_MAP_H_
+
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+
+
+
+
+
+#define VL53L1_NVM__IDENTIFICATION__MODEL_ID 0x0008
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__IDENTIFICATION__MODULE_TYPE 0x000C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__IDENTIFICATION__REVISION_ID 0x000D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__IDENTIFICATION__MODULE_ID 0x000E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__I2C_VALID 0x0010
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__I2C_SLAVE__DEVICE_ADDRESS 0x0011
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__OSC_MEASURED__FAST_OSC_FREQUENCY 0x0014
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__FAST_OSC_TRIM_MAX 0x0016
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__FAST_OSC_FREQ_SET 0x0017
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SLOW_OSC_CALIBRATION 0x0018
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__OSC_MEASURED__FAST_OSC_FREQUENCY 0x001C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FAST_OSC_TRIM_MAX 0x001E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FAST_OSC_FREQ_SET 0x001F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SLOW_OSC_CALIBRATION 0x0020
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__VHV_CONFIG_UNLOCK 0x0028
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__REF_SELVDDPIX 0x0029
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__REF_SELVQUENCH 0x002A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__REGAVDD1V2_SEL_REGDVDD1V2_SEL 0x002B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__VHV_CONFIG__TIMEOUT_MACROP_LOOP_BOUND 0x002C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__VHV_CONFIG__COUNT_THRESH 0x002D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__VHV_CONFIG__OFFSET 0x002E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__VHV_CONFIG__INIT 0x002F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_TRIM_LL 0x0030
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_LL 0x0031
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_MAX_LL 0x0032
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__MULT_LL 0x0034
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__CLIP_LL 0x0035
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_TRIM_LD 0x0038
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_LD 0x0039
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_MAX_LD 0x003A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__MULT_LD 0x003C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY__CLIP_LD 0x003D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY_LOCK_BYTE 0x0040
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__LASER_SAFETY_UNLOCK_BYTE 0x0044
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_0_ 0x0048
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_1_ 0x0049
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_2_ 0x004A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_3_ 0x004B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_4_ 0x004C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_5_ 0x004D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_6_ 0x004E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_7_ 0x004F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_8_ 0x0050
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_9_ 0x0051
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_10_ 0x0052
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_11_ 0x0053
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_12_ 0x0054
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_13_ 0x0055
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_14_ 0x0056
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_15_ 0x0057
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_16_ 0x0058
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_17_ 0x0059
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_18_ 0x005A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_19_ 0x005B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_20_ 0x005C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_21_ 0x005D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_22_ 0x005E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_23_ 0x005F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_24_ 0x0060
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_25_ 0x0061
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_26_ 0x0062
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_27_ 0x0063
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_28_ 0x0064
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_29_ 0x0065
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_30_ 0x0066
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_RTN_31_ 0x0067
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_0_ 0x0068
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_1_ 0x0069
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_2_ 0x006A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_3_ 0x006B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_4_ 0x006C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_5_ 0x006D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_0_ 0x0070
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_1_ 0x0071
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_2_ 0x0072
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_3_ 0x0073
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_4_ 0x0074
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_5_ 0x0075
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_0_ 0x0078
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_1_ 0x0079
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_2_ 0x007A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_3_ 0x007B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_4_ 0x007C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_5_ 0x007D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_0_ 0x0080
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_1_ 0x0081
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_2_ 0x0082
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_3_ 0x0083
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_4_ 0x0084
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_5_ 0x0085
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_6_ 0x0086
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_7_ 0x0087
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_8_ 0x0088
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_9_ 0x0089
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_10_ 0x008A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_11_ 0x008B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_12_ 0x008C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_13_ 0x008D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_14_ 0x008E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_15_ 0x008F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_16_ 0x0090
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_17_ 0x0091
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_18_ 0x0092
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_19_ 0x0093
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_20_ 0x0094
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_21_ 0x0095
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_22_ 0x0096
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_23_ 0x0097
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_24_ 0x0098
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_25_ 0x0099
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_26_ 0x009A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_27_ 0x009B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_28_ 0x009C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_29_ 0x009D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_30_ 0x009E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_RTN_31_ 0x009F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_0_ 0x00A0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_1_ 0x00A1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_2_ 0x00A2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_3_ 0x00A3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_4_ 0x00A4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_5_ 0x00A5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_0_ 0x00A8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_1_ 0x00A9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_2_ 0x00AA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_3_ 0x00AB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_4_ 0x00AC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_5_ 0x00AD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_0_ 0x00B0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_1_ 0x00B1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_2_ 0x00B2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_3_ 0x00B3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_4_ 0x00B4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_5_ 0x00B5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ROI_CONFIG__MODE_ROI_CENTRE_SPAD 0x00B8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ROI_CONFIG__MODE_ROI_XY_SIZE 0x00B9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__REF_SPAD_APPLY__NUM_REQUESTED_REF_SPAD 0x00BC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__REF_SPAD_MAN__REF_LOCATION 0x00BD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__MM_CONFIG__INNER_OFFSET_MM 0x00C0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__MM_CONFIG__OUTER_OFFSET_MM 0x00C2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ALGO__PART_TO_PART_RANGE_OFFSET_MM 0x00C4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS 0x00C8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS \
+	0x00CA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS \
+	0x00CC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_0 0x00CE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_1 0x00CF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUSTOMER_NVM_SPACE_PROGRAMMED 0x00E0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__I2C_SLAVE__DEVICE_ADDRESS 0x00E4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__REF_SPAD_APPLY__NUM_REQUESTED_REF_SPAD 0x00E8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__REF_SPAD_MAN__REF_LOCATION 0x00E9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__MM_CONFIG__INNER_OFFSET_MM 0x00EC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__MM_CONFIG__OUTER_OFFSET_MM 0x00EE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__ALGO__PART_TO_PART_RANGE_OFFSET_MM 0x00F0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS 0x00F4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS \
+	0x00F6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS \
+	0x00F8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_0 0x00FA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__CUST__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_1 0x00FB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_0 0x01DC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_1 0x01DD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_2 0x01DE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_3 0x01DF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_4 0x01E0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_5 0x01E1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_6 0x01E2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_7 0x01E3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_8 0x01E4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_9 0x01E5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_10 0x01E6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_11 0x01E7
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_12 0x01E8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_13 0x01E9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_14 0x01EA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__FGC__BYTE_15 0x01EB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__TEST_PROGRAM_MAJOR_MINOR 0x01EC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__MAP_MAJOR_MINOR 0x01ED
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__YEAR_MONTH 0x01EE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__DAY_MODULE_DATE_PHASE 0x01EF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__TIME 0x01F0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__TESTER_ID 0x01F2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__SITE_ID 0x01F3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__TEST_PROGRAM_MAJOR_MINOR 0x01F4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__PROBE_CARD_MAJOR_MINOR 0x01F5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__TESTER_ID 0x01F6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_0 0x01F8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_1 0x01F9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_2 0x01FA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_3 0x01FB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_4 0x01FC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__LOT__BYTE_5 0x01FD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__WAFER 0x01FD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__XCOORD 0x01FE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__EWS__YCOORD 0x01FF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_INDEX 0x00B8
+#define VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_SIZE      4
+
+#define VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_INDEX 0x015C
+#define VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_SIZE   56
+
+#define VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_INDEX 0x0194
+#define VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_SIZE   8
+
+#define VL53L1_NVM__FMT__RANGE_RESULTS__140MM_MM_PRE_RANGE 0x019C
+#define VL53L1_NVM__FMT__RANGE_RESULTS__140MM_DARK 0x01AC
+#define VL53L1_NVM__FMT__RANGE_RESULTS__400MM_DARK 0x01BC
+#define VL53L1_NVM__FMT__RANGE_RESULTS__400MM_AMBIENT 0x01CC
+#define VL53L1_NVM__FMT__RANGE_RESULTS__SIZE_BYTES         16
+
+
+
+
+
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_nvm_structs.h b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_structs.h
new file mode 100644
index 0000000000000000000000000000000000000000..4f9504034bc4952dd5536d25cbde6ec667a1fcdc
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_nvm_structs.h
@@ -0,0 +1,809 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_NVM_STRUCTS_H_
+#define _VL53L1_NVM_STRUCTS_H_
+
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include "vl53l1_platform.h"
+#include "vl53l1_ll_def.h"
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint16_t  result__actual_effective_rtn_spads;
+
+
+	uint8_t   ref_spad_array__num_requested_ref_spads;
+
+
+	uint8_t   ref_spad_array__ref_location;
+
+
+	uint16_t  result__peak_signal_count_rate_rtn_mcps;
+
+
+	uint16_t  result__ambient_count_rate_rtn_mcps;
+
+
+	uint16_t  result__peak_signal_count_rate_ref_mcps;
+
+
+	uint16_t  result__ambient_count_rate_ref_mcps;
+
+
+	uint16_t  measured_distance_mm;
+
+
+	uint16_t  measured_distance_stdev_mm;
+
+
+
+} VL53L1_decoded_nvm_fmt_range_data_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	char      nvm__fmt__fgc[19];
+
+
+	uint8_t   nvm__fmt__test_program_major;
+
+
+
+
+
+	uint8_t   nvm__fmt__test_program_minor;
+
+
+
+
+
+	uint8_t   nvm__fmt__map_major;
+
+
+
+
+
+	uint8_t   nvm__fmt__map_minor;
+
+
+
+
+
+	uint8_t   nvm__fmt__year;
+
+
+
+
+
+	uint8_t   nvm__fmt__month;
+
+
+
+
+
+	uint8_t   nvm__fmt__day;
+
+
+
+
+
+	uint8_t   nvm__fmt__module_date_phase;
+
+
+
+
+
+	uint16_t  nvm__fmt__time;
+
+
+
+
+
+	uint8_t   nvm__fmt__tester_id;
+
+
+
+
+
+	uint8_t   nvm__fmt__site_id;
+
+
+
+
+
+	uint8_t   nvm__ews__test_program_major;
+
+
+
+
+
+	uint8_t   nvm__ews__test_program_minor;
+
+
+
+
+
+	uint8_t   nvm__ews__probe_card_major;
+
+
+
+
+
+	uint8_t   nvm__ews__probe_card_minor;
+
+
+
+
+
+	uint8_t   nvm__ews__tester_id;
+
+
+
+
+
+
+	char      nvm__ews__lot[8];
+
+
+	uint8_t   nvm__ews__wafer;
+
+
+
+
+
+	uint8_t   nvm__ews__xcoord;
+
+
+
+
+
+	uint8_t   nvm__ews__ycoord;
+
+
+
+
+
+} VL53L1_decoded_nvm_fmt_info_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+
+	uint8_t   nvm__ews__test_program_major;
+
+
+
+
+
+	uint8_t   nvm__ews__test_program_minor;
+
+
+
+
+
+	uint8_t   nvm__ews__probe_card_major;
+
+
+
+
+
+	uint8_t   nvm__ews__probe_card_minor;
+
+
+
+
+
+	uint8_t   nvm__ews__tester_id;
+
+
+
+
+
+
+	char      nvm__ews__lot[8];
+
+
+	uint8_t   nvm__ews__wafer;
+
+
+
+
+
+	uint8_t   nvm__ews__xcoord;
+
+
+
+
+
+	uint8_t   nvm__ews__ycoord;
+
+
+
+
+
+
+} VL53L1_decoded_nvm_ews_info_t;
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   nvm__identification_model_id;
+
+
+
+
+
+	uint8_t   nvm__identification_module_type;
+
+
+
+
+
+	uint8_t   nvm__identification_revision_id;
+
+
+
+
+
+	uint16_t  nvm__identification_module_id;
+
+
+
+
+
+	uint8_t   nvm__i2c_valid;
+
+
+
+
+
+	uint8_t   nvm__i2c_device_address_ews;
+
+
+
+
+
+	uint16_t  nvm__ews__fast_osc_frequency;
+
+
+
+
+
+	uint8_t   nvm__ews__fast_osc_trim_max;
+
+
+
+
+
+	uint8_t   nvm__ews__fast_osc_freq_set;
+
+
+
+
+
+	uint16_t  nvm__ews__slow_osc_calibration;
+
+
+
+
+
+	uint16_t  nvm__fmt__fast_osc_frequency;
+
+
+
+
+
+	uint8_t   nvm__fmt__fast_osc_trim_max;
+
+
+
+
+
+	uint8_t   nvm__fmt__fast_osc_freq_set;
+
+
+
+
+
+	uint16_t  nvm__fmt__slow_osc_calibration;
+
+
+
+
+
+	uint8_t   nvm__vhv_config_unlock;
+
+
+
+
+
+	uint8_t   nvm__ref_selvddpix;
+
+
+
+
+
+	uint8_t   nvm__ref_selvquench;
+
+
+
+
+
+	uint8_t   nvm__regavdd1v2_sel;
+
+
+
+
+
+	uint8_t   nvm__regdvdd1v2_sel;
+
+
+
+
+
+	uint8_t   nvm__vhv_timeout__macrop;
+
+
+
+
+
+	uint8_t   nvm__vhv_loop_bound;
+
+
+
+
+
+	uint8_t   nvm__vhv_count_threshold;
+
+
+
+
+
+	uint8_t   nvm__vhv_offset;
+
+
+
+
+
+	uint8_t   nvm__vhv_init_enable;
+
+
+
+
+
+	uint8_t   nvm__vhv_init_value;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_trim_ll;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_selion_ll;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_selion_max_ll;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_mult_ll;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_clip_ll;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_trim_ld;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_selion_ld;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_vcsel_selion_max_ld;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_mult_ld;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_clip_ld;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_lock_byte;
+
+
+
+
+
+	uint8_t   nvm__laser_safety_unlock_byte;
+
+
+
+
+
+	uint8_t   nvm__ews__spad_enables_rtn[VL53L1_RTN_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__ews__spad_enables_ref__loc1[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__ews__spad_enables_ref__loc2[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__ews__spad_enables_ref__loc3[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__fmt__spad_enables_rtn[VL53L1_RTN_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__fmt__spad_enables_ref__loc1[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__fmt__spad_enables_ref__loc2[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__fmt__spad_enables_ref__loc3[VL53L1_REF_SPAD_BUFFER_SIZE];
+
+
+
+
+
+	uint8_t   nvm__fmt__roi_config__mode_roi_centre_spad;
+
+
+
+
+
+	uint8_t   nvm__fmt__roi_config__mode_roi_x_size;
+
+
+
+
+
+	uint8_t   nvm__fmt__roi_config__mode_roi_y_size;
+
+
+
+
+
+	uint8_t   nvm__fmt__ref_spad_apply__num_requested_ref_spad;
+
+
+
+
+
+	uint8_t   nvm__fmt__ref_spad_man__ref_location;
+
+
+
+
+
+	uint16_t  nvm__fmt__mm_config__inner_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__fmt__mm_config__outer_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__fmt__algo_part_to_part_range_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__fmt__algo__crosstalk_compensation_plane_offset_kcps;
+
+
+
+
+
+	uint16_t  nvm__fmt__algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+
+
+
+	uint16_t  nvm__fmt__algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+
+	uint8_t   nvm__fmt__spare__host_config__nvm_config_spare_0;
+
+
+
+
+
+	uint8_t   nvm__fmt__spare__host_config__nvm_config_spare_1;
+
+
+
+
+
+	uint8_t   nvm__customer_space_programmed;
+
+
+
+
+
+	uint8_t   nvm__cust__i2c_device_address;
+
+
+
+
+
+	uint8_t   nvm__cust__ref_spad_apply__num_requested_ref_spad;
+
+
+
+
+
+	uint8_t   nvm__cust__ref_spad_man__ref_location;
+
+
+
+
+
+	uint16_t  nvm__cust__mm_config__inner_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__cust__mm_config__outer_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__cust__algo_part_to_part_range_offset_mm;
+
+
+
+
+
+	uint16_t  nvm__cust__algo__crosstalk_compensation_plane_offset_kcps;
+
+
+
+
+
+	uint16_t  nvm__cust__algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+
+
+
+	uint16_t  nvm__cust__algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+
+	uint8_t   nvm__cust__spare__host_config__nvm_config_spare_0;
+
+
+
+
+
+	uint8_t   nvm__cust__spare__host_config__nvm_config_spare_1;
+
+
+
+
+
+
+	VL53L1_optical_centre_t              fmt_optical_centre;
+	VL53L1_cal_peak_rate_map_t           fmt_peak_rate_map;
+	VL53L1_additional_offset_cal_data_t  fmt_add_offset_data;
+
+	VL53L1_decoded_nvm_fmt_range_data_t
+		fmt_range_data[VL53L1_NVM_MAX_FMT_RANGE_DATA];
+
+	VL53L1_decoded_nvm_fmt_info_t        fmt_info;
+	VL53L1_decoded_nvm_ews_info_t        ews_info;
+
+} VL53L1_decoded_nvm_data_t;
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_preset_setup.h b/drivers/input/misc/vl53L1/inc/vl53l1_preset_setup.h
new file mode 100644
index 0000000000000000000000000000000000000000..2a93fe70f3307940cef921539eba6b8697529fdf
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_preset_setup.h
@@ -0,0 +1,110 @@
+
+/******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+ ******************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+ *******************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+ *******************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones mentioned above :
+
+ *******************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+ *******************************************************************************
+ */
+
+#ifndef _VL53L1_PRESET_SETUP_H_
+#define _VL53L1_PRESET_SETUP_H_
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+/* indexes for the bare driver tuning setting API function */
+enum VL53L1_Tuning_t {
+	VL53L1_TUNING_VERSION = 0,
+	VL53L1_TUNING_PROXY_MIN,
+	VL53L1_TUNING_SINGLE_TARGET_XTALK_TARGET_DISTANCE_MM,
+	VL53L1_TUNING_SINGLE_TARGET_XTALK_SAMPLE_NUMBER,
+	VL53L1_TUNING_MIN_AMBIENT_DMAX_VALID,
+	VL53L1_TUNING_MAX_SIMPLE_OFFSET_CALIBRATION_SAMPLE_NUMBER,
+	VL53L1_TUNING_XTALK_FULL_ROI_TARGET_DISTANCE_MM,
+	VL53L1_TUNING_SIMPLE_OFFSET_CALIBRATION_REPEAT,
+
+	VL53L1_TUNING_MAX_TUNABLE_KEY
+};
+
+/* default values for the tuning settings parameters */
+#define TUNING_VERSION	0x0004
+
+#define TUNING_PROXY_MIN -30 /* min distance in mm */
+#define TUNING_SINGLE_TARGET_XTALK_TARGET_DISTANCE_MM 600
+/* Target distance in mm for single target Xtalk */
+#define TUNING_SINGLE_TARGET_XTALK_SAMPLE_NUMBER 50
+/* Number of sample used for single target Xtalk */
+#define TUNING_MIN_AMBIENT_DMAX_VALID 8
+/* Minimum ambient level to state the Dmax returned by the device is valid */
+#define TUNING_MAX_SIMPLE_OFFSET_CALIBRATION_SAMPLE_NUMBER 5
+/* Maximum loops to perform simple offset calibration */
+#define TUNING_XTALK_FULL_ROI_TARGET_DISTANCE_MM 600
+/* Target distance in mm for target Xtalk from Bins method*/
+#define TUNING_SIMPLE_OFFSET_CALIBRATION_REPEAT 3
+/* Number of loops done during the simple offset calibration*/
+
+/* the following table should actually be defined as static and shall be part
+ * of the VL53L1_StaticInit() function code
+ */
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* _VL53L1_PRESET_SETUP_H_ */
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_register_funcs.h b/drivers/input/misc/vl53L1/inc/vl53l1_register_funcs.h
new file mode 100644
index 0000000000000000000000000000000000000000..37f492699c463d723131b9a40905257e3b9dea26
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_register_funcs.h
@@ -0,0 +1,1694 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_REGISTER_FUNCS_H_
+#define _VL53L1_REGISTER_FUNCS_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_static_nvm_managed(
+	VL53L1_static_nvm_managed_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_static_nvm_managed(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_static_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_static_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_static_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_customer_nvm_managed(
+	VL53L1_customer_nvm_managed_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_customer_nvm_managed(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_customer_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_customer_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_customer_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_customer_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_customer_nvm_managed_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_static_config(
+	VL53L1_static_config_t    *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_static_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_static_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_general_config(
+	VL53L1_general_config_t   *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_general_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_general_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_general_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_general_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_timing_config(
+	VL53L1_timing_config_t    *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_timing_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_timing_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_timing_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_timing_config_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_dynamic_config(
+	VL53L1_dynamic_config_t   *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_dynamic_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_dynamic_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_dynamic_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_dynamic_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_dynamic_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_dynamic_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_system_control(
+	VL53L1_system_control_t   *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_system_control(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_system_control_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_system_control(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_control_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_system_control(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_control_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_system_results(
+	VL53L1_system_results_t   *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_system_results_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_results_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_results_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_core_results(
+	VL53L1_core_results_t     *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_core_results_t     *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_core_results_t     *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_core_results_t     *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_debug_results(
+	VL53L1_debug_results_t    *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_debug_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_debug_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_debug_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_debug_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_debug_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_debug_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_nvm_copy_data(
+	VL53L1_nvm_copy_data_t    *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_nvm_copy_data(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_nvm_copy_data_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_nvm_copy_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_nvm_copy_data_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_nvm_copy_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_nvm_copy_data_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_prev_shadow_system_results(
+	VL53L1_prev_shadow_system_results_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_prev_shadow_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_prev_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_prev_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_prev_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_prev_shadow_core_results(
+	VL53L1_prev_shadow_core_results_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_prev_shadow_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_prev_shadow_core_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_prev_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_core_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_prev_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_core_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_patch_debug(
+	VL53L1_patch_debug_t      *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_patch_debug(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_patch_debug_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_patch_debug(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_debug_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_patch_debug(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_debug_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_general_config(
+	VL53L1_gph_general_config_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_general_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_general_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_gph_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_general_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_gph_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_general_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_static_config(
+	VL53L1_gph_static_config_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_static_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_static_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_gph_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_static_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_gph_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_static_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_timing_config(
+	VL53L1_gph_timing_config_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_timing_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_timing_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_gph_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_timing_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_gph_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_timing_config_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_fw_internal(
+	VL53L1_fw_internal_t      *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_fw_internal(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_fw_internal_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_fw_internal(
+	VL53L1_DEV                 Dev,
+	VL53L1_fw_internal_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_fw_internal(
+	VL53L1_DEV                 Dev,
+	VL53L1_fw_internal_t      *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_patch_results(
+	VL53L1_patch_results_t    *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_patch_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_patch_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_patch_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_patch_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_results_t    *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_shadow_system_results(
+	VL53L1_shadow_system_results_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_shadow_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_system_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_encode_shadow_core_results(
+	VL53L1_shadow_core_results_t  *pdata,
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_i2c_decode_shadow_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_shadow_core_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_core_results_t  *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_core_results_t  *pdata);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_register_map.h b/drivers/input/misc/vl53L1/inc/vl53l1_register_map.h
new file mode 100644
index 0000000000000000000000000000000000000000..5b73b703b45396654532585ae439a587613c8326
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_register_map.h
@@ -0,0 +1,13151 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_REGISTER_MAP_H_
+#define _VL53L1_REGISTER_MAP_H_
+
+
+
+
+
+
+
+#define VL53L1_SOFT_RESET 0x0000
+
+
+
+
+
+
+
+#define VL53L1_I2C_SLAVE__DEVICE_ADDRESS 0x0001
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VHV_REF_SEL_VDDPIX 0x0002
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VHV_REF_SEL_VQUENCH 0x0003
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__REG_AVDD1V2_SEL 0x0004
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__FAST_OSC__TRIM 0x0005
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_OSC_MEASURED__FAST_OSC__FREQUENCY 0x0006
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_OSC_MEASURED__FAST_OSC__FREQUENCY_HI 0x0006
+
+
+
+
+
+
+
+#define VL53L1_OSC_MEASURED__FAST_OSC__FREQUENCY_LO 0x0007
+
+
+
+
+
+
+
+#define VL53L1_VHV_CONFIG__TIMEOUT_MACROP_LOOP_BOUND 0x0008
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_CONFIG__COUNT_THRESH 0x0009
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_CONFIG__OFFSET 0x000A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_CONFIG__INIT 0x000B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0 0x000D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_1 0x000E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_2 0x000F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_3 0x0010
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_4 0x0011
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_5 0x0012
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__REF_EN_START_SELECT 0x0013
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_MAN__NUM_REQUESTED_REF_SPADS 0x0014
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_MAN__REF_LOCATION 0x0015
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS 0x0016
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS_HI 0x0016
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS_LO 0x0017
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS 0x0018
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS_HI 0x0018
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS_LO 0x0019
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS 0x001A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS_HI 0x001A
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS_LO 0x001B
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_CHAR__TOTAL_RATE_TARGET_MCPS 0x001C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_CHAR__TOTAL_RATE_TARGET_MCPS_HI 0x001C
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_CHAR__TOTAL_RATE_TARGET_MCPS_LO 0x001D
+
+
+
+
+
+
+
+#define VL53L1_ALGO__PART_TO_PART_RANGE_OFFSET_MM 0x001E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__PART_TO_PART_RANGE_OFFSET_MM_HI 0x001E
+
+
+
+
+
+
+
+#define VL53L1_ALGO__PART_TO_PART_RANGE_OFFSET_MM_LO 0x001F
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__INNER_OFFSET_MM 0x0020
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__INNER_OFFSET_MM_HI 0x0020
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__INNER_OFFSET_MM_LO 0x0021
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__OUTER_OFFSET_MM 0x0022
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__OUTER_OFFSET_MM_HI 0x0022
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__OUTER_OFFSET_MM_LO 0x0023
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS 0x0024
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS_HI 0x0024
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS_LO 0x0025
+
+
+
+
+
+
+
+#define VL53L1_DEBUG__CTRL 0x0026
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_TEST_MODE__CTRL 0x0027
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_CLK_GATING__CTRL 0x0028
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM_BIST__CTRL 0x0029
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM_BIST__NUM_NVM_WORDS 0x002A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM_BIST__START_ADDRESS 0x002B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_HOST_IF__STATUS 0x002C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PAD_I2C_HV__CONFIG 0x002D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PAD_I2C_HV__EXTSUP_CONFIG 0x002E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO_HV_PAD__CTRL 0x002F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO_HV_MUX__CTRL 0x0030
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO__TIO_HV_STATUS 0x0031
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO__FIO_HV_STATUS 0x0032
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__SPAD_SEL_PSWIDTH 0x0033
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VCSEL_PULSE_WIDTH_OFFSET 0x0034
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__FAST_OSC__CONFIG_CTRL 0x0035
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SIGMA_ESTIMATOR__EFFECTIVE_PULSE_WIDTH_NS 0x0036
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SIGMA_ESTIMATOR__EFFECTIVE_AMBIENT_WIDTH_NS 0x0037
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SIGMA_ESTIMATOR__SIGMA_REF_MM 0x0038
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CROSSTALK_COMPENSATION_VALID_HEIGHT_MM 0x0039
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SPARE_HOST_CONFIG__STATIC_CONFIG_SPARE_0 0x003A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SPARE_HOST_CONFIG__STATIC_CONFIG_SPARE_1 0x003B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__RANGE_IGNORE_THRESHOLD_MCPS 0x003C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__RANGE_IGNORE_THRESHOLD_MCPS_HI 0x003C
+
+
+
+
+
+
+
+#define VL53L1_ALGO__RANGE_IGNORE_THRESHOLD_MCPS_LO 0x003D
+
+
+
+
+
+
+
+#define VL53L1_ALGO__RANGE_IGNORE_VALID_HEIGHT_MM 0x003E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__RANGE_MIN_CLIP 0x003F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ALGO__CONSISTENCY_CHECK__TOLERANCE 0x0040
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SPARE_HOST_CONFIG__STATIC_CONFIG_SPARE_2 0x0041
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__RESET_STAGES_MSB 0x0042
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__RESET_STAGES_LSB 0x0043
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH_CONFIG__STREAM_COUNT_UPDATE_VALUE 0x0044
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__STREAM_DIVIDER 0x0045
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERRUPT_CONFIG_GPIO 0x0046
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_CAL_CONFIG__VCSEL_START 0x0047
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_CAL_CONFIG__REPEAT_RATE 0x0048
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_CAL_CONFIG__REPEAT_RATE_HI 0x0048
+
+
+
+
+
+
+
+#define VL53L1_CAL_CONFIG__REPEAT_RATE_LO 0x0049
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__VCSEL_WIDTH 0x004A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_CONFIG__TIMEOUT_MACROP 0x004B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_CONFIG__TARGET 0x004C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_CONFIG__OVERRIDE 0x004D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__ROI_MODE_CONTROL 0x004F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_HIGH 0x0050
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_HIGH_HI 0x0050
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_HIGH_LO 0x0051
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_LOW 0x0052
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_LOW_HI 0x0052
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_RATE_LOW_LO 0x0053
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT 0x0054
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT_HI 0x0054
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT_LO 0x0055
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MANUAL_BLOCK_SELECT 0x0056
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__APERTURE_ATTENUATION 0x0057
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MAX_SPADS_LIMIT 0x0058
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CONFIG__MIN_SPADS_LIMIT 0x0059
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__TIMEOUT_MACROP_A_HI 0x005A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__TIMEOUT_MACROP_A_LO 0x005B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__TIMEOUT_MACROP_B_HI 0x005C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_CONFIG__TIMEOUT_MACROP_B_LO 0x005D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__TIMEOUT_MACROP_A_HI 0x005E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__TIMEOUT_MACROP_A_LO 0x005F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__VCSEL_PERIOD_A 0x0060
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__TIMEOUT_MACROP_B_HI 0x0061
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__TIMEOUT_MACROP_B_LO 0x0062
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__VCSEL_PERIOD_B 0x0063
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__SIGMA_THRESH 0x0064
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__SIGMA_THRESH_HI 0x0064
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__SIGMA_THRESH_LO 0x0065
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS 0x0066
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS_HI 0x0066
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS_LO 0x0067
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__VALID_PHASE_LOW 0x0068
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_CONFIG__VALID_PHASE_HIGH 0x0069
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERMEASUREMENT_PERIOD 0x006C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERMEASUREMENT_PERIOD_3 0x006C
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERMEASUREMENT_PERIOD_2 0x006D
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERMEASUREMENT_PERIOD_1 0x006E
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERMEASUREMENT_PERIOD_0 0x006F
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__FRACTIONAL_ENABLE 0x0070
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD_0 0x0071
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_HIGH 0x0072
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_HIGH_HI 0x0072
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_HIGH_LO 0x0073
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_LOW 0x0074
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_LOW_HI 0x0074
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__THRESH_LOW_LO 0x0075
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__ENABLE_XTALK_PER_QUADRANT 0x0076
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__SEED_CONFIG 0x0077
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__WOI_SD0 0x0078
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__WOI_SD1 0x0079
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__INITIAL_PHASE_SD0 0x007A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__INITIAL_PHASE_SD1 0x007B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD_1 0x007C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__FIRST_ORDER_SELECT 0x007D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SD_CONFIG__QUANTIFIER 0x007E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ROI_CONFIG__USER_ROI_CENTRE_SPAD 0x007F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ROI_CONFIG__USER_ROI_REQUESTED_GLOBAL_XY_SIZE 0x0080
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__SEQUENCE_CONFIG 0x0081
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD 0x0082
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_POWER_MANAGEMENT__GO1_POWER_FORCE 0x0083
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__STREAM_COUNT_CTRL 0x0084
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__ENABLE 0x0085
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERRUPT_CLEAR 0x0086
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__MODE_START 0x0087
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__INTERRUPT_STATUS 0x0088
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__RANGE_STATUS 0x0089
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__REPORT_STATUS 0x008A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__STREAM_COUNT 0x008B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0 0x008C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x008C
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x008D
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0 0x008E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x008E
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x008F
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0 0x0090
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_HI 0x0090
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_LO 0x0091
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD0 0x0092
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD0_HI 0x0092
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD0_LO 0x0093
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD0 0x0094
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD0_HI 0x0094
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD0_LO 0x0095
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0 0x0096
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_HI 0x0096
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_LO 0x0097
+
+
+
+
+
+
+
+#define VL53L1_PEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0 0x0098
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1__PEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_HI 0x0098
+
+
+
+
+
+
+
+#define VL53L1___PEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_LO 0x0099
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0 0x009A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x009A
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x009B
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0 0x009C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x009C
+
+
+
+
+
+
+
+#define VL53L1_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x009D
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0 0x009E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x009E
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x009F
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1 0x00A0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_HI 0x00A0
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_LO 0x00A1
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1 0x00A2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_HI 0x00A2
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_LO 0x00A3
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1 0x00A4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_HI 0x00A4
+
+
+
+
+
+
+
+#define VL53L1_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_LO 0x00A5
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD1 0x00A6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD1_HI 0x00A6
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SIGMA_SD1_LO 0x00A7
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD1 0x00A8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD1_HI 0x00A8
+
+
+
+
+
+
+
+#define VL53L1_RESULT__PHASE_SD1_LO 0x00A9
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1 0x00AA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_HI 0x00AA
+
+
+
+
+
+
+
+#define VL53L1_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_LO 0x00AB
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_0_SD1 0x00AC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_0_SD1_HI 0x00AC
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_0_SD1_LO 0x00AD
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_1_SD1 0x00AE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_1_SD1_HI 0x00AE
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_1_SD1_LO 0x00AF
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_2_SD1 0x00B0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_2_SD1_HI 0x00B0
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_2_SD1_LO 0x00B1
+
+
+
+
+
+
+
+#define VL53L1_RESULT__SPARE_3_SD1 0x00B2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__THRESH_INFO 0x00B3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0 0x00B4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_3 0x00B4
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_2 0x00B5
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_1 0x00B6
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_0 0x00B7
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0 0x00B8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_3 0x00B8
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_2 0x00B9
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_1 0x00BA
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_0 0x00BB
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0 0x00BC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_3 0x00BC
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_2 0x00BD
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_1 0x00BE
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_0 0x00BF
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0 0x00C0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_3 0x00C0
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_2 0x00C1
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_1 0x00C2
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_0 0x00C3
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1 0x00C4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_3 0x00C4
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_2 0x00C5
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_1 0x00C6
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_0 0x00C7
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1 0x00C8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_3 0x00C8
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_2 0x00C9
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_1 0x00CA
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_0 0x00CB
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1 0x00CC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_3 0x00CC
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_2 0x00CD
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_1 0x00CE
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_0 0x00CF
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1 0x00D0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_3 0x00D0
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_2 0x00D1
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_1 0x00D2
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_0 0x00D3
+
+
+
+
+
+
+
+#define VL53L1_RESULT_CORE__SPARE_0 0x00D4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__REFERENCE_PHASE 0x00D6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__REFERENCE_PHASE_HI 0x00D6
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__REFERENCE_PHASE_LO 0x00D7
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__VCSEL_START 0x00D8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_CHAR_RESULT__NUM_ACTUAL_REF_SPADS 0x00D9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_REF_SPAD_CHAR_RESULT__REF_LOCATION 0x00DA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__COLDBOOT_STATUS 0x00DB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SEARCH_RESULT 0x00DC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__LATEST_SETTING 0x00DD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__OSC_CALIBRATE_VAL 0x00DE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__OSC_CALIBRATE_VAL_HI 0x00DE
+
+
+
+
+
+
+
+#define VL53L1_RESULT__OSC_CALIBRATE_VAL_LO 0x00DF
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__POWERDOWN_GO1 0x00E0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__REF_BG_CTRL 0x00E1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__REGDVDD1V2_CTRL 0x00E2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__OSC_SLOW_CTRL 0x00E3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_TEST_MODE__STATUS 0x00E4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__SYSTEM_STATUS 0x00E5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__MODE_STATUS 0x00E6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__SECONDARY_MODE_STATUS 0x00E7
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__CAL_REPEAT_RATE_COUNTER 0x00E8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__CAL_REPEAT_RATE_COUNTER_HI 0x00E8
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__CAL_REPEAT_RATE_COUNTER_LO 0x00E9
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__HISTOGRAM_BIN 0x00EA
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_HIGH 0x00EC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_HIGH_HI 0x00EC
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_HIGH_LO 0x00ED
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_LOW 0x00EE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_LOW_HI 0x00EE
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_LOW_LO 0x00EF
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__ENABLE_XTALK_PER_QUADRANT 0x00F0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SPARE_0 0x00F1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__WOI_SD0 0x00F2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__WOI_SD1 0x00F3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__INITIAL_PHASE_SD0 0x00F4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__INITIAL_PHASE_SD1 0x00F5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__FIRST_ORDER_SELECT 0x00F6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SD_CONFIG__QUANTIFIER 0x00F7
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__ROI_CONFIG__USER_ROI_CENTRE_SPAD 0x00F8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__ROI_CONFIG__USER_ROI_REQUESTED_GLOBAL_XY_SIZE 0x00F9
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__SEQUENCE_CONFIG 0x00FA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__GPH_ID 0x00FB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SYSTEM__INTERRUPT_SET 0x00FC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_MANAGER__ENABLES 0x00FD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_MANAGER__CLEAR 0x00FE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_MANAGER__STATUS 0x00FF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_TO_HOST_BANK__WR_ACCESS_EN 0x0100
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_POWER_MANAGEMENT__GO1_RESET_STATUS 0x0101
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PAD_STARTUP_MODE__VALUE_RO 0x0102
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PAD_STARTUP_MODE__VALUE_CTRL 0x0103
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PLL_PERIOD_US 0x0104
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PLL_PERIOD_US_3 0x0104
+
+
+
+
+
+
+
+#define VL53L1_PLL_PERIOD_US_2 0x0105
+
+
+
+
+
+
+
+#define VL53L1_PLL_PERIOD_US_1 0x0106
+
+
+
+
+
+
+
+#define VL53L1_PLL_PERIOD_US_0 0x0107
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_SCHEDULER__DATA_OUT 0x0108
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_SCHEDULER__DATA_OUT_3 0x0108
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_SCHEDULER__DATA_OUT_2 0x0109
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_SCHEDULER__DATA_OUT_1 0x010A
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_SCHEDULER__DATA_OUT_0 0x010B
+
+
+
+
+
+
+
+#define VL53L1_NVM_BIST__COMPLETE 0x010C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_NVM_BIST__STATUS 0x010D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__MODEL_ID 0x010F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__MODULE_TYPE 0x0110
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__REVISION_ID 0x0111
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__MODULE_ID 0x0112
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__MODULE_ID_HI 0x0112
+
+
+
+
+
+
+
+#define VL53L1_IDENTIFICATION__MODULE_ID_LO 0x0113
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__FAST_OSC__TRIM_MAX 0x0114
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__FAST_OSC__FREQ_SET 0x0115
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VCSEL_TRIM 0x0116
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VCSEL_SELION 0x0117
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ANA_CONFIG__VCSEL_SELION_MAX 0x0118
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PROTECTED_LASER_SAFETY__LOCK_BIT 0x0119
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_LASER_SAFETY__KEY 0x011A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_LASER_SAFETY__KEY_RO 0x011B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_LASER_SAFETY__CLIP 0x011C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_LASER_SAFETY__MULT 0x011D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_0 0x011E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_1 0x011F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_2 0x0120
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_3 0x0121
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_4 0x0122
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_5 0x0123
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_6 0x0124
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_7 0x0125
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_8 0x0126
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_9 0x0127
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_10 0x0128
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_11 0x0129
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_12 0x012A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_13 0x012B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_14 0x012C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_15 0x012D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_16 0x012E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_17 0x012F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_18 0x0130
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_19 0x0131
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_20 0x0132
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_21 0x0133
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_22 0x0134
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_23 0x0135
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_24 0x0136
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_25 0x0137
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_26 0x0138
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_27 0x0139
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_28 0x013A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_29 0x013B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_30 0x013C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_RTN_31 0x013D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ROI_CONFIG__MODE_ROI_CENTRE_SPAD 0x013E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_ROI_CONFIG__MODE_ROI_XY_SIZE 0x013F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GO2_HOST_BANK_ACCESS__OVERRIDE 0x0300
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLICAND 0x0400
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLICAND_3 0x0400
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLICAND_2 0x0401
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLICAND_1 0x0402
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLICAND_0 0x0403
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLIER 0x0404
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLIER_3 0x0404
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLIER_2 0x0405
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLIER_1 0x0406
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__MULTIPLIER_0 0x0407
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_HI 0x0408
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_HI_3 0x0408
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_HI_2 0x0409
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_HI_1 0x040A
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_HI_0 0x040B
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_LO 0x040C
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_LO_3 0x040C
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_LO_2 0x040D
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_LO_1 0x040E
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__PRODUCT_LO_0 0x040F
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__START 0x0410
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_MULTIPLIER__STATUS 0x0411
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__START 0x0412
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__STATUS 0x0413
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVIDEND 0x0414
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVIDEND_3 0x0414
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVIDEND_2 0x0415
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVIDEND_1 0x0416
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVIDEND_0 0x0417
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVISOR 0x0418
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVISOR_3 0x0418
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVISOR_2 0x0419
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVISOR_1 0x041A
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__DIVISOR_0 0x041B
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__QUOTIENT 0x041C
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__QUOTIENT_3 0x041C
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__QUOTIENT_2 0x041D
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__QUOTIENT_1 0x041E
+
+
+
+
+
+
+
+#define VL53L1_MCU_UTIL_DIVIDER__QUOTIENT_0 0x041F
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__VALUE_IN 0x0420
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__VALUE_IN_3 0x0420
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__VALUE_IN_2 0x0421
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__VALUE_IN_1 0x0422
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__VALUE_IN_0 0x0423
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__VALUE_IN 0x0424
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__VALUE_IN_3 0x0424
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__VALUE_IN_2 0x0425
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__VALUE_IN_1 0x0426
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__VALUE_IN_0 0x0427
+
+
+
+
+
+
+
+#define VL53L1_TIMER0__CTRL 0x0428
+
+
+
+
+
+
+
+#define VL53L1_TIMER1__CTRL 0x0429
+
+
+
+
+
+
+
+#define VL53L1_MCU_GENERAL_PURPOSE__GP_0 0x042C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_GENERAL_PURPOSE__GP_1 0x042D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_GENERAL_PURPOSE__GP_2 0x042E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_GENERAL_PURPOSE__GP_3 0x042F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__CONFIG 0x0430
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__OFFSET_CORRECTED_RANGE 0x0432
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__OFFSET_CORRECTED_RANGE_HI 0x0432
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__OFFSET_CORRECTED_RANGE_LO 0x0433
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_4 0x0434
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_4_3 0x0434
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_4_2 0x0435
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_4_1 0x0436
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_4_0 0x0437
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_DURATION_PRE_CALC 0x0438
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_DURATION_PRE_CALC_HI 0x0438
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_DURATION_PRE_CALC_LO 0x0439
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_VCSEL_PERIOD 0x043C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_5 0x043D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_TOTAL_PERIODS 0x043E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_TOTAL_PERIODS_HI 0x043E
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_TOTAL_PERIODS_LO 0x043F
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ACCUM_PHASE 0x0440
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ACCUM_PHASE_3 0x0440
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ACCUM_PHASE_2 0x0441
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ACCUM_PHASE_1 0x0442
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ACCUM_PHASE_0 0x0443
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_SIGNAL_EVENTS 0x0444
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_SIGNAL_EVENTS_3 0x0444
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_SIGNAL_EVENTS_2 0x0445
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_SIGNAL_EVENTS_1 0x0446
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_SIGNAL_EVENTS_0 0x0447
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_AMBIENT_EVENTS 0x0448
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_AMBIENT_EVENTS_3 0x0448
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_AMBIENT_EVENTS_2 0x0449
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_AMBIENT_EVENTS_1 0x044A
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_AMBIENT_EVENTS_0 0x044B
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_6 0x044C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_6_HI 0x044C
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_6_LO 0x044D
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ADJUST_VCSEL_PERIOD 0x044E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ADJUST_VCSEL_PERIOD_HI 0x044E
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__ALGO_ADJUST_VCSEL_PERIOD_LO 0x044F
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__NUM_SPADS 0x0450
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__NUM_SPADS_HI 0x0450
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__NUM_SPADS_LO 0x0451
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PHASE_OUTPUT 0x0452
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PHASE_OUTPUT_HI 0x0452
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PHASE_OUTPUT_LO 0x0453
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__RATE_PER_SPAD_MCPS 0x0454
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__RATE_PER_SPAD_MCPS_3 0x0454
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__RATE_PER_SPAD_MCPS_2 0x0455
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__RATE_PER_SPAD_MCPS_1 0x0456
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__RATE_PER_SPAD_MCPS_0 0x0457
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_7 0x0458
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_8 0x0459
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_MCPS 0x045A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_MCPS_HI 0x045A
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_MCPS_LO 0x045B
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AVG_SIGNAL_RATE_MCPS 0x045C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AVG_SIGNAL_RATE_MCPS_HI 0x045C
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AVG_SIGNAL_RATE_MCPS_LO 0x045D
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_RATE_MCPS 0x045E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_RATE_MCPS_HI 0x045E
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__AMBIENT_RATE_MCPS_LO 0x045F
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__XTALK 0x0460
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__XTALK_HI 0x0460
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__XTALK_LO 0x0461
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__CALC_STATUS 0x0462
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__DEBUG 0x0463
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_XTALK_CORR_MCPS 0x0464
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_XTALK_CORR_MCPS_HI 0x0464
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__PEAK_SIGNAL_RATE_XTALK_CORR_MCPS_LO 0x0465
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_0 0x0468
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_1 0x0469
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_2 0x046A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_RANGE_CALC__SPARE_3 0x046B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PATCH__CTRL 0x0470
+
+
+
+
+
+
+
+#define VL53L1_PATCH__JMP_ENABLES 0x0472
+
+
+
+
+
+
+
+#define VL53L1_PATCH__JMP_ENABLES_HI 0x0472
+
+
+
+
+
+
+
+#define VL53L1_PATCH__JMP_ENABLES_LO 0x0473
+
+
+
+
+
+
+
+#define VL53L1_PATCH__DATA_ENABLES 0x0474
+
+
+
+
+
+
+
+#define VL53L1_PATCH__DATA_ENABLES_HI 0x0474
+
+
+
+
+
+
+
+#define VL53L1_PATCH__DATA_ENABLES_LO 0x0475
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_0 0x0476
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_0_HI 0x0476
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_0_LO 0x0477
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_1 0x0478
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_1_HI 0x0478
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_1_LO 0x0479
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_2 0x047A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_2_HI 0x047A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_2_LO 0x047B
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_3 0x047C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_3_HI 0x047C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_3_LO 0x047D
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_4 0x047E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_4_HI 0x047E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_4_LO 0x047F
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_5 0x0480
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_5_HI 0x0480
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_5_LO 0x0481
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_6 0x0482
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_6_HI 0x0482
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_6_LO 0x0483
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_7 0x0484
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_7_HI 0x0484
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_7_LO 0x0485
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_8 0x0486
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_8_HI 0x0486
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_8_LO 0x0487
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_9 0x0488
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_9_HI 0x0488
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_9_LO 0x0489
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_10 0x048A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_10_HI 0x048A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_10_LO 0x048B
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_11 0x048C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_11_HI 0x048C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_11_LO 0x048D
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_12 0x048E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_12_HI 0x048E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_12_LO 0x048F
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_13 0x0490
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_13_HI 0x0490
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_13_LO 0x0491
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_14 0x0492
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_14_HI 0x0492
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_14_LO 0x0493
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_15 0x0494
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_15_HI 0x0494
+
+
+
+
+
+
+
+#define VL53L1_PATCH__OFFSET_15_LO 0x0495
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_0 0x0496
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_0_HI 0x0496
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_0_LO 0x0497
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_1 0x0498
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_1_HI 0x0498
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_1_LO 0x0499
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_2 0x049A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_2_HI 0x049A
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_2_LO 0x049B
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_3 0x049C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_3_HI 0x049C
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_3_LO 0x049D
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_4 0x049E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_4_HI 0x049E
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_4_LO 0x049F
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_5 0x04A0
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_5_HI 0x04A0
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_5_LO 0x04A1
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_6 0x04A2
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_6_HI 0x04A2
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_6_LO 0x04A3
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_7 0x04A4
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_7_HI 0x04A4
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_7_LO 0x04A5
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_8 0x04A6
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_8_HI 0x04A6
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_8_LO 0x04A7
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_9 0x04A8
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_9_HI 0x04A8
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_9_LO 0x04A9
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_10 0x04AA
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_10_HI 0x04AA
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_10_LO 0x04AB
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_11 0x04AC
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_11_HI 0x04AC
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_11_LO 0x04AD
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_12 0x04AE
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_12_HI 0x04AE
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_12_LO 0x04AF
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_13 0x04B0
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_13_HI 0x04B0
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_13_LO 0x04B1
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_14 0x04B2
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_14_HI 0x04B2
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_14_LO 0x04B3
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_15 0x04B4
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_15_HI 0x04B4
+
+
+
+
+
+
+
+#define VL53L1_PATCH__ADDRESS_15_LO 0x04B5
+
+
+
+
+
+
+
+#define VL53L1_SPI_ASYNC_MUX__CTRL 0x04C0
+
+
+
+
+
+
+
+#define VL53L1_CLK__CONFIG 0x04C4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO_LV_MUX__CTRL 0x04CC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPIO_LV_PAD__CTRL 0x04CD
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PAD_I2C_LV__CONFIG 0x04D0
+
+
+
+
+
+
+
+#define VL53L1_PAD_STARTUP_MODE__VALUE_RO_GO1 0x04D4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_HOST_IF__STATUS_GO1 0x04D5
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MCU_CLK_GATING__CTRL 0x04D8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_ROM_CTRL 0x04E0
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_ROM_RESULT 0x04E1
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_ROM_MCU_SIG 0x04E2
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_ROM_MCU_SIG_HI 0x04E2
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_ROM_MCU_SIG_LO 0x04E3
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_RAM_CTRL 0x04E4
+
+
+
+
+
+
+
+#define VL53L1_TEST__BIST_RAM_RESULT 0x04E5
+
+
+
+
+
+
+
+#define VL53L1_TEST__TMC 0x04E8
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MIN_THRESHOLD 0x04F0
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MIN_THRESHOLD_HI 0x04F0
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MIN_THRESHOLD_LO 0x04F1
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MAX_THRESHOLD 0x04F2
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MAX_THRESHOLD_HI 0x04F2
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_MAX_THRESHOLD_LO 0x04F3
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_COUNT_OUT 0x04F4
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_COUNT_OUT_HI 0x04F4
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_COUNT_OUT_LO 0x04F5
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_GONOGO 0x04F6
+
+
+
+
+
+
+
+#define VL53L1_TEST__PLL_BIST_CTRL 0x04F7
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__DEVICE_ID 0x0680
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REVISION_ID 0x0681
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CLK_CTRL1 0x0683
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CLK_CTRL2 0x0684
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__WOI_1 0x0685
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__WOI_REF_1 0x0686
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__START_RANGING 0x0687
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__LOW_LIMIT_1 0x0690
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__HIGH_LIMIT_1 0x0691
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__LOW_LIMIT_REF_1 0x0692
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__HIGH_LIMIT_REF_1 0x0693
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__QUANTIFIER_1_MSB 0x0694
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__QUANTIFIER_1_LSB 0x0695
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__QUANTIFIER_REF_1_MSB 0x0696
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__QUANTIFIER_REF_1_LSB 0x0697
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_OFFSET_1_MSB 0x0698
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_OFFSET_1_LSB 0x0699
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_OFFSET_REF_1_MSB 0x069A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_OFFSET_REF_1_LSB 0x069B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FILTER_STRENGTH_1 0x069C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FILTER_STRENGTH_REF_1 0x069D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_EVENT_LIMIT_1_MSB 0x069E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_EVENT_LIMIT_1_LSB 0x069F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_EVENT_LIMIT_REF_1_MSB 0x06A0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_EVENT_LIMIT_REF_1_LSB 0x06A1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TIMEOUT_OVERALL_PERIODS_MSB 0x06A4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TIMEOUT_OVERALL_PERIODS_LSB 0x06A5
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__INVERT_HW 0x06A6
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FORCE_HW 0x06A7
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATIC_HW_VALUE 0x06A8
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FORCE_CONTINUOUS_AMBIENT 0x06A9
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TEST_PHASE_SELECT_TO_FILTER 0x06AA
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TEST_PHASE_SELECT_TO_TIMING_GEN 0x06AB
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__INITIAL_PHASE_VALUE_1 0x06AC
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__INITIAL_PHASE_VALUE_REF_1 0x06AD
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FORCE_UP_IN 0x06AE
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__FORCE_DN_IN 0x06AF
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATIC_UP_VALUE_1 0x06B0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATIC_UP_VALUE_REF_1 0x06B1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATIC_DN_VALUE_1 0x06B2
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATIC_DN_VALUE_REF_1 0x06B3
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__MONITOR_UP_DN 0x06B4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__INVERT_UP_DN 0x06B5
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CPUMP_1 0x06B6
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CPUMP_2 0x06B7
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CPUMP_3 0x06B8
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__OSC_1 0x06B9
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__PLL_1 0x06BB
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__PLL_2 0x06BC
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REFERENCE_1 0x06BD
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REFERENCE_3 0x06BF
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REFERENCE_4 0x06C0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REFERENCE_5 0x06C1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REGAVDD1V2 0x06C3
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CALIB_1 0x06C4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CALIB_2 0x06C5
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CALIB_3 0x06C6
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TST_MUX_SEL1 0x06C9
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TST_MUX_SEL2 0x06CA
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TST_MUX 0x06CB
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__GPIO_OUT_TESTMUX 0x06CC
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CUSTOM_FE 0x06CD
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CUSTOM_FE_2 0x06CE
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_READOUT 0x06CF
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_READOUT_1 0x06D0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_READOUT_2 0x06D1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_PS 0x06D2
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__LASER_SAFETY_2 0x06D4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__MODE 0x0780
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__PDN 0x0781
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__PROGN 0x0782
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__READN 0x0783
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__PULSE_WIDTH_MSB 0x0784
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__PULSE_WIDTH_LSB 0x0785
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__HV_RISE_MSB 0x0786
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__HV_RISE_LSB 0x0787
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__HV_FALL_MSB 0x0788
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__HV_FALL_LSB 0x0789
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__TST 0x078A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__TESTREAD 0x078B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAIN_MMM 0x078C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAIN_LMM 0x078D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAIN_LLM 0x078E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAIN_LLL 0x078F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_MMM 0x0790
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_LMM 0x0791
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_LLM 0x0792
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_LLL 0x0793
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__ADDR 0x0794
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_ECC 0x0795
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_0 0x0796
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_1 0x0797
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_2 0x0798
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_3 0x0799
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_4 0x079A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_5 0x079B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_6 0x079C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_7 0x079D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_8 0x079E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_9 0x079F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_10 0x07A0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_11 0x07A1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_12 0x07A2
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_13 0x07A3
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_14 0x07A4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_15 0x07A5
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_16 0x07A6
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_17 0x07A7
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_SHIFT_EN 0x07BA
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_DISABLE_CTRL 0x07BB
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_EN_SHIFT_OUT_DEBUG 0x07BC
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPI_MODE 0x07BD
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__GPIO_DIR 0x07BE
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_PERIOD 0x0880
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_START 0x0881
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_STOP 0x0882
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_1 0x0885
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_STATUS 0x088D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATUS 0x0980
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__LASER_CONTINUITY_STATE 0x0981
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_1_MMM 0x0982
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_1_LMM 0x0983
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_1_LLM 0x0984
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_1_LLL 0x0985
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_REF_1_MMM 0x0986
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_REF_1_LMM 0x0987
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_REF_1_LLM 0x0988
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGE_REF_1_LLL 0x0989
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_1_MMM 0x098A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_1_LMM 0x098B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_1_LLM 0x098C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_1_LLL 0x098D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_1_MMM 0x098E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_1_LMM 0x098F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_1_LLM 0x0990
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_1_LLL 0x0991
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_1_MMM 0x0992
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_1_LMM 0x0993
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_1_LLM 0x0994
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_1_LLL 0x0995
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_1_MM 0x0996
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_1_LM 0x0997
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_1_LL 0x0998
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_MM 0x0999
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_LM 0x099A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_LL 0x099B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_REF_1_MMM 0x099C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_REF_1_LMM 0x099D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_REF_1_LLM 0x099E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_WINDOW_EVENTS_REF_1_LLL 0x099F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_REF_1_MMM 0x09A0
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_REF_1_LMM 0x09A1
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_REF_1_LLM 0x09A2
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RANGING_TOTAL_EVENTS_REF_1_LLL 0x09A3
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_REF_1_MMM 0x09A4
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_REF_1_LMM 0x09A5
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_REF_1_LLM 0x09A6
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SIGNAL_TOTAL_EVENTS_REF_1_LLL 0x09A7
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_REF_1_MM 0x09A8
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_REF_1_LM 0x09A9
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TOTAL_PERIODS_ELAPSED_REF_1_LL 0x09AA
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_REF_MM 0x09AB
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_REF_LM 0x09AC
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__AMBIENT_MISMATCH_REF_LL 0x09AD
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__GPIO_CONFIG__A0 0x0A00
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RESET_CONTROL__A0 0x0A01
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__INTR_MANAGER__A0 0x0A02
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__POWER_FSM_TIME_OSC__A0 0x0A06
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_ATEST__A0 0x0A07
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_PERIOD_CLIPPED__A0 0x0A08
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_STOP_CLIPPED__A0 0x0A09
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CALIB_2__A0 0x0A0A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STOP_CONDITION__A0 0x0A0B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__STATUS_RESET__A0 0x0A0C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__READOUT_CFG__A0 0x0A0D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__WINDOW_SETTING__A0 0x0A0E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_DELAY__A0 0x0A1A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REFERENCE_2__A0 0x0A1B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REGAVDD1V2__A0 0x0A1D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__TST_MUX__A0 0x0A1F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CUSTOM_FE_2__A0 0x0A20
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_READOUT__A0 0x0A21
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__CPUMP_1__A0 0x0A22
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPARE_REGISTER__A0 0x0A23
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__VCSEL_CONT_STAGE5_BYPASS__A0 0x0A24
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_18 0x0A25
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_19 0x0A26
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_20 0x0A27
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_21 0x0A28
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_22 0x0A29
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_23 0x0A2A
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_24 0x0A2B
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_25 0x0A2C
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_26 0x0A2D
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_27 0x0A2E
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_28 0x0A2F
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_29 0x0A30
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_30 0x0A31
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__RET_SPAD_EN_31 0x0A32
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_0__EWOK 0x0A33
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_1__EWOK 0x0A34
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_2__EWOK 0x0A35
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_3__EWOK 0x0A36
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_4__EWOK 0x0A37
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_SPAD_EN_5__EWOK 0x0A38
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REF_EN_START_SELECT 0x0A39
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__REGDVDD1V2_ATEST__EWOK 0x0A41
+
+
+
+
+
+
+
+#define VL53L1_SOFT_RESET_GO1 0x0B00
+
+
+
+
+
+
+
+#define VL53L1_PRIVATE__PATCH_BASE_ADDR_RSLV 0x0E00
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__INTERRUPT_STATUS 0x0ED0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__RANGE_STATUS 0x0ED1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__REPORT_STATUS 0x0ED2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__STREAM_COUNT 0x0ED3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0 0x0ED4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0ED4
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0ED5
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0 0x0ED6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x0ED6
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x0ED7
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0 0x0ED8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_HI 0x0ED8
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_LO 0x0ED9
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD0 0x0EDA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD0_HI 0x0EDA
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD0_LO 0x0EDB
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD0 0x0EDC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD0_HI 0x0EDC
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD0_LO 0x0EDD
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0 0x0EDE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_HI 0x0EDE
+
+
+
+
+
+
+
+#define VL53L1_PREV__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_LO 0x0EDF
+
+
+
+
+
+
+
+#define VL53L1_PREV__PEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0 0x0EE0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PPEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_HI 0x0EE0
+
+
+
+
+
+
+
+#define VL53L1_PPEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_LO 0x0EE1
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0 0x0EE2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0EE2
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0EE3
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0 0x0EE4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0EE4
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0EE5
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0 0x0EE6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x0EE6
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x0EE7
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1 0x0EE8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_HI 0x0EE8
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_LO 0x0EE9
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1 0x0EEA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_HI 0x0EEA
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_LO 0x0EEB
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1 0x0EEC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_HI 0x0EEC
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_LO 0x0EED
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD1 0x0EEE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD1_HI 0x0EEE
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SIGMA_SD1_LO 0x0EEF
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD1 0x0EF0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD1_HI 0x0EF0
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__PHASE_SD1_LO 0x0EF1
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1 0x0EF2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PFINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_HI 0x0EF2
+
+
+
+
+
+
+
+#define VL53L1_PFINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_LO 0x0EF3
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_0_SD1 0x0EF4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_0_SD1_HI 0x0EF4
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_0_SD1_LO 0x0EF5
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_1_SD1 0x0EF6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_1_SD1_HI 0x0EF6
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_1_SD1_LO 0x0EF7
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_2_SD1 0x0EF8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_2_SD1_HI 0x0EF8
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_2_SD1_LO 0x0EF9
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_3_SD1 0x0EFA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_3_SD1_HI 0x0EFA
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT__SPARE_3_SD1_LO 0x0EFB
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0 0x0EFC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_3 0x0EFC
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_2 0x0EFD
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_1 0x0EFE
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_0 0x0EFF
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0 0x0F00
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_3 0x0F00
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_2 0x0F01
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_1 0x0F02
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_0 0x0F03
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0 0x0F04
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_3 0x0F04
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_2 0x0F05
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_1 0x0F06
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_0 0x0F07
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0 0x0F08
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_3 0x0F08
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_2 0x0F09
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_1 0x0F0A
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_0 0x0F0B
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1 0x0F0C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_3 0x0F0C
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_2 0x0F0D
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_1 0x0F0E
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_0 0x0F0F
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1 0x0F10
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_3 0x0F10
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_2 0x0F11
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_1 0x0F12
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_0 0x0F13
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1 0x0F14
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_3 0x0F14
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_2 0x0F15
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_1 0x0F16
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_0 0x0F17
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1 0x0F18
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_3 0x0F18
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_2 0x0F19
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_1 0x0F1A
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_0 0x0F1B
+
+
+
+
+
+
+
+#define VL53L1_PREV_SHADOW_RESULT_CORE__SPARE_0 0x0F1C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DEBUG_STATUS 0x0F20
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RESULT__DEBUG_STAGE 0x0F21
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH 0x0F24
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH_HI 0x0F24
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH_LO 0x0F25
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_LOW 0x0F26
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_LOW_HI 0x0F26
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__THRESH_RATE_LOW_LO 0x0F27
+
+
+
+
+
+
+
+#define VL53L1_GPH__SYSTEM__INTERRUPT_CONFIG_GPIO 0x0F28
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__ROI_MODE_CONTROL 0x0F2F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT 0x0F30
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT_HI 0x0F30
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MANUAL_EFFECTIVE_SPADS_SELECT_LO 0x0F31
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MANUAL_BLOCK_SELECT 0x0F32
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MAX_SPADS_LIMIT 0x0F33
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__DSS_CONFIG__MIN_SPADS_LIMIT 0x0F34
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_A_HI 0x0F36
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_A_LO 0x0F37
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_B_HI 0x0F38
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_B_LO 0x0F39
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__TIMEOUT_MACROP_A_HI 0x0F3A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__TIMEOUT_MACROP_A_LO 0x0F3B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__VCSEL_PERIOD_A 0x0F3C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__VCSEL_PERIOD_B 0x0F3D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__TIMEOUT_MACROP_B_HI 0x0F3E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__TIMEOUT_MACROP_B_LO 0x0F3F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__SIGMA_THRESH 0x0F40
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__SIGMA_THRESH_HI 0x0F40
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__SIGMA_THRESH_LO 0x0F41
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS 0x0F42
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS_HI 0x0F42
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS_LO 0x0F43
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__VALID_PHASE_LOW 0x0F44
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_GPH__RANGE_CONFIG__VALID_PHASE_HIGH 0x0F45
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__INTERNAL_STREAM_COUNT_DIV 0x0F46
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_FIRMWARE__INTERNAL_STREAM_COUNTER_VAL 0x0F47
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__ROI_CTRL 0x0F54
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_1 0x0F55
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_2 0x0F56
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_3 0x0F57
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_4 0x0F58
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_5 0x0F59
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_6 0x0F5A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__SPARE_7 0x0F5B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_0 0x0F5C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_1 0x0F5D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_2 0x0F5E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_3 0x0F5F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_4 0x0F60
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_5 0x0F61
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_6 0x0F62
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_7 0x0F63
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_8 0x0F64
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_9 0x0F65
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_10 0x0F66
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_11 0x0F67
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_12 0x0F68
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_13 0x0F69
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_14 0x0F6A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_15 0x0F6B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_16 0x0F6C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_17 0x0F6D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_18 0x0F6E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_19 0x0F6F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_20 0x0F70
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_21 0x0F71
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_22 0x0F72
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_23 0x0F73
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_24 0x0F74
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_25 0x0F75
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_26 0x0F76
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_27 0x0F77
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_28 0x0F78
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_29 0x0F79
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_30 0x0F7A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_SPAD_EN_31 0x0F7B
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_0 0x0F7C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__USER_ROI_1 0x0F7D
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__MODE_ROI_0 0x0F7E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_CALC__MODE_ROI_1 0x0F7F
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SIGMA_ESTIMATOR_CALC__SPARE_0 0x0F80
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__PEAK_SIGNAL_RATE_MCPS 0x0F82
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__PEAK_SIGNAL_RATE_MCPS_HI 0x0F82
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__PEAK_SIGNAL_RATE_MCPS_LO 0x0F83
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SIGNAL_TOTAL_EVENTS_REF 0x0F84
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SIGNAL_TOTAL_EVENTS_REF_3 0x0F84
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SIGNAL_TOTAL_EVENTS_REF_2 0x0F85
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SIGNAL_TOTAL_EVENTS_REF_1 0x0F86
+
+
+
+
+
+
+
+#define VL53L1_VHV_RESULT__SIGNAL_TOTAL_EVENTS_REF_0 0x0F87
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__PHASE_OUTPUT_REF 0x0F88
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__PHASE_OUTPUT_REF_HI 0x0F88
+
+
+
+
+
+
+
+#define VL53L1_PHASECAL_RESULT__PHASE_OUTPUT_REF_LO 0x0F89
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__TOTAL_RATE_PER_SPAD 0x0F8A
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__TOTAL_RATE_PER_SPAD_HI 0x0F8A
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__TOTAL_RATE_PER_SPAD_LO 0x0F8B
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__ENABLED_BLOCKS 0x0F8C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__NUM_REQUESTED_SPADS 0x0F8E
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__NUM_REQUESTED_SPADS_HI 0x0F8E
+
+
+
+
+
+
+
+#define VL53L1_DSS_RESULT__NUM_REQUESTED_SPADS_LO 0x0F8F
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__INNER_INTERSECTION_RATE 0x0F92
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__INNER_INTERSECTION_RATE_HI 0x0F92
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__INNER_INTERSECTION_RATE_LO 0x0F93
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__OUTER_COMPLEMENT_RATE 0x0F94
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__OUTER_COMPLEMENT_RATE_HI 0x0F94
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__OUTER_COMPLEMENT_RATE_LO 0x0F95
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__TOTAL_OFFSET 0x0F96
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__TOTAL_OFFSET_HI 0x0F96
+
+
+
+
+
+
+
+#define VL53L1_MM_RESULT__TOTAL_OFFSET_LO 0x0F97
+
+
+
+
+
+
+
+#define VL53L1_XTALK_CALC__XTALK_FOR_ENABLED_SPADS 0x0F98
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_XTALK_CALC__XTALK_FOR_ENABLED_SPADS_3 0x0F98
+
+
+
+
+
+
+
+#define VL53L1_XTALK_CALC__XTALK_FOR_ENABLED_SPADS_2 0x0F99
+
+
+
+
+
+
+
+#define VL53L1_XTALK_CALC__XTALK_FOR_ENABLED_SPADS_1 0x0F9A
+
+
+
+
+
+
+
+#define VL53L1_XTALK_CALC__XTALK_FOR_ENABLED_SPADS_0 0x0F9B
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_USER_ROI_KCPS 0x0F9C
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_USER_ROI_KCPS_3 0x0F9C
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_USER_ROI_KCPS_2 0x0F9D
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_USER_ROI_KCPS_1 0x0F9E
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_USER_ROI_KCPS_0 0x0F9F
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_INNER_ROI_KCPS 0x0FA0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_INNER_ROI_KCPS_3 0x0FA0
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_INNER_ROI_KCPS_2 0x0FA1
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_INNER_ROI_KCPS_1 0x0FA2
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_INNER_ROI_KCPS_0 0x0FA3
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_OUTER_ROI_KCPS 0x0FA4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_OUTER_ROI_KCPS_3 0x0FA4
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_OUTER_ROI_KCPS_2 0x0FA5
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_OUTER_ROI_KCPS_1 0x0FA6
+
+
+
+
+
+
+
+#define VL53L1_XTALK_RESULT__AVG_XTALK_MM_OUTER_ROI_KCPS_0 0x0FA7
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__ACCUM_PHASE 0x0FA8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__ACCUM_PHASE_3 0x0FA8
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__ACCUM_PHASE_2 0x0FA9
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__ACCUM_PHASE_1 0x0FAA
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__ACCUM_PHASE_0 0x0FAB
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__OFFSET_CORRECTED_RANGE 0x0FAC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__OFFSET_CORRECTED_RANGE_HI 0x0FAC
+
+
+
+
+
+
+
+#define VL53L1_RANGE_RESULT__OFFSET_CORRECTED_RANGE_LO 0x0FAD
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_PHASECAL_RESULT__VCSEL_START 0x0FAE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__INTERRUPT_STATUS 0x0FB0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__RANGE_STATUS 0x0FB1
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__REPORT_STATUS 0x0FB2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__STREAM_COUNT 0x0FB3
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0 0x0FB4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0FB4
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0FB5
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0 0x0FB6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x0FB6
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x0FB7
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0 0x0FB8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_HI 0x0FB8
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD0_LO 0x0FB9
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD0 0x0FBA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD0_HI 0x0FBA
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD0_LO 0x0FBB
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD0 0x0FBC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD0_HI 0x0FBC
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD0_LO 0x0FBD
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0 0x0FBE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_HI 0x0FBE
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD0_LO 0x0FBF
+
+
+
+
+
+
+
+#define VL53L1_SHPEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0 0x0FC0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHPEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_HI 0x0FC0
+
+
+
+
+
+
+
+#define VL53L1_SHPEAK_SIGNAL_COUNT_RATE_CROSSTALK_CORRECTED_MCPS_SD0_LO 0x0FC1
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0 0x0FC2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0FC2
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_INNER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0FC3
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0 0x0FC4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_HI 0x0FC4
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__MM_OUTER_ACTUAL_EFFECTIVE_SPADS_SD0_LO 0x0FC5
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0 0x0FC6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_HI 0x0FC6
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AVG_SIGNAL_COUNT_RATE_MCPS_SD0_LO 0x0FC7
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1 0x0FC8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_HI 0x0FC8
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__DSS_ACTUAL_EFFECTIVE_SPADS_SD1_LO 0x0FC9
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1 0x0FCA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_HI 0x0FCA
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PEAK_SIGNAL_COUNT_RATE_MCPS_SD1_LO 0x0FCB
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1 0x0FCC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_HI 0x0FCC
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__AMBIENT_COUNT_RATE_MCPS_SD1_LO 0x0FCD
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD1 0x0FCE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD1_HI 0x0FCE
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SIGMA_SD1_LO 0x0FCF
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD1 0x0FD0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD1_HI 0x0FD0
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__PHASE_SD1_LO 0x0FD1
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1 0x0FD2
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_HI 0x0FD2
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__FINAL_CROSSTALK_CORRECTED_RANGE_MM_SD1_LO 0x0FD3
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_0_SD1 0x0FD4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_0_SD1_HI 0x0FD4
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_0_SD1_LO 0x0FD5
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_1_SD1 0x0FD6
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_1_SD1_HI 0x0FD6
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_1_SD1_LO 0x0FD7
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_2_SD1 0x0FD8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_2_SD1_HI 0x0FD8
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_2_SD1_LO 0x0FD9
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__SPARE_3_SD1 0x0FDA
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT__THRESH_INFO 0x0FDB
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0 0x0FDC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_3 0x0FDC
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_2 0x0FDD
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_1 0x0FDE
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0_0 0x0FDF
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0 0x0FE0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_3 0x0FE0
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_2 0x0FE1
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_1 0x0FE2
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD0_0 0x0FE3
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0 0x0FE4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_3 0x0FE4
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_2 0x0FE5
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_1 0x0FE6
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD0_0 0x0FE7
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0 0x0FE8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_3 0x0FE8
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_2 0x0FE9
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_1 0x0FEA
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD0_0 0x0FEB
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1 0x0FEC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_3 0x0FEC
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_2 0x0FED
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_1 0x0FEE
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD1_0 0x0FEF
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1 0x0FF0
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_3 0x0FF0
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_2 0x0FF1
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_1 0x0FF2
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__RANGING_TOTAL_EVENTS_SD1_0 0x0FF3
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1 0x0FF4
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_3 0x0FF4
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_2 0x0FF5
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_1 0x0FF6
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SIGNAL_TOTAL_EVENTS_SD1_0 0x0FF7
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1 0x0FF8
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_3 0x0FF8
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_2 0x0FF9
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_1 0x0FFA
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__TOTAL_PERIODS_ELAPSED_SD1_0 0x0FFB
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_RESULT_CORE__SPARE_0 0x0FFC
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_PHASECAL_RESULT__REFERENCE_PHASE_HI 0x0FFE
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_SHADOW_PHASECAL_RESULT__REFERENCE_PHASE_LO 0x0FFF
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_register_settings.h b/drivers/input/misc/vl53L1/inc/vl53l1_register_settings.h
new file mode 100644
index 0000000000000000000000000000000000000000..767367f08217b81e7995e412be78433a5cd1d68c
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_register_settings.h
@@ -0,0 +1,274 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_REGISTER_SETTINGS_H_
+#define _VL53L1_REGISTER_SETTINGS_H_
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO  0x00
+#define VL53L1_DEVICESCHEDULERMODE_STREAMING    0x01
+#define VL53L1_DEVICESCHEDULERMODE_HISTOGRAM    0x02
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DEVICEREADOUTMODE_SINGLE_SD        (0x00 << 2)
+#define VL53L1_DEVICEREADOUTMODE_DUAL_SD          (0x01 << 2)
+#define VL53L1_DEVICEREADOUTMODE_SPLIT_READOUT    (0x02 << 2)
+#define VL53L1_DEVICEREADOUTMODE_SPLIT_MANUAL     (0x03 << 2)
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_DEVICEMEASUREMENTMODE_MODE_MASK          0xF0
+#define VL53L1_DEVICEMEASUREMENTMODE_STOP_MASK          0x0F
+
+#define VL53L1_GROUPEDPARAMETERHOLD_ID_MASK             0x02
+
+
+
+
+#define VL53L1_EWOK_I2C_DEV_ADDR_DEFAULT                0x29
+
+
+#define VL53L1_OSC_FREQUENCY                            0x00
+#define VL53L1_OSC_TRIM_DEFAULT                         0x00
+#define VL53L1_OSC_FREQ_SET_DEFAULT                     0x00
+
+#define VL53L1_RANGE_HISTOGRAM_REF                      0x08
+#define VL53L1_RANGE_HISTOGRAM_RET                      0x10
+#define VL53L1_RANGE_HISTOGRAM_BOTH                     0x18
+#define VL53L1_RANGE_HISTOGRAM_INIT                     0x20
+#define VL53L1_RANGE_VHV_INIT                           0x40
+
+
+
+#define VL53L1_RESULT_RANGE_STATUS                      0x1F
+
+
+
+#define VL53L1_SYSTEM__SEED_CONFIG__MANUAL              0x00
+#define VL53L1_SYSTEM__SEED_CONFIG__STANDARD            0x01
+#define VL53L1_SYSTEM__SEED_CONFIG__EVEN_UPDATE_ONLY    0x02
+
+
+
+#define VL53L1_INTERRUPT_CONFIG_LEVEL_LOW               0x00
+#define VL53L1_INTERRUPT_CONFIG_LEVEL_HIGH              0x01
+#define VL53L1_INTERRUPT_CONFIG_OUT_OF_WINDOW           0x02
+#define VL53L1_INTERRUPT_CONFIG_IN_WINDOW               0x03
+#define VL53L1_INTERRUPT_CONFIG_NEW_SAMPLE_READY        0x20
+
+
+
+#define VL53L1_CLEAR_RANGE_INT                          0x01
+#define VL53L1_CLEAR_ERROR_INT                          0x02
+
+
+
+#define VL53L1_SEQUENCE_VHV_EN						    0x01
+#define VL53L1_SEQUENCE_PHASECAL_EN                     0x02
+#define VL53L1_SEQUENCE_REFERENCE_PHASE_EN              0x04
+#define VL53L1_SEQUENCE_DSS1_EN                         0x08
+#define VL53L1_SEQUENCE_DSS2_EN                         0x10
+#define VL53L1_SEQUENCE_MM1_EN                          0x20
+#define VL53L1_SEQUENCE_MM2_EN                          0x40
+#define VL53L1_SEQUENCE_RANGE_EN                        0x80
+
+
+
+#define VL53L1_DSS_CONTROL__ROI_SUBTRACT                0x20
+#define VL53L1_DSS_CONTROL__ROI_INTERSECT               0x10
+
+#define VL53L1_DSS_CONTROL__MODE_DISABLED               0x00
+#define VL53L1_DSS_CONTROL__MODE_TARGET_RATE            0x01
+#define VL53L1_DSS_CONTROL__MODE_EFFSPADS               0x02
+#define VL53L1_DSS_CONTROL__MODE_BLOCKSELECT            0x03
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGING_CORE__SPAD_READOUT__STANDARD              0x45
+#define VL53L1_RANGING_CORE__SPAD_READOUT__RETURN_ARRAY_ONLY     0x05
+#define VL53L1_RANGING_CORE__SPAD_READOUT__REFERENCE_ARRAY_ONLY  0x55
+#define VL53L1_RANGING_CORE__SPAD_READOUT__RETURN_SPLIT_ARRAY    0x25
+#define VL53L1_RANGING_CORE__SPAD_READOUT__CALIB_PULSES          0xF5
+
+
+#define VL53L1_LASER_SAFETY__KEY_VALUE                  0x6C
+
+
+
+
+
+
+
+
+
+
+#define VL53L1_RANGE_STATUS__RANGE_STATUS_MASK          0x1F
+#define VL53L1_RANGE_STATUS__MAX_THRESHOLD_HIT_MASK     0x20
+#define VL53L1_RANGE_STATUS__MIN_THRESHOLD_HIT_MASK     0x40
+#define VL53L1_RANGE_STATUS__GPH_ID_RANGE_STATUS_MASK   0x80
+
+
+
+
+
+
+
+
+
+#define VL53L1_INTERRUPT_STATUS__INT_STATUS_MASK            0x07
+#define VL53L1_INTERRUPT_STATUS__INT_ERROR_STATUS_MASK      0x18
+#define VL53L1_INTERRUPT_STATUS__GPH_ID_INT_STATUS_MASK     0x20
+
+
+
+
+
+#endif
+
+
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_register_structs.h b/drivers/input/misc/vl53L1/inc/vl53l1_register_structs.h
new file mode 100644
index 0000000000000000000000000000000000000000..c5d70adf68f20d41573eb59ec730a4fc02f09731
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_register_structs.h
@@ -0,0 +1,4872 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_REGISTER_STRUCTS_H_
+#define _VL53L1_REGISTER_STRUCTS_H_
+
+#include "vl53l1_types.h"
+#include "vl53l1_register_map.h"
+
+#define VL53L1_STATIC_NVM_MANAGED_I2C_INDEX             \
+	VL53L1_I2C_SLAVE__DEVICE_ADDRESS
+#define VL53L1_CUSTOMER_NVM_MANAGED_I2C_INDEX           \
+	VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0
+#define VL53L1_STATIC_CONFIG_I2C_INDEX                  \
+	VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS
+#define VL53L1_GENERAL_CONFIG_I2C_INDEX                  \
+	VL53L1_GPH_CONFIG__STREAM_COUNT_UPDATE_VALUE
+#define VL53L1_TIMING_CONFIG_I2C_INDEX                  \
+	VL53L1_MM_CONFIG__TIMEOUT_MACROP_A_HI
+#define VL53L1_DYNAMIC_CONFIG_I2C_INDEX                 \
+	VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD_0
+#define VL53L1_SYSTEM_CONTROL_I2C_INDEX                 \
+	VL53L1_POWER_MANAGEMENT__GO1_POWER_FORCE
+#define VL53L1_SYSTEM_RESULTS_I2C_INDEX                 \
+	VL53L1_RESULT__INTERRUPT_STATUS
+#define VL53L1_CORE_RESULTS_I2C_INDEX                   \
+	VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0
+#define VL53L1_DEBUG_RESULTS_I2C_INDEX                  \
+	VL53L1_PHASECAL_RESULT__REFERENCE_PHASE
+#define VL53L1_NVM_COPY_DATA_I2C_INDEX                 \
+	VL53L1_IDENTIFICATION__MODEL_ID
+#define VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_INDEX    \
+	VL53L1_PREV_SHADOW_RESULT__INTERRUPT_STATUS
+#define VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_INDEX      \
+	VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0
+#define VL53L1_PATCH_DEBUG_I2C_INDEX                   \
+	VL53L1_RESULT__DEBUG_STATUS
+#define VL53L1_GPH_GENERAL_CONFIG_I2C_INDEX            \
+	VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH
+#define VL53L1_GPH_STATIC_CONFIG_I2C_INDEX             \
+	VL53L1_GPH__DSS_CONFIG__ROI_MODE_CONTROL
+#define VL53L1_GPH_TIMING_CONFIG_I2C_INDEX             \
+	VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_A_HI
+#define VL53L1_FW_INTERNAL_I2C_INDEX                   \
+	VL53L1_FIRMWARE__INTERNAL_STREAM_COUNT_DIV
+#define VL53L1_PATCH_RESULTS_I2C_INDEX                 \
+	VL53L1_DSS_CALC__ROI_CTRL
+#define VL53L1_SHADOW_SYSTEM_RESULTS_I2C_INDEX         \
+	VL53L1_SHADOW_PHASECAL_RESULT__VCSEL_START
+#define VL53L1_SHADOW_CORE_RESULTS_I2C_INDEX           \
+	VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0
+
+#define VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES           11
+#define VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES         23
+#define VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES                32
+#define VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES               22
+#define VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES                23
+#define VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES               18
+#define VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES                5
+#define VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES               44
+#define VL53L1_CORE_RESULTS_I2C_SIZE_BYTES                 33
+#define VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES                56
+#define VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES                49
+#define VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES   44
+#define VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES     33
+#define VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES                   2
+#define VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES            5
+#define VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES             6
+#define VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES            16
+#define VL53L1_FW_INTERNAL_I2C_SIZE_BYTES                   2
+#define VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES                90
+#define VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES        82
+#define VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES          33
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   i2c_slave__device_address;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vhv_ref_sel_vddpix;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vhv_ref_sel_vquench;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__reg_avdd1v2_sel;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__fast_osc__trim;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  osc_measured__fast_osc__frequency;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_config__timeout_macrop_loop_bound;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_config__count_thresh;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_config__offset;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_config__init;
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_static_nvm_managed_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   global_config__spad_enables_ref_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_ref_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_ref_2;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_ref_3;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_ref_4;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_ref_5;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__ref_en_start_select;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ref_spad_man__num_requested_ref_spads;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ref_spad_man__ref_location;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  algo__crosstalk_compensation_plane_offset_kcps;
+
+
+
+
+
+
+
+
+
+
+	int16_t   algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+
+
+
+
+
+
+
+
+
+	int16_t   algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  ref_spad_char__total_rate_target_mcps;
+
+
+
+
+
+
+
+
+
+
+	int16_t   algo__part_to_part_range_offset_mm;
+
+
+
+
+
+
+
+
+
+
+	int16_t   mm_config__inner_offset_mm;
+
+
+
+
+
+
+
+
+
+
+	int16_t   mm_config__outer_offset_mm;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_customer_nvm_managed_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint16_t  dss_config__target_total_rate_mcps;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   debug__ctrl;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   test_mode__ctrl;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   clk_gating__ctrl;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   nvm_bist__ctrl;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   nvm_bist__num_nvm_words;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   nvm_bist__start_address;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   host_if__status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   pad_i2c_hv__config;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   pad_i2c_hv__extsup_config;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gpio_hv_pad__ctrl;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gpio_hv_mux__ctrl;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gpio__tio_hv_status;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gpio__fio_hv_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__spad_sel_pswidth;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vcsel_pulse_width_offset;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__fast_osc__config_ctrl;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sigma_estimator__effective_pulse_width_ns;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sigma_estimator__effective_ambient_width_ns;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sigma_estimator__sigma_ref_mm;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   algo__crosstalk_compensation_valid_height_mm;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   spare_host_config__static_config_spare_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   spare_host_config__static_config_spare_1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  algo__range_ignore_threshold_mcps;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   algo__range_ignore_valid_height_mm;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   algo__range_min_clip;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   algo__consistency_check__tolerance;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   spare_host_config__static_config_spare_2;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__reset_stages_msb;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__reset_stages_lsb;
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_static_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   gph_config__stream_count_update_value;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__stream_divider;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__interrupt_config_gpio;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   cal_config__vcsel_start;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  cal_config__repeat_rate;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__vcsel_width;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   phasecal_config__timeout_macrop;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   phasecal_config__target;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   phasecal_config__override;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_config__roi_mode_control;
+
+
+
+
+
+
+
+
+
+
+
+	uint16_t  system__thresh_rate_high;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  system__thresh_rate_low;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  dss_config__manual_effective_spads_select;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_config__manual_block_select;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_config__aperture_attenuation;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_config__max_spads_limit;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_config__min_spads_limit;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_general_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   mm_config__timeout_macrop_a_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   mm_config__timeout_macrop_a_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   mm_config__timeout_macrop_b_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   mm_config__timeout_macrop_b_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__timeout_macrop_a_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__timeout_macrop_a_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__vcsel_period_a;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__timeout_macrop_b_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__timeout_macrop_b_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__vcsel_period_b;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  range_config__sigma_thresh;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  range_config__min_count_rate_rtn_limit_mcps;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__valid_phase_low;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   range_config__valid_phase_high;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  system__intermeasurement_period;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__fractional_enable;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_timing_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   system__grouped_parameter_hold_0;
+
+
+
+
+
+
+
+
+
+
+
+	uint16_t  system__thresh_high;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  system__thresh_low;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__enable_xtalk_per_quadrant;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__seed_config;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__woi_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__woi_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__initial_phase_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__initial_phase_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__grouped_parameter_hold_1;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__first_order_select;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sd_config__quantifier;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   roi_config__user_roi_centre_spad;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   roi_config__user_roi_requested_global_xy_size;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__sequence_config;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__grouped_parameter_hold;
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_dynamic_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   power_management__go1_power_force;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__stream_count_ctrl;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   firmware__enable;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__interrupt_clear;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__mode_start;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_system_control_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   result__interrupt_status;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__range_status;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__report_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__stream_count;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__dss_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__peak_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__ambient_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__sigma_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__phase_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__final_crosstalk_corrected_range_mm_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__mm_inner_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__mm_outer_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__avg_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__dss_actual_effective_spads_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__peak_signal_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__ambient_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__sigma_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__phase_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__final_crosstalk_corrected_range_mm_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__spare_0_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__spare_1_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__spare_2_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__spare_3_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__thresh_info;
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_system_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint32_t  result_core__ambient_window_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  result_core__ranging_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	int32_t   result_core__signal_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  result_core__total_periods_elapsed_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  result_core__ambient_window_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  result_core__ranging_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	int32_t   result_core__signal_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  result_core__total_periods_elapsed_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result_core__spare_0;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_core_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint16_t  phasecal_result__reference_phase;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   phasecal_result__vcsel_start;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ref_spad_char_result__num_actual_ref_spads;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ref_spad_char_result__ref_location;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_result__coldboot_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_result__search_result;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   vhv_result__latest_setting;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  result__osc_calibrate_val;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__powerdown_go1;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__ref_bg_ctrl;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__regdvdd1v2_ctrl;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__osc_slow_ctrl;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   test_mode__status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   firmware__system_status;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   firmware__mode_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   firmware__secondary_mode_status;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  firmware__cal_repeat_rate_counter;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__system__thresh_high;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__system__thresh_low;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__system__enable_xtalk_per_quadrant;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__spare_0;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__woi_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__woi_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__initial_phase_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__initial_phase_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__first_order_select;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__sd_config__quantifier;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__roi_config__user_roi_centre_spad;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__roi_config__user_roi_requested_global_xy_size;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__system__sequence_config;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__gph_id;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   system__interrupt_set;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   interrupt_manager__enables;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   interrupt_manager__clear;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   interrupt_manager__status;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   mcu_to_host_bank__wr_access_en;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   power_management__go1_reset_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   pad_startup_mode__value_ro;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   pad_startup_mode__value_ctrl;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint32_t  pll_period_us;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  interrupt_scheduler__data_out;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   nvm_bist__complete;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   nvm_bist__status;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_debug_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   identification__model_id;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   identification__module_type;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   identification__revision_id;
+
+
+
+
+
+
+
+
+
+
+
+	uint16_t  identification__module_id;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__fast_osc__trim_max;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__fast_osc__freq_set;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vcsel_trim;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vcsel_selion;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   ana_config__vcsel_selion_max;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   protected_laser_safety__lock_bit;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   laser_safety__key;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   laser_safety__key_ro;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   laser_safety__clip;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   laser_safety__mult;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_2;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_3;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_4;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_5;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_6;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_7;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_8;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_9;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_10;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_11;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_12;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_13;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_14;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_15;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_16;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_17;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_18;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_19;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_20;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_21;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_22;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_23;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_24;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_25;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_26;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_27;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_28;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_29;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_30;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   global_config__spad_enables_rtn_31;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   roi_config__mode_roi_centre_spad;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   roi_config__mode_roi_xy_size;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_nvm_copy_data_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   prev_shadow_result__interrupt_status;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   prev_shadow_result__range_status;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   prev_shadow_result__report_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   prev_shadow_result__stream_count;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__dss_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__peak_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__ambient_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__sigma_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__phase_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__final_crosstalk_corrected_range_mm_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t
+	psr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__mm_inner_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__mm_outer_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__avg_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__dss_actual_effective_spads_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__peak_signal_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__ambient_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__sigma_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__phase_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__final_crosstalk_corrected_range_mm_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__spare_0_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__spare_1_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__spare_2_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  prev_shadow_result__spare_3_sd1;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_prev_shadow_system_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint32_t  prev_shadow_result_core__ambient_window_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  prev_shadow_result_core__ranging_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	int32_t   prev_shadow_result_core__signal_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  prev_shadow_result_core__total_periods_elapsed_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  prev_shadow_result_core__ambient_window_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  prev_shadow_result_core__ranging_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	int32_t   prev_shadow_result_core__signal_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  prev_shadow_result_core__total_periods_elapsed_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   prev_shadow_result_core__spare_0;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_prev_shadow_core_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   result__debug_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   result__debug_stage;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_patch_debug_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint16_t  gph__system__thresh_rate_high;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__system__thresh_rate_low;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__system__interrupt_config_gpio;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+} VL53L1_gph_general_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   gph__dss_config__roi_mode_control;
+
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__dss_config__manual_effective_spads_select;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__dss_config__manual_block_select;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__dss_config__max_spads_limit;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__dss_config__min_spads_limit;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_gph_static_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   gph__mm_config__timeout_macrop_a_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__mm_config__timeout_macrop_a_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__mm_config__timeout_macrop_b_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__mm_config__timeout_macrop_b_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__timeout_macrop_a_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__timeout_macrop_a_lo;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__vcsel_period_a;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__vcsel_period_b;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__timeout_macrop_b_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__timeout_macrop_b_lo;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__range_config__sigma_thresh;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  gph__range_config__min_count_rate_rtn_limit_mcps;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__valid_phase_low;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   gph__range_config__valid_phase_high;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_gph_timing_config_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   firmware__internal_stream_count_div;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   firmware__internal_stream_counter_val;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_fw_internal_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   dss_calc__roi_ctrl;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_2;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_3;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_4;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_5;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_6;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__spare_7;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_2;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_3;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_4;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_5;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_6;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_7;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_8;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_9;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_10;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_11;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_12;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_13;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_14;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_15;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_16;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_17;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_18;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_19;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_20;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_21;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_22;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_23;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_24;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_25;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_26;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_27;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_28;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_29;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_30;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_spad_en_31;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__user_roi_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__mode_roi_0;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_calc__mode_roi_1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   sigma_estimator_calc__spare_0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  vhv_result__peak_signal_rate_mcps;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  vhv_result__signal_total_events_ref;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  phasecal_result__phase_output_ref;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  dss_result__total_rate_per_spad;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   dss_result__enabled_blocks;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  dss_result__num_requested_spads;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  mm_result__inner_intersection_rate;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  mm_result__outer_complement_rate;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  mm_result__total_offset;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  xtalk_calc__xtalk_for_enabled_spads;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  xtalk_result__avg_xtalk_user_roi_kcps;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  xtalk_result__avg_xtalk_mm_inner_roi_kcps;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  xtalk_result__avg_xtalk_mm_outer_roi_kcps;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  range_result__accum_phase;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  range_result__offset_corrected_range;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_patch_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint8_t   shadow_phasecal_result__vcsel_start;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__interrupt_status;
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__range_status;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__report_status;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__stream_count;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__dss_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__peak_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__ambient_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__sigma_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__phase_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__final_crosstalk_corrected_range_mm_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t
+	shr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__mm_inner_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__mm_outer_actual_effective_spads_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__avg_signal_count_rate_mcps_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__dss_actual_effective_spads_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__peak_signal_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__ambient_count_rate_mcps_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__sigma_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__phase_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__final_crosstalk_corrected_range_mm_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__spare_0_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__spare_1_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint16_t  shadow_result__spare_2_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__spare_3_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result__thresh_info;
+
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_phasecal_result__reference_phase_hi;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_phasecal_result__reference_phase_lo;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_shadow_system_results_t;
+
+
+
+
+
+
+
+
+
+
+
+
+typedef struct {
+	uint32_t  shadow_result_core__ambient_window_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  shadow_result_core__ranging_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	int32_t   shadow_result_core__signal_total_events_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  shadow_result_core__total_periods_elapsed_sd0;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  shadow_result_core__ambient_window_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  shadow_result_core__ranging_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	int32_t   shadow_result_core__signal_total_events_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint32_t  shadow_result_core__total_periods_elapsed_sd1;
+
+
+
+
+
+
+
+
+
+
+	uint8_t   shadow_result_core__spare_0;
+
+
+
+
+
+
+
+
+
+
+} VL53L1_shadow_core_results_t;
+
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_silicon_core.h b/drivers/input/misc/vl53L1/inc/vl53l1_silicon_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..f9eea814d65f70f1683ab0a8b9abac838f886065
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_silicon_core.h
@@ -0,0 +1,134 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_SILICON_CORE_H_
+#define _VL53L1_SILICON_CORE_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_is_firmware_ready_silicon(
+	VL53L1_DEV      Dev,
+	uint8_t        *pready);
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_tuning_parm_defaults.h b/drivers/input/misc/vl53L1/inc/vl53l1_tuning_parm_defaults.h
new file mode 100644
index 0000000000000000000000000000000000000000..119d67e0b17eb342f0840e153f59b75ab501d28b
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_tuning_parm_defaults.h
@@ -0,0 +1,410 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_TUNING_PARM_DEFAULTS_H_
+#define _VL53L1_TUNING_PARM_DEFAULTS_H_
+
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+#define VL53L1_TUNINGPARM_VERSION_DEFAULT \
+((uint16_t) 27)
+#define VL53L1_TUNINGPARM_KEY_TABLE_VERSION_DEFAULT \
+((uint16_t) 14)
+#define VL53L1_TUNINGPARM_LLD_VERSION_DEFAULT \
+((uint16_t) 12180)
+#define VL53L1_TUNINGPARM_HIST_ALGO_SELECT_DEFAULT \
+((uint8_t) 4)
+#define VL53L1_TUNINGPARM_HIST_TARGET_ORDER_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_HIST_FILTER_WOI_0_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_HIST_FILTER_WOI_1_DEFAULT \
+((uint8_t) 2)
+#define VL53L1_TUNINGPARM_HIST_AMB_EST_METHOD_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_0_DEFAULT \
+((uint8_t) 80)
+#define VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_1_DEFAULT \
+((uint8_t) 112)
+#define VL53L1_TUNINGPARM_HIST_MIN_AMB_THRESH_EVENTS_DEFAULT \
+((int32_t) 16)
+#define VL53L1_TUNINGPARM_HIST_AMB_EVENTS_SCALER_DEFAULT \
+((uint16_t) 4157)
+#define VL53L1_TUNINGPARM_HIST_NOISE_THRESHOLD_DEFAULT \
+((uint16_t) 50)
+#define VL53L1_TUNINGPARM_HIST_SIGNAL_TOTAL_EVENTS_LIMIT_DEFAULT \
+((int32_t) 100)
+#define VL53L1_TUNINGPARM_HIST_SIGMA_EST_REF_MM_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_HIST_SIGMA_THRESH_MM_DEFAULT \
+((uint16_t) 160)
+#define VL53L1_TUNINGPARM_HIST_GAIN_FACTOR_DEFAULT \
+((uint16_t) 1987)
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_PHASE_TOLERANCE_DEFAULT \
+((uint8_t) 8)
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_MIN_MAX_TOLERANCE_MM_DEFAULT \
+((uint16_t) 250)
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_MIN_SPAD_LIMIT_DEFAULT \
+((uint16_t) 2048)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_LONG_RANGE_DEFAULT \
+((uint8_t) 9)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_MED_RANGE_DEFAULT \
+((uint8_t) 5)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_SHORT_RANGE_DEFAULT \
+((uint8_t) 3)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_LONG_RANGE_DEFAULT \
+((uint8_t) 6)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_MED_RANGE_DEFAULT \
+((uint8_t) 6)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_SHORT_RANGE_DEFAULT \
+((uint8_t) 6)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM_DEFAULT \
+((int16_t) -50)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM_DEFAULT \
+((int16_t) 50)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM_DEFAULT \
+((uint16_t) 140)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MIN_MAX_TOLERANCE_DEFAULT \
+((uint16_t) 50)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS_DEFAULT \
+((uint16_t) 64000)
+#define VL53L1_TUNINGPARM_XTALK_DETECT_EVENT_SIGMA_DEFAULT \
+((uint8_t) 80)
+#define VL53L1_TUNINGPARM_HIST_XTALK_MARGIN_KCPS_DEFAULT \
+((int16_t) 512)
+#define VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE_DEFAULT \
+((uint8_t) 2)
+#define VL53L1_TUNINGPARM_PHASECAL_TARGET_DEFAULT \
+((uint8_t) 33)
+#define VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE_DEFAULT \
+((uint16_t) 0)
+#define VL53L1_TUNINGPARM_LITE_RANGING_GAIN_FACTOR_DEFAULT \
+((uint16_t) 2011)
+#define VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM_DEFAULT \
+((uint16_t) 60)
+#define VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM_DEFAULT \
+((uint16_t) 60)
+#define VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM_DEFAULT \
+((uint16_t) 60)
+#define VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS_DEFAULT \
+((uint16_t) 128)
+#define VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS_DEFAULT \
+((uint16_t) 128)
+#define VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS_DEFAULT \
+((uint16_t) 128)
+#define VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH_DEFAULT \
+((uint8_t) 8)
+#define VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS_DEFAULT \
+((uint8_t) 16)
+#define VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_LITE_RIT_MULT_DEFAULT \
+((uint8_t) 64)
+#define VL53L1_TUNINGPARM_LITE_SEED_CONFIG_DEFAULT \
+((uint8_t) 2)
+#define VL53L1_TUNINGPARM_LITE_QUANTIFIER_DEFAULT \
+((uint8_t) 2)
+#define VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS_DEFAULT \
+((int16_t) 0)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE_DEFAULT \
+((uint8_t) 14)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE_DEFAULT \
+((uint8_t) 10)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE_DEFAULT \
+((uint8_t) 6)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE_DEFAULT \
+((uint8_t) 14)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE_DEFAULT \
+((uint8_t) 10)
+#define VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE_DEFAULT \
+((uint8_t) 6)
+#define VL53L1_TUNINGPARM_TIMED_SEED_CONFIG_DEFAULT \
+((uint8_t) 1)
+#define VL53L1_TUNINGPARM_DMAX_CFG_SIGNAL_THRESH_SIGMA_DEFAULT \
+((uint8_t) 32)
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_0_DEFAULT \
+((uint16_t) 15)
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_1_DEFAULT \
+((uint16_t) 52)
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_2_DEFAULT \
+((uint16_t) 200)
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_3_DEFAULT \
+((uint16_t) 364)
+#define VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_4_DEFAULT \
+((uint16_t) 400)
+#define VL53L1_TUNINGPARM_VHV_LOOPBOUND_DEFAULT \
+((uint8_t) 129)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE_DEFAULT \
+((uint8_t) 8)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD_DEFAULT \
+((uint8_t) 11)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US_DEFAULT \
+((uint32_t) 1000)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS_DEFAULT \
+((uint16_t) 2560)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS_DEFAULT \
+((uint16_t) 1280)
+#define VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS_DEFAULT \
+((uint16_t) 5120)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_NUM_OF_SAMPLES_DEFAULT \
+((uint8_t) 7)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MIN_FILTER_THRESH_MM_DEFAULT \
+((int16_t) -70)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_FILTER_THRESH_MM_DEFAULT \
+((int16_t) 70)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_RATE_MCPS_DEFAULT \
+((uint16_t) 5120)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_PHASECAL_TIMEOUT_US_DEFAULT \
+((uint32_t) 15000)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_VALID_RATE_KCPS_DEFAULT \
+((uint16_t) 64000)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_SIGMA_THRESHOLD_MM_DEFAULT \
+((uint16_t) 140)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_XTALK_EXTRACT_BIN_TIMEOUT_US_DEFAULT \
+((uint32_t) 10000)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS_DEFAULT \
+((uint16_t) 2560)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US_DEFAULT \
+((uint32_t) 1000)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US_DEFAULT \
+((uint32_t) 13000)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US_DEFAULT \
+((uint32_t) 13000)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES_DEFAULT \
+((uint8_t) 8)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES_DEFAULT \
+((uint8_t) 40)
+#define VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES_DEFAULT \
+((uint8_t) 9)
+#define VL53L1_TUNINGPARM_ZONE_CAL_DSS_RATE_MCPS_DEFAULT \
+((uint16_t) 5120)
+#define VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_TIMEOUT_US_DEFAULT \
+((uint32_t) 15000)
+#define VL53L1_TUNINGPARM_ZONE_CAL_DSS_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_NUM_SAMPLES_DEFAULT \
+((uint16_t) 16)
+#define VL53L1_TUNINGPARM_ZONE_CAL_RANGE_TIMEOUT_US_DEFAULT \
+((uint32_t) 1000)
+#define VL53L1_TUNINGPARM_ZONE_CAL_ZONE_NUM_SAMPLES_DEFAULT \
+((uint16_t) 8)
+#define VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD_DEFAULT \
+((uint8_t) 18)
+#define VL53L1_TUNINGPARM_SPADMAP_VCSEL_START_DEFAULT \
+((uint8_t) 15)
+#define VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS_DEFAULT \
+((uint16_t) 12)
+#define VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT \
+((uint16_t) 2560)
+#define VL53L1_TUNINGPARM_RANGING_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT \
+((uint16_t) 5120)
+#define VL53L1_TUNINGPARM_MZ_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT \
+((uint16_t) 5120)
+#define VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT \
+((uint16_t) 2560)
+#define VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 1000)
+#define VL53L1_TUNINGPARM_RANGING_LONG_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 15000)
+#define VL53L1_TUNINGPARM_RANGING_MED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 9000)
+#define VL53L1_TUNINGPARM_RANGING_SHORT_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 6000)
+#define VL53L1_TUNINGPARM_MZ_LONG_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 15000)
+#define VL53L1_TUNINGPARM_MZ_MED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 9000)
+#define VL53L1_TUNINGPARM_MZ_SHORT_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 6000)
+#define VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 1000)
+#define VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_RANGING_MM_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_MZ_MM_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2000)
+#define VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 63000)
+#define VL53L1_TUNINGPARM_RANGING_RANGE_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2500)
+#define VL53L1_TUNINGPARM_MZ_RANGE_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 2500)
+#define VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 13000)
+#define VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_MARGIN_DEFAULT \
+((uint16_t) 512)
+#define VL53L1_TUNINGPARM_DYNXTALK_NOISE_MARGIN_DEFAULT \
+((uint32_t) 500)
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_DEFAULT \
+((uint32_t) 0)
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_HI_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_DYNXTALK_SAMPLE_LIMIT_DEFAULT \
+((uint32_t) 200)
+#define VL53L1_TUNINGPARM_DYNXTALK_SINGLE_XTALK_DELTA_DEFAULT \
+((uint32_t) 10240)
+#define VL53L1_TUNINGPARM_DYNXTALK_AVERAGED_XTALK_DELTA_DEFAULT \
+((uint32_t) 4096)
+#define VL53L1_TUNINGPARM_DYNXTALK_CLIP_LIMIT_DEFAULT \
+((uint32_t) 1046528)
+#define VL53L1_TUNINGPARM_DYNXTALK_SCALER_CALC_METHOD_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_DYNXTALK_XGRADIENT_SCALER_DEFAULT \
+((int16_t) 256)
+#define VL53L1_TUNINGPARM_DYNXTALK_YGRADIENT_SCALER_DEFAULT \
+((int16_t) 256)
+#define VL53L1_TUNINGPARM_DYNXTALK_USER_SCALER_SET_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_COR_SINGLE_APPLY_DEFAULT \
+((uint8_t) 0)
+#define VL53L1_TUNINGPARM_DYNXTALK_XTALK_AMB_THRESHOLD_DEFAULT \
+((uint32_t) 1280)
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_AMB_THRESHOLD_KCPS_DEFAULT \
+((uint32_t) 57671680)
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_SAMPLE_LIMIT_DEFAULT \
+((uint32_t) 10)
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS_DEFAULT \
+((uint32_t) 2048)
+#define VL53L1_TUNINGPARM_DYNXTALK_NODETECT_MIN_RANGE_MM_DEFAULT \
+((uint16_t) 900)
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND_DEFAULT \
+((uint8_t) 3)
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 1)
+#define VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US_DEFAULT \
+((uint32_t) 8000)
+#define VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS_DEFAULT \
+((uint16_t) 10240)
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_wait.h b/drivers/input/misc/vl53L1/inc/vl53l1_wait.h
new file mode 100644
index 0000000000000000000000000000000000000000..eb19e3b9bcb4652b54eca1efed49eeddaf27445e
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_wait.h
@@ -0,0 +1,319 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_WAIT_H_
+#define _VL53L1_WAIT_H_
+
+#include "vl53l1_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_wait_for_boot_completion(
+	VL53L1_DEV      Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_wait_for_firmware_ready(
+	VL53L1_DEV      Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_wait_for_range_completion(
+	VL53L1_DEV   Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_wait_for_test_completion(
+	VL53L1_DEV   Dev);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_is_boot_complete(
+	VL53L1_DEV      Dev,
+	uint8_t        *pready);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_is_firmware_ready(
+	VL53L1_DEV      Dev,
+	uint8_t        *pready);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_is_new_data_ready(
+	VL53L1_DEV      Dev,
+	uint8_t        *pready);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_poll_for_boot_completion(
+	VL53L1_DEV      Dev,
+	uint32_t        timeout_ms);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_poll_for_firmware_ready(
+	VL53L1_DEV      Dev,
+	uint32_t        timeout_ms);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_poll_for_range_completion(
+	VL53L1_DEV   Dev,
+	uint32_t     timeout_ms);
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/inc/vl53l1_zone_presets.h b/drivers/input/misc/vl53L1/inc/vl53l1_zone_presets.h
new file mode 100644
index 0000000000000000000000000000000000000000..34f3652f0a950b1865c51656b7f49706ec6ccf97
--- /dev/null
+++ b/drivers/input/misc/vl53L1/inc/vl53l1_zone_presets.h
@@ -0,0 +1,183 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifndef _VL53L1_ZONE_PRESETS_H_
+#define _VL53L1_ZONE_PRESETS_H_
+
+#include "vl53l1_ll_def.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_zone_config_structure(
+	uint8_t x_off,
+	uint8_t x_inc,
+	uint8_t x_zones,
+	uint8_t y_off,
+	uint8_t y_inc,
+	uint8_t y_zones,
+	uint8_t width,
+	uint8_t height,
+	VL53L1_zone_config_t   *pdata);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_zone_preset_xtalk_planar(
+	VL53L1_general_config_t	*pgeneral,
+	VL53L1_zone_config_t    *pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_init_zone_config_histogram_bins(
+	VL53L1_zone_config_t   *pdata);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
diff --git a/drivers/input/misc/vl53L1/ipp/ipp_linux.c b/drivers/input/misc/vl53L1/ipp/ipp_linux.c
new file mode 100644
index 0000000000000000000000000000000000000000..7b8c5b76e2a1c90a7f8b68cbacbba63cd7eeab13
--- /dev/null
+++ b/drivers/input/misc/vl53L1/ipp/ipp_linux.c
@@ -0,0 +1,343 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file ipp_linux.c kernel side implementation of vl53l1 protected processing
+ *
+ *  @date  Sep 1, 2016
+ *  @author : imaging
+ *
+ *  @ingroup ipp_dev
+ */
+
+#include "stmvl53l1.h"
+
+#define IPP_ERR_CODE (VL53L1_ERROR_PLATFORM_SPECIFIC_START-1)
+
+static int stmvl53l1_ipp_do_wrapper(struct stmvl53l1_data *data,
+	struct ipp_work_t *pin, struct ipp_work_t *pout, int payload_out)
+{
+	int rc;
+
+	if (data->ipp.buzy) {
+		vl53l1_errmsg("try exec new ipp but still buzy on previous");
+		/*  TODO shall we discard it and push new ? */
+		rc = IPP_ERR_CODE;
+		goto done;
+	}
+	WARN_ON(pin->payload > IPP_WORK_MAX_PAYLOAD);
+	stmvl531_ipp_tim_start(data);
+	rc = stmvl53l1_ipp_do(data, pin, pout);
+	if (rc != 0) {
+		vl53l1_errmsg("stmvl53l1_ipp_do err %d\n", rc);
+		rc = IPP_ERR_CODE;
+		goto done;
+	}
+	//vl53l1_dbgmsg("ipp ok \n");
+	/* check what we got back if valid answer error etc */
+	if (pout->status) {
+		vl53l1_errmsg("ipp error status %d from user", pout->status);
+		if (pout->status >= stmvl53l1_ipp_status_proc_code)
+			rc = pout->status & (stmvl53l1_ipp_status_proc_code-1);
+		else
+			rc = IPP_ERR_CODE;
+		goto done;
+	}
+	WARN_ON(pout->payload > IPP_WORK_MAX_PAYLOAD);
+	if (pout->payload != payload_out) {
+		/* bad formated answer */
+		vl53l1_errmsg("bad payload %d != %d in ipp work back",
+				pout->payload, payload_out);
+		rc = IPP_ERR_CODE;
+		goto done;
+	}
+	stmvl531_ipp_tim_stop(data);
+	/*stmvl531_ipp_stat(data, "ipp #%5x to=%3d fm=%3d in %5ld us",
+			pin->xfer_id, pin->payload,
+			pout->payload,
+			stmvl531_ipp_time(data));*/
+
+	rc = 0;
+done:
+
+	return rc;
+}
+
+/**
+ * @file   vl53l1_platform_ipp.h
+ *
+ * @brief  EwokPlus25 IPP Wrapper Functions
+ */
+
+/**
+ * @brief  IPP Wrapper call for histogram post processing
+ *
+ *
+ * @param[in]    Dev                       : Device handle
+ * @param[in]    pdmax_cal                 : DMAX calibration data
+ * @param[in]    pdmax_cfg                 : DMAX configuration data
+ * @param[in]    ppost_cfg                 : VL53L1_hist_post_process_config_t
+ * @param[in]    pbins                     : Input histogram raw bin data
+ * @param[in]    pxtalk                    : Cross talk histogram data
+ * @param[out]   presults                  : Output VL53L1_range_results_t
+ *                                           structure
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_ipp_hist_process_data(
+	VL53L1_DEV dev,
+	VL53L1_dmax_calibration_data_t    *pdmax_cal,
+	VL53L1_hist_gen3_dmax_config_t    *pdmax_cfg,
+	VL53L1_hist_post_process_config_t *ppost_cfg,
+	VL53L1_histogram_bin_data_t       *pbins,
+	VL53L1_xtalk_histogram_data_t     *pxtalk,
+	VL53L1_range_results_t            *presults)
+{
+	struct stmvl53l1_data *data = (struct stmvl53l1_data *)
+		container_of(dev, struct stmvl53l1_data, stdev);
+	struct ipp_work_t *pout = &data->ipp.work_out;
+	struct ipp_work_t *pin = &data->ipp.work;
+	int rc;
+	VL53L1_range_results_t *presults_ipp;
+
+	IPP_SERIALIZE_VAR;
+
+	/* setup pin */
+	IPP_SERIALIZE_START(pin->data, 5);
+	IPP_SET_ARG_PTR(pin->data, 0, pdmax_cal);
+	IPP_SET_ARG_PTR(pin->data, 1, pdmax_cfg);
+	IPP_SET_ARG_PTR(pin->data, 2, ppost_cfg);
+	IPP_SET_ARG_PTR(pin->data, 3, pbins);
+	IPP_SET_ARG_PTR(pin->data, 4, pxtalk);
+	pin->payload = IPP_SERIALIZE_PAYLAOD();
+	pin->process_no = stmvl53l1_ipp_cal_hist;
+
+	/* setup pout */
+	IPP_SERIALIZE_START(pout->data, 1);
+	IPP_OUT_ARG_PTR(pout->data, 0, presults_ipp);
+
+	/* do ipp */
+	rc = stmvl53l1_ipp_do_wrapper(data, pin, pout, IPP_SERIALIZE_PAYLAOD());
+	if (rc)
+		goto done;
+
+	/* copy output */
+	memcpy(presults, presults_ipp, sizeof(*presults));
+
+	rc = 0;
+done:
+
+	return rc;
+}
+
+/**
+ * @brief  IPP Wrapper call for histogram ambient dmax calc
+ *
+ * The target reflectance in percent for the DMAX calculation
+ * is set by target_reflectance input
+ *
+ * The fixed point format is 7.2
+ *
+ * @param[in]    Dev                : Device handle
+ * @param[in]    target_reflectance : target reflectance to report ambient DMAX
+ *                                    Percentage in 7.2 fixed point format
+ * @param[in]    pdmax_cal          : DMAX calibration data
+ * @param[in]    pdmax_cfg          : DMAX configuration data
+ * @param[in]    pbins              : Input histogram raw bin data
+ * @param[out]   pambient_dmax_mm   : Output ambient DMAX distance in [mm]
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_ipp_hist_ambient_dmax(
+	VL53L1_DEV                         dev,
+	uint16_t                           target_reflectance,
+	VL53L1_dmax_calibration_data_t    *pdmax_cal,
+	VL53L1_hist_gen3_dmax_config_t    *pdmax_cfg,
+	VL53L1_histogram_bin_data_t       *pbins,
+	int16_t                           *pambient_dmax_mm)
+{
+	struct stmvl53l1_data *data = (struct stmvl53l1_data *)
+		container_of(dev, struct stmvl53l1_data, stdev);
+	struct ipp_work_t *pout = &data->ipp.work_out;
+	struct ipp_work_t *pin = &data->ipp.work;
+	int rc;
+	int16_t *pambient_dmax_mm_ipp;
+
+	IPP_SERIALIZE_VAR;
+
+	/* setup pin */
+	IPP_SERIALIZE_START(pin->data, 4);
+	IPP_SET_ARG(pin->data, 0, target_reflectance);
+	IPP_SET_ARG_PTR(pin->data, 1, pdmax_cal);
+	IPP_SET_ARG_PTR(pin->data, 2, pdmax_cfg);
+	IPP_SET_ARG_PTR(pin->data, 3, pbins);
+	pin->payload = IPP_SERIALIZE_PAYLAOD();
+	pin->process_no = stmvl53l1_ipp_hist_ambient_dmax;
+
+	/* setup pout */
+	IPP_SERIALIZE_START(pout->data, 1);
+	IPP_OUT_ARG_PTR(pout->data, 0, pambient_dmax_mm_ipp);
+
+	/* do ipp */
+	rc = stmvl53l1_ipp_do_wrapper(data, pin, pout, IPP_SERIALIZE_PAYLAOD());
+	if (rc)
+		goto done;
+
+	/* copy output */
+	memcpy(pambient_dmax_mm, pambient_dmax_mm_ipp,
+		sizeof(*pambient_dmax_mm));
+
+	rc = 0;
+done:
+
+	return rc;
+}
+
+/**
+ * @brief  IPP Wrapper call for xtalk calibration post processing
+ *
+ * @param[in]      Dev                 : Device handle
+ * @param[in]      pxtalk_ranges       : Input VL53L1_xtalk_range_results_t
+ *                                       Must contain 5 ranges, 4 quadrants + 1
+ *                                       full FoV
+ * @param[out]     pxtalk_shape        : Output normalised Cross talk  histogram
+ *                                       shape
+ * @param[out]     pxtalk_cal        : Output VL53L1_xtalk_calibration_results_t
+ *                                     structure
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+VL53L1_Error VL53L1_ipp_xtalk_calibration_process_data(
+	VL53L1_DEV                          dev,
+	VL53L1_xtalk_range_results_t       *pxtalk_ranges,
+	VL53L1_xtalk_histogram_data_t      *pxtalk_shape,
+	VL53L1_xtalk_calibration_results_t *pxtalk_cal)
+{
+	struct stmvl53l1_data *data = (struct stmvl53l1_data *)
+		container_of(dev, struct stmvl53l1_data, stdev);
+	struct ipp_work_t *pout = &data->ipp.work_out;
+	struct ipp_work_t *pin = &data->ipp.work;
+	int rc;
+	VL53L1_xtalk_histogram_data_t *pxtalk_shape_ipp;
+	VL53L1_xtalk_calibration_results_t *pxtalk_cal_ipp;
+
+	IPP_SERIALIZE_VAR;
+
+	/* setup pin */
+	IPP_SERIALIZE_START(pin->data, 1);
+	IPP_SET_ARG_PTR(pin->data, 0, pxtalk_ranges);
+	pin->payload = IPP_SERIALIZE_PAYLAOD();
+	pin->process_no = stmvl53l1_ipp_xtalk_calibration;
+
+	/* setup pout */
+	IPP_SERIALIZE_START(pout->data, 2);
+	IPP_OUT_ARG_PTR(pout->data, 0, pxtalk_shape_ipp);
+	IPP_OUT_ARG_PTR(pout->data, 1, pxtalk_cal_ipp);
+
+	/* do ipp */
+	rc = stmvl53l1_ipp_do_wrapper(data, pin, pout, IPP_SERIALIZE_PAYLAOD());
+	if (rc)
+		goto done;
+
+	/* copy output */
+	memcpy(pxtalk_shape, pxtalk_shape_ipp, sizeof(*pxtalk_shape));
+	memcpy(pxtalk_cal, pxtalk_cal_ipp, sizeof(*pxtalk_cal));
+
+	rc = 0;
+done:
+
+	return rc;
+}
+
+/**
+ * @brief  IPP Wrapper call for Generating Xtalk data from dual reflectance
+ * histogram data
+ *
+ * @param[in]  Dev                          : Device handle
+ * @param[in]  pxtalk_results               : Pointer to xtalk_results structure
+ *                                            containing dual reflectance
+ *                                            histogram data
+ * @param[in]  expected_target_distance_mm  : User input of true target distance
+ * @param[in]  higher_reflectance           : User input detailing which
+ *                                            histogram data 1 or 2 has the
+ *                                            highest reflectance.
+ * @param[out] pxtalk_avg_samples           : Pointer to output xtalk histogram
+ *                                            data
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_generate_dual_reflectance_xtalk_samples(
+	VL53L1_DEV                     dev,
+	VL53L1_xtalk_range_results_t  *pxtalk_results,
+	uint16_t                       expected_target_distance_mm,
+	uint8_t                        higher_reflectance,
+	VL53L1_histogram_bin_data_t    *pxtalk_avg_samples)
+{
+	struct stmvl53l1_data *data = (struct stmvl53l1_data *)
+		container_of(dev, struct stmvl53l1_data, stdev);
+	struct ipp_work_t *pout = &data->ipp.work_out;
+	struct ipp_work_t *pin = &data->ipp.work;
+	int rc;
+	VL53L1_histogram_bin_data_t *pxtalk_avg_samples_ipp;
+
+	IPP_SERIALIZE_VAR;
+
+	/* setup pin */
+	IPP_SERIALIZE_START(pin->data, 3);
+	IPP_SET_ARG_PTR(pin->data, 0, pxtalk_results);
+	IPP_SET_ARG(pin->data, 1, expected_target_distance_mm);
+	IPP_SET_ARG(pin->data, 2, higher_reflectance);
+	pin->payload = IPP_SERIALIZE_PAYLAOD();
+	pin->process_no = stmvl53l1_ipp_generate_dual_reflectance_xtalk_samples;
+
+	/* setup pout */
+	IPP_SERIALIZE_START(pout->data, 1);
+	IPP_OUT_ARG_PTR(pout->data, 0, pxtalk_avg_samples_ipp);
+
+	/* do ipp */
+	rc = stmvl53l1_ipp_do_wrapper(data, pin, pout, IPP_SERIALIZE_PAYLAOD());
+	if (rc)
+		goto done;
+
+	/* copy output */
+	memcpy(pxtalk_avg_samples, pxtalk_avg_samples_ipp,
+		sizeof(*pxtalk_avg_samples));
+
+	rc = 0;
+done:
+
+	return rc;
+}
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api.c b/drivers/input/misc/vl53L1/src/vl53l1_api.c
new file mode 100644
index 0000000000000000000000000000000000000000..bb49c457224e4635f79be3c7e13fcbd5d3e09daa
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api.c
@@ -0,0 +1,3716 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_api.h"
+#include "vl53l1_api_strings.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_register_funcs.h"
+#include "vl53l1_core.h"
+#include "vl53l1_api_calibration.h"
+#include "vl53l1_wait.h"
+#include "vl53l1_preset_setup.h"
+#include "vl53l1_api_debug.h"
+#include "vl53l1_api_core.h"
+#include "vl53l1_nvm.h"
+
+
+
+#define ZONE_CHECK VL53L1_MAX_USER_ZONES
+
+#if ZONE_CHECK < 5
+#error Must define at least 5 zones in MAX_USER_ZONES constant
+#endif
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_API, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_API, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_API, status, \
+			fmt, ##__VA_ARGS__)
+
+#ifdef VL53L1_LOG_ENABLE
+#define trace_print(level, ...) trace_print_module_function(\
+		VL53L1_TRACE_MODULE_API, level, VL53L1_TRACE_FUNCTION_NONE, \
+		##__VA_ARGS__)
+#endif
+
+#ifndef MIN
+#define MIN(v1, v2) ((v1) < (v2) ? (v1) : (v2))
+#endif
+#ifndef MAX
+#define MAX(v1, v2) ((v1) < (v2) ? (v2) : (v1))
+#endif
+
+#define DMAX_REFLECTANCE_IDX 2
+
+
+
+
+
+
+
+#define LOWPOWER_AUTO_VHV_LOOP_DURATION_US 245
+#define LOWPOWER_AUTO_OVERHEAD_BEFORE_A_RANGING 1448
+#define LOWPOWER_AUTO_OVERHEAD_BETWEEN_A_B_RANGING 2100
+
+#define FDA_MAX_TIMING_BUDGET_US 550000
+
+
+
+
+
+
+
+
+
+static int32_t BDTable[VL53L1_TUNING_MAX_TUNABLE_KEY] = {
+		TUNING_VERSION,
+		TUNING_PROXY_MIN,
+		TUNING_SINGLE_TARGET_XTALK_TARGET_DISTANCE_MM,
+		TUNING_SINGLE_TARGET_XTALK_SAMPLE_NUMBER,
+		TUNING_MIN_AMBIENT_DMAX_VALID,
+		TUNING_MAX_SIMPLE_OFFSET_CALIBRATION_SAMPLE_NUMBER,
+		TUNING_XTALK_FULL_ROI_TARGET_DISTANCE_MM,
+		TUNING_SIMPLE_OFFSET_CALIBRATION_REPEAT
+};
+
+
+
+static VL53L1_Error SingleTargetXTalkCalibration(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	uint32_t sum_ranging = 0;
+	uint32_t sum_spads = 0;
+	FixPoint1616_t sum_signalRate = 0;
+	FixPoint1616_t total_count = 0;
+	uint8_t xtalk_meas = 0;
+	uint8_t xtalk_measmax =
+		BDTable[VL53L1_TUNING_SINGLE_TARGET_XTALK_SAMPLE_NUMBER];
+	VL53L1_RangingMeasurementData_t RMData;
+	FixPoint1616_t xTalkStoredMeanSignalRate;
+	FixPoint1616_t xTalkStoredMeanRange;
+	FixPoint1616_t xTalkStoredMeanRtnSpads;
+	uint32_t xTalkStoredMeanRtnSpadsAsInt;
+	uint32_t xTalkCalDistanceAsInt;
+	FixPoint1616_t XTalkCompensationRateMegaCps;
+	uint32_t signalXTalkTotalPerSpad;
+	VL53L1_PresetModes PresetMode;
+	VL53L1_CalibrationData_t  CalibrationData;
+	VL53L1_CustomerNvmManaged_t *pC;
+
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+	if ((PresetMode != VL53L1_PRESETMODE_AUTONOMOUS) &&
+		(PresetMode != VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS) &&
+		(PresetMode != VL53L1_PRESETMODE_LITE_RANGING)) {
+		Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+		goto ENDFUNC;
+	}
+
+
+
+	Status = VL53L1_disable_xtalk_compensation(Dev);
+
+	if (Status != VL53L1_ERROR_NONE)
+		goto ENDFUNC;
+
+	Status = VL53L1_StartMeasurement(Dev);
+
+	if (Status != VL53L1_ERROR_NONE)
+		goto ENDFUNC;
+
+
+
+	VL53L1_WaitMeasurementDataReady(Dev);
+	VL53L1_GetRangingMeasurementData(Dev, &RMData);
+	VL53L1_ClearInterruptAndStartMeasurement(Dev);
+
+	sum_ranging = 0;
+	sum_spads = 0;
+	sum_signalRate = 0;
+	total_count = 0;
+	for (xtalk_meas = 0; xtalk_meas < xtalk_measmax; xtalk_meas++) {
+		VL53L1_WaitMeasurementDataReady(Dev);
+		VL53L1_GetRangingMeasurementData(Dev, &RMData);
+		VL53L1_ClearInterruptAndStartMeasurement(Dev);
+		if (RMData.RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) {
+			sum_ranging += RMData.RangeMilliMeter;
+			sum_signalRate += RMData.SignalRateRtnMegaCps;
+			sum_spads += RMData.EffectiveSpadRtnCount / 256;
+			total_count++;
+		}
+	}
+	Status = VL53L1_StopMeasurement(Dev);
+
+	if (total_count > 0) {
+
+
+		xTalkStoredMeanSignalRate = sum_signalRate / total_count;
+		xTalkStoredMeanRange = (FixPoint1616_t)(sum_ranging << 16);
+		xTalkStoredMeanRange /= total_count;
+		xTalkStoredMeanRtnSpads = (FixPoint1616_t)(sum_spads << 16);
+		xTalkStoredMeanRtnSpads /= total_count;
+
+
+
+
+
+
+
+
+
+
+
+
+
+		xTalkStoredMeanRtnSpadsAsInt = (xTalkStoredMeanRtnSpads +
+			0x8000) >> 16;
+
+
+
+
+
+
+		 xTalkCalDistanceAsInt = ((uint32_t)BDTable[
+			VL53L1_TUNING_SINGLE_TARGET_XTALK_TARGET_DISTANCE_MM]);
+		if (xTalkStoredMeanRtnSpadsAsInt == 0 ||
+		xTalkCalDistanceAsInt == 0 ||
+		xTalkStoredMeanRange >= (xTalkCalDistanceAsInt << 16)) {
+			XTalkCompensationRateMegaCps = 0;
+		} else {
+
+
+
+
+
+
+			signalXTalkTotalPerSpad = (xTalkStoredMeanSignalRate) /
+				xTalkStoredMeanRtnSpadsAsInt;
+
+
+
+
+
+
+
+			signalXTalkTotalPerSpad *= (((uint32_t)1 << 16) -
+				(xTalkStoredMeanRange / xTalkCalDistanceAsInt));
+
+
+
+			XTalkCompensationRateMegaCps = (signalXTalkTotalPerSpad
+				+ 0x8000) >> 16;
+		}
+
+
+		Status = VL53L1_GetCalibrationData(Dev, &CalibrationData);
+
+		if (Status != VL53L1_ERROR_NONE)
+			goto ENDFUNC;
+
+		pC = &CalibrationData.customer;
+
+		pC->algo__crosstalk_compensation_plane_offset_kcps =
+			(uint32_t)(1000 * ((XTalkCompensationRateMegaCps  +
+				((uint32_t)1<<6)) >> (16-9)));
+
+		Status = VL53L1_SetCalibrationData(Dev, &CalibrationData);
+
+		if (Status != VL53L1_ERROR_NONE)
+			goto ENDFUNC;
+
+		Status = VL53L1_enable_xtalk_compensation(Dev);
+
+	} else
+
+
+		Status = VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL;
+
+ENDFUNC:
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+
+
+
+
+
+
+
+
+
+static VL53L1_Error CheckValidRectRoi(VL53L1_UserRoi_t ROI)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	if ((ROI.TopLeftX > 15) || (ROI.TopLeftY > 15) ||
+		(ROI.BotRightX > 15) || (ROI.BotRightY > 15))
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+
+	if ((ROI.TopLeftX > ROI.BotRightX) || (ROI.TopLeftY < ROI.BotRightY))
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+static VL53L1_GPIO_Interrupt_Mode ConvertModeToLLD(VL53L1_Error *pStatus,
+		VL53L1_ThresholdMode CrossMode)
+{
+	VL53L1_GPIO_Interrupt_Mode Mode;
+
+	switch (CrossMode) {
+	case VL53L1_THRESHOLD_CROSSED_LOW:
+		Mode = VL53L1_GPIOINTMODE_LEVEL_LOW;
+		break;
+	case VL53L1_THRESHOLD_CROSSED_HIGH:
+		Mode = VL53L1_GPIOINTMODE_LEVEL_HIGH;
+		break;
+	case VL53L1_THRESHOLD_OUT_OF_WINDOW:
+		Mode = VL53L1_GPIOINTMODE_OUT_OF_WINDOW;
+		break;
+	case VL53L1_THRESHOLD_IN_WINDOW:
+		Mode = VL53L1_GPIOINTMODE_IN_WINDOW;
+		break;
+	default:
+
+
+		Mode = VL53L1_GPIOINTMODE_LEVEL_HIGH;
+		*pStatus = VL53L1_ERROR_INVALID_PARAMS;
+	}
+	return Mode;
+}
+
+static VL53L1_ThresholdMode ConvertModeFromLLD(VL53L1_Error *pStatus,
+		VL53L1_GPIO_Interrupt_Mode CrossMode)
+{
+	VL53L1_ThresholdMode Mode;
+
+	switch (CrossMode) {
+	case VL53L1_GPIOINTMODE_LEVEL_LOW:
+		Mode = VL53L1_THRESHOLD_CROSSED_LOW;
+		break;
+	case VL53L1_GPIOINTMODE_LEVEL_HIGH:
+		Mode = VL53L1_THRESHOLD_CROSSED_HIGH;
+		break;
+	case VL53L1_GPIOINTMODE_OUT_OF_WINDOW:
+		Mode = VL53L1_THRESHOLD_OUT_OF_WINDOW;
+		break;
+	case VL53L1_GPIOINTMODE_IN_WINDOW:
+		Mode = VL53L1_THRESHOLD_IN_WINDOW;
+		break;
+	default:
+
+
+		Mode = VL53L1_THRESHOLD_CROSSED_HIGH;
+		*pStatus = VL53L1_ERROR_UNDEFINED;
+	}
+	return Mode;
+}
+
+
+
+
+VL53L1_Error VL53L1_GetVersion(VL53L1_Version_t *pVersion)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	pVersion->major = VL53L1_IMPLEMENTATION_VER_MAJOR;
+	pVersion->minor = VL53L1_IMPLEMENTATION_VER_MINOR;
+	pVersion->build = VL53L1_IMPLEMENTATION_VER_SUB;
+
+	pVersion->revision = VL53L1_IMPLEMENTATION_VER_REVISION;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetProductRevision(VL53L1_DEV Dev,
+	uint8_t *pProductRevisionMajor, uint8_t *pProductRevisionMinor)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t revision_id;
+	VL53L1_LLDriverData_t   *pLLData;
+
+	LOG_FUNCTION_START("");
+
+	pLLData =  VL53L1DevStructGetLLDriverHandle(Dev);
+	revision_id = pLLData->nvm_copy_data.identification__revision_id;
+	*pProductRevisionMajor = 1;
+	*pProductRevisionMinor = (revision_id & 0xF0) >> 4;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+VL53L1_Error VL53L1_GetDeviceInfo(VL53L1_DEV Dev,
+	VL53L1_DeviceInfo_t *pVL53L1_DeviceInfo)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t revision_id;
+	VL53L1_LLDriverData_t   *pLLData;
+
+	LOG_FUNCTION_START("");
+
+	pLLData =  VL53L1DevStructGetLLDriverHandle(Dev);
+
+	strncpy(pVL53L1_DeviceInfo->ProductId, "",
+			VL53L1_DEVINFO_STRLEN-1);
+	pVL53L1_DeviceInfo->ProductType =
+			pLLData->nvm_copy_data.identification__module_type;
+
+	revision_id = pLLData->nvm_copy_data.identification__revision_id;
+	pVL53L1_DeviceInfo->ProductRevisionMajor = 1;
+	pVL53L1_DeviceInfo->ProductRevisionMinor = (revision_id & 0xF0) >> 4;
+
+#ifndef VL53L1_USE_EMPTY_STRING
+	if (pVL53L1_DeviceInfo->ProductRevisionMinor == 0)
+		strncpy(pVL53L1_DeviceInfo->Name,
+				VL53L1_STRING_DEVICE_INFO_NAME0,
+				VL53L1_DEVINFO_STRLEN-1);
+	else
+		strncpy(pVL53L1_DeviceInfo->Name,
+				VL53L1_STRING_DEVICE_INFO_NAME1,
+				VL53L1_DEVINFO_STRLEN-1);
+	strncpy(pVL53L1_DeviceInfo->Type,
+			VL53L1_STRING_DEVICE_INFO_TYPE,
+			VL53L1_DEVINFO_STRLEN-1);
+#else
+	pVL53L1_DeviceInfo->Name[0] = 0;
+	pVL53L1_DeviceInfo->Type[0] = 0;
+#endif
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetRangeStatusString(uint8_t RangeStatus,
+	char *pRangeStatusString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_range_status_string(RangeStatus,
+		pRangeStatusString);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetPalErrorString(VL53L1_Error PalErrorCode,
+	char *pPalErrorString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_pal_error_string(PalErrorCode, pPalErrorString);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetPalStateString(VL53L1_State PalStateCode,
+	char *pPalStateString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_pal_state_string(PalStateCode, pPalStateString);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetPalState(VL53L1_DEV Dev, VL53L1_State *pPalState)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	*pPalState = VL53L1DevDataGet(Dev, PalState);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_SetDeviceAddress(VL53L1_DEV Dev, uint8_t DeviceAddress)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_WrByte(Dev, VL53L1_I2C_SLAVE__DEVICE_ADDRESS,
+			DeviceAddress / 2);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_DataInit(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t i;
+
+	LOG_FUNCTION_START("");
+
+
+
+#ifdef USE_I2C_2V8
+	Status = VL53L1_RdByte(Dev, VL53L1_PAD_I2C_HV__EXTSUP_CONFIG, &i);
+	if (Status == VL53L1_ERROR_NONE) {
+		i = (i & 0xfe) | 0x01;
+		Status = VL53L1_WrByte(Dev, VL53L1_PAD_I2C_HV__EXTSUP_CONFIG,
+				i);
+	}
+#endif
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_data_init(Dev, 1);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		VL53L1DevDataSet(Dev, PalState, VL53L1_STATE_WAIT_STATICINIT);
+		VL53L1DevDataSet(Dev, CurrentParameters.PresetMode,
+				VL53L1_PRESETMODE_RANGING);
+	}
+
+
+
+	for (i = 0; i < VL53L1_CHECKENABLE_NUMBER_OF_CHECKS; i++) {
+		if (Status == VL53L1_ERROR_NONE)
+			Status |= VL53L1_SetLimitCheckEnable(Dev, i, 1);
+		else
+			break;
+
+	}
+
+
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_SetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+				(FixPoint1616_t)(18 * 65536));
+	}
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_SetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+				(FixPoint1616_t)(25 * 65536 / 100));
+
+
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_StaticInit(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t  measurement_mode;
+
+	LOG_FUNCTION_START("");
+
+	VL53L1DevDataSet(Dev, PalState, VL53L1_STATE_IDLE);
+
+	measurement_mode  = VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	VL53L1DevDataSet(Dev, LLData.measurement_mode, measurement_mode);
+
+	VL53L1DevDataSet(Dev, CurrentParameters.DistanceMode,
+			VL53L1_DISTANCEMODE_LONG);
+
+	VL53L1DevDataSet(Dev, CurrentParameters.OutputMode,
+			VL53L1_OUTPUTMODE_NEAREST);
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_WaitDeviceBooted(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_poll_for_boot_completion(Dev,
+			VL53L1_BOOT_COMPLETION_POLLING_TIMEOUT_MS);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+static VL53L1_Error ComputeDevicePresetMode(
+		VL53L1_PresetModes PresetMode,
+		VL53L1_DistanceModes DistanceMode,
+		VL53L1_DevicePresetModes *pDevicePresetMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	uint8_t DistIdx;
+	VL53L1_DevicePresetModes LightModes[3] = {
+		VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_SHORT_RANGE,
+		VL53L1_DEVICEPRESETMODE_STANDARD_RANGING,
+		VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_LONG_RANGE};
+
+	VL53L1_DevicePresetModes RangingModes[3] = {
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE,
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE,
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE};
+
+	VL53L1_DevicePresetModes ScanningModes[3] = {
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_SHORT_RANGE,
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE,
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_LONG_RANGE};
+
+	VL53L1_DevicePresetModes TimedModes[3] = {
+		VL53L1_DEVICEPRESETMODE_TIMED_RANGING_SHORT_RANGE,
+		VL53L1_DEVICEPRESETMODE_TIMED_RANGING,
+		VL53L1_DEVICEPRESETMODE_TIMED_RANGING_LONG_RANGE};
+
+	VL53L1_DevicePresetModes LowPowerTimedModes[3] = {
+		VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_SHORT_RANGE,
+		VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_MEDIUM_RANGE,
+		VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_LONG_RANGE};
+
+	*pDevicePresetMode = VL53L1_DEVICEPRESETMODE_STANDARD_RANGING;
+
+	switch (DistanceMode) {
+	case VL53L1_DISTANCEMODE_SHORT:
+		DistIdx = 0;
+		break;
+	case VL53L1_DISTANCEMODE_MEDIUM:
+		DistIdx = 1;
+		break;
+	default:
+		DistIdx = 2;
+	}
+
+	switch (PresetMode) {
+	case VL53L1_PRESETMODE_LITE_RANGING:
+		*pDevicePresetMode = LightModes[DistIdx];
+		break;
+
+	case VL53L1_PRESETMODE_RANGING:
+		*pDevicePresetMode = RangingModes[DistIdx];
+		break;
+
+	case VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+		*pDevicePresetMode = ScanningModes[DistIdx];
+		break;
+
+	case VL53L1_PRESETMODE_AUTONOMOUS:
+		*pDevicePresetMode = TimedModes[DistIdx];
+		break;
+
+	case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+		*pDevicePresetMode = LowPowerTimedModes[DistIdx];
+		break;
+	case VL53L1_PRESETMODE_OLT:
+		*pDevicePresetMode = VL53L1_DEVICEPRESETMODE_OLT;
+		break;
+	case VL53L1_PRESETMODE_PROXY_RANGING_MODE:
+		*pDevicePresetMode =
+			VL53L1_DEVICEPRESETMODE_SPECIAL_HISTOGRAM_SHORT_RANGE;
+		break;
+
+	default:
+
+
+		Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+	}
+
+	return Status;
+}
+
+static VL53L1_Error SetPresetMode(VL53L1_DEV Dev,
+		VL53L1_PresetModes PresetMode,
+		VL53L1_DistanceModes DistanceMode,
+		uint32_t inter_measurement_period_ms)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_DevicePresetModes   device_preset_mode;
+	uint8_t measurement_mode;
+	uint16_t dss_config__target_total_rate_mcps;
+	uint32_t phasecal_config_timeout_us;
+	uint32_t mm_config_timeout_us;
+	uint32_t lld_range_config_timeout_us;
+
+	LOG_FUNCTION_START("%d", (int)PresetMode);
+
+	if ((PresetMode == VL53L1_PRESETMODE_AUTONOMOUS) ||
+		(PresetMode == VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS))
+		measurement_mode  = VL53L1_DEVICEMEASUREMENTMODE_TIMED;
+	else
+		measurement_mode  = VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+
+
+	Status = ComputeDevicePresetMode(PresetMode, DistanceMode,
+			&device_preset_mode);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status =  VL53L1_get_preset_mode_timing_cfg(Dev,
+				device_preset_mode,
+				&dss_config__target_total_rate_mcps,
+				&phasecal_config_timeout_us,
+				&mm_config_timeout_us,
+				&lld_range_config_timeout_us);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_set_preset_mode(
+				Dev,
+				device_preset_mode,
+				dss_config__target_total_rate_mcps,
+				phasecal_config_timeout_us,
+				mm_config_timeout_us,
+				lld_range_config_timeout_us,
+				inter_measurement_period_ms);
+
+	if (Status == VL53L1_ERROR_NONE)
+		VL53L1DevDataSet(Dev, LLData.measurement_mode,
+				measurement_mode);
+
+	if (Status == VL53L1_ERROR_NONE)
+		VL53L1DevDataSet(Dev, CurrentParameters.PresetMode, PresetMode);
+
+	VL53L1DevDataSet(Dev, CurrentParameters.OutputMode,
+			VL53L1_OUTPUTMODE_NEAREST);
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetPresetMode(VL53L1_DEV Dev, VL53L1_PresetModes PresetMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_DistanceModes DistanceMode = VL53L1_DISTANCEMODE_LONG;
+
+	LOG_FUNCTION_START("%d", (int)PresetMode);
+
+
+
+	Status = VL53L1_low_power_auto_data_init(Dev);
+
+	if (PresetMode == VL53L1_PRESETMODE_PROXY_RANGING_MODE)
+		DistanceMode = VL53L1_DISTANCEMODE_SHORT;
+	Status = SetPresetMode(Dev,
+			PresetMode,
+			DistanceMode,
+			1000);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		if ((PresetMode == VL53L1_PRESETMODE_LITE_RANGING) ||
+			(PresetMode == VL53L1_PRESETMODE_AUTONOMOUS) ||
+			(PresetMode == VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS))
+			Status = VL53L1_SetMeasurementTimingBudgetMicroSeconds(
+				Dev, 41000);
+		else
+
+
+			Status = VL53L1_SetMeasurementTimingBudgetMicroSeconds(
+				Dev, 33333);
+	}
+
+	if (Status == VL53L1_ERROR_NONE) {
+
+
+		Status = VL53L1_SetInterMeasurementPeriodMilliSeconds(Dev,
+				1000);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetPresetMode(VL53L1_DEV Dev,
+	VL53L1_PresetModes *pPresetMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	*pPresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetDistanceMode(VL53L1_DEV Dev,
+		VL53L1_DistanceModes DistanceMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_PresetModes PresetMode;
+	uint32_t inter_measurement_period_ms;
+	uint32_t TimingBudget;
+	uint32_t MmTimeoutUs;
+	uint32_t PhaseCalTimeoutUs;
+	VL53L1_zone_config_t zone_config;
+
+	LOG_FUNCTION_START("%d", (int)DistanceMode);
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+
+
+
+
+
+
+	if ((PresetMode == VL53L1_PRESETMODE_PROXY_RANGING_MODE) &&
+		(DistanceMode != VL53L1_DISTANCEMODE_SHORT))
+		return VL53L1_ERROR_INVALID_PARAMS;
+	if ((DistanceMode != VL53L1_DISTANCEMODE_SHORT) &&
+		(DistanceMode != VL53L1_DISTANCEMODE_MEDIUM) &&
+		(DistanceMode != VL53L1_DISTANCEMODE_LONG))
+		return VL53L1_ERROR_INVALID_PARAMS;
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_get_zone_config(Dev, &zone_config);
+
+	inter_measurement_period_ms =  VL53L1DevDataGet(Dev,
+				LLData.inter_measurement_period_ms);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_get_timeouts_us(Dev, &PhaseCalTimeoutUs,
+			&MmTimeoutUs, &TimingBudget);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = SetPresetMode(Dev,
+				PresetMode,
+				DistanceMode,
+				inter_measurement_period_ms);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		VL53L1DevDataSet(Dev, CurrentParameters.DistanceMode,
+				DistanceMode);
+	}
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_set_timeouts_us(Dev, PhaseCalTimeoutUs,
+			MmTimeoutUs, TimingBudget);
+
+		if (Status == VL53L1_ERROR_NONE)
+			VL53L1DevDataSet(Dev, LLData.range_config_timeout_us,
+				TimingBudget);
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_set_zone_config(Dev, &zone_config);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetDistanceMode(VL53L1_DEV Dev,
+	VL53L1_DistanceModes *pDistanceMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	*pDistanceMode = VL53L1DevDataGet(Dev, CurrentParameters.DistanceMode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetOutputMode(VL53L1_DEV Dev,
+		VL53L1_OutputModes OutputMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if ((OutputMode != VL53L1_OUTPUTMODE_NEAREST) &&
+		(OutputMode != VL53L1_OUTPUTMODE_STRONGEST))
+		Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+	else
+		VL53L1DevDataSet(Dev, CurrentParameters.OutputMode, OutputMode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetOutputMode(VL53L1_DEV Dev,
+		VL53L1_OutputModes *pOutputMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	*pOutputMode = VL53L1DevDataGet(Dev, CurrentParameters.OutputMode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+VL53L1_Error VL53L1_SetMeasurementTimingBudgetMicroSeconds(VL53L1_DEV Dev,
+	uint32_t MeasurementTimingBudgetMicroSeconds)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t Mm1Enabled;
+	uint8_t Mm2Enabled;
+	uint32_t TimingGuard;
+	uint32_t divisor;
+	uint32_t TimingBudget;
+	uint32_t MmTimeoutUs;
+	VL53L1_PresetModes PresetMode;
+	uint32_t PhaseCalTimeoutUs;
+	uint32_t vhv;
+	int32_t vhv_loops;
+	uint32_t FDAMaxTimingBudgetUs = FDA_MAX_TIMING_BUDGET_US;
+
+	LOG_FUNCTION_START("");
+
+
+
+	if (MeasurementTimingBudgetMicroSeconds > 10000000)
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_GetSequenceStepEnable(Dev,
+			VL53L1_SEQUENCESTEP_MM1, &Mm1Enabled);
+	}
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_GetSequenceStepEnable(Dev,
+			VL53L1_SEQUENCESTEP_MM2, &Mm2Enabled);
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_get_timeouts_us(Dev,
+			&PhaseCalTimeoutUs,
+			&MmTimeoutUs,
+			&TimingBudget);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		PresetMode = VL53L1DevDataGet(Dev,
+				CurrentParameters.PresetMode);
+
+		TimingGuard = 0;
+		divisor = 1;
+		switch (PresetMode) {
+		case VL53L1_PRESETMODE_LITE_RANGING:
+			if ((Mm1Enabled == 1) || (Mm2Enabled == 1))
+				TimingGuard = 5000;
+			else
+				TimingGuard = 1000;
+		break;
+
+		case VL53L1_PRESETMODE_AUTONOMOUS:
+			FDAMaxTimingBudgetUs *= 2;
+			if ((Mm1Enabled == 1) || (Mm2Enabled == 1))
+				TimingGuard = 26600;
+			else
+				TimingGuard = 21600;
+			divisor = 2;
+		break;
+
+		case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+			FDAMaxTimingBudgetUs *= 2;
+			vhv = LOWPOWER_AUTO_VHV_LOOP_DURATION_US;
+			VL53L1_get_tuning_parm(Dev,
+				VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND,
+				&vhv_loops);
+			if (vhv_loops > 0) {
+				vhv += vhv_loops *
+					LOWPOWER_AUTO_VHV_LOOP_DURATION_US;
+			}
+			TimingGuard = LOWPOWER_AUTO_OVERHEAD_BEFORE_A_RANGING +
+				LOWPOWER_AUTO_OVERHEAD_BETWEEN_A_B_RANGING +
+				vhv;
+			divisor = 2;
+		break;
+
+		case VL53L1_PRESETMODE_RANGING:
+		case VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+		case VL53L1_PRESETMODE_PROXY_RANGING_MODE:
+			TimingGuard = 1700;
+			divisor = 6;
+		break;
+
+		case VL53L1_PRESETMODE_OLT:
+			TimingGuard = MmTimeoutUs + 5000;
+		break;
+		default:
+
+
+			Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+		}
+
+		if (MeasurementTimingBudgetMicroSeconds <= TimingGuard)
+			Status = VL53L1_ERROR_INVALID_PARAMS;
+		else {
+			TimingBudget = (MeasurementTimingBudgetMicroSeconds
+					- TimingGuard);
+		}
+
+		if (Status == VL53L1_ERROR_NONE) {
+			if (TimingBudget > FDAMaxTimingBudgetUs)
+				Status = VL53L1_ERROR_INVALID_PARAMS;
+			else {
+				TimingBudget /= divisor;
+				Status = VL53L1_set_timeouts_us(
+					Dev,
+					PhaseCalTimeoutUs,
+					MmTimeoutUs,
+					TimingBudget);
+			}
+
+			if (Status == VL53L1_ERROR_NONE)
+				VL53L1DevDataSet(Dev,
+					LLData.range_config_timeout_us,
+					TimingBudget);
+		}
+	}
+	if (Status == VL53L1_ERROR_NONE) {
+		VL53L1DevDataSet(Dev,
+			CurrentParameters.MeasurementTimingBudgetMicroSeconds,
+			MeasurementTimingBudgetMicroSeconds);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetMeasurementTimingBudgetMicroSeconds(VL53L1_DEV Dev,
+	uint32_t *pMeasurementTimingBudgetMicroSeconds)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t Mm1Enabled = 0;
+	uint8_t Mm2Enabled = 0;
+	uint32_t  MmTimeoutUs = 0;
+	uint32_t  RangeTimeoutUs = 0;
+	uint32_t  MeasTimingBdg = 0;
+	uint32_t PhaseCalTimeoutUs = 0;
+	VL53L1_PresetModes PresetMode;
+	uint32_t TimingGuard;
+	uint32_t vhv;
+	int32_t vhv_loops;
+
+	LOG_FUNCTION_START("");
+
+	*pMeasurementTimingBudgetMicroSeconds = 0;
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_GetSequenceStepEnable(Dev,
+			VL53L1_SEQUENCESTEP_MM1, &Mm1Enabled);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_GetSequenceStepEnable(Dev,
+			VL53L1_SEQUENCESTEP_MM2, &Mm2Enabled);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_get_timeouts_us(Dev,
+			&PhaseCalTimeoutUs,
+			&MmTimeoutUs,
+			&RangeTimeoutUs);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		PresetMode = VL53L1DevDataGet(Dev,
+				CurrentParameters.PresetMode);
+
+		switch (PresetMode) {
+		case VL53L1_PRESETMODE_LITE_RANGING:
+			if ((Mm1Enabled == 1) || (Mm2Enabled == 1))
+				MeasTimingBdg = RangeTimeoutUs + 5000;
+			else
+				MeasTimingBdg = RangeTimeoutUs + 1000;
+
+		break;
+
+		case VL53L1_PRESETMODE_AUTONOMOUS:
+			if ((Mm1Enabled == 1) || (Mm2Enabled == 1))
+				MeasTimingBdg = 2 * RangeTimeoutUs + 26600;
+			else
+				MeasTimingBdg = 2 * RangeTimeoutUs + 21600;
+
+		break;
+
+		case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+			vhv = LOWPOWER_AUTO_VHV_LOOP_DURATION_US;
+			VL53L1_get_tuning_parm(Dev,
+				VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND,
+				&vhv_loops);
+			if (vhv_loops > 0) {
+				vhv += vhv_loops *
+					LOWPOWER_AUTO_VHV_LOOP_DURATION_US;
+			}
+			TimingGuard = LOWPOWER_AUTO_OVERHEAD_BEFORE_A_RANGING +
+				LOWPOWER_AUTO_OVERHEAD_BETWEEN_A_B_RANGING +
+				vhv;
+			MeasTimingBdg = 2 * RangeTimeoutUs + TimingGuard;
+		break;
+
+		case VL53L1_PRESETMODE_RANGING:
+		case VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+		case VL53L1_PRESETMODE_PROXY_RANGING_MODE:
+			MeasTimingBdg = (6 * RangeTimeoutUs) + 1700;
+		break;
+
+		case VL53L1_PRESETMODE_OLT:
+			MeasTimingBdg = RangeTimeoutUs + MmTimeoutUs + 5000;
+		break;
+		default:
+
+
+			Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+		}
+	}
+	if (Status == VL53L1_ERROR_NONE)
+		*pMeasurementTimingBudgetMicroSeconds = MeasTimingBdg;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+VL53L1_Error VL53L1_SetInterMeasurementPeriodMilliSeconds(VL53L1_DEV Dev,
+	uint32_t InterMeasurementPeriodMilliSeconds)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint32_t adjustedIMP;
+
+	LOG_FUNCTION_START("");
+
+
+
+	adjustedIMP = InterMeasurementPeriodMilliSeconds;
+	adjustedIMP += (adjustedIMP * 64) / 1000;
+
+
+	Status = VL53L1_set_inter_measurement_period_ms(Dev,
+			adjustedIMP);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetInterMeasurementPeriodMilliSeconds(VL53L1_DEV Dev,
+	uint32_t *pInterMeasurementPeriodMilliSeconds)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint32_t adjustedIMP;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_inter_measurement_period_ms(Dev, &adjustedIMP);
+
+
+	adjustedIMP -= (adjustedIMP * 64) / 1000;
+	*pInterMeasurementPeriodMilliSeconds = adjustedIMP;
+
+
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetDmaxReflectance(VL53L1_DEV Dev,
+		FixPoint1616_t DmaxReflectance)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_dmax_reflectance_array_t dmax_reflectances;
+
+	LOG_FUNCTION_START("");
+
+	if (DmaxReflectance > 100*65536)
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_get_dmax_reflectance_values(Dev,
+				&dmax_reflectances);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		dmax_reflectances.target_reflectance_for_dmax[
+			DMAX_REFLECTANCE_IDX] =
+			VL53L1_FIXPOINT1616TOFIXPOINT72(DmaxReflectance);
+		Status = VL53L1_set_dmax_reflectance_values(Dev,
+				&dmax_reflectances);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetDmaxReflectance(VL53L1_DEV Dev,
+		FixPoint1616_t *pDmaxReflectance)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_dmax_reflectance_array_t dmax_reflectances;
+	uint16_t r;
+
+	LOG_FUNCTION_START("");
+	Status = VL53L1_get_dmax_reflectance_values(Dev, &dmax_reflectances);
+	if (Status == VL53L1_ERROR_NONE) {
+		r = dmax_reflectances.target_reflectance_for_dmax[
+							DMAX_REFLECTANCE_IDX];
+		*pDmaxReflectance = VL53L1_FIXPOINT72TOFIXPOINT1616(r);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_SetDmaxMode(VL53L1_DEV Dev,
+		VL53L1_DeviceDmaxModes DmaxMode)
+{
+
+	VL53L1_Error  Status = VL53L1_ERROR_NONE;
+	VL53L1_DeviceDmaxMode dmax_mode;
+
+	LOG_FUNCTION_START("");
+
+	switch (DmaxMode) {
+	case VL53L1_DMAXMODE_FMT_CAL_DATA:
+		dmax_mode = VL53L1_DEVICEDMAXMODE__FMT_CAL_DATA;
+		break;
+	case VL53L1_DMAXMODE_CUSTCAL_DATA:
+		dmax_mode = VL53L1_DEVICEDMAXMODE__CUST_CAL_DATA;
+		break;
+	case VL53L1_DMAXMODE_PER_ZONE_CAL_DATA:
+		dmax_mode = VL53L1_DEVICEDMAXMODE__PER_ZONE_CAL_DATA;
+		break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+		break;
+	}
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_set_dmax_mode(Dev, dmax_mode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetDmaxMode(VL53L1_DEV Dev,
+	VL53L1_DeviceDmaxModes *pDmaxMode)
+{
+	VL53L1_Error  Status = VL53L1_ERROR_NONE;
+	VL53L1_DeviceDmaxMode dmax_mode;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_dmax_mode(Dev, &dmax_mode);
+	if (Status == VL53L1_ERROR_NONE) {
+		switch (dmax_mode) {
+		case VL53L1_DEVICEDMAXMODE__FMT_CAL_DATA:
+			*pDmaxMode = VL53L1_DMAXMODE_FMT_CAL_DATA;
+			break;
+		case VL53L1_DEVICEDMAXMODE__CUST_CAL_DATA:
+			*pDmaxMode = VL53L1_DMAXMODE_CUSTCAL_DATA;
+			break;
+		case VL53L1_DEVICEDMAXMODE__PER_ZONE_CAL_DATA:
+			*pDmaxMode = VL53L1_DMAXMODE_PER_ZONE_CAL_DATA;
+			break;
+		default:
+
+
+			*pDmaxMode = VL53L1_ERROR_NOT_IMPLEMENTED;
+			break;
+		}
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_GetNumberOfLimitCheck(uint16_t *pNumberOfLimitCheck)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	*pNumberOfLimitCheck = VL53L1_CHECKENABLE_NUMBER_OF_CHECKS;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetLimitCheckInfo(uint16_t LimitCheckId,
+	char *pLimitCheckString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_limit_check_info(LimitCheckId,
+		pLimitCheckString);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetLimitCheckStatus(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	uint8_t *pLimitCheckStatus)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t Temp8;
+
+	LOG_FUNCTION_START("");
+
+	if (LimitCheckId >= VL53L1_CHECKENABLE_NUMBER_OF_CHECKS) {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	} else {
+		VL53L1_GETARRAYPARAMETERFIELD(Dev, LimitChecksStatus,
+			LimitCheckId, Temp8);
+		*pLimitCheckStatus = Temp8;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+static VL53L1_Error SetLimitValue(VL53L1_DEV Dev, uint16_t LimitCheckId,
+		FixPoint1616_t value)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint16_t tmpuint16;
+
+
+	LOG_FUNCTION_START("");
+
+	switch (LimitCheckId) {
+	case VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE:
+		tmpuint16 = VL53L1_FIXPOINT1616TOFIXPOINT142(value);
+		VL53L1_set_lite_sigma_threshold(Dev, tmpuint16);
+		break;
+	case VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE:
+		tmpuint16 = VL53L1_FIXPOINT1616TOFIXPOINT97(value);
+		VL53L1_set_lite_min_count_rate(Dev, tmpuint16);
+		break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_SetLimitCheckEnable(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	uint8_t LimitCheckEnable)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	FixPoint1616_t TempFix1616 = 0;
+
+	LOG_FUNCTION_START("");
+
+
+	if (LimitCheckId >= VL53L1_CHECKENABLE_NUMBER_OF_CHECKS) {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	} else {
+
+
+		if (LimitCheckEnable == 0)
+			TempFix1616 = 0;
+		else
+			VL53L1_GETARRAYPARAMETERFIELD(Dev, LimitChecksValue,
+				LimitCheckId, TempFix1616);
+
+		Status = SetLimitValue(Dev, LimitCheckId, TempFix1616);
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		VL53L1_SETARRAYPARAMETERFIELD(Dev,
+			LimitChecksEnable,
+			LimitCheckId,
+			((LimitCheckEnable == 0) ? 0 : 1));
+
+
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetLimitCheckEnable(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	uint8_t *pLimitCheckEnable)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t Temp8;
+
+	LOG_FUNCTION_START("");
+
+	if (LimitCheckId >= VL53L1_CHECKENABLE_NUMBER_OF_CHECKS) {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+		*pLimitCheckEnable = 0;
+	} else {
+		VL53L1_GETARRAYPARAMETERFIELD(Dev, LimitChecksEnable,
+			LimitCheckId, Temp8);
+		*pLimitCheckEnable = Temp8;
+	}
+
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetLimitCheckValue(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	FixPoint1616_t LimitCheckValue)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t LimitChecksEnable;
+
+	LOG_FUNCTION_START("");
+
+	if (LimitCheckId >= VL53L1_CHECKENABLE_NUMBER_OF_CHECKS) {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	} else {
+
+		VL53L1_GETARRAYPARAMETERFIELD(Dev, LimitChecksEnable,
+				LimitCheckId,
+				LimitChecksEnable);
+
+		if (LimitChecksEnable == 0) {
+
+
+			VL53L1_SETARRAYPARAMETERFIELD(Dev, LimitChecksValue,
+				LimitCheckId, LimitCheckValue);
+		} else {
+
+			Status = SetLimitValue(Dev, LimitCheckId,
+					LimitCheckValue);
+
+			if (Status == VL53L1_ERROR_NONE) {
+				VL53L1_SETARRAYPARAMETERFIELD(Dev,
+					LimitChecksValue,
+					LimitCheckId, LimitCheckValue);
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetLimitCheckValue(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	FixPoint1616_t *pLimitCheckValue)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint16_t MinCountRate;
+	FixPoint1616_t TempFix1616;
+	uint16_t SigmaThresh;
+
+	LOG_FUNCTION_START("");
+
+	switch (LimitCheckId) {
+	case VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE:
+		Status = VL53L1_get_lite_sigma_threshold(Dev, &SigmaThresh);
+		TempFix1616 = VL53L1_FIXPOINT142TOFIXPOINT1616(SigmaThresh);
+		break;
+	case VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE:
+		Status = VL53L1_get_lite_min_count_rate(Dev, &MinCountRate);
+		TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(MinCountRate);
+		break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	if (Status == VL53L1_ERROR_NONE) {
+
+		if (TempFix1616 == 0) {
+
+
+			VL53L1_GETARRAYPARAMETERFIELD(Dev,
+				LimitChecksValue, LimitCheckId,
+				TempFix1616);
+			*pLimitCheckValue = TempFix1616;
+			VL53L1_SETARRAYPARAMETERFIELD(Dev,
+				LimitChecksEnable, LimitCheckId, 0);
+		} else {
+			*pLimitCheckValue = TempFix1616;
+			VL53L1_SETARRAYPARAMETERFIELD(Dev,
+				LimitChecksValue, LimitCheckId,
+				TempFix1616);
+			VL53L1_SETARRAYPARAMETERFIELD(Dev,
+				LimitChecksEnable, LimitCheckId, 1);
+		}
+	}
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+VL53L1_Error VL53L1_GetLimitCheckCurrent(VL53L1_DEV Dev, uint16_t LimitCheckId,
+	FixPoint1616_t *pLimitCheckCurrent)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	FixPoint1616_t TempFix1616 = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (LimitCheckId >= VL53L1_CHECKENABLE_NUMBER_OF_CHECKS) {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	} else {
+		VL53L1_GETARRAYPARAMETERFIELD(Dev, LimitChecksCurrent,
+			LimitCheckId, TempFix1616);
+		*pLimitCheckCurrent = TempFix1616;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_GetMaxNumberOfROI(VL53L1_DEV Dev,
+	uint8_t *pMaxNumberOfROI)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_PresetModes PresetMode;
+
+	LOG_FUNCTION_START("");
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+
+
+	if (PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING)
+		*pMaxNumberOfROI = VL53L1_MAX_USER_ZONES;
+	else
+		*pMaxNumberOfROI = 1;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetROI(VL53L1_DEV Dev,
+		VL53L1_RoiConfig_t *pRoiConfig)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_PresetModes PresetMode;
+	uint8_t MaxNumberOfROI = 1;
+	VL53L1_zone_config_t  zone_cfg;
+	VL53L1_UserRoi_t CurrROI;
+	uint8_t  i;
+	uint8_t  x_centre;
+	uint8_t  y_centre;
+	uint8_t  width, height;
+
+	LOG_FUNCTION_START("");
+
+
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+
+
+	if (PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING)
+		MaxNumberOfROI = VL53L1_MAX_USER_ZONES;
+
+	if ((pRoiConfig->NumberOfRoi > MaxNumberOfROI) ||
+			(pRoiConfig->NumberOfRoi < 1))
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+
+	if (Status == VL53L1_ERROR_NONE) {
+
+
+
+		zone_cfg.max_zones = MaxNumberOfROI;
+		zone_cfg.active_zones = pRoiConfig->NumberOfRoi - 1;
+
+		for (i = 0; i < pRoiConfig->NumberOfRoi; i++) {
+			CurrROI = pRoiConfig->UserRois[i];
+
+
+
+
+
+
+
+
+
+			Status = CheckValidRectRoi(CurrROI);
+			if (Status != VL53L1_ERROR_NONE)
+				break;
+
+			x_centre = (CurrROI.BotRightX + CurrROI.TopLeftX  + 1)
+					/ 2;
+			y_centre = (CurrROI.TopLeftY  + CurrROI.BotRightY + 1)
+					/ 2;
+			width =     (CurrROI.BotRightX - CurrROI.TopLeftX);
+			height =    (CurrROI.TopLeftY  - CurrROI.BotRightY);
+			if ((width < 3) || (height < 3)) {
+				Status = VL53L1_ERROR_INVALID_PARAMS;
+				break;
+			}
+			zone_cfg.user_zones[i].x_centre = x_centre;
+			zone_cfg.user_zones[i].y_centre = y_centre;
+			zone_cfg.user_zones[i].width = width;
+			zone_cfg.user_zones[i].height = height;
+		}
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_set_zone_config(Dev, &zone_cfg);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetROI(VL53L1_DEV Dev,
+		VL53L1_RoiConfig_t *pRoiConfig)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_zone_config_t      zone_cfg;
+	uint8_t  i;
+	uint8_t  TopLeftX;
+	uint8_t  TopLeftY;
+	uint8_t  BotRightX;
+	uint8_t  BotRightY;
+
+	LOG_FUNCTION_START("");
+
+	VL53L1_get_zone_config(Dev, &zone_cfg);
+
+	pRoiConfig->NumberOfRoi = zone_cfg.active_zones + 1;
+
+	for (i = 0; i < pRoiConfig->NumberOfRoi; i++) {
+		TopLeftX = (2 * zone_cfg.user_zones[i].x_centre -
+			zone_cfg.user_zones[i].width) >> 1;
+		TopLeftY = (2 * zone_cfg.user_zones[i].y_centre +
+			zone_cfg.user_zones[i].height) >> 1;
+		BotRightX = (2 * zone_cfg.user_zones[i].x_centre +
+			zone_cfg.user_zones[i].width) >> 1;
+		BotRightY = (2 * zone_cfg.user_zones[i].y_centre -
+			zone_cfg.user_zones[i].height) >> 1;
+		pRoiConfig->UserRois[i].TopLeftX = TopLeftX;
+		pRoiConfig->UserRois[i].TopLeftY = TopLeftY;
+		pRoiConfig->UserRois[i].BotRightX = BotRightX;
+		pRoiConfig->UserRois[i].BotRightY = BotRightY;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_GetNumberOfSequenceSteps(VL53L1_DEV Dev,
+	uint8_t *pNumberOfSequenceSteps)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	SUPPRESS_UNUSED_WARNING(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pNumberOfSequenceSteps = VL53L1_SEQUENCESTEP_NUMBER_OF_ITEMS;
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetSequenceStepsInfo(VL53L1_SequenceStepId SequenceStepId,
+	char *pSequenceStepsString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_sequence_steps_info(
+			SequenceStepId,
+			pSequenceStepsString);
+
+	LOG_FUNCTION_END(Status);
+
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetSequenceStepEnable(VL53L1_DEV Dev,
+	VL53L1_SequenceStepId SequenceStepId, uint8_t SequenceStepEnabled)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint32_t MeasurementTimingBudgetMicroSeconds;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	Status = VL53L1_set_sequence_config_bit(Dev,
+		(VL53L1_DeviceSequenceConfig)SequenceStepId,
+		SequenceStepEnabled);
+
+
+
+	if (Status == VL53L1_ERROR_NONE) {
+
+
+
+		MeasurementTimingBudgetMicroSeconds = VL53L1DevDataGet(Dev,
+			CurrentParameters.MeasurementTimingBudgetMicroSeconds);
+
+		VL53L1_SetMeasurementTimingBudgetMicroSeconds(Dev,
+			MeasurementTimingBudgetMicroSeconds);
+	}
+
+	LOG_FUNCTION_END(Status);
+
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetSequenceStepEnable(VL53L1_DEV Dev,
+	VL53L1_SequenceStepId SequenceStepId, uint8_t *pSequenceStepEnabled)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_sequence_config_bit(Dev,
+		(VL53L1_DeviceSequenceConfig)SequenceStepId,
+		pSequenceStepEnabled);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_StartMeasurement(VL53L1_DEV Dev)
+{
+#define TIMED_MODE_TIMING_GUARD_MILLISECONDS 4
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t DeviceMeasurementMode;
+	VL53L1_State CurrPalState;
+	VL53L1_Error lStatus;
+	uint32_t MTBus, IMPms;
+
+	LOG_FUNCTION_START("");
+
+	CurrPalState = VL53L1DevDataGet(Dev, PalState);
+	switch (CurrPalState) {
+	case VL53L1_STATE_IDLE:
+		Status = VL53L1_ERROR_NONE;
+		break;
+	case VL53L1_STATE_POWERDOWN:
+	case VL53L1_STATE_WAIT_STATICINIT:
+	case VL53L1_STATE_STANDBY:
+	case VL53L1_STATE_RUNNING:
+	case VL53L1_STATE_RESET:
+	case VL53L1_STATE_UNKNOWN:
+	case VL53L1_STATE_ERROR:
+		Status = VL53L1_ERROR_INVALID_COMMAND;
+		break;
+	default:
+		Status = VL53L1_ERROR_UNDEFINED;
+	}
+
+	DeviceMeasurementMode = VL53L1DevDataGet(Dev, LLData.measurement_mode);
+
+
+
+
+	if ((Status == VL53L1_ERROR_NONE) &&
+		(DeviceMeasurementMode == VL53L1_DEVICEMEASUREMENTMODE_TIMED)) {
+		lStatus = VL53L1_GetMeasurementTimingBudgetMicroSeconds(Dev,
+				&MTBus);
+
+
+		MTBus /= 1000;
+		lStatus = VL53L1_GetInterMeasurementPeriodMilliSeconds(Dev,
+				&IMPms);
+
+
+		SUPPRESS_UNUSED_WARNING(lStatus);
+		if (IMPms < MTBus + TIMED_MODE_TIMING_GUARD_MILLISECONDS)
+			Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status = VL53L1_init_and_start_range(
+				Dev,
+				DeviceMeasurementMode,
+				VL53L1_DEVICECONFIGLEVEL_FULL);
+
+
+
+	if (Status == VL53L1_ERROR_NONE)
+		VL53L1DevDataSet(Dev, PalState, VL53L1_STATE_RUNNING);
+
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_StopMeasurement(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_stop_range(Dev);
+
+
+
+	if (Status == VL53L1_ERROR_NONE)
+		VL53L1DevDataSet(Dev, PalState, VL53L1_STATE_IDLE);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_ClearInterruptAndStartMeasurement(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t DeviceMeasurementMode;
+
+	LOG_FUNCTION_START("");
+
+	DeviceMeasurementMode = VL53L1DevDataGet(Dev, LLData.measurement_mode);
+
+	Status = VL53L1_clear_interrupt_and_enable_next_range(Dev,
+			DeviceMeasurementMode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetMeasurementDataReady(VL53L1_DEV Dev,
+	uint8_t *pMeasurementDataReady)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_is_new_data_ready(Dev, pMeasurementDataReady);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_WaitMeasurementDataReady(VL53L1_DEV Dev)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	Status = VL53L1_poll_for_range_completion(Dev,
+			VL53L1_RANGE_COMPLETION_POLLING_TIMEOUT_MS);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+static void GenNewPresetMode(int16_t RefRange,
+		VL53L1_DistanceModes InternalDistanceMode,
+		VL53L1_DistanceModes *pNewDistanceMode)
+{
+	uint16_t HRLI = 600;
+	uint16_t HRLH = 700;
+	uint16_t MRLI = 1400;
+	uint16_t MRLH = 1500;
+
+	switch (InternalDistanceMode) {
+	case VL53L1_DISTANCEMODE_SHORT:
+
+
+
+
+
+		if (RefRange > MRLH)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_LONG;
+		else if (RefRange > HRLH)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_MEDIUM;
+		break;
+	case VL53L1_DISTANCEMODE_MEDIUM:
+
+
+
+
+
+		if (RefRange > MRLH)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_LONG;
+		else if (RefRange < HRLI)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_SHORT;
+		break;
+	default:
+
+
+
+
+
+
+		if (RefRange < HRLI)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_SHORT;
+		else if (RefRange < MRLI)
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_MEDIUM;
+		break;
+	}
+}
+
+static void CheckAndChangeDistanceMode(VL53L1_DEV Dev,
+		VL53L1_TargetRangeData_t *pRangeData,
+		int16_t Ambient100DmaxMm,
+		VL53L1_DistanceModes *pNewDistanceMode
+)
+{
+	VL53L1_DistanceModes DistanceMode;
+	uint8_t RangeStatus = pRangeData->RangeStatus;
+	uint8_t DmaxValid;
+	int32_t MinAmbient = BDTable[VL53L1_TUNING_MIN_AMBIENT_DMAX_VALID];
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	int32_t  tmpint32;
+
+
+
+	switch (RangeStatus) {
+	case VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL:
+	case VL53L1_RANGESTATUS_WRAP_TARGET_FAIL:
+	case VL53L1_RANGESTATUS_RANGE_VALID_MERGED_PULSE:
+	case VL53L1_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL:
+	case VL53L1_RANGESTATUS_SYNCRONISATION_INT:
+	case VL53L1_RANGESTATUS_NONE:
+		return;
+	default:
+
+
+		break;
+	}
+
+	DmaxValid = 1;
+	tmpint32 = pdev->hist_data.VL53L1_p_004;
+	if (tmpint32 < MinAmbient)
+		DmaxValid = 0;
+
+	DistanceMode = VL53L1DevDataGet(Dev,
+			CurrentParameters.DistanceMode);
+
+	*pNewDistanceMode = DistanceMode;
+
+	if (RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID)
+		GenNewPresetMode(pRangeData->RangeMilliMeter,
+				DistanceMode, pNewDistanceMode);
+	else {
+		if (DmaxValid)
+			GenNewPresetMode(Ambient100DmaxMm,
+					DistanceMode, pNewDistanceMode);
+		else
+			*pNewDistanceMode = VL53L1_DISTANCEMODE_LONG;
+	}
+}
+
+static uint8_t ComputeRQL(uint8_t active_results,
+		uint8_t FilteredRangeStatus,
+		VL53L1_range_data_t *presults_data)
+{
+	int16_t T_Wide = 150;
+	int16_t SRL = 300;
+	uint16_t SRAS = 30;
+	FixPoint1616_t RAS;
+	FixPoint1616_t SRQL;
+	FixPoint1616_t GI =   7713587;
+
+	FixPoint1616_t GGm =  3198157;
+
+	FixPoint1616_t LRAP = 6554;
+
+	FixPoint1616_t partial;
+	uint8_t finalvalue;
+	uint8_t returnvalue;
+
+	if (active_results == 0)
+		returnvalue = 0;
+	else if (((presults_data->max_range_mm -
+			presults_data->min_range_mm) >= T_Wide) ||
+		(FilteredRangeStatus == VL53L1_DEVICEERROR_PHASECONSISTENCY))
+		returnvalue = 50;
+	else {
+		if (presults_data->median_range_mm < SRL)
+			RAS = SRAS * 65536;
+		else
+			RAS = LRAP * presults_data->median_range_mm;
+
+
+
+		if (RAS != 0) {
+			partial = (GGm * presults_data->VL53L1_p_005);
+			partial = partial + (RAS >> 1);
+			partial = partial / RAS;
+			partial = partial * 65536;
+			if (partial <= GI)
+				SRQL = GI - partial;
+			else
+				SRQL = 50 * 65536;
+		} else
+			SRQL = 100 * 65536;
+
+		finalvalue = (uint8_t)(SRQL >> 16);
+		returnvalue = MAX(50, MIN(100, finalvalue));
+	}
+
+	return returnvalue;
+}
+
+
+static uint8_t ConvertStatusLite(uint8_t FilteredRangeStatus)
+{
+	uint8_t RangeStatus;
+
+	switch (FilteredRangeStatus) {
+	case VL53L1_DEVICEERROR_GPHSTREAMCOUNT0READY:
+		RangeStatus = VL53L1_RANGESTATUS_SYNCRONISATION_INT;
+		break;
+	case VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_RANGEPHASECHECK:
+		RangeStatus = VL53L1_RANGESTATUS_OUTOFBOUNDS_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_MSRCNOTARGET:
+		RangeStatus = VL53L1_RANGESTATUS_SIGNAL_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_SIGMATHRESHOLDCHECK:
+		RangeStatus = VL53L1_RANGESTATUS_SIGMA_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_PHASECONSISTENCY:
+		RangeStatus = VL53L1_RANGESTATUS_WRAP_TARGET_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_RANGEIGNORETHRESHOLD:
+		RangeStatus = VL53L1_RANGESTATUS_XTALK_SIGNAL_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_MINCLIP:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID_MIN_RANGE_CLIPPED;
+		break;
+	case VL53L1_DEVICEERROR_RANGECOMPLETE:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID;
+		break;
+	default:
+		RangeStatus = VL53L1_RANGESTATUS_NONE;
+	}
+
+	return RangeStatus;
+}
+
+
+static uint8_t ConvertStatusHisto(uint8_t FilteredRangeStatus)
+{
+	uint8_t RangeStatus;
+
+	switch (FilteredRangeStatus) {
+	case VL53L1_DEVICEERROR_RANGEPHASECHECK:
+		RangeStatus = VL53L1_RANGESTATUS_OUTOFBOUNDS_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_SIGMATHRESHOLDCHECK:
+		RangeStatus = VL53L1_RANGESTATUS_SIGMA_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID_NO_WRAP_CHECK_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_PHASECONSISTENCY:
+		RangeStatus = VL53L1_RANGESTATUS_WRAP_TARGET_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_PREV_RANGE_NO_TARGETS:
+		RangeStatus = VL53L1_RANGESTATUS_TARGET_PRESENT_LACK_OF_SIGNAL;
+		break;
+	case VL53L1_DEVICEERROR_EVENTCONSISTENCY:
+		RangeStatus = VL53L1_RANGESTATUS_WRAP_TARGET_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_RANGECOMPLETE_MERGED_PULSE:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID_MERGED_PULSE;
+		break;
+	case VL53L1_DEVICEERROR_RANGECOMPLETE:
+		RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID;
+		break;
+	default:
+		RangeStatus = VL53L1_RANGESTATUS_NONE;
+	}
+
+	return RangeStatus;
+}
+
+static VL53L1_Error SetSimpleData(VL53L1_DEV Dev,
+	uint8_t active_results, uint8_t device_status,
+	VL53L1_range_data_t *presults_data,
+	VL53L1_RangingMeasurementData_t *pRangeData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t FilteredRangeStatus;
+	uint8_t SigmaLimitflag;
+	uint8_t SignalLimitflag;
+	uint8_t Temp8Enable;
+	uint8_t Temp8;
+	FixPoint1616_t AmbientRate;
+	FixPoint1616_t SignalRate;
+	FixPoint1616_t TempFix1616;
+	FixPoint1616_t LimitCheckValue;
+	VL53L1_PresetModes PresetMode;
+	int16_t Range;
+
+	pRangeData->TimeStamp = presults_data->time_stamp;
+
+	FilteredRangeStatus = presults_data->range_status & 0x1F;
+
+	pRangeData->RangeQualityLevel = ComputeRQL(active_results,
+					FilteredRangeStatus,
+					presults_data);
+
+	SignalRate = VL53L1_FIXPOINT97TOFIXPOINT1616(
+		presults_data->peak_signal_count_rate_mcps);
+	pRangeData->SignalRateRtnMegaCps
+		= SignalRate;
+
+	AmbientRate = VL53L1_FIXPOINT97TOFIXPOINT1616(
+		presults_data->ambient_count_rate_mcps);
+	pRangeData->AmbientRateRtnMegaCps = AmbientRate;
+
+	pRangeData->EffectiveSpadRtnCount =
+		presults_data->VL53L1_p_006;
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->VL53L1_p_005);
+
+	pRangeData->SigmaMilliMeter = TempFix1616;
+
+	pRangeData->RangeMilliMeter = presults_data->median_range_mm;
+
+	pRangeData->RangeFractionalPart = 0;
+
+
+
+	switch (device_status) {
+	case VL53L1_DEVICEERROR_MULTCLIPFAIL:
+	case VL53L1_DEVICEERROR_VCSELWATCHDOGTESTFAILURE:
+	case VL53L1_DEVICEERROR_VCSELCONTINUITYTESTFAILURE:
+	case VL53L1_DEVICEERROR_NOVHVVALUEFOUND:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_HARDWARE_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_USERROICLIP:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_MIN_RANGE_FAIL;
+		break;
+	default:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID;
+	}
+
+
+
+	if (pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) {
+		PresetMode = VL53L1DevDataGet(Dev,
+				CurrentParameters.PresetMode);
+		if ((PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING) ||
+			(PresetMode == VL53L1_PRESETMODE_RANGING) ||
+			(PresetMode == VL53L1_PRESETMODE_PROXY_RANGING_MODE))
+			pRangeData->RangeStatus =
+				ConvertStatusHisto(FilteredRangeStatus);
+		else
+			pRangeData->RangeStatus =
+				ConvertStatusLite(FilteredRangeStatus);
+	}
+
+
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->VL53L1_p_005);
+	VL53L1_SETARRAYPARAMETERFIELD(Dev,
+		LimitChecksCurrent, VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+		TempFix1616);
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->peak_signal_count_rate_mcps);
+	VL53L1_SETARRAYPARAMETERFIELD(Dev,
+		LimitChecksCurrent, VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+		TempFix1616);
+
+
+
+
+
+	VL53L1_GetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+			&LimitCheckValue);
+
+	SigmaLimitflag = (FilteredRangeStatus ==
+			VL53L1_DEVICEERROR_SIGMATHRESHOLDCHECK)
+			? 1 : 0;
+
+	VL53L1_GetLimitCheckEnable(Dev,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+			&Temp8Enable);
+
+	Temp8 = ((Temp8Enable == 1) && (SigmaLimitflag == 1)) ? 1 : 0;
+	VL53L1_SETARRAYPARAMETERFIELD(Dev, LimitChecksStatus,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE, Temp8);
+
+
+
+	VL53L1_GetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+			&LimitCheckValue);
+
+	SignalLimitflag = (FilteredRangeStatus ==
+			VL53L1_DEVICEERROR_MSRCNOTARGET)
+			? 1 : 0;
+
+	VL53L1_GetLimitCheckEnable(Dev,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+			&Temp8Enable);
+
+	Temp8 = ((Temp8Enable == 1) && (SignalLimitflag == 1)) ? 1 : 0;
+	VL53L1_SETARRAYPARAMETERFIELD(Dev, LimitChecksStatus,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE, Temp8);
+
+	Range = pRangeData->RangeMilliMeter;
+	if ((pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) &&
+		(Range < 0)) {
+		if (Range < BDTable[VL53L1_TUNING_PROXY_MIN])
+			pRangeData->RangeStatus =
+					VL53L1_RANGESTATUS_RANGE_INVALID;
+		else
+			pRangeData->RangeMilliMeter = 0;
+	}
+
+	return Status;
+}
+
+static VL53L1_Error SetTargetData(VL53L1_DEV Dev,
+	uint8_t active_results, uint8_t device_status,
+	VL53L1_range_data_t *presults_data,
+	VL53L1_TargetRangeData_t *pRangeData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t FilteredRangeStatus;
+	uint8_t SigmaLimitflag;
+	uint8_t SignalLimitflag;
+	uint8_t Temp8Enable;
+	uint8_t Temp8;
+	FixPoint1616_t AmbientRate;
+	FixPoint1616_t SignalRate;
+	FixPoint1616_t TempFix1616;
+	FixPoint1616_t LimitCheckValue;
+	VL53L1_PresetModes PresetMode;
+	int16_t Range;
+
+	FilteredRangeStatus = presults_data->range_status & 0x1F;
+
+	pRangeData->RangeQualityLevel = ComputeRQL(active_results,
+					FilteredRangeStatus,
+					presults_data);
+
+	SignalRate = VL53L1_FIXPOINT97TOFIXPOINT1616(
+		presults_data->peak_signal_count_rate_mcps);
+	pRangeData->SignalRateRtnMegaCps
+		= SignalRate;
+
+	AmbientRate = VL53L1_FIXPOINT97TOFIXPOINT1616(
+		presults_data->ambient_count_rate_mcps);
+	pRangeData->AmbientRateRtnMegaCps = AmbientRate;
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->VL53L1_p_005);
+
+	pRangeData->SigmaMilliMeter = TempFix1616;
+
+	pRangeData->RangeMilliMeter = presults_data->median_range_mm;
+	pRangeData->RangeMaxMilliMeter = presults_data->max_range_mm;
+	pRangeData->RangeMinMilliMeter = presults_data->min_range_mm;
+
+	pRangeData->RangeFractionalPart = 0;
+
+
+
+	switch (device_status) {
+	case VL53L1_DEVICEERROR_MULTCLIPFAIL:
+	case VL53L1_DEVICEERROR_VCSELWATCHDOGTESTFAILURE:
+	case VL53L1_DEVICEERROR_VCSELCONTINUITYTESTFAILURE:
+	case VL53L1_DEVICEERROR_NOVHVVALUEFOUND:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_HARDWARE_FAIL;
+		break;
+	case VL53L1_DEVICEERROR_USERROICLIP:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_MIN_RANGE_FAIL;
+		break;
+	default:
+		pRangeData->RangeStatus = VL53L1_RANGESTATUS_RANGE_VALID;
+	}
+
+    if ((pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) &&
+        (active_results == 0)) {
+        pRangeData->RangeStatus = VL53L1_RANGESTATUS_NONE;
+        pRangeData->SignalRateRtnMegaCps = 0;
+        pRangeData->SigmaMilliMeter = 0;
+        pRangeData->RangeMilliMeter = 8191;
+        pRangeData->RangeMaxMilliMeter = 8191;
+        pRangeData->RangeMinMilliMeter = 8191;
+    }
+
+	if (pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) {
+		PresetMode = VL53L1DevDataGet(Dev,
+				CurrentParameters.PresetMode);
+		if ((PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING) ||
+			(PresetMode == VL53L1_PRESETMODE_RANGING) ||
+			(PresetMode == VL53L1_PRESETMODE_PROXY_RANGING_MODE))
+			pRangeData->RangeStatus =
+				ConvertStatusHisto(FilteredRangeStatus);
+		else
+			pRangeData->RangeStatus =
+				ConvertStatusLite(FilteredRangeStatus);
+	}
+
+
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->VL53L1_p_005);
+	VL53L1_SETARRAYPARAMETERFIELD(Dev,
+		LimitChecksCurrent, VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+		TempFix1616);
+
+	TempFix1616 = VL53L1_FIXPOINT97TOFIXPOINT1616(
+			presults_data->peak_signal_count_rate_mcps);
+	VL53L1_SETARRAYPARAMETERFIELD(Dev,
+		LimitChecksCurrent, VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+		TempFix1616);
+
+
+
+
+
+	VL53L1_GetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+			&LimitCheckValue);
+
+	SigmaLimitflag = (FilteredRangeStatus ==
+			VL53L1_DEVICEERROR_SIGMATHRESHOLDCHECK)
+			? 1 : 0;
+
+	VL53L1_GetLimitCheckEnable(Dev,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE,
+			&Temp8Enable);
+
+	Temp8 = ((Temp8Enable == 1) && (SigmaLimitflag == 1)) ? 1 : 0;
+	VL53L1_SETARRAYPARAMETERFIELD(Dev, LimitChecksStatus,
+			VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE, Temp8);
+
+
+
+	VL53L1_GetLimitCheckValue(Dev,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+			&LimitCheckValue);
+
+	SignalLimitflag = (FilteredRangeStatus ==
+			VL53L1_DEVICEERROR_MSRCNOTARGET)
+			? 1 : 0;
+
+	VL53L1_GetLimitCheckEnable(Dev,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE,
+			&Temp8Enable);
+
+	Temp8 = ((Temp8Enable == 1) && (SignalLimitflag == 1)) ? 1 : 0;
+	VL53L1_SETARRAYPARAMETERFIELD(Dev, LimitChecksStatus,
+			VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE, Temp8);
+
+	Range = pRangeData->RangeMilliMeter;
+	if ((pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID) &&
+		(Range < 0)) {
+		if (Range < BDTable[VL53L1_TUNING_PROXY_MIN])
+			pRangeData->RangeStatus =
+					VL53L1_RANGESTATUS_RANGE_INVALID;
+		else
+			pRangeData->RangeMilliMeter = 0;
+	}
+
+	return Status;
+}
+
+static uint8_t GetOutputDataIndex(VL53L1_DEV Dev,
+	VL53L1_range_results_t *presults)
+{
+	uint8_t i;
+	uint8_t index = 0;
+	VL53L1_OutputModes OutputMode;
+
+	OutputMode = VL53L1DevDataGet(Dev, CurrentParameters.OutputMode);
+
+
+
+
+	if (OutputMode == VL53L1_OUTPUTMODE_NEAREST)
+		return 0;
+
+
+
+
+
+	for (i = 1; i < presults->active_results; i++) {
+		if (presults->VL53L1_p_002[i].peak_signal_count_rate_mcps >
+		presults->VL53L1_p_002[index].peak_signal_count_rate_mcps)
+			index = i;
+	}
+
+	return index;
+}
+
+VL53L1_Error VL53L1_GetRangingMeasurementData(VL53L1_DEV Dev,
+	VL53L1_RangingMeasurementData_t *pRangingMeasurementData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_range_results_t       results;
+	VL53L1_range_results_t       *presults = &results;
+	VL53L1_range_data_t *presults_data;
+	VL53L1_PresetModes PresetMode;
+	uint8_t index = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+	if (PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING) {
+		Status = VL53L1_ERROR_MODE_NOT_SUPPORTED;
+		LOG_FUNCTION_END(Status);
+		return Status;
+	}
+
+
+
+	memset(pRangingMeasurementData, 0xFF,
+		sizeof(VL53L1_RangingMeasurementData_t));
+
+
+
+	Status = VL53L1_get_device_results(
+			Dev,
+			VL53L1_DEVICERESULTSLEVEL_FULL,
+			presults);
+
+	if (Status == VL53L1_ERROR_NONE) {
+		pRangingMeasurementData->StreamCount = presults->stream_count;
+
+
+
+
+
+		index = GetOutputDataIndex(Dev, presults);
+		presults_data = &(presults->VL53L1_p_002[index]);
+		Status = SetSimpleData(Dev, presults->active_results,
+				presults->device_status,
+				presults_data,
+				pRangingMeasurementData);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+static VL53L1_Error SetMeasurementData(VL53L1_DEV Dev,
+	VL53L1_range_results_t *presults,
+	VL53L1_MultiRangingData_t *pMultiRangingData)
+{
+	uint8_t i;
+	uint8_t iteration;
+	VL53L1_TargetRangeData_t *pRangeData;
+	VL53L1_range_data_t *presults_data;
+	int16_t dmax_min;
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	uint8_t Furthest_idx = 0;
+	int16_t Furthest_range = 0;
+	uint8_t ActiveResults;
+
+	pMultiRangingData->NumberOfObjectsFound = presults->active_results;
+	pMultiRangingData->RoiNumber = presults->zone_id;
+	pMultiRangingData->HasXtalkValueChanged =
+			presults->smudge_corrector_data.new_xtalk_applied_flag;
+	dmax_min = MIN(presults->wrap_dmax_mm,
+			presults->VL53L1_p_007[DMAX_REFLECTANCE_IDX]);
+	pMultiRangingData->DmaxMilliMeter = dmax_min;
+
+
+
+
+
+	pMultiRangingData->TimeStamp = 0;
+
+	pMultiRangingData->StreamCount = presults->stream_count;
+
+	pMultiRangingData->RecommendedDistanceMode =
+		VL53L1DevDataGet(Dev, CurrentParameters.DistanceMode);
+	ActiveResults = presults->active_results;
+	if (ActiveResults < 1)
+
+
+
+
+		iteration = 1;
+	else
+		iteration = ActiveResults;
+	for (i = 0; i < iteration; i++) {
+		pRangeData = &(pMultiRangingData->RangeData[i]);
+
+		presults_data = &(presults->VL53L1_p_002[i]);
+		if (Status == VL53L1_ERROR_NONE)
+			Status = SetTargetData(Dev, ActiveResults,
+					presults->device_status,
+					presults_data,
+					pRangeData);
+
+		pMultiRangingData->EffectiveSpadRtnCount =
+				presults_data->VL53L1_p_006;
+
+		if ((pRangeData->RangeStatus == VL53L1_RANGESTATUS_RANGE_VALID)
+			&& (pRangeData->RangeMilliMeter > Furthest_range)) {
+			Furthest_range = pRangeData->RangeMilliMeter;
+			Furthest_idx = i;
+		}
+
+	}
+
+
+	if ((Status == VL53L1_ERROR_NONE) && (ActiveResults > 0)) {
+		pRangeData = &(pMultiRangingData->RangeData[Furthest_idx]);
+		CheckAndChangeDistanceMode(Dev, pRangeData,
+		  presults->VL53L1_p_007[VL53L1_MAX_AMBIENT_DMAX_VALUES-1],
+		  &pMultiRangingData->RecommendedDistanceMode);
+	}
+
+
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetMultiRangingData(VL53L1_DEV Dev,
+		VL53L1_MultiRangingData_t *pMultiRangingData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_range_results_t       results;
+	VL53L1_range_results_t       *presults = &results;
+
+	LOG_FUNCTION_START("");
+
+
+
+	memset(pMultiRangingData, 0xFF,
+		sizeof(VL53L1_MultiRangingData_t));
+
+
+
+	Status = VL53L1_get_device_results(
+				Dev,
+				VL53L1_DEVICERESULTSLEVEL_FULL,
+				presults);
+
+
+	if (Status == VL53L1_ERROR_NONE) {
+
+		switch (presults->rd_device_state) {
+		case VL53L1_DEVICESTATE_RANGING_GATHER_DATA:
+			pMultiRangingData->RoiStatus =
+					VL53L1_ROISTATUS_VALID_NOT_LAST;
+			break;
+		case VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA:
+			pMultiRangingData->RoiStatus =
+					VL53L1_ROISTATUS_VALID_LAST;
+			break;
+		default:
+			pMultiRangingData->RoiStatus =
+					VL53L1_ROISTATUS_NOT_VALID;
+		}
+
+		Status = SetMeasurementData(Dev,
+					presults,
+					pMultiRangingData);
+
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetAdditionalData(VL53L1_DEV Dev,
+		VL53L1_AdditionalData_t *pAdditionalData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_additional_data(Dev, pAdditionalData);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_SetTuningParameter(VL53L1_DEV Dev,
+		uint16_t TuningParameterId, int32_t TuningParameterValue)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+	if (TuningParameterId ==
+		VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS)
+		return VL53L1_ERROR_INVALID_PARAMS;
+
+
+	if (TuningParameterId >= 32768)
+		Status = VL53L1_set_tuning_parm(Dev,
+			TuningParameterId,
+			TuningParameterValue);
+	else {
+		if (TuningParameterId < VL53L1_TUNING_MAX_TUNABLE_KEY)
+			BDTable[TuningParameterId] = TuningParameterValue;
+		else
+			Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetTuningParameter(VL53L1_DEV Dev,
+		uint16_t TuningParameterId, int32_t *pTuningParameterValue)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (TuningParameterId >= 32768)
+		Status = VL53L1_get_tuning_parm(Dev,
+			TuningParameterId,
+			pTuningParameterValue);
+	else {
+		if (TuningParameterId < VL53L1_TUNING_MAX_TUNABLE_KEY)
+			*pTuningParameterValue = BDTable[TuningParameterId];
+		else
+			Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_PerformRefSpadManagement(VL53L1_DEV Dev)
+{
+#ifdef VL53L1_NOCALIB
+	VL53L1_Error Status = VL53L1_ERROR_NOT_SUPPORTED;
+
+	SUPPRESS_UNUSED_WARNING(Dev);
+
+	LOG_FUNCTION_START("");
+#else
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_Error RawStatus;
+	uint8_t dcrbuffer[24];
+	uint8_t *commbuf;
+	uint8_t numloc[2] = {5, 3};
+	VL53L1_LLDriverData_t *pdev;
+	VL53L1_customer_nvm_managed_t *pc;
+	VL53L1_PresetModes PresetMode;
+
+	LOG_FUNCTION_START("");
+
+	pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	pc = &pdev->customer;
+
+	if (Status == VL53L1_ERROR_NONE) {
+		PresetMode = VL53L1DevDataGet(Dev,
+				CurrentParameters.PresetMode);
+		Status = VL53L1_run_ref_spad_char(Dev, &RawStatus);
+
+
+
+
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_SetPresetMode(Dev, PresetMode);
+	}
+
+	if (Status == VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH) {
+
+
+
+
+		Status = VL53L1_read_nvm_raw_data(Dev,
+				(uint8_t)(0xA0 >> 2),
+				(uint8_t)(24 >> 2),
+				dcrbuffer);
+
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_WriteMulti(Dev,
+				VL53L1_REF_SPAD_MAN__NUM_REQUESTED_REF_SPADS,
+				numloc, 2);
+
+		if (Status == VL53L1_ERROR_NONE) {
+			pc->ref_spad_man__num_requested_ref_spads = numloc[0];
+			pc->ref_spad_man__ref_location = numloc[1];
+		}
+
+		if (Status == VL53L1_ERROR_NONE)
+			commbuf = &dcrbuffer[16];
+
+
+
+
+
+
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_WriteMulti(Dev,
+				VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0,
+				commbuf, 6);
+
+		if (Status == VL53L1_ERROR_NONE) {
+			pc->global_config__spad_enables_ref_0 = commbuf[0];
+			pc->global_config__spad_enables_ref_1 = commbuf[1];
+			pc->global_config__spad_enables_ref_2 = commbuf[2];
+			pc->global_config__spad_enables_ref_3 = commbuf[3];
+			pc->global_config__spad_enables_ref_4 = commbuf[4];
+			pc->global_config__spad_enables_ref_5 = commbuf[5];
+		}
+
+
+	}
+
+#endif
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SmudgeCorrectionEnable(VL53L1_DEV Dev,
+		VL53L1_SmudgeCorrectionModes Mode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_Error s1 = VL53L1_ERROR_NONE;
+	VL53L1_Error s2 = VL53L1_ERROR_NONE;
+	VL53L1_Error s3 = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	switch (Mode) {
+	case VL53L1_SMUDGE_CORRECTION_NONE:
+		s1 = VL53L1_dynamic_xtalk_correction_disable(Dev);
+		s2 = VL53L1_dynamic_xtalk_correction_apply_disable(Dev);
+		s3 = VL53L1_dynamic_xtalk_correction_single_apply_disable(Dev);
+		break;
+	case VL53L1_SMUDGE_CORRECTION_CONTINUOUS:
+		s1 = VL53L1_dynamic_xtalk_correction_enable(Dev);
+		s2 = VL53L1_dynamic_xtalk_correction_apply_enable(Dev);
+		s3 = VL53L1_dynamic_xtalk_correction_single_apply_disable(Dev);
+		break;
+	case VL53L1_SMUDGE_CORRECTION_SINGLE:
+		s1 = VL53L1_dynamic_xtalk_correction_enable(Dev);
+		s2 = VL53L1_dynamic_xtalk_correction_apply_enable(Dev);
+		s3 = VL53L1_dynamic_xtalk_correction_single_apply_enable(Dev);
+		break;
+	case VL53L1_SMUDGE_CORRECTION_DEBUG:
+		s1 = VL53L1_dynamic_xtalk_correction_enable(Dev);
+		s2 = VL53L1_dynamic_xtalk_correction_apply_disable(Dev);
+		s3 = VL53L1_dynamic_xtalk_correction_single_apply_disable(Dev);
+		break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+		break;
+	}
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = s1;
+		if (Status == VL53L1_ERROR_NONE)
+			Status = s2;
+		if (Status == VL53L1_ERROR_NONE)
+			Status = s3;
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetXTalkCompensationEnable(VL53L1_DEV Dev,
+	uint8_t XTalkCompensationEnable)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (XTalkCompensationEnable == 0)
+		Status = VL53L1_disable_xtalk_compensation(Dev);
+	else
+		Status = VL53L1_enable_xtalk_compensation(Dev);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetXTalkCompensationEnable(VL53L1_DEV Dev,
+	uint8_t *pXTalkCompensationEnable)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	VL53L1_get_xtalk_compensation_enable(
+		Dev,
+		pXTalkCompensationEnable);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_PerformXTalkCalibration(VL53L1_DEV Dev,
+		uint8_t CalibrationOption)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_Error UnfilteredStatus;
+	int16_t CalDistanceMm;
+	VL53L1_xtalk_calibration_results_t xtalk;
+
+	LOG_FUNCTION_START("");
+
+	switch (CalibrationOption) {
+	case VL53L1_XTALKCALIBRATIONMODE_NO_TARGET:
+		Status = VL53L1_run_xtalk_extraction(Dev, &UnfilteredStatus);
+
+
+		if (Status == VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL)
+			VL53L1_xtalk_cal_data_init(Dev);
+		break;
+	case VL53L1_XTALKCALIBRATIONMODE_SINGLE_TARGET:
+		Status = SingleTargetXTalkCalibration(Dev);
+		break;
+	case VL53L1_XTALKCALIBRATIONMODE_FULL_ROI:
+		CalDistanceMm = (int16_t)
+		BDTable[VL53L1_TUNING_XTALK_FULL_ROI_TARGET_DISTANCE_MM];
+		Status = VL53L1_run_hist_xtalk_extraction(Dev, CalDistanceMm,
+				&UnfilteredStatus);
+		break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+
+	if (Status == VL53L1_ERROR_NONE) {
+		Status = VL53L1_get_current_xtalk_settings(Dev, &xtalk);
+		Status = VL53L1_set_tuning_parm(Dev,
+			VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS,
+			xtalk.algo__crosstalk_compensation_plane_offset_kcps);
+	}
+
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetOffsetCalibrationMode(VL53L1_DEV Dev,
+		VL53L1_OffsetCalibrationModes OffsetCalibrationMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_OffsetCalibrationMode   offset_cal_mode;
+
+	LOG_FUNCTION_START("");
+
+	if (OffsetCalibrationMode == VL53L1_OFFSETCALIBRATIONMODE_STANDARD) {
+		offset_cal_mode =
+			VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD;
+	} else if (OffsetCalibrationMode ==
+			VL53L1_OFFSETCALIBRATIONMODE_PRERANGE_ONLY) {
+		offset_cal_mode =
+		VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD_PRE_RANGE_ONLY;
+	} else if (OffsetCalibrationMode ==
+			VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE) {
+		offset_cal_mode =
+				VL53L1_OFFSETCALIBRATIONMODE__PER_ZONE;
+	} else {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status =  VL53L1_set_offset_calibration_mode(Dev,
+				offset_cal_mode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetOffsetCorrectionMode(VL53L1_DEV Dev,
+		VL53L1_OffsetCorrectionModes OffsetCorrectionMode)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_OffsetCorrectionMode   offset_cor_mode;
+
+	LOG_FUNCTION_START("");
+
+	if (OffsetCorrectionMode == VL53L1_OFFSETCORRECTIONMODE_STANDARD) {
+		offset_cor_mode =
+				VL53L1_OFFSETCORRECTIONMODE__MM1_MM2_OFFSETS;
+	} else if (OffsetCorrectionMode ==
+			VL53L1_OFFSETCORRECTIONMODE_PERZONE) {
+		offset_cor_mode =
+				VL53L1_OFFSETCORRECTIONMODE__PER_ZONE_OFFSETS;
+	} else {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status =  VL53L1_set_offset_correction_mode(Dev,
+				offset_cor_mode);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_PerformOffsetCalibration(VL53L1_DEV Dev,
+	int32_t CalDistanceMilliMeter, FixPoint1616_t CalReflectancePercent)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_Error UnfilteredStatus;
+	VL53L1_OffsetCalibrationMode   offset_cal_mode;
+	uint16_t CalReflectancePercent_int;
+
+
+	VL53L1_DevicePresetModes      device_preset_mode;
+	VL53L1_DeviceZonePreset       zone_preset;
+	VL53L1_zone_config_t         zone_cfg;
+
+	LOG_FUNCTION_START("");
+
+	CalReflectancePercent_int =
+			VL53L1_FIXPOINT1616TOFIXPOINT72(CalReflectancePercent);
+
+	if (Status == VL53L1_ERROR_NONE)
+		Status =  VL53L1_get_offset_calibration_mode(Dev,
+				&offset_cal_mode);
+
+	if (Status != VL53L1_ERROR_NONE) {
+		LOG_FUNCTION_END(Status);
+		return Status;
+	}
+
+
+	if ((offset_cal_mode ==
+		VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD) ||
+		(offset_cal_mode ==
+		VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD_PRE_RANGE_ONLY
+		)) {
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_run_offset_calibration(
+					Dev,
+					(int16_t)CalDistanceMilliMeter,
+					CalReflectancePercent_int,
+					&UnfilteredStatus);
+
+	} else if (offset_cal_mode ==
+			VL53L1_OFFSETCALIBRATIONMODE__PER_ZONE) {
+		device_preset_mode =
+			VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_LONG_RANGE;
+		zone_preset = VL53L1_DEVICEZONEPRESET_CUSTOM;
+
+		Status = VL53L1_get_zone_config(Dev, &zone_cfg);
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_run_zone_calibration(
+					Dev,
+					device_preset_mode,
+					zone_preset,
+					&zone_cfg,
+					(int16_t)CalDistanceMilliMeter,
+					CalReflectancePercent_int,
+					&UnfilteredStatus);
+
+	} else {
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_PerformOffsetSimpleCalibration(VL53L1_DEV Dev,
+	int32_t CalDistanceMilliMeter)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	int32_t sum_ranging;
+	uint8_t offset_meas;
+	int16_t Max, UnderMax, OverMax, Repeat;
+	int32_t total_count, inloopcount;
+	int32_t IncRounding;
+	int16_t meanDistance_mm;
+	int16_t offset;
+	VL53L1_RangingMeasurementData_t RangingMeasurementData;
+	VL53L1_LLDriverData_t *pdev;
+	uint8_t goodmeas;
+	VL53L1_Error SmudgeStatus = VL53L1_ERROR_NONE;
+	uint8_t smudge_corr_en;
+
+	LOG_FUNCTION_START("");
+
+	pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+
+	smudge_corr_en = pdev->smudge_correct_config.smudge_corr_enabled;
+	SmudgeStatus = VL53L1_dynamic_xtalk_correction_disable(Dev);
+
+
+	pdev->customer.algo__part_to_part_range_offset_mm = 0;
+	pdev->customer.mm_config__inner_offset_mm = 0;
+	pdev->customer.mm_config__outer_offset_mm = 0;
+
+	Repeat = BDTable[VL53L1_TUNING_SIMPLE_OFFSET_CALIBRATION_REPEAT];
+	Max = BDTable[
+		VL53L1_TUNING_MAX_SIMPLE_OFFSET_CALIBRATION_SAMPLE_NUMBER];
+	UnderMax = 1 + (Max / 2);
+	OverMax = Max + (Max / 2);
+	sum_ranging = 0;
+	total_count = 0;
+
+	while ((Repeat > 0) && (Status == VL53L1_ERROR_NONE)) {
+		Status = VL53L1_StartMeasurement(Dev);
+
+
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_WaitMeasurementDataReady(Dev);
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_GetRangingMeasurementData(Dev,
+						&RangingMeasurementData);
+		if (Status == VL53L1_ERROR_NONE)
+			Status = VL53L1_ClearInterruptAndStartMeasurement(Dev);
+
+
+		inloopcount = 0;
+		offset_meas = 0;
+		while ((Status == VL53L1_ERROR_NONE) && (inloopcount < Max) &&
+				(offset_meas < OverMax)) {
+			Status = VL53L1_WaitMeasurementDataReady(Dev);
+			if (Status == VL53L1_ERROR_NONE)
+				Status = VL53L1_GetRangingMeasurementData(Dev,
+						&RangingMeasurementData);
+			goodmeas = (RangingMeasurementData.RangeStatus ==
+					VL53L1_RANGESTATUS_RANGE_VALID);
+			if ((Status == VL53L1_ERROR_NONE) && goodmeas) {
+				sum_ranging = sum_ranging +
+					RangingMeasurementData.RangeMilliMeter;
+				inloopcount++;
+			}
+			Status = VL53L1_ClearInterruptAndStartMeasurement(Dev);
+			offset_meas++;
+		}
+		total_count += inloopcount;
+
+
+
+		if (inloopcount < UnderMax)
+			Status = VL53L1_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL;
+
+		VL53L1_StopMeasurement(Dev);
+
+		Repeat--;
+
+	}
+
+
+	if ((SmudgeStatus == VL53L1_ERROR_NONE) && (smudge_corr_en == 1))
+		SmudgeStatus = VL53L1_dynamic_xtalk_correction_enable(Dev);
+
+
+	if ((sum_ranging < 0) ||
+		(sum_ranging > ((int32_t) total_count * 0xffff))) {
+		Status = VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH;
+	}
+
+	if ((Status == VL53L1_ERROR_NONE) && (total_count > 0)) {
+		IncRounding = total_count / 2;
+		meanDistance_mm = (int16_t)((sum_ranging + IncRounding)
+				/ total_count);
+		offset = (int16_t)CalDistanceMilliMeter - meanDistance_mm;
+		pdev->customer.algo__part_to_part_range_offset_mm = 0;
+		pdev->customer.mm_config__inner_offset_mm = offset;
+		pdev->customer.mm_config__outer_offset_mm = offset;
+
+		Status = VL53L1_set_customer_nvm_managed(Dev,
+				&(pdev->customer));
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_SetCalibrationData(VL53L1_DEV Dev,
+		VL53L1_CalibrationData_t *pCalibrationData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_CustomerNvmManaged_t          *pC;
+	VL53L1_calibration_data_t            cal_data;
+	uint32_t x;
+	VL53L1_xtalk_calibration_results_t xtalk;
+
+	LOG_FUNCTION_START("");
+
+	cal_data.struct_version = pCalibrationData->struct_version -
+			VL53L1_ADDITIONAL_CALIBRATION_DATA_STRUCT_VERSION;
+
+
+
+
+
+
+	memcpy(
+		&(cal_data.fmt_dmax_cal),
+		&(pCalibrationData->fmt_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+	memcpy(
+		&(cal_data.cust_dmax_cal),
+		&(pCalibrationData->cust_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+
+	memcpy(
+		&(cal_data.add_off_cal_data),
+		&(pCalibrationData->add_off_cal_data),
+		sizeof(VL53L1_additional_offset_cal_data_t));
+
+
+
+	memcpy(
+		&(cal_data.optical_centre),
+		&(pCalibrationData->optical_centre),
+		sizeof(VL53L1_optical_centre_t));
+
+
+
+	memcpy(
+		&(cal_data.xtalkhisto),
+		&(pCalibrationData->xtalkhisto),
+		sizeof(VL53L1_xtalk_histogram_data_t));
+
+
+
+	memcpy(
+		&(cal_data.gain_cal),
+		&(pCalibrationData->gain_cal),
+		sizeof(VL53L1_gain_calibration_data_t));
+
+
+
+	memcpy(
+		&(cal_data.cal_peak_rate_map),
+		&(pCalibrationData->cal_peak_rate_map),
+		sizeof(VL53L1_cal_peak_rate_map_t));
+
+	pC = &pCalibrationData->customer;
+	x = pC->algo__crosstalk_compensation_plane_offset_kcps;
+	cal_data.customer.algo__crosstalk_compensation_plane_offset_kcps =
+		(uint16_t)(x&0x0000FFFF);
+
+	cal_data.customer.global_config__spad_enables_ref_0 =
+		pC->global_config__spad_enables_ref_0;
+	cal_data.customer.global_config__spad_enables_ref_1 =
+		pC->global_config__spad_enables_ref_1;
+	cal_data.customer.global_config__spad_enables_ref_2 =
+		pC->global_config__spad_enables_ref_2;
+	cal_data.customer.global_config__spad_enables_ref_3 =
+		pC->global_config__spad_enables_ref_3;
+	cal_data.customer.global_config__spad_enables_ref_4 =
+		pC->global_config__spad_enables_ref_4;
+	cal_data.customer.global_config__spad_enables_ref_5 =
+		pC->global_config__spad_enables_ref_5;
+	cal_data.customer.global_config__ref_en_start_select =
+		pC->global_config__ref_en_start_select;
+	cal_data.customer.ref_spad_man__num_requested_ref_spads =
+		pC->ref_spad_man__num_requested_ref_spads;
+	cal_data.customer.ref_spad_man__ref_location =
+		pC->ref_spad_man__ref_location;
+	cal_data.customer.algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	cal_data.customer.algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	cal_data.customer.ref_spad_char__total_rate_target_mcps =
+		pC->ref_spad_char__total_rate_target_mcps;
+	cal_data.customer.algo__part_to_part_range_offset_mm =
+		pC->algo__part_to_part_range_offset_mm;
+	cal_data.customer.mm_config__inner_offset_mm =
+		pC->mm_config__inner_offset_mm;
+	cal_data.customer.mm_config__outer_offset_mm =
+		pC->mm_config__outer_offset_mm;
+
+	Status = VL53L1_set_part_to_part_data(Dev, &cal_data);
+	if (Status != VL53L1_ERROR_NONE)
+		goto ENDFUNC;
+
+	Status = VL53L1_get_current_xtalk_settings(Dev, &xtalk);
+
+	if (Status != VL53L1_ERROR_NONE)
+		goto ENDFUNC;
+
+	xtalk.algo__crosstalk_compensation_plane_offset_kcps = x;
+
+
+	Status = VL53L1_set_tuning_parm(Dev,
+			VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS,
+			x);
+
+
+
+	Status = VL53L1_set_current_xtalk_settings(Dev, &xtalk);
+
+ENDFUNC:
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+VL53L1_Error VL53L1_GetCalibrationData(VL53L1_DEV Dev,
+		VL53L1_CalibrationData_t  *pCalibrationData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_calibration_data_t      cal_data;
+	VL53L1_CustomerNvmManaged_t         *pC;
+	VL53L1_customer_nvm_managed_t       *pC2;
+	VL53L1_xtalk_calibration_results_t xtalk;
+	uint32_t                          tmp;
+	VL53L1_PresetModes PresetMode;
+
+	LOG_FUNCTION_START("");
+
+
+
+	Status = VL53L1_get_part_to_part_data(Dev, &cal_data);
+
+	pCalibrationData->struct_version = cal_data.struct_version +
+			VL53L1_ADDITIONAL_CALIBRATION_DATA_STRUCT_VERSION;
+
+
+
+	memcpy(
+		&(pCalibrationData->fmt_dmax_cal),
+		&(cal_data.fmt_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+	memcpy(
+		&(pCalibrationData->cust_dmax_cal),
+		&(cal_data.cust_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+	memcpy(
+		&(pCalibrationData->add_off_cal_data),
+		&(cal_data.add_off_cal_data),
+		sizeof(VL53L1_additional_offset_cal_data_t));
+
+
+
+	memcpy(
+		&(pCalibrationData->optical_centre),
+		&(cal_data.optical_centre),
+		sizeof(VL53L1_optical_centre_t));
+
+
+
+	memcpy(
+		&(pCalibrationData->xtalkhisto),
+		&(cal_data.xtalkhisto),
+		sizeof(VL53L1_xtalk_histogram_data_t));
+
+
+	memcpy(
+		&(pCalibrationData->gain_cal),
+		&(cal_data.gain_cal),
+		sizeof(VL53L1_gain_calibration_data_t));
+
+
+
+	memcpy(
+		&(pCalibrationData->cal_peak_rate_map),
+		&(cal_data.cal_peak_rate_map),
+		sizeof(VL53L1_cal_peak_rate_map_t));
+
+
+	pC = &pCalibrationData->customer;
+	pC2 = &cal_data.customer;
+	pC->global_config__spad_enables_ref_0 =
+		pC2->global_config__spad_enables_ref_0;
+	pC->global_config__spad_enables_ref_1 =
+		pC2->global_config__spad_enables_ref_1;
+	pC->global_config__spad_enables_ref_2 =
+		pC2->global_config__spad_enables_ref_2;
+	pC->global_config__spad_enables_ref_3 =
+		pC2->global_config__spad_enables_ref_3;
+	pC->global_config__spad_enables_ref_4 =
+		pC2->global_config__spad_enables_ref_4;
+	pC->global_config__spad_enables_ref_5 =
+		pC2->global_config__spad_enables_ref_5;
+	pC->global_config__ref_en_start_select =
+		pC2->global_config__ref_en_start_select;
+	pC->ref_spad_man__num_requested_ref_spads =
+		pC2->ref_spad_man__num_requested_ref_spads;
+	pC->ref_spad_man__ref_location =
+		pC2->ref_spad_man__ref_location;
+	pC->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC2->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pC->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC2->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	pC->ref_spad_char__total_rate_target_mcps =
+		pC2->ref_spad_char__total_rate_target_mcps;
+	pC->algo__part_to_part_range_offset_mm =
+		pC2->algo__part_to_part_range_offset_mm;
+	pC->mm_config__inner_offset_mm =
+		pC2->mm_config__inner_offset_mm;
+	pC->mm_config__outer_offset_mm =
+		pC2->mm_config__outer_offset_mm;
+
+	pC->algo__crosstalk_compensation_plane_offset_kcps =
+		(uint32_t)(
+			pC2->algo__crosstalk_compensation_plane_offset_kcps);
+
+
+	PresetMode = VL53L1DevDataGet(Dev, CurrentParameters.PresetMode);
+
+	if ((PresetMode == VL53L1_PRESETMODE_RANGING) ||
+		(PresetMode == VL53L1_PRESETMODE_MULTIZONES_SCANNING) ||
+		(PresetMode == VL53L1_PRESETMODE_PROXY_RANGING_MODE)
+		) {
+
+		Status = VL53L1_get_current_xtalk_settings(Dev, &xtalk);
+
+		if (Status != VL53L1_ERROR_NONE)
+			goto ENDFUNC;
+
+		tmp = xtalk.algo__crosstalk_compensation_plane_offset_kcps;
+		pC->algo__crosstalk_compensation_plane_offset_kcps = tmp;
+		tmp = xtalk.algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps = tmp;
+		tmp = xtalk.algo__crosstalk_compensation_y_plane_gradient_kcps;
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps = tmp;
+	}
+ENDFUNC:
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_SetZoneCalibrationData(VL53L1_DEV Dev,
+		VL53L1_ZoneCalibrationData_t *pZoneCalibrationData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_set_zone_calibration_data(Dev, pZoneCalibrationData);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+
+}
+
+VL53L1_Error VL53L1_GetZoneCalibrationData(VL53L1_DEV Dev,
+		VL53L1_ZoneCalibrationData_t  *pZoneCalibrationData)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_zone_calibration_data(Dev, pZoneCalibrationData);
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+VL53L1_Error VL53L1_GetOpticalCenter(VL53L1_DEV Dev,
+		FixPoint1616_t *pOpticalCenterX,
+		FixPoint1616_t *pOpticalCenterY)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_calibration_data_t  CalibrationData;
+
+	LOG_FUNCTION_START("");
+
+	*pOpticalCenterX = 0;
+	*pOpticalCenterY = 0;
+	Status = VL53L1_get_part_to_part_data(Dev, &CalibrationData);
+	if (Status == VL53L1_ERROR_NONE) {
+		*pOpticalCenterX = VL53L1_FIXPOINT44TOFIXPOINT1616(
+				CalibrationData.optical_centre.x_centre);
+		*pOpticalCenterY = VL53L1_FIXPOINT44TOFIXPOINT1616(
+				CalibrationData.optical_centre.y_centre);
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_SetThresholdConfig(VL53L1_DEV Dev,
+		VL53L1_DetectionConfig_t *pConfig)
+{
+#define BADTHRESBOUNDS(T) \
+	(((T.CrossMode == VL53L1_THRESHOLD_OUT_OF_WINDOW) || \
+	(T.CrossMode == VL53L1_THRESHOLD_IN_WINDOW)) && (T.Low > T.High))
+
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_GPIO_interrupt_config_t Cfg;
+	uint16_t g;
+	FixPoint1616_t gain, high1616, low1616;
+	VL53L1_LLDriverData_t *pdev;
+
+	LOG_FUNCTION_START("");
+
+	pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	Status = VL53L1_get_GPIO_interrupt_config(Dev, &Cfg);
+	if (Status == VL53L1_ERROR_NONE) {
+		if (pConfig->DetectionMode == VL53L1_DETECTION_NORMAL_RUN) {
+			Cfg.intr_new_measure_ready = 1;
+			Status = VL53L1_set_GPIO_interrupt_config_struct(Dev,
+					Cfg);
+		} else {
+			if (BADTHRESBOUNDS(pConfig->Distance))
+				Status = VL53L1_ERROR_INVALID_PARAMS;
+			if ((Status == VL53L1_ERROR_NONE) &&
+					(BADTHRESBOUNDS(pConfig->Rate)))
+				Status = VL53L1_ERROR_INVALID_PARAMS;
+			if (Status == VL53L1_ERROR_NONE) {
+				Cfg.intr_new_measure_ready = 0;
+				Cfg.intr_no_target = pConfig->IntrNoTarget;
+
+
+
+				g = pdev->gain_cal.standard_ranging_gain_factor;
+
+
+				gain = (FixPoint1616_t) ((uint32_t)g << 5);
+				high1616 = (FixPoint1616_t) ((uint32_t)
+						pConfig->Distance.High << 16);
+				low1616 = (FixPoint1616_t) ((uint32_t)
+						pConfig->Distance.Low << 16);
+
+
+				high1616 = (high1616 + 32768) / gain;
+				low1616 = (low1616 + 32768) / gain;
+				Cfg.threshold_distance_high = (uint16_t)
+						(high1616 & 0xFFFF);
+				Cfg.threshold_distance_low = (uint16_t)
+						(low1616 & 0xFFFF);
+
+
+				Cfg.threshold_rate_high =
+					VL53L1_FIXPOINT1616TOFIXPOINT97(
+							pConfig->Rate.High);
+				Cfg.threshold_rate_low =
+					VL53L1_FIXPOINT1616TOFIXPOINT97(
+							pConfig->Rate.Low);
+
+				Cfg.intr_mode_distance = ConvertModeToLLD(
+						&Status,
+						pConfig->Distance.CrossMode);
+				if (Status == VL53L1_ERROR_NONE)
+					Cfg.intr_mode_rate = ConvertModeToLLD(
+						&Status,
+						pConfig->Rate.CrossMode);
+			}
+
+
+
+			if (Status == VL53L1_ERROR_NONE) {
+				Cfg.intr_combined_mode = 1;
+				switch (pConfig->DetectionMode) {
+				case VL53L1_DETECTION_DISTANCE_ONLY:
+					Cfg.threshold_rate_high = 0;
+					Cfg.threshold_rate_low = 0;
+					break;
+				case VL53L1_DETECTION_RATE_ONLY:
+					Cfg.threshold_distance_high = 0;
+					Cfg.threshold_distance_low = 0;
+					break;
+				case VL53L1_DETECTION_DISTANCE_OR_RATE:
+
+
+
+
+					break;
+				case VL53L1_DETECTION_DISTANCE_AND_RATE:
+					Cfg.intr_combined_mode = 0;
+					break;
+				default:
+					Status = VL53L1_ERROR_INVALID_PARAMS;
+				}
+			}
+
+			if (Status == VL53L1_ERROR_NONE)
+				Status =
+				VL53L1_set_GPIO_interrupt_config_struct(Dev,
+						Cfg);
+
+		}
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+VL53L1_Error VL53L1_GetThresholdConfig(VL53L1_DEV Dev,
+		VL53L1_DetectionConfig_t *pConfig)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+	VL53L1_GPIO_interrupt_config_t Cfg;
+
+	LOG_FUNCTION_START("");
+
+	Status = VL53L1_get_GPIO_interrupt_config(Dev, &Cfg);
+
+	if (Status != VL53L1_ERROR_NONE) {
+		LOG_FUNCTION_END(Status);
+		return Status;
+	}
+
+	pConfig->IntrNoTarget = Cfg.intr_no_target;
+	pConfig->Distance.High = Cfg.threshold_distance_high;
+	pConfig->Distance.Low = Cfg.threshold_distance_low;
+	pConfig->Rate.High =
+		VL53L1_FIXPOINT97TOFIXPOINT1616(
+				Cfg.threshold_rate_high);
+	pConfig->Rate.Low =
+		VL53L1_FIXPOINT97TOFIXPOINT1616(Cfg.threshold_rate_low);
+	pConfig->Distance.CrossMode =
+		ConvertModeFromLLD(&Status, Cfg.intr_mode_distance);
+	if (Status == VL53L1_ERROR_NONE)
+		pConfig->Rate.CrossMode =
+			ConvertModeFromLLD(&Status, Cfg.intr_mode_rate);
+
+	if (Cfg.intr_new_measure_ready == 1) {
+		pConfig->DetectionMode = VL53L1_DETECTION_NORMAL_RUN;
+	} else {
+
+
+		if (Status == VL53L1_ERROR_NONE) {
+			if (Cfg.intr_combined_mode == 0)
+				pConfig->DetectionMode =
+				VL53L1_DETECTION_DISTANCE_AND_RATE;
+			else {
+				if ((Cfg.threshold_distance_high == 0) &&
+					(Cfg.threshold_distance_low == 0))
+					pConfig->DetectionMode =
+					VL53L1_DETECTION_RATE_ONLY;
+				else if ((Cfg.threshold_rate_high == 0) &&
+					(Cfg.threshold_rate_low == 0))
+					pConfig->DetectionMode =
+					VL53L1_DETECTION_DISTANCE_ONLY;
+				else
+					pConfig->DetectionMode =
+					VL53L1_DETECTION_DISTANCE_OR_RATE;
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api_calibration.c b/drivers/input/misc/vl53L1/src/vl53l1_api_calibration.c
new file mode 100644
index 0000000000000000000000000000000000000000..b3b1a98a20ae83212a312cde19d4fc39574c14e4
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api_calibration.c
@@ -0,0 +1,2765 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_platform_ipp.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_register_funcs.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_hist_map.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_core.h"
+#include "vl53l1_wait.h"
+#include "vl53l1_api_preset_modes.h"
+#include "vl53l1_silicon_core.h"
+#include "vl53l1_api_core.h"
+#include "vl53l1_api_calibration.h"
+
+#ifdef VL53L1_LOG_ENABLE
+  #include "vl53l1_api_debug.h"
+#endif
+
+
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, status, \
+		fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_CORE, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_run_ref_spad_char(
+	VL53L1_DEV        Dev,
+	VL53L1_Error     *pcal_status)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t comms_buffer[6];
+
+	VL53L1_refspadchar_config_t *prefspadchar  = &(pdev->refspadchar);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_enable_powerforce(Dev);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+		VL53L1_set_ref_spad_char_config(
+			Dev,
+			prefspadchar->VL53L1_p_009,
+			prefspadchar->timeout_us,
+			prefspadchar->target_count_rate_mcps,
+			prefspadchar->max_count_rate_limit_mcps,
+			prefspadchar->min_count_rate_limit_mcps,
+			pdev->stat_nvm.osc_measured__fast_osc__frequency);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_run_device_test(
+					Dev,
+					prefspadchar->device_test_mode);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+		VL53L1_ReadMulti(
+			Dev,
+			VL53L1_REF_SPAD_CHAR_RESULT__NUM_ACTUAL_REF_SPADS,
+			comms_buffer,
+			2);
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->dbg_results.ref_spad_char_result__num_actual_ref_spads =
+				comms_buffer[0];
+		pdev->dbg_results.ref_spad_char_result__ref_location =
+				comms_buffer[1];
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				VL53L1_REF_SPAD_MAN__NUM_REQUESTED_REF_SPADS,
+				comms_buffer,
+				2);
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->customer.ref_spad_man__num_requested_ref_spads =
+				comms_buffer[0];
+		pdev->customer.ref_spad_man__ref_location =
+				comms_buffer[1];
+	}
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_ReadMulti(
+				Dev,
+				VL53L1_RESULT__SPARE_0_SD1,
+				comms_buffer,
+				6);
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0,
+				comms_buffer,
+				6);
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->customer.global_config__spad_enables_ref_0 =
+				comms_buffer[0];
+		pdev->customer.global_config__spad_enables_ref_1 =
+				comms_buffer[1];
+		pdev->customer.global_config__spad_enables_ref_2 =
+				comms_buffer[2];
+		pdev->customer.global_config__spad_enables_ref_3 =
+				comms_buffer[3];
+		pdev->customer.global_config__spad_enables_ref_4 =
+				comms_buffer[4];
+		pdev->customer.global_config__spad_enables_ref_5 =
+				comms_buffer[5];
+	}
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+	if (status == VL53L1_ERROR_NONE)
+		VL53L1_print_customer_nvm_managed(
+			&(pdev->customer),
+			"run_ref_spad_char():pdev->lldata.customer.",
+			VL53L1_TRACE_MODULE_REF_SPAD_CHAR);
+#endif
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		switch (pdev->sys_results.result__range_status) {
+
+		case VL53L1_DEVICEERROR_REFSPADCHARNOTENOUGHDPADS:
+			status = VL53L1_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS;
+			break;
+
+		case VL53L1_DEVICEERROR_REFSPADCHARMORETHANTARGET:
+			status = VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH;
+			break;
+
+		case VL53L1_DEVICEERROR_REFSPADCHARLESSTHANTARGET:
+			status = VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW;
+			break;
+		}
+	}
+
+
+
+
+
+
+	*pcal_status = status;
+
+
+
+
+	IGNORE_STATUS(
+		IGNORE_REF_SPAD_CHAR_NOT_ENOUGH_SPADS,
+		VL53L1_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_REF_SPAD_CHAR_RATE_TOO_HIGH,
+		VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_REF_SPAD_CHAR_RATE_TOO_LOW,
+		VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW,
+		status);
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_run_xtalk_extraction(
+	VL53L1_DEV	                        Dev,
+	VL53L1_Error                       *pcal_status)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+
+
+
+
+
+	VL53L1_xtalkextract_config_t *pX = &(pdev->xtalk_extract_cfg);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_xtalk_calibration_results_t *pXC = &(pdev->xtalk_cal);
+
+	uint8_t results_invalid  = 0;
+
+	uint8_t i                = 0;
+	uint16_t tmp16 = 0;
+
+	uint8_t measurement_mode = VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+	VL53L1_init_histogram_bin_data_struct(
+			0,
+			(uint16_t)VL53L1_HISTOGRAM_BUFFER_SIZE,
+			&(pdev->xtalk_results.central_histogram_avg));
+
+	VL53L1_init_histogram_bin_data_struct(
+			0,
+			(uint16_t)VL53L1_HISTOGRAM_BUFFER_SIZE,
+			&(pdev->xtalk_results.central_histogram_sum));
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+		VL53L1_set_preset_mode(
+		Dev,
+		VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_PLANAR,
+
+
+		pX->dss_config__target_total_rate_mcps,
+		pX->phasecal_config_timeout_us,
+		pX->mm_config_timeout_us,
+		pX->range_config_timeout_us,
+
+
+		100);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_xtalk_compensation(Dev);
+
+
+
+
+
+
+	pdev->xtalk_results.max_results    = VL53L1_MAX_XTALK_RANGE_RESULTS;
+	pdev->xtalk_results.active_results = pdev->zone_cfg.active_zones+1;
+
+
+
+
+	pdev->xtalk_results.central_histogram__window_start = 0xFF;
+	pdev->xtalk_results.central_histogram__window_end   = 0x00;
+
+	pdev->xtalk_results.num_of_samples_status = 0x00;
+	pdev->xtalk_results.zero_samples_status   = 0x00;
+	pdev->xtalk_results.max_sigma_status      = 0x00;
+
+	for (i = 0; i < pdev->xtalk_results.max_results; i++) {
+		pdev->xtalk_results.VL53L1_p_002[i].no_of_samples           = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].signal_total_events_avg = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].signal_total_events_sum = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].rate_per_spad_kcps_sum  = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].rate_per_spad_kcps_avg  = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].sigma_mm_sum            = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].sigma_mm_avg            = 0;
+
+
+		pdev->xtalk_results.VL53L1_p_002[i].median_phase_sum        = 0;
+		pdev->xtalk_results.VL53L1_p_002[i].median_phase_avg        = 0;
+
+
+	}
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status =
+		VL53L1_get_and_avg_xtalk_samples(
+		Dev,
+
+
+		pX->num_of_samples,
+
+
+		measurement_mode,
+
+
+		pX->algo__crosstalk_extract_max_valid_range_mm,
+		pX->algo__crosstalk_extract_min_valid_range_mm,
+		pX->algo__crosstalk_extract_max_valid_rate_kcps,
+
+
+		0x0,
+
+		0x4,
+
+		&(pdev->xtalk_results),
+		&(pdev->xtalk_results.central_histogram_sum),
+		&(pdev->xtalk_results.central_histogram_avg));
+	}
+
+
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		if ((pdev->xtalk_results.VL53L1_p_002[4].no_of_samples == 0) ||
+			(pdev->xtalk_results.VL53L1_p_002[4].sigma_mm_avg >
+			((uint32_t)pX->algo__crosstalk_extract_max_sigma_mm
+					<< 5)))
+			results_invalid = 0x01;
+
+
+
+
+#ifdef VL53L1_LOG_ENABLE
+	if (status == VL53L1_ERROR_NONE)
+		VL53L1_print_xtalk_range_results(
+			&(pdev->xtalk_results),
+			"pdev->xtalk_results",
+			VL53L1_TRACE_MODULE_CORE);
+#endif
+
+	if ((status == VL53L1_ERROR_NONE) && (results_invalid == 0)) {
+
+		status =
+			VL53L1_ipp_xtalk_calibration_process_data(
+					Dev,
+					&(pdev->xtalk_results),
+					&(pdev->xtalk_shapes),
+					&(pdev->xtalk_cal));
+
+		if (status == VL53L1_ERROR_NONE) {
+
+			pC->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			pXC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+			pC->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			pXC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+			pC->algo__crosstalk_compensation_plane_offset_kcps =
+			pXC->algo__crosstalk_compensation_plane_offset_kcps;
+
+
+		}
+
+
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_xtalk_compensation(Dev);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		for (i = 0; i < pdev->xtalk_results.max_results; i++) {
+
+
+			if (pdev->xtalk_results.VL53L1_p_002[i].no_of_samples !=
+
+
+				pX->num_of_samples) {
+
+
+				pdev->xtalk_results.num_of_samples_status =
+				pdev->xtalk_results.num_of_samples_status |
+					(1 << i);
+			}
+
+
+			if (pdev->xtalk_results.VL53L1_p_002[i].no_of_samples ==
+				0x00) {
+				pdev->xtalk_results.zero_samples_status =
+				pdev->xtalk_results.zero_samples_status |
+					(1 << i);
+			}
+
+
+
+
+
+
+
+
+
+
+
+
+			tmp16 = pX->algo__crosstalk_extract_max_sigma_mm;
+			if (pdev->xtalk_results.VL53L1_p_002[i].sigma_mm_avg >
+				((uint32_t)tmp16 << 5)) {
+				pdev->xtalk_results.max_sigma_status =
+					pdev->xtalk_results.max_sigma_status |
+					(1 << i);
+			}
+
+
+		}
+	}
+
+
+
+
+
+
+
+
+
+
+
+
+
+	if (results_invalid > 0) {
+
+
+		if (pdev->xtalk_results.VL53L1_p_002[4].no_of_samples == 0) {
+			status = VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL;
+		} else {
+
+
+
+			if (pdev->xtalk_results.VL53L1_p_002[4].sigma_mm_avg >
+			(((uint32_t)pX->algo__crosstalk_extract_max_sigma_mm)
+				<< 5)) {
+				status =
+				VL53L1_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL;
+			}
+
+
+		}
+	} else {
+
+
+		if (pdev->xtalk_results.zero_samples_status != 0x00) {
+			status = VL53L1_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT;
+		} else {
+			if (pdev->xtalk_results.max_sigma_status != 0x00) {
+				status =
+				VL53L1_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT;
+			} else {
+				if (pdev->xtalk_results.num_of_samples_status !=
+						0x00)
+					status =
+					VL53L1_WARNING_XTALK_MISSING_SAMPLES;
+			}
+		}
+	}
+
+
+
+
+
+
+	pdev->xtalk_results.cal_status = status;
+	*pcal_status = pdev->xtalk_results.cal_status;
+
+
+
+
+	IGNORE_STATUS(
+		IGNORE_XTALK_EXTRACTION_NO_SAMPLE_FAIL,
+		VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL,
+		VL53L1_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_XTALK_EXTRACTION_NO_SAMPLE_FOR_GRADIENT_WARN,
+		VL53L1_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_XTALK_EXTRACTION_SIGMA_LIMIT_FOR_GRADIENT_WARN,
+		VL53L1_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_XTALK_EXTRACTION_MISSING_SAMPLES_WARN,
+		VL53L1_WARNING_XTALK_MISSING_SAMPLES,
+		status);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+	VL53L1_print_customer_nvm_managed(
+		&(pdev->customer),
+		"run_xtalk_extraction():pdev->lldata.customer.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_config(
+		&(pdev->xtalk_cfg),
+		"run_xtalk_extraction():pdev->lldata.xtalk_cfg.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_extract_config(
+		&(pdev->xtalk_extract_cfg),
+		"run_xtalk_extraction():pdev->lldata.xtalk_extract_cfg.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_histogram_bin_data(
+		&(pdev->hist_data),
+		"run_xtalk_extraction():pdev->lldata.hist_data.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_histogram_data(
+		&(pdev->xtalk_shapes),
+		"pdev->lldata.xtalk_shapes.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_range_results(
+		&(pdev->xtalk_results),
+		"run_xtalk_extraction():pdev->lldata.xtalk_results.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_get_and_avg_xtalk_samples(
+		VL53L1_DEV	                  Dev,
+		uint8_t                       num_of_samples,
+		uint8_t                       measurement_mode,
+		int16_t                       xtalk_filter_thresh_max_mm,
+		int16_t                       xtalk_filter_thresh_min_mm,
+		uint16_t                      xtalk_max_valid_rate_kcps,
+		uint8_t                       xtalk_result_id,
+		uint8_t                       xtalk_histo_id,
+		VL53L1_xtalk_range_results_t *pXR,
+		VL53L1_histogram_bin_data_t  *psum_histo,
+		VL53L1_histogram_bin_data_t  *pavg_histo)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+#ifdef VL53L1_LOG_ENABLE
+	VL53L1_LLDriverResults_t *pres =
+		VL53L1DevStructGetLLResultsHandle(Dev);
+#endif
+
+	VL53L1_range_results_t      range_results;
+	VL53L1_range_results_t      *prs = &range_results;
+
+	VL53L1_range_data_t         *prange_data;
+	VL53L1_xtalk_range_data_t   *pxtalk_range_data;
+
+	uint8_t i                = 0;
+	uint8_t j                = 0;
+	uint8_t zone_id          = 0;
+	uint8_t final_zone       = pdev->zone_cfg.active_zones+1;
+	uint8_t valid_result;
+
+	uint8_t smudge_corr_en   = 0;
+
+
+
+
+
+
+	smudge_corr_en = pdev->smudge_correct_config.smudge_corr_enabled;
+
+	status = VL53L1_dynamic_xtalk_correction_disable(Dev);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS);
+
+
+	for (i = 0; i <= (final_zone*num_of_samples); i++) {
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_wait_for_range_completion(Dev);
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_get_device_results(
+					Dev,
+					VL53L1_DEVICERESULTSLEVEL_FULL,
+					prs);
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE &&
+			pdev->ll_state.rd_device_state !=
+			VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC) {
+
+			zone_id = pdev->ll_state.rd_zone_id + xtalk_result_id;
+			prange_data       = &(prs->VL53L1_p_002[0]);
+
+
+
+			if (prs->active_results > 1) {
+				for (j = 1;
+				j < prs->active_results; j++) {
+					if (prs->VL53L1_p_002[j].median_range_mm
+						<
+						prange_data->median_range_mm)
+						prange_data =
+						&(prs->VL53L1_p_002[j]);
+
+				}
+			}
+
+			pxtalk_range_data = &(pXR->VL53L1_p_002[zone_id]);
+
+
+
+
+			if ((prs->active_results > 0) &&
+				(prange_data->median_range_mm <
+						xtalk_filter_thresh_max_mm) &&
+				(prange_data->median_range_mm >
+						xtalk_filter_thresh_min_mm) &&
+				(prange_data->VL53L1_p_012 <
+				(uint32_t)(xtalk_max_valid_rate_kcps * 16)))
+				valid_result = 1;
+			else
+				valid_result = 0;
+
+			if (valid_result == 1) {
+
+				pxtalk_range_data->no_of_samples++;
+
+				pxtalk_range_data->rate_per_spad_kcps_sum +=
+					prange_data->VL53L1_p_012;
+
+				pxtalk_range_data->signal_total_events_sum +=
+					prange_data->VL53L1_p_013;
+
+				pxtalk_range_data->sigma_mm_sum +=
+					(uint32_t)prange_data->VL53L1_p_005;
+
+
+
+
+				pxtalk_range_data->median_phase_sum +=
+					(uint32_t)prange_data->VL53L1_p_014;
+
+
+
+
+
+
+
+
+
+
+			}
+
+			if ((valid_result == 1) && (zone_id >= 4)) {
+				status = VL53L1_sum_histogram_data(
+						&(pdev->hist_data),
+						psum_histo);
+
+
+
+
+
+				if (prange_data->VL53L1_p_015 <
+					pXR->central_histogram__window_start)
+					pXR->central_histogram__window_start =
+					prange_data->VL53L1_p_015;
+
+
+
+				if (prange_data->VL53L1_p_016 >
+					pXR->central_histogram__window_end)
+					pXR->central_histogram__window_end =
+						prange_data->VL53L1_p_016;
+
+			}
+
+		}
+
+
+
+
+
+
+
+#ifdef VL53L1_LOG_ENABLE
+		if (status == VL53L1_ERROR_NONE) {
+			VL53L1_print_range_results(
+					&(pres->range_results),
+					"pres->range_results.",
+					VL53L1_TRACE_MODULE_CORE);
+		}
+#endif
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_wait_for_firmware_ready(Dev);
+
+
+
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_clear_interrupt_and_enable_next_range(
+					Dev,
+					measurement_mode);
+
+
+	}
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_stop_range(Dev);
+
+
+
+
+
+	for (i = 0; i < (pdev->zone_cfg.active_zones+1); i++) {
+
+		pxtalk_range_data = &(pXR->VL53L1_p_002[i+xtalk_result_id]);
+
+		if (pxtalk_range_data->no_of_samples > 0) {
+			pxtalk_range_data->rate_per_spad_kcps_avg =
+			pxtalk_range_data->rate_per_spad_kcps_sum /
+			(uint32_t)pxtalk_range_data->no_of_samples;
+
+			pxtalk_range_data->signal_total_events_avg =
+			pxtalk_range_data->signal_total_events_sum /
+			(int32_t)pxtalk_range_data->no_of_samples;
+
+			pxtalk_range_data->sigma_mm_avg =
+			pxtalk_range_data->sigma_mm_sum /
+			(uint32_t)pxtalk_range_data->no_of_samples;
+
+
+
+
+			pxtalk_range_data->median_phase_avg =
+				pxtalk_range_data->median_phase_sum /
+				(uint32_t)pxtalk_range_data->no_of_samples;
+
+
+
+
+		} else {
+			pxtalk_range_data->rate_per_spad_kcps_avg =
+				pxtalk_range_data->rate_per_spad_kcps_sum;
+			pxtalk_range_data->signal_total_events_avg =
+				pxtalk_range_data->signal_total_events_sum;
+			pxtalk_range_data->sigma_mm_avg =
+				pxtalk_range_data->sigma_mm_sum;
+
+
+
+
+			pxtalk_range_data->median_phase_avg =
+					pxtalk_range_data->median_phase_sum;
+
+
+
+		}
+	}
+
+
+
+
+	memcpy(pavg_histo, &(pdev->hist_data),
+			sizeof(VL53L1_histogram_bin_data_t));
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		pxtalk_range_data = &(pXR->VL53L1_p_002[xtalk_histo_id]);
+
+		status = VL53L1_avg_histogram_data(
+			pxtalk_range_data->no_of_samples,
+			psum_histo,
+			pavg_histo);
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		if (smudge_corr_en == 1)
+			status = VL53L1_dynamic_xtalk_correction_enable(Dev);
+	}
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_run_offset_calibration(
+	VL53L1_DEV	                  Dev,
+	int16_t                       cal_distance_mm,
+	uint16_t                      cal_reflectance_pc,
+	VL53L1_Error                 *pcal_status)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_DevicePresetModes device_preset_modes[
+				VL53L1_MAX_OFFSET_RANGE_RESULTS];
+
+	VL53L1_range_results_t      range_results;
+	VL53L1_range_results_t     *prange_results = &range_results;
+	VL53L1_range_data_t        *pRData = NULL;
+	VL53L1_offset_range_data_t *pfs     = NULL;
+	VL53L1_general_config_t *pG = &(pdev->gen_cfg);
+	VL53L1_additional_offset_cal_data_t *pAO = &(pdev->add_off_cal_data);
+
+	uint8_t  i                      = 0;
+	uint8_t  m                      = 0;
+	uint8_t  measurement_mode       =
+		VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	uint16_t manual_effective_spads =
+		pG->dss_config__manual_effective_spads_select;
+
+	uint8_t num_of_samples[VL53L1_MAX_OFFSET_RANGE_RESULTS];
+
+	uint8_t smudge_corr_en   = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	switch (pdev->offset_calibration_mode) {
+
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM:
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM_PRE_RANGE_ONLY:
+		device_preset_modes[0] =
+			VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING;
+		device_preset_modes[1] =
+			VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM1_CAL;
+		device_preset_modes[2] =
+			VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM2_CAL;
+	break;
+
+	default:
+		device_preset_modes[0] =
+			VL53L1_DEVICEPRESETMODE_STANDARD_RANGING;
+		device_preset_modes[1] =
+			VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM1_CAL;
+		device_preset_modes[2] =
+			VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM2_CAL;
+	break;
+	}
+
+
+
+
+
+	num_of_samples[0] = pdev->offsetcal_cfg.pre_num_of_samples;
+	num_of_samples[1] = pdev->offsetcal_cfg.mm1_num_of_samples;
+	num_of_samples[2] = pdev->offsetcal_cfg.mm2_num_of_samples;
+
+
+
+
+
+
+	switch (pdev->offset_calibration_mode) {
+
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD_PRE_RANGE_ONLY:
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM_PRE_RANGE_ONLY:
+
+
+		pdev->offset_results.active_results  = 1;
+
+	break;
+
+	default:
+
+		pdev->customer.mm_config__inner_offset_mm  = 0;
+		pdev->customer.mm_config__outer_offset_mm  = 0;
+		pdev->offset_results.active_results  =
+			VL53L1_MAX_OFFSET_RANGE_RESULTS;
+
+	break;
+	}
+
+	pdev->customer.algo__part_to_part_range_offset_mm = 0;
+
+
+
+
+	pdev->offset_results.max_results   = VL53L1_MAX_OFFSET_RANGE_RESULTS;
+	pdev->offset_results.cal_distance_mm       = cal_distance_mm;
+	pdev->offset_results.cal_reflectance_pc    = cal_reflectance_pc;
+
+	for (m = 0; m <  VL53L1_MAX_OFFSET_RANGE_RESULTS; m++) {
+
+		pfs = &(pdev->offset_results.VL53L1_p_002[m]);
+		pfs->preset_mode         = 0;
+		pfs->no_of_samples       = 0;
+		pfs->effective_spads     = 0;
+		pfs->peak_rate_mcps      = 0;
+		pfs->VL53L1_p_005            = 0;
+		pfs->median_range_mm     = 0;
+	}
+
+
+
+
+
+
+	smudge_corr_en = pdev->smudge_correct_config.smudge_corr_enabled;
+
+	status = VL53L1_dynamic_xtalk_correction_disable(Dev);
+
+
+
+
+	for (m = 0; m < pdev->offset_results.active_results; m++) {
+
+		pfs = &(pdev->offset_results.VL53L1_p_002[m]);
+
+		pfs->preset_mode         = device_preset_modes[m];
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+			VL53L1_set_preset_mode(
+			Dev,
+			device_preset_modes[m],
+
+
+			pdev->offsetcal_cfg.dss_config__target_total_rate_mcps,
+			pdev->offsetcal_cfg.phasecal_config_timeout_us,
+			pdev->offsetcal_cfg.mm_config_timeout_us,
+			pdev->offsetcal_cfg.range_config_timeout_us,
+
+
+			100);
+
+		pG->dss_config__manual_effective_spads_select =
+				manual_effective_spads;
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+			VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS);
+
+		for (i = 0; i <= (num_of_samples[m]+2); i++) {
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_wait_for_range_completion(Dev);
+
+
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_get_device_results(
+						Dev,
+						VL53L1_DEVICERESULTSLEVEL_FULL,
+						prange_results);
+
+
+
+
+
+
+
+
+
+			pRData  = &(prange_results->VL53L1_p_002[0]);
+
+			if ((prange_results->active_results > 0 &&
+				prange_results->stream_count   > 1) &&
+				(pRData->range_status ==
+				VL53L1_DEVICEERROR_RANGECOMPLETE)) {
+
+				pfs->no_of_samples++;
+				pfs->effective_spads +=
+				(uint32_t)pRData->VL53L1_p_006;
+				pfs->peak_rate_mcps  +=
+				(uint32_t)pRData->peak_signal_count_rate_mcps;
+				pfs->VL53L1_p_005        +=
+					(uint32_t)pRData->VL53L1_p_005;
+				pfs->median_range_mm +=
+					(int32_t)pRData->median_range_mm;
+
+				pfs->dss_config__roi_mode_control =
+				pG->dss_config__roi_mode_control;
+				pfs->dss_config__manual_effective_spads_select =
+				pG->dss_config__manual_effective_spads_select;
+
+			}
+
+
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_wait_for_firmware_ready(Dev);
+
+
+
+
+
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+				VL53L1_clear_interrupt_and_enable_next_range(
+					Dev,
+					measurement_mode);
+		}
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_stop_range(Dev);
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WaitUs(Dev, 1000);
+
+
+
+		if (pfs->no_of_samples > 0) {
+
+			pfs->effective_spads += (pfs->no_of_samples/2);
+			pfs->effective_spads /= pfs->no_of_samples;
+
+			pfs->peak_rate_mcps  += (pfs->no_of_samples/2);
+			pfs->peak_rate_mcps  /= pfs->no_of_samples;
+
+			pfs->VL53L1_p_005        += (pfs->no_of_samples/2);
+			pfs->VL53L1_p_005        /= pfs->no_of_samples;
+
+			pfs->median_range_mm += (pfs->no_of_samples/2);
+			pfs->median_range_mm /= pfs->no_of_samples;
+
+			pfs->range_mm_offset  =  (int32_t)cal_distance_mm;
+			pfs->range_mm_offset -= pfs->median_range_mm;
+
+
+
+			if (pfs->preset_mode ==
+				VL53L1_DEVICEPRESETMODE_STANDARD_RANGING)
+				manual_effective_spads =
+					(uint16_t)pfs->effective_spads;
+		}
+	}
+
+
+
+
+	switch (pdev->offset_calibration_mode) {
+
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD_PRE_RANGE_ONLY:
+	case VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__HISTOGRAM_PRE_RANGE_ONLY:
+
+
+
+		pdev->customer.mm_config__inner_offset_mm +=
+		(int16_t)pdev->offset_results.VL53L1_p_002[0].range_mm_offset;
+		pdev->customer.mm_config__outer_offset_mm +=
+		(int16_t)pdev->offset_results.VL53L1_p_002[0].range_mm_offset;
+	break;
+
+	default:
+
+
+		pdev->customer.mm_config__inner_offset_mm =
+		(int16_t)pdev->offset_results.VL53L1_p_002[1].range_mm_offset;
+		pdev->customer.mm_config__outer_offset_mm =
+		(int16_t)pdev->offset_results.VL53L1_p_002[2].range_mm_offset;
+		pdev->customer.algo__part_to_part_range_offset_mm = 0;
+
+
+
+
+
+		pAO->result__mm_inner_actual_effective_spads =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[1].effective_spads;
+		pAO->result__mm_outer_actual_effective_spads =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[2].effective_spads;
+
+		pAO->result__mm_inner_peak_signal_count_rtn_mcps =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[1].peak_rate_mcps;
+		pAO->result__mm_outer_peak_signal_count_rtn_mcps =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[2].peak_rate_mcps;
+
+		break;
+	}
+
+
+
+
+
+
+
+	pdev->cust_dmax_cal.ref__actual_effective_spads =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[0].effective_spads;
+	pdev->cust_dmax_cal.ref__peak_signal_count_rate_mcps =
+		(uint16_t)pdev->offset_results.VL53L1_p_002[0].peak_rate_mcps;
+
+
+
+	pdev->cust_dmax_cal.ref__distance_mm = cal_distance_mm * 16;
+
+	pdev->cust_dmax_cal.ref_reflectance_pc = cal_reflectance_pc;
+	pdev->cust_dmax_cal.coverglass_transmission = 0x0100;
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_customer_nvm_managed(
+				Dev,
+				&(pdev->customer));
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		if (smudge_corr_en == 1)
+			status = VL53L1_dynamic_xtalk_correction_enable(Dev);
+	}
+
+
+
+
+
+
+
+
+	for (m = 0; m < pdev->offset_results.active_results; m++) {
+
+		pfs = &(pdev->offset_results.VL53L1_p_002[m]);
+
+		if (status == VL53L1_ERROR_NONE) {
+
+			pdev->offset_results.cal_report = m;
+
+			if (pfs->no_of_samples < num_of_samples[m])
+				status =
+				VL53L1_WARNING_OFFSET_CAL_MISSING_SAMPLES;
+
+
+
+
+
+
+			if (m == 0 && pfs->VL53L1_p_005 >
+				((uint32_t)VL53L1_OFFSET_CAL_MAX_SIGMA_MM << 5))
+				status =
+				VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH;
+
+			if (pfs->peak_rate_mcps >
+				VL53L1_OFFSET_CAL_MAX_PRE_PEAK_RATE_MCPS)
+				status =
+				VL53L1_WARNING_OFFSET_CAL_RATE_TOO_HIGH;
+
+			if (pfs->dss_config__manual_effective_spads_select <
+				VL53L1_OFFSET_CAL_MIN_EFFECTIVE_SPADS)
+				status =
+				VL53L1_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW;
+
+			if (pfs->dss_config__manual_effective_spads_select == 0)
+				status =
+				VL53L1_ERROR_OFFSET_CAL_NO_SPADS_ENABLED_FAIL;
+
+			if (pfs->no_of_samples == 0)
+				status = VL53L1_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL;
+		}
+	}
+
+
+
+
+
+
+	pdev->offset_results.cal_status = status;
+	*pcal_status = pdev->offset_results.cal_status;
+
+
+
+
+	IGNORE_STATUS(
+		IGNORE_OFFSET_CAL_MISSING_SAMPLES,
+		VL53L1_WARNING_OFFSET_CAL_MISSING_SAMPLES,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_OFFSET_CAL_SIGMA_TOO_HIGH,
+		VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_OFFSET_CAL_RATE_TOO_HIGH,
+		VL53L1_WARNING_OFFSET_CAL_RATE_TOO_HIGH,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_OFFSET_CAL_SPAD_COUNT_TOO_LOW,
+		VL53L1_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW,
+		status);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+	VL53L1_print_customer_nvm_managed(
+		&(pdev->customer),
+		"run_offset_calibration():pdev->lldata.customer.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+
+	VL53L1_print_dmax_calibration_data(
+		&(pdev->fmt_dmax_cal),
+		"run_offset_calibration():pdev->lldata.fmt_dmax_cal.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+
+	VL53L1_print_dmax_calibration_data(
+		&(pdev->cust_dmax_cal),
+		"run_offset_calibration():pdev->lldata.cust_dmax_cal.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+
+	VL53L1_print_additional_offset_cal_data(
+		&(pdev->add_off_cal_data),
+		"run_offset_calibration():pdev->lldata.add_off_cal_data.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+
+	VL53L1_print_offset_range_results(
+		&(pdev->offset_results),
+		"run_offset_calibration():pdev->lldata.offset_results.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_run_phasecal_average(
+	VL53L1_DEV	            Dev,
+	uint8_t                 measurement_mode,
+	uint8_t                 phasecal_result__vcsel_start,
+	uint16_t                phasecal_num_of_samples,
+	VL53L1_range_results_t *prange_results,
+	uint16_t               *pphasecal_result__reference_phase,
+	uint16_t               *pzero_distance_phase)
+{
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint16_t  i                                = 0;
+	uint16_t  m                                = 0;
+	uint32_t  samples                          = 0;
+
+	uint32_t  period                           = 0;
+	uint32_t  VL53L1_p_017                            = 0;
+	uint32_t  phasecal_result__reference_phase = 0;
+	uint32_t  zero_distance_phase              = 0;
+
+
+
+
+	for (m = 0; m < phasecal_num_of_samples; m++) {
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+			VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS);
+
+		for (i = 0; i <= 1; i++) {
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_wait_for_range_completion(Dev);
+
+
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_get_device_results(
+						Dev,
+						VL53L1_DEVICERESULTSLEVEL_FULL,
+						prange_results);
+
+
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+					VL53L1_wait_for_firmware_ready(Dev);
+
+
+
+
+
+
+			if (status == VL53L1_ERROR_NONE)
+				status =
+				VL53L1_clear_interrupt_and_enable_next_range(
+					Dev,
+					measurement_mode);
+		}
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_stop_range(Dev);
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WaitUs(Dev, 1000);
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+
+			samples++;
+
+
+
+
+
+
+
+			period = 2048 *
+				(uint32_t)VL53L1_decode_vcsel_period(
+					pdev->hist_data.VL53L1_p_009);
+
+			VL53L1_p_017  = period;
+			VL53L1_p_017 += (uint32_t)(
+			pdev->hist_data.phasecal_result__reference_phase);
+			VL53L1_p_017 +=
+				(2048 *
+				(uint32_t)phasecal_result__vcsel_start);
+			VL53L1_p_017 -= (2048 *
+			(uint32_t)pdev->hist_data.cal_config__vcsel_start);
+
+			VL53L1_p_017  = VL53L1_p_017 % period;
+
+			phasecal_result__reference_phase += (uint32_t)(
+			pdev->hist_data.phasecal_result__reference_phase);
+
+			zero_distance_phase += (uint32_t)VL53L1_p_017;
+		}
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE && samples > 0) {
+
+		phasecal_result__reference_phase += (samples >> 1);
+		phasecal_result__reference_phase /= samples;
+
+		zero_distance_phase += (samples >> 1);
+		zero_distance_phase /= samples;
+
+		*pphasecal_result__reference_phase =
+			(uint16_t)phasecal_result__reference_phase;
+		*pzero_distance_phase =
+			(uint16_t)zero_distance_phase;
+	}
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_run_zone_calibration(
+	VL53L1_DEV	                  Dev,
+	VL53L1_DevicePresetModes      device_preset_mode,
+	VL53L1_DeviceZonePreset       zone_preset,
+	VL53L1_zone_config_t         *pzone_cfg,
+	int16_t                       cal_distance_mm,
+	uint16_t                      cal_reflectance_pc,
+	VL53L1_Error                 *pcal_status)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_LLDriverResults_t *pres =
+		VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_range_results_t          range_results;
+	VL53L1_range_results_t         *pRR = &range_results;
+	VL53L1_range_data_t            *prange_data = NULL;
+	VL53L1_zone_calibration_data_t *pzone_data  = NULL;
+
+	uint16_t  i                      = 0;
+	uint16_t  m                      = 0;
+
+	uint8_t   z                      = 0;
+	uint8_t   measurement_mode       =
+		VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+
+	VL53L1_OffsetCorrectionMode  offset_cor_mode =
+			VL53L1_OFFSETCORRECTIONMODE__NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_preset_mode(
+			Dev,
+			device_preset_mode,
+
+
+			pdev->zonecal_cfg.dss_config__target_total_rate_mcps,
+			pdev->zonecal_cfg.phasecal_config_timeout_us,
+			pdev->zonecal_cfg.mm_config_timeout_us,
+			pdev->zonecal_cfg.range_config_timeout_us,
+
+
+			100);
+
+
+
+
+	if (zone_preset == VL53L1_DEVICEZONEPRESET_CUSTOM) {
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_set_zone_config(
+					Dev,
+					pzone_cfg);
+
+	} else if (zone_preset != VL53L1_DEVICEZONEPRESET_NONE) {
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_set_zone_preset(
+					Dev,
+					zone_preset);
+	}
+
+
+
+
+
+
+	pres->zone_cal.preset_mode        = device_preset_mode;
+	pres->zone_cal.zone_preset        = zone_preset;
+
+
+	pres->zone_cal.cal_distance_mm    = cal_distance_mm * 16;
+	pres->zone_cal.cal_reflectance_pc = cal_reflectance_pc;
+	pres->zone_cal.max_zones          = VL53L1_MAX_USER_ZONES;
+	pres->zone_cal.active_zones       = pdev->zone_cfg.active_zones + 1;
+
+	for (i = 0; i < VL53L1_MAX_USER_ZONES; i++) {
+		pres->zone_cal.VL53L1_p_002[i].no_of_samples   = 0;
+		pres->zone_cal.VL53L1_p_002[i].effective_spads = 0;
+		pres->zone_cal.VL53L1_p_002[i].peak_rate_mcps  = 0;
+		pres->zone_cal.VL53L1_p_002[i].VL53L1_p_014    = 0;
+		pres->zone_cal.VL53L1_p_002[i].VL53L1_p_005        = 0;
+		pres->zone_cal.VL53L1_p_002[i].median_range_mm = 0;
+		pres->zone_cal.VL53L1_p_002[i].range_mm_offset = 0;
+	}
+
+	pres->zone_cal.phasecal_result__reference_phase = 0;
+	pres->zone_cal.zero_distance_phase              = 0;
+
+
+
+
+
+
+
+	status =
+		VL53L1_get_offset_correction_mode(
+			Dev,
+			&offset_cor_mode);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_offset_correction_mode(
+				Dev,
+				VL53L1_OFFSETCORRECTIONMODE__NONE);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS);
+
+
+
+
+
+
+	m = (pdev->zonecal_cfg.zone_num_of_samples + 2) *
+			(uint16_t)pres->zone_cal.active_zones;
+
+
+
+	for (i = 0; i <= m; i++) {
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_wait_for_range_completion(Dev);
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_get_device_results(
+					Dev,
+					VL53L1_DEVICERESULTSLEVEL_FULL,
+					pRR);
+
+
+
+
+
+
+
+
+
+		prange_data  = &(pRR->VL53L1_p_002[0]);
+
+		if (pRR->active_results > 0 &&
+			i > (uint16_t)pres->zone_cal.active_zones) {
+
+			if (prange_data->range_status ==
+				VL53L1_DEVICEERROR_RANGECOMPLETE) {
+
+				pres->zone_cal.phasecal_result__reference_phase
+				=
+				pdev->hist_data.phasecal_result__reference_phase
+				;
+				pres->zone_cal.zero_distance_phase =
+					pdev->hist_data.zero_distance_phase;
+
+				pzone_data =
+				&(pres->zone_cal.VL53L1_p_002[pRR->zone_id]);
+				pzone_data->no_of_samples++;
+				pzone_data->effective_spads +=
+				(uint32_t)prange_data->VL53L1_p_006;
+				pzone_data->peak_rate_mcps  += (uint32_t)(
+				prange_data->peak_signal_count_rate_mcps);
+				pzone_data->VL53L1_p_014  +=
+				(uint32_t)prange_data->VL53L1_p_014;
+				pzone_data->VL53L1_p_005        +=
+				(uint32_t)prange_data->VL53L1_p_005;
+				pzone_data->median_range_mm +=
+				(int32_t)prange_data->median_range_mm;
+
+			}
+		}
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_wait_for_firmware_ready(Dev);
+
+
+
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_clear_interrupt_and_enable_next_range(
+					Dev,
+					measurement_mode);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_stop_range(Dev);
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WaitUs(Dev, 1000);
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_run_phasecal_average(
+			Dev,
+			measurement_mode,
+			pdev->hist_data.phasecal_result__vcsel_start,
+
+
+			pdev->zonecal_cfg.phasecal_num_of_samples,
+
+
+			pRR,
+			&(pres->zone_cal.phasecal_result__reference_phase),
+			&(pres->zone_cal.zero_distance_phase));
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_offset_correction_mode(
+				Dev,
+				offset_cor_mode);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		for (z = 0; z < pres->zone_cal.active_zones; z++) {
+
+			pzone_data = &(pres->zone_cal.VL53L1_p_002[z]);
+
+
+
+			if (pzone_data->no_of_samples > 0) {
+
+				pzone_data->effective_spads +=
+					(pzone_data->no_of_samples/2);
+				pzone_data->effective_spads /=
+					pzone_data->no_of_samples;
+
+				pzone_data->peak_rate_mcps  +=
+					(pzone_data->no_of_samples/2);
+				pzone_data->peak_rate_mcps  /=
+					pzone_data->no_of_samples;
+
+				pzone_data->VL53L1_p_014    +=
+					(pzone_data->no_of_samples/2);
+				pzone_data->VL53L1_p_014    /=
+					pzone_data->no_of_samples;
+
+				pzone_data->VL53L1_p_005        +=
+					(pzone_data->no_of_samples/2);
+				pzone_data->VL53L1_p_005        /=
+					pzone_data->no_of_samples;
+
+
+
+
+
+
+
+				pzone_data->median_range_mm =
+				VL53L1_range_maths(
+				pdev->stat_nvm.osc_measured__fast_osc__frequency
+				, (uint16_t)pzone_data->VL53L1_p_014,
+				pres->zone_cal.zero_distance_phase,
+				2,
+
+				0x0800,
+
+				0);
+
+
+				pzone_data->range_mm_offset  =
+						((int32_t)cal_distance_mm) * 4;
+				pzone_data->range_mm_offset -=
+						pzone_data->median_range_mm;
+
+
+
+				if (pzone_data->no_of_samples <
+					pdev->zonecal_cfg.zone_num_of_samples)
+					status =
+					VL53L1_WARNING_ZONE_CAL_MISSING_SAMPLES;
+
+
+
+				if (pzone_data->VL53L1_p_005 >
+					((uint32_t)VL53L1_ZONE_CAL_MAX_SIGMA_MM
+							<< 5))
+					status =
+					VL53L1_WARNING_ZONE_CAL_SIGMA_TOO_HIGH;
+
+				if (pzone_data->peak_rate_mcps >
+					VL53L1_ZONE_CAL_MAX_PRE_PEAK_RATE_MCPS)
+					status =
+					VL53L1_WARNING_ZONE_CAL_RATE_TOO_HIGH;
+
+			} else {
+				status = VL53L1_ERROR_ZONE_CAL_NO_SAMPLE_FAIL;
+			}
+		}
+	}
+
+
+
+
+
+
+	pres->zone_cal.cal_status = status;
+	*pcal_status = pres->zone_cal.cal_status;
+
+
+
+
+	IGNORE_STATUS(
+		IGNORE_ZONE_CAL_MISSING_SAMPLES,
+		VL53L1_WARNING_ZONE_CAL_MISSING_SAMPLES,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_ZONE_CAL_SIGMA_TOO_HIGH,
+		VL53L1_WARNING_ZONE_CAL_SIGMA_TOO_HIGH,
+		status);
+
+	IGNORE_STATUS(
+		IGNORE_ZONE_CAL_RATE_TOO_HIGH,
+		VL53L1_WARNING_ZONE_CAL_RATE_TOO_HIGH,
+		status);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+	VL53L1_print_zone_calibration_results(
+		&(pres->zone_cal),
+		"run_zone_calibration():pdev->llresults.zone_cal.",
+		VL53L1_TRACE_MODULE_OFFSET_DATA);
+
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_run_spad_rate_map(
+	VL53L1_DEV                 Dev,
+	VL53L1_DeviceTestMode      device_test_mode,
+	VL53L1_DeviceSscArray      array_select,
+	uint32_t                   ssc_config_timeout_us,
+	VL53L1_spad_rate_data_t   *pspad_rate_data)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_powerforce(Dev);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->ssc_cfg.array_select = array_select;
+		pdev->ssc_cfg.timeout_us   = ssc_config_timeout_us;
+		status =
+		VL53L1_set_ssc_config(
+			Dev,
+			&(pdev->ssc_cfg),
+			pdev->stat_nvm.osc_measured__fast_osc__frequency);
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_run_device_test(
+				Dev,
+				device_test_mode);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_get_spad_rate_data(
+				Dev,
+				pspad_rate_data);
+
+	if (device_test_mode == VL53L1_DEVICETESTMODE_LCR_VCSEL_ON)
+		pspad_rate_data->fractional_bits =  7;
+	else
+		pspad_rate_data->fractional_bits = 15;
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_powerforce(Dev);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		VL53L1_print_spad_rate_data(
+			pspad_rate_data,
+			"run_spad_rate_map():",
+			VL53L1_TRACE_MODULE_SPAD_RATE_MAP);
+		VL53L1_print_spad_rate_map(
+			pspad_rate_data,
+			"run_spad_rate_map():",
+			VL53L1_TRACE_MODULE_SPAD_RATE_MAP);
+	}
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_run_device_test(
+	VL53L1_DEV             Dev,
+	VL53L1_DeviceTestMode  device_test_mode)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t      comms_buffer[2];
+	uint8_t      gpio_hv_mux__ctrl = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_RdByte(
+				Dev,
+				VL53L1_GPIO_HV_MUX__CTRL,
+				&gpio_hv_mux__ctrl);
+
+	if (status == VL53L1_ERROR_NONE)
+		pdev->stat_cfg.gpio_hv_mux__ctrl = gpio_hv_mux__ctrl;
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_start_test(
+					Dev,
+					device_test_mode);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_wait_for_test_completion(Dev);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_ReadMulti(
+				Dev,
+				VL53L1_RESULT__RANGE_STATUS,
+				comms_buffer,
+				2);
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->sys_results.result__range_status  = comms_buffer[0];
+		pdev->sys_results.result__report_status = comms_buffer[1];
+	}
+
+
+
+
+	pdev->sys_results.result__range_status &=
+		VL53L1_RANGE_STATUS__RANGE_STATUS_MASK;
+
+	if (status == VL53L1_ERROR_NONE) {
+		trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"    Device Test Complete:\n\t%-32s = %3u\n\t%-32s = %3u\n",
+		"result__range_status",
+		pdev->sys_results.result__range_status,
+		"result__report_status",
+		pdev->sys_results.result__report_status);
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_clear_interrupt(Dev);
+	}
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_start_test(
+				Dev,
+				0x00);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+void VL53L1_hist_xtalk_extract_data_init(
+	VL53L1_hist_xtalk_extract_data_t *pxtalk_data)
+{
+
+
+
+
+
+	int32_t lb = 0;
+
+	pxtalk_data->sample_count             = 0U;
+	pxtalk_data->pll_period_mm            = 0U;
+	pxtalk_data->peak_duration_us_sum     = 0U;
+	pxtalk_data->effective_spad_count_sum = 0U;
+	pxtalk_data->zero_distance_phase_sum  = 0U;
+	pxtalk_data->zero_distance_phase_avg  = 0U;
+	pxtalk_data->event_scaler_sum         = 0U;
+	pxtalk_data->event_scaler_avg         = 4096U;
+	pxtalk_data->signal_events_sum        = 0;
+	pxtalk_data->xtalk_rate_kcps_per_spad = 0U;
+	pxtalk_data->VL53L1_p_015             = 0U;
+	pxtalk_data->VL53L1_p_016               = 0U;
+	pxtalk_data->target_start             = 0U;
+
+	for (lb = 0; lb < VL53L1_XTALK_HISTO_BINS; lb++)
+		pxtalk_data->bin_data_sums[lb] = 0;
+
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_update(
+	int16_t                             target_distance_mm,
+	uint16_t                            target_width_oversize,
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status =
+		VL53L1_hist_xtalk_extract_calc_window(
+			target_distance_mm,
+			target_width_oversize,
+			phist_bins,
+			pxtalk_data);
+
+	if (status == VL53L1_ERROR_NONE) {
+		status =
+			VL53L1_hist_xtalk_extract_calc_event_sums(
+				phist_bins,
+				pxtalk_data);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_fini(
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data,
+	VL53L1_xtalk_calibration_results_t *pxtalk_cal,
+	VL53L1_xtalk_histogram_shape_t     *pxtalk_shape)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_xtalk_calibration_results_t *pX = pxtalk_cal;
+
+	LOG_FUNCTION_START("");
+
+	if (pxtalk_data->sample_count > 0) {
+
+
+
+		pxtalk_data->event_scaler_avg  = pxtalk_data->event_scaler_sum;
+		pxtalk_data->event_scaler_avg +=
+				(pxtalk_data->sample_count >> 1);
+		pxtalk_data->event_scaler_avg /=  pxtalk_data->sample_count;
+
+
+
+
+
+
+		status =
+			VL53L1_hist_xtalk_extract_calc_rate_per_spad(
+				pxtalk_data);
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+
+
+
+			pxtalk_data->zero_distance_phase_avg =
+				pxtalk_data->zero_distance_phase_sum;
+			pxtalk_data->zero_distance_phase_avg +=
+					(pxtalk_data->sample_count >> 1);
+			pxtalk_data->zero_distance_phase_avg /=
+					pxtalk_data->sample_count;
+
+
+
+			status =
+				VL53L1_hist_xtalk_extract_calc_shape(
+					pxtalk_data,
+					pxtalk_shape);
+
+
+
+
+
+
+
+
+
+
+
+			pxtalk_shape->phasecal_result__vcsel_start =
+				phist_bins->phasecal_result__vcsel_start;
+			pxtalk_shape->cal_config__vcsel_start =
+				phist_bins->cal_config__vcsel_start;
+			pxtalk_shape->vcsel_width =
+				phist_bins->vcsel_width;
+			pxtalk_shape->VL53L1_p_019 =
+				phist_bins->VL53L1_p_019;
+		}
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+
+
+
+			pX->algo__crosstalk_compensation_plane_offset_kcps =
+				pxtalk_data->xtalk_rate_kcps_per_spad;
+			pX->algo__crosstalk_compensation_x_plane_gradient_kcps
+				= 0U;
+			pX->algo__crosstalk_compensation_y_plane_gradient_kcps
+				= 0U;
+
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error   VL53L1_run_hist_xtalk_extraction(
+	VL53L1_DEV	                        Dev,
+	int16_t                             cal_distance_mm,
+	VL53L1_Error                       *pcal_status)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status        = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_xtalkextract_config_t *pX = &(pdev->xtalk_extract_cfg);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_xtalk_calibration_results_t *pXC = &(pdev->xtalk_cal);
+
+
+
+
+
+
+	uint8_t smudge_corr_en   = 0;
+	uint8_t i                = 0;
+	uint8_t measurement_mode = VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+
+
+
+
+	VL53L1_range_results_t      range_results;
+	VL53L1_range_results_t     *prange_results = &range_results;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	VL53L1_hist_xtalk_extract_data_init(
+		&(pdev->xtalk_extract));
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_set_preset_mode(
+				Dev,
+				VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE,
+				pX->dss_config__target_total_rate_mcps,
+				pX->phasecal_config_timeout_us,
+				pX->mm_config_timeout_us,
+				pX->range_config_timeout_us,
+				100);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_disable_xtalk_compensation(
+			Dev);
+	}
+
+
+
+
+	smudge_corr_en = pdev->smudge_correct_config.smudge_corr_enabled;
+
+	if (status == VL53L1_ERROR_NONE) {
+		status =
+			VL53L1_dynamic_xtalk_correction_disable(Dev);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS);
+
+
+
+
+	for (i = 0; i <= pX->num_of_samples; i++) {
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_wait_for_range_completion(Dev);
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_get_device_results(
+					Dev,
+					VL53L1_DEVICERESULTSLEVEL_FULL,
+					prange_results);
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE &&
+			pdev->ll_state.rd_device_state !=
+				VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC) {
+
+			status =
+				VL53L1_hist_xtalk_extract_update(
+					cal_distance_mm,
+					4,
+
+					&(pdev->hist_data),
+					&(pdev->xtalk_extract));
+		}
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_wait_for_firmware_ready(Dev);
+
+
+
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_clear_interrupt_and_enable_next_range(
+					Dev,
+					measurement_mode);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_stop_range(Dev);
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_hist_xtalk_extract_fini(
+				&(pdev->hist_data),
+				&(pdev->xtalk_extract),
+				&(pdev->xtalk_cal),
+				&(pdev->xtalk_shapes.xtalk_shape));
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			pXC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			pXC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+		pC->algo__crosstalk_compensation_plane_offset_kcps =
+			pXC->algo__crosstalk_compensation_plane_offset_kcps;
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_xtalk_compensation(Dev);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		if (smudge_corr_en == 1)
+			status = VL53L1_dynamic_xtalk_correction_enable(Dev);
+
+
+
+
+
+
+	pdev->xtalk_results.cal_status = status;
+	*pcal_status = pdev->xtalk_results.cal_status;
+
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+	VL53L1_print_customer_nvm_managed(
+		&(pdev->customer),
+		"run_xtalk_extraction():pdev->lldata.customer.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_config(
+		&(pdev->xtalk_cfg),
+		"run_xtalk_extraction():pdev->lldata.xtalk_cfg.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+	VL53L1_print_xtalk_histogram_data(
+		&(pdev->xtalk_shapes),
+		"pdev->lldata.xtalk_shapes.",
+		VL53L1_TRACE_MODULE_XTALK_DATA);
+
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api_core.c b/drivers/input/misc/vl53L1/src/vl53l1_api_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..8ae39b0fe6328e03b4aed2b022c4ccfbe47f0aa4
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api_core.c
@@ -0,0 +1,7438 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_platform_ipp.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_register_funcs.h"
+#include "vl53l1_hist_map.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_nvm_map.h"
+#include "vl53l1_nvm_structs.h"
+#include "vl53l1_nvm.h"
+#include "vl53l1_core.h"
+#include "vl53l1_wait.h"
+#include "vl53l1_zone_presets.h"
+#include "vl53l1_api_preset_modes.h"
+#include "vl53l1_silicon_core.h"
+#include "vl53l1_api_core.h"
+#include "vl53l1_tuning_parm_defaults.h"
+
+#ifdef VL53L1_LOG_ENABLE
+#include "vl53l1_api_debug.h"
+#endif
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, status, \
+	fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_CORE, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+#define VL53L1_MAX_I2C_XFER_SIZE 256
+
+VL53L1_Error VL53L1_get_version(
+	VL53L1_DEV           Dev,
+	VL53L1_ll_version_t *pdata)
+{
+
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_init_version(Dev);
+
+	memcpy(pdata, &(pdev->version), sizeof(VL53L1_ll_version_t));
+
+	return VL53L1_ERROR_NONE;
+}
+
+
+VL53L1_Error VL53L1_get_device_firmware_version(
+	VL53L1_DEV        Dev,
+	uint16_t         *pfw_version)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_RdWord(
+				Dev,
+				VL53L1_MCU_GENERAL_PURPOSE__GP_0,
+				pfw_version);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_data_init(
+	VL53L1_DEV        Dev,
+	uint8_t           read_p2p_data)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t    *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+
+
+
+	VL53L1_zone_objects_t    *pobjects;
+
+	uint8_t  i = 0;
+
+	LOG_FUNCTION_START("");
+
+	VL53L1_init_ll_driver_state(
+			Dev,
+			VL53L1_DEVICESTATE_UNKNOWN);
+
+	pres->range_results.max_results    = VL53L1_MAX_RANGE_RESULTS;
+	pres->range_results.active_results = 0;
+	pres->zone_results.max_zones       = VL53L1_MAX_USER_ZONES;
+	pres->zone_results.active_zones    = 0;
+
+	for (i = 0; i < VL53L1_MAX_USER_ZONES; i++) {
+		pobjects = &(pres->zone_results.VL53L1_p_002[i]);
+		pobjects->xmonitor.VL53L1_p_020 = 0;
+		pobjects->xmonitor.VL53L1_p_021  = 0;
+		pobjects->xmonitor.VL53L1_p_014          = 0;
+		pobjects->xmonitor.range_status =
+				VL53L1_DEVICEERROR_NOUPDATE;
+	}
+
+
+
+
+	pres->zone_hists.max_zones         = VL53L1_MAX_USER_ZONES;
+	pres->zone_hists.active_zones      = 0;
+
+
+
+
+	pres->zone_cal.max_zones           = VL53L1_MAX_USER_ZONES;
+	pres->zone_cal.active_zones        = 0;
+	for (i = 0; i < VL53L1_MAX_USER_ZONES; i++) {
+		pres->zone_cal.VL53L1_p_002[i].no_of_samples   = 0;
+		pres->zone_cal.VL53L1_p_002[i].effective_spads = 0;
+		pres->zone_cal.VL53L1_p_002[i].peak_rate_mcps  = 0;
+		pres->zone_cal.VL53L1_p_002[i].median_range_mm = 0;
+		pres->zone_cal.VL53L1_p_002[i].range_mm_offset = 0;
+	}
+
+	pdev->wait_method             = VL53L1_WAIT_METHOD_BLOCKING;
+	pdev->preset_mode   = VL53L1_DEVICEPRESETMODE_STANDARD_RANGING;
+	pdev->zone_preset             = VL53L1_DEVICEZONEPRESET_NONE;
+	pdev->measurement_mode        = VL53L1_DEVICEMEASUREMENTMODE_STOP;
+
+	pdev->offset_calibration_mode =
+		VL53L1_OFFSETCALIBRATIONMODE__MM1_MM2__STANDARD;
+	pdev->offset_correction_mode  =
+		VL53L1_OFFSETCORRECTIONMODE__MM1_MM2_OFFSETS;
+	pdev->dmax_mode  =
+		VL53L1_DEVICEDMAXMODE__FMT_CAL_DATA;
+
+	pdev->phasecal_config_timeout_us  =  1000;
+	pdev->mm_config_timeout_us        =  2000;
+	pdev->range_config_timeout_us     = 13000;
+	pdev->inter_measurement_period_ms =   100;
+	pdev->dss_config__target_total_rate_mcps = 0x0A00;
+	pdev->debug_mode                  =  0x00;
+
+	pdev->offset_results.max_results    = VL53L1_MAX_OFFSET_RANGE_RESULTS;
+	pdev->offset_results.active_results = 0;
+
+
+
+
+
+	pdev->gain_cal.standard_ranging_gain_factor =
+			VL53L1_TUNINGPARM_LITE_RANGING_GAIN_FACTOR_DEFAULT;
+	pdev->gain_cal.histogram_ranging_gain_factor =
+			VL53L1_TUNINGPARM_HIST_GAIN_FACTOR_DEFAULT;
+
+
+
+
+
+	VL53L1_init_version(Dev);
+
+
+
+
+
+
+
+
+
+
+	if (read_p2p_data > 0 && status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_read_p2p_data(Dev);
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_refspadchar_config_struct(
+			&(pdev->refspadchar));
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_ssc_config_struct(
+			&(pdev->ssc_cfg));
+
+
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_xtalk_config_struct(
+			&(pdev->customer),
+			&(pdev->xtalk_cfg));
+
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_xtalk_extract_config_struct(
+			&(pdev->xtalk_extract_cfg));
+
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_offset_cal_config_struct(
+		    &(pdev->offsetcal_cfg));
+
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_zone_cal_config_struct(
+			&(pdev->zonecal_cfg));
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_hist_post_process_config_struct(
+			pdev->xtalk_cfg.global_crosstalk_compensation_enable,
+			&(pdev->histpostprocess));
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_hist_gen3_dmax_config_struct(
+			&(pdev->dmax_cfg));
+
+
+
+
+
+    if (status == VL53L1_ERROR_NONE)
+        status = VL53L1_init_tuning_parm_storage_struct(
+			&(pdev->tuning_parms));
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_set_preset_mode(
+			Dev,
+			pdev->preset_mode,
+			pdev->dss_config__target_total_rate_mcps,
+
+			pdev->phasecal_config_timeout_us,
+			pdev->mm_config_timeout_us,
+			pdev->range_config_timeout_us,
+			pdev->inter_measurement_period_ms);
+
+
+
+	VL53L1_init_histogram_bin_data_struct(
+			0,
+			VL53L1_HISTOGRAM_BUFFER_SIZE,
+			&(pdev->hist_data));
+
+	VL53L1_init_histogram_bin_data_struct(
+			0,
+			VL53L1_HISTOGRAM_BUFFER_SIZE,
+			&(pdev->hist_xtalk));
+
+
+
+	VL53L1_init_xtalk_bin_data_struct(
+			0,
+			VL53L1_XTALK_HISTO_BINS,
+			&(pdev->xtalk_shapes.xtalk_shape));
+
+
+
+
+
+	VL53L1_xtalk_cal_data_init(
+			Dev
+			);
+
+
+
+
+
+	VL53L1_dynamic_xtalk_correction_data_init(
+			Dev
+			);
+
+
+
+
+
+	VL53L1_low_power_auto_data_init(
+			Dev
+			);
+
+#ifdef VL53L1_LOG_ENABLE
+
+
+
+
+	VL53L1_print_static_nvm_managed(
+		&(pdev->stat_nvm),
+		"data_init():pdev->lldata.stat_nvm.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_customer_nvm_managed(
+		&(pdev->customer),
+		"data_init():pdev->lldata.customer.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_nvm_copy_data(
+		&(pdev->nvm_copy_data),
+		"data_init():pdev->lldata.nvm_copy_data.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_dmax_calibration_data(
+		&(pdev->fmt_dmax_cal),
+		"data_init():pdev->lldata.fmt_dmax_cal.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_dmax_calibration_data(
+		&(pdev->cust_dmax_cal),
+		"data_init():pdev->lldata.cust_dmax_cal.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_additional_offset_cal_data(
+		&(pdev->add_off_cal_data),
+		"data_init():pdev->lldata.add_off_cal_data.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_user_zone(
+		&(pdev->mm_roi),
+		"data_init():pdev->lldata.mm_roi.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_optical_centre(
+		&(pdev->optical_centre),
+		"data_init():pdev->lldata.optical_centre.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+	VL53L1_print_cal_peak_rate_map(
+		&(pdev->cal_peak_rate_map),
+		"data_init():pdev->lldata.cal_peak_rate_map.",
+		VL53L1_TRACE_MODULE_DATA_INIT);
+
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_read_p2p_data(
+	VL53L1_DEV        Dev)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+	VL53L1_additional_offset_cal_data_t *pCD = &(pdev->add_off_cal_data);
+
+	VL53L1_decoded_nvm_fmt_range_data_t fmt_rrd;
+
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_get_static_nvm_managed(
+						Dev,
+						&(pdev->stat_nvm));
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_get_customer_nvm_managed(
+						Dev,
+						&(pdev->customer));
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status = VL53L1_get_nvm_copy_data(
+						Dev,
+						&(pdev->nvm_copy_data));
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			VL53L1_copy_rtn_good_spads_to_buffer(
+					&(pdev->nvm_copy_data),
+					&(pdev->rtn_good_spads[0]));
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		pHP->algo__crosstalk_compensation_plane_offset_kcps =
+		pN->algo__crosstalk_compensation_plane_offset_kcps;
+		pHP->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pN->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pHP->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pN->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	}
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_read_nvm_optical_centre(
+				Dev,
+				&(pdev->optical_centre));
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_read_nvm_cal_peak_rate_map(
+				Dev,
+				&(pdev->cal_peak_rate_map));
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status =
+			VL53L1_read_nvm_additional_offset_cal_data(
+				Dev,
+				&(pdev->add_off_cal_data));
+
+
+
+
+
+
+		if (pCD->result__mm_inner_peak_signal_count_rtn_mcps == 0 &&
+			pCD->result__mm_outer_peak_signal_count_rtn_mcps == 0) {
+
+			pCD->result__mm_inner_peak_signal_count_rtn_mcps
+					= 0x0080;
+
+			pCD->result__mm_outer_peak_signal_count_rtn_mcps
+					= 0x0180;
+
+
+
+
+
+			VL53L1_calc_mm_effective_spads(
+			pdev->nvm_copy_data.roi_config__mode_roi_centre_spad,
+			pdev->nvm_copy_data.roi_config__mode_roi_xy_size,
+			0xC7,
+
+			0xFF,
+			&(pdev->rtn_good_spads[0]),
+			VL53L1_RTN_SPAD_APERTURE_TRANSMISSION,
+			&(pCD->result__mm_inner_actual_effective_spads),
+			&(pCD->result__mm_outer_actual_effective_spads));
+		}
+	}
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status =
+			VL53L1_read_nvm_fmt_range_results_data(
+				Dev,
+				VL53L1_NVM__FMT__RANGE_RESULTS__140MM_DARK,
+				&fmt_rrd);
+
+		if (status == VL53L1_ERROR_NONE) {
+			pdev->fmt_dmax_cal.ref__actual_effective_spads =
+			fmt_rrd.result__actual_effective_rtn_spads;
+			pdev->fmt_dmax_cal.ref__peak_signal_count_rate_mcps =
+			fmt_rrd.result__peak_signal_count_rate_rtn_mcps;
+			pdev->fmt_dmax_cal.ref__distance_mm =
+			fmt_rrd.measured_distance_mm;
+
+
+
+
+
+
+			if (pdev->cal_peak_rate_map.cal_reflectance_pc != 0) {
+				pdev->fmt_dmax_cal.ref_reflectance_pc =
+				pdev->cal_peak_rate_map.cal_reflectance_pc;
+			} else {
+				pdev->fmt_dmax_cal.ref_reflectance_pc = 0x0014;
+			}
+
+
+
+			pdev->fmt_dmax_cal.coverglass_transmission = 0x0100;
+		}
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_RdWord(
+				Dev,
+				VL53L1_RESULT__OSC_CALIBRATE_VAL,
+				&(pdev->dbg_results.result__osc_calibrate_val));
+
+
+
+
+
+
+	if (pdev->stat_nvm.osc_measured__fast_osc__frequency < 0x1000) {
+		trace_print(
+			VL53L1_TRACE_LEVEL_WARNING,
+			"\nInvalid %s value (0x%04X) - forcing to 0x%04X\n\n",
+			"pdev->stat_nvm.osc_measured__fast_osc__frequency",
+			pdev->stat_nvm.osc_measured__fast_osc__frequency,
+			0xBCCC);
+		pdev->stat_nvm.osc_measured__fast_osc__frequency = 0xBCCC;
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_get_mode_mitigation_roi(
+				Dev,
+				&(pdev->mm_roi));
+
+
+
+
+
+
+	if (pdev->optical_centre.x_centre == 0 &&
+		pdev->optical_centre.y_centre == 0) {
+		pdev->optical_centre.x_centre =
+				pdev->mm_roi.x_centre << 4;
+		pdev->optical_centre.y_centre =
+				pdev->mm_roi.y_centre << 4;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_software_reset(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_WrByte(
+						Dev,
+						VL53L1_SOFT_RESET,
+						0x00);
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WaitUs(
+				Dev,
+				VL53L1_SOFTWARE_RESET_DURATION_US);
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+						Dev,
+						VL53L1_SOFT_RESET,
+						0x01);
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_wait_for_boot_completion(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_part_to_part_data(
+	VL53L1_DEV                            Dev,
+	VL53L1_calibration_data_t            *pcal_data)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+
+	uint32_t tempu32;
+
+	LOG_FUNCTION_START("");
+
+	if (pcal_data->struct_version !=
+		VL53L1_LL_CALIBRATION_DATA_STRUCT_VERSION) {
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+		memcpy(
+			&(pdev->customer),
+			&(pcal_data->customer),
+			sizeof(VL53L1_customer_nvm_managed_t));
+
+
+
+		memcpy(
+			&(pdev->add_off_cal_data),
+			&(pcal_data->add_off_cal_data),
+			sizeof(VL53L1_additional_offset_cal_data_t));
+
+
+
+		memcpy(
+			&(pdev->fmt_dmax_cal),
+			&(pcal_data->fmt_dmax_cal),
+			sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+		memcpy(
+			&(pdev->cust_dmax_cal),
+			&(pcal_data->cust_dmax_cal),
+			sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+		memcpy(
+			&(pdev->xtalk_shapes),
+			&(pcal_data->xtalkhisto),
+			sizeof(VL53L1_xtalk_histogram_data_t));
+
+
+
+		memcpy(
+			&(pdev->gain_cal),
+			&(pcal_data->gain_cal),
+			sizeof(VL53L1_gain_calibration_data_t));
+
+
+
+		memcpy(
+			&(pdev->cal_peak_rate_map),
+			&(pcal_data->cal_peak_rate_map),
+			sizeof(VL53L1_cal_peak_rate_map_t));
+
+
+
+
+
+
+		pC->algo__crosstalk_compensation_plane_offset_kcps =
+			pN->algo__crosstalk_compensation_plane_offset_kcps;
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			pN->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			pN->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+		pHP->algo__crosstalk_compensation_plane_offset_kcps =
+			VL53L1_calc_crosstalk_plane_offset_with_margin(
+			pC->algo__crosstalk_compensation_plane_offset_kcps,
+			pC->histogram_mode_crosstalk_margin_kcps);
+
+		pHP->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pHP->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+		if (pC->global_crosstalk_compensation_enable == 0x00) {
+			pN->algo__crosstalk_compensation_plane_offset_kcps =
+				0x00;
+			pN->algo__crosstalk_compensation_x_plane_gradient_kcps =
+				0x00;
+			pN->algo__crosstalk_compensation_y_plane_gradient_kcps =
+				0x00;
+		} else {
+			tempu32 =
+			VL53L1_calc_crosstalk_plane_offset_with_margin(
+			pC->algo__crosstalk_compensation_plane_offset_kcps,
+			pC->lite_mode_crosstalk_margin_kcps);
+
+
+
+			if (tempu32 > 0xFFFF)
+				tempu32 = 0xFFFF;
+
+			pN->algo__crosstalk_compensation_plane_offset_kcps =
+				(uint16_t)tempu32;
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_part_to_part_data(
+	VL53L1_DEV                      Dev,
+	VL53L1_calibration_data_t      *pcal_data)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_customer_nvm_managed_t *pCN = &(pcal_data->customer);
+
+	LOG_FUNCTION_START("");
+
+	pcal_data->struct_version =
+			VL53L1_LL_CALIBRATION_DATA_STRUCT_VERSION;
+
+
+
+	memcpy(
+		&(pcal_data->customer),
+		&(pdev->customer),
+		sizeof(VL53L1_customer_nvm_managed_t));
+
+
+
+
+
+
+	if (pC->algo__crosstalk_compensation_plane_offset_kcps > 0xFFFF) {
+		pCN->algo__crosstalk_compensation_plane_offset_kcps =
+			0xFFFF;
+	} else {
+		pCN->algo__crosstalk_compensation_plane_offset_kcps =
+		(uint16_t)pC->algo__crosstalk_compensation_plane_offset_kcps;
+	}
+	pCN->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pCN->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+	memcpy(
+		&(pcal_data->fmt_dmax_cal),
+		&(pdev->fmt_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+	memcpy(
+		&(pcal_data->cust_dmax_cal),
+		&(pdev->cust_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+
+
+	memcpy(
+		&(pcal_data->add_off_cal_data),
+		&(pdev->add_off_cal_data),
+		sizeof(VL53L1_additional_offset_cal_data_t));
+
+
+
+	memcpy(
+		&(pcal_data->optical_centre),
+		&(pdev->optical_centre),
+		sizeof(VL53L1_optical_centre_t));
+
+
+
+	memcpy(
+		&(pcal_data->xtalkhisto),
+		&(pdev->xtalk_shapes),
+		sizeof(VL53L1_xtalk_histogram_data_t));
+
+
+
+	memcpy(
+		&(pcal_data->gain_cal),
+		&(pdev->gain_cal),
+		sizeof(VL53L1_gain_calibration_data_t));
+
+
+
+	memcpy(
+		&(pcal_data->cal_peak_rate_map),
+		&(pdev->cal_peak_rate_map),
+		sizeof(VL53L1_cal_peak_rate_map_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_inter_measurement_period_ms(
+	VL53L1_DEV              Dev,
+	uint32_t                inter_measurement_period_ms)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->dbg_results.result__osc_calibrate_val == 0)
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->inter_measurement_period_ms = inter_measurement_period_ms;
+		pdev->tim_cfg.system__intermeasurement_period =
+			inter_measurement_period_ms *
+			(uint32_t)pdev->dbg_results.result__osc_calibrate_val;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_inter_measurement_period_ms(
+	VL53L1_DEV              Dev,
+	uint32_t               *pinter_measurement_period_ms)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->dbg_results.result__osc_calibrate_val == 0)
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+
+	if (status == VL53L1_ERROR_NONE)
+		*pinter_measurement_period_ms =
+			pdev->tim_cfg.system__intermeasurement_period /
+			(uint32_t)pdev->dbg_results.result__osc_calibrate_val;
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_timeouts_us(
+	VL53L1_DEV          Dev,
+	uint32_t            phasecal_config_timeout_us,
+	uint32_t            mm_config_timeout_us,
+	uint32_t            range_config_timeout_us)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->stat_nvm.osc_measured__fast_osc__frequency == 0)
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		pdev->phasecal_config_timeout_us = phasecal_config_timeout_us;
+		pdev->mm_config_timeout_us       = mm_config_timeout_us;
+		pdev->range_config_timeout_us    = range_config_timeout_us;
+
+		status =
+		VL53L1_calc_timeout_register_values(
+			phasecal_config_timeout_us,
+			mm_config_timeout_us,
+			range_config_timeout_us,
+			pdev->stat_nvm.osc_measured__fast_osc__frequency,
+			&(pdev->gen_cfg),
+			&(pdev->tim_cfg));
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_timeouts_us(
+	VL53L1_DEV           Dev,
+	uint32_t            *pphasecal_config_timeout_us,
+	uint32_t            *pmm_config_timeout_us,
+	uint32_t			*prange_config_timeout_us)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint32_t  macro_period_us = 0;
+	uint16_t  timeout_encoded = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->stat_nvm.osc_measured__fast_osc__frequency == 0)
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+		macro_period_us =
+			VL53L1_calc_macro_period_us(
+			pdev->stat_nvm.osc_measured__fast_osc__frequency,
+			pdev->tim_cfg.range_config__vcsel_period_a);
+
+
+
+
+		*pphasecal_config_timeout_us =
+			VL53L1_calc_timeout_us(
+			(uint32_t)pdev->gen_cfg.phasecal_config__timeout_macrop,
+			macro_period_us);
+
+
+
+
+		timeout_encoded =
+			(uint16_t)pdev->tim_cfg.mm_config__timeout_macrop_a_hi;
+		timeout_encoded = (timeout_encoded << 8) +
+			(uint16_t)pdev->tim_cfg.mm_config__timeout_macrop_a_lo;
+
+		*pmm_config_timeout_us =
+			VL53L1_calc_decoded_timeout_us(
+				timeout_encoded,
+				macro_period_us);
+
+
+
+
+		timeout_encoded =
+		(uint16_t)pdev->tim_cfg.range_config__timeout_macrop_a_hi;
+		timeout_encoded = (timeout_encoded << 8) +
+		(uint16_t)pdev->tim_cfg.range_config__timeout_macrop_a_lo;
+
+		*prange_config_timeout_us =
+			VL53L1_calc_decoded_timeout_us(
+				timeout_encoded,
+				macro_period_us);
+
+		pdev->phasecal_config_timeout_us = *pphasecal_config_timeout_us;
+		pdev->mm_config_timeout_us       = *pmm_config_timeout_us;
+		pdev->range_config_timeout_us    = *prange_config_timeout_us;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_calibration_repeat_period(
+	VL53L1_DEV          Dev,
+	uint16_t            cal_config__repeat_period)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->gen_cfg.cal_config__repeat_rate = cal_config__repeat_period;
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_calibration_repeat_period(
+	VL53L1_DEV          Dev,
+	uint16_t           *pcal_config__repeat_period)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	*pcal_config__repeat_period = pdev->gen_cfg.cal_config__repeat_rate;
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_set_sequence_config_bit(
+	VL53L1_DEV                    Dev,
+	VL53L1_DeviceSequenceConfig   bit_id,
+	uint8_t                       value)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  bit_mask        = 0x01;
+	uint8_t  clr_mask        = 0xFF  - bit_mask;
+	uint8_t  bit_value       = value & bit_mask;
+
+	if (bit_id <= VL53L1_DEVICESEQUENCECONFIG_RANGE) {
+
+		if (bit_id > 0) {
+			bit_mask  = 0x01 << bit_id;
+			bit_value = bit_value << bit_id;
+			clr_mask  = 0xFF  - bit_mask;
+		}
+
+		pdev->dyn_cfg.system__sequence_config =
+			(pdev->dyn_cfg.system__sequence_config & clr_mask) |
+			bit_value;
+
+	} else {
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_sequence_config_bit(
+	VL53L1_DEV                    Dev,
+	VL53L1_DeviceSequenceConfig   bit_id,
+	uint8_t                      *pvalue)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  bit_mask        = 0x01;
+
+	if (bit_id <= VL53L1_DEVICESEQUENCECONFIG_RANGE) {
+
+		if (bit_id > 0)
+			bit_mask  = 0x01 << bit_id;
+
+		*pvalue =
+			pdev->dyn_cfg.system__sequence_config & bit_mask;
+
+		if (bit_id > 0)
+			*pvalue  = *pvalue >> bit_id;
+
+	} else {
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_interrupt_polarity(
+	VL53L1_DEV                      Dev,
+	VL53L1_DeviceInterruptPolarity  interrupt_polarity)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->stat_cfg.gpio_hv_mux__ctrl =
+			(pdev->stat_cfg.gpio_hv_mux__ctrl &
+			VL53L1_DEVICEINTERRUPTPOLARITY_CLEAR_MASK) |
+			(interrupt_polarity &
+			VL53L1_DEVICEINTERRUPTPOLARITY_BIT_MASK);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_set_refspadchar_config_struct(
+	VL53L1_DEV                     Dev,
+	VL53L1_refspadchar_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->refspadchar.device_test_mode = pdata->device_test_mode;
+	pdev->refspadchar.VL53L1_p_009     = pdata->VL53L1_p_009;
+	pdev->refspadchar.timeout_us       = pdata->timeout_us;
+	pdev->refspadchar.target_count_rate_mcps    =
+			pdata->target_count_rate_mcps;
+	pdev->refspadchar.min_count_rate_limit_mcps =
+			pdata->min_count_rate_limit_mcps;
+	pdev->refspadchar.max_count_rate_limit_mcps =
+			pdata->max_count_rate_limit_mcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_get_refspadchar_config_struct(
+	VL53L1_DEV                     Dev,
+	VL53L1_refspadchar_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdata->device_test_mode       = pdev->refspadchar.device_test_mode;
+	pdata->VL53L1_p_009           = pdev->refspadchar.VL53L1_p_009;
+	pdata->timeout_us             = pdev->refspadchar.timeout_us;
+	pdata->target_count_rate_mcps =
+			pdev->refspadchar.target_count_rate_mcps;
+	pdata->min_count_rate_limit_mcps =
+			pdev->refspadchar.min_count_rate_limit_mcps;
+	pdata->max_count_rate_limit_mcps =
+			pdev->refspadchar.max_count_rate_limit_mcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_set_range_ignore_threshold(
+	VL53L1_DEV              Dev,
+	uint8_t                 range_ignore_thresh_mult,
+	uint16_t                range_ignore_threshold_mcps)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->xtalk_cfg.crosstalk_range_ignore_threshold_rate_mcps =
+		range_ignore_threshold_mcps;
+
+	pdev->xtalk_cfg.crosstalk_range_ignore_threshold_mult =
+		range_ignore_thresh_mult;
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_range_ignore_threshold(
+	VL53L1_DEV              Dev,
+	uint8_t                *prange_ignore_thresh_mult,
+	uint16_t               *prange_ignore_threshold_mcps_internal,
+	uint16_t               *prange_ignore_threshold_mcps_current)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	*prange_ignore_thresh_mult =
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_mult;
+
+	*prange_ignore_threshold_mcps_current =
+		pdev->stat_cfg.algo__range_ignore_threshold_mcps;
+
+	*prange_ignore_threshold_mcps_internal =
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_rate_mcps;
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_get_interrupt_polarity(
+	VL53L1_DEV                       Dev,
+	VL53L1_DeviceInterruptPolarity  *pinterrupt_polarity)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	*pinterrupt_polarity =
+		pdev->stat_cfg.gpio_hv_mux__ctrl &
+		VL53L1_DEVICEINTERRUPTPOLARITY_BIT_MASK;
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_set_user_zone(
+	VL53L1_DEV              Dev,
+	VL53L1_user_zone_t     *puser_zone)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	VL53L1_encode_row_col(
+		puser_zone->y_centre,
+		puser_zone->x_centre,
+		&(pdev->dyn_cfg.roi_config__user_roi_centre_spad));
+
+
+
+	VL53L1_encode_zone_size(
+		puser_zone->width,
+		puser_zone->height,
+		&(pdev->dyn_cfg.roi_config__user_roi_requested_global_xy_size));
+
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_user_zone(
+	VL53L1_DEV              Dev,
+	VL53L1_user_zone_t     *puser_zone)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	VL53L1_decode_row_col(
+			pdev->dyn_cfg.roi_config__user_roi_centre_spad,
+			&(puser_zone->y_centre),
+			&(puser_zone->x_centre));
+
+
+
+	VL53L1_decode_zone_size(
+		pdev->dyn_cfg.roi_config__user_roi_requested_global_xy_size,
+		&(puser_zone->width),
+		&(puser_zone->height));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_get_mode_mitigation_roi(
+	VL53L1_DEV              Dev,
+	VL53L1_user_zone_t     *pmm_roi)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  x       = 0;
+	uint8_t  y       = 0;
+	uint8_t  xy_size = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+	VL53L1_decode_row_col(
+			pdev->nvm_copy_data.roi_config__mode_roi_centre_spad,
+			&y,
+			&x);
+
+	pmm_roi->x_centre = x;
+	pmm_roi->y_centre = y;
+
+
+
+
+
+
+
+
+
+
+	xy_size = pdev->nvm_copy_data.roi_config__mode_roi_xy_size;
+
+	pmm_roi->height = xy_size >> 4;
+	pmm_roi->width  = xy_size & 0x0F;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_zone_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(&(pdev->zone_cfg.user_zones), &(pzone_cfg->user_zones),
+			sizeof(pdev->zone_cfg.user_zones));
+
+
+
+	pdev->zone_cfg.max_zones    = pzone_cfg->max_zones;
+	pdev->zone_cfg.active_zones = pzone_cfg->active_zones;
+
+	status = VL53L1_init_zone_config_histogram_bins(&pdev->zone_cfg);
+
+
+
+
+
+
+
+
+
+
+	if (pzone_cfg->active_zones == 0)
+		pdev->gen_cfg.global_config__stream_divider = 0;
+	else if (pzone_cfg->active_zones < VL53L1_MAX_USER_ZONES)
+		pdev->gen_cfg.global_config__stream_divider =
+				pzone_cfg->active_zones + 1;
+	else
+		pdev->gen_cfg.global_config__stream_divider =
+				VL53L1_MAX_USER_ZONES + 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_zone_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(pzone_cfg, &(pdev->zone_cfg), sizeof(VL53L1_zone_config_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_get_preset_mode_timing_cfg(
+	VL53L1_DEV                   Dev,
+	VL53L1_DevicePresetModes     device_preset_mode,
+	uint16_t                    *pdss_config__target_total_rate_mcps,
+	uint32_t                    *pphasecal_config_timeout_us,
+	uint32_t                    *pmm_config_timeout_us,
+	uint32_t                    *prange_config_timeout_us)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+	switch (device_preset_mode) {
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING:
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_SHORT_RANGE:
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_LONG_RANGE:
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM1_CAL:
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM2_CAL:
+	case VL53L1_DEVICEPRESETMODE_OLT:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_lite_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_lite_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_lite_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_lite_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING:
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING_SHORT_RANGE:
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING_LONG_RANGE:
+	case VL53L1_DEVICEPRESETMODE_SINGLESHOT_RANGING:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_timed_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_timed_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_timed_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_timed_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_SHORT_RANGE:
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_MEDIUM_RANGE:
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_LONG_RANGE:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_timed_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_timed_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_lpa_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_lpa_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM1:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM2:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM1_CAL:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM2_CAL:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_REF_ARRAY:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM1:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM2:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_CHARACTERISATION:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_hist_long_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_histo_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_histo_us;
+
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mz_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_mz_med_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_mz_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_mz_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_SHORT_RANGE:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mz_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_mz_short_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_mz_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_mz_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_LONG_RANGE:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mz_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_mz_long_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_mz_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_mz_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_SHORT_TIMING:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_hist_short_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_histo_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_histo_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM1:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM2:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_histo_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_hist_med_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_histo_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_histo_us;
+	break;
+
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM1:
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM2:
+		*pdss_config__target_total_rate_mcps =
+				pdev->tuning_parms.tp_dss_target_histo_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_hist_short_us;
+		*pmm_config_timeout_us =
+				pdev->tuning_parms.tp_mm_timeout_histo_us;
+		*prange_config_timeout_us =
+				pdev->tuning_parms.tp_range_timeout_histo_us;
+	break;
+
+	case VL53L1_DEVICEPRESETMODE_SPECIAL_HISTOGRAM_SHORT_RANGE:
+		*pdss_config__target_total_rate_mcps =
+			pdev->tuning_parms.tp_dss_target_very_short_mcps;
+		*pphasecal_config_timeout_us =
+			pdev->tuning_parms.tp_phasecal_timeout_hist_short_us;
+		*pmm_config_timeout_us =
+			pdev->tuning_parms.tp_mm_timeout_histo_us;
+		*prange_config_timeout_us =
+			pdev->tuning_parms.tp_range_timeout_histo_us;
+	break;
+
+	default:
+		status = VL53L1_ERROR_INVALID_PARAMS;
+		break;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_preset_mode(
+	VL53L1_DEV                   Dev,
+	VL53L1_DevicePresetModes     device_preset_mode,
+	uint16_t                     dss_config__target_total_rate_mcps,
+	uint32_t                     phasecal_config_timeout_us,
+	uint32_t                     mm_config_timeout_us,
+	uint32_t                     range_config_timeout_us,
+	uint32_t                     inter_measurement_period_ms)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_hist_post_process_config_t *phistpostprocess =
+			&(pdev->histpostprocess);
+
+	VL53L1_static_config_t        *pstatic       = &(pdev->stat_cfg);
+	VL53L1_histogram_config_t     *phistogram    = &(pdev->hist_cfg);
+	VL53L1_general_config_t       *pgeneral      = &(pdev->gen_cfg);
+	VL53L1_timing_config_t        *ptiming       = &(pdev->tim_cfg);
+	VL53L1_dynamic_config_t       *pdynamic      = &(pdev->dyn_cfg);
+	VL53L1_system_control_t       *psystem       = &(pdev->sys_ctrl);
+	VL53L1_zone_config_t          *pzone_cfg     = &(pdev->zone_cfg);
+	VL53L1_tuning_parm_storage_t  *ptuning_parms = &(pdev->tuning_parms);
+	VL53L1_low_power_auto_data_t  *plpadata      =
+					&(pdev->low_power_auto_data);
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdev->preset_mode                 = device_preset_mode;
+	pdev->mm_config_timeout_us        = mm_config_timeout_us;
+	pdev->range_config_timeout_us     = range_config_timeout_us;
+	pdev->inter_measurement_period_ms = inter_measurement_period_ms;
+
+
+
+
+	VL53L1_init_ll_driver_state(
+			Dev,
+			VL53L1_DEVICESTATE_SW_STANDBY);
+
+
+
+
+	switch (device_preset_mode) {
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING:
+		status = VL53L1_preset_mode_standard_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_SHORT_RANGE:
+		status = VL53L1_preset_mode_standard_ranging_short_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_LONG_RANGE:
+		status = VL53L1_preset_mode_standard_ranging_long_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM1_CAL:
+		status = VL53L1_preset_mode_standard_ranging_mm1_cal(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_STANDARD_RANGING_MM2_CAL:
+		status = VL53L1_preset_mode_standard_ranging_mm2_cal(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING:
+		status = VL53L1_preset_mode_timed_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING_SHORT_RANGE:
+		status = VL53L1_preset_mode_timed_ranging_short_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_TIMED_RANGING_LONG_RANGE:
+		status = VL53L1_preset_mode_timed_ranging_long_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING:
+		status = VL53L1_preset_mode_histogram_ranging(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM1:
+		status = VL53L1_preset_mode_histogram_ranging_with_mm1(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_WITH_MM2:
+		status = VL53L1_preset_mode_histogram_ranging_with_mm2(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM1_CAL:
+		status = VL53L1_preset_mode_histogram_ranging_mm1_cal(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_MM2_CAL:
+		status = VL53L1_preset_mode_histogram_ranging_mm2_cal(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE:
+		status = VL53L1_preset_mode_histogram_multizone(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_SHORT_RANGE:
+		status = VL53L1_preset_mode_histogram_multizone_short_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MULTIZONE_LONG_RANGE:
+		status = VL53L1_preset_mode_histogram_multizone_long_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_REF_ARRAY:
+		status = VL53L1_preset_mode_histogram_ranging_ref(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_RANGING_SHORT_TIMING:
+		status = VL53L1_preset_mode_histogram_ranging_short_timing(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE:
+		status = VL53L1_preset_mode_histogram_long_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM1:
+		status = VL53L1_preset_mode_histogram_long_range_mm1(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_LONG_RANGE_MM2:
+		status = VL53L1_preset_mode_histogram_long_range_mm2(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE:
+		status = VL53L1_preset_mode_histogram_medium_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM1:
+		status = VL53L1_preset_mode_histogram_medium_range_mm1(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_MEDIUM_RANGE_MM2:
+		status = VL53L1_preset_mode_histogram_medium_range_mm2(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE:
+		status = VL53L1_preset_mode_histogram_short_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM1:
+		status = VL53L1_preset_mode_histogram_short_range_mm1(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_SHORT_RANGE_MM2:
+		status = VL53L1_preset_mode_histogram_short_range_mm2(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_CHARACTERISATION:
+		status = VL53L1_preset_mode_histogram_characterisation(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_PLANAR:
+		status = VL53L1_preset_mode_histogram_xtalk_planar(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_MM1:
+		status = VL53L1_preset_mode_histogram_xtalk_mm1(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_HISTOGRAM_XTALK_MM2:
+		status = VL53L1_preset_mode_histogram_xtalk_mm2(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_OLT:
+		status = VL53L1_preset_mode_olt(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_SINGLESHOT_RANGING:
+		status = VL53L1_preset_mode_singleshot_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_SHORT_RANGE:
+		status = VL53L1_preset_mode_low_power_auto_short_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg,
+					plpadata);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_MEDIUM_RANGE:
+		status = VL53L1_preset_mode_low_power_auto_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg,
+					plpadata);
+		break;
+
+	case VL53L1_DEVICEPRESETMODE_LOWPOWERAUTO_LONG_RANGE:
+		status = VL53L1_preset_mode_low_power_auto_long_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg,
+					plpadata);
+		break;
+
+
+	case VL53L1_DEVICEPRESETMODE_SPECIAL_HISTOGRAM_SHORT_RANGE:
+		status = VL53L1_preset_mode_special_histogram_short_range(
+					phistpostprocess,
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+	break;
+
+	default:
+		status = VL53L1_ERROR_INVALID_PARAMS;
+		break;
+
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		pstatic->dss_config__target_total_rate_mcps =
+				dss_config__target_total_rate_mcps;
+		pdev->dss_config__target_total_rate_mcps    =
+				dss_config__target_total_rate_mcps;
+
+	}
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_timeouts_us(
+				Dev,
+				phasecal_config_timeout_us,
+				mm_config_timeout_us,
+				range_config_timeout_us);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_set_inter_measurement_period_ms(
+				Dev,
+				inter_measurement_period_ms);
+
+
+
+
+	V53L1_init_zone_results_structure(
+			pdev->zone_cfg.active_zones+1,
+			&(pres->zone_results));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_zone_preset(
+	VL53L1_DEV                 Dev,
+	VL53L1_DeviceZonePreset    zone_preset)
+{
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_general_config_t       *pgeneral      = &(pdev->gen_cfg);
+	VL53L1_zone_config_t          *pzone_cfg     = &(pdev->zone_cfg);
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdev->zone_preset        = zone_preset;
+
+
+
+
+	switch (zone_preset) {
+
+	case VL53L1_DEVICEZONEPRESET_XTALK_PLANAR:
+		status =
+			VL53L1_zone_preset_xtalk_planar(
+				pgeneral,
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_1X1_SIZE_16X16:
+		status =
+			VL53L1_init_zone_config_structure(
+				8, 1, 1,
+
+				8, 1, 1,
+
+				15, 15,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_1X2_SIZE_16X8:
+		status =
+			VL53L1_init_zone_config_structure(
+				8, 1, 1,
+
+				4, 8, 2,
+
+				15, 7,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_2X1_SIZE_8X16:
+		status =
+			VL53L1_init_zone_config_structure(
+				4, 8, 2,
+
+				8, 1, 1,
+
+				7, 15,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_2X2_SIZE_8X8:
+		status =
+			VL53L1_init_zone_config_structure(
+				4, 8, 2,
+
+				4, 8, 2,
+
+				7, 7,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_3X3_SIZE_5X5:
+		status =
+			VL53L1_init_zone_config_structure(
+				2, 5, 3,
+
+				2, 5, 3,
+
+				4, 4,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_4X4_SIZE_4X4:
+		status =
+			VL53L1_init_zone_config_structure(
+				2, 4, 4,
+
+				2, 4, 4,
+
+				3, 3,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_5X5_SIZE_4X4:
+		status =
+			VL53L1_init_zone_config_structure(
+				2, 3, 5,
+
+				2, 3, 5,
+
+				3, 3,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_11X11_SIZE_5X5:
+		status =
+			VL53L1_init_zone_config_structure(
+				3, 1, 11,
+
+				3, 1, 11,
+
+				4, 4,
+
+				pzone_cfg);
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_13X13_SIZE_4X4:
+		status =
+			VL53L1_init_zone_config_structure(
+				2, 1, 13,
+
+				2, 1, 13,
+
+				3, 3,
+
+				pzone_cfg);
+
+		break;
+
+	case VL53L1_DEVICEZONEPRESET_1X1_SIZE_4X4_POS_8X8:
+		status =
+			VL53L1_init_zone_config_structure(
+				8, 1, 1,
+
+				8, 1, 1,
+
+				3, 3,
+
+				pzone_cfg);
+		break;
+
+	}
+
+
+
+
+
+
+
+
+
+
+	if (pzone_cfg->active_zones == 0)
+		pdev->gen_cfg.global_config__stream_divider = 0;
+	else if (pzone_cfg->active_zones < VL53L1_MAX_USER_ZONES)
+		pdev->gen_cfg.global_config__stream_divider =
+			pzone_cfg->active_zones + 1;
+	else
+		pdev->gen_cfg.global_config__stream_divider =
+			VL53L1_MAX_USER_ZONES + 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error  VL53L1_enable_xtalk_compensation(
+	VL53L1_DEV                 Dev)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint32_t tempu32;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+
+	LOG_FUNCTION_START("");
+
+
+
+	tempu32 = VL53L1_calc_crosstalk_plane_offset_with_margin(
+		pC->algo__crosstalk_compensation_plane_offset_kcps,
+		pC->lite_mode_crosstalk_margin_kcps);
+	if (tempu32 > 0xFFFF)
+		tempu32 = 0xFFFF;
+
+	pN->algo__crosstalk_compensation_plane_offset_kcps =
+		(uint16_t)tempu32;
+
+	pN->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+	pN->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+	pHP->algo__crosstalk_compensation_plane_offset_kcps =
+		VL53L1_calc_crosstalk_plane_offset_with_margin(
+			pC->algo__crosstalk_compensation_plane_offset_kcps,
+			pC->histogram_mode_crosstalk_margin_kcps);
+
+	pHP->algo__crosstalk_compensation_x_plane_gradient_kcps
+		= pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pHP->algo__crosstalk_compensation_y_plane_gradient_kcps
+		= pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+	pC->global_crosstalk_compensation_enable = 0x01;
+
+	pHP->algo__crosstalk_compensation_enable =
+		pC->global_crosstalk_compensation_enable;
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		pC->crosstalk_range_ignore_threshold_rate_mcps =
+		VL53L1_calc_range_ignore_threshold(
+			pC->algo__crosstalk_compensation_plane_offset_kcps,
+			pC->algo__crosstalk_compensation_x_plane_gradient_kcps,
+			pC->algo__crosstalk_compensation_y_plane_gradient_kcps,
+			pC->crosstalk_range_ignore_threshold_mult);
+}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_set_customer_nvm_managed(
+				Dev,
+				&(pdev->customer));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+void VL53L1_get_xtalk_compensation_enable(
+	VL53L1_DEV    Dev,
+	uint8_t       *pcrosstalk_compensation_enable)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	*pcrosstalk_compensation_enable =
+		pdev->xtalk_cfg.global_crosstalk_compensation_enable;
+
+}
+
+
+VL53L1_Error VL53L1_get_lite_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                           *pxtalk_margin)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pxtalk_margin = pdev->xtalk_cfg.lite_mode_crosstalk_margin_kcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_lite_xtalk_margin_kcps(
+	VL53L1_DEV                     Dev,
+	int16_t                        xtalk_margin)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->xtalk_cfg.lite_mode_crosstalk_margin_kcps = xtalk_margin;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_histogram_xtalk_margin_kcps(
+	VL53L1_DEV                          Dev,
+	int16_t                           *pxtalk_margin)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pxtalk_margin = pdev->xtalk_cfg.histogram_mode_crosstalk_margin_kcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_histogram_xtalk_margin_kcps(
+	VL53L1_DEV                     Dev,
+	int16_t                        xtalk_margin)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->xtalk_cfg.histogram_mode_crosstalk_margin_kcps = xtalk_margin;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_restore_xtalk_nvm_default(
+	VL53L1_DEV                     Dev)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+
+	LOG_FUNCTION_START("");
+
+	pC->algo__crosstalk_compensation_plane_offset_kcps =
+		pC->nvm_default__crosstalk_compensation_plane_offset_kcps;
+	pC->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC->nvm_default__crosstalk_compensation_x_plane_gradient_kcps;
+	pC->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC->nvm_default__crosstalk_compensation_y_plane_gradient_kcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error  VL53L1_disable_xtalk_compensation(
+	VL53L1_DEV                 Dev)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+
+	LOG_FUNCTION_START("");
+
+
+
+	pN->algo__crosstalk_compensation_plane_offset_kcps =
+		0x00;
+
+	pN->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		0x00;
+
+	pN->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		0x00;
+
+
+
+
+	pdev->xtalk_cfg.global_crosstalk_compensation_enable = 0x00;
+
+	pHP->algo__crosstalk_compensation_enable =
+		pdev->xtalk_cfg.global_crosstalk_compensation_enable;
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_rate_mcps =
+			0x0000;
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status =
+			VL53L1_set_customer_nvm_managed(
+				Dev,
+				&(pdev->customer));
+	}
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_histogram_phase_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pphase_consistency)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+
+	LOG_FUNCTION_START("");
+
+	*pphase_consistency =
+		pHP->algo__consistency_check__phase_tolerance;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_histogram_phase_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                             phase_consistency)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->histpostprocess.algo__consistency_check__phase_tolerance =
+			phase_consistency;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_histogram_event_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pevent_consistency)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pevent_consistency =
+		pdev->histpostprocess.algo__consistency_check__event_sigma;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_histogram_event_consistency(
+	VL53L1_DEV                          Dev,
+	uint8_t                             event_consistency)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->histpostprocess.algo__consistency_check__event_sigma =
+		event_consistency;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_histogram_ambient_threshold_sigma(
+	VL53L1_DEV                          Dev,
+	uint8_t                            *pamb_thresh_sigma)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pamb_thresh_sigma =
+			pdev->histpostprocess.ambient_thresh_sigma1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_histogram_ambient_threshold_sigma(
+	VL53L1_DEV                          Dev,
+	uint8_t                             amb_thresh_sigma)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->histpostprocess.ambient_thresh_sigma1 =
+		amb_thresh_sigma;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_lite_sigma_threshold(
+	VL53L1_DEV                          Dev,
+	uint16_t                           *plite_sigma)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*plite_sigma =
+			pdev->tim_cfg.range_config__sigma_thresh;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_lite_sigma_threshold(
+	VL53L1_DEV                          Dev,
+	uint16_t                           lite_sigma)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->tim_cfg.range_config__sigma_thresh = lite_sigma;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_lite_min_count_rate(
+	VL53L1_DEV                          Dev,
+	uint16_t                           *plite_mincountrate)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*plite_mincountrate =
+		pdev->tim_cfg.range_config__min_count_rate_rtn_limit_mcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_lite_min_count_rate(
+	VL53L1_DEV                          Dev,
+	uint16_t                            lite_mincountrate)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->tim_cfg.range_config__min_count_rate_rtn_limit_mcps =
+		lite_mincountrate;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_xtalk_detect_config(
+	VL53L1_DEV                          Dev,
+	int16_t                            *pmax_valid_range_mm,
+	int16_t                            *pmin_valid_range_mm,
+	uint16_t                           *pmax_valid_rate_kcps,
+	uint16_t                           *pmax_sigma_mm)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pmax_valid_range_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_range_mm;
+	*pmin_valid_range_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_min_valid_range_mm;
+	*pmax_valid_rate_kcps =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_rate_kcps;
+	*pmax_sigma_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_sigma_mm;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_xtalk_detect_config(
+	VL53L1_DEV                          Dev,
+	int16_t                             max_valid_range_mm,
+	int16_t                             min_valid_range_mm,
+	uint16_t                            max_valid_rate_kcps,
+	uint16_t                            max_sigma_mm)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_range_mm =
+		max_valid_range_mm;
+	pdev->xtalk_cfg.algo__crosstalk_detect_min_valid_range_mm =
+		min_valid_range_mm;
+	pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_rate_kcps =
+		max_valid_rate_kcps;
+	pdev->xtalk_cfg.algo__crosstalk_detect_max_sigma_mm =
+		max_sigma_mm;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_target_order_mode(
+	VL53L1_DEV                          Dev,
+	VL53L1_HistTargetOrder             *phist_target_order)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*phist_target_order =
+			pdev->histpostprocess.hist_target_order;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_target_order_mode(
+	VL53L1_DEV                          Dev,
+	VL53L1_HistTargetOrder              hist_target_order)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->histpostprocess.hist_target_order = hist_target_order;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_get_dmax_reflectance_values(
+	VL53L1_DEV                          Dev,
+	VL53L1_dmax_reflectance_array_t    *pdmax_reflectances)
+{
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint8_t i = 0;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	for (i = 0; i < VL53L1_MAX_AMBIENT_DMAX_VALUES; i++) {
+		pdmax_reflectances->target_reflectance_for_dmax[i] =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[i];
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_set_dmax_reflectance_values(
+	VL53L1_DEV                          Dev,
+	VL53L1_dmax_reflectance_array_t    *pdmax_reflectances)
+{
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint8_t i = 0;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	for (i = 0; i < VL53L1_MAX_AMBIENT_DMAX_VALUES; i++) {
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[i] =
+		pdmax_reflectances->target_reflectance_for_dmax[i];
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+VL53L1_Error VL53L1_get_vhv_loopbound(
+	VL53L1_DEV                   Dev,
+	uint8_t                     *pvhv_loopbound)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pvhv_loopbound =
+		pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound / 4;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_set_vhv_loopbound(
+	VL53L1_DEV                   Dev,
+	uint8_t                      vhv_loopbound)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound =
+		(pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound & 0x03) +
+		(vhv_loopbound * 4);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_get_vhv_config(
+	VL53L1_DEV                   Dev,
+	uint8_t                     *pvhv_init_en,
+	uint8_t                     *pvhv_init_value)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pvhv_init_en    = (pdev->stat_nvm.vhv_config__init & 0x80) >> 7;
+	*pvhv_init_value =
+			(pdev->stat_nvm.vhv_config__init & 0x7F);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_set_vhv_config(
+	VL53L1_DEV                   Dev,
+	uint8_t                      vhv_init_en,
+	uint8_t                      vhv_init_value)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->stat_nvm.vhv_config__init =
+		((vhv_init_en   & 0x01) << 7) +
+		(vhv_init_value & 0x7F);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+VL53L1_Error VL53L1_init_and_start_range(
+	VL53L1_DEV                     Dev,
+	uint8_t                        measurement_mode,
+	VL53L1_DeviceConfigLevel       device_config_level)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	uint8_t buffer[VL53L1_MAX_I2C_XFER_SIZE];
+
+	VL53L1_static_nvm_managed_t   *pstatic_nvm   = &(pdev->stat_nvm);
+	VL53L1_customer_nvm_managed_t *pcustomer_nvm = &(pdev->customer);
+	VL53L1_static_config_t        *pstatic       = &(pdev->stat_cfg);
+	VL53L1_general_config_t       *pgeneral      = &(pdev->gen_cfg);
+	VL53L1_timing_config_t        *ptiming       = &(pdev->tim_cfg);
+	VL53L1_dynamic_config_t       *pdynamic      = &(pdev->dyn_cfg);
+	VL53L1_system_control_t       *psystem       = &(pdev->sys_ctrl);
+
+	VL53L1_ll_driver_state_t  *pstate   = &(pdev->ll_state);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+
+	uint8_t  *pbuffer                   = &buffer[0];
+	uint16_t i                          = 0;
+	uint16_t i2c_index                  = 0;
+	uint16_t i2c_buffer_offset_bytes    = 0;
+	uint16_t i2c_buffer_size_bytes      = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdev->measurement_mode = measurement_mode;
+
+
+
+
+	psystem->system__mode_start =
+		(psystem->system__mode_start &
+		VL53L1_DEVICEMEASUREMENTMODE_STOP_MASK) |
+		measurement_mode;
+
+
+
+
+
+
+	status =
+		VL53L1_set_user_zone(
+		Dev,
+		&(pdev->zone_cfg.user_zones[pdev->ll_state.cfg_zone_id]));
+
+
+
+
+
+	if (pdev->zone_cfg.active_zones > 0) {
+		status =
+		VL53L1_set_zone_dss_config(
+		Dev,
+		&(pres->zone_dyn_cfgs.VL53L1_p_002[pdev->ll_state.cfg_zone_id])
+		);
+	}
+
+
+
+
+
+
+	if (((pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICESCHEDULERMODE_HISTOGRAM) == 0x00) &&
+		(pdev->xtalk_cfg.global_crosstalk_compensation_enable
+				== 0x01)) {
+		pdev->stat_cfg.algo__range_ignore_threshold_mcps =
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_rate_mcps;
+	}
+
+
+
+
+
+
+
+
+	if (pdev->low_power_auto_data.low_power_auto_range_count == 0xFF)
+		pdev->low_power_auto_data.low_power_auto_range_count = 0x0;
+
+
+
+	if ((pdev->low_power_auto_data.is_low_power_auto_mode == 1) &&
+		(pdev->low_power_auto_data.low_power_auto_range_count == 0)) {
+
+
+		pdev->low_power_auto_data.saved_interrupt_config =
+			pdev->gen_cfg.system__interrupt_config_gpio;
+
+
+		pdev->gen_cfg.system__interrupt_config_gpio = 1 << 5;
+
+
+		if ((pdev->dyn_cfg.system__sequence_config & (
+			VL53L1_SEQUENCE_MM1_EN | VL53L1_SEQUENCE_MM2_EN)) ==
+				0x0) {
+			pN->algo__part_to_part_range_offset_mm =
+			(pN->mm_config__outer_offset_mm << 2);
+		} else {
+			pN->algo__part_to_part_range_offset_mm = 0x0;
+		}
+
+
+
+		if (device_config_level <
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS) {
+			device_config_level =
+				VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS;
+		}
+	}
+
+	if ((pdev->low_power_auto_data.is_low_power_auto_mode == 1) &&
+		(pdev->low_power_auto_data.low_power_auto_range_count == 1)) {
+
+
+		pdev->gen_cfg.system__interrupt_config_gpio =
+			pdev->low_power_auto_data.saved_interrupt_config;
+
+
+
+		device_config_level = VL53L1_DEVICECONFIGLEVEL_FULL;
+	}
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_save_cfg_data(Dev);
+
+
+
+
+
+
+	switch (device_config_level) {
+	case VL53L1_DEVICECONFIGLEVEL_FULL:
+		i2c_index = VL53L1_STATIC_NVM_MANAGED_I2C_INDEX;
+		break;
+	case VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS:
+		i2c_index = VL53L1_CUSTOMER_NVM_MANAGED_I2C_INDEX;
+		break;
+	case VL53L1_DEVICECONFIGLEVEL_STATIC_ONWARDS:
+		i2c_index = VL53L1_STATIC_CONFIG_I2C_INDEX;
+		break;
+	case VL53L1_DEVICECONFIGLEVEL_GENERAL_ONWARDS:
+		i2c_index = VL53L1_GENERAL_CONFIG_I2C_INDEX;
+		break;
+	case VL53L1_DEVICECONFIGLEVEL_TIMING_ONWARDS:
+		i2c_index = VL53L1_TIMING_CONFIG_I2C_INDEX;
+		break;
+	case VL53L1_DEVICECONFIGLEVEL_DYNAMIC_ONWARDS:
+		i2c_index = VL53L1_DYNAMIC_CONFIG_I2C_INDEX;
+		break;
+	default:
+		i2c_index = VL53L1_SYSTEM_CONTROL_I2C_INDEX;
+		break;
+	}
+
+
+
+
+	i2c_buffer_size_bytes =
+			(VL53L1_SYSTEM_CONTROL_I2C_INDEX +
+			VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES) -
+			i2c_index;
+
+
+
+
+	pbuffer = &buffer[0];
+	for (i = 0; i < i2c_buffer_size_bytes; i++)
+		*pbuffer++ = 0;
+
+
+
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_FULL &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+			VL53L1_STATIC_NVM_MANAGED_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_static_nvm_managed(
+				pstatic_nvm,
+				VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_CUSTOMER_ONWARDS &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+			VL53L1_CUSTOMER_NVM_MANAGED_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_customer_nvm_managed(
+				pcustomer_nvm,
+				VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_STATIC_ONWARDS &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+			VL53L1_STATIC_CONFIG_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_static_config(
+				pstatic,
+				VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_GENERAL_ONWARDS &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+				VL53L1_GENERAL_CONFIG_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_general_config(
+				pgeneral,
+				VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_TIMING_ONWARDS &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+				VL53L1_TIMING_CONFIG_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_timing_config(
+				ptiming,
+				VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (device_config_level >= VL53L1_DEVICECONFIGLEVEL_DYNAMIC_ONWARDS &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+			VL53L1_DYNAMIC_CONFIG_I2C_INDEX - i2c_index;
+
+
+
+		if ((psystem->system__mode_start &
+			VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK) ==
+			VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK) {
+			pdynamic->system__grouped_parameter_hold_0 =
+					pstate->cfg_gph_id | 0x01;
+			pdynamic->system__grouped_parameter_hold_1 =
+					pstate->cfg_gph_id | 0x01;
+			pdynamic->system__grouped_parameter_hold   =
+					pstate->cfg_gph_id;
+		}
+		status =
+			VL53L1_i2c_encode_dynamic_config(
+				pdynamic,
+				VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+				VL53L1_SYSTEM_CONTROL_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_encode_system_control(
+				psystem,
+				VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes]);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				i2c_index,
+				buffer,
+				(uint32_t)i2c_buffer_size_bytes);
+	}
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_update_ll_driver_rd_state(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_update_ll_driver_cfg_state(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_stop_range(
+	VL53L1_DEV     Dev)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+
+
+
+	pdev->sys_ctrl.system__mode_start =
+			(pdev->sys_ctrl.system__mode_start &
+				VL53L1_DEVICEMEASUREMENTMODE_STOP_MASK) |
+			 VL53L1_DEVICEMEASUREMENTMODE_ABORT;
+
+	status = VL53L1_set_system_control(
+				Dev,
+				&pdev->sys_ctrl);
+
+
+
+	pdev->sys_ctrl.system__mode_start =
+			(pdev->sys_ctrl.system__mode_start &
+				VL53L1_DEVICEMEASUREMENTMODE_STOP_MASK);
+
+
+
+	VL53L1_init_ll_driver_state(
+			Dev,
+			VL53L1_DEVICESTATE_SW_STANDBY);
+
+
+
+	V53L1_init_zone_results_structure(
+			pdev->zone_cfg.active_zones+1,
+			&(pres->zone_results));
+
+
+
+	V53L1_init_zone_dss_configs(Dev);
+
+
+
+	if (pdev->low_power_auto_data.is_low_power_auto_mode == 1)
+		VL53L1_low_power_auto_data_stop_range(Dev);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_measurement_results(
+	VL53L1_DEV                     Dev,
+	VL53L1_DeviceResultsLevel      device_results_level)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t buffer[VL53L1_MAX_I2C_XFER_SIZE];
+
+	VL53L1_system_results_t   *psystem_results = &(pdev->sys_results);
+	VL53L1_core_results_t     *pcore_results   = &(pdev->core_results);
+	VL53L1_debug_results_t    *pdebug_results  = &(pdev->dbg_results);
+
+	uint16_t i2c_index               = VL53L1_SYSTEM_RESULTS_I2C_INDEX;
+	uint16_t i2c_buffer_offset_bytes = 0;
+	uint16_t i2c_buffer_size_bytes   = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	switch (device_results_level) {
+	case VL53L1_DEVICERESULTSLEVEL_FULL:
+		i2c_buffer_size_bytes =
+				(VL53L1_DEBUG_RESULTS_I2C_INDEX +
+				VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES) -
+				i2c_index;
+		break;
+	case VL53L1_DEVICERESULTSLEVEL_UPTO_CORE:
+		i2c_buffer_size_bytes =
+				(VL53L1_CORE_RESULTS_I2C_INDEX +
+				VL53L1_CORE_RESULTS_I2C_SIZE_BYTES) -
+				i2c_index;
+		break;
+	default:
+		i2c_buffer_size_bytes =
+				VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES;
+		break;
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_ReadMulti(
+				Dev,
+				i2c_index,
+				buffer,
+				(uint32_t)i2c_buffer_size_bytes);
+
+
+
+
+	if (device_results_level >= VL53L1_DEVICERESULTSLEVEL_FULL &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+				VL53L1_DEBUG_RESULTS_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_decode_debug_results(
+				VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes],
+				pdebug_results);
+	}
+
+	if (device_results_level >= VL53L1_DEVICERESULTSLEVEL_UPTO_CORE &&
+		status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes =
+				VL53L1_CORE_RESULTS_I2C_INDEX - i2c_index;
+
+		status =
+			VL53L1_i2c_decode_core_results(
+				VL53L1_CORE_RESULTS_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes],
+				pcore_results);
+	}
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		i2c_buffer_offset_bytes = 0;
+		status =
+			VL53L1_i2c_decode_system_results(
+				VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+				&buffer[i2c_buffer_offset_bytes],
+				psystem_results);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_device_results(
+	VL53L1_DEV                    Dev,
+	VL53L1_DeviceResultsLevel     device_results_level,
+	VL53L1_range_results_t       *prange_results)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_range_results_t   *presults =
+			&(pres->range_results);
+	VL53L1_zone_objects_t    *pobjects =
+			&(pres->zone_results.VL53L1_p_002[0]);
+	VL53L1_ll_driver_state_t *pstate   =
+			&(pdev->ll_state);
+	VL53L1_zone_config_t     *pzone_cfg =
+			&(pdev->zone_cfg);
+	VL53L1_zone_hist_info_t  *phist_info =
+			&(pres->zone_hists.VL53L1_p_002[0]);
+
+	VL53L1_dmax_calibration_data_t   dmax_cal;
+	VL53L1_dmax_calibration_data_t *pdmax_cal = &dmax_cal;
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_xtalk_config_t *pC = &(pdev->xtalk_cfg);
+	VL53L1_low_power_auto_data_t *pL = &(pdev->low_power_auto_data);
+	VL53L1_histogram_bin_data_t *pHD = &(pdev->hist_data);
+	VL53L1_customer_nvm_managed_t *pN = &(pdev->customer);
+	VL53L1_zone_histograms_t *pZH = &(pres->zone_hists);
+
+	uint8_t i;
+	uint8_t tmp8;
+	uint8_t zid;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	if ((pdev->sys_ctrl.system__mode_start &
+		 VL53L1_DEVICESCHEDULERMODE_HISTOGRAM)
+		 == VL53L1_DEVICESCHEDULERMODE_HISTOGRAM) {
+
+
+
+
+
+
+		status = VL53L1_get_histogram_bin_data(
+						Dev,
+						&(pdev->hist_data));
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE &&
+			pHD->number_of_ambient_bins == 0) {
+			zid = pdev->ll_state.rd_zone_id;
+			status = VL53L1_hist_copy_and_scale_ambient_info(
+			&(pZH->VL53L1_p_002[zid]),
+			&(pdev->hist_data));
+		}
+
+
+
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+
+		pHP->gain_factor =
+			pdev->gain_cal.histogram_ranging_gain_factor;
+
+		pHP->algo__crosstalk_compensation_plane_offset_kcps =
+		VL53L1_calc_crosstalk_plane_offset_with_margin(
+		pC->algo__crosstalk_compensation_plane_offset_kcps,
+		pC->histogram_mode_crosstalk_margin_kcps);
+
+		pHP->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pHP->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+		pdev->dmax_cfg.ambient_thresh_sigma =
+			pHP->ambient_thresh_sigma1;
+		pdev->dmax_cfg.min_ambient_thresh_events =
+			pHP->min_ambient_thresh_events;
+		pdev->dmax_cfg.signal_total_events_limit =
+			pHP->signal_total_events_limit;
+		pdev->dmax_cfg.dss_config__target_total_rate_mcps =
+			pdev->stat_cfg.dss_config__target_total_rate_mcps;
+		pdev->dmax_cfg.dss_config__aperture_attenuation =
+			pdev->gen_cfg.dss_config__aperture_attenuation;
+
+		pHP->algo__crosstalk_detect_max_valid_range_mm =
+			pC->algo__crosstalk_detect_max_valid_range_mm;
+		pHP->algo__crosstalk_detect_min_valid_range_mm =
+			pC->algo__crosstalk_detect_min_valid_range_mm;
+		pHP->algo__crosstalk_detect_max_valid_rate_kcps =
+			pC->algo__crosstalk_detect_max_valid_rate_kcps;
+		pHP->algo__crosstalk_detect_max_sigma_mm =
+			pC->algo__crosstalk_detect_max_sigma_mm;
+
+
+
+
+		VL53L1_copy_rtn_good_spads_to_buffer(
+				&(pdev->nvm_copy_data),
+				&(pdev->rtn_good_spads[0]));
+
+
+
+
+		switch (pdev->offset_correction_mode) {
+
+		case VL53L1_OFFSETCORRECTIONMODE__MM1_MM2_OFFSETS:
+			tmp8 = pdev->gen_cfg.dss_config__aperture_attenuation;
+
+			VL53L1_hist_combine_mm1_mm2_offsets(
+			pN->mm_config__inner_offset_mm,
+			pN->mm_config__outer_offset_mm,
+			pdev->nvm_copy_data.roi_config__mode_roi_centre_spad,
+			pdev->nvm_copy_data.roi_config__mode_roi_xy_size,
+			pHD->roi_config__user_roi_centre_spad,
+			pHD->roi_config__user_roi_requested_global_xy_size,
+			&(pdev->add_off_cal_data),
+			&(pdev->rtn_good_spads[0]),
+			(uint16_t)tmp8,
+			&(pHP->range_offset_mm));
+		break;
+		case VL53L1_OFFSETCORRECTIONMODE__PER_ZONE_OFFSETS:
+			zid = pdev->ll_state.rd_zone_id;
+			pHP->range_offset_mm = (int16_t)(
+			pres->zone_cal.VL53L1_p_002[zid].range_mm_offset);
+		break;
+		default:
+			pHP->range_offset_mm = 0;
+		break;
+
+		}
+
+
+
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+
+		VL53L1_calc_max_effective_spads(
+		pHD->roi_config__user_roi_centre_spad,
+		pHD->roi_config__user_roi_requested_global_xy_size,
+		&(pdev->rtn_good_spads[0]),
+		(uint16_t)pdev->gen_cfg.dss_config__aperture_attenuation,
+		&(pdev->dmax_cfg.max_effective_spads));
+
+		status =
+			VL53L1_get_dmax_calibration_data(
+				Dev,
+				pdev->dmax_mode,
+				pdev->ll_state.rd_zone_id,
+				pdmax_cal);
+
+
+
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+		status = VL53L1_ipp_hist_process_data(
+				Dev,
+				pdmax_cal,
+				&(pdev->dmax_cfg),
+				&(pdev->histpostprocess),
+				&(pdev->hist_data),
+				&(pdev->xtalk_shapes),
+				presults);
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+		status = VL53L1_hist_wrap_dmax(
+				&(pdev->histpostprocess),
+				&(pdev->hist_data),
+				&(presults->wrap_dmax_mm));
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+		zid = pdev->ll_state.rd_zone_id;
+		status = VL53L1_hist_phase_consistency_check(
+			Dev,
+			&(pZH->VL53L1_p_002[zid]),
+			&(pres->zone_results.VL53L1_p_002[zid]),
+			presults);
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+		zid = pdev->ll_state.rd_zone_id;
+		status = VL53L1_hist_xmonitor_consistency_check(
+			Dev,
+			&(pZH->VL53L1_p_002[zid]),
+			&(pres->zone_results.VL53L1_p_002[zid]),
+			&(presults->xmonitor));
+
+
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+
+		zid = pdev->ll_state.rd_zone_id;
+		pZH->max_zones    = VL53L1_MAX_USER_ZONES;
+		pZH->active_zones =
+				pdev->zone_cfg.active_zones+1;
+		pHD->zone_id       = zid;
+
+		if (zid <
+				pres->zone_results.max_zones) {
+
+			phist_info =
+			&(pZH->VL53L1_p_002[zid]);
+
+			phist_info->rd_device_state =
+				pHD->rd_device_state;
+
+			phist_info->number_of_ambient_bins =
+				pHD->number_of_ambient_bins;
+
+			phist_info->result__dss_actual_effective_spads =
+			pHD->result__dss_actual_effective_spads;
+
+			phist_info->VL53L1_p_009 =
+				pHD->VL53L1_p_009;
+
+			phist_info->total_periods_elapsed =
+				pHD->total_periods_elapsed;
+
+			phist_info->ambient_events_sum =
+				pHD->ambient_events_sum;
+		}
+
+
+
+
+
+
+
+		if (status != VL53L1_ERROR_NONE)
+			goto UPDATE_DYNAMIC_CONFIG;
+
+		VL53L1_hist_copy_results_to_sys_and_core(
+				&(pdev->hist_data),
+				presults,
+				&(pdev->sys_results),
+				&(pdev->core_results));
+
+
+
+
+
+
+UPDATE_DYNAMIC_CONFIG:
+		if (pzone_cfg->active_zones > 0) {
+			if (pstate->rd_device_state !=
+				VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC) {
+				if (status == VL53L1_ERROR_NONE) {
+					status = VL53L1_dynamic_zone_update(
+						Dev, presults);
+				}
+			}
+
+
+
+
+
+			for (i = 0; i < VL53L1_MAX_USER_ZONES; i++) {
+				pzone_cfg->bin_config[i] =
+				((pdev->ll_state.cfg_internal_stream_count)
+						& 0x01) ?
+					VL53L1_ZONECONFIG_BINCONFIG__HIGHAMB :
+					VL53L1_ZONECONFIG_BINCONFIG__LOWAMB;
+			}
+
+			if (status == VL53L1_ERROR_NONE)
+				status = VL53L1_multizone_hist_bins_update(Dev);
+
+		}
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_dynamic_xtalk_correction_corrector(Dev);
+
+#ifdef VL53L1_LOG_ENABLE
+		if (status == VL53L1_ERROR_NONE)
+			VL53L1_print_histogram_bin_data(
+				&(pdev->hist_data),
+				"get_device_results():pdev->lldata.hist_data.",
+				VL53L1_TRACE_MODULE_HISTOGRAM_DATA);
+#endif
+
+	} else {
+
+		if (status == VL53L1_ERROR_NONE)
+
+			status = VL53L1_get_measurement_results(
+							Dev,
+							device_results_level);
+
+		if (status == VL53L1_ERROR_NONE)
+			VL53L1_copy_sys_and_core_results_to_range_results(
+			(int32_t)pdev->gain_cal.standard_ranging_gain_factor,
+			&(pdev->sys_results),
+			&(pdev->core_results),
+			presults);
+
+
+
+
+
+		if (pL->is_low_power_auto_mode == 1) {
+
+
+
+			if ((status == VL53L1_ERROR_NONE) &&
+				(pL->low_power_auto_range_count == 0)) {
+
+				status =
+				VL53L1_low_power_auto_setup_manual_calibration(
+						Dev);
+				pL->low_power_auto_range_count = 1;
+			} else if ((status == VL53L1_ERROR_NONE) &&
+				(pL->low_power_auto_range_count == 1)) {
+				pL->low_power_auto_range_count = 2;
+			}
+
+
+
+			if ((pL->low_power_auto_range_count != 0xFF) &&
+				(status == VL53L1_ERROR_NONE)) {
+				status = VL53L1_low_power_auto_update_DSS(
+						Dev);
+			}
+		}
+
+
+	}
+
+
+
+	presults->cfg_device_state = pdev->ll_state.cfg_device_state;
+	presults->rd_device_state  = pdev->ll_state.rd_device_state;
+	presults->zone_id          = pdev->ll_state.rd_zone_id;
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+		pres->zone_results.max_zones    = VL53L1_MAX_USER_ZONES;
+		pres->zone_results.active_zones = pdev->zone_cfg.active_zones+1;
+		zid = pdev->ll_state.rd_zone_id;
+
+		if (zid < pres->zone_results.max_zones) {
+
+			pobjects =
+			&(pres->zone_results.VL53L1_p_002[zid]);
+
+			pobjects->cfg_device_state  =
+					presults->cfg_device_state;
+			pobjects->rd_device_state   = presults->rd_device_state;
+			pobjects->zone_id           = presults->zone_id;
+			pobjects->stream_count      = presults->stream_count;
+
+
+
+
+			pobjects->xmonitor.VL53L1_p_020 =
+				presults->xmonitor.VL53L1_p_020;
+			pobjects->xmonitor.VL53L1_p_021 =
+				presults->xmonitor.VL53L1_p_021;
+			pobjects->xmonitor.VL53L1_p_014 =
+				presults->xmonitor.VL53L1_p_014;
+			pobjects->xmonitor.range_status =
+				presults->xmonitor.range_status;
+
+			pobjects->max_objects      = presults->max_results;
+			pobjects->active_objects   = presults->active_results;
+
+			for (i = 0; i < presults->active_results; i++) {
+				pobjects->VL53L1_p_002[i].VL53L1_p_020 =
+					presults->VL53L1_p_002[i].VL53L1_p_020;
+				pobjects->VL53L1_p_002[i].VL53L1_p_021 =
+					presults->VL53L1_p_002[i].VL53L1_p_021;
+				pobjects->VL53L1_p_002[i].VL53L1_p_014 =
+					presults->VL53L1_p_002[i].VL53L1_p_014;
+				pobjects->VL53L1_p_002[i].range_status =
+					presults->VL53L1_p_002[i].range_status;
+			}
+
+
+
+		}
+	}
+
+
+
+
+	memcpy(
+		prange_results,
+		presults,
+		sizeof(VL53L1_range_results_t));
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_check_ll_driver_rd_state(Dev);
+
+#ifdef VL53L1_LOG_ENABLE
+	if (status == VL53L1_ERROR_NONE)
+		VL53L1_print_range_results(
+			presults,
+			"get_device_results():pdev->llresults.range_results.",
+			VL53L1_TRACE_MODULE_RANGE_RESULTS_DATA);
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_clear_interrupt_and_enable_next_range(
+	VL53L1_DEV        Dev,
+	uint8_t           measurement_mode)
+{
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_init_and_start_range(
+				Dev,
+				measurement_mode,
+				VL53L1_DEVICECONFIGLEVEL_GENERAL_ONWARDS);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_histogram_bin_data(
+		VL53L1_DEV                   Dev,
+		VL53L1_histogram_bin_data_t *pdata)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_zone_private_dyn_cfg_t *pzone_dyn_cfg;
+
+	VL53L1_static_nvm_managed_t   *pstat_nvm = &(pdev->stat_nvm);
+	VL53L1_static_config_t        *pstat_cfg = &(pdev->stat_cfg);
+	VL53L1_general_config_t       *pgen_cfg  = &(pdev->gen_cfg);
+	VL53L1_timing_config_t        *ptim_cfg  = &(pdev->tim_cfg);
+	VL53L1_range_results_t        *presults  = &(pres->range_results);
+
+	uint8_t    buffer[VL53L1_MAX_I2C_XFER_SIZE];
+	uint8_t   *pbuffer = &buffer[0];
+	uint8_t    bin_23_0 = 0x00;
+	uint16_t   bin                      = 0;
+	uint16_t   i2c_buffer_offset_bytes  = 0;
+	uint16_t   encoded_timeout          = 0;
+
+	uint32_t   pll_period_us            = 0;
+	uint32_t   periods_elapsed_tmp      = 0;
+
+	uint8_t    i                        = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX,
+			pbuffer,
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_SIZE_BYTES);
+
+
+
+
+
+
+	pdata->result__interrupt_status               = *(pbuffer +   0);
+	pdata->result__range_status                   = *(pbuffer +   1);
+	pdata->result__report_status                  = *(pbuffer +   2);
+	pdata->result__stream_count                   = *(pbuffer +   3);
+	pdata->result__dss_actual_effective_spads =
+		VL53L1_i2c_decode_uint16_t(2, pbuffer +   4);
+
+
+
+
+
+
+	i2c_buffer_offset_bytes =
+			VL53L1_PHASECAL_RESULT__REFERENCE_PHASE -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	pbuffer = &buffer[i2c_buffer_offset_bytes];
+
+	pdata->phasecal_result__reference_phase =
+			VL53L1_i2c_decode_uint16_t(2, pbuffer);
+
+	i2c_buffer_offset_bytes =
+			VL53L1_PHASECAL_RESULT__VCSEL_START -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	pdata->phasecal_result__vcsel_start = buffer[i2c_buffer_offset_bytes];
+
+
+
+
+	pdev->dbg_results.phasecal_result__reference_phase =
+			pdata->phasecal_result__reference_phase;
+	pdev->dbg_results.phasecal_result__vcsel_start =
+			pdata->phasecal_result__vcsel_start;
+
+
+
+
+
+
+
+	i2c_buffer_offset_bytes =
+			VL53L1_RESULT__HISTOGRAM_BIN_23_0_MSB -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	bin_23_0 = buffer[i2c_buffer_offset_bytes] << 2;
+
+	i2c_buffer_offset_bytes =
+			VL53L1_RESULT__HISTOGRAM_BIN_23_0_LSB -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	bin_23_0 += buffer[i2c_buffer_offset_bytes];
+
+	i2c_buffer_offset_bytes =
+			VL53L1_RESULT__HISTOGRAM_BIN_23_0 -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	buffer[i2c_buffer_offset_bytes] = bin_23_0;
+
+
+
+
+
+
+
+	i2c_buffer_offset_bytes =
+			VL53L1_RESULT__HISTOGRAM_BIN_0_2 -
+			VL53L1_HISTOGRAM_BIN_DATA_I2C_INDEX;
+
+	pbuffer = &buffer[i2c_buffer_offset_bytes];
+	for (bin = 0; bin < VL53L1_HISTOGRAM_BUFFER_SIZE; bin++) {
+		pdata->bin_data[bin] =
+			(int32_t)VL53L1_i2c_decode_uint32_t(3, pbuffer);
+		pbuffer += 3;
+	}
+
+
+
+	pdata->zone_id                 = pdev->ll_state.rd_zone_id;
+	pdata->VL53L1_p_022               = 0;
+	pdata->VL53L1_p_023             = VL53L1_HISTOGRAM_BUFFER_SIZE;
+	pdata->VL53L1_p_024          = VL53L1_HISTOGRAM_BUFFER_SIZE;
+
+	pdata->cal_config__vcsel_start = pgen_cfg->cal_config__vcsel_start;
+
+
+
+
+	pdata->vcsel_width =
+		((uint16_t)pgen_cfg->global_config__vcsel_width) << 4;
+	pdata->vcsel_width +=
+		(uint16_t)pstat_cfg->ana_config__vcsel_pulse_width_offset;
+
+
+
+	pdata->VL53L1_p_019 =
+		pstat_nvm->osc_measured__fast_osc__frequency;
+
+
+
+
+	VL53L1_hist_get_bin_sequence_config(Dev, pdata);
+
+
+
+
+
+
+	if (pdev->ll_state.rd_timing_status == 0) {
+
+		encoded_timeout =
+			(ptim_cfg->range_config__timeout_macrop_a_hi << 8)
+			+ ptim_cfg->range_config__timeout_macrop_a_lo;
+		pdata->VL53L1_p_009 =  ptim_cfg->range_config__vcsel_period_a;
+	} else {
+
+		encoded_timeout =
+			(ptim_cfg->range_config__timeout_macrop_b_hi << 8)
+			+ ptim_cfg->range_config__timeout_macrop_b_lo;
+		pdata->VL53L1_p_009 = ptim_cfg->range_config__vcsel_period_b;
+	}
+
+
+
+
+	pdata->number_of_ambient_bins  = 0;
+
+	for (i = 0; i < 6; i++) {
+		if ((pdata->bin_seq[i] & 0x07) == 0x07)
+			pdata->number_of_ambient_bins  =
+					pdata->number_of_ambient_bins + 0x04;
+	}
+
+	pdata->total_periods_elapsed =
+		VL53L1_decode_timeout(encoded_timeout);
+
+
+
+
+
+
+
+	pll_period_us =
+		VL53L1_calc_pll_period_us(pdata->VL53L1_p_019);
+
+
+
+
+	periods_elapsed_tmp = pdata->total_periods_elapsed + 1;
+
+
+
+
+
+
+	pdata->peak_duration_us =
+		VL53L1_duration_maths(
+			pll_period_us,
+			(uint32_t)pdata->vcsel_width,
+			VL53L1_RANGING_WINDOW_VCSEL_PERIODS,
+			periods_elapsed_tmp);
+
+	pdata->woi_duration_us     = 0;
+
+
+
+
+	VL53L1_hist_calc_zero_distance_phase(pdata);
+
+
+
+
+
+
+	VL53L1_hist_estimate_ambient_from_ambient_bins(pdata);
+
+
+
+
+	pdata->cfg_device_state = pdev->ll_state.cfg_device_state;
+	pdata->rd_device_state  = pdev->ll_state.rd_device_state;
+
+
+
+
+	pzone_dyn_cfg = &(pres->zone_dyn_cfgs.VL53L1_p_002[pdata->zone_id]);
+
+	pdata->roi_config__user_roi_centre_spad =
+		pzone_dyn_cfg->roi_config__user_roi_centre_spad;
+	pdata->roi_config__user_roi_requested_global_xy_size =
+		pzone_dyn_cfg->roi_config__user_roi_requested_global_xy_size;
+
+
+
+
+
+
+	presults->device_status = VL53L1_DEVICEERROR_NOUPDATE;
+
+
+
+
+	switch (pdata->result__range_status &
+			VL53L1_RANGE_STATUS__RANGE_STATUS_MASK) {
+
+	case VL53L1_DEVICEERROR_VCSELCONTINUITYTESTFAILURE:
+	case VL53L1_DEVICEERROR_VCSELWATCHDOGTESTFAILURE:
+	case VL53L1_DEVICEERROR_NOVHVVALUEFOUND:
+	case VL53L1_DEVICEERROR_USERROICLIP:
+	case VL53L1_DEVICEERROR_MULTCLIPFAIL:
+
+		presults->device_status = (pdata->result__range_status &
+				VL53L1_RANGE_STATUS__RANGE_STATUS_MASK);
+
+		status = VL53L1_ERROR_RANGE_ERROR;
+
+	break;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+void VL53L1_copy_sys_and_core_results_to_range_results(
+	int32_t                           gain_factor,
+	VL53L1_system_results_t          *psys,
+	VL53L1_core_results_t            *pcore,
+	VL53L1_range_results_t           *presults)
+{
+	uint8_t  i = 0;
+
+	VL53L1_range_data_t *pdata;
+	int32_t range_mm = 0;
+	uint32_t tmpu32 = 0;
+	uint16_t rpscr_crosstalk_corrected_mcps_sd0;
+	uint16_t rmmo_effective_spads_sd0;
+	uint16_t rmmi_effective_spads_sd0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	presults->zone_id         = 0;
+	presults->stream_count    = psys->result__stream_count;
+	presults->wrap_dmax_mm    = 0;
+	presults->max_results     = VL53L1_MAX_RANGE_RESULTS;
+	presults->active_results  = 1;
+	rpscr_crosstalk_corrected_mcps_sd0 =
+	psys->result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0;
+	rmmo_effective_spads_sd0 =
+			psys->result__mm_outer_actual_effective_spads_sd0;
+	rmmi_effective_spads_sd0 =
+			psys->result__mm_inner_actual_effective_spads_sd0;
+
+
+	for (i = 0; i < VL53L1_MAX_AMBIENT_DMAX_VALUES; i++)
+		presults->VL53L1_p_007[i] = 0;
+
+	pdata = &(presults->VL53L1_p_002[0]);
+
+	for (i = 0; i < 2; i++) {
+
+		pdata->range_id     = i;
+		pdata->time_stamp   = 0;
+
+		if ((psys->result__stream_count == 0) &&
+			((psys->result__range_status &
+				VL53L1_RANGE_STATUS__RANGE_STATUS_MASK) ==
+			VL53L1_DEVICEERROR_RANGECOMPLETE)) {
+			pdata->range_status =
+				VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK;
+		} else {
+			pdata->range_status =
+				psys->result__range_status &
+				VL53L1_RANGE_STATUS__RANGE_STATUS_MASK;
+		}
+
+		pdata->VL53L1_p_015 = 0;
+		pdata->VL53L1_p_022    = 0;
+		pdata->VL53L1_p_025   = 0;
+		pdata->VL53L1_p_026     = 0;
+		pdata->VL53L1_p_016   = 0;
+		pdata->VL53L1_p_027    = 0;
+
+		switch (i) {
+
+		case 0:
+			if (psys->result__report_status ==
+				VL53L1_DEVICEREPORTSTATUS_MM1)
+				pdata->VL53L1_p_006 =
+						rmmi_effective_spads_sd0;
+			else if (psys->result__report_status ==
+					VL53L1_DEVICEREPORTSTATUS_MM2)
+				pdata->VL53L1_p_006 =
+						rmmo_effective_spads_sd0;
+			else
+				pdata->VL53L1_p_006 =
+				psys->result__dss_actual_effective_spads_sd0;
+
+			pdata->peak_signal_count_rate_mcps =
+					rpscr_crosstalk_corrected_mcps_sd0;
+			pdata->avg_signal_count_rate_mcps =
+				psys->result__avg_signal_count_rate_mcps_sd0;
+			pdata->ambient_count_rate_mcps =
+				psys->result__ambient_count_rate_mcps_sd0;
+
+
+
+
+
+
+			tmpu32 = ((uint32_t)psys->result__sigma_sd0 << 5);
+			if (tmpu32 > 0xFFFF)
+				tmpu32 = 0xFFFF;
+
+			pdata->VL53L1_p_005 = (uint16_t)tmpu32;
+
+
+
+
+			pdata->VL53L1_p_014 =
+				psys->result__phase_sd0;
+
+			range_mm = (int32_t)(
+			psys->result__final_crosstalk_corrected_range_mm_sd0);
+
+
+
+			range_mm *= gain_factor;
+			range_mm += 0x0400;
+			range_mm /= 0x0800;
+
+			pdata->median_range_mm = (int16_t)range_mm;
+
+			pdata->VL53L1_p_021 =
+				pcore->result_core__ranging_total_events_sd0;
+			pdata->VL53L1_p_013 =
+				pcore->result_core__signal_total_events_sd0;
+			pdata->total_periods_elapsed =
+				pcore->result_core__total_periods_elapsed_sd0;
+			pdata->VL53L1_p_020 =
+				pcore->result_core__ambient_window_events_sd0;
+
+			break;
+		case 1:
+
+			pdata->VL53L1_p_006 =
+				psys->result__dss_actual_effective_spads_sd1;
+			pdata->peak_signal_count_rate_mcps =
+				psys->result__peak_signal_count_rate_mcps_sd1;
+			pdata->avg_signal_count_rate_mcps =
+				0xFFFF;
+			pdata->ambient_count_rate_mcps =
+				psys->result__ambient_count_rate_mcps_sd1;
+
+
+
+
+
+
+			tmpu32 = ((uint32_t)psys->result__sigma_sd1 << 5);
+			if (tmpu32 > 0xFFFF)
+				tmpu32 = 0xFFFF;
+
+			pdata->VL53L1_p_005 = (uint16_t)tmpu32;
+
+
+
+
+			pdata->VL53L1_p_014 =
+				psys->result__phase_sd1;
+
+			range_mm = (int32_t)(
+			psys->result__final_crosstalk_corrected_range_mm_sd1);
+
+
+
+			range_mm *= gain_factor;
+			range_mm += 0x0400;
+			range_mm /= 0x0800;
+
+			pdata->median_range_mm = (int16_t)range_mm;
+
+			pdata->VL53L1_p_021 =
+				pcore->result_core__ranging_total_events_sd1;
+			pdata->VL53L1_p_013 =
+				pcore->result_core__signal_total_events_sd1;
+			pdata->total_periods_elapsed  =
+				pcore->result_core__total_periods_elapsed_sd1;
+			pdata->VL53L1_p_020 =
+				pcore->result_core__ambient_window_events_sd1;
+
+			break;
+		}
+
+
+
+
+
+		pdata->VL53L1_p_028    = pdata->VL53L1_p_014;
+		pdata->VL53L1_p_029    = pdata->VL53L1_p_014;
+		pdata->min_range_mm = pdata->median_range_mm;
+		pdata->max_range_mm = pdata->median_range_mm;
+
+		pdata++;
+	}
+
+
+
+
+
+
+	presults->device_status = VL53L1_DEVICEERROR_NOUPDATE;
+
+
+
+
+
+
+
+
+	switch (psys->result__range_status &
+			VL53L1_RANGE_STATUS__RANGE_STATUS_MASK) {
+
+	case VL53L1_DEVICEERROR_VCSELCONTINUITYTESTFAILURE:
+	case VL53L1_DEVICEERROR_VCSELWATCHDOGTESTFAILURE:
+	case VL53L1_DEVICEERROR_NOVHVVALUEFOUND:
+	case VL53L1_DEVICEERROR_USERROICLIP:
+	case VL53L1_DEVICEERROR_MULTCLIPFAIL:
+
+		presults->device_status = (psys->result__range_status &
+				VL53L1_RANGE_STATUS__RANGE_STATUS_MASK);
+
+		presults->VL53L1_p_002[0].range_status =
+			VL53L1_DEVICEERROR_NOUPDATE;
+	break;
+
+	}
+
+	LOG_FUNCTION_END(0);
+}
+
+
+VL53L1_Error VL53L1_set_zone_dss_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_zone_private_dyn_cfg_t  *pzone_dyn_cfg)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_ll_driver_state_t *pstate = &(pdev->ll_state);
+
+	LOG_FUNCTION_START("");
+
+	if (pstate->cfg_device_state ==
+		VL53L1_DEVICESTATE_RANGING_DSS_MANUAL) {
+		pdev->gen_cfg.dss_config__roi_mode_control =
+		VL53L1_DSS_CONTROL__MODE_EFFSPADS;
+		pdev->gen_cfg.dss_config__manual_effective_spads_select =
+			pzone_dyn_cfg->dss_requested_effective_spad_count;
+	} else {
+		pdev->gen_cfg.dss_config__roi_mode_control =
+			VL53L1_DSS_CONTROL__MODE_TARGET_RATE;
+	}
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+VL53L1_Error VL53L1_calc_ambient_dmax(
+	VL53L1_DEV      Dev,
+	uint16_t        target_reflectance,
+	int16_t         *pambient_dmax_mm)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_dmax_calibration_data_t   dmax_cal;
+	VL53L1_dmax_calibration_data_t *pdmax_cal = &dmax_cal;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	status =
+		VL53L1_get_dmax_calibration_data(
+			Dev,
+			pdev->debug_mode,
+			pdev->ll_state.rd_zone_id,
+			pdmax_cal);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_ipp_hist_ambient_dmax(
+				Dev,
+				target_reflectance,
+				&(pdev->fmt_dmax_cal),
+				&(pdev->dmax_cfg),
+				&(pdev->hist_data),
+				pambient_dmax_mm);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_interrupt_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_distance,
+	VL53L1_GPIO_Interrupt_Mode	intr_mode_rate,
+	uint8_t				intr_new_measure_ready,
+	uint8_t				intr_no_target,
+	uint8_t				intr_combined_mode,
+	uint16_t			thresh_distance_high,
+	uint16_t			thresh_distance_low,
+	uint16_t			thresh_rate_high,
+	uint16_t			thresh_rate_low
+	)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_GPIO_interrupt_config_t *pintconf =
+			&(pdev->gpio_interrupt_config);
+
+	LOG_FUNCTION_START("");
+
+
+
+	pintconf->intr_mode_distance = intr_mode_distance;
+	pintconf->intr_mode_rate = intr_mode_rate;
+	pintconf->intr_new_measure_ready = intr_new_measure_ready;
+	pintconf->intr_no_target = intr_no_target;
+	pintconf->intr_combined_mode = intr_combined_mode;
+	pintconf->threshold_distance_high = thresh_distance_high;
+	pintconf->threshold_distance_low = thresh_distance_low;
+	pintconf->threshold_rate_high = thresh_rate_high;
+	pintconf->threshold_rate_low = thresh_rate_low;
+
+
+
+	pdev->gen_cfg.system__interrupt_config_gpio =
+		VL53L1_encode_GPIO_interrupt_config(pintconf);
+
+
+
+
+	status = VL53L1_set_GPIO_thresholds_from_struct(
+			Dev,
+			pintconf);
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_interrupt_config_struct(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t	intconf)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_GPIO_interrupt_config_t *pintconf =
+			&(pdev->gpio_interrupt_config);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(pintconf, &(intconf), sizeof(VL53L1_GPIO_interrupt_config_t));
+
+
+
+	pdev->gen_cfg.system__interrupt_config_gpio =
+		VL53L1_encode_GPIO_interrupt_config(pintconf);
+
+
+
+	status = VL53L1_set_GPIO_thresholds_from_struct(
+			Dev,
+			pintconf);
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_GPIO_interrupt_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t	*pintconf)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pdev->gpio_interrupt_config = VL53L1_decode_GPIO_interrupt_config(
+			pdev->gen_cfg.system__interrupt_config_gpio);
+
+
+
+
+
+	pdev->gpio_interrupt_config.threshold_distance_high =
+		pdev->dyn_cfg.system__thresh_high;
+	pdev->gpio_interrupt_config.threshold_distance_low =
+		pdev->dyn_cfg.system__thresh_low;
+
+	pdev->gpio_interrupt_config.threshold_rate_high =
+		pdev->gen_cfg.system__thresh_rate_high;
+	pdev->gpio_interrupt_config.threshold_rate_low =
+		pdev->gen_cfg.system__thresh_rate_low;
+
+	if (pintconf == &(pdev->gpio_interrupt_config))	{
+
+
+	} else {
+
+
+
+		memcpy(pintconf, &(pdev->gpio_interrupt_config),
+				sizeof(VL53L1_GPIO_interrupt_config_t));
+	}
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_dmax_mode(
+	VL53L1_DEV               Dev,
+	VL53L1_DeviceDmaxMode    dmax_mode)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->dmax_mode = dmax_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_dmax_mode(
+	VL53L1_DEV               Dev,
+	VL53L1_DeviceDmaxMode   *pdmax_mode)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*pdmax_mode = pdev->dmax_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_dmax_calibration_data(
+	VL53L1_DEV                      Dev,
+	VL53L1_DeviceDmaxMode           dmax_mode,
+	uint8_t                         zone_id,
+	VL53L1_dmax_calibration_data_t *pdmax_cal)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t    *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres =
+		VL53L1DevStructGetLLResultsHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	switch (dmax_mode) {
+
+	case VL53L1_DEVICEDMAXMODE__PER_ZONE_CAL_DATA:
+		pdmax_cal->ref__actual_effective_spads =
+		(uint16_t)pres->zone_cal.VL53L1_p_002[zone_id].effective_spads;
+		pdmax_cal->ref__peak_signal_count_rate_mcps =
+		(uint16_t)pres->zone_cal.VL53L1_p_002[zone_id].peak_rate_mcps;
+		pdmax_cal->ref__distance_mm =
+		pres->zone_cal.cal_distance_mm;
+		pdmax_cal->ref_reflectance_pc =
+		pres->zone_cal.cal_reflectance_pc;
+		pdmax_cal->coverglass_transmission = 0x0100;
+	break;
+
+	case VL53L1_DEVICEDMAXMODE__CUST_CAL_DATA:
+		memcpy(
+			pdmax_cal,
+			&(pdev->cust_dmax_cal),
+			sizeof(VL53L1_dmax_calibration_data_t));
+	break;
+
+	case VL53L1_DEVICEDMAXMODE__FMT_CAL_DATA:
+		memcpy(
+			pdmax_cal,
+			&(pdev->fmt_dmax_cal),
+			sizeof(VL53L1_dmax_calibration_data_t));
+	break;
+
+	default:
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	break;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_hist_dmax_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_hist_gen3_dmax_config_t *pdmax_cfg)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		&(pdev->dmax_cfg),
+		pdmax_cfg,
+		sizeof(VL53L1_hist_gen3_dmax_config_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_hist_dmax_config(
+	VL53L1_DEV                      Dev,
+	VL53L1_hist_gen3_dmax_config_t *pdmax_cfg)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		pdmax_cfg,
+		&(pdev->dmax_cfg),
+		sizeof(VL53L1_hist_gen3_dmax_config_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_offset_calibration_mode(
+	VL53L1_DEV                     Dev,
+	VL53L1_OffsetCalibrationMode   offset_cal_mode)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->offset_calibration_mode = offset_cal_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_offset_calibration_mode(
+	VL53L1_DEV                     Dev,
+	VL53L1_OffsetCalibrationMode  *poffset_cal_mode)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*poffset_cal_mode = pdev->offset_calibration_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_offset_correction_mode(
+	VL53L1_DEV                     Dev,
+	VL53L1_OffsetCorrectionMode    offset_cor_mode)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->offset_correction_mode = offset_cor_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_offset_correction_mode(
+	VL53L1_DEV                     Dev,
+	VL53L1_OffsetCorrectionMode   *poffset_cor_mode)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	*poffset_cor_mode = pdev->offset_correction_mode;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error VL53L1_set_zone_calibration_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_zone_calibration_results_t  *pzone_cal)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverResults_t *pres = VL53L1DevStructGetLLResultsHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	if (pzone_cal->struct_version !=
+		VL53L1_LL_ZONE_CALIBRATION_DATA_STRUCT_VERSION)
+		status = VL53L1_ERROR_INVALID_PARAMS;
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+
+		memcpy(
+			&(pres->zone_cal),
+			pzone_cal,
+			sizeof(VL53L1_zone_calibration_results_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_zone_calibration_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_zone_calibration_results_t  *pzone_cal)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverResults_t *pres = VL53L1DevStructGetLLResultsHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		pzone_cal,
+		&(pres->zone_cal),
+		sizeof(VL53L1_zone_calibration_results_t));
+
+	pzone_cal->struct_version =
+			VL53L1_LL_ZONE_CALIBRATION_DATA_STRUCT_VERSION;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_tuning_debug_data(
+	VL53L1_DEV                            Dev,
+	VL53L1_tuning_parameters_t           *ptun_data)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_xtalkextract_config_t *pXC = &(pdev->xtalk_extract_cfg);
+
+	LOG_FUNCTION_START("");
+
+	ptun_data->vl53l1_tuningparm_version =
+		pdev->tuning_parms.tp_tuning_parm_version;
+
+	ptun_data->vl53l1_tuningparm_key_table_version =
+		pdev->tuning_parms.tp_tuning_parm_key_table_version;
+
+
+	ptun_data->vl53l1_tuningparm_lld_version =
+		pdev->tuning_parms.tp_tuning_parm_lld_version;
+
+	ptun_data->vl53l1_tuningparm_hist_algo_select =
+		pHP->hist_algo_select;
+
+	ptun_data->vl53l1_tuningparm_hist_target_order =
+		pHP->hist_target_order;
+
+	ptun_data->vl53l1_tuningparm_hist_filter_woi_0 =
+		pHP->filter_woi0;
+
+	ptun_data->vl53l1_tuningparm_hist_filter_woi_1 =
+		pHP->filter_woi1;
+
+	ptun_data->vl53l1_tuningparm_hist_amb_est_method =
+		pHP->hist_amb_est_method;
+
+	ptun_data->vl53l1_tuningparm_hist_amb_thresh_sigma_0 =
+		pHP->ambient_thresh_sigma0;
+
+	ptun_data->vl53l1_tuningparm_hist_amb_thresh_sigma_1 =
+		pHP->ambient_thresh_sigma1;
+
+	ptun_data->vl53l1_tuningparm_hist_min_amb_thresh_events =
+		pHP->min_ambient_thresh_events;
+
+	ptun_data->vl53l1_tuningparm_hist_amb_events_scaler =
+		pHP->ambient_thresh_events_scaler;
+
+	ptun_data->vl53l1_tuningparm_hist_noise_threshold =
+		pHP->noise_threshold;
+
+	ptun_data->vl53l1_tuningparm_hist_signal_total_events_limit =
+		pHP->signal_total_events_limit;
+
+	ptun_data->vl53l1_tuningparm_hist_sigma_est_ref_mm =
+		pHP->sigma_estimator__sigma_ref_mm;
+
+	ptun_data->vl53l1_tuningparm_hist_sigma_thresh_mm =
+		pHP->sigma_thresh;
+
+	ptun_data->vl53l1_tuningparm_hist_gain_factor =
+		pdev->gain_cal.histogram_ranging_gain_factor;
+
+	ptun_data->vl53l1_tuningparm_consistency_hist_phase_tolerance =
+		pHP->algo__consistency_check__phase_tolerance;
+
+	ptun_data->vl53l1_tuningparm_consistency_hist_min_max_tolerance_mm =
+		pHP->algo__consistency_check__min_max_tolerance;
+
+	ptun_data->vl53l1_tuningparm_consistency_hist_event_sigma =
+		pHP->algo__consistency_check__event_sigma;
+
+	ptun_data->vl53l1_tuningparm_consistency_hist_event_sigma_min_spad_limit
+		= pHP->algo__consistency_check__event_min_spad_count;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_histo_long_range =
+		pdev->tuning_parms.tp_init_phase_rtn_hist_long;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_histo_med_range =
+		pdev->tuning_parms.tp_init_phase_rtn_hist_med;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_histo_short_range =
+		pdev->tuning_parms.tp_init_phase_rtn_hist_short;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_histo_long_range =
+		pdev->tuning_parms.tp_init_phase_ref_hist_long;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_histo_med_range =
+		pdev->tuning_parms.tp_init_phase_ref_hist_med;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_histo_short_range =
+		pdev->tuning_parms.tp_init_phase_ref_hist_short;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_min_valid_range_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_min_valid_range_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_max_valid_range_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_range_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_max_sigma_mm =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_sigma_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_min_max_tolerance =
+		pHP->algo__crosstalk_detect_min_max_tolerance;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_max_valid_rate_kcps =
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_rate_kcps;
+
+	ptun_data->vl53l1_tuningparm_xtalk_detect_event_sigma =
+		pHP->algo__crosstalk_detect_event_sigma;
+
+	ptun_data->vl53l1_tuningparm_hist_xtalk_margin_kcps =
+		pdev->xtalk_cfg.histogram_mode_crosstalk_margin_kcps;
+
+	ptun_data->vl53l1_tuningparm_consistency_lite_phase_tolerance =
+		pdev->tuning_parms.tp_consistency_lite_phase_tolerance;
+
+	ptun_data->vl53l1_tuningparm_phasecal_target =
+		pdev->tuning_parms.tp_phasecal_target;
+
+	ptun_data->vl53l1_tuningparm_lite_cal_repeat_rate =
+		pdev->tuning_parms.tp_cal_repeat_rate;
+
+	ptun_data->vl53l1_tuningparm_lite_ranging_gain_factor =
+		pdev->gain_cal.standard_ranging_gain_factor;
+
+	ptun_data->vl53l1_tuningparm_lite_min_clip_mm =
+		pdev->tuning_parms.tp_lite_min_clip;
+
+	ptun_data->vl53l1_tuningparm_lite_long_sigma_thresh_mm =
+		pdev->tuning_parms.tp_lite_long_sigma_thresh_mm;
+
+	ptun_data->vl53l1_tuningparm_lite_med_sigma_thresh_mm =
+		pdev->tuning_parms.tp_lite_med_sigma_thresh_mm;
+
+	ptun_data->vl53l1_tuningparm_lite_short_sigma_thresh_mm =
+		pdev->tuning_parms.tp_lite_short_sigma_thresh_mm;
+
+	ptun_data->vl53l1_tuningparm_lite_long_min_count_rate_rtn_mcps =
+		pdev->tuning_parms.tp_lite_long_min_count_rate_rtn_mcps;
+
+	ptun_data->vl53l1_tuningparm_lite_med_min_count_rate_rtn_mcps =
+		pdev->tuning_parms.tp_lite_med_min_count_rate_rtn_mcps;
+
+	ptun_data->vl53l1_tuningparm_lite_short_min_count_rate_rtn_mcps =
+		pdev->tuning_parms.tp_lite_short_min_count_rate_rtn_mcps;
+
+	ptun_data->vl53l1_tuningparm_lite_sigma_est_pulse_width =
+		pdev->tuning_parms.tp_lite_sigma_est_pulse_width_ns;
+
+	ptun_data->vl53l1_tuningparm_lite_sigma_est_amb_width_ns =
+		pdev->tuning_parms.tp_lite_sigma_est_amb_width_ns;
+
+	ptun_data->vl53l1_tuningparm_lite_sigma_ref_mm =
+		pdev->tuning_parms.tp_lite_sigma_ref_mm;
+
+	ptun_data->vl53l1_tuningparm_lite_rit_mult =
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_mult;
+
+	ptun_data->vl53l1_tuningparm_lite_seed_config =
+		pdev->tuning_parms.tp_lite_seed_cfg;
+
+	ptun_data->vl53l1_tuningparm_lite_quantifier =
+		pdev->tuning_parms.tp_lite_quantifier;
+
+	ptun_data->vl53l1_tuningparm_lite_first_order_select =
+		pdev->tuning_parms.tp_lite_first_order_select;
+
+	ptun_data->vl53l1_tuningparm_lite_xtalk_margin_kcps =
+		pdev->xtalk_cfg.lite_mode_crosstalk_margin_kcps;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_lite_long_range =
+		pdev->tuning_parms.tp_init_phase_rtn_lite_long;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_lite_med_range =
+		pdev->tuning_parms.tp_init_phase_rtn_lite_med;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_rtn_lite_short_range =
+		pdev->tuning_parms.tp_init_phase_rtn_lite_short;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_lite_long_range =
+		pdev->tuning_parms.tp_init_phase_ref_lite_long;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_lite_med_range =
+		pdev->tuning_parms.tp_init_phase_ref_lite_med;
+
+	ptun_data->vl53l1_tuningparm_initial_phase_ref_lite_short_range =
+		pdev->tuning_parms.tp_init_phase_ref_lite_short;
+
+	ptun_data->vl53l1_tuningparm_timed_seed_config =
+		pdev->tuning_parms.tp_timed_seed_cfg;
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_signal_thresh_sigma =
+		pdev->dmax_cfg.signal_thresh_sigma;
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_reflectance_array_0 =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[0];
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_reflectance_array_1 =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[1];
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_reflectance_array_2 =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[2];
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_reflectance_array_3 =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[3];
+
+	ptun_data->vl53l1_tuningparm_dmax_cfg_reflectance_array_4 =
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[4];
+
+	ptun_data->vl53l1_tuningparm_vhv_loopbound =
+		pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_device_test_mode =
+		pdev->refspadchar.device_test_mode;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_vcsel_period =
+		pdev->refspadchar.VL53L1_p_009;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_phasecal_timeout_us =
+		pdev->refspadchar.timeout_us;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_target_count_rate_mcps =
+		pdev->refspadchar.target_count_rate_mcps;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_min_countrate_limit_mcps =
+		pdev->refspadchar.min_count_rate_limit_mcps;
+
+	ptun_data->vl53l1_tuningparm_refspadchar_max_countrate_limit_mcps =
+		pdev->refspadchar.max_count_rate_limit_mcps;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_num_of_samples =
+		pXC->num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_min_filter_thresh_mm =
+		pXC->algo__crosstalk_extract_min_valid_range_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_max_filter_thresh_mm =
+		pXC->algo__crosstalk_extract_max_valid_range_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_dss_rate_mcps =
+		pXC->dss_config__target_total_rate_mcps;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_phasecal_timeout_us =
+		pXC->phasecal_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_max_valid_rate_kcps =
+		pXC->algo__crosstalk_extract_max_valid_rate_kcps;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_sigma_threshold_mm =
+		pXC->algo__crosstalk_extract_max_sigma_mm;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_dss_timeout_us =
+		pXC->mm_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_xtalk_extract_bin_timeout_us =
+		pXC->range_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_dss_rate_mcps =
+		pdev->offsetcal_cfg.dss_config__target_total_rate_mcps;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_phasecal_timeout_us =
+		pdev->offsetcal_cfg.phasecal_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_mm_timeout_us =
+		pdev->offsetcal_cfg.mm_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_range_timeout_us =
+		pdev->offsetcal_cfg.range_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_pre_samples =
+		pdev->offsetcal_cfg.pre_num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_mm1_samples =
+		pdev->offsetcal_cfg.mm1_num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_offset_cal_mm2_samples =
+		pdev->offsetcal_cfg.mm2_num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_dss_rate_mcps =
+		pdev->zonecal_cfg.dss_config__target_total_rate_mcps;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_phasecal_timeout_us =
+		pdev->zonecal_cfg.phasecal_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_dss_timeout_us =
+		pdev->zonecal_cfg.mm_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_phasecal_num_samples =
+		pdev->zonecal_cfg.phasecal_num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_range_timeout_us =
+		pdev->zonecal_cfg.range_config_timeout_us;
+
+	ptun_data->vl53l1_tuningparm_zone_cal_zone_num_samples =
+		pdev->zonecal_cfg.zone_num_of_samples;
+
+	ptun_data->vl53l1_tuningparm_spadmap_vcsel_period =
+		pdev->ssc_cfg.VL53L1_p_009;
+
+	ptun_data->vl53l1_tuningparm_spadmap_vcsel_start =
+		pdev->ssc_cfg.vcsel_start;
+
+	ptun_data->vl53l1_tuningparm_spadmap_rate_limit_mcps =
+		pdev->ssc_cfg.rate_limit_mcps;
+
+	ptun_data->vl53l1_tuningparm_lite_dss_config_target_total_rate_mcps =
+		pdev->tuning_parms.tp_dss_target_lite_mcps;
+
+	ptun_data->vl53l1_tuningparm_ranging_dss_config_target_total_rate_mcps =
+		pdev->tuning_parms.tp_dss_target_histo_mcps;
+
+	ptun_data->vl53l1_tuningparm_mz_dss_config_target_total_rate_mcps =
+		pdev->tuning_parms.tp_dss_target_histo_mz_mcps;
+
+	ptun_data->vl53l1_tuningparm_timed_dss_config_target_total_rate_mcps =
+		pdev->tuning_parms.tp_dss_target_timed_mcps;
+
+	ptun_data->vl53l1_tuningparm_lite_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_lite_us;
+
+	ptun_data->vl53l1_tuningparm_ranging_long_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_hist_long_us;
+
+	ptun_data->vl53l1_tuningparm_ranging_med_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_hist_med_us;
+
+	ptun_data->vl53l1_tuningparm_ranging_short_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_hist_short_us;
+
+	ptun_data->vl53l1_tuningparm_mz_long_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_mz_long_us;
+
+	ptun_data->vl53l1_tuningparm_mz_med_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_mz_med_us;
+
+	ptun_data->vl53l1_tuningparm_mz_short_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_mz_short_us;
+
+	ptun_data->vl53l1_tuningparm_timed_phasecal_config_timeout_us =
+		pdev->tuning_parms.tp_phasecal_timeout_timed_us;
+
+	ptun_data->vl53l1_tuningparm_lite_mm_config_timeout_us =
+		pdev->tuning_parms.tp_mm_timeout_lite_us;
+
+	ptun_data->vl53l1_tuningparm_ranging_mm_config_timeout_us =
+		pdev->tuning_parms.tp_mm_timeout_histo_us;
+
+	ptun_data->vl53l1_tuningparm_mz_mm_config_timeout_us =
+		pdev->tuning_parms.tp_mm_timeout_mz_us;
+
+	ptun_data->vl53l1_tuningparm_timed_mm_config_timeout_us =
+		pdev->tuning_parms.tp_mm_timeout_timed_us;
+
+	ptun_data->vl53l1_tuningparm_lite_range_config_timeout_us =
+		pdev->tuning_parms.tp_range_timeout_lite_us;
+
+	ptun_data->vl53l1_tuningparm_ranging_range_config_timeout_us =
+		pdev->tuning_parms.tp_range_timeout_histo_us;
+
+	ptun_data->vl53l1_tuningparm_mz_range_config_timeout_us =
+		pdev->tuning_parms.tp_range_timeout_mz_us;
+
+	ptun_data->vl53l1_tuningparm_timed_range_config_timeout_us =
+		pdev->tuning_parms.tp_range_timeout_timed_us;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_smudge_margin =
+		pdev->smudge_correct_config.smudge_margin;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_noise_margin =
+		pdev->smudge_correct_config.noise_margin;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_xtalk_offset_limit =
+		pdev->smudge_correct_config.user_xtalk_offset_limit;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_xtalk_offset_limit_hi =
+		pdev->smudge_correct_config.user_xtalk_offset_limit_hi;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_sample_limit =
+		pdev->smudge_correct_config.sample_limit;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_single_xtalk_delta =
+		pdev->smudge_correct_config.single_xtalk_delta;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_averaged_xtalk_delta =
+		pdev->smudge_correct_config.averaged_xtalk_delta;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_clip_limit =
+		pdev->smudge_correct_config.smudge_corr_clip_limit;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_scaler_calc_method =
+		pdev->smudge_correct_config.scaler_calc_method;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_xgradient_scaler =
+		pdev->smudge_correct_config.x_gradient_scaler;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_ygradient_scaler =
+		pdev->smudge_correct_config.y_gradient_scaler;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_user_scaler_set =
+		pdev->smudge_correct_config.user_scaler_set;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_smudge_cor_single_apply =
+		pdev->smudge_correct_config.smudge_corr_single_apply;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_xtalk_amb_threshold =
+		pdev->smudge_correct_config.smudge_corr_ambient_threshold;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_nodetect_amb_threshold_kcps =
+		pdev->smudge_correct_config.nodetect_ambient_threshold;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_nodetect_sample_limit =
+		pdev->smudge_correct_config.nodetect_sample_limit;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_nodetect_xtalk_offset_kcps =
+		pdev->smudge_correct_config.nodetect_xtalk_offset;
+
+	ptun_data->vl53l1_tuningparm_dynxtalk_nodetect_min_range_mm =
+		pdev->smudge_correct_config.nodetect_min_range_mm;
+
+	ptun_data->vl53l1_tuningparm_lowpowerauto_vhv_loop_bound =
+		pdev->low_power_auto_data.vhv_loop_bound;
+
+	ptun_data->vl53l1_tuningparm_lowpowerauto_mm_config_timeout_us =
+		pdev->tuning_parms.tp_mm_timeout_lpa_us;
+
+	ptun_data->vl53l1_tuningparm_lowpowerauto_range_config_timeout_us =
+		pdev->tuning_parms.tp_range_timeout_lpa_us;
+
+	ptun_data->vl53l1_tuningparm_very_short_dss_rate_mcps =
+		pdev->tuning_parms.tp_dss_target_very_short_mcps;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_tuning_parm(
+	VL53L1_DEV                     Dev,
+	VL53L1_TuningParms             tuning_parm_key,
+	int32_t                       *ptuning_parm_value)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_xtalkextract_config_t *pXC = &(pdev->xtalk_extract_cfg);
+
+	LOG_FUNCTION_START("");
+
+	switch (tuning_parm_key) {
+
+	case VL53L1_TUNINGPARM_VERSION:
+		*ptuning_parm_value =
+			(int32_t)pdev->tuning_parms.tp_tuning_parm_version;
+	break;
+	case VL53L1_TUNINGPARM_KEY_TABLE_VERSION:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_tuning_parm_key_table_version;
+	break;
+	case VL53L1_TUNINGPARM_LLD_VERSION:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_tuning_parm_lld_version;
+	break;
+	case VL53L1_TUNINGPARM_HIST_ALGO_SELECT:
+		*ptuning_parm_value =
+				(int32_t)pHP->hist_algo_select;
+	break;
+	case VL53L1_TUNINGPARM_HIST_TARGET_ORDER:
+		*ptuning_parm_value =
+				(int32_t)pHP->hist_target_order;
+	break;
+	case VL53L1_TUNINGPARM_HIST_FILTER_WOI_0:
+		*ptuning_parm_value =
+				(int32_t)pHP->filter_woi0;
+	break;
+	case VL53L1_TUNINGPARM_HIST_FILTER_WOI_1:
+		*ptuning_parm_value =
+				(int32_t)pHP->filter_woi1;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_EST_METHOD:
+		*ptuning_parm_value =
+				(int32_t)pHP->hist_amb_est_method;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_0:
+		*ptuning_parm_value =
+				(int32_t)pHP->ambient_thresh_sigma0;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_1:
+		*ptuning_parm_value =
+				(int32_t)pHP->ambient_thresh_sigma1;
+	break;
+	case VL53L1_TUNINGPARM_HIST_MIN_AMB_THRESH_EVENTS:
+		*ptuning_parm_value =
+				(int32_t)pHP->min_ambient_thresh_events;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_EVENTS_SCALER:
+		*ptuning_parm_value =
+				(int32_t)pHP->ambient_thresh_events_scaler;
+	break;
+	case VL53L1_TUNINGPARM_HIST_NOISE_THRESHOLD:
+		*ptuning_parm_value =
+				(int32_t)pHP->noise_threshold;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGNAL_TOTAL_EVENTS_LIMIT:
+		*ptuning_parm_value =
+				(int32_t)pHP->signal_total_events_limit;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGMA_EST_REF_MM:
+		*ptuning_parm_value =
+				(int32_t)pHP->sigma_estimator__sigma_ref_mm;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGMA_THRESH_MM:
+		*ptuning_parm_value =
+				(int32_t)pHP->sigma_thresh;
+	break;
+	case VL53L1_TUNINGPARM_HIST_GAIN_FACTOR:
+		*ptuning_parm_value =
+		(int32_t)pdev->gain_cal.histogram_ranging_gain_factor;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_PHASE_TOLERANCE:
+		*ptuning_parm_value =
+	(int32_t)pHP->algo__consistency_check__phase_tolerance;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_MIN_MAX_TOLERANCE_MM:
+		*ptuning_parm_value =
+	(int32_t)pHP->algo__consistency_check__min_max_tolerance;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA:
+		*ptuning_parm_value =
+		(int32_t)pHP->algo__consistency_check__event_sigma;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_MIN_SPAD_LIMIT:
+		*ptuning_parm_value =
+		(int32_t)pHP->algo__consistency_check__event_min_spad_count;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_LONG_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_hist_long;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_MED_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_hist_med;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_SHORT_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_hist_short;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_LONG_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_hist_long;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_MED_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_hist_med;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_SHORT_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_hist_short;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM:
+		*ptuning_parm_value = (int32_t)(
+		pdev->xtalk_cfg.algo__crosstalk_detect_min_valid_range_mm);
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM:
+		*ptuning_parm_value = (int32_t)(
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_range_mm);
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->xtalk_cfg.algo__crosstalk_detect_max_sigma_mm;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MIN_MAX_TOLERANCE:
+		*ptuning_parm_value =
+		(int32_t)pHP->algo__crosstalk_detect_min_max_tolerance;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS:
+		*ptuning_parm_value = (int32_t)(
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_rate_kcps);
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_EVENT_SIGMA:
+		*ptuning_parm_value =
+		(int32_t)pHP->algo__crosstalk_detect_event_sigma;
+	break;
+	case VL53L1_TUNINGPARM_HIST_XTALK_MARGIN_KCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->xtalk_cfg.histogram_mode_crosstalk_margin_kcps;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_consistency_lite_phase_tolerance;
+	break;
+	case VL53L1_TUNINGPARM_PHASECAL_TARGET:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_target;
+	break;
+	case VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_cal_repeat_rate;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RANGING_GAIN_FACTOR:
+		*ptuning_parm_value =
+		(int32_t)pdev->gain_cal.standard_ranging_gain_factor;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_min_clip;
+	break;
+	case VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_long_sigma_thresh_mm;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_med_sigma_thresh_mm;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_short_sigma_thresh_mm;
+	break;
+	case VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS:
+		*ptuning_parm_value = (int32_t)(
+		pdev->tuning_parms.tp_lite_long_min_count_rate_rtn_mcps);
+	break;
+	case VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_med_min_count_rate_rtn_mcps;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS:
+		*ptuning_parm_value = (int32_t)(
+		pdev->tuning_parms.tp_lite_short_min_count_rate_rtn_mcps);
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_sigma_est_pulse_width_ns;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_sigma_est_amb_width_ns;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_sigma_ref_mm;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RIT_MULT:
+		*ptuning_parm_value =
+		(int32_t)pdev->xtalk_cfg.crosstalk_range_ignore_threshold_mult;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SEED_CONFIG:
+		*ptuning_parm_value =
+				(int32_t)pdev->tuning_parms.tp_lite_seed_cfg;
+	break;
+	case VL53L1_TUNINGPARM_LITE_QUANTIFIER:
+		*ptuning_parm_value =
+				(int32_t)pdev->tuning_parms.tp_lite_quantifier;
+	break;
+	case VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_lite_first_order_select;
+	break;
+	case VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->xtalk_cfg.lite_mode_crosstalk_margin_kcps;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_lite_long;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_lite_med;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_rtn_lite_short;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_lite_long;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_lite_med;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_init_phase_ref_lite_short;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_SEED_CONFIG:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_timed_seed_cfg;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_SIGNAL_THRESH_SIGMA:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.signal_thresh_sigma;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_0:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.target_reflectance_for_dmax_calc[0];
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_1:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.target_reflectance_for_dmax_calc[1];
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_2:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.target_reflectance_for_dmax_calc[2];
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_3:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.target_reflectance_for_dmax_calc[3];
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_4:
+		*ptuning_parm_value =
+		(int32_t)pdev->dmax_cfg.target_reflectance_for_dmax_calc[4];
+	break;
+	case VL53L1_TUNINGPARM_VHV_LOOPBOUND:
+		*ptuning_parm_value =
+		(int32_t)pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.device_test_mode;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.VL53L1_p_009;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.target_count_rate_mcps;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.min_count_rate_limit_mcps;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->refspadchar.max_count_rate_limit_mcps;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_NUM_OF_SAMPLES:
+		*ptuning_parm_value =
+		(int32_t)pXC->num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MIN_FILTER_THRESH_MM:
+		*ptuning_parm_value =
+		(int32_t)pXC->algo__crosstalk_extract_min_valid_range_mm;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_FILTER_THRESH_MM:
+		*ptuning_parm_value =
+		(int32_t)pXC->algo__crosstalk_extract_max_valid_range_mm;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pXC->dss_config__target_total_rate_mcps;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_PHASECAL_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pXC->phasecal_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_VALID_RATE_KCPS:
+		*ptuning_parm_value =
+		(int32_t)pXC->algo__crosstalk_extract_max_valid_rate_kcps;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_SIGMA_THRESHOLD_MM:
+		*ptuning_parm_value =
+		(int32_t)pXC->algo__crosstalk_extract_max_sigma_mm;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pXC->mm_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_BIN_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pXC->range_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.dss_config__target_total_rate_mcps;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.phasecal_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.mm_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.range_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.pre_num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES:
+		*ptuning_parm_value =
+	(int32_t)pdev->offsetcal_cfg.mm1_num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES:
+		*ptuning_parm_value =
+		(int32_t)pdev->offsetcal_cfg.mm2_num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_DSS_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->zonecal_cfg.dss_config__target_total_rate_mcps;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_TIMEOUT_US:
+		*ptuning_parm_value =
+	(int32_t)pdev->zonecal_cfg.phasecal_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_DSS_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->zonecal_cfg.mm_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_NUM_SAMPLES:
+		*ptuning_parm_value =
+		(int32_t)pdev->zonecal_cfg.phasecal_num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_RANGE_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->zonecal_cfg.range_config_timeout_us;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_ZONE_NUM_SAMPLES:
+		*ptuning_parm_value =
+		(int32_t)pdev->zonecal_cfg.zone_num_of_samples;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD:
+		*ptuning_parm_value =
+		(int32_t)pdev->ssc_cfg.VL53L1_p_009;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_VCSEL_START:
+		*ptuning_parm_value =
+		(int32_t)pdev->ssc_cfg.vcsel_start;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->ssc_cfg.rate_limit_mcps;
+	break;
+	case VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_dss_target_lite_mcps;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_dss_target_histo_mcps;
+	break;
+	case VL53L1_TUNINGPARM_MZ_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_dss_target_histo_mz_mcps;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_dss_target_timed_mcps;
+	break;
+	case VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_lite_us;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_LONG_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_hist_long_us;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_MED_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_hist_med_us;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_SHORT_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_hist_short_us;
+	break;
+	case VL53L1_TUNINGPARM_MZ_LONG_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_mz_long_us;
+	break;
+	case VL53L1_TUNINGPARM_MZ_MED_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_mz_med_us;
+	break;
+	case VL53L1_TUNINGPARM_MZ_SHORT_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_mz_short_us;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_phasecal_timeout_timed_us;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_mm_timeout_lite_us;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_MM_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_mm_timeout_histo_us;
+	break;
+	case VL53L1_TUNINGPARM_MZ_MM_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_mm_timeout_mz_us;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_mm_timeout_timed_us;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_range_timeout_lite_us;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_RANGE_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_range_timeout_histo_us;
+	break;
+	case VL53L1_TUNINGPARM_MZ_RANGE_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_range_timeout_mz_us;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_range_timeout_timed_us;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_MARGIN:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.smudge_margin;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NOISE_MARGIN:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.noise_margin;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.user_xtalk_offset_limit;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_HI:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.user_xtalk_offset_limit_hi;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SAMPLE_LIMIT:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.sample_limit;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SINGLE_XTALK_DELTA:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.single_xtalk_delta;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_AVERAGED_XTALK_DELTA:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.averaged_xtalk_delta;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_CLIP_LIMIT:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.smudge_corr_clip_limit;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SCALER_CALC_METHOD:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.scaler_calc_method;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XGRADIENT_SCALER:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.x_gradient_scaler;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_YGRADIENT_SCALER:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.y_gradient_scaler;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_USER_SCALER_SET:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.user_scaler_set;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_COR_SINGLE_APPLY:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.smudge_corr_single_apply;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_AMB_THRESHOLD:
+		*ptuning_parm_value = (int32_t)(
+		pdev->smudge_correct_config.smudge_corr_ambient_threshold);
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_AMB_THRESHOLD_KCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.nodetect_ambient_threshold;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_SAMPLE_LIMIT:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.nodetect_sample_limit;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.nodetect_xtalk_offset;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_MIN_RANGE_MM:
+		*ptuning_parm_value =
+		(int32_t)pdev->smudge_correct_config.nodetect_min_range_mm;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND:
+		*ptuning_parm_value =
+		(int32_t)pdev->low_power_auto_data.vhv_loop_bound;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_mm_timeout_lpa_us;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_range_timeout_lpa_us;
+	break;
+	case VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS:
+		*ptuning_parm_value =
+		(int32_t)pdev->tuning_parms.tp_dss_target_very_short_mcps;
+	break;
+
+
+	default:
+		*ptuning_parm_value = 0x7FFFFFFF;
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	break;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_set_tuning_parm(
+	VL53L1_DEV            Dev,
+	VL53L1_TuningParms    tuning_parm_key,
+	int32_t               tuning_parm_value)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_hist_post_process_config_t *pHP = &(pdev->histpostprocess);
+	VL53L1_xtalkextract_config_t *pXC = &(pdev->xtalk_extract_cfg);
+
+	LOG_FUNCTION_START("");
+
+	switch (tuning_parm_key) {
+
+	case VL53L1_TUNINGPARM_VERSION:
+		pdev->tuning_parms.tp_tuning_parm_version =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_KEY_TABLE_VERSION:
+		pdev->tuning_parms.tp_tuning_parm_key_table_version =
+					(uint16_t)tuning_parm_value;
+
+
+
+
+
+
+
+
+
+
+		if ((uint16_t)tuning_parm_value
+			!= VL53L1_TUNINGPARM_KEY_TABLE_VERSION_DEFAULT)
+			status = VL53L1_ERROR_TUNING_PARM_KEY_MISMATCH;
+
+	break;
+	case VL53L1_TUNINGPARM_LLD_VERSION:
+		pdev->tuning_parms.tp_tuning_parm_lld_version =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_ALGO_SELECT:
+		pHP->hist_algo_select =
+				(VL53L1_HistAlgoSelect)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_TARGET_ORDER:
+		pHP->hist_target_order =
+				(VL53L1_HistTargetOrder)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_FILTER_WOI_0:
+		pHP->filter_woi0 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_FILTER_WOI_1:
+		pHP->filter_woi1 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_EST_METHOD:
+		pHP->hist_amb_est_method =
+				(VL53L1_HistAmbEstMethod)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_0:
+		pHP->ambient_thresh_sigma0 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_1:
+		pHP->ambient_thresh_sigma1 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_MIN_AMB_THRESH_EVENTS:
+		pHP->min_ambient_thresh_events =
+		(int32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_AMB_EVENTS_SCALER:
+		pHP->ambient_thresh_events_scaler =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_NOISE_THRESHOLD:
+		pHP->noise_threshold =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGNAL_TOTAL_EVENTS_LIMIT:
+		pHP->signal_total_events_limit =
+		(int32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGMA_EST_REF_MM:
+		pHP->sigma_estimator__sigma_ref_mm =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_SIGMA_THRESH_MM:
+		pHP->sigma_thresh =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_GAIN_FACTOR:
+		pdev->gain_cal.histogram_ranging_gain_factor =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_PHASE_TOLERANCE:
+		pHP->algo__consistency_check__phase_tolerance =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_MIN_MAX_TOLERANCE_MM:
+		pHP->algo__consistency_check__min_max_tolerance =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA:
+		pHP->algo__consistency_check__event_sigma =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_MIN_SPAD_LIMIT:
+		pHP->algo__consistency_check__event_min_spad_count =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_LONG_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_hist_long =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_MED_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_hist_med =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_SHORT_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_hist_short =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_LONG_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_hist_long =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_MED_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_hist_med =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_SHORT_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_hist_short =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM:
+		pdev->xtalk_cfg.algo__crosstalk_detect_min_valid_range_mm =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM:
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_range_mm =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM:
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_sigma_mm =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MIN_MAX_TOLERANCE:
+		pHP->algo__crosstalk_detect_min_max_tolerance =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS:
+		pdev->xtalk_cfg.algo__crosstalk_detect_max_valid_rate_kcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_DETECT_EVENT_SIGMA:
+		pHP->algo__crosstalk_detect_event_sigma =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_HIST_XTALK_MARGIN_KCPS:
+		pdev->xtalk_cfg.histogram_mode_crosstalk_margin_kcps =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE:
+		pdev->tuning_parms.tp_consistency_lite_phase_tolerance =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_PHASECAL_TARGET:
+		pdev->tuning_parms.tp_phasecal_target =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE:
+		pdev->tuning_parms.tp_cal_repeat_rate =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RANGING_GAIN_FACTOR:
+		pdev->gain_cal.standard_ranging_gain_factor =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM:
+		pdev->tuning_parms.tp_lite_min_clip =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM:
+		pdev->tuning_parms.tp_lite_long_sigma_thresh_mm =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM:
+		pdev->tuning_parms.tp_lite_med_sigma_thresh_mm =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM:
+		pdev->tuning_parms.tp_lite_short_sigma_thresh_mm =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS:
+		pdev->tuning_parms.tp_lite_long_min_count_rate_rtn_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS:
+		pdev->tuning_parms.tp_lite_med_min_count_rate_rtn_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS:
+		pdev->tuning_parms.tp_lite_short_min_count_rate_rtn_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH:
+		pdev->tuning_parms.tp_lite_sigma_est_pulse_width_ns =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS:
+		pdev->tuning_parms.tp_lite_sigma_est_amb_width_ns =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM:
+		pdev->tuning_parms.tp_lite_sigma_ref_mm =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RIT_MULT:
+		pdev->xtalk_cfg.crosstalk_range_ignore_threshold_mult =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_SEED_CONFIG:
+		pdev->tuning_parms.tp_lite_seed_cfg =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_QUANTIFIER:
+		pdev->tuning_parms.tp_lite_quantifier =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT:
+		pdev->tuning_parms.tp_lite_first_order_select =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS:
+		pdev->xtalk_cfg.lite_mode_crosstalk_margin_kcps =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_lite_long =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_lite_med =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE:
+		pdev->tuning_parms.tp_init_phase_rtn_lite_short =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_lite_long =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_lite_med =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE:
+		pdev->tuning_parms.tp_init_phase_ref_lite_short =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_SEED_CONFIG:
+		pdev->tuning_parms.tp_timed_seed_cfg =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_SIGNAL_THRESH_SIGMA:
+		pdev->dmax_cfg.signal_thresh_sigma =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_0:
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[0] =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_1:
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[1] =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_2:
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[2] =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_3:
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[3] =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_4:
+		pdev->dmax_cfg.target_reflectance_for_dmax_calc[4] =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_VHV_LOOPBOUND:
+		pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE:
+		pdev->refspadchar.device_test_mode =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD:
+		pdev->refspadchar.VL53L1_p_009 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US:
+		pdev->refspadchar.timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS:
+		pdev->refspadchar.target_count_rate_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS:
+		pdev->refspadchar.min_count_rate_limit_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS:
+		pdev->refspadchar.max_count_rate_limit_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_NUM_OF_SAMPLES:
+		pXC->num_of_samples =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MIN_FILTER_THRESH_MM:
+		pXC->algo__crosstalk_extract_min_valid_range_mm =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_FILTER_THRESH_MM:
+		pXC->algo__crosstalk_extract_max_valid_range_mm =
+				(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_RATE_MCPS:
+		pXC->dss_config__target_total_rate_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_PHASECAL_TIMEOUT_US:
+		pXC->phasecal_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_VALID_RATE_KCPS:
+		 pXC->algo__crosstalk_extract_max_valid_rate_kcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_SIGMA_THRESHOLD_MM:
+		pXC->algo__crosstalk_extract_max_sigma_mm =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_TIMEOUT_US:
+		pXC->mm_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_XTALK_EXTRACT_BIN_TIMEOUT_US:
+		pXC->range_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS:
+		pdev->offsetcal_cfg.dss_config__target_total_rate_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US:
+		pdev->offsetcal_cfg.phasecal_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US:
+		pdev->offsetcal_cfg.mm_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US:
+		pdev->offsetcal_cfg.range_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES:
+		pdev->offsetcal_cfg.pre_num_of_samples =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES:
+		pdev->offsetcal_cfg.mm1_num_of_samples =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES:
+		pdev->offsetcal_cfg.mm2_num_of_samples =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_DSS_RATE_MCPS:
+		pdev->zonecal_cfg.dss_config__target_total_rate_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_TIMEOUT_US:
+		pdev->zonecal_cfg.phasecal_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_DSS_TIMEOUT_US:
+		pdev->zonecal_cfg.mm_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_NUM_SAMPLES:
+		pdev->zonecal_cfg.phasecal_num_of_samples =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_RANGE_TIMEOUT_US:
+		pdev->zonecal_cfg.range_config_timeout_us =
+				(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_ZONE_CAL_ZONE_NUM_SAMPLES:
+		pdev->zonecal_cfg.zone_num_of_samples =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD:
+		pdev->ssc_cfg.VL53L1_p_009 =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_VCSEL_START:
+		pdev->ssc_cfg.vcsel_start =
+				(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS:
+		pdev->ssc_cfg.rate_limit_mcps =
+				(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		pdev->tuning_parms.tp_dss_target_lite_mcps =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		pdev->tuning_parms.tp_dss_target_histo_mcps =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		pdev->tuning_parms.tp_dss_target_histo_mz_mcps =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS:
+		pdev->tuning_parms.tp_dss_target_timed_mcps =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_lite_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_LONG_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_hist_long_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_MED_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_hist_med_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_SHORT_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_hist_short_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_LONG_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_mz_long_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_MED_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_mz_med_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_SHORT_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_mz_short_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_phasecal_timeout_timed_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_mm_timeout_lite_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_MM_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_mm_timeout_histo_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_MM_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_mm_timeout_mz_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_mm_timeout_timed_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_range_timeout_lite_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_RANGING_RANGE_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_range_timeout_histo_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_MZ_RANGE_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_range_timeout_mz_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_range_timeout_timed_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_MARGIN:
+		pdev->smudge_correct_config.smudge_margin =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NOISE_MARGIN:
+		pdev->smudge_correct_config.noise_margin =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT:
+		pdev->smudge_correct_config.user_xtalk_offset_limit =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_HI:
+		pdev->smudge_correct_config.user_xtalk_offset_limit_hi =
+			(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SAMPLE_LIMIT:
+		pdev->smudge_correct_config.sample_limit =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SINGLE_XTALK_DELTA:
+		pdev->smudge_correct_config.single_xtalk_delta =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_AVERAGED_XTALK_DELTA:
+		pdev->smudge_correct_config.averaged_xtalk_delta =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_CLIP_LIMIT:
+		pdev->smudge_correct_config.smudge_corr_clip_limit =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_SCALER_CALC_METHOD:
+		pdev->smudge_correct_config.scaler_calc_method =
+			(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XGRADIENT_SCALER:
+		pdev->smudge_correct_config.x_gradient_scaler =
+			(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_YGRADIENT_SCALER:
+		pdev->smudge_correct_config.y_gradient_scaler =
+			(int16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_USER_SCALER_SET:
+		pdev->smudge_correct_config.user_scaler_set =
+			(uint8_t)tuning_parm_value;
+	break;
+
+	case VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_COR_SINGLE_APPLY:
+		pdev->smudge_correct_config.smudge_corr_single_apply =
+			(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_XTALK_AMB_THRESHOLD:
+		pdev->smudge_correct_config.smudge_corr_ambient_threshold =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_AMB_THRESHOLD_KCPS:
+		pdev->smudge_correct_config.nodetect_ambient_threshold =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_SAMPLE_LIMIT:
+		pdev->smudge_correct_config.nodetect_sample_limit =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS:
+		pdev->smudge_correct_config.nodetect_xtalk_offset =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_DYNXTALK_NODETECT_MIN_RANGE_MM:
+		pdev->smudge_correct_config.nodetect_min_range_mm =
+			(uint16_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND:
+		pdev->low_power_auto_data.vhv_loop_bound =
+			(uint8_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_mm_timeout_lpa_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US:
+		pdev->tuning_parms.tp_range_timeout_lpa_us =
+			(uint32_t)tuning_parm_value;
+	break;
+	case VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS:
+		pdev->tuning_parms.tp_dss_target_very_short_mcps =
+			(uint16_t)tuning_parm_value;
+	break;
+
+
+	default:
+		status = VL53L1_ERROR_INVALID_PARAMS;
+	break;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_enable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_enabled = 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_disable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_enabled = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_apply_enable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_apply_enabled = 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_apply_disable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_apply_enabled = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_single_apply_enable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_single_apply = 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_single_apply_disable(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.smudge_corr_single_apply = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_set_scalers(
+	VL53L1_DEV	Dev,
+	int16_t		x_scaler_in,
+	int16_t		y_scaler_in,
+	uint8_t		user_scaler_set_in
+	)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->smudge_correct_config.x_gradient_scaler = x_scaler_in;
+	pdev->smudge_correct_config.y_gradient_scaler = y_scaler_in;
+	pdev->smudge_correct_config.user_scaler_set = user_scaler_set_in;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_get_current_xtalk_settings(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_calibration_results_t *pxtalk
+	)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pxtalk->algo__crosstalk_compensation_plane_offset_kcps =
+		pdev->xtalk_cfg.algo__crosstalk_compensation_plane_offset_kcps;
+	pxtalk->algo__crosstalk_compensation_x_plane_gradient_kcps =
+	pdev->xtalk_cfg.algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pxtalk->algo__crosstalk_compensation_y_plane_gradient_kcps =
+	pdev->xtalk_cfg.algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_current_xtalk_settings(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_calibration_results_t *pxtalk
+	)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->xtalk_cfg.algo__crosstalk_compensation_plane_offset_kcps =
+		pxtalk->algo__crosstalk_compensation_plane_offset_kcps;
+	pdev->xtalk_cfg.algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pxtalk->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pdev->xtalk_cfg.algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pxtalk->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api_debug.c b/drivers/input/misc/vl53L1/src/vl53l1_api_debug.c
new file mode 100644
index 0000000000000000000000000000000000000000..46f7f0daa5d3f64167ff0408bf01fc2732aaf2e2
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api_debug.c
@@ -0,0 +1,3629 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_register_structs.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_nvm_structs.h"
+#include "vl53l1_nvm.h"
+#include "vl53l1_core.h"
+#include "vl53l1_api_debug.h"
+
+#ifdef VL53L1_LOG_ENABLE
+#include "vl53l1_nvm_debug.h"
+#endif
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, status, \
+	fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(trace_flags, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_decode_calibration_data_buffer(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_calibration_data_t *pdata)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (sizeof(VL53L1_calibration_data_t) > buf_size)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	memcpy(pdata, pbuffer, sizeof(VL53L1_calibration_data_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_nvm_debug_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_decoded_nvm_data_t          *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_read_nvm(Dev, 0, pdata);
+
+#ifdef VL53L1_LOG_ENABLE
+	if (status == VL53L1_ERROR_NONE)
+		VL53L1_print_decoded_nvm_data(
+			pdata,
+			"get_nvm_debug_data():pnvm_info.",
+			VL53L1_TRACE_MODULE_NVM_DATA);
+#endif
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_histogram_debug_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_histogram_bin_data_t        *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		pdata,
+		&(pdev->hist_data),
+		sizeof(VL53L1_histogram_bin_data_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error VL53L1_get_additional_data(
+	VL53L1_DEV                       Dev,
+	VL53L1_additional_data_t        *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdata->preset_mode             = pdev->preset_mode;
+	pdata->zone_preset             = pdev->zone_preset;
+	pdata->measurement_mode        = pdev->measurement_mode;
+	pdata->offset_calibration_mode = pdev->offset_calibration_mode;
+	pdata->offset_correction_mode  = pdev->offset_correction_mode;
+	pdata->dmax_mode               = pdev->dmax_mode;
+
+	pdata->phasecal_config_timeout_us  = pdev->phasecal_config_timeout_us;
+	pdata->mm_config_timeout_us        = pdev->mm_config_timeout_us;
+	pdata->range_config_timeout_us     = pdev->range_config_timeout_us;
+	pdata->inter_measurement_period_ms = pdev->inter_measurement_period_ms;
+	pdata->dss_config__target_total_rate_mcps =
+			pdev->dss_config__target_total_rate_mcps;
+
+
+
+
+	status =
+		VL53L1_get_histogram_debug_data(
+			Dev,
+			&(pdata->VL53L1_p_010));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error VL53L1_get_xtalk_debug_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_debug_data_t          *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		&(pdata->customer),
+		&(pdev->customer),
+		sizeof(VL53L1_customer_nvm_managed_t));
+
+	memcpy(
+		&(pdata->xtalk_cfg),
+		&(pdev->xtalk_cfg),
+		sizeof(VL53L1_xtalk_config_t));
+
+	memcpy(
+		&(pdata->hist_data),
+		&(pdev->hist_data),
+		sizeof(VL53L1_histogram_bin_data_t));
+
+	memcpy(
+		&(pdata->xtalk_shapes),
+		&(pdev->xtalk_shapes),
+		sizeof(VL53L1_xtalk_histogram_data_t));
+
+	memcpy(
+		&(pdata->xtalk_results),
+		&(pdev->xtalk_results),
+		sizeof(VL53L1_xtalk_range_results_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_offset_debug_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_offset_debug_data_t         *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+	memcpy(
+		&(pdata->customer),
+		&(pdev->customer),
+		sizeof(VL53L1_customer_nvm_managed_t));
+
+	memcpy(
+		&(pdata->fmt_dmax_cal),
+		&(pdev->fmt_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+	memcpy(
+		&(pdata->cust_dmax_cal),
+		&(pdev->cust_dmax_cal),
+		sizeof(VL53L1_dmax_calibration_data_t));
+
+	memcpy(
+		&(pdata->add_off_cal_data),
+		&(pdev->add_off_cal_data),
+		sizeof(VL53L1_additional_offset_cal_data_t));
+
+	memcpy(
+		&(pdata->offset_results),
+		&(pdev->offset_results),
+		sizeof(VL53L1_offset_range_results_t));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+#ifdef VL53L1_LOG_ENABLE
+
+void  VL53L1_signed_fixed_point_sprintf(
+	int32_t    signed_fp_value,
+	uint8_t    frac_bits,
+	uint16_t   buf_size,
+	char      *pbuffer)
+{
+
+
+
+
+
+	uint32_t  fp_value      = 0;
+	uint32_t  unity_fp_value = 0;
+	uint32_t  sign_bit       = 0;
+	uint32_t  int_part       = 0;
+	uint32_t  frac_part      = 0;
+	uint32_t  dec_points     = 0;
+	uint32_t  dec_scaler     = 0;
+	uint32_t  dec_part       = 0;
+
+	uint64_t  tmp_long_int   = 0;
+
+	char  fmt[VL53L1_MAX_STRING_LENGTH];
+
+	SUPPRESS_UNUSED_WARNING(buf_size);
+
+
+
+
+	sign_bit       =  signed_fp_value >> 31;
+
+	if (sign_bit > 0) {
+		fp_value = 0x80000000 -
+			(0x7FFFFFFF & (uint32_t)signed_fp_value);
+	} else
+		fp_value = (uint32_t)signed_fp_value;
+
+	int_part       =  fp_value >> frac_bits;
+	unity_fp_value =  0x01 << frac_bits;
+	frac_part      =  fp_value & (unity_fp_value-1);
+
+
+
+
+
+	dec_points =   2;
+	dec_scaler = 100;
+
+	while (dec_scaler < unity_fp_value) {
+		dec_points++;
+		dec_scaler *= 10;
+	}
+
+
+
+	if (sign_bit > 0)
+		sprintf(fmt, "-%%u.%%0%uu", dec_points);
+	else
+		sprintf(fmt,  "%%u.%%0%uu", dec_points);
+
+
+
+
+
+	tmp_long_int  = (uint64_t)frac_part * (uint64_t)dec_scaler;
+	tmp_long_int += (uint64_t)unity_fp_value/2;
+
+	tmp_long_int = do_division_u(tmp_long_int, (uint64_t)unity_fp_value);
+
+	dec_part = (uint32_t)tmp_long_int;
+
+
+
+	sprintf(
+		pbuffer,
+		fmt,
+		int_part,
+		dec_part);
+}
+
+
+void VL53L1_print_static_nvm_managed(
+	VL53L1_static_nvm_managed_t   *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = 0x%02X\n",
+		pprefix,
+		"i2c_slave__device_address",
+		pdata->i2c_slave__device_address);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__vhv_ref_sel_vddpix",
+		pdata->ana_config__vhv_ref_sel_vddpix);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__vhv_ref_sel_vquench",
+		pdata->ana_config__vhv_ref_sel_vquench);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__reg_avdd1v2_sel",
+		pdata->ana_config__reg_avdd1v2_sel);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__fast_osc__trim",
+		pdata->ana_config__fast_osc__trim);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->osc_measured__fast_osc__frequency,
+		12,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"osc_measured__fast_osc__frequency",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"vhv_config__timeout_macrop_loop_bound",
+		pdata->vhv_config__timeout_macrop_loop_bound);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"vhv_config__count_thresh",
+		pdata->vhv_config__count_thresh);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"vhv_config__offset",
+		pdata->vhv_config__offset);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"vhv_config__init",
+		pdata->vhv_config__init);
+}
+
+
+void VL53L1_print_customer_nvm_managed(
+	VL53L1_customer_nvm_managed_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	int16_t tmpi16;
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_0",
+		pdata->global_config__spad_enables_ref_0);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_1",
+		pdata->global_config__spad_enables_ref_1);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_2",
+		pdata->global_config__spad_enables_ref_2);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_3",
+		pdata->global_config__spad_enables_ref_3);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_4",
+		pdata->global_config__spad_enables_ref_4);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_ref_5",
+		pdata->global_config__spad_enables_ref_5);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__ref_en_start_select",
+		pdata->global_config__ref_en_start_select);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ref_spad_man__num_requested_ref_spads",
+		pdata->ref_spad_man__num_requested_ref_spads);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ref_spad_man__ref_location",
+		pdata->ref_spad_man__ref_location);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_compensation_plane_offset_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_plane_offset_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_x_plane_gradient_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_y_plane_gradient_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ref_spad_char__total_rate_target_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ref_spad_char__total_rate_target_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__part_to_part_range_offset_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__part_to_part_range_offset_mm",
+		fp_text);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"mm_config__inner_offset_mm",
+		pdata->mm_config__inner_offset_mm);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"mm_config__outer_offset_mm",
+		pdata->mm_config__outer_offset_mm);
+}
+
+
+void VL53L1_print_nvm_copy_data(
+	VL53L1_nvm_copy_data_t      *pdata,
+	char                        *pprefix,
+	uint32_t                     trace_flags)
+{
+
+
+
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"identification__model_id",
+		pdata->identification__model_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"identification__module_type",
+		pdata->identification__module_type);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"identification__revision_id",
+		pdata->identification__revision_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"identification__module_id",
+		pdata->identification__module_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__fast_osc__trim_max",
+		pdata->ana_config__fast_osc__trim_max);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__fast_osc__freq_set",
+		pdata->ana_config__fast_osc__freq_set);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__vcsel_trim",
+		pdata->ana_config__vcsel_trim);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__vcsel_selion",
+		pdata->ana_config__vcsel_selion);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ana_config__vcsel_selion_max",
+		pdata->ana_config__vcsel_selion_max);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"protected_laser_safety__lock_bit",
+		pdata->protected_laser_safety__lock_bit);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"laser_safety__key",
+		pdata->laser_safety__key);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"laser_safety__key_ro",
+		pdata->laser_safety__key_ro);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"laser_safety__clip",
+		pdata->laser_safety__clip);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"laser_safety__mult",
+		pdata->laser_safety__mult);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_0",
+		pdata->global_config__spad_enables_rtn_0);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_1",
+		pdata->global_config__spad_enables_rtn_1);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_2",
+		pdata->global_config__spad_enables_rtn_2);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_3",
+		pdata->global_config__spad_enables_rtn_3);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_4",
+		pdata->global_config__spad_enables_rtn_4);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_5",
+		pdata->global_config__spad_enables_rtn_5);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_6",
+		pdata->global_config__spad_enables_rtn_6);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_7",
+		pdata->global_config__spad_enables_rtn_7);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_8",
+		pdata->global_config__spad_enables_rtn_8);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_9",
+		pdata->global_config__spad_enables_rtn_9);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_10",
+		pdata->global_config__spad_enables_rtn_10);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_11",
+		pdata->global_config__spad_enables_rtn_11);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_12",
+		pdata->global_config__spad_enables_rtn_12);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_13",
+		pdata->global_config__spad_enables_rtn_13);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_14",
+		pdata->global_config__spad_enables_rtn_14);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_15",
+		pdata->global_config__spad_enables_rtn_15);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_16",
+		pdata->global_config__spad_enables_rtn_16);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_17",
+		pdata->global_config__spad_enables_rtn_17);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_18",
+		pdata->global_config__spad_enables_rtn_18);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_19",
+		pdata->global_config__spad_enables_rtn_19);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_20",
+		pdata->global_config__spad_enables_rtn_20);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_21",
+		pdata->global_config__spad_enables_rtn_21);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_22",
+		pdata->global_config__spad_enables_rtn_22);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_23",
+		pdata->global_config__spad_enables_rtn_23);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_24",
+		pdata->global_config__spad_enables_rtn_24);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_25",
+		pdata->global_config__spad_enables_rtn_25);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_26",
+		pdata->global_config__spad_enables_rtn_26);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_27",
+		pdata->global_config__spad_enables_rtn_27);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_28",
+		pdata->global_config__spad_enables_rtn_28);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_29",
+		pdata->global_config__spad_enables_rtn_29);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_30",
+		pdata->global_config__spad_enables_rtn_30);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_config__spad_enables_rtn_31",
+		pdata->global_config__spad_enables_rtn_31);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"roi_config__mode_roi_centre_spad",
+		pdata->roi_config__mode_roi_centre_spad);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = 0x%02X\n",
+		pprefix,
+		"roi_config__mode_roi_xy_size",
+		pdata->roi_config__mode_roi_xy_size);
+}
+
+
+void VL53L1_print_histogram_bin_data(
+	VL53L1_histogram_bin_data_t *pdata,
+	char                        *pprefix,
+	uint32_t                     trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t  i             = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cfg_device_state",
+		pdata->cfg_device_state);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"rd_device_state",
+		pdata->rd_device_state);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_022",
+		pdata->VL53L1_p_022);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_023",
+		pdata->VL53L1_p_023);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_024",
+		pdata->VL53L1_p_024);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"number_of_ambient_bins",
+		pdata->number_of_ambient_bins);
+
+	for (i = 0; i < VL53L1_MAX_BIN_SEQUENCE_LENGTH; i++) {
+		sprintf(ppre_text, "%sbin_seq[%u]", pprefix, i);
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->bin_seq[i]);
+	}
+
+	for (i = 0; i < VL53L1_MAX_BIN_SEQUENCE_LENGTH; i++) {
+		sprintf(ppre_text, "%sbin_rep[%u]", pprefix, i);
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->bin_rep[i]);
+	}
+
+	for (i = 0; i < pdata->VL53L1_p_024; i++) {
+		sprintf(ppre_text, "%sbin_data[%u]", pprefix, i);
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %d\n",
+			ppre_text,
+			pdata->bin_data[i]);
+	}
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"result__interrupt_status",
+		pdata->result__interrupt_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"result__range_status",
+		pdata->result__range_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"result__report_status",
+		pdata->result__report_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"result__stream_count",
+		pdata->result__stream_count);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__dss_actual_effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__dss_actual_effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->phasecal_result__reference_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"phasecal_result__reference_phase",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_result__vcsel_start",
+		pdata->phasecal_result__vcsel_start);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_config__vcsel_start",
+		pdata->cal_config__vcsel_start);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(uint32_t)pdata->vcsel_width,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"vcsel_width",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_009",
+		pdata->VL53L1_p_009);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_019,
+		12,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_019",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"total_periods_elapsed",
+		pdata->total_periods_elapsed);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"peak_duration_us",
+		pdata->peak_duration_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"woi_duration_us",
+		pdata->woi_duration_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"min_bin_value",
+		pdata->min_bin_value);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_bin_value",
+		pdata->max_bin_value);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->zero_distance_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"zero_distance_phase",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"number_of_ambient_samples",
+		pdata->number_of_ambient_samples);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"ambient_events_sum",
+		pdata->ambient_events_sum);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"VL53L1_p_004",
+		pdata->VL53L1_p_004);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = 0x%02X\n",
+		pprefix,
+		"roi_config__user_roi_centre_spad",
+		pdata->roi_config__user_roi_centre_spad);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = 0x%02X\n",
+		pprefix,
+		"roi_config__user_roi_requested_global_xy_size",
+		pdata->roi_config__user_roi_requested_global_xy_size);
+}
+
+
+void VL53L1_print_xtalk_histogram_shape_data(
+	VL53L1_xtalk_histogram_shape_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t  i             = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_022",
+		pdata->VL53L1_p_022);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_023",
+		pdata->VL53L1_p_023);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_024",
+		pdata->VL53L1_p_024);
+
+	for (i = 0; i < pdata->VL53L1_p_024; i++) {
+
+		sprintf(ppre_text, "%sbin_data[%u]", pprefix, i);
+
+		VL53L1_signed_fixed_point_sprintf(
+				(int32_t)pdata->bin_data[i],
+				10,
+				VL53L1_MAX_STRING_LENGTH,
+				fp_text);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %s\n",
+			ppre_text,
+			fp_text);
+	}
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->phasecal_result__reference_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"phasecal_result__reference_phase",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_result__vcsel_start",
+		pdata->phasecal_result__vcsel_start);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_config__vcsel_start",
+		pdata->cal_config__vcsel_start);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->vcsel_width,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"vcsel_width",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_019,
+		12,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_019",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->zero_distance_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"zero_distance_phase",
+		fp_text);
+}
+
+
+void VL53L1_print_xtalk_histogram_data(
+	VL53L1_xtalk_histogram_data_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+
+
+	sprintf(ppre_text, "%sxtalk_shape.", pprefix);
+	VL53L1_print_xtalk_histogram_shape_data(
+		&(pdata->xtalk_shape),
+		ppre_text, trace_flags);
+
+
+
+	sprintf(ppre_text, "%sxtalk_hist_removed.", pprefix);
+	VL53L1_print_histogram_bin_data(
+		&(pdata->xtalk_hist_removed),
+		ppre_text, trace_flags);
+}
+
+
+void VL53L1_print_range_data(
+	VL53L1_range_data_t *pdata,
+	char                *pprefix,
+	uint32_t             trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_id",
+		pdata->range_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"time_stamp",
+		pdata->time_stamp);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_015",
+		pdata->VL53L1_p_015);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_022",
+		pdata->VL53L1_p_022);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_025",
+		pdata->VL53L1_p_025);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_026",
+		pdata->VL53L1_p_026);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_016",
+		pdata->VL53L1_p_016);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_027",
+		pdata->VL53L1_p_027);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->width,
+		 4,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"width",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_030",
+		pdata->VL53L1_p_030);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->fast_osc_frequency,
+		12,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"fast_osc_frequency",
+		fp_text);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->zero_distance_phase,
+		11, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"zero_distance_phase",
+		fp_text);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_006,
+		8, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"actual_effective_spad",
+		fp_text);
+
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"total_periods_elapsed",
+		pdata->total_periods_elapsed);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"peak_duration_us",
+		pdata->peak_duration_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"woi_duration_us",
+		pdata->woi_duration_us);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+			"VL53L1_p_020",
+			pdata->VL53L1_p_020);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+			"VL53L1_p_021",
+			pdata->VL53L1_p_021);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+			"VL53L1_p_013",
+			pdata->VL53L1_p_013);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->peak_signal_count_rate_mcps,
+		7, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"peak_signal_count_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->avg_signal_count_rate_mcps,
+		7, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"avg_signal_count_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ambient_count_rate_mcps,
+		7, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ambient_count_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->total_rate_per_spad_mcps,
+		13, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"total_rate_per_spad_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_012,
+		11, VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_012",
+		fp_text);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_005,
+		 2,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_005",
+		fp_text);
+
+
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_028,
+		11,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_028",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_014,
+		11,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_014",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_029,
+		11,	VL53L1_MAX_STRING_LENGTH, fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_029",
+		fp_text);
+
+
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"min_range_mm",
+		pdata->min_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"median_range_mm",
+		pdata->median_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"max_range_mm",
+		pdata->max_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_status",
+		pdata->range_status);
+}
+
+
+void VL53L1_print_range_results(
+	VL53L1_range_results_t *pdata,
+	char                   *pprefix,
+	uint32_t                trace_flags)
+{
+
+
+
+
+
+	char     pre_text[VL53L1_MAX_STRING_LENGTH];
+	char    *ppre_text = &(pre_text[0]);
+
+	uint8_t  i = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cfg_device_state",
+		pdata->cfg_device_state);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"rd_device_state",
+		pdata->rd_device_state);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"zone_id",
+		pdata->zone_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"stream_count",
+		pdata->stream_count);
+
+	for (i = 0; i < VL53L1_MAX_AMBIENT_DMAX_VALUES; i++) {
+		sprintf(
+			ppre_text,
+			"%sambient_dmax_mm[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->VL53L1_p_007[i]);
+	}
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%s = %u\n",
+			pprefix,
+			"device_status",
+			pdata->device_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"wrap_dmax_mm",
+		pdata->wrap_dmax_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_results",
+		pdata->max_results);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"active_results",
+		pdata->active_results);
+
+	for (i = 0; i < pdata->active_results; i++) {
+		sprintf(ppre_text, "%sdata[%u].", pprefix, i);
+		VL53L1_print_range_data(
+			&pdata->VL53L1_p_002[i],
+			ppre_text, trace_flags);
+	}
+
+	sprintf(ppre_text, "%sxmonitor.", pprefix);
+	VL53L1_print_range_data(
+		&pdata->xmonitor,
+		ppre_text, trace_flags);
+}
+
+
+void VL53L1_print_offset_range_results(
+	VL53L1_offset_range_results_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t  i = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_distance_mm",
+		pdata->cal_distance_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->cal_reflectance_pc,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"cal_reflectance_pc",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_status",
+		pdata->cal_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_report",
+		pdata->cal_report);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_results",
+		pdata->max_results);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"active_results",
+		pdata->active_results);
+
+	for (i = 0; i < pdata->active_results; i++) {
+		sprintf(ppre_text, "%sdata[%u].", pprefix, i);
+		VL53L1_print_offset_range_data(
+			&(pdata->VL53L1_p_002[i]),
+			ppre_text, trace_flags);
+	}
+}
+
+
+void VL53L1_print_offset_range_data(
+	VL53L1_offset_range_data_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"preset_mode",
+		pdata->preset_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"dss_config__roi_mode_control",
+		pdata->dss_config__roi_mode_control);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->dss_config__manual_effective_spads_select,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"dss_config__manual_effective_spads_select",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"no_of_samples",
+		pdata->no_of_samples);
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->peak_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"peak_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_005,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_005",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"median_range_mm",
+		pdata->median_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"range_mm_offset",
+		pdata->range_mm_offset);
+}
+
+
+void VL53L1_print_cal_peak_rate_map(
+	VL53L1_cal_peak_rate_map_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t   i = 0;
+	uint8_t   x = 0;
+	uint8_t   y = 0;
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->cal_distance_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"cal_distance_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->cal_reflectance_pc,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"cal_reflectance_pc",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_samples",
+		pdata->max_samples);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"width",
+		pdata->width);
+
+	trace_print(
+	VL53L1_TRACE_LEVEL_INFO,
+	"%s%s = %u\n",
+	pprefix,
+	"height",
+	pdata->height);
+
+	i = 0;
+	for (y = 0; y < pdata->height; y++) {
+		for (x = 0; x < pdata->width; x++) {
+
+			sprintf(ppre_text, "%speak_rate_mcps[%u]", pprefix, i);
+
+			VL53L1_signed_fixed_point_sprintf(
+				(int32_t)pdata->peak_rate_mcps[i],
+				7,
+				VL53L1_MAX_STRING_LENGTH,
+				fp_text);
+
+			trace_print(
+				VL53L1_TRACE_LEVEL_INFO,
+				"%s = %s\n",
+				ppre_text,
+				fp_text);
+
+			i++;
+		}
+	}
+}
+
+void VL53L1_print_additional_data(
+	VL53L1_additional_data_t *pdata,
+	char                     *pprefix,
+	uint32_t                 trace_flags)
+{
+
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"preset_mode",
+		pdata->preset_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"zone_preset",
+		pdata->zone_preset);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"measurement_mode",
+		pdata->measurement_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"offset_calibration_mode",
+		pdata->offset_calibration_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"offset_correction_mode",
+		pdata->offset_correction_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"dmax_mode",
+		pdata->dmax_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_config_timeout_us",
+		pdata->phasecal_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"mm_config_timeout_us",
+		pdata->mm_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_config_timeout_us",
+		pdata->range_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"inter_measurement_period_ms",
+		pdata->inter_measurement_period_ms);
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->dss_config__target_total_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"dss_config__target_total_rate_mcps",
+		fp_text);
+
+	sprintf(ppre_text, "%s VL53L1_p_010.", pprefix);
+		VL53L1_print_histogram_bin_data(
+			&pdata->VL53L1_p_010,
+			ppre_text, trace_flags);
+
+
+}
+
+
+void VL53L1_print_additional_offset_cal_data(
+	VL53L1_additional_offset_cal_data_t *pdata,
+	char                                *pprefix,
+	uint32_t                             trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__mm_inner_actual_effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__mm_inner_actual_effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__mm_outer_actual_effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__mm_outer_actual_effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__mm_inner_peak_signal_count_rtn_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__mm_inner_peak_signal_count_rtn_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__mm_outer_peak_signal_count_rtn_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__mm_outer_peak_signal_count_rtn_mcps",
+		fp_text);
+}
+
+
+void VL53L1_print_gain_calibration_data(
+	VL53L1_gain_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->standard_ranging_gain_factor,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"standard_ranging_gain_factor",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->histogram_ranging_gain_factor,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"histogram_ranging_gain_factor",
+		fp_text);
+}
+
+
+void VL53L1_print_zone_calibration_data(
+	VL53L1_zone_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"no_of_samples",
+		pdata->no_of_samples);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->peak_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"peak_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_014,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_014",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->VL53L1_p_005,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"VL53L1_p_005",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->median_range_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"median_range_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->range_mm_offset,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"range_mm_offset",
+		fp_text);
+}
+
+
+void VL53L1_print_zone_calibration_results(
+	VL53L1_zone_calibration_results_t *pdata,
+	char                              *pprefix,
+	uint32_t                           trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t  i = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"preset_mode",
+		pdata->preset_mode);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"zone_preset",
+		pdata->zone_preset);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_distance_mm",
+		pdata->cal_distance_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->cal_reflectance_pc,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"cal_reflectance_pc",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->phasecal_result__reference_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"phasecal_result__reference_phase",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->zero_distance_phase,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"zero_distance_phase",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_status",
+		pdata->cal_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_zones",
+		pdata->max_zones);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"active_zones",
+		pdata->active_zones);
+
+	for (i = 0; i < pdata->active_zones; i++) {
+		sprintf(ppre_text, "%sdata[%u].", pprefix, i);
+		VL53L1_print_zone_calibration_data(
+			&(pdata->VL53L1_p_002[i]),
+			ppre_text, trace_flags);
+	}
+}
+
+void VL53L1_print_xtalk_range_results(
+	VL53L1_xtalk_range_results_t *pdata,
+	char                         *pprefix,
+	uint32_t                      trace_flags)
+{
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+	uint8_t  i = 0;
+
+	VL53L1_histogram_bin_data_t *pbin_data;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"cal_status",
+		pdata->cal_status);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%s = %u\n",
+			pprefix,
+			"num_of_samples_status",
+			pdata->num_of_samples_status);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%s = %u\n",
+			pprefix,
+			"zero_samples_status",
+			pdata->zero_samples_status);
+
+	trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%s = %u\n",
+			pprefix,
+			"max_sigma_status",
+			pdata->max_sigma_status);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_results",
+		pdata->max_results);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"active_results",
+		pdata->active_results);
+
+	for (i = 0; i < pdata->active_results; i++) {
+		sprintf(ppre_text, "%sdata[%u].", pprefix, i);
+		VL53L1_print_xtalk_range_data(
+			&(pdata->VL53L1_p_002[i]),
+			ppre_text, trace_flags);
+	}
+
+	sprintf(ppre_text, "%scentral_histogram_sum.", pprefix);
+	VL53L1_print_histogram_bin_data(
+		&pdata->central_histogram_sum,
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%scentral_histogram_avg.", pprefix);
+	VL53L1_print_histogram_bin_data(
+		&pdata->central_histogram_avg,
+		ppre_text, trace_flags);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_015",
+		pdata->central_histogram__window_start);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"VL53L1_p_016",
+		pdata->central_histogram__window_end);
+
+	pbin_data = &(pdata->histogram_avg_1[0]);
+
+	for (i = 0; i < 5; i++) {
+		sprintf(ppre_text, "%shistogram_avg_1[%u].", pprefix, i);
+		VL53L1_print_histogram_bin_data(
+			pbin_data,
+			ppre_text, trace_flags);
+			pbin_data++;
+	}
+
+	pbin_data = &(pdata->histogram_avg_2[0]);
+
+	for (i = 0; i < 5; i++) {
+		sprintf(ppre_text, "%shistogram_avg_2[%u].", pprefix, i);
+		VL53L1_print_histogram_bin_data(
+			pbin_data,
+			ppre_text, trace_flags);
+			pbin_data++;
+	}
+
+	pbin_data = &(pdata->xtalk_avg[0]);
+
+	for (i = 0; i < 5; i++) {
+		sprintf(ppre_text, "%sxtalk_avg[%u].", pprefix, i);
+		VL53L1_print_histogram_bin_data(
+			pbin_data,
+			ppre_text, trace_flags);
+			pbin_data++;
+	}
+}
+
+
+void VL53L1_print_xtalk_range_data(
+	VL53L1_xtalk_range_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"no_of_samples",
+		pdata->no_of_samples);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"signal_total_events_sum",
+		pdata->signal_total_events_sum);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"signal_total_events_avg",
+		pdata->signal_total_events_avg);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->rate_per_spad_kcps_sum,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"rate_per_spad_kcps_sum",
+		fp_text);
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->rate_per_spad_kcps_avg,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"rate_per_spad_kcps_avg",
+		fp_text);
+}
+
+
+void VL53L1_print_xtalk_calibration_results(
+	VL53L1_xtalk_calibration_results_t *pdata,
+	char                               *pprefix,
+	uint32_t                            trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	int16_t tmpi16;
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_compensation_plane_offset_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_plane_offset_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_x_plane_gradient_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_y_plane_gradient_kcps",
+		fp_text);
+}
+
+
+void VL53L1_print_xtalk_config(
+	VL53L1_xtalk_config_t *pdata,
+	char                  *pprefix,
+	uint32_t               trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	int16_t tmpi16;
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_compensation_plane_offset_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_plane_offset_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_x_plane_gradient_kcps",
+		fp_text);
+
+	tmpi16 = pdata->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)tmpi16,
+		11,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_compensation_y_plane_gradient_kcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"global_crosstalk_compensation_enable",
+		pdata->global_crosstalk_compensation_enable);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->histogram_mode_crosstalk_margin_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"histogram_mode_crosstalk_margin_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->lite_mode_crosstalk_margin_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"lite_mode_crosstalk_margin_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->crosstalk_range_ignore_threshold_mult,
+		5,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"crosstalk_range_ignore_threshold_mult",
+		fp_text);
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->crosstalk_range_ignore_threshold_rate_mcps,
+		13,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"crosstalk_range_ignore_threshold_rate_mcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"algo__crosstalk_detect_max_valid_range_mm",
+		pdata->algo__crosstalk_detect_max_valid_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"algo__crosstalk_detect_min_valid_range_mm",
+		pdata->algo__crosstalk_detect_min_valid_range_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_detect_max_valid_rate_kcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_detect_max_valid_rate_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_detect_max_sigma_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_detect_max_sigma_mm",
+		fp_text);
+
+}
+
+
+void VL53L1_print_xtalk_extract_config(
+	VL53L1_xtalkextract_config_t *pdata,
+	char                         *pprefix,
+	uint32_t                      trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->dss_config__target_total_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"dss_config__target_total_rate_mcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"mm_config_timeout_us",
+		pdata->mm_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_config_timeout_us",
+		pdata->range_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"num_of_samples",
+		pdata->num_of_samples);
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"algo__crosstalk_extract_max_valid_range_mm",
+		pdata->algo__crosstalk_extract_max_valid_range_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"algo__crosstalk_extract_min_valid_range_mm",
+		pdata->algo__crosstalk_extract_min_valid_range_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_extract_max_valid_rate_kcps,
+		9,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_extract_max_valid_rate_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->algo__crosstalk_extract_max_sigma_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"algo__crosstalk_extract_max_sigma_mm",
+		fp_text);
+
+}
+
+
+void VL53L1_print_zone_cal_config(
+	VL53L1_zonecal_config_t *pdata,
+	char                    *pprefix,
+	uint32_t                 trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->dss_config__target_total_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"dss_config__target_total_rate_mcps",
+		fp_text);
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"mm_config_timeout_us",
+		pdata->mm_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_config_timeout_us",
+		pdata->range_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_config_timeout_us",
+		pdata->phasecal_config_timeout_us);
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_num_of_samples",
+		pdata->phasecal_num_of_samples);
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"zone_num_of_samples",
+		pdata->zone_num_of_samples);
+
+}
+
+void VL53L1_print_offset_cal_config(
+	VL53L1_offsetcal_config_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->dss_config__target_total_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"dss_config__target_total_rate_mcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"phasecal_config_timeout_us",
+		pdata->phasecal_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"range_config_timeout_us",
+		pdata->range_config_timeout_us);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"pre_num_of_samples",
+		pdata->pre_num_of_samples);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"mm1_num_of_samples",
+		pdata->mm1_num_of_samples);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"mm2_num_of_samples",
+		pdata->mm2_num_of_samples);
+
+
+}
+
+
+void VL53L1_print_dmax_calibration_data(
+	VL53L1_dmax_calibration_data_t *pdata,
+	char                           *pprefix,
+	uint32_t                        trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ref__actual_effective_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ref__actual_effective_spads",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ref__peak_signal_count_rate_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ref__peak_signal_count_rate_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ref__distance_mm,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ref__distance_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->ref_reflectance_pc,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"ref_reflectance_pc",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->coverglass_transmission,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"coverglass_transmission",
+		fp_text);
+}
+
+
+void VL53L1_print_calibration_data(
+	VL53L1_calibration_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags)
+{
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = 0x%08X\n",
+		pprefix,
+		"struct_version",
+		pdata->struct_version);
+
+	sprintf(ppre_text, "%scustomer.", pprefix);
+	VL53L1_print_customer_nvm_managed(
+		&(pdata->customer),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sfmt_dmax_cal.", pprefix);
+	VL53L1_print_dmax_calibration_data(
+		&(pdata->fmt_dmax_cal),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%scust_dmax_cal.", pprefix);
+	VL53L1_print_dmax_calibration_data(
+		&(pdata->cust_dmax_cal),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sadd_off_cal_data.", pprefix);
+	VL53L1_print_additional_offset_cal_data(
+		&(pdata->add_off_cal_data),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%soptical_centre.", pprefix);
+	VL53L1_print_optical_centre(
+		&(pdata->optical_centre),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sxtalkhisto.", pprefix);
+	VL53L1_print_xtalk_histogram_data(
+		&(pdata->xtalkhisto),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sgain_cal.", pprefix);
+	VL53L1_print_gain_calibration_data(
+		&(pdata->gain_cal),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%scal_peak_rate_map.", pprefix);
+	VL53L1_print_cal_peak_rate_map(
+		&(pdata->cal_peak_rate_map),
+		ppre_text, trace_flags);
+}
+
+
+void VL53L1_print_xtalk_debug_data(
+	VL53L1_xtalk_debug_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags)
+{
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	sprintf(ppre_text, "%scustomer.", pprefix);
+	VL53L1_print_customer_nvm_managed(
+		&(pdata->customer),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sxtalk_cfg.", pprefix);
+	VL53L1_print_xtalk_config(
+		&(pdata->xtalk_cfg),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sxtalk_extract_cfg.", pprefix);
+	VL53L1_print_xtalk_extract_config(
+		&(pdata->xtalk_extract_cfg),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%shist_data.", pprefix);
+	VL53L1_print_histogram_bin_data(
+		&(pdata->hist_data),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sxtalk_shapes.", pprefix);
+	VL53L1_print_xtalk_histogram_data(
+		&(pdata->xtalk_shapes),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sgain_cal.", pprefix);
+	VL53L1_print_xtalk_range_results(
+		&(pdata->xtalk_results),
+		ppre_text, trace_flags);
+}
+
+
+void VL53L1_print_offset_debug_data(
+	VL53L1_offset_debug_data_t *pdata,
+	char                       *pprefix,
+	uint32_t                    trace_flags)
+{
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	sprintf(ppre_text, "%scustomer.", pprefix);
+	VL53L1_print_customer_nvm_managed(
+		&(pdata->customer),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sfmt_dmax_cal.", pprefix);
+	VL53L1_print_dmax_calibration_data(
+		&(pdata->fmt_dmax_cal),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%scust_dmax_cal.", pprefix);
+	VL53L1_print_dmax_calibration_data(
+		&(pdata->cust_dmax_cal),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%sadd_off_cal_data.", pprefix);
+	VL53L1_print_additional_offset_cal_data(
+		&(pdata->add_off_cal_data),
+		ppre_text, trace_flags);
+
+	sprintf(ppre_text, "%soffset_results.", pprefix);
+	VL53L1_print_offset_range_results(
+		&(pdata->offset_results),
+		ppre_text, trace_flags);
+}
+
+
+void VL53L1_print_zone_config(
+	VL53L1_zone_config_t *pdata,
+	char                 *pprefix,
+	uint32_t              trace_flags)
+{
+
+
+
+
+
+
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t  i = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"max_zones",
+		pdata->max_zones);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"active_zones",
+		pdata->active_zones);
+
+	for (i = 0; i < pdata->active_zones; i++) {
+		sprintf(ppre_text, "%suser_zones[%u].", pprefix, i);
+		VL53L1_print_user_zone(
+			&pdata->user_zones[i],
+			ppre_text,
+			trace_flags);
+	}
+}
+
+
+void VL53L1_print_optical_centre(
+	VL53L1_optical_centre_t  *pdata,
+	char                     *pprefix,
+	uint32_t                  trace_flags)
+{
+
+
+
+
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->x_centre,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"x_centre",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->y_centre,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"y_centre",
+		fp_text);
+}
+
+
+void VL53L1_print_user_zone(
+	VL53L1_user_zone_t   *pdata,
+	char                 *pprefix,
+	uint32_t              trace_flags)
+{
+
+
+
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"x_centre",
+		pdata->x_centre);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"y_centre",
+		pdata->y_centre);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"width",
+		pdata->width);
+
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"height",
+		pdata->height);
+}
+
+
+void VL53L1_print_spad_rate_data(
+	VL53L1_spad_rate_data_t  *pspad_rates,
+	char                     *pprefix,
+	uint32_t                  trace_flags)
+{
+
+
+
+
+
+
+	uint16_t spad_no = 0;
+	uint8_t  row     = 0;
+	uint8_t  col     = 0;
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%8s,%4s,%4s, %s\n",
+		pprefix,
+		"spad_no",
+		"row",
+		"col",
+		"peak_rate_mcps");
+
+	for (spad_no = 0; spad_no < pspad_rates->no_of_values; spad_no++) {
+
+
+
+		VL53L1_decode_row_col(
+			(uint8_t)spad_no,
+			&row,
+			&col);
+
+
+
+
+		VL53L1_signed_fixed_point_sprintf(
+			(int32_t)pspad_rates->rate_data[spad_no],
+			pspad_rates->fractional_bits,
+			VL53L1_MAX_STRING_LENGTH,
+			fp_text);
+
+
+
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%8u,%4u,%4u, %s\n",
+			pprefix,
+			spad_no,
+			row,
+			col,
+			fp_text);
+	}
+}
+
+
+void VL53L1_print_spad_rate_map(
+	VL53L1_spad_rate_data_t  *pspad_rates,
+	char                     *pprefix,
+	uint32_t                  trace_flags)
+{
+
+
+
+
+
+
+	uint8_t  spad_no = 0;
+	uint8_t  row     = 0;
+	uint8_t  col     = 0;
+
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%4s",
+		pprefix,
+		" ");
+
+	for (col = 0;  col < VL53L1_SPAD_ARRAY_WIDTH; col++)
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			",%8u",
+			col);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"\n");
+
+
+
+
+	for (row = 0;  row < VL53L1_SPAD_ARRAY_HEIGHT; row++) {
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s%4u",
+			pprefix,
+			row);
+
+		for (col = 0;  col < VL53L1_SPAD_ARRAY_HEIGHT; col++) {
+
+
+
+
+			VL53L1_encode_row_col(
+				row,
+				col,
+				&spad_no);
+
+
+
+
+			VL53L1_signed_fixed_point_sprintf(
+				(int32_t)pspad_rates->rate_data[spad_no],
+				pspad_rates->fractional_bits,
+				VL53L1_MAX_STRING_LENGTH,
+				fp_text);
+
+
+
+
+			trace_print(
+				VL53L1_TRACE_LEVEL_INFO,
+				",%8s",
+				fp_text);
+		}
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"\n");
+	}
+}
+
+
+#endif
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api_preset_modes.c b/drivers/input/misc/vl53L1/src/vl53l1_api_preset_modes.c
new file mode 100644
index 0000000000000000000000000000000000000000..e00f48830d2d5327a39ca2e5039c7771eeead201
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api_preset_modes.c
@@ -0,0 +1,4927 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_register_structs.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_zone_presets.h"
+#include "vl53l1_core.h"
+#include "vl53l1_api_preset_modes.h"
+#include "vl53l1_tuning_parm_defaults.h"
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_API, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_API, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_API,\
+	status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_init_refspadchar_config_struct(
+	VL53L1_refspadchar_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+
+
+
+	pdata->device_test_mode =
+		VL53L1_TUNINGPARM_REFSPADCHAR_DEVICE_TEST_MODE_DEFAULT;
+	pdata->VL53L1_p_009              =
+		VL53L1_TUNINGPARM_REFSPADCHAR_VCSEL_PERIOD_DEFAULT;
+	pdata->timeout_us                =
+		VL53L1_TUNINGPARM_REFSPADCHAR_PHASECAL_TIMEOUT_US_DEFAULT;
+	pdata->target_count_rate_mcps    =
+		VL53L1_TUNINGPARM_REFSPADCHAR_TARGET_COUNT_RATE_MCPS_DEFAULT;
+	pdata->min_count_rate_limit_mcps =
+		VL53L1_TUNINGPARM_REFSPADCHAR_MIN_COUNTRATE_LIMIT_MCPS_DEFAULT;
+	pdata->max_count_rate_limit_mcps =
+		VL53L1_TUNINGPARM_REFSPADCHAR_MAX_COUNTRATE_LIMIT_MCPS_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_ssc_config_struct(
+	VL53L1_ssc_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	pdata->array_select = VL53L1_DEVICESSCARRAY_RTN;
+
+
+
+	pdata->VL53L1_p_009 =
+			VL53L1_TUNINGPARM_SPADMAP_VCSEL_PERIOD_DEFAULT;
+
+
+
+	pdata->vcsel_start  =
+			VL53L1_TUNINGPARM_SPADMAP_VCSEL_START_DEFAULT;
+
+
+
+	pdata->vcsel_width = 0x02;
+
+
+
+	pdata->timeout_us   = 36000;
+
+
+
+
+
+
+	pdata->rate_limit_mcps =
+			VL53L1_TUNINGPARM_SPADMAP_RATE_LIMIT_MCPS_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_xtalk_config_struct(
+	VL53L1_customer_nvm_managed_t *pnvm,
+	VL53L1_xtalk_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	pdata->algo__crosstalk_compensation_plane_offset_kcps      =
+		pnvm->algo__crosstalk_compensation_plane_offset_kcps;
+	pdata->algo__crosstalk_compensation_x_plane_gradient_kcps  =
+		pnvm->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pdata->algo__crosstalk_compensation_y_plane_gradient_kcps  =
+		pnvm->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+
+	pdata->nvm_default__crosstalk_compensation_plane_offset_kcps      =
+		(uint32_t)pnvm->algo__crosstalk_compensation_plane_offset_kcps;
+	pdata->nvm_default__crosstalk_compensation_x_plane_gradient_kcps  =
+		pnvm->algo__crosstalk_compensation_x_plane_gradient_kcps;
+	pdata->nvm_default__crosstalk_compensation_y_plane_gradient_kcps  =
+		pnvm->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+	pdata->histogram_mode_crosstalk_margin_kcps                =
+			VL53L1_TUNINGPARM_HIST_XTALK_MARGIN_KCPS_DEFAULT;
+	pdata->lite_mode_crosstalk_margin_kcps                     =
+			VL53L1_TUNINGPARM_LITE_XTALK_MARGIN_KCPS_DEFAULT;
+
+
+
+
+	pdata->crosstalk_range_ignore_threshold_mult =
+			VL53L1_TUNINGPARM_LITE_RIT_MULT_DEFAULT;
+
+	if ((pdata->algo__crosstalk_compensation_plane_offset_kcps == 0x00)
+		&& (pdata->algo__crosstalk_compensation_x_plane_gradient_kcps
+				== 0x00)
+		&& (pdata->algo__crosstalk_compensation_y_plane_gradient_kcps
+				== 0x00))
+		pdata->global_crosstalk_compensation_enable = 0x00;
+	else
+		pdata->global_crosstalk_compensation_enable = 0x01;
+
+
+	if ((status == VL53L1_ERROR_NONE) &&
+		(pdata->global_crosstalk_compensation_enable == 0x01)) {
+		pdata->crosstalk_range_ignore_threshold_rate_mcps =
+		VL53L1_calc_range_ignore_threshold(
+		pdata->algo__crosstalk_compensation_plane_offset_kcps,
+		pdata->algo__crosstalk_compensation_x_plane_gradient_kcps,
+		pdata->algo__crosstalk_compensation_y_plane_gradient_kcps,
+		pdata->crosstalk_range_ignore_threshold_mult);
+	} else {
+		pdata->crosstalk_range_ignore_threshold_rate_mcps = 0;
+	}
+
+
+
+
+
+
+
+	pdata->algo__crosstalk_detect_min_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM_DEFAULT;
+	pdata->algo__crosstalk_detect_max_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM_DEFAULT;
+	pdata->algo__crosstalk_detect_max_valid_rate_kcps =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS_DEFAULT;
+	pdata->algo__crosstalk_detect_max_sigma_mm        =
+			VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_init_xtalk_extract_config_struct(
+	VL53L1_xtalkextract_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdata->dss_config__target_total_rate_mcps          =
+			VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_RATE_MCPS_DEFAULT;
+
+
+	pdata->mm_config_timeout_us                        =
+			VL53L1_TUNINGPARM_XTALK_EXTRACT_DSS_TIMEOUT_US_DEFAULT;
+
+
+	pdata->num_of_samples                              =
+			VL53L1_TUNINGPARM_XTALK_EXTRACT_NUM_OF_SAMPLES_DEFAULT;
+
+	pdata->phasecal_config_timeout_us                  =
+		VL53L1_TUNINGPARM_XTALK_EXTRACT_PHASECAL_TIMEOUT_US_DEFAULT;
+
+
+	pdata->range_config_timeout_us                     =
+			VL53L1_TUNINGPARM_XTALK_EXTRACT_BIN_TIMEOUT_US_DEFAULT;
+
+
+
+
+
+
+	pdata->algo__crosstalk_extract_min_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_EXTRACT_MIN_FILTER_THRESH_MM_DEFAULT;
+	pdata->algo__crosstalk_extract_max_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_FILTER_THRESH_MM_DEFAULT;
+	pdata->algo__crosstalk_extract_max_valid_rate_kcps =
+		VL53L1_TUNINGPARM_XTALK_EXTRACT_MAX_VALID_RATE_KCPS_DEFAULT;
+	pdata->algo__crosstalk_extract_max_sigma_mm        =
+		VL53L1_TUNINGPARM_XTALK_EXTRACT_SIGMA_THRESHOLD_MM_DEFAULT;
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_offset_cal_config_struct(
+	VL53L1_offsetcal_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdata->dss_config__target_total_rate_mcps          =
+			VL53L1_TUNINGPARM_OFFSET_CAL_DSS_RATE_MCPS_DEFAULT;
+
+
+	pdata->phasecal_config_timeout_us                  =
+		VL53L1_TUNINGPARM_OFFSET_CAL_PHASECAL_TIMEOUT_US_DEFAULT;
+
+
+	pdata->range_config_timeout_us                     =
+			VL53L1_TUNINGPARM_OFFSET_CAL_RANGE_TIMEOUT_US_DEFAULT;
+
+
+	pdata->mm_config_timeout_us                        =
+			VL53L1_TUNINGPARM_OFFSET_CAL_MM_TIMEOUT_US_DEFAULT;
+
+
+
+
+
+
+	pdata->pre_num_of_samples                          =
+			VL53L1_TUNINGPARM_OFFSET_CAL_PRE_SAMPLES_DEFAULT;
+	pdata->mm1_num_of_samples                          =
+			VL53L1_TUNINGPARM_OFFSET_CAL_MM1_SAMPLES_DEFAULT;
+	pdata->mm2_num_of_samples                          =
+			VL53L1_TUNINGPARM_OFFSET_CAL_MM2_SAMPLES_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_init_zone_cal_config_struct(
+	VL53L1_zonecal_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdata->dss_config__target_total_rate_mcps          =
+			VL53L1_TUNINGPARM_ZONE_CAL_DSS_RATE_MCPS_DEFAULT;
+
+
+	pdata->phasecal_config_timeout_us                  =
+			VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_TIMEOUT_US_DEFAULT;
+
+
+	pdata->range_config_timeout_us                     =
+			VL53L1_TUNINGPARM_ZONE_CAL_RANGE_TIMEOUT_US_DEFAULT;
+
+
+	pdata->mm_config_timeout_us                        =
+			VL53L1_TUNINGPARM_ZONE_CAL_DSS_TIMEOUT_US_DEFAULT;
+
+
+
+
+
+
+	pdata->phasecal_num_of_samples                     =
+			VL53L1_TUNINGPARM_ZONE_CAL_PHASECAL_NUM_SAMPLES_DEFAULT;
+	pdata->zone_num_of_samples                         =
+			VL53L1_TUNINGPARM_ZONE_CAL_ZONE_NUM_SAMPLES_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_hist_post_process_config_struct(
+	uint8_t                             xtalk_compensation_enable,
+	VL53L1_hist_post_process_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pdata->hist_algo_select =
+			VL53L1_TUNINGPARM_HIST_ALGO_SELECT_DEFAULT;
+
+
+
+
+	pdata->hist_target_order =
+			VL53L1_TUNINGPARM_HIST_TARGET_ORDER_DEFAULT;
+
+
+
+
+	pdata->filter_woi0                   =
+			VL53L1_TUNINGPARM_HIST_FILTER_WOI_0_DEFAULT;
+
+	pdata->filter_woi1                   =
+			VL53L1_TUNINGPARM_HIST_FILTER_WOI_1_DEFAULT;
+
+
+
+
+	pdata->hist_amb_est_method =
+			VL53L1_TUNINGPARM_HIST_AMB_EST_METHOD_DEFAULT;
+
+	pdata->ambient_thresh_sigma0         =
+			VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_0_DEFAULT;
+
+	pdata->ambient_thresh_sigma1         =
+			VL53L1_TUNINGPARM_HIST_AMB_THRESH_SIGMA_1_DEFAULT;
+
+
+
+
+	pdata->ambient_thresh_events_scaler     =
+			VL53L1_TUNINGPARM_HIST_AMB_EVENTS_SCALER_DEFAULT;
+
+
+
+	pdata->min_ambient_thresh_events     =
+			VL53L1_TUNINGPARM_HIST_MIN_AMB_THRESH_EVENTS_DEFAULT;
+
+
+	pdata->noise_threshold               =
+			VL53L1_TUNINGPARM_HIST_NOISE_THRESHOLD_DEFAULT;
+
+
+	pdata->signal_total_events_limit     =
+		VL53L1_TUNINGPARM_HIST_SIGNAL_TOTAL_EVENTS_LIMIT_DEFAULT;
+
+	pdata->sigma_estimator__sigma_ref_mm =
+		VL53L1_TUNINGPARM_HIST_SIGMA_EST_REF_MM_DEFAULT;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	pdata->sigma_thresh                  =
+			VL53L1_TUNINGPARM_HIST_SIGMA_THRESH_MM_DEFAULT;
+
+	pdata->range_offset_mm            =      0;
+
+
+	pdata->gain_factor                =
+			VL53L1_TUNINGPARM_HIST_GAIN_FACTOR_DEFAULT;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	pdata->valid_phase_low = 0x08;
+	pdata->valid_phase_high = 0x88;
+
+
+
+
+
+
+
+
+
+	pdata->algo__consistency_check__phase_tolerance =
+		VL53L1_TUNINGPARM_CONSISTENCY_HIST_PHASE_TOLERANCE_DEFAULT;
+
+
+
+
+
+
+
+
+
+	pdata->algo__consistency_check__event_sigma =
+		VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_DEFAULT;
+
+
+
+	pdata->algo__consistency_check__event_min_spad_count =
+	VL53L1_TUNINGPARM_CONSISTENCY_HIST_EVENT_SIGMA_MIN_SPAD_LIMIT_DEFAULT;
+
+
+
+
+
+	pdata->algo__consistency_check__min_max_tolerance =
+		VL53L1_TUNINGPARM_CONSISTENCY_HIST_MIN_MAX_TOLERANCE_MM_DEFAULT;
+
+
+
+	pdata->algo__crosstalk_compensation_enable = xtalk_compensation_enable;
+
+
+
+
+
+
+
+
+
+
+
+	pdata->algo__crosstalk_detect_min_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MIN_VALID_RANGE_MM_DEFAULT;
+	pdata->algo__crosstalk_detect_max_valid_range_mm  =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RANGE_MM_DEFAULT;
+	pdata->algo__crosstalk_detect_max_valid_rate_kcps =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MAX_VALID_RATE_KCPS_DEFAULT;
+	pdata->algo__crosstalk_detect_max_sigma_mm        =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MAX_SIGMA_MM_DEFAULT;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	pdata->algo__crosstalk_detect_event_sigma       =
+		VL53L1_TUNINGPARM_XTALK_DETECT_EVENT_SIGMA_DEFAULT;
+
+
+
+
+
+	pdata->algo__crosstalk_detect_min_max_tolerance   =
+		VL53L1_TUNINGPARM_XTALK_DETECT_MIN_MAX_TOLERANCE_DEFAULT;
+
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_dmax_calibration_data_struct(
+	VL53L1_dmax_calibration_data_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pdata->ref__actual_effective_spads = 0x5F2D;
+
+
+	pdata->ref__peak_signal_count_rate_mcps = 0x0844;
+
+
+	pdata->ref__distance_mm = 0x08A5;
+
+
+
+
+	pdata->ref_reflectance_pc = 0x0014;
+
+
+
+	pdata->coverglass_transmission = 0x0100;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_tuning_parm_storage_struct(
+	VL53L1_tuning_parm_storage_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	pdata->tp_tuning_parm_version              =
+			VL53L1_TUNINGPARM_VERSION_DEFAULT;
+	pdata->tp_tuning_parm_key_table_version    =
+			VL53L1_TUNINGPARM_KEY_TABLE_VERSION_DEFAULT;
+	pdata->tp_tuning_parm_lld_version          =
+			VL53L1_TUNINGPARM_LLD_VERSION_DEFAULT;
+	pdata->tp_init_phase_rtn_lite_long         =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_LONG_RANGE_DEFAULT;
+	pdata->tp_init_phase_rtn_lite_med          =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_MED_RANGE_DEFAULT;
+	pdata->tp_init_phase_rtn_lite_short        =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_LITE_SHORT_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_lite_long         =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_LONG_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_lite_med          =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_MED_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_lite_short        =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_LITE_SHORT_RANGE_DEFAULT;
+	pdata->tp_init_phase_rtn_hist_long         =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_LONG_RANGE_DEFAULT;
+	pdata->tp_init_phase_rtn_hist_med          =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_MED_RANGE_DEFAULT;
+	pdata->tp_init_phase_rtn_hist_short        =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_RTN_HISTO_SHORT_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_hist_long         =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_LONG_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_hist_med          =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_MED_RANGE_DEFAULT;
+	pdata->tp_init_phase_ref_hist_short        =
+		VL53L1_TUNINGPARM_INITIAL_PHASE_REF_HISTO_SHORT_RANGE_DEFAULT;
+	pdata->tp_consistency_lite_phase_tolerance =
+		VL53L1_TUNINGPARM_CONSISTENCY_LITE_PHASE_TOLERANCE_DEFAULT;
+	pdata->tp_phasecal_target                  =
+			VL53L1_TUNINGPARM_PHASECAL_TARGET_DEFAULT;
+	pdata->tp_cal_repeat_rate                  =
+			VL53L1_TUNINGPARM_LITE_CAL_REPEAT_RATE_DEFAULT;
+	pdata->tp_lite_min_clip                    =
+			VL53L1_TUNINGPARM_LITE_MIN_CLIP_MM_DEFAULT;
+	pdata->tp_lite_long_sigma_thresh_mm        =
+			VL53L1_TUNINGPARM_LITE_LONG_SIGMA_THRESH_MM_DEFAULT;
+	pdata->tp_lite_med_sigma_thresh_mm         =
+			VL53L1_TUNINGPARM_LITE_MED_SIGMA_THRESH_MM_DEFAULT;
+	pdata->tp_lite_short_sigma_thresh_mm       =
+			VL53L1_TUNINGPARM_LITE_SHORT_SIGMA_THRESH_MM_DEFAULT;
+	pdata->tp_lite_long_min_count_rate_rtn_mcps  =
+		VL53L1_TUNINGPARM_LITE_LONG_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
+	pdata->tp_lite_med_min_count_rate_rtn_mcps   =
+		VL53L1_TUNINGPARM_LITE_MED_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
+	pdata->tp_lite_short_min_count_rate_rtn_mcps =
+		VL53L1_TUNINGPARM_LITE_SHORT_MIN_COUNT_RATE_RTN_MCPS_DEFAULT;
+	pdata->tp_lite_sigma_est_pulse_width_ns      =
+			VL53L1_TUNINGPARM_LITE_SIGMA_EST_PULSE_WIDTH_DEFAULT;
+	pdata->tp_lite_sigma_est_amb_width_ns        =
+			VL53L1_TUNINGPARM_LITE_SIGMA_EST_AMB_WIDTH_NS_DEFAULT;
+	pdata->tp_lite_sigma_ref_mm                  =
+			VL53L1_TUNINGPARM_LITE_SIGMA_REF_MM_DEFAULT;
+	pdata->tp_lite_seed_cfg                      =
+			VL53L1_TUNINGPARM_LITE_SEED_CONFIG_DEFAULT;
+	pdata->tp_timed_seed_cfg                     =
+			VL53L1_TUNINGPARM_TIMED_SEED_CONFIG_DEFAULT;
+	pdata->tp_lite_quantifier                    =
+			VL53L1_TUNINGPARM_LITE_QUANTIFIER_DEFAULT;
+	pdata->tp_lite_first_order_select            =
+			VL53L1_TUNINGPARM_LITE_FIRST_ORDER_SELECT_DEFAULT;
+
+
+
+
+
+
+	pdata->tp_dss_target_lite_mcps               =
+	VL53L1_TUNINGPARM_LITE_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
+	pdata->tp_dss_target_histo_mcps              =
+	VL53L1_TUNINGPARM_RANGING_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
+	pdata->tp_dss_target_histo_mz_mcps           =
+	VL53L1_TUNINGPARM_MZ_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
+	pdata->tp_dss_target_timed_mcps              =
+	VL53L1_TUNINGPARM_TIMED_DSS_CONFIG_TARGET_TOTAL_RATE_MCPS_DEFAULT;
+	pdata->tp_phasecal_timeout_lite_us           =
+		VL53L1_TUNINGPARM_LITE_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_hist_long_us      =
+	VL53L1_TUNINGPARM_RANGING_LONG_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_hist_med_us       =
+	VL53L1_TUNINGPARM_RANGING_MED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_hist_short_us     =
+	VL53L1_TUNINGPARM_RANGING_SHORT_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_mz_long_us        =
+	VL53L1_TUNINGPARM_MZ_LONG_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_mz_med_us         =
+		VL53L1_TUNINGPARM_MZ_MED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_mz_short_us       =
+		VL53L1_TUNINGPARM_MZ_SHORT_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_phasecal_timeout_timed_us          =
+		VL53L1_TUNINGPARM_TIMED_PHASECAL_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_mm_timeout_lite_us                 =
+			VL53L1_TUNINGPARM_LITE_MM_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_mm_timeout_histo_us                =
+			VL53L1_TUNINGPARM_RANGING_MM_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_mm_timeout_mz_us                   =
+			VL53L1_TUNINGPARM_MZ_MM_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_mm_timeout_timed_us                =
+			VL53L1_TUNINGPARM_TIMED_MM_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_range_timeout_lite_us              =
+			VL53L1_TUNINGPARM_LITE_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_range_timeout_histo_us             =
+		VL53L1_TUNINGPARM_RANGING_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_range_timeout_mz_us                =
+			VL53L1_TUNINGPARM_MZ_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_range_timeout_timed_us             =
+		VL53L1_TUNINGPARM_TIMED_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
+
+
+
+
+	pdata->tp_mm_timeout_lpa_us =
+		VL53L1_TUNINGPARM_LOWPOWERAUTO_MM_CONFIG_TIMEOUT_US_DEFAULT;
+	pdata->tp_range_timeout_lpa_us =
+		VL53L1_TUNINGPARM_LOWPOWERAUTO_RANGE_CONFIG_TIMEOUT_US_DEFAULT;
+
+	pdata->tp_dss_target_very_short_mcps =
+			VL53L1_TUNINGPARM_VERY_SHORT_DSS_RATE_MCPS_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_hist_gen3_dmax_config_struct(
+	VL53L1_hist_gen3_dmax_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdata->dss_config__target_total_rate_mcps = 0x1400;
+	pdata->dss_config__aperture_attenuation = 0x38;
+
+	pdata->signal_thresh_sigma                 =
+			VL53L1_TUNINGPARM_DMAX_CFG_SIGNAL_THRESH_SIGMA_DEFAULT;
+	pdata->ambient_thresh_sigma = 0x70;
+	pdata->min_ambient_thresh_events           = 16;
+	pdata->signal_total_events_limit           = 100;
+	pdata->max_effective_spads = 0xFFFF;
+
+
+
+
+
+
+
+
+
+
+
+	pdata->target_reflectance_for_dmax_calc[0] =
+			VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_0_DEFAULT;
+	pdata->target_reflectance_for_dmax_calc[1] =
+			VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_1_DEFAULT;
+	pdata->target_reflectance_for_dmax_calc[2] =
+			VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_2_DEFAULT;
+	pdata->target_reflectance_for_dmax_calc[3] =
+			VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_3_DEFAULT;
+	pdata->target_reflectance_for_dmax_calc[4] =
+			VL53L1_TUNINGPARM_DMAX_CFG_REFLECTANCE_ARRAY_4_DEFAULT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pstatic->dss_config__target_total_rate_mcps = 0x0A00;
+	pstatic->debug__ctrl = 0x00;
+	pstatic->test_mode__ctrl = 0x00;
+	pstatic->clk_gating__ctrl = 0x00;
+	pstatic->nvm_bist__ctrl = 0x00;
+	pstatic->nvm_bist__num_nvm_words = 0x00;
+	pstatic->nvm_bist__start_address = 0x00;
+	pstatic->host_if__status = 0x00;
+	pstatic->pad_i2c_hv__config = 0x00;
+	pstatic->pad_i2c_hv__extsup_config = 0x00;
+
+
+
+
+
+
+	pstatic->gpio_hv_pad__ctrl = 0x00;
+
+
+
+
+
+
+
+
+	pstatic->gpio_hv_mux__ctrl  =
+			VL53L1_DEVICEINTERRUPTPOLARITY_ACTIVE_LOW |
+			VL53L1_DEVICEGPIOMODE_OUTPUT_RANGE_AND_ERROR_INTERRUPTS;
+
+	pstatic->gpio__tio_hv_status = 0x02;
+	pstatic->gpio__fio_hv_status = 0x00;
+	pstatic->ana_config__spad_sel_pswidth = 0x02;
+	pstatic->ana_config__vcsel_pulse_width_offset = 0x08;
+	pstatic->ana_config__fast_osc__config_ctrl = 0x00;
+
+	pstatic->sigma_estimator__effective_pulse_width_ns        =
+			ptuning_parms->tp_lite_sigma_est_pulse_width_ns;
+	pstatic->sigma_estimator__effective_ambient_width_ns      =
+			ptuning_parms->tp_lite_sigma_est_amb_width_ns;
+	pstatic->sigma_estimator__sigma_ref_mm                    =
+			ptuning_parms->tp_lite_sigma_ref_mm;
+
+
+	pstatic->algo__crosstalk_compensation_valid_height_mm = 0x01;
+	pstatic->spare_host_config__static_config_spare_0 = 0x00;
+	pstatic->spare_host_config__static_config_spare_1 = 0x00;
+
+	pstatic->algo__range_ignore_threshold_mcps = 0x0000;
+
+
+
+	pstatic->algo__range_ignore_valid_height_mm = 0xff;
+	pstatic->algo__range_min_clip                             =
+			ptuning_parms->tp_lite_min_clip;
+
+
+
+
+
+
+	pstatic->algo__consistency_check__tolerance               =
+			ptuning_parms->tp_consistency_lite_phase_tolerance;
+	pstatic->spare_host_config__static_config_spare_2 = 0x00;
+	pstatic->sd_config__reset_stages_msb = 0x00;
+	pstatic->sd_config__reset_stages_lsb = 0x00;
+
+	pgeneral->gph_config__stream_count_update_value = 0x00;
+	pgeneral->global_config__stream_divider = 0x00;
+	pgeneral->system__interrupt_config_gpio =
+			VL53L1_INTERRUPT_CONFIG_NEW_SAMPLE_READY;
+	pgeneral->cal_config__vcsel_start = 0x0B;
+
+
+
+
+
+
+
+
+	pgeneral->cal_config__repeat_rate                         =
+			ptuning_parms->tp_cal_repeat_rate;
+	pgeneral->global_config__vcsel_width = 0x02;
+
+
+	pgeneral->phasecal_config__timeout_macrop = 0x0D;
+
+
+	pgeneral->phasecal_config__target                         =
+			ptuning_parms->tp_phasecal_target;
+	pgeneral->phasecal_config__override = 0x00;
+	pgeneral->dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__TARGET_RATE;
+
+
+	pgeneral->system__thresh_rate_high = 0x0000;
+	pgeneral->system__thresh_rate_low = 0x0000;
+
+
+	pgeneral->dss_config__manual_effective_spads_select = 0x8C00;
+	pgeneral->dss_config__manual_block_select = 0x00;
+
+
+
+
+
+
+
+
+	pgeneral->dss_config__aperture_attenuation = 0x38;
+	pgeneral->dss_config__max_spads_limit = 0xFF;
+	pgeneral->dss_config__min_spads_limit = 0x01;
+
+
+
+
+
+
+	ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+	ptiming->mm_config__timeout_macrop_a_lo = 0x1a;
+	ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+	ptiming->mm_config__timeout_macrop_b_lo = 0x20;
+
+
+	ptiming->range_config__timeout_macrop_a_hi = 0x01;
+	ptiming->range_config__timeout_macrop_a_lo = 0xCC;
+
+
+	ptiming->range_config__vcsel_period_a = 0x0B;
+
+
+	ptiming->range_config__timeout_macrop_b_hi = 0x01;
+	ptiming->range_config__timeout_macrop_b_lo = 0xF5;
+
+
+	ptiming->range_config__vcsel_period_b = 0x09;
+
+
+
+
+
+
+
+	ptiming->range_config__sigma_thresh                       =
+			ptuning_parms->tp_lite_med_sigma_thresh_mm;
+
+
+
+
+
+
+	ptiming->range_config__min_count_rate_rtn_limit_mcps      =
+			ptuning_parms->tp_lite_med_min_count_rate_rtn_mcps;
+
+
+
+
+
+
+	ptiming->range_config__valid_phase_low = 0x08;
+	ptiming->range_config__valid_phase_high = 0x78;
+	ptiming->system__intermeasurement_period = 0x00000000;
+	ptiming->system__fractional_enable = 0x00;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	phistogram->histogram_config__low_amb_even_bin_0_1 = 0x07;
+	phistogram->histogram_config__low_amb_even_bin_2_3 = 0x21;
+	phistogram->histogram_config__low_amb_even_bin_4_5 = 0x43;
+
+	phistogram->histogram_config__low_amb_odd_bin_0_1 = 0x10;
+	phistogram->histogram_config__low_amb_odd_bin_2_3 = 0x32;
+	phistogram->histogram_config__low_amb_odd_bin_4_5 = 0x54;
+
+	phistogram->histogram_config__mid_amb_even_bin_0_1 = 0x07;
+	phistogram->histogram_config__mid_amb_even_bin_2_3 = 0x21;
+	phistogram->histogram_config__mid_amb_even_bin_4_5 = 0x43;
+
+	phistogram->histogram_config__mid_amb_odd_bin_0_1 = 0x10;
+	phistogram->histogram_config__mid_amb_odd_bin_2 = 0x02;
+	phistogram->histogram_config__mid_amb_odd_bin_3_4 = 0x43;
+	phistogram->histogram_config__mid_amb_odd_bin_5 = 0x05;
+
+	phistogram->histogram_config__user_bin_offset = 0x00;
+
+	phistogram->histogram_config__high_amb_even_bin_0_1 = 0x07;
+	phistogram->histogram_config__high_amb_even_bin_2_3 = 0x21;
+	phistogram->histogram_config__high_amb_even_bin_4_5 = 0x43;
+
+	phistogram->histogram_config__high_amb_odd_bin_0_1 = 0x10;
+	phistogram->histogram_config__high_amb_odd_bin_2_3 = 0x32;
+	phistogram->histogram_config__high_amb_odd_bin_4_5 = 0x54;
+
+	phistogram->histogram_config__amb_thresh_low = 0xFFFF;
+	phistogram->histogram_config__amb_thresh_high = 0xFFFF;
+
+	phistogram->histogram_config__spad_array_selection = 0x00;
+
+
+
+
+
+
+
+
+	pzone_cfg->max_zones                     = VL53L1_MAX_USER_ZONES;
+	pzone_cfg->active_zones = 0x00;
+	pzone_cfg->user_zones[0].height = 0x0f;
+	pzone_cfg->user_zones[0].width = 0x0f;
+	pzone_cfg->user_zones[0].x_centre = 0x08;
+	pzone_cfg->user_zones[0].y_centre = 0x08;
+
+
+
+
+	pdynamic->system__grouped_parameter_hold_0 = 0x01;
+
+	pdynamic->system__thresh_high = 0x0000;
+	pdynamic->system__thresh_low = 0x0000;
+	pdynamic->system__enable_xtalk_per_quadrant = 0x00;
+	pdynamic->system__seed_config =
+			ptuning_parms->tp_lite_seed_cfg;
+
+
+
+	pdynamic->sd_config__woi_sd0 = 0x0B;
+
+
+	pdynamic->sd_config__woi_sd1 = 0x09;
+
+	pdynamic->sd_config__initial_phase_sd0                     =
+			ptuning_parms->tp_init_phase_rtn_lite_med;
+	pdynamic->sd_config__initial_phase_sd1                     =
+			ptuning_parms->tp_init_phase_ref_lite_med;
+
+	pdynamic->system__grouped_parameter_hold_1 = 0x01;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	pdynamic->sd_config__first_order_select =
+			ptuning_parms->tp_lite_first_order_select;
+	pdynamic->sd_config__quantifier         =
+			ptuning_parms->tp_lite_quantifier;
+
+
+
+
+
+
+	pdynamic->roi_config__user_roi_centre_spad = 0xC7;
+
+
+	pdynamic->roi_config__user_roi_requested_global_xy_size = 0xFF;
+
+
+	pdynamic->system__sequence_config                          =
+			VL53L1_SEQUENCE_VHV_EN |
+			VL53L1_SEQUENCE_PHASECAL_EN |
+			VL53L1_SEQUENCE_DSS1_EN |
+			VL53L1_SEQUENCE_DSS2_EN |
+			VL53L1_SEQUENCE_MM2_EN |
+			VL53L1_SEQUENCE_RANGE_EN;
+
+	pdynamic->system__grouped_parameter_hold = 0x02;
+
+
+
+
+
+	psystem->system__stream_count_ctrl = 0x00;
+	psystem->firmware__enable = 0x01;
+	psystem->system__interrupt_clear                           =
+			VL53L1_CLEAR_RANGE_INT;
+
+	psystem->system__mode_start                                =
+			VL53L1_DEVICESCHEDULERMODE_STREAMING |
+			VL53L1_DEVICEREADOUTMODE_SINGLE_SD |
+			VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_short_range(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+		pstatic,
+		phistogram,
+		pgeneral,
+		ptiming,
+		pdynamic,
+		psystem,
+		ptuning_parms,
+		pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x07;
+		ptiming->range_config__vcsel_period_b = 0x05;
+		ptiming->range_config__sigma_thresh                  =
+				ptuning_parms->tp_lite_short_sigma_thresh_mm;
+		ptiming->range_config__min_count_rate_rtn_limit_mcps =
+			ptuning_parms->tp_lite_short_min_count_rate_rtn_mcps;
+		ptiming->range_config__valid_phase_low = 0x08;
+		ptiming->range_config__valid_phase_high = 0x38;
+
+
+
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x07;
+		pdynamic->sd_config__woi_sd1 = 0x05;
+		pdynamic->sd_config__initial_phase_sd0               =
+				ptuning_parms->tp_init_phase_rtn_lite_short;
+		pdynamic->sd_config__initial_phase_sd1               =
+				ptuning_parms->tp_init_phase_ref_lite_short;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_long_range(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+		pstatic,
+		phistogram,
+		pgeneral,
+		ptiming,
+		pdynamic,
+		psystem,
+		ptuning_parms,
+		pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x0F;
+		ptiming->range_config__vcsel_period_b = 0x0D;
+		ptiming->range_config__sigma_thresh                  =
+				ptuning_parms->tp_lite_long_sigma_thresh_mm;
+		ptiming->range_config__min_count_rate_rtn_limit_mcps =
+			ptuning_parms->tp_lite_long_min_count_rate_rtn_mcps;
+		ptiming->range_config__valid_phase_low = 0x08;
+		ptiming->range_config__valid_phase_high = 0xB8;
+
+
+
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x0F;
+		pdynamic->sd_config__woi_sd1 = 0x0D;
+		pdynamic->sd_config__initial_phase_sd0               =
+				ptuning_parms->tp_init_phase_rtn_lite_long;
+		pdynamic->sd_config__initial_phase_sd1               =
+				ptuning_parms->tp_init_phase_ref_lite_long;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_mm1_cal(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+		pstatic,
+		phistogram,
+		pgeneral,
+		ptiming,
+		pdynamic,
+		psystem,
+		ptuning_parms,
+		pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		pgeneral->dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+
+		pdynamic->system__sequence_config  =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_standard_ranging_mm2_cal(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+		pstatic,
+		phistogram,
+		pgeneral,
+		ptiming,
+		pdynamic,
+		psystem,
+		ptuning_parms,
+		pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		pgeneral->dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+
+		pdynamic->system__sequence_config  =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pdynamic->system__grouped_parameter_hold = 0x00;
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0xB1;
+
+
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0xD4;
+
+
+
+
+		ptiming->system__intermeasurement_period = 0x00000600;
+		pdynamic->system__seed_config =
+				ptuning_parms->tp_timed_seed_cfg;
+
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO |
+				VL53L1_DEVICEREADOUTMODE_SINGLE_SD     |
+				VL53L1_DEVICEMEASUREMENTMODE_TIMED;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging_short_range(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging_short_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pdynamic->system__grouped_parameter_hold = 0x00;
+
+
+
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x01;
+		ptiming->range_config__timeout_macrop_a_lo = 0x84;
+
+
+		ptiming->range_config__timeout_macrop_b_hi = 0x01;
+		ptiming->range_config__timeout_macrop_b_lo = 0xB1;
+
+		ptiming->system__intermeasurement_period = 0x00000600;
+		pdynamic->system__seed_config =
+				ptuning_parms->tp_timed_seed_cfg;
+
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO |
+				VL53L1_DEVICEREADOUTMODE_SINGLE_SD     |
+				VL53L1_DEVICEMEASUREMENTMODE_TIMED;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_timed_ranging_long_range(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging_long_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pdynamic->system__grouped_parameter_hold = 0x00;
+
+
+
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x97;
+
+
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0xB1;
+
+		ptiming->system__intermeasurement_period = 0x00000600;
+		pdynamic->system__seed_config =
+				ptuning_parms->tp_timed_seed_cfg;
+
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO |
+				VL53L1_DEVICEREADOUTMODE_SINGLE_SD     |
+				VL53L1_DEVICEMEASUREMENTMODE_TIMED;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_timed_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_config_low_power_auto_mode(
+				pgeneral,
+				pdynamic,
+				plpadata
+				);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_short_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_timed_ranging_short_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_config_low_power_auto_mode(
+				pgeneral,
+				pdynamic,
+				plpadata
+				);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_low_power_auto_long_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg,
+	VL53L1_low_power_auto_data_t *plpadata)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_timed_ranging_long_range(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_config_low_power_auto_mode(
+				pgeneral,
+				pdynamic,
+				plpadata
+				);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_singleshot_ranging(
+
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+		pstatic,
+		phistogram,
+		pgeneral,
+		ptiming,
+		pdynamic,
+		psystem,
+		ptuning_parms,
+		pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pdynamic->system__grouped_parameter_hold = 0x00;
+
+
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0xB1;
+
+
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0xD4;
+
+		pdynamic->system__seed_config =
+				ptuning_parms->tp_timed_seed_cfg;
+
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_PSEUDO_SOLO |
+				VL53L1_DEVICEREADOUTMODE_SINGLE_SD     |
+				VL53L1_DEVICEMEASUREMENTMODE_SINGLESHOT;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_standard_ranging(
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pstatic->dss_config__target_total_rate_mcps = 0x1400;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				7, 0, 1, 2, 3, 4,
+				0, 1, 2, 3, 4, 5,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				7, 0, 1, 2, 3, 4,
+				0, 1, 2, 3, 4, 5,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x09;
+		ptiming->range_config__vcsel_period_b = 0x0B;
+		pdynamic->sd_config__woi_sd0 = 0x09;
+		pdynamic->sd_config__woi_sd1 = 0x0B;
+
+
+
+
+
+
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x20;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x1A;
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x28;
+
+
+
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x21;
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xF5;
+
+
+
+
+
+
+
+
+		phistpostprocess->valid_phase_low = 0x08;
+		phistpostprocess->valid_phase_high = 0x88;
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+
+
+
+
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_with_mm1(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				  7,   0,   1, 2, 3, 4,
+				8+0, 8+1, 8+2, 3, 4, 5,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				  7,  0,    1, 2, 3, 4,
+				8+0, 8+1, 8+2, 3, 4, 5,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_with_mm2(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging_with_mm1(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_mm1_cal(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				  7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				8+0, 8+1, 8+2, 8+3, 8+4, 8+5,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				  7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				8+0, 8+1, 8+2, 8+3, 8+4, 8+5,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+		pgeneral->dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_mm2_cal(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging_mm1_cal(
+				phistpostprocess,
+				pstatic,
+				phistogram,
+				pgeneral,
+				ptiming,
+				pdynamic,
+				psystem,
+				ptuning_parms,
+				pzone_cfg);
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_short_timing(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		pstatic->dss_config__target_total_rate_mcps = 0x1400;
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				7, 0, 1, 2, 3, 4,
+				7, 0, 1, 2, 3, 4,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				7, 0, 1, 2, 3, 4,
+				7, 0, 1, 2, 3, 4,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x04;
+		ptiming->range_config__vcsel_period_b = 0x03;
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x42;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x42;
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x52;
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x66;
+
+		pgeneral->cal_config__vcsel_start = 0x04;
+
+
+
+
+
+
+
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xa4;
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+
+
+
+
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+			7, 0, 1, 2, 3, 4,
+			0, 1, 2, 3, 4, 5,
+			phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+			7, 0, 1, 2, 3, 4,
+
+			0, 1, 2, 3, 4, 5,
+
+			&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+			phistogram,
+			pstatic,
+			pgeneral,
+			ptiming,
+			pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x09;
+		ptiming->range_config__vcsel_period_b = 0x0b;
+
+
+
+
+
+
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x21;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x1b;
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x29;
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x22;
+
+
+
+
+		pgeneral->cal_config__vcsel_start = 0x09;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xF5;
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x09;
+		pdynamic->sd_config__woi_sd1 = 0x0B;
+		pdynamic->sd_config__initial_phase_sd0            =
+				ptuning_parms->tp_init_phase_rtn_hist_long;
+		pdynamic->sd_config__initial_phase_sd1            =
+				ptuning_parms->tp_init_phase_ref_hist_long;
+
+
+
+
+
+
+
+
+		phistpostprocess->valid_phase_low = 0x08;
+		phistpostprocess->valid_phase_high = 0x88;
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range_mm1(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_long_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				  7,   0,   1, 2, 3, 4,
+				8+0, 8+1, 8+2, 3, 4, 5,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				  7,   0,   1, 2, 3, 4,
+				8+0, 8+1, 8+2, 3, 4, 5,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_long_range_mm2(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t      *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_long_range_mm1(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				7, 0, 1, 1, 2, 2,
+				0, 1, 2, 1, 2, 3,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				7, 0, 1, 1, 2, 2,
+				0, 1, 2, 1, 2, 3,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x05;
+		ptiming->range_config__vcsel_period_b = 0x07;
+
+
+
+
+
+
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x36;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x28;
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x44;
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x33;
+
+
+
+
+		pgeneral->cal_config__vcsel_start = 0x05;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xF5;
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x05;
+		pdynamic->sd_config__woi_sd1 = 0x07;
+		pdynamic->sd_config__initial_phase_sd0            =
+			ptuning_parms->tp_init_phase_rtn_hist_med;
+		pdynamic->sd_config__initial_phase_sd1            =
+			ptuning_parms->tp_init_phase_ref_hist_med;
+
+
+
+
+
+
+
+
+		phistpostprocess->valid_phase_low = 0x08;
+		phistpostprocess->valid_phase_high = 0x48;
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range_mm1(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_medium_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				  7,   0,   1, 1, 2, 2,
+				8+0, 8+1, 8+2, 1, 2, 3,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				  7,   0,   1, 1, 2, 2,
+				8+0, 8+1, 8+2, 1, 2, 3,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN  |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_medium_range_mm2(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_medium_range_mm1(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				7, 7, 0, 1, 1, 1,
+				0, 1, 1, 1, 2, 2,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				7, 7, 0, 1, 1, 1,
+				0, 1, 1, 1, 2, 2,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x03;
+		ptiming->range_config__vcsel_period_b = 0x05;
+
+
+
+
+
+
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x52;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x37;
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x66;
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x44;
+
+
+
+
+		pgeneral->cal_config__vcsel_start = 0x03;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xF5;
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x03;
+		pdynamic->sd_config__woi_sd1 = 0x05;
+		pdynamic->sd_config__initial_phase_sd0            =
+			ptuning_parms->tp_init_phase_rtn_hist_short;
+		pdynamic->sd_config__initial_phase_sd1            =
+			ptuning_parms->tp_init_phase_ref_hist_short;
+
+
+
+
+
+
+
+		phistpostprocess->valid_phase_low = 0x08;
+		phistpostprocess->valid_phase_high = 0x28;
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN  |
+
+
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_special_histogram_short_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_short_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				7, 7, 0, 0, 1, 1,
+				0, 0, 0, 1, 1, 1,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				7, 7, 0, 0, 1, 1,
+				0, 0, 0, 1, 1, 1,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x02;
+		ptiming->range_config__vcsel_period_b = 0x03;
+
+
+
+
+		pgeneral->cal_config__vcsel_start = 0x00;
+
+
+
+
+
+		pgeneral->phasecal_config__target = 0x31;
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x02;
+		pdynamic->sd_config__woi_sd1 = 0x03;
+		pdynamic->sd_config__initial_phase_sd0            =
+			ptuning_parms->tp_init_phase_rtn_hist_short;
+		pdynamic->sd_config__initial_phase_sd1            =
+			ptuning_parms->tp_init_phase_ref_hist_short;
+
+
+
+
+
+
+
+
+		phistpostprocess->valid_phase_low = 0x10;
+		phistpostprocess->valid_phase_high = 0x18;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range_mm1(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_short_range(
+			phistpostprocess,
+				pstatic,
+				phistogram,
+				pgeneral,
+				ptiming,
+				pdynamic,
+				psystem,
+				ptuning_parms,
+				pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				  7,   7, 0, 1, 1, 1,
+				8+0, 8+1, 1, 1, 2, 2,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				  7,   7, 0, 1, 1, 1,
+				8+0, 8+1, 1, 1, 2, 2,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN  |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_short_range_mm2(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_short_range_mm1(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_characterisation(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		pstatic->debug__ctrl = 0x01;
+		psystem->power_management__go1_power_force = 0x01;
+
+		pdynamic->system__sequence_config               =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+		psystem->system__mode_start                     =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM    |
+				VL53L1_DEVICEREADOUTMODE_SPLIT_MANUAL   |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_planar(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_multizone_long_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		status =
+			VL53L1_zone_preset_xtalk_planar(
+				pgeneral,
+				pzone_cfg);
+
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x09;
+		ptiming->range_config__vcsel_period_b = 0x09;
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+			7, 0, 1, 2, 3, 4,
+			7, 0, 1, 2, 3, 4,
+			phistogram);
+
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+			7, 0, 1, 2, 3, 4,
+
+			7, 0, 1, 2, 3, 4,
+
+			&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+			status =
+			VL53L1_set_histogram_multizone_initial_bin_config(
+			pzone_cfg,
+			phistogram,
+			&(pzone_cfg->multizone_hist_cfg));
+		}
+
+
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+			phistogram,
+			pstatic,
+			pgeneral,
+			ptiming,
+			pdynamic);
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_mm1(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+
+
+		VL53L1_init_histogram_config_structure(
+				8+7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				8+7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				phistogram);
+
+
+
+
+
+
+		VL53L1_init_histogram_multizone_config_structure(
+				8+7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				8+7, 8+0, 8+1, 8+2, 8+3, 8+4,
+				&(pzone_cfg->multizone_hist_cfg));
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+
+
+
+
+
+
+		ptiming->range_config__vcsel_period_a = 0x09;
+		ptiming->range_config__vcsel_period_b = 0x09;
+
+
+
+
+
+
+		ptiming->mm_config__timeout_macrop_a_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_a_lo = 0x21;
+		ptiming->mm_config__timeout_macrop_b_hi = 0x00;
+		ptiming->mm_config__timeout_macrop_b_lo = 0x21;
+
+
+
+
+		ptiming->range_config__timeout_macrop_a_hi = 0x00;
+		ptiming->range_config__timeout_macrop_a_lo = 0x29;
+		ptiming->range_config__timeout_macrop_b_hi = 0x00;
+		ptiming->range_config__timeout_macrop_b_lo = 0x29;
+
+
+
+
+		pgeneral->cal_config__vcsel_start = 0x09;
+
+
+
+
+
+
+
+
+
+
+
+
+
+		pgeneral->phasecal_config__timeout_macrop = 0xF5;
+
+
+
+
+		pdynamic->sd_config__woi_sd0 = 0x09;
+		pdynamic->sd_config__woi_sd1 = 0x09;
+		pdynamic->sd_config__initial_phase_sd0 = 0x09;
+		pdynamic->sd_config__initial_phase_sd1 = 0x06;
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM1_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+
+
+		psystem->system__mode_start =
+				VL53L1_DEVICESCHEDULERMODE_HISTOGRAM |
+				VL53L1_DEVICEREADOUTMODE_DUAL_SD |
+				VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_xtalk_mm2(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_xtalk_mm1(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+		pdynamic->system__sequence_config =
+				VL53L1_SEQUENCE_VHV_EN |
+				VL53L1_SEQUENCE_PHASECAL_EN |
+				VL53L1_SEQUENCE_DSS1_EN |
+				VL53L1_SEQUENCE_DSS2_EN |
+				VL53L1_SEQUENCE_MM2_EN |
+				VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_medium_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		status =
+			VL53L1_init_zone_config_structure(
+				4, 8, 2,
+
+				4, 8, 2,
+
+				7, 7,
+
+				pzone_cfg);
+
+		pgeneral->global_config__stream_divider =
+			pzone_cfg->active_zones + 1;
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+			status =
+			VL53L1_set_histogram_multizone_initial_bin_config(
+				pzone_cfg,
+				phistogram,
+				&(pzone_cfg->multizone_hist_cfg));
+		}
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone_short_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_short_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		status =
+			VL53L1_init_zone_config_structure(
+				4, 8, 2,
+
+				4, 8, 2,
+
+				7, 7,
+
+				pzone_cfg);
+
+		pgeneral->global_config__stream_divider =
+			pzone_cfg->active_zones + 1;
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+			status =
+			VL53L1_set_histogram_multizone_initial_bin_config(
+			pzone_cfg,
+			phistogram,
+			&(pzone_cfg->multizone_hist_cfg)
+			);
+		}
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_multizone_long_range(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_long_range(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+		status =
+			VL53L1_init_zone_config_structure(
+				4, 8, 2,
+
+				4, 8, 2,
+
+				7, 7,
+
+				pzone_cfg);
+
+		pgeneral->global_config__stream_divider =
+			pzone_cfg->active_zones + 1;
+
+
+
+
+
+
+		if (status == VL53L1_ERROR_NONE) {
+			status =
+			VL53L1_set_histogram_multizone_initial_bin_config(
+				pzone_cfg,
+				phistogram,
+				&(pzone_cfg->multizone_hist_cfg));
+		}
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+			phistogram,
+			pstatic,
+			pgeneral,
+			ptiming,
+			pdynamic);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_preset_mode_olt(
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_system_control_t   *psystem,
+	VL53L1_tuning_parm_storage_t *ptuning_parms,
+	VL53L1_zone_config_t      *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_preset_mode_standard_ranging(
+					pstatic,
+					phistogram,
+					pgeneral,
+					ptiming,
+					pdynamic,
+					psystem,
+					ptuning_parms,
+					pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+
+		psystem->system__stream_count_ctrl = 0x01;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+void VL53L1_copy_hist_cfg_to_static_cfg(
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_timing_config_t    *ptiming,
+	VL53L1_dynamic_config_t   *pdynamic)
+{
+
+
+
+
+
+
+	LOG_FUNCTION_START("");
+
+	SUPPRESS_UNUSED_WARNING(pgeneral);
+
+	pstatic->sigma_estimator__effective_pulse_width_ns =
+			phistogram->histogram_config__high_amb_even_bin_0_1;
+	pstatic->sigma_estimator__effective_ambient_width_ns =
+			phistogram->histogram_config__high_amb_even_bin_2_3;
+	pstatic->sigma_estimator__sigma_ref_mm =
+			phistogram->histogram_config__high_amb_even_bin_4_5;
+
+	pstatic->algo__crosstalk_compensation_valid_height_mm =
+			phistogram->histogram_config__high_amb_odd_bin_0_1;
+
+	pstatic->spare_host_config__static_config_spare_0 =
+			phistogram->histogram_config__high_amb_odd_bin_2_3;
+	pstatic->spare_host_config__static_config_spare_1 =
+			phistogram->histogram_config__high_amb_odd_bin_4_5;
+
+	pstatic->algo__range_ignore_threshold_mcps =
+		(((uint16_t)phistogram->histogram_config__mid_amb_even_bin_0_1)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__mid_amb_even_bin_2_3;
+
+	pstatic->algo__range_ignore_valid_height_mm =
+			phistogram->histogram_config__mid_amb_even_bin_4_5;
+	pstatic->algo__range_min_clip =
+			phistogram->histogram_config__mid_amb_odd_bin_0_1;
+	pstatic->algo__consistency_check__tolerance =
+			phistogram->histogram_config__mid_amb_odd_bin_2;
+
+	pstatic->spare_host_config__static_config_spare_2 =
+			phistogram->histogram_config__mid_amb_odd_bin_3_4;
+	pstatic->sd_config__reset_stages_msb =
+			phistogram->histogram_config__mid_amb_odd_bin_5;
+
+	pstatic->sd_config__reset_stages_lsb =
+			phistogram->histogram_config__user_bin_offset;
+
+	ptiming->range_config__sigma_thresh =
+		(((uint16_t)phistogram->histogram_config__low_amb_even_bin_0_1)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__low_amb_even_bin_2_3;
+
+	ptiming->range_config__min_count_rate_rtn_limit_mcps =
+		(((uint16_t)phistogram->histogram_config__low_amb_even_bin_4_5)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__low_amb_odd_bin_0_1;
+
+	ptiming->range_config__valid_phase_low =
+			phistogram->histogram_config__low_amb_odd_bin_2_3;
+	ptiming->range_config__valid_phase_high =
+			phistogram->histogram_config__low_amb_odd_bin_4_5;
+
+	pdynamic->system__thresh_high =
+			phistogram->histogram_config__amb_thresh_low;
+
+	pdynamic->system__thresh_low =
+			phistogram->histogram_config__amb_thresh_high;
+
+	pdynamic->system__enable_xtalk_per_quadrant =
+			phistogram->histogram_config__spad_array_selection;
+
+	LOG_FUNCTION_END(0);
+
+}
+
+void VL53L1_copy_hist_bins_to_static_cfg(
+	VL53L1_histogram_config_t *phistogram,
+	VL53L1_static_config_t    *pstatic,
+	VL53L1_timing_config_t    *ptiming)
+{
+
+
+
+
+
+
+	LOG_FUNCTION_START("");
+
+	pstatic->sigma_estimator__effective_pulse_width_ns =
+			phistogram->histogram_config__high_amb_even_bin_0_1;
+	pstatic->sigma_estimator__effective_ambient_width_ns =
+			phistogram->histogram_config__high_amb_even_bin_2_3;
+	pstatic->sigma_estimator__sigma_ref_mm =
+			phistogram->histogram_config__high_amb_even_bin_4_5;
+
+	pstatic->algo__crosstalk_compensation_valid_height_mm =
+			phistogram->histogram_config__high_amb_odd_bin_0_1;
+
+	pstatic->spare_host_config__static_config_spare_0 =
+			phistogram->histogram_config__high_amb_odd_bin_2_3;
+	pstatic->spare_host_config__static_config_spare_1 =
+			phistogram->histogram_config__high_amb_odd_bin_4_5;
+
+	pstatic->algo__range_ignore_threshold_mcps =
+		(((uint16_t)phistogram->histogram_config__mid_amb_even_bin_0_1)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__mid_amb_even_bin_2_3;
+
+	pstatic->algo__range_ignore_valid_height_mm =
+			phistogram->histogram_config__mid_amb_even_bin_4_5;
+	pstatic->algo__range_min_clip =
+			phistogram->histogram_config__mid_amb_odd_bin_0_1;
+	pstatic->algo__consistency_check__tolerance =
+			phistogram->histogram_config__mid_amb_odd_bin_2;
+
+	pstatic->spare_host_config__static_config_spare_2 =
+			phistogram->histogram_config__mid_amb_odd_bin_3_4;
+	pstatic->sd_config__reset_stages_msb =
+			phistogram->histogram_config__mid_amb_odd_bin_5;
+
+	ptiming->range_config__sigma_thresh =
+		(((uint16_t)phistogram->histogram_config__low_amb_even_bin_0_1)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__low_amb_even_bin_2_3;
+
+	ptiming->range_config__min_count_rate_rtn_limit_mcps =
+		(((uint16_t)phistogram->histogram_config__low_amb_even_bin_4_5)
+				<< 8)
+		+ (uint16_t)phistogram->histogram_config__low_amb_odd_bin_0_1;
+
+	ptiming->range_config__valid_phase_low =
+			phistogram->histogram_config__low_amb_odd_bin_2_3;
+	ptiming->range_config__valid_phase_high =
+			phistogram->histogram_config__low_amb_odd_bin_4_5;
+
+	LOG_FUNCTION_END(0);
+
+}
+
+
+VL53L1_Error VL53L1_preset_mode_histogram_ranging_ref(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_static_config_t             *pstatic,
+	VL53L1_histogram_config_t          *phistogram,
+	VL53L1_general_config_t            *pgeneral,
+	VL53L1_timing_config_t             *ptiming,
+	VL53L1_dynamic_config_t            *pdynamic,
+	VL53L1_system_control_t            *psystem,
+	VL53L1_tuning_parm_storage_t       *ptuning_parms,
+	VL53L1_zone_config_t               *pzone_cfg)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_preset_mode_histogram_ranging(
+			phistpostprocess,
+			pstatic,
+			phistogram,
+			pgeneral,
+			ptiming,
+			pdynamic,
+			psystem,
+			ptuning_parms,
+			pzone_cfg);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+		phistogram->histogram_config__spad_array_selection = 0x01;
+
+
+
+
+		VL53L1_copy_hist_cfg_to_static_cfg(
+				phistogram,
+				pstatic,
+				pgeneral,
+				ptiming,
+				pdynamic);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_api_strings.c b/drivers/input/misc/vl53L1/src/vl53l1_api_strings.c
new file mode 100644
index 0000000000000000000000000000000000000000..70266e4418a797756c6e98078cd618dc6f9af2d2
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_api_strings.c
@@ -0,0 +1,334 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_api_core.h"
+#include "vl53l1_api_strings.h"
+#include "vl53l1_error_codes.h"
+#include "vl53l1_error_strings.h"
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_API, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_API, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_API, status, fmt, \
+			##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_get_range_status_string(
+	uint8_t   RangeStatus,
+	char    *pRangeStatusString)
+{
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	VL53L1_COPYSTRING(pRangeStatusString, "");
+#else
+	switch (RangeStatus) {
+	case 0:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_RANGEVALID);
+	break;
+	case 1:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_SIGMA);
+	break;
+	case 2:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_SIGNAL);
+	break;
+	case 3:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_MINRANGE);
+	break;
+	case 4:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_PHASE);
+	break;
+	case 5:
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_HW);
+	break;
+
+	default:
+
+		VL53L1_COPYSTRING(pRangeStatusString,
+			VL53L1_STRING_RANGESTATUS_NONE);
+	}
+#endif
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_pal_state_string(
+	VL53L1_State PalStateCode,
+	char *pPalStateString)
+{
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	VL53L1_COPYSTRING(pPalStateString, "");
+#else
+	switch (PalStateCode) {
+	case VL53L1_STATE_POWERDOWN:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_POWERDOWN);
+	break;
+	case VL53L1_STATE_WAIT_STATICINIT:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_WAIT_STATICINIT);
+	break;
+	case VL53L1_STATE_STANDBY:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_STANDBY);
+	break;
+	case VL53L1_STATE_IDLE:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_IDLE);
+	break;
+	case VL53L1_STATE_RUNNING:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_RUNNING);
+	break;
+	case VL53L1_STATE_RESET:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_RESET);
+	break;
+	case VL53L1_STATE_UNKNOWN:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_UNKNOWN);
+	break;
+	case VL53L1_STATE_ERROR:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_ERROR);
+	break;
+
+	default:
+		VL53L1_COPYSTRING(pPalStateString,
+			VL53L1_STRING_STATE_UNKNOWN);
+	}
+#endif
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+VL53L1_Error VL53L1_get_sequence_steps_info(
+		VL53L1_SequenceStepId SequenceStepId,
+		char *pSequenceStepsString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	VL53L1_COPYSTRING(pSequenceStepsString, "");
+#else
+	switch (SequenceStepId) {
+	case VL53L1_SEQUENCESTEP_VHV:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_VHV);
+	break;
+	case VL53L1_SEQUENCESTEP_PHASECAL:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_PHASECAL);
+	break;
+	case VL53L1_SEQUENCESTEP_REFPHASE:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_DSS1);
+	break;
+	case VL53L1_SEQUENCESTEP_DSS1:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_DSS1);
+	break;
+	case VL53L1_SEQUENCESTEP_DSS2:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_DSS2);
+	break;
+	case VL53L1_SEQUENCESTEP_MM1:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_MM1);
+	break;
+	case VL53L1_SEQUENCESTEP_MM2:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_MM2);
+	break;
+	case VL53L1_SEQUENCESTEP_RANGE:
+		VL53L1_COPYSTRING(pSequenceStepsString,
+				VL53L1_STRING_SEQUENCESTEP_RANGE);
+	break;
+	default:
+		Status = VL53L1_ERROR_INVALID_PARAMS;
+	}
+#endif
+
+	LOG_FUNCTION_END(Status);
+
+	return Status;
+}
+
+VL53L1_Error VL53L1_get_limit_check_info(uint16_t LimitCheckId,
+	char *pLimitCheckString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	VL53L1_COPYSTRING(pLimitCheckString, "");
+#else
+	switch (LimitCheckId) {
+	case VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE:
+		VL53L1_COPYSTRING(pLimitCheckString,
+			VL53L1_STRING_CHECKENABLE_SIGMA_FINAL_RANGE);
+	break;
+	case VL53L1_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE:
+		VL53L1_COPYSTRING(pLimitCheckString,
+			VL53L1_STRING_CHECKENABLE_SIGNAL_RATE_FINAL_RANGE);
+	break;
+	default:
+		VL53L1_COPYSTRING(pLimitCheckString,
+			VL53L1_STRING_UNKNOW_ERROR_CODE);
+	}
+#endif
+
+	LOG_FUNCTION_END(Status);
+	return Status;
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_core.c b/drivers/input/misc/vl53L1/src/vl53l1_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..6d1fa6c3117fd8e557e30409b9b43a648d5041aa
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_core.c
@@ -0,0 +1,5888 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_register_funcs.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_hist_structs.h"
+#include "vl53l1_api_preset_modes.h"
+#include "vl53l1_core.h"
+#include "vl53l1_tuning_parm_defaults.h"
+
+
+
+
+
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, \
+		status, fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_CORE, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+
+void  VL53L1_init_version(
+	VL53L1_DEV        Dev)
+{
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->version.ll_major    = VL53L1_LL_API_IMPLEMENTATION_VER_MAJOR;
+	pdev->version.ll_minor    = VL53L1_LL_API_IMPLEMENTATION_VER_MINOR;
+	pdev->version.ll_build    = VL53L1_LL_API_IMPLEMENTATION_VER_SUB;
+	pdev->version.ll_revision = VL53L1_LL_API_IMPLEMENTATION_VER_REVISION;
+}
+
+
+void  VL53L1_init_ll_driver_state(
+	VL53L1_DEV         Dev,
+	VL53L1_DeviceState device_state)
+{
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_ll_driver_state_t *pstate = &(pdev->ll_state);
+
+	pstate->cfg_device_state  = device_state;
+	pstate->cfg_stream_count  = 0;
+	pstate->cfg_gph_id        = VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+	pstate->cfg_timing_status = 0;
+	pstate->cfg_zone_id       = 0;
+
+	pstate->rd_device_state   = device_state;
+	pstate->rd_stream_count   = 0;
+	pstate->rd_gph_id         = VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+	pstate->rd_timing_status  = 0;
+	pstate->rd_zone_id        = 0;
+
+}
+
+
+VL53L1_Error  VL53L1_update_ll_driver_rd_state(
+	VL53L1_DEV         Dev)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error        status  = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_ll_driver_state_t *pstate = &(pdev->ll_state);
+
+
+
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	if ((pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICEMEASUREMENTMODE_MODE_MASK) == 0x00) {
+
+		pstate->rd_device_state  = VL53L1_DEVICESTATE_SW_STANDBY;
+		pstate->rd_stream_count  = 0;
+		pstate->rd_internal_stream_count = 0;
+		pstate->rd_internal_stream_count_val = 0;
+		pstate->rd_gph_id = VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+		pstate->rd_timing_status = 0;
+		pstate->rd_zone_id       = 0;
+
+	} else {
+
+
+
+
+
+
+		if (pstate->rd_stream_count == 0xFF)
+			pstate->rd_stream_count = 0x80;
+		else
+			pstate->rd_stream_count++;
+
+
+
+
+
+		status = VL53L1_update_internal_stream_counters(Dev,
+			pstate->rd_stream_count,
+			&(pstate->rd_internal_stream_count),
+			&(pstate->rd_internal_stream_count_val));
+
+
+
+
+
+
+		pstate->rd_gph_id ^= VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+
+
+
+
+		switch (pstate->rd_device_state) {
+
+		case VL53L1_DEVICESTATE_SW_STANDBY:
+
+			if ((pdev->dyn_cfg.system__grouped_parameter_hold &
+				VL53L1_GROUPEDPARAMETERHOLD_ID_MASK) > 0) {
+				pstate->rd_device_state =
+				VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC;
+			} else {
+				if (pstate->rd_zone_id >=
+					pdev->zone_cfg.active_zones)
+					pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA;
+				else
+					pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_GATHER_DATA;
+			}
+
+			pstate->rd_stream_count  = 0;
+			pstate->rd_internal_stream_count = 0;
+			pstate->rd_internal_stream_count_val = 0;
+			pstate->rd_timing_status = 0;
+			pstate->rd_zone_id       = 0;
+
+			break;
+
+		case VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC:
+			pstate->rd_stream_count = 0;
+			pstate->rd_internal_stream_count = 0;
+			pstate->rd_internal_stream_count_val = 0;
+			pstate->rd_zone_id      = 0;
+			if (pstate->rd_zone_id >=
+				pdev->zone_cfg.active_zones)
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA;
+			else
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_GATHER_DATA;
+
+			break;
+
+		case VL53L1_DEVICESTATE_RANGING_GATHER_DATA:
+			pstate->rd_zone_id++;
+			if (pstate->rd_zone_id >=
+				pdev->zone_cfg.active_zones)
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA;
+			else
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_GATHER_DATA;
+
+			break;
+
+		case VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA:
+			pstate->rd_zone_id        = 0;
+			pstate->rd_timing_status ^= 0x01;
+
+			if (pstate->rd_zone_id >=
+				pdev->zone_cfg.active_zones)
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA;
+			else
+				pstate->rd_device_state =
+					VL53L1_DEVICESTATE_RANGING_GATHER_DATA;
+			break;
+
+		default:
+			pstate->rd_device_state  =
+				VL53L1_DEVICESTATE_SW_STANDBY;
+			pstate->rd_stream_count  = 0;
+			pstate->rd_internal_stream_count = 0;
+			pstate->rd_internal_stream_count_val = 0;
+			pstate->rd_gph_id = VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+			pstate->rd_timing_status = 0;
+			pstate->rd_zone_id       = 0;
+			break;
+		}
+	}
+
+
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_check_ll_driver_rd_state(
+	VL53L1_DEV         Dev)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error         status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t  *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_ll_driver_state_t  *pstate       = &(pdev->ll_state);
+	VL53L1_system_results_t   *psys_results = &(pdev->sys_results);
+	VL53L1_histogram_bin_data_t *phist_data = &(pdev->hist_data);
+	VL53L1_zone_private_dyn_cfgs_t *pZ = &(pres->zone_dyn_cfgs);
+
+	uint8_t   device_range_status   = 0;
+	uint8_t   device_stream_count   = 0;
+	uint8_t   device_gph_id         = 0;
+	uint8_t   histogram_mode        = 0;
+	uint8_t   expected_stream_count = 0;
+	uint8_t   expected_gph_id       = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	device_range_status =
+			psys_results->result__range_status &
+			VL53L1_RANGE_STATUS__RANGE_STATUS_MASK;
+
+	device_stream_count = psys_results->result__stream_count;
+
+
+
+
+	histogram_mode =
+		(pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICESCHEDULERMODE_HISTOGRAM) ==
+		VL53L1_DEVICESCHEDULERMODE_HISTOGRAM;
+
+
+
+	device_gph_id = (psys_results->result__interrupt_status &
+		VL53L1_INTERRUPT_STATUS__GPH_ID_INT_STATUS_MASK) >> 4;
+
+	if (histogram_mode)
+		device_gph_id = (phist_data->result__interrupt_status &
+			VL53L1_INTERRUPT_STATUS__GPH_ID_INT_STATUS_MASK) >> 4;
+
+
+
+
+	if (!((pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK) ==
+		VL53L1_DEVICEMEASUREMENTMODE_BACKTOBACK))
+		goto ENDFUNC;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	if (pstate->rd_device_state ==
+		VL53L1_DEVICESTATE_RANGING_WAIT_GPH_SYNC) {
+
+		if (histogram_mode == 0) {
+			if (device_range_status !=
+			VL53L1_DEVICEERROR_GPHSTREAMCOUNT0READY)
+				status =
+				VL53L1_ERROR_GPH_SYNC_CHECK_FAIL;
+
+		}
+	} else {
+		if (pstate->rd_stream_count != device_stream_count)
+			status = VL53L1_ERROR_STREAM_COUNT_CHECK_FAIL;
+
+
+
+
+
+		if (pstate->rd_gph_id != device_gph_id)
+			status = VL53L1_ERROR_GPH_ID_CHECK_FAIL;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		expected_stream_count =
+		pZ->VL53L1_p_002[pstate->rd_zone_id].expected_stream_count;
+		expected_gph_id =
+		pZ->VL53L1_p_002[pstate->rd_zone_id].expected_gph_id;
+
+
+
+
+
+
+		if (expected_stream_count != device_stream_count) {
+
+
+
+
+
+			if (!((pdev->zone_cfg.active_zones == 0) &&
+				(device_stream_count == 255)))
+				status =
+				VL53L1_ERROR_ZONE_STREAM_COUNT_CHECK_FAIL;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+		}
+
+
+
+
+
+
+		if (expected_gph_id != device_gph_id)
+			status = VL53L1_ERROR_ZONE_GPH_ID_CHECK_FAIL;
+
+
+
+
+
+
+
+
+
+
+	}
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+ENDFUNC:
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+VL53L1_Error  VL53L1_update_ll_driver_cfg_state(
+	VL53L1_DEV         Dev)
+{
+
+
+
+
+
+	VL53L1_Error         status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t  *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_ll_driver_state_t *pstate = &(pdev->ll_state);
+	VL53L1_zone_private_dyn_cfgs_t *pZ = &(pres->zone_dyn_cfgs);
+
+	uint8_t prev_cfg_zone_id;
+	uint8_t prev_cfg_gph_id;
+	uint8_t prev_cfg_stream_count;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	if ((pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICEMEASUREMENTMODE_MODE_MASK) == 0x00) {
+
+		pstate->cfg_device_state  = VL53L1_DEVICESTATE_SW_STANDBY;
+		pstate->cfg_stream_count  = 0;
+		pstate->cfg_internal_stream_count = 0;
+		pstate->cfg_internal_stream_count_val = 0;
+		pstate->cfg_gph_id = VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+		pstate->cfg_timing_status = 0;
+		pstate->cfg_zone_id       = 0;
+		prev_cfg_zone_id          = 0;
+		prev_cfg_gph_id           = 0;
+		prev_cfg_stream_count     = 0;
+
+	} else {
+
+
+
+
+		prev_cfg_gph_id           = pstate->cfg_gph_id;
+		prev_cfg_zone_id          = pstate->cfg_zone_id;
+		prev_cfg_stream_count     = pstate->cfg_stream_count;
+
+
+
+
+
+
+		if (pstate->cfg_stream_count == 0xFF)
+			pstate->cfg_stream_count = 0x80;
+		else
+			pstate->cfg_stream_count++;
+
+
+
+
+
+		status = VL53L1_update_internal_stream_counters(
+			Dev,
+			pstate->cfg_stream_count,
+			&(pstate->cfg_internal_stream_count),
+			&(pstate->cfg_internal_stream_count_val));
+
+
+
+
+
+
+		pstate->cfg_gph_id ^= VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+
+
+
+
+
+
+		switch (pstate->cfg_device_state) {
+
+		case VL53L1_DEVICESTATE_SW_STANDBY:
+			pstate->cfg_zone_id = 1;
+			if (pstate->cfg_zone_id >
+				pdev->zone_cfg.active_zones) {
+				pstate->cfg_zone_id = 0;
+				pstate->cfg_timing_status ^= 0x01;
+			}
+			pstate->cfg_stream_count = 1;
+
+			if (pdev->gen_cfg.global_config__stream_divider == 0) {
+				pstate->cfg_internal_stream_count = 1;
+				pstate->cfg_internal_stream_count_val = 0;
+			} else {
+				pstate->cfg_internal_stream_count = 0;
+				pstate->cfg_internal_stream_count_val = 1;
+			}
+			pstate->cfg_device_state =
+					VL53L1_DEVICESTATE_RANGING_DSS_AUTO;
+			break;
+
+		case VL53L1_DEVICESTATE_RANGING_DSS_AUTO:
+			pstate->cfg_zone_id++;
+			if (pstate->cfg_zone_id >
+				pdev->zone_cfg.active_zones) {
+
+				pstate->cfg_zone_id = 0;
+				pstate->cfg_timing_status ^= 0x01;
+
+
+
+
+
+
+				if (pdev->zone_cfg.active_zones > 0) {
+					pstate->cfg_device_state =
+					VL53L1_DEVICESTATE_RANGING_DSS_MANUAL;
+				}
+			}
+			break;
+
+		case VL53L1_DEVICESTATE_RANGING_DSS_MANUAL:
+			pstate->cfg_zone_id++;
+			if (pstate->cfg_zone_id >
+				pdev->zone_cfg.active_zones) {
+				pstate->cfg_zone_id = 0;
+				pstate->cfg_timing_status ^= 0x01;
+			}
+			break;
+
+		default:
+			pstate->cfg_device_state =
+					VL53L1_DEVICESTATE_SW_STANDBY;
+			pstate->cfg_stream_count = 0;
+			pstate->cfg_internal_stream_count = 0;
+			pstate->cfg_internal_stream_count_val = 0;
+			pstate->cfg_gph_id =
+					VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+			pstate->cfg_timing_status = 0;
+			pstate->cfg_zone_id       = 0;
+			break;
+		}
+	}
+
+
+
+
+
+	if (pdev->zone_cfg.active_zones == 0) {
+
+
+
+
+
+		pZ->VL53L1_p_002[prev_cfg_zone_id].expected_stream_count
+			= prev_cfg_stream_count - 1;
+
+		pZ->VL53L1_p_002[pstate->rd_zone_id].expected_gph_id =
+			prev_cfg_gph_id ^ VL53L1_GROUPEDPARAMETERHOLD_ID_MASK;
+	} else {
+		pZ->VL53L1_p_002[prev_cfg_zone_id].expected_stream_count
+			= prev_cfg_stream_count;
+		pZ->VL53L1_p_002[prev_cfg_zone_id].expected_gph_id =
+			prev_cfg_gph_id;
+	}
+
+
+
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+void VL53L1_copy_rtn_good_spads_to_buffer(
+	VL53L1_nvm_copy_data_t  *pdata,
+	uint8_t                 *pbuffer)
+{
+
+
+
+
+
+	*(pbuffer +  0) = pdata->global_config__spad_enables_rtn_0;
+	*(pbuffer +  1) = pdata->global_config__spad_enables_rtn_1;
+	*(pbuffer +  2) = pdata->global_config__spad_enables_rtn_2;
+	*(pbuffer +  3) = pdata->global_config__spad_enables_rtn_3;
+	*(pbuffer +  4) = pdata->global_config__spad_enables_rtn_4;
+	*(pbuffer +  5) = pdata->global_config__spad_enables_rtn_5;
+	*(pbuffer +  6) = pdata->global_config__spad_enables_rtn_6;
+	*(pbuffer +  7) = pdata->global_config__spad_enables_rtn_7;
+	*(pbuffer +  8) = pdata->global_config__spad_enables_rtn_8;
+	*(pbuffer +  9) = pdata->global_config__spad_enables_rtn_9;
+	*(pbuffer + 10) = pdata->global_config__spad_enables_rtn_10;
+	*(pbuffer + 11) = pdata->global_config__spad_enables_rtn_11;
+	*(pbuffer + 12) = pdata->global_config__spad_enables_rtn_12;
+	*(pbuffer + 13) = pdata->global_config__spad_enables_rtn_13;
+	*(pbuffer + 14) = pdata->global_config__spad_enables_rtn_14;
+	*(pbuffer + 15) = pdata->global_config__spad_enables_rtn_15;
+	*(pbuffer + 16) = pdata->global_config__spad_enables_rtn_16;
+	*(pbuffer + 17) = pdata->global_config__spad_enables_rtn_17;
+	*(pbuffer + 18) = pdata->global_config__spad_enables_rtn_18;
+	*(pbuffer + 19) = pdata->global_config__spad_enables_rtn_19;
+	*(pbuffer + 20) = pdata->global_config__spad_enables_rtn_20;
+	*(pbuffer + 21) = pdata->global_config__spad_enables_rtn_21;
+	*(pbuffer + 22) = pdata->global_config__spad_enables_rtn_22;
+	*(pbuffer + 23) = pdata->global_config__spad_enables_rtn_23;
+	*(pbuffer + 24) = pdata->global_config__spad_enables_rtn_24;
+	*(pbuffer + 25) = pdata->global_config__spad_enables_rtn_25;
+	*(pbuffer + 26) = pdata->global_config__spad_enables_rtn_26;
+	*(pbuffer + 27) = pdata->global_config__spad_enables_rtn_27;
+	*(pbuffer + 28) = pdata->global_config__spad_enables_rtn_28;
+	*(pbuffer + 29) = pdata->global_config__spad_enables_rtn_29;
+	*(pbuffer + 30) = pdata->global_config__spad_enables_rtn_30;
+	*(pbuffer + 31) = pdata->global_config__spad_enables_rtn_31;
+}
+
+
+void VL53L1_init_system_results(
+		VL53L1_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	pdata->result__interrupt_status                       = 0xFF;
+	pdata->result__range_status                           = 0xFF;
+	pdata->result__report_status                          = 0xFF;
+	pdata->result__stream_count                           = 0xFF;
+
+	pdata->result__dss_actual_effective_spads_sd0         = 0xFFFF;
+	pdata->result__peak_signal_count_rate_mcps_sd0        = 0xFFFF;
+	pdata->result__ambient_count_rate_mcps_sd0            = 0xFFFF;
+	pdata->result__sigma_sd0                              = 0xFFFF;
+	pdata->result__phase_sd0                              = 0xFFFF;
+	pdata->result__final_crosstalk_corrected_range_mm_sd0 = 0xFFFF;
+	pdata->result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0 =
+			0xFFFF;
+	pdata->result__mm_inner_actual_effective_spads_sd0    = 0xFFFF;
+	pdata->result__mm_outer_actual_effective_spads_sd0    = 0xFFFF;
+	pdata->result__avg_signal_count_rate_mcps_sd0         = 0xFFFF;
+
+	pdata->result__dss_actual_effective_spads_sd1         = 0xFFFF;
+	pdata->result__peak_signal_count_rate_mcps_sd1        = 0xFFFF;
+	pdata->result__ambient_count_rate_mcps_sd1            = 0xFFFF;
+	pdata->result__sigma_sd1                              = 0xFFFF;
+	pdata->result__phase_sd1                              = 0xFFFF;
+	pdata->result__final_crosstalk_corrected_range_mm_sd1 = 0xFFFF;
+	pdata->result__spare_0_sd1                            = 0xFFFF;
+	pdata->result__spare_1_sd1                            = 0xFFFF;
+	pdata->result__spare_2_sd1                            = 0xFFFF;
+	pdata->result__spare_3_sd1                            = 0xFF;
+
+}
+
+
+void V53L1_init_zone_results_structure(
+	uint8_t                 active_zones,
+	VL53L1_zone_results_t  *pdata)
+{
+
+
+
+
+	uint8_t  z = 0;
+	VL53L1_zone_objects_t *pobjects;
+
+	pdata->max_zones    = VL53L1_MAX_USER_ZONES;
+	pdata->active_zones = active_zones;
+
+	for (z = 0; z < pdata->max_zones; z++) {
+		pobjects = &(pdata->VL53L1_p_002[z]);
+		pobjects->cfg_device_state = VL53L1_DEVICESTATE_SW_STANDBY;
+		pobjects->rd_device_state  = VL53L1_DEVICESTATE_SW_STANDBY;
+		pobjects->max_objects      = VL53L1_MAX_RANGE_RESULTS;
+		pobjects->active_objects   = 0;
+	}
+}
+
+void V53L1_init_zone_dss_configs(
+	VL53L1_DEV              Dev)
+{
+
+
+
+
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+	uint8_t  z = 0;
+	uint8_t max_zones    = VL53L1_MAX_USER_ZONES;
+	VL53L1_zone_private_dyn_cfgs_t *pdata = &(pres->zone_dyn_cfgs);
+
+	for (z = 0; z < max_zones; z++) {
+		pdata->VL53L1_p_002[z].dss_mode =
+			VL53L1_DSS_CONTROL__MODE_TARGET_RATE;
+		pdata->VL53L1_p_002[z].dss_requested_effective_spad_count = 0;
+	}
+}
+
+
+void VL53L1_init_histogram_config_structure(
+	uint8_t   even_bin0,
+	uint8_t   even_bin1,
+	uint8_t   even_bin2,
+	uint8_t   even_bin3,
+	uint8_t   even_bin4,
+	uint8_t   even_bin5,
+	uint8_t   odd_bin0,
+	uint8_t   odd_bin1,
+	uint8_t   odd_bin2,
+	uint8_t   odd_bin3,
+	uint8_t   odd_bin4,
+	uint8_t   odd_bin5,
+	VL53L1_histogram_config_t  *pdata)
+{
+
+
+
+
+
+
+	pdata->histogram_config__low_amb_even_bin_0_1  =
+			(even_bin1 << 4) + even_bin0;
+	pdata->histogram_config__low_amb_even_bin_2_3  =
+			(even_bin3 << 4) + even_bin2;
+	pdata->histogram_config__low_amb_even_bin_4_5  =
+			(even_bin5 << 4) + even_bin4;
+
+	pdata->histogram_config__low_amb_odd_bin_0_1   =
+			(odd_bin1 << 4) + odd_bin0;
+	pdata->histogram_config__low_amb_odd_bin_2_3   =
+			(odd_bin3 << 4) + odd_bin2;
+	pdata->histogram_config__low_amb_odd_bin_4_5   =
+			(odd_bin5 << 4) + odd_bin4;
+
+	pdata->histogram_config__mid_amb_even_bin_0_1  =
+			pdata->histogram_config__low_amb_even_bin_0_1;
+	pdata->histogram_config__mid_amb_even_bin_2_3  =
+			pdata->histogram_config__low_amb_even_bin_2_3;
+	pdata->histogram_config__mid_amb_even_bin_4_5  =
+			pdata->histogram_config__low_amb_even_bin_4_5;
+
+	pdata->histogram_config__mid_amb_odd_bin_0_1   =
+			pdata->histogram_config__low_amb_odd_bin_0_1;
+	pdata->histogram_config__mid_amb_odd_bin_2     = odd_bin2;
+	pdata->histogram_config__mid_amb_odd_bin_3_4   =
+			(odd_bin4 << 4) + odd_bin3;
+	pdata->histogram_config__mid_amb_odd_bin_5     = odd_bin5;
+
+	pdata->histogram_config__user_bin_offset       = 0x00;
+
+	pdata->histogram_config__high_amb_even_bin_0_1 =
+			pdata->histogram_config__low_amb_even_bin_0_1;
+	pdata->histogram_config__high_amb_even_bin_2_3 =
+			pdata->histogram_config__low_amb_even_bin_2_3;
+	pdata->histogram_config__high_amb_even_bin_4_5 =
+			pdata->histogram_config__low_amb_even_bin_4_5;
+
+	pdata->histogram_config__high_amb_odd_bin_0_1  =
+			pdata->histogram_config__low_amb_odd_bin_0_1;
+	pdata->histogram_config__high_amb_odd_bin_2_3  =
+			pdata->histogram_config__low_amb_odd_bin_2_3;
+	pdata->histogram_config__high_amb_odd_bin_4_5  =
+			pdata->histogram_config__low_amb_odd_bin_4_5;
+
+
+
+
+	pdata->histogram_config__amb_thresh_low        = 0xFFFF;
+	pdata->histogram_config__amb_thresh_high       = 0xFFFF;
+
+
+
+
+	pdata->histogram_config__spad_array_selection  = 0x00;
+
+}
+
+void VL53L1_init_histogram_multizone_config_structure(
+	uint8_t   even_bin0,
+	uint8_t   even_bin1,
+	uint8_t   even_bin2,
+	uint8_t   even_bin3,
+	uint8_t   even_bin4,
+	uint8_t   even_bin5,
+	uint8_t   odd_bin0,
+	uint8_t   odd_bin1,
+	uint8_t   odd_bin2,
+	uint8_t   odd_bin3,
+	uint8_t   odd_bin4,
+	uint8_t   odd_bin5,
+	VL53L1_histogram_config_t  *pdata)
+{
+
+
+
+
+
+
+
+	pdata->histogram_config__low_amb_even_bin_0_1  =
+			(even_bin1 << 4) + even_bin0;
+	pdata->histogram_config__low_amb_even_bin_2_3  =
+			(even_bin3 << 4) + even_bin2;
+	pdata->histogram_config__low_amb_even_bin_4_5  =
+			(even_bin5 << 4) + even_bin4;
+
+	pdata->histogram_config__low_amb_odd_bin_0_1   =
+			pdata->histogram_config__low_amb_even_bin_0_1;
+	pdata->histogram_config__low_amb_odd_bin_2_3
+		= pdata->histogram_config__low_amb_even_bin_2_3;
+	pdata->histogram_config__low_amb_odd_bin_4_5
+		= pdata->histogram_config__low_amb_even_bin_4_5;
+
+	pdata->histogram_config__mid_amb_even_bin_0_1  =
+		pdata->histogram_config__low_amb_even_bin_0_1;
+	pdata->histogram_config__mid_amb_even_bin_2_3
+		= pdata->histogram_config__low_amb_even_bin_2_3;
+	pdata->histogram_config__mid_amb_even_bin_4_5
+		= pdata->histogram_config__low_amb_even_bin_4_5;
+
+	pdata->histogram_config__mid_amb_odd_bin_0_1
+		= pdata->histogram_config__low_amb_odd_bin_0_1;
+	pdata->histogram_config__mid_amb_odd_bin_2     = odd_bin2;
+	pdata->histogram_config__mid_amb_odd_bin_3_4   =
+			(odd_bin4 << 4) + odd_bin3;
+	pdata->histogram_config__mid_amb_odd_bin_5     = odd_bin5;
+
+	pdata->histogram_config__user_bin_offset       = 0x00;
+
+	pdata->histogram_config__high_amb_even_bin_0_1 =
+			(odd_bin1 << 4) + odd_bin0;
+	pdata->histogram_config__high_amb_even_bin_2_3 =
+			(odd_bin3 << 4) + odd_bin2;
+	pdata->histogram_config__high_amb_even_bin_4_5 =
+			(odd_bin5 << 4) + odd_bin4;
+
+	pdata->histogram_config__high_amb_odd_bin_0_1
+		= pdata->histogram_config__high_amb_even_bin_0_1;
+	pdata->histogram_config__high_amb_odd_bin_2_3
+		= pdata->histogram_config__high_amb_even_bin_2_3;
+	pdata->histogram_config__high_amb_odd_bin_4_5
+		= pdata->histogram_config__high_amb_even_bin_4_5;
+
+
+
+
+	pdata->histogram_config__amb_thresh_low        = 0xFFFF;
+	pdata->histogram_config__amb_thresh_high       = 0xFFFF;
+
+
+
+
+	pdata->histogram_config__spad_array_selection  = 0x00;
+}
+
+
+void VL53L1_init_xtalk_bin_data_struct(
+	uint32_t                        bin_value,
+	uint16_t                        VL53L1_p_024,
+	VL53L1_xtalk_histogram_shape_t *pdata)
+{
+
+
+
+
+
+
+	uint16_t          i = 0;
+
+	pdata->zone_id                   = 0;
+	pdata->time_stamp                = 0;
+
+	pdata->VL53L1_p_022                 = 0;
+	pdata->VL53L1_p_023               = VL53L1_XTALK_HISTO_BINS;
+	pdata->VL53L1_p_024            = (uint8_t)VL53L1_p_024;
+
+	pdata->phasecal_result__reference_phase   = 0;
+	pdata->phasecal_result__vcsel_start       = 0;
+	pdata->cal_config__vcsel_start            = 0;
+
+	pdata->vcsel_width                        = 0;
+	pdata->VL53L1_p_019                = 0;
+
+	pdata->zero_distance_phase                = 0;
+
+	for (i = 0; i < VL53L1_XTALK_HISTO_BINS; i++) {
+		if (i < VL53L1_p_024)
+			pdata->bin_data[i] = bin_value;
+		else
+			pdata->bin_data[i] = 0;
+	}
+}
+
+
+void VL53L1_i2c_encode_uint16_t(
+	uint16_t    ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint16_t   i    = 0;
+	uint16_t   VL53L1_p_002 = 0;
+
+	VL53L1_p_002 =  ip_value;
+
+	for (i = 0; i < count; i++) {
+		pbuffer[count-i-1] = (uint8_t)(VL53L1_p_002 & 0x00FF);
+		VL53L1_p_002 = VL53L1_p_002 >> 8;
+	}
+}
+
+uint16_t VL53L1_i2c_decode_uint16_t(
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint16_t   value = 0x00;
+
+	while (count-- > 0)
+		value = (value << 8) | (uint16_t)*pbuffer++;
+
+	return value;
+}
+
+
+void VL53L1_i2c_encode_int16_t(
+	int16_t     ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint16_t   i    = 0;
+	int16_t    VL53L1_p_002 = 0;
+
+	VL53L1_p_002 =  ip_value;
+
+	for (i = 0; i < count; i++) {
+		pbuffer[count-i-1] = (uint8_t)(VL53L1_p_002 & 0x00FF);
+		VL53L1_p_002 = VL53L1_p_002 >> 8;
+	}
+}
+
+int16_t VL53L1_i2c_decode_int16_t(
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	int16_t    value = 0x00;
+
+
+
+	if (*pbuffer >= 0x80)
+		value = 0xFFFF;
+
+	while (count-- > 0)
+		value = (value << 8) | (int16_t)*pbuffer++;
+
+	return value;
+}
+
+void VL53L1_i2c_encode_uint32_t(
+	uint32_t    ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint16_t   i    = 0;
+	uint32_t   VL53L1_p_002 = 0;
+
+	VL53L1_p_002 =  ip_value;
+
+	for (i = 0; i < count; i++) {
+		pbuffer[count-i-1] = (uint8_t)(VL53L1_p_002 & 0x00FF);
+		VL53L1_p_002 = VL53L1_p_002 >> 8;
+	}
+}
+
+uint32_t VL53L1_i2c_decode_uint32_t(
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint32_t   value = 0x00;
+
+	while (count-- > 0)
+		value = (value << 8) | (uint32_t)*pbuffer++;
+
+	return value;
+}
+
+
+uint32_t VL53L1_i2c_decode_with_mask(
+	uint16_t    count,
+	uint8_t    *pbuffer,
+	uint32_t    bit_mask,
+	uint32_t    down_shift,
+	uint32_t    offset)
+{
+
+
+
+
+
+
+	uint32_t   value = 0x00;
+
+
+
+	while (count-- > 0)
+		value = (value << 8) | (uint32_t)*pbuffer++;
+
+
+
+	value =  value & bit_mask;
+	if (down_shift > 0)
+		value = value >> down_shift;
+
+
+
+	value = value + offset;
+
+	return value;
+}
+
+
+void VL53L1_i2c_encode_int32_t(
+	int32_t     ip_value,
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	uint16_t   i    = 0;
+	int32_t    VL53L1_p_002 = 0;
+
+	VL53L1_p_002 =  ip_value;
+
+	for (i = 0; i < count; i++) {
+		pbuffer[count-i-1] = (uint8_t)(VL53L1_p_002 & 0x00FF);
+		VL53L1_p_002 = VL53L1_p_002 >> 8;
+	}
+}
+
+int32_t VL53L1_i2c_decode_int32_t(
+	uint16_t    count,
+	uint8_t    *pbuffer)
+{
+
+
+
+
+
+
+	int32_t    value = 0x00;
+
+
+
+	if (*pbuffer >= 0x80)
+		value = 0xFFFFFFFF;
+
+	while (count-- > 0)
+		value = (value << 8) | (int32_t)*pbuffer++;
+
+	return value;
+}
+
+
+VL53L1_Error VL53L1_start_test(
+	VL53L1_DEV    Dev,
+	uint8_t       test_mode__ctrl)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_TEST_MODE__CTRL,
+					test_mode__ctrl);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_firmware_enable_register(
+	VL53L1_DEV    Dev,
+	uint8_t       value)
+{
+
+
+
+
+
+	VL53L1_Error status         = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->sys_ctrl.firmware__enable = value;
+
+	status = VL53L1_WrByte(
+				Dev,
+				VL53L1_FIRMWARE__ENABLE,
+				pdev->sys_ctrl.firmware__enable);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_enable_firmware(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_set_firmware_enable_register(Dev, 0x01);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_disable_firmware(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_set_firmware_enable_register(Dev, 0x00);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_powerforce_register(
+	VL53L1_DEV    Dev,
+	uint8_t       value)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	pdev->sys_ctrl.power_management__go1_power_force = value;
+
+	status = VL53L1_WrByte(
+			Dev,
+			VL53L1_POWER_MANAGEMENT__GO1_POWER_FORCE,
+			pdev->sys_ctrl.power_management__go1_power_force);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_enable_powerforce(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_set_powerforce_register(Dev, 0x01);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_disable_powerforce(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_set_powerforce_register(Dev, 0x00);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_clear_interrupt(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->sys_ctrl.system__interrupt_clear = VL53L1_CLEAR_RANGE_INT;
+
+	status = VL53L1_WrByte(
+				Dev,
+				VL53L1_SYSTEM__INTERRUPT_CLEAR,
+				pdev->sys_ctrl.system__interrupt_clear);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_force_shadow_stream_count_to_zero(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_WrByte(
+				Dev,
+				VL53L1_SHADOW_RESULT__STREAM_COUNT,
+				0x00);
+	}
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	return status;
+}
+
+
+uint32_t VL53L1_calc_macro_period_us(
+	uint16_t  fast_osc_frequency,
+	uint8_t   VL53L1_p_009)
+{
+
+
+
+
+
+
+
+
+	uint32_t  pll_period_us        = 0;
+	uint8_t   VL53L1_p_031   = 0;
+	uint32_t  macro_period_us      = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pll_period_us = VL53L1_calc_pll_period_us(fast_osc_frequency);
+
+
+
+
+
+
+	VL53L1_p_031 = VL53L1_decode_vcsel_period(VL53L1_p_009);
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	macro_period_us =
+			(uint32_t)VL53L1_MACRO_PERIOD_VCSEL_PERIODS *
+			pll_period_us;
+	macro_period_us = macro_period_us >> 6;
+
+	macro_period_us = macro_period_us * (uint32_t)VL53L1_p_031;
+	macro_period_us = macro_period_us >> 6;
+
+
+
+
+
+
+
+
+
+
+
+
+
+	LOG_FUNCTION_END(0);
+
+	return macro_period_us;
+}
+
+
+uint16_t VL53L1_calc_range_ignore_threshold(
+	uint32_t central_rate,
+	int16_t  x_gradient,
+	int16_t  y_gradient,
+	uint8_t  rate_mult)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	int32_t    range_ignore_thresh_int  = 0;
+	uint16_t   range_ignore_thresh_kcps = 0;
+	int32_t    central_rate_int         = 0;
+	int16_t    x_gradient_int           = 0;
+	int16_t    y_gradient_int           = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	central_rate_int = ((int32_t)central_rate * (1 << 4)) / (1000);
+
+	if (x_gradient < 0)
+		x_gradient_int = x_gradient * -1;
+
+	if (y_gradient < 0)
+		y_gradient_int = y_gradient * -1;
+
+
+
+
+
+
+
+
+	range_ignore_thresh_int = (8 * x_gradient_int * 4) +
+			(8 * y_gradient_int * 4);
+
+
+
+
+	range_ignore_thresh_int = range_ignore_thresh_int / 1000;
+
+
+
+
+	range_ignore_thresh_int = range_ignore_thresh_int + central_rate_int;
+
+
+
+
+	range_ignore_thresh_int = (int32_t)rate_mult * range_ignore_thresh_int;
+
+	range_ignore_thresh_int = (range_ignore_thresh_int + (1<<4)) / (1<<5);
+
+
+
+
+	if (range_ignore_thresh_int > 0xFFFF)
+		range_ignore_thresh_kcps = 0xFFFF;
+	else
+		range_ignore_thresh_kcps = (uint16_t)range_ignore_thresh_int;
+
+
+
+
+
+
+
+	LOG_FUNCTION_END(0);
+
+	return range_ignore_thresh_kcps;
+}
+
+
+uint32_t VL53L1_calc_timeout_mclks(
+	uint32_t timeout_us,
+	uint32_t macro_period_us)
+{
+
+
+
+
+
+
+
+
+
+
+	uint32_t timeout_mclks   = 0;
+
+	LOG_FUNCTION_START("");
+
+	timeout_mclks   =
+			((timeout_us << 12) + (macro_period_us>>1)) /
+			macro_period_us;
+
+	LOG_FUNCTION_END(0);
+
+	return timeout_mclks;
+}
+
+
+uint16_t VL53L1_calc_encoded_timeout(
+	uint32_t timeout_us,
+	uint32_t macro_period_us)
+{
+
+
+
+
+
+
+
+
+
+
+	uint32_t timeout_mclks   = 0;
+	uint16_t timeout_encoded = 0;
+
+	LOG_FUNCTION_START("");
+
+	timeout_mclks   =
+		VL53L1_calc_timeout_mclks(timeout_us, macro_period_us);
+
+	timeout_encoded =
+		VL53L1_encode_timeout(timeout_mclks);
+
+
+
+
+
+
+
+
+
+
+	LOG_FUNCTION_END(0);
+
+	return timeout_encoded;
+}
+
+
+uint32_t VL53L1_calc_timeout_us(
+	uint32_t timeout_mclks,
+	uint32_t macro_period_us)
+{
+
+
+
+
+
+
+
+
+
+
+	uint32_t timeout_us     = 0;
+	uint64_t tmp            = 0;
+
+	LOG_FUNCTION_START("");
+
+	tmp  = (uint64_t)timeout_mclks * (uint64_t)macro_period_us;
+	tmp += 0x00800;
+	tmp  = tmp >> 12;
+
+	timeout_us = (uint32_t)tmp;
+
+
+
+
+
+
+
+
+
+
+
+	LOG_FUNCTION_END(0);
+
+	return timeout_us;
+}
+
+uint32_t VL53L1_calc_crosstalk_plane_offset_with_margin(
+		uint32_t     plane_offset_kcps,
+		int16_t      margin_offset_kcps)
+{
+	uint32_t plane_offset_with_margin = 0;
+	int32_t  plane_offset_kcps_temp   = 0;
+
+	LOG_FUNCTION_START("");
+
+	plane_offset_kcps_temp =
+		(int32_t)plane_offset_kcps +
+		(int32_t)margin_offset_kcps;
+
+	if (plane_offset_kcps_temp < 0)
+		plane_offset_kcps_temp = 0;
+	else
+		if (plane_offset_kcps_temp > 0x3FFFF)
+			plane_offset_kcps_temp = 0x3FFFF;
+
+	plane_offset_with_margin = (uint32_t) plane_offset_kcps_temp;
+
+	LOG_FUNCTION_END(0);
+
+	return plane_offset_with_margin;
+
+}
+
+uint32_t VL53L1_calc_decoded_timeout_us(
+	uint16_t timeout_encoded,
+	uint32_t macro_period_us)
+{
+
+
+
+
+
+
+
+
+
+
+	uint32_t timeout_mclks  = 0;
+	uint32_t timeout_us     = 0;
+
+	LOG_FUNCTION_START("");
+
+	timeout_mclks =
+		VL53L1_decode_timeout(timeout_encoded);
+
+	timeout_us    =
+		VL53L1_calc_timeout_us(timeout_mclks, macro_period_us);
+
+	LOG_FUNCTION_END(0);
+
+	return timeout_us;
+}
+
+
+uint16_t VL53L1_encode_timeout(uint32_t timeout_mclks)
+{
+
+
+
+
+
+	uint16_t encoded_timeout = 0;
+	uint32_t ls_byte = 0;
+	uint16_t ms_byte = 0;
+
+	if (timeout_mclks > 0) {
+		ls_byte = timeout_mclks - 1;
+
+		while ((ls_byte & 0xFFFFFF00) > 0) {
+			ls_byte = ls_byte >> 1;
+			ms_byte++;
+		}
+
+		encoded_timeout = (ms_byte << 8)
+				+ (uint16_t) (ls_byte & 0x000000FF);
+	}
+
+	return encoded_timeout;
+}
+
+
+uint32_t VL53L1_decode_timeout(uint16_t encoded_timeout)
+{
+
+
+
+
+
+
+	uint32_t timeout_macro_clks = 0;
+
+	timeout_macro_clks = ((uint32_t) (encoded_timeout & 0x00FF)
+			<< (uint32_t) ((encoded_timeout & 0xFF00) >> 8)) + 1;
+
+	return timeout_macro_clks;
+}
+
+
+VL53L1_Error VL53L1_calc_timeout_register_values(
+	uint32_t                 phasecal_config_timeout_us,
+	uint32_t                 mm_config_timeout_us,
+	uint32_t                 range_config_timeout_us,
+	uint16_t                 fast_osc_frequency,
+	VL53L1_general_config_t *pgeneral,
+	VL53L1_timing_config_t  *ptiming)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	uint32_t macro_period_us    = 0;
+	uint32_t timeout_mclks      = 0;
+	uint16_t timeout_encoded    = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (fast_osc_frequency == 0) {
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+	} else {
+
+
+		macro_period_us =
+				VL53L1_calc_macro_period_us(
+					fast_osc_frequency,
+					ptiming->range_config__vcsel_period_a);
+
+
+
+		timeout_mclks =
+			VL53L1_calc_timeout_mclks(
+				phasecal_config_timeout_us,
+				macro_period_us);
+
+
+
+		if (timeout_mclks > 0xFF)
+			timeout_mclks = 0xFF;
+
+		pgeneral->phasecal_config__timeout_macrop =
+				(uint8_t)timeout_mclks;
+
+
+
+		timeout_encoded =
+			VL53L1_calc_encoded_timeout(
+				mm_config_timeout_us,
+				macro_period_us);
+
+		ptiming->mm_config__timeout_macrop_a_hi =
+				(uint8_t)((timeout_encoded & 0xFF00) >> 8);
+		ptiming->mm_config__timeout_macrop_a_lo =
+				(uint8_t) (timeout_encoded & 0x00FF);
+
+
+
+		timeout_encoded =
+			VL53L1_calc_encoded_timeout(
+				range_config_timeout_us,
+				macro_period_us);
+
+		ptiming->range_config__timeout_macrop_a_hi =
+				(uint8_t)((timeout_encoded & 0xFF00) >> 8);
+		ptiming->range_config__timeout_macrop_a_lo =
+				(uint8_t) (timeout_encoded & 0x00FF);
+
+
+
+		macro_period_us =
+				VL53L1_calc_macro_period_us(
+					fast_osc_frequency,
+					ptiming->range_config__vcsel_period_b);
+
+
+
+		timeout_encoded =
+				VL53L1_calc_encoded_timeout(
+					mm_config_timeout_us,
+					macro_period_us);
+
+		ptiming->mm_config__timeout_macrop_b_hi =
+				(uint8_t)((timeout_encoded & 0xFF00) >> 8);
+		ptiming->mm_config__timeout_macrop_b_lo =
+				(uint8_t) (timeout_encoded & 0x00FF);
+
+
+
+		timeout_encoded = VL53L1_calc_encoded_timeout(
+							range_config_timeout_us,
+							macro_period_us);
+
+		ptiming->range_config__timeout_macrop_b_hi =
+				(uint8_t)((timeout_encoded & 0xFF00) >> 8);
+		ptiming->range_config__timeout_macrop_b_lo =
+				(uint8_t) (timeout_encoded & 0x00FF);
+	}
+
+	LOG_FUNCTION_END(0);
+
+	return status;
+
+}
+
+
+uint8_t VL53L1_encode_vcsel_period(uint8_t VL53L1_p_031)
+{
+
+
+
+
+
+
+	uint8_t vcsel_period_reg = 0;
+
+	vcsel_period_reg = (VL53L1_p_031 >> 1) - 1;
+
+	return vcsel_period_reg;
+}
+
+
+uint32_t VL53L1_decode_unsigned_integer(
+	uint8_t  *pbuffer,
+	uint8_t   no_of_bytes)
+{
+
+
+
+
+
+	uint8_t   i = 0;
+	uint32_t  decoded_value = 0;
+
+	for (i = 0; i < no_of_bytes; i++)
+		decoded_value = (decoded_value << 8) + (uint32_t)pbuffer[i];
+
+	return decoded_value;
+}
+
+
+void VL53L1_encode_unsigned_integer(
+	uint32_t  ip_value,
+	uint8_t   no_of_bytes,
+	uint8_t  *pbuffer)
+{
+
+
+
+
+
+	uint8_t   i    = 0;
+	uint32_t  VL53L1_p_002 = 0;
+
+	VL53L1_p_002 = ip_value;
+	for (i = 0; i < no_of_bytes; i++) {
+		pbuffer[no_of_bytes-i-1] = VL53L1_p_002 & 0x00FF;
+		VL53L1_p_002 = VL53L1_p_002 >> 8;
+	}
+}
+
+
+VL53L1_Error  VL53L1_hist_copy_and_scale_ambient_info(
+	VL53L1_zone_hist_info_t       *pidata,
+	VL53L1_histogram_bin_data_t   *podata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	int64_t  VL53L1_p_008            = 0;
+	int64_t  tmpi              = 0;
+	int64_t  tmpo              = 0;
+
+	LOG_FUNCTION_START("");
+
+
+	if (pidata->result__dss_actual_effective_spads == 0) {
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+	} else {
+		if (pidata->number_of_ambient_bins >  0 &&
+			podata->number_of_ambient_bins == 0) {
+
+
+
+
+
+
+
+
+
+
+			tmpo    = 1 + (int64_t)podata->total_periods_elapsed;
+			tmpo   *=
+			(int64_t)podata->result__dss_actual_effective_spads;
+
+			tmpi    = 1 + (int64_t)pidata->total_periods_elapsed;
+			tmpi   *=
+			(int64_t)pidata->result__dss_actual_effective_spads;
+
+			VL53L1_p_008  = tmpo *
+				(int64_t)pidata->ambient_events_sum;
+			VL53L1_p_008 += (tmpi/2);
+
+
+
+
+			VL53L1_p_008 = do_division_s(VL53L1_p_008, tmpi);
+
+			podata->ambient_events_sum = (int32_t)VL53L1_p_008;
+
+
+
+
+
+
+			podata->VL53L1_p_004 =
+					podata->ambient_events_sum;
+			podata->VL53L1_p_004 +=
+				((int32_t)pidata->number_of_ambient_bins / 2);
+			podata->VL53L1_p_004 /=
+				(int32_t)pidata->number_of_ambient_bins;
+		}
+	}
+
+	LOG_FUNCTION_END(0);
+
+	return status;
+}
+
+
+void  VL53L1_hist_get_bin_sequence_config(
+	VL53L1_DEV                     Dev,
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	int32_t amb_thresh_low   = 0;
+	int32_t amb_thresh_high  = 0;
+
+	uint8_t i = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	amb_thresh_low  = 1024 *
+		(int32_t)pdev->hist_cfg.histogram_config__amb_thresh_low;
+	amb_thresh_high = 1024 *
+		(int32_t)pdev->hist_cfg.histogram_config__amb_thresh_high;
+
+
+
+
+
+
+
+
+
+
+	if ((pdev->ll_state.rd_stream_count & 0x01) == 0) {
+
+		pdata->bin_seq[5] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_4_5 >> 4;
+		pdata->bin_seq[4] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_4_5 & 0x0F;
+		pdata->bin_seq[3] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_2_3 >> 4;
+		pdata->bin_seq[2] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_2_3 & 0x0F;
+		pdata->bin_seq[1] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_0_1 >> 4;
+		pdata->bin_seq[0] =
+		pdev->hist_cfg.histogram_config__mid_amb_even_bin_0_1 & 0x0F;
+
+		if (pdata->ambient_events_sum > amb_thresh_high) {
+			pdata->bin_seq[5] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_4_5
+			>> 4;
+			pdata->bin_seq[4] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_4_5
+			& 0x0F;
+			pdata->bin_seq[3] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_2_3
+			>> 4;
+			pdata->bin_seq[2] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_2_3
+			& 0x0F;
+			pdata->bin_seq[1] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_0_1
+			>> 4;
+			pdata->bin_seq[0] =
+			pdev->hist_cfg.histogram_config__high_amb_even_bin_0_1
+			& 0x0F;
+		}
+
+		if (pdata->ambient_events_sum < amb_thresh_low) {
+			pdata->bin_seq[5] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_4_5
+			>> 4;
+			pdata->bin_seq[4] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_4_5
+			& 0x0F;
+			pdata->bin_seq[3] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_2_3
+			>> 4;
+			pdata->bin_seq[2] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_2_3
+			& 0x0F;
+			pdata->bin_seq[1] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_0_1
+			>> 4;
+			pdata->bin_seq[0] =
+			pdev->hist_cfg.histogram_config__low_amb_even_bin_0_1
+			& 0x0F;
+		}
+
+	} else {
+		pdata->bin_seq[5] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_5
+			& 0x0F;
+		pdata->bin_seq[4] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_3_4
+			& 0x0F;
+		pdata->bin_seq[3] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_3_4
+			>> 4;
+		pdata->bin_seq[2] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_2 &
+			0x0F;
+		pdata->bin_seq[1] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_0_1
+			>> 4;
+		pdata->bin_seq[0] =
+			pdev->hist_cfg.histogram_config__mid_amb_odd_bin_0_1
+			& 0x0F;
+
+		if (pdata->ambient_events_sum > amb_thresh_high) {
+			pdata->bin_seq[5] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_4_5
+			>> 4;
+			pdata->bin_seq[4] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_4_5
+			& 0x0F;
+			pdata->bin_seq[3] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_2_3
+			>> 4;
+			pdata->bin_seq[2] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_2_3
+			& 0x0F;
+			pdata->bin_seq[1] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_0_1
+			>> 4;
+			pdata->bin_seq[0] =
+			pdev->hist_cfg.histogram_config__high_amb_odd_bin_0_1
+			& 0x0F;
+		}
+
+		if (pdata->ambient_events_sum < amb_thresh_low) {
+			pdata->bin_seq[5] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_4_5
+			>> 4;
+			pdata->bin_seq[4] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_4_5
+			& 0x0F;
+			pdata->bin_seq[3] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_2_3
+			>> 4;
+			pdata->bin_seq[2] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_2_3
+			& 0x0F;
+			pdata->bin_seq[1] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_0_1
+			>> 4;
+			pdata->bin_seq[0] =
+			pdev->hist_cfg.histogram_config__low_amb_odd_bin_0_1
+			& 0x0F;
+		}
+	}
+
+
+
+
+	for (i = 0; i < VL53L1_MAX_BIN_SEQUENCE_LENGTH; i++)
+		pdata->bin_rep[i] = 1;
+
+	LOG_FUNCTION_END(0);
+
+}
+
+
+VL53L1_Error  VL53L1_hist_phase_consistency_check(
+	VL53L1_DEV                   Dev,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_zone_objects_t       *prange_prev,
+	VL53L1_range_results_t      *prange_curr)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t   lc = 0;
+	uint8_t   p = 0;
+
+	uint16_t  phase_delta      = 0;
+	uint16_t  phase_tolerance  = 0;
+
+	int32_t   events_delta     = 0;
+	int32_t   events_tolerance = 0;
+
+
+
+	uint8_t event_sigma;
+	uint16_t event_min_spad_count;
+	uint16_t min_max_tolerance;
+	uint8_t pht;
+
+	VL53L1_DeviceError  range_status = 0;
+
+	LOG_FUNCTION_START("");
+
+	event_sigma =
+		pdev->histpostprocess.algo__consistency_check__event_sigma;
+	event_min_spad_count =
+	pdev->histpostprocess.algo__consistency_check__event_min_spad_count;
+	min_max_tolerance =
+	pdev->histpostprocess.algo__consistency_check__min_max_tolerance;
+
+
+
+	pht = pdev->histpostprocess.algo__consistency_check__phase_tolerance;
+	phase_tolerance = (uint16_t)pht;
+	phase_tolerance = phase_tolerance << 8;
+
+
+
+
+	if (prange_prev->rd_device_state !=
+			VL53L1_DEVICESTATE_RANGING_GATHER_DATA &&
+		prange_prev->rd_device_state !=
+				VL53L1_DEVICESTATE_RANGING_OUTPUT_DATA)
+		return status;
+
+
+
+
+	if (phase_tolerance == 0)
+		return status;
+
+	for (lc = 0; lc < prange_curr->active_results; lc++) {
+
+		if (!((prange_curr->VL53L1_p_002[lc].range_status ==
+			VL53L1_DEVICEERROR_RANGECOMPLETE) ||
+			(prange_curr->VL53L1_p_002[lc].range_status ==
+			VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK)))
+			continue;
+
+
+
+
+
+
+
+
+		if (prange_prev->active_objects == 0)
+			prange_curr->VL53L1_p_002[lc].range_status =
+			VL53L1_DEVICEERROR_PREV_RANGE_NO_TARGETS;
+		else
+			prange_curr->VL53L1_p_002[lc].range_status =
+				VL53L1_DEVICEERROR_PHASECONSISTENCY;
+
+
+
+
+
+
+
+
+
+
+		for (p = 0; p < prange_prev->active_objects; p++) {
+
+			if (prange_curr->VL53L1_p_002[lc].VL53L1_p_014 >
+				prange_prev->VL53L1_p_002[p].VL53L1_p_014) {
+				phase_delta =
+				prange_curr->VL53L1_p_002[lc].VL53L1_p_014 -
+				prange_prev->VL53L1_p_002[p].VL53L1_p_014;
+			} else {
+				phase_delta =
+				prange_prev->VL53L1_p_002[p].VL53L1_p_014 -
+				prange_curr->VL53L1_p_002[lc].VL53L1_p_014;
+			}
+
+			if (phase_delta < phase_tolerance) {
+
+
+
+
+
+
+
+
+
+
+				if (status == VL53L1_ERROR_NONE)
+					status =
+					VL53L1_hist_events_consistency_check(
+					event_sigma,
+					event_min_spad_count,
+					phist_prev,
+					&(prange_prev->VL53L1_p_002[p]),
+					&(prange_curr->VL53L1_p_002[lc]),
+					&events_tolerance,
+					&events_delta,
+					&range_status);
+
+
+
+
+
+
+
+
+
+				if (status == VL53L1_ERROR_NONE &&
+					range_status ==
+					VL53L1_DEVICEERROR_RANGECOMPLETE)
+					status =
+					VL53L1_hist_merged_pulse_check(
+					min_max_tolerance,
+					&(prange_curr->VL53L1_p_002[lc]),
+					&range_status);
+
+				prange_curr->VL53L1_p_002[lc].range_status =
+						range_status;
+			}
+		}
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error  VL53L1_hist_events_consistency_check(
+	uint8_t                      event_sigma,
+	uint16_t                     min_effective_spad_count,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_object_data_t        *prange_prev,
+	VL53L1_range_data_t         *prange_curr,
+	int32_t                     *pevents_tolerance,
+	int32_t                     *pevents_delta,
+	VL53L1_DeviceError          *prange_status)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	int64_t   tmpp                   = 0;
+	int64_t   tmpc                   = 0;
+	int64_t   events_scaler          = 0;
+	int64_t   events_scaler_sq       = 0;
+	int64_t   c_signal_events        = 0;
+	int64_t   c_sig_noise_sq         = 0;
+	int64_t   c_amb_noise_sq         = 0;
+	int64_t   p_amb_noise_sq         = 0;
+
+	int32_t   p_signal_events        = 0;
+	uint32_t  noise_sq_sum           = 0;
+
+
+
+
+	if (event_sigma == 0) {
+		*prange_status = VL53L1_DEVICEERROR_RANGECOMPLETE;
+		return status;
+	}
+
+
+
+
+	tmpp  = 1 + (int64_t)phist_prev->total_periods_elapsed;
+	tmpp *= (int64_t)phist_prev->result__dss_actual_effective_spads;
+
+
+
+
+	tmpc  = 1 + (int64_t)prange_curr->total_periods_elapsed;
+	tmpc *= (int64_t)prange_curr->VL53L1_p_006;
+
+
+
+
+	events_scaler  = tmpp * 4096;
+	events_scaler += (tmpc/2);
+	events_scaler  = do_division_s(events_scaler, tmpc);
+
+	events_scaler_sq  = events_scaler * events_scaler;
+	events_scaler_sq += 2048;
+	events_scaler_sq /= 4096;
+
+
+
+
+	c_signal_events  = (int64_t)prange_curr->VL53L1_p_021;
+	c_signal_events -= (int64_t)prange_curr->VL53L1_p_020;
+	c_signal_events *= (int64_t)events_scaler;
+	c_signal_events += 2048;
+	c_signal_events /= 4096;
+
+	c_sig_noise_sq  = (int64_t)events_scaler_sq;
+	c_sig_noise_sq *= (int64_t)prange_curr->VL53L1_p_021;
+	c_sig_noise_sq += 2048;
+	c_sig_noise_sq /= 4096;
+
+	c_amb_noise_sq  = (int64_t)events_scaler_sq;
+	c_amb_noise_sq *= (int64_t)prange_curr->VL53L1_p_020;
+	c_amb_noise_sq += 2048;
+	c_amb_noise_sq /= 4096;
+
+
+
+	c_amb_noise_sq += 2;
+	c_amb_noise_sq /= 4;
+
+
+
+
+
+
+
+	p_amb_noise_sq  =
+		(int64_t)prange_prev->VL53L1_p_020;
+
+
+
+	p_amb_noise_sq += 2;
+	p_amb_noise_sq /= 4;
+
+	noise_sq_sum =
+		(uint32_t)prange_prev->VL53L1_p_021 +
+		(uint32_t)c_sig_noise_sq +
+		(uint32_t)p_amb_noise_sq +
+		(uint32_t)c_amb_noise_sq;
+
+	*pevents_tolerance =
+		(int32_t)VL53L1_isqrt(noise_sq_sum * 16);
+
+	*pevents_tolerance *= (int32_t)event_sigma;
+	*pevents_tolerance += 32;
+	*pevents_tolerance /= 64;
+
+	p_signal_events  = (int32_t)prange_prev->VL53L1_p_021;
+	p_signal_events -= (int32_t)prange_prev->VL53L1_p_020;
+
+	if ((int32_t)c_signal_events > p_signal_events)
+		*pevents_delta =
+			(int32_t)c_signal_events - p_signal_events;
+	else
+		*pevents_delta =
+			p_signal_events - (int32_t)c_signal_events;
+
+	if (*pevents_delta > *pevents_tolerance &&
+		prange_curr->VL53L1_p_006 > min_effective_spad_count)
+		*prange_status = VL53L1_DEVICEERROR_EVENTCONSISTENCY;
+	else
+		*prange_status = VL53L1_DEVICEERROR_RANGECOMPLETE;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_merged_pulse_check(
+	int16_t                      min_max_tolerance_mm,
+	VL53L1_range_data_t         *pdata,
+	VL53L1_DeviceError          *prange_status)
+{
+
+
+
+
+
+
+	VL53L1_Error  status   = VL53L1_ERROR_NONE;
+	int16_t       delta_mm = 0;
+
+	if (pdata->max_range_mm > pdata->min_range_mm)
+		delta_mm =
+			pdata->max_range_mm - pdata->min_range_mm;
+	else
+		delta_mm =
+			pdata->min_range_mm - pdata->max_range_mm;
+
+	if (min_max_tolerance_mm > 0 &&
+		delta_mm > min_max_tolerance_mm)
+		*prange_status = VL53L1_DEVICEERROR_RANGECOMPLETE_MERGED_PULSE;
+	else
+		*prange_status = VL53L1_DEVICEERROR_RANGECOMPLETE;
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_xmonitor_consistency_check(
+	VL53L1_DEV                   Dev,
+	VL53L1_zone_hist_info_t     *phist_prev,
+	VL53L1_zone_objects_t       *prange_prev,
+	VL53L1_range_data_t         *prange_curr)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev =
+		VL53L1DevStructGetLLDriverHandle(Dev);
+
+	int32_t   events_delta     = 0;
+	int32_t   events_tolerance = 0;
+	uint8_t event_sigma;
+	uint16_t min_spad_count;
+
+	event_sigma = pdev->histpostprocess.algo__crosstalk_detect_event_sigma;
+	min_spad_count =
+	pdev->histpostprocess.algo__consistency_check__event_min_spad_count;
+
+	if (prange_curr->range_status == VL53L1_DEVICEERROR_RANGECOMPLETE ||
+		prange_curr->range_status ==
+			VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK ||
+		prange_curr->range_status ==
+				VL53L1_DEVICEERROR_EVENTCONSISTENCY) {
+
+		if (prange_prev->xmonitor.range_status ==
+				VL53L1_DEVICEERROR_RANGECOMPLETE ||
+			prange_prev->xmonitor.range_status ==
+			VL53L1_DEVICEERROR_RANGECOMPLETE_NO_WRAP_CHECK ||
+			prange_prev->xmonitor.range_status ==
+				VL53L1_DEVICEERROR_EVENTCONSISTENCY) {
+
+			prange_curr->range_status =
+					VL53L1_DEVICEERROR_RANGECOMPLETE;
+
+			status =
+				VL53L1_hist_events_consistency_check(
+					event_sigma,
+					min_spad_count,
+					phist_prev,
+					&(prange_prev->xmonitor),
+					prange_curr,
+					&events_tolerance,
+					&events_delta,
+					&(prange_curr->range_status));
+
+		}
+	}
+
+	return status;
+}
+
+
+
+
+
+VL53L1_Error  VL53L1_hist_wrap_dmax(
+	VL53L1_hist_post_process_config_t  *phistpostprocess,
+	VL53L1_histogram_bin_data_t        *pcurrent,
+	int16_t                            *pwrap_dmax_mm)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint32_t  pll_period_mm        = 0;
+	uint32_t  wrap_dmax_phase      = 0;
+	uint32_t  range_mm             = 0;
+
+	LOG_FUNCTION_START("");
+
+	*pwrap_dmax_mm = 0;
+
+
+	if (pcurrent->VL53L1_p_019 != 0) {
+
+
+
+
+		pll_period_mm =
+			VL53L1_calc_pll_period_mm(
+				pcurrent->VL53L1_p_019);
+
+
+
+
+		wrap_dmax_phase =
+			(uint32_t)phistpostprocess->valid_phase_high << 8;
+
+
+
+
+
+		range_mm = wrap_dmax_phase * pll_period_mm;
+		range_mm = (range_mm + (1<<14)) >> 15;
+
+		*pwrap_dmax_mm = (int16_t)range_mm;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+void VL53L1_hist_combine_mm1_mm2_offsets(
+	int16_t                               mm1_offset_mm,
+	int16_t                               mm2_offset_mm,
+	uint8_t                               encoded_mm_roi_centre,
+	uint8_t                               encoded_mm_roi_size,
+	uint8_t                               encoded_zone_centre,
+	uint8_t                               encoded_zone_size,
+	VL53L1_additional_offset_cal_data_t  *pcal_data,
+	uint8_t                              *pgood_spads,
+	uint16_t                              aperture_attenuation,
+	int16_t                               *prange_offset_mm)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint16_t max_mm_inner_effective_spads = 0;
+	uint16_t max_mm_outer_effective_spads = 0;
+	uint16_t mm_inner_effective_spads     = 0;
+	uint16_t mm_outer_effective_spads     = 0;
+
+	uint32_t scaled_mm1_peak_rate_mcps    = 0;
+	uint32_t scaled_mm2_peak_rate_mcps    = 0;
+
+	int32_t tmp0 = 0;
+	int32_t tmp1 = 0;
+
+
+
+
+	VL53L1_calc_mm_effective_spads(
+		encoded_mm_roi_centre,
+		encoded_mm_roi_size,
+		0xC7,
+
+		0xFF,
+		pgood_spads,
+		aperture_attenuation,
+		&max_mm_inner_effective_spads,
+		&max_mm_outer_effective_spads);
+
+
+
+
+	VL53L1_calc_mm_effective_spads(
+		encoded_mm_roi_centre,
+		encoded_mm_roi_size,
+		encoded_zone_centre,
+		encoded_zone_size,
+		pgood_spads,
+		aperture_attenuation,
+		&mm_inner_effective_spads,
+		&mm_outer_effective_spads);
+
+
+
+
+	scaled_mm1_peak_rate_mcps  =
+	(uint32_t)pcal_data->result__mm_inner_peak_signal_count_rtn_mcps;
+	scaled_mm1_peak_rate_mcps *= (uint32_t)mm_inner_effective_spads;
+	scaled_mm1_peak_rate_mcps /= (uint32_t)max_mm_inner_effective_spads;
+
+	scaled_mm2_peak_rate_mcps  =
+	(uint32_t)pcal_data->result__mm_outer_peak_signal_count_rtn_mcps;
+	scaled_mm2_peak_rate_mcps *= (uint32_t)mm_outer_effective_spads;
+	scaled_mm2_peak_rate_mcps /= (uint32_t)max_mm_outer_effective_spads;
+
+
+
+
+	tmp0  = ((int32_t)mm1_offset_mm * (int32_t)scaled_mm1_peak_rate_mcps);
+	tmp0 += ((int32_t)mm2_offset_mm * (int32_t)scaled_mm2_peak_rate_mcps);
+
+	tmp1 =  (int32_t)scaled_mm1_peak_rate_mcps +
+			(int32_t)scaled_mm2_peak_rate_mcps;
+
+
+
+
+
+
+	if (tmp1 != 0)
+		tmp0 = (tmp0 * 4) / tmp1;
+
+	*prange_offset_mm = (int16_t)tmp0;
+
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_window(
+	int16_t                             target_distance_mm,
+	uint16_t                            target_width_oversize,
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	pxtalk_data->pll_period_mm =
+		VL53L1_calc_pll_period_mm(phist_bins->VL53L1_p_019);
+
+
+
+	pxtalk_data->xtalk_width_phase =
+		(int32_t)phist_bins->vcsel_width * 128;
+	pxtalk_data->target_width_phase =
+		pxtalk_data->xtalk_width_phase +
+		(int32_t)target_width_oversize * 128;
+
+
+
+
+
+
+
+	pxtalk_data->xtalk_start_phase =
+		(int32_t)phist_bins->zero_distance_phase -
+		(pxtalk_data->xtalk_width_phase / 2);
+	pxtalk_data->xtalk_end_phase  =
+		(int32_t)pxtalk_data->xtalk_start_phase +
+		pxtalk_data->xtalk_width_phase;
+
+	if (pxtalk_data->xtalk_start_phase < 0)
+		pxtalk_data->xtalk_start_phase = 0;
+
+
+
+
+
+
+
+
+	pxtalk_data->VL53L1_p_015 =
+		(uint8_t)(pxtalk_data->xtalk_start_phase / 2048);
+
+
+
+	pxtalk_data->VL53L1_p_016 =
+		(uint8_t)((pxtalk_data->xtalk_end_phase + 2047) / 2048);
+
+
+
+
+
+
+
+	pxtalk_data->target_start_phase  =
+			(int32_t)target_distance_mm * 2048 * 16;
+	pxtalk_data->target_start_phase +=
+			((int32_t)pxtalk_data->pll_period_mm / 2);
+	pxtalk_data->target_start_phase /= (int32_t)pxtalk_data->pll_period_mm;
+	pxtalk_data->target_start_phase +=
+			(int32_t)phist_bins->zero_distance_phase;
+
+
+
+
+
+
+	pxtalk_data->target_start_phase -=
+			(pxtalk_data->target_width_phase / 2);
+	pxtalk_data->target_end_phase  =
+		(int32_t)pxtalk_data->target_start_phase +
+		pxtalk_data->target_width_phase;
+
+	if (pxtalk_data->target_start_phase < 0)
+		pxtalk_data->target_start_phase = 0;
+
+
+
+	pxtalk_data->target_start =
+		(uint8_t)(pxtalk_data->target_start_phase / 2048);
+
+
+
+	if (pxtalk_data->VL53L1_p_016 > (pxtalk_data->target_start-1))
+		pxtalk_data->VL53L1_p_016 = pxtalk_data->target_start-1;
+
+
+
+	pxtalk_data->effective_width =
+			(2048 * ((int32_t)pxtalk_data->VL53L1_p_016+1));
+	pxtalk_data->effective_width -= pxtalk_data->xtalk_start_phase;
+
+
+
+
+
+	if (pxtalk_data->effective_width > pxtalk_data->xtalk_width_phase)
+		pxtalk_data->effective_width = pxtalk_data->xtalk_width_phase;
+
+	if (pxtalk_data->effective_width < 1)
+		pxtalk_data->effective_width = 1;
+
+
+
+	pxtalk_data->event_scaler  =  pxtalk_data->xtalk_width_phase * 1000;
+	pxtalk_data->event_scaler +=  (pxtalk_data->effective_width / 2);
+	pxtalk_data->event_scaler /=  pxtalk_data->effective_width;
+
+
+
+
+
+	if (pxtalk_data->event_scaler < 1000)
+		pxtalk_data->event_scaler = 1000;
+
+	if (pxtalk_data->event_scaler > 4000)
+		pxtalk_data->event_scaler = 4000;
+
+
+
+	pxtalk_data->event_scaler_sum += pxtalk_data->event_scaler;
+
+
+
+	pxtalk_data->peak_duration_us_sum +=
+		(uint32_t)phist_bins->peak_duration_us;
+
+
+
+	pxtalk_data->effective_spad_count_sum +=
+		(uint32_t)phist_bins->result__dss_actual_effective_spads;
+
+
+
+	pxtalk_data->zero_distance_phase_sum +=
+		(uint32_t)phist_bins->zero_distance_phase;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_event_sums(
+	VL53L1_histogram_bin_data_t        *phist_bins,
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint8_t   lb = 0;
+	uint8_t   i = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	for (lb  = pxtalk_data->VL53L1_p_015;
+		 lb <= pxtalk_data->VL53L1_p_016;
+		 lb++) {
+
+
+
+		i = (lb + phist_bins->number_of_ambient_bins +
+			phist_bins->VL53L1_p_024) %
+					phist_bins->VL53L1_p_024;
+
+
+
+		pxtalk_data->signal_events_sum += phist_bins->bin_data[i];
+		pxtalk_data->signal_events_sum -=
+				phist_bins->VL53L1_p_004;
+	}
+
+
+
+
+	for (lb  = 0; lb < VL53L1_XTALK_HISTO_BINS  &&
+			lb < phist_bins->VL53L1_p_024; lb++) {
+
+
+
+		i = (lb + phist_bins->number_of_ambient_bins +
+			phist_bins->VL53L1_p_024) %
+					phist_bins->VL53L1_p_024;
+
+
+
+		pxtalk_data->bin_data_sums[lb] += phist_bins->bin_data[i];
+		pxtalk_data->bin_data_sums[lb] -=
+				phist_bins->VL53L1_p_004;
+	}
+
+	pxtalk_data->sample_count += 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_rate_per_spad(
+	VL53L1_hist_xtalk_extract_data_t   *pxtalk_data)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint64_t tmp64_0        = 0;
+	uint64_t tmp64_1        = 0;
+	uint64_t xtalk_per_spad = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	tmp64_0 =
+		((uint64_t)pxtalk_data->signal_events_sum *
+		 (uint64_t)pxtalk_data->sample_count *
+		 (uint64_t)pxtalk_data->event_scaler_avg * 256U) << 9U;
+	tmp64_1 =
+		(uint64_t)pxtalk_data->effective_spad_count_sum *
+		(uint64_t)pxtalk_data->peak_duration_us_sum;
+
+
+
+
+	if (tmp64_1 > 0U) {
+
+
+		tmp64_0 = tmp64_0 + (tmp64_1 >> 1U);
+		xtalk_per_spad = do_division_u(tmp64_0, tmp64_1);
+	} else {
+		xtalk_per_spad = (uint64_t)tmp64_0;
+	}
+
+	pxtalk_data->xtalk_rate_kcps_per_spad = (uint32_t)xtalk_per_spad;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_extract_calc_shape(
+	VL53L1_hist_xtalk_extract_data_t  *pxtalk_data,
+	VL53L1_xtalk_histogram_shape_t    *pxtalk_shape)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	int32_t  lb = 0;
+	uint64_t total_events    = 0U;
+	uint64_t tmp64_0         = 0U;
+	int32_t  remaining_area  = 1024;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pxtalk_shape->VL53L1_p_022      = 0;
+	pxtalk_shape->VL53L1_p_023    = VL53L1_XTALK_HISTO_BINS;
+	pxtalk_shape->VL53L1_p_024 = VL53L1_XTALK_HISTO_BINS;
+
+	pxtalk_shape->zero_distance_phase =
+		(uint16_t)pxtalk_data->zero_distance_phase_avg;
+	pxtalk_shape->phasecal_result__reference_phase =
+		(uint16_t)pxtalk_data->zero_distance_phase_avg + (3*2048);
+
+
+
+
+	if (pxtalk_data->signal_events_sum > 0)
+		total_events =
+			(uint64_t)pxtalk_data->signal_events_sum *
+			(uint64_t)pxtalk_data->event_scaler_avg;
+	else
+		total_events = 1;
+
+
+
+	remaining_area  = 1024;
+	pxtalk_data->max_shape_value = 0;
+
+	for (lb = 0; lb < VL53L1_XTALK_HISTO_BINS; lb++) {
+
+		if ((lb < (int32_t)pxtalk_data->VL53L1_p_015 ||
+			 lb > (int32_t)pxtalk_data->VL53L1_p_016)  ||
+				pxtalk_data->bin_data_sums[lb] < 0) {
+
+
+
+
+
+
+			if (remaining_area > 0 && remaining_area < 1024) {
+				if (remaining_area >
+					pxtalk_data->max_shape_value) {
+					pxtalk_shape->bin_data[lb] =
+					(uint32_t)pxtalk_data->max_shape_value;
+					remaining_area -=
+						pxtalk_data->max_shape_value;
+				} else {
+					pxtalk_shape->bin_data[lb] =
+						(uint32_t)remaining_area;
+					remaining_area = 0;
+				}
+			} else {
+				pxtalk_shape->bin_data[lb] = 0;
+			}
+
+		} else {
+
+
+
+
+			tmp64_0 =
+				(uint64_t)pxtalk_data->bin_data_sums[lb]
+							* 1024U * 1000U;
+			tmp64_0 += (total_events >> 1);
+			tmp64_0 = do_division_u(tmp64_0, total_events);
+			if (tmp64_0 > 0xFFFFU)
+				tmp64_0 = 0xFFFFU;
+
+			pxtalk_shape->bin_data[lb] = (uint32_t)tmp64_0;
+
+
+
+
+
+			if ((int32_t)pxtalk_shape->bin_data[lb] >
+				pxtalk_data->max_shape_value)
+				pxtalk_data->max_shape_value =
+					(int32_t)pxtalk_shape->bin_data[lb];
+
+			remaining_area -= (int32_t)pxtalk_shape->bin_data[lb];
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_hist_xtalk_shape_model(
+	uint16_t                         events_per_bin,
+	uint16_t                         pulse_centre,
+	uint16_t                         pulse_width,
+	VL53L1_xtalk_histogram_shape_t  *pxtalk_shape)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint32_t phase_start  = 0;
+	uint32_t phase_stop   = 0;
+	uint32_t phase_bin    = 0;
+
+	uint32_t bin_start    = 0;
+	uint32_t bin_stop     = 0;
+
+	uint32_t  lb           = 0;
+	uint16_t  VL53L1_p_008      = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pxtalk_shape->VL53L1_p_022      = 0;
+	pxtalk_shape->VL53L1_p_023    = VL53L1_XTALK_HISTO_BINS;
+	pxtalk_shape->VL53L1_p_024 = VL53L1_XTALK_HISTO_BINS;
+
+	pxtalk_shape->zero_distance_phase              = pulse_centre;
+	pxtalk_shape->phasecal_result__reference_phase =
+			pulse_centre + (3*2048);
+
+
+
+	if (pulse_centre > (pulse_width >> 1))
+		phase_start = (uint32_t)pulse_centre -
+			((uint32_t)pulse_width >> 1);
+	else
+		phase_start = 0;
+
+	phase_stop = (uint32_t)pulse_centre  +
+			((uint32_t)pulse_width >> 1);
+
+
+
+	bin_start = (phase_start / 2048);
+	bin_stop  = (phase_stop  / 2048);
+
+	for (lb = 0; lb < VL53L1_XTALK_HISTO_BINS; lb++) {
+		VL53L1_p_008 = 0;
+
+
+
+		if (lb == bin_start && lb == bin_stop) {
+			VL53L1_p_008 =
+			VL53L1_hist_xtalk_shape_model_interp(
+				events_per_bin,
+				phase_stop - phase_start);
+
+		} else if (lb > bin_start && lb < bin_stop) {
+
+
+
+			VL53L1_p_008 = events_per_bin;
+
+		} else if (lb == bin_start) {
+
+
+
+			phase_bin = (lb + 1) * 2048;
+			VL53L1_p_008 =
+			VL53L1_hist_xtalk_shape_model_interp(
+				events_per_bin,
+				(phase_bin - phase_start));
+
+		} else if (lb == bin_stop) {
+
+
+
+			phase_bin = lb * 2048;
+			VL53L1_p_008 =
+			VL53L1_hist_xtalk_shape_model_interp(
+				events_per_bin,
+				(phase_stop - phase_bin));
+		}
+
+		pxtalk_shape->bin_data[lb] = VL53L1_p_008;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+uint16_t VL53L1_hist_xtalk_shape_model_interp(
+	uint16_t      events_per_bin,
+	uint32_t      phase_delta)
+{
+
+
+
+
+
+
+
+
+
+	uint32_t  VL53L1_p_008  = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+	VL53L1_p_008  = (uint32_t)events_per_bin * phase_delta;
+	VL53L1_p_008 +=  1024;
+	VL53L1_p_008 /=  2048;
+
+
+
+	if (VL53L1_p_008 > 0xFFFFU)
+		VL53L1_p_008 = 0xFFFFU;
+
+	LOG_FUNCTION_END(0);
+
+	return (uint16_t)VL53L1_p_008;
+}
+
+
+void VL53L1_spad_number_to_byte_bit_index(
+	uint8_t  spad_number,
+	uint8_t *pbyte_index,
+	uint8_t *pbit_index,
+	uint8_t *pbit_mask)
+{
+
+
+
+
+
+
+
+
+
+
+	*pbyte_index  = spad_number >> 3;
+	*pbit_index   = spad_number & 0x07;
+	*pbit_mask    = 0x01 << *pbit_index;
+
+}
+
+
+void VL53L1_encode_row_col(
+	uint8_t  row,
+	uint8_t  col,
+	uint8_t *pspad_number)
+{
+
+
+
+
+
+	if (row > 7)
+		*pspad_number = 128 + (col << 3) + (15-row);
+	else
+		*pspad_number = ((15-col) << 3) + row;
+
+}
+
+
+void VL53L1_decode_zone_size(
+	uint8_t  encoded_xy_size,
+	uint8_t  *pwidth,
+	uint8_t  *pheight)
+{
+
+
+
+
+
+
+
+
+
+
+
+	*pheight = encoded_xy_size >> 4;
+	*pwidth  = encoded_xy_size & 0x0F;
+
+}
+
+
+void VL53L1_encode_zone_size(
+	uint8_t  width,
+	uint8_t  height,
+	uint8_t *pencoded_xy_size)
+{
+
+
+
+
+
+
+
+
+
+
+	*pencoded_xy_size = (height << 4) + width;
+
+}
+
+
+void VL53L1_decode_zone_limits(
+	uint8_t   encoded_xy_centre,
+	uint8_t   encoded_xy_size,
+	int16_t  *px_ll,
+	int16_t  *py_ll,
+	int16_t  *px_ur,
+	int16_t  *py_ur)
+{
+
+
+
+
+
+
+
+
+
+	uint8_t x_centre = 0;
+	uint8_t y_centre = 0;
+	uint8_t width    = 0;
+	uint8_t height   = 0;
+
+
+
+
+	VL53L1_decode_row_col(
+		encoded_xy_centre,
+		&y_centre,
+		&x_centre);
+
+	VL53L1_decode_zone_size(
+		encoded_xy_size,
+		&width,
+		&height);
+
+
+
+
+	*px_ll = (int16_t)x_centre - ((int16_t)width + 1) / 2;
+	if (*px_ll < 0)
+		*px_ll = 0;
+
+	*px_ur = *px_ll + (int16_t)width;
+	if (*px_ur > (VL53L1_SPAD_ARRAY_WIDTH-1))
+		*px_ur = VL53L1_SPAD_ARRAY_WIDTH-1;
+
+	*py_ll = (int16_t)y_centre - ((int16_t)height + 1) / 2;
+	if (*py_ll < 0)
+		*py_ll = 0;
+
+	*py_ur = *py_ll + (int16_t)height;
+	if (*py_ur > (VL53L1_SPAD_ARRAY_HEIGHT-1))
+		*py_ur = VL53L1_SPAD_ARRAY_HEIGHT-1;
+}
+
+
+uint8_t VL53L1_is_aperture_location(
+	uint8_t row,
+	uint8_t col)
+{
+
+
+
+
+
+	uint8_t is_aperture = 0;
+	uint8_t mod_row     = row % 4;
+	uint8_t mod_col     = col % 4;
+
+	if (mod_row == 0 && mod_col == 2)
+		is_aperture = 1;
+
+	if (mod_row == 2 && mod_col == 0)
+		is_aperture = 1;
+
+	return is_aperture;
+}
+
+
+void VL53L1_calc_max_effective_spads(
+	uint8_t     encoded_zone_centre,
+	uint8_t     encoded_zone_size,
+	uint8_t    *pgood_spads,
+	uint16_t    aperture_attenuation,
+	uint16_t   *pmax_effective_spads)
+{
+
+
+
+
+
+
+	int16_t   x         = 0;
+	int16_t   y         = 0;
+
+	int16_t   zone_x_ll = 0;
+	int16_t   zone_y_ll = 0;
+	int16_t   zone_x_ur = 0;
+	int16_t   zone_y_ur = 0;
+
+	uint8_t   spad_number = 0;
+	uint8_t   byte_index  = 0;
+	uint8_t   bit_index   = 0;
+	uint8_t   bit_mask    = 0;
+
+	uint8_t   is_aperture = 0;
+
+
+
+
+	VL53L1_decode_zone_limits(
+		encoded_zone_centre,
+		encoded_zone_size,
+		&zone_x_ll,
+		&zone_y_ll,
+		&zone_x_ur,
+		&zone_y_ur);
+
+
+
+
+
+
+
+	*pmax_effective_spads = 0;
+
+	for (y = zone_y_ll; y <= zone_y_ur; y++) {
+		for (x = zone_x_ll; x <= zone_x_ur; x++) {
+
+
+
+
+			VL53L1_encode_row_col(
+				(uint8_t)y,
+				(uint8_t)x,
+				&spad_number);
+
+
+
+
+
+
+
+
+			VL53L1_spad_number_to_byte_bit_index(
+				spad_number,
+				&byte_index,
+				&bit_index,
+				&bit_mask);
+
+
+
+
+			if ((pgood_spads[byte_index] & bit_mask) > 0) {
+
+
+
+				is_aperture = VL53L1_is_aperture_location(
+					(uint8_t)y,
+					(uint8_t)x);
+
+				if (is_aperture > 0)
+					*pmax_effective_spads +=
+							aperture_attenuation;
+				else
+					*pmax_effective_spads += 0x0100;
+
+			}
+		}
+	}
+}
+
+
+void VL53L1_calc_mm_effective_spads(
+	uint8_t     encoded_mm_roi_centre,
+	uint8_t     encoded_mm_roi_size,
+	uint8_t     encoded_zone_centre,
+	uint8_t     encoded_zone_size,
+	uint8_t    *pgood_spads,
+	uint16_t    aperture_attenuation,
+	uint16_t   *pmm_inner_effective_spads,
+	uint16_t   *pmm_outer_effective_spads)
+{
+
+
+
+
+
+
+
+	int16_t   x         = 0;
+	int16_t   y         = 0;
+
+	int16_t   mm_x_ll   = 0;
+	int16_t   mm_y_ll   = 0;
+	int16_t   mm_x_ur   = 0;
+	int16_t   mm_y_ur   = 0;
+
+	int16_t   zone_x_ll = 0;
+	int16_t   zone_y_ll = 0;
+	int16_t   zone_x_ur = 0;
+	int16_t   zone_y_ur = 0;
+
+	uint8_t   spad_number = 0;
+	uint8_t   byte_index  = 0;
+	uint8_t   bit_index   = 0;
+	uint8_t   bit_mask    = 0;
+
+	uint8_t   is_aperture = 0;
+	uint16_t  spad_attenuation = 0;
+
+
+
+
+	VL53L1_decode_zone_limits(
+		encoded_mm_roi_centre,
+		encoded_mm_roi_size,
+		&mm_x_ll,
+		&mm_y_ll,
+		&mm_x_ur,
+		&mm_y_ur);
+
+	VL53L1_decode_zone_limits(
+		encoded_zone_centre,
+		encoded_zone_size,
+		&zone_x_ll,
+		&zone_y_ll,
+		&zone_x_ur,
+		&zone_y_ur);
+
+
+
+
+
+
+
+
+
+	*pmm_inner_effective_spads = 0;
+	*pmm_outer_effective_spads = 0;
+
+	for (y = zone_y_ll; y <= zone_y_ur; y++) {
+		for (x = zone_x_ll; x <= zone_x_ur; x++) {
+
+
+
+
+			VL53L1_encode_row_col(
+				(uint8_t)y,
+				(uint8_t)x,
+				&spad_number);
+
+
+
+
+
+
+
+
+			VL53L1_spad_number_to_byte_bit_index(
+				spad_number,
+				&byte_index,
+				&bit_index,
+				&bit_mask);
+
+
+
+
+			if ((pgood_spads[byte_index] & bit_mask) > 0) {
+
+
+
+				is_aperture = VL53L1_is_aperture_location(
+					(uint8_t)y,
+					(uint8_t)x);
+
+				if (is_aperture > 0)
+					spad_attenuation = aperture_attenuation;
+				else
+					spad_attenuation = 0x0100;
+
+
+
+
+
+
+
+				if (x >= mm_x_ll && x <= mm_x_ur &&
+					y >= mm_y_ll && y <= mm_y_ur)
+					*pmm_inner_effective_spads +=
+						spad_attenuation;
+				else
+					*pmm_outer_effective_spads +=
+						spad_attenuation;
+			}
+		}
+	}
+}
+
+
+void VL53L1_hist_copy_results_to_sys_and_core(
+	VL53L1_histogram_bin_data_t      *pbins,
+	VL53L1_range_results_t           *phist,
+	VL53L1_system_results_t          *psys,
+	VL53L1_core_results_t            *pcore)
+{
+
+
+
+
+
+	uint8_t  i = 0;
+
+	VL53L1_range_data_t  *pdata;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	VL53L1_init_system_results(psys);
+
+
+
+
+	psys->result__interrupt_status = pbins->result__interrupt_status;
+	psys->result__range_status     = phist->active_results;
+	psys->result__report_status    = pbins->result__report_status;
+	psys->result__stream_count     = pbins->result__stream_count;
+
+	pdata = &(phist->VL53L1_p_002[0]);
+
+	for (i = 0; i < phist->active_results; i++) {
+
+		switch (i) {
+		case 0:
+			psys->result__dss_actual_effective_spads_sd0 =
+					pdata->VL53L1_p_006;
+			psys->result__peak_signal_count_rate_mcps_sd0 =
+					pdata->peak_signal_count_rate_mcps;
+			psys->result__avg_signal_count_rate_mcps_sd0 =
+					pdata->avg_signal_count_rate_mcps;
+			psys->result__ambient_count_rate_mcps_sd0 =
+					pdata->ambient_count_rate_mcps;
+
+			psys->result__sigma_sd0 = pdata->VL53L1_p_005;
+			psys->result__phase_sd0 = pdata->VL53L1_p_014;
+
+			psys->result__final_crosstalk_corrected_range_mm_sd0 =
+					(uint16_t)pdata->median_range_mm;
+
+			psys->result__phase_sd1  = pdata->zero_distance_phase;
+
+			pcore->result_core__ranging_total_events_sd0 =
+					pdata->VL53L1_p_021;
+			pcore->result_core__signal_total_events_sd0 =
+					pdata->VL53L1_p_013;
+			pcore->result_core__total_periods_elapsed_sd0 =
+					pdata->total_periods_elapsed;
+			pcore->result_core__ambient_window_events_sd0 =
+					pdata->VL53L1_p_020;
+
+			break;
+		case 1:
+			psys->result__dss_actual_effective_spads_sd1 =
+				pdata->VL53L1_p_006;
+			psys->result__peak_signal_count_rate_mcps_sd1 =
+				pdata->peak_signal_count_rate_mcps;
+			psys->result__ambient_count_rate_mcps_sd1 =
+				pdata->ambient_count_rate_mcps;
+
+			psys->result__sigma_sd1 = pdata->VL53L1_p_005;
+			psys->result__phase_sd1 = pdata->VL53L1_p_014;
+
+			psys->result__final_crosstalk_corrected_range_mm_sd1 =
+				(uint16_t)pdata->median_range_mm;
+
+			pcore->result_core__ranging_total_events_sd1 =
+				pdata->VL53L1_p_021;
+			pcore->result_core__signal_total_events_sd1 =
+				pdata->VL53L1_p_013;
+			pcore->result_core__total_periods_elapsed_sd1 =
+				pdata->total_periods_elapsed;
+			pcore->result_core__ambient_window_events_sd1 =
+				pdata->VL53L1_p_020;
+			break;
+		}
+
+		pdata++;
+	}
+
+	LOG_FUNCTION_END(0);
+
+}
+
+
+VL53L1_Error VL53L1_sum_histogram_data(
+		VL53L1_histogram_bin_data_t *phist_input,
+		VL53L1_histogram_bin_data_t *phist_output)
+{
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	uint8_t i = 0;
+	uint8_t smallest_bin_num = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		if (phist_output->VL53L1_p_024 >=
+				phist_input->VL53L1_p_024)
+			smallest_bin_num = phist_input->VL53L1_p_024;
+		else
+			smallest_bin_num = phist_output->VL53L1_p_024;
+	}
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		for (i = 0; i < smallest_bin_num; i++)
+
+
+			phist_output->bin_data[i] += phist_input->bin_data[i];
+
+	if (status == VL53L1_ERROR_NONE)
+
+		phist_output->VL53L1_p_004 +=
+			phist_input->VL53L1_p_004;
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_avg_histogram_data(
+			uint8_t no_of_samples,
+			VL53L1_histogram_bin_data_t *phist_sum,
+			VL53L1_histogram_bin_data_t *phist_avg)
+{
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	uint8_t i = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		for (i = 0; i < phist_sum->VL53L1_p_024; i++) {
+
+
+
+
+			if (no_of_samples > 0)
+				phist_avg->bin_data[i] =
+					phist_sum->bin_data[i] /
+					(int32_t)no_of_samples;
+			else
+				phist_avg->bin_data[i] = phist_sum->bin_data[i];
+		}
+	}
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		if (no_of_samples > 0)
+			phist_avg->VL53L1_p_004 =
+				phist_sum->VL53L1_p_004 /
+					(int32_t)no_of_samples;
+		else
+			phist_avg->VL53L1_p_004 =
+					phist_sum->VL53L1_p_004;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_save_cfg_data(
+	VL53L1_DEV  Dev)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t  *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+
+	VL53L1_zone_private_dyn_cfg_t *pzone_dyn_cfg;
+	VL53L1_dynamic_config_t       *pdynamic = &(pdev->dyn_cfg);
+
+	LOG_FUNCTION_START("");
+
+	pzone_dyn_cfg =
+		&(pres->zone_dyn_cfgs.VL53L1_p_002[pdev->ll_state.cfg_zone_id]);
+
+	pzone_dyn_cfg->expected_stream_count =
+			pdev->ll_state.cfg_stream_count;
+
+	pzone_dyn_cfg->expected_gph_id =
+			pdev->ll_state.cfg_gph_id;
+
+	pzone_dyn_cfg->roi_config__user_roi_centre_spad =
+		pdynamic->roi_config__user_roi_centre_spad;
+
+	pzone_dyn_cfg->roi_config__user_roi_requested_global_xy_size =
+		pdynamic->roi_config__user_roi_requested_global_xy_size;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_dynamic_zone_update(
+	VL53L1_DEV  Dev,
+	VL53L1_range_results_t *presults)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t  *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t  *pres =
+			VL53L1DevStructGetLLResultsHandle(Dev);
+	VL53L1_zone_private_dyn_cfgs_t *pZ = &(pres->zone_dyn_cfgs);
+
+	uint8_t   zone_id = pdev->ll_state.rd_zone_id;
+	uint8_t   i;
+	uint16_t  max_total_rate_per_spads;
+	uint16_t  target_rate =
+		pdev->stat_cfg.dss_config__target_total_rate_mcps;
+	uint32_t  temp = 0xFFFF;
+#ifdef VL53L1_LOG_ENABLE
+	uint16_t eff_spad_cnt =
+		pZ->VL53L1_p_002[zone_id].dss_requested_effective_spad_count;
+#endif
+
+	LOG_FUNCTION_START("");
+
+	pZ->VL53L1_p_002[zone_id].dss_requested_effective_spad_count = 0;
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"    DYNZONEUPDATE: peak signal count rate mcps:");
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"%u actual effective spads: %u\n",
+		presults->VL53L1_p_002[0].peak_signal_count_rate_mcps,
+		presults->VL53L1_p_002[0].VL53L1_p_006);
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"    DYNZONEUPDATE: active results: %u\n",
+		presults->active_results);
+
+	max_total_rate_per_spads =
+		presults->VL53L1_p_002[0].total_rate_per_spad_mcps;
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"    DYNZONEUPDATE: max total rate per spad at start: %u\n",
+		max_total_rate_per_spads);
+
+	for (i = 1; i < presults->active_results; i++) {
+		trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"    DYNZONEUPDATE: zone total rate per spad: zone_id: %u,",
+		i);
+
+		trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"total rate per spad: %u\n",
+		presults->VL53L1_p_002[i].total_rate_per_spad_mcps);
+
+		if (presults->VL53L1_p_002[i].total_rate_per_spad_mcps >
+			max_total_rate_per_spads)
+			max_total_rate_per_spads =
+			presults->VL53L1_p_002[i].total_rate_per_spad_mcps;
+
+	}
+
+	if (max_total_rate_per_spads == 0) {
+
+
+
+
+
+		temp = 0xFFFF;
+	} else {
+
+
+
+
+
+		temp = target_rate << 14;
+		trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+			"    DYNZONEUPDATE: 1: temp: %u\n",
+			temp);
+
+
+
+
+
+		temp = temp / max_total_rate_per_spads;
+
+		trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+			"    DYNZONEUPDATE: 2: temp: %u\n",
+			temp);
+
+
+
+
+
+		if (temp > 0xFFFF)
+			temp = 0xFFFF;
+
+		trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+			"    DYNZONEUPDATE: 3: temp: %u\n",
+			temp);
+	}
+
+	pZ->VL53L1_p_002[zone_id].dss_requested_effective_spad_count =
+			(uint16_t)temp;
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"    DYNZONEUPDATE: zone_id: %u, target_rate: %u,",
+		zone_id,
+		target_rate);
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"max_total_rate_per_spads: %u, requested_spads: %u\n",
+		max_total_rate_per_spads,
+		eff_spad_cnt);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_multizone_hist_bins_update(
+	VL53L1_DEV  Dev)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_ll_driver_state_t *pstate = &(pdev->ll_state);
+	VL53L1_zone_config_t *pzone_cfg = &(pdev->zone_cfg);
+	VL53L1_histogram_config_t *phist_cfg = &(pdev->hist_cfg);
+	VL53L1_histogram_config_t *pmulti_hist =
+			&(pzone_cfg->multizone_hist_cfg);
+
+	uint8_t   next_range_is_odd_timing = (pstate->cfg_stream_count) % 2;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	if (pzone_cfg->bin_config[pdev->ll_state.cfg_zone_id] ==
+		VL53L1_ZONECONFIG_BINCONFIG__LOWAMB) {
+		if (!next_range_is_odd_timing) {
+			trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"   HISTBINCONFIGUPDATE: Setting LOWAMB EVEN timing\n");
+			phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__low_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__low_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__low_amb_even_bin_4_5;
+		}
+
+		if (next_range_is_odd_timing) {
+			trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"    HISTBINCONFIGUPDATE: Setting LOWAMB ODD timing\n");
+			phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__low_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__low_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__low_amb_even_bin_4_5;
+		}
+	} else if (pzone_cfg->bin_config[pdev->ll_state.cfg_zone_id] ==
+		VL53L1_ZONECONFIG_BINCONFIG__MIDAMB) {
+
+		trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"    HISTBINCONFIGUPDATE: Setting MIDAMB timing\n");
+		if (!next_range_is_odd_timing) {
+			trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+			"   HISTBINCONFIGUPDATE: Setting MIDAMB EVEN timing\n");
+			phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_4_5;
+		}
+
+		if (next_range_is_odd_timing) {
+			trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"    HISTBINCONFIGUPDATE: Setting MIDAMB ODD timing\n");
+			phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_4_5;
+		}
+	} else if (pzone_cfg->bin_config[pdev->ll_state.cfg_zone_id] ==
+			VL53L1_ZONECONFIG_BINCONFIG__HIGHAMB) {
+		if (!next_range_is_odd_timing) {
+			trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"    HISTBINCONFIGUPDATE: Setting HIGHAMB EVEN timing\n"
+					);
+			phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__high_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__high_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__high_amb_even_bin_4_5;
+		}
+
+		if (next_range_is_odd_timing) {
+			trace_print (VL53L1_TRACE_LEVEL_DEBUG,
+			"   HISTBINCONFIGUPDATE: Setting HIGHAMB ODD timing\n");
+			phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__high_amb_even_bin_0_1;
+			phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__high_amb_even_bin_2_3;
+			phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__high_amb_even_bin_4_5;
+		}
+	}
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+		VL53L1_copy_hist_bins_to_static_cfg(
+			phist_cfg,
+			&(pdev->stat_cfg),
+			&(pdev->tim_cfg));
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_update_internal_stream_counters(
+	VL53L1_DEV  Dev,
+	uint8_t     external_stream_count,
+	uint8_t    *pinternal_stream_count,
+	uint8_t    *pinternal_stream_count_val)
+{
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t stream_divider;
+
+	VL53L1_LLDriverData_t  *pdev =
+			VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	stream_divider = pdev->gen_cfg.global_config__stream_divider;
+
+	if (stream_divider == 0) {
+
+
+
+
+
+
+		*pinternal_stream_count = external_stream_count;
+
+	} else if (*pinternal_stream_count_val == (stream_divider-1)) {
+
+
+
+
+
+		if (*pinternal_stream_count == 0xFF)
+			*pinternal_stream_count = 0x80;
+		else
+			*pinternal_stream_count = *pinternal_stream_count + 1;
+
+
+
+
+
+		*pinternal_stream_count_val = 0;
+
+	} else {
+
+
+
+
+
+		*pinternal_stream_count_val = *pinternal_stream_count_val + 1;
+	}
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"UPDINTSTREAMCOUNT   internal_steam_count:  %d,",
+		*pinternal_stream_count);
+
+	trace_print(VL53L1_TRACE_LEVEL_DEBUG,
+		"internal_stream_count_val: %d, divider: %d\n",
+		*pinternal_stream_count_val,
+		stream_divider);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_histogram_multizone_initial_bin_config(
+	VL53L1_zone_config_t		*pzone_cfg,
+	VL53L1_histogram_config_t	*phist_cfg,
+	VL53L1_histogram_config_t	*pmulti_hist)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	if (pzone_cfg->bin_config[0] ==
+			VL53L1_ZONECONFIG_BINCONFIG__LOWAMB) {
+		phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__low_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__low_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__low_amb_even_bin_4_5;
+
+		phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__low_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__low_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__low_amb_even_bin_4_5;
+	} else if (pzone_cfg->bin_config[0] ==
+			VL53L1_ZONECONFIG_BINCONFIG__MIDAMB) {
+
+		phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_4_5;
+
+		phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__mid_amb_even_bin_4_5;
+	} else if (pzone_cfg->bin_config[0] ==
+			VL53L1_ZONECONFIG_BINCONFIG__HIGHAMB) {
+		phist_cfg->histogram_config__low_amb_even_bin_0_1  =
+			pmulti_hist->histogram_config__high_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_even_bin_2_3  =
+			pmulti_hist->histogram_config__high_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_even_bin_4_5  =
+			pmulti_hist->histogram_config__high_amb_even_bin_4_5;
+		phist_cfg->histogram_config__low_amb_odd_bin_0_1  =
+			pmulti_hist->histogram_config__high_amb_even_bin_0_1;
+		phist_cfg->histogram_config__low_amb_odd_bin_2_3  =
+			pmulti_hist->histogram_config__high_amb_even_bin_2_3;
+		phist_cfg->histogram_config__low_amb_odd_bin_4_5  =
+			pmulti_hist->histogram_config__high_amb_even_bin_4_5;
+	}
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+
+
+
+
+uint8_t	VL53L1_encode_GPIO_interrupt_config(
+	VL53L1_GPIO_interrupt_config_t	*pintconf)
+{
+	uint8_t system__interrupt_config;
+
+	system__interrupt_config = pintconf->intr_mode_distance;
+	system__interrupt_config |= ((pintconf->intr_mode_rate) << 2);
+	system__interrupt_config |= ((pintconf->intr_new_measure_ready) << 5);
+	system__interrupt_config |= ((pintconf->intr_no_target) << 6);
+	system__interrupt_config |= ((pintconf->intr_combined_mode) << 7);
+
+	return system__interrupt_config;
+}
+
+
+
+
+
+
+VL53L1_GPIO_interrupt_config_t VL53L1_decode_GPIO_interrupt_config(
+	uint8_t		system__interrupt_config)
+{
+	VL53L1_GPIO_interrupt_config_t	intconf;
+
+	intconf.intr_mode_distance = system__interrupt_config & 0x03;
+	intconf.intr_mode_rate = (system__interrupt_config >> 2) & 0x03;
+	intconf.intr_new_measure_ready = (system__interrupt_config >> 5) & 0x01;
+	intconf.intr_no_target = (system__interrupt_config >> 6) & 0x01;
+	intconf.intr_combined_mode = (system__interrupt_config >> 7) & 0x01;
+
+
+
+	intconf.threshold_rate_low = 0;
+	intconf.threshold_rate_high = 0;
+	intconf.threshold_distance_low = 0;
+	intconf.threshold_distance_high = 0;
+
+	return intconf;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_distance_threshold(
+	VL53L1_DEV                      Dev,
+	uint16_t			threshold_high,
+	uint16_t			threshold_low)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->dyn_cfg.system__thresh_high = threshold_high;
+	pdev->dyn_cfg.system__thresh_low = threshold_low;
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_rate_threshold(
+	VL53L1_DEV                      Dev,
+	uint16_t			threshold_high,
+	uint16_t			threshold_low)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->gen_cfg.system__thresh_rate_high = threshold_high;
+	pdev->gen_cfg.system__thresh_rate_low = threshold_low;
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+
+
+
+
+VL53L1_Error VL53L1_set_GPIO_thresholds_from_struct(
+	VL53L1_DEV                      Dev,
+	VL53L1_GPIO_interrupt_config_t *pintconf)
+{
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_set_GPIO_distance_threshold(
+			Dev,
+			pintconf->threshold_distance_high,
+			pintconf->threshold_distance_low);
+
+	if (status == VL53L1_ERROR_NONE) {
+		status =
+			VL53L1_set_GPIO_rate_threshold(
+				Dev,
+				pintconf->threshold_rate_high,
+				pintconf->threshold_rate_low);
+	}
+
+	LOG_FUNCTION_END(status);
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_ref_spad_char_config(
+	VL53L1_DEV    Dev,
+	uint8_t       vcsel_period_a,
+	uint32_t      phasecal_timeout_us,
+	uint16_t      total_rate_target_mcps,
+	uint16_t      max_count_rate_rtn_limit_mcps,
+	uint16_t      min_count_rate_rtn_limit_mcps,
+	uint16_t      fast_osc_frequency)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t buffer[2];
+
+	uint32_t macro_period_us = 0;
+	uint32_t timeout_mclks   = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	macro_period_us =
+		VL53L1_calc_macro_period_us(
+			fast_osc_frequency,
+			vcsel_period_a);
+
+
+
+
+
+
+	timeout_mclks = phasecal_timeout_us << 12;
+	timeout_mclks = timeout_mclks + (macro_period_us>>1);
+	timeout_mclks = timeout_mclks / macro_period_us;
+
+	if (timeout_mclks > 0xFF)
+		pdev->gen_cfg.phasecal_config__timeout_macrop = 0xFF;
+	else
+		pdev->gen_cfg.phasecal_config__timeout_macrop =
+				(uint8_t)timeout_mclks;
+
+	pdev->tim_cfg.range_config__vcsel_period_a = vcsel_period_a;
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status =
+			VL53L1_WrByte(
+				Dev,
+				VL53L1_PHASECAL_CONFIG__TIMEOUT_MACROP,
+				pdev->gen_cfg.phasecal_config__timeout_macrop);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrByte(
+				Dev,
+				VL53L1_RANGE_CONFIG__VCSEL_PERIOD_A,
+				pdev->tim_cfg.range_config__vcsel_period_a);
+
+
+
+
+
+
+
+	buffer[0] = pdev->tim_cfg.range_config__vcsel_period_a;
+	buffer[1] = pdev->tim_cfg.range_config__vcsel_period_a;
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				VL53L1_SD_CONFIG__WOI_SD0,
+				buffer,
+				2);
+
+
+
+
+
+
+
+	pdev->customer.ref_spad_char__total_rate_target_mcps =
+			total_rate_target_mcps;
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrWord(
+				Dev,
+				VL53L1_REF_SPAD_CHAR__TOTAL_RATE_TARGET_MCPS,
+				total_rate_target_mcps);
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrWord(
+				Dev,
+				VL53L1_RANGE_CONFIG__SIGMA_THRESH,
+				max_count_rate_rtn_limit_mcps);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrWord(
+			Dev,
+			VL53L1_RANGE_CONFIG__MIN_COUNT_RATE_RTN_LIMIT_MCPS,
+			min_count_rate_rtn_limit_mcps);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_ssc_config(
+	VL53L1_DEV            Dev,
+	VL53L1_ssc_config_t  *pssc_cfg,
+	uint16_t              fast_osc_frequency)
+{
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t buffer[5];
+
+	uint32_t macro_period_us = 0;
+	uint16_t timeout_encoded = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	macro_period_us =
+		VL53L1_calc_macro_period_us(
+			fast_osc_frequency,
+			pssc_cfg->VL53L1_p_009);
+
+
+
+
+
+	timeout_encoded =
+		VL53L1_calc_encoded_timeout(
+			pssc_cfg->timeout_us,
+			macro_period_us);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrByte(
+				Dev,
+				VL53L1_CAL_CONFIG__VCSEL_START,
+				pssc_cfg->vcsel_start);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrByte(
+				Dev,
+				VL53L1_GLOBAL_CONFIG__VCSEL_WIDTH,
+				pssc_cfg->vcsel_width);
+
+
+
+
+	buffer[0] = (uint8_t)((timeout_encoded &  0x0000FF00) >> 8);
+	buffer[1] = (uint8_t) (timeout_encoded &  0x000000FF);
+	buffer[2] = pssc_cfg->VL53L1_p_009;
+	buffer[3] = (uint8_t)((pssc_cfg->rate_limit_mcps &  0x0000FF00) >> 8);
+	buffer[4] = (uint8_t) (pssc_cfg->rate_limit_mcps &  0x000000FF);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				VL53L1_RANGE_CONFIG__TIMEOUT_MACROP_B_HI,
+				buffer,
+				5);
+
+
+
+
+
+
+
+	buffer[0] = pssc_cfg->VL53L1_p_009;
+	buffer[1] = pssc_cfg->VL53L1_p_009;
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WriteMulti(
+				Dev,
+				VL53L1_SD_CONFIG__WOI_SD0,
+				buffer,
+				2);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WrByte(
+				Dev,
+				VL53L1_NVM_BIST__CTRL,
+				pssc_cfg->array_select);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_spad_rate_data(
+	VL53L1_DEV                Dev,
+	VL53L1_spad_rate_data_t  *pspad_rates)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	int               i = 0;
+
+	uint8_t  VL53L1_p_002[512];
+	uint8_t *pdata = &VL53L1_p_002[0];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_ReadMulti(
+				Dev,
+				VL53L1_PRIVATE__PATCH_BASE_ADDR_RSLV,
+				pdata,
+				512);
+
+
+
+	pdata = &VL53L1_p_002[0];
+	for (i = 0; i < VL53L1_NO_OF_SPAD_ENABLES; i++) {
+		pspad_rates->rate_data[i] =
+			(uint16_t)VL53L1_decode_unsigned_integer(pdata, 2);
+		pdata += 2;
+	}
+
+
+
+
+	pspad_rates->VL53L1_p_023     = VL53L1_NO_OF_SPAD_ENABLES;
+	pspad_rates->no_of_values    = VL53L1_NO_OF_SPAD_ENABLES;
+	pspad_rates->fractional_bits = 15;
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_calc_required_samples(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres = VL53L1DevStructGetLLResultsHandle(Dev);
+	VL53L1_smudge_corrector_config_t *pconfig =
+				&(pdev->smudge_correct_config);
+	VL53L1_smudge_corrector_internals_t *pint =
+				&(pdev->smudge_corrector_internals);
+
+	VL53L1_range_results_t *presults = &(pres->range_results);
+	VL53L1_range_data_t *pxmonitor = &(presults->xmonitor);
+
+	uint32_t peak_duration_us = pxmonitor->peak_duration_us;
+
+	uint64_t temp64a;
+	uint64_t temp64z;
+
+	LOG_FUNCTION_START("");
+
+	temp64a = pxmonitor->VL53L1_p_021 +
+		pxmonitor->VL53L1_p_020;
+	temp64a = do_division_u((temp64a * 1000), peak_duration_us);
+	temp64a = do_division_u((temp64a * 1000), peak_duration_us);
+
+	temp64z = pconfig->noise_margin * pxmonitor->VL53L1_p_006;
+	temp64a = temp64a * 1000 * 256;
+	temp64a = do_division_u(temp64a, temp64z);
+	temp64a = temp64a * 1000 * 256;
+	temp64a = do_division_u(temp64a, temp64z);
+
+	pint->required_samples = (uint32_t)temp64a;
+
+
+
+	if (pint->required_samples < 2)
+		pint->required_samples = 2;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+	VL53L1_DEV				Dev,
+	uint32_t				xtalk_offset_out,
+	VL53L1_smudge_corrector_config_t	*pconfig,
+	VL53L1_smudge_corrector_data_t		*pout,
+	uint8_t					add_smudge,
+	uint8_t					soft_update
+	)
+{
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	int16_t  x_gradient_scaler;
+	int16_t  y_gradient_scaler;
+	uint32_t orig_xtalk_offset;
+	int16_t  orig_x_gradient;
+	int16_t  orig_y_gradient;
+	int32_t  itemp32;
+	VL53L1_xtalk_config_t  *pX = &(pdev->xtalk_cfg);
+	VL53L1_xtalk_calibration_results_t  *pC = &(pdev->xtalk_cal);
+
+	LOG_FUNCTION_START("");
+
+
+
+	if (add_smudge == 1) {
+		pout->algo__crosstalk_compensation_plane_offset_kcps =
+			(uint32_t)xtalk_offset_out +
+			(uint32_t)pconfig->smudge_margin;
+	} else {
+		pout->algo__crosstalk_compensation_plane_offset_kcps =
+			(uint32_t)xtalk_offset_out;
+	}
+
+
+
+	orig_xtalk_offset =
+	pX->nvm_default__crosstalk_compensation_plane_offset_kcps;
+
+	orig_x_gradient =
+		pX->nvm_default__crosstalk_compensation_x_plane_gradient_kcps;
+
+	orig_y_gradient =
+		pX->nvm_default__crosstalk_compensation_y_plane_gradient_kcps;
+
+	if (((pconfig->user_scaler_set == 0)
+				|| (pconfig->scaler_calc_method == 1)) &&
+		(pC->algo__crosstalk_compensation_plane_offset_kcps
+		!= 0)) {
+
+
+		orig_xtalk_offset =
+			pC->algo__crosstalk_compensation_plane_offset_kcps;
+
+		orig_x_gradient =
+			pC->algo__crosstalk_compensation_x_plane_gradient_kcps;
+
+		orig_y_gradient =
+			pC->algo__crosstalk_compensation_y_plane_gradient_kcps;
+	}
+
+
+
+	if ((pconfig->user_scaler_set == 0) && (orig_x_gradient == 0))
+		pout->gradient_zero_flag |= 0x01;
+
+	if ((pconfig->user_scaler_set == 0) && (orig_y_gradient == 0))
+		pout->gradient_zero_flag |= 0x02;
+
+
+
+
+
+
+	if (orig_xtalk_offset == 0)
+		orig_xtalk_offset = 1;
+
+
+
+
+	if (pconfig->user_scaler_set == 1) {
+		x_gradient_scaler = pconfig->x_gradient_scaler;
+		y_gradient_scaler = pconfig->y_gradient_scaler;
+	} else {
+
+
+
+
+		x_gradient_scaler = (int16_t)do_division_s(
+				(((int32_t)orig_x_gradient) << 6),
+				orig_xtalk_offset);
+		pconfig->x_gradient_scaler = x_gradient_scaler;
+		y_gradient_scaler = (int16_t)do_division_s(
+				(((int32_t)orig_y_gradient) << 6),
+				orig_xtalk_offset);
+		pconfig->y_gradient_scaler = y_gradient_scaler;
+	}
+
+
+
+
+	if (pconfig->scaler_calc_method == 0) {
+
+
+
+
+
+
+		itemp32 = (int32_t)(
+			pout->algo__crosstalk_compensation_plane_offset_kcps *
+				x_gradient_scaler);
+		itemp32 = itemp32 >> 6;
+		if (itemp32 > 0xFFFF)
+			itemp32 = 0xFFFF;
+
+		pout->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			(int16_t)itemp32;
+
+		itemp32 = (int32_t)(
+			pout->algo__crosstalk_compensation_plane_offset_kcps *
+				y_gradient_scaler);
+		itemp32 = itemp32 >> 6;
+		if (itemp32 > 0xFFFF)
+			itemp32 = 0xFFFF;
+
+		pout->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			(int16_t)itemp32;
+	} else if (pconfig->scaler_calc_method == 1) {
+
+
+
+
+
+		itemp32 = (int32_t)(orig_xtalk_offset -
+			pout->algo__crosstalk_compensation_plane_offset_kcps);
+		itemp32 = (int32_t)(do_division_s(itemp32, 16));
+		itemp32 = itemp32 << 2;
+		itemp32 = itemp32 + (int32_t)(orig_x_gradient);
+		if (itemp32 > 0xFFFF)
+			itemp32 = 0xFFFF;
+
+		pout->algo__crosstalk_compensation_x_plane_gradient_kcps =
+			(int16_t)itemp32;
+
+		itemp32 = (int32_t)(orig_xtalk_offset -
+			pout->algo__crosstalk_compensation_plane_offset_kcps);
+		itemp32 = (int32_t)(do_division_s(itemp32, 80));
+		itemp32 = itemp32 << 2;
+		itemp32 = itemp32 + (int32_t)(orig_y_gradient);
+		if (itemp32 > 0xFFFF)
+			itemp32 = 0xFFFF;
+
+		pout->algo__crosstalk_compensation_y_plane_gradient_kcps =
+			(int16_t)itemp32;
+	}
+
+
+
+	if (pconfig->smudge_corr_apply_enabled == 1 &&
+			(soft_update != 1)
+			 ) {
+
+
+		pout->new_xtalk_applied_flag = 1;
+
+
+
+		pX->algo__crosstalk_compensation_plane_offset_kcps =
+			pout->algo__crosstalk_compensation_plane_offset_kcps;
+		pX->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		pout->algo__crosstalk_compensation_x_plane_gradient_kcps;
+		pX->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		pout->algo__crosstalk_compensation_y_plane_gradient_kcps;
+
+
+
+		if (pconfig->smudge_corr_single_apply == 1) {
+
+
+			pconfig->smudge_corr_apply_enabled = 0;
+			pconfig->smudge_corr_single_apply = 0;
+		}
+	}
+
+
+
+	if (soft_update != 1)
+		pout->smudge_corr_valid = 1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+#define CONT_CONTINUE	0
+#define CONT_NEXT_LOOP	1
+#define CONT_RESET	2
+VL53L1_Error VL53L1_dynamic_xtalk_correction_corrector(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres = VL53L1DevStructGetLLResultsHandle(Dev);
+	VL53L1_smudge_corrector_config_t *pconfig =
+				&(pdev->smudge_correct_config);
+	VL53L1_smudge_corrector_internals_t *pint =
+				&(pdev->smudge_corrector_internals);
+	VL53L1_smudge_corrector_data_t *pout =
+			&(pres->range_results.smudge_corrector_data);
+	VL53L1_range_results_t  *pR = &(pres->range_results);
+	VL53L1_xtalk_config_t  *pX = &(pdev->xtalk_cfg);
+
+	uint8_t	run_smudge_detection = 0;
+	uint8_t	run_nodetect = 0;
+	uint8_t ambient_check = 0;
+	int32_t itemp32 = 0;
+	uint64_t utemp64 = 0;
+	uint8_t continue_processing = CONT_CONTINUE;
+	uint32_t xtalk_offset_out = 0;
+	uint32_t xtalk_offset_in = 0;
+	uint32_t current_xtalk = 0;
+	uint32_t smudge_margin_adjusted = 0;
+	uint8_t i = 0;
+	uint8_t nodetect_index = 0;
+	uint16_t    amr;
+
+	uint32_t    cco;
+
+
+
+	LOG_FUNCTION_START("");
+
+
+
+	VL53L1_dynamic_xtalk_correction_output_init(pres);
+
+
+
+	ambient_check = (pconfig->smudge_corr_ambient_threshold == 0) ||
+			(pconfig->smudge_corr_ambient_threshold >
+	((uint32_t)pR->xmonitor.ambient_count_rate_mcps));
+
+
+
+
+	run_smudge_detection = (pconfig->smudge_corr_enabled == 1) &&
+		ambient_check &&
+		(pR->xmonitor.range_status
+			== VL53L1_DEVICEERROR_RANGECOMPLETE);
+
+
+
+
+	if ((pR->xmonitor.range_status
+		!= VL53L1_DEVICEERROR_RANGECOMPLETE) &&
+			(pconfig->smudge_corr_enabled == 1)) {
+
+
+		run_nodetect = 2;
+		for (i = 0; i < pR->active_results; i++) {
+			if (pR->VL53L1_p_002[i].range_status ==
+				VL53L1_DEVICEERROR_RANGECOMPLETE) {
+				if (pR->VL53L1_p_002[i].median_range_mm
+						<=
+					pconfig->nodetect_min_range_mm) {
+					run_nodetect = 0;
+				} else {
+					if (run_nodetect == 2) {
+						run_nodetect = 1;
+						nodetect_index = i;
+					}
+				}
+			}
+		}
+
+		if (run_nodetect == 2)
+
+
+			run_nodetect = 0;
+
+		amr =
+		pR->VL53L1_p_002[nodetect_index].ambient_count_rate_mcps;
+
+		if (run_nodetect == 1) {
+
+
+
+
+
+
+
+			utemp64 = 1000 * ((uint64_t)amr);
+
+
+
+			utemp64 = utemp64 << 9;
+
+
+
+			if (utemp64 < pconfig->nodetect_ambient_threshold)
+				run_nodetect = 1;
+			else
+				run_nodetect = 0;
+
+		}
+	}
+
+
+	if (run_smudge_detection == 1) {
+
+
+		pint->nodetect_counter = 0;
+
+
+
+		VL53L1_dynamic_xtalk_correction_calc_required_samples(Dev);
+
+
+
+		xtalk_offset_in =
+			pR->xmonitor.VL53L1_p_012;
+
+
+
+		cco = pX->algo__crosstalk_compensation_plane_offset_kcps;
+		current_xtalk = ((uint32_t)cco) << 2;
+
+
+
+		smudge_margin_adjusted =
+				((uint32_t)(pconfig->smudge_margin)) << 2;
+
+
+
+		itemp32 = xtalk_offset_in - current_xtalk +
+			smudge_margin_adjusted;
+
+		if (itemp32 < 0)
+			itemp32 = itemp32 * (-1);
+
+
+		if (itemp32 > ((int32_t)pconfig->single_xtalk_delta)) {
+			if ((int32_t)xtalk_offset_in >
+				((int32_t)current_xtalk -
+					(int32_t)smudge_margin_adjusted)) {
+				pout->single_xtalk_delta_flag = 1;
+			} else {
+				pout->single_xtalk_delta_flag = 2;
+			}
+		}
+
+
+
+		pint->current_samples = pint->current_samples + 1;
+
+
+
+		if (pint->current_samples > pconfig->sample_limit) {
+			pout->sample_limit_exceeded_flag = 1;
+			continue_processing = CONT_RESET;
+		} else {
+
+			pint->accumulator = pint->accumulator +
+				xtalk_offset_in;
+		}
+
+		if (pint->current_samples < pint->required_samples)
+			continue_processing = CONT_NEXT_LOOP;
+
+
+
+		xtalk_offset_out =
+		(uint32_t)(do_division_u(pint->accumulator,
+			pint->current_samples));
+
+
+
+		itemp32 = xtalk_offset_out - current_xtalk +
+			smudge_margin_adjusted;
+
+		if (itemp32 < 0)
+			itemp32 = itemp32 * (-1);
+
+		if (continue_processing == CONT_CONTINUE &&
+			(itemp32 >= ((int32_t)(pconfig->averaged_xtalk_delta)))
+			) {
+			if ((int32_t)xtalk_offset_out >
+				((int32_t)current_xtalk -
+					(int32_t)smudge_margin_adjusted))
+				pout->averaged_xtalk_delta_flag = 1;
+			else
+				pout->averaged_xtalk_delta_flag = 2;
+		}
+
+		if (continue_processing == CONT_CONTINUE &&
+			(itemp32 < ((int32_t)(pconfig->averaged_xtalk_delta)))
+			)
+
+
+			continue_processing = CONT_RESET;
+
+
+
+
+		pout->smudge_corr_clipped = 0;
+		if ((continue_processing == CONT_CONTINUE) &&
+			(pconfig->smudge_corr_clip_limit != 0)) {
+			if (xtalk_offset_out >
+				pconfig->smudge_corr_clip_limit) {
+				pout->smudge_corr_clipped = 1;
+				continue_processing = CONT_RESET;
+			}
+		}
+
+
+
+
+
+		if (pconfig->user_xtalk_offset_limit_hi &&
+			(xtalk_offset_out >
+				pconfig->user_xtalk_offset_limit))
+			xtalk_offset_out =
+				pconfig->user_xtalk_offset_limit;
+
+
+
+
+		if ((pconfig->user_xtalk_offset_limit_hi == 0) &&
+			(xtalk_offset_out <
+				pconfig->user_xtalk_offset_limit))
+			xtalk_offset_out =
+				pconfig->user_xtalk_offset_limit;
+
+
+
+
+		xtalk_offset_out = xtalk_offset_out >> 2;
+		if (xtalk_offset_out > 0x3FFFF)
+			xtalk_offset_out = 0x3FFFF;
+
+
+
+		if (continue_processing == CONT_CONTINUE) {
+
+
+			VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+				Dev,
+				xtalk_offset_out,
+				pconfig,
+				pout,
+				1,
+
+				0
+
+				);
+
+
+
+			continue_processing = CONT_RESET;
+		} else {
+
+
+			VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+				Dev,
+				xtalk_offset_out,
+				pconfig,
+				pout,
+				1,
+
+				1
+
+				);
+		}
+
+
+
+		if (continue_processing == CONT_RESET) {
+			pint->accumulator = 0;
+			pint->current_samples = 0;
+			pint->nodetect_counter = 0;
+		}
+
+	}
+
+	continue_processing = CONT_CONTINUE;
+	if (run_nodetect == 1) {
+
+
+		pint->nodetect_counter += 1;
+
+
+
+		if (pint->nodetect_counter < pconfig->nodetect_sample_limit)
+			continue_processing = CONT_NEXT_LOOP;
+
+
+
+		xtalk_offset_out = (uint32_t)(pconfig->nodetect_xtalk_offset);
+
+		if (continue_processing == CONT_CONTINUE) {
+
+
+			VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+				Dev,
+				xtalk_offset_out,
+				pconfig,
+				pout,
+				0,
+
+				0
+
+				);
+
+
+
+			pout->smudge_corr_valid = 2;
+
+
+
+			continue_processing = CONT_RESET;
+		} else {
+
+
+			VL53L1_dynamic_xtalk_correction_calc_new_xtalk(
+				Dev,
+				xtalk_offset_out,
+				pconfig,
+				pout,
+				0,
+
+				1
+
+				);
+		}
+
+
+
+		if (continue_processing == CONT_RESET) {
+			pint->accumulator = 0;
+			pint->current_samples = 0;
+			pint->nodetect_counter = 0;
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_data_init(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+	VL53L1_LLDriverResults_t *pres = VL53L1DevStructGetLLResultsHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdev->smudge_correct_config.smudge_corr_enabled       = 1;
+	pdev->smudge_correct_config.smudge_corr_apply_enabled = 1;
+	pdev->smudge_correct_config.smudge_corr_single_apply  =
+		VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_COR_SINGLE_APPLY_DEFAULT;
+
+	pdev->smudge_correct_config.smudge_margin =
+			VL53L1_TUNINGPARM_DYNXTALK_SMUDGE_MARGIN_DEFAULT;
+	pdev->smudge_correct_config.noise_margin =
+			VL53L1_TUNINGPARM_DYNXTALK_NOISE_MARGIN_DEFAULT;
+	pdev->smudge_correct_config.user_xtalk_offset_limit =
+			VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_DEFAULT;
+	pdev->smudge_correct_config.user_xtalk_offset_limit_hi =
+		VL53L1_TUNINGPARM_DYNXTALK_XTALK_OFFSET_LIMIT_HI_DEFAULT;
+	pdev->smudge_correct_config.sample_limit =
+			VL53L1_TUNINGPARM_DYNXTALK_SAMPLE_LIMIT_DEFAULT;
+	pdev->smudge_correct_config.single_xtalk_delta =
+			VL53L1_TUNINGPARM_DYNXTALK_SINGLE_XTALK_DELTA_DEFAULT;
+	pdev->smudge_correct_config.averaged_xtalk_delta =
+			VL53L1_TUNINGPARM_DYNXTALK_AVERAGED_XTALK_DELTA_DEFAULT;
+	pdev->smudge_correct_config.smudge_corr_clip_limit =
+			VL53L1_TUNINGPARM_DYNXTALK_CLIP_LIMIT_DEFAULT;
+	pdev->smudge_correct_config.smudge_corr_ambient_threshold =
+			VL53L1_TUNINGPARM_DYNXTALK_XTALK_AMB_THRESHOLD_DEFAULT;
+	pdev->smudge_correct_config.scaler_calc_method =
+			0;
+
+	pdev->smudge_correct_config.x_gradient_scaler =
+			VL53L1_TUNINGPARM_DYNXTALK_XGRADIENT_SCALER_DEFAULT;
+	pdev->smudge_correct_config.y_gradient_scaler =
+			VL53L1_TUNINGPARM_DYNXTALK_YGRADIENT_SCALER_DEFAULT;
+	pdev->smudge_correct_config.user_scaler_set =
+			VL53L1_TUNINGPARM_DYNXTALK_USER_SCALER_SET_DEFAULT;
+	pdev->smudge_correct_config.nodetect_ambient_threshold =
+		VL53L1_TUNINGPARM_DYNXTALK_NODETECT_AMB_THRESHOLD_KCPS_DEFAULT;
+	pdev->smudge_correct_config.nodetect_sample_limit =
+		VL53L1_TUNINGPARM_DYNXTALK_NODETECT_SAMPLE_LIMIT_DEFAULT;
+	pdev->smudge_correct_config.nodetect_xtalk_offset =
+		VL53L1_TUNINGPARM_DYNXTALK_NODETECT_XTALK_OFFSET_KCPS_DEFAULT;
+	pdev->smudge_correct_config.nodetect_min_range_mm =
+		VL53L1_TUNINGPARM_DYNXTALK_NODETECT_MIN_RANGE_MM_DEFAULT;
+
+
+
+	pdev->smudge_corrector_internals.current_samples = 0;
+	pdev->smudge_corrector_internals.required_samples = 0;
+	pdev->smudge_corrector_internals.accumulator = 0;
+	pdev->smudge_corrector_internals.nodetect_counter = 0;
+
+
+
+	VL53L1_dynamic_xtalk_correction_output_init(pres);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_dynamic_xtalk_correction_output_init(
+	VL53L1_LLDriverResults_t *pres
+	)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_smudge_corrector_data_t *pdata;
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdata = &(pres->range_results.smudge_corrector_data);
+
+	pdata->smudge_corr_valid = 0;
+	pdata->smudge_corr_clipped = 0;
+	pdata->single_xtalk_delta_flag = 0;
+	pdata->averaged_xtalk_delta_flag = 0;
+	pdata->sample_limit_exceeded_flag = 0;
+	pdata->gradient_zero_flag = 0;
+	pdata->new_xtalk_applied_flag = 0;
+
+	pdata->algo__crosstalk_compensation_plane_offset_kcps = 0;
+	pdata->algo__crosstalk_compensation_x_plane_gradient_kcps = 0;
+	pdata->algo__crosstalk_compensation_y_plane_gradient_kcps = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_xtalk_cal_data_init(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	pdev->xtalk_cal.algo__crosstalk_compensation_plane_offset_kcps = 0;
+	pdev->xtalk_cal.algo__crosstalk_compensation_x_plane_gradient_kcps = 0;
+	pdev->xtalk_cal.algo__crosstalk_compensation_y_plane_gradient_kcps = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
+
+
+
+VL53L1_Error VL53L1_low_power_auto_data_init(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	pdev->low_power_auto_data.vhv_loop_bound =
+		VL53L1_TUNINGPARM_LOWPOWERAUTO_VHV_LOOP_BOUND_DEFAULT;
+	pdev->low_power_auto_data.is_low_power_auto_mode = 0;
+	pdev->low_power_auto_data.low_power_auto_range_count = 0;
+	pdev->low_power_auto_data.saved_interrupt_config = 0;
+	pdev->low_power_auto_data.saved_vhv_init = 0;
+	pdev->low_power_auto_data.saved_vhv_timeout = 0;
+	pdev->low_power_auto_data.first_run_phasecal_result = 0;
+	pdev->low_power_auto_data.dss__total_rate_per_spad_mcps = 0;
+	pdev->low_power_auto_data.dss__required_spads = 0;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_low_power_auto_data_stop_range(
+	VL53L1_DEV                          Dev
+	)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	pdev->low_power_auto_data.low_power_auto_range_count = 0xFF;
+
+	pdev->low_power_auto_data.first_run_phasecal_result = 0;
+	pdev->low_power_auto_data.dss__total_rate_per_spad_mcps = 0;
+	pdev->low_power_auto_data.dss__required_spads = 0;
+
+
+
+	if (pdev->low_power_auto_data.saved_vhv_init != 0)
+		pdev->stat_nvm.vhv_config__init =
+			pdev->low_power_auto_data.saved_vhv_init;
+	if (pdev->low_power_auto_data.saved_vhv_timeout != 0)
+		pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound =
+			pdev->low_power_auto_data.saved_vhv_timeout;
+
+
+
+	pdev->gen_cfg.phasecal_config__override = 0x00;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_config_low_power_auto_mode(
+	VL53L1_general_config_t   *pgeneral,
+	VL53L1_dynamic_config_t   *pdynamic,
+	VL53L1_low_power_auto_data_t *plpadata
+	)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	plpadata->is_low_power_auto_mode = 1;
+
+
+
+	plpadata->low_power_auto_range_count = 0;
+
+
+
+	pdynamic->system__sequence_config =
+			VL53L1_SEQUENCE_VHV_EN |
+			VL53L1_SEQUENCE_PHASECAL_EN |
+			VL53L1_SEQUENCE_DSS1_EN |
+
+
+
+
+
+
+			VL53L1_SEQUENCE_RANGE_EN;
+
+
+
+	pgeneral->dss_config__manual_effective_spads_select = 200 << 8;
+	pgeneral->dss_config__roi_mode_control =
+		VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_low_power_auto_setup_manual_calibration(
+	VL53L1_DEV        Dev)
+{
+
+
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+	pdev->low_power_auto_data.saved_vhv_init =
+		pdev->stat_nvm.vhv_config__init;
+	pdev->low_power_auto_data.saved_vhv_timeout =
+		pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound;
+
+
+
+	pdev->stat_nvm.vhv_config__init &= 0x7F;
+
+
+	pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound =
+		(pdev->stat_nvm.vhv_config__timeout_macrop_loop_bound & 0x03) +
+		(pdev->low_power_auto_data.vhv_loop_bound << 2);
+
+
+	pdev->gen_cfg.phasecal_config__override = 0x01;
+	pdev->low_power_auto_data.first_run_phasecal_result =
+		pdev->dbg_results.phasecal_result__vcsel_start;
+	pdev->gen_cfg.cal_config__vcsel_start =
+		pdev->low_power_auto_data.first_run_phasecal_result;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_low_power_auto_update_DSS(
+	VL53L1_DEV        Dev)
+{
+
+
+
+
+
+
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	VL53L1_system_results_t *pS = &(pdev->sys_results);
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint32_t utemp32a;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	utemp32a =
+		pS->result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0
+		 + pS->result__ambient_count_rate_mcps_sd0;
+
+
+
+	if (utemp32a > 0xFFFF)
+		utemp32a = 0xFFFF;
+
+
+
+
+
+	utemp32a = utemp32a << 16;
+
+
+
+	if (pdev->sys_results.result__dss_actual_effective_spads_sd0 == 0)
+		status = VL53L1_ERROR_DIVISION_BY_ZERO;
+	else {
+
+
+		utemp32a = utemp32a /
+		pdev->sys_results.result__dss_actual_effective_spads_sd0;
+
+
+		pdev->low_power_auto_data.dss__total_rate_per_spad_mcps =
+			utemp32a;
+
+
+
+
+		utemp32a = pdev->stat_cfg.dss_config__target_total_rate_mcps <<
+			16;
+
+
+
+		if (pdev->low_power_auto_data.dss__total_rate_per_spad_mcps
+				== 0)
+			status = VL53L1_ERROR_DIVISION_BY_ZERO;
+		else {
+
+
+
+			utemp32a = utemp32a /
+			pdev->low_power_auto_data.dss__total_rate_per_spad_mcps;
+
+
+
+			if (utemp32a > 0xFFFF)
+				utemp32a = 0xFFFF;
+
+
+
+			pdev->low_power_auto_data.dss__required_spads =
+				(uint16_t)utemp32a;
+
+
+
+			pdev->gen_cfg.dss_config__manual_effective_spads_select
+			= pdev->low_power_auto_data.dss__required_spads;
+			pdev->gen_cfg.dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+		}
+
+	}
+
+	if (status == VL53L1_ERROR_DIVISION_BY_ZERO) {
+
+
+
+
+
+
+		pdev->low_power_auto_data.dss__required_spads = 0x8000;
+
+
+
+		pdev->gen_cfg.dss_config__manual_effective_spads_select =
+			pdev->low_power_auto_data.dss__required_spads;
+		pdev->gen_cfg.dss_config__roi_mode_control =
+			VL53L1_DEVICEDSSMODE__REQUESTED_EFFFECTIVE_SPADS;
+
+
+
+		status = VL53L1_ERROR_NONE;
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_core_support.c b/drivers/input/misc/vl53L1/src/vl53l1_core_support.c
new file mode 100644
index 0000000000000000000000000000000000000000..8a8947b6cfe203f13a5dde9d20d862d2871fe61f
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_core_support.c
@@ -0,0 +1,938 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_core_support.h"
+#include "vl53l1_platform_user_data.h"
+#include "vl53l1_platform_user_defines.h"
+
+
+
+
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, \
+		status, fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_CORE, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+
+uint32_t VL53L1_calc_pll_period_us(
+	uint16_t  fast_osc_frequency)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint32_t  pll_period_us        = 0;
+
+	LOG_FUNCTION_START("");
+
+	pll_period_us = (0x01 << 30) / fast_osc_frequency;
+
+
+
+
+
+
+
+	LOG_FUNCTION_END(0);
+
+	return pll_period_us;
+}
+
+
+uint32_t  VL53L1_duration_maths(
+	uint32_t  pll_period_us,
+	uint32_t  vcsel_parm_pclks,
+	uint32_t  window_vclks,
+	uint32_t  elapsed_mclks)
+{
+
+
+
+
+
+
+
+
+
+
+	uint64_t  tmp_long_int = 0;
+	uint32_t  duration_us  = 0;
+
+
+
+
+
+
+	duration_us = window_vclks * pll_period_us;
+
+
+
+
+
+	duration_us = duration_us >> 12;
+
+
+
+	tmp_long_int = (uint64_t)duration_us;
+
+
+
+
+
+
+	duration_us = elapsed_mclks * vcsel_parm_pclks;
+
+
+
+
+
+	duration_us = duration_us >> 4;
+
+
+
+
+
+	tmp_long_int = tmp_long_int * (uint64_t)duration_us;
+
+
+
+
+
+	tmp_long_int = tmp_long_int >> 12;
+
+
+
+	if (tmp_long_int > 0xFFFFFFFF)
+		tmp_long_int = 0xFFFFFFFF;
+
+	duration_us  = (uint32_t)tmp_long_int;
+
+	return duration_us;
+}
+
+
+uint32_t VL53L1_events_per_spad_maths(
+	int32_t   VL53L1_p_013,
+	uint16_t  num_spads,
+	uint32_t  duration)
+{
+	uint64_t total_hist_counts  = 0;
+	uint64_t xtalk_per_spad     = 0;
+	uint32_t rate_per_spad_kcps = 0;
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+	uint64_t dividend = ((uint64_t)VL53L1_p_013
+			* 1000 * 256);
+
+	total_hist_counts = do_division_u(dividend, (uint64_t)num_spads);
+
+
+
+
+	if (duration > 0) {
+
+
+
+
+
+
+
+
+		uint64_t dividend = (((uint64_t)(total_hist_counts << 11))
+			+ ((uint64_t)duration / 2));
+
+		xtalk_per_spad = do_division_u(dividend, (uint64_t)duration);
+	} else {
+		xtalk_per_spad =   (uint64_t)(total_hist_counts << 11);
+	}
+
+	rate_per_spad_kcps = (uint32_t)xtalk_per_spad;
+
+	return rate_per_spad_kcps;
+}
+
+
+uint32_t VL53L1_isqrt(uint32_t num)
+{
+
+
+
+
+
+
+
+
+	uint32_t  res = 0;
+	uint32_t  bit = 1 << 30;
+
+
+
+
+	while (bit > num)
+		bit >>= 2;
+
+	while (bit != 0) {
+		if (num >= res + bit)  {
+			num -= res + bit;
+			res = (res >> 1) + bit;
+		} else {
+			res >>= 1;
+		}
+		bit >>= 2;
+	}
+
+	return res;
+}
+
+
+void  VL53L1_hist_calc_zero_distance_phase(
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+
+	uint32_t  period        = 0;
+	uint32_t  VL53L1_p_017         = 0;
+
+	LOG_FUNCTION_START("");
+
+	period = 2048 *
+		(uint32_t)VL53L1_decode_vcsel_period(pdata->VL53L1_p_009);
+
+	VL53L1_p_017  = period;
+	VL53L1_p_017 += (uint32_t)pdata->phasecal_result__reference_phase;
+	VL53L1_p_017 += (2048 * (uint32_t)pdata->phasecal_result__vcsel_start);
+	VL53L1_p_017 -= (2048 * (uint32_t)pdata->cal_config__vcsel_start);
+
+	VL53L1_p_017  = VL53L1_p_017 % period;
+
+	pdata->zero_distance_phase = (uint16_t)VL53L1_p_017;
+
+	LOG_FUNCTION_END(0);
+}
+
+
+void  VL53L1_hist_estimate_ambient_from_thresholded_bins(
+	int32_t                        ambient_threshold_sigma,
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+
+
+
+
+	uint8_t  bin                      = 0;
+	int32_t  VL53L1_p_032 = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	VL53L1_hist_find_min_max_bin_values(pdata);
+
+
+
+
+
+
+
+	VL53L1_p_032  =
+		(int32_t)VL53L1_isqrt((uint32_t)pdata->min_bin_value);
+	VL53L1_p_032 *= ambient_threshold_sigma;
+	VL53L1_p_032 += 0x07;
+	VL53L1_p_032  = VL53L1_p_032 >> 4;
+	VL53L1_p_032 += pdata->min_bin_value;
+
+
+
+
+
+
+	pdata->number_of_ambient_samples = 0;
+	pdata->ambient_events_sum        = 0;
+
+	for (bin = 0; bin < pdata->VL53L1_p_024; bin++)
+		if (pdata->bin_data[bin] < VL53L1_p_032) {
+			pdata->ambient_events_sum += pdata->bin_data[bin];
+			pdata->number_of_ambient_samples++;
+		}
+
+
+
+
+
+
+	if (pdata->number_of_ambient_samples > 0) {
+		pdata->VL53L1_p_004 =
+			pdata->ambient_events_sum;
+		pdata->VL53L1_p_004 +=
+			((int32_t)pdata->number_of_ambient_samples/2);
+		pdata->VL53L1_p_004 /=
+			(int32_t)pdata->number_of_ambient_samples;
+	}
+
+	LOG_FUNCTION_END(0);
+}
+
+
+void  VL53L1_hist_remove_ambient_bins(
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+
+
+	uint8_t bin = 0;
+	uint8_t lc = 0;
+	uint8_t i = 0;
+
+
+
+
+	if ((pdata->bin_seq[0] & 0x07) == 0x07) {
+
+		i = 0;
+		for (lc = 0; lc < VL53L1_MAX_BIN_SEQUENCE_LENGTH; lc++) {
+			if ((pdata->bin_seq[lc] & 0x07) != 0x07) {
+				pdata->bin_seq[i] = pdata->bin_seq[lc];
+				pdata->bin_rep[i] = pdata->bin_rep[lc];
+				i++;
+			}
+		}
+
+
+
+
+
+
+		for (lc = i; lc < VL53L1_MAX_BIN_SEQUENCE_LENGTH; lc++) {
+			pdata->bin_seq[lc] = VL53L1_MAX_BIN_SEQUENCE_CODE + 1;
+			pdata->bin_rep[lc] = 0;
+		}
+	}
+
+	if (pdata->number_of_ambient_bins > 0) {
+
+
+
+		for (bin = pdata->number_of_ambient_bins;
+				bin < pdata->VL53L1_p_023; bin++) {
+			pdata->bin_data[bin-pdata->number_of_ambient_bins] =
+				pdata->bin_data[bin];
+		}
+
+
+
+		pdata->VL53L1_p_024 =
+				pdata->VL53L1_p_024 -
+				pdata->number_of_ambient_bins;
+		pdata->number_of_ambient_bins = 0;
+	}
+}
+
+
+uint32_t VL53L1_calc_pll_period_mm(
+	uint16_t fast_osc_frequency)
+{
+
+
+
+
+
+
+	uint32_t pll_period_us = 0;
+	uint32_t pll_period_mm = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pll_period_us  = VL53L1_calc_pll_period_us(fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+
+
+	pll_period_mm =
+			VL53L1_SPEED_OF_LIGHT_IN_AIR_DIV_8 *
+			(pll_period_us >> 2);
+
+
+
+	pll_period_mm = (pll_period_mm + (0x01<<15)) >> 16;
+
+	LOG_FUNCTION_END(0);
+
+	return pll_period_mm;
+}
+
+
+uint16_t VL53L1_rate_maths(
+	int32_t   VL53L1_p_008,
+	uint32_t  time_us)
+{
+
+
+
+
+
+
+
+
+
+
+
+
+	uint32_t  tmp_int   = 0;
+	uint32_t  frac_bits = 7;
+	uint16_t  rate_mcps = 0;
+
+
+
+
+
+
+
+	if (VL53L1_p_008 > VL53L1_SPAD_TOTAL_COUNT_MAX)
+		tmp_int = VL53L1_SPAD_TOTAL_COUNT_MAX;
+	else if (VL53L1_p_008 > 0)
+		tmp_int = (uint32_t)VL53L1_p_008;
+
+
+
+
+
+
+
+
+	if (VL53L1_p_008 > VL53L1_SPAD_TOTAL_COUNT_RES_THRES)
+		frac_bits = 3;
+	else
+		frac_bits = 7;
+
+
+
+
+
+
+
+	if (time_us > 0)
+		tmp_int = ((tmp_int << frac_bits) + (time_us / 2)) / time_us;
+
+
+
+
+
+	if (VL53L1_p_008 > VL53L1_SPAD_TOTAL_COUNT_RES_THRES)
+		tmp_int = tmp_int << 4;
+
+
+
+
+
+
+
+	if (tmp_int > 0xFFFF)
+		tmp_int = 0xFFFF;
+
+	rate_mcps =  (uint16_t)tmp_int;
+
+	return rate_mcps;
+}
+
+
+uint16_t VL53L1_rate_per_spad_maths(
+	uint32_t  frac_bits,
+	uint32_t  peak_count_rate,
+	uint16_t  num_spads,
+	uint32_t  max_output_value)
+{
+
+	uint32_t  tmp_int   = 0;
+
+
+
+	uint16_t  rate_per_spad = 0;
+
+
+
+
+
+
+
+
+
+	if (num_spads > 0) {
+		tmp_int = (peak_count_rate << 8) << frac_bits;
+		tmp_int = (tmp_int +
+			((uint32_t)num_spads / 2)) /
+				(uint32_t)num_spads;
+	} else {
+		tmp_int = ((peak_count_rate) << frac_bits);
+	}
+
+
+
+
+	if (tmp_int > max_output_value)
+		tmp_int = max_output_value;
+
+	rate_per_spad = (uint16_t)tmp_int;
+
+	return rate_per_spad;
+}
+
+
+int32_t VL53L1_range_maths(
+	uint16_t  fast_osc_frequency,
+	uint16_t  VL53L1_p_017,
+	uint16_t  zero_distance_phase,
+	uint8_t   fractional_bits,
+	int32_t   gain_factor,
+	int32_t   range_offset_mm)
+{
+
+
+
+
+
+	uint32_t    pll_period_us = 0;
+
+	int64_t     tmp_long_int  = 0;
+	int32_t     range_mm      = 0;
+	int32_t     range_mm_10   = 0;
+
+
+
+
+	pll_period_us  = VL53L1_calc_pll_period_us(fast_osc_frequency);
+
+
+
+
+
+
+
+
+
+
+	tmp_long_int = (int64_t)VL53L1_p_017 - (int64_t)zero_distance_phase;
+
+
+
+
+
+
+
+
+
+
+	tmp_long_int =  tmp_long_int * (int64_t)pll_period_us;
+
+
+
+
+
+
+	tmp_long_int =  tmp_long_int / (0x01 << 9);
+
+
+
+
+
+
+
+
+
+
+
+	tmp_long_int =  tmp_long_int * VL53L1_SPEED_OF_LIGHT_IN_AIR_DIV_8;
+
+
+
+
+
+
+	tmp_long_int =  tmp_long_int / (0x01 << 22);
+
+
+
+	range_mm  = (int32_t)tmp_long_int + range_offset_mm;
+
+
+
+	range_mm *= gain_factor;
+	range_mm += 0x0400;
+	range_mm /= 0x0800;
+
+
+
+	if (fractional_bits == 0) {
+		range_mm_10 = range_mm * 10;
+		range_mm_10 = range_mm_10 / (0x01 << 2);
+		if ((range_mm_10 % 10) < 5)
+			range_mm = (int16_t)(range_mm_10 / 10);
+		else
+			range_mm = (int16_t)(range_mm_10 / 10 + 1);
+	} else if (fractional_bits == 1)
+		range_mm = range_mm / (0x01 << 1);
+
+	return range_mm;
+}
+
+
+uint8_t VL53L1_decode_vcsel_period(uint8_t vcsel_period_reg)
+{
+
+
+
+
+
+
+	uint8_t VL53L1_p_031 = 0;
+
+	VL53L1_p_031 = (vcsel_period_reg + 1) << 1;
+
+	return VL53L1_p_031;
+}
+
+
+void VL53L1_copy_xtalk_bin_data_to_histogram_data_struct(
+		VL53L1_xtalk_histogram_shape_t *pxtalk,
+		VL53L1_histogram_bin_data_t    *phist)
+{
+
+
+
+
+
+
+	phist->cal_config__vcsel_start =
+			pxtalk->cal_config__vcsel_start;
+	phist->VL53L1_p_019 =
+			pxtalk->VL53L1_p_019;
+	phist->VL53L1_p_022 =
+			pxtalk->VL53L1_p_022;
+
+	phist->phasecal_result__reference_phase   =
+			pxtalk->phasecal_result__reference_phase;
+	phist->phasecal_result__vcsel_start       =
+			pxtalk->phasecal_result__vcsel_start;
+
+	phist->vcsel_width =
+			pxtalk->vcsel_width;
+	phist->zero_distance_phase =
+			pxtalk->zero_distance_phase;
+
+	phist->zone_id      = pxtalk->zone_id;
+	phist->VL53L1_p_023  = pxtalk->VL53L1_p_023;
+	phist->time_stamp   = pxtalk->time_stamp;
+}
+
+
+void VL53L1_init_histogram_bin_data_struct(
+	int32_t                      bin_value,
+	uint16_t                     VL53L1_p_024,
+	VL53L1_histogram_bin_data_t *pdata)
+{
+
+
+
+
+
+
+	uint16_t          i = 0;
+
+	pdata->cfg_device_state          = VL53L1_DEVICESTATE_SW_STANDBY;
+	pdata->rd_device_state           = VL53L1_DEVICESTATE_SW_STANDBY;
+
+	pdata->zone_id                   = 0;
+	pdata->time_stamp                = 0;
+
+	pdata->VL53L1_p_022                 = 0;
+	pdata->VL53L1_p_023               = VL53L1_HISTOGRAM_BUFFER_SIZE;
+	pdata->VL53L1_p_024            = (uint8_t)VL53L1_p_024;
+	pdata->number_of_ambient_bins    = 0;
+
+	pdata->result__interrupt_status           = 0;
+	pdata->result__range_status               = 0;
+	pdata->result__report_status              = 0;
+	pdata->result__stream_count               = 0;
+
+	pdata->result__dss_actual_effective_spads = 0;
+	pdata->phasecal_result__reference_phase   = 0;
+	pdata->phasecal_result__vcsel_start       = 0;
+	pdata->cal_config__vcsel_start            = 0;
+
+	pdata->vcsel_width                        = 0;
+	pdata->VL53L1_p_009                       = 0;
+	pdata->VL53L1_p_019                = 0;
+	pdata->total_periods_elapsed              = 0;
+
+	pdata->min_bin_value                      = 0;
+	pdata->max_bin_value                      = 0;
+
+	pdata->zero_distance_phase                = 0;
+	pdata->number_of_ambient_samples          = 0;
+	pdata->ambient_events_sum                 = 0;
+	pdata->VL53L1_p_004             = 0;
+
+	for (i = 0; i < VL53L1_MAX_BIN_SEQUENCE_LENGTH; i++)
+		pdata->bin_seq[i] = (uint8_t)i;
+
+	for (i = 0; i < VL53L1_MAX_BIN_SEQUENCE_LENGTH; i++)
+		pdata->bin_rep[i] = 1;
+
+
+	for (i = 0; i < VL53L1_HISTOGRAM_BUFFER_SIZE; i++)
+		if (i < VL53L1_p_024)
+			pdata->bin_data[i] = bin_value;
+		else
+			pdata->bin_data[i] = 0;
+
+
+}
+
+
+void VL53L1_decode_row_col(
+	uint8_t  spad_number,
+	uint8_t  *prow,
+	uint8_t  *pcol)
+{
+
+
+
+
+
+
+
+	if (spad_number > 127) {
+		*prow = 8 + ((255-spad_number) & 0x07);
+		*pcol = (spad_number-128) >> 3;
+	} else {
+		*prow = spad_number & 0x07;
+		*pcol = (127-spad_number) >> 3;
+	}
+}
+
+
+void  VL53L1_hist_find_min_max_bin_values(
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+	uint8_t  bin            = 0;
+
+	LOG_FUNCTION_START("");
+
+	for (bin = 0; bin < pdata->VL53L1_p_024; bin++) {
+
+		if (bin == 0 || pdata->min_bin_value >= pdata->bin_data[bin])
+			pdata->min_bin_value = pdata->bin_data[bin];
+
+		if (bin == 0 || pdata->max_bin_value <= pdata->bin_data[bin])
+			pdata->max_bin_value = pdata->bin_data[bin];
+
+	}
+
+	LOG_FUNCTION_END(0);
+
+}
+
+
+void  VL53L1_hist_estimate_ambient_from_ambient_bins(
+	VL53L1_histogram_bin_data_t   *pdata)
+{
+
+
+
+
+
+
+	uint8_t  bin            = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (pdata->number_of_ambient_bins > 0) {
+
+		pdata->number_of_ambient_samples =
+			pdata->number_of_ambient_bins;
+
+
+
+
+		pdata->ambient_events_sum = 0;
+		for (bin = 0; bin < pdata->number_of_ambient_bins; bin++)
+			pdata->ambient_events_sum += pdata->bin_data[bin];
+
+		pdata->VL53L1_p_004 = pdata->ambient_events_sum;
+		pdata->VL53L1_p_004 +=
+				((int32_t)pdata->number_of_ambient_bins / 2);
+		pdata->VL53L1_p_004 /=
+			(int32_t)pdata->number_of_ambient_bins;
+
+	}
+
+	LOG_FUNCTION_END(0);
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_error_strings.c b/drivers/input/misc/vl53L1/src/vl53l1_error_strings.c
new file mode 100644
index 0000000000000000000000000000000000000000..e8e9920e4a368eca206ee6672b1624b3d67148f0
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_error_strings.c
@@ -0,0 +1,334 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_error_codes.h"
+#include "vl53l1_error_strings.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_ll_def.h"
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_API, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_API, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_API, \
+		status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_get_pal_error_string(
+#ifndef VL53L1_USE_EMPTY_STRING
+	VL53L1_Error   PalErrorCode,
+#endif
+	char          *pPalErrorString)
+{
+	VL53L1_Error Status = VL53L1_ERROR_NONE;
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	SUPPRESS_UNUSED_WARNING(PalErrorCode);
+#endif
+
+	LOG_FUNCTION_START("");
+
+#ifdef VL53L1_USE_EMPTY_STRING
+	VL53L1_COPYSTRING(pPalErrorString, "");
+#else
+
+	switch (PalErrorCode) {
+	case VL53L1_ERROR_NONE:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_NONE);
+		break;
+	case VL53L1_ERROR_CALIBRATION_WARNING:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_CALIBRATION_WARNING);
+		break;
+	case VL53L1_ERROR_MIN_CLIPPED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_MIN_CLIPPED);
+		break;
+	case VL53L1_ERROR_UNDEFINED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_UNDEFINED);
+		break;
+	case VL53L1_ERROR_INVALID_PARAMS:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_INVALID_PARAMS);
+		break;
+	case VL53L1_ERROR_NOT_SUPPORTED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_NOT_SUPPORTED);
+		break;
+	case VL53L1_ERROR_RANGE_ERROR:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_RANGE_ERROR);
+		break;
+	case VL53L1_ERROR_TIME_OUT:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_TIME_OUT);
+		break;
+	case VL53L1_ERROR_MODE_NOT_SUPPORTED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_MODE_NOT_SUPPORTED);
+		break;
+	case VL53L1_ERROR_BUFFER_TOO_SMALL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_BUFFER_TOO_SMALL);
+		break;
+	case VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_COMMS_BUFFER_TOO_SMALL);
+		break;
+	case VL53L1_ERROR_GPIO_NOT_EXISTING:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_GPIO_NOT_EXISTING);
+		break;
+	case VL53L1_ERROR_GPIO_FUNCTIONALITY_NOT_SUPPORTED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_GPIO_FUNCTIONALITY_NOT_SUPPORTED);
+		break;
+	case VL53L1_ERROR_CONTROL_INTERFACE:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_CONTROL_INTERFACE);
+		break;
+	case VL53L1_ERROR_INVALID_COMMAND:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_INVALID_COMMAND);
+		break;
+	case VL53L1_ERROR_DIVISION_BY_ZERO:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_DIVISION_BY_ZERO);
+		break;
+	case VL53L1_ERROR_REF_SPAD_INIT:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_REF_SPAD_INIT);
+		break;
+	case VL53L1_ERROR_GPH_SYNC_CHECK_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_GPH_SYNC_CHECK_FAIL);
+		break;
+	case VL53L1_ERROR_STREAM_COUNT_CHECK_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_STREAM_COUNT_CHECK_FAIL);
+		break;
+	case VL53L1_ERROR_GPH_ID_CHECK_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_GPH_ID_CHECK_FAIL);
+		break;
+	case VL53L1_ERROR_ZONE_STREAM_COUNT_CHECK_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_ZONE_STREAM_COUNT_CHECK_FAIL);
+		break;
+	case VL53L1_ERROR_ZONE_GPH_ID_CHECK_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_ZONE_GPH_ID_CHECK_FAIL);
+		break;
+
+	case VL53L1_ERROR_XTALK_EXTRACTION_NO_SAMPLE_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_XTALK_EXTRACTION_NO_SAMPLES_FAIL);
+		break;
+	case VL53L1_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_XTALK_EXTRACTION_SIGMA_LIMIT_FAIL);
+		break;
+
+	case VL53L1_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_OFFSET_CAL_NO_SAMPLE_FAIL);
+		break;
+	case VL53L1_ERROR_OFFSET_CAL_NO_SPADS_ENABLED_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_OFFSET_CAL_NO_SPADS_ENABLED_FAIL);
+		break;
+	case VL53L1_ERROR_ZONE_CAL_NO_SAMPLE_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_ZONE_CAL_NO_SAMPLE_FAIL);
+		break;
+
+	case VL53L1_WARNING_OFFSET_CAL_MISSING_SAMPLES:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_OFFSET_CAL_MISSING_SAMPLES);
+		break;
+	case VL53L1_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_OFFSET_CAL_SIGMA_TOO_HIGH);
+		break;
+	case VL53L1_WARNING_OFFSET_CAL_RATE_TOO_HIGH:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_OFFSET_CAL_RATE_TOO_HIGH);
+		break;
+	case VL53L1_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_OFFSET_CAL_SPAD_COUNT_TOO_LOW);
+		break;
+
+	case VL53L1_WARNING_ZONE_CAL_MISSING_SAMPLES:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_ZONE_CAL_MISSING_SAMPLES);
+		break;
+	case VL53L1_WARNING_ZONE_CAL_SIGMA_TOO_HIGH:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_ZONE_CAL_SIGMA_TOO_HIGH);
+		break;
+	case VL53L1_WARNING_ZONE_CAL_RATE_TOO_HIGH:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_ZONE_CAL_RATE_TOO_HIGH);
+		break;
+
+	case VL53L1_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_REF_SPAD_CHAR_NOT_ENOUGH_SPADS);
+		break;
+	case VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_REF_SPAD_CHAR_RATE_TOO_HIGH);
+		break;
+	case VL53L1_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_REF_SPAD_CHAR_RATE_TOO_LOW);
+		break;
+
+	case VL53L1_WARNING_XTALK_MISSING_SAMPLES:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_XTALK_MISSING_SAMPLES);
+		break;
+	case VL53L1_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_XTALK_NO_SAMPLES_FOR_GRADIENT);
+		break;
+	case VL53L1_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_WARNING_XTALK_SIGMA_LIMIT_FOR_GRADIENT);
+		break;
+
+	case VL53L1_ERROR_DEVICE_FIRMWARE_TOO_OLD:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_DEVICE_FIRMWARE_TOO_OLD);
+		break;
+	case VL53L1_ERROR_DEVICE_FIRMWARE_TOO_NEW:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_DEVICE_FIRMWARE_TOO_NEW);
+		break;
+	case VL53L1_ERROR_UNIT_TEST_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_UNIT_TEST_FAIL);
+		break;
+	case VL53L1_ERROR_FILE_READ_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_FILE_READ_FAIL);
+		break;
+	case VL53L1_ERROR_FILE_WRITE_FAIL:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_FILE_WRITE_FAIL);
+		break;
+	case VL53L1_ERROR_NOT_IMPLEMENTED:
+		VL53L1_COPYSTRING(pPalErrorString,
+			VL53L1_STRING_ERROR_NOT_IMPLEMENTED);
+		break;
+	default:
+		VL53L1_COPYSTRING(pPalErrorString,
+				VL53L1_STRING_UNKNOW_ERROR_CODE);
+	}
+
+#endif
+
+	LOG_FUNCTION_END(Status);
+
+	return Status;
+}
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_hist_char.c b/drivers/input/misc/vl53L1/src/vl53l1_hist_char.c
new file mode 100644
index 0000000000000000000000000000000000000000..5f13482e28e576ccfc22b52a8aac2c0c73f28de7
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_hist_char.c
@@ -0,0 +1,282 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include <stdio.h>
+
+#include <stdlib.h>
+
+
+
+
+
+
+
+#include "vl53l1_core.h"
+#include "vl53l1_register_settings.h"
+#include "vl53l1_hist_char.h"
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_HISTOGRAM, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_HISTOGRAM, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_HISTOGRAM,\
+		status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_set_calib_config(
+	VL53L1_DEV      Dev,
+	uint8_t         vcsel_delay__a0,
+	uint8_t         calib_1,
+	uint8_t         calib_2,
+	uint8_t         calib_3,
+	uint8_t         calib_2__a0,
+	uint8_t         spad_readout)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+	uint8_t      comms_buffer[3];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_enable_powerforce(Dev);
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__VCSEL_DELAY__A0,
+					vcsel_delay__a0);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE) {
+
+
+
+
+
+
+
+		comms_buffer[0] = calib_1;
+		comms_buffer[1] = calib_2;
+		comms_buffer[2] = calib_3;
+
+		status = VL53L1_WriteMulti(
+					Dev,
+					VL53L1_RANGING_CORE__CALIB_1,
+					comms_buffer,
+					3);
+	}
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__CALIB_2__A0,
+					calib_2__a0);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__SPAD_READOUT,
+					spad_readout);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+VL53L1_Error VL53L1_set_hist_calib_pulse_delay(
+	VL53L1_DEV      Dev,
+	uint8_t         calib_delay)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status =
+		VL53L1_set_calib_config(
+			Dev,
+			0x01,
+
+			calib_delay,
+
+			0x04,
+
+			0x08,
+
+			0x14,
+
+			VL53L1_RANGING_CORE__SPAD_READOUT__CALIB_PULSES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_disable_calib_pulse_delay(
+	VL53L1_DEV      Dev)
+{
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	status =
+		VL53L1_set_calib_config(
+			Dev,
+			0x00,
+
+			0x00,
+
+			0x00,
+
+			0x00,
+
+			0x00,
+
+			VL53L1_RANGING_CORE__SPAD_READOUT__STANDARD);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_nvm.c b/drivers/input/misc/vl53L1/src/vl53l1_nvm.c
new file mode 100644
index 0000000000000000000000000000000000000000..1a0175fa6a3f151a60fc7d3fc667c52e3af8a53c
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_nvm.c
@@ -0,0 +1,1751 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#ifdef _MSC_VER
+#define snprintf _snprintf
+#endif
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_core.h"
+#include "vl53l1_nvm_structs.h"
+#include "vl53l1_nvm_map.h"
+#include "vl53l1_nvm.h"
+
+
+
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_NVM, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_NVM, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_NVM,\
+		status, fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(VL53L1_TRACE_MODULE_NVM, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_nvm_enable(
+	VL53L1_DEV      Dev,
+	uint16_t        nvm_ctrl_pulse_width,
+	int32_t         nvm_power_up_delay_us)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_powerforce(Dev);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WaitUs(
+			Dev,
+			VL53L1_ENABLE_POWERFORCE_SETTLING_TIME_US);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__NVM_CTRL__PDN,
+					0x01);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__CLK_CTRL1,
+					0x05);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WaitUs(
+					Dev,
+					nvm_power_up_delay_us);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__NVM_CTRL__MODE,
+					0x01);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrWord(
+			Dev,
+			VL53L1_RANGING_CORE__NVM_CTRL__PULSE_WIDTH_MSB,
+			nvm_ctrl_pulse_width);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_nvm_read(
+	VL53L1_DEV    Dev,
+	uint8_t       start_address,
+	uint8_t       count,
+	uint8_t      *pdata)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+	uint8_t      nvm_addr = 0;
+
+	LOG_FUNCTION_START("");
+
+	trace_print(
+		   VL53L1_TRACE_LEVEL_INFO,
+		   "%-12s = 0x%02X (%3u)\n",
+		   "nvm_addr", nvm_addr, nvm_addr);
+
+	trace_print(
+		   VL53L1_TRACE_LEVEL_INFO,
+		   "%-12s = 0x%02X (%3u)\n",
+		   "count", count, count);
+
+	for (nvm_addr = start_address;
+		nvm_addr < (start_address+count) ; nvm_addr++) {
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WrByte(
+				Dev,
+				VL53L1_RANGING_CORE__NVM_CTRL__ADDR,
+				nvm_addr);
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WrByte(
+				Dev,
+				VL53L1_RANGING_CORE__NVM_CTRL__READN,
+				0x00);
+
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WaitUs(
+				Dev,
+				VL53L1_NVM_READ_TRIGGER_DELAY_US);
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_WrByte(
+				Dev,
+				VL53L1_RANGING_CORE__NVM_CTRL__READN,
+				0x01);
+
+
+
+		if (status == VL53L1_ERROR_NONE)
+			status = VL53L1_ReadMulti(
+				Dev,
+				VL53L1_RANGING_CORE__NVM_CTRL__DATAOUT_MMM,
+				pdata,
+				4);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"NVM address : 0x%02X = 0x%02X%02X%02X%02X\n",
+			nvm_addr, *pdata, *(pdata+1), *(pdata+2), *(pdata+3));
+
+
+
+
+		pdata = pdata + 4;
+
+
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_disable(
+	VL53L1_DEV    Dev)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__NVM_CTRL__READN,
+					0x01);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WrByte(
+					Dev,
+					VL53L1_RANGING_CORE__NVM_CTRL__PDN,
+					0x00);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_powerforce(Dev);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_nvm_format_decode(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_decoded_nvm_data_t *pdata)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	uint8_t    i        = 0;
+	uint8_t   *ptmp     = NULL;
+	int        pptmp[VL53L1_NVM_MAX_FMT_RANGE_DATA];
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_NVM_SIZE_IN_BYTES)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->nvm__identification_model_id =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__IDENTIFICATION__MODEL_ID,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__identification_module_type =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__IDENTIFICATION__MODULE_TYPE,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__identification_revision_id =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__IDENTIFICATION__REVISION_ID,
+			0x0000000F,
+			0,
+			0);
+	pdata->nvm__identification_module_id =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__IDENTIFICATION__MODULE_ID,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__i2c_valid =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__I2C_VALID,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__i2c_device_address_ews =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__I2C_SLAVE__DEVICE_ADDRESS,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__ews__fast_osc_frequency =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer +
+			VL53L1_NVM__EWS__OSC_MEASURED__FAST_OSC_FREQUENCY,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__ews__fast_osc_trim_max =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__FAST_OSC_TRIM_MAX,
+			0x0000007F,
+			0,
+			0);
+	pdata->nvm__ews__fast_osc_freq_set =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__FAST_OSC_FREQ_SET,
+			0x00000007,
+			0,
+			0);
+	pdata->nvm__ews__slow_osc_calibration =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__EWS__SLOW_OSC_CALIBRATION,
+			0x000003FF,
+			0,
+			0);
+	pdata->nvm__fmt__fast_osc_frequency =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer +
+			VL53L1_NVM__FMT__OSC_MEASURED__FAST_OSC_FREQUENCY,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__fmt__fast_osc_trim_max =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FAST_OSC_TRIM_MAX,
+			0x0000007F,
+			0,
+			0);
+	pdata->nvm__fmt__fast_osc_freq_set =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FAST_OSC_FREQ_SET,
+			0x00000007,
+			0,
+			0);
+	pdata->nvm__fmt__slow_osc_calibration =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__FMT__SLOW_OSC_CALIBRATION,
+			0x000003FF,
+			0,
+			0);
+	pdata->nvm__vhv_config_unlock =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__VHV_CONFIG_UNLOCK,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__ref_selvddpix =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__REF_SELVDDPIX,
+			0x0000000F,
+			0,
+			0);
+	pdata->nvm__ref_selvquench =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__REF_SELVQUENCH,
+			0x00000078,
+			3,
+			0);
+	pdata->nvm__regavdd1v2_sel =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__REGAVDD1V2_SEL_REGDVDD1V2_SEL,
+			0x0000000C,
+			2,
+			0);
+	pdata->nvm__regdvdd1v2_sel =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__REGAVDD1V2_SEL_REGDVDD1V2_SEL,
+			0x00000003,
+			0,
+			0);
+	pdata->nvm__vhv_timeout__macrop =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__VHV_CONFIG__TIMEOUT_MACROP_LOOP_BOUND,
+			0x00000003,
+			0,
+			0);
+	pdata->nvm__vhv_loop_bound =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__VHV_CONFIG__TIMEOUT_MACROP_LOOP_BOUND,
+			0x000000FC,
+			2,
+			0);
+	pdata->nvm__vhv_count_threshold =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__VHV_CONFIG__COUNT_THRESH,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__vhv_offset =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__VHV_CONFIG__OFFSET,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__vhv_init_enable =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__VHV_CONFIG__INIT,
+			0x00000080,
+			7,
+			0);
+	pdata->nvm__vhv_init_value =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__VHV_CONFIG__INIT,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_trim_ll =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_TRIM_LL,
+			0x00000007,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_selion_ll =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_LL,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_selion_max_ll =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_MAX_LL,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_mult_ll =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__MULT_LL,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_clip_ll =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__CLIP_LL,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_trim_ld =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_TRIM_LD,
+			0x00000007,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_selion_ld =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_LD,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_vcsel_selion_max_ld =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__VCSEL_SELION_MAX_LD,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_mult_ld =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__MULT_LD,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_clip_ld =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY__CLIP_LD,
+			0x0000003F,
+			0,
+			0);
+	pdata->nvm__laser_safety_lock_byte =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY_LOCK_BYTE,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__laser_safety_unlock_byte =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__LASER_SAFETY_UNLOCK_BYTE,
+			0x000000FF,
+			0,
+			0);
+
+
+
+
+	ptmp = pbuffer + VL53L1_NVM__EWS__SPAD_ENABLES_RTN_0_;
+	for (i = 0 ; i < VL53L1_RTN_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__ews__spad_enables_rtn[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC1_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__ews__spad_enables_ref__loc1[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC2_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__ews__spad_enables_ref__loc2[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__EWS__SPAD_ENABLES_REF__LOC3_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__ews__spad_enables_ref__loc3[i] = *ptmp++;
+
+
+
+
+	ptmp = pbuffer + VL53L1_NVM__FMT__SPAD_ENABLES_RTN_0_;
+	for (i = 0 ; i < VL53L1_RTN_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__fmt__spad_enables_rtn[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC1_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__fmt__spad_enables_ref__loc1[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC2_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__fmt__spad_enables_ref__loc2[i] = *ptmp++;
+
+	ptmp = pbuffer + VL53L1_NVM__FMT__SPAD_ENABLES_REF__LOC3_0_;
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++)
+		pdata->nvm__fmt__spad_enables_ref__loc3[i] = *ptmp++;
+
+
+	pdata->nvm__fmt__roi_config__mode_roi_centre_spad =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__FMT__ROI_CONFIG__MODE_ROI_CENTRE_SPAD,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__fmt__roi_config__mode_roi_x_size =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__FMT__ROI_CONFIG__MODE_ROI_XY_SIZE,
+			0x000000F0,
+			4,
+			0);
+	pdata->nvm__fmt__roi_config__mode_roi_y_size =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__ROI_CONFIG__MODE_ROI_XY_SIZE,
+			0x0000000F,
+			0,
+			0);
+	pdata->nvm__fmt__ref_spad_apply__num_requested_ref_spad =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__FMT__REF_SPAD_APPLY__NUM_REQUESTED_REF_SPAD,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__fmt__ref_spad_man__ref_location =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__REF_SPAD_MAN__REF_LOCATION,
+			0x00000003,
+			0,
+			0);
+	pdata->nvm__fmt__mm_config__inner_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__FMT__MM_CONFIG__INNER_OFFSET_MM,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__fmt__mm_config__outer_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__FMT__MM_CONFIG__OUTER_OFFSET_MM,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__fmt__algo_part_to_part_range_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer +
+			VL53L1_NVM__FMT__ALGO__PART_TO_PART_RANGE_OFFSET_MM,
+			0x00000FFF,
+			0,
+			0);
+	pdata->nvm__fmt__algo__crosstalk_compensation_plane_offset_kcps =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+		2,
+		pbuffer +
+		VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS,
+		0x0000FFFF,
+		0,
+		0);
+	pdata->nvm__fmt__algo__crosstalk_compensation_x_plane_gradient_kcps =
+	(uint16_t)VL53L1_i2c_decode_with_mask(
+	2,
+	pbuffer +
+	VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS,
+	0x0000FFFF,
+	0,
+	0);
+	pdata->nvm__fmt__algo__crosstalk_compensation_y_plane_gradient_kcps =
+	(uint16_t)VL53L1_i2c_decode_with_mask(
+	2,
+	pbuffer +
+	VL53L1_NVM__FMT__ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS,
+	0x0000FFFF,
+	0,
+	0);
+	pdata->nvm__fmt__spare__host_config__nvm_config_spare_0 =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__FMT__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_0,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__fmt__spare__host_config__nvm_config_spare_1 =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer +
+			VL53L1_NVM__FMT__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_1,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__customer_space_programmed =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__CUSTOMER_NVM_SPACE_PROGRAMMED,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__cust__i2c_device_address =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__CUST__I2C_SLAVE__DEVICE_ADDRESS,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__cust__ref_spad_apply__num_requested_ref_spad =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+		1,
+		pbuffer +
+		VL53L1_NVM__CUST__REF_SPAD_APPLY__NUM_REQUESTED_REF_SPAD,
+		0x000000FF,
+		0,
+		0);
+	pdata->nvm__cust__ref_spad_man__ref_location =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__CUST__REF_SPAD_MAN__REF_LOCATION,
+			0x00000003,
+			0,
+			0);
+	pdata->nvm__cust__mm_config__inner_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__CUST__MM_CONFIG__INNER_OFFSET_MM,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__cust__mm_config__outer_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__CUST__MM_CONFIG__OUTER_OFFSET_MM,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__cust__algo_part_to_part_range_offset_mm =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer +
+			VL53L1_NVM__CUST__ALGO__PART_TO_PART_RANGE_OFFSET_MM,
+			0x00000FFF,
+			0,
+			0);
+	pdata->nvm__cust__algo__crosstalk_compensation_plane_offset_kcps =
+	(uint16_t)VL53L1_i2c_decode_with_mask(
+	2,
+	pbuffer +
+	VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_PLANE_OFFSET_KCPS,
+	0x0000FFFF,
+	0,
+	0);
+	pdata->nvm__cust__algo__crosstalk_compensation_x_plane_gradient_kcps =
+	(uint16_t)VL53L1_i2c_decode_with_mask(
+	2,
+	pbuffer +
+	VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_X_PLANE_GRADIENT_KCPS,
+	0x0000FFFF,
+	0,
+	0);
+	pdata->nvm__cust__algo__crosstalk_compensation_y_plane_gradient_kcps =
+	(uint16_t)VL53L1_i2c_decode_with_mask(
+	2,
+	pbuffer +
+	VL53L1_NVM__CUST__ALGO__CROSSTALK_COMPENSATION_Y_PLANE_GRADIENT_KCPS,
+	0x0000FFFF,
+	0,
+	0);
+	pdata->nvm__cust__spare__host_config__nvm_config_spare_0 =
+	(uint8_t)VL53L1_i2c_decode_with_mask(
+	1,
+	pbuffer + VL53L1_NVM__CUST__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_0,
+	0x000000FF,
+	0,
+	0);
+	pdata->nvm__cust__spare__host_config__nvm_config_spare_1 =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+		1,
+		pbuffer +
+		VL53L1_NVM__CUST__SPARE_HOST_CONFIG__NVM_CONFIG_SPARE_1,
+		0x000000FF,
+		0,
+		0);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+		VL53L1_nvm_decode_optical_centre(
+			buf_size,
+			pbuffer + VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_INDEX,
+			&(pdata->fmt_optical_centre));
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+		VL53L1_nvm_decode_cal_peak_rate_map(
+			buf_size,
+			pbuffer + VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_INDEX,
+			&(pdata->fmt_peak_rate_map));
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+		VL53L1_nvm_decode_additional_offset_cal_data(
+			buf_size,
+			pbuffer +
+			VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_INDEX,
+			&(pdata->fmt_add_offset_data));
+
+
+
+
+	pptmp[0] = VL53L1_NVM__FMT__RANGE_RESULTS__140MM_MM_PRE_RANGE;
+	pptmp[1] = VL53L1_NVM__FMT__RANGE_RESULTS__140MM_DARK;
+	pptmp[2] = VL53L1_NVM__FMT__RANGE_RESULTS__400MM_DARK;
+	pptmp[3] = VL53L1_NVM__FMT__RANGE_RESULTS__400MM_AMBIENT;
+
+	for (i = 0 ; i < VL53L1_NVM_MAX_FMT_RANGE_DATA ; i++) {
+		if (status == VL53L1_ERROR_NONE)
+			status =
+				VL53L1_nvm_decode_fmt_range_results_data(
+					buf_size,
+					pbuffer + pptmp[i],
+					&(pdata->fmt_range_data[i]));
+	}
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_nvm_decode_fmt_info(
+				buf_size,
+				pbuffer,
+				&(pdata->fmt_info));
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_nvm_decode_ews_info(
+				buf_size,
+				pbuffer,
+				&(pdata->ews_info));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_optical_centre(
+	uint16_t                    buf_size,
+	uint8_t                    *pbuffer,
+	VL53L1_optical_centre_t    *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	uint16_t  tmp = 0;
+
+	if (buf_size < VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_SIZE)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+
+
+
+
+	tmp  = 0x0100;
+	tmp -= (uint16_t)*(pbuffer + 2);
+	if (tmp > 0x0FF)
+		tmp = 0;
+
+	pdata->x_centre = (uint8_t)tmp;
+	pdata->y_centre = *(pbuffer + 3);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_cal_peak_rate_map(
+	uint16_t                    buf_size,
+	uint8_t                    *pbuffer,
+	VL53L1_cal_peak_rate_map_t *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	uint8_t   *ptmp = NULL;
+	uint8_t       i = 0;
+
+	if (buf_size < VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_SIZE)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->cal_distance_mm =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer);
+
+	pdata->cal_reflectance_pc =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 2);
+	pdata->cal_reflectance_pc =
+		pdata->cal_reflectance_pc >> 6;
+
+	pdata->max_samples = VL53L1_NVM_PEAK_RATE_MAP_SAMPLES;
+	pdata->width       = VL53L1_NVM_PEAK_RATE_MAP_WIDTH;
+	pdata->height      = VL53L1_NVM_PEAK_RATE_MAP_HEIGHT;
+
+	ptmp = pbuffer + 4;
+	for (i = 0 ; i < VL53L1_NVM_PEAK_RATE_MAP_SAMPLES ; i++) {
+		pdata->peak_rate_mcps[i] =
+			(uint16_t)VL53L1_i2c_decode_uint16_t(2, ptmp);
+		ptmp += 2;
+	}
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_additional_offset_cal_data(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_additional_offset_cal_data_t *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	if (buf_size < VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_SIZE)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->result__mm_inner_actual_effective_spads =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer);
+
+	pdata->result__mm_outer_actual_effective_spads =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 2);
+
+	pdata->result__mm_inner_peak_signal_count_rtn_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 4);
+
+	pdata->result__mm_outer_peak_signal_count_rtn_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 6);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_fmt_range_results_data(
+	uint16_t                             buf_size,
+	uint8_t                             *pbuffer,
+	VL53L1_decoded_nvm_fmt_range_data_t *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	if (buf_size < VL53L1_NVM__FMT__RANGE_RESULTS__SIZE_BYTES)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->result__actual_effective_rtn_spads =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer);
+
+	pdata->ref_spad_array__num_requested_ref_spads =
+		*(pbuffer+2);
+
+	pdata->ref_spad_array__ref_location =
+		*(pbuffer+3);
+
+	pdata->result__peak_signal_count_rate_rtn_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 4);
+
+	pdata->result__ambient_count_rate_rtn_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 6);
+
+	pdata->result__peak_signal_count_rate_ref_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 8);
+
+	pdata->result__ambient_count_rate_ref_mcps =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 10);
+
+	pdata->measured_distance_mm =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 12);
+
+	pdata->measured_distance_stdev_mm =
+		(uint16_t)VL53L1_i2c_decode_uint16_t(2, pbuffer + 14);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_fmt_info(
+	uint16_t                       buf_size,
+	uint8_t                       *pbuffer,
+	VL53L1_decoded_nvm_fmt_info_t *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	if (buf_size < VL53L1_NVM_SIZE_IN_BYTES)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->nvm__fmt__fgc[0] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_0,
+			0x000000FE,
+			1,
+			0);
+	pdata->nvm__fmt__fgc[1] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_1,
+			0x000001FC,
+			2,
+			0);
+	pdata->nvm__fmt__fgc[2] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_2 - 1,
+			0x000003F8,
+			3,
+			0);
+	pdata->nvm__fmt__fgc[3] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_3 - 1,
+			0x000007F0,
+			4,
+			0);
+	pdata->nvm__fmt__fgc[4] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_4 - 1,
+			0x00000FE0,
+			5,
+			0);
+	pdata->nvm__fmt__fgc[5] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_5 - 1,
+			0x00001FC0,
+			6,
+			0);
+	pdata->nvm__fmt__fgc[6] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_6 - 1,
+			0x00003F80,
+			7,
+			0);
+	pdata->nvm__fmt__fgc[7] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_6,
+			0x0000007F,
+			0,
+			0);
+	pdata->nvm__fmt__fgc[8] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_7,
+			0x000000FE,
+			1,
+			0);
+	pdata->nvm__fmt__fgc[9] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_8,
+			0x000001FC,
+			2,
+			0);
+	pdata->nvm__fmt__fgc[10] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_9 - 1,
+			0x000003F8,
+			3,
+			0);
+	pdata->nvm__fmt__fgc[11] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_10 - 1,
+			0x000007F0,
+			4,
+			0);
+	pdata->nvm__fmt__fgc[12] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_11 - 1,
+			0x00000FE0,
+			5,
+			0);
+	pdata->nvm__fmt__fgc[13] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_12 - 1,
+			0x00001FC0,
+			6,
+			0);
+	pdata->nvm__fmt__fgc[14] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_13 - 1,
+			0x00003F80,
+			7,
+			0);
+	pdata->nvm__fmt__fgc[15] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_13,
+			0x0000007F,
+			0,
+			0);
+	pdata->nvm__fmt__fgc[16] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_14,
+			0x000000FE,
+			1,
+			0);
+	pdata->nvm__fmt__fgc[17] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__FGC__BYTE_15,
+			0x000001FC,
+			2,
+			0);
+	pdata->nvm__fmt__fgc[18] = 0x00;
+
+			pdata->nvm__fmt__test_program_major =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__TEST_PROGRAM_MAJOR_MINOR,
+			0x000000E0,
+			5,
+			0);
+	pdata->nvm__fmt__test_program_minor =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__TEST_PROGRAM_MAJOR_MINOR,
+			0x0000001F,
+			0,
+			0);
+	pdata->nvm__fmt__map_major =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__MAP_MAJOR_MINOR,
+			0x000000E0,
+			5,
+			0);
+	pdata->nvm__fmt__map_minor =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__MAP_MAJOR_MINOR,
+			0x0000001F,
+			0,
+			0);
+	pdata->nvm__fmt__year =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__YEAR_MONTH,
+			0x000000F0,
+			4,
+			0);
+	pdata->nvm__fmt__month =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__YEAR_MONTH,
+			0x0000000F,
+			0,
+			0);
+	pdata->nvm__fmt__day =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__DAY_MODULE_DATE_PHASE,
+			0x000000F8,
+			3,
+			0);
+	pdata->nvm__fmt__module_date_phase =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__DAY_MODULE_DATE_PHASE,
+			0x00000007,
+			0,
+			0);
+	pdata->nvm__fmt__time =
+		(uint16_t)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__FMT__TIME,
+			0x0000FFFF,
+			0,
+			0);
+	pdata->nvm__fmt__tester_id =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__TESTER_ID,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__fmt__site_id =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__FMT__SITE_ID,
+			0x000000FF,
+			0,
+			0);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_nvm_decode_ews_info(
+	uint16_t                       buf_size,
+	uint8_t                       *pbuffer,
+	VL53L1_decoded_nvm_ews_info_t *pdata)
+{
+
+	VL53L1_Error status   = VL53L1_ERROR_NONE;
+
+	if (buf_size < VL53L1_NVM_SIZE_IN_BYTES)
+		return VL53L1_ERROR_BUFFER_TOO_SMALL;
+
+	pdata->nvm__ews__test_program_major =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__TEST_PROGRAM_MAJOR_MINOR,
+			0x000000E0,
+			5,
+			0);
+	pdata->nvm__ews__test_program_minor =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__TEST_PROGRAM_MAJOR_MINOR,
+			0x0000001F,
+			0,
+			0);
+	pdata->nvm__ews__probe_card_major =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__PROBE_CARD_MAJOR_MINOR,
+			0x000000F0,
+			4,
+			0);
+	pdata->nvm__ews__probe_card_minor =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__PROBE_CARD_MAJOR_MINOR,
+			0x0000000F,
+			0,
+			0);
+	pdata->nvm__ews__tester_id =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__TESTER_ID,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__ews__lot[0] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_0,
+			0x000000FC,
+			2,
+			32);
+	pdata->nvm__ews__lot[1] =
+		(char)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_1 - 1,
+			0x000003F0,
+			4,
+			32);
+	pdata->nvm__ews__lot[2] =
+		(char)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_2 - 1,
+			0x00000FC0,
+			6,
+			32);
+	pdata->nvm__ews__lot[3] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_2,
+			0x0000003F,
+			0,
+			32);
+	pdata->nvm__ews__lot[4] =
+		(char)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_3,
+			0x000000FC,
+			2,
+			32);
+	pdata->nvm__ews__lot[5] =
+		(char)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_4 - 1,
+			0x000003F0,
+			4,
+			32);
+	pdata->nvm__ews__lot[6] =
+		(char)VL53L1_i2c_decode_with_mask(
+			2,
+			pbuffer + VL53L1_NVM__EWS__LOT__BYTE_5 - 1,
+			0x00000FC0,
+			6,
+			32);
+
+	pdata->nvm__ews__lot[7] = 0x00;
+
+	pdata->nvm__ews__wafer =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__WAFER,
+			0x0000001F,
+			0,
+			0);
+	pdata->nvm__ews__xcoord =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__XCOORD,
+			0x000000FF,
+			0,
+			0);
+	pdata->nvm__ews__ycoord =
+		(uint8_t)VL53L1_i2c_decode_with_mask(
+			1,
+			pbuffer + VL53L1_NVM__EWS__YCOORD,
+			0x000000FF,
+			0,
+			0);
+
+	return status;
+
+}
+
+
+void VL53L1_nvm_format_encode(
+	VL53L1_decoded_nvm_data_t *pnvm_info,
+	uint8_t                   *pnvm_data)
+{
+	SUPPRESS_UNUSED_WARNING(pnvm_info);
+	SUPPRESS_UNUSED_WARNING(pnvm_data);
+}
+
+
+VL53L1_Error VL53L1_read_nvm_raw_data(
+	VL53L1_DEV     Dev,
+	uint8_t        start_address,
+	uint8_t        count,
+	uint8_t       *pnvm_raw_data)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_nvm_enable(
+					Dev,
+					0x0004,
+					VL53L1_NVM_POWER_UP_DELAY_US);
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_nvm_read(
+			Dev,
+			start_address,
+			count,
+			pnvm_raw_data);
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_nvm_disable(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_read_nvm(
+	VL53L1_DEV                 Dev,
+	uint8_t                    nvm_format,
+	VL53L1_decoded_nvm_data_t *pnvm_info)
+{
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+
+
+	uint8_t nvm_data[2*VL53L1_NVM_SIZE_IN_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	SUPPRESS_UNUSED_WARNING(nvm_format);
+
+
+
+
+	status = VL53L1_read_nvm_raw_data(
+				Dev,
+				0,
+				VL53L1_NVM_SIZE_IN_BYTES >> 2,
+				nvm_data);
+
+
+
+
+
+
+
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_nvm_format_decode(
+			VL53L1_NVM_SIZE_IN_BYTES,
+			nvm_data,
+			pnvm_info);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_read_nvm_optical_centre(
+	VL53L1_DEV                        Dev,
+	VL53L1_optical_centre_t          *pcentre)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+
+
+	uint8_t nvm_data[2*VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_SIZE];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_read_nvm_raw_data(
+			Dev,
+			(uint8_t)(VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_INDEX
+					>> 2),
+			(uint8_t)(VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_SIZE
+					>> 2),
+			nvm_data);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_nvm_decode_optical_centre(
+				VL53L1_NVM__FMT__OPTICAL_CENTRE_DATA_SIZE,
+				nvm_data,
+				pcentre);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_read_nvm_cal_peak_rate_map(
+	VL53L1_DEV                           Dev,
+	VL53L1_cal_peak_rate_map_t          *pcal_data)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+
+
+	uint8_t nvm_data[2*VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_SIZE];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_read_nvm_raw_data(
+			Dev,
+			(uint8_t)(VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_INDEX
+					>> 2),
+			(uint8_t)(VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_SIZE
+					>> 2),
+			nvm_data);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_nvm_decode_cal_peak_rate_map(
+				VL53L1_NVM__FMT__CAL_PEAK_RATE_MAP_DATA_SIZE,
+				nvm_data,
+				pcal_data);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_read_nvm_additional_offset_cal_data(
+	VL53L1_DEV                           Dev,
+	VL53L1_additional_offset_cal_data_t *pcal_data)
+{
+
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+
+
+	uint8_t nvm_data[2*VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_SIZE];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_read_nvm_raw_data(
+			Dev,
+			(uint8_t)(
+			VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_INDEX >> 2),
+			(uint8_t)(
+			VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_SIZE >> 2),
+			nvm_data);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_nvm_decode_additional_offset_cal_data(
+			VL53L1_NVM__FMT__ADDITIONAL_OFFSET_CAL_DATA_SIZE,
+			nvm_data,
+			pcal_data);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_read_nvm_fmt_range_results_data(
+	VL53L1_DEV                           Dev,
+	uint16_t                             range_results_select,
+	VL53L1_decoded_nvm_fmt_range_data_t *prange_data)
+{
+
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+
+
+	uint8_t nvm_data[2*VL53L1_NVM__FMT__RANGE_RESULTS__SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_read_nvm_raw_data(
+		Dev,
+		(uint8_t)(range_results_select >> 2),
+		(uint8_t)(VL53L1_NVM__FMT__RANGE_RESULTS__SIZE_BYTES >> 2),
+		nvm_data);
+
+
+
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_nvm_decode_fmt_range_results_data(
+				VL53L1_NVM__FMT__RANGE_RESULTS__SIZE_BYTES,
+				nvm_data,
+				prange_data);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_nvm_debug.c b/drivers/input/misc/vl53L1/src/vl53l1_nvm_debug.c
new file mode 100644
index 0000000000000000000000000000000000000000..b1acfd144577c8d68774f81b6166ccf323ef77c7
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_nvm_debug.c
@@ -0,0 +1,1126 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_api_debug.h"
+#include "vl53l1_nvm_structs.h"
+#include "vl53l1_nvm_debug.h"
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_NVM, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_NVM, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_NVM,\
+		status, fmt, ##__VA_ARGS__)
+
+#define trace_print(level, ...) \
+	_LOG_TRACE_PRINT(trace_flags, \
+	level, VL53L1_TRACE_FUNCTION_NONE, ##__VA_ARGS__)
+
+#ifdef VL53L1_LOG_ENABLE
+
+void VL53L1_print_nvm_raw_data(
+	uint8_t                       *pnvm_raw_data,
+	uint32_t                       trace_flags)
+{
+
+
+
+
+
+	int i = 0;
+
+	LOG_FUNCTION_START("");
+
+	for (i = 0 ; i < VL53L1_NVM_SIZE_IN_BYTES ; i++) {
+		if (i % 4 == 0)
+			trace_print(
+				VL53L1_TRACE_LEVEL_INFO,
+				"\n    NVM Addr 0x%02X : 0x",
+				i/4);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%02X",
+			*pnvm_raw_data++);
+	}
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"\n");
+
+	LOG_FUNCTION_END(0);
+}
+
+
+void VL53L1_print_decoded_nvm_data(
+	VL53L1_decoded_nvm_data_t *pdata,
+	char                      *pprefix,
+	uint32_t                   trace_flags)
+{
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+	char  pre_text[VL53L1_MAX_STRING_LENGTH];
+	char *ppre_text = &(pre_text[0]);
+
+	uint8_t i = 0;
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__identification_model_id",
+		pdata->nvm__identification_model_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__identification_module_type",
+		pdata->nvm__identification_module_type);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__identification_revision_id",
+		pdata->nvm__identification_revision_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__identification_module_id",
+		pdata->nvm__identification_module_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__i2c_valid",
+		pdata->nvm__i2c_valid);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__i2c_device_address_ews",
+		pdata->nvm__i2c_device_address_ews);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->nvm__ews__fast_osc_frequency,
+		12,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__ews__fast_osc_frequency",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__fast_osc_trim_max",
+		pdata->nvm__ews__fast_osc_trim_max);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__fast_osc_freq_set",
+		pdata->nvm__ews__fast_osc_freq_set);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__slow_osc_calibration",
+		pdata->nvm__ews__slow_osc_calibration);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->nvm__fmt__fast_osc_frequency,
+		12,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__fmt__fast_osc_frequency",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__fast_osc_trim_max",
+		pdata->nvm__fmt__fast_osc_trim_max);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__fast_osc_freq_set",
+		pdata->nvm__fmt__fast_osc_freq_set);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__slow_osc_calibration",
+		pdata->nvm__fmt__slow_osc_calibration);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_config_unlock",
+		pdata->nvm__vhv_config_unlock);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ref_selvddpix",
+		pdata->nvm__ref_selvddpix);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ref_selvquench",
+		pdata->nvm__ref_selvquench);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__regavdd1v2_sel",
+		pdata->nvm__regavdd1v2_sel);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__regdvdd1v2_sel",
+		pdata->nvm__regdvdd1v2_sel);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_timeout__macrop",
+		pdata->nvm__vhv_timeout__macrop);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_loop_bound",
+		pdata->nvm__vhv_loop_bound);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_count_threshold",
+		pdata->nvm__vhv_count_threshold);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_offset",
+		pdata->nvm__vhv_offset);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_init_enable",
+		pdata->nvm__vhv_init_enable);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__vhv_init_value",
+		pdata->nvm__vhv_init_value);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_trim_ll",
+		pdata->nvm__laser_safety_vcsel_trim_ll);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_selion_ll",
+		pdata->nvm__laser_safety_vcsel_selion_ll);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_selion_max_ll",
+		pdata->nvm__laser_safety_vcsel_selion_max_ll);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_mult_ll",
+		pdata->nvm__laser_safety_mult_ll);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_clip_ll",
+		pdata->nvm__laser_safety_clip_ll);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_trim_ld",
+		pdata->nvm__laser_safety_vcsel_trim_ld);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_selion_ld",
+		pdata->nvm__laser_safety_vcsel_selion_ld);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_vcsel_selion_max_ld",
+		pdata->nvm__laser_safety_vcsel_selion_max_ld);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_mult_ld",
+		pdata->nvm__laser_safety_mult_ld);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_clip_ld",
+		pdata->nvm__laser_safety_clip_ld);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_lock_byte",
+		pdata->nvm__laser_safety_lock_byte);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__laser_safety_unlock_byte",
+		pdata->nvm__laser_safety_unlock_byte);
+
+
+
+
+	for (i = 0 ; i < VL53L1_RTN_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__ews__spad_enables_rtn[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__ews__spad_enables_rtn[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__ews__spad_enables_ref__loc1[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__ews__spad_enables_ref__loc1[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__ews__spad_enables_ref__loc2[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__ews__spad_enables_ref__loc2[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__ews__spad_enables_ref__loc3[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__ews__spad_enables_ref__loc3[i]);
+	}
+
+
+
+
+
+	for (i = 0 ; i < VL53L1_RTN_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__fmt__spad_enables_rtn[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__fmt__spad_enables_rtn[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__fmt__spad_enables_ref__loc1[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__fmt__spad_enables_ref__loc1[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__fmt__spad_enables_ref__loc2[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__fmt__spad_enables_ref__loc2[i]);
+	}
+
+	for (i = 0 ; i < VL53L1_REF_SPAD_BUFFER_SIZE ; i++) {
+		sprintf(
+			ppre_text,
+			"%snvm__fmt__spad_enables_ref__loc3[%u]",
+			pprefix, i);
+
+		trace_print(
+			VL53L1_TRACE_LEVEL_INFO,
+			"%s = %u\n",
+			ppre_text,
+			pdata->nvm__fmt__spad_enables_ref__loc3[i]);
+	}
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__roi_config__mode_roi_centre_spad",
+		pdata->nvm__fmt__roi_config__mode_roi_centre_spad);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__roi_config__mode_roi_x_size",
+		pdata->nvm__fmt__roi_config__mode_roi_x_size);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__roi_config__mode_roi_y_size",
+		pdata->nvm__fmt__roi_config__mode_roi_y_size);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__ref_spad_apply__num_requested_ref_spad",
+		pdata->nvm__fmt__ref_spad_apply__num_requested_ref_spad);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__ref_spad_man__ref_location",
+		pdata->nvm__fmt__ref_spad_man__ref_location);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"nvm__fmt__mm_config__inner_offset_mm",
+		pdata->nvm__fmt__mm_config__inner_offset_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"nvm__fmt__mm_config__outer_offset_mm",
+		pdata->nvm__fmt__mm_config__outer_offset_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->nvm__fmt__algo_part_to_part_range_offset_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__fmt__algo_part_to_part_range_offset_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(int32_t)(
+	pdata->nvm__fmt__algo__crosstalk_compensation_plane_offset_kcps),
+	9,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__fmt__algo__crosstalk_compensation_plane_offset_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(int32_t)(
+	pdata->nvm__fmt__algo__crosstalk_compensation_x_plane_gradient_kcps),
+	11,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__fmt__algo__crosstalk_compensation_x_plane_gradient_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(int32_t)(
+	pdata->nvm__fmt__algo__crosstalk_compensation_y_plane_gradient_kcps),
+	11,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__fmt__algo__crosstalk_compensation_y_plane_gradient_kcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__spare__host_config__nvm_config_spare_0",
+		pdata->nvm__fmt__spare__host_config__nvm_config_spare_0);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__spare__host_config__nvm_config_spare_1",
+		pdata->nvm__fmt__spare__host_config__nvm_config_spare_1);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__customer_space_programmed",
+		pdata->nvm__customer_space_programmed);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__cust__i2c_device_address",
+		pdata->nvm__cust__i2c_device_address);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__cust__ref_spad_apply__num_requested_ref_spad",
+		pdata->nvm__cust__ref_spad_apply__num_requested_ref_spad);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__cust__ref_spad_man__ref_location",
+		pdata->nvm__cust__ref_spad_man__ref_location);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"nvm__cust__mm_config__inner_offset_mm",
+		pdata->nvm__cust__mm_config__inner_offset_mm);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %d\n",
+		pprefix,
+		"nvm__cust__mm_config__outer_offset_mm",
+		pdata->nvm__cust__mm_config__outer_offset_mm);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->nvm__cust__algo_part_to_part_range_offset_mm,
+		2,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__cust__algo_part_to_part_range_offset_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(uint32_t)(
+	pdata->nvm__cust__algo__crosstalk_compensation_plane_offset_kcps),
+	9,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__cust__algo__crosstalk_compensation_plane_offset_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(int32_t)(
+	pdata->nvm__cust__algo__crosstalk_compensation_x_plane_gradient_kcps),
+	11,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__cust__algo__crosstalk_compensation_x_plane_gradient_kcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+	(int32_t)(
+	pdata->nvm__cust__algo__crosstalk_compensation_y_plane_gradient_kcps),
+	11,
+	VL53L1_MAX_STRING_LENGTH,
+	fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"nvm__cust__algo__crosstalk_compensation_y_plane_gradient_kcps",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__cust__spare__host_config__nvm_config_spare_0",
+		pdata->nvm__cust__spare__host_config__nvm_config_spare_0);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__cust__spare__host_config__nvm_config_spare_1",
+		pdata->nvm__cust__spare__host_config__nvm_config_spare_1);
+
+
+
+
+	sprintf(
+		ppre_text,
+		"%sfmt_optical_centre.", pprefix);
+
+	VL53L1_print_optical_centre(
+		&(pdata->fmt_optical_centre),
+		ppre_text,
+		VL53L1_TRACE_MODULE_NVM_DATA);
+
+
+
+
+	sprintf(
+		ppre_text,
+		"%sfmt_peak_rate_map.", pprefix);
+
+	VL53L1_print_cal_peak_rate_map(
+		&(pdata->fmt_peak_rate_map),
+		ppre_text,
+		VL53L1_TRACE_MODULE_NVM_DATA);
+
+
+
+
+	sprintf(
+		ppre_text,
+		"%sfmt_add_offset_data.",
+		pprefix);
+
+	VL53L1_print_additional_offset_cal_data(
+		&(pdata->fmt_add_offset_data),
+		ppre_text,
+		VL53L1_TRACE_MODULE_NVM_DATA);
+
+
+
+
+	for (i = 0 ; i < VL53L1_NVM_MAX_FMT_RANGE_DATA ; i++) {
+		sprintf(
+			ppre_text,
+			"%sfmt_range_data[%u].",
+			pprefix, i);
+
+		VL53L1_print_decoded_nvm_fmt_range_data(
+			&(pdata->fmt_range_data[i]),
+			ppre_text,
+			trace_flags);
+	}
+
+	sprintf(
+		ppre_text,
+		"%sfmt_info.",
+		pprefix);
+
+	VL53L1_print_decoded_nvm_fmt_info(
+		&(pdata->fmt_info),
+		ppre_text,
+		trace_flags);
+
+	sprintf(
+		ppre_text,
+		"%sews_info.",
+		pprefix);
+
+	VL53L1_print_decoded_nvm_ews_info(
+		&(pdata->ews_info),
+		ppre_text,
+		trace_flags);
+}
+
+
+void VL53L1_print_decoded_nvm_fmt_range_data(
+	VL53L1_decoded_nvm_fmt_range_data_t *pdata,
+	char                                *pprefix,
+	uint32_t                             trace_flags)
+{
+	char  fp_text[VL53L1_MAX_STRING_LENGTH];
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__actual_effective_rtn_spads,
+		8,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__actual_effective_rtn_spads",
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ref_spad_array__num_requested_ref_spads",
+		pdata->ref_spad_array__num_requested_ref_spads);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"ref_spad_array__ref_location",
+		pdata->ref_spad_array__ref_location);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__peak_signal_count_rate_rtn_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__peak_signal_count_rate_rtn_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__ambient_count_rate_rtn_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__ambient_count_rate_rtn_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__peak_signal_count_rate_ref_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"result__peak_signal_count_rate_ref_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->result__ambient_count_rate_ref_mcps,
+		7,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"result__ambient_count_rate_ref_mcps",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(int32_t)pdata->measured_distance_mm,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"measured_distance_mm",
+		fp_text);
+
+	VL53L1_signed_fixed_point_sprintf(
+		(uint32_t)pdata->measured_distance_stdev_mm,
+		4,
+		VL53L1_MAX_STRING_LENGTH,
+		fp_text);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %s\n",
+		pprefix,
+		"measured_distance_stdev_mm",
+		fp_text);
+}
+
+
+void VL53L1_print_decoded_nvm_fmt_info(
+	VL53L1_decoded_nvm_fmt_info_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = \"%s\"\n",
+		pprefix,
+		"nvm__fmt__fgc",
+		pdata->nvm__fmt__fgc);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__test_program_major",
+		pdata->nvm__fmt__test_program_major);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__test_program_minor",
+		pdata->nvm__fmt__test_program_minor);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__map_major",
+		pdata->nvm__fmt__map_major);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__map_minor",
+		pdata->nvm__fmt__map_minor);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__year",
+		pdata->nvm__fmt__year);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__month",
+		pdata->nvm__fmt__month);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__day",
+		pdata->nvm__fmt__day);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__module_date_phase",
+		pdata->nvm__fmt__module_date_phase);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__time",
+		pdata->nvm__fmt__time);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__tester_id",
+		pdata->nvm__fmt__tester_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__fmt__site_id",
+		pdata->nvm__fmt__site_id);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__test_program_major",
+		pdata->nvm__ews__test_program_major);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__test_program_minor",
+		pdata->nvm__ews__test_program_minor);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__probe_card_major",
+		pdata->nvm__ews__probe_card_major);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__probe_card_minor",
+		pdata->nvm__ews__probe_card_minor);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__tester_id",
+		pdata->nvm__ews__tester_id);
+}
+
+
+void VL53L1_print_decoded_nvm_ews_info(
+	VL53L1_decoded_nvm_ews_info_t *pdata,
+	char                          *pprefix,
+	uint32_t                       trace_flags)
+{
+	trace_print(VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = \"%s\"\n",
+		pprefix,
+		"nvm__ews__lot",
+		pdata->nvm__ews__lot);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__wafer",
+		pdata->nvm__ews__wafer);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__xcoord",
+		pdata->nvm__ews__xcoord);
+
+	trace_print(
+		VL53L1_TRACE_LEVEL_INFO,
+		"%s%s = %u\n",
+		pprefix,
+		"nvm__ews__ycoord",
+		pdata->nvm__ews__ycoord);
+}
+
+#endif
+
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_register_funcs.c b/drivers/input/misc/vl53L1/src/vl53l1_register_funcs.c
new file mode 100644
index 0000000000000000000000000000000000000000..21d886e8ae77af67dfae11fb62230bc57c1de49b
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_register_funcs.c
@@ -0,0 +1,4596 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_core.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_register_structs.h"
+#include "vl53l1_register_funcs.h"
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_REGISTERS, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_REGISTERS, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_REGISTERS,\
+			status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_i2c_encode_static_nvm_managed(
+	VL53L1_static_nvm_managed_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->i2c_slave__device_address & 0x7F;
+	*(pbuffer +   1) =
+		pdata->ana_config__vhv_ref_sel_vddpix & 0xF;
+	*(pbuffer +   2) =
+		pdata->ana_config__vhv_ref_sel_vquench & 0x7F;
+	*(pbuffer +   3) =
+		pdata->ana_config__reg_avdd1v2_sel & 0x3;
+	*(pbuffer +   4) =
+		pdata->ana_config__fast_osc__trim & 0x7F;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->osc_measured__fast_osc__frequency,
+		2,
+		pbuffer +   5);
+	*(pbuffer +   7) =
+		pdata->vhv_config__timeout_macrop_loop_bound;
+	*(pbuffer +   8) =
+		pdata->vhv_config__count_thresh;
+	*(pbuffer +   9) =
+		pdata->vhv_config__offset & 0x3F;
+	*(pbuffer +  10) =
+		pdata->vhv_config__init;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_static_nvm_managed(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_static_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->i2c_slave__device_address =
+		(*(pbuffer +   0)) & 0x7F;
+	pdata->ana_config__vhv_ref_sel_vddpix =
+		(*(pbuffer +   1)) & 0xF;
+	pdata->ana_config__vhv_ref_sel_vquench =
+		(*(pbuffer +   2)) & 0x7F;
+	pdata->ana_config__reg_avdd1v2_sel =
+		(*(pbuffer +   3)) & 0x3;
+	pdata->ana_config__fast_osc__trim =
+		(*(pbuffer +   4)) & 0x7F;
+	pdata->osc_measured__fast_osc__frequency =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   5));
+	pdata->vhv_config__timeout_macrop_loop_bound =
+		(*(pbuffer +   7));
+	pdata->vhv_config__count_thresh =
+		(*(pbuffer +   8));
+	pdata->vhv_config__offset =
+		(*(pbuffer +   9)) & 0x3F;
+	pdata->vhv_config__init =
+		(*(pbuffer +  10));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_static_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_static_nvm_managed(
+			pdata,
+			VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_I2C_SLAVE__DEVICE_ADDRESS,
+			comms_buffer,
+			VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_static_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_I2C_SLAVE__DEVICE_ADDRESS,
+			comms_buffer,
+			VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_static_nvm_managed(
+			VL53L1_STATIC_NVM_MANAGED_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_customer_nvm_managed(
+	VL53L1_customer_nvm_managed_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->global_config__spad_enables_ref_0;
+	*(pbuffer +   1) =
+		pdata->global_config__spad_enables_ref_1;
+	*(pbuffer +   2) =
+		pdata->global_config__spad_enables_ref_2;
+	*(pbuffer +   3) =
+		pdata->global_config__spad_enables_ref_3;
+	*(pbuffer +   4) =
+		pdata->global_config__spad_enables_ref_4;
+	*(pbuffer +   5) =
+		pdata->global_config__spad_enables_ref_5 & 0xF;
+	*(pbuffer +   6) =
+		pdata->global_config__ref_en_start_select;
+	*(pbuffer +   7) =
+		pdata->ref_spad_man__num_requested_ref_spads & 0x3F;
+	*(pbuffer +   8) =
+		pdata->ref_spad_man__ref_location & 0x3;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->algo__crosstalk_compensation_plane_offset_kcps,
+		2,
+		pbuffer +   9);
+	VL53L1_i2c_encode_int16_t(
+		pdata->algo__crosstalk_compensation_x_plane_gradient_kcps,
+		2,
+		pbuffer +  11);
+	VL53L1_i2c_encode_int16_t(
+		pdata->algo__crosstalk_compensation_y_plane_gradient_kcps,
+		2,
+		pbuffer +  13);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->ref_spad_char__total_rate_target_mcps,
+		2,
+		pbuffer +  15);
+	VL53L1_i2c_encode_int16_t(
+		pdata->algo__part_to_part_range_offset_mm & 0x1FFF,
+		2,
+		pbuffer +  17);
+	VL53L1_i2c_encode_int16_t(
+		pdata->mm_config__inner_offset_mm,
+		2,
+		pbuffer +  19);
+	VL53L1_i2c_encode_int16_t(
+		pdata->mm_config__outer_offset_mm,
+		2,
+		pbuffer +  21);
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_customer_nvm_managed(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_customer_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->global_config__spad_enables_ref_0 =
+		(*(pbuffer +   0));
+	pdata->global_config__spad_enables_ref_1 =
+		(*(pbuffer +   1));
+	pdata->global_config__spad_enables_ref_2 =
+		(*(pbuffer +   2));
+	pdata->global_config__spad_enables_ref_3 =
+		(*(pbuffer +   3));
+	pdata->global_config__spad_enables_ref_4 =
+		(*(pbuffer +   4));
+	pdata->global_config__spad_enables_ref_5 =
+		(*(pbuffer +   5)) & 0xF;
+	pdata->global_config__ref_en_start_select =
+		(*(pbuffer +   6));
+	pdata->ref_spad_man__num_requested_ref_spads =
+		(*(pbuffer +   7)) & 0x3F;
+	pdata->ref_spad_man__ref_location =
+		(*(pbuffer +   8)) & 0x3;
+	pdata->algo__crosstalk_compensation_plane_offset_kcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   9));
+	pdata->algo__crosstalk_compensation_x_plane_gradient_kcps =
+		(VL53L1_i2c_decode_int16_t(2, pbuffer +  11));
+	pdata->algo__crosstalk_compensation_y_plane_gradient_kcps =
+		(VL53L1_i2c_decode_int16_t(2, pbuffer +  13));
+	pdata->ref_spad_char__total_rate_target_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  15));
+	pdata->algo__part_to_part_range_offset_mm =
+		(VL53L1_i2c_decode_int16_t(2, pbuffer +  17)) & 0x1FFF;
+	pdata->mm_config__inner_offset_mm =
+		(VL53L1_i2c_decode_int16_t(2, pbuffer +  19));
+	pdata->mm_config__outer_offset_mm =
+		(VL53L1_i2c_decode_int16_t(2, pbuffer +  21));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_customer_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_customer_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_customer_nvm_managed(
+			pdata,
+			VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0,
+			comms_buffer,
+			VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_customer_nvm_managed(
+	VL53L1_DEV                 Dev,
+	VL53L1_customer_nvm_managed_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_GLOBAL_CONFIG__SPAD_ENABLES_REF_0,
+			comms_buffer,
+			VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_customer_nvm_managed(
+			VL53L1_CUSTOMER_NVM_MANAGED_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_static_config(
+	VL53L1_static_config_t   *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint16_t(
+		pdata->dss_config__target_total_rate_mcps,
+		2,
+		pbuffer +   0);
+	*(pbuffer +   2) =
+		pdata->debug__ctrl & 0x1;
+	*(pbuffer +   3) =
+		pdata->test_mode__ctrl & 0xF;
+	*(pbuffer +   4) =
+		pdata->clk_gating__ctrl & 0xF;
+	*(pbuffer +   5) =
+		pdata->nvm_bist__ctrl & 0x1F;
+	*(pbuffer +   6) =
+		pdata->nvm_bist__num_nvm_words & 0x7F;
+	*(pbuffer +   7) =
+		pdata->nvm_bist__start_address & 0x7F;
+	*(pbuffer +   8) =
+		pdata->host_if__status & 0x1;
+	*(pbuffer +   9) =
+		pdata->pad_i2c_hv__config;
+	*(pbuffer +  10) =
+		pdata->pad_i2c_hv__extsup_config & 0x1;
+	*(pbuffer +  11) =
+		pdata->gpio_hv_pad__ctrl & 0x3;
+	*(pbuffer +  12) =
+		pdata->gpio_hv_mux__ctrl & 0x1F;
+	*(pbuffer +  13) =
+		pdata->gpio__tio_hv_status & 0x3;
+	*(pbuffer +  14) =
+		pdata->gpio__fio_hv_status & 0x3;
+	*(pbuffer +  15) =
+		pdata->ana_config__spad_sel_pswidth & 0x7;
+	*(pbuffer +  16) =
+		pdata->ana_config__vcsel_pulse_width_offset & 0x1F;
+	*(pbuffer +  17) =
+		pdata->ana_config__fast_osc__config_ctrl & 0x1;
+	*(pbuffer +  18) =
+		pdata->sigma_estimator__effective_pulse_width_ns;
+	*(pbuffer +  19) =
+		pdata->sigma_estimator__effective_ambient_width_ns;
+	*(pbuffer +  20) =
+		pdata->sigma_estimator__sigma_ref_mm;
+	*(pbuffer +  21) =
+		pdata->algo__crosstalk_compensation_valid_height_mm;
+	*(pbuffer +  22) =
+		pdata->spare_host_config__static_config_spare_0;
+	*(pbuffer +  23) =
+		pdata->spare_host_config__static_config_spare_1;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->algo__range_ignore_threshold_mcps,
+		2,
+		pbuffer +  24);
+	*(pbuffer +  26) =
+		pdata->algo__range_ignore_valid_height_mm;
+	*(pbuffer +  27) =
+		pdata->algo__range_min_clip;
+	*(pbuffer +  28) =
+		pdata->algo__consistency_check__tolerance & 0xF;
+	*(pbuffer +  29) =
+		pdata->spare_host_config__static_config_spare_2;
+	*(pbuffer +  30) =
+		pdata->sd_config__reset_stages_msb & 0xF;
+	*(pbuffer +  31) =
+		pdata->sd_config__reset_stages_lsb;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_static_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_static_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->dss_config__target_total_rate_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   0));
+	pdata->debug__ctrl =
+		(*(pbuffer +   2)) & 0x1;
+	pdata->test_mode__ctrl =
+		(*(pbuffer +   3)) & 0xF;
+	pdata->clk_gating__ctrl =
+		(*(pbuffer +   4)) & 0xF;
+	pdata->nvm_bist__ctrl =
+		(*(pbuffer +   5)) & 0x1F;
+	pdata->nvm_bist__num_nvm_words =
+		(*(pbuffer +   6)) & 0x7F;
+	pdata->nvm_bist__start_address =
+		(*(pbuffer +   7)) & 0x7F;
+	pdata->host_if__status =
+		(*(pbuffer +   8)) & 0x1;
+	pdata->pad_i2c_hv__config =
+		(*(pbuffer +   9));
+	pdata->pad_i2c_hv__extsup_config =
+		(*(pbuffer +  10)) & 0x1;
+	pdata->gpio_hv_pad__ctrl =
+		(*(pbuffer +  11)) & 0x3;
+	pdata->gpio_hv_mux__ctrl =
+		(*(pbuffer +  12)) & 0x1F;
+	pdata->gpio__tio_hv_status =
+		(*(pbuffer +  13)) & 0x3;
+	pdata->gpio__fio_hv_status =
+		(*(pbuffer +  14)) & 0x3;
+	pdata->ana_config__spad_sel_pswidth =
+		(*(pbuffer +  15)) & 0x7;
+	pdata->ana_config__vcsel_pulse_width_offset =
+		(*(pbuffer +  16)) & 0x1F;
+	pdata->ana_config__fast_osc__config_ctrl =
+		(*(pbuffer +  17)) & 0x1;
+	pdata->sigma_estimator__effective_pulse_width_ns =
+		(*(pbuffer +  18));
+	pdata->sigma_estimator__effective_ambient_width_ns =
+		(*(pbuffer +  19));
+	pdata->sigma_estimator__sigma_ref_mm =
+		(*(pbuffer +  20));
+	pdata->algo__crosstalk_compensation_valid_height_mm =
+		(*(pbuffer +  21));
+	pdata->spare_host_config__static_config_spare_0 =
+		(*(pbuffer +  22));
+	pdata->spare_host_config__static_config_spare_1 =
+		(*(pbuffer +  23));
+	pdata->algo__range_ignore_threshold_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  24));
+	pdata->algo__range_ignore_valid_height_mm =
+		(*(pbuffer +  26));
+	pdata->algo__range_min_clip =
+		(*(pbuffer +  27));
+	pdata->algo__consistency_check__tolerance =
+		(*(pbuffer +  28)) & 0xF;
+	pdata->spare_host_config__static_config_spare_2 =
+		(*(pbuffer +  29));
+	pdata->sd_config__reset_stages_msb =
+		(*(pbuffer +  30)) & 0xF;
+	pdata->sd_config__reset_stages_lsb =
+		(*(pbuffer +  31));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_static_config(
+			pdata,
+			VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS,
+			comms_buffer,
+			VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_static_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_DSS_CONFIG__TARGET_TOTAL_RATE_MCPS,
+			comms_buffer,
+			VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_static_config(
+			VL53L1_STATIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_general_config(
+	VL53L1_general_config_t  *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->gph_config__stream_count_update_value;
+	*(pbuffer +   1) =
+		pdata->global_config__stream_divider;
+	*(pbuffer +   2) =
+		pdata->system__interrupt_config_gpio;
+	*(pbuffer +   3) =
+		pdata->cal_config__vcsel_start & 0x7F;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->cal_config__repeat_rate & 0xFFF,
+		2,
+		pbuffer +   4);
+	*(pbuffer +   6) =
+		pdata->global_config__vcsel_width & 0x7F;
+	*(pbuffer +   7) =
+		pdata->phasecal_config__timeout_macrop;
+	*(pbuffer +   8) =
+		pdata->phasecal_config__target;
+	*(pbuffer +   9) =
+		pdata->phasecal_config__override & 0x1;
+	*(pbuffer +  11) =
+		pdata->dss_config__roi_mode_control & 0x7;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->system__thresh_rate_high,
+		2,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->system__thresh_rate_low,
+		2,
+		pbuffer +  14);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->dss_config__manual_effective_spads_select,
+		2,
+		pbuffer +  16);
+	*(pbuffer +  18) =
+		pdata->dss_config__manual_block_select;
+	*(pbuffer +  19) =
+		pdata->dss_config__aperture_attenuation;
+	*(pbuffer +  20) =
+		pdata->dss_config__max_spads_limit;
+	*(pbuffer +  21) =
+		pdata->dss_config__min_spads_limit;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_general_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_general_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->gph_config__stream_count_update_value =
+		(*(pbuffer +   0));
+	pdata->global_config__stream_divider =
+		(*(pbuffer +   1));
+	pdata->system__interrupt_config_gpio =
+		(*(pbuffer +   2));
+	pdata->cal_config__vcsel_start =
+		(*(pbuffer +   3)) & 0x7F;
+	pdata->cal_config__repeat_rate =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   4)) & 0xFFF;
+	pdata->global_config__vcsel_width =
+		(*(pbuffer +   6)) & 0x7F;
+	pdata->phasecal_config__timeout_macrop =
+		(*(pbuffer +   7));
+	pdata->phasecal_config__target =
+		(*(pbuffer +   8));
+	pdata->phasecal_config__override =
+		(*(pbuffer +   9)) & 0x1;
+	pdata->dss_config__roi_mode_control =
+		(*(pbuffer +  11)) & 0x7;
+	pdata->system__thresh_rate_high =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->system__thresh_rate_low =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  14));
+	pdata->dss_config__manual_effective_spads_select =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  16));
+	pdata->dss_config__manual_block_select =
+		(*(pbuffer +  18));
+	pdata->dss_config__aperture_attenuation =
+		(*(pbuffer +  19));
+	pdata->dss_config__max_spads_limit =
+		(*(pbuffer +  20));
+	pdata->dss_config__min_spads_limit =
+		(*(pbuffer +  21));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_general_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_general_config(
+			pdata,
+			VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_GPH_CONFIG__STREAM_COUNT_UPDATE_VALUE,
+			comms_buffer,
+			VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_general_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_GPH_CONFIG__STREAM_COUNT_UPDATE_VALUE,
+			comms_buffer,
+			VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_general_config(
+			VL53L1_GENERAL_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_timing_config(
+	VL53L1_timing_config_t   *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->mm_config__timeout_macrop_a_hi & 0xF;
+	*(pbuffer +   1) =
+		pdata->mm_config__timeout_macrop_a_lo;
+	*(pbuffer +   2) =
+		pdata->mm_config__timeout_macrop_b_hi & 0xF;
+	*(pbuffer +   3) =
+		pdata->mm_config__timeout_macrop_b_lo;
+	*(pbuffer +   4) =
+		pdata->range_config__timeout_macrop_a_hi & 0xF;
+	*(pbuffer +   5) =
+		pdata->range_config__timeout_macrop_a_lo;
+	*(pbuffer +   6) =
+		pdata->range_config__vcsel_period_a & 0x3F;
+	*(pbuffer +   7) =
+		pdata->range_config__timeout_macrop_b_hi & 0xF;
+	*(pbuffer +   8) =
+		pdata->range_config__timeout_macrop_b_lo;
+	*(pbuffer +   9) =
+		pdata->range_config__vcsel_period_b & 0x3F;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->range_config__sigma_thresh,
+		2,
+		pbuffer +  10);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->range_config__min_count_rate_rtn_limit_mcps,
+		2,
+		pbuffer +  12);
+	*(pbuffer +  14) =
+		pdata->range_config__valid_phase_low;
+	*(pbuffer +  15) =
+		pdata->range_config__valid_phase_high;
+	VL53L1_i2c_encode_uint32_t(
+		pdata->system__intermeasurement_period,
+		4,
+		pbuffer +  18);
+	*(pbuffer +  22) =
+		pdata->system__fractional_enable & 0x1;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_timing_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_timing_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->mm_config__timeout_macrop_a_hi =
+		(*(pbuffer +   0)) & 0xF;
+	pdata->mm_config__timeout_macrop_a_lo =
+		(*(pbuffer +   1));
+	pdata->mm_config__timeout_macrop_b_hi =
+		(*(pbuffer +   2)) & 0xF;
+	pdata->mm_config__timeout_macrop_b_lo =
+		(*(pbuffer +   3));
+	pdata->range_config__timeout_macrop_a_hi =
+		(*(pbuffer +   4)) & 0xF;
+	pdata->range_config__timeout_macrop_a_lo =
+		(*(pbuffer +   5));
+	pdata->range_config__vcsel_period_a =
+		(*(pbuffer +   6)) & 0x3F;
+	pdata->range_config__timeout_macrop_b_hi =
+		(*(pbuffer +   7)) & 0xF;
+	pdata->range_config__timeout_macrop_b_lo =
+		(*(pbuffer +   8));
+	pdata->range_config__vcsel_period_b =
+		(*(pbuffer +   9)) & 0x3F;
+	pdata->range_config__sigma_thresh =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  10));
+	pdata->range_config__min_count_rate_rtn_limit_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->range_config__valid_phase_low =
+		(*(pbuffer +  14));
+	pdata->range_config__valid_phase_high =
+		(*(pbuffer +  15));
+	pdata->system__intermeasurement_period =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  18));
+	pdata->system__fractional_enable =
+		(*(pbuffer +  22)) & 0x1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_timing_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_timing_config(
+			pdata,
+			VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_MM_CONFIG__TIMEOUT_MACROP_A_HI,
+			comms_buffer,
+			VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_timing_config_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_MM_CONFIG__TIMEOUT_MACROP_A_HI,
+			comms_buffer,
+			VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_timing_config(
+			VL53L1_TIMING_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_dynamic_config(
+	VL53L1_dynamic_config_t  *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->system__grouped_parameter_hold_0 & 0x3;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->system__thresh_high,
+		2,
+		pbuffer +   1);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->system__thresh_low,
+		2,
+		pbuffer +   3);
+	*(pbuffer +   5) =
+		pdata->system__enable_xtalk_per_quadrant & 0x1;
+	*(pbuffer +   6) =
+		pdata->system__seed_config & 0x7;
+	*(pbuffer +   7) =
+		pdata->sd_config__woi_sd0;
+	*(pbuffer +   8) =
+		pdata->sd_config__woi_sd1;
+	*(pbuffer +   9) =
+		pdata->sd_config__initial_phase_sd0 & 0x7F;
+	*(pbuffer +  10) =
+		pdata->sd_config__initial_phase_sd1 & 0x7F;
+	*(pbuffer +  11) =
+		pdata->system__grouped_parameter_hold_1 & 0x3;
+	*(pbuffer +  12) =
+		pdata->sd_config__first_order_select & 0x3;
+	*(pbuffer +  13) =
+		pdata->sd_config__quantifier & 0xF;
+	*(pbuffer +  14) =
+		pdata->roi_config__user_roi_centre_spad;
+	*(pbuffer +  15) =
+		pdata->roi_config__user_roi_requested_global_xy_size;
+	*(pbuffer +  16) =
+		pdata->system__sequence_config;
+	*(pbuffer +  17) =
+		pdata->system__grouped_parameter_hold & 0x3;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_dynamic_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_dynamic_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->system__grouped_parameter_hold_0 =
+		(*(pbuffer +   0)) & 0x3;
+	pdata->system__thresh_high =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   1));
+	pdata->system__thresh_low =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   3));
+	pdata->system__enable_xtalk_per_quadrant =
+		(*(pbuffer +   5)) & 0x1;
+	pdata->system__seed_config =
+		(*(pbuffer +   6)) & 0x7;
+	pdata->sd_config__woi_sd0 =
+		(*(pbuffer +   7));
+	pdata->sd_config__woi_sd1 =
+		(*(pbuffer +   8));
+	pdata->sd_config__initial_phase_sd0 =
+		(*(pbuffer +   9)) & 0x7F;
+	pdata->sd_config__initial_phase_sd1 =
+		(*(pbuffer +  10)) & 0x7F;
+	pdata->system__grouped_parameter_hold_1 =
+		(*(pbuffer +  11)) & 0x3;
+	pdata->sd_config__first_order_select =
+		(*(pbuffer +  12)) & 0x3;
+	pdata->sd_config__quantifier =
+		(*(pbuffer +  13)) & 0xF;
+	pdata->roi_config__user_roi_centre_spad =
+		(*(pbuffer +  14));
+	pdata->roi_config__user_roi_requested_global_xy_size =
+		(*(pbuffer +  15));
+	pdata->system__sequence_config =
+		(*(pbuffer +  16));
+	pdata->system__grouped_parameter_hold =
+		(*(pbuffer +  17)) & 0x3;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_dynamic_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_dynamic_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_dynamic_config(
+			pdata,
+			VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD_0,
+			comms_buffer,
+			VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_dynamic_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_dynamic_config_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_SYSTEM__GROUPED_PARAMETER_HOLD_0,
+			comms_buffer,
+			VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_dynamic_config(
+			VL53L1_DYNAMIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_system_control(
+	VL53L1_system_control_t  *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->power_management__go1_power_force & 0x1;
+	*(pbuffer +   1) =
+		pdata->system__stream_count_ctrl & 0x1;
+	*(pbuffer +   2) =
+		pdata->firmware__enable & 0x1;
+	*(pbuffer +   3) =
+		pdata->system__interrupt_clear & 0x3;
+	*(pbuffer +   4) =
+		pdata->system__mode_start;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_system_control(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_system_control_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->power_management__go1_power_force =
+		(*(pbuffer +   0)) & 0x1;
+	pdata->system__stream_count_ctrl =
+		(*(pbuffer +   1)) & 0x1;
+	pdata->firmware__enable =
+		(*(pbuffer +   2)) & 0x1;
+	pdata->system__interrupt_clear =
+		(*(pbuffer +   3)) & 0x3;
+	pdata->system__mode_start =
+		(*(pbuffer +   4));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_system_control(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_control_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_system_control(
+			pdata,
+			VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_POWER_MANAGEMENT__GO1_POWER_FORCE,
+			comms_buffer,
+			VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_system_control(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_control_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_POWER_MANAGEMENT__GO1_POWER_FORCE,
+			comms_buffer,
+			VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_system_control(
+			VL53L1_SYSTEM_CONTROL_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_system_results(
+	VL53L1_system_results_t  *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->result__interrupt_status & 0x3F;
+	*(pbuffer +   1) =
+		pdata->result__range_status;
+	*(pbuffer +   2) =
+		pdata->result__report_status & 0xF;
+	*(pbuffer +   3) =
+		pdata->result__stream_count;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__dss_actual_effective_spads_sd0,
+		2,
+		pbuffer +   4);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__peak_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +   6);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__ambient_count_rate_mcps_sd0,
+		2,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__sigma_sd0,
+		2,
+		pbuffer +  10);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__phase_sd0,
+		2,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__final_crosstalk_corrected_range_mm_sd0,
+		2,
+		pbuffer +  14);
+	VL53L1_i2c_encode_uint16_t(
+	pdata->result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0,
+	2,
+	pbuffer +  16);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__mm_inner_actual_effective_spads_sd0,
+		2,
+		pbuffer +  18);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__mm_outer_actual_effective_spads_sd0,
+		2,
+		pbuffer +  20);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__avg_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +  22);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__dss_actual_effective_spads_sd1,
+		2,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__peak_signal_count_rate_mcps_sd1,
+		2,
+		pbuffer +  26);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__ambient_count_rate_mcps_sd1,
+		2,
+		pbuffer +  28);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__sigma_sd1,
+		2,
+		pbuffer +  30);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__phase_sd1,
+		2,
+		pbuffer +  32);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__final_crosstalk_corrected_range_mm_sd1,
+		2,
+		pbuffer +  34);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__spare_0_sd1,
+		2,
+		pbuffer +  36);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__spare_1_sd1,
+		2,
+		pbuffer +  38);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__spare_2_sd1,
+		2,
+		pbuffer +  40);
+	*(pbuffer +  42) =
+		pdata->result__spare_3_sd1;
+	*(pbuffer +  43) =
+		pdata->result__thresh_info;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_system_results_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->result__interrupt_status =
+		(*(pbuffer +   0)) & 0x3F;
+	pdata->result__range_status =
+		(*(pbuffer +   1));
+	pdata->result__report_status =
+		(*(pbuffer +   2)) & 0xF;
+	pdata->result__stream_count =
+		(*(pbuffer +   3));
+	pdata->result__dss_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   4));
+	pdata->result__peak_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   6));
+	pdata->result__ambient_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   8));
+	pdata->result__sigma_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  10));
+	pdata->result__phase_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->result__final_crosstalk_corrected_range_mm_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  14));
+	pdata->result__peak_signal_count_rate_crosstalk_corrected_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  16));
+	pdata->result__mm_inner_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  18));
+	pdata->result__mm_outer_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  20));
+	pdata->result__avg_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  22));
+	pdata->result__dss_actual_effective_spads_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  24));
+	pdata->result__peak_signal_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  26));
+	pdata->result__ambient_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  28));
+	pdata->result__sigma_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  30));
+	pdata->result__phase_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  32));
+	pdata->result__final_crosstalk_corrected_range_mm_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  34));
+	pdata->result__spare_0_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  36));
+	pdata->result__spare_1_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  38));
+	pdata->result__spare_2_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  40));
+	pdata->result__spare_3_sd1 =
+		(*(pbuffer +  42));
+	pdata->result__thresh_info =
+		(*(pbuffer +  43));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_results_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_system_results(
+			pdata,
+			VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_RESULT__INTERRUPT_STATUS,
+			comms_buffer,
+			VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_system_results_t   *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_RESULT__INTERRUPT_STATUS,
+			comms_buffer,
+			VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_system_results(
+			VL53L1_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_core_results(
+	VL53L1_core_results_t    *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__ambient_window_events_sd0,
+		4,
+		pbuffer +   0);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__ranging_total_events_sd0,
+		4,
+		pbuffer +   4);
+	VL53L1_i2c_encode_int32_t(
+		pdata->result_core__signal_total_events_sd0,
+		4,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__total_periods_elapsed_sd0,
+		4,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__ambient_window_events_sd1,
+		4,
+		pbuffer +  16);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__ranging_total_events_sd1,
+		4,
+		pbuffer +  20);
+	VL53L1_i2c_encode_int32_t(
+		pdata->result_core__signal_total_events_sd1,
+		4,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->result_core__total_periods_elapsed_sd1,
+		4,
+		pbuffer +  28);
+	*(pbuffer +  32) =
+		pdata->result_core__spare_0;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_core_results_t     *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->result_core__ambient_window_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   0));
+	pdata->result_core__ranging_total_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   4));
+	pdata->result_core__signal_total_events_sd0 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +   8));
+	pdata->result_core__total_periods_elapsed_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  12));
+	pdata->result_core__ambient_window_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  16));
+	pdata->result_core__ranging_total_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  20));
+	pdata->result_core__signal_total_events_sd1 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +  24));
+	pdata->result_core__total_periods_elapsed_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  28));
+	pdata->result_core__spare_0 =
+		(*(pbuffer +  32));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_core_results_t     *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_core_results(
+			pdata,
+			VL53L1_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+			comms_buffer,
+			VL53L1_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_core_results_t     *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+			comms_buffer,
+			VL53L1_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_core_results(
+			VL53L1_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_debug_results(
+	VL53L1_debug_results_t   *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint16_t(
+		pdata->phasecal_result__reference_phase,
+		2,
+		pbuffer +   0);
+	*(pbuffer +   2) =
+		pdata->phasecal_result__vcsel_start & 0x7F;
+	*(pbuffer +   3) =
+		pdata->ref_spad_char_result__num_actual_ref_spads & 0x3F;
+	*(pbuffer +   4) =
+		pdata->ref_spad_char_result__ref_location & 0x3;
+	*(pbuffer +   5) =
+		pdata->vhv_result__coldboot_status & 0x1;
+	*(pbuffer +   6) =
+		pdata->vhv_result__search_result & 0x3F;
+	*(pbuffer +   7) =
+		pdata->vhv_result__latest_setting & 0x3F;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->result__osc_calibrate_val & 0x3FF,
+		2,
+		pbuffer +   8);
+	*(pbuffer +  10) =
+		pdata->ana_config__powerdown_go1 & 0x3;
+	*(pbuffer +  11) =
+		pdata->ana_config__ref_bg_ctrl & 0x3;
+	*(pbuffer +  12) =
+		pdata->ana_config__regdvdd1v2_ctrl & 0xF;
+	*(pbuffer +  13) =
+		pdata->ana_config__osc_slow_ctrl & 0x7;
+	*(pbuffer +  14) =
+		pdata->test_mode__status & 0x1;
+	*(pbuffer +  15) =
+		pdata->firmware__system_status & 0x3;
+	*(pbuffer +  16) =
+		pdata->firmware__mode_status;
+	*(pbuffer +  17) =
+		pdata->firmware__secondary_mode_status;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->firmware__cal_repeat_rate_counter & 0xFFF,
+		2,
+		pbuffer +  18);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__system__thresh_high,
+		2,
+		pbuffer +  22);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__system__thresh_low,
+		2,
+		pbuffer +  24);
+	*(pbuffer +  26) =
+		pdata->gph__system__enable_xtalk_per_quadrant & 0x1;
+	*(pbuffer +  27) =
+		pdata->gph__spare_0 & 0x7;
+	*(pbuffer +  28) =
+		pdata->gph__sd_config__woi_sd0;
+	*(pbuffer +  29) =
+		pdata->gph__sd_config__woi_sd1;
+	*(pbuffer +  30) =
+		pdata->gph__sd_config__initial_phase_sd0 & 0x7F;
+	*(pbuffer +  31) =
+		pdata->gph__sd_config__initial_phase_sd1 & 0x7F;
+	*(pbuffer +  32) =
+		pdata->gph__sd_config__first_order_select & 0x3;
+	*(pbuffer +  33) =
+		pdata->gph__sd_config__quantifier & 0xF;
+	*(pbuffer +  34) =
+		pdata->gph__roi_config__user_roi_centre_spad;
+	*(pbuffer +  35) =
+		pdata->gph__roi_config__user_roi_requested_global_xy_size;
+	*(pbuffer +  36) =
+		pdata->gph__system__sequence_config;
+	*(pbuffer +  37) =
+		pdata->gph__gph_id & 0x1;
+	*(pbuffer +  38) =
+		pdata->system__interrupt_set & 0x3;
+	*(pbuffer +  39) =
+		pdata->interrupt_manager__enables & 0x1F;
+	*(pbuffer +  40) =
+		pdata->interrupt_manager__clear & 0x1F;
+	*(pbuffer +  41) =
+		pdata->interrupt_manager__status & 0x1F;
+	*(pbuffer +  42) =
+		pdata->mcu_to_host_bank__wr_access_en & 0x1;
+	*(pbuffer +  43) =
+		pdata->power_management__go1_reset_status & 0x1;
+	*(pbuffer +  44) =
+		pdata->pad_startup_mode__value_ro & 0x3;
+	*(pbuffer +  45) =
+		pdata->pad_startup_mode__value_ctrl & 0x3F;
+	VL53L1_i2c_encode_uint32_t(
+		pdata->pll_period_us & 0x3FFFF,
+		4,
+		pbuffer +  46);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->interrupt_scheduler__data_out,
+		4,
+		pbuffer +  50);
+	*(pbuffer +  54) =
+		pdata->nvm_bist__complete & 0x1;
+	*(pbuffer +  55) =
+		pdata->nvm_bist__status & 0x1;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_debug_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_debug_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->phasecal_result__reference_phase =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   0));
+	pdata->phasecal_result__vcsel_start =
+		(*(pbuffer +   2)) & 0x7F;
+	pdata->ref_spad_char_result__num_actual_ref_spads =
+		(*(pbuffer +   3)) & 0x3F;
+	pdata->ref_spad_char_result__ref_location =
+		(*(pbuffer +   4)) & 0x3;
+	pdata->vhv_result__coldboot_status =
+		(*(pbuffer +   5)) & 0x1;
+	pdata->vhv_result__search_result =
+		(*(pbuffer +   6)) & 0x3F;
+	pdata->vhv_result__latest_setting =
+		(*(pbuffer +   7)) & 0x3F;
+	pdata->result__osc_calibrate_val =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   8)) & 0x3FF;
+	pdata->ana_config__powerdown_go1 =
+		(*(pbuffer +  10)) & 0x3;
+	pdata->ana_config__ref_bg_ctrl =
+		(*(pbuffer +  11)) & 0x3;
+	pdata->ana_config__regdvdd1v2_ctrl =
+		(*(pbuffer +  12)) & 0xF;
+	pdata->ana_config__osc_slow_ctrl =
+		(*(pbuffer +  13)) & 0x7;
+	pdata->test_mode__status =
+		(*(pbuffer +  14)) & 0x1;
+	pdata->firmware__system_status =
+		(*(pbuffer +  15)) & 0x3;
+	pdata->firmware__mode_status =
+		(*(pbuffer +  16));
+	pdata->firmware__secondary_mode_status =
+		(*(pbuffer +  17));
+	pdata->firmware__cal_repeat_rate_counter =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  18)) & 0xFFF;
+	pdata->gph__system__thresh_high =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  22));
+	pdata->gph__system__thresh_low =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  24));
+	pdata->gph__system__enable_xtalk_per_quadrant =
+		(*(pbuffer +  26)) & 0x1;
+	pdata->gph__spare_0 =
+		(*(pbuffer +  27)) & 0x7;
+	pdata->gph__sd_config__woi_sd0 =
+		(*(pbuffer +  28));
+	pdata->gph__sd_config__woi_sd1 =
+		(*(pbuffer +  29));
+	pdata->gph__sd_config__initial_phase_sd0 =
+		(*(pbuffer +  30)) & 0x7F;
+	pdata->gph__sd_config__initial_phase_sd1 =
+		(*(pbuffer +  31)) & 0x7F;
+	pdata->gph__sd_config__first_order_select =
+		(*(pbuffer +  32)) & 0x3;
+	pdata->gph__sd_config__quantifier =
+		(*(pbuffer +  33)) & 0xF;
+	pdata->gph__roi_config__user_roi_centre_spad =
+		(*(pbuffer +  34));
+	pdata->gph__roi_config__user_roi_requested_global_xy_size =
+		(*(pbuffer +  35));
+	pdata->gph__system__sequence_config =
+		(*(pbuffer +  36));
+	pdata->gph__gph_id =
+		(*(pbuffer +  37)) & 0x1;
+	pdata->system__interrupt_set =
+		(*(pbuffer +  38)) & 0x3;
+	pdata->interrupt_manager__enables =
+		(*(pbuffer +  39)) & 0x1F;
+	pdata->interrupt_manager__clear =
+		(*(pbuffer +  40)) & 0x1F;
+	pdata->interrupt_manager__status =
+		(*(pbuffer +  41)) & 0x1F;
+	pdata->mcu_to_host_bank__wr_access_en =
+		(*(pbuffer +  42)) & 0x1;
+	pdata->power_management__go1_reset_status =
+		(*(pbuffer +  43)) & 0x1;
+	pdata->pad_startup_mode__value_ro =
+		(*(pbuffer +  44)) & 0x3;
+	pdata->pad_startup_mode__value_ctrl =
+		(*(pbuffer +  45)) & 0x3F;
+	pdata->pll_period_us =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  46)) & 0x3FFFF;
+	pdata->interrupt_scheduler__data_out =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  50));
+	pdata->nvm_bist__complete =
+		(*(pbuffer +  54)) & 0x1;
+	pdata->nvm_bist__status =
+		(*(pbuffer +  55)) & 0x1;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_debug_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_debug_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_debug_results(
+			pdata,
+			VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_PHASECAL_RESULT__REFERENCE_PHASE,
+			comms_buffer,
+			VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_debug_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_debug_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_PHASECAL_RESULT__REFERENCE_PHASE,
+			comms_buffer,
+			VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_debug_results(
+			VL53L1_DEBUG_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_nvm_copy_data(
+	VL53L1_nvm_copy_data_t   *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->identification__model_id;
+	*(pbuffer +   1) =
+		pdata->identification__module_type;
+	*(pbuffer +   2) =
+		pdata->identification__revision_id;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->identification__module_id,
+		2,
+		pbuffer +   3);
+	*(pbuffer +   5) =
+		pdata->ana_config__fast_osc__trim_max & 0x7F;
+	*(pbuffer +   6) =
+		pdata->ana_config__fast_osc__freq_set & 0x7;
+	*(pbuffer +   7) =
+		pdata->ana_config__vcsel_trim & 0x7;
+	*(pbuffer +   8) =
+		pdata->ana_config__vcsel_selion & 0x3F;
+	*(pbuffer +   9) =
+		pdata->ana_config__vcsel_selion_max & 0x3F;
+	*(pbuffer +  10) =
+		pdata->protected_laser_safety__lock_bit & 0x1;
+	*(pbuffer +  11) =
+		pdata->laser_safety__key & 0x7F;
+	*(pbuffer +  12) =
+		pdata->laser_safety__key_ro & 0x1;
+	*(pbuffer +  13) =
+		pdata->laser_safety__clip & 0x3F;
+	*(pbuffer +  14) =
+		pdata->laser_safety__mult & 0x3F;
+	*(pbuffer +  15) =
+		pdata->global_config__spad_enables_rtn_0;
+	*(pbuffer +  16) =
+		pdata->global_config__spad_enables_rtn_1;
+	*(pbuffer +  17) =
+		pdata->global_config__spad_enables_rtn_2;
+	*(pbuffer +  18) =
+		pdata->global_config__spad_enables_rtn_3;
+	*(pbuffer +  19) =
+		pdata->global_config__spad_enables_rtn_4;
+	*(pbuffer +  20) =
+		pdata->global_config__spad_enables_rtn_5;
+	*(pbuffer +  21) =
+		pdata->global_config__spad_enables_rtn_6;
+	*(pbuffer +  22) =
+		pdata->global_config__spad_enables_rtn_7;
+	*(pbuffer +  23) =
+		pdata->global_config__spad_enables_rtn_8;
+	*(pbuffer +  24) =
+		pdata->global_config__spad_enables_rtn_9;
+	*(pbuffer +  25) =
+		pdata->global_config__spad_enables_rtn_10;
+	*(pbuffer +  26) =
+		pdata->global_config__spad_enables_rtn_11;
+	*(pbuffer +  27) =
+		pdata->global_config__spad_enables_rtn_12;
+	*(pbuffer +  28) =
+		pdata->global_config__spad_enables_rtn_13;
+	*(pbuffer +  29) =
+		pdata->global_config__spad_enables_rtn_14;
+	*(pbuffer +  30) =
+		pdata->global_config__spad_enables_rtn_15;
+	*(pbuffer +  31) =
+		pdata->global_config__spad_enables_rtn_16;
+	*(pbuffer +  32) =
+		pdata->global_config__spad_enables_rtn_17;
+	*(pbuffer +  33) =
+		pdata->global_config__spad_enables_rtn_18;
+	*(pbuffer +  34) =
+		pdata->global_config__spad_enables_rtn_19;
+	*(pbuffer +  35) =
+		pdata->global_config__spad_enables_rtn_20;
+	*(pbuffer +  36) =
+		pdata->global_config__spad_enables_rtn_21;
+	*(pbuffer +  37) =
+		pdata->global_config__spad_enables_rtn_22;
+	*(pbuffer +  38) =
+		pdata->global_config__spad_enables_rtn_23;
+	*(pbuffer +  39) =
+		pdata->global_config__spad_enables_rtn_24;
+	*(pbuffer +  40) =
+		pdata->global_config__spad_enables_rtn_25;
+	*(pbuffer +  41) =
+		pdata->global_config__spad_enables_rtn_26;
+	*(pbuffer +  42) =
+		pdata->global_config__spad_enables_rtn_27;
+	*(pbuffer +  43) =
+		pdata->global_config__spad_enables_rtn_28;
+	*(pbuffer +  44) =
+		pdata->global_config__spad_enables_rtn_29;
+	*(pbuffer +  45) =
+		pdata->global_config__spad_enables_rtn_30;
+	*(pbuffer +  46) =
+		pdata->global_config__spad_enables_rtn_31;
+	*(pbuffer +  47) =
+		pdata->roi_config__mode_roi_centre_spad;
+	*(pbuffer +  48) =
+		pdata->roi_config__mode_roi_xy_size;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_nvm_copy_data(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_nvm_copy_data_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->identification__model_id =
+		(*(pbuffer +   0));
+	pdata->identification__module_type =
+		(*(pbuffer +   1));
+	pdata->identification__revision_id =
+		(*(pbuffer +   2));
+	pdata->identification__module_id =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   3));
+	pdata->ana_config__fast_osc__trim_max =
+		(*(pbuffer +   5)) & 0x7F;
+	pdata->ana_config__fast_osc__freq_set =
+		(*(pbuffer +   6)) & 0x7;
+	pdata->ana_config__vcsel_trim =
+		(*(pbuffer +   7)) & 0x7;
+	pdata->ana_config__vcsel_selion =
+		(*(pbuffer +   8)) & 0x3F;
+	pdata->ana_config__vcsel_selion_max =
+		(*(pbuffer +   9)) & 0x3F;
+	pdata->protected_laser_safety__lock_bit =
+		(*(pbuffer +  10)) & 0x1;
+	pdata->laser_safety__key =
+		(*(pbuffer +  11)) & 0x7F;
+	pdata->laser_safety__key_ro =
+		(*(pbuffer +  12)) & 0x1;
+	pdata->laser_safety__clip =
+		(*(pbuffer +  13)) & 0x3F;
+	pdata->laser_safety__mult =
+		(*(pbuffer +  14)) & 0x3F;
+	pdata->global_config__spad_enables_rtn_0 =
+		(*(pbuffer +  15));
+	pdata->global_config__spad_enables_rtn_1 =
+		(*(pbuffer +  16));
+	pdata->global_config__spad_enables_rtn_2 =
+		(*(pbuffer +  17));
+	pdata->global_config__spad_enables_rtn_3 =
+		(*(pbuffer +  18));
+	pdata->global_config__spad_enables_rtn_4 =
+		(*(pbuffer +  19));
+	pdata->global_config__spad_enables_rtn_5 =
+		(*(pbuffer +  20));
+	pdata->global_config__spad_enables_rtn_6 =
+		(*(pbuffer +  21));
+	pdata->global_config__spad_enables_rtn_7 =
+		(*(pbuffer +  22));
+	pdata->global_config__spad_enables_rtn_8 =
+		(*(pbuffer +  23));
+	pdata->global_config__spad_enables_rtn_9 =
+		(*(pbuffer +  24));
+	pdata->global_config__spad_enables_rtn_10 =
+		(*(pbuffer +  25));
+	pdata->global_config__spad_enables_rtn_11 =
+		(*(pbuffer +  26));
+	pdata->global_config__spad_enables_rtn_12 =
+		(*(pbuffer +  27));
+	pdata->global_config__spad_enables_rtn_13 =
+		(*(pbuffer +  28));
+	pdata->global_config__spad_enables_rtn_14 =
+		(*(pbuffer +  29));
+	pdata->global_config__spad_enables_rtn_15 =
+		(*(pbuffer +  30));
+	pdata->global_config__spad_enables_rtn_16 =
+		(*(pbuffer +  31));
+	pdata->global_config__spad_enables_rtn_17 =
+		(*(pbuffer +  32));
+	pdata->global_config__spad_enables_rtn_18 =
+		(*(pbuffer +  33));
+	pdata->global_config__spad_enables_rtn_19 =
+		(*(pbuffer +  34));
+	pdata->global_config__spad_enables_rtn_20 =
+		(*(pbuffer +  35));
+	pdata->global_config__spad_enables_rtn_21 =
+		(*(pbuffer +  36));
+	pdata->global_config__spad_enables_rtn_22 =
+		(*(pbuffer +  37));
+	pdata->global_config__spad_enables_rtn_23 =
+		(*(pbuffer +  38));
+	pdata->global_config__spad_enables_rtn_24 =
+		(*(pbuffer +  39));
+	pdata->global_config__spad_enables_rtn_25 =
+		(*(pbuffer +  40));
+	pdata->global_config__spad_enables_rtn_26 =
+		(*(pbuffer +  41));
+	pdata->global_config__spad_enables_rtn_27 =
+		(*(pbuffer +  42));
+	pdata->global_config__spad_enables_rtn_28 =
+		(*(pbuffer +  43));
+	pdata->global_config__spad_enables_rtn_29 =
+		(*(pbuffer +  44));
+	pdata->global_config__spad_enables_rtn_30 =
+		(*(pbuffer +  45));
+	pdata->global_config__spad_enables_rtn_31 =
+		(*(pbuffer +  46));
+	pdata->roi_config__mode_roi_centre_spad =
+		(*(pbuffer +  47));
+	pdata->roi_config__mode_roi_xy_size =
+		(*(pbuffer +  48));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_nvm_copy_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_nvm_copy_data_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_nvm_copy_data(
+			pdata,
+			VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_IDENTIFICATION__MODEL_ID,
+			comms_buffer,
+			VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_nvm_copy_data(
+	VL53L1_DEV                 Dev,
+	VL53L1_nvm_copy_data_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_IDENTIFICATION__MODEL_ID,
+			comms_buffer,
+			VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_nvm_copy_data(
+			VL53L1_NVM_COPY_DATA_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_prev_shadow_system_results(
+	VL53L1_prev_shadow_system_results_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->prev_shadow_result__interrupt_status & 0x3F;
+	*(pbuffer +   1) =
+		pdata->prev_shadow_result__range_status;
+	*(pbuffer +   2) =
+		pdata->prev_shadow_result__report_status & 0xF;
+	*(pbuffer +   3) =
+		pdata->prev_shadow_result__stream_count;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__dss_actual_effective_spads_sd0,
+		2,
+		pbuffer +   4);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__peak_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +   6);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__ambient_count_rate_mcps_sd0,
+		2,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__sigma_sd0,
+		2,
+		pbuffer +  10);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__phase_sd0,
+		2,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint16_t(
+	pdata->prev_shadow_result__final_crosstalk_corrected_range_mm_sd0,
+	2,
+	pbuffer +  14);
+	VL53L1_i2c_encode_uint16_t(
+	pdata->psr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0,
+	2,
+	pbuffer +  16);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__mm_inner_actual_effective_spads_sd0,
+		2,
+		pbuffer +  18);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__mm_outer_actual_effective_spads_sd0,
+		2,
+		pbuffer +  20);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__avg_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +  22);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__dss_actual_effective_spads_sd1,
+		2,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__peak_signal_count_rate_mcps_sd1,
+		2,
+		pbuffer +  26);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__ambient_count_rate_mcps_sd1,
+		2,
+		pbuffer +  28);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__sigma_sd1,
+		2,
+		pbuffer +  30);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__phase_sd1,
+		2,
+		pbuffer +  32);
+	VL53L1_i2c_encode_uint16_t(
+	pdata->prev_shadow_result__final_crosstalk_corrected_range_mm_sd1,
+	2,
+	pbuffer +  34);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__spare_0_sd1,
+		2,
+		pbuffer +  36);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__spare_1_sd1,
+		2,
+		pbuffer +  38);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__spare_2_sd1,
+		2,
+		pbuffer +  40);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->prev_shadow_result__spare_3_sd1,
+		2,
+		pbuffer +  42);
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_prev_shadow_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_prev_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->prev_shadow_result__interrupt_status =
+		(*(pbuffer +   0)) & 0x3F;
+	pdata->prev_shadow_result__range_status =
+		(*(pbuffer +   1));
+	pdata->prev_shadow_result__report_status =
+		(*(pbuffer +   2)) & 0xF;
+	pdata->prev_shadow_result__stream_count =
+		(*(pbuffer +   3));
+	pdata->prev_shadow_result__dss_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   4));
+	pdata->prev_shadow_result__peak_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   6));
+	pdata->prev_shadow_result__ambient_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   8));
+	pdata->prev_shadow_result__sigma_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  10));
+	pdata->prev_shadow_result__phase_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->prev_shadow_result__final_crosstalk_corrected_range_mm_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  14));
+	pdata->psr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  16));
+	pdata->prev_shadow_result__mm_inner_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  18));
+	pdata->prev_shadow_result__mm_outer_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  20));
+	pdata->prev_shadow_result__avg_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  22));
+	pdata->prev_shadow_result__dss_actual_effective_spads_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  24));
+	pdata->prev_shadow_result__peak_signal_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  26));
+	pdata->prev_shadow_result__ambient_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  28));
+	pdata->prev_shadow_result__sigma_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  30));
+	pdata->prev_shadow_result__phase_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  32));
+	pdata->prev_shadow_result__final_crosstalk_corrected_range_mm_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  34));
+	pdata->prev_shadow_result__spare_0_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  36));
+	pdata->prev_shadow_result__spare_1_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  38));
+	pdata->prev_shadow_result__spare_2_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  40));
+	pdata->prev_shadow_result__spare_3_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  42));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_prev_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_prev_shadow_system_results(
+			pdata,
+			VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_PREV_SHADOW_RESULT__INTERRUPT_STATUS,
+			comms_buffer,
+			VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_prev_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_PREV_SHADOW_RESULT__INTERRUPT_STATUS,
+			comms_buffer,
+			VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_prev_shadow_system_results(
+			VL53L1_PREV_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_prev_shadow_core_results(
+	VL53L1_prev_shadow_core_results_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__ambient_window_events_sd0,
+		4,
+		pbuffer +   0);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__ranging_total_events_sd0,
+		4,
+		pbuffer +   4);
+	VL53L1_i2c_encode_int32_t(
+		pdata->prev_shadow_result_core__signal_total_events_sd0,
+		4,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__total_periods_elapsed_sd0,
+		4,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__ambient_window_events_sd1,
+		4,
+		pbuffer +  16);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__ranging_total_events_sd1,
+		4,
+		pbuffer +  20);
+	VL53L1_i2c_encode_int32_t(
+		pdata->prev_shadow_result_core__signal_total_events_sd1,
+		4,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->prev_shadow_result_core__total_periods_elapsed_sd1,
+		4,
+		pbuffer +  28);
+	*(pbuffer +  32) =
+		pdata->prev_shadow_result_core__spare_0;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_prev_shadow_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_prev_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->prev_shadow_result_core__ambient_window_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   0));
+	pdata->prev_shadow_result_core__ranging_total_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   4));
+	pdata->prev_shadow_result_core__signal_total_events_sd0 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +   8));
+	pdata->prev_shadow_result_core__total_periods_elapsed_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  12));
+	pdata->prev_shadow_result_core__ambient_window_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  16));
+	pdata->prev_shadow_result_core__ranging_total_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  20));
+	pdata->prev_shadow_result_core__signal_total_events_sd1 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +  24));
+	pdata->prev_shadow_result_core__total_periods_elapsed_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  28));
+	pdata->prev_shadow_result_core__spare_0 =
+		(*(pbuffer +  32));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_prev_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_prev_shadow_core_results(
+			pdata,
+			VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+		Dev,
+		VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+		comms_buffer,
+		VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_prev_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_prev_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+		Dev,
+		VL53L1_PREV_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+		comms_buffer,
+		VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_prev_shadow_core_results(
+			VL53L1_PREV_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_patch_debug(
+	VL53L1_patch_debug_t     *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->result__debug_status;
+	*(pbuffer +   1) =
+		pdata->result__debug_stage;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_patch_debug(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_patch_debug_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->result__debug_status =
+		(*(pbuffer +   0));
+	pdata->result__debug_stage =
+		(*(pbuffer +   1));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_patch_debug(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_debug_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_patch_debug(
+			pdata,
+			VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_RESULT__DEBUG_STATUS,
+			comms_buffer,
+			VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_patch_debug(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_debug_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_RESULT__DEBUG_STATUS,
+			comms_buffer,
+			VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_patch_debug(
+			VL53L1_PATCH_DEBUG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_general_config(
+	VL53L1_gph_general_config_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__system__thresh_rate_high,
+		2,
+		pbuffer +   0);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__system__thresh_rate_low,
+		2,
+		pbuffer +   2);
+	*(pbuffer +   4) =
+		pdata->gph__system__interrupt_config_gpio;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_general_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_general_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->gph__system__thresh_rate_high =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   0));
+	pdata->gph__system__thresh_rate_low =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   2));
+	pdata->gph__system__interrupt_config_gpio =
+		(*(pbuffer +   4));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_gph_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_general_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_gph_general_config(
+			pdata,
+			VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH,
+			comms_buffer,
+			VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_gph_general_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_general_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_GPH__SYSTEM__THRESH_RATE_HIGH,
+			comms_buffer,
+			VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_gph_general_config(
+			VL53L1_GPH_GENERAL_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_static_config(
+	VL53L1_gph_static_config_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->gph__dss_config__roi_mode_control & 0x7;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__dss_config__manual_effective_spads_select,
+		2,
+		pbuffer +   1);
+	*(pbuffer +   3) =
+		pdata->gph__dss_config__manual_block_select;
+	*(pbuffer +   4) =
+		pdata->gph__dss_config__max_spads_limit;
+	*(pbuffer +   5) =
+		pdata->gph__dss_config__min_spads_limit;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_static_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_static_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->gph__dss_config__roi_mode_control =
+		(*(pbuffer +   0)) & 0x7;
+	pdata->gph__dss_config__manual_effective_spads_select =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   1));
+	pdata->gph__dss_config__manual_block_select =
+		(*(pbuffer +   3));
+	pdata->gph__dss_config__max_spads_limit =
+		(*(pbuffer +   4));
+	pdata->gph__dss_config__min_spads_limit =
+		(*(pbuffer +   5));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_gph_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_static_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_gph_static_config(
+			pdata,
+			VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_GPH__DSS_CONFIG__ROI_MODE_CONTROL,
+			comms_buffer,
+			VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_gph_static_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_static_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_GPH__DSS_CONFIG__ROI_MODE_CONTROL,
+			comms_buffer,
+			VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_gph_static_config(
+			VL53L1_GPH_STATIC_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_gph_timing_config(
+	VL53L1_gph_timing_config_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->gph__mm_config__timeout_macrop_a_hi & 0xF;
+	*(pbuffer +   1) =
+		pdata->gph__mm_config__timeout_macrop_a_lo;
+	*(pbuffer +   2) =
+		pdata->gph__mm_config__timeout_macrop_b_hi & 0xF;
+	*(pbuffer +   3) =
+		pdata->gph__mm_config__timeout_macrop_b_lo;
+	*(pbuffer +   4) =
+		pdata->gph__range_config__timeout_macrop_a_hi & 0xF;
+	*(pbuffer +   5) =
+		pdata->gph__range_config__timeout_macrop_a_lo;
+	*(pbuffer +   6) =
+		pdata->gph__range_config__vcsel_period_a & 0x3F;
+	*(pbuffer +   7) =
+		pdata->gph__range_config__vcsel_period_b & 0x3F;
+	*(pbuffer +   8) =
+		pdata->gph__range_config__timeout_macrop_b_hi & 0xF;
+	*(pbuffer +   9) =
+		pdata->gph__range_config__timeout_macrop_b_lo;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__range_config__sigma_thresh,
+		2,
+		pbuffer +  10);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->gph__range_config__min_count_rate_rtn_limit_mcps,
+		2,
+		pbuffer +  12);
+	*(pbuffer +  14) =
+		pdata->gph__range_config__valid_phase_low;
+	*(pbuffer +  15) =
+		pdata->gph__range_config__valid_phase_high;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_gph_timing_config(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_gph_timing_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->gph__mm_config__timeout_macrop_a_hi =
+		(*(pbuffer +   0)) & 0xF;
+	pdata->gph__mm_config__timeout_macrop_a_lo =
+		(*(pbuffer +   1));
+	pdata->gph__mm_config__timeout_macrop_b_hi =
+		(*(pbuffer +   2)) & 0xF;
+	pdata->gph__mm_config__timeout_macrop_b_lo =
+		(*(pbuffer +   3));
+	pdata->gph__range_config__timeout_macrop_a_hi =
+		(*(pbuffer +   4)) & 0xF;
+	pdata->gph__range_config__timeout_macrop_a_lo =
+		(*(pbuffer +   5));
+	pdata->gph__range_config__vcsel_period_a =
+		(*(pbuffer +   6)) & 0x3F;
+	pdata->gph__range_config__vcsel_period_b =
+		(*(pbuffer +   7)) & 0x3F;
+	pdata->gph__range_config__timeout_macrop_b_hi =
+		(*(pbuffer +   8)) & 0xF;
+	pdata->gph__range_config__timeout_macrop_b_lo =
+		(*(pbuffer +   9));
+	pdata->gph__range_config__sigma_thresh =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  10));
+	pdata->gph__range_config__min_count_rate_rtn_limit_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->gph__range_config__valid_phase_low =
+		(*(pbuffer +  14));
+	pdata->gph__range_config__valid_phase_high =
+		(*(pbuffer +  15));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_gph_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_timing_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_gph_timing_config(
+			pdata,
+			VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_A_HI,
+			comms_buffer,
+			VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_gph_timing_config(
+	VL53L1_DEV                 Dev,
+	VL53L1_gph_timing_config_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_GPH__MM_CONFIG__TIMEOUT_MACROP_A_HI,
+			comms_buffer,
+			VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_gph_timing_config(
+			VL53L1_GPH_TIMING_CONFIG_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_fw_internal(
+	VL53L1_fw_internal_t     *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_FW_INTERNAL_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->firmware__internal_stream_count_div;
+	*(pbuffer +   1) =
+		pdata->firmware__internal_stream_counter_val;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_fw_internal(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_fw_internal_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_FW_INTERNAL_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->firmware__internal_stream_count_div =
+		(*(pbuffer +   0));
+	pdata->firmware__internal_stream_counter_val =
+		(*(pbuffer +   1));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_fw_internal(
+	VL53L1_DEV                 Dev,
+	VL53L1_fw_internal_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_FW_INTERNAL_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_fw_internal(
+			pdata,
+			VL53L1_FW_INTERNAL_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_FIRMWARE__INTERNAL_STREAM_COUNT_DIV,
+			comms_buffer,
+			VL53L1_FW_INTERNAL_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_fw_internal(
+	VL53L1_DEV                 Dev,
+	VL53L1_fw_internal_t      *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_FW_INTERNAL_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_FIRMWARE__INTERNAL_STREAM_COUNT_DIV,
+			comms_buffer,
+			VL53L1_FW_INTERNAL_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_fw_internal(
+			VL53L1_FW_INTERNAL_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_patch_results(
+	VL53L1_patch_results_t   *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->dss_calc__roi_ctrl & 0x3;
+	*(pbuffer +   1) =
+		pdata->dss_calc__spare_1;
+	*(pbuffer +   2) =
+		pdata->dss_calc__spare_2;
+	*(pbuffer +   3) =
+		pdata->dss_calc__spare_3;
+	*(pbuffer +   4) =
+		pdata->dss_calc__spare_4;
+	*(pbuffer +   5) =
+		pdata->dss_calc__spare_5;
+	*(pbuffer +   6) =
+		pdata->dss_calc__spare_6;
+	*(pbuffer +   7) =
+		pdata->dss_calc__spare_7;
+	*(pbuffer +   8) =
+		pdata->dss_calc__user_roi_spad_en_0;
+	*(pbuffer +   9) =
+		pdata->dss_calc__user_roi_spad_en_1;
+	*(pbuffer +  10) =
+		pdata->dss_calc__user_roi_spad_en_2;
+	*(pbuffer +  11) =
+		pdata->dss_calc__user_roi_spad_en_3;
+	*(pbuffer +  12) =
+		pdata->dss_calc__user_roi_spad_en_4;
+	*(pbuffer +  13) =
+		pdata->dss_calc__user_roi_spad_en_5;
+	*(pbuffer +  14) =
+		pdata->dss_calc__user_roi_spad_en_6;
+	*(pbuffer +  15) =
+		pdata->dss_calc__user_roi_spad_en_7;
+	*(pbuffer +  16) =
+		pdata->dss_calc__user_roi_spad_en_8;
+	*(pbuffer +  17) =
+		pdata->dss_calc__user_roi_spad_en_9;
+	*(pbuffer +  18) =
+		pdata->dss_calc__user_roi_spad_en_10;
+	*(pbuffer +  19) =
+		pdata->dss_calc__user_roi_spad_en_11;
+	*(pbuffer +  20) =
+		pdata->dss_calc__user_roi_spad_en_12;
+	*(pbuffer +  21) =
+		pdata->dss_calc__user_roi_spad_en_13;
+	*(pbuffer +  22) =
+		pdata->dss_calc__user_roi_spad_en_14;
+	*(pbuffer +  23) =
+		pdata->dss_calc__user_roi_spad_en_15;
+	*(pbuffer +  24) =
+		pdata->dss_calc__user_roi_spad_en_16;
+	*(pbuffer +  25) =
+		pdata->dss_calc__user_roi_spad_en_17;
+	*(pbuffer +  26) =
+		pdata->dss_calc__user_roi_spad_en_18;
+	*(pbuffer +  27) =
+		pdata->dss_calc__user_roi_spad_en_19;
+	*(pbuffer +  28) =
+		pdata->dss_calc__user_roi_spad_en_20;
+	*(pbuffer +  29) =
+		pdata->dss_calc__user_roi_spad_en_21;
+	*(pbuffer +  30) =
+		pdata->dss_calc__user_roi_spad_en_22;
+	*(pbuffer +  31) =
+		pdata->dss_calc__user_roi_spad_en_23;
+	*(pbuffer +  32) =
+		pdata->dss_calc__user_roi_spad_en_24;
+	*(pbuffer +  33) =
+		pdata->dss_calc__user_roi_spad_en_25;
+	*(pbuffer +  34) =
+		pdata->dss_calc__user_roi_spad_en_26;
+	*(pbuffer +  35) =
+		pdata->dss_calc__user_roi_spad_en_27;
+	*(pbuffer +  36) =
+		pdata->dss_calc__user_roi_spad_en_28;
+	*(pbuffer +  37) =
+		pdata->dss_calc__user_roi_spad_en_29;
+	*(pbuffer +  38) =
+		pdata->dss_calc__user_roi_spad_en_30;
+	*(pbuffer +  39) =
+		pdata->dss_calc__user_roi_spad_en_31;
+	*(pbuffer +  40) =
+		pdata->dss_calc__user_roi_0;
+	*(pbuffer +  41) =
+		pdata->dss_calc__user_roi_1;
+	*(pbuffer +  42) =
+		pdata->dss_calc__mode_roi_0;
+	*(pbuffer +  43) =
+		pdata->dss_calc__mode_roi_1;
+	*(pbuffer +  44) =
+		pdata->sigma_estimator_calc__spare_0;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->vhv_result__peak_signal_rate_mcps,
+		2,
+		pbuffer +  46);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->vhv_result__signal_total_events_ref,
+		4,
+		pbuffer +  48);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->phasecal_result__phase_output_ref,
+		2,
+		pbuffer +  52);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->dss_result__total_rate_per_spad,
+		2,
+		pbuffer +  54);
+	*(pbuffer +  56) =
+		pdata->dss_result__enabled_blocks;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->dss_result__num_requested_spads,
+		2,
+		pbuffer +  58);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->mm_result__inner_intersection_rate,
+		2,
+		pbuffer +  62);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->mm_result__outer_complement_rate,
+		2,
+		pbuffer +  64);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->mm_result__total_offset,
+		2,
+		pbuffer +  66);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->xtalk_calc__xtalk_for_enabled_spads & 0xFFFFFF,
+		4,
+		pbuffer +  68);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->xtalk_result__avg_xtalk_user_roi_kcps & 0xFFFFFF,
+		4,
+		pbuffer +  72);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->xtalk_result__avg_xtalk_mm_inner_roi_kcps & 0xFFFFFF,
+		4,
+		pbuffer +  76);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->xtalk_result__avg_xtalk_mm_outer_roi_kcps & 0xFFFFFF,
+		4,
+		pbuffer +  80);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->range_result__accum_phase,
+		4,
+		pbuffer +  84);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->range_result__offset_corrected_range,
+		2,
+		pbuffer +  88);
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_patch_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_patch_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->dss_calc__roi_ctrl =
+		(*(pbuffer +   0)) & 0x3;
+	pdata->dss_calc__spare_1 =
+		(*(pbuffer +   1));
+	pdata->dss_calc__spare_2 =
+		(*(pbuffer +   2));
+	pdata->dss_calc__spare_3 =
+		(*(pbuffer +   3));
+	pdata->dss_calc__spare_4 =
+		(*(pbuffer +   4));
+	pdata->dss_calc__spare_5 =
+		(*(pbuffer +   5));
+	pdata->dss_calc__spare_6 =
+		(*(pbuffer +   6));
+	pdata->dss_calc__spare_7 =
+		(*(pbuffer +   7));
+	pdata->dss_calc__user_roi_spad_en_0 =
+		(*(pbuffer +   8));
+	pdata->dss_calc__user_roi_spad_en_1 =
+		(*(pbuffer +   9));
+	pdata->dss_calc__user_roi_spad_en_2 =
+		(*(pbuffer +  10));
+	pdata->dss_calc__user_roi_spad_en_3 =
+		(*(pbuffer +  11));
+	pdata->dss_calc__user_roi_spad_en_4 =
+		(*(pbuffer +  12));
+	pdata->dss_calc__user_roi_spad_en_5 =
+		(*(pbuffer +  13));
+	pdata->dss_calc__user_roi_spad_en_6 =
+		(*(pbuffer +  14));
+	pdata->dss_calc__user_roi_spad_en_7 =
+		(*(pbuffer +  15));
+	pdata->dss_calc__user_roi_spad_en_8 =
+		(*(pbuffer +  16));
+	pdata->dss_calc__user_roi_spad_en_9 =
+		(*(pbuffer +  17));
+	pdata->dss_calc__user_roi_spad_en_10 =
+		(*(pbuffer +  18));
+	pdata->dss_calc__user_roi_spad_en_11 =
+		(*(pbuffer +  19));
+	pdata->dss_calc__user_roi_spad_en_12 =
+		(*(pbuffer +  20));
+	pdata->dss_calc__user_roi_spad_en_13 =
+		(*(pbuffer +  21));
+	pdata->dss_calc__user_roi_spad_en_14 =
+		(*(pbuffer +  22));
+	pdata->dss_calc__user_roi_spad_en_15 =
+		(*(pbuffer +  23));
+	pdata->dss_calc__user_roi_spad_en_16 =
+		(*(pbuffer +  24));
+	pdata->dss_calc__user_roi_spad_en_17 =
+		(*(pbuffer +  25));
+	pdata->dss_calc__user_roi_spad_en_18 =
+		(*(pbuffer +  26));
+	pdata->dss_calc__user_roi_spad_en_19 =
+		(*(pbuffer +  27));
+	pdata->dss_calc__user_roi_spad_en_20 =
+		(*(pbuffer +  28));
+	pdata->dss_calc__user_roi_spad_en_21 =
+		(*(pbuffer +  29));
+	pdata->dss_calc__user_roi_spad_en_22 =
+		(*(pbuffer +  30));
+	pdata->dss_calc__user_roi_spad_en_23 =
+		(*(pbuffer +  31));
+	pdata->dss_calc__user_roi_spad_en_24 =
+		(*(pbuffer +  32));
+	pdata->dss_calc__user_roi_spad_en_25 =
+		(*(pbuffer +  33));
+	pdata->dss_calc__user_roi_spad_en_26 =
+		(*(pbuffer +  34));
+	pdata->dss_calc__user_roi_spad_en_27 =
+		(*(pbuffer +  35));
+	pdata->dss_calc__user_roi_spad_en_28 =
+		(*(pbuffer +  36));
+	pdata->dss_calc__user_roi_spad_en_29 =
+		(*(pbuffer +  37));
+	pdata->dss_calc__user_roi_spad_en_30 =
+		(*(pbuffer +  38));
+	pdata->dss_calc__user_roi_spad_en_31 =
+		(*(pbuffer +  39));
+	pdata->dss_calc__user_roi_0 =
+		(*(pbuffer +  40));
+	pdata->dss_calc__user_roi_1 =
+		(*(pbuffer +  41));
+	pdata->dss_calc__mode_roi_0 =
+		(*(pbuffer +  42));
+	pdata->dss_calc__mode_roi_1 =
+		(*(pbuffer +  43));
+	pdata->sigma_estimator_calc__spare_0 =
+		(*(pbuffer +  44));
+	pdata->vhv_result__peak_signal_rate_mcps =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  46));
+	pdata->vhv_result__signal_total_events_ref =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  48));
+	pdata->phasecal_result__phase_output_ref =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  52));
+	pdata->dss_result__total_rate_per_spad =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  54));
+	pdata->dss_result__enabled_blocks =
+		(*(pbuffer +  56));
+	pdata->dss_result__num_requested_spads =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  58));
+	pdata->mm_result__inner_intersection_rate =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  62));
+	pdata->mm_result__outer_complement_rate =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  64));
+	pdata->mm_result__total_offset =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  66));
+	pdata->xtalk_calc__xtalk_for_enabled_spads =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  68)) & 0xFFFFFF;
+	pdata->xtalk_result__avg_xtalk_user_roi_kcps =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  72)) & 0xFFFFFF;
+	pdata->xtalk_result__avg_xtalk_mm_inner_roi_kcps =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  76)) & 0xFFFFFF;
+	pdata->xtalk_result__avg_xtalk_mm_outer_roi_kcps =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  80)) & 0xFFFFFF;
+	pdata->range_result__accum_phase =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  84));
+	pdata->range_result__offset_corrected_range =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  88));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_patch_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_patch_results(
+			pdata,
+			VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_DSS_CALC__ROI_CTRL,
+			comms_buffer,
+			VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_patch_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_patch_results_t    *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_DSS_CALC__ROI_CTRL,
+			comms_buffer,
+			VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_patch_results(
+			VL53L1_PATCH_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_shadow_system_results(
+	VL53L1_shadow_system_results_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	*(pbuffer +   0) =
+		pdata->shadow_phasecal_result__vcsel_start;
+	*(pbuffer +   2) =
+		pdata->shadow_result__interrupt_status & 0x3F;
+	*(pbuffer +   3) =
+		pdata->shadow_result__range_status;
+	*(pbuffer +   4) =
+		pdata->shadow_result__report_status & 0xF;
+	*(pbuffer +   5) =
+		pdata->shadow_result__stream_count;
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__dss_actual_effective_spads_sd0,
+		2,
+		pbuffer +   6);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__peak_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__ambient_count_rate_mcps_sd0,
+		2,
+		pbuffer +  10);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__sigma_sd0,
+		2,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__phase_sd0,
+		2,
+		pbuffer +  14);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__final_crosstalk_corrected_range_mm_sd0,
+		2,
+		pbuffer +  16);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0,
+		2,
+		pbuffer +  18);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__mm_inner_actual_effective_spads_sd0,
+		2,
+		pbuffer +  20);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__mm_outer_actual_effective_spads_sd0,
+		2,
+		pbuffer +  22);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__avg_signal_count_rate_mcps_sd0,
+		2,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__dss_actual_effective_spads_sd1,
+		2,
+		pbuffer +  26);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__peak_signal_count_rate_mcps_sd1,
+		2,
+		pbuffer +  28);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__ambient_count_rate_mcps_sd1,
+		2,
+		pbuffer +  30);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__sigma_sd1,
+		2,
+		pbuffer +  32);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__phase_sd1,
+		2,
+		pbuffer +  34);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__final_crosstalk_corrected_range_mm_sd1,
+		2,
+		pbuffer +  36);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__spare_0_sd1,
+		2,
+		pbuffer +  38);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__spare_1_sd1,
+		2,
+		pbuffer +  40);
+	VL53L1_i2c_encode_uint16_t(
+		pdata->shadow_result__spare_2_sd1,
+		2,
+		pbuffer +  42);
+	*(pbuffer +  44) =
+		pdata->shadow_result__spare_3_sd1;
+	*(pbuffer +  45) =
+		pdata->shadow_result__thresh_info;
+	*(pbuffer +  80) =
+		pdata->shadow_phasecal_result__reference_phase_hi;
+	*(pbuffer +  81) =
+		pdata->shadow_phasecal_result__reference_phase_lo;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_shadow_system_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->shadow_phasecal_result__vcsel_start =
+		(*(pbuffer +   0));
+	pdata->shadow_result__interrupt_status =
+		(*(pbuffer +   2)) & 0x3F;
+	pdata->shadow_result__range_status =
+		(*(pbuffer +   3));
+	pdata->shadow_result__report_status =
+		(*(pbuffer +   4)) & 0xF;
+	pdata->shadow_result__stream_count =
+		(*(pbuffer +   5));
+	pdata->shadow_result__dss_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   6));
+	pdata->shadow_result__peak_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +   8));
+	pdata->shadow_result__ambient_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  10));
+	pdata->shadow_result__sigma_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  12));
+	pdata->shadow_result__phase_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  14));
+	pdata->shadow_result__final_crosstalk_corrected_range_mm_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  16));
+	pdata->shr__peak_signal_count_rate_crosstalk_corrected_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  18));
+	pdata->shadow_result__mm_inner_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  20));
+	pdata->shadow_result__mm_outer_actual_effective_spads_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  22));
+	pdata->shadow_result__avg_signal_count_rate_mcps_sd0 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  24));
+	pdata->shadow_result__dss_actual_effective_spads_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  26));
+	pdata->shadow_result__peak_signal_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  28));
+	pdata->shadow_result__ambient_count_rate_mcps_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  30));
+	pdata->shadow_result__sigma_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  32));
+	pdata->shadow_result__phase_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  34));
+	pdata->shadow_result__final_crosstalk_corrected_range_mm_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  36));
+	pdata->shadow_result__spare_0_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  38));
+	pdata->shadow_result__spare_1_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  40));
+	pdata->shadow_result__spare_2_sd1 =
+		(VL53L1_i2c_decode_uint16_t(2, pbuffer +  42));
+	pdata->shadow_result__spare_3_sd1 =
+		(*(pbuffer +  44));
+	pdata->shadow_result__thresh_info =
+		(*(pbuffer +  45));
+	pdata->shadow_phasecal_result__reference_phase_hi =
+		(*(pbuffer +  80));
+	pdata->shadow_phasecal_result__reference_phase_lo =
+		(*(pbuffer +  81));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_shadow_system_results(
+			pdata,
+			VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_SHADOW_PHASECAL_RESULT__VCSEL_START,
+			comms_buffer,
+			VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_shadow_system_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_system_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_SHADOW_PHASECAL_RESULT__VCSEL_START,
+			comms_buffer,
+			VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_shadow_system_results(
+			VL53L1_SHADOW_SYSTEM_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_encode_shadow_core_results(
+	VL53L1_shadow_core_results_t *pdata,
+	uint16_t                  buf_size,
+	uint8_t                  *pbuffer)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__ambient_window_events_sd0,
+		4,
+		pbuffer +   0);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__ranging_total_events_sd0,
+		4,
+		pbuffer +   4);
+	VL53L1_i2c_encode_int32_t(
+		pdata->shadow_result_core__signal_total_events_sd0,
+		4,
+		pbuffer +   8);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__total_periods_elapsed_sd0,
+		4,
+		pbuffer +  12);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__ambient_window_events_sd1,
+		4,
+		pbuffer +  16);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__ranging_total_events_sd1,
+		4,
+		pbuffer +  20);
+	VL53L1_i2c_encode_int32_t(
+		pdata->shadow_result_core__signal_total_events_sd1,
+		4,
+		pbuffer +  24);
+	VL53L1_i2c_encode_uint32_t(
+		pdata->shadow_result_core__total_periods_elapsed_sd1,
+		4,
+		pbuffer +  28);
+	*(pbuffer +  32) =
+		pdata->shadow_result_core__spare_0;
+	LOG_FUNCTION_END(status);
+
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_i2c_decode_shadow_core_results(
+	uint16_t                   buf_size,
+	uint8_t                   *pbuffer,
+	VL53L1_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+	if (buf_size < VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES)
+		return VL53L1_ERROR_COMMS_BUFFER_TOO_SMALL;
+
+	pdata->shadow_result_core__ambient_window_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   0));
+	pdata->shadow_result_core__ranging_total_events_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +   4));
+	pdata->shadow_result_core__signal_total_events_sd0 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +   8));
+	pdata->shadow_result_core__total_periods_elapsed_sd0 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  12));
+	pdata->shadow_result_core__ambient_window_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  16));
+	pdata->shadow_result_core__ranging_total_events_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  20));
+	pdata->shadow_result_core__signal_total_events_sd1 =
+		(VL53L1_i2c_decode_int32_t(4, pbuffer +  24));
+	pdata->shadow_result_core__total_periods_elapsed_sd1 =
+		(VL53L1_i2c_decode_uint32_t(4, pbuffer +  28));
+	pdata->shadow_result_core__spare_0 =
+		(*(pbuffer +  32));
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_set_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_i2c_encode_shadow_core_results(
+			pdata,
+			VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_WriteMulti(
+			Dev,
+			VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+			comms_buffer,
+			VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_get_shadow_core_results(
+	VL53L1_DEV                 Dev,
+	VL53L1_shadow_core_results_t  *pdata)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t comms_buffer[VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES];
+
+	LOG_FUNCTION_START("");
+
+	if (status == VL53L1_ERROR_NONE)
+
+		status = VL53L1_disable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_ReadMulti(
+			Dev,
+			VL53L1_SHADOW_RESULT_CORE__AMBIENT_WINDOW_EVENTS_SD0,
+			comms_buffer,
+			VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_enable_firmware(Dev);
+
+	if (status == VL53L1_ERROR_NONE)
+		status = VL53L1_i2c_decode_shadow_core_results(
+			VL53L1_SHADOW_CORE_RESULTS_I2C_SIZE_BYTES,
+			comms_buffer,
+			pdata);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_silicon_core.c b/drivers/input/misc/vl53L1/src/vl53l1_silicon_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..2c3112b841bd1aca7d20373ea0ff97a448780bcc
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_silicon_core.c
@@ -0,0 +1,187 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_register_map.h"
+#include "vl53l1_core.h"
+#include "vl53l1_silicon_core.h"
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE,\
+			status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_is_firmware_ready_silicon(
+	VL53L1_DEV     Dev,
+	uint8_t       *pready)
+{
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  comms_buffer[5];
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status = VL53L1_ReadMulti(
+				Dev,
+				VL53L1_INTERRUPT_MANAGER__ENABLES,
+				comms_buffer,
+				5);
+
+	if (status != VL53L1_ERROR_NONE)
+		goto ENDFUNC;
+
+	pdev->dbg_results.interrupt_manager__enables =
+			comms_buffer[0];
+	pdev->dbg_results.interrupt_manager__clear =
+			comms_buffer[1];
+	pdev->dbg_results.interrupt_manager__status =
+			comms_buffer[2];
+	pdev->dbg_results.mcu_to_host_bank__wr_access_en =
+			comms_buffer[3];
+	pdev->dbg_results.power_management__go1_reset_status =
+			comms_buffer[4];
+
+	if ((pdev->sys_ctrl.power_management__go1_power_force & 0x01)
+			== 0x01) {
+
+		if (((pdev->dbg_results.interrupt_manager__enables &
+				0x1F) == 0x1F) &&
+			((pdev->dbg_results.interrupt_manager__clear
+					& 0x1F) == 0x1F))
+			*pready = 0x01;
+		else
+			*pready = 0x00;
+
+	} else {
+
+
+
+		if ((pdev->dbg_results.power_management__go1_reset_status
+				& 0x01) == 0x00)
+			*pready = 0x01;
+		else
+			*pready = 0x00;
+	}
+
+
+ENDFUNC:
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_wait.c b/drivers/input/misc/vl53L1/src/vl53l1_wait.c
new file mode 100644
index 0000000000000000000000000000000000000000..083e53d584a3afee0df0395cb5eaa018bcc4ef31
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_wait.c
@@ -0,0 +1,621 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform.h"
+#include "vl53l1_core.h"
+#include "vl53l1_silicon_core.h"
+#include "vl53l1_wait.h"
+#include "vl53l1_register_settings.h"
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE, status, \
+		fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_wait_for_boot_completion(
+	VL53L1_DEV     Dev)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t      fw_ready  = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->wait_method == VL53L1_WAIT_METHOD_BLOCKING) {
+
+
+
+
+		status =
+			VL53L1_poll_for_boot_completion(
+				Dev,
+				VL53L1_BOOT_COMPLETION_POLLING_TIMEOUT_MS);
+
+	} else {
+
+
+
+
+		fw_ready = 0;
+		while (fw_ready == 0x00 && status == VL53L1_ERROR_NONE) {
+			status = VL53L1_is_boot_complete(
+				Dev,
+				&fw_ready);
+
+			if (status == VL53L1_ERROR_NONE) {
+				status = VL53L1_WaitMs(
+					Dev,
+					VL53L1_POLLING_DELAY_MS);
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+
+}
+
+
+VL53L1_Error VL53L1_wait_for_firmware_ready(
+	VL53L1_DEV     Dev)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t      fw_ready  = 0;
+	uint8_t      mode_start  = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+	mode_start =
+		pdev->sys_ctrl.system__mode_start &
+		VL53L1_DEVICEMEASUREMENTMODE_MODE_MASK;
+
+
+
+
+
+
+
+	if ((mode_start == VL53L1_DEVICEMEASUREMENTMODE_TIMED) ||
+		(mode_start == VL53L1_DEVICEMEASUREMENTMODE_SINGLESHOT)) {
+
+		if (pdev->wait_method == VL53L1_WAIT_METHOD_BLOCKING) {
+
+
+
+
+			status =
+			VL53L1_poll_for_firmware_ready(
+				Dev,
+				VL53L1_RANGE_COMPLETION_POLLING_TIMEOUT_MS);
+
+		} else {
+
+
+
+
+			fw_ready = 0;
+			while (fw_ready == 0x00 && status ==
+					VL53L1_ERROR_NONE) {
+				status = VL53L1_is_firmware_ready(
+					Dev,
+					&fw_ready);
+
+				if (status == VL53L1_ERROR_NONE) {
+					status = VL53L1_WaitMs(
+						Dev,
+						VL53L1_POLLING_DELAY_MS);
+				}
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_wait_for_range_completion(
+	VL53L1_DEV     Dev)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t      data_ready  = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->wait_method == VL53L1_WAIT_METHOD_BLOCKING) {
+
+
+
+
+		status =
+			VL53L1_poll_for_range_completion(
+				Dev,
+				VL53L1_RANGE_COMPLETION_POLLING_TIMEOUT_MS);
+
+	} else {
+
+
+
+
+		data_ready = 0;
+		while (data_ready == 0x00 && status == VL53L1_ERROR_NONE) {
+			status = VL53L1_is_new_data_ready(
+				Dev,
+				&data_ready);
+
+			if (status == VL53L1_ERROR_NONE) {
+				status = VL53L1_WaitMs(
+					Dev,
+					VL53L1_POLLING_DELAY_MS);
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_wait_for_test_completion(
+	VL53L1_DEV     Dev)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t      data_ready  = 0;
+
+	LOG_FUNCTION_START("");
+
+	if (pdev->wait_method == VL53L1_WAIT_METHOD_BLOCKING) {
+
+
+
+
+		status =
+			VL53L1_poll_for_range_completion(
+				Dev,
+				VL53L1_TEST_COMPLETION_POLLING_TIMEOUT_MS);
+
+	} else {
+
+
+
+
+		data_ready = 0;
+		while (data_ready == 0x00 && status == VL53L1_ERROR_NONE) {
+			status = VL53L1_is_new_data_ready(
+				Dev,
+				&data_ready);
+
+			if (status == VL53L1_ERROR_NONE) {
+				status = VL53L1_WaitMs(
+					Dev,
+					VL53L1_POLLING_DELAY_MS);
+			}
+		}
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_is_boot_complete(
+	VL53L1_DEV     Dev,
+	uint8_t       *pready)
+{
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t  firmware__system_status = 0;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+	status =
+		VL53L1_RdByte(
+			Dev,
+			VL53L1_FIRMWARE__SYSTEM_STATUS,
+			&firmware__system_status);
+
+
+
+
+
+
+	if ((firmware__system_status & 0x01) == 0x01) {
+		*pready = 0x01;
+		VL53L1_init_ll_driver_state(
+			Dev,
+			VL53L1_DEVICESTATE_SW_STANDBY);
+	} else {
+		*pready = 0x00;
+		VL53L1_init_ll_driver_state(
+			Dev,
+			VL53L1_DEVICESTATE_FW_COLDBOOT);
+	}
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_is_firmware_ready(
+	VL53L1_DEV     Dev,
+	uint8_t       *pready)
+{
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	LOG_FUNCTION_START("");
+
+	status = VL53L1_is_firmware_ready_silicon(
+				Dev,
+				pready);
+
+	pdev->fw_ready = *pready;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_is_new_data_ready(
+	VL53L1_DEV     Dev,
+	uint8_t       *pready)
+{
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  gpio__mux_active_high_hv = 0;
+	uint8_t  gpio__tio_hv_status      = 0;
+	uint8_t  interrupt_ready          = 0;
+
+	LOG_FUNCTION_START("");
+
+	gpio__mux_active_high_hv =
+			pdev->stat_cfg.gpio_hv_mux__ctrl &
+			VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_MASK;
+
+	if (gpio__mux_active_high_hv == VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_HIGH)
+		interrupt_ready = 0x01;
+	else
+		interrupt_ready = 0x00;
+
+
+
+
+	status = VL53L1_RdByte(
+					Dev,
+					VL53L1_GPIO__TIO_HV_STATUS,
+					&gpio__tio_hv_status);
+
+
+
+
+	if ((gpio__tio_hv_status & 0x01) == interrupt_ready)
+		*pready = 0x01;
+	else
+		*pready = 0x00;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+
+
+VL53L1_Error VL53L1_poll_for_boot_completion(
+	VL53L1_DEV    Dev,
+	uint32_t      timeout_ms)
+{
+
+
+
+
+
+
+	VL53L1_Error status       = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+
+
+	status = VL53L1_WaitUs(
+			Dev,
+			VL53L1_FIRMWARE_BOOT_TIME_US);
+
+	if (status == VL53L1_ERROR_NONE)
+		status =
+			VL53L1_WaitValueMaskEx(
+				Dev,
+				timeout_ms,
+				VL53L1_FIRMWARE__SYSTEM_STATUS,
+				0x01,
+				0x01,
+				VL53L1_POLLING_DELAY_MS);
+
+	if (status == VL53L1_ERROR_NONE)
+		VL53L1_init_ll_driver_state(Dev, VL53L1_DEVICESTATE_SW_STANDBY);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_poll_for_firmware_ready(
+	VL53L1_DEV    Dev,
+	uint32_t      timeout_ms)
+{
+
+
+
+
+
+
+	VL53L1_Error status          = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint32_t     start_time_ms   = 0;
+	uint32_t     current_time_ms = 0;
+	int32_t      poll_delay_ms   = VL53L1_POLLING_DELAY_MS;
+	uint8_t      fw_ready        = 0;
+
+
+
+
+	VL53L1_GetTickCount(&start_time_ms);
+
+	pdev->fw_ready_poll_duration_ms = 0;
+
+
+
+
+	while ((status == VL53L1_ERROR_NONE) &&
+		   (pdev->fw_ready_poll_duration_ms < timeout_ms) &&
+		   (fw_ready == 0)) {
+
+		status = VL53L1_is_firmware_ready(
+			Dev,
+			&fw_ready);
+
+		if (status == VL53L1_ERROR_NONE &&
+			fw_ready == 0 &&
+			poll_delay_ms > 0) {
+			status = VL53L1_WaitMs(
+				Dev,
+				poll_delay_ms);
+		}
+
+
+
+
+
+
+		VL53L1_GetTickCount(&current_time_ms);
+
+		pdev->fw_ready_poll_duration_ms =
+				current_time_ms - start_time_ms;
+	}
+
+	if (fw_ready == 0 && status == VL53L1_ERROR_NONE)
+		status = VL53L1_ERROR_TIME_OUT;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_poll_for_range_completion(
+	VL53L1_DEV     Dev,
+	uint32_t       timeout_ms)
+{
+
+
+
+
+
+
+
+
+
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	VL53L1_LLDriverData_t *pdev = VL53L1DevStructGetLLDriverHandle(Dev);
+
+	uint8_t  gpio__mux_active_high_hv = 0;
+	uint8_t  interrupt_ready          = 0;
+
+	LOG_FUNCTION_START("");
+
+	gpio__mux_active_high_hv =
+			pdev->stat_cfg.gpio_hv_mux__ctrl &
+			VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_MASK;
+
+	if (gpio__mux_active_high_hv == VL53L1_DEVICEINTERRUPTLEVEL_ACTIVE_HIGH)
+		interrupt_ready = 0x01;
+	else
+		interrupt_ready = 0x00;
+
+	status =
+		VL53L1_WaitValueMaskEx(
+			Dev,
+			timeout_ms,
+			VL53L1_GPIO__TIO_HV_STATUS,
+			interrupt_ready,
+			0x01,
+			VL53L1_POLLING_DELAY_MS);
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
diff --git a/drivers/input/misc/vl53L1/src/vl53l1_zone_presets.c b/drivers/input/misc/vl53L1/src/vl53l1_zone_presets.c
new file mode 100644
index 0000000000000000000000000000000000000000..e35f395a233f4e0685143a380fa87b02ca28210c
--- /dev/null
+++ b/drivers/input/misc/vl53L1/src/vl53l1_zone_presets.c
@@ -0,0 +1,253 @@
+
+/*******************************************************************************
+ * Copyright (c) 2017, STMicroelectronics - All Rights Reserved
+
+ This file is part of VL53L1 Core and is dual licensed,
+ either 'STMicroelectronics
+ Proprietary license'
+ or 'BSD 3-clause "New" or "Revised" License' , at your option.
+
+********************************************************************************
+
+ 'STMicroelectronics Proprietary license'
+
+********************************************************************************
+
+ License terms: STMicroelectronics Proprietary in accordance with licensing
+ terms at www.st.com/sla0081
+
+ STMicroelectronics confidential
+ Reproduction and Communication of this document is strictly prohibited unless
+ specifically authorized in writing by STMicroelectronics.
+
+
+********************************************************************************
+
+ Alternatively, VL53L1 Core may be distributed under the terms of
+ 'BSD 3-clause "New" or "Revised" License', in which case the following
+ provisions apply instead of the ones
+ mentioned above :
+
+********************************************************************************
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+********************************************************************************
+
+*/
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_ll_device.h"
+#include "vl53l1_platform_log.h"
+#include "vl53l1_zone_presets.h"
+
+
+#define LOG_FUNCTION_START(fmt, ...) \
+	_LOG_FUNCTION_START(VL53L1_TRACE_MODULE_CORE, fmt, ##__VA_ARGS__)
+#define LOG_FUNCTION_END(status, ...) \
+	_LOG_FUNCTION_END(VL53L1_TRACE_MODULE_CORE, status, ##__VA_ARGS__)
+#define LOG_FUNCTION_END_FMT(status, fmt, ...) \
+	_LOG_FUNCTION_END_FMT(VL53L1_TRACE_MODULE_CORE,\
+			status, fmt, ##__VA_ARGS__)
+
+
+VL53L1_Error VL53L1_init_zone_config_structure(
+	uint8_t x_off,
+	uint8_t x_inc,
+	uint8_t x_zones,
+	uint8_t y_off,
+	uint8_t y_inc,
+	uint8_t y_zones,
+	uint8_t width,
+	uint8_t height,
+	VL53L1_zone_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint8_t  x  = 0;
+	uint8_t  y  = 0;
+	uint16_t  i  = 0;
+
+	LOG_FUNCTION_START("");
+
+	pdata->max_zones = VL53L1_MAX_USER_ZONES;
+
+	i = 0;
+
+	for (x = 0 ; x < x_zones ; x++) {
+		for (y = 0 ; y <  y_zones ; y++) {
+
+			if (i < VL53L1_MAX_USER_ZONES) {
+
+				pdata->active_zones = (uint8_t)i;
+				pdata->user_zones[i].height   = height;
+				pdata->user_zones[i].width    = width;
+				pdata->user_zones[i].x_centre =
+						x_off + (x * x_inc);
+				pdata->user_zones[i].y_centre =
+						y_off + (y * y_inc);
+			}
+
+			i++;
+		}
+	}
+
+	status = VL53L1_init_zone_config_histogram_bins(pdata);
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_zone_preset_xtalk_planar(
+	VL53L1_general_config_t	*pgeneral,
+	VL53L1_zone_config_t    *pzone_cfg)
+{
+
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	LOG_FUNCTION_START("");
+
+
+
+
+
+
+	pgeneral->global_config__stream_divider = 0x05;
+
+
+
+	pzone_cfg->active_zones                 = 0x04;
+
+	pzone_cfg->user_zones[0].height         = 15;
+	pzone_cfg->user_zones[0].width          = 7;
+	pzone_cfg->user_zones[0].x_centre       = 4;
+	pzone_cfg->user_zones[0].y_centre       = 8;
+
+	pzone_cfg->user_zones[1].height         = 15;
+	pzone_cfg->user_zones[1].width          = 7;
+	pzone_cfg->user_zones[1].x_centre       = 12;
+	pzone_cfg->user_zones[1].y_centre       = 8;
+
+	pzone_cfg->user_zones[2].height         = 7;
+	pzone_cfg->user_zones[2].width          = 15;
+	pzone_cfg->user_zones[2].x_centre       = 8;
+	pzone_cfg->user_zones[2].y_centre       = 4;
+
+	pzone_cfg->user_zones[3].height         = 7;
+	pzone_cfg->user_zones[3].width          = 15;
+	pzone_cfg->user_zones[3].x_centre       = 8;
+	pzone_cfg->user_zones[3].y_centre       = 12;
+
+
+
+
+	pzone_cfg->user_zones[4].height         = 15;
+	pzone_cfg->user_zones[4].width          = 15;
+	pzone_cfg->user_zones[4].x_centre       = 8;
+	pzone_cfg->user_zones[4].y_centre       = 8;
+
+	status = VL53L1_init_zone_config_histogram_bins(pzone_cfg);
+
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
+
+VL53L1_Error VL53L1_init_zone_config_histogram_bins(
+	VL53L1_zone_config_t   *pdata)
+{
+
+
+
+
+
+	VL53L1_Error  status = VL53L1_ERROR_NONE;
+
+	uint8_t i;
+
+	LOG_FUNCTION_START("");
+
+	for (i = 0; i < pdata->max_zones; i++)
+		pdata->bin_config[i] = VL53L1_ZONECONFIG_BINCONFIG__LOWAMB;
+
+	LOG_FUNCTION_END(status);
+
+	return status;
+}
+
diff --git a/drivers/input/misc/vl53L1/st,stmvl53l1.txt b/drivers/input/misc/vl53L1/st,stmvl53l1.txt
new file mode 100644
index 0000000000000000000000000000000000000000..3f81932590c235b37623945be36530e66db84c45
--- /dev/null
+++ b/drivers/input/misc/vl53L1/st,stmvl53l1.txt
@@ -0,0 +1,26 @@
+StMicroelectronis vl53l1
+
+Requires properties:
+- compatible: must be "st,stmvl53l1".
+- reg: I2C address of the chip.
+- xsdn-gpio: gpio number connected to vl53l1 reset pin.
+
+Optional properties:
+- intr-gpio: gpio number connected to vl53l1 irq pin.
+- vdd: a phandle for the regulator supplying power for vl53l1.
+- pwren-gpio: gpio number use to control vl53l1 power.
+
+Example:
+	&i2c1 {
+		/* ... */
+
+		stmvl53l1: stmvl53l1@29 {
+			compatible = "st,stmvl53l1";
+			reg = <0x29>;
+			xsdn-gpio = <19>;
+			pwren-gpio = <12>;
+			intr-gpio = <16>;
+		};
+
+		/* ... */
+	};
diff --git a/drivers/input/misc/vl53L1/stmvl53l1-i2c.h b/drivers/input/misc/vl53L1/stmvl53l1-i2c.h
new file mode 100644
index 0000000000000000000000000000000000000000..ffde504a00051790db7c72a0b85227a05daf2bfe
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1-i2c.h
@@ -0,0 +1,116 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**  @file stmvl53l1-i2c.h
+ * Linux kernel i2c/cci  wrapper for  ST VL53L1 sensor i2c interface
+ **/
+
+#ifndef STMVL53L1_I2C_H
+#define STMVL53L1_I2C_H
+#include <linux/types.h>
+#include "stmvl53l1.h"
+
+struct i2c_data {
+	struct i2c_client *client;
+	/** back link to driver for interrupt and clean-up */
+	struct stmvl53l1_data *vl53l1_data;
+
+	/* reference counter */
+	struct kref ref;
+
+	/*!< if null no regulator use for power ctrl */
+	struct regulator *vdd;
+
+	/*!< power enable gpio number
+	 *
+	 * if -1 no gpio if vdd not avl pwr is not controllable
+	 */
+	int pwren_gpio;
+
+	/*!< xsdn reset (low active) gpio number to device
+	 *
+	 *  -1  mean none assume no "resetable"
+	 */
+	int xsdn_gpio;
+
+	/*!< intr gpio number to device
+	 *
+	 *  intr is active/low negative edge by default
+	 *
+	 *  -1  mean none assume use polling
+	 *  @warning if the dev tree and intr gpio is require please adapt code
+	 */
+	int intr_gpio;
+
+	/*!< device boot i2c register address
+	 *
+	 * boot_reg is the value of device i2c address after it is bring out
+	 * of reset.
+	 */
+	int boot_reg;
+
+	/*!< is set if above irq gpio got acquired */
+	struct i2d_data_flags_t {
+		unsigned pwr_owned:1; /*!< set if pwren gpio is owned*/
+		unsigned xsdn_owned:1; /*!< set if sxdn  gpio is owned*/
+		unsigned intr_owned:1; /*!< set if intr  gpio is owned*/
+		unsigned intr_started:1; /*!< set if irq is hanlde  */
+	} io_flag;
+
+	/** the irq vectore assigned to gpio
+	 * -1 if no irq hanled
+	 */
+	int irq;
+
+	struct msgtctrl_t {
+		unsigned unhandled_irq_vec:1;
+	} msg_flag;
+};
+
+#ifdef USE_CAMERA_CCI
+int __init stmvl53l1_init_cci(void);
+void __exit stmvl53l1_exit_cci(void*);
+int stmvl53l1_enable_pinctrl(void);
+int stmvl53l1_disable_pinctrl(void);
+#else
+int stmvl53l1_init_i2c(void);
+void __exit stmvl53l1_exit_i2c(void *arg);
+#endif
+int stmvl53l1_power_up_i2c(void *arg);
+int stmvl53l1_power_down_i2c(void *arg);
+int stmvl53l1_reset_release_i2c(void *arg);
+int stmvl53l1_reset_hold_i2c(void *arg);
+void stmvl53l1_clean_up_i2c(void);
+int stmvl53l1_start_intr(void *object, int *poll_mode);
+void *stmvl53l1_get(void *arg);
+void stmvl53l1_put(void *arg);
+
+#endif /* STMVL53L1_I2C_H */
diff --git a/drivers/input/misc/vl53L1/stmvl53l1.h b/drivers/input/misc/vl53L1/stmvl53l1.h
new file mode 100644
index 0000000000000000000000000000000000000000..25f14fc467cc57c0311fe4e734c21867b9ab8bbf
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1.h
@@ -0,0 +1,391 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+/**
+ * @file stmvl53l1.h header for vl53l1 sensor driver
+ */
+#ifndef STMVL53L1_H
+#define STMVL53L1_H
+
+#include <linux/types.h>
+#include <linux/mutex.h>
+#include <linux/workqueue.h>
+#include <linux/miscdevice.h>
+#include <linux/wait.h>
+
+#include "vl53l1_api.h"
+
+/**
+ * IPP adapt
+ */
+#ifdef DEBUG
+#	define IPP_PRINT(...) printk(__VA_ARGS__)
+#else
+#	define IPP_PRINT(...) (void)0
+#endif
+
+#include "stmvl53l1_ipp.h"
+#include "stmvl53l1_if.h"
+
+/**
+ * Configure the Netlink-id use
+ */
+#define STMVL531_CFG_NETLINK_USER 31
+
+#define STMVL53L1_MAX_CCI_XFER_SZ	256
+#define STMVL53L1_DRV_NAME	"stmvl53l1"
+
+/**
+ * configure usage of regulator device from device tree info
+ * to enable/disable sensor power
+ * see module-i2c or module-cci file
+ */
+/* define CFG_STMVL53L1_HAVE_REGULATOR */
+
+#define DRIVER_VERSION		"13.0.1"
+
+/** @ingroup vl53l1_config
+ * @{
+ */
+/**
+ * Configure max number of device the driver can support
+ */
+#define STMVL53L1_CFG_MAX_DEV	2
+/** @} */ /* ingroup vl53l1_config */
+
+/** @ingroup vl53l1_mod_dbg
+ * @{
+ */
+#if 1
+#define DEBUG	1
+#endif
+#if 1
+#define FORCE_CONSOLE_DEBUG
+#endif
+
+extern int stmvl53l1_enable_debug;
+
+#ifdef DEBUG
+#	ifdef FORCE_CONSOLE_DEBUG
+#define vl53l1_dbgmsg(str, ...) do { \
+	if (stmvl53l1_enable_debug) \
+		pr_info("%s: " str, __func__, ##__VA_ARGS__); \
+} while (0)
+#	else
+#define vl53l1_dbgmsg(str, ...) do { \
+	if (stmvl53l1_enable_debug) \
+		pr_debug("%s: " str, __func__, ##__VA_ARGS__); \
+} while (0)
+#	endif
+#else
+#	define vl53l1_dbgmsg(...) (void)0
+#endif
+
+/**
+ * set to 0 1 activate or not debug from work (data interrupt/polling)
+ */
+#define WORK_DEBUG	0
+#if WORK_DEBUG
+#	define work_dbg(msg, ...)\
+	printk("[D WK53L1] :" msg "\n", ##__VA_ARGS__)
+#else
+#	define work_dbg(...) (void)0
+#endif
+
+#define vl53l1_info(str, args...) \
+	pr_info("%s: " str "\n", __func__, ##args)
+
+#define vl53l1_errmsg(str, args...) \
+	pr_err("%s: " str, __func__, ##args)
+
+#define vl53l1_wanrmsg(str, args...) \
+	pr_warn("%s: " str, __func__, ##args)
+
+/* turn off poll log if not defined */
+#ifndef STMVL53L1_LOG_POLL_TIMING
+#	define STMVL53L1_LOG_POLL_TIMING	0
+#endif
+/* turn off cci log timing if not defined */
+#ifndef STMVL53L1_LOG_CCI_TIMING
+#	define STMVL53L1_LOG_CCI_TIMING	0
+#endif
+
+/**@} */ /* ingroup mod_dbg*/
+
+#include <net/sock.h>
+#include <linux/netlink.h>
+#include <linux/wait.h>
+
+/** if set to 1 enable ipp execution timing (if debug enabled)
+ * @ingroup vl53l1_mod_dbg
+ */
+#define IPP_LOG_TIMING	1
+
+struct ipp_data_t {
+	struct ipp_work_t work;
+	struct ipp_work_t work_out;
+	int test_n;
+	/*!< buzy state 0 is idle
+	 *any other value do not try to use (state value defined in source)
+	 */
+	int buzy;
+	int waited_xfer_id;
+	/*!< when buzy is set that is the id we are expecting
+	 * note that value 0 is reserved and stand for "not waiting"
+	 * as such never id 0 will be in any round trip exchange
+	 * it's ok for daemon to use 0 in "ping" when it identify himself
+	 */
+	int status;	/** if that is not 0 do not look at out work data */
+	wait_queue_head_t waitq;
+	/*!< ipp caller are put in that queue wait while job is posted to user
+	 * @warning  ipp and dev mutex will be released before waiting
+	 * see @ref ipp_abort
+	 */
+#if IPP_LOG_TIMING
+	struct timeval start_tv, stop_tv;
+#endif
+};
+
+struct stmvl53l1_waiters {
+	struct list_head list;
+	pid_t pid;
+};
+
+/*
+ *  driver data structs
+ */
+struct stmvl53l1_data {
+	int id;			/*!< multiple device id 0 based*/
+	char name[64];		/*!< misc device name */
+
+	VL53L1_DevData_t stdev;	/*!<embed ST VL53L0 Dev data as "stdev" */
+
+	void *client_object;	/*!< cci or i2c model i/f specific ptr  */
+	bool is_device_remove;	/*!< true when device has been remove */
+
+	struct mutex work_mutex; /*!< main dev mutex/lock */;
+	struct delayed_work	dwork;
+	/*!< work for pseudo irq polling check  */
+
+	struct input_dev *input_dev_ps;
+	/*!< input device used for sending event */
+
+	/* misc device */
+	struct miscdevice miscdev;
+	/* first irq has no valid data, so avoid to update data on first one */
+	int is_first_irq;
+	/* set when first start has be done */
+	int is_first_start_done;
+
+	/* control data */
+	int poll_mode;	/*!< use poll even if interrupt line present*/
+	int poll_delay_ms;	/*!< rescheduled time use in poll mode  */
+	int enable_sensor;	/*!< actual device enabled state  */
+	struct timeval start_tv;/*!< stream start time */
+	int enable_debug;
+	bool allow_hidden_start_stop; /*!< allow stop/start sequence in bare */
+
+	/* Custom values set by app */
+
+	int preset_mode;	/*!< preset working mode of the device */
+	uint32_t timing_budget;	/*!< Timing Budget */
+	int distance_mode;	/*!< distance mode of the device */
+	int crosstalk_enable;	/*!< is crosstalk compensation is enable */
+	int output_mode;	/*!< output mode of the device */
+	bool force_device_on_en;/*!< keep device active when stopped */
+	VL53L1_Error last_error;/*!< last device internal error */
+	int offset_correction_mode;/*!< offset correction mode to apply */
+	FixPoint1616_t dmax_reflectance;/*!< reflectance use for dmax calc */
+	int dmax_mode;		/*!< Dmax mode of the device */
+	int smudge_correction_mode; /*!< smudge mode */
+
+	/* Read only values */
+	FixPoint1616_t optical_offset_x;
+	FixPoint1616_t optical_offset_y;
+	bool is_xtalk_value_changed; /*!< xtalk values has been updated */
+
+	/* PS parameters */
+
+	/* Calibration parameters */
+	bool is_calibrating;	/*!< active during calibration phases */
+
+	/* Range Data and stat */
+	struct range_t {
+		uint32_t	cnt;
+		uint32_t	intr;
+		int	poll_cnt;
+		uint32_t	err_cnt; /* on actual measurement */
+		uint32_t	err_tot; /* from start */
+		struct timeval start_tv;
+		struct timeval comp_tv;
+		VL53L1_RangingMeasurementData_t single_range_data;
+		VL53L1_MultiRangingData_t multi_range_data;
+		VL53L1_MultiRangingData_t tmp_range_data;
+		VL53L1_AdditionalData_t additional_data;
+		/* non mode 1 for data agregation */
+	} meas;
+
+	/* workqueue use to fire flush event */
+	uint32_t flushCount;
+	int flush_todo_counter;
+
+	/* Device parameters */
+	/* Polling thread */
+	/* Wait Queue on which the poll thread blocks */
+
+	/* Manage blocking ioctls */
+	struct list_head simple_data_reader_list;
+	struct list_head mz_data_reader_list;
+	wait_queue_head_t waiter_for_data;
+	bool is_data_valid;
+
+	/* control when using delay is acceptable */
+	bool is_delay_allowed;
+
+	/* maintain reset state */
+	int reset_state;
+
+	/* Recent interrupt status */
+	/* roi */
+	VL53L1_RoiConfig_t roi_cfg;
+
+	/* use for zone calibration / roi mismatch detection */
+	uint32_t current_roi_id;
+
+	/* Embed here since it's too huge for kernek stack */
+	struct stmvl53l1_ioctl_zone_calibration_data_t calib;
+
+	/* autonomous config */
+	uint32_t auto_pollingTimeInMs;
+	VL53L1_DetectionConfig_t auto_config;
+
+	/* Debug */
+	struct ipp_data_t ipp;
+#if IPP_LOG_TIMING
+#	define stmvl531_ipp_tim_stop(data)\
+	do_gettimeofday(&data->ipp.stop_tv)
+#	define stmvl531_ipp_tim_start(data)\
+	do_gettimeofday(&data->ipp.start_tv)
+#	define stmvl531_ipp_time(data)\
+	stmvl53l1_tv_dif(&data->ipp.start_tv, &data->ipp.stop_tv)
+#	define stmvl531_ipp_stat(data, fmt, ...)\
+	vl53l1_dbgmsg("IPPSTAT " fmt "\n", ##__VA_ARGS__)
+#else
+#	define stmvl531_ipp_tim_stop(data) (void)0
+#	define stmvl531_ipp_tim_start(data) (void)0
+#	define stmvl531_ipp_stat(...) (void)0
+#endif
+};
+
+
+/**
+ * timeval diff in us
+ *
+ * @param pstart_tv
+ * @param pstop_tv
+ */
+long stmvl53l1_tv_dif(struct timeval *pstart_tv, struct timeval *pstop_tv);
+
+
+/**
+ * The device table list table is update as device get added
+ * we do not support adding removing device mutiple time !
+ * use for clean "unload" purpose
+ */
+extern struct stmvl53l1_data *stmvl53l1_dev_table[];
+
+int stmvl53l1_setup(struct stmvl53l1_data *data);
+void stmvl53l1_cleanup(struct stmvl53l1_data *data);
+#ifdef CONFIG_PM_SLEEP
+void stmvl53l1_pm_suspend_stop(struct stmvl53l1_data *data);
+#endif
+int stmvl53l1_intr_handler(struct stmvl53l1_data *data);
+
+
+/**
+ * request ipp to abort or stop
+ *
+ * require dev work_mutex held
+ *
+ * @warning because the "waiting" work can't be aborted we must wake it up
+ * it will happen and at some later time not earlier than release of lock
+ * if after lock release we have a new request to start the race may not be
+ * handled correctly
+ *
+ * @param data the device
+ * @return 0 if no ipp got canceled, @warning this is maybe not grant we
+ * can't re-sched "dev work"  and re-run the worker back
+ */
+int stmvl53l1_ipp_stop(struct stmvl53l1_data *data);
+
+int stmvl53l1_ipp_do(struct stmvl53l1_data *data, struct ipp_work_t *work_in,
+		struct ipp_work_t *work_out);
+
+/**
+ * per device netlink init
+ * @param data
+ * @return
+ */
+int stmvl53l1_ipp_setup(struct stmvl53l1_data *data);
+/**
+ * per device ipp netlink cleaning
+ * @param data
+ * @return
+ */
+void stmvl53l1_ipp_cleanup(struct stmvl53l1_data *data);
+
+/**
+ * Module init for netlink
+ * @return 0 on success
+ */
+int stmvl53l1_ipp_init(void);
+
+/**
+ * Module exit for netlink
+ * @return 0 on success
+ */
+void stmvl53l1_ipp_exit(void);
+
+/**
+ * enable and start ipp exhange
+ * @param n_dev number of device to run on
+ * @param data  dev struct
+ * @return 0 on success
+ */
+int stmvl53l1_ipp_enable(int n_dev, struct stmvl53l1_data *data);
+
+
+/*
+ *  function pointer structs
+ */
+
+
+
+#endif /* STMVL53L1_H */
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_i2c.c b/drivers/input/misc/vl53L1/stmvl53l1_i2c.c
new file mode 100644
index 0000000000000000000000000000000000000000..bd21dc8cfa20bbfbc0628d9be9b7e3f3a2678d5e
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_i2c.c
@@ -0,0 +1,399 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file stmvl53l1_i2c.c  vl53l1 linux native i2c interface
+ *
+ */
+#include "stmvl53l1.h"
+#include "stmvl53l1-i2c.h"
+#include <linux/i2c.h>
+#include "cam_cci_ctrl_interface.h"
+
+
+#if STMVL53L1_LOG_POLL_TIMING
+/**
+ * helper to elapse time in polling
+ * @param ptv pointer to start time_val
+
+ */
+#	define poll_timing_log(ptv) \
+	vl53l1_dbgmsg("poll in %d us\n", tv_elapsed_us(ptv))
+#else
+#	define poll_timing_log(...) (void)0
+#endif
+
+#if STMVL53L1_LOG_CCI_TIMING
+/**
+ * compute elapsed time in in micro  sec based on do_gettimeofday
+ * @param tv pointer to start time_val
+ * @return time elapsed in  micro seconde
+ */
+
+/**
+ * compute elapsed time in in micro  sec based on do_gettimeofday
+ * @param tv pointer to start time_val
+ * @return time elapsed in  micro seconde
+ */
+static uint32_t tv_elapsed_us(struct timeval *tv)
+{
+	struct timeval now;
+
+	do_gettimeofday(&now);
+	return (now.tv_sec - tv->tv_sec) * 1000000 + (now.tv_usec -
+			tv->tv_usec);
+}
+
+#	define	cci_access_var struct timeval cci_log_start_tv
+#	define cci_access_start()\
+	do_gettimeofday(&cci_log_start_tv)
+#	define cci_access_over(fmt, ...) \
+	vl53l1_dbgmsg("cci_timing %d us" fmt "\n", \
+			tv_elapsed_us(&cci_log_start_tv), ##__VA_ARGS__)
+#else
+#	define cci_access_var
+#	define cci_access_start(...) (void)0
+#	define cci_access_over(...) (void)0
+#endif
+
+#ifdef STMVL53L1_DEBUG_I2C
+#	define i2c_debug(fmt, ...) vl53l1_dbgmsg(fmt, ##__VA_ARGS__)
+#else
+#	define i2c_debug(fmt, ...) (void)0
+#endif
+
+VL53L1_Error VL53L1_GetTickCount(uint32_t *ptime_ms)
+{
+	(void)ptime_ms;
+	BUG_ON(1);
+}
+
+/**
+ * compute elapsed time in in milli sec based on do_gettimeofday
+ * @param tv pointer to start time_val
+ * @return time elapsed in milli seconde
+ */
+static uint32_t tv_elapsed_ms(struct timeval *tv)
+{
+	struct timeval now;
+
+	do_gettimeofday(&now);
+	return (now.tv_sec - tv->tv_sec) * 1000 +
+		(now.tv_usec - tv->tv_usec) / 1000;
+}
+
+#ifndef USE_CAMERA_CCI
+static int cci_write(struct stmvl53l1_data *dev, int index,
+		uint8_t *data, uint16_t len)
+{
+	uint8_t buffer[STMVL53L1_MAX_CCI_XFER_SZ + 2];
+	struct i2c_msg msg;
+	struct i2c_data *i2c_client_obj = (struct i2c_data *)dev->client_object;
+	struct i2c_client *client = (struct i2c_client *)i2c_client_obj->client;
+	int rc;
+
+	cci_access_var;
+	if (len > STMVL53L1_MAX_CCI_XFER_SZ || len == 0) {
+		vl53l1_errmsg("invalid len %d\n", len);
+		return -1;
+	}
+	cci_access_start();
+	/* build up little endian index in buffer */
+	buffer[0] = (index >> 8) & 0xFF;
+	buffer[1] = (index >> 0) & 0xFF;
+	/* copy write data to buffer after index  */
+	memcpy(buffer + 2, data, len);
+	/* set i2c msg */
+	msg.addr = client->addr;
+	msg.flags = client->flags;
+	msg.buf = buffer;
+	msg.len = len + 2;
+
+	rc = i2c_transfer(client->adapter, &msg, 1);
+	if (rc != 1) {
+		vl53l1_errmsg("wr i2c_transfer err:%d, index 0x%x len %d\n",
+				rc, index, len);
+	}
+	cci_access_over("rd status %d long %d ", rc != 1, len);
+	return rc != 1;
+}
+
+static int cci_read(struct stmvl53l1_data *dev, int index,
+		uint8_t *data, uint16_t len)
+{
+	uint8_t buffer[2];
+	struct i2c_msg msg[2];
+	struct i2c_data *i2c_client_obj = (struct i2c_data *)dev->client_object;
+	struct i2c_client *client = (struct i2c_client *)i2c_client_obj->client;
+	int rc;
+
+	cci_access_var;
+	if (len > STMVL53L1_MAX_CCI_XFER_SZ || len == 0) {
+		vl53l1_errmsg("invalid len %d\n", len);
+		return -1;
+	}
+	cci_access_start();
+
+	/* build up little endian index in buffer */
+	buffer[0] = (index >> 8) & 0xFF;
+	buffer[1] = (index >> 0) & 0xFF;
+
+	msg[0].addr = client->addr;
+	msg[0].flags = client->flags;	/* Write */
+	msg[0].buf = buffer;
+	msg[0].len = 2;
+	/* read part of the i2c transaction */
+	msg[1].addr = client->addr;
+	msg[1].flags = I2C_M_RD | client->flags;
+	msg[1].buf = data;
+	msg[1].len = len;
+
+	rc = i2c_transfer(client->adapter, msg, 2);
+	if (rc != 2) {
+		pr_err("%s: i2c_transfer :%d, @%x index 0x%x len %d\n",
+				__func__, rc, client->addr, index, len);
+
+	}
+	cci_access_over(" wr len %d status %d", rc != 2, len);
+	return rc != 2;
+}
+#endif
+VL53L1_Error VL53L1_WrByte(VL53L1_DEV pdev, uint16_t index, uint8_t data)
+{
+	struct stmvl53l1_data *dev;
+    struct camera_cci_transfer ccit;
+	dev = (struct stmvl53l1_data *)container_of(pdev,
+		struct stmvl53l1_data, stdev);
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_WRITE;
+    ccit.addr = index;
+    ccit.data = &data;
+    ccit.count = 1;
+    return cam_cci_control_interface(&ccit);
+#else
+	return  cci_write(dev, index, &data, 1);
+#endif
+}
+
+VL53L1_Error VL53L1_RdByte(VL53L1_DEV pdev, uint16_t index, uint8_t *pdata)
+{
+	struct stmvl53l1_data *dev;
+    struct camera_cci_transfer ccit;
+
+	dev = (struct stmvl53l1_data *) container_of(pdev,
+		struct stmvl53l1_data, stdev);
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_READ;
+    ccit.addr = index;
+    ccit.data = pdata;
+    ccit.count = 1;
+    return cam_cci_control_interface(&ccit);
+#else
+	return  cci_read(dev, index, pdata, 1) ?
+		VL53L1_ERROR_CONTROL_INTERFACE : VL53L1_ERROR_NONE;
+#endif
+}
+
+VL53L1_Error VL53L1_WrWord(VL53L1_DEV pdev, uint16_t index, uint16_t data)
+{
+	VL53L1_Error status;
+	uint8_t buffer[2];
+
+	/* Split 16-bit word into MS and L*  stmvl53l1 FlightSense sensor */
+
+	buffer[0] = (uint8_t) (data >> 8);
+	buffer[1] = (uint8_t) (data & 0x00FF);
+	i2c_debug(" @%x d= %x  => [ %x , %x ] ", index, data, buffer[0],
+			buffer[1]);
+	status = VL53L1_WriteMulti(pdev, index, buffer, 2);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_RdWord(VL53L1_DEV pdev, uint16_t index, uint16_t *pdata)
+{
+	VL53L1_Error status;
+	uint8_t buffer[2];
+
+	status = VL53L1_ReadMulti(pdev, index, buffer, 2);
+
+	*pdata = ((uint16_t) buffer[0] << 8) + (uint16_t) buffer[1];
+
+	return status;
+}
+
+VL53L1_Error VL53L1_WrDWord(VL53L1_DEV pdev, uint16_t index, uint32_t data)
+{
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t buffer[4];
+
+	/* Split 32-bit word into MS ... LS bytes */
+	buffer[0] = (uint8_t) (data >> 24);
+	buffer[1] = (uint8_t) ((data & 0x00FF0000) >> 16);
+	buffer[2] = (uint8_t) ((data & 0x0000FF00) >> 8);
+	buffer[3] = (uint8_t) (data & 0x000000FF);
+
+	status = VL53L1_WriteMulti(pdev, index, buffer, 4);
+
+	return status;
+}
+
+VL53L1_Error VL53L1_RdDWord(VL53L1_DEV pdev, uint16_t index, uint32_t *pdata)
+{
+	VL53L1_Error status = VL53L1_ERROR_NONE;
+	uint8_t buffer[4];
+
+	status = VL53L1_ReadMulti(pdev, index, buffer, 4);
+
+	*pdata = ((uint32_t) buffer[0] << 24) + ((uint32_t) buffer[1] << 16)
+		+ ((uint32_t) buffer[2] << 8) + (uint32_t) buffer[3];
+
+	return status;
+}
+
+VL53L1_Error VL53L1_WriteMulti(VL53L1_DEV pdev, uint16_t index,
+		uint8_t *pdata, uint32_t count)
+{
+	struct stmvl53l1_data *dev;
+    struct camera_cci_transfer ccit;
+
+	dev = (struct stmvl53l1_data *) container_of(pdev,
+			struct stmvl53l1_data, stdev);
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_WRITE;
+    ccit.addr = index;
+    ccit.data = pdata;
+    ccit.count = count;
+    return cam_cci_control_interface(&ccit);
+#else
+	return cci_write(dev, index, pdata, count) ?
+			VL53L1_ERROR_CONTROL_INTERFACE : VL53L1_ERROR_NONE;
+#endif
+}
+
+VL53L1_Error VL53L1_ReadMulti(VL53L1_DEV pdev, uint16_t index,
+		uint8_t *pdata, uint32_t count)
+{
+	struct stmvl53l1_data *dev;
+    struct camera_cci_transfer ccit;
+
+	dev = (struct stmvl53l1_data *) container_of(pdev,
+			struct stmvl53l1_data, stdev);
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_READ;
+    ccit.addr = index;
+    ccit.data = pdata;
+    ccit.count = count;
+    return cam_cci_control_interface(&ccit);
+#else
+	return cci_read(dev, index, pdata, count) ?
+			VL53L1_ERROR_CONTROL_INTERFACE : VL53L1_ERROR_NONE;
+#endif
+}
+
+static int is_time_over(struct timeval *tv, uint32_t msec)
+{
+	return tv_elapsed_ms(tv) >= msec;
+}
+
+VL53L1_Error VL53L1_WaitValueMaskEx(VL53L1_DEV pdev,
+		uint32_t timeout_ms,
+		uint16_t index,
+		uint8_t value,
+		uint8_t mask, uint32_t poll_delay_ms)
+{
+	struct timeval start_tv;
+	struct stmvl53l1_data *dev;
+	int rc, time_over;
+	uint8_t rd_val;
+    struct camera_cci_transfer ccit;
+
+	dev = (struct stmvl53l1_data *) container_of(pdev,
+				struct stmvl53l1_data, stdev);
+
+	do_gettimeofday(&start_tv);
+	do {
+#ifdef USE_CAMERA_CCI
+        memset(&ccit,0,sizeof(ccit));
+        ccit.cmd = CAMERA_CCI_READ;
+        ccit.addr = index;
+        ccit.data = &rd_val;
+        ccit.count = 1;
+        rc = cam_cci_control_interface(&ccit);
+#else
+		rc = cci_read(dev, index, &rd_val, 1);
+#endif
+		if (rc)
+			return VL53L1_ERROR_CONTROL_INTERFACE;
+		if ((rd_val & mask) == value) {
+			poll_timing_log(&start_tv);
+			return VL53L1_ERROR_NONE;
+		}
+		vl53l1_dbgmsg("poll @%x %x & %d != %x", index,
+				rd_val, mask, value);
+		time_over = is_time_over(&start_tv, timeout_ms);
+		if (!time_over)
+			msleep(poll_delay_ms);
+	} while (!time_over);
+	vl53l1_errmsg("time over %d ms", timeout_ms);
+	return VL53L1_ERROR_TIME_OUT;
+}
+
+VL53L1_Error VL53L1_WaitUs(VL53L1_DEV pdev, int32_t wait_us)
+{
+	struct stmvl53l1_data *data;
+
+	data = (struct stmvl53l1_data *)container_of(pdev,
+			struct stmvl53l1_data,
+			stdev);
+
+	if (!data->is_delay_allowed)
+		return VL53L1_ERROR_PLATFORM_SPECIFIC_START;
+
+	/* follow Documentation/timers/timers-howto.txt recommendations */
+	if (wait_us < 10)
+		udelay(wait_us);
+	else if (wait_us < 20000)
+		usleep_range(wait_us, wait_us + 1);
+	else
+		msleep(wait_us / 1000);
+
+	return VL53L1_ERROR_NONE;
+}
+
+VL53L1_Error VL53L1_WaitMs(VL53L1_DEV pdev, int32_t wait_ms)
+{
+	return VL53L1_WaitUs(pdev, wait_ms * 1000);
+}
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_if.h b/drivers/input/misc/vl53L1/stmvl53l1_if.h
new file mode 100644
index 0000000000000000000000000000000000000000..1e3fe358625509f60dbf6518489414a95ccd7433
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_if.h
@@ -0,0 +1,671 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+/**
+ *  @file stmvl53l1_if.h  vl53l1 kernel driver user interface
+ *
+ * @note to use this header in a user space application it requires
+ *  all st bare/ll driver platform wrapper files (for data struct def)
+ *  this files (types etc ..) shall be same or compliant with bar driver version
+ *  used in the kernel module
+ */
+
+#ifndef STMVL53L1_IF_H
+#define STMVL53L1_IF_H
+
+
+#include "vl53l1_def.h"
+/**
+ * @addtogroup vl53l1_ioctl
+ * @{
+ */
+
+/**
+ * misc device name for ioctl device
+ *
+ * for mutli instance all device 2nd and next instance are basic name +"1"+"2"
+ * @li stmvl53l1_ranging
+ * @li stmvl53l1_ranging1
+ * @li stmvl53l1_ranging2
+ */
+#define VL53L1_MISC_DEV_NAME		"stmvl53l1_ranging"
+/**
+ * register data use for simple/single ranging data @ref VL53L1_IOCTL_GETDATAS
+ *
+ * @warning this definition is subject to change !
+ */
+#define stmvl531_range_data_t VL53L1_RangingMeasurementData_t
+
+/**
+ * parameter name in @ref stmvl53l1_parameter when using
+ * @ref VL53L1_IOCTL_PARAMETER
+ */
+enum __stmv53l1_parameter_name_e {
+	VL53L1_XTALKENABLE_PAR = 2,
+	/*!< VL53L1_XTALKENABLE_PAR enable/disable crosstalk compensation\n
+	 * valid value :
+	 * @li 0 disable crosstalk compensation
+	 * @li 1 enable crosstalk compensation
+	 *
+	 * @warning mode can only be set while not ranging
+	 */
+
+	VL53L1_DEVICEMODE_PAR = 6,
+	/*!< DEVICEMODE_PAR set ranging mode  \n
+	 * valid mode value :
+	 * @li 1 @a VL53L1_PRESETMODE_RANGING default ranging
+	 * @li 2 @a VL53L1_PRESETMODE_MULTIZONES_SCANNING multiple zone
+	 * @li 3 @a VL53L1_PRESETMODE_AUTONOMOUS autonomous mode
+	 * @li 4 @a VL53L1_PRESETMODE_LITE_RANGING low mips ranging mode
+	 * @li 8 @a VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS low power autonomous
+	 * mode
+	 *
+	 * @warning mode can only be set while not ranging
+	 */
+
+	VL53L1_POLLDELAY_PAR = 10,
+	/*!< set the polling delay (msec)\n
+	 *
+	 * @note apply only when operates in polling mode  as no effect
+	 * otherwise
+	 */
+	VL53L1_TIMINGBUDGET_PAR = 11,
+	/*!< VL53L1_TIMINGBUDGET_PAR
+	 * @ref stmvl53l1_parameter.value field is timing budget in micro second
+	 */
+
+	VL53L1_DISTANCEMODE_PAR = 12,
+	/*!< VL53L1_DISTANCEMODE_PAR
+	 * valid distance mode value :
+	 * @li 1 @a VL53L1_DISTANCEMODE_SHORT
+	 * @li 2 @a VL53L1_DISTANCEMODE_MEDIUM
+	 * @li 3 @a VL53L1_DISTANCEMODE_LONG
+	 *
+	 * @warning distance mode can only be set while not ranging
+	 */
+
+	VL53L1_OUTPUTMODE_PAR = 13,
+	/*!< VL53L1_OUTPUTMODE_PAR
+	 * valid output mode value :
+	 * @li 1 @a VL53L1_OUTPUTMODE_NEAREST
+	 * @li 2 @a VL53L1_OUTPUTMODE_STRONGEST
+	 *
+	 * @warning distance mode can only be set while not ranging
+	 */
+
+	VL53L1_FORCEDEVICEONEN_PAR = 14,
+	/*!< VL53L1_FORCEDEVICEONEN_PAR
+	 * This parameter will control if device is put under reset when
+	 * stopped.
+	 * valid force device on value :
+	 * @li 0 feature is disable. Device is put under reset when stopped.
+	 * @li 1 feature is enable. Device is not put under reset when stopped.
+	 */
+
+	VL53L1_LASTERROR_PAR = 15,
+	/*!< VL53L1_LASTERROR_PAR
+	 * This is a read only parameter. It will return last device internal
+	 * error. It's valid only after an ioctl/sysfs return an -EIO error.
+	 */
+
+	VL53L1_OFFSETCORRECTIONMODE_PAR = 16,
+	/*!< VL53L1_OFFSETCORRECTIONMODE_PAR
+	 * This parameter will define which mode to use for the offset
+	 * correction.
+	 * valid force device on value :
+	 * @li 1 @a VL53L1_OFFSETCORRECTIONMODE_STANDARD
+	 * @li 2 @a VL53L1_OFFSETCORRECTIONMODE_PERZONE
+	 *
+	 * @warning offset correction mode can only be set while not ranging
+	 */
+
+	VL53L1_OPTICALCENTER_PAR = 17,
+	/*!< VL53L1_OPTICALCENTER_PAR
+	 * This is a read only parameter. It will return optical center issued
+	 * from the nvm set at FTM stage. value will contain X position of
+	 * center. value2 will contain Y position of center.
+	 * Return values have FixPoint1616_t type.
+	 */
+
+	VL53L1_DMAXREFLECTANCE_PAR = 18,
+	/*!< VL53L1_DMAXREFLECTANCE_PAR
+	 * This parameter will define target reflectance @ 940nm used to
+	 * calculate the ambient DMAX. Parameter is of type FixPoint1616_t.
+	 *
+	 * @warning dmax reflectance can only be be set while not ranging
+	 */
+
+	VL53L1_DMAXMODE_PAR = 19,
+	/*!< VL53L1_DMAXMODE_PAR
+	 * This parameter will select Dmax mode.
+	 * valid Dmax mode value :
+	 * @li 1 @a VL53L1_DMAXMODE_FMT_CAL_DATA
+	 * @li 2 @a VL53L1_DMAXMODE_CUSTCAL_DATA
+	 * @li 3 @a VL53L1_DMAXMODE_PER_ZONE_CAL_DATA
+	 *
+	 * @warning Dmax mode can only be set while not ranging
+	 */
+
+	VL53L1_TUNING_PAR = 20,
+	/*!< VL53L1_DMAXMODE_PAR
+	 * This parameter is a write only parameter. It will allow to provide
+	 * low level layer with a configuration parameter.
+	 * value will be use as a key parameter.
+	 * value2 will be use as value parameter.
+	 *
+	 * @warning those configuration parameter settings are only allowed
+	 * before device is start once.
+	 */
+
+	VL53L1_SMUDGECORRECTIONMODE_PAR = 21,
+	/*!< VL53L1_SMUDGECORRECTIONMODE_PAR
+	 * This parameter will control if smudge correction is enable and how
+	 * crosstalk values are updated.
+	 * @li 0 @a VL53L1_SMUDGE_CORRECTION_NONE
+	 * @li 1 @a VL53L1_SMUDGE_CORRECTION_CONTINUOUS
+	 * @li 2 @a VL53L1_SMUDGE_CORRECTION_SINGLE
+	 * @li 3 @a VL53L1_SMUDGE_CORRECTION_DEBUG
+	 */
+
+	VL53L1_ISXTALKVALUECHANGED_PAR = 22,
+	/*!< VL53L1_ISXTALKCHANGED_PAR
+	 * This is a read only parameter. It will return if Xtalk value has
+	 * been updated while ranging. This parameter is reset each time device
+	 * start to range.
+	 * @li 0 Xtalk values has not been changed.
+	 * @li 1 Xtalk values has been changed.
+	 */
+};
+#define stmv53l1_parameter_name_e enum __stmv53l1_parameter_name_e
+
+/**
+ * parameter structure use in @ref VL53L1_IOCTL_PARAMETER
+ */
+struct stmvl53l1_parameter {
+	uint32_t is_read;	/*!< [in] 1: Get 0: Set*/
+	/*!< [in] parameter to set/get
+	 * see @ref stmv53l1_parameter_name_e
+	 */
+	stmv53l1_parameter_name_e name;
+	int32_t value;		/*!< [in/out] value to set /get */
+	int32_t value2;		/*!< [in/out] optional 2nd value */
+	int32_t status;		/*!< [out] status of the operation */
+};
+
+
+/**
+ * roi structure use as  @ref VL53L1_IOCTL_ROI arg
+ *
+ * see @ref stmvl53l1_roi_full_t for easy to use type variable declaration
+ * required
+ */
+struct stmvl53l1_roi_t {
+	int32_t		is_read;
+	/*!<  specify roi transfer direction \n
+	 * @li 0 to get roi
+	 * @li !0 to set roi
+	 */
+	/*! roi data and count type use in @ VL53L1_IOCTL_ROI */
+	struct roi_cfg_t {
+		uint8_t NumberOfRoi;
+		/*!< [in/out] Number of Rois to set/get
+		 *
+		 * on set :\n
+		 * [in] number of roi to set
+		 * @note 0 set can be used to return to device default roi usage
+		 *
+		 * on get :\n
+		 * [in] max number provided\n
+		 * [out] number of ROI  copied back to user\n
+		 * @warning 0 will not return any roi datas!
+		 */
+		VL53L1_UserRoi_t    UserRois[1];
+		/*!< roi data array length  definition is 1 but
+		 * NumberOfRoi+ FirstRoiToScan in array are required
+		 * and will be effectively copy to/from user space
+		 *
+		 * @sa stmvl53l1_roi_full_t
+		 */
+	} roi_cfg /*!  [in/out] roi data and count */;
+};
+
+/**
+ * full roi struct use in @ref VL53L1_IOCTL_ROI arg
+ *
+ * this definition make easier variable declaration with the max roi storage
+ * capabilities.
+ *
+ * @sa stmvl53l1_roi_t for  field details
+ */
+struct stmvl53l1_roi_full_t {
+	int32_t		is_read;
+	/*!<  specify roi transfer direction \n
+	 * @li 0 to get roi
+	 * @li !0 to set roi
+	 */
+	VL53L1_RoiConfig_t roi_cfg;
+	/*!< roi data array of max length but only requested copy to/from user
+	 * space effectively used
+	 * see @a stmvl53l1_roi_t::roi_cfg for  details
+	 */
+};
+
+/**
+ * parameter structure use in @ref VL53L1_IOCTL_CALIBRATION_DATA
+ */
+struct stmvl53l1_ioctl_calibration_data_t {
+	int32_t is_read;	/*!< [in] 1: Get 0: Set*/
+	VL53L1_CalibrationData_t data;
+	/*!< [in/out] data to set /get. Caller
+	 * should consider this structure as an opaque one
+	 */
+};
+
+/**
+ * Opaque structure use to hold content of zone offset calibration result.
+ */
+#define stmvl531_zone_calibration_data_t \
+	struct _stmvl531_zone_calibration_data_t
+
+struct _stmvl531_zone_calibration_data_t {
+	uint32_t id;
+	VL53L1_ZoneCalibrationData_t data;
+};
+
+/**
+ * parameter structure use in @ref VL53L1_IOCTL_ZONE_CALIBRATION_DATA
+ */
+struct stmvl53l1_ioctl_zone_calibration_data_t {
+	int32_t is_read;	/*!< [in] 1: Get 0: Set*/
+	stmvl531_zone_calibration_data_t data;
+	/*!< [in/out] data to set /get. Caller
+	 * should consider this structure as an opaque one
+	 */
+};
+
+/** Select reference spad calibration in @ref VL53L1_IOCTL_PERFORM_CALIBRATION.
+ *
+ * param1, param2 and param3 not use
+ */
+#define VL53L1_CALIBRATION_REF_SPAD		0
+
+/** Select crosstalk calibration in @ref VL53L1_IOCTL_PERFORM_CALIBRATION.
+ *
+ * param1 is calibration method. param2 and param3 not use.
+ * @li VL53L1_XTALKCALIBRATIONMODE_NO_TARGET
+ * @li VL53L1_XTALKCALIBRATIONMODE_SINGLE_TARGET
+ * @li VL53L1_XTALKCALIBRATIONMODE_FULL_ROI
+ */
+#define VL53L1_CALIBRATION_CROSSTALK		1
+
+/** Select offset calibration  @ref VL53L1_IOCTL_PERFORM_CALIBRATION.
+ * param1 is offset calibration mode. Parameter is either:
+ *        - VL53L1_OFFSETCALIBRATIONMODE_STANDARD
+ *        - VL53L1_OFFSETCALIBRATIONMODE_PRERANGE_ONLY
+ *        - VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE (deprecated)
+ * param2 is target distance in mm.
+ * param3 is target reflectance in percent. Parameter is of type FixPoint1616_t.
+ *
+ * Note that VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE usage is deprecated. Per
+ * zone offset calibration should use VL53L1_CALIBRATION_OFFSET_PER_ZONE
+ * instead.
+ */
+#define VL53L1_CALIBRATION_OFFSET		2
+
+/** Select offset calibration per zone @ref VL53L1_IOCTL_PERFORM_CALIBRATION.
+ * param1 is offset calibration mode. Parameter is:
+ *        - VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE
+ * param2 is target distance in mm.
+ * param3 is target reflectance in percent. Parameter is of type FixPoint1616_t.
+ *
+ * Note that region of interest should be defined by a prior call to
+ * VL53L1_IOCTL_ROI before calling VL53L1_IOCTL_PERFORM_CALIBRATION /
+ * VL53L1_CALIBRATION_OFFSET combinaison.
+ */
+#define VL53L1_CALIBRATION_OFFSET_PER_ZONE	3
+
+/** Select simple offset calibration @ref VL53L1_IOCTL_PERFORM_CALIBRATION.
+ * param1 is target distance in mm.
+ * param2 and param3 are not used
+ */
+#define VL53L1_CALIBRATION_OFFSET_SIMPLE	4
+
+/**
+ * parameter structure use in @ref VL53L1_IOCTL_PERFORM_CALIBRATION
+ */
+struct stmvl53l1_ioctl_perform_calibration_t {
+	uint32_t calibration_type;
+	/*!< [in] select which calibration to do :
+	 * @li @ref VL53L1_CALIBRATION_REF_SPAD
+	 * @li @ref VL53L1_CALIBRATION_CROSSTALK
+	 * @li @ref VL53L1_CALIBRATION_OFFSET
+	 * @li @ref VL53L1_CALIBRATION_OFFSET_SIMPLE
+	 * @li @ref VL53L1_CALIBRATION_OFFSET_PER_ZONE
+	 */
+	uint32_t param1;
+	/*!< [in] first param. Usage depends on calibration_type */
+	uint32_t param2;
+	/*!< [in] second param. Usage depends on calibration_type */
+	uint32_t param3;
+	/*!< [in] third param. Usage depends on calibration_type */
+};
+
+/**
+ * parameter structure use in @ref VL53L1_IOCTL_AUTONOMOUS_CONFIG
+ */
+struct stmvl53l1_autonomous_config_t {
+	int32_t is_read;
+	/*!< [in] 1: Get 0: Set*/
+	uint32_t pollingTimeInMs;
+	/*!< [in/out] interval between two measure in ms */
+	VL53L1_DetectionConfig_t config;
+	/*!< [int/out] autonomous mode configuration structure */
+};
+
+/*
+ * IOCTL definitions
+ */
+
+
+/**
+ * Start ranging (no argument)
+ *
+ * @note  sysfs and ioctl control are assumed mutual exclusive use
+ * control from ioctl execute with no consideration of sysfs path.
+ *
+ * @return :
+ *	@li 0 on success
+ *	@li -EBUSY if already started
+ *	@li -ENXIO failed to change i2c address change after reset release
+ *	@li -EIO. Read last_error to get device error code
+ *	@li -ENODEV. Device has been removed.
+ *
+ * example user land  :
+ @code
+ int smtvl53l1_start(int fd){error
+	int rc;
+	rc= ioctl(fd, VL53L1_IOCTL_START,NULL);
+	if( rc ){
+		if( errno == EBUSY){
+			//the device is already started
+			ioctl_warn("already started");
+			return EBUSY;
+		}
+	}
+	if( rc ){
+		ioctl_error("%d %s", rc,strerror(errno));
+	}
+	return rc;
+}
+ @endcode
+*/
+
+#define VL53L1_IOCTL_START			_IO('p', 0x01)
+
+/**
+ * stop ranging (no argument)
+
+ * @note  sysfs and ioctl control are assumed mutual exclusive use
+ * control from ioctl execute action with no consideration of sysfs path.
+ *
+ * @return
+ * @li 0 on success
+ * @li -EBUSY if it was already
+ * @li -EIO. Read last_error to get device error code
+ * @li -ENODEV. Device has been removed.
+ *
+ * c example userland :
+ @code
+int smtvl53l1_stop(int fd){
+	int rc;
+	rc= ioctl(fd, VL53L1_IOCTL_STOP,NULL);
+	if( rc ){
+		if( errno == EBUSY ){
+			ioctl_warn("already stopped");
+			return errno;
+		}
+		ioctl_error("%d %s", rc,strerror(errno));
+	}
+	return rc;
+}
+@endcode
+ */
+#define VL53L1_IOCTL_STOP			_IO('p', 0x05)
+
+/**
+ * get single ranging data @sa for multi zone/objet
+ *
+ * retrieve the last range data available form the device
+ *
+ * @param in/out data struct ptr of type @ref stmvl531_range_data_t
+ * it may come in but is out as of now
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copied
+ * @li -ENODEV. Device has been removed.
+ *
+ * @warning this ioctl will not wait for a new range sample acquisition
+ * it will return what available at time it get called . Hence same data maybe
+ * returned many time when doing fast polling.\n
+ * End user must inspect the data structure (time stamp etc )to find about it\n
+ * Despite it's non "waiting" nature this ioctl may still block/sleep shortly
+ * to ensure race free usage acquiring mutex and/or locks.
+ */
+#define VL53L1_IOCTL_GETDATAS \
+	_IOWR('p', 0x0b, stmvl531_range_data_t)
+
+/**
+ * set or get parameter
+ *
+ * @param parameter in/out  @ref stmvl53l1_parameter
+ * @sa stmv53l1_parameter_name_e
+ *
+ * for get if ioctl fail do not check for out params it is not valid
+ * for set theirs not copy back only see ioctl status, errno to get error case
+ *
+ * @return 0 on success else o, error check errno
+ * @li -ENODEV. Device has been removed.
+ *
+ * @note a set parameter may not be absorbed straight aways !
+ */
+#define VL53L1_IOCTL_PARAMETER \
+	_IOWR('p', 0x0d, struct stmvl53l1_parameter)
+
+
+/**
+ * set/get roi
+ *
+ * shall only be use while device is stopped (EBUSY error otherwise)
+ * setting 0 rois stand for "disable  user define roi usage, use device default"
+ *
+ * @param roi_cfg [in/out] type @ref stmvl53l1_roi_t and
+ * @ref stmvl53l1_roi_full_t
+ * @note when getting roi the returned roi cnt is set to available number
+ * of roi in driver but  at most requested number or available one
+ * will be set in returned structure
+ * @warning the coordinate system is not usual image x,y (y down)but traditional
+ * ecludian x,y (y up)
+ *
+ * @warning once defined the user roi is kept alive until unset by user .
+ * User shall update roi when required (mode change etc ..)\n
+ * To return to default unset roi by setting none, device will return to default
+ * at next start
+ *
+ * @note roi validity is only checked at start ranging , as such invalid roi set
+ * can make start to fail
+ *
+ * @return 0 on success , see errno for error detail
+ *  @li EBUSY when trying to set roi while ranging
+ *  @li ENODEV never device get started and trying to get more rois than set
+ *  @li other errno code could be ll driver specific
+ */
+#define VL53L1_IOCTL_ROI\
+	_IOWR('p', 0x0e, struct stmvl53l1_roi_t)
+
+/**
+ * Get multi object/zone ranging data
+ *
+ * this call is non blocking and will return what available internally
+ * in all case (veen error)
+ *
+ * @param [out] multi zone range @ref VL53L1_MultiRangingData_t always update
+ * but -EFAULT error case
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copyed
+ * @li -ENOEXEC active mode is not mutli-zone
+ * @li -ENODEV device is not ranging or device has been removed.
+ * as in that case MZ data may not be fully valid
+ */
+#define VL53L1_IOCTL_MZ_DATA\
+	_IOR('p', 0x0f, VL53L1_MultiRangingData_t)
+
+/**
+ * get single ranging data @sa for multi zone/objet
+ *
+ * this call is equivalent to VL53L1_IOCTL_GETDATAS but will block until
+ * new data are available since previous call.
+ *
+ * @param in/out data struct ptr of type @ref stmvl531_range_data_t
+ * it may come in but is out as of now
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copied
+ * @li -ENODEV device is not ranging or device has been removed.
+ * @li -ERESTARTSYS interrupt while sleeping.
+ */
+#define VL53L1_IOCTL_GETDATAS_BLOCKING\
+	_IOWR('p', 0x10, stmvl531_range_data_t)
+
+/**
+ * Get multi object/zone ranging data
+ *
+ * this call is equivalent to VL53L1_IOCTL_MZ_DATA but will block until
+ * new data are available since previous call.
+ *
+ * @param [out] multi zone range @ref VL53L1_MultiRangingData_t always update
+ * but -EFAULT error case
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copyed
+ * @li -ENOEXEC active mode is not mutli-zone
+ * @li -ENODEV device is not ranging or device has been removed.
+ * @li -ERESTARTSYS interrupt while sleeping.
+ * as in that case MZ data may not be fully valid
+ */
+#define VL53L1_IOCTL_MZ_DATA_BLOCKING\
+	_IOR('p', 0x11, VL53L1_MultiRangingData_t)
+
+/**
+ * Get / set calibration data
+ *
+ * this call allow client to either read calibration data after calibration
+ * has been performed to store them in the host filesystem or push calibration
+ * data before ranging at each start-up.
+ *
+ * @param [in/out] data struct ptr of type
+ * @ref stmvl53l1_ioctl_calibration_data_t. Caller should consider it as an
+ * opaque structure.
+ *
+ * use this after either VL53L1_CALIBRATION_REF_SPAD,
+ * VL53L1_CALIBRATION_CROSSTALK or VL53L1_CALIBRATION_OFFSET.
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copied
+ * @li -EBUSY when trying to set calibration data while ranging
+ * @li -EIO. Read last_error to get device error code
+ * @li -ENODEV. Device has been removed.
+ */
+#define VL53L1_IOCTL_CALIBRATION_DATA\
+	_IOWR('p', 0x12, struct stmvl53l1_ioctl_calibration_data_t)
+
+/**
+ * Get / set zone calibration data
+ *
+ * this call allow client to either read zone calibration data after calibration
+ * has been performed to store them in the host filesystem or push zone
+ * calibration data before ranging at each start-up.
+ *
+ * use this after VL53L1_CALIBRATION_OFFSET_PER_ZONE calibration.
+ *
+ * @param [in/out] data struct ptr of type
+ * @ref stmvl53l1_ioctl_zone_calibration_data_t. Caller should consider it as an
+ * opaque structure.
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copied
+ * @li -EBUSY when trying to set calibration data while ranging
+ * @li -EIO. Read last_error to get device error code
+ * @li -ENODEV. Device has been removed.
+ */
+#define VL53L1_IOCTL_ZONE_CALIBRATION_DATA\
+	_IOWR('p', 0x12, struct stmvl53l1_ioctl_zone_calibration_data_t)
+
+/**
+ * perform calibration squence according to calibration_type
+ *
+ * this call is attended to be used during factory calibration. You select
+ * calibration to issue using calibration_type.
+ *
+ * @param [in] data struct ptr of type
+ * @ref stmvl53l1_ioctl_perform_calibration_t.
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copied
+ * @li -EBUSY when trying to perform calibration data while ranging
+ * @li -EIO. Read last_error to get device error code
+ * @li -ENODEV. Device has been removed.
+ */
+#define VL53L1_IOCTL_PERFORM_CALIBRATION\
+	_IOW('p', 0x13, struct stmvl53l1_ioctl_perform_calibration_t)
+
+/**
+ * set/get configure autonomous mode parameters
+ *
+ * Allow to get or set autonomous configuration. Change it only when device
+ * is stopped otherwise you will receive an EBUSY error.
+ *
+ * @param stmvl53l1_autonomous_config_t [in/out]
+ *
+ * @note autonomous config validity is only checked at start ranging , as such
+ * invalid autonomous config set can make start to fail.
+ *
+ * @return 0 on success , see errno for error detail
+ * @li -EFAULT failed to copy from/to configuration.
+ * @li -EBUSY when trying to change configuration while ranging.
+ * @li -ENODEV. Device has been removed.
+ */
+#define VL53L1_IOCTL_AUTONOMOUS_CONFIG\
+	_IOWR('p', 0x14, struct stmvl53l1_autonomous_config_t)
+
+/** @} */ /* ioctl group */
+#endif /* STMVL53L1_IF_H */
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_internal_if.h b/drivers/input/misc/vl53L1/stmvl53l1_internal_if.h
new file mode 100644
index 0000000000000000000000000000000000000000..5a4c004c1ffdf930b8d75eb2c37854fd49ecadb2
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_internal_if.h
@@ -0,0 +1,120 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+#ifndef STMVL53L1_INTERNAL_IF_H
+#define STMVL53L1_INTERNAL_IF_H
+
+#include "vl53l1_def.h"
+
+/* interface definition move in this file is not supposed to be use by a normal
+ * client. It's only here for internal testing purpose.
+ */
+
+/* structure and ioctl that allow raw access to vl53l1 register */
+struct stmvl53l1_register {
+	uint32_t is_read;   /*!< type of the access 1: read 0: write*/
+	uint32_t index;     /*!< register index */
+	uint32_t cnt;       /*!< register size shall be 1 to n */
+	int32_t status;     /*!< operation status 0 ok else error */
+
+	union reg_data_t {
+		uint8_t b;  /*!< single data byte*/
+		uint16_t w; /*!< single data word (16 bits)*/
+		uint32_t dw;    /*!< single data dword (32 bits)*/
+		/*!< any size byte array
+		 * @note only effectively used array size is needed and will be
+		 * set/used another possible register definition is
+		 * @ref stmvl53l1_register_flexi
+		 */
+		uint8_t bytes[256];
+		/*!< data only *@warning device is big endian and
+		 * no endianess adaptation is performed by
+		 * @ref VL53L1_IOCTL_REGISTER
+		 */
+	} data;
+};
+
+struct stmvl53l1_register_flexi {
+	uint32_t is_read;   /*!< [in] type of the access 1: read 0: write*/
+	uint32_t index;     /*!< [in] register index */
+	uint32_t cnt;       /*!< [în] register size shall be 1 to n */
+	int32_t status;     /*!< [out] operation status 0 ok else error */
+	uint8_t data[];     /*!< [in/out] flexible array size data */
+	/*!< data only *@warning device is big endian and
+	 * no endianess adaptation is performed by @ref VL53L1_IOCTL_REGISTER
+	 */
+};
+
+#define VL53L1_IOCTL_REGISTER   _IOWR('p', 0x0c, struct stmvl53l1_register)
+
+struct stmvl53l1_data_with_additional {
+	VL53L1_MultiRangingData_t data;
+	VL53L1_AdditionalData_t additional_data;
+};
+
+/**
+ * Get multi object/zone ranging data with additional data for debug
+ *
+ * this call is non blocking and will return what available internally
+ * in all case (veen error)
+ *
+ * @param [out] multi zone range @ref VL53L1_MultiRangingData_t always update
+ * but -EFAULT error case
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copyed
+ * @li -ENOEXEC active mode is not mutli-zone
+ * @li -ENODEV device is not ranging or device has been removed.
+ * as in that case MZ data may not be fully valid
+ */
+#define VL53L1_IOCTL_MZ_DATA_ADDITIONAL\
+			_IOR('p', 0x15, struct stmvl53l1_data_with_additional)
+
+/**
+ * Get multi object/zone ranging data
+ *
+ * this call is equivalent to VL53L1_IOCTL_MZ_DATA_ADDITIONAL but will block
+ * until new data are available since previous call.
+ *
+ * @param [out] multi zone range @ref VL53L1_MultiRangingData_t always update
+ * but -EFAULT error case
+ *
+ * @return 0 on success else o, error check errno
+ * @li -EFAULT fault in cpy to f/m user out range data not copyed
+ * @li -ENOEXEC active mode is not mutli-zone
+ * @li -ENODEV device is not ranging or device has been removed.
+ * @li -ERESTARTSYS interrupt while sleeping.
+ * as in that case MZ data may not be fully valid
+ */
+#define VL53L1_IOCTL_MZ_DATA_ADDITIONAL_BLOCKING\
+			_IOR('p', 0x16, struct stmvl53l1_data_with_additional)
+
+#endif
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_ipp.h b/drivers/input/misc/vl53L1/stmvl53l1_ipp.h
new file mode 100644
index 0000000000000000000000000000000000000000..31e75a196debba451f083318150fe30392e2ddd1
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_ipp.h
@@ -0,0 +1,386 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file stmvl53l1_ipp.h
+ *
+ * helper to serialize de-serialize data in ipp exchange  between user/kernel
+ *
+ * @date Sep 2, 2016
+ * @author imaging
+ */
+
+#ifndef _STMVL53L1_IPP_H_
+#define _STMVL53L1_IPP_H_
+
+#include "vl53l1_types.h"
+
+
+/** @ingroup ipp_dev
+ * @{
+ */
+
+/**
+ * @defgroup ipp_serialize ST IPP serialization helper
+ *
+ * to use the dump help you lust define first a few extra "specific"
+ *
+ * @li IPP_PRINT(fmt,..) with typical printf/printk interface
+ */
+ /** @{ */
+/**
+ * generic data type to serialized scalar and offset for pointer
+ *
+ * serialized data can be seen as a first array of n ipp_art_t
+ * where each input are arg value for scaler type
+ * and an offset with respect to the ipp_arg base array where the data
+ *
+ * @note if all ipp argument can fit on 32 bit  then ipp_arg_t is best set as
+ * a 32 bit base type '(i e uint32_t) to save space
+ * on 64 bit cpu it can remain 64 bit type to get better alignment
+ */
+typedef uint64_t ipp_arg_t;
+
+/**
+ * set to the cpu structure alignment and packing constrain
+ *
+ * all serialized argument passed by pointer will be stored with
+ * this memory align constrain
+ *
+ *
+ * @note if target cpu is ok to access unaligned data or less constrain ie 64
+ * bit data align 32 are ok then it can be set to 4 to save space in data
+ * packing and copy\n
+ * We may be over constraining in many cases as a struct is only required to
+ * be aligned on i'st biggest item size
+ *
+ * @warning it must be a 2 power of 2 (& operation instead of mudulo used in
+ * align calculation)
+ * @warning using 8 byte constrain require that the @a ipp_arg_t is already
+ * aligned on that constrain
+ */
+#define IPP_ALIGN_REQ   8
+
+/**
+ * set x to it's nearest aligned offset (not that 0 is fine as a valid offset
+ * than will not be up aligned to next align chunk  )
+ */
+#define IPP_ALIGN_OFFSET(x)  (((x)+(IPP_ALIGN_REQ-1)) & (~(IPP_ALIGN_REQ-1)))
+
+/**
+ * declare variable needed for ipp serialization
+ */
+#define IPP_SERIALIZE_VAR	int ipp_offset
+/**
+ * Put in function start to init the serialization coding
+ *
+ * @param ipp_args buffer for data serialization
+ * @param n_args is the total number of argument scalar and ptr to serialized
+ *  dot not count out only arg that will be returned
+ *
+ * it define local var "ipp_offset" used to accumulate all input args that must
+ * be serialize. It reserve header room in the buffer to place for scalar args
+ * and offset for args ptr copy
+ *
+ * args pass by pointer must be serialized by @ref IPP_SET_ARG_PTR in order they
+ * are declare\n
+ * scalar args can be serialized in any order with @ref IPP_SET_ARG
+ *
+ * scalar args that can't be cast to basic @ref ipp_arg_t shall be serialized
+ * Manually or using a macro similar to ptr that can be pass by copy
+ *
+ *@note @ref IPP_SERIALIZE_VAR must be use first
+ * @code
+ * int ipp_to _ser(int arg0, struct st_t *pdata1){
+ * char *local var;
+ * ipp_arg_t args[256];
+ *  IPP_SERIALIZE_START(2);
+ *  IPP_SET_ARG(args, 0, arg0);
+ *  IPP_SET_ARG_PTR(args, 1, pdata);
+ *  do_one_ipp(args);
+ * }
+ * @endcode
+ *
+ */
+#define IPP_SERIALIZE_START(ipp_args, n_args)\
+	(ipp_offset = IPP_ALIGN_OFFSET((char *)(&ipp_args[n_args]) - \
+	(char *)ipp_args))
+
+/**
+ * @brief Serialize scalar argument
+ *
+ * serialized arg number n into ipp_args\n
+ * can be used in any order
+ *
+ * @param ipp_args the args buffer
+ * @param n 0 base arg number
+ * @param v the scalar argument variable
+ * @warning usable only for scalar type that can be copy on a ipp_arg_t
+ */
+#define IPP_SET_ARG(ipp_args, n, v) memcpy(&ipp_args[n], &v, sizeof(v))
+
+/**
+ * @brief  Serialize an arg passed by pointer
+ *
+ * @param  ipp_args the arg ptr array
+ * @param  n the arg number to serialize
+ * @param  pdata  argument it must be a type like struct x_t *  int [n] etc ...
+ *  that size is given by size of and and be copied by a single memcpy
+ */
+#define IPP_SET_ARG_PTR(ipp_args, n, pdata)\
+	do {\
+		ipp_args[n] = ipp_offset;\
+		memcpy(((char *)ipp_args) + ipp_offset, pdata, sizeof(*pdata));\
+		ipp_offset = IPP_ALIGN_OFFSET(ipp_offset + sizeof(*pdata));\
+	} while (0)
+
+/**
+ * serialize out get ptr for pdata
+ *
+ * @note it does not cpy data just set ptr and update the offset
+ * @warning  to be use in order
+ *
+ * @param  ipp_args the arg ptr array
+ * @param  n the arg number to serialize (unused)
+ * @param  pdata init to ptr in ipp_args type is used for offset computation
+ * @warning to use sequential in order agr are serialized
+ */
+#define IPP_OUT_ARG_PTR(ipp_args, n, pdata)\
+	do {\
+		pdata = (void *)(((char *)ipp_args) + ipp_offset);\
+		ipp_offset = IPP_ALIGN_OFFSET(ipp_offset + \
+		(int)sizeof(*pdata));\
+	} while (0)
+
+
+/**
+ * @brief ipp get payload
+ *
+ * @return paylaod at time used \n
+ * when all done it's overall out payload
+ *
+ * require @ref IPP_SERIALIZE_VAR and @ref IPP_SERIALIZE_START used first\n
+ * best use after all @ref IPP_OUT_ARG_PTR or @ref IPP_SET_ARG_PTR done to get
+ * full payload
+ **/
+#define IPP_SERIALIZE_PAYLAOD() (ipp_offset + IPP_WORK_HDR_SIZE)
+
+/**
+ * de-serialize and argument that was passed by value
+ * @param  ipp_args the args array
+ * @param  n  the 0 base argument number
+ * @param  v argument it must be exact type
+ *
+ *
+ * @code
+ * f_deserialize(ipp_arg_t args[])
+ * {
+ *	// f_ser is like (uint16_t arg0, struct s_arg_t * arg1, int arg2)
+ *	uint16_t arg0;
+ *	void * parg1;
+ *	int arg2;
+ *
+ *	IPP_GET_ARG( args, 0, arg0)
+ *	IPP_GET_ARG( args, 2, arg2)
+ * }
+ * @endcode
+ */
+#define IPP_GET_ARG(ipp_args, n, v) memcpy(&v, &ipp_args[n], sizeof(v))
+
+
+/**
+ * de-serialize an argument passed by pointer
+ *
+ * @param ipp_args the serialized argument array
+ * @param n 0 base argument number
+ * @param p  ptr to arg to be set
+ *
+ * @note unlike serializing de-serializing pointer args data can be done in any
+ * order
+ *
+ * @code
+ * struct some_struct_t *parg2;
+ * IPP_GET_ARG_PTR(args,2,parg2);
+ * @endcode
+ */
+#define IPP_GET_ARG_PTR(ipp_args, n, p) (p = (void *)((char *)ipp_args + \
+	ipp_args[n]))
+
+
+
+
+/**
+ * debug macro to pint out all serialized args
+ *
+ * Implementation shall define IPP_PRINT_FUNC function to use
+ */
+#define IPP_PRINT_ARGS(ipp_args, n) \
+	do {\
+		int i;\
+		for (i = 0; i < n; i++)\
+			IPP_PRINT("arg#%d/%d is %8d 0x%08x\n", i, n,\
+				ipp_args[i], ipp_args[i]);\
+		IPP_PRINT("used data size %d\n", ipp_offset);\
+	} while (0)
+
+
+/**
+ * processing code type of proccesing
+ *
+ * used in @a ipp_work_t::process_no
+ */
+enum stmvl53l1_ipp_proccesing_e {
+	stmvl53l1_ipp_ping = 0,
+	/*!< stmvl53l1_ipp_ping
+	 * @li can be sent by driver to check client is alive
+	 * @li  daemon sent it to identify and register himself to the driver
+	 */
+	stmvl53l1_ipp_cal_hist = 1,
+	/*!< stmvl53l1_ipp_cal_hist process cal hist*/
+
+	stmvl53l1_ipp_xtalk_calibration = 2,
+	/*!< stmvl53l1_ipp_xtalk_calibration process crosstalk calibration data
+	 */
+
+	stmvl53l1_ipp_hist_ambient_dmax = 3,
+	/*!< stmvl53l1_ipp_hist_ambient_dmax process ambient dmac calculation
+	 * from histogram
+	 */
+
+	stmvl53l1_ipp_generate_dual_reflectance_xtalk_samples = 4,
+	/*!< stmvl53l1_ipp_generate_dual_reflectance_xtalk_samples process
+	 * Xtalk data from dual reflectance histogram data
+	 */
+
+	/** keep last*/
+	stmvl53l1_ipp_max /*!< stmvl53l1_ipp_max */
+};
+
+/**
+ * status use on @a ipp_work_t::status
+ */
+enum stmvl53l1_ipp_status_e {
+	stmvl53l1_ipp_status_ok = 0,	/*!< ok work done */
+	stmvl53l1_ipp_status_inv_id,	/*!< dev id  not supported or invalid */
+	stmvl53l1_ipp_status_inv_proc,
+	/*!< process_no asked  not supported or not implemented */
+	stmvl53l1_ipp_status_inv_payload,
+	/*!< data payload for asked processing incorrect*/
+
+	stmvl53l1_ipp_status_proc_code = 0x100,
+	/*!< the lowest 8 bit is the error code form the processing */
+};
+
+/**
+ * Ipp work (job) struct
+ *
+ * containing header with sequenc control information plus serialized data
+ */
+struct ipp_work_t {
+	int8_t dev_id;		/*!< [in]/[out] device id */
+	/*!< Identify the work do be run see @a stmvl53l1_ipp_proccesing_e */
+	uint8_t process_no;
+	/*!< [out] status from daemon */
+	int16_t status;
+	/*!< [in/out] unique xfer id */
+	uint32_t xfer_id;
+	/*!< [in/out] effective data length including header*/
+	uint32_t payload;
+
+/** max IPP data payload (not including header)
+ *
+ * we substract size of of item above
+ * must be lesss than one netlink packet
+ */
+#define MAX_IPP_DATA	((4096-4*3)/8)
+	ipp_arg_t data[MAX_IPP_DATA];	/*!< [in][out] */
+};
+
+/**
+ * size of header only message ( no payload)
+ * require \#include <stddef.h> in user land
+ */
+#define IPP_WORK_HDR_SIZE	(offsetof(struct ipp_work_t, data[0]))
+/**
+ * max payload per ipp transfer
+ */
+#define IPP_WORK_MAX_PAYLOAD	sizeof(struct ipp_work_t)
+
+/** copy ipp header from src to dest
+ *
+ * used to prepare return work using incoming work header
+ * @param dest  dest work ptr
+ * @param src   src work ptr
+ */
+#define IPP_CPY_HEADER(dest, src) memcpy(dest, src, IPP_WORK_HDR_SIZE)
+
+/**
+ * dump in human readble way ipp struct
+ *
+ * @note require IPP_PRINT macro
+ *
+ * @param pw	ipp_work struct to dump
+ * @param max_data	max amount of data to be dump
+ * @param max_dev	max number of dev (for check)
+ */
+static inline void ipp_dump_work(struct ipp_work_t *pw, uint32_t max_data,
+		int max_dev)
+{
+	uint32_t data_cnt;
+	uint32_t i;
+	uint8_t *pbdata;
+
+	(void)max_dev; /* avoid warning when not used */
+	(void)pbdata; /*avoid warning in case no print no use*/
+
+	IPP_PRINT("dev #%d (%s)\n", pw->dev_id, pw->dev_id < max_dev ?
+			"ok" : "bad");
+	IPP_PRINT("process #%d (%s)\n", pw->process_no,
+			pw->process_no < stmvl53l1_ipp_max ? "ok" : "bad");
+	IPP_PRINT("status %d\n",  pw->status);
+	IPP_PRINT("Xfer id 0x%08X payload  %d bytes (%s)\n", pw->xfer_id,
+			pw->payload,
+			pw->payload > IPP_WORK_MAX_PAYLOAD ? "invalid" : "ok");
+	data_cnt = pw->payload > IPP_WORK_MAX_PAYLOAD ?
+			IPP_WORK_MAX_PAYLOAD : pw->payload;
+	data_cnt  = data_cnt > max_data ? max_data : data_cnt;
+	for (i = 0, pbdata = (uint8_t *)pw->data; i < data_cnt; i++) {
+		if (i%16 == 0)
+			IPP_PRINT("\n%4X\t", i);
+		IPP_PRINT("%02X ", pbdata[i]);
+	}
+	IPP_PRINT("\n");
+}
+
+/** @} */ /* ingroup helper */
+
+/** @} */ /* ingroup ipp_dev */
+#endif /* _STMVL53L1_IPP_H_ */
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_ipp_nl.c b/drivers/input/misc/vl53L1/stmvl53l1_ipp_nl.c
new file mode 100644
index 0000000000000000000000000000000000000000..af4dc93bf0cc399c4bfc76f7fe168ef14777c9f3
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_ipp_nl.c
@@ -0,0 +1,383 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file stmvl53l1_ipp_nl.c  vl53l1 ipp proxy over netlink kernel side
+ */
+#include <linux/module.h>
+#include <net/sock.h>
+#include <linux/netlink.h>
+#include <linux/skbuff.h>
+#include <linux/version.h>
+
+#include "stmvl53l1.h"
+
+#include "vl53l1_platform_ipp.h"
+#include "stmvl53l1_ipp.h"
+
+#define IPP_DEBUG	1
+#ifndef IPP_DEBUG
+#	define _ipp_dump_work(...) (void)0
+#else
+#	define _ipp_dump_work(...) ipp_dump_work(__VA_ARGS__)
+#endif
+
+#define IPP_STATE_PENDING	1
+#define IPP_STATE_COMPLETED	2
+#define IPP_STATE_CANCELED	4
+
+#define IPP_TIMEOUT_MS		100
+
+/** the single netlink strut use by all instance
+ * @note is NULL until set
+ */
+static struct sock *nl_sk;
+
+static DEFINE_MUTEX(ipp_mutex);
+
+/**
+ * current registered daemon pid
+ * @note default value 0 or later 1 is kind of invalid and will require
+ * user space to connect before we can send any packet
+ */
+static int daemon_pid;
+
+/**
+ * next xfer_id (shared other all dev)
+ * no direct us used  @@ref get_next_xfer_id (will get lock)
+ * @note default to 0 what is "reserved"
+ */
+static int next_xfer_id;
+
+
+#define ipp_err(fmt, ...) pr_err("STMVL53L1 IPP Err in %s %d :" fmt "\n", \
+		__func__, __LINE__, ##__VA_ARGS__)
+
+#define ipp_warn(fmt, ...) pr_warn("STMVL53L1 IPP wng in %s %d : "fmt"\n",\
+		__func__, __LINE__, ##__VA_ARGS__)
+
+#if 0
+#	define ipp_dbg(fmt, ...) pr_info("IPP %s %d " fmt "\n",\
+		__func__, __LINE__, ##__VA_ARGS__)
+#else
+#	define ipp_dbg(...) (void)0
+#endif
+
+/**
+ * get and managed increment of next xfer_id
+ * @note will get ipp_mutex
+ * @return the xfer_id to be used
+ */
+static int get_next_xfer_id(void)
+{
+	mutex_lock(&ipp_mutex);
+	next_xfer_id++;
+	/*0 is reserved skip it*/
+	if (next_xfer_id == 0)
+		next_xfer_id = 1;
+	mutex_unlock(&ipp_mutex);
+
+	return next_xfer_id;
+}
+
+static int send_client_msg(void *msg_data, int msg_size)
+{
+	int rc;
+	struct sk_buff *skb_out;
+	struct nlmsghdr *nlh;
+	void *nl_data;
+
+	ipp_dbg("to send %d byte", msg_size);
+	skb_out = nlmsg_new(msg_size, 0);
+	if (!skb_out) {
+		ipp_err("nlmsg_new fail\n");
+		return -1;
+	}
+
+	nlh = nlmsg_put(skb_out, 0, 0, NLMSG_DONE, msg_size, 0);
+	NETLINK_CB(skb_out).dst_group = 0; /* not in mcast group */
+
+	nl_data = nlmsg_data(nlh); /*get data ptr from header*/
+	memcpy(nl_data, msg_data, msg_size);
+
+	/* FIXME do we real need to lock to send a data other nl_sk ? */
+	mutex_lock(&ipp_mutex);
+	rc = nlmsg_unicast(nl_sk, skb_out, daemon_pid);
+	if (rc < 0)
+		ipp_err("fail to send data size %d to pid %d\n",
+				msg_size, daemon_pid);
+	/* stat can be done here in else case */
+	mutex_unlock(&ipp_mutex);
+
+	return rc;
+}
+
+/*
+ * ipp lock is held ping already handled
+ */
+int ipp_in_process(struct ipp_work_t *pwork)
+{
+	struct stmvl53l1_data *data;
+
+	ipp_dbg("enter");
+	_ipp_dump_work(pwork, IPP_WORK_MAX_PAYLOAD, STMVL53L1_CFG_MAX_DEV);
+
+	/* work id check already done */
+	data = stmvl53l1_dev_table[pwork->dev_id];
+	ipp_dbg("to lock ");
+	/* Release now useless ipp_mutex for below work since we may deadlock
+	 * with irq path.
+	 */
+	mutex_unlock(&ipp_mutex);
+	mutex_lock(&data->work_mutex);
+	if (data->ipp.buzy == IPP_STATE_PENDING) {
+		/* if  it was already handled ignore it */
+		if (data->ipp.waited_xfer_id == pwork->xfer_id) {
+			/* ok that is what we are expecting back */
+			memcpy(&data->ipp.work_out, pwork, pwork->payload);
+			data->ipp.buzy |= IPP_STATE_COMPLETED;
+			ipp_dbg("to wake ipp waiter as buzy state %d",
+					data->ipp.buzy);
+			wake_up(&data->ipp.waitq);
+			goto done_lock;
+		}
+	}
+	/* either not waiting any more or not the expected id drop it */
+	ipp_err("dev #%d ippp buzy %d xfer id %d  rcv id %d droping it",
+			data->id, data->ipp.buzy, data->ipp.waited_xfer_id,
+			pwork->xfer_id);
+done_lock:
+	mutex_unlock(&data->work_mutex);
+	mutex_lock(&ipp_mutex);
+
+	return 0;
+}
+
+int stmvl53l1_ipp_stop(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	rc = data->ipp.buzy;
+	ipp_dbg("#%d to stop buzy %d", data->id, data->ipp.buzy);
+	if (data->ipp.buzy) {
+		/* set invalid wait id to discard canceled job when back */
+		data->ipp.waited_xfer_id = 0;
+		data->ipp.buzy |= IPP_STATE_CANCELED|IPP_STATE_COMPLETED;
+		ipp_dbg("#%dto wake up worker", data->id);
+		/* wake up worker or abort the thread */
+		wake_up(&data->ipp.waitq);
+	}
+
+	return rc;
+}
+
+/*
+ * ipp and dev lock are held
+ * release and re-grabbed here
+ */
+int stmvl53l1_ipp_do(struct stmvl53l1_data *data,
+		struct ipp_work_t *pin, struct ipp_work_t *pout)
+{
+	int xfer_id;
+	int rc;
+	bool has_timeout;
+
+	ipp_dbg("enter");
+
+	xfer_id = get_next_xfer_id();
+	/* set xfer and device dependent part of the work */
+	pin->dev_id = data->id;
+	pin->xfer_id =  xfer_id;
+	data->ipp.waited_xfer_id = xfer_id;
+	/*  try to do it */
+	rc = send_client_msg(pin, pin->payload);
+	/* shall we retry if fail to send for some time or number of try ? */
+	if (rc < 0) {
+		rc = -1;
+		ipp_err("fail to send msg %d", rc);
+	} else if (data->ipp.buzy == 0) {
+		/* send ok put the ipp on buzy state while locked */
+		data->ipp.buzy = IPP_STATE_PENDING;
+		/*  unlock now that state is marked buzy */
+		mutex_unlock(&data->work_mutex);
+
+		/* put task to wait for completion */
+		ipp_dbg("to wait");
+		has_timeout = !wait_event_timeout(data->ipp.waitq,
+			(data->ipp.buzy != IPP_STATE_PENDING),
+			msecs_to_jiffies(IPP_TIMEOUT_MS));
+
+		/* relock the main lock */
+		mutex_lock(&data->work_mutex);
+
+		rc = (data->ipp.buzy & IPP_STATE_CANCELED) || has_timeout ?
+			-1 : 0;
+		if (rc) {
+			ipp_dbg("waking up with from canceled/timeout ipp");
+		} else {
+			/* return status from the ipp itself */
+			ipp_dbg("ip back with status %d", data->ipp.status);
+			rc = data->ipp.status;
+		}
+		data->ipp.buzy = 0;/* buzy clear but locked so safe */
+	} else {
+		ipp_dbg("buzy still not zero %d", data->ipp.buzy);
+		rc = -1;
+	}
+
+
+/* done_lock: */
+	return rc;
+}
+
+
+static void stmvl53l1_nl_recv_msg(struct sk_buff *skb_in)
+{
+	int pid_chg = 0;
+	int pid;
+	struct nlmsghdr *nlh;
+	struct ipp_work_t *pwork;
+
+	ipp_dbg("Entering");
+
+	nlh = (struct nlmsghdr *)skb_in->data;
+	pid = nlh->nlmsg_pid; /*pid of sending process */
+
+	pwork = nlmsg_data(nlh);
+	if (pwork->payload < IPP_WORK_HDR_SIZE ||
+			pwork->payload > IPP_WORK_MAX_PAYLOAD){
+		/* invalid header size */
+		ipp_err("invalid msg header size %d", pwork->payload);
+		_ipp_dump_work(pwork, IPP_WORK_MAX_PAYLOAD,
+			STMVL53L1_CFG_MAX_DEV);
+		return;
+	}
+
+	mutex_lock(&ipp_mutex);
+
+	if ((pwork->dev_id >= STMVL53L1_CFG_MAX_DEV) || (pwork->dev_id < 0)) {
+		ipp_err("invalid dev id on msg %d", pwork->dev_id);
+		_ipp_dump_work(pwork, IPP_WORK_MAX_PAYLOAD,
+			STMVL53L1_CFG_MAX_DEV);
+		goto done_locked;
+	}
+
+	if (pwork->process_no == stmvl53l1_ipp_ping) {
+		/* in that case the payload must be exact status size only
+		 * if not it is a badly format message or bad message
+		 */
+		if (pwork->payload !=  IPP_WORK_HDR_SIZE) {
+			ipp_err("invalid ping msg size %d!=%zu ",
+					pwork->payload, IPP_WORK_HDR_SIZE);
+			_ipp_dump_work(pwork, IPP_WORK_MAX_PAYLOAD,
+				STMVL53L1_CFG_MAX_DEV);
+			goto done_locked;
+		}
+		/* if pid was not set or change resent all ongoing ipp */
+		if (pid != daemon_pid)
+			ipp_warn("pid chg %d => %d\n", daemon_pid, pid);
+		else
+			ipp_dbg("got ping fm pid %d\n", daemon_pid);
+		daemon_pid = pid;
+		pid_chg = 1;
+	} else {
+		ipp_in_process(pwork);
+	}
+ done_locked:
+	mutex_unlock(&ipp_mutex);
+}
+
+int stmvl53l1_ipp_setup(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	mutex_lock(&ipp_mutex);
+
+	data->ipp.buzy = 0;
+	init_waitqueue_head(&data->ipp.waitq);
+	ipp_dbg("now %d dev daemon pid is %d", STMVL53L1_CFG_MAX_DEV,
+		daemon_pid);
+	rc = 0;
+
+	mutex_unlock(&ipp_mutex);
+
+	return rc;
+}
+
+void stmvl53l1_ipp_cleanup(struct stmvl53l1_data *data)
+{
+	/* nothink to do */
+}
+
+#if !defined(OLD_NETLINK_API)
+struct netlink_kernel_cfg cfg = {
+	.input = stmvl53l1_nl_recv_msg
+};
+#endif
+
+static int netlink_protocol_type = STMVL531_CFG_NETLINK_USER;
+
+module_param(netlink_protocol_type, int, 0444);
+MODULE_PARM_DESC(netlink_protocol_type,
+	"select netlink protocol type for ipp communications");
+
+int stmvl53l1_ipp_init(void)
+{
+	mutex_init(&ipp_mutex);
+	daemon_pid = 1; /* pid  1 is safe should not be use for user space */
+
+#if defined(OLD_NETLINK_API)
+	nl_sk = netlink_kernel_create(&init_net,
+			netlink_protocol_type,
+			0,
+			stmvl53l1_nl_recv_msg,
+			NULL,
+			THIS_MODULE);
+#else
+	nl_sk = netlink_kernel_create(&init_net,
+			netlink_protocol_type,
+			&cfg);
+#endif
+
+	return nl_sk ? 0 : -1;
+}
+
+
+void stmvl53l1_ipp_exit(void)
+{
+	if (nl_sk != NULL) {
+		vl53l1_dbgmsg("releasing netlink socket");
+		netlink_kernel_release(nl_sk);
+		nl_sk = NULL;
+	}
+}
+
+
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_log.c b/drivers/input/misc/vl53L1/stmvl53l1_log.c
new file mode 100644
index 0000000000000000000000000000000000000000..ecedcb446ddaf5cdc019f218aa0369a417d52111
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_log.c
@@ -0,0 +1,78 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+/**
+ * @file /stmvl53l1_module.c  vl53l1_module  ST VL53L1 linux kernel module
+ *
+ * This is implementation of low level driver trace support
+ */
+#include <linux/module.h>
+#include <linux/printk.h>
+
+#include "stmvl53l1.h"
+
+#ifdef VL53L1_LOG_ENABLE
+
+static bool trace_function;
+static int trace_module;
+static int trace_level;
+
+module_param(trace_function, bool, 0644);
+MODULE_PARM_DESC(trace_function,
+	"allow tracing of low level function entry and exit");
+
+module_param(trace_module, int, 0644);
+MODULE_PARM_DESC(trace_module,
+	"control tracing of low level per module");
+
+module_param(trace_level, int, 0644);
+MODULE_PARM_DESC(trace_level,
+	"control tracing of low level per level");
+
+void log_trace_print(uint32_t module, uint32_t level, uint32_t function,
+	const char *format, ...)
+{
+	va_list args;
+
+	if (function && !trace_function)
+		return;
+
+	if (!(module & trace_module))
+		return;
+
+	if (level > trace_level)
+		return;
+
+	va_start(args, format);
+	vprintk(format, args);
+	va_end(args);
+}
+
+#endif
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_module-cci.c b/drivers/input/misc/vl53L1/stmvl53l1_module-cci.c
new file mode 100644
index 0000000000000000000000000000000000000000..8c4e99582c9116d08958f6e7a0c8ecc19d4042ac
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_module-cci.c
@@ -0,0 +1,274 @@
+/*
+* Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+*
+* License terms: BSD 3-clause "New" or "Revised" License.
+*
+* Redistribution and use in source and binary forms, with or without
+* modification, are permitted provided that the following conditions are met:
+*
+* 1. Redistributions of source code must retain the above copyright notice, this
+* list of conditions and the following disclaimer.
+*
+* 2. Redistributions in binary form must reproduce the above copyright notice,
+* this list of conditions and the following disclaimer in the documentation
+* and/or other materials provided with the distribution.
+*
+* 3. Neither the name of the copyright holder nor the names of its contributors
+* may be used to endorse or promote products derived from this software
+* without specific prior written permission.
+*
+* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+/**
+ * @file stmvl53l1_module-i2c.c
+ *
+ *  implement STM VL53L1 module interface i2c wrapper + control
+ *  using linux native i2c + gpio + reg api
+ */
+#include <linux/uaccess.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/mutex.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/gpio.h>
+#include <linux/input.h>
+#include <linux/miscdevice.h>
+#include <linux/kernel.h>
+#include <linux/fs.h>
+#include <linux/time.h>
+#include <linux/platform_device.h>
+#include <linux/version.h>
+
+/*
+ * power specific includes
+ */
+#include <linux/pwm.h>
+#include <linux/regulator/consumer.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/clk.h>
+#include <linux/of_gpio.h>
+#include <linux/gpio.h>
+
+#include "stmvl53l1-i2c.h"
+#include "stmvl53l1.h"
+struct stmvl53l1_pinctrl_info {
+	struct pinctrl *pinctrl;
+	struct pinctrl_state *gpio_state_active;
+	struct pinctrl_state *gpio_state_suspend;
+};
+
+struct stmvl53l1_pinctrl_info stmvl53l1_pinctrl;
+
+extern int stmvl53l1_parse_tree(struct device *dev, struct i2c_data *i2c_data);
+extern void stmvl53l1_release_gpios(struct i2c_data *i2c_data);
+
+static int stmvl53l1_request_pinctrl(struct device *dev)
+{
+    struct stmvl53l1_pinctrl_info *device_pctrl = &stmvl53l1_pinctrl;
+	device_pctrl->pinctrl = devm_pinctrl_get(dev);
+	if (IS_ERR_OR_NULL(device_pctrl->pinctrl)) {
+		vl53l1_errmsg("Pinctrl not available");
+		device_pctrl->pinctrl = NULL;
+		return 0;
+	}
+	device_pctrl->gpio_state_active =
+		pinctrl_lookup_state(device_pctrl->pinctrl,
+				"laser_default");
+	if (IS_ERR_OR_NULL(device_pctrl->gpio_state_active)) {
+		vl53l1_errmsg("Failed to get the active state pinctrl handle");
+		device_pctrl->gpio_state_active = NULL;
+		return -EINVAL;
+	}
+	device_pctrl->gpio_state_suspend
+		= pinctrl_lookup_state(device_pctrl->pinctrl,
+				"laser_suspend");
+	if (IS_ERR_OR_NULL(device_pctrl->gpio_state_suspend)) {
+		vl53l1_errmsg("Failed to get the suspend state pinctrl handle");
+		device_pctrl->gpio_state_suspend = NULL;
+		return -EINVAL;
+	}
+	return 0;
+}
+
+int stmvl53l1_enable_pinctrl(void)
+{
+    int rc = 0;
+
+    if (stmvl53l1_pinctrl.pinctrl &&
+        stmvl53l1_pinctrl.gpio_state_active) {
+        rc = pinctrl_select_state(stmvl53l1_pinctrl.pinctrl,
+            stmvl53l1_pinctrl.gpio_state_active);
+        vl53l1_errmsg("enable pinctrl rc=%d\n", rc);
+    }
+
+    return rc;
+}
+
+int stmvl53l1_disable_pinctrl(void)
+{
+    int rc = 0;
+
+    if (stmvl53l1_pinctrl.pinctrl &&
+        stmvl53l1_pinctrl.gpio_state_suspend) {
+        rc = pinctrl_select_state(stmvl53l1_pinctrl.pinctrl,
+            stmvl53l1_pinctrl.gpio_state_suspend);
+        vl53l1_errmsg("disable pinctrl rc=%d\n", rc);
+    }
+
+    return rc;
+
+}
+
+int stmvl53l1_release_pinctrl(struct device *dev)
+{
+    if (stmvl53l1_pinctrl.pinctrl)
+        devm_pinctrl_put(stmvl53l1_pinctrl.pinctrl);
+    stmvl53l1_pinctrl.pinctrl = NULL;
+
+    return 0;
+}
+
+static int32_t stmvl53l1_probe_cci(
+	struct platform_device *pdev)
+{
+    int rc = 0;
+    struct stmvl53l1_data *vl53l1_data = NULL;
+    struct i2c_data *i2c_data = NULL;
+
+    vl53l1_dbgmsg("Enter %s : 0x%02x\n", pdev->name, pdev->id);
+
+
+    vl53l1_data = kzalloc(sizeof(struct stmvl53l1_data), GFP_KERNEL);
+    if (!vl53l1_data) {
+        rc = -ENOMEM;
+        return rc;
+    }
+    if (vl53l1_data) {
+        vl53l1_data->client_object =
+                kzalloc(sizeof(struct i2c_data), GFP_KERNEL);
+        if (!vl53l1_data)
+            goto done_freemem;
+        i2c_data = (struct i2c_data *)vl53l1_data->client_object;
+    }
+    //i2c_data->client = client;
+    i2c_data->vl53l1_data = vl53l1_data;
+    i2c_data->irq = -1 ;
+    rc = stmvl53l1_parse_tree(&(pdev->dev), i2c_data);
+    if (rc)
+        goto done_freemem;
+
+    rc = stmvl53l1_request_pinctrl(&(pdev->dev));
+    if (rc){
+        vl53l1_errmsg("fail to request pinctrl,rc = %d", rc);
+        goto done_freemem;
+    }
+    rc = stmvl53l1_enable_pinctrl();
+    if (rc){
+        vl53l1_errmsg("fail to enable pinctrl,rc = %d", rc);
+        goto release_gpios;
+    }
+
+    platform_set_drvdata(pdev, vl53l1_data);
+    //vl53l1_data->plat_dev = pdev;
+
+    rc = stmvl53l1_setup(vl53l1_data);
+    if (rc)
+        goto release_gpios;
+    vl53l1_dbgmsg("End\n");
+
+    kref_init(&i2c_data->ref);
+
+    return rc;
+
+release_gpios:
+    stmvl53l1_release_gpios(i2c_data);
+
+done_freemem:
+    kfree(vl53l1_data);
+    kfree(i2c_data);
+
+    return 0;
+}
+
+static int32_t stmvl53l1_remove_cci(struct platform_device *pdev)
+{
+    int rc = 0;
+    struct stmvl53l1_data *data = platform_get_drvdata(pdev);
+    struct i2c_data *i2c_data = (struct i2c_data *)data->client_object;
+
+    vl53l1_dbgmsg("Enter\n");
+    mutex_lock(&data->work_mutex);
+    /* main driver cleanup */
+    stmvl53l1_cleanup(data);
+
+    rc = stmvl53l1_disable_pinctrl();
+    if (rc){
+        vl53l1_errmsg("fatal,fail to disable pinctrl,rc = %d", rc);
+    }
+    rc = stmvl53l1_release_pinctrl(&(pdev->dev));
+    if (rc){
+        vl53l1_errmsg("fatal,fail to release pinctrl,rc = %d", rc);
+    }
+
+    /* release gpios */
+    stmvl53l1_release_gpios(i2c_data);
+
+    mutex_unlock(&data->work_mutex);
+
+    stmvl53l1_put(data->client_object);
+
+    vl53l1_dbgmsg("End\n");
+
+    return 0;
+}
+
+static const struct of_device_id stmvl53l1_driver_dt_match[] = {
+	{.compatible = "st,stmvl53l1"},
+	{}
+};
+
+MODULE_DEVICE_TABLE(of, stmvl53l1_driver_dt_match);
+
+static struct platform_driver stmvl53l1_platform_driver = {
+	.probe = stmvl53l1_probe_cci,
+	.driver = {
+		.name = "st,stmvl53l1",
+		.owner = THIS_MODULE,
+		.of_match_table = stmvl53l1_driver_dt_match,
+	},
+	.remove = stmvl53l1_remove_cci,
+};
+
+int __init stmvl53l1_init_cci(void)
+{
+	int32_t rc = 0;
+    vl53l1_dbgmsg("enter\n");
+	rc = platform_driver_register(&stmvl53l1_platform_driver);
+	if (rc < 0) {
+        vl53l1_dbgmsg("platform_driver_register fail\n");
+		return rc;
+	}
+
+	return rc;
+}
+
+void __exit stmvl53l1_exit_cci(void* obj)
+{
+    vl53l1_dbgmsg("enter\n");
+	platform_driver_unregister(&stmvl53l1_platform_driver);
+}
+
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_module-i2c.c b/drivers/input/misc/vl53L1/stmvl53l1_module-i2c.c
new file mode 100644
index 0000000000000000000000000000000000000000..880fbdb34a1f610c3c6c93ef74b36ec92bc44bd4
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_module-i2c.c
@@ -0,0 +1,866 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file stmvl53l1_module-i2c.c
+ *
+ *  implement STM VL53L1 module interface i2c wrapper + control
+ *  using linux native i2c + gpio + reg api
+ */
+#include <linux/uaccess.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/mutex.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/gpio.h>
+#include <linux/input.h>
+#include <linux/miscdevice.h>
+#include <linux/kernel.h>
+#include <linux/fs.h>
+#include <linux/time.h>
+#include <linux/platform_device.h>
+#include <linux/version.h>
+
+/*
+ * power specific includes
+ */
+#include <linux/pwm.h>
+#include <linux/regulator/consumer.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/clk.h>
+#include <linux/of_gpio.h>
+#include <linux/gpio.h>
+
+#include "stmvl53l1-i2c.h"
+#include "stmvl53l1.h"
+#include "cam_cci_ctrl_interface.h"
+
+#define STMVL53L1_SLAVE_ADDR	(0x52>>1)
+#define IGNORE_IRQ  0       //songyt add
+/** @ingroup drv_port
+ * @{
+ */
+
+/**
+ * control specific debug message echo
+ *
+ * Set to 0/1 do not remove
+ *
+ * most dbg warn err messages goes true main driver macro
+ * this one permit some specific debug without activating all main dbg
+ */
+#define MODI2C_DEBUG	0
+
+/*
+ * mutex to handle device i2c address changes. It allow to avoid multiple
+ * device active with same i2c addresses at the same time. Note that we don't
+ * support case where boot_reg has the same value as a final i2c address of
+ * another device.
+ */
+static DEFINE_MUTEX(dev_addr_change_mutex);
+
+/**
+ * i2c client assigned to our driver
+ *
+ * this is use for stm test purpose as we fake client create and regstration
+ * we stores the i2c client for release in clean-up overwise we wan't reload
+ * the module multiple time
+ *
+ * in a normal dev tree prod system this is not required
+ */
+static struct i2c_client *stm_test_i2c_client;
+
+/*
+ * pi3:
+ * insmod stmvl53l1.ko force_device=1 adapter_nb=1 xsdn_gpio_nb=19
+ * intr_gpio_nb=16 pwren_gpio_nb=12
+ *
+ * panda
+ * insmod stmvl53l1.ko force_device=1 adapter_nb=4 xsdn_gpio_nb=56
+ * intr_gpio_nb=59 pwren_gpio_nb=55
+*/
+
+static int force_device;
+static int adapter_nb = -1;
+static int xsdn_gpio_nb = -1;
+static int pwren_gpio_nb = -1;
+static int intr_gpio_nb = -1;
+
+module_param(force_device, int, 0000);
+MODULE_PARM_DESC(force_device, "force device insertion at module init");
+
+module_param(adapter_nb, int, 0000);
+MODULE_PARM_DESC(adapter_nb, "i2c adapter to use");
+
+module_param(xsdn_gpio_nb, int, 0000);
+MODULE_PARM_DESC(xsdn_gpio_nb, "select gpio numer to use for vl53l1 reset");
+
+module_param(pwren_gpio_nb, int, 0000);
+MODULE_PARM_DESC(pwren_gpio_nb, "select gpio numer to use for vl53l1 power");
+
+module_param(intr_gpio_nb, int, 0000);
+MODULE_PARM_DESC(intr_gpio_nb, "select gpio numer to use for vl53l1 interrupt");
+
+/**
+ * warn message
+ *
+ * @warning use only in scope where i2c_data ptr is present
+ **/
+#define modi2c_warn(fmt, ...)\
+	dev_WARN(&i2c_data->client->dev, fmt, ##__VA_ARGS__)
+
+/**
+ * err message
+ *
+ * @warning use only in scope where i2c_data ptr is present
+ */
+#define modi2c_err(fmt, ...)\
+	dev_err(&i2c_data->client->dev, fmt, ##__VA_ARGS__)
+
+
+
+#if MODI2C_DEBUG
+#	define modi2c_dbg(fmt, ...)\
+		pr_devel("%s "fmt"\n", __func__, ##__VA_ARGS__)
+#else
+#	define modi2c_dbg(...)	(void)0
+#endif
+
+static int insert_device(void)
+{
+	int ret = 0;
+	struct i2c_adapter *adapter;
+	struct i2c_board_info info = {
+		.type = "stmvl53l1",
+		.addr = STMVL53L1_SLAVE_ADDR,
+	};
+
+	memset(&info, 0, sizeof(info));
+	strcpy(info.type, "stmvl53l1");
+	info.addr = STMVL53L1_SLAVE_ADDR;
+	adapter = i2c_get_adapter(adapter_nb);
+	if (!adapter) {
+		ret = -EINVAL;
+		goto done;
+	}
+	stm_test_i2c_client = i2c_new_device(adapter, &info);
+	if (!stm_test_i2c_client)
+		ret = -EINVAL;
+
+done:
+	return ret;
+}
+
+static int get_xsdn(struct device *dev, struct i2c_data *i2c_data)
+{
+	int rc = 0;
+
+	i2c_data->io_flag.xsdn_owned = 0;
+	if (i2c_data->xsdn_gpio == -1) {
+		vl53l1_errmsg("reset gpio is required");
+		rc = -ENODEV;
+		goto no_gpio;
+	}
+
+	vl53l1_dbgmsg("request xsdn_gpio %d", i2c_data->xsdn_gpio);
+	rc = gpio_request(i2c_data->xsdn_gpio, "vl53l1_xsdn");
+	if (rc) {
+		vl53l1_errmsg("fail to acquire xsdn %d", rc);
+		goto request_failed;
+	}
+
+	rc = gpio_direction_output(i2c_data->xsdn_gpio, 0);
+	if (rc) {
+		vl53l1_errmsg("fail to configure xsdn as output %d", rc);
+		goto direction_failed;
+	}
+	i2c_data->io_flag.xsdn_owned = 1;
+
+	return rc;
+
+direction_failed:
+	gpio_free(i2c_data->xsdn_gpio);
+
+request_failed:
+no_gpio:
+	return rc;
+}
+
+static void put_xsdn(struct i2c_data *i2c_data)
+{
+	if (i2c_data->io_flag.xsdn_owned) {
+		vl53l1_dbgmsg("release xsdn_gpio %d", i2c_data->xsdn_gpio);
+		gpio_free(i2c_data->xsdn_gpio);
+		i2c_data->io_flag.xsdn_owned = 0;
+		i2c_data->xsdn_gpio = -1;
+	}
+	i2c_data->xsdn_gpio = -1;
+}
+
+static int get_pwren(struct device *dev, struct i2c_data *i2c_data)
+{
+	int rc = 0;
+
+	i2c_data->io_flag.pwr_owned = 0;
+	if (i2c_data->pwren_gpio == -1) {
+		vl53l1_wanrmsg("pwren gpio disable");
+		goto no_gpio;
+	}
+
+	vl53l1_dbgmsg("request pwren_gpio %d", i2c_data->pwren_gpio);
+	rc = gpio_request(i2c_data->pwren_gpio, "vl53l1_pwren");
+	if (rc) {
+		vl53l1_errmsg("fail to acquire pwren %d", rc);
+		goto request_failed;
+	}
+
+	rc = gpio_direction_output(i2c_data->pwren_gpio, 0);
+	if (rc) {
+		vl53l1_errmsg("fail to configure pwren as output %d", rc);
+		goto direction_failed;
+	}
+	i2c_data->io_flag.pwr_owned = 1;
+
+	return rc;
+
+direction_failed:
+	gpio_free(i2c_data->xsdn_gpio);
+
+request_failed:
+no_gpio:
+	return rc;
+}
+
+static void put_pwren(struct i2c_data *i2c_data)
+{
+	if (i2c_data->io_flag.pwr_owned) {
+		vl53l1_dbgmsg("release pwren_gpio %d", i2c_data->pwren_gpio);
+		gpio_free(i2c_data->pwren_gpio);
+		i2c_data->io_flag.pwr_owned = 0;
+		i2c_data->pwren_gpio = -1;
+	}
+	i2c_data->pwren_gpio = -1;
+}
+
+static int get_intr(struct device *dev, struct i2c_data *i2c_data)
+{
+	int rc = 0;
+
+	i2c_data->io_flag.intr_owned = 0;
+	if (i2c_data->intr_gpio == -1) {
+		vl53l1_wanrmsg("no interrupt gpio");
+		goto no_gpio;
+	}
+
+	vl53l1_dbgmsg("request intr_gpio %d", i2c_data->intr_gpio);
+	rc = gpio_request(i2c_data->intr_gpio, "vl53l1_intr");
+	if (rc) {
+		vl53l1_errmsg("fail to acquire intr %d", rc);
+		goto request_failed;
+	}
+
+	rc = gpio_direction_input(i2c_data->intr_gpio);
+	if (rc) {
+		vl53l1_errmsg("fail to configure intr as input %d", rc);
+		goto direction_failed;
+	}
+
+	i2c_data->irq = gpio_to_irq(i2c_data->intr_gpio);
+	if (i2c_data->irq < 0) {
+		vl53l1_errmsg("fail to map GPIO: %d to interrupt:%d\n",
+				i2c_data->intr_gpio, i2c_data->irq);
+		goto irq_failed;
+	}
+	i2c_data->io_flag.intr_owned = 1;
+
+	return rc;
+
+irq_failed:
+direction_failed:
+	gpio_free(i2c_data->intr_gpio);
+
+request_failed:
+no_gpio:
+	return rc;
+}
+
+static void put_intr(struct i2c_data *i2c_data)
+{
+	if (i2c_data->io_flag.intr_owned) {
+		if (i2c_data->io_flag.intr_started) {
+			free_irq(i2c_data->irq, i2c_data);
+			i2c_data->io_flag.intr_started = 0;
+		}
+		vl53l1_dbgmsg("release intr_gpio %d", i2c_data->intr_gpio);
+		gpio_free(i2c_data->intr_gpio);
+		i2c_data->io_flag.intr_owned = 0;
+	}
+	i2c_data->intr_gpio = -1;
+}
+
+/**
+ *  parse dev tree for all platform specific input
+ */
+int stmvl53l1_parse_tree(struct device *dev, struct i2c_data *i2c_data)
+{
+	int rc = 0;
+	enum of_gpio_flags flags;
+	/* if force device is in use then gpio nb comes from module param else
+	 * we use devicetree.
+	 */
+	i2c_data->vdd = NULL;
+	i2c_data->pwren_gpio = -1;
+	i2c_data->xsdn_gpio = -1;
+	i2c_data->intr_gpio = -1;
+	i2c_data->boot_reg = STMVL53L1_SLAVE_ADDR;
+	if (force_device) {
+		i2c_data->xsdn_gpio = xsdn_gpio_nb;
+		i2c_data->pwren_gpio = pwren_gpio_nb;
+		i2c_data->intr_gpio = intr_gpio_nb;
+	} else if (dev->of_node) {
+		/* power : either vdd or pwren_gpio. try reulator first */
+		i2c_data->vdd = regulator_get(dev, "laser_vdd");
+		if (IS_ERR(i2c_data->vdd) || i2c_data->vdd == NULL) {
+			i2c_data->vdd = NULL;
+			vl53l1_wanrmsg(
+        		"no laser_vdd, fatal.");
+		}
+		i2c_data->pwren_gpio = of_get_named_gpio_flags(dev->of_node, "pwren-gpio", 0,
+						  &flags);
+		if (gpio_is_valid(i2c_data->pwren_gpio)) {
+			vl53l1_dbgmsg("pwren-gpio %d",
+				i2c_data->pwren_gpio);
+		} else {
+			vl53l1_wanrmsg(
+        		"no regulator, nor power gpio => power ctrl disabled");
+			i2c_data->pwren_gpio = -1;
+		}
+		i2c_data->xsdn_gpio = of_get_named_gpio_flags(dev->of_node, "xsdn-gpio", 0,
+						  &flags);
+		if (gpio_is_valid(i2c_data->xsdn_gpio)) {
+			vl53l1_dbgmsg("xsdn-gpio %d",
+				i2c_data->xsdn_gpio);
+		} else {
+			vl53l1_wanrmsg("Unable to find xsdn-gpio %d",
+				i2c_data->xsdn_gpio);
+			i2c_data->xsdn_gpio = -1;
+		}
+#if IGNORE_IRQ
+        i2c_data->intr_gpio = -1;
+        vl53l1_dbgmsg("do not use intr-gpio!");
+#else
+		i2c_data->intr_gpio = of_get_named_gpio_flags(dev->of_node, "intr-gpio", 0,&flags);
+		if (gpio_is_valid(i2c_data->intr_gpio)) {
+			vl53l1_dbgmsg("intr-gpio %d",
+				i2c_data->intr_gpio);
+		} else {
+			vl53l1_wanrmsg("Unable to find intr-gpio %d",
+				i2c_data->intr_gpio);
+			i2c_data->intr_gpio = -1;
+		}
+#endif
+	}
+
+	/* configure gpios */
+	rc = get_xsdn(dev, i2c_data);
+	if (rc)
+		goto no_xsdn;
+	rc = get_pwren(dev, i2c_data);
+	if (rc)
+		goto no_pwren;
+	rc = get_intr(dev, i2c_data);
+	if (rc){
+        vl53l1_errmsg("get_intr failed.");
+		goto no_intr;
+    }
+	return rc;
+
+no_intr:
+#if IGNORE_IRQ
+    return 0;
+#else
+	if (i2c_data->vdd) {
+		regulator_put(i2c_data->vdd);
+		i2c_data->vdd = NULL;
+	}
+	put_pwren(i2c_data);
+#endif
+no_pwren:
+	put_xsdn(i2c_data);
+no_xsdn:
+	return rc;
+}
+
+void stmvl53l1_release_gpios(struct i2c_data *i2c_data)
+{
+	put_xsdn(i2c_data);
+	if (i2c_data->vdd) {
+		regulator_put(i2c_data->vdd);
+		i2c_data->vdd = NULL;
+	}
+	put_pwren(i2c_data);
+	put_intr(i2c_data);
+}
+
+static int stmvl53l1_probe(struct i2c_client *client,
+				const struct i2c_device_id *id)
+{
+	int rc = 0;
+	struct stmvl53l1_data *vl53l1_data = NULL;
+	struct i2c_data *i2c_data = NULL;
+
+	vl53l1_dbgmsg("Enter %s : 0x%02x\n", client->name, client->addr);
+
+	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE)) {
+		rc = -EIO;
+		return rc;
+	}
+
+	vl53l1_data = kzalloc(sizeof(struct stmvl53l1_data), GFP_KERNEL);
+	if (!vl53l1_data) {
+		rc = -ENOMEM;
+		return rc;
+	}
+	if (vl53l1_data) {
+		vl53l1_data->client_object =
+				kzalloc(sizeof(struct i2c_data), GFP_KERNEL);
+		if (!vl53l1_data)
+			goto done_freemem;
+		i2c_data = (struct i2c_data *)vl53l1_data->client_object;
+	}
+	i2c_data->client = client;
+	i2c_data->vl53l1_data = vl53l1_data;
+	i2c_data->irq = -1 ; /* init to no irq */
+
+	/* parse and configure hardware */
+	rc = stmvl53l1_parse_tree(&i2c_data->client->dev, i2c_data);
+	if (rc)
+		goto done_freemem;
+
+	/* setup device name */
+	/* vl53l1_data->dev_name = dev_name(&client->dev); */
+
+	/* setup client data */
+	i2c_set_clientdata(client, vl53l1_data);
+
+	/* end up by core driver setup */
+	rc = stmvl53l1_setup(vl53l1_data);
+	if (rc)
+		goto release_gpios;
+	vl53l1_dbgmsg("End\n");
+
+	kref_init(&i2c_data->ref);
+
+	return rc;
+
+release_gpios:
+	stmvl53l1_release_gpios(i2c_data);
+
+done_freemem:
+	/* kfree safe against NULL */
+	kfree(vl53l1_data);
+	kfree(i2c_data);
+
+	return -1;
+}
+
+static int stmvl53l1_remove(struct i2c_client *client)
+{
+	struct stmvl53l1_data *data = i2c_get_clientdata(client);
+	struct i2c_data *i2c_data = (struct i2c_data *)data->client_object;
+
+	vl53l1_dbgmsg("Enter\n");
+	mutex_lock(&data->work_mutex);
+	/* main driver cleanup */
+	stmvl53l1_cleanup(data);
+
+	/* release gpios */
+	stmvl53l1_release_gpios(i2c_data);
+
+	mutex_unlock(&data->work_mutex);
+
+	stmvl53l1_put(data->client_object);
+
+	vl53l1_dbgmsg("End\n");
+
+	return 0;
+}
+
+#ifdef CONFIG_PM_SLEEP
+static int stmvl53l1_suspend(struct device *dev)
+{
+	struct stmvl53l1_data *data = i2c_get_clientdata(to_i2c_client(dev));
+
+	vl53l1_dbgmsg("Enter\n");
+	mutex_lock(&data->work_mutex);
+	/* Stop ranging */
+	stmvl53l1_pm_suspend_stop(data);
+
+	mutex_unlock(&data->work_mutex);
+
+	vl53l1_dbgmsg("End\n");
+
+	return 0;
+}
+
+static int stmvl53l1_resume(struct device *dev)
+{
+#if 0
+	struct stmvl53l1_data *data = i2c_get_clientdata(to_i2c_client(dev));
+
+	vl53l1_dbgmsg("Enter\n");
+
+	mutex_lock(&data->work_mutex);
+
+	/* do nothing user will restart measurements */
+
+	mutex_unlock(&data->work_mutex);
+
+	vl53l1_dbgmsg("End\n");
+#else
+	vl53l1_dbgmsg("Enter\n");
+	vl53l1_dbgmsg("End\n");
+#endif
+	return 0;
+}
+#endif
+
+
+static SIMPLE_DEV_PM_OPS(stmvl53l1_pm_ops, stmvl53l1_suspend, stmvl53l1_resume);
+
+static const struct i2c_device_id stmvl53l1_id[] = {
+	{ STMVL53L1_DRV_NAME, 0 },
+	{ },
+};
+MODULE_DEVICE_TABLE(i2c, stmvl53l1_id);
+
+static const struct of_device_id st_stmvl53l1_dt_match[] = {
+	{ .compatible = "st,"STMVL53L1_DRV_NAME, },
+	{ },
+};
+
+static struct i2c_driver stmvl53l1_driver = {
+	.driver = {
+		.name	= STMVL53L1_DRV_NAME,
+		.owner	= THIS_MODULE,
+		.of_match_table = st_stmvl53l1_dt_match,
+		.pm	= &stmvl53l1_pm_ops,
+	},
+	.probe	= stmvl53l1_probe,
+	.remove	= stmvl53l1_remove,
+	.id_table = stmvl53l1_id,
+
+};
+
+/**
+ * give power to device
+ *
+ * @param object  the i2c layer object
+ * @return
+ */
+int stmvl53l1_power_up_i2c(void *object)
+{
+	int rc = 0;
+	struct i2c_data *data = (struct i2c_data *) object;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	/* turn on power */
+	if (data->vdd) {
+		rc = regulator_enable(data->vdd);
+		if (rc) {
+			vl53l1_errmsg("fail to turn on regulator");
+			return rc;
+		}
+	}
+    if (data->pwren_gpio != -1) {
+		gpio_set_value(data->pwren_gpio, 1);
+		vl53l1_info("slow power on");
+	} else
+		vl53l1_wanrmsg("no power control");
+
+	return rc;
+}
+
+/**
+ * remove power to device (reset it)
+ *
+ * @param i2c_object the i2c layer object
+ * @return 0 on success
+ */
+int stmvl53l1_power_down_i2c(void *i2c_object)
+{
+	struct i2c_data *data = (struct i2c_data *) i2c_object;
+	int rc = 0;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	/* turn off power */
+	if (data->vdd) {
+		rc = regulator_disable(data->vdd);
+		if (rc)
+			vl53l1_errmsg("reg disable failed. rc=%d\n",
+				rc);
+	}
+    if (data->pwren_gpio != -1) {
+		gpio_set_value(data->pwren_gpio, 0);
+	}
+	vl53l1_dbgmsg("power off");
+
+	vl53l1_dbgmsg("End\n");
+
+	return rc;
+}
+
+static int handle_i2c_address_device_change_lock(struct i2c_data *data)
+{
+	return 0;
+}
+
+/* reset release will also handle device address change. It will avoid state
+ * where multiple stm53l1 are bring out of reset at the same time with the
+ * same boot address.
+ * Note that we don't manage case where boot_reg has the same value as a final
+ * i2c address of another device. This case is not supported and will lead
+ * to unpredictable behavior.
+ */
+static int release_reset(struct i2c_data *data)
+{
+	//struct i2c_client *client = (struct i2c_client *) data->client;
+	int rc = 0;
+	bool is_address_change = false;//client->addr != data->boot_reg;//songyt modify
+
+	if (is_address_change)
+		mutex_lock(&dev_addr_change_mutex);
+    //vl53l1_dbgmsg("reset xsdn pin to 1\n");
+	gpio_set_value(data->xsdn_gpio, 1);
+	if (is_address_change) {
+		rc = handle_i2c_address_device_change_lock(data);
+		if (rc){
+			gpio_set_value(data->xsdn_gpio, 0);
+            //vl53l1_dbgmsg("reset xsdn pin to 0\n");
+        }
+	}
+
+	if (is_address_change)
+		mutex_unlock(&dev_addr_change_mutex);
+
+	return rc;
+}
+
+/**
+ * release device reset
+ *
+ * @param i2c_object the i2c layer object
+ * @return 0 on success
+ */
+int stmvl53l1_reset_release_i2c(void *i2c_object)
+{
+	int rc;
+	struct i2c_data *data = (struct i2c_data *) i2c_object;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	rc = release_reset(data);
+	if (rc)
+		goto error;
+
+	/* and now wait for device end of boot */
+	data->vl53l1_data->is_delay_allowed = true;
+	rc = VL53L1_WaitDeviceBooted(&data->vl53l1_data->stdev);
+	data->vl53l1_data->is_delay_allowed = false;
+	if (rc) {
+		gpio_set_value(data->xsdn_gpio, 0);
+		vl53l1_errmsg("boot fail with error %d,change xsdn pin to 0", rc);
+		data->vl53l1_data->last_error = rc;
+		rc = -EIO;
+	}
+
+error:
+	vl53l1_dbgmsg("End\n");
+
+	return rc;
+}
+
+/**
+ * put device under reset
+ *
+ * @param i2c_object the i2c layer object
+ * @return 0 on success
+ */
+int stmvl53l1_reset_hold_i2c(void *i2c_object)
+{
+	struct i2c_data *data = (struct i2c_data *) i2c_object;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	gpio_set_value(data->xsdn_gpio, 0);
+
+	vl53l1_dbgmsg("End\n");
+
+	return 0;
+}
+
+int stmvl53l1_init_i2c(void)
+{
+	int ret = 0;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	/* register as a i2c client device */
+	ret = i2c_add_driver(&stmvl53l1_driver);
+	if (ret)
+		vl53l1_errmsg("%d erro ret:%d\n", __LINE__, ret);
+
+	if (!ret && force_device)
+		ret = insert_device();
+
+	if (ret)
+		i2c_del_driver(&stmvl53l1_driver);
+
+	vl53l1_dbgmsg("End with rc:%d\n", ret);
+
+	return ret;
+}
+
+
+void stmvl53l1_clean_up_i2c(void)
+{
+	if (stm_test_i2c_client) {
+		vl53l1_dbgmsg("to unregister i2c client\n");
+		i2c_unregister_device(stm_test_i2c_client);
+	}
+}
+
+static irqreturn_t stmvl53l1_irq_handler_i2c(int vec, void *info)
+{
+	struct i2c_data *i2c_data = (struct i2c_data *)info;
+
+	if (i2c_data->irq == vec) {
+		modi2c_dbg("irq");
+		stmvl53l1_intr_handler(i2c_data->vl53l1_data);
+		modi2c_dbg("over");
+	} else {
+		if (!i2c_data->msg_flag.unhandled_irq_vec) {
+			modi2c_warn("unmatching vec %d != %d\n",
+					vec, i2c_data->irq);
+			i2c_data->msg_flag.unhandled_irq_vec = 1;
+		}
+	}
+
+	return IRQ_HANDLED;
+}
+
+/**
+ * enable and start intr handling
+ *
+ * @param object  our i2c_data specific object
+ * @param poll_mode [in/out] set to force mode clear to use irq
+ * @return 0 on success and set ->poll_mode if it faill ranging wan't start
+ */
+int stmvl53l1_start_intr(void *object, int *poll_mode)
+{
+	struct i2c_data *i2c_data;
+	int rc;
+
+	i2c_data = (struct i2c_data *)object;
+	/* irq and gpio acquire config done in parse_tree */
+	if (i2c_data->irq < 0) {
+		/* the i2c tree as no intr force polling mode */
+		*poll_mode = -1;
+		return 0;
+	}
+	/* clear irq warning report enabe it again for this session */
+	i2c_data->msg_flag.unhandled_irq_vec = 0;
+	/* if started do no nothing */
+	if (i2c_data->io_flag.intr_started) {
+		/* nothing to do */
+		*poll_mode = 0;
+		return 0;
+	}
+
+	vl53l1_dbgmsg("to register_irq:%d\n", i2c_data->irq);
+	rc = request_threaded_irq(i2c_data->irq, NULL,
+			stmvl53l1_irq_handler_i2c,
+			IRQF_TRIGGER_FALLING|IRQF_ONESHOT,
+			"vl53l1_interrupt",
+			(void *)i2c_data);
+	if (rc) {
+		vl53l1_errmsg("fail to req threaded irq rc=%d\n", rc);
+		*poll_mode = 0;
+	} else {
+		vl53l1_dbgmsg("irq %d now handled\n", i2c_data->irq);
+		i2c_data->io_flag.intr_started = 1;
+		*poll_mode = 0;
+	}
+	return rc;
+}
+
+void *stmvl53l1_get(void *object)
+{
+	struct i2c_data *data = (struct i2c_data *) object;
+
+	vl53l1_dbgmsg("Enter\n");
+	kref_get(&data->ref);
+	vl53l1_dbgmsg("End\n");
+
+	return object;
+}
+
+static void memory_release(struct kref *kref)
+{
+	struct i2c_data *data = container_of(kref, struct i2c_data, ref);
+
+	vl53l1_dbgmsg("Enter\n");
+	kfree(data->vl53l1_data);
+	kfree(data);
+	vl53l1_dbgmsg("End\n");
+}
+
+void stmvl53l1_put(void *object)
+{
+	struct i2c_data *data = (struct i2c_data *) object;
+
+	vl53l1_dbgmsg("Enter\n");
+	kref_put(&data->ref, memory_release);
+	vl53l1_dbgmsg("End\n");
+}
+
+void __exit stmvl53l1_exit_i2c(void *i2c_object)
+{
+	vl53l1_dbgmsg("Enter\n");
+	i2c_del_driver(&stmvl53l1_driver);
+	vl53l1_dbgmsg("End\n");
+}
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_module.c b/drivers/input/misc/vl53L1/stmvl53l1_module.c
new file mode 100644
index 0000000000000000000000000000000000000000..0c5cff49a1beb8958a15a13e838b5240d9952370
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_module.c
@@ -0,0 +1,4295 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+/**
+ * @file /stmvl53l1_module.c  vl53l1_module  ST VL53L1 linux kernel module
+ *
+ * main file
+ */
+#include <linux/uaccess.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/mutex.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/gpio.h>
+#include <linux/input.h>
+#include <linux/miscdevice.h>
+#include <linux/kernel.h>
+#include <linux/fs.h>
+#include <linux/time.h>
+#include <linux/platform_device.h>
+#include <linux/kobject.h>
+#include <linux/kthread.h>
+#include <linux/jhash.h>
+#include <linux/ctype.h>
+
+/*
+ * API includes
+ */
+
+#include "stmvl53l1.h"
+#include "cam_cci_ctrl_interface.h"
+#include "stmvl53l1-i2c.h"
+#include "stmvl53l1_ipp.h"
+
+#include "stmvl53l1_if.h" /* our device interface to user space */
+#include "stmvl53l1_internal_if.h"
+
+/*
+ * include default tuning file
+ */
+#include "stmvl53l1_tunings.h"
+
+/** @ingroup vl53l1_config
+ * @{
+ */
+/**
+ * default polling period delay in millisecond
+ *
+ * It can be set at run time via @ref vl53l1_ioctl or @ref sysfs_attrib
+ *
+ * @note apply only for device operating in polling mode only
+ */
+#define STMVL53L1_CFG_POLL_DELAY_MS	30
+
+/**
+ * default timing budget in microsecond
+ *
+ * Can be change at run time via @ref vl53l1_ioctl or @ref sysfs_attrib
+ */
+#define STMVL53L1_CFG_TIMING_BUDGET_US	30000 //songyt test 16000
+
+/** default preset ranging mode */
+//#define STMVL53L1_CFG_DEFAULT_MODE VL53L1_PRESETMODE_RANGING
+
+/** default distance mode */
+#define STMVL53L1_CFG_DEFAULT_DISTANCE_MODE	VL53L1_DISTANCEMODE_LONG
+
+/** default crosstalk enable */
+#define STMVL53L1_CFG_DEFAULT_CROSSTALK_ENABLE	0
+
+/** default output mode */
+#define STMVL53L1_CFG_DEFAULT_OUTPUT_MODE	VL53L1_OUTPUTMODE_NEAREST
+
+#define STMVL53L1_CFG_DEFAULT_OFFSET_CORRECTION_MODE \
+	VL53L1_OFFSETCORRECTIONMODE_STANDARD
+
+/** default Dmax mode */
+#define STMVL53L1_CFG_DEFAULT_DMAX_MODE		VL53L1_DMAXMODE_CUSTCAL_DATA    //VL53L1_DMAXMODE_FMT_CAL_DATA songyt
+
+/** default smudge correction enable value */
+#define STMVL53L1_CFG_DEFAULT_SMUDGE_CORRECTION_MODE \
+	VL53L1_SMUDGE_CORRECTION_NONE
+
+/** @} */ /* ingroup vl53l1_config */
+
+/** @ingroup vl53l1_mod_dbg
+ * @{
+ */
+
+/**
+ * activate dump of roi in roi ctrl operation
+ *
+ * @note uses @a vl53l1_dbgmsg for output so make sure to enable debug
+ * to get roi dump
+ */
+#define STMVL53L1_CFG_ROI_DEBUG	1       //songyt 0 to 1
+
+/** @} */ /* ingroup vl53l1_mod_dbg*/
+
+/* #define DEBUG_TIME_LOG */
+
+
+#ifdef DEBUG_TIME_LOG
+struct timeval start_tv, stop_tv;
+#endif
+
+/* Set default value to 1 to allow to see module insertion debug messages */
+int stmvl53l1_enable_debug = 1;
+
+#define VL53L1_INPUT_DEVICE_NAME	"STM VL53L1 proximity sensor"
+
+static long stmvl53l1_ioctl(struct file *file,
+		unsigned int cmd, unsigned long arg);
+static int stmvl53l1_open(struct inode *inode, struct file *file);
+static int stmvl53l1_release(struct inode *inode, struct file *file);
+static int ctrl_start(struct stmvl53l1_data *data);
+static int ctrl_stop(struct stmvl53l1_data *data);
+
+static bool force_device_on_en_default = false;//songyt change true to false
+
+module_param(force_device_on_en_default, bool, 0444);
+MODULE_PARM_DESC(force_device_on_en_default,
+	"select whether force_device_on_en is true or false by default");
+
+/* boilerplate for integer parameter */
+#define IMPLEMENT_PARAMETER_INTEGER(sysfs_name, info_name)\
+static ssize_t stmvl53l1_show_##sysfs_name(struct device *dev, \
+				struct device_attribute *attr, char *buf) \
+{ \
+	struct stmvl53l1_data *data = dev_get_drvdata(dev); \
+	int param; \
+\
+	mutex_lock(&data->work_mutex); \
+	param = data->sysfs_name; \
+	mutex_unlock(&data->work_mutex);; \
+\
+	return scnprintf(buf, PAGE_SIZE, "%d\n", param); \
+} \
+\
+static ssize_t stmvl53l1_store_##sysfs_name(struct device *dev, \
+					struct device_attribute *attr, \
+					const char *buf, size_t count) \
+{ \
+	struct stmvl53l1_data *data = dev_get_drvdata(dev); \
+	int rc; \
+	int param; \
+\
+	mutex_lock(&data->work_mutex); \
+\
+	if (kstrtoint(buf, 0, &param)) { \
+		vl53l1_errmsg("invalid syntax in %s", buf); \
+		rc = -EINVAL; \
+	} else \
+		rc = stmvl53l1_set_##sysfs_name(data, param); \
+\
+	mutex_unlock(&data->work_mutex); \
+\
+	return rc ? rc : count; \
+} \
+\
+static int ctrl_param_##sysfs_name(struct stmvl53l1_data *data, \
+		struct stmvl53l1_parameter *param) \
+{ \
+	int rc; \
+\
+	if (param->is_read) { \
+		param->value = data->sysfs_name; \
+		param->status = 0; \
+		vl53l1_dbgmsg("get " info_name " %d", param->value); \
+		rc = 0; \
+	} else { \
+		rc = stmvl53l1_set_##sysfs_name(data, param->value); \
+		vl53l1_dbgmsg("rc %d req %d now %d", rc, \
+				param->value, data->sysfs_name); \
+	} \
+\
+	return rc; \
+}
+
+/**
+ *  module interface struct
+ *  interface to platform speficic device handling , concern power/reset ...
+ */
+struct stmvl53l1_module_fn_t {
+	int (*init)(void);	/*!< init */
+	/**
+	 * clean up job
+	 * @param data module specific data ptr
+	 */
+	void (*deinit)(void *data);
+	/**
+	 *  give device power
+	 * @param data  specific module storage ptr
+	 * @return 0 on sucess
+	 */
+	int (*power_up)(void *data);
+	/**
+	 *  power down TOFO also stop intr
+	 */
+	int (*power_down)(void *data);
+	/*
+	 * release reset so device start.
+	 */
+	int (*reset_release)(void *data);
+	/*
+	 * put device under reset.
+	 */
+	int (*reset_hold)(void *data);
+
+	 /**
+	  * enable interrupt
+	  *
+	  * @param object : interface speficic ptr
+	  * @note "module specfic ptr is data->client_object
+	  * @return 0 on success else error then drievr wan't start ranging!
+	  * if no interrupt or it can't be hooked but still to operated in poll
+	  * mode then return 0  and force data->poll_mode
+	  * might have to clear poll_mode exlplcilty if to operate in real intr
+	  * mode as pool mode
+	  * is the default
+	  */
+	int (*start_intr)(void *object, int *poll_mode);
+
+	void (*clean_up)(void); /*!< optional can be void */
+
+	/* increment reference counter */
+	void *(*get)(void *object);
+
+	/* decrement reference counter and deallocate memory when zero */
+	void (*put)(void *object);
+};
+
+/** i2c module interface*/
+static struct stmvl53l1_module_fn_t stmvl53l1_module_func_tbl = {
+#ifdef USE_CAMERA_CCI
+    .init = stmvl53l1_init_cci,
+    .deinit = stmvl53l1_exit_cci,
+#else
+	.init = stmvl53l1_init_i2c,
+	.deinit = stmvl53l1_exit_i2c,
+#endif
+	.power_up = stmvl53l1_power_up_i2c,
+	.power_down = stmvl53l1_power_down_i2c,
+	.reset_release = stmvl53l1_reset_release_i2c,
+	.reset_hold = stmvl53l1_reset_hold_i2c,
+	.clean_up = stmvl53l1_clean_up_i2c,
+	.start_intr = stmvl53l1_start_intr,
+	.get = stmvl53l1_get,
+	.put = stmvl53l1_put,
+};
+static bool ipp_inited = false;
+
+
+#ifndef MIN
+#	define MIN(a, b) ((a) < (b) ? (a) : (b))
+#endif
+
+/*
+ * INPUT Subsys interface
+ */
+
+static void stmvl53l1_input_push_data(struct stmvl53l1_data *data);
+
+/*
+ * Mutex to handle device id add/removal
+ */
+static DEFINE_MUTEX(dev_table_mutex);
+
+/**
+ * in-used device LUT
+ * we need this as the message reception from netlink message can't
+ * associate directly to a device instance that is as we look up id
+ * to device data structure
+ */
+struct stmvl53l1_data *stmvl53l1_dev_table[STMVL53L1_CFG_MAX_DEV];
+
+/**
+ * Misc device device operations
+ */
+static const struct file_operations stmvl53l1_ranging_fops = {
+	.owner =		THIS_MODULE,
+	.unlocked_ioctl =	stmvl53l1_ioctl,
+	.open =			stmvl53l1_open,
+	.release =		stmvl53l1_release,
+	/* .flush =		stmvl53l0_flush, */
+};
+
+static int store_last_error(struct stmvl53l1_data *data, int rc)
+{
+	data->last_error = rc;
+
+	return -EIO;
+}
+
+static int allocate_dev_id(void)
+{
+	int i;
+
+	mutex_lock(&dev_table_mutex);
+
+	for (i = 0; i < STMVL53L1_CFG_MAX_DEV; i++)
+		if (!stmvl53l1_dev_table[i])
+			break;
+	i = i < STMVL53L1_CFG_MAX_DEV ? i : -1;
+
+	mutex_unlock(&dev_table_mutex);
+
+	return i;
+}
+
+static void deallocate_dev_id(int id)
+{
+	mutex_lock(&dev_table_mutex);
+
+	stmvl53l1_dev_table[id] = NULL;
+
+	mutex_unlock(&dev_table_mutex);
+}
+
+/* helpers to manage reader list for blockint ioctl */
+/* call them with lock */
+static void empty_and_free_list(struct list_head *head)
+{
+	struct stmvl53l1_waiters *waiter;
+	struct stmvl53l1_waiters *tmp;
+
+	list_for_each_entry_safe(waiter, tmp, head, list) {
+		list_del(&waiter->list);
+		kfree(waiter);
+	}
+}
+
+static int add_reader(pid_t pid, struct list_head *head)
+{
+	struct stmvl53l1_waiters *new_waiter;
+
+	new_waiter = kmalloc(sizeof(struct stmvl53l1_waiters), GFP_KERNEL);
+	if (!new_waiter)
+		return -ENOMEM;
+	new_waiter->pid = pid;
+	list_add(&new_waiter->list, head);
+
+	return 0;
+}
+
+static bool is_pid_in_list(pid_t pid, struct list_head *head)
+{
+	struct stmvl53l1_waiters *waiter;
+
+	list_for_each_entry(waiter, head, list)
+		if (waiter->pid == pid)
+			return true;
+
+	return false;
+}
+
+static void wake_up_data_waiters(struct stmvl53l1_data *data)
+{
+	empty_and_free_list(&data->simple_data_reader_list);
+	empty_and_free_list(&data->mz_data_reader_list);
+	wake_up(&data->waiter_for_data);
+}
+
+static void stmvl53l1_insert_flush_events_lock(struct stmvl53l1_data *data)
+{
+	while (data->flush_todo_counter) {
+		data->flushCount++;
+		input_report_abs(data->input_dev_ps, ABS_GAS, data->flushCount);
+		input_sync(data->input_dev_ps);
+		vl53l1_dbgmsg("Sensor HAL Flush Count = %u\n",
+			data->flushCount);
+		data->flush_todo_counter--;
+	}
+}
+
+static int reset_release(struct stmvl53l1_data *data)
+{
+    int rc;
+    struct camera_cci_transfer ccit;
+
+    if (!data->reset_state)
+        return 0;
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_INIT;
+    cam_cci_control_interface(&ccit);
+#endif
+
+    rc = stmvl53l1_module_func_tbl.reset_release(data->client_object);
+    if (rc){
+        vl53l1_errmsg("reset release fail rc=%d try to release cci\n", rc);
+#ifdef USE_CAMERA_CCI
+        memset(&ccit,0,sizeof(ccit));
+        ccit.cmd = CAMERA_CCI_RELEASE;
+        cam_cci_control_interface(&ccit);
+#endif
+    }else
+        data->reset_state = 0;
+
+    return rc;
+}
+
+static int reset_hold(struct stmvl53l1_data *data)
+{
+	int rc;
+    struct camera_cci_transfer ccit;
+
+	if (data->reset_state)
+		return 0;
+
+	if (data->force_device_on_en)
+		return 0;
+
+	rc = stmvl53l1_module_func_tbl.reset_hold(data->client_object);
+	if (!rc)
+		data->reset_state = 1;
+#ifdef USE_CAMERA_CCI
+    memset(&ccit,0,sizeof(ccit));
+    ccit.cmd = CAMERA_CCI_RELEASE;
+    cam_cci_control_interface(&ccit);
+#endif
+
+	return rc;
+}
+
+#ifdef DEBUG_TIME_LOG
+static void stmvl53l0_DebugTimeGet(struct timeval *ptv)
+{
+	do_gettimeofday(ptv);
+}
+
+#endif
+
+/**
+ *
+ * @param pstart_tv time val  starting point
+ * @param pstop_tv time val  end point
+ * @return time dif in usec
+ */
+long stmvl53l1_tv_dif(struct timeval *pstart_tv, struct timeval *pstop_tv)
+{
+	long total_sec, total_usec;
+
+	total_sec = pstop_tv->tv_sec - pstart_tv->tv_sec;
+	total_usec = (pstop_tv->tv_usec - pstart_tv->tv_usec);
+
+	return total_sec*1000000+total_usec;
+}
+
+#if STMVL53L1_CFG_ROI_DEBUG
+static void dump_roi(VL53L1_UserRoi_t *rois, uint32_t n)
+{
+	uint32_t i;
+
+	vl53l1_dbgmsg("roi dump %d roi:\n", n);
+	for (i = 0; i < n ; i++) {
+		vl53l1_dbgmsg("ROI#%02d %2d %2d %2d %2d\n", (int)i,
+				(int)rois[i].TopLeftX, (int)rois[i].TopLeftY,
+				(int)rois[i].BotRightX, (int)rois[i].BotRightY);
+	}
+}
+#else
+#	define dump_roi(...) (void)0
+#endif
+
+static int setup_tunings(struct stmvl53l1_data *data)
+{
+	int rc = 0;
+	int i;
+
+	for (i = 0; i < ARRAY_SIZE(tunings); i++) {
+		rc = VL53L1_SetTuningParameter(&data->stdev, tunings[i][0],
+			tunings[i][1]);
+		if (rc) {
+			rc = store_last_error(data, rc);
+			break;
+		}
+	}
+
+	return rc;
+}
+
+/**
+ *
+ * @param data device data
+ * @return non 0 if current "preset mode" is a multi zone one
+ */
+static int is_mz_mode(struct stmvl53l1_data *data)
+{
+	return data->preset_mode == VL53L1_PRESETMODE_RANGING ||
+		data->preset_mode  == VL53L1_PRESETMODE_MULTIZONES_SCANNING;
+}
+
+static void kill_mz_data(VL53L1_MultiRangingData_t *pdata)
+{
+	int i;
+
+	memset(pdata, 0, sizeof(*pdata));
+	for (i = 0; i < VL53L1_MAX_RANGE_RESULTS; i++)
+		pdata->RangeData[i].RangeStatus = VL53L1_RANGESTATUS_NONE;
+	pdata->RoiStatus = VL53L1_ROISTATUS_NOT_VALID;
+}
+
+static void stmvl53l1_setup_auto_config(struct stmvl53l1_data *data)
+{
+	/* default config is detect object below 300mm with 1s period */
+	data->auto_pollingTimeInMs = 1000;
+	data->auto_config.DetectionMode = VL53L1_DETECTION_DISTANCE_ONLY;
+	data->auto_config.IntrNoTarget = 0;
+	data->auto_config.Distance.CrossMode = VL53L1_THRESHOLD_CROSSED_LOW;
+	data->auto_config.Distance.High = 1000;
+	data->auto_config.Distance.Low = 300;
+	data->auto_config.Rate.CrossMode = VL53L1_THRESHOLD_CROSSED_LOW;
+	data->auto_config.Rate.High = 0;
+	data->auto_config.Rate.Low = 0;
+}
+
+static uint32_t stmvl53l1_compute_hash(VL53L1_RoiConfig_t *roi_cfg)
+{
+	return jhash(roi_cfg->UserRois,
+		roi_cfg->NumberOfRoi * sizeof(VL53L1_UserRoi_t),
+		roi_cfg->NumberOfRoi);
+}
+
+static int stmvl53l1_check_calibration_id(struct stmvl53l1_data *data)
+{
+	uint32_t roi_id;
+	int rc;
+
+	if (data->offset_correction_mode != VL53L1_OFFSETCORRECTIONMODE_PERZONE)
+		return 0;
+	if (data->current_roi_id == 0)
+		return 0;
+
+	roi_id = stmvl53l1_compute_hash(&data->roi_cfg);
+	rc = roi_id == data->current_roi_id ? 0 : -EINVAL;
+
+	if (rc)
+		vl53l1_errmsg(
+			"Mismatch in zone calibration data 0x%08x != 0x%08x",
+			roi_id, data->current_roi_id);
+
+	return rc;
+}
+
+/**
+ * send params to sensor
+ *
+ * @warning must be used if only stopped
+ * @param data device data
+ * @return 0 on sucess
+ */
+static int stmvl53l1_sendparams(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	/* activated  stored or last request defined mode */
+	rc = VL53L1_SetPresetMode(&data->stdev, data->preset_mode);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetPresetMode %d fail %d",
+				data->preset_mode, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	rc = VL53L1_SetXTalkCompensationEnable(&data->stdev,
+		data->crosstalk_enable);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetXTalkCompensationEnable %d fail %d",
+				data->crosstalk_enable, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* apply distance mode only in lite and standard ranging */
+	rc = VL53L1_SetDistanceMode(&data->stdev, data->distance_mode);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetDistanceMode %d fail %d",
+			data->distance_mode, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* apply timing budget */
+	rc = VL53L1_SetMeasurementTimingBudgetMicroSeconds(&data->stdev,
+			data->timing_budget);
+	if (rc) {
+		vl53l1_errmsg("SetTimingBudget %d fail %d",
+				data->timing_budget, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+	vl53l1_dbgmsg("timing budget @%d\n", data->timing_budget);
+
+	/* apply offset correction mode */
+	rc = VL53L1_SetOffsetCorrectionMode(&data->stdev,
+			data->offset_correction_mode);
+	if (rc) {
+		vl53l1_errmsg("offset correction mode %d fail %d",
+				data->offset_correction_mode, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+	vl53l1_dbgmsg("offset correction mode @%d\n",
+		data->offset_correction_mode);
+
+	/* check zone calibration vs roi */
+	rc = stmvl53l1_check_calibration_id(data);
+	if (rc)
+		goto done;
+
+	/* apply Dmax reflectance */
+	rc = VL53L1_SetDmaxReflectance(&data->stdev, data->dmax_reflectance);
+	if (rc) {
+		vl53l1_errmsg("dmax relectance %d fail %d",
+			data->dmax_reflectance, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+	vl53l1_dbgmsg("dmax reflectance @%d\n", data->dmax_reflectance);
+
+	/* apply Dmax mode */
+	rc = VL53L1_SetDmaxMode(&data->stdev, data->dmax_mode);
+	if (rc) {
+		vl53l1_errmsg("dmax mode %d fail %d", data->dmax_mode, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+	vl53l1_dbgmsg("dmax mode @%d\n", data->dmax_mode);
+
+	/* apply smudge correction enable */
+	rc =  VL53L1_SmudgeCorrectionEnable(&data->stdev,
+		data->smudge_correction_mode);
+	if (rc) {
+		vl53l1_errmsg("smudge correction mode %d fail %d",
+			data->smudge_correction_mode, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+	vl53l1_dbgmsg("smudge correction mode @%d\n",
+		data->smudge_correction_mode);
+
+	/* apply roi if any set */
+    //songyt add default range roi
+    if(data->preset_mode == VL53L1_PRESETMODE_MULTIZONES_SCANNING
+        /*|| data->preset_mode == VL53L1_PRESETMODE_RANGING*/){
+        data->roi_cfg.NumberOfRoi = 4;
+        data->roi_cfg.UserRois[0].TopLeftX = 0;
+        data->roi_cfg.UserRois[0].TopLeftY = 15;
+        data->roi_cfg.UserRois[0].BotRightX = 7;
+        data->roi_cfg.UserRois[0].BotRightY = 8;
+
+        data->roi_cfg.UserRois[1].TopLeftX = 8;
+        data->roi_cfg.UserRois[1].TopLeftY = 15;
+        data->roi_cfg.UserRois[1].BotRightX = 15;
+        data->roi_cfg.UserRois[1].BotRightY = 8;
+
+        data->roi_cfg.UserRois[2].TopLeftX = 0;
+        data->roi_cfg.UserRois[2].TopLeftY = 7;
+        data->roi_cfg.UserRois[2].BotRightX = 7;
+        data->roi_cfg.UserRois[2].BotRightY = 0;
+
+        data->roi_cfg.UserRois[3].TopLeftX = 8;
+        data->roi_cfg.UserRois[3].TopLeftY = 7;
+        data->roi_cfg.UserRois[3].BotRightX = 15;
+        data->roi_cfg.UserRois[3].BotRightY = 0;
+    }else{
+        data->roi_cfg.NumberOfRoi = 0;
+    }
+    //end
+    dump_roi(data->roi_cfg.UserRois, data->roi_cfg.NumberOfRoi);
+	if (data->roi_cfg.NumberOfRoi) {
+		rc = VL53L1_SetROI(&data->stdev, &data->roi_cfg);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_SetROI fail %d\n", rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+		vl53l1_dbgmsg("#%d custom ROI set status\n",
+				data->roi_cfg.NumberOfRoi);
+	} else {
+		vl53l1_dbgmsg("using default ROI\n");
+	}
+
+	/* set autonomous mode configuration */
+	if ((data->preset_mode == VL53L1_PRESETMODE_AUTONOMOUS) ||
+		(data->preset_mode == VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS)) {
+		rc = VL53L1_SetInterMeasurementPeriodMilliSeconds(&data->stdev,
+			data->auto_pollingTimeInMs);
+		if (rc) {
+			vl53l1_errmsg("Fail to set auto period %d\n", rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+		rc = VL53L1_SetThresholdConfig(&data->stdev,
+			&data->auto_config);
+		if (rc) {
+			vl53l1_errmsg("Fail to set auto config %d\n", rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+	}
+
+done:
+
+	return rc;
+}
+
+/**
+ * start sensor
+ *
+ * @warning must be used if only stopped
+ * @param data device data
+ * @return 0 on sucess
+ */
+static int stmvl53l1_start(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	data->is_first_irq = true;
+	data->is_data_valid = false;
+	data->is_xtalk_value_changed = false;
+    stmvl53l1_enable_pinctrl();
+    stmvl53l1_module_func_tbl.power_up(data->client_object);
+	rc = reset_release(data);
+	if (rc)
+		goto done;
+
+	/* full setup when out of reset or power up */
+	rc = VL53L1_StaticInit(&data->stdev);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_StaticInit @%d fail %d\n",
+				__LINE__, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	rc = stmvl53l1_sendparams(data);
+	if (rc)
+		goto done;
+
+	/* init the timing  */
+	do_gettimeofday(&data->start_tv);
+	data->meas.start_tv = data->start_tv;
+	/* init the ranging data => kill the previous ranging mz data */
+	kill_mz_data(&data->meas.multi_range_data);
+	/* kill the single ranging data */
+	memset(&data->meas.single_range_data, 0,
+			sizeof(VL53L1_RangingMeasurementData_t));
+
+	data->allow_hidden_start_stop = false;
+	/* kick off ranging */
+	rc = VL53L1_StartMeasurement(&data->stdev);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_StartMeasurement @%d fail %d",
+				__LINE__, rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	data->meas.cnt = 0;
+	data->meas.err_cnt = 0;
+	data->meas.err_tot = 0;
+	data->meas.poll_cnt = 0;
+	data->meas.intr = 0;
+	data->enable_sensor = 1;
+	if (data->poll_mode) {
+		/* kick off the periodical polling work */
+		schedule_delayed_work(&data->dwork,
+			msecs_to_jiffies(data->poll_delay_ms));
+	}
+done:
+	data->is_first_start_done = true;
+
+	return rc;
+}
+
+/**
+ * stop sensor
+ *
+ * work lock must be held
+ * @warning to be used if only started!
+ */
+static int stmvl53l1_stop(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	rc = VL53L1_StopMeasurement(&data->stdev);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_StopMeasurement @%d fail %d",
+				__LINE__, rc);
+		rc = store_last_error(data, rc);
+	}
+	/* put device under reset */
+	/* do we ask explicit intr stop or just use stop */
+	reset_hold(data);
+
+	data->enable_sensor = 0;
+	if (data->poll_mode) {
+		/* cancel periodical polling work */
+		cancel_delayed_work(&data->dwork);
+	}
+
+	/* if we are in ipp waiting mode then abort it */
+	stmvl53l1_ipp_stop(data);
+	/* wake up all waiters */
+	/* they will receive -ENODEV error */
+	wake_up_data_waiters(data);
+    stmvl53l1_module_func_tbl.power_down(data->client_object);
+    stmvl53l1_disable_pinctrl();
+
+	return rc;
+}
+
+/*
+ * SysFS support
+ */
+static ssize_t stmvl53l1_show_enable_ps_sensor(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+
+	return snprintf(buf, 5, "%d\n", data->enable_sensor);
+}
+
+static ssize_t stmvl53l1_store_enable_ps_sensor(struct device *dev,
+				struct device_attribute *attr, const char *buf,
+				size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int rc = 0;
+	unsigned long val;
+
+	rc = kstrtoul(buf, 10, &val);
+	if (rc) {
+		vl53l1_errmsg("enable sensor syntax in %s\n", buf);
+		return -EINVAL;
+	}
+	if (val == 1) {
+		rc = ctrl_start(data);
+	} else if (val == 0) {
+		rc = ctrl_stop(data);
+	} else {
+		//TODO: Remove this workaround after investigation
+		//see Codex - 479397 for details
+		vl53l1_dbgmsg("Unclog Input sub-system\n");
+		/* Unclog the input device sub-system */
+		input_report_abs(data->input_dev_ps, ABS_HAT0X, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT0Y, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT1X, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT1Y, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT2X, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT2Y, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT3X, -1);
+		input_report_abs(data->input_dev_ps, ABS_HAT3Y, -1);
+		input_report_abs(data->input_dev_ps, ABS_WHEEL, -1);
+		input_report_abs(data->input_dev_ps, ABS_BRAKE, -1);
+		input_report_abs(data->input_dev_ps, ABS_GAS, -1);
+		input_report_abs(data->input_dev_ps, ABS_TILT_X, -1);
+		input_report_abs(data->input_dev_ps, ABS_TILT_Y, -1);
+		input_report_abs(data->input_dev_ps, ABS_TOOL_WIDTH, -1);
+		input_report_abs(data->input_dev_ps, ABS_DISTANCE, -1);
+		input_report_abs(data->input_dev_ps, ABS_THROTTLE, -1);
+		input_report_abs(data->input_dev_ps, ABS_RUDDER, -1);
+		input_report_abs(data->input_dev_ps, ABS_MISC, -1);
+		input_report_abs(data->input_dev_ps, ABS_VOLUME,
+									-1);
+		input_sync(data->input_dev_ps);
+		vl53l1_dbgmsg("Unclog the input sub-system\n");
+		rc = 0;
+	}
+
+	vl53l1_dbgmsg("End\n");
+
+	return rc ? rc : count;
+}
+
+/**
+ * sysfs attribute "enable_ps_sensor" [rd/wr]
+ *
+ * @li read show the current enable state
+ * @li write set the new state value "0" put sensor off "1"  put it on
+ *
+ * @return  0 on success , EINVAL if fail to start
+ *
+ * @warning their's no check and assume exclusive usage of sysfs and ioctl\n
+ * Sensor will be put on/off disregard of any setup done by the ioctl channel.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(enable_ps_sensor, 0664/*S_IWUGO | S_IRUGO*/,
+		stmvl53l1_show_enable_ps_sensor,
+		stmvl53l1_store_enable_ps_sensor);
+
+static int stmvl53l1_set_poll_delay_ms(struct stmvl53l1_data *data, int delay)
+{
+	int rc = 0;
+
+	if (delay <= 0)
+		rc = -EINVAL;
+	else
+		data->poll_delay_ms = delay;
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(poll_delay_ms, "poll delay ms")
+
+/**
+ * sysfs attribute "poll_delay_ms" [rd/wr]
+ *
+ * @li read show the current polling delay in millisecond
+ * @li write set the new polling delay in millisecond
+ *
+ * @note apply only if device is in polling mode\n
+ * for best performances (minimal delay and cpu load ) set it to the device
+ * period operating period +1 millis
+
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(set_delay_ms, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_poll_delay_ms,
+				stmvl53l1_store_poll_delay_ms);
+
+/* Timing Budget */
+static int stmvl53l1_set_timing_budget(struct stmvl53l1_data *data, int timing)
+{
+	int rc = 0;
+
+	if (timing <= 0) {
+		vl53l1_errmsg("invalid timing valid %d\n", timing);
+		rc = -EINVAL;
+	} else if (data->enable_sensor) {
+		rc = VL53L1_SetMeasurementTimingBudgetMicroSeconds(&data->stdev,
+			timing);
+		if (rc) {
+			vl53l1_errmsg("SetTimingBudget %d fail %d", timing, rc);
+			rc = store_last_error(data, rc);
+		} else
+			data->timing_budget = timing;
+	} else
+		data->timing_budget = timing;
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(timing_budget, "timing budget")
+
+/**
+ * sysfs "timing_budget"  [rd/wr]
+ *
+ *  set or get the ranging timing budget in microsecond
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(timing_budget, 0660/*S_IWUGO | S_IRUGO*/,
+			stmvl53l1_show_timing_budget,
+			stmvl53l1_store_timing_budget);
+
+
+static ssize_t stmvl53l1_show_roi(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int i;
+	int n;
+
+
+	mutex_lock(&data->work_mutex);
+	if (data->roi_cfg.NumberOfRoi == 0) {
+		/* none define by user */
+		/* we could get what stored but may not even be default */
+		n = scnprintf(buf, PAGE_SIZE, "device default\n");
+	} else {
+		for (i = 0, n = 0; i < data->roi_cfg.NumberOfRoi; i++) {
+			n += scnprintf(buf+n, PAGE_SIZE-n, "%d %d %d %d%c",
+					data->roi_cfg.UserRois[i].TopLeftX,
+					data->roi_cfg.UserRois[i].TopLeftY,
+					data->roi_cfg.UserRois[i].BotRightX,
+					data->roi_cfg.UserRois[i].BotRightY,
+					i == data->roi_cfg.NumberOfRoi-1 ?
+							'\n' : ',');
+		}
+	}
+	mutex_unlock(&data->work_mutex);
+	return n;
+}
+
+
+static const char str_roi_ranging[] = "ERROR can't set roi while ranging\n";
+
+static ssize_t stmvl53l1_store_roi(struct device *dev,
+					struct device_attribute *attr,
+					const char *buf, size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	VL53L1_UserRoi_t rois[VL53L1_MAX_USER_ZONES];
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+	if (data->enable_sensor) {
+		vl53l1_errmsg(" cant set roi now\n");
+		rc = -EBUSY;
+	} else {
+		int n, n_roi = 0;
+		const char *pc = buf;
+		int tlx, tly, brx, bry;
+
+		while (n_roi < VL53L1_MAX_USER_ZONES && pc != NULL
+				&& *pc != 0 && *pc != '\n') {
+			n = sscanf(pc, "%d %d %d %d", &tlx, &tly, &brx, &bry);
+			if (n == 4) {
+				rois[n_roi].TopLeftX = tlx;
+				rois[n_roi].TopLeftY = tly;
+				rois[n_roi].BotRightX = brx;
+				rois[n_roi].BotRightY = bry;
+				n_roi++;
+			} else {
+				vl53l1_errmsg(
+"wrong roi #%d syntax around %s of %s", n_roi, pc, buf);
+				n_roi = -1;
+				break;
+			}
+			/* find next roi separator */
+			pc = strchr(pc, ',');
+			if (pc)
+				pc++;
+		}
+		/*if any set them */
+		if (n_roi >= 0) {
+			if (n_roi)
+				memcpy(data->roi_cfg.UserRois, rois,
+						n_roi*sizeof(rois[0]));
+			data->roi_cfg.NumberOfRoi = n_roi;
+			dump_roi(data->roi_cfg.UserRois,
+					data->roi_cfg.NumberOfRoi);
+			rc = count;
+		} else {
+			rc = -EINVAL;
+		}
+	}
+	mutex_unlock(&data->work_mutex);
+	vl53l1_dbgmsg("ret %d count %d\n", rc, (int)count);
+
+	return rc;
+}
+
+/**
+ * sysfs attribute "roi" [rd/wr]
+ *
+ * @li read show the current user customized roi setting
+ * @li write set user custom roi, it can only be done while not ranging.
+ *
+ * syntax for set input roi
+ * @li "[tlx tly brx bry,]\n" repeat n time require will set the n roi
+ * @li "\n" will reset
+ *
+ * @warning roi coordinate is not image x,y(down) but euclidian x,y(up)
+ *
+ * @warning roi validity is only check at next range start
+ * @warning user is responsible to set appropriate number an roi before each
+ * mode change
+ * @note roi can be return to default by setting none ""
+ *
+ *@code
+ * >#to set 2x roi
+ * >echo "0 15 15 0, 0 8 8 0" > /sys/class/input6/roi
+ * >echo $?
+ * 0
+ * >cat /sys/class/input6/roi
+ * "0 15 15 0,0 8 8 0"
+ * #to cancel user define roi"
+ * >echo "" > /sys/class/input1/roi
+ * >echo $?
+ * 0
+ * >echo "1" > /sys/class/input6/enable_ps_senspor
+ * #try to set roi while ranging
+ * >echo "0 15 15 0, 0 8 8 0" > /sys/class/input6/roi
+ * [58451.912109] stmvl53l1_store_roi:  cant set roi now
+ * >echo $?
+ * 1
+ *@endcode
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(roi, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_roi,
+				stmvl53l1_store_roi);
+
+
+static int stmvl53l1_set_preset_mode(struct stmvl53l1_data *data, int mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (mode) {
+		case VL53L1_PRESETMODE_RANGING:
+		case VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+		case VL53L1_PRESETMODE_LITE_RANGING:
+		case VL53L1_PRESETMODE_AUTONOMOUS:
+		case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+			data->preset_mode = mode;
+			vl53l1_dbgmsg("preset mode %d\n", mode);
+			break;
+		default:
+			vl53l1_errmsg("invalid mode %d\n", mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(preset_mode, "preset mode")
+
+/**
+ * sysfs attribute "mode " [rd/wr]
+ *
+ * set the mode value can only be used while: not ranging
+ * @li 1 @a VL53L1_PRESETMODE_RANGING default ranging
+ * @li 2 @a VL53L1_PRESETMODE_MULTIZONES_SCANNING multiple zone
+ * @li 3 @a VL53L1_PRESETMODE_AUTONOMOUS autonomous mode
+ * @li 4 @a VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS low Power autonomous mode
+ * @li 5 @a VL53L1_PRESETMODE_LITE_RANGING low mips ranging mode
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_preset_mode,
+				stmvl53l1_store_preset_mode);
+
+static int stmvl53l1_set_distance_mode(struct stmvl53l1_data *data,
+	int distance_mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change distance mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (distance_mode) {
+		case VL53L1_DISTANCEMODE_SHORT:
+		case VL53L1_DISTANCEMODE_MEDIUM:
+		case VL53L1_DISTANCEMODE_LONG:
+			data->distance_mode = distance_mode;
+            vl53l1_dbgmsg("distance mode %d\n",distance_mode);
+			break;
+		default:
+			vl53l1_errmsg("invalid distance mode %d\n",
+				distance_mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(distance_mode, "distance mode")
+
+/**
+ * sysfs attribute " distance mode" [rd/wr]
+ *
+ * set the distance mode value can only be used while: not ranging
+ * @li 1 @a VL53L1_DISTANCEMODE_SHORT
+ * @li 2 @a VL53L1_DISTANCEMODE_MEDIUM
+ * @li 3 @a VL53L1_DISTANCEMODE_LONG
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(distance_mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_distance_mode,
+				stmvl53l1_store_distance_mode);
+
+static int stmvl53l1_set_crosstalk_enable(struct stmvl53l1_data *data,
+	int crosstalk_enable)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change crosstalk enable while ranging\n");
+		rc = -EBUSY;
+	} else if (crosstalk_enable == 0 || crosstalk_enable == 1) {
+		data->crosstalk_enable = crosstalk_enable;
+	} else {
+		vl53l1_errmsg("invalid crosstalk enable %d\n",
+			crosstalk_enable);
+		rc = -EINVAL;
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(crosstalk_enable, "crosstalk enable")
+
+/**
+ * sysfs attribute " crosstalk enable" [rd/wr]
+ *
+ * control if crosstalk compensation is eanble or not
+ * @li 0 disable crosstalk compensation
+ * @li 1 enable crosstalk compensation
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(crosstalk_enable, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_crosstalk_enable,
+				stmvl53l1_store_crosstalk_enable);
+
+static int stmvl53l1_set_output_mode(struct stmvl53l1_data *data,
+	int output_mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change output mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (output_mode) {
+		case VL53L1_OUTPUTMODE_NEAREST:
+		case VL53L1_OUTPUTMODE_STRONGEST:
+			data->output_mode = output_mode;
+            vl53l1_dbgmsg("output mode %d\n", output_mode);
+			break;
+		default:
+			vl53l1_errmsg("invalid output mode %d\n", output_mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(output_mode, "output mode")
+
+/**
+ * sysfs attribute " output mode" [rd/wr]
+ *
+ * set the output mode value can only be used while: not ranging
+ * @li 1 @a VL53L1_OUTPUTMODE_NEAREST
+ * @li 2 @a VL53L1_OUTPUTMODE_STRONGEST
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(output_mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_output_mode,
+				stmvl53l1_store_output_mode);
+
+
+static int stmvl53l1_set_force_device_on_en(struct stmvl53l1_data *data,
+	int force_device_on_en)
+{
+	int rc;
+
+	if (force_device_on_en != 0 && force_device_on_en != 1) {
+		vl53l1_errmsg("invalid force_device_on_en mode %d\n",
+			force_device_on_en);
+		return -EINVAL;
+	}
+
+	data->force_device_on_en = force_device_on_en;
+
+	/* don't update reset if sensor is enable */
+	if (data->enable_sensor)
+		return 0;
+
+	/* ok update reset according force_device_on_en value */
+	if (force_device_on_en){
+		rc = reset_release(data);
+        vl53l1_dbgmsg("force_device_on_en.\n");
+	}else{
+        vl53l1_dbgmsg("force_device_on_en disable.\n");
+		rc = reset_hold(data);
+    }
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(force_device_on_en, "force device on enable")
+
+/**
+ * sysfs attribute " force_device_on_enable" [rd/wr]
+ *
+ * Control if device is put under reset when stopped.
+ * @li 0 feature is disable. Device is put under reset when stopped.
+ * @li 1 feature is enable. Device is not put under reset when stopped.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(force_device_on_enable, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_force_device_on_en,
+				stmvl53l1_store_force_device_on_en);
+
+static int stmvl53l1_set_offset_correction_mode(struct stmvl53l1_data *data,
+	int offset_correction_mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg(
+			"can't change offset correction mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (offset_correction_mode) {
+		case VL53L1_OFFSETCORRECTIONMODE_STANDARD:
+		case VL53L1_OFFSETCORRECTIONMODE_PERZONE:
+			data->offset_correction_mode = offset_correction_mode;
+			break;
+		default:
+			vl53l1_errmsg("invalid offset correction mode %d\n",
+				offset_correction_mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(offset_correction_mode, "offset correction mode")
+
+/**
+ * sysfs attribute " offset_correction_mode" [rd/wr]
+ *
+ * Control which offset correction is apply on result. can only be used
+ * while: not ranging
+ * @li 1 @a VL53L1_OFFSETCORRECTIONMODE_STANDARD
+ * @li 2 @a VL53L1_OFFSETCORRECTIONMODE_PERZONE
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(offset_correction_mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_offset_correction_mode,
+				stmvl53l1_store_offset_correction_mode);
+
+static ssize_t stmvl53l1_do_flush(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+
+	mutex_lock(&data->work_mutex);
+
+	data->flush_todo_counter++;
+	if (data->enable_sensor == 0)
+		stmvl53l1_insert_flush_events_lock(data);
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+}
+
+static DEVICE_ATTR(do_flush, 0660/*S_IWUGO | S_IRUGO*/,
+			NULL,
+			stmvl53l1_do_flush);
+
+static ssize_t stmvl53l1_show_enable_debug(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	return scnprintf(buf, PAGE_SIZE, "%d\n", stmvl53l1_enable_debug);
+}
+
+static ssize_t stmvl53l1_store_enable_debug(struct device *dev,
+					struct device_attribute *attr,
+					const char *buf, size_t count)
+{
+	int enable_debug;
+	int rc = 0;
+
+	if (kstrtoint(buf, 0, &enable_debug)) {
+		vl53l1_errmsg("invalid syntax in %s", buf);
+		rc = -EINVAL;
+	} else
+		stmvl53l1_enable_debug = enable_debug;
+
+	return rc ? rc : count;
+}
+
+/**
+ * sysfs attribute " debug enable" [rd/wr]
+ *
+ * dynamic control of vl53l1_dbgmsg messages. Note that in any case your code
+ * must be enable with DEBUG in stmvl53l1.h at compile time.
+ * @li 0 disable vl53l1_dbgmsg messages
+ * @li 1 enable vl53l1_dbgmsg messages
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(enable_debug, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_enable_debug,
+				stmvl53l1_store_enable_debug);
+
+static ssize_t display_FixPoint1616(char *buf, size_t size, FixPoint1616_t fix)
+{
+	uint32_t msb = fix >> 16;
+	uint32_t lsb = fix & 0xffff;
+
+	lsb = (lsb * 1000000ULL + 32768) / 65536;
+
+	return scnprintf(buf, size, "%d.%06d", msb, (uint32_t) lsb);
+}
+
+static ssize_t stmvl53l1_show_autonomous_config(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	ssize_t res = 0;
+
+	res += scnprintf(&buf[res], PAGE_SIZE, "%d %d %d %d %d %d %d ",
+		data->auto_pollingTimeInMs,
+		data->auto_config.DetectionMode,
+		data->auto_config.IntrNoTarget,
+		data->auto_config.Distance.CrossMode,
+		data->auto_config.Distance.High,
+		data->auto_config.Distance.Low,
+		data->auto_config.Rate.CrossMode);
+
+	res += display_FixPoint1616(&buf[res], PAGE_SIZE - res,
+		data->auto_config.Rate.High);
+
+	res += scnprintf(&buf[res], PAGE_SIZE - res, " ");
+
+	res += display_FixPoint1616(&buf[res], PAGE_SIZE - res,
+		data->auto_config.Rate.Low);
+
+	res += scnprintf(&buf[res], PAGE_SIZE - res, "\n");
+
+	return res;
+}
+
+static const char *parse_integer(const char *buf, int *res)
+{
+	int rc;
+
+	while (*buf == ' ')
+		buf++;
+	rc = sscanf(buf, "%d ", res);
+	if (!rc)
+		return NULL;
+
+	return strchr(buf, ' ');
+}
+
+static bool is_float_format(const char *buf, bool is_last)
+{
+	char *dot = strchr(buf, '.');
+	char *space_or_eos = strchr(buf, is_last ? '\0' : ' ');
+
+	if (!space_or_eos)
+		return !!dot;
+	if (!dot)
+		return false;
+
+	return dot < space_or_eos ? true : false;
+}
+
+static int parse_FixPoint16x16_lsb(const char *lsb_char)
+{
+	int lsb = 0;
+	int digit_nb = 0;
+
+	/* parse at most 6 digits */
+	lsb_char++;
+	while (isdigit(*lsb_char) && digit_nb < 6) {
+		lsb = lsb * 10 + (*lsb_char - '0');
+		lsb_char++;
+		digit_nb++;
+	}
+	while (digit_nb++ < 6)
+		lsb = lsb * 10;
+
+	return div64_s64(lsb * 65536ULL + 500000, 1000000);
+}
+
+/* parse next fix point value and return a pointer to next blank or newline
+ * character according to is_last parameter.
+ * parse string must have digit for integer part (something like '.125' will
+ * return an error) or an error will be return. Only the first 6 digit of the
+ * decimal part will be parsed.
+ */
+static const char *parse_FixPoint16x16(const char *buf, FixPoint1616_t *res,
+	bool is_last)
+{
+	bool is_float;
+	int msb;
+	int lsb = 0;
+	int rc;
+
+	while (*buf == ' ')
+		buf++;
+	is_float = is_float_format(buf, is_last);
+
+	/* scan msb */
+	rc = sscanf(buf, "%d ", &msb);
+	if (!rc)
+		return NULL;
+	/* then lsb if present */
+	if (is_float)
+		lsb = parse_FixPoint16x16_lsb(strchr(buf, '.'));
+	*res = (msb << 16) + lsb;
+
+	return strchr(buf, is_last ? '\0' : ' ');
+}
+
+static ssize_t stmvl53l1_store_autonomous_config(struct device *dev,
+					struct device_attribute *attr,
+					const char *buf, size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int pollingTimeInMs, DetectionMode, IntrNoTarget;
+	int d_CrossMode, d_High, d_Low;
+	int r_CrossMode;
+	FixPoint1616_t r_High, r_Low;
+	const char *buf_ori = buf;
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->enable_sensor)
+		goto busy;
+
+	buf = parse_integer(buf, &pollingTimeInMs);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &DetectionMode);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &IntrNoTarget);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &d_CrossMode);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &d_High);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &d_Low);
+	if (!buf)
+		goto invalid;
+	buf = parse_integer(buf, &r_CrossMode);
+	if (!buf)
+		goto invalid;
+	buf = parse_FixPoint16x16(buf, &r_High, false);
+	if (!buf)
+		goto invalid;
+	buf = parse_FixPoint16x16(buf, &r_Low, true);
+	if (!buf)
+		goto invalid;
+
+	data->auto_pollingTimeInMs = pollingTimeInMs;
+	data->auto_config.DetectionMode = DetectionMode;
+	data->auto_config.IntrNoTarget = IntrNoTarget;
+	data->auto_config.Distance.CrossMode = d_CrossMode;
+	data->auto_config.Distance.High = d_High;
+	data->auto_config.Distance.Low = d_Low;
+	data->auto_config.Rate.CrossMode = r_CrossMode;
+	data->auto_config.Rate.High = r_High;
+	data->auto_config.Rate.Low = r_Low;
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+busy:
+	vl53l1_errmsg("can't change config while ranging");
+	rc = -EBUSY;
+	goto error;
+
+invalid:
+	vl53l1_errmsg("invalid syntax in %s", buf_ori);
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+/**
+ * sysfs attribute " autonomous_config" [rd/wr]
+ *
+ * Will set/get autonomous configuration using sysfs.
+ *
+ * format is the following :
+ * <poll_ms> <mode> <no_target_irq> <distance_mode> <distance_low>
+ * <distance_high> <rate_mode> <rate_low> <rate_high>
+ *
+ *@code
+ * > echo "1000 1 0 0 1000 300 0 2.2 1.001" > autonomous_config
+ *@endcode
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(autonomous_config, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_autonomous_config,
+				stmvl53l1_store_autonomous_config);
+
+static ssize_t stmvl53l1_show_last_error_config(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+
+	return scnprintf(buf, PAGE_SIZE, "%d\n", data->last_error);
+}
+
+/**
+ * sysfs attribute " last_error" [rd]
+ *
+ * Will get last internal error using sysfs.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(last_error, 0440/*S_IRUGO*/,
+				stmvl53l1_show_last_error_config,
+				NULL);
+
+static ssize_t stmvl53l1_show_optical_center_config(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	ssize_t res = 0;
+
+	res += display_FixPoint1616(&buf[res], PAGE_SIZE - res,
+		data->optical_offset_x);
+	res += scnprintf(&buf[res], PAGE_SIZE - res, " ");
+	res += display_FixPoint1616(&buf[res], PAGE_SIZE - res,
+		data->optical_offset_y);
+
+	res += scnprintf(&buf[res], PAGE_SIZE - res, "\n");
+
+	return res;
+}
+
+/**
+ * sysfs attribute " optical_center" [rd]
+ *
+ * Will get optical_center using sysfs.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(optical_center, 0440/*S_IRUGO*/,
+				stmvl53l1_show_optical_center_config,
+				NULL);
+
+static int stmvl53l1_set_dmax_reflectance(struct stmvl53l1_data *data,
+	int dmax_reflectance)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg(
+			"can't change dmax reflectance while ranging\n");
+		rc = -EBUSY;
+	} else
+		data->dmax_reflectance = dmax_reflectance;
+
+	return rc;
+}
+
+static ssize_t stmvl53l1_show_dmax_reflectance(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	ssize_t res = 0;
+
+	res += display_FixPoint1616(&buf[res], PAGE_SIZE - res,
+		data->dmax_reflectance);
+
+	res += scnprintf(&buf[res], PAGE_SIZE - res, "\n");
+
+	return res;
+}
+
+static ssize_t stmvl53l1_store_dmax_reflectance(struct device *dev,
+					struct device_attribute *attr,
+					const char *buf, size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	FixPoint1616_t dmax_reflectance;
+	const char *buf_ori = buf;
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	buf = parse_FixPoint16x16(buf, &dmax_reflectance, true);
+	if (!buf)
+		goto invalid;
+	rc = stmvl53l1_set_dmax_reflectance(data, dmax_reflectance);
+	if (rc)
+		goto error;
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+invalid:
+	vl53l1_errmsg("invalid syntax in %s", buf_ori);
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+/**
+ * sysfs attribute "dmax_reflectance" [rd/wr]
+ *
+ * target reflectance use for calculate the ambient DMAX. can only be used
+ * while: not ranging
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(dmax_reflectance, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_dmax_reflectance,
+				stmvl53l1_store_dmax_reflectance);
+
+static int stmvl53l1_set_dmax_mode(struct stmvl53l1_data *data,
+	int dmax_mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change dmax mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (dmax_mode) {
+		case VL53L1_DMAXMODE_FMT_CAL_DATA:
+		case VL53L1_DMAXMODE_CUSTCAL_DATA:
+		case VL53L1_DMAXMODE_PER_ZONE_CAL_DATA:
+			data->dmax_mode = dmax_mode;
+			break;
+		default:
+			vl53l1_errmsg("invalid dmax mode %d\n", dmax_mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(dmax_mode, "dmax mode")
+
+/**
+ * sysfs attribute " dmax mode" [rd/wr]
+ *
+ * set the dmax mode value can only be used while: not ranging
+ * @li 1 @a VL53L1_DMAXMODE_FMT_CAL_DATA
+ * @li 2 @a VL53L1_DMAXMODE_CUSTCAL_DATA
+ * @li 3 @a VL53L1_DMAXMODE_PER_ZONE_CAL_DATA
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(dmax_mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_dmax_mode,
+				stmvl53l1_store_dmax_mode);
+
+static int stmvl53l1_set_tuning(struct stmvl53l1_data *data, int key,
+	int value)
+{
+	int rc;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change tuning params while ranging\n");
+		return -EBUSY;
+	}
+
+	if (data->is_calibrating) {
+		vl53l1_errmsg("can't change tuning params while calibrating\n");
+		return -EBUSY;
+	}
+
+	if (key & ~0xffff)
+		return -EINVAL;
+
+	vl53l1_dbgmsg("trying to set %d with key %d", value, key);
+
+	rc = VL53L1_SetTuningParameter(&data->stdev, key, value);
+	if (rc)
+		rc = store_last_error(data, rc);
+
+	return rc;
+}
+
+static ssize_t stmvl53l1_store_tuning(struct device *dev,
+					struct device_attribute *attr,
+					const char *buf, size_t count)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int key;
+	int value;
+	int n;
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	n = sscanf(buf, "%d %d", &key, &value);
+	if (n != 2) {
+		rc = -EINVAL;
+		goto error;
+	}
+	rc = stmvl53l1_set_tuning(data, key, value);
+	if (rc)
+		goto error;
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+/**
+ * sysfs attribute "tuning" [wr]
+ *
+ * write a tuning parameter. Two integer parameters are given. First one
+ * is a key that specify which tuning parameter is update. Other one is the
+ * value which is write.
+ *
+ * writing a tuning parameter is only allowed before the first start.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(tuning, 0220/*S_IWUGO */,
+				NULL,
+				stmvl53l1_store_tuning);
+
+static int stmvl53l1_display_tuning_key(struct stmvl53l1_data *data, char *buf,
+	int *pos, int key)
+{
+	int rc = 0;
+	int value = 0;
+	int sz;
+
+	rc = VL53L1_GetTuningParameter(&data->stdev, key, &value);
+	if (rc)
+		return 0;
+
+	sz = snprintf(&buf[*pos], PAGE_SIZE - *pos, "%d %d\n", key, value);
+	if (sz >= PAGE_SIZE - *pos)
+		return -ENOSPC; /* FIXME : another better error ? */
+
+	*pos += sz;
+
+	return 0;
+}
+
+static ssize_t stmvl53l1_show_tuning_status(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	const int max_tuning_key = 65535;
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int rc;
+	int i;
+	int pos = 0;
+
+	mutex_lock(&data->work_mutex);
+
+	for (i = 0; i < max_tuning_key; ++i) {
+		rc = stmvl53l1_display_tuning_key(data, buf, &pos, i);
+		if (rc)
+			break;
+	}
+
+	mutex_unlock(&data->work_mutex);
+
+	return rc ? rc : pos;
+}
+
+/**
+ * sysfs attribute "tuning_status" [rd]
+ *
+ * write a tuning parameter. Two integer parameters are given. First one
+ * is a key that specify which tuning parameter is update. Other one is the
+ * value which is write.
+ *
+ * writing a tuning parameter is only allowed before the first start.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(tuning_status, 0440/*S_IRUGO */,
+				stmvl53l1_show_tuning_status,
+				NULL);
+
+static int stmvl53l1_set_smudge_correction_mode(struct stmvl53l1_data *data,
+	int smudge_correction_mode)
+{
+	int rc = 0;
+
+	if (data->enable_sensor) {
+		vl53l1_errmsg("can't change smudge corr mode while ranging\n");
+		rc = -EBUSY;
+	} else {
+		switch (smudge_correction_mode) {
+		case VL53L1_SMUDGE_CORRECTION_NONE:
+		case VL53L1_SMUDGE_CORRECTION_CONTINUOUS:
+		case VL53L1_SMUDGE_CORRECTION_SINGLE:
+		case VL53L1_SMUDGE_CORRECTION_DEBUG:
+			data->smudge_correction_mode = smudge_correction_mode;
+			break;
+		default:
+			vl53l1_errmsg("invalid smudge correction mode %d\n",
+				smudge_correction_mode);
+			rc = -EINVAL;
+			break;
+		}
+	}
+
+	return rc;
+}
+
+IMPLEMENT_PARAMETER_INTEGER(smudge_correction_mode, "smudge correction mode")
+
+/**
+ * sysfs attribute " smudge_correction_mode" [rd/wr]
+ *
+ * This parameter will control if smudge correction is enable and how crosstalk
+ * values are updated.
+ * @li 0 @a VL53L1_SMUDGE_CORRECTION_NONE
+ * @li 1 @a VL53L1_SMUDGE_CORRECTION_CONTINUOUS
+ * @li 2 @a VL53L1_SMUDGE_CORRECTION_SINGLE
+ * @li 3 @a VL53L1_SMUDGE_CORRECTION_DEBUG
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(smudge_correction_mode, 0660/*S_IWUGO | S_IRUGO*/,
+				stmvl53l1_show_smudge_correction_mode,
+				stmvl53l1_store_smudge_correction_mode);
+
+static ssize_t stmvl53l1_show_is_xtalk_value_changed_config(struct device *dev,
+				struct device_attribute *attr, char *buf)
+{
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int param;
+
+	mutex_lock(&data->work_mutex);
+	param = data->is_xtalk_value_changed;
+	mutex_unlock(&data->work_mutex);
+
+	return scnprintf(buf, PAGE_SIZE, "%d\n", param);
+}
+
+/**
+ * sysfs attribute " optical_center" [rd]
+ *
+ * Will get optical_center using sysfs.
+ *
+ * @ingroup sysfs_attrib
+ */
+static DEVICE_ATTR(is_xtalk_value_changed, 0440/*S_IRUGO*/,
+				stmvl53l1_show_is_xtalk_value_changed_config,
+				NULL);
+
+static struct attribute *stmvl53l1_attributes[] = {
+	&dev_attr_enable_ps_sensor.attr,
+	&dev_attr_set_delay_ms.attr,
+	&dev_attr_timing_budget.attr,
+	&dev_attr_roi.attr,
+	&dev_attr_mode.attr,
+	&dev_attr_do_flush.attr,
+	&dev_attr_distance_mode.attr,
+	&dev_attr_crosstalk_enable.attr,
+	&dev_attr_enable_debug.attr,
+	&dev_attr_output_mode.attr,
+	&dev_attr_force_device_on_enable.attr,
+	&dev_attr_autonomous_config.attr,
+	&dev_attr_last_error.attr,
+	&dev_attr_offset_correction_mode.attr,
+	&dev_attr_optical_center.attr,
+	&dev_attr_dmax_reflectance.attr,
+	&dev_attr_dmax_mode.attr,
+	&dev_attr_tuning.attr,
+	&dev_attr_tuning_status.attr,
+	&dev_attr_smudge_correction_mode.attr,
+	&dev_attr_is_xtalk_value_changed.attr,
+	NULL
+};
+
+static const struct attribute_group stmvl53l1_attr_group = {
+	.attrs = stmvl53l1_attributes,
+};
+
+static ssize_t stmvl53l1_calib_data_read(struct file *filp,
+	struct kobject *kobj, struct bin_attribute *attr,
+	char *buf, loff_t off, size_t count)
+{
+	struct device *dev = container_of(kobj, struct device, kobj);
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	VL53L1_CalibrationData_t calib;
+	int rc;
+	void *src = (void *) &calib;
+
+	mutex_lock(&data->work_mutex);
+
+	vl53l1_dbgmsg("off = %lld / count = %d", off, count);
+
+	/* sanity check */
+	if (off < 0 || off >= sizeof(VL53L1_CalibrationData_t))
+		goto invalid;
+
+	/* got current calibration data */
+	memset(&calib, 0, sizeof(calib));
+	rc = VL53L1_GetCalibrationData(&data->stdev, &calib);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetCalibrationData fail %d", rc);
+		rc = store_last_error(data, rc);
+		goto error;
+	}
+
+	/* copy to buffer */
+	if (off + count > sizeof(VL53L1_CalibrationData_t))
+		count = sizeof(VL53L1_CalibrationData_t) - off;
+	memcpy(buf, src + off, count);
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+invalid:
+	vl53l1_errmsg("invalid syntax");
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static ssize_t stmvl53l1_calib_data_write(struct file *filp,
+	struct kobject *kobj, struct bin_attribute *attr,
+	char *buf, loff_t off, size_t count)
+{
+	struct device *dev = container_of(kobj, struct device, kobj);
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	vl53l1_dbgmsg("off = %lld / count = %d", off, count);
+
+	if (data->enable_sensor) {
+		rc = -EBUSY;
+		vl53l1_errmsg("can't set calib data while ranging\n");
+		goto error;
+	}
+
+	/* we only support one time write */
+	if (off != 0 || count != sizeof(VL53L1_CalibrationData_t))
+		goto invalid;
+
+	rc = VL53L1_SetCalibrationData(&data->stdev,
+		(VL53L1_CalibrationData_t *) buf);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetCalibrationData fail %d", rc);
+		rc = store_last_error(data, rc);
+		goto error;
+	}
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+invalid:
+	vl53l1_errmsg("invalid syntax");
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static struct bin_attribute stmvl53l1_calib_data_attr = {
+	.attr = {
+		.name = "calibration_data",
+		.mode = 0660/*S_IWUGO | S_IRUGO*/,
+	},
+	.size = sizeof(VL53L1_CalibrationData_t),
+	.read = stmvl53l1_calib_data_read,
+	.write = stmvl53l1_calib_data_write,
+};
+
+static ssize_t stmvl53l1_zone_calib_data_read(struct file *filp,
+	struct kobject *kobj, struct bin_attribute *attr,
+	char *buf, loff_t off, size_t count)
+{
+	struct device *dev = container_of(kobj, struct device, kobj);
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int rc;
+	void *src = (void *) &data->calib.data;
+
+	mutex_lock(&data->work_mutex);
+
+	vl53l1_dbgmsg("off = %lld / count = %d", off, count);
+
+	/* sanity check */
+	if (off < 0 || off >= sizeof(stmvl531_zone_calibration_data_t))
+		goto invalid;
+
+	/* got current zone calibration data */
+	rc = VL53L1_GetZoneCalibrationData(&data->stdev,
+		&data->calib.data.data);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetZoneCalibrationData fail %d", rc);
+		rc = store_last_error(data, rc);
+		goto error;
+	}
+	data->calib.data.id = data->current_roi_id;
+
+	/* copy to buffer */
+	if (off + count > sizeof(stmvl531_zone_calibration_data_t))
+		count = sizeof(stmvl531_zone_calibration_data_t) - off;
+	memcpy(buf, src + off, count);
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+invalid:
+	vl53l1_errmsg("invalid syntax");
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static ssize_t stmvl53l1_zone_calib_data_write(struct file *filp,
+	struct kobject *kobj, struct bin_attribute *attr,
+	char *buf, loff_t off, size_t count)
+{
+	struct device *dev = container_of(kobj, struct device, kobj);
+	struct stmvl53l1_data *data = dev_get_drvdata(dev);
+	int rc;
+	void *dst = &data->calib.data;
+
+	mutex_lock(&data->work_mutex);
+
+	vl53l1_dbgmsg("off = %lld / count = %d", off, count);
+
+	/* implementation if quite fragile. We suppose successive access. We
+	 * trigger set on last byte write if amount is exact.
+	 */
+	if (off < 0 || off >= sizeof(stmvl531_zone_calibration_data_t))
+		goto invalid;
+	if (off + count > sizeof(stmvl531_zone_calibration_data_t))
+		goto invalid;
+
+	memcpy(dst + off, buf, count);
+	if (off + count == sizeof(stmvl531_zone_calibration_data_t)) {
+		vl53l1_dbgmsg("trigger zone calib setting");
+		rc = VL53L1_SetZoneCalibrationData(&data->stdev,
+			&data->calib.data.data);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_SetZoneCalibrationData fail %d",
+				rc);
+		rc = store_last_error(data, rc);
+		goto error;
+		}
+		data->current_roi_id = data->calib.data.id;
+	}
+
+	mutex_unlock(&data->work_mutex);
+
+	return count;
+
+invalid:
+	vl53l1_errmsg("invalid syntax");
+	rc = -EINVAL;
+	goto error;
+
+error:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static struct bin_attribute stmvl53l1_zone_calib_data_attr = {
+	.attr = {
+		.name = "zone_calibration_data",
+		.mode = 0660/*S_IWUGO | S_IRUGO*/,
+	},
+	.size = sizeof(stmvl531_zone_calibration_data_t),
+	.read = stmvl53l1_zone_calib_data_read,
+	.write = stmvl53l1_zone_calib_data_write,
+};
+
+static int ctrl_reg_access(struct stmvl53l1_data *data, void *p)
+{
+	struct stmvl53l1_register reg;
+	size_t total_byte;
+	int rc;
+
+	if (data->is_device_remove)
+		return -ENODEV;
+
+	total_byte = offsetof(struct stmvl53l1_register, data.b);
+	if (copy_from_user(&reg, p, total_byte)) {
+		vl53l1_errmsg("%d, fail\n", __LINE__);
+		return -EFAULT;
+	}
+
+	if (reg.cnt > STMVL53L1_MAX_CCI_XFER_SZ) {
+		vl53l1_errmsg("reg len %d > size limit\n", reg.cnt);
+		return -EINVAL;
+	}
+
+	total_byte = offsetof(struct stmvl53l1_register, data.bytes[reg.cnt]);
+	/* for write get the effective data part of the structure */
+	if (!reg.is_read) {
+		if (copy_from_user(&reg, p, total_byte)) {
+			vl53l1_errmsg(" data cpy fail\n");
+			return -EFAULT;
+		}
+	}
+
+	/* put back to user only needed amount of data */
+	if (!reg.is_read) {
+		rc = VL53L1_WriteMulti(&data->stdev, (uint16_t)reg.index,
+				reg.data.bytes, reg.cnt);
+		reg.status = rc;
+		/* for write only write back status no data */
+		total_byte = offsetof(struct stmvl53l1_register, data.b);
+		vl53l1_dbgmsg("wr %x %d bytes statu %d\n",
+				reg.index, reg.cnt, rc);
+		if (rc)
+			rc = store_last_error(data, rc);
+	} else {
+		rc = VL53L1_ReadMulti(&data->stdev, (uint16_t)reg.index,
+				reg.data.bytes, reg.cnt);
+		reg.status = rc;
+		vl53l1_dbgmsg("rd %x %d bytes status %d\n",
+				reg.index, reg.cnt, rc);
+		/*  if fail do not copy back data only status */
+		if (rc) {
+			total_byte = offsetof(struct stmvl53l1_register,
+					data.b);
+			rc = store_last_error(data, rc);
+		}
+		/* else the total byte is already the full pay-load with data */
+	}
+
+	if (copy_to_user(p, &reg, total_byte)) {
+		vl53l1_errmsg("%d, fail\n", __LINE__);
+		return -EFAULT;
+	}
+	return rc;
+}
+
+
+/*
+ *
+ */
+static int ctrl_start(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+
+	vl53l1_dbgmsg(" state = %d\n", data->enable_sensor);
+
+	/* turn on tof sensor only if it's not already started */
+	if (data->enable_sensor == 0 && !data->is_calibrating) {
+		/* to start */
+		rc = stmvl53l1_start(data);
+	} else{
+		rc = -EBUSY;
+	}
+	vl53l1_dbgmsg(" final state = %d\n", data->enable_sensor);
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+/**
+ * no lock version of ctrl_stop (mutex shall be held)
+ *
+ * @warning exist only for use in device exit to ensure "locked and started"
+ * may also beuse in soem erro handling when mutex is already locked
+ * @return 0 on success and was running >0 if already off <0 on error
+ */
+static int _ctrl_stop(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	vl53l1_dbgmsg("enter state = %d\n", data->enable_sensor);
+	/* be sure waiters are woken */
+	data->is_data_valid = true;
+	/* turn on tof sensor only if it's not enabled by other	client */
+	if (data->enable_sensor == 1) {
+		/* to stop */
+		rc = stmvl53l1_stop(data);
+	} else {
+		vl53l1_dbgmsg("already off did nothing\n");
+		rc = 0;
+	}
+	stmvl53l1_insert_flush_events_lock(data);
+	vl53l1_dbgmsg("	final state = %d\n", data->enable_sensor);
+
+	return rc;
+}
+
+/**
+ * get work lock and stop sensor
+ *
+ * see @ref _ctrl_stop
+ *
+ * @param data device
+ * @return 0 on success EBUSY if arleady off
+ */
+static int ctrl_stop(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	if (data->enable_sensor)
+		rc = _ctrl_stop(data);
+	else
+		rc = -EBUSY;
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_getdata(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	rc = copy_to_user(p,
+		&data->meas.single_range_data,
+		sizeof(stmvl531_range_data_t));
+	if (rc) {
+		vl53l1_dbgmsg("copy to user fail %d", rc);
+		rc = -EFAULT;
+	}
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static bool is_new_data_for_me(struct stmvl53l1_data *data, pid_t pid,
+	struct list_head *head)
+{
+	return data->is_data_valid && !is_pid_in_list(pid, head);
+}
+
+static bool sleep_for_data_condition(struct stmvl53l1_data *data, pid_t pid,
+	struct list_head *head)
+{
+	bool res;
+
+	mutex_lock(&data->work_mutex);
+	res = is_new_data_for_me(data, pid, head);
+	mutex_unlock(&data->work_mutex);
+
+	return res;
+}
+
+static int sleep_for_data(struct stmvl53l1_data *data, pid_t pid,
+				struct list_head *head)
+{
+	int rc;
+
+	mutex_unlock(&data->work_mutex);
+    if(data->preset_mode == VL53L1_PRESETMODE_LITE_RANGING){
+    	rc = wait_event_killable(data->waiter_for_data,
+			sleep_for_data_condition(data, pid, head));
+    }else{
+    	rc = wait_event_killable_timeout(data->waiter_for_data,
+			sleep_for_data_condition(data, pid, head),HZ);//songyt change to timeoutable.1 second.
+    }
+	mutex_lock(&data->work_mutex);
+
+	return data->enable_sensor ? rc : -ENODEV;
+}
+
+static int ctrl_getdata_blocking(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc = 0;
+	pid_t pid = current->pid;
+
+	mutex_lock(&data->work_mutex);
+	/* If device not ranging then exit on error */
+	if (data->is_device_remove || !data->enable_sensor) {
+		rc = -ENODEV;
+		goto done;
+	}
+	/* sleep if data already read */
+	if (!is_new_data_for_me(data, pid, &data->simple_data_reader_list))
+		rc = sleep_for_data(data, pid, &data->simple_data_reader_list);
+	if (rc)
+		goto done;
+
+	/* unless we got interrupted we return data to user and note read */
+	rc = copy_to_user(p, &data->meas.single_range_data,
+		sizeof(stmvl531_range_data_t));
+	if (rc)
+		goto done;
+	rc = add_reader(pid, &data->simple_data_reader_list);
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_mz_data_common(struct stmvl53l1_data *data, void __user *p,
+	bool is_additional)
+{
+	struct stmvl53l1_data_with_additional __user *d = p;
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	rc = copy_to_user(&d->data, &data->meas.multi_range_data,
+		sizeof(VL53L1_MultiRangingData_t));
+	if (rc) {
+		vl53l1_dbgmsg("copy to user fail %d", rc);
+		rc = -EFAULT;
+		goto done;
+	}
+	if (is_additional) {
+		rc = copy_to_user(&d->additional_data,
+			&data->meas.additional_data,
+			sizeof(VL53L1_AdditionalData_t));
+		if (rc) {
+			vl53l1_dbgmsg("copy to user fail %d", rc);
+			rc = -EFAULT;
+			goto done;
+		}
+	}
+	if (!data->enable_sensor)
+		rc = -ENODEV;
+	else if (!is_mz_mode(data))
+		rc = -ENOEXEC;
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_mz_data_blocking_common(struct stmvl53l1_data *data,
+	void __user *p, bool is_additional)
+{
+	int rc = 0;
+	struct stmvl53l1_data_with_additional __user *d = p;
+	pid_t pid = current->pid;
+
+	mutex_lock(&data->work_mutex);
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	/* mode 2 or 3 */
+	if (!is_mz_mode(data)) {
+		rc = -ENOEXEC;
+		goto done;
+	}
+	/* If device not ranging then exit on error */
+	if (!data->enable_sensor) {
+		rc = -ENODEV;
+		goto done;
+	}
+	/* sleep if data already read */
+	if (!is_new_data_for_me(data, pid, &data->mz_data_reader_list))
+		rc = sleep_for_data(data, pid, &data->mz_data_reader_list);//songyt test
+	if (rc)
+		goto done;
+
+	/* unless we got interrupted we return data to user and note read */
+	rc = copy_to_user(&d->data, &data->meas.multi_range_data,
+		sizeof(VL53L1_MultiRangingData_t));
+	if (rc)
+		goto done;
+	if (is_additional) {
+		rc = copy_to_user(&d->additional_data,
+			&data->meas.additional_data,
+			sizeof(VL53L1_AdditionalData_t));
+		if (rc)
+			goto done;
+	}
+	rc = add_reader(pid, &data->mz_data_reader_list);
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+/**
+ * Get multi zone data
+ * @param data
+ * @param p [out] user ptr to @ref VL53L1_MultiRangingData_t structure\n
+ *  is always set but on EFAULT error
+ *
+ * @return
+ * @li 0 on success
+ * @li ENODEV if not ranging
+ * @li ENOEXEC not in multi zone mode
+ * @li EFAULT  copy to user error
+ */
+static int ctrl_mz_data(struct stmvl53l1_data *data, void __user *p)
+{
+	return ctrl_mz_data_common(data, p, false);
+}
+
+static int ctrl_mz_data_blocking(struct stmvl53l1_data *data, void __user *p)
+{
+	return ctrl_mz_data_blocking_common(data, p, false);
+}
+
+/**
+ * Get multi zone data with histogram debug data
+ * @param data
+ * @param p [out] user ptr to @ref struct stmvl53l1_data_with_additional
+ * structure is always set but on EFAULT error
+ *
+ * @return
+ * @li 0 on success
+ * @li ENODEV if not ranging
+ * @li ENOEXEC not in multi zone mode
+ * @li EFAULT  copy to user error
+ */
+static int ctrl_mz_data_additional(struct stmvl53l1_data *data, void __user *p)
+{
+	return ctrl_mz_data_common(data, p, true);
+}
+
+static int ctrl_mz_data_blocking_additional(struct stmvl53l1_data *data,
+	void __user *p)
+{
+	return ctrl_mz_data_blocking_common(data, p, true);
+}
+
+static int ctrl_param_last_error(struct stmvl53l1_data *data,
+		struct stmvl53l1_parameter *param)
+{
+	int rc;
+
+	if (param->is_read) {
+		param->value = data->last_error;
+		param->status = 0;
+		vl53l1_dbgmsg("get last error %d", param->value);
+		rc = 0;
+	} else {
+		rc = -EINVAL;
+	}
+
+	return rc;
+}
+
+static int ctrl_param_optical_center(struct stmvl53l1_data *data,
+		struct stmvl53l1_parameter *param)
+{
+	if (!param->is_read)
+		return -EINVAL;
+
+	param->value = data->optical_offset_x;
+	param->value2 = data->optical_offset_y;
+
+	return 0;
+}
+
+static int ctrl_param_dmax_reflectance(struct stmvl53l1_data *data,
+		struct stmvl53l1_parameter *param)
+{
+	int rc;
+
+	if (param->is_read) {
+		param->value = data->dmax_reflectance;
+		param->status = 0;
+		vl53l1_dbgmsg("get dmax reflectance %d", param->value);
+		rc = 0;
+	} else {
+		rc = stmvl53l1_set_dmax_reflectance(data, param->value);
+		vl53l1_dbgmsg("rc %d req %d now %d", rc,
+				param->value, data->dmax_reflectance);
+	}
+
+	return rc;
+}
+
+static int ctrl_param_tuning(struct stmvl53l1_data *data,
+		struct stmvl53l1_parameter *param)
+{
+	if (param->is_read)
+		return -EINVAL;
+
+	return stmvl53l1_set_tuning(data, param->value, param->value2);
+}
+
+static int ctrl_param_is_xtalk_value_changed(struct stmvl53l1_data *data,
+		struct stmvl53l1_parameter *param)
+{
+	if (!param->is_read)
+		return -EINVAL;
+
+	param->value = data->is_xtalk_value_changed;
+
+	return 0;
+}
+
+/**
+ * handle ioctl set param mode
+ *
+ * @param data
+ * @param p
+ * @return 0 on success
+ */
+static int ctrl_params(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc, rc2;
+	struct stmvl53l1_parameter param;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	rc = copy_from_user(&param, p, sizeof(param));
+	param.status = 0;
+	if (rc) {
+		rc = -EFAULT;
+		goto done; /* no need for status in user struct */
+	}
+	switch (param.name) {
+	case VL53L1_POLLDELAY_PAR:
+		rc = ctrl_param_poll_delay_ms(data, &param);
+		break;
+	case VL53L1_TIMINGBUDGET_PAR:
+		rc = ctrl_param_timing_budget(data, &param);
+		break;
+	case VL53L1_DEVICEMODE_PAR:
+		rc = ctrl_param_preset_mode(data, &param);
+	break;
+	case VL53L1_DISTANCEMODE_PAR:
+		rc = ctrl_param_distance_mode(data, &param);
+	break;
+	case VL53L1_XTALKENABLE_PAR:
+		rc = ctrl_param_crosstalk_enable(data, &param);
+	break;
+	case VL53L1_OUTPUTMODE_PAR:
+		rc = ctrl_param_output_mode(data, &param);
+	break;
+	case VL53L1_FORCEDEVICEONEN_PAR:
+		rc = ctrl_param_force_device_on_en(data, &param);
+	break;
+	case VL53L1_LASTERROR_PAR:
+		rc = ctrl_param_last_error(data, &param);
+	break;
+	case VL53L1_OFFSETCORRECTIONMODE_PAR:
+		rc = ctrl_param_offset_correction_mode(data, &param);
+	break;
+	case VL53L1_OPTICALCENTER_PAR:
+		rc = ctrl_param_optical_center(data, &param);
+	break;
+	case VL53L1_DMAXREFLECTANCE_PAR:
+		rc = ctrl_param_dmax_reflectance(data, &param);
+	break;
+	case VL53L1_DMAXMODE_PAR:
+		rc = ctrl_param_dmax_mode(data, &param);
+	break;
+	case VL53L1_TUNING_PAR:
+		rc = ctrl_param_tuning(data, &param);
+		break;
+	case VL53L1_SMUDGECORRECTIONMODE_PAR:
+		rc = ctrl_param_smudge_correction_mode(data, &param);
+	break;
+	case VL53L1_ISXTALKVALUECHANGED_PAR:
+		rc = ctrl_param_is_xtalk_value_changed(data, &param);
+	break;
+	default:
+		vl53l1_errmsg("unknown or unsupported %d\n", param.name);
+		rc = -EINVAL;
+	}
+	/* copy back (status at least ) to user */
+	if (param.is_read  && rc == 0) {
+		rc2 = copy_to_user(p, &param, sizeof(param));
+		if (rc2) {
+			rc = -EFAULT; /* kill prev status if that fail */
+			vl53l1_errmsg("copy to user fail %d\n", rc);
+		}
+	}
+done:
+	mutex_unlock(&data->work_mutex);
+	return rc;
+}
+
+/**
+ * implement set/get roi ioctl
+ * @param data device
+ * @param p user space ioctl arg ptr
+ * @return 0 on success <0 errno code
+ *	@li -EINVAL invalid number of roi
+ *	@li -EBUSY when trying to set roi while ranging
+ *	@li -EFAULT if cpy to/fm user fail for requested number of roi
+ */
+static int ctrl_roi(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc;
+	int roi_cnt;
+	struct stmvl53l1_roi_full_t rois;
+
+	mutex_lock(&data->work_mutex);
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	/* copy fixed part of args at first */
+	rc = copy_from_user(&rois, p,
+			offsetof(struct stmvl53l1_roi_full_t,
+					roi_cfg.UserRois[0]));
+	if (rc) {
+		rc = -EFAULT;
+		goto done;
+	}
+	/* check no of roi limit is ok */
+	roi_cnt = rois.roi_cfg.NumberOfRoi;
+	if (roi_cnt > VL53L1_MAX_USER_ZONES) {
+		vl53l1_errmsg("invalid roi spec cnt=%d > %d",
+				rois.roi_cfg.NumberOfRoi,
+				VL53L1_MAX_USER_ZONES);
+		rc = -EINVAL;
+		goto done;
+	}
+
+	if (rois.is_read) {
+		int cpy_size;
+
+		roi_cnt = MIN(rois.roi_cfg.NumberOfRoi,
+				data->roi_cfg.NumberOfRoi);
+		cpy_size = offsetof(VL53L1_RoiConfig_t, UserRois[roi_cnt]);
+		/* copy from local to user only effective part requested */
+		rc = copy_to_user(&((struct stmvl53l1_roi_full_t *)p)->roi_cfg,
+			&data->roi_cfg, cpy_size);
+		vl53l1_dbgmsg("return %d of %d\n", roi_cnt,
+				data->roi_cfg.NumberOfRoi);
+	} else {
+		/* SET check cnt roi is ok */
+		if (data->enable_sensor) {
+			rc = -EBUSY;
+			vl53l1_errmsg("can't set roi while ranging\n");
+			goto done;
+		}
+		/* get full data that  required from user */
+		rc = copy_from_user(&rois, p,
+					offsetof(struct stmvl53l1_roi_full_t,
+						roi_cfg.UserRois[roi_cnt]));
+		if (rc) {
+			vl53l1_errmsg("get %d roi fm user fail", roi_cnt);
+			rc = -EFAULT;
+			goto done;
+		}
+		dump_roi(data->roi_cfg.UserRois, data->roi_cfg.NumberOfRoi);
+		/* we may ask ll driver to check but check is mode dependent
+		 * and so we could get erroneous error back
+		 */
+		memcpy(&data->roi_cfg, &rois.roi_cfg, sizeof(data->roi_cfg));
+	}
+done:
+	mutex_unlock(&data->work_mutex);
+	return rc;
+}
+
+static int ctrl_autonomous_config(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc = 0;
+	struct stmvl53l1_autonomous_config_t full;
+
+	mutex_lock(&data->work_mutex);
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	/* first copy all data */
+	rc = copy_from_user(&full, p, sizeof(full));
+	if (rc) {
+		rc = -EFAULT;
+		goto done;
+	}
+
+	if (full.is_read) {
+		full.pollingTimeInMs = data->auto_pollingTimeInMs;
+		full.config = data->auto_config;
+		rc = copy_to_user(p, &full, sizeof(full));
+		if (rc)
+			rc = -EFAULT;
+	} else {
+		if (data->enable_sensor) {
+			rc = -EBUSY;
+			vl53l1_errmsg("can't change config while ranging\n");
+			goto done;
+		}
+		data->auto_pollingTimeInMs = full.pollingTimeInMs;
+		data->auto_config = full.config;
+	}
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_calibration_data(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc;
+	struct stmvl53l1_ioctl_calibration_data_t calib;
+	int data_offset = offsetof(struct stmvl53l1_ioctl_calibration_data_t,
+					data);
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	rc = copy_from_user(&calib, p, data_offset);
+	if (rc) {
+		vl53l1_errmsg("fail to detect read or write %d", rc);
+		rc = -EFAULT;
+		goto done;
+	}
+
+	if (calib.is_read) {
+		memset(&calib.data, 0, sizeof(calib.data));
+		rc = VL53L1_GetCalibrationData(&data->stdev, &calib.data);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_GetCalibrationData fail %d", rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+		rc = copy_to_user(p + data_offset, &calib.data,
+			sizeof(calib.data));
+	} else {
+		if (data->enable_sensor) {
+			rc = -EBUSY;
+			vl53l1_errmsg("can't set calib data while ranging\n");
+			goto done;
+		}
+		rc = copy_from_user(&calib.data, p + data_offset,
+			sizeof(calib.data));
+		if (rc) {
+			vl53l1_errmsg("fail to copy calib data");
+			rc = -EFAULT;
+			goto done;
+		}
+		rc = VL53L1_SetCalibrationData(&data->stdev, &calib.data);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_SetCalibrationData fail %d", rc);
+			rc = store_last_error(data, rc);
+		}
+	}
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_zone_calibration_data(struct stmvl53l1_data *data,
+	void __user *p)
+{
+	int rc;
+	struct stmvl53l1_ioctl_zone_calibration_data_t *calib;
+	int data_offset =
+		offsetof(struct stmvl53l1_ioctl_zone_calibration_data_t, data);
+
+	mutex_lock(&data->work_mutex);
+
+	calib = &data->calib;
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	rc = copy_from_user(calib, p, data_offset);
+	if (rc) {
+		vl53l1_errmsg("fail to detect read or write %d", rc);
+		rc = -EFAULT;
+		goto done;
+	}
+
+	if (calib->is_read) {
+		memset(&calib->data, 0, sizeof(calib->data));
+		rc = VL53L1_GetZoneCalibrationData(&data->stdev,
+			&calib->data.data);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_GetZoneCalibrationData fail %d",
+				rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+		calib->data.id = data->current_roi_id;
+		rc = copy_to_user(p + data_offset, &calib->data,
+			sizeof(calib->data));
+	} else {
+		if (data->enable_sensor) {
+			rc = -EBUSY;
+			vl53l1_errmsg("can't set calib data while ranging\n");
+			goto done;
+		}
+		rc = copy_from_user(&calib->data, p + data_offset,
+			sizeof(calib->data));
+		if (rc) {
+			vl53l1_errmsg("fail to copy calib data");
+			rc = -EFAULT;
+			goto done;
+		}
+		rc = VL53L1_SetZoneCalibrationData(&data->stdev,
+			&calib->data.data);
+		if (rc) {
+			vl53l1_errmsg("VL53L1_SetZoneCalibrationData fail %d",
+				rc);
+			rc = store_last_error(data, rc);
+			goto done;
+		}
+		data->current_roi_id = calib->data.id;
+	}
+
+done:
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int ctrl_perform_calibration_ref_spad_lock(struct stmvl53l1_data *data,
+	struct stmvl53l1_ioctl_perform_calibration_t *calib)
+{
+	int rc = VL53L1_PerformRefSpadManagement(&data->stdev);
+
+	if (rc) {
+		vl53l1_errmsg("VL53L1_PerformRefSpadManagement fail => %d", rc);
+		rc = store_last_error(data, rc);
+	}
+
+	return rc;
+}
+
+static int ctrl_perform_calibration_crosstalk_lock(struct stmvl53l1_data *data,
+	struct stmvl53l1_ioctl_perform_calibration_t *calib)
+{
+	int rc = 0;
+
+	rc = stmvl53l1_sendparams(data);
+	if (rc)
+		goto done;
+
+	rc = VL53L1_PerformXTalkCalibration(&data->stdev, calib->param1);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_PerformXTalkCalibration fail => %d", rc);
+		rc = store_last_error(data, rc);
+	}
+
+done:
+		return rc;
+}
+
+static int ctrl_perform_zone_calibration_offset_lock(
+	struct stmvl53l1_data *data,
+	struct stmvl53l1_ioctl_perform_calibration_t *calib)
+{
+	int rc;
+
+	/* first sanity check */
+	if (calib->param1 != VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE) {
+		vl53l1_errmsg("invalid param1");
+		rc = -EINVAL;
+		goto done;
+	}
+
+	/* setup offset calibration mode */
+	rc = VL53L1_SetOffsetCalibrationMode(&data->stdev, calib->param1);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetOffsetCalibrationMode fail => %d", rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* set mode to multi zone to allow roi settings */
+	rc = VL53L1_SetPresetMode(&data->stdev,
+		VL53L1_PRESETMODE_MULTIZONES_SCANNING);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetPresetMode fail => %d", rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* setup roi */
+	rc = VL53L1_SetROI(&data->stdev, &data->roi_cfg);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetROI fail => %d", rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* finally perform calibration */
+	/* allow delay add after stop in VL53L1_run_<offset|zone>_calibration */
+	data->is_delay_allowed = 1;
+	rc = VL53L1_PerformOffsetCalibration(&data->stdev, calib->param2,
+		calib->param3);
+	data->is_delay_allowed = 0;
+	if (rc) {
+		vl53l1_errmsg("VL53L1_PerformOffsetCalibration fail => %d", rc);
+		rc = store_last_error(data, rc);
+	}
+
+	/* save roi hash for later use */
+	data->current_roi_id = stmvl53l1_compute_hash(&data->roi_cfg);
+
+done:
+	return rc;
+}
+
+static int ctrl_perform_calibration_offset_lock(struct stmvl53l1_data *data,
+	struct stmvl53l1_ioctl_perform_calibration_t *calib)
+{
+	int rc;
+
+	/* for legacy purpose we still support mz */
+	if (calib->param1 == VL53L1_OFFSETCALIBRATIONMODE_MULTI_ZONE)
+		return ctrl_perform_zone_calibration_offset_lock(data, calib);
+
+	/* setup offset calibration mode */
+	rc = VL53L1_SetOffsetCalibrationMode(&data->stdev, calib->param1);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_SetOffsetCalibrationMode fail => %d", rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	/* finally perform calibration */
+	/* allow delay add after stop in VL53L1_run_<offset|zone>_calibration */
+	data->is_delay_allowed = 1;
+	rc = VL53L1_PerformOffsetCalibration(&data->stdev, calib->param2,
+		calib->param3);
+	data->is_delay_allowed = 0;
+	if (rc) {
+		vl53l1_errmsg("VL53L1_PerformOffsetCalibration fail => %d", rc);
+		rc = store_last_error(data, rc);
+	}
+
+done:
+	return rc;
+}
+
+static int ctrl_perform_simple_calibration_offset_lock(
+	struct stmvl53l1_data *data,
+	struct stmvl53l1_ioctl_perform_calibration_t *calib)
+{
+	int rc;
+
+	/* finally perform calibration */
+	/* allow delay add after stop in VL53L1_run_<offset|zone>_calibration */
+	data->is_delay_allowed = 1;
+
+	rc = stmvl53l1_sendparams(data);
+	if (rc)
+		goto done;
+
+	rc = VL53L1_PerformOffsetSimpleCalibration(&data->stdev, calib->param1);
+	data->is_delay_allowed = 0;
+	if (rc) {
+		vl53l1_errmsg(
+			"VL53L1_PerformOffsetSimpleCalibration fail => %d", rc);
+		rc = store_last_error(data, rc);
+	}
+
+done:
+	return rc;
+}
+
+static int ctrl_perform_calibration(struct stmvl53l1_data *data, void __user *p)
+{
+	int rc;
+	struct stmvl53l1_ioctl_perform_calibration_t calib;
+
+	mutex_lock(&data->work_mutex);
+
+	if (data->is_device_remove) {
+		rc = -ENODEV;
+		goto done;
+	}
+	data->is_calibrating = true;
+	rc = copy_from_user(&calib, p, sizeof(calib));
+	if (rc) {
+		rc = -EFAULT;
+		goto done;
+	}
+	if (data->enable_sensor) {
+		rc = -EBUSY;
+		vl53l1_errmsg("can't perform calibration while ranging\n");
+		goto done;
+	}
+    vl53l1_info("cali power on");//songyt add
+    stmvl53l1_module_func_tbl.power_up(data->client_object);
+
+	rc = reset_release(data);
+	if (rc)
+		goto done;
+
+	rc = VL53L1_StaticInit(&data->stdev);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_StaticInit fail => %d", rc);
+		rc = store_last_error(data, rc);
+		goto done;
+	}
+
+	switch (calib.calibration_type) {
+	case VL53L1_CALIBRATION_REF_SPAD:
+		rc = ctrl_perform_calibration_ref_spad_lock(data,
+			&calib);
+		break;
+	case VL53L1_CALIBRATION_CROSSTALK:
+		rc = ctrl_perform_calibration_crosstalk_lock(data,
+			&calib);
+		break;
+	case VL53L1_CALIBRATION_OFFSET:
+		rc = ctrl_perform_calibration_offset_lock(data,
+			&calib);
+		break;
+	case VL53L1_CALIBRATION_OFFSET_SIMPLE:
+		rc = ctrl_perform_simple_calibration_offset_lock(data,
+			&calib);
+		break;
+	case VL53L1_CALIBRATION_OFFSET_PER_ZONE:
+		rc = ctrl_perform_zone_calibration_offset_lock(data,
+			&calib);
+		break;
+	default:
+		rc = -EINVAL;
+		break;
+	}
+
+	reset_hold(data);
+    vl53l1_info("cali power down");//songyt add
+    stmvl53l1_module_func_tbl.power_down(data->client_object);
+
+done:
+	data->is_calibrating = false;
+	data->is_first_start_done = true;
+	mutex_unlock(&data->work_mutex);
+
+	return rc;
+}
+
+static int stmvl53l1_ioctl_handler(
+		struct stmvl53l1_data *data,
+		unsigned int cmd, unsigned long arg,
+		void __user *p)
+{
+	int rc = 0;
+
+	if (!data)
+		return -EINVAL;
+
+	switch (cmd) {
+
+	case VL53L1_IOCTL_START:
+		vl53l1_dbgmsg("VL53L1_IOCTL_START\n");
+		rc = ctrl_start(data);
+		break;
+
+	case VL53L1_IOCTL_STOP:
+		vl53l1_dbgmsg("VL53L1_IOCTL_STOP\n");
+		rc = ctrl_stop(data);
+		break;
+
+	case VL53L1_IOCTL_GETDATAS:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_GETDATAS\n"); */
+		rc = ctrl_getdata(data, p);
+		break;
+
+	case VL53L1_IOCTL_GETDATAS_BLOCKING:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_GETDATAS_BLOCKING\n"); */
+		rc = ctrl_getdata_blocking(data, p);
+		break;
+
+	/* Register tool */
+	case VL53L1_IOCTL_REGISTER:
+		vl53l1_dbgmsg("VL53L1_IOCTL_REGISTER\n");
+		rc = ctrl_reg_access(data, p);
+		break;
+
+	case VL53L1_IOCTL_PARAMETER:
+		vl53l1_dbgmsg("VL53L1_IOCTL_PARAMETER\n");
+		rc = ctrl_params(data, p);
+		break;
+
+	case VL53L1_IOCTL_ROI:
+		vl53l1_dbgmsg("VL53L1_IOCTL_ROI\n");
+		rc = ctrl_roi(data, p);
+		break;
+	case VL53L1_IOCTL_MZ_DATA:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_MZ_DATA\n"); */
+		rc = ctrl_mz_data(data, p);
+		break;
+	case VL53L1_IOCTL_MZ_DATA_BLOCKING:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_MZ_DATA_BLOCKING\n"); */
+		rc = ctrl_mz_data_blocking(data, p);
+		break;
+	case VL53L1_IOCTL_CALIBRATION_DATA:
+		vl53l1_dbgmsg("VL53L1_IOCTL_CALIBRATION_DATA\n");
+		rc = ctrl_calibration_data(data, p);
+		break;
+	case VL53L1_IOCTL_PERFORM_CALIBRATION:
+		vl53l1_dbgmsg("VL53L1_IOCTL_PERFORM_CALIBRATION\n");
+		rc = ctrl_perform_calibration(data, p);
+		break;
+	case VL53L1_IOCTL_AUTONOMOUS_CONFIG:
+		vl53l1_dbgmsg("VL53L1_IOCTL_AUTONOMOUS_CONFIG\n");
+		rc = ctrl_autonomous_config(data, p);
+		break;
+	case VL53L1_IOCTL_ZONE_CALIBRATION_DATA:
+		vl53l1_dbgmsg("VL53L1_IOCTL_ZONE_CALIBRATION_DATA\n");
+		rc = ctrl_zone_calibration_data(data, p);
+		break;
+	case VL53L1_IOCTL_MZ_DATA_ADDITIONAL:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_MZ_DATA_ADDITIONAL\n"); */
+		rc = ctrl_mz_data_additional(data, p);
+		break;
+	case VL53L1_IOCTL_MZ_DATA_ADDITIONAL_BLOCKING:
+		/* vl53l1_dbgmsg("VL53L1_IOCTL_MZ_DATA_ADDITIONAL_BLOCKING\n");
+		 */
+		rc = ctrl_mz_data_blocking_additional(data, p);
+		break;
+	default:
+		rc = -EINVAL;
+		break;
+	}
+
+	return rc;
+}
+
+
+
+static int stmvl53l1_open(struct inode *inode, struct file *file)
+{
+	struct stmvl53l1_data *data = container_of(file->private_data,
+		struct stmvl53l1_data, miscdev);
+
+	vl53l1_dbgmsg("Start\n");
+	stmvl53l1_module_func_tbl.get(data->client_object);
+	vl53l1_dbgmsg("End\n");
+
+	return 0;
+}
+
+static int stmvl53l1_release(struct inode *inode, struct file *file)
+{
+	struct stmvl53l1_data *data = container_of(file->private_data,
+		struct stmvl53l1_data, miscdev);
+
+	vl53l1_dbgmsg("Start\n");
+	stmvl53l1_module_func_tbl.put(data->client_object);
+	vl53l1_dbgmsg("End\n");
+
+	return 0;
+}
+
+
+/** max number or error per measure too abort */
+#define stvm531_get_max_meas_err(...) 3
+/** max number or error per stream too abort */
+#define stvm531_get_max_stream_err(...) 6
+
+static void detect_xtalk_value_change(struct stmvl53l1_data *data,
+	VL53L1_MultiRangingData_t *meas)
+{
+	data->is_xtalk_value_changed = meas->HasXtalkValueChanged ? true :
+		data->is_xtalk_value_changed;
+}
+
+/**
+ * handle data retrieval and dispatch
+ *
+ * work lock must be held
+ *
+ * called  form work or interrupt thread it must be a blocable context !
+ * @param data the device
+ */
+static void stmvl53l1_on_newdata_event(struct stmvl53l1_data *data)
+{
+	int rc;
+	VL53L1_RangingMeasurementData_t *pmsinglerange;
+	VL53L1_MultiRangingData_t *pmrange;
+	VL53L1_MultiRangingData_t *tmprange;
+	VL53L1_TargetRangeData_t RangeData[VL53L1_MAX_RANGE_RESULTS];
+	VL53L1_RangingMeasurementData_t singledata;
+	long ts_msec;
+	int i;
+
+	do_gettimeofday(&data->meas.comp_tv);
+	ts_msec = stmvl53l1_tv_dif(&data->start_tv, &data->meas.comp_tv)/1000;
+
+	pmrange = &data->meas.multi_range_data;
+	tmprange = &data->meas.tmp_range_data;
+	pmsinglerange = &data->meas.single_range_data;
+
+	memcpy(&singledata, pmsinglerange,
+			sizeof(VL53L1_RangingMeasurementData_t));
+	for (i = 0; i < VL53L1_MAX_RANGE_RESULTS; i++)
+		memcpy(&RangeData[i], &pmrange->RangeData[i],
+				sizeof(VL53L1_TargetRangeData_t));
+
+	data->meas.intr++;
+
+	/* use get data method based on active mode */
+	switch (data->preset_mode) {
+	case VL53L1_PRESETMODE_LITE_RANGING:
+	case VL53L1_PRESETMODE_AUTONOMOUS:
+	case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+		rc = VL53L1_GetRangingMeasurementData(&data->stdev,
+			pmsinglerange);
+		/* In case of VL53L1_RANGESTATUS_NONE we prefer to return
+		 * the previous ranging values along that error status
+		 */
+		if (pmsinglerange->RangeStatus == VL53L1_RANGESTATUS_NONE)  {
+			memcpy(pmsinglerange, &singledata,
+				sizeof(VL53L1_RangingMeasurementData_t));
+			pmsinglerange->RangeStatus = VL53L1_RANGESTATUS_NONE;
+		}
+	break;
+	case VL53L1_PRESETMODE_RANGING:
+	case VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+	/* IMPORTANT : during VL53L1_GetMultiRangingData() call
+	 * work_mutex is release during ipp. This is why we use
+	 * tmp_range_data which is not access somewhere else. When we are
+	 * back we then copy tmp_range_data in multi_range_data.
+	 */
+
+		rc = VL53L1_GetMultiRangingData(&data->stdev,
+			&data->meas.tmp_range_data);
+
+		/* be sure we got VL53L1_RANGESTATUS_NONE for object 0 if we got
+		 * invalid roi or no object. So if client read data using
+		 * VL53L1_IOCTL_GETDATAS we got correct status.
+		 */
+		if (tmprange->RoiStatus == VL53L1_ROISTATUS_NOT_VALID ||
+			tmprange->NumberOfObjectsFound == 0)
+			tmprange->RangeData[0].RangeStatus =
+						VL53L1_RANGESTATUS_NONE;
+
+		memcpy(pmrange, tmprange, sizeof(VL53L1_MultiRangingData_t));
+
+		/* In case of VL53L1_RANGESTATUS_NONE we prefer to return
+		 * the previous ranging values along that error status
+		 */
+		/*AmbientRate issue: Output ranging data even no target is detected
+		for (i = 0; i < VL53L1_MAX_RANGE_RESULTS; i++) {
+			if (pmrange->RangeData[i].RangeStatus ==
+					VL53L1_RANGESTATUS_NONE) {
+				memcpy(&pmrange->RangeData[i], &RangeData[i],
+					sizeof(VL53L1_TargetRangeData_t));
+				pmrange->RangeData[i].RangeStatus =
+						VL53L1_RANGESTATUS_NONE;
+			}
+		}*/
+
+		/* got histogram debug data in case user want it later on */
+		if (!rc)
+			rc = VL53L1_GetAdditionalData(&data->stdev,
+				&data->meas.additional_data);
+		detect_xtalk_value_change(data, pmrange);
+	break;
+	default:
+		/* that must be some bug or data corruption stop now */
+		rc = -1;
+		vl53l1_errmsg("unsorted mode %d=>stop\n", data->preset_mode);
+		_ctrl_stop(data);
+	}
+	/* check if not stopped yet
+	 * as we may have been unlocked we must re-check
+	 */
+	if (data->enable_sensor == 0) {
+		vl53l1_dbgmsg("at meas #%d we got stopped\n", data->meas.cnt);
+		return;
+	}
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetRangingMeasurementData @%d %d",
+				__LINE__, rc);
+		data->meas.err_cnt++;
+		data->meas.err_tot++;
+		if (data->meas.err_cnt > stvm531_get_max_meas_err(data) ||
+			data->meas.err_tot > stvm531_get_max_stream_err(data)) {
+			vl53l1_errmsg("on #%d %d err %d tot stop",
+				data->meas.cnt, data->meas.err_cnt,
+				data->meas.err_tot);
+			_ctrl_stop(data);
+		}
+		return;
+	}
+
+	/* FIXME: remove when implemented by ll or bare driver */
+	pmrange->TimeStamp = ts_msec;
+	pmsinglerange->TimeStamp = ts_msec;
+	for (i = 1; i < pmrange->NumberOfObjectsFound; i++)
+		pmrange->TimeStamp = ts_msec;
+
+	data->meas.cnt++;
+#if 0
+	vl53l1_dbgmsg("#%3d %2d poll ts %5d status=%d obj cnt=%d\n",
+		data->meas.cnt,
+		data->meas.poll_cnt,
+		pmrange->TimeStamp,
+		pmrange->RangeData[0].RangeStatus,
+		pmrange->NumberOfObjectsFound);
+	vl53l1_dbgmsg(
+"meas m#%04d i#%04d  p#%04d in %d ms data range status %d range %d\n",
+			(int)data->meas.cnt,
+			(int)data->meas.intr,
+			(int)data->meas.poll_cnt,
+			(int)stmvl53l1_tv_dif(&data->meas.start_tv,
+					&data->meas.comp_tv)/1000,
+			(int)data->meas.range_data.RangeStatus,
+			(int)data->meas.range_data.RangeMilliMeter);
+#endif
+	/* ready that is not always on each new data event */
+
+	/* mark data as valid from now */
+	data->is_data_valid = true;
+
+	/* wake up sleeping client */
+	wake_up_data_waiters(data);
+
+	/* push data to input subsys and only and make val for ioctl*/
+	stmvl53l1_input_push_data(data);
+	stmvl53l1_insert_flush_events_lock(data);
+
+	/* roll time now data got used */
+	data->meas.start_tv = data->meas.comp_tv;
+	data->meas.poll_cnt = 0;
+	data->meas.err_cnt = 0;
+}
+
+
+/**
+ * * handle interrupt/pusdo irq by polling handling
+ *
+ * work lock must be held
+ *
+ * @param data driver
+ * @return 0 on success
+ */
+static int stmvl53l1_intr_process(struct stmvl53l1_data *data)
+{
+	uint8_t data_rdy;
+	int rc = 0;
+	struct timeval tv_now;
+
+	if (!data->enable_sensor)
+		goto done;
+
+	data->meas.poll_cnt++;
+	rc = VL53L1_GetMeasurementDataReady(&data->stdev, &data_rdy);
+	if (rc) {
+		vl53l1_errmsg("GetMeasurementDataReady @%d %d, fail\n",
+				__LINE__, rc);
+		/* too many successive fail => stop but do not try to do any new
+		 * i/o
+		 */
+		goto stop_io;
+	}
+
+	if (!data_rdy) {
+		/* FIXME this part to completely skip
+		 * if using interrupt and sure we have
+		 * no false interrupt to handle or no to do any timing check
+		 */
+		long poll_us;
+
+		do_gettimeofday(&tv_now);
+		poll_us = stmvl53l1_tv_dif(&data->meas.start_tv, &tv_now);
+		if (poll_us > data->timing_budget*4) {
+			vl53l1_errmsg("we're polling %ld ms too long\n",
+					poll_us/1000);
+			/*  fixme stop or just warn ? */
+			goto stop_io;
+		}
+		/*  keep trying it could be intr with no processing */
+		work_dbg("intr with no data rdy");
+		goto done;
+	}
+	/* we have data to handle */
+	/* first irq after reset has no data so we skip it */
+	if (data->is_first_irq) {
+		data->is_first_irq = false;
+
+		if (data->preset_mode ==
+			VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS) {
+			/*
+			 * If VL53L1_GetRangingMeasurementData()
+			 * is not called after
+			 * for the first ranging measurement,
+			 * the thresholds do not seem
+			 * to work for ALP mode
+			 */
+			VL53L1_RangingMeasurementData_t RangingMeasurementData;
+
+			/* printk("Test Workaround for ALP mode\n"); */
+			VL53L1_GetRangingMeasurementData(&data->stdev,
+				&RangingMeasurementData);
+		}
+
+	} else
+		stmvl53l1_on_newdata_event(data);
+	/* enable_sensor could change on event handling check again */
+	if (data->enable_sensor) {
+		/* clear interrupt and continue ranging */
+		work_dbg("intr clr");
+		/* In autonomous mode, bare driver will trigger stop/start
+		 * sequence. In that case it wall call platform delay functions.
+		 * So allow delay in VL53L1_ClearInterruptAndStartMeasurement()
+		 * call.
+		 */
+		data->is_delay_allowed = data->allow_hidden_start_stop;
+		rc = VL53L1_ClearInterruptAndStartMeasurement(&data->stdev);
+		data->is_delay_allowed = 0;
+		if (rc) {
+			/* go to stop but stop any new i/o for dbg */
+			vl53l1_errmsg("Cltr intr restart fail %d\n", rc);
+			goto stop_io;
+		}
+	}
+done:
+	return rc;
+stop_io:
+	/* too many successive fail take action => stop but do not try to do
+	 * any new i/o
+	 */
+	vl53l1_errmsg("GetDatardy fail stop\n");
+	_ctrl_stop(data);
+	return rc;
+
+}
+
+static void stmvl53l1_work_handler(struct work_struct *work)
+{
+	struct stmvl53l1_data *data;
+
+	data = container_of(work, struct stmvl53l1_data, dwork.work);
+	work_dbg("enter");
+	mutex_lock(&data->work_mutex);
+	stmvl53l1_intr_process(data);
+	if (data->poll_mode && data->enable_sensor) {
+		/* re-sched ourself */
+		schedule_delayed_work(&data->dwork,
+			msecs_to_jiffies(data->poll_delay_ms));
+	}
+	mutex_unlock(&data->work_mutex);
+}
+
+static void stmvl53l1_input_push_data_singleobject(struct stmvl53l1_data *data)
+{
+	struct input_dev *input = data->input_dev_ps;
+	VL53L1_RangingMeasurementData_t *meas = &data->meas.single_range_data;
+	FixPoint1616_t LimitCheckCurrent;
+	VL53L1_Error st = VL53L1_ERROR_NONE;
+
+	vl53l1_dbgmsg("******* FIXME!!! ************\n");
+	vl53l1_dbgmsg("Sensor HAL in Lite ranging mode not yet updated\n");
+	vl53l1_dbgmsg("******* FIXME!!! ************\n");
+
+	/* Do not send the events till this if fixed properly */
+	return;
+
+	input_report_abs(input, ABS_DISTANCE, (meas->RangeMilliMeter + 5) / 10);
+	input_report_abs(input, ABS_HAT0X, meas->TimeStamp / 1000);
+	input_report_abs(input, ABS_HAT0Y, (meas->TimeStamp % 1000) * 1000);
+	input_report_abs(input, ABS_HAT1X, meas->RangeMilliMeter);
+	input_report_abs(input, ABS_HAT1Y, meas->RangeStatus);
+	input_report_abs(input, ABS_HAT2X, meas->SignalRateRtnMegaCps);
+	input_report_abs(input, ABS_HAT2Y, meas->AmbientRateRtnMegaCps);
+	input_report_abs(input, ABS_HAT3X, meas->SigmaMilliMeter);
+	st = VL53L1_GetLimitCheckCurrent(&data->stdev,
+		VL53L1_CHECKENABLE_SIGMA_FINAL_RANGE, &LimitCheckCurrent);
+	if (st == VL53L1_ERROR_NONE)
+		input_report_abs(input, ABS_WHEEL, LimitCheckCurrent);
+	input_report_abs(input, ABS_TILT_Y, meas->EffectiveSpadRtnCount);
+	input_report_abs(input, ABS_TOOL_WIDTH, meas->RangeQualityLevel);
+
+	input_sync(input);
+}
+
+static void stmvl53l1_input_push_data_multiobject(struct stmvl53l1_data *data)
+{
+	VL53L1_MultiRangingData_t *mmeas = &data->meas.multi_range_data;
+	int i;
+	int rc;
+	VL53L1_TargetRangeData_t *meas_array[4];
+	VL53L1_CalibrationData_t calibration_data;
+	struct timeval tv;
+	struct input_dev *input = data->input_dev_ps;
+
+	do_gettimeofday(&tv);
+
+	for (i = 0; i < 4; i++)
+		meas_array[i] = &mmeas->RangeData[i];
+
+	/*************************************************************
+	 *  INPUT EVENT CODE	L1/L3 Data
+	   ABS_HAT0X	Time in Sec(32)
+	   ABS_HAT0Y	Time in uSec(32)
+	   ABS_HAT1X	Obj0_Distance(16) :  Obj0_Sigma(16)
+	   ABS_HAT1Y	Obj0_MinRange(16) : Obj0_MaxRange(16)
+	   ABS_HAT2X	Obj1_Distance(16) :  Obj1_Sigma(16)
+	   ABS_HAT2Y	Obj1_ MinRange (16) : Obj1_ MaxRange (16)
+	   ABS_HAT3X	Obj0_SignalRate_Spad(32)
+	   ABS_HAT3Y	Obj1_SignalRate_Spad(32)
+	   ABS_WHEEL	AmbientRate(32)
+	   ABS_BRAKE	EffectiveSpadRtnCount(16):RangeStatus_1(8):
+					Range_status_0(8)
+	   ABS_TILT_X	XtalkChange(8) :StreamCount(8) :
+					NumberofObjects(2) : RoiNumber(4) :
+					RoiStatus(2)
+	   ABS_TILT_Y	DMAX
+	   ABS_TOOL_WIDTH	XtalkValue
+	   ABS_DISTANCE
+	   ABS_THROTTLE
+	   ABS_RUDDER
+	   ABS_MISC
+	   ABS_VOLUME
+	 ************************************************************/
+
+	rc = VL53L1_GetCalibrationData(&data->stdev, &calibration_data);
+	if (rc) {
+		//This should not happen
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		return;
+	}
+
+	//ABS_HAT0X  -	Time in Sec(32)
+
+	input_report_abs(input, ABS_HAT0X, tv.tv_sec);
+	//vl53l1_dbgmsg("ABS_HAT0X : %ld, %zu\n", tv.tv_sec, sizeof(tv.tv_sec));
+	//ABS_HAT0Y   - Time in uSec(32)
+	//REVISIT : The following code may cause loss of data due to
+	//8 bytes to 32 bits conversion
+	input_report_abs(input, ABS_HAT0Y, tv.tv_usec);
+	//vl53l1_dbgmsg("ABS_HAT0Y : %ld\n", tv.tv_usec);
+
+	if (mmeas->NumberOfObjectsFound == 0) {
+		//ABS_TILT_X	XtalkChange(8) :StreamCount(8) :
+		//Number of Objects(2) : RoiNumber(4) : RoiStatus(2)
+		input_report_abs(input, ABS_TILT_X,
+				(mmeas->HasXtalkValueChanged << 16)
+				|  (mmeas->StreamCount << 8)
+				| ((mmeas->NumberOfObjectsFound & 0x3) << 6)
+				| ((mmeas->RoiNumber & 0xF) << 2)
+				| (mmeas->RoiStatus & 0x3));
+		/*vl53l1_dbgmsg("ABS_TILT_X :(%d):(%d):(%d):(%d):(%d)\n\n",
+						mmeas->HasXtalkValueChanged,
+						mmeas->StreamCount,
+						mmeas->NumberOfObjectsFound,
+						mmeas->RoiNumber,
+						mmeas->RoiStatus
+						);*/
+
+
+		//ABS_TILT_Y	DMAX
+		input_report_abs(input, ABS_TILT_Y,   mmeas->DmaxMilliMeter);
+		//vl53l1_dbgmsg("ABS_TILT_Y DMAX = %d\n", mmeas->DmaxMilliMeter);
+
+		//ABS_TOOL_WIDTH
+		input_report_abs(input, ABS_TOOL_WIDTH,
+                        calibration_data.customer.algo__crosstalk_compensation_plane_offset_kcps);
+		//vl53l1_dbgmsg("ABS_TOOL_WIDTH Xtalk = %d\n",
+        //                calibration_data.customer.algo__crosstalk_compensation_plane_offset_kcps);
+
+
+		input_sync(input);
+		return;
+	}
+
+	//ABS_HAT1X   -	 Obj0_Distance(16) :  Obj0_Sigma(16)
+	input_report_abs(input, ABS_HAT1X, meas_array[0]->RangeMilliMeter << 16
+			| (meas_array[0]->SigmaMilliMeter/65536));
+	/*vl53l1_dbgmsg("ABS_HAT1X : 0x%X(%d:%d)\n",
+			meas_array[0]->RangeMilliMeter << 16
+			| (meas_array[0]->SigmaMilliMeter/65536),
+			meas_array[0]->RangeMilliMeter,
+			(meas_array[0]->SigmaMilliMeter/65536));*/
+
+	//ABS_HAT1Y   -	Obj0_MinRange(16) : Obj0_MaxRange(16)
+	input_report_abs(input, ABS_HAT1Y,
+			meas_array[0]->RangeMinMilliMeter << 16
+			| meas_array[0]->RangeMaxMilliMeter);
+
+	/*vl53l1_dbgmsg("ABS_HAT1Y : 0x%X(%d:%d)\n",
+			meas_array[0]->RangeMinMilliMeter << 16
+			| meas_array[0]->RangeMaxMilliMeter,
+			meas_array[0]->RangeMinMilliMeter,
+			meas_array[0]->RangeMaxMilliMeter);*/
+
+	if (mmeas->NumberOfObjectsFound > 1) {
+		//ABS_HAT2X   -	Obj1_Distance(16) :  Obj1_Sigma(16)
+		input_report_abs(input, ABS_HAT2X,
+				meas_array[1]->RangeMilliMeter << 16
+				| (meas_array[1]->SigmaMilliMeter/65536));
+		/*vl53l1_dbgmsg("ABS_HAT2X : 0x%x(%d:%d)\n",
+				meas_array[1]->RangeMilliMeter << 16
+				| (meas_array[1]->SigmaMilliMeter/65536),
+				meas_array[1]->RangeMilliMeter,
+				(meas_array[1]->SigmaMilliMeter/65536));*/
+
+		//ABS_HAT2Y   -	Obj1_ MinRange (16) : Obj1_ MaxRange (16)
+		input_report_abs(input, ABS_HAT2Y,
+				meas_array[1]->RangeMinMilliMeter << 16
+				| meas_array[1]->RangeMaxMilliMeter);
+
+		/*vl53l1_dbgmsg("ABS_HAT1Y : 0x%X(%d:%d)\n",
+				meas_array[1]->RangeMinMilliMeter << 16
+				| meas_array[1]->RangeMaxMilliMeter,
+				meas_array[1]->RangeMinMilliMeter,
+				meas_array[1]->RangeMaxMilliMeter);*/
+
+	}
+
+	// ABS_HAT3X	  -	Obj0_SignalRate_Spad(32)
+	input_report_abs(input, ABS_HAT3X,
+			meas_array[0]->SignalRateRtnMegaCps);
+	//vl53l1_dbgmsg("ABS_HAT3X : SignalRateRtnMegaCps_0(%d)\n",
+	//		meas_array[0]->SignalRateRtnMegaCps);
+	if (mmeas->NumberOfObjectsFound > 1) {
+		//ABS_HAT3Y  -		Obj1_SignalRate_Spad(32)
+		input_report_abs(input, ABS_HAT3Y,
+			meas_array[1]->SignalRateRtnMegaCps);
+	//	vl53l1_dbgmsg("ABS_HAT3Y : SignalRateRtnMegaCps_1(%d)\n",
+	//		meas_array[1]->SignalRateRtnMegaCps);
+	}
+	//ABS_WHEEL  - AmbientRate(32)
+	input_report_abs(input, ABS_WHEEL,
+		meas_array[0]->AmbientRateRtnMegaCps);
+	//vl53l1_dbgmsg("ABS_WHEEL : AmbRate = %d\n",
+	//	meas_array[0]->AmbientRateRtnMegaCps);
+
+
+	//ABS_BRAKE  -	EffectiveSpadRtnCount(16):RangeStatus_3(1):
+	//Range_status_2(0)
+	input_report_abs(input, ABS_BRAKE,
+			 mmeas->EffectiveSpadRtnCount << 16
+			| ((meas_array[1]->RangeStatus) << 8)
+			| meas_array[0]->RangeStatus);
+
+	/*vl53l1_dbgmsg("ABS_BRAKE : (%d):(%d):(%d)\n",
+			mmeas->EffectiveSpadRtnCount,
+			meas_array[1]->RangeStatus,
+			meas_array[0]->RangeStatus);
+
+	vl53l1_dbgmsg("ABS_BRAKE : 0x%X\n",
+			(mmeas->EffectiveSpadRtnCount & 0xFFFF) << 16
+			| ((meas_array[1]->RangeStatus) << 8)
+			| meas_array[0]->RangeStatus);*/
+	//ABS_TILT_X	XtalkChange(8) :StreamCount(8) :
+	//Number of Objects(2) : RoiNumber(4) : RoiStatus(2)
+	//On maint2 driver, the max possible range status value is 14.
+	//Revisit If this changes in future
+	input_report_abs(input, ABS_TILT_X,
+				(mmeas->HasXtalkValueChanged << 16)
+			|  (mmeas->StreamCount << 8)
+			| ((mmeas->NumberOfObjectsFound & 0x3) << 6)
+			| ((mmeas->RoiNumber & 0xF) << 2)
+			| (mmeas->RoiStatus & 0x3));
+	/*vl53l1_dbgmsg("ABS_TILT_X :(%d):(%d):(%d):(%d):(%d)\n",
+			mmeas->HasXtalkValueChanged,
+			mmeas->StreamCount,
+			mmeas->NumberOfObjectsFound,
+			mmeas->RoiNumber,
+			mmeas->RoiStatus
+			);*/
+	//ABS_TILT_Y	DMAX
+	input_report_abs(input, ABS_TILT_Y,   mmeas->DmaxMilliMeter);
+	//vl53l1_dbgmsg("ABS_TILT_Y DMAX = %d\n", mmeas->DmaxMilliMeter);
+
+	//ABS_TOOL_WIDTH
+	input_report_abs(input, ABS_TOOL_WIDTH,
+        calibration_data.customer.algo__crosstalk_compensation_plane_offset_kcps);
+	//vl53l1_dbgmsg("ABS_TOOL_WIDTH Xtalk = %d\n\n",
+    //    calibration_data.customer.algo__crosstalk_compensation_plane_offset_kcps);
+	input_sync(input);
+}
+
+static void stmvl53l1_input_push_data(struct stmvl53l1_data *data)
+{
+	/* use get data method based on active mode */
+	switch (data->preset_mode) {
+	case VL53L1_PRESETMODE_LITE_RANGING:
+	case VL53L1_PRESETMODE_AUTONOMOUS:
+	case VL53L1_PRESETMODE_LOWPOWER_AUTONOMOUS:
+		stmvl53l1_input_push_data_singleobject(data);
+	break;
+	default:
+	/* VL53L1_PRESETMODE_RANGING:
+	 * VL53L1_PRESETMODE_MULTIZONES_SCANNING:
+	 */
+		stmvl53l1_input_push_data_multiobject(data);
+	}
+}
+
+static int stmvl53l1_input_setup(struct stmvl53l1_data *data)
+{
+	int rc;
+	struct input_dev *idev;
+	/* Register to Input Device */
+	idev = input_allocate_device();
+	if (idev == NULL) {
+		rc = -ENOMEM;
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		goto exit_err;
+	}
+	/*  setup all event */
+	set_bit(EV_ABS, idev->evbit);
+
+	input_set_abs_params(idev, ABS_DISTANCE, 0, 0xff, 0, 0);
+
+	input_set_abs_params(idev, ABS_HAT0X, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT0Y, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT1X, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT1Y, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT2X, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT2Y, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT3X, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_HAT3Y, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_WHEEL, 0, 0xffffffff, 0, 0);
+
+	input_set_abs_params(idev, ABS_TILT_Y, 0, 0xffffffff, 0, 0);
+
+	input_set_abs_params(idev, ABS_BRAKE, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_TILT_X, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_TOOL_WIDTH, 0, 0xffffffff, 0, 0);
+
+	input_set_abs_params(idev, ABS_THROTTLE, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_RUDDER, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_MISC, 0, 0xffffffff, 0, 0);
+
+	input_set_abs_params(idev, ABS_VOLUME, 0, 0xffffffff, 0, 0);
+	input_set_abs_params(idev, ABS_GAS, 0, 0xffffffff, 0, 0);
+
+	idev->name = "STM VL53L1 proximity sensor";
+	rc = input_register_device(idev);
+	if (rc) {
+		rc = -ENOMEM;
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		goto exit_free_dev_ps;
+	}
+	/* setup drv data */
+	input_set_drvdata(idev, data);
+	data->input_dev_ps = idev;
+	return 0;
+
+
+exit_free_dev_ps:
+	input_free_device(data->input_dev_ps);
+exit_err:
+	return rc;
+}
+
+/**
+ * handler to be called by interface module on interrupt
+ *
+ * managed poll/irq filtering in case poll/irq can be soft forced
+ * and the module side still fire interrupt
+ *
+ * @param data
+ * @return 0 if all ok else for error
+ */
+int stmvl53l1_intr_handler(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	mutex_lock(&data->work_mutex);
+
+	/* handle it only if if we are not stopped */
+	if (data->enable_sensor) {
+		rc = stmvl53l1_intr_process(data);
+	} else {
+		/* it's likely race/last unhandled interrupt after
+		 * stop.
+		 * Such dummy irq also occured during offset and crosstalk
+		 * calibration procedures.
+		 */
+		vl53l1_dbgmsg("got intr but not on (dummy or calibration)\n");
+		rc = 0;
+	}
+
+	mutex_unlock(&data->work_mutex);
+	return rc;
+}
+
+
+/**
+ * One time device  setup
+ *
+ * call by bus (i2c/cci) level probe to finalize non bus related device setup
+ *
+ * @param	data The device data
+ * @return	0 on success
+ */
+int stmvl53l1_setup(struct stmvl53l1_data *data)
+{
+	int rc = 0;
+	VL53L1_DeviceInfo_t dev_info;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	/* acquire an id */
+	data->id = allocate_dev_id();
+	if (data->id < 0) {
+		vl53l1_errmsg("too many device already created");
+		return -1;
+	}
+	vl53l1_dbgmsg("Dev id %d is @%p\n", data->id, data);
+	stmvl53l1_dev_table[data->id] = data;
+
+	/* init mutex */
+	/* mutex_init(&data->update_lock); */
+	mutex_init(&data->work_mutex);
+
+	/* init work handler */
+	INIT_DELAYED_WORK(&data->dwork, stmvl53l1_work_handler);
+
+	/* init ipp side */
+	stmvl53l1_ipp_setup(data);
+
+	data->force_device_on_en = force_device_on_en_default;
+	data->reset_state = 1;
+	data->is_calibrating = false;
+	data->last_error = VL53L1_ERROR_NONE;
+	data->is_device_remove = false;
+
+	rc = stmvl53l1_module_func_tbl.power_up(data->client_object);
+	if (rc) {
+		vl53l1_errmsg("%d,error rc %d\n", __LINE__, rc);
+		goto exit_ipp_cleanup;
+	}
+	rc = reset_release(data);
+	if (rc)
+		goto exit_ipp_cleanup;
+
+	rc = stmvl53l1_input_setup(data);
+	if (rc)
+		goto exit_ipp_cleanup;
+
+	/* init blocking ioctl stuff */
+	INIT_LIST_HEAD(&data->simple_data_reader_list);
+	INIT_LIST_HEAD(&data->mz_data_reader_list);
+	init_waitqueue_head(&data->waiter_for_data);
+	data->is_data_valid = false;
+
+	/* Register sysfs hooks under input dev */
+	rc = sysfs_create_group(&data->input_dev_ps->dev.kobj,
+			&stmvl53l1_attr_group);
+	if (rc) {
+		rc = -ENOMEM;
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		goto exit_unregister_dev_ps;
+	}
+	rc = sysfs_create_bin_file(&data->input_dev_ps->dev.kobj,
+		&stmvl53l1_calib_data_attr);
+	if (rc) {
+		rc = -ENOMEM;
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		goto exit_unregister_dev_ps;
+	}
+	rc = sysfs_create_bin_file(&data->input_dev_ps->dev.kobj,
+		&stmvl53l1_zone_calib_data_attr);
+	if (rc) {
+		rc = -ENOMEM;
+		vl53l1_errmsg("%d error:%d\n", __LINE__, rc);
+		goto exit_unregister_dev_ps;
+	}
+
+	data->enable_sensor = 0;
+
+	data->poll_delay_ms = STMVL53L1_CFG_POLL_DELAY_MS;
+	data->timing_budget = STMVL53L1_CFG_TIMING_BUDGET_US;
+	data->preset_mode = STMVL53L1_CFG_DEFAULT_MODE;
+    //songyt add default range roi
+    if(data->preset_mode == VL53L1_PRESETMODE_MULTIZONES_SCANNING
+        /*|| data->preset_mode == VL53L1_PRESETMODE_RANGING*/){
+        data->roi_cfg.NumberOfRoi = 4;
+        data->roi_cfg.UserRois[0].TopLeftX = 0;
+        data->roi_cfg.UserRois[0].TopLeftY = 15;
+        data->roi_cfg.UserRois[0].BotRightX = 7;
+        data->roi_cfg.UserRois[0].BotRightY = 8;
+
+        data->roi_cfg.UserRois[1].TopLeftX = 8;
+        data->roi_cfg.UserRois[1].TopLeftY = 15;
+        data->roi_cfg.UserRois[1].BotRightX = 15;
+        data->roi_cfg.UserRois[1].BotRightY = 8;
+
+        data->roi_cfg.UserRois[2].TopLeftX = 0;
+        data->roi_cfg.UserRois[2].TopLeftY = 7;
+        data->roi_cfg.UserRois[2].BotRightX = 7;
+        data->roi_cfg.UserRois[2].BotRightY = 0;
+
+        data->roi_cfg.UserRois[3].TopLeftX = 8;
+        data->roi_cfg.UserRois[3].TopLeftY = 7;
+        data->roi_cfg.UserRois[3].BotRightX = 15;
+        data->roi_cfg.UserRois[3].BotRightY = 0;
+    }else{
+        data->roi_cfg.NumberOfRoi = 0;
+    }
+    //end
+	data->distance_mode = STMVL53L1_CFG_DEFAULT_DISTANCE_MODE;
+	data->crosstalk_enable = STMVL53L1_CFG_DEFAULT_CROSSTALK_ENABLE;
+	data->output_mode = STMVL53L1_CFG_DEFAULT_OUTPUT_MODE;
+	data->offset_correction_mode =
+		STMVL53L1_CFG_DEFAULT_OFFSET_CORRECTION_MODE;
+	stmvl53l1_setup_auto_config(data);
+	data->dmax_mode = STMVL53L1_CFG_DEFAULT_DMAX_MODE;
+	data->smudge_correction_mode =
+		STMVL53L1_CFG_DEFAULT_SMUDGE_CORRECTION_MODE;
+	data->current_roi_id = 0;
+	data->is_xtalk_value_changed = false;
+
+	data->is_delay_allowed = true;
+	/* need to be done once */
+	rc = VL53L1_DataInit(&data->stdev);
+	data->is_delay_allowed = false;
+	if (rc) {
+		vl53l1_errmsg("VL53L1_DataInit %d\n", rc);
+		goto exit_unregister_dev_ps;
+	}
+
+	rc = VL53L1_GetDeviceInfo(&data->stdev, &dev_info);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetDeviceInfo %d\n", rc);
+		goto exit_unregister_dev_ps;
+	}
+	vl53l1_errmsg("device name %s\ntype %s\n",
+			dev_info.Name, dev_info.Type);
+
+	/* get managed data here */
+	rc = VL53L1_GetDmaxReflectance(&data->stdev, &data->dmax_reflectance);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetDmaxReflectance %d\n", rc);
+		goto exit_unregister_dev_ps;
+	}
+	rc = VL53L1_GetOpticalCenter(&data->stdev, &data->optical_offset_x,
+		&data->optical_offset_y);
+	if (rc) {
+		vl53l1_errmsg("VL53L1_GetOpticalCenter %d\n", rc);
+		goto exit_unregister_dev_ps;
+	}
+
+	/* set tuning from stmvl53l1_tunings.h */
+	rc = setup_tunings(data);
+	if (rc) {
+		vl53l1_errmsg("setup_tunings %d\n", rc);
+		goto exit_unregister_dev_ps;
+	}
+
+	/* if working in interrupt ask intr to enable and hook the handler */
+	data->poll_mode = 0;
+	rc = stmvl53l1_module_func_tbl.start_intr(data->client_object,
+		&data->poll_mode);
+	if (rc < 0) {
+		vl53l1_errmsg("can't start no  intr\n");
+		goto exit_unregister_dev_ps;
+	}
+
+	data->is_first_irq = true;
+	data->is_first_start_done = false;
+	data->is_delay_allowed = false;
+
+	/* to register as a misc device */
+	data->miscdev.minor = MISC_DYNAMIC_MINOR;
+	/* multiple dev name use id in name but 1st */
+	if (data->id == 0)
+		strcpy(data->name, VL53L1_MISC_DEV_NAME);
+	else
+		sprintf(data->name, "%s%d", VL53L1_MISC_DEV_NAME, data->id);
+
+	data->miscdev.name = data->name;
+	data->miscdev.fops = &stmvl53l1_ranging_fops;
+	vl53l1_errmsg("Misc device registration name:%s\n", data->miscdev.name);
+	rc = misc_register(&data->miscdev);
+	if (rc != 0) {
+		vl53l1_errmsg("misc dev reg fail\n");
+		goto exit_unregister_dev_ps;
+	}
+	/* bring back device under reset */
+	reset_hold(data);
+	rc = stmvl53l1_module_func_tbl.power_down(data->client_object);
+	if (rc) {
+		vl53l1_errmsg("%d,error1 power_down rc %d\n", __LINE__, rc);
+	}
+    stmvl53l1_disable_pinctrl();
+	return 0;
+
+exit_unregister_dev_ps:
+	sysfs_remove_bin_file(&data->input_dev_ps->dev.kobj,
+		&stmvl53l1_zone_calib_data_attr);
+	sysfs_remove_bin_file(&data->input_dev_ps->dev.kobj,
+		&stmvl53l1_calib_data_attr);
+	sysfs_remove_group(&data->input_dev_ps->dev.kobj,
+		&stmvl53l1_attr_group);
+	input_unregister_device(data->input_dev_ps);
+exit_ipp_cleanup:
+	stmvl53l1_ipp_cleanup(data);
+	rc = stmvl53l1_module_func_tbl.power_down(data->client_object);
+	if (rc) {
+		vl53l1_errmsg("%d,error2 power_down rc %d\n", __LINE__, rc);
+	}
+
+	return rc;
+}
+
+
+void stmvl53l1_cleanup(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	vl53l1_dbgmsg("enter\n");
+	rc = _ctrl_stop(data);
+	if (rc < 0)
+		vl53l1_errmsg("stop failed %d aborting anyway\n", rc);
+
+	if (data->input_dev_ps) {
+		vl53l1_dbgmsg("to remove sysfs group\n");
+		sysfs_remove_group(&data->input_dev_ps->dev.kobj,
+				&stmvl53l1_attr_group);
+		sysfs_remove_bin_file(&data->input_dev_ps->dev.kobj,
+				&stmvl53l1_calib_data_attr);
+		sysfs_remove_bin_file(&data->input_dev_ps->dev.kobj,
+				&stmvl53l1_zone_calib_data_attr);
+
+		vl53l1_dbgmsg("to unregister input dev\n");
+		input_unregister_device(data->input_dev_ps);
+	}
+
+	if (!IS_ERR(data->miscdev.this_device) &&
+			data->miscdev.this_device != NULL) {
+		vl53l1_dbgmsg("to unregister misc dev\n");
+		misc_deregister(&data->miscdev);
+	}
+	stmvl53l1_ipp_cleanup(data);
+	/* be sure device is put under reset */
+	data->force_device_on_en = false;
+	reset_hold(data);
+	stmvl53l1_module_func_tbl.power_down(data->client_object);
+	vl53l1_dbgmsg("done\n");
+	deallocate_dev_id(data->id);
+	data->is_device_remove = true;
+}
+
+#ifdef CONFIG_PM_SLEEP
+void stmvl53l1_pm_suspend_stop(struct stmvl53l1_data *data)
+{
+	int rc;
+
+	vl53l1_dbgmsg("Enter\n");
+
+	rc = _ctrl_stop(data);
+	if (rc < 0)
+		vl53l1_errmsg("stop failed %d aborting anyway\n", rc);
+
+	vl53l1_dbgmsg("done\n");
+}
+#endif
+
+static long stmvl53l1_ioctl(struct file *file,
+		unsigned int cmd, unsigned long arg)
+{
+	long ret;
+	struct stmvl53l1_data *data =
+			container_of(file->private_data,
+				struct stmvl53l1_data, miscdev);
+	ret = stmvl53l1_ioctl_handler(data, cmd, arg, (void __user *)arg);
+	return ret;
+}
+
+static int __init stmvl53l1_init(void)
+{
+	int rc = 0;
+    rc = stmvl53l1_ipp_init();
+	vl53l1_dbgmsg("Enter,rc=%d\n",rc);
+    if (rc){
+		stmvl53l1_ipp_exit();
+        return rc;
+    }
+    ipp_inited = true;
+	return rc;
+}
+
+static int __init stmvl53l1_late_init(void)
+{
+	int rc = 0;
+
+    vl53l1_dbgmsg("Enter,rc=%d\n",rc);
+    rc = 0;
+	if (rc)
+		goto done;
+	/* i2c/cci client specific init function */
+	rc = stmvl53l1_module_func_tbl.init();
+	if (rc){
+        if(ipp_inited)
+    		stmvl53l1_ipp_exit();
+        ipp_inited = false;
+    }
+done:
+	vl53l1_dbgmsg("End %d\n", rc);
+
+	return rc;
+}
+
+static void __exit stmvl53l1_exit(void)
+{
+	vl53l1_dbgmsg("Enter\n");
+	stmvl53l1_module_func_tbl.deinit(NULL);
+	if (stmvl53l1_module_func_tbl.clean_up != NULL)
+		stmvl53l1_module_func_tbl.clean_up();
+    if(ipp_inited)
+    	stmvl53l1_ipp_exit();
+	vl53l1_dbgmsg("End\n");
+}
+
+/* MODULE_DEVICE_TABLE(i2c, stmvl53l1_id); */
+MODULE_AUTHOR("STMicroelectronics Imaging Division");
+MODULE_DESCRIPTION("ST FlightSense Time-of-Flight sensor driver");
+MODULE_LICENSE("GPL");
+MODULE_VERSION(DRIVER_VERSION);
+
+module_init(stmvl53l1_init);
+late_initcall(stmvl53l1_late_init);
+module_exit(stmvl53l1_exit);
diff --git a/drivers/input/misc/vl53L1/stmvl53l1_tunings.h b/drivers/input/misc/vl53L1/stmvl53l1_tunings.h
new file mode 100644
index 0000000000000000000000000000000000000000..6a92a3b2c3c23040e0495a3781740004237c5b33
--- /dev/null
+++ b/drivers/input/misc/vl53L1/stmvl53l1_tunings.h
@@ -0,0 +1,42 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/*
+ * THIS IS A GENERATED FILE
+ */
+
+#ifndef STMVL53L1_TUNINGS_H
+#define STMVL53L1_TUNINGS_H
+
+static const int tunings[][2] = {
+};
+
+#endif /* STMVL53L1_TUNINGS_H */
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform.h b/drivers/input/misc/vl53L1/vl53l1_platform.h
new file mode 100644
index 0000000000000000000000000000000000000000..742e25aa66dadfd71d913e0bc851ff94e3de5cf5
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform.h
@@ -0,0 +1,444 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+#ifndef _VL53L1_PLATFORM_H_
+#define _VL53L1_PLATFORM_H_
+
+#include "vl53l1_ll_def.h"
+#include "vl53l1_platform_log.h"
+
+#define VL53L1_IPP_API
+#include "vl53l1_platform_ipp_imports.h"
+#include "vl53l1_platform_user_data.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+/**
+ * @file   vl53l1_platform.h
+ *
+ * @brief  All end user OS/platform/application porting
+ */
+
+
+
+/**
+ * @brief  Initialise platform comms.
+ *
+ * @param[in]   pdev            : pointer to device structure (device handle)
+ * @param[in]   comms_type      : selects between I2C and SPI
+ * @param[in]   comms_speed_khz : unsigned short containing the I2C speed in kHz
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_CommsInitialise(
+	VL53L1_Dev_t *pdev,
+	uint8_t       comms_type,
+	uint16_t      comms_speed_khz);
+
+
+/**
+ * @brief  Close platform comms.
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_CommsClose(
+	VL53L1_Dev_t *pdev);
+
+
+/**
+ * @brief Writes the supplied byte buffer to the device
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[in]   pdata     : pointer to uint8_t (byte) buffer containing the data
+ *                          to be written
+ * @param[in]   count     : number of bytes in the supplied byte buffer
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WriteMulti(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint8_t      *pdata,
+		uint32_t      count);
+
+
+/**
+ * @brief  Reads the requested number of bytes from the device
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[out]  pdata     : pointer to the uint8_t (byte) buffer to store read
+ *                          data
+ * @param[in]   count     : number of bytes to read
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ReadMulti(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint8_t      *pdata,
+		uint32_t      count);
+
+
+/**
+ * @brief  Writes a single byte to the device
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[in]   data      : uint8_t data value to write
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WrByte(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint8_t       data);
+
+
+/**
+ * @brief  Writes a single word (16-bit unsigned) to the device
+ *
+ * Manages the big-endian nature of the device register map
+ * (first byte written is the MS byte).
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[in]   data      : uin16_t data value write
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WrWord(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint16_t      data);
+
+
+/**
+ * @brief  Writes a single dword (32-bit unsigned) to the device
+ *
+ * Manages the big-endian nature of the device register map
+ * (first byte written is the MS byte).
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[in]   data      : uint32_t data value to write
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WrDWord(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint32_t      data);
+
+
+
+/**
+ * @brief  Reads a single byte from the device
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index
+ * @param[out]  pdata     : pointer to uint8_t data value
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ *
+ */
+
+VL53L1_Error VL53L1_RdByte(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint8_t      *pdata);
+
+
+/**
+ * @brief  Reads a single word (16-bit unsigned) from the device
+ *
+ * Manages the big-endian nature of the device (first byte read is the MS byte).
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[out]  pdata     : pointer to uint16_t data value
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_RdWord(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint16_t     *pdata);
+
+
+/**
+ * @brief  Reads a single dword (32-bit unsigned) from the device
+ *
+ * Manages the big-endian nature of the device (first byte read is the MS byte).
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   index     : uint16_t register index value
+ * @param[out]  pdata     : pointer to uint32_t data value
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_RdDWord(
+		VL53L1_Dev_t *pdev,
+		uint16_t      index,
+		uint32_t     *pdata);
+
+
+
+/**
+ * @brief  Implements a programmable wait in us
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   wait_us   : integer wait in micro seconds
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WaitUs(
+		VL53L1_Dev_t *pdev,
+		int32_t       wait_us);
+
+
+/**
+ * @brief  Implements a programmable wait in ms
+ *
+ * @param[in]   pdev      : pointer to device structure (device handle)
+ * @param[in]   wait_ms   : integer wait in milliseconds
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WaitMs(
+		VL53L1_Dev_t *pdev,
+		int32_t       wait_ms);
+
+
+/**
+ * @brief Get the frequency of the timer used for ranging results time stamps
+ *
+ * @param[out] ptimer_freq_hz : pointer for timer frequency
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GetTimerFrequency(int32_t *ptimer_freq_hz);
+
+/**
+ * @brief Get the timer value in units of timer_freq_hz (see
+ *        VL53L1_get_timestamp_frequency())
+ *
+ * @param[out] ptimer_count : pointer for timer count value
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GetTimerValue(int32_t *ptimer_count);
+
+
+/**
+ * @brief Set the mode of a specified GPIO pin
+ *
+ * @param  pin - an identifier specifying the pin being modified - defined per
+ *         platform
+ *
+ * @param  mode - an identifier specifying the requested mode - defined per
+ *         platform
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioSetMode(uint8_t pin, uint8_t mode);
+
+
+/**
+ * @brief Set the value of a specified GPIO pin
+ *
+ * @param  pin - an identifier specifying the pin being modified - defined per
+ *         platform
+ *
+ * @param  value - a value to set on the GPIO pin - typically 0 or 1
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioSetValue(uint8_t pin, uint8_t value);
+
+
+/**
+ * @brief Get the value of a specified GPIO pin
+ *
+ * @param  pin - an identifier specifying the pin being modified - defined per
+ *         platform
+ *
+ * @param  pvalue - a value retrieved from the GPIO pin - typically 0 or 1
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioGetValue(uint8_t pin, uint8_t *pvalue);
+
+
+/**
+ * @brief Sets and clears the XShutdown pin on the Ewok
+ *
+ * @param  value - the value for xshutdown - 0 = in reset, 1 = operational
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioXshutdown(uint8_t value);
+
+
+/**
+ * @brief Sets and clears the Comms Mode pin (NCS) on the Ewok
+ *
+ * @param  value - the value for comms select - 0 = I2C, 1 = SPI
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioCommsSelect(uint8_t value);
+
+
+/**
+ * @brief Enables and disables the power to the Ewok module
+ *
+ * @param  value - the state of the power supply - 0 = power off, 1 = power on
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GpioPowerEnable(uint8_t value);
+
+/**
+ * @brief Enables callbacks to the supplied funtion pointer when Ewok interrupts
+ *        ocurr
+ *
+ * @param  function - a function callback supplies by the caller, for interrupt
+ *         notification
+ * @param  edge_type - falling edge or rising edge interrupt detection
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error  VL53L1_GpioInterruptEnable(void (*function)(void),
+	uint8_t edge_type);
+
+
+/**
+ * @brief Disables the callback on Ewok interrupts
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error  VL53L1_GpioInterruptDisable(void);
+
+
+/*
+ * @brief Gets current system tick count in [ms]
+ *
+ * @return  time_ms : current time in [ms]
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_GetTickCount(
+	uint32_t *ptime_ms);
+
+
+/**
+ * @brief Register "wait for value" polling routine
+ *
+ * Port of the V2WReg Script function  WaitValueMaskEx()
+ *
+ * @param[in]   pdev          : pointer to device structure (device handle)
+ * @param[in]   timeout_ms    : timeout in [ms]
+ * @param[in]   index         : uint16_t register index value
+ * @param[in]   value         : value to wait for
+ * @param[in]   mask          : mask to be applied before comparison with value
+ * @param[in]   poll_delay_ms : polling delay been each read transaction in [ms]
+ *
+ * @return  VL53L1_ERROR_NONE     Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_WaitValueMaskEx(
+		VL53L1_Dev_t *pdev,
+		uint32_t      timeout_ms,
+		uint16_t      index,
+		uint8_t       value,
+		uint8_t       mask,
+		uint32_t      poll_delay_ms);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_ipp.h b/drivers/input/misc/vl53L1/vl53l1_platform_ipp.h
new file mode 100644
index 0000000000000000000000000000000000000000..b187272fe7b335bc81064c928eb98722b71247bd
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_ipp.h
@@ -0,0 +1,188 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+#ifndef _VL53L1_PLATFORM_IPP_H_
+#define _VL53L1_PLATFORM_IPP_H_
+
+#include "vl53l1_ll_def.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+/**
+ * @file   vl53l1_platform_ipp.h
+ *
+ * @brief  EwokPlus25 IPP Wrapper Functions
+ */
+
+/**
+ * @brief  IPP Wrapper call for histogram post processing
+ *
+ *
+ * @param[in]    Dev                       : Device handle
+ * @param[in]    pdmax_cal                 : DMAX calibration data
+ * @param[in]    pdmax_cfg                 : DMAX configuration data
+ * @param[in]    ppost_cfg                 : VL53L1_hist_post_process_config_t
+ * @param[in]    pbins                     : Input histogram raw bin data
+ * @param[in]    pxtalk                    : Cross talk histogram data
+ * @param[out]   presults                  : Output VL53L1_range_results_t
+ *                                           structure
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_hist_process_data(
+	VL53L1_DEV                         Dev,
+	VL53L1_dmax_calibration_data_t    *pdmax_cal,
+	VL53L1_hist_gen3_dmax_config_t    *pdmax_cfg,
+	VL53L1_hist_post_process_config_t *ppost_cfg,
+	VL53L1_histogram_bin_data_t       *pbins,
+	VL53L1_xtalk_histogram_data_t     *pxtalk,
+	VL53L1_range_results_t            *presults);
+
+
+/**
+ * @brief  IPP Wrapper call for histogram ambient dmax calc
+ *
+ * The target reflectance in percent for the DMAX calculation
+ * is set by target_reflectance input
+ *
+ * The fixed point format is 7.2
+ *
+ * @param[in]    Dev                : Device handle
+ * @param[in]    target_reflectance : target reflectance to report ambient DMAX
+ *                                    Percentage in 7.2 fixed point format
+ * @param[in]    pdmax_cal          : DMAX calibration data
+ * @param[in]    pdmax_cfg          : DMAX configuration data
+ * @param[in]    pbins              : Input histogram raw bin data
+ * @param[out]   pambient_dmax_mm   : Output ambient DMAX distance in [mm]
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_hist_ambient_dmax(
+	VL53L1_DEV                         Dev,
+	uint16_t                           target_reflectance,
+	VL53L1_dmax_calibration_data_t    *pdmax_cal,
+	VL53L1_hist_gen3_dmax_config_t    *pdmax_cfg,
+	VL53L1_histogram_bin_data_t       *pbins,
+	int16_t                           *pambient_dmax_mm);
+
+
+/**
+ * @brief  IPP Wrapper call for xtalk calibration post processing
+ *
+ * @param[in]      Dev                 : Device handle
+ * @param[in]      pxtalk_ranges       : Input VL53L1_xtalk_range_results_t
+ *                                       Must contain 5 ranges, 4 quadrants + 1
+ *                                       full FoV
+ * @param[out]     pxtalk_shape        : Output normalised Cross talk  histogram
+ *                                       shape
+ * @param[out]     pxtalk_cal        : Output VL53L1_xtalk_calibration_results_t
+ *                                     structure
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_xtalk_calibration_process_data(
+	VL53L1_DEV                          Dev,
+	VL53L1_xtalk_range_results_t       *pxtalk_ranges,
+	VL53L1_xtalk_histogram_data_t      *pxtalk_shape,
+	VL53L1_xtalk_calibration_results_t *pxtalk_cal);
+
+
+/**
+ * @brief  IPP Wrapper call for applying histogram xtalk correction
+ *
+ * @param[in]   Dev                 : Device handle
+ * @param[in]   pcustomer           : Pointer to input customer data structure
+ * @param[in]   pdyn_cfg            : Pointer to input dynamic parameters
+ *                                    structure
+ * @param[in]   pxtalk_shape        : Pointer to input normalised xtalk
+ *                                    histogram shape
+ * @param[in]   pip_hist_data       : Pointer to input histogram data struct
+ * @param[out]  pop_hist_data       : Pointer to output xtalk corrected
+ *                                    histogram data struct
+ * @param[out]  pxtalk_count_data    : Pointer to output xtalk histogram
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_hist_xtalk_correction(
+	VL53L1_DEV                    Dev,
+	VL53L1_customer_nvm_managed_t *pcustomer,
+	VL53L1_dynamic_config_t       *pdyn_cfg,
+	VL53L1_xtalk_histogram_data_t *pxtalk_shape,
+	VL53L1_histogram_bin_data_t   *pip_hist_data,
+	VL53L1_histogram_bin_data_t   *pop_hist_data,
+	VL53L1_histogram_bin_data_t   *pxtalk_count_data);
+
+/**
+ * @brief  IPP Wrapper call for Generating Xtalk data from dual reflectance
+ * histogram data
+ *
+ * @param[in]  Dev                          : Device handle
+ * @param[in]  pxtalk_results               : Pointer to xtalk_results structure
+ *                                            containing dual reflectance
+ *                                            histogram data
+ * @param[in]  expected_target_distance_mm  : User input of true target distance
+ * @param[in]  higher_reflectance           : User input detailing which
+ *                                            histogram data 1 or 2 has the
+ *                                            highest reflectance.
+ * @param[out] pxtalk_avg_samples           : Pointer to output xtalk histogram
+ *                                            data
+ *
+ * @return   VL53L1_ERROR_NONE    Success
+ * @return  "Other error code"    See ::VL53L1_Error
+ */
+
+VL53L1_Error VL53L1_ipp_generate_dual_reflectance_xtalk_samples(
+	VL53L1_DEV                     Dev,
+	VL53L1_xtalk_range_results_t  *pxtalk_results,
+	uint16_t                       expected_target_distance_mm,
+	uint8_t                        higher_reflectance,
+	VL53L1_histogram_bin_data_t	  *pxtalk_avg_samples);
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_ipp_imports.h b/drivers/input/misc/vl53L1/vl53l1_platform_ipp_imports.h
new file mode 100644
index 0000000000000000000000000000000000000000..b7700a9190898ad93274c52b6a43b4432d9422bc
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_ipp_imports.h
@@ -0,0 +1,36 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+#ifndef _VL53L1_PLATFORM_IPP_IMPORTS_H_
+#define _VL53L1_PLATFORM_IPP_IMPORTS_H_
+
+#endif
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_log.h b/drivers/input/misc/vl53L1/vl53l1_platform_log.h
new file mode 100644
index 0000000000000000000000000000000000000000..357e0abb97731cb62a6ce4e4dbbad2627b7b0b76
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_log.h
@@ -0,0 +1,177 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file  vl53l1_platform_log.h
+ *
+ * @brief EwokPlus25 platform logging function definition
+ */
+
+
+#ifndef _VL53L1_PLATFORM_LOG_H_
+#define _VL53L1_PLATFORM_LOG_H_
+
+#include <linux/string.h>
+
+#ifdef VL53L1_LOG_ENABLE
+	#include "vl53l1_platform_user_config.h"
+
+	#ifdef _MSC_VER
+	#   define EWOKPLUS_EXPORTS  __declspec(dllexport)
+	#else
+	#       define EWOKPLUS_EXPORTS
+	#endif
+
+	#include "vl53l1_types.h"
+
+	#ifdef __cplusplus
+	extern "C" {
+	#endif
+
+	#include <linux/time.h>
+
+	/**
+	 * @brief Set the level, output and specific functions for module
+	 * logging.
+	 *
+	 *
+	 * @param filename  - full path of output log file, NULL for print to
+	 * stdout
+	 *
+	 * @param modules   - Module or None or All to trace
+	 *                      VL53L1_TRACE_MODULE_NONE
+	 *                      VL53L1_TRACE_MODULE_API
+	 *                      VL53L1_TRACE_MODULE_CORE
+	 *                      VL53L1_TRACE_MODULE_TUNING
+	 *                      VL53L1_TRACE_MODULE_CHARACTERISATION
+	 *                      VL53L1_TRACE_MODULE_PLATFORM
+	 *                      VL53L1_TRACE_MODULE_ALL
+	 *
+	 * @param level     - trace level
+	 *                      VL53L1_TRACE_LEVEL_NONE
+	 *                      VL53L1_TRACE_LEVEL_ERRORS
+	 *                      VL53L1_TRACE_LEVEL_WARNING
+	 *                      VL53L1_TRACE_LEVEL_INFO
+	 *                      VL53L1_TRACE_LEVEL_DEBUG
+	 *                      VL53L1_TRACE_LEVEL_ALL
+	 *                      VL53L1_TRACE_LEVEL_IGNORE
+	 *
+	 *  @param functions - function level to trace;
+	 *                      VL53L1_TRACE_FUNCTION_NONE
+	 *                      VL53L1_TRACE_FUNCTION_I2C
+	 *                      VL53L1_TRACE_FUNCTION_ALL
+	 *
+	 * @return status - always VL53L1_ERROR_NONE
+	 *
+	 */
+
+	#define		VL53L1_TRACE_LEVEL_NONE			0x00000000
+	#define		VL53L1_TRACE_LEVEL_ERRORS		0x00000001
+	#define		VL53L1_TRACE_LEVEL_WARNING		0x00000002
+	#define		VL53L1_TRACE_LEVEL_INFO			0x00000004
+	#define		VL53L1_TRACE_LEVEL_DEBUG		0x00000008
+	#define		VL53L1_TRACE_LEVEL_ALL			0x00000010
+	#define		VL53L1_TRACE_LEVEL_IGNORE		0x00000020
+
+	#define		VL53L1_TRACE_FUNCTION_NONE		0x00000000
+	#define		VL53L1_TRACE_FUNCTION_I2C		0x00000001
+	#define		VL53L1_TRACE_FUNCTION_ALL		0x7fffffff
+
+	#define		VL53L1_TRACE_MODULE_NONE		0x00000000
+	#define		VL53L1_TRACE_MODULE_API			0x00000001
+	#define		VL53L1_TRACE_MODULE_CORE		0x00000002
+	#define		VL53L1_TRACE_MODULE_PROTECTED		0x00000004
+	#define		VL53L1_TRACE_MODULE_HISTOGRAM		0x00000008
+	#define		VL53L1_TRACE_MODULE_REGISTERS		0x00000010
+	#define		VL53L1_TRACE_MODULE_PLATFORM		0x00000020
+	#define		VL53L1_TRACE_MODULE_NVM			0x00000040
+	#define		VL53L1_TRACE_MODULE_CALIBRATION_DATA	0x00000080
+	#define		VL53L1_TRACE_MODULE_NVM_DATA		0x00000100
+	#define		VL53L1_TRACE_MODULE_HISTOGRAM_DATA	0x00000200
+	#define		VL53L1_TRACE_MODULE_RANGE_RESULTS_DATA	0x00000400
+	#define		VL53L1_TRACE_MODULE_XTALK_DATA		0x00000800
+	#define		VL53L1_TRACE_MODULE_OFFSET_DATA		0x00001000
+	#define		VL53L1_TRACE_MODULE_DATA_INIT		0x00002000
+	#define		VL53L1_TRACE_MODULE_REF_SPAD_CHAR	0x00004000
+	#define		VL53L1_TRACE_MODULE_SPAD_RATE_MAP	0x00008000
+	#ifdef PAL_EXTENDED
+		#define	VL53L1_TRACE_MODULE_SPAD		0x01000000
+		#define	VL53L1_TRACE_MODULE_FMT			0x02000000
+		#define	VL53L1_TRACE_MODULE_UTILS		0x04000000
+		#define	VL53L1_TRACE_MODULE_BENCH_FUNCS		0x08000000
+	#endif
+	#define		VL53L1_TRACE_MODULE_CUSTOMER_API	0x40000000
+	#define		VL53L1_TRACE_MODULE_ALL			0x7fffffff
+
+	extern void log_trace_print(uint32_t module, uint32_t level,
+		uint32_t function, const char *format, ...);
+
+	#define _LOG_TRACE_PRINT_FMT(module, level, function, format, ...) \
+		log_trace_print(module, level, function, \
+			KERN_INFO "<TRACE> " format, ##__VA_ARGS__)
+	#define _LOG_TRACE_PRINT(module, level, function, ...) \
+		_LOG_TRACE_PRINT_FMT(module, level, function, ##__VA_ARGS__)
+	#define _LOG_FUNCTION_START(module, fmt, ...) \
+		log_trace_print(module, VL53L1_TRACE_LEVEL_NONE, \
+			VL53L1_TRACE_FUNCTION_ALL, \
+			KERN_INFO "<START> %s "fmt"\n", __func__, ##__VA_ARGS__)
+	#define _LOG_FUNCTION_END(module, status, ...) \
+		log_trace_print(module, VL53L1_TRACE_LEVEL_NONE, \
+			VL53L1_TRACE_FUNCTION_ALL, \
+			KERN_INFO "<END>   %s %d\n", __func__, status)
+	#define _LOG_FUNCTION_END_FMT(module, status, fmt, ...) \
+		log_trace_print(module, VL53L1_TRACE_LEVEL_NONE, \
+			VL53L1_TRACE_FUNCTION_ALL, \
+			KERN_INFO "<END  > %s %d"fmt"\n", __func__, status, \
+			##__VA_ARGS__)
+	#define _LOG_GET_TRACE_FUNCTIONS() 0
+	#define _LOG_SET_TRACE_FUNCTIONS(functions)
+
+	#define _LOG_STRING_BUFFER(x) char x[VL53L1_MAX_STRING_LENGTH]
+
+	#ifdef __cplusplus
+	}
+	#endif
+
+#else /* VL53L1_LOG_ENABLE - no logging */
+	#include "vl53l1_platform_user_config.h"
+
+	#define _LOG_TRACE_PRINT(module, level, function, ...)
+	#define _LOG_FUNCTION_START(module, fmt, ...)
+	#define _LOG_FUNCTION_END(module, status, ...)
+	#define _LOG_FUNCTION_END_FMT(module, status, fmt, ...)
+	#define _LOG_GET_TRACE_FUNCTIONS() 0
+	#define _LOG_SET_TRACE_FUNCTIONS(functions)
+	#define _LOG_STRING_BUFFER(x)
+
+#endif /* VL53L1_LOG_ENABLE */
+
+#endif  /* _VL53L1_PLATFORM_LOG_H_ */
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_user_config.h b/drivers/input/misc/vl53L1/vl53l1_platform_user_config.h
new file mode 100644
index 0000000000000000000000000000000000000000..396d25762a5d341e9d9a742bda336dcea93f65bf
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_user_config.h
@@ -0,0 +1,117 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+/**
+ * @file  vl53l1_platform_user_config.h
+ *
+ * @brief EwokPlus compile time user modifiable configuration
+ */
+
+
+#ifndef _VL53L1_PLATFORM_USER_CONFIG_H_
+#define _VL53L1_PLATFORM_USER_CONFIG_H_
+
+#define    VL53L1_BYTES_PER_WORD              2
+#define    VL53L1_BYTES_PER_DWORD             4
+
+/* Define polling delays */
+#define VL53L1_BOOT_COMPLETION_POLLING_TIMEOUT_MS     500
+#define VL53L1_RANGE_COMPLETION_POLLING_TIMEOUT_MS   2000
+#define VL53L1_TEST_COMPLETION_POLLING_TIMEOUT_MS   60000
+
+#define VL53L1_POLLING_DELAY_MS                         1
+
+/* Define LLD TuningParms Page Base Address
+ * - Part of Patch_AddedTuningParms_11761
+ */
+#define VL53L1_TUNINGPARM_PUBLIC_PAGE_BASE_ADDRESS  0x8000
+#define VL53L1_TUNINGPARM_PRIVATE_PAGE_BASE_ADDRESS 0xC000
+
+#define VL53L1_GAIN_FACTOR__STANDARD_DEFAULT       0x0800
+	/*!<  Default standard ranging gain correction factor
+	 * 1.11 format. 1.0 = 0x0800, 0.980 = 0x07D7
+	 */
+#define VL53L1_GAIN_FACTOR__HISTOGRAM_DEFAULT      0x0800
+	/*!<  Default histogram ranging gain correction factor
+	 * 1.11 format. 1.0 = 0x0800, 0.975 = 0x07CC
+	 */
+
+
+#define VL53L1_OFFSET_CAL_MIN_EFFECTIVE_SPADS  0x0500
+	/*!< Lower Limit for the  MM1 effective SPAD count during offset
+	 * calibration Format 8.8 0x0500 -> 5.0 effective SPADs
+	 */
+
+#define VL53L1_OFFSET_CAL_MAX_PRE_PEAK_RATE_MCPS   0x1900
+	/*!< Max Limit for the pre range preak rate during offset
+	 * calibration Format 9.7 0x1900 -> 50.0 Mcps.
+	 * If larger then in pile up
+	 */
+
+#define VL53L1_OFFSET_CAL_MAX_SIGMA_MM             0x0040
+	/*!< Max sigma estimate limit during offset calibration
+	 *   Check applies to pre-range, mm1 and mm2 ranges
+	 *   Format 14.2 0x0040 -> 16.0mm.
+	 */
+
+
+#define VL53L1_ZONE_CAL_MAX_PRE_PEAK_RATE_MCPS     0x1900
+	/*!< Max Peak Rate Limit for the during zone calibration
+	 *   Format 9.7 0x1900 -> 50.0 Mcps.
+	 *   If larger then in pile up
+	 */
+
+#define VL53L1_ZONE_CAL_MAX_SIGMA_MM               0x0040
+	/*!< Max sigma estimate limit during zone calibration
+	 *   Format 14.2 0x0040 -> 16.0mm.
+	 */
+
+
+#define VL53L1_XTALK_EXTRACT_MAX_SIGMA_MM          0x008C
+	/*!< Max Sigma value allowed for a successful xtalk extraction
+	 *   Format 14.2 0x008C -> 35.0 mm.
+	 */
+
+
+#define VL53L1_MAX_USER_ZONES                169
+	/*!< Max number of user Zones - maximal limitation from
+	 * FW stream divide - value of 254
+	 */
+
+#define VL53L1_MAX_RANGE_RESULTS              4
+	/*!< Sets the maximum number of targets distances the histogram
+	 * post processing can generate
+	 */
+
+#define VL53L1_MAX_STRING_LENGTH 512
+
+#endif  /* _VL53L1_PLATFORM_USER_CONFIG_H_ */
+
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_user_data.h b/drivers/input/misc/vl53L1/vl53l1_platform_user_data.h
new file mode 100644
index 0000000000000000000000000000000000000000..41da1dda1235f29fa5f317f3e7aee72cae4ff8a8
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_user_data.h
@@ -0,0 +1,63 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+#ifndef _VL53L1_PLATFORM_USER_DATA_H_
+#define _VL53L1_PLATFORM_USER_DATA_H_
+
+#include "vl53l1_ll_def.h"
+
+#include <linux/string.h>
+#include "vl53l1_def.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <linux/string.h>
+
+#define VL53L1_Dev_t VL53L1_DevData_t
+#define VL53L1_DEV VL53L1_DevData_t *
+
+#define VL53L1DevDataGet(Dev, field) (Dev->field)
+#define VL53L1DevDataSet(Dev, field, data) ((Dev->field) = (data))
+
+#define VL53L1DevStructGetLLDriverHandle(Dev) (&VL53L1DevDataGet(Dev, LLData))
+#define VL53L1DevStructGetLLResultsHandle(Dev) (&VL53L1DevDataGet(Dev,\
+		llresults))
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/vl53l1_platform_user_defines.h b/drivers/input/misc/vl53L1/vl53l1_platform_user_defines.h
new file mode 100644
index 0000000000000000000000000000000000000000..731c48341756a632ed396303a316f7a99aea347d
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_platform_user_defines.h
@@ -0,0 +1,92 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+
+
+#ifndef _VL53L1_PLATFORM_USER_DEFINES_H_
+#define _VL53L1_PLATFORM_USER_DEFINES_H_
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#ifdef __KERNEL__
+#include <linux/math64.h>
+#endif
+
+/**
+ * @file   vl53l1_platform_user_defines.h
+ *
+ * @brief  All end user OS/platform/application definitions
+ */
+
+
+/**
+ * @def do_division_u
+ * @brief customer supplied division operation - 64-bit unsigned
+ *
+ * @param dividend      unsigned 64-bit numerator
+ * @param divisor       unsigned 64-bit denominator
+ */
+#ifdef __KERNEL__
+#define do_division_u(dividend, divisor) div64_u64(dividend, divisor)
+#else
+#define do_division_u(dividend, divisor) (dividend / divisor)
+#endif
+
+/**
+ * @def do_division_s
+ * @brief customer supplied division operation - 64-bit signed
+ *
+ * @param dividend      signed 64-bit numerator
+ * @param divisor       signed 64-bit denominator
+ */
+#ifdef __KERNEL__
+#define do_division_s(dividend, divisor) div64_s64(dividend, divisor)
+#else
+#define do_division_s(dividend, divisor) (dividend / divisor)
+#endif
+
+#define WARN_OVERRIDE_STATUS(__X__)\
+	trace_print(VL53L1_TRACE_LEVEL_WARNING, #__X__)
+
+
+#define DISABLE_WARNINGS()
+#define ENABLE_WARNINGS()
+
+
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
diff --git a/drivers/input/misc/vl53L1/vl53l1_types.h b/drivers/input/misc/vl53L1/vl53l1_types.h
new file mode 100644
index 0000000000000000000000000000000000000000..3d78e25592046029e98a55d2811cb8b5e15aed2f
--- /dev/null
+++ b/drivers/input/misc/vl53L1/vl53l1_types.h
@@ -0,0 +1,46 @@
+/**************************************************************************
+ * Copyright (c) 2016, STMicroelectronics - All Rights Reserved
+
+ License terms: BSD 3-clause "New" or "Revised" License.
+
+ Redistribution and use in source and binary forms, with or without
+ modification, are permitted provided that the following conditions are met:
+
+ 1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+
+ 2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+ 3. Neither the name of the copyright holder nor the names of its contributors
+ may be used to endorse or promote products derived from this software
+ without specific prior written permission.
+
+ THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ ****************************************************************************/
+/**
+ * @file  vl53l1_types.h
+ * @brief VL53L1 types definition
+ */
+
+#ifndef _VL53L1_TYPES_H_
+#define _VL53L1_TYPES_H_
+
+#include <linux/types.h>
+/** use where fractional values are expected
+ *
+ * Given a floating point value f it's .16 bit point is (int)(f*(1<<16))
+ */
+typedef uint32_t FixPoint1616_t;
+
+#endif /* VL53L1_TYPES_H_ */
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
index e4ba3f6d84e5be116076741f9a7704df1b6c293a..2f2c15a64d84826a1113e3554f7617c00b2a70e2 100644
--- a/drivers/input/touchscreen/Kconfig
+++ b/drivers/input/touchscreen/Kconfig
@@ -1256,6 +1256,12 @@ config TOUCHSCREEN_ST
 
 source "drivers/input/touchscreen/st/Kconfig"
 
+config TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI
+	tristate "Synaptics s3320 i2c touchscreen"
+	depends on I2C
+	help
+	  This enables support for Synaptics s1302 RMI over I2C based touch key.
+
 config TOUCHSCREEN_HIMAX_CHIPSET
 	bool "Himax touchpanel CHIPSET"
 	depends on I2C
@@ -1277,5 +1283,6 @@ config TOUCHSCREEN_SYNAPTICS_DSX
           If unsure, say N.
 
 source "drivers/input/touchscreen/synaptics_dsx/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Kconfig"
 
 endif
diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile
index fbc7fdbaf3f023f7b430bc782a09f9453b4192df..14b8e7c5635e169b83591c50bfe430eaa48e097b 100644
--- a/drivers/input/touchscreen/Makefile
+++ b/drivers/input/touchscreen/Makefile
@@ -73,7 +73,7 @@ obj-$(CONFIG_TOUCHSCREEN_STMPE)		+= stmpe-ts.o
 obj-$(CONFIG_TOUCHSCREEN_SUN4I)		+= sun4i-ts.o
 obj-$(CONFIG_TOUCHSCREEN_SUR40)		+= sur40.o
 obj-$(CONFIG_TOUCHSCREEN_SURFACE3_SPI)	+= surface3_spi.o
-obj-$(CONFIG_TOUCHSCREEN_SYNAPTICS_DSX) += synaptics_dsx/
+#obj-$(CONFIG_TOUCHSCREEN_SYNAPTICS_DSX) += synaptics_dsx/
 obj-$(CONFIG_TOUCHSCREEN_TI_AM335X_TSC)	+= ti_am335x_tsc.o
 obj-$(CONFIG_TOUCHSCREEN_TOUCHIT213)	+= touchit213.o
 obj-$(CONFIG_TOUCHSCREEN_TOUCHRIGHT)	+= touchright.o
@@ -106,4 +106,9 @@ obj-$(CONFIG_TOUCHSCREEN_ZFORCE)	+= zforce_ts.o
 obj-$(CONFIG_TOUCHSCREEN_COLIBRI_VF50)	+= colibri-vf50-ts.o
 obj-$(CONFIG_TOUCHSCREEN_ROHM_BU21023)	+= rohm_bu21023.o
 obj-$(CONFIG_TOUCHSCREEN_ST)		+= st/
+obj-$(CONFIG_TOUCHPANEL_ONEPLUS)	+= oneplus_touchscreen/
+obj-$(CONFIG_TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI) += synaptics_driver_s3320.o
+obj-$(CONFIG_TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI) += synaptics_s3320_redremote.o
+obj-$(CONFIG_TOUCHSCREEN_SYNAPTICS_S3320_I2C_RMI) += synaptics_dsx_fw_update.o
+
 obj-$(CONFIG_TOUCHSCREEN_HIMAX_CHIPSET)	+= hxchipset/
diff --git a/drivers/input/touchscreen/fw_update_v7.if b/drivers/input/touchscreen/fw_update_v7.if
new file mode 100644
index 0000000000000000000000000000000000000000..31869adb96eb605a5dcddb075f109f43d002e91a
--- /dev/null
+++ b/drivers/input/touchscreen/fw_update_v7.if
@@ -0,0 +1,1877 @@
+/*
+ * Synaptics DSX touchscreen driver
+ *
+ * Copyright (C) 2012 Synaptics Incorporated
+ *
+ * Copyright (C) 2012 Alexandra Chin <alexandra.chin@tw.synaptics.com>
+ * Copyright (C) 2012 Scott Lin <scott.lin@tw.synaptics.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ */
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/firmware.h>
+#include <linux/platform_device.h>
+
+
+#define DO_STARTUP_FW_UPDATE
+
+#ifdef DO_STARTUP_FW_UPDATE
+#ifdef CONFIG_FB
+#define WAIT_FOR_FB_READY
+#define FB_READY_WAIT_MS 100
+#define FB_READY_TIMEOUT_S 30
+#endif
+#endif
+
+#define FORCE_UPDATE false
+#define DO_LOCKDOWN false
+
+#define MAX_IMAGE_NAME_LEN 256
+#define MAX_FIRMWARE_ID_LEN 10
+
+#define IMAGE_HEADER_VERSION_05 0x05
+#define IMAGE_HEADER_VERSION_06 0x06
+#define IMAGE_HEADER_VERSION_10 0x10
+
+#define IMAGE_AREA_OFFSET 0x100
+#define LOCKDOWN_SIZE 0x50
+
+#define V5V6_BOOTLOADER_ID_OFFSET 0
+
+#define V5_PROPERTIES_OFFSET 2
+#define V5_BLOCK_SIZE_OFFSET 3
+#define V5_BLOCK_COUNT_OFFSET 5
+#define V5_BLOCK_NUMBER_OFFSET 0
+#define V5_BLOCK_DATA_OFFSET 2
+
+#define V6_PROPERTIES_OFFSET 1
+#define V6_BLOCK_SIZE_OFFSET 2
+#define V6_BLOCK_COUNT_OFFSET 3
+#define V6_PROPERTIES_2_OFFSET 4
+#define V6_GUEST_CODE_BLOCK_COUNT_OFFSET 5
+#define V6_BLOCK_NUMBER_OFFSET 0
+#define V6_BLOCK_DATA_OFFSET 1
+#define V6_FLASH_COMMAND_OFFSET 2
+#define V6_FLASH_STATUS_OFFSET 3
+
+#define V7_FLASH_STATUS_OFFSET 0
+#define V7_PARTITION_ID_OFFSET 1
+#define V7_BLOCK_NUMBER_OFFSET 2
+#define V7_TRANSFER_LENGTH_OFFSET 3
+#define V7_COMMAND_OFFSET 4
+#define V7_PAYLOAD_OFFSET 5
+
+#define V7_PARTITION_SUPPORT_BYTES 4
+
+#define F35_ERROR_CODE_OFFSET 0
+#define F35_CHUNK_NUM_LSB_OFFSET 0
+#define F35_CHUNK_NUM_MSB_OFFSET 1
+#define F35_CHUNK_DATA_OFFSET 2
+#define F35_CHUNK_COMMAND_OFFSET 18
+
+#define F35_CHUNK_SIZE 16
+#define F35_ERASE_ALL_WAIT_MS 3000
+#define F35_RESET_WAIT_MS 250
+
+#define SLEEP_MODE_NORMAL (0x00)
+#define SLEEP_MODE_SENSOR_SLEEP (0x01)
+#define SLEEP_MODE_RESERVED0 (0x02)
+#define SLEEP_MODE_RESERVED1 (0x03)
+
+#define ENABLE_WAIT_MS (1 * 1000)
+#define WRITE_WAIT_MS (3 * 1000)
+#define ERASE_WAIT_MS (5 * 1000)
+
+#define MIN_SLEEP_TIME_US 50
+#define MAX_SLEEP_TIME_US 100
+
+#define INT_DISABLE_WAIT_MS 20
+#define ENTER_FLASH_PROG_WAIT_MS 20
+
+#define PRODUCT_ID_SIZE 10
+
+#define MASK_16BIT 0xFFFF
+#define MASK_8BIT 0xFF
+#define MASK_7BIT 0x7F
+#define MASK_6BIT 0x3F
+#define MASK_5BIT 0x1F
+#define MASK_4BIT 0x0F
+#define MASK_3BIT 0x07
+#define MASK_2BIT 0x03
+#define MASK_1BIT 0x01
+
+enum f34_version {
+	F34_V0 = 0,
+	F34_V1,
+	F34_V2,
+};
+
+enum bl_version {
+	BL_V5 = 5,
+	BL_V6 = 6,
+	BL_V7 = 7,
+};
+
+enum flash_area {
+	NONE = 0,
+	UI_FIRMWARE,
+	UI_CONFIG,
+};
+
+enum update_mode {
+	NORMAL = 1,
+	FORCE = 2,
+	LOCKDOWN = 8,
+};
+
+enum config_area {
+	UI_CONFIG_AREA = 0,
+	PM_CONFIG_AREA,
+	BL_CONFIG_AREA,
+	DP_CONFIG_AREA,
+	FLASH_CONFIG_AREA,
+};
+
+enum v7_partition_id {
+	BOOTLOADER_PARTITION = 0x01,
+	DEVICE_CONFIG_PARTITION,
+	FLASH_CONFIG_PARTITION,
+	MANUFACTURING_BLOCK_PARTITION,
+	GUEST_SERIALIZATION_PARTITION,
+	GLOBAL_PARAMETERS_PARTITION,
+	CORE_CODE_PARTITION,
+	CORE_CONFIG_PARTITION,
+	GUEST_CODE_PARTITION,
+	DISPLAY_CONFIG_PARTITION,
+};
+
+enum v7_flash_command {
+	CMD_V7_IDLE = 0x00,
+	CMD_V7_ENTER_BL,
+	CMD_V7_READ,
+	CMD_V7_WRITE,
+	CMD_V7_ERASE,
+	CMD_V7_ERASE_AP,
+	CMD_V7_SENSOR_ID,
+};
+
+enum v5v6_flash_command {
+	CMD_V5V6_IDLE = 0x0,
+	CMD_V5V6_WRITE_FW = 0x2,
+	CMD_V5V6_ERASE_ALL = 0x3,
+	CMD_V5V6_WRITE_LOCKDOWN = 0x4,
+	CMD_V5V6_READ_CONFIG = 0x5,
+	CMD_V5V6_WRITE_CONFIG = 0x6,
+	CMD_V5V6_ERASE_UI_CONFIG = 0x7,
+	CMD_V5V6_ERASE_BL_CONFIG = 0x9,
+	CMD_V5V6_ERASE_DISP_CONFIG = 0xa,
+	CMD_V5V6_ERASE_GUEST_CODE = 0xb,
+	CMD_V5V6_WRITE_GUEST_CODE = 0xc,
+	CMD_V5V6_ENABLE_FLASH_PROG = 0xf,
+};
+
+enum flash_command {
+	CMD_IDLE = 0,
+	CMD_WRITE_FW,
+	CMD_WRITE_CONFIG,
+	CMD_WRITE_LOCKDOWN,
+	CMD_WRITE_GUEST_CODE,
+	CMD_READ_CONFIG,
+	CMD_ERASE_ALL,
+	CMD_ERASE_UI_FIRMWARE,
+	CMD_ERASE_UI_CONFIG,
+	CMD_ERASE_BL_CONFIG,
+	CMD_ERASE_DISP_CONFIG,
+	CMD_ERASE_FLASH_CONFIG,
+	CMD_ERASE_GUEST_CODE,
+	CMD_ENABLE_FLASH_PROG,
+};
+
+enum f35_flash_command {
+	CMD_F35_IDLE = 0x0,
+	CMD_F35_RESERVED = 0x1,
+	CMD_F35_WRITE_CHUNK = 0x2,
+	CMD_F35_ERASE_ALL = 0x3,
+	CMD_F35_RESET = 0x10,
+};
+
+enum container_id {
+	TOP_LEVEL_CONTAINER = 0,
+	UI_CONTAINER,
+	UI_CONFIG_CONTAINER,
+	BL_CONTAINER,
+	BL_IMAGE_CONTAINER,
+	BL_CONFIG_CONTAINER,
+	BL_LOCKDOWN_INFO_CONTAINER,
+	PERMANENT_CONFIG_CONTAINER,
+	GUEST_CODE_CONTAINER,
+	BL_PROTOCOL_DESCRIPTOR_CONTAINER,
+	UI_PROTOCOL_DESCRIPTOR_CONTAINER,
+	RMI_SELF_DISCOVERY_CONTAINER,
+	RMI_PAGE_CONTENT_CONTAINER,
+	GENERAL_INFORMATION_CONTAINER,
+	DEVICE_CONFIG_CONTAINER,
+	FLASH_CONFIG_CONTAINER,
+	GUEST_SERIALIZATION_CONTAINER,
+	GLOBAL_PARAMETERS_CONTAINER,
+	CORE_CODE_CONTAINER,
+	CORE_CONFIG_CONTAINER,
+	DISPLAY_CONFIG_CONTAINER,
+};
+
+struct pdt_properties {
+	union {
+		struct {
+			unsigned char reserved_1:6;
+			unsigned char has_bsr:1;
+			unsigned char reserved_2:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct partition_table {
+	unsigned char partition_id:5;
+	unsigned char byte_0_reserved:3;
+	unsigned char byte_1_reserved;
+	unsigned char partition_length_7_0;
+	unsigned char partition_length_15_8;
+	unsigned char start_physical_address_7_0;
+	unsigned char start_physical_address_15_8;
+	unsigned char partition_properties_7_0;
+	unsigned char partition_properties_15_8;
+} __packed;
+
+struct f01_device_control {
+	union {
+		struct {
+			unsigned char sleep_mode:2;
+			unsigned char nosleep:1;
+			unsigned char reserved:2;
+			unsigned char charger_connected:1;
+			unsigned char report_rate:1;
+			unsigned char configured:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v7_query_0 {
+	union {
+		struct {
+			unsigned char subpacket_1_size:3;
+			unsigned char has_config_id:1;
+			unsigned char f34_query0_b4:1;
+			unsigned char has_thqa:1;
+			unsigned char f34_query0_b6__7:2;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v7_query_1_7 {
+	union {
+		struct {
+			/* query 1 */
+			unsigned char bl_minor_revision;
+			unsigned char bl_major_revision;
+
+			/* query 2 */
+			unsigned char bl_fw_id_7_0;
+			unsigned char bl_fw_id_15_8;
+			unsigned char bl_fw_id_23_16;
+			unsigned char bl_fw_id_31_24;
+
+			/* query 3 */
+			unsigned char minimum_write_size;
+			unsigned char block_size_7_0;
+			unsigned char block_size_15_8;
+			unsigned char flash_page_size_7_0;
+			unsigned char flash_page_size_15_8;
+
+			/* query 4 */
+			unsigned char adjustable_partition_area_size_7_0;
+			unsigned char adjustable_partition_area_size_15_8;
+
+			/* query 5 */
+			unsigned char flash_config_length_7_0;
+			unsigned char flash_config_length_15_8;
+
+			/* query 6 */
+			unsigned char payload_length_7_0;
+			unsigned char payload_length_15_8;
+
+			/* query 7 */
+			unsigned char f34_query7_b0:1;
+			unsigned char has_bootloader:1;
+			unsigned char has_device_config:1;
+			unsigned char has_flash_config:1;
+			unsigned char has_manufacturing_block:1;
+			unsigned char has_guest_serialization:1;
+			unsigned char has_global_parameters:1;
+			unsigned char has_core_code:1;
+			unsigned char has_core_config:1;
+			unsigned char has_guest_code:1;
+			unsigned char has_display_config:1;
+			unsigned char f34_query7_b11__15:5;
+			unsigned char f34_query7_b16__23;
+			unsigned char f34_query7_b24__31;
+		} __packed;
+		unsigned char data[21];
+	};
+};
+
+struct f34_v7_data_1_5 {
+	union {
+		struct {
+			unsigned char partition_id:5;
+			unsigned char f34_data1_b5__7:3;
+			unsigned char block_offset_7_0;
+			unsigned char block_offset_15_8;
+			unsigned char transfer_length_7_0;
+			unsigned char transfer_length_15_8;
+			unsigned char command;
+			unsigned char payload_0;
+			unsigned char payload_1;
+		} __packed;
+		unsigned char data[8];
+	};
+};
+
+struct f34_v5v6_flash_properties {
+	union {
+		struct {
+			unsigned char reg_map:1;
+			unsigned char unlocked:1;
+			unsigned char has_config_id:1;
+			unsigned char has_pm_config:1;
+			unsigned char has_bl_config:1;
+			unsigned char has_disp_config:1;
+			unsigned char has_ctrl1:1;
+			unsigned char has_query4:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct register_offset {
+	unsigned char properties;
+	unsigned char properties_2;
+	unsigned char block_size;
+	unsigned char block_count;
+	unsigned char gc_block_count;
+	unsigned char flash_status;
+	unsigned char partition_id;
+	unsigned char block_number;
+	unsigned char transfer_length;
+	unsigned char flash_cmd;
+	unsigned char payload;
+};
+
+struct block_count {
+	unsigned short ui_firmware;
+	unsigned short ui_config;
+	unsigned short dp_config;
+	unsigned short fl_config;
+	unsigned short pm_config;
+	unsigned short bl_config;
+	unsigned short lockdown;
+	unsigned short guest_code;
+};
+
+struct physical_address {
+	unsigned short ui_firmware;
+	unsigned short ui_config;
+	unsigned short dp_config;
+	unsigned short guest_code;
+	unsigned short pm_config;
+};
+
+struct container_descriptor {
+	unsigned char content_checksum[4];
+	unsigned char container_id[2];
+	unsigned char minor_version;
+	unsigned char major_version;
+	unsigned char reserved_08;
+	unsigned char reserved_09;
+	unsigned char reserved_0a;
+	unsigned char reserved_0b;
+	unsigned char container_option_flags[4];
+	unsigned char content_options_length[4];
+	unsigned char content_options_address[4];
+	unsigned char content_length[4];
+	unsigned char content_address[4];
+};
+
+struct image_header_10 {
+	unsigned char checksum[4];
+	unsigned char reserved_04;
+	unsigned char reserved_05;
+	unsigned char minor_header_version;
+	unsigned char major_header_version;
+	unsigned char reserved_08;
+	unsigned char reserved_09;
+	unsigned char reserved_0a;
+	unsigned char reserved_0b;
+	unsigned char top_level_container_start_addr[4];
+};
+
+struct block_data {
+	unsigned int size;
+	const unsigned char *data;
+};
+
+struct image_metadata {
+	bool contains_firmware_id;
+	bool contains_bootloader;
+	bool contains_disp_config;
+	bool contains_guest_code;
+	bool contains_flash_config;
+	unsigned int firmware_id;
+	unsigned int checksum;
+	unsigned int bootloader_size;
+	unsigned int disp_config_offset;
+	unsigned char bl_version;
+	unsigned char product_id[PRODUCT_ID_SIZE + 1];
+	unsigned char cstmr_product_id[PRODUCT_ID_SIZE + 1];
+	struct block_data bootloader;
+	struct block_data ui_firmware;
+	struct block_data ui_config;
+	struct block_data dp_config;
+	struct block_data fl_config;
+	struct block_data bl_config;
+	struct block_data guest_code;
+	struct block_data lockdown;
+	struct block_count blkcount;
+	struct physical_address phyaddr;
+};
+struct synaptics_rmi4_fn_desc {
+	union {
+		struct {
+			unsigned char query_base_addr;
+			unsigned char cmd_base_addr;
+			unsigned char ctrl_base_addr;
+			unsigned char data_base_addr;
+			unsigned char intr_src_count:3;
+			unsigned char reserved_1:2;
+			unsigned char fn_version:2;
+			unsigned char reserved_2:1;
+			unsigned char fn_number;
+		} __packed;
+		unsigned char data[6];
+	};
+};
+
+
+struct synaptics_rmi4_fwu_handle {
+	enum bl_version bl_version;
+	bool initialized;
+	bool in_bl_mode;
+	bool in_ub_mode;
+	bool force_update;
+	bool do_lockdown;
+	bool has_guest_code;
+	bool new_partition_table;
+	unsigned int data_pos;
+	unsigned char *ext_data_source;
+	unsigned char *read_config_buf;
+	unsigned char intr_mask;
+	unsigned char command;
+	unsigned char bootloader_id[2];
+	unsigned char flash_status;
+	unsigned char partitions;
+	unsigned short block_size;
+	unsigned short config_size;
+	unsigned short config_area;
+	unsigned short config_block_count;
+	unsigned short flash_config_length;
+	unsigned short payload_length;
+	unsigned short partition_table_bytes;
+	unsigned short read_config_buf_size;
+	const unsigned char *config_data;
+	const unsigned char *image;
+	unsigned char *image_name;
+	unsigned int image_size;
+    unsigned char bl_reset_add;
+	struct image_metadata img;
+	struct register_offset off;
+	struct block_count blkcount;
+	struct physical_address phyaddr;
+	struct f34_v5v6_flash_properties flash_properties;
+	struct synaptics_rmi4_fn_desc f34_fd;
+	struct synaptics_rmi4_fn_desc f35_fd;
+	struct workqueue_struct *fwu_workqueue;
+	struct work_struct fwu_work;
+    struct i2c_client *client;
+};
+
+static struct synaptics_rmi4_fwu_handle *fwu;
+
+static unsigned int le_to_uint(const unsigned char *ptr)
+{
+	return (unsigned int)ptr[0] +
+			(unsigned int)ptr[1] * 0x100 +
+			(unsigned int)ptr[2] * 0x10000 +
+			(unsigned int)ptr[3] * 0x1000000;
+}
+/*
+static void fwu_compare_partition_tables(void)
+{
+	if (fwu->phyaddr.ui_firmware != fwu->img.phyaddr.ui_firmware) {
+		fwu->new_partition_table = true;
+		return;
+	}
+
+	if (fwu->phyaddr.ui_config != fwu->img.phyaddr.ui_config) {
+		fwu->new_partition_table = true;
+		return;
+	}
+
+	if (fwu->flash_properties.has_disp_config) {
+		if (fwu->phyaddr.dp_config != fwu->img.phyaddr.dp_config) {
+			fwu->new_partition_table = true;
+			return;
+		}
+	}
+
+	if (fwu->flash_properties.has_disp_config) {
+		if (fwu->phyaddr.dp_config != fwu->img.phyaddr.dp_config) {
+			fwu->new_partition_table = true;
+			return;
+		}
+	}
+
+	if (fwu->has_guest_code) {
+		if (fwu->phyaddr.guest_code != fwu->img.phyaddr.guest_code) {
+			fwu->new_partition_table = true;
+			return;
+		}
+	}
+
+	fwu->new_partition_table = false;
+
+	return;
+}
+*/
+
+static void fwu_parse_partition_table(const unsigned char *partition_table,
+		struct block_count *blkcount, struct physical_address *phyaddr)
+{
+	unsigned char ii;
+	unsigned char index;
+	//unsigned char offset;
+	unsigned short partition_length;
+	unsigned short physical_address;
+	struct partition_table *ptable;
+
+	for (ii = 0; ii < fwu->partitions; ii++) {
+		index = ii * 8 + 2;
+		ptable = (struct partition_table *)&partition_table[index];
+		partition_length = ptable->partition_length_15_8 << 8 |
+				ptable->partition_length_7_0;
+		physical_address = ptable->start_physical_address_15_8 << 8 |
+				ptable->start_physical_address_7_0;
+		TPD_DEBUG("%s: Partition entry %d:\n",
+				__func__, ii);
+/*
+		for (offset = 0; offset < 8; offset++) {
+			TPD_DEBUG("%s: 0x%02x\n",
+					__func__,
+					partition_table[index + offset]);
+		}
+*/
+		switch (ptable->partition_id) {
+		case CORE_CODE_PARTITION:
+			blkcount->ui_firmware = partition_length;
+			phyaddr->ui_firmware = physical_address;
+			TPD_DEBUG("%s: Core code block count: %d\n",
+					__func__, blkcount->ui_firmware);
+			break;
+		case CORE_CONFIG_PARTITION:
+			blkcount->ui_config = partition_length;
+			phyaddr->ui_config = physical_address;
+			TPD_DEBUG("%s: Core config block count: %d\n",
+					__func__, blkcount->ui_config);
+			break;
+		case DISPLAY_CONFIG_PARTITION:
+			blkcount->dp_config = partition_length;
+			phyaddr->dp_config = physical_address;
+			TPD_DEBUG("%s: Display config block count: %d\n",
+					__func__, blkcount->dp_config);
+			break;
+		case FLASH_CONFIG_PARTITION:
+			blkcount->fl_config = partition_length;
+			TPD_DEBUG("%s: Flash config block count: %d\n",
+					__func__, blkcount->fl_config);
+			break;
+		case GUEST_CODE_PARTITION:
+			blkcount->guest_code = partition_length;
+			phyaddr->guest_code = physical_address;
+			TPD_DEBUG("%s: Guest code block count: %d\n",
+					__func__, blkcount->guest_code);
+			break;
+		case GUEST_SERIALIZATION_PARTITION:
+			blkcount->pm_config = partition_length;
+			TPD_DEBUG("%s: Guest serialization block count: %d\n",
+					__func__, blkcount->pm_config);
+			break;
+		case GLOBAL_PARAMETERS_PARTITION:
+			blkcount->bl_config = partition_length;
+			TPD_DEBUG("%s: Global parameters block count: %d\n",
+					__func__, blkcount->bl_config);
+			break;
+		case DEVICE_CONFIG_PARTITION:
+			blkcount->lockdown = partition_length;
+			TPD_DEBUG("%s: Device config block count: %d\n",
+					__func__, blkcount->lockdown);
+			break;
+		};
+	}
+
+	return;
+}
+
+
+static void fwu_parse_image_header_10_bl_container(const unsigned char *image)
+{
+	unsigned char ii;
+	unsigned char num_of_containers;
+	unsigned int addr;
+	unsigned int container_id;
+	unsigned int length;
+	const unsigned char *content;
+	struct container_descriptor *descriptor;
+
+	num_of_containers = (fwu->img.bootloader.size - 4) / 4;
+
+	for (ii = 1; ii <= num_of_containers; ii++) {
+		addr = le_to_uint(fwu->img.bootloader.data + (ii * 4));
+		descriptor = (struct container_descriptor *)(image + addr);
+		container_id = descriptor->container_id[0] |
+				descriptor->container_id[1] << 8;
+		content = image + le_to_uint(descriptor->content_address);
+		length = le_to_uint(descriptor->content_length);
+		switch (container_id) {
+		case BL_CONFIG_CONTAINER:
+		case GLOBAL_PARAMETERS_CONTAINER:
+			fwu->img.bl_config.data = content;
+			fwu->img.bl_config.size = length;
+			break;
+		case BL_LOCKDOWN_INFO_CONTAINER:
+		case DEVICE_CONFIG_CONTAINER:
+			fwu->img.lockdown.data = content;
+			fwu->img.lockdown.size = length;
+			break;
+		default:
+			break;
+		};
+	}
+
+	return;
+}
+
+static void fwu_parse_image_header_10(void)
+{
+	unsigned char ii;
+	unsigned char num_of_containers;
+	unsigned int addr;
+	unsigned int offset;
+	unsigned int container_id;
+	unsigned int length;
+	const unsigned char *image;
+	const unsigned char *content;
+	struct container_descriptor *descriptor;
+	struct image_header_10 *header;
+
+	image = fwu->image;
+	header = (struct image_header_10 *)image;
+
+	fwu->img.checksum = le_to_uint(header->checksum);
+
+	/* address of top level container */
+	offset = le_to_uint(header->top_level_container_start_addr);
+	descriptor = (struct container_descriptor *)(image + offset);
+
+	/* address of top level container content */
+	offset = le_to_uint(descriptor->content_address);
+	num_of_containers = le_to_uint(descriptor->content_length) / 4;
+
+	for (ii = 0; ii < num_of_containers; ii++) {
+		addr = le_to_uint(image + offset);
+		offset += 4;
+		descriptor = (struct container_descriptor *)(image + addr);
+		container_id = descriptor->container_id[0] |
+				descriptor->container_id[1] << 8;
+		content = image + le_to_uint(descriptor->content_address);
+		length = le_to_uint(descriptor->content_length);
+		switch (container_id) {
+		case UI_CONTAINER:
+		case CORE_CODE_CONTAINER:
+			fwu->img.ui_firmware.data = content;
+			fwu->img.ui_firmware.size = length;
+            TPD_DEBUG("%s ui_firmware_pointer[%p]\n",__func__,fwu->img.ui_firmware.data);
+			break;
+		case UI_CONFIG_CONTAINER:
+		case CORE_CONFIG_CONTAINER:
+			fwu->img.ui_config.data = content;
+			fwu->img.ui_config.size = length;
+			break;
+		case BL_CONTAINER:
+			fwu->img.bl_version = *content;
+			fwu->img.bootloader.data = content;
+			fwu->img.bootloader.size = length;
+			fwu_parse_image_header_10_bl_container(image);
+			break;
+		case GUEST_CODE_CONTAINER:
+			fwu->img.contains_guest_code = true;
+			fwu->img.guest_code.data = content;
+			fwu->img.guest_code.size = length;
+			break;
+		case DISPLAY_CONFIG_CONTAINER:
+			fwu->img.contains_disp_config = true;
+			fwu->img.dp_config.data = content;
+			fwu->img.dp_config.size = length;
+			break;
+		case FLASH_CONFIG_CONTAINER:
+			fwu->img.contains_flash_config = true;
+			fwu->img.fl_config.data = content;
+			fwu->img.fl_config.size = length;
+			break;
+		case GENERAL_INFORMATION_CONTAINER:
+			fwu->img.contains_firmware_id = true;
+			fwu->img.firmware_id = le_to_uint(content + 4);
+			break;
+		default:
+			break;
+		}
+	}
+
+	return;
+}
+
+static int fwu_parse_image_info(unsigned char *fw)
+{
+	struct image_header_10 *header;
+
+	header = (struct image_header_10 *)fw;
+
+	memset(&fwu->img, 0x00, sizeof(fwu->img));
+
+	fwu_parse_image_header_10();
+
+	if (!fwu->img.contains_flash_config) {
+		return -EINVAL;
+	}
+
+	//fwu_parse_partition_table(fwu->img.fl_config.data,
+			//&fwu->img.blkcount, &fwu->img.phyaddr);
+
+	//fwu_compare_partition_tables();
+
+	return 0;
+}
+
+static int fwu_read_flash_status(void)
+{
+	int retval;
+	unsigned char status;
+	unsigned char command;
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			fwu->f34_fd.data_base_addr + fwu->off.flash_status,sizeof(status),&status);
+	if (retval < 0) {
+		return retval;
+	}
+    //TPD_ERR("flash_status_address[0x%x] status[0x%x]\n",fwu->f34_fd.data_base_addr + fwu->off.flash_status,status);
+	fwu->in_bl_mode = status >> 7;
+
+	if (fwu->bl_version == BL_V5)
+		fwu->flash_status = (status >> 4) & MASK_3BIT;
+	else if (fwu->bl_version == BL_V6)
+		fwu->flash_status = status & MASK_3BIT;
+	else if (fwu->bl_version == BL_V7)
+		fwu->flash_status = status & MASK_5BIT;
+
+	if (fwu->flash_status != 0x00) {
+		TPD_ERR("%s: Flash status = %d, command = 0x%02x\n",
+				__func__, fwu->flash_status, fwu->command);
+	}
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			fwu->f34_fd.data_base_addr + fwu->off.flash_cmd,
+			sizeof(command),&command);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash command[%d]\n",
+				__func__,command);
+		return retval;
+	}
+    //TPD_ERR("flash_command_address[0x%x] command[0x%x]\n",fwu->f34_fd.data_base_addr + fwu->off.flash_cmd,command);
+
+	if (fwu->bl_version == BL_V5)
+		fwu->command = command & MASK_4BIT;
+	else if (fwu->bl_version == BL_V6)
+		fwu->command = command & MASK_6BIT;
+	else if (fwu->bl_version == BL_V7)
+		fwu->command = command;
+
+	return 0;
+}
+
+static int fwu_wait_for_idle(int timeout_ms, bool poll)
+{
+	int count = 0;
+	int timeout_count = ((timeout_ms * 1000) / MAX_SLEEP_TIME_US) + 1;
+
+	do {
+		usleep_range(MIN_SLEEP_TIME_US, MAX_SLEEP_TIME_US);
+
+		count++;
+		if (poll || (count == timeout_count))
+			fwu_read_flash_status();
+
+		if ((fwu->command == CMD_IDLE) && (fwu->flash_status == 0x00))
+			return 0;
+	} while (count < timeout_count);
+
+	TPD_ERR("%s: Timed out waiting for idle status command[%d],flash_status[%d]\n",
+			__func__,fwu->command,fwu->flash_status);
+
+	return -ETIMEDOUT;
+}
+static int fwu_write_f34_v7_command_single_transaction(unsigned char cmd)
+{
+	int retval;
+	unsigned char base;
+	struct f34_v7_data_1_5 data_1_5;
+
+	base = fwu->f34_fd.data_base_addr;
+
+	memset(data_1_5.data, 0x00, sizeof(data_1_5.data));
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			base + fwu->off.partition_id,
+			sizeof(data_1_5.data),data_1_5.data);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read queries 1 to 7\n",
+				__func__);
+		return retval;
+	}
+
+	switch (cmd) {
+	case CMD_ERASE_ALL:
+		data_1_5.partition_id = CORE_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE_AP;
+		break;
+	case CMD_ERASE_UI_FIRMWARE:
+		data_1_5.partition_id = CORE_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_BL_CONFIG:
+		data_1_5.partition_id = GLOBAL_PARAMETERS_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_UI_CONFIG:
+		data_1_5.partition_id = CORE_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_DISP_CONFIG:
+		data_1_5.partition_id = DISPLAY_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_FLASH_CONFIG:
+		data_1_5.partition_id = FLASH_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_GUEST_CODE:
+		data_1_5.partition_id = GUEST_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		data_1_5.partition_id = BOOTLOADER_PARTITION;
+		data_1_5.command = CMD_V7_ENTER_BL;
+		break;
+	};
+
+	data_1_5.payload_0 = fwu->bootloader_id[0];
+	data_1_5.payload_1 = fwu->bootloader_id[1];
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.partition_id,
+			sizeof(data_1_5.data),data_1_5.data);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write single transaction command\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_v7_command(unsigned char cmd)
+{
+	int retval;
+	unsigned char base;
+	unsigned char command;
+
+	base = fwu->f34_fd.data_base_addr;
+
+	switch (cmd) {
+	case CMD_WRITE_FW:
+	case CMD_WRITE_CONFIG:
+	case CMD_WRITE_GUEST_CODE:
+		command = CMD_V7_WRITE;
+		break;
+	case CMD_READ_CONFIG:
+		command = CMD_V7_READ;
+		break;
+	case CMD_ERASE_ALL:
+		command = CMD_V7_ERASE_AP;
+		break;
+	case CMD_ERASE_UI_FIRMWARE:
+	case CMD_ERASE_BL_CONFIG:
+	case CMD_ERASE_UI_CONFIG:
+	case CMD_ERASE_DISP_CONFIG:
+	case CMD_ERASE_FLASH_CONFIG:
+	case CMD_ERASE_GUEST_CODE:
+		command = CMD_V7_ERASE;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		command = CMD_V7_ENTER_BL;
+		break;
+	default:
+		TPD_ERR("%s: Invalid command 0x%02x\n",
+				__func__, cmd);
+		return -EINVAL;
+	};
+
+	fwu->command = command;
+
+	switch (cmd) {
+	case CMD_ERASE_ALL:
+	case CMD_ERASE_UI_FIRMWARE:
+	case CMD_ERASE_BL_CONFIG:
+	case CMD_ERASE_UI_CONFIG:
+	case CMD_ERASE_DISP_CONFIG:
+	case CMD_ERASE_FLASH_CONFIG:
+	case CMD_ERASE_GUEST_CODE:
+	case CMD_ENABLE_FLASH_PROG:
+		retval = fwu_write_f34_v7_command_single_transaction(cmd);
+		if (retval < 0)
+			return retval;
+		else
+			return 0;
+	default:
+		break;
+	};
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.flash_cmd,
+			sizeof(command),&command);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write flash command\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_command(unsigned char cmd)
+{
+	int retval;
+
+	retval = fwu_write_f34_v7_command(cmd);
+
+	return retval;
+}
+
+static int fwu_write_f34_v7_partition_id(unsigned char cmd)
+{
+	int retval;
+	unsigned char base;
+	unsigned char partition = 0;
+
+	base = fwu->f34_fd.data_base_addr;
+
+	switch (cmd) {
+	case CMD_WRITE_FW:
+		partition = CORE_CODE_PARTITION;
+		break;
+	case CMD_WRITE_CONFIG:
+	case CMD_READ_CONFIG:
+		if (fwu->config_area == UI_CONFIG_AREA)
+			partition = CORE_CONFIG_PARTITION;
+		else if (fwu->config_area == DP_CONFIG_AREA)
+			partition = DISPLAY_CONFIG_PARTITION;
+		else if (fwu->config_area == PM_CONFIG_AREA)
+			partition = GUEST_SERIALIZATION_PARTITION;
+		else if (fwu->config_area == BL_CONFIG_AREA)
+			partition = GLOBAL_PARAMETERS_PARTITION;
+		else if (fwu->config_area == FLASH_CONFIG_AREA)
+			partition = FLASH_CONFIG_PARTITION;
+		break;
+	case CMD_WRITE_GUEST_CODE:
+		partition = GUEST_CODE_PARTITION;
+		break;
+	case CMD_ERASE_ALL:
+		partition = CORE_CODE_PARTITION;
+		break;
+	case CMD_ERASE_BL_CONFIG:
+		partition = GLOBAL_PARAMETERS_PARTITION;
+		break;
+	case CMD_ERASE_UI_CONFIG:
+		partition = CORE_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_DISP_CONFIG:
+		partition = DISPLAY_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_FLASH_CONFIG:
+		partition = FLASH_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_GUEST_CODE:
+		partition = GUEST_CODE_PARTITION;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		partition = BOOTLOADER_PARTITION;
+		break;
+	default:
+		TPD_ERR("%s: Invalid command 0x%02x\n",
+				__func__, cmd);
+		return -EINVAL;
+	};
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.partition_id,
+			sizeof(partition),&partition);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write partition ID\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_partition_id(unsigned char cmd)
+{
+	int retval;
+
+	retval = fwu_write_f34_v7_partition_id(cmd);
+
+	return retval;
+}
+
+static int fwu_read_f34_v7_partition_table(void)
+{
+	int retval;
+	unsigned char base;
+	unsigned char length[2];
+	unsigned short block_number = 0;
+
+	base = fwu->f34_fd.data_base_addr;
+
+	fwu->config_area = FLASH_CONFIG_AREA;
+
+	retval = fwu_write_f34_partition_id(CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.block_number,
+			sizeof(block_number),(unsigned char *)&block_number);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	length[0] = (unsigned char)(fwu->flash_config_length & MASK_8BIT);
+	length[1] = (unsigned char)(fwu->flash_config_length >> 8);
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.transfer_length,
+			sizeof(length), length);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write transfer length\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_write_f34_command(CMD_READ_CONFIG);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write command\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to wait for idle status\n",
+				__func__);
+		return retval;
+	}
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			base + fwu->off.payload,fwu->partition_table_bytes,fwu->read_config_buf);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read block data\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_read_f34_v7_queries(void)
+{
+	int retval;
+	unsigned char ii;
+	unsigned char base;
+	unsigned char index;
+	unsigned char offset;
+	unsigned char *ptable;
+	struct f34_v7_query_0 query_0;
+	struct f34_v7_query_1_7 query_1_7;
+
+	base = fwu->f34_fd.query_base_addr;
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			base,
+			sizeof(query_0.data),query_0.data);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read query 0\n",
+				__func__);
+		return retval;
+	}
+
+	offset = query_0.subpacket_1_size + 1;
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			base + offset,
+			sizeof(query_1_7.data),query_1_7.data);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read queries 1 to 7\n",
+				__func__);
+		return retval;
+	}
+
+	fwu->bootloader_id[0] = query_1_7.bl_minor_revision;
+	fwu->bootloader_id[1] = query_1_7.bl_major_revision;
+
+	fwu->block_size = query_1_7.block_size_15_8 << 8 |
+			query_1_7.block_size_7_0;
+
+	fwu->flash_config_length = query_1_7.flash_config_length_15_8 << 8 |
+			query_1_7.flash_config_length_7_0;
+
+	fwu->payload_length = query_1_7.payload_length_15_8 << 8 |
+			query_1_7.payload_length_7_0;
+
+	fwu->off.flash_status = V7_FLASH_STATUS_OFFSET;
+	fwu->off.partition_id = V7_PARTITION_ID_OFFSET;
+	fwu->off.block_number = V7_BLOCK_NUMBER_OFFSET;
+	fwu->off.transfer_length = V7_TRANSFER_LENGTH_OFFSET;
+	fwu->off.flash_cmd = V7_COMMAND_OFFSET;
+	fwu->off.payload = V7_PAYLOAD_OFFSET;
+
+	fwu->flash_properties.has_disp_config = query_1_7.has_display_config;
+	fwu->flash_properties.has_pm_config = query_1_7.has_guest_serialization;
+	fwu->flash_properties.has_bl_config = query_1_7.has_global_parameters;
+
+	fwu->has_guest_code = query_1_7.has_guest_code;
+
+	index = sizeof(query_1_7.data) - V7_PARTITION_SUPPORT_BYTES;
+
+	fwu->partitions = 0;
+	for (offset = 0; offset < V7_PARTITION_SUPPORT_BYTES; offset++) {
+		for (ii = 0; ii < 8; ii++) {
+			if (query_1_7.data[index + offset] & (1 << ii))
+				fwu->partitions++;
+		}
+	}
+
+	fwu->partition_table_bytes = fwu->partitions * 8 + 2;
+
+	kfree(fwu->read_config_buf);
+	fwu->read_config_buf = kzalloc(fwu->partition_table_bytes, GFP_KERNEL);
+	if (!fwu->read_config_buf) {
+		TPD_ERR("%s: Failed to alloc mem for fwu->read_config_buf\n",
+				__func__);
+		fwu->read_config_buf_size = 0;
+		return -ENOMEM;
+	}
+	fwu->read_config_buf_size = fwu->partition_table_bytes;
+	ptable = fwu->read_config_buf;
+
+	retval = fwu_read_f34_v7_partition_table();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read partition table\n",
+				__func__);
+		return retval;
+	}
+
+	fwu_parse_partition_table(ptable, &fwu->blkcount, &fwu->phyaddr);
+
+	return 0;
+}
+
+static int fwu_read_f34_queries(void)
+{
+	int retval;
+
+	memset(&fwu->blkcount, 0x00, sizeof(fwu->blkcount));
+	memset(&fwu->phyaddr, 0x00, sizeof(fwu->phyaddr));
+	retval = fwu_read_f34_v7_queries();
+
+	return retval;
+}
+static int fwu_write_f34_v7_blocks(unsigned char *block_ptr,
+		unsigned short block_cnt, unsigned char command)
+{
+	int retval;
+	unsigned char base;
+	unsigned char length[2];
+	unsigned short transfer;
+	unsigned short max_transfer;
+	unsigned short remaining = block_cnt;
+	unsigned short block_number = 0;
+    int send_cnt = 1;
+
+	base = fwu->f34_fd.data_base_addr;
+
+    retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+    if (retval < 0) {
+        TPD_ERR("%s: line[%d]Failed to wait for idle status\n",__func__, __LINE__);
+    }
+
+	retval = fwu_write_f34_partition_id(command);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.block_number,
+			sizeof(block_number),(unsigned char *)&block_number);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",__func__);
+		return retval;
+	}
+
+	if (fwu->payload_length > (PAGE_SIZE / fwu->block_size))
+		max_transfer = PAGE_SIZE / fwu->block_size;
+	else
+		max_transfer = fwu->payload_length;
+
+	do {
+		if (remaining / max_transfer)
+			transfer = max_transfer;
+		else
+			transfer = remaining;
+
+        TPD_DEBUG("send_cnt[%d],transfer_block[%d],remaining[%d]\n",send_cnt++,transfer,remaining);
+		length[0] = (unsigned char)(transfer & MASK_8BIT);
+		length[1] = (unsigned char)(transfer >> 8);
+
+		retval = synaptics_rmi4_i2c_write_block(fwu->client,
+				base + fwu->off.transfer_length,
+				sizeof(length),length);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write transfer length (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write command (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = synaptics_rmi4_i2c_write_block(fwu->client,
+				base + fwu->off.payload,
+				transfer * fwu->block_size,block_ptr);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write block data (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to wait for idle status (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		block_ptr += (transfer * fwu->block_size);
+		remaining -= transfer;
+	} while (remaining);
+
+	return 0;
+}
+
+static int fwu_write_f34_blocks(unsigned char *block_ptr,
+		unsigned short block_cnt, unsigned char cmd)
+{
+	int retval;
+	retval = fwu_write_f34_v7_blocks(block_ptr, block_cnt, cmd);
+	return retval;
+}
+
+static int fwu_read_f34_v7_blocks(unsigned short block_cnt,
+		unsigned char command)
+{
+	int retval;
+	unsigned char base;
+	unsigned char length[2];
+	unsigned short transfer;
+	unsigned short max_transfer;
+	unsigned short remaining = block_cnt;
+	unsigned short block_number = 0;
+	unsigned short index = 0;
+
+	base = fwu->f34_fd.data_base_addr;
+
+	retval = fwu_write_f34_partition_id(command);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.block_number,
+			sizeof(block_number),(unsigned char *)&block_number);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	if (fwu->payload_length > (PAGE_SIZE / fwu->block_size))
+		max_transfer = PAGE_SIZE / fwu->block_size;
+	else
+		max_transfer = fwu->payload_length;
+
+	do {
+		if (remaining / max_transfer)
+			transfer = max_transfer;
+		else
+			transfer = remaining;
+
+		length[0] = (unsigned char)(transfer & MASK_8BIT);
+		length[1] = (unsigned char)(transfer >> 8);
+
+		retval = synaptics_rmi4_i2c_write_block(fwu->client,
+				base + fwu->off.transfer_length,sizeof(length),length);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write transfer length (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write command (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, false);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to wait for idle status (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = synaptics_rmi4_i2c_read_block(fwu->client,
+				base + fwu->off.payload,
+                transfer * fwu->block_size,&fwu->read_config_buf[index]);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read block data (%d blocks remaining)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		index += (transfer * fwu->block_size);
+		remaining -= transfer;
+	} while (remaining);
+
+	return 0;
+}
+
+static int fwu_read_f34_blocks(unsigned short block_cnt, unsigned char cmd)
+{
+	int retval;
+
+	retval = fwu_read_f34_v7_blocks(block_cnt, cmd);
+
+	return retval;
+}
+
+static int fwu_check_ui_firmware_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.ui_firmware.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.ui_firmware) {
+		TPD_ERR("%s: UI firmware size mismatch\n",__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_ui_configuration_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.ui_config.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.ui_config) {
+		TPD_ERR("%s: UI configuration size mismatch\n",__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_bl_configuration_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.bl_config.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.bl_config) {
+		TPD_ERR("%s: Bootloader configuration size mismatch\n",__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_write_firmware(void)
+{
+	unsigned short firmware_block_count;
+
+	firmware_block_count = fwu->img.ui_firmware.size / fwu->block_size;
+
+	return fwu_write_f34_blocks((unsigned char *)fwu->img.ui_firmware.data,
+			firmware_block_count, CMD_WRITE_FW);
+}
+
+static int fwu_erase_configuration(void)
+{
+	int retval;
+
+	switch (fwu->config_area) {
+	case UI_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_UI_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case DP_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_DISP_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case BL_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_BL_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	}
+
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+	if (retval < 0)
+		return retval;
+
+
+	return retval;
+}
+
+static int fwu_erase_all(void)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7) {
+		retval = fwu_write_f34_command(CMD_ERASE_UI_FIRMWARE);
+		if (retval < 0)
+			return retval;
+
+		TPD_ERR("%s: Erase command written\n",__func__);
+
+		retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+		if (retval < 0)
+			return retval;
+
+		TPD_ERR("%s: Idle status detected\n",__func__);
+
+		fwu->config_area = UI_CONFIG_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			return retval;
+	} else {
+		retval = fwu_write_f34_command(CMD_ERASE_ALL);
+		if (retval < 0)
+			return retval;
+
+		TPD_ERR("%s: Erase all command written\n",__func__);
+
+		retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+		if (retval < 0)
+			return retval;
+
+		TPD_ERR("%s: Idle status detected\n",__func__);
+	}
+
+	if (fwu->flash_properties.has_disp_config) {
+		fwu->config_area = DP_CONFIG_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_configuration(void)
+{
+	return fwu_write_f34_blocks((unsigned char *)fwu->config_data,
+			fwu->config_block_count, CMD_WRITE_CONFIG);
+}
+
+static int fwu_write_ui_configuration(void)
+{
+	fwu->config_area = UI_CONFIG_AREA;
+	fwu->config_data = fwu->img.ui_config.data;
+	fwu->config_size = fwu->img.ui_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	return fwu_write_configuration();
+}
+
+static int fwu_write_flash_configuration(void)
+{
+	int retval;
+    
+	TPD_ERR("%s: enter!!\n",__func__);
+	fwu->config_area = FLASH_CONFIG_AREA;
+	fwu->config_data = fwu->img.fl_config.data;
+	fwu->config_size = fwu->img.fl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	if (fwu->config_block_count != fwu->blkcount.fl_config) {
+		TPD_ERR("%s: Flash configuration size mismatch\n",__func__);
+		return -EINVAL;
+	}
+
+	retval = fwu_write_f34_command(CMD_ERASE_FLASH_CONFIG);
+	if (retval < 0)
+		return retval;
+
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+	if (retval < 0){
+        TPD_ERR("Erase configuration wait Idle status timeout!\n");
+		return retval;
+    }
+
+	retval = fwu_write_configuration();
+	if (retval < 0){
+        TPD_ERR("write configuration error!\n");
+		return retval;
+    }
+	TPD_ERR("%s: finish!!\n",__func__);
+	return 0;
+}
+
+static int fwu_write_partition_table(void)
+{
+	int retval;
+	unsigned short block_count;
+
+	block_count = fwu->blkcount.bl_config;
+	fwu->config_area = BL_CONFIG_AREA;
+	fwu->config_size = fwu->block_size * block_count;
+	kfree(fwu->read_config_buf);
+	fwu->read_config_buf = kzalloc(fwu->config_size, GFP_KERNEL);
+	if (!fwu->read_config_buf) {
+		TPD_ERR("%s: Failed to alloc mem for fwu->read_config_buf\n",__func__);
+		fwu->read_config_buf_size = 0;
+		return -ENOMEM;
+	}
+	fwu->read_config_buf_size = fwu->config_size;
+
+	retval = fwu_read_f34_blocks(block_count, CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_write_flash_configuration();
+	if (retval < 0)
+		return retval;
+
+	fwu->config_area = BL_CONFIG_AREA;
+	fwu->config_data = fwu->read_config_buf;
+	fwu->config_size = fwu->img.bl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static int fwu_do_reflash(void)
+{
+	int retval;
+
+	if (!fwu->new_partition_table) {
+		retval = fwu_check_ui_firmware_size();
+		if (retval < 0)
+			return retval;
+
+		retval = fwu_check_ui_configuration_size();
+		if (retval < 0)
+			return retval;
+
+		retval = fwu_check_bl_configuration_size();
+		if (retval < 0)
+			return retval;
+        }
+
+	retval = fwu_erase_all();
+	if (retval < 0)
+		return retval;
+
+	if (fwu->new_partition_table) {
+		retval = fwu_write_partition_table();
+		if (retval < 0)
+			return retval;
+		pr_notice("%s: Partition table programmed\n", __func__);
+	}
+
+	retval = fwu_write_firmware();
+	if (retval < 0)
+		return retval;
+	pr_notice("%s: Firmware programmed\n", __func__);
+
+	fwu->config_area = UI_CONFIG_AREA;
+	retval = fwu_write_ui_configuration();
+	if (retval < 0)
+		return retval;
+	pr_notice("%s: Configuration programmed\n", __func__);
+
+	return retval;
+}
+
+static int scan_pdt(void)
+{
+	int retval = 0;
+	char add_buf[6] = { 0 };
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,0xE9,sizeof(add_buf),add_buf);
+	if (retval < 0)
+		return retval;
+	fwu->f34_fd.query_base_addr = add_buf[0];
+	fwu->f34_fd.ctrl_base_addr = add_buf[2];
+	fwu->f34_fd.data_base_addr = add_buf[3];
+	if (add_buf[4]>>5) 
+		fwu->bl_version = BL_V7;
+	TPD_ERR("F34_query_base_addr[0x%x],F34_ctrl_base_addr[0x%x],F34_data_base_addr[0x%x]\n",\
+	add_buf[0],add_buf[2],add_buf[3]);
+
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,0xE3,sizeof(add_buf),add_buf);
+	fwu->bl_reset_add = add_buf[1];
+
+    return retval;
+}
+
+static int fwu_read_f34_serialization(void)
+{
+	int retval;
+	unsigned char base;
+	unsigned char length[2];
+	unsigned short block_number = 0;
+        unsigned char buffer[32];
+        //static bool judge_version = true;
+	base = fwu->f34_fd.data_base_addr;
+
+	fwu->config_area = PM_CONFIG_AREA;
+
+	retval = fwu_write_f34_partition_id(CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.block_number,
+			sizeof(block_number),(unsigned char *)&block_number);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	length[0] = (unsigned char)(fwu->blkcount.pm_config & MASK_8BIT);
+	length[1] = (unsigned char)(fwu->blkcount.pm_config >> 8);
+
+	retval = synaptics_rmi4_i2c_write_block(fwu->client,
+			base + fwu->off.transfer_length,
+			sizeof(length), length);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write transfer length\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_write_f34_command(CMD_READ_CONFIG);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write command\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to wait for idle status\n",
+				__func__);
+		return retval;
+	}
+	/*buffer = kzalloc(fwu->blkcount.pm_config, GFP_KERNEL);
+	if (!buffer) {
+		TPD_ERR("%s: Failed to alloc mem for fwu->blkcount->pm_config\n",
+				__func__);
+		return -ENOMEM;
+	}
+        */
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+			base + fwu->off.payload,fwu->blkcount.pm_config,buffer);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read block data\n",
+				__func__);
+		return retval;
+	}
+	TPD_ERR("%s:buffer5[0x%02x]\n",__func__,buffer[5]);
+	if(!(buffer[0] || buffer[1] || buffer[2] || buffer[4] || buffer[5])){
+              TPD_ERR("%s:tp hardware version is 15801\n",__func__);
+              return  1;
+        }else{
+              TPD_ERR("%s:tp hardware version is 15801vb\n",__func__);
+              return 0;
+	}
+}
+
+int fwu_start_reflash_check(const unsigned char *fw_image, struct i2c_client *client)
+{
+	int retval;
+	//unsigned char *fw = (unsigned char *)fw_image;
+
+	fwu = kzalloc(sizeof(*fwu), GFP_KERNEL);
+	if (!fwu) {
+		TPD_ERR("%s: Failed to alloc mem for fwu\n",__func__);
+		return -1;
+	}
+
+	fwu->client = client;
+
+	retval = scan_pdt();
+	if (retval < 0)
+		return retval;
+	fwu->image = fw_image;
+
+	memset(&fwu->blkcount, 0x00, sizeof(fwu->blkcount));
+	memset(&fwu->phyaddr, 0x00, sizeof(fwu->phyaddr));
+	retval = fwu_read_f34_v7_queries();
+	if (retval < 0) {
+		TPD_ERR("%s: fwu_read_f34_v7_queries\n",__func__);
+		return retval;
+	}
+        TPD_DEBUG("%s: fwu_read_f34_serialization\n",__func__);
+
+	retval = fwu_read_f34_serialization();
+        kfree(fwu);
+        return retval;
+	}
+
+int fwu_start_reflash(const unsigned char *fw_image, struct i2c_client *client)
+{
+	int retval = 0;
+	unsigned char *fw = (unsigned char *)fw_image;
+	fwu = kzalloc(sizeof(*fwu), GFP_KERNEL);
+	if (!fwu) {
+		TPD_ERR("%s: Failed to alloc mem for fwu\n",__func__);
+		return -ENOMEM;
+	}
+	fwu->client = client;
+
+	retval = scan_pdt();
+	fwu->image = fw_image;
+
+	fwu_read_f34_queries();
+	retval = fwu_parse_image_info(fw);
+
+	retval = fwu_read_flash_status();
+	if (retval < 0)
+                goto exit_free_fwu;
+  
+	msleep(INT_DISABLE_WAIT_MS);
+
+	retval = fwu_write_f34_command(CMD_ENABLE_FLASH_PROG);
+	if (retval < 0)
+                goto exit_free_fwu;
+
+	retval = fwu_wait_for_idle(ENABLE_WAIT_MS, false);
+	if (retval < 0){
+                goto exit_free_fwu;
+        }
+	if (!fwu->in_bl_mode) {
+		kfree(fwu);
+		fwu = NULL;
+		TPD_ERR("%s: BL mode not entered\n",__func__);
+		return -EINVAL;
+	}
+	TPD_ERR("fwu->bl_version[%d] fwu->in_bl_mode[%d]\n",fwu->bl_version,fwu->in_bl_mode);
+	retval = scan_pdt();
+
+	TPD_ERR("CMD_ERASE_UI_FIRMWARE.....................\n");
+	retval = fwu_write_f34_command(CMD_ERASE_UI_FIRMWARE);
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, true);
+	if (retval < 0){
+		TPD_ERR("CMD_ERASE_UI_FIRMWARE timeout!\n");
+		goto exit_free_fwu;
+	}
+	TPD_ERR("CMD_ERASE_UI_CONFIG.............\n");
+	retval = fwu_write_f34_command(CMD_ERASE_UI_CONFIG);
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, true);
+	if (retval < 0){
+		TPD_ERR("CMD_ERASE_UI_FIRMWARE timeout!\n");
+		goto exit_free_fwu;
+	}
+
+	if (1){
+		retval = fwu_write_firmware();
+	}else{
+		retval = fwu_do_reflash();
+	}
+	retval = fwu_write_ui_configuration();
+	synaptics_rmi4_i2c_write_byte(fwu->client,fwu->bl_reset_add,0x01);//reset tp   
+	return retval;
+
+exit_free_fwu:
+	kfree(fwu);
+	fwu = NULL;
+	return retval;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Kconfig
new file mode 100755
index 0000000000000000000000000000000000000000..402971761e2114f1f6b3278ec5f1f87b7afdff81
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for focal ft8006 ic driver
+
+config TOUCHPANEL_FOCAL_FT8006
+#	default y
+	bool "TP focal_ft8006 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing focal ft8006
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..c9c315db2ae3fdf94947a0c6af828d4c96c63475
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_FOCAL_FT8006) += focal_drivers_ft8006.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.c b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.c
new file mode 100755
index 0000000000000000000000000000000000000000..2422bb7fcfb25de70025edac7e6ee9d3ded60f88
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.c
@@ -0,0 +1,2378 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : focal_drivers_ft8006.c
+ * Description: Source file for focal FT8006 driver
+ * Version   : 1.0
+ * Date        : 2017-06-12
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "focal_drivers_ft8006.h"
+
+/****************** Start of Log Tag Declear and level define*******************************/
+#define TPD_DEVICE "focal-ft8006"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+/******************** End of Log Tag Declear and level define*********************************/
+
+struct chip_data_ft8006 *g_chip_info = NULL;
+/*************************** start of function delcare****************************************/
+static int focal_upgrade_use_buf(void *chip_data, u8 *pbt_buf, u32 dw_lenth);
+static int focal_lcd_cfg_upgrade_use_buf(void *chip_data, u8* pbt_buf, u32 dw_lenth);
+static void focal_esd_check_enable(void *chip_data, bool enable);
+static int focal_get_chip_info(void *chip_data);
+void __attribute__((weak)) lcd_esd_recovery_mutex(bool enable) {return;}    //lcd esd recovery mutex
+
+/**************************** end of function delcare*****************************************/
+
+
+/****** Start of other functions that work for oppo_touchpanel_operations callbacks***********/
+static int focal_enter_sleep(struct chip_data_ft8006 *chip_info, bool config)
+{
+    int ret = 1;
+
+    if (config) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_POWER_MODE, 0x03);
+        if (ret < 0) {
+            TPD_INFO("%s: enter sleep mode failed!\n", __func__);
+            return -1;
+        } else {
+            chip_info->is_sleep_reg_write = true;
+            TPD_INFO("%s: enter sleep mode sucess!\n", __func__);
+        }
+    }
+
+    return ret;
+}
+
+void focal_rst_pin_output(bool enable)
+{
+    static bool rst_pulled_down = false;
+
+    if (g_chip_info && gpio_is_valid(g_chip_info->hw_res->reset_gpio)) {
+        gpio_direction_output(g_chip_info->hw_res->reset_gpio, enable);
+        if (!enable) {
+            rst_pulled_down = true;
+        } else {
+            if (rst_pulled_down) {
+                g_chip_info->is_sleep_reg_write = false;
+            }
+            rst_pulled_down = false;
+        }
+        TPD_INFO("%s: enable = %d\n", __func__, enable);
+    }
+}
+
+static void focal_reset_via_gpio(void *chip_data, int mscond)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+        gpio_direction_output(chip_info->hw_res->reset_gpio, 0);
+        msleep(20);
+        gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+        msleep(mscond);
+        chip_info->is_sleep_reg_write = false;
+    }
+
+}
+
+static int focal_reset(void *chip_data)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    focal_reset_via_gpio(chip_info, RESET_TO_NORMAL_TIME);
+
+    TPD_INFO("%s.\n", __func__);
+    return 0;
+}
+
+static int focal_enable_black_gesture(struct chip_data_ft8006 *chip_info, bool enable)
+{
+    int state = -1;
+    int ret = -1;
+    int i = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    if (chip_info->is_sleep_reg_write) {
+        focal_reset(chip_info);
+    }
+
+    for (i = 0; i < 5; i++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHIP_ID);
+        if (ret != 0x80) {
+            TPD_INFO("%s: read chip id failed,ret:0x%02x, try %d(<4 is ok) times\n", __func__, ret, i);
+            msleep(10);
+        } else {
+            break;
+        }
+    }
+
+    if (enable) {
+        for (i = 0; i < 5; i++) {
+            touch_i2c_write_byte(chip_info->client, 0xd1, 0xff);
+            touch_i2c_write_byte(chip_info->client, 0xd2, 0xff);
+            touch_i2c_write_byte(chip_info->client, 0xd5, 0xff);
+            touch_i2c_write_byte(chip_info->client, 0xd6, 0xff);
+            touch_i2c_write_byte(chip_info->client, 0xd7, 0xff);
+            touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN, 0x01);
+            msleep(1);
+            state = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+            if (state == 1)
+                break;
+        }
+    } else {
+        for (i = 0; i < 5; i++)
+        {
+            touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN, 0x00);
+            msleep(1);
+            state = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+            if (state == 0)
+                break;
+        }
+    }
+
+    if (i >= 5) {
+        ret = -1;
+        TPD_INFO("%s: enter black gesture state: %d failed\n", __func__, enable);
+    } else {
+        TPD_INFO("%s: enter black gesture state: %d success\n", __func__, enable);
+    }
+    return ret;
+}
+
+static int focal_enable_edge_limit(struct chip_data_ft8006 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    TPD_INFO("%s: edge limit enable = %d\n", __func__, enable);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_EDG_CTR, 0x00);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_EDG_CTR, 0x01);
+    }
+
+    if (ret < 0) {
+        TPD_INFO("%s: enable edge limit state: %d failed!\n", __func__, enable);
+    } else {
+        TPD_INFO("%s: enable edge limit state: %d success!\n", __func__, enable);
+    }
+    return ret;
+}
+
+static int focal_enable_charge_mode(struct chip_data_ft8006 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHARGER_MODE_EN, 0x01);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHARGER_MODE_EN, 0x00);
+    }
+
+    if (ret < 0) {
+        TPD_INFO("%s: enable charge state: %d failed!\n", __func__, enable);
+    } else {
+        TPD_INFO("%s: enable charge state: %d success!\n", __func__, enable);
+    }
+    return ret;
+}
+
+static void getSpecialPoint(uint8_t *buf, int n, struct Coordinate *point)
+{
+    int x, y, i;
+
+    point[0].x = (buf[0] & 0x0F) << 8 | (buf[1] & 0xFF);
+    point[0].y = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+    point[1] = point[0];
+    point[2] = point[0];
+    point[3] = point[0];
+    for (i = 0; i < n; i++) {
+        x = (buf[0 + 4*i] & 0x0F) << 8 | (buf[1 + 4*i] & 0xFF);
+        y = (buf[2 + 4*i] & 0x0F) << 8 | (buf[3 + 4*i] & 0xFF);
+        if (point[3].x < x) {   //xmax
+            point[3].x = x;
+            point[3].y = y;
+        }
+        if (point[1].x > x) {   //xmin
+            point[1].x = x;
+            point[1].y = y;
+        }
+        if (point[2].y < y) {   //ymax
+            point[2].y = y;
+            point[2].x = x;
+        }
+        if (point[0].y > y) {   //ymin
+            point[0].y = y;
+            point[0].x = x;
+        }
+    }
+}
+/****** End of other functions that work for oppo_touchpanel_operations callbacks*************/
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int focal_ftm_process(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    TPD_INFO("%s is called!\n", __func__);
+    ret = focal_get_chip_info(chip_info);
+    if (!ret) {
+        ret = focal_enter_sleep(chip_info, true);
+    }
+
+    return ret;
+}
+
+static int focal_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    char manu_temp[MAX_DEVICE_MANU_LENGTH] = FOCAL_PREFIX;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+    strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+static int focal_get_chip_info(void *chip_data)
+{
+    int i = 0;
+    int ret = -1;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    struct focal_register   *reg_info = &chip_info->reg_info;
+
+    reg_info->FTS_REG_GESTURE_EN = 0xD0;
+    reg_info->FTS_REG_CHIP_ID = 0xA3;
+    reg_info->FTS_REG_FW_VER = 0xA6;
+    reg_info->FTS_REG_INITCODE_VER = 0xE4;
+    reg_info->FTS_REG_TOUCH_DATA = 0x00;
+    reg_info->FTS_REG_POWER_MODE = 0xA5;
+    reg_info->FTS_REG_EDG_CTR = 0x8C;
+    reg_info->FTS_REG_GESTURE_DATA = 0xD3;
+    reg_info->FTS_RST_CMD_REG = 0xFC;
+    reg_info->FTS_ERASE_APP_REG = 0x61;
+    reg_info->FTS_REG_VENDOR_ID = 0xA8;
+    reg_info->FTS_REG_BASELINE_DATA = 0x7B;
+    reg_info->FTS_REG_FLOW_WORK_CNT = 0x91;
+    reg_info->FTS_REG_CHARGER_MODE_EN = 0x8B;
+    reg_info->FTS_REG_INT_CNT = 0x8F;
+    reg_info->FTS_REG_RAWDIFF_CONTR = 0xEF;
+    reg_info->FTS_REG_RAW_DATA = 0x75;
+    reg_info->FTS_REG_DIFF_DATA = 0x77;
+
+    for (i = 0; i < 3; i++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHIP_ID);
+        if (ret == 0x80) {  //0x80 is ok
+            break;
+        }
+        msleep(90);
+    }
+    if (i == 3) {
+        TPD_INFO("%s: read chip id failed(ret:%d), ic work abnormal\n", __func__, ret);
+    }
+
+    return 0;
+}
+
+static int focal_power_control(void *chip_data, bool enable)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (enable) {
+        gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+        //msleep(RESET_TO_NORMAL_TIME);   //after lcd reset, tp need wait ic work
+    }
+    return 0;
+}
+
+static fw_check_state focal_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    int ret = 0;
+    uint8_t ver_len = 0;
+    char dev_version[MAX_DEVICE_VERSION_LENGTH] = {0};
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHIP_ID);
+    if (ret != 0x80) {
+        TPD_INFO("Read chip Id failed, need Update the Firmware, ret: %d\n", ret);
+        return FW_ABNORMAL;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FW_VER);
+    if (ret <= 0) {
+        TPD_INFO("Read firmware version failed, need Update the Firmware, ret: %d\n", ret);
+        return FW_ABNORMAL;
+    } else {
+        panel_data->TP_FW = ret;
+        sprintf(dev_version, "%02x", panel_data->TP_FW);
+        if (panel_data->manufacture_info.version) {
+            ver_len = strlen(panel_data->manufacture_info.version);
+            if (ver_len <= 8) {
+                strlcat(panel_data->manufacture_info.version, dev_version, MAX_DEVICE_VERSION_LENGTH);
+            } else {
+                strlcpy(&panel_data->manufacture_info.version[8], dev_version, MAX_DEVICE_VERSION_LENGTH - 8);
+            }
+        }
+    }
+    return FW_NORMAL;
+}
+
+static fw_update_state focal_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret = 0;
+    int i = 0;
+    int initcode_len = 0;
+    fw_update_state update_state = FW_NO_NEED_UPDATE;
+    uint8_t PANEL_ID_IN_FLASH = 0, PANEL_ID_IN_BIN = 0;
+    uint8_t TP_CURRENT_FIRMWARE_ID = 0, TP_FIRMWARE_ID = 0;
+    uint8_t LCD_CURRENT_FIRMWARE_ID = 0, LCD_FIRMWARE_ID = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    u8 *fw_data = NULL;
+    int fw_len = fw->size;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called, force update:%d\n", __func__, force);
+
+    if (fw_len < APP_FILE_MIN_SIZE || fw_len > APP_FILE_MAX_SIZE) {
+        TPD_INFO("%s: firmware size have some problem, no need update\n", __func__);
+        return FW_NO_NEED_UPDATE;
+    }
+
+    fw_data = kzalloc(fw_len, GFP_KERNEL);
+    if (!fw_data) {
+        TPD_INFO("%s: kzalloc memory failed\n", __func__);
+        return FW_UPDATE_ERROR;
+    }
+    memcpy(fw_data, fw->data, fw_len);
+
+    PANEL_ID_IN_BIN = fw_data[0x0F9E];  //read out panel id in fw.bin
+    PANEL_ID_IN_FLASH = touch_i2c_read_byte(chip_info->client, 0xE3);   //read out panel id in flash
+    TPD_INFO("PANEL_ID_IN_BIN = %02x, PANEL_ID_IN_FLASH= %02x [0x8a-tianma/0xb0-truly/0xc3-boeb3/0xc8-boeb8]\n", PANEL_ID_IN_BIN, PANEL_ID_IN_FLASH);
+    if (PANEL_ID_IN_BIN != PANEL_ID_IN_FLASH) {
+        force = 1;  //set force update flag
+        TPD_INFO("panel id not match, will force update\n");
+    }
+
+    TP_CURRENT_FIRMWARE_ID = fw_data[APP_FILE_VER_MAPPING];
+    TP_FIRMWARE_ID = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FW_VER);
+    TPD_INFO("%s, TP_FIRMWARE_ID(in .bin) = %02x, TP_FIRMWARE_ID(in flash) = %02x\n", __func__, TP_CURRENT_FIRMWARE_ID, TP_FIRMWARE_ID);
+    if (!force) {
+        if (TP_CURRENT_FIRMWARE_ID == TP_FIRMWARE_ID) {
+            update_state = FW_NO_NEED_UPDATE;
+            TPD_INFO("%s: tp fw no need update!\n", __func__);
+        } else {
+            ret = focal_upgrade_use_buf(chip_info, fw_data + APP_OFFSET, fw_len - APP_OFFSET);
+            if (ret != 0) {
+                update_state = FW_UPDATE_ERROR;
+                TPD_INFO("%s: tp fw update failed!\n", __func__);
+            } else {
+                update_state =  FW_UPDATE_SUCCESS;
+                TPD_INFO("%s: tp fw update success!\n", __func__);
+            }
+        }
+    } else {
+        ret = focal_upgrade_use_buf(chip_info, fw_data + APP_OFFSET, fw_len - APP_OFFSET);
+        if (ret != 0) {
+            update_state = FW_UPDATE_ERROR;
+            TPD_INFO("%s: tp fw update failed!\n", __func__);
+        } else {
+            update_state =  FW_UPDATE_SUCCESS;
+            TPD_INFO("%s: tp fw update success!\n", __func__);
+        }
+    }
+
+    for (i = 0; i < 3; i++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHIP_ID);
+        if (ret == 0x80) {  //0x80 is ok
+            break;
+        }
+        msleep(10);
+    }
+    if (i == 3) {
+        TPD_INFO("%s: Read chip Id failed(ret:%d), no need Update the Firmware\n", __func__, ret);
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    initcode_len = (uint32_t)((uint32_t)(fw_data[2] << 8) + fw_data[3]);
+    if (0xFF != fw_data[initcode_len] + fw_data[initcode_len + 1]) {
+        TPD_INFO("%s: init code check failed, no need update\n", __func__);
+    } else {
+        TPD_INFO("%s: init code check success\n", __func__);
+
+        LCD_CURRENT_FIRMWARE_ID = fw_data[initcode_len];
+        LCD_FIRMWARE_ID = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_INITCODE_VER);
+        TPD_INFO("%s: LCD_FIRMWARE_ID(in .bin) = %02x, LCD_FIRMWARE_ID(in flash) = %02x\n", __func__, LCD_CURRENT_FIRMWARE_ID, LCD_FIRMWARE_ID);
+        if (!force) {
+            if (LCD_FIRMWARE_ID == 0xA5) {  //0xA5: the lcd initcode is stable
+                TPD_INFO("%s : check lcd version is A5, must no update initcode\n", __func__);
+                goto OUT;
+            }
+            if ((LCD_CURRENT_FIRMWARE_ID != LCD_FIRMWARE_ID) || (LCD_FIRMWARE_ID == 0xFF)) {    //0xFF: lcd initcode must update
+                ret = focal_lcd_cfg_upgrade_use_buf(chip_info, fw_data, 4096);
+                if (ret != 0) {
+                    update_state = FW_UPDATE_ERROR;
+                    TPD_INFO("%s: init code update failed!\n", __func__);
+                } else {
+                    TPD_INFO("%s: init code update success!\n", __func__);
+                }
+            } else {
+                TPD_INFO("%s: init code no need update!\n", __func__);
+            }
+        } else {
+            ret = focal_lcd_cfg_upgrade_use_buf(chip_info, fw_data, 4096);
+            if (ret != 0) {
+                update_state = FW_UPDATE_ERROR;
+                TPD_INFO("%s: init code update failed!\n", __func__);
+            } else {
+                TPD_INFO("%s: init code update success!\n", __func__);
+            }
+        }
+    }
+
+OUT:
+    kfree(fw_data);
+    return update_state;
+}
+
+static u8 focal_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int state = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    state = touch_i2c_read_word(chip_info->client, 0x01);
+    if (state == 0xFFFF) {  //all 0xff when fw reset
+        return IRQ_FW_AUTO_RESET;
+    }
+
+    if ((gesture_enable == 1) && is_suspended) {
+        state = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+        if (state == 1) {
+            return IRQ_GESTURE;
+        } else {
+            touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN, 0x01);
+            return IRQ_IGNORE;
+        }
+    } else if (is_suspended) {
+        return IRQ_IGNORE;
+    }
+
+    return IRQ_TOUCH;
+}
+
+static int focal_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int obj_attention = 0;
+    uint8_t pointid = 0;
+    uint8_t point_state = 0;
+    uint8_t point_num = 0;
+    int ret = 0;
+    int i = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    char buf[6 * max_num + 3];
+
+    memset(buf, 0, sizeof(buf));
+    focal_esd_check_enable(chip_info, false);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_TOUCH_DATA, 3, buf);
+    if (ret < 0) {
+        TPD_INFO("read touch data header failed\n");
+        focal_esd_check_enable(chip_info, true);
+        return -1;
+    }
+
+    point_num = buf[2] & 0x0F;
+    if (point_num > max_num) {
+        TPD_INFO("read invalid point number, no need handle\n");
+        focal_esd_check_enable(chip_info, true);
+        return -1;
+    } else if (point_num) {
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_TOUCH_DATA + 3, 6 * point_num, buf + 3);
+        if (ret < 0) {
+            TPD_INFO("read touch data content failed\n");
+            focal_esd_check_enable(chip_info, true);
+            return -1;
+        }
+    }
+    focal_esd_check_enable(chip_info, true);
+
+    if ((0x0F != point_num) && (0x00 != point_num)) {
+        for (i = 0; i < point_num; i++) {
+            pointid = buf[i * 6 + 5] >> 4;
+            if (pointid >= max_num) {
+                break;
+            }
+            points[pointid].x = ((buf[i * 6 + 3] & 0x0f) << 8) | (buf[i * 6 + 4] & 0xff);
+            points[pointid].y = ((buf[i * 6 + 5] & 0x0f) << 8) | (buf[i * 6 + 6] & 0xff);
+            points[pointid].z = buf[i * 6 + 7];
+            points[pointid].width_major = buf[i * 6 + 8] >> 4;
+            points[pointid].status = 1;
+            point_state = buf[i * 6 + 3] >> 6;  /*0&2 is down, 1 is up*/
+            if ((0 == point_state) || (2 == point_state)) {
+                //SET_BIT(obj_attention, pointid);
+                obj_attention = obj_attention | (1 << pointid);
+            }
+        }
+    }
+
+    return obj_attention;
+}
+
+static int focal_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int i = 0, ret = 0;
+    uint8_t buf[255 * 4];
+    struct Coordinate limitPoint[4];
+    uint8_t point_num = 0;
+    int gesture_id = 0;
+    int stepX = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    memset(buf, 0, sizeof(buf));
+    focal_esd_check_enable(chip_info, false);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_DATA, 8, &(buf[0]));
+    if (ret < 0) {
+        TPD_INFO("Read gesture header data failed!\n");
+        focal_esd_check_enable(chip_info, true);
+        return ret;
+    }
+
+    gesture_id = buf[0];
+    point_num = buf[1];
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_DATA, 4 * point_num + 2, &(buf[0]));
+    focal_esd_check_enable(chip_info, true);
+    if (ret < 0) {
+        TPD_INFO("Read gesture point data failed!\n");
+        return ret;
+    }
+
+    if (LEVEL_BASIC != tp_debug) {
+        TPD_INFO("gesture pointNum(%d), points:", point_num);
+        for (i = 0; i < point_num; i++) {
+            printk("(%d, %d) ",(buf[4*i+2] & 0x0F) << 8 | (buf[4*i+3] & 0xFF), (buf[4*i+4] & 0x0F) << 8 | (buf[4*i+5] & 0xFF));
+        }
+    }
+
+    //judge the gesture mode
+    gesture->clockwise = 2;
+    switch (gesture_id)
+    {
+        case GESTURE_LEFT:
+            gesture->gesture_type = Right2LeftSwip;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            break;
+        case GESTURE_RIGHT:
+            gesture->gesture_type = Left2RightSwip;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            break;
+        case GESTURE_UP:
+            gesture->gesture_type = Down2UpSwip;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            break;
+        case GESTURE_DOWN:
+            gesture->gesture_type = Up2DownSwip;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            break;
+        case GESTURE_DOUBLECLICK:
+            gesture->gesture_type = DouTap;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            break;
+        case GESTURE_O:
+            gesture->gesture_type = Circle;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->clockwise = 0;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_1st = limitPoint[0]; //ymin
+            gesture->Point_2nd = limitPoint[1]; //xmin
+            gesture->Point_3rd = limitPoint[2]; //ymax
+            gesture->Point_4th = limitPoint[3]; //xmax
+            break;
+        case GESTURE_CLOCKWISE_O:
+            gesture->gesture_type = Circle;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->clockwise = 1;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_1st = limitPoint[0]; //ymin
+            gesture->Point_2nd = limitPoint[1]; //xmin
+            gesture->Point_3rd = limitPoint[2]; //ymax
+            gesture->Point_4th = limitPoint[3]; //xmax
+            break;
+        case GESTURE_W:
+            gesture->gesture_type = Wgestrue;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            stepX = abs(limitPoint[3].x - limitPoint[1].x)/4;
+            gesture->Point_start.x = limitPoint[1].x;
+            gesture->Point_start.y = limitPoint[0].y;
+            gesture->Point_end.x = limitPoint[3].x;
+            gesture->Point_end.y = limitPoint[0].y;
+            gesture->Point_1st.x = limitPoint[1].x + stepX;
+            gesture->Point_1st.y = limitPoint[2].y;
+            gesture->Point_2nd.x = limitPoint[1].x + 2 * stepX;
+            gesture->Point_2nd.y = limitPoint[0].y;
+            gesture->Point_3rd.x = limitPoint[1].x + 3 * stepX;
+            gesture->Point_3rd.y = limitPoint[2].y;
+            break;
+        case GESTURE_M:
+            gesture->gesture_type = Mgestrue;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_start.x = limitPoint[1].x;
+            gesture->Point_start.y = limitPoint[2].y;
+            gesture->Point_end.x = limitPoint[3].x;
+            gesture->Point_end.y = limitPoint[2].y;
+            gesture->Point_1st.x = limitPoint[1].x + stepX;
+            gesture->Point_1st.y = limitPoint[0].y;
+            gesture->Point_2nd.x = limitPoint[1].x + 2 * stepX;
+            gesture->Point_2nd.y = limitPoint[2].y;
+            gesture->Point_3rd.x = limitPoint[1].x + 3 * stepX;
+            gesture->Point_3rd.y = limitPoint[0].y;
+            break;
+        case GESTURE_LEFT_V:
+            gesture->gesture_type = LeftVee;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->Point_1st = limitPoint[3]; //xmax point
+            break;
+        case GESTURE_RIGHT_V:
+            gesture->gesture_type = RightVee;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->Point_1st = limitPoint[1]; //xmin point
+            break;
+        case GESTURE_UP_V:
+            gesture->gesture_type = UpVee;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->Point_1st = limitPoint[2]; //ymax point
+            break;
+        case GESTURE_DOWN_V:
+            gesture->gesture_type = DownVee;
+            getSpecialPoint(&buf[2], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[4*(point_num-1)+2] & 0x0F) << 8 | (buf[4*(point_num-1)+3] & 0xFF);
+            gesture->Point_end.y = (buf[4*(point_num-1)+4] & 0x0F) << 8 | (buf[4*(point_num-1)+5] & 0xFF);
+            gesture->Point_1st = limitPoint[0]; //ymin point
+            break;
+        case GESTURE_DOUBLE_LINE:
+            gesture->gesture_type = DouSwip;
+            gesture->Point_start.x = (buf[2] & 0x0F) << 8 | (buf[3] & 0xFF);
+            gesture->Point_start.y = (buf[4] & 0x0F) << 8 | (buf[5] & 0xFF);
+            gesture->Point_end.x = (buf[6] & 0x0F) << 8 | (buf[7] & 0xFF);
+            gesture->Point_end.y = (buf[8] & 0x0F) << 8 | (buf[9] & 0xFF);
+            gesture->Point_1st.x = (buf[10] & 0x0F) << 8 | (buf[11] & 0xFF);
+            gesture->Point_1st.y = (buf[12] & 0x0F) << 8 | (buf[13] & 0xFF);
+            gesture->Point_2nd.x = (buf[14] & 0x0F) << 8 | (buf[15] & 0xFF);
+            gesture->Point_2nd.y = (buf[16] & 0x0F) << 8 | (buf[17] & 0xFF);
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+
+    TPD_INFO("%s, gesture_id: 0x%x, gesture_type: %d, clockwise: %d, points: (%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)\n", \
+                __func__, gesture_id, gesture->gesture_type, gesture->clockwise, \
+                gesture->Point_start.x, gesture->Point_start.y, \
+                gesture->Point_end.x, gesture->Point_end.y, \
+                gesture->Point_1st.x, gesture->Point_1st.y, \
+                gesture->Point_2nd.x, gesture->Point_2nd.y, \
+                gesture->Point_3rd.x, gesture->Point_3rd.y, \
+                gesture->Point_4th.x, gesture->Point_4th.y);
+
+    return 0;
+}
+
+static int focal_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;
+            break;
+
+        case MODE_SLEEP:
+            ret = focal_enter_sleep(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: focal enter sleep failed\n", __func__);
+            }
+            break;
+
+        case MODE_GESTURE:
+            ret = focal_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: focal enable gesture failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = focal_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: focal enable edg limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = focal_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int focal_esd_handle(void *chip_data)
+{
+    s32 ret = -1;
+    int i = 0;
+    static int flow_work_cnt_last = 0;
+    static int err_cnt = 0;
+    static int i2c_err = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (chip_info->esd_check_need_stop) {
+        goto NORMAL_END;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    if ((ret & 0x70) == 0x40) { //work in factory mode
+        goto NORMAL_END;
+    }
+
+    lcd_esd_recovery_mutex(true);
+
+    for (i = 0; i < 3; i++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHIP_ID);
+        if (ret != 0x80) {
+            TPD_INFO("%s: read chip_id failed!(ret:%d)\n", __func__, ret);
+            msleep(10);
+            i2c_err++;
+        } else {
+            i2c_err = 0;
+            break;
+        }
+    }
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FLOW_WORK_CNT);
+    if (ret < 0) {
+        TPD_INFO("%s: read FTS_REG_FLOW_WORK_CNT failed!\n", __func__);
+        i2c_err++;
+    }
+
+    if (flow_work_cnt_last == ret) {
+        err_cnt++;
+    } else {
+        err_cnt = 0;
+    }
+    flow_work_cnt_last = ret;
+
+    if ((err_cnt >= 5) || (i2c_err >= 3)) {
+        TPD_INFO("esd check failed, start reset!\n");
+        disable_irq_nosync(chip_info->client->irq);
+        tp_touch_btnkey_release();
+        focal_reset(chip_info);
+        enable_irq(chip_info->client->irq);
+        flow_work_cnt_last = 0;
+        err_cnt = 0;
+        i2c_err = 0;
+    }
+
+    lcd_esd_recovery_mutex(false);
+NORMAL_END:
+    return 0;
+}
+
+static void focal_black_screen_test(void *chip_data, char *message)
+{
+    int state = -1;
+    uint8_t retry = 6;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    //wait until ic get into gesture mode
+    while (--retry) {
+        state = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+        if (state == 1) {
+            break;
+        }
+        msleep(10);
+    }
+
+    if (retry) {
+        TPD_INFO("%s,:try %d times, get into gesture mode success!\n", __func__, 5-retry);
+        sprintf(message, "0 errors. get into gesture mode success\n");
+    } else {
+        TPD_INFO("%s,:try %d times, get into gesture mode failed!\n", __func__, 5-retry);
+        sprintf(message, "1 errors. get into gesture mode failed\n");
+    }
+}
+
+static fp_touch_state focal_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t *raw_data = NULL;
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_BASELINE_DATA, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data); //read baseline data
+    if (ret < 0) {
+        TPD_INFO("%s: read baseline failed\n", __func__);
+        return fp_touch_state;
+    }
+
+    for (x = 1; x < SPURIOUS_FP_RX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 0; y < TX_NUM; y++) {
+            z = TX_NUM * x + y;
+            temp_data = (raw_data[z * 2] << 8) | raw_data[z * 2 + 1];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if ((delta_data + SPURIOUS_FP_LIMIT) < 0) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug)
+                break;
+        }
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+    return fp_touch_state;
+}
+
+static void focal_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if (TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800) {
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*SPURIOUS_FP_RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        kfree(raw_data);
+        ret = -ENOMEM;
+        return;
+    }
+
+RE_TRY:
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_BASELINE_DATA, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            msleep(10);
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < SPURIOUS_FP_RX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < TX_NUM; y++) {
+            z = TX_NUM*x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z *2] << 8) | raw_data[z*2 + 1];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    kfree(raw_data);
+
+}
+
+static void focal_register_info_read(void * chip_data, uint16_t register_addr, uint8_t * result, uint8_t length)
+{
+    int ret = 0;
+    uint8_t addr = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    addr = register_addr & 0xFF;
+    ret = touch_i2c_read_block(chip_info->client, addr, length, result);
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int focal_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+#endif
+
+static struct oppo_touchpanel_operations focal_ops = {
+    .ftm_process                = focal_ftm_process,
+    .get_vendor                 = focal_get_vendor,
+    .get_chip_info              = focal_get_chip_info,
+    .reset                      = focal_reset,
+    .power_control              = focal_power_control,
+    .fw_check                   = focal_fw_check,
+    .fw_update                  = focal_fw_update,
+    .trigger_reason             = focal_trigger_reason,
+    .get_touch_points           = focal_get_touch_points,
+    .get_gesture_info           = focal_get_gesture_info,
+    .mode_switch                = focal_mode_switch,
+    .esd_handle                 = focal_esd_handle,
+    .black_screen_test          = focal_black_screen_test,
+    .spurious_fp_check          = focal_spurious_fp_check,
+    .finger_proctect_data_get   = focal_finger_proctect_data_get,
+    .register_info_read         = focal_register_info_read,
+    .get_usb_state              = focal_get_usb_state,
+};
+/********* End of implementation of oppo_touchpanel_operations callbacks**********************/
+
+/****************** Start of function work for focal debug callbacks**************************/
+enum FW_STATUS focal_get_pram_or_rom_id(void *chip_data)
+{
+    u8 buf[4];
+    u8 reg_val[2] = {0};
+    enum FW_STATUS inRomBoot = FTS_RUN_IN_ERROR;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    /*Enter upgrade mode*/
+    /*send 0x55 in time windows*/
+    buf[0] = 0x55;
+    buf[1] = 0xAA;
+    touch_i2c_write(chip_info->client, buf, 2);
+
+    msleep(20);
+
+    buf[0] = 0x90;
+    buf[1] = buf[2] = buf[3] =0x00;
+    touch_i2c_read(chip_info->client, buf, 4, reg_val, 2);
+
+    TPD_INFO("[UPGRADE] Read ROM/PRAM/Bootloader id:0x%02x%02x\n", reg_val[0], reg_val[1]);
+    if ((reg_val[0] == 0x00) || (reg_val[0] == 0xFF)) {
+        inRomBoot = FTS_RUN_IN_ERROR;
+    } else if (reg_val[0] == 0x80 && reg_val[1] == 0xC6) {
+        inRomBoot = FTS_RUN_IN_PRAM;
+    } else if (reg_val[0] == 0x80 && reg_val[1] == 0x06) {
+        inRomBoot = FTS_RUN_IN_ROM;
+    } else if (reg_val[0] == 0x80 && reg_val[1] == 0xB6) {
+        inRomBoot = FTS_RUN_IN_BOOTLOADER;
+    }
+
+    return inRomBoot;
+}
+
+bool focal_check_run_state(void *chip_data, int rstate)
+{
+    int i = 0;
+    enum FW_STATUS cstate = FTS_RUN_IN_ERROR;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    for (i = 0; i < FTS_UPGRADE_LOOP; i++)
+    {
+        cstate = focal_get_pram_or_rom_id(chip_info);
+        TPD_DEBUG( "[UPGRADE]: run state = %d", cstate);
+
+        if (cstate == rstate)
+            return true;
+        msleep(20);
+    }
+
+    return false;
+}
+
+int focal_start_fw_upgrade(void *chip_data)
+{
+    int i_ret = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    /*send the soft upgrade commond to FW, and start upgrade*/
+    i_ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_RST_CMD_REG, 0xAA);
+    msleep(10);
+    i_ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_RST_CMD_REG, 0x55);
+    msleep(200);
+
+    return i_ret;
+}
+
+int focal_erase_flash(void *chip_data)
+{
+    u32 i = 0;
+    u8 auc_i2c_write_buf[10];
+    u8 reg_val[4] = {0};
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    TPD_INFO("[UPGRADE]**********erase app now**********\n");
+
+    /*send to erase flash*/
+    auc_i2c_write_buf[0] = 0x61;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(1350);
+
+    for (i = 0; i < 15; i++) {
+        /*get the erase app status, if get 0xF0AA£¬erase flash success*/
+        auc_i2c_write_buf[0] = 0x6a;
+        reg_val[0] = reg_val[1] = 0x00;
+        touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+        if (0xF0==reg_val[0] && 0xAA==reg_val[1]) { /*erase flash success*/
+            break;
+        }
+        msleep(50);
+    }
+
+    /*erase flash fail*/
+    if ((0xF0!=reg_val[0] || 0xAA!=reg_val[1]) && (i >= 15)) {
+        TPD_INFO("[UPGRADE]: erase app error.need reset tp and reload FW!!\n");
+        return -EIO;
+    }
+    TPD_INFO("[UPGRADE]: erase app ok!!\n");
+
+    return 0;
+}
+
+void focal_upgrade_delay(u32 i)
+{
+    do {
+        i--;
+    } while (i > 0);
+}
+
+static int print_data(u8 *buf, u32 len)
+{
+    int i = 0;
+    int n = 0;
+    u8 *p = NULL;
+
+    p = kmalloc(len*4, GFP_KERNEL);
+    memset(p, 0, len*4);
+
+    for (i = 0; i < len; i++) {
+        n += sprintf(p + n, "%02x ", buf[i]);
+    }
+
+    TPD_INFO("%s \n", p);
+
+    kfree(p);
+    return 0;
+}
+
+
+static int focal_read_3gamma(struct i2c_client *client, u8 **gamma, u16 *len)
+{
+    int ret = 0;
+    int i = 0;
+    int packet_num = 0;
+    int packet_len = 0;
+    int remainder = 0;
+    u8 cmd[4] = { 0 };
+    u32 addr = 0x01D000;
+    u8 gamma_header[0x20] = { 0 };
+    u16 gamma_len = 0;
+    u16 gamma_len_n = 0;
+    u16 pos = 0;
+    bool gamma_has_enable = false;
+    u8 *pgamma = NULL;
+    int j = 0;
+    u8 gamma_ecc = 0;
+    
+    cmd[0] = 0x03;
+    cmd[1] = (u8)(addr >> 16);
+    cmd[2] = (u8)(addr >> 8);
+    cmd[3] = (u8)addr;
+    ret = touch_i2c_write(client, cmd, 4);
+    msleep(10);
+    ret = touch_i2c_read(client, NULL, 0, gamma_header, 0x20);
+    if(ret < 0) {
+         TPD_INFO("read 3-gamma header fail\n");
+           return ret;
+    }
+
+    gamma_len = (u16)((u16)gamma_header[0] << 8) + gamma_header[1];
+    gamma_len_n = (u16)((u16)gamma_header[2] << 8) + gamma_header[3];
+
+    if((gamma_len + gamma_len_n) != 0xFFFF) {
+        TPD_INFO("gamma length check fail:%x %x\n", gamma_len, gamma_len);
+        return -EIO;
+    }
+
+    if((gamma_header[4] + gamma_header[5]) != 0xFF) {
+        TPD_INFO("gamma ecc check fail:%x %x\n", gamma_header[4], gamma_header[5]);
+        return -EIO;
+    }
+
+    if(gamma_len > MAX_GAMMA_LEN) {
+        TPD_INFO("gamma data len(%d) is too long\n", gamma_len);
+        return -EINVAL;
+    }
+
+    pgamma = *gamma;
+    packet_num = gamma_len/FTS_PACKET_LENGTH;
+    packet_len = FTS_PACKET_LENGTH;
+    remainder = gamma_len%FTS_PACKET_LENGTH;
+    if(remainder) {
+        packet_num++;
+    }
+    TPD_INFO("3-gamma len:%d\n", gamma_len);
+    cmd[0] = 0x03;
+    addr += 0x20;
+    for(i = 0; i < packet_num; i++) {
+        addr += i * FTS_PACKET_LENGTH;
+        cmd[1] = (u8)(addr >> 16);
+        cmd[2] = (u8)(addr >> 8);
+        cmd[3] = (u8)addr;
+        if ((i == packet_num -1) && remainder) {
+            packet_len = remainder;
+        }
+        ret = touch_i2c_write(client, cmd, 4);
+        msleep(10);
+        ret = touch_i2c_read(client, NULL, 0, pgamma + i*FTS_PACKET_LENGTH, packet_len);
+        if(ret < 0) {
+            TPD_INFO("read 3-gamma data fail\n");
+            return ret;
+        }
+    }
+
+    // ecc
+    for(j = 0; j < gamma_len; j++) {
+        gamma_ecc ^= pgamma[j];
+    }
+    TPD_INFO("back_3gamma_ecc: 0x%x, 0x%x\n",gamma_ecc,gamma_header[0x04]);
+    if(gamma_ecc != gamma_header[0x04]) {
+        TPD_INFO("back gamma ecc check fail:%x %x\n", gamma_ecc, gamma_header[0x04]);
+        return -EIO;
+    }
+
+    /* check last byte is 91 80 00 19 01 */
+    pos = gamma_len - 5;
+    if((gamma_enable[1] == pgamma[pos]) && (gamma_enable[2] == pgamma[pos+1])
+        && (gamma_enable[3] == pgamma[pos+2]) && (gamma_enable[4] == pgamma[pos+3])) {
+        gamma_has_enable = true;
+    }
+
+    if(false == gamma_has_enable) {
+        TPD_INFO("3-gamma has no gamma enable info\n");
+        pgamma[gamma_len++] = gamma_enable[1];
+        pgamma[gamma_len++] = gamma_enable[2];
+        pgamma[gamma_len++] = gamma_enable[3];
+        pgamma[gamma_len++] = gamma_enable[4];
+        pgamma[gamma_len++] = gamma_enable[5];
+    }
+
+    *len = gamma_len;
+    
+    if (tp_debug == 2) {
+        TPD_DEBUG("read 3-gamma data:");
+        print_data(*gamma, gamma_len);
+    }
+
+    return 0;
+}
+
+static int focal_replace_3gamma(u8 *initcode, u8 *gamma, u16 gamma_len)
+{
+    u16 gamma_pos = 0;
+
+    /* Analog Gamma */
+    if((initcode[gamma_analog[0]] == gamma[gamma_pos]) && (initcode[gamma_analog[0] + 1] == gamma[gamma_pos + 1])) {
+        memcpy(initcode + gamma_analog[0] + 4 , gamma + gamma_pos + 4, gamma_analog[5]);
+        gamma_pos += gamma_analog[5] + 4;
+    } else {
+        goto find_gamma_bank_err;
+    }
+
+    /* Digital1 Gamma */
+    if((initcode[gamma_digital1[0]] == gamma[gamma_pos]) && (initcode[gamma_digital1[0] + 1] == gamma[gamma_pos + 1])) {
+        memcpy(initcode + gamma_digital1[0] + 4 , gamma + gamma_pos + 4, gamma_digital1[5]);
+        gamma_pos += gamma_digital1[5] + 4;
+    } else {
+        goto find_gamma_bank_err;
+    }
+
+    /* Digital2 Gamma */
+    if((initcode[gamma_digital2[0]] == gamma[gamma_pos]) && (initcode[gamma_digital2[0] + 1] == gamma[gamma_pos + 1])) {
+        memcpy(initcode + gamma_digital2[0] + 4 , gamma + gamma_pos + 4, gamma_digital2[5]);
+        gamma_pos += gamma_digital2[5] + 4;
+    } else {
+        goto find_gamma_bank_err;
+    }
+
+    /* enable Gamma */
+    if((initcode[gamma_enable[0]] == gamma[gamma_pos]) && (initcode[gamma_enable[0] + 1] == gamma[gamma_pos + 1])) {
+        if(gamma[gamma_pos + 4]) {
+            initcode[gamma_enable[0] + 4 + 15] |= 0x01;
+        } else {
+            initcode[gamma_enable[0] + 4 + 15] &= 0xFE;
+        }
+        gamma_pos += 1 + 4;
+    } else {
+        goto find_gamma_bank_err;
+    }
+
+    if (tp_debug == 2) {
+        TPD_DEBUG("replace 3-gamma data:");
+        print_data(initcode, 1100);
+    }
+
+    return 0;
+
+find_gamma_bank_err:
+    TPD_INFO("3-gamma bank(%02x %02x) not find", gamma[gamma_pos], gamma[gamma_pos+1]);
+    return -ENODATA;
+}
+
+
+/* calculate lcd init code ecc */
+static int focal_cal_lcdinitcode_ecc(u8 *buf, u16 *ecc_val)
+{
+    u32 bank_crc_en = 0;
+    u8 bank_data[MAX_BANK_DATA] = { 0 };
+    u16 bank_len = 0;
+    u16 bank_addr = 0;
+    u32 bank_num = 0;
+    u16 file_len = 0;
+    u16 pos = 0;
+    int i = 0;
+    union short_bits ecc;
+    union short_bits ecc_last;
+    union short_bits temp_byte;
+    u8 bank_mapping[] = { 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0x7, 0x8, 0x9,
+        0xA, 0xB, 0xC, 0xD, 0xE, 0xF, 0x10, 0x11, 0x12, 0x13, 0x14, 0x18, 
+        0x19, 0x1A, 0x1C, 0x1D, 0x1E, 0x1F, 0x20, 0x22, 0x23, 0x24}; //Actaul mipi bank
+    u8 banknum_8006 = 0;
+
+    ecc.dshort = 0;
+    ecc_last.dshort = 0;
+    temp_byte.dshort = 0;
+
+    file_len = (u16)(((u16)buf[2] << 8) + buf[3]);
+    bank_crc_en = (u32)(((u32)buf[9] << 24) + ((u32)buf[8] << 16) + ((u32)buf[7] << 8) + (u32)buf[6]);
+    TPD_INFO("lcd init code len=%x bank en=%x\n", file_len, bank_crc_en);
+
+    pos = 0x0A; // addr of first bank
+    while(pos < file_len) {
+        bank_addr = (u16)(((u16)buf[pos + 0] << 8 ) + buf[pos + 1]);
+        bank_len = (u16)(((u16)buf[pos + 2] << 8 ) + buf[pos + 3]);
+        TPD_INFO("bank pos=%x bank_addr=%x bank_len=%x\n", pos, bank_addr, bank_len);
+        if(bank_len > MAX_BANK_DATA) {
+            return -EINVAL;
+        }
+        memset(bank_data, 0, MAX_BANK_DATA);
+        memcpy(bank_data, buf + pos + 4, bank_len);
+
+        bank_num = (bank_addr - 0x8000)/MAX_BANK_DATA;
+        TPD_INFO("actual mipi bank number = %x\n", bank_num);
+        for(i = 0; i < sizeof(bank_mapping)/sizeof(u8); i++) {
+            if(bank_num == bank_mapping[i]) {
+                banknum_8006 = i;
+                break;
+            }
+        }
+        if(i >= sizeof(bank_mapping)/sizeof(u8)) {
+            TPD_INFO("actual mipi bank(%d) not find in bank mapping, need jump\n", bank_num);
+        } else {
+            TPD_INFO("8006 bank number = %d\n", banknum_8006);
+            if((bank_crc_en >> banknum_8006) & 0x01) {
+                for(i = 0; i < MAX_BANK_DATA; i++) {
+                    temp_byte.dshort = (u16)bank_data[i];
+                    if(i == 0) {
+                        TPD_INFO("data0=%x, %d %d %d %d %d %d %d %d", temp_byte.dshort, temp_byte.bits.bit0, 
+                            temp_byte.bits.bit1, temp_byte.bits.bit2, temp_byte.bits.bit3, temp_byte.bits.bit4, 
+                            temp_byte.bits.bit5, temp_byte.bits.bit6, temp_byte.bits.bit7);
+                    }
+
+                    ecc.bits.bit0 = ecc_last.bits.bit8 ^ ecc_last.bits.bit9 ^ ecc_last.bits.bit10 ^ ecc_last.bits.bit11
+                        ^ ecc_last.bits.bit12 ^ ecc_last.bits.bit13 ^ ecc_last.bits.bit14 ^ ecc_last.bits.bit15
+                        ^ temp_byte.bits.bit0 ^ temp_byte.bits.bit1 ^ temp_byte.bits.bit2 ^ temp_byte.bits.bit3
+                        ^ temp_byte.bits.bit4 ^ temp_byte.bits.bit5 ^ temp_byte.bits.bit6 ^ temp_byte.bits.bit7;
+                    ecc.bits.bit1 = ecc_last.bits.bit9 ^ ecc_last.bits.bit10 ^ ecc_last.bits.bit11 ^ ecc_last.bits.bit12
+                        ^ ecc_last.bits.bit13 ^ ecc_last.bits.bit14 ^ ecc_last.bits.bit15
+                        ^ temp_byte.bits.bit1 ^ temp_byte.bits.bit2 ^ temp_byte.bits.bit3 ^ temp_byte.bits.bit4
+                        ^ temp_byte.bits.bit5 ^ temp_byte.bits.bit6 ^ temp_byte.bits.bit7;
+                    ecc.bits.bit2 = ecc_last.bits.bit8 ^ ecc_last.bits.bit9 ^ temp_byte.bits.bit0 ^ temp_byte.bits.bit1;
+                    ecc.bits.bit3 = ecc_last.bits.bit9 ^ ecc_last.bits.bit10 ^ temp_byte.bits.bit1 ^ temp_byte.bits.bit2;
+                    ecc.bits.bit4 = ecc_last.bits.bit10 ^ ecc_last.bits.bit11 ^ temp_byte.bits.bit2 ^ temp_byte.bits.bit3;
+                    ecc.bits.bit5 = ecc_last.bits.bit11 ^ ecc_last.bits.bit12 ^ temp_byte.bits.bit3 ^ temp_byte.bits.bit4;
+                    ecc.bits.bit6 = ecc_last.bits.bit12 ^ ecc_last.bits.bit13 ^ temp_byte.bits.bit4 ^ temp_byte.bits.bit5;
+                    ecc.bits.bit7 = ecc_last.bits.bit13 ^ ecc_last.bits.bit14 ^ temp_byte.bits.bit5 ^ temp_byte.bits.bit6;
+                    ecc.bits.bit8 = ecc_last.bits.bit0 ^ ecc_last.bits.bit14^ ecc_last.bits.bit15 ^ temp_byte.bits.bit6 ^ temp_byte.bits.bit7;
+                    ecc.bits.bit9 = ecc_last.bits.bit1 ^ ecc_last.bits.bit15 ^ temp_byte.bits.bit7;
+                    ecc.bits.bit10 = ecc_last.bits.bit2;
+                    ecc.bits.bit11 = ecc_last.bits.bit3;
+                    ecc.bits.bit12 = ecc_last.bits.bit4;
+                    ecc.bits.bit13 = ecc_last.bits.bit5;
+                    ecc.bits.bit14 = ecc_last.bits.bit6;
+                    ecc.bits.bit15 = ecc_last.bits.bit7 ^ ecc_last.bits.bit8 ^ ecc_last.bits.bit9 ^ ecc_last.bits.bit10
+                        ^ ecc_last.bits.bit11 ^ ecc_last.bits.bit12 ^ ecc_last.bits.bit13 ^ ecc_last.bits.bit14 ^ ecc_last.bits.bit15
+                        ^ temp_byte.bits.bit0 ^ temp_byte.bits.bit1 ^ temp_byte.bits.bit2 ^ temp_byte.bits.bit3
+                        ^ temp_byte.bits.bit4 ^ temp_byte.bits.bit5 ^ temp_byte.bits.bit6 ^ temp_byte.bits.bit7;
+                    ecc_last.dshort = ecc.dshort;
+                    
+                }
+            }
+        }
+        pos += bank_len + 4;        
+    }
+
+    *ecc_val = ecc.dshort;
+    return 0;
+}
+
+
+/* calculate lcd init code checksum */
+static unsigned short focal_cal_lcdinitcode_checksum(u8 *ptr , int length)
+{
+    //CRC16
+    u16 cFcs = 0;
+    int i, j;
+
+    if (length%2) {
+        return 0xFFFF;
+    }
+
+    for ( i = 0; i < length; i += 2) {
+        cFcs ^= ((ptr[i] << 8) + ptr[i+1]);
+        for (j = 0; j < 16; j ++) {
+            if (cFcs & 1) {
+                cFcs = (unsigned short)((cFcs >> 1) ^ ((1 << 15) + (1 << 10) + (1 << 3)));
+            } else {
+                cFcs >>= 1;
+            }
+        }
+    }
+    return cFcs;
+}
+
+static int focal_read_replace_3gamma(struct i2c_client *client, u8 *buf)
+{
+    int ret = 0;
+    u16 initcode_ecc = 0;
+    u16 initcode_checksum = 0;
+    u8 *gamma = NULL;
+    u16 gamma_len = 0;
+
+    gamma = kmalloc(MAX_GAMMA_LEN, GFP_KERNEL);
+    if(NULL == gamma) {
+        TPD_INFO("malloc gamma memory fail\n");
+        return -ENOMEM;
+    }
+
+    ret = focal_read_3gamma(client, &gamma, &gamma_len); //read out 3gamma data from ic backup
+    if(ret < 0) {
+        TPD_INFO("no valid 3-gamma data, not replace\n");
+        goto OUT;
+    }
+
+    ret = focal_replace_3gamma(buf, gamma, gamma_len); //replace initcode in fw with reading out 3gamma
+    if(ret < 0) {
+        TPD_INFO("replace 3-gamma fail\n");
+        goto OUT;
+    }
+
+    ret = focal_cal_lcdinitcode_ecc(buf, &initcode_ecc);
+    if (ret < 0) {
+        TPD_INFO("lcd init code ecc calculate fail\n");
+        goto OUT;
+    }
+    TPD_INFO("lcd init code cal ecc:%04x\n", initcode_ecc);
+    buf[4] = (u8)(initcode_ecc >> 8);
+    buf[5] = (u8)(initcode_ecc);
+    buf[0x43d] = (u8)(initcode_ecc >> 8);
+    buf[0x43c] = (u8)(initcode_ecc);
+
+    initcode_checksum = focal_cal_lcdinitcode_checksum(buf + 2, 0x43e - 2);
+    TPD_INFO("lcd init code calc checksum:%04x\n", initcode_checksum);
+    buf[0] = (u8)(initcode_checksum >> 8);
+    buf[1] = (u8)(initcode_checksum);
+
+OUT:
+    kfree(gamma);
+    return ret < 0 ? ret : 0;
+}
+
+int focal_check_initialCode_valid(struct i2c_client *client, u8 *buf)
+{
+    int ret = 0;
+    u16 initcode_ecc = 0;
+    u16 initcode_checksum = 0;
+
+    initcode_checksum = focal_cal_lcdinitcode_checksum(buf + 2, 0x43e - 2);
+    TPD_INFO("lcd init code calc checksum:%04x\n", initcode_checksum);
+    if (initcode_checksum != ((u16)((u16)buf[0] << 8) + buf[1])) {
+        TPD_INFO("Initial Code checksum fail\n");
+        return -EINVAL;
+    }
+
+    ret = focal_cal_lcdinitcode_ecc(buf, &initcode_ecc);
+    if (ret < 0) {
+        TPD_INFO("lcd init code ecc calculate fail\n");
+        return ret;
+    }
+    TPD_INFO("lcd init code cal ecc:%04x\n", initcode_ecc);
+    if(initcode_ecc != ((u16)((u16)buf[4] << 8) + buf[5])) {
+        TPD_INFO("Initial Code ecc check fail\n");
+        return -EINVAL;
+    }
+
+    return 0;
+}
+/******************* End of function work for focal debug callbacks***************************/
+
+/****************** Start of implementation of focal debug callbacks**************************/
+static int focal_upgrade_use_buf(void *chip_data, u8 *pbt_buf, u32 dw_lenth)
+{
+    u8 reg_val[4] = {0};
+    u32 i = 0;
+    u32 packet_number;
+    u32 j = 0;
+    u32 temp;
+    u32 lenght;
+    u8 packet_buf[FTS_PACKET_LENGTH + 6];
+    u8 auc_i2c_write_buf[10];
+    u8 upgrade_ecc;
+    int i_ret = 0;
+    bool inbootloader = false;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    TPD_INFO("[UPGRADE]**********send 0xAA and 0x55 to FW, start upgrade**********\n");
+    i_ret = focal_start_fw_upgrade(chip_info);
+    if (i_ret < 0) {
+        TPD_INFO( "[UPGRADE]: send upgrade cmd to FW error!!\n");
+        return i_ret;
+    }
+
+    TPD_INFO("[UPGRADE]**********check if run in bootloader mode**********\n");
+    inbootloader = focal_check_run_state(chip_info, FTS_RUN_IN_BOOTLOADER);
+    if (!inbootloader) {
+        TPD_INFO( "[UPGRADE]: not run in bootloader, upgrade fail!!\n");
+        return -EIO;
+    }
+
+    /*send upgrade type to reg 0x09: 0x0B: upgrade; 0x0A: download*/
+    auc_i2c_write_buf[0] = 0x09;
+    auc_i2c_write_buf[1] = 0x0B;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 2);
+
+    /* All.bin <= 128K
+     * APP.bin <= 94K
+     * LCD_CFG <= 4K */
+    auc_i2c_write_buf[0] = 0xB0;
+    auc_i2c_write_buf[1] = (u8) ((dw_lenth >> 16) & 0xFF);
+    auc_i2c_write_buf[2] = (u8) ((dw_lenth >> 8) & 0xFF);
+    auc_i2c_write_buf[3] = (u8) (dw_lenth & 0xFF);
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 4);
+
+    /*erase the app erea in flash*/
+    TPD_INFO("[UPGRADE]**********start earse flash area**********\n");
+    i_ret = focal_erase_flash(chip_info);
+    if (i_ret < 0) {
+        TPD_INFO( "[UPGRADE]: erase flash error!!\n");
+        return i_ret;
+    }
+
+    /*write FW to ctpm flash*/
+    upgrade_ecc = 0;
+    temp = 0;
+    packet_number = (dw_lenth) / FTS_PACKET_LENGTH;
+    packet_buf[0] = FTS_FW_WRITE_CMD;
+
+    TPD_INFO("[UPGRADE]**********start write fw to flash**********\n");
+    for (j = 0; j < packet_number; j++) {
+        temp = 0x5000 + j * FTS_PACKET_LENGTH;
+        packet_buf[1] = (u8) (temp >> 16);
+        packet_buf[2] = (u8) (temp >> 8);
+        packet_buf[3] = (u8) temp;
+        lenght = FTS_PACKET_LENGTH;
+        packet_buf[4] = (u8) (lenght >> 8);
+        packet_buf[5] = (u8) lenght;
+        for (i = 0; i < FTS_PACKET_LENGTH; i++) {
+            packet_buf[6 + i] = pbt_buf[j * FTS_PACKET_LENGTH + i];
+            upgrade_ecc ^= packet_buf[6 + i];
+        }
+        touch_i2c_write(chip_info->client, packet_buf, FTS_PACKET_LENGTH + 6);
+        //msleep(1);
+
+        for (i = 0; i < 30; i++) {
+            auc_i2c_write_buf[0] = 0x6a;
+            reg_val[0] = reg_val[1] = 0x00;
+            touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+            if ((j + 0x1000 + (0x5000/FTS_PACKET_LENGTH)) == (((reg_val[0]) << 8) | reg_val[1])) {
+                break;
+            }
+
+            if (i > 15) {
+                msleep(1);
+                TPD_INFO("[UPGRADE]: write flash: host : %x status : %x!!\n", (j + 0x1000 + (0x5000/FTS_PACKET_LENGTH)), (((reg_val[0]) << 8) | reg_val[1]));
+            }
+            //msleep(1);
+            focal_upgrade_delay(10000);
+        }
+    }
+
+    if ((dw_lenth) % FTS_PACKET_LENGTH > 0) {
+        temp = 0x5000 + packet_number * FTS_PACKET_LENGTH;
+        packet_buf[1] = (u8) (temp >> 16);
+        packet_buf[2] = (u8) (temp >> 8);
+        packet_buf[3] = (u8) temp;
+        temp = (dw_lenth) % FTS_PACKET_LENGTH;
+        packet_buf[4] = (u8) (temp >> 8);
+        packet_buf[5] = (u8) temp;
+        for (i = 0; i < temp; i++) {
+            packet_buf[6 + i] = pbt_buf[packet_number * FTS_PACKET_LENGTH + i];
+            upgrade_ecc ^= packet_buf[6 + i];
+        }
+        touch_i2c_write(chip_info->client, packet_buf, temp + 6);
+        //msleep(1);
+
+        for (i = 0; i < 30; i++) {
+            auc_i2c_write_buf[0] = 0x6a;
+            reg_val[0] = reg_val[1] = 0x00;
+            touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+            if ((0x1000 + ((0x5000 + packet_number * FTS_PACKET_LENGTH)/((dw_lenth) % FTS_PACKET_LENGTH))) == (((reg_val[0]) << 8) | reg_val[1])) {
+                break;
+            }
+
+            if (i > 15) {
+                msleep(1);
+                TPD_INFO("[UPGRADE]: write flash: host : %x status : %x!!\n", (j + 0x1000 + (0x5000/FTS_PACKET_LENGTH)), (((reg_val[0]) << 8) | reg_val[1]));
+            }
+            //msleep(1);
+            focal_upgrade_delay(10000);
+        }
+    }
+
+    msleep(50);
+
+    /*********Step 6: read out checksum***********************/
+    /*send the opration head */
+    TPD_INFO("[UPGRADE]**********start read checksum**********\n");
+    auc_i2c_write_buf[0] = 0x64;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(300);
+
+    temp = 0x5000;
+    auc_i2c_write_buf[0] = 0x65;
+    auc_i2c_write_buf[1] = (u8)(temp >> 16);
+    auc_i2c_write_buf[2] = (u8)(temp >> 8);
+    auc_i2c_write_buf[3] = (u8)(temp);
+    temp = (64*1024-1);
+    auc_i2c_write_buf[4] = (u8)(temp >> 8);
+    auc_i2c_write_buf[5] = (u8)(temp);
+    i_ret = touch_i2c_write(chip_info->client, auc_i2c_write_buf, 6);
+    msleep(dw_lenth/256);
+
+    temp = (0x5000+(64*1024-1));
+    auc_i2c_write_buf[0] = 0x65;
+    auc_i2c_write_buf[1] = (u8)(temp >> 16);
+    auc_i2c_write_buf[2] = (u8)(temp >> 8);
+    auc_i2c_write_buf[3] = (u8)(temp);
+    temp = (dw_lenth-(64*1024-1));
+    auc_i2c_write_buf[4] = (u8)(temp >> 8);
+    auc_i2c_write_buf[5] = (u8)(temp);
+    i_ret = touch_i2c_write(chip_info->client, auc_i2c_write_buf, 6);
+    msleep(dw_lenth/256);
+
+    for (i = 0; i < 100; i++) {
+        auc_i2c_write_buf[0] = 0x6a;
+        reg_val[0] = reg_val[1] = 0x00;
+        touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+        if (0xF0==reg_val[0] && 0x55==reg_val[1]) {
+            TPD_DEBUG("[UPGRADE]: reg_val[0]=%02x reg_val[0]=%02x!!", reg_val[0], reg_val[1]);
+            break;
+        }
+        msleep(1);
+    }
+    auc_i2c_write_buf[0] = 0x66;
+    touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 1);
+    if (reg_val[0] != upgrade_ecc) {
+        TPD_INFO("[UPGRADE]: ecc error! FW=%02x upgrade_ecc=%02x!!\n",reg_val[0],upgrade_ecc);
+        return -EIO;
+    }
+    TPD_INFO("[UPGRADE]: checksum %x %x!!\n",reg_val[0],upgrade_ecc);
+
+    TPD_INFO("[UPGRADE]: reset the new FW!!\n");
+    auc_i2c_write_buf[0] = 0x07;    //FTS_REG_RESET_FW
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(1000);
+
+    TPD_INFO("[UPGRADE]**********end of fw upgrade sucess**********\n");
+    return 0;
+}
+
+static int focal_lcd_cfg_upgrade_use_buf(void *chip_data, u8* pbt_buf, u32 dw_lenth)
+{
+    u8 reg_val[4] = {0};
+    u32 i = 0;
+    u32 packet_number;
+    u32 j = 0;
+    u32 temp;
+    u32 lenght;
+    bool inbootloader = false;
+    u8 packet_buf[FTS_PACKET_LENGTH + 6];
+    u8 auc_i2c_write_buf[10];
+    u8 upgrade_ecc;
+    int i_ret;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    TPD_INFO("[UPGRADE]**********send 0xAA and 0x55 to FW, start upgrade**********\n");
+    i_ret = focal_start_fw_upgrade(chip_info);
+    if (i_ret < 0) {
+        TPD_INFO( "[UPGRADE]: send upgrade cmd to FW error!!\n");
+    }
+
+    TPD_INFO("[UPGRADE]**********check if run in bootloader mode**********\n");
+    inbootloader = focal_check_run_state(chip_info, FTS_RUN_IN_BOOTLOADER);
+    if (!inbootloader) {
+        TPD_INFO( "[UPGRADE]: not run in bootloader, upgrade fail!!\n");
+        return -EIO;
+    }
+
+    i_ret = focal_read_replace_3gamma(chip_info->client, pbt_buf);
+    if(i_ret < 0) {
+        TPD_INFO("replace 3-gamma fail, not upgrade lcd init code\n");
+        return i_ret;
+    }
+
+    i_ret = focal_check_initialCode_valid(chip_info->client, pbt_buf);
+    if(i_ret < 0) {
+        TPD_INFO("initial code invalid, not upgrade lcd init code");
+        return i_ret;
+    }
+
+    /*send upgrade type to reg 0x09: 0x0B: upgrade; 0x0A: download*/
+    auc_i2c_write_buf[0] = 0x09;
+    auc_i2c_write_buf[1] = 0x0C;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 2);
+
+    /*Step 4:erase app and panel paramenter area*/
+    TPD_INFO("[UPGRADE]**********erase app and panel paramenter area**********\n");
+    auc_i2c_write_buf[0] = chip_info->reg_info.FTS_ERASE_APP_REG;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(1000);
+
+    for (i = 0; i < 15; i++) {
+        auc_i2c_write_buf[0] = 0x6a;
+        reg_val[0] = reg_val[1] = 0x00;
+        touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+        if (0xF0==reg_val[0] && 0xAA==reg_val[1]) {
+            break;
+        }
+        msleep(50);
+    }
+    TPD_INFO("[UPGRADE]: erase app area reg_val[0] = %x reg_val[1] = %x!!\n", reg_val[0], reg_val[1]);
+
+    auc_i2c_write_buf[0] = 0xB0;
+    auc_i2c_write_buf[1] = 0;
+    auc_i2c_write_buf[2] = (u8) ((dw_lenth >> 8) & 0xFF);
+    auc_i2c_write_buf[3] = (u8) (dw_lenth & 0xFF);
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 4);
+
+    /*write FW to ctpm flash*/
+    upgrade_ecc = 0;
+    TPD_INFO("[UPGRADE]**********write fw to lcd flash area**********\n");
+    temp = 0;
+    packet_number = (dw_lenth) / FTS_PACKET_LENGTH;
+    packet_buf[0] = FTS_FW_WRITE_CMD;
+    packet_buf[1] = 0;
+    for (j = 0; j < packet_number; j++) {
+        temp = j * FTS_PACKET_LENGTH;
+        packet_buf[2] = (u8) (temp >> 8);
+        packet_buf[3] = (u8) temp;
+        lenght = FTS_PACKET_LENGTH;
+        packet_buf[4] = (u8) (lenght >> 8);
+        packet_buf[5] = (u8) lenght;
+        for (i = 0; i < FTS_PACKET_LENGTH; i++) {
+            packet_buf[6 + i] = pbt_buf[j * FTS_PACKET_LENGTH + i];
+            upgrade_ecc ^= packet_buf[6 + i];
+        }
+        touch_i2c_write(chip_info->client, packet_buf, FTS_PACKET_LENGTH + 6);
+
+        for (i = 0; i < 30; i++) {
+            auc_i2c_write_buf[0] = 0x6a;
+            reg_val[0] = reg_val[1] = 0x00;
+            touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+            if ((j + 0x1000) == (((reg_val[0]) << 8) | reg_val[1])) {
+                break;
+            }
+
+            if (i > 15) {
+                msleep(1);
+                TPD_INFO("[UPGRADE]: write flash: host : %x status : %x!!\n", (j + 0x1000 + (0x5000/FTS_PACKET_LENGTH)), (((reg_val[0]) << 8) | reg_val[1]));
+            }
+            focal_upgrade_delay(10000);
+        }
+    }
+
+    if ((dw_lenth) % FTS_PACKET_LENGTH > 0) {
+        temp = packet_number * FTS_PACKET_LENGTH;
+        packet_buf[2] = (u8) (temp >> 8);
+        packet_buf[3] = (u8) temp;
+        temp = (dw_lenth) % FTS_PACKET_LENGTH;
+        packet_buf[4] = (u8) (temp >> 8);
+        packet_buf[5] = (u8) temp;
+        for (i = 0; i < temp; i++) {
+            packet_buf[6 + i] = pbt_buf[packet_number * FTS_PACKET_LENGTH + i];
+            upgrade_ecc ^= packet_buf[6 + i];
+        }
+        touch_i2c_write(chip_info->client, packet_buf, temp + 6);
+
+        for (i = 0; i < 30; i++) {
+            auc_i2c_write_buf[0] = 0x6a;
+            reg_val[0] = reg_val[1] = 0x00;
+            touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+            if ((0x1000 + ((packet_number * FTS_PACKET_LENGTH)/((dw_lenth) % FTS_PACKET_LENGTH))) == (((reg_val[0]) << 8) | reg_val[1])) {
+                break;
+            }
+
+            if (i > 15) {
+                msleep(1);
+                TPD_INFO("[UPGRADE]: write flash: host : %x status : %x!!\n", (j + 0x1000 + (0x5000/FTS_PACKET_LENGTH)), (((reg_val[0]) << 8) | reg_val[1]));
+            }
+            focal_upgrade_delay(10000);
+        }
+    }
+
+    msleep(50);
+
+    /*********Step 6: read out checksum***********************/
+    /*send the opration head */
+    TPD_INFO("[UPGRADE]: read out checksum!!\n");
+    auc_i2c_write_buf[0] = 0x64;
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(300);
+
+    temp = 0x00;
+    auc_i2c_write_buf[0] = 0x65;
+    auc_i2c_write_buf[1] = 0;
+    auc_i2c_write_buf[2] = (u8)(temp >> 8);
+    auc_i2c_write_buf[3] = (u8)(temp);
+    temp = dw_lenth;
+    auc_i2c_write_buf[4] = (u8)(temp >> 8);
+    auc_i2c_write_buf[5] = (u8)(temp);
+    i_ret = touch_i2c_write(chip_info->client, auc_i2c_write_buf, 6);
+    msleep(dw_lenth/256);
+
+    for (i = 0; i < 100; i++) {
+        auc_i2c_write_buf[0] = 0x6a;
+        reg_val[0] = reg_val[1] = 0x00;
+        touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 2);
+
+        if (0xF0==reg_val[0] && 0x55==reg_val[1]) {
+            TPD_INFO("[UPGRADE]: reg_val[0]=%02x reg_val[0]=%02x!!\n", reg_val[0], reg_val[1]);
+            break;
+        }
+        msleep(1);
+    }
+    auc_i2c_write_buf[0] = 0x66;
+    touch_i2c_read(chip_info->client, auc_i2c_write_buf, 1, reg_val, 1);
+    if (reg_val[0] != upgrade_ecc) {
+        TPD_INFO("[UPGRADE]: ecc error! FW=%02x upgrade_ecc=%02x!!\n",reg_val[0],upgrade_ecc);
+        return -EIO;
+    }
+    TPD_INFO("[UPGRADE]: checksum %x %x!!\n",reg_val[0],upgrade_ecc);
+
+    TPD_INFO("[UPGRADE]: reset the new FW!!\n");
+    auc_i2c_write_buf[0] = 0x07;    //FTS_REG_RESET_FW
+    touch_i2c_write(chip_info->client, auc_i2c_write_buf, 1);
+    msleep(1000);
+
+    return 0;
+}
+
+static void focal_esd_check_enable(void *chip_data, bool enable)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    chip_info->esd_check_need_stop = !enable;
+}
+
+static bool focal_get_esd_check_flag(void *chip_data)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    return chip_info->esd_check_need_stop;
+}
+
+static int focal_get_fw_version(void *chip_data)
+{
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+    return touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FW_VER);
+}
+
+static int focal_dump_reg_state(void *chip_data, char *buf)
+{
+    int count = 0;
+    u8 regvalue = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    //power mode 0:active 1:monitor 3:sleep
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_POWER_MODE);
+    count += sprintf(buf + count, "Power Mode:0x%02x\n", regvalue);
+
+    //FW version
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FW_VER);
+    count += sprintf(buf + count, "FW Ver:0x%02x\n",regvalue);
+
+    //Vendor ID
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_VENDOR_ID);
+    count += sprintf(buf + count, "Vendor ID:0x%02x\n", regvalue);
+
+    // 1 Gesture mode,0 Normal mode
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+    count += sprintf(buf + count, "Gesture Mode:0x%02x\n", regvalue);
+
+    // 3 charge in
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHARGER_MODE_EN);
+    count += sprintf(buf + count, "charge stat:0x%02x\n", regvalue);
+
+    //Interrupt counter
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_INT_CNT);
+    count += sprintf(buf + count, "INT count:0x%02x\n", regvalue);
+
+    //Flow work counter
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FLOW_WORK_CNT);
+    count += sprintf(buf + count, "ESD count:0x%02x\n", regvalue);
+
+    return count;
+}
+
+struct focal_debug_func focal_debug_ops =
+{
+    .esd_check_enable               = focal_esd_check_enable,
+    .get_esd_check_flag             = focal_get_esd_check_flag,
+    .reset                          = focal_reset_via_gpio,
+    .get_fw_version                 = focal_get_fw_version,
+    .dump_reg_sate                  = focal_dump_reg_state,
+};
+/******************* End of implementation of focal debug callbacks***************************/
+
+/**************** Start of implementation of debug_info proc callbacks************************/
+static void focal_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0, retry = 21;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (!chip_info)
+        return;
+
+    focal_esd_check_enable(chip_info, false);   //no allowed esd check
+    //wait data can be read
+    while (--retry) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR);
+        if (!ret) {
+            break;
+        }
+        msleep(1);
+    }
+    if (!retry) {
+        seq_printf(s, "wait data be ready timed out\n");
+        focal_esd_check_enable(chip_info, true);    //allowed esd check
+        return;
+    }
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        focal_esd_check_enable(chip_info, true);    //allowed esd check
+        return;
+    }
+
+    //open interface to read delta and rawdata
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR, 0x01);
+    msleep(10);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_DIFF_DATA, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = raw_data[z * 2 + 1] | (raw_data[z * 2] << 8);
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR, 0x00);
+
+    focal_esd_check_enable(chip_info, true);    //allowed esd check
+    kfree(raw_data);
+}
+
+static void focal_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0, retry = 21;
+    int16_t temp_delta = 0;
+    uint8_t *baseline_data = NULL;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (!chip_info)
+        return;
+
+    focal_esd_check_enable(chip_info, false);   //no allowed esd check
+    //wait data can be read
+    while (--retry) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR);
+        if (!ret) {
+            break;
+        }
+        msleep(1);
+    }
+    if (!retry) {
+        seq_printf(s, "wait data be ready timed out\n");
+        focal_esd_check_enable(chip_info, true);    //allowed esd check
+        return;
+    }
+
+    baseline_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!baseline_data) {
+        TPD_INFO("baseline_data kzalloc error\n");
+        focal_esd_check_enable(chip_info, true);    //allowed esd check
+        return;
+    }
+
+    //open interface to read delta and rawdata
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR, 0x01);
+    msleep(10);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.FTS_REG_RAW_DATA, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, baseline_data);  //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = baseline_data[z * 2 + 1] | (baseline_data[z * 2] << 8);
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.FTS_REG_RAWDIFF_CONTR, 0x00);
+
+    focal_esd_check_enable(chip_info, true);    //allowed esd check
+    kfree(baseline_data);
+}
+
+static void focal_main_register_read(struct seq_file *s, void *chip_data)
+{
+    u8 regvalue = 0;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    focal_esd_check_enable(chip_info, false);   //no allowed esd check
+
+    //power mode 0:active 1:monitor 3:sleep
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_POWER_MODE);
+    seq_printf(s, "Power Mode:0x%02x\n", regvalue);
+
+    //TP FW version
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FW_VER);
+    seq_printf(s, "TP FW Ver:0x%02x\n",regvalue);
+
+    //initcode version
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_INITCODE_VER);
+    seq_printf(s, "initcode Ver:0x%02x\n",regvalue);
+
+    //Vendor ID
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_VENDOR_ID);
+    seq_printf(s, "Vendor ID(0x8d/0xda/0x5a):0x%02x\n", regvalue);
+
+    // 1 Gesture mode,0 Normal mode
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_GESTURE_EN);
+    seq_printf(s, "Gesture Mode:0x%02x\n", regvalue);
+
+    // 3 charge in
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_CHARGER_MODE_EN);
+    seq_printf(s, "charge state:0x%02x\n", regvalue);
+
+    //Interrupt counter
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_INT_CNT);
+    seq_printf(s, "INT count:0x%02x\n", regvalue);
+
+    //Flow work counter
+    regvalue = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.FTS_REG_FLOW_WORK_CNT);
+    seq_printf(s, "ESD count:0x%02x\n", regvalue);
+
+    //Panel ID
+    regvalue = touch_i2c_read_byte(chip_info->client, 0xE3);
+    seq_printf(s, "PANEL ID(0x8a-tianma/0xb0-truly/0xc3-boeb3/0xc8-boeb8):0x%02x\n", regvalue);
+
+    //Work Freq
+    regvalue = touch_i2c_read_byte(chip_info->client, 0xFE);
+    seq_printf(s, "work Freq:0x%02x\n", regvalue);
+
+    focal_esd_check_enable(chip_info, true);    //allowed esd check
+
+    return;
+}
+
+static void focal_cb_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0, i = 0;
+    u8 regvalue = 0;
+    int16_t temp_delta = 0;
+    uint8_t *cb_data = NULL;
+    struct chip_data_ft8006 *chip_info = (struct chip_data_ft8006 *)chip_data;
+
+    if (!chip_info)
+        return;
+
+    focal_esd_check_enable(chip_info, false); //no allowed esd check
+    cb_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!cb_data) {
+        TPD_INFO("cb_data kzalloc error\n");
+        focal_esd_check_enable(chip_info, true);
+        return;
+    }
+
+    // enter factory mode
+    ret = touch_i2c_write_byte(chip_info->client, 0x00, 0x40);
+    msleep(200);
+
+    //auto clb
+    ret = touch_i2c_write_byte(chip_info->client, 0x04, 0x04);
+    for (i = 0; i < 50; i++) {
+      msleep(100);
+      ret = touch_i2c_write_byte(chip_info->client, 0x00, 0x04 << 4);
+      regvalue = touch_i2c_read_byte(chip_info->client, 0x04);
+      if( regvalue == 0x02)
+            break;
+    }
+    if (i == 50) {
+      seq_printf(s, "calibration failed\n");
+      goto OUT;
+    }
+
+    // read cb
+    seq_printf(s, "cb data:");
+    ret = touch_i2c_write_byte(chip_info->client, 0x18, 0x00);//Address offset high 8 bit
+    ret = touch_i2c_write_byte(chip_info->client, 0x19, 0x00);//Address offset low 8 bit 
+    ret = touch_i2c_read_block(chip_info->client, 0x6E, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM, cb_data);  //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = cb_data[z];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+OUT:
+    // enter work mode
+    ret = touch_i2c_write_byte(chip_info->client, 0x00, 0x00);
+    msleep(100);
+
+    focal_esd_check_enable(chip_info, true); //allowed esd check
+    kfree(cb_data);
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .delta_read    = focal_delta_read,
+    .baseline_read = focal_baseline_read,
+    .main_register_read = focal_main_register_read,
+    .reserve_read = focal_cb_read,
+};
+/***************** End of implementation of debug_info proc callbacks*************************/
+
+/*********** Start of I2C Driver and Implementation of it's callbacks*************************/
+static int focal_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_ft8006 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    /* 1. alloc chip info */
+    chip_info = kzalloc(sizeof(struct chip_data_ft8006), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. bind client and dev for easy operate */
+    chip_info->client = client;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+    chip_info->esd_check_need_stop = false;
+    chip_info->is_sleep_reg_write = false;
+    g_chip_info = chip_info;
+
+    /* 4. file_operations callbacks binding */
+    ts->ts_ops = &focal_ops;
+    ts->private_data = &focal_debug_ops;
+
+    /* 5. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+    ts->skip_reset_in_resume = true;
+    ts->skip_suspend_operate = true;
+    ts->tp_suspend_order = LCD_TP_SUSPEND;
+    ts->tp_resume_order = LCD_TP_RESUME;
+
+    //reset esd handle time interval
+    if (ts->esd_handle_support) {
+        ts->esd_info.esd_work_time = HZ; // change esd check interval to 1s
+        TPD_INFO("%s:change esd handle time to %d s\n", __func__, ts->esd_info.esd_work_time/HZ);
+    }
+
+    /* 6. collect data for supurious_fp_touch */
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        focal_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    /* 7. create focal apk debug files */
+    focal_create_apk_debug_channel(ts);
+
+    /* 8. create sys info file */
+    focal_create_sysfs(client);
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int focal_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int focal_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int focal_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = focal_i2c_suspend,
+    .resume = focal_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver =
+{
+    .probe = focal_tp_probe,
+    .remove = focal_tp_remove,
+    .id_table = tp_id,
+    .driver = {
+        .name = TPD_DEVICE,
+        .owner = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+/******************* End of I2C Driver and It's dev_pm_ops***********************/
+
+/***********************Start of module init and exit****************************/
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+/***********************End of module init and exit*******************************/
+
+MODULE_AUTHOR("FocalTech Driver");
+MODULE_DESCRIPTION("FocalTech Touchscreen Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.h b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.h
new file mode 100755
index 0000000000000000000000000000000000000000..ba59346c73c251e347dff7da4d9ff6c2955bedb0
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/focal_drivers_ft8006.h
@@ -0,0 +1,138 @@
+/***************************************************
+ * File:focal_FT8006.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             focal FT8006 driver
+ * Version:1.0:
+ * Date created:2017/06/12
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef FOCAL_H_FT8006
+#define FOCAL_H_FT8006
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../focal_common.h"
+
+/*********PART2:Define Area**********************/
+
+#define RESET_TO_NORMAL_TIME 270    /*Sleep time after reset*/
+#define POWEWRUP_TO_RESET_TIME 10
+
+#define SPURIOUS_FP_LIMIT 60
+#define SPURIOUS_FP_RX_NUM 11
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+#define GESTURE_LEFT                            0x20
+#define GESTURE_RIGHT                           0x21
+#define GESTURE_UP                              0x22
+#define GESTURE_DOWN                            0x23
+#define GESTURE_DOUBLECLICK                     0x24
+#define GESTURE_O                               0x30
+#define GESTURE_CLOCKWISE_O                     0x57
+#define GESTURE_W                               0x31
+#define GESTURE_M                               0x32
+#define GESTURE_E                               0x33
+#define GESTURE_L                               0x44
+#define GESTURE_S                               0x46
+#define GESTURE_V                               0x54
+#define GESTURE_Z                               0x41
+#define GESTURE_C                               0x34
+
+#define GESTURE_LEFT_V                          0x52
+#define GESTURE_RIGHT_V                         0x51
+#define GESTURE_UP_V                            0x54
+#define GESTURE_DOWN_V                          0x53
+#define GESTURE_DOUBLE_LINE                     0x77
+
+
+#define APP_OFFSET                  0x5000
+#define APP_FILE_MAX_SIZE           (116 * 1024)
+#define APP_FILE_MIN_SIZE           (8)
+#define APP_FILE_VER_MAPPING        (0x10E + APP_OFFSET)
+#define FTS_PACKET_LENGTH           128
+#define FTS_UPGRADE_LOOP            30
+#define FTS_FW_WRITE_CMD            0xBF
+
+//3-gamma
+#define MAX_BANK_DATA               0x80
+#define MAX_GAMMA_LEN               0x180
+int gamma_analog[] = { 0x003A, 0x85, 0x00, 0x00, 0x2C, 0x2B };
+int gamma_digital1[] = { 0x0355, 0x8D, 0x00, 0x00, 0x80, 0x80 };
+int gamma_digital2[] = { 0x03d9, 0x8D, 0x80, 0x00, 0x14, 0x13 };
+int gamma_enable[] = { 0x040d, 0x91, 0x80, 0x00, 0x19, 0x01 };
+union short_bits{
+    u16 dshort;
+    struct bits{
+        u16 bit0:1;
+        u16 bit1:1;
+        u16 bit2:1;
+        u16 bit3:1;
+        u16 bit4:1;
+        u16 bit5:1;
+        u16 bit6:1;
+        u16 bit7:1;
+        u16 bit8:1;
+        u16 bit9:1;
+        u16 bit10:1;
+        u16 bit11:1;
+        u16 bit12:1;
+        u16 bit13:1;
+        u16 bit14:1;
+        u16 bit15:1;
+    }bits;
+};
+
+/*********PART3:Struct Area**********************/
+enum FW_STATUS
+{
+    FTS_RUN_IN_ERROR,
+    FTS_RUN_IN_APP,
+    FTS_RUN_IN_ROM,
+    FTS_RUN_IN_PRAM,
+    FTS_RUN_IN_BOOTLOADER
+};
+
+struct focal_register
+{
+    uint8_t FTS_REG_GESTURE_EN;         /*black gesture control register*/
+    uint8_t FTS_REG_CHIP_ID;            /*chip id*/
+    uint8_t FTS_REG_FW_VER;             /*firamware version*/
+    uint8_t FTS_REG_TOUCH_DATA;         /*touch point data*/
+    uint8_t FTS_REG_GESTURE_DATA;       /*gesture point data*/
+    uint8_t FTS_REG_POWER_MODE;         /*power mode*/
+    uint8_t FTS_REG_EDG_CTR;            /*edge prevent mistake touch*/
+    uint8_t FTS_RST_CMD_REG;            /*before upgrade, need send soft upgrade commond*/
+    uint8_t FTS_ERASE_APP_REG;          /*earse app and panel paramenter*/
+    uint8_t FTS_REG_VENDOR_ID;          /*save vendor id*/
+    uint8_t FTS_REG_BASELINE_DATA;      /*use for reading baseline data*/
+    uint8_t FTS_REG_FLOW_WORK_CNT;      /*work flow cnt*/
+    uint8_t FTS_REG_CHARGER_MODE_EN;    /*charge mode state*/
+    uint8_t FTS_REG_INT_CNT;            /*IC interrupt count*/
+    uint8_t FTS_REG_INITCODE_VER;       /*init code version*/
+    uint8_t FTS_REG_RAWDIFF_CONTR;      /*control read rawdata or delta*/
+    uint8_t FTS_REG_RAW_DATA;           /*read out rawdata from this register*/
+    uint8_t FTS_REG_DIFF_DATA;          /*read out diffdata from this register*/
+};
+
+
+struct chip_data_ft8006 {
+    tp_dev                          tp_type;
+    struct i2c_client               *client;
+    struct focal_register           reg_info;
+    struct hw_resource              *hw_res;
+    int16_t                         *spuri_fp_data;
+    bool                            is_sleep_reg_write;    /*true:ic in sleep mode*/
+    bool                            esd_check_need_stop;   /*true:esd check do nothing*/
+};
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Focal/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..694bfcf7491d36cbe645f753af10c4a94a8687e9
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/Kconfig
@@ -0,0 +1,3 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Focal/FT8006/Kconfig"
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Focal/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..c7b3b5b9981ace72d26ef17edf960a7e9a144d31
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/Makefile
@@ -0,0 +1,10 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_FOCAL) += focal_common.o
+obj-$(CONFIG_TOUCHPANEL_FOCAL_FT8006) += FT8006/
+
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..200d85cb5a910b07486f1b3779620c05be544f77
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.c
@@ -0,0 +1,581 @@
+/***************************************************
+ * File:synaptics_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             focal common driver
+ * Version:1.0:
+ * Date created:2017/06/18
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "../touchpanel_common.h"
+#include "focal_common.h"
+
+/*******LOG TAG Declear*****************************/
+
+#define TPD_DEVICE "focal_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (tp_debug)\
+        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+
+/************ Start of other functions work for device attribute file*************************/
+
+
+static int is_hex_char(const char ch)
+{
+    if ((ch >= '0' && ch <= '9') || (ch >= 'a' && ch <= 'f') || (ch >= 'A' && ch <= 'F')) {
+        return 1;
+    }
+
+    return 0;
+}
+
+static int hex_char_to_int(const char ch)
+{
+    int result = 0;
+    if (ch >= '0' && ch <= '9') {
+        result = (int)(ch - '0');
+    } else if (ch >= 'a' && ch <= 'f') {
+        result = (int)(ch - 'a') + 10;
+    } else if (ch >= 'A' && ch <= 'F') {
+        result = (int)(ch - 'A') + 10;
+    } else {
+        result = -1;
+    }
+
+    return result;
+}
+
+static int hex_to_str(char *hex, int iHexLen, char *ch, int *iChLen)
+{
+    int high=0;
+    int low=0;
+    int tmp = 0;
+    int i = 0;
+    int iCharLen = 0;
+    if (hex == NULL || ch == NULL) {
+        return -1;
+    }
+
+    TPD_INFO("iHexLen: %d in function:%s!!\n", iHexLen, __func__);
+
+    if (iHexLen %2 == 1) {
+        return -2;
+    }
+
+    for (i=0; i<iHexLen; i+=2) {
+        high = hex_char_to_int(hex[i]);
+        if (high < 0) {
+            ch[iCharLen] = '\0';
+            return -3;
+        }
+
+        low = hex_char_to_int(hex[i+1]);
+        if (low < 0) {
+            ch[iCharLen] = '\0';
+            return -3;
+        }
+        tmp = (high << 4) + low;
+        ch[iCharLen++] = (char)tmp;
+    }
+    ch[iCharLen] = '\0';
+    *iChLen = iCharLen;
+    TPD_INFO("iCharLen: %d, iChLen: %d in function:%s!!\n", iCharLen, *iChLen, __func__);
+    return 0;
+}
+
+static void str_to_bytes(char * bufStr, int iLen, char* uBytes, int *iBytesLen)
+{
+    int i=0;
+    int iNumChLen=0;
+    *iBytesLen=0;
+
+    for (i=0; i<iLen; i++) {
+        //filter illegal chars
+        if (is_hex_char(bufStr[i])) {
+            bufStr[iNumChLen++] = bufStr[i];
+        }
+    }
+
+    bufStr[iNumChLen] = '\0';
+    hex_to_str(bufStr, iNumChLen, uBytes, iBytesLen);
+}
+/***************** End of other functions work for device attribute file*********************/
+
+
+static struct
+{
+    int op;         // 0: read, 1: write
+    int reg;        // register
+    int value;      // read: return value, write: op return
+    int result;     // 0: success, otherwise: fail
+} g_rwreg_result;
+/************************** Start of device attribute file***********************************/
+static ssize_t focal_hw_reset_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    ssize_t count = 0;
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (focal_debug_ops && focal_debug_ops->reset) {
+        mutex_lock(&ts->mutex);
+        focal_debug_ops->reset(ts->chip_data, 200);
+        mutex_unlock(&ts->mutex);
+    }
+
+    count = snprintf(buf, PAGE_SIZE, "hw reset executed\n");
+    return count;
+}
+
+static ssize_t focal_irq_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    if ((strcmp(buf, "1")  == 0) || (strcmp(buf, "on") == 0)) {
+        if (ts) {
+            enable_irq(ts->irq);
+        }
+        TPD_INFO("[EX-FUN]enable irq\n");
+    } else if ((strcmp(buf, "0")  == 0) || (strcmp(buf, "off") == 0)) {
+        if (ts) {
+            disable_irq_nosync(ts->irq);
+        }
+        TPD_INFO("[EX-FUN]disable irq\n");
+    }
+    return count;
+}
+
+static ssize_t focal_fw_version_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    ssize_t num_read_chars = 0;
+    u8 fw_version = 0;
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, false);
+        }
+    }
+
+    if (focal_debug_ops && focal_debug_ops->get_fw_version) {
+        mutex_lock(&ts->mutex);
+        fw_version = focal_debug_ops->get_fw_version(ts->chip_data);
+        mutex_unlock(&ts->mutex);
+        if (fw_version < 0) {
+            num_read_chars = snprintf(buf, PAGE_SIZE,"I2c transfer error!\n");
+        }
+
+        if (fw_version == 255) {
+            num_read_chars = snprintf(buf, PAGE_SIZE,"get tp fw version fail!\n");
+        } else {
+            num_read_chars = snprintf(buf, PAGE_SIZE, "%02X\n", fw_version);
+        }
+    }
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, true);
+        }
+    }
+
+    return num_read_chars;
+}
+
+
+static ssize_t focal_rw_reg_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    int count;
+
+    if (!g_rwreg_result.op) {
+        if (g_rwreg_result.result == 0) {
+            count = sprintf(buf, "Read %02X: %02X\n", g_rwreg_result.reg, g_rwreg_result.value);
+        } else {
+            count = sprintf(buf, "Read %02X failed, ret: %d\n",g_rwreg_result.reg,  g_rwreg_result.result);
+        }
+    } else {
+        if (g_rwreg_result.result == 0) {
+            count = sprintf(buf, "Write %02X, %02X success\n",g_rwreg_result.reg,  g_rwreg_result.value);
+        } else {
+            count = sprintf(buf, "Write %02X failed, ret: %d\n",g_rwreg_result.reg,  g_rwreg_result.result);
+        }
+    }
+
+    return count;
+}
+
+static ssize_t focal_rw_reg_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+    ssize_t num_read_chars = 0;
+    int retval;
+    long unsigned int wmreg = 0;
+    u8 regaddr = 0xff, regvalue = 0xff;
+    u8 valbuf[5] = {0};
+
+    memset(valbuf, 0, sizeof(valbuf));
+    num_read_chars = count - 1;
+    if ((num_read_chars != 2) && (num_read_chars != 4)) {
+        TPD_INFO("please input 2 or 4 character\n");
+        goto error_return;
+    }
+
+    memcpy(valbuf, buf, num_read_chars);
+    retval = kstrtoul(valbuf, 16, &wmreg);
+    str_to_bytes((char*)buf, num_read_chars, valbuf, &retval);
+
+    if (1 == retval) {
+        regaddr = valbuf[0];
+        retval = 0;
+    } else if (2 == retval) {
+        regaddr = valbuf[0];
+        regvalue = valbuf[1];
+        retval = 0;
+    } else {
+        retval =-1;
+    }
+
+    if (0 != retval) {
+        TPD_INFO("%s() - ERROR: Could not convert the given input to a number. The given input was: %s\n", __func__, buf);
+        goto error_return;
+    }
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, false);
+        }
+    }
+
+    mutex_lock(&ts->mutex);
+
+    if (2 == num_read_chars) {
+        g_rwreg_result.op = 0;
+        g_rwreg_result.reg = regaddr;
+        /*read register*/
+        regaddr = wmreg;
+        regvalue = touch_i2c_read_byte(ts->client, regaddr);
+        if (regvalue < 0)  {
+            TPD_INFO("Could not read the register(0x%02x)\n", regaddr);
+            g_rwreg_result.result = -1;
+        } else {
+            TPD_INFO("the register(0x%02x) is 0x%02x\n", regaddr, regvalue);
+            g_rwreg_result.value = regvalue;
+            g_rwreg_result.result = 0;
+        }
+    } else {
+        regaddr = wmreg>>8;
+        regvalue = wmreg;
+
+        g_rwreg_result.op = 1;
+        g_rwreg_result.reg = regaddr;
+        g_rwreg_result.value = regvalue;
+        g_rwreg_result.result = touch_i2c_write_byte(ts->client, regaddr, regvalue);
+        if (g_rwreg_result.result < 0) {
+            TPD_INFO("Could not write the register(0x%02x)\n", regaddr);
+
+        } else {
+            TPD_INFO("Write 0x%02x into register(0x%02x) successful\n", regvalue, regaddr);
+            g_rwreg_result.result = 0;
+        }
+    }
+
+    mutex_unlock(&ts->mutex);
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, true);
+        }
+    }
+error_return:
+
+    return count;
+}
+
+static ssize_t focal_esdcheck_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    if (ts->esd_handle_support) {
+        if ((strcmp(buf, "1")  == 0) || (strcmp(buf, "on") == 0)) {
+            esd_handle_switch(&ts->esd_info, true);
+        } else if ((strcmp(buf, "0")  == 0) || (strcmp(buf, "off") == 0)) {
+            esd_handle_switch(&ts->esd_info, false);
+        }
+    }
+
+    return count;
+}
+
+static ssize_t focal_esdcheck_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    int count = 0;
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->get_esd_check_flag) {
+            count = sprintf(buf, "esd_running_flag: %d,  esd_check_need_stop: %d\n", \
+                            ts->esd_info.esd_running_flag, focal_debug_ops->get_esd_check_flag(ts->chip_data));
+        } else {
+            count = sprintf(buf, "esd_running_flag: %d\n", ts->esd_info.esd_running_flag);
+        }
+    } else {
+        count = sprintf(buf, "not support esd handle\n");
+    }
+
+    return count;
+}
+
+static ssize_t focal_dump_reg_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    char tmp[256];
+    int count = 0;
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, false);
+        }
+    }
+
+    mutex_lock(&ts->mutex);
+    if (focal_debug_ops && focal_debug_ops->dump_reg_sate) {
+        count = focal_debug_ops->dump_reg_sate(ts->chip_data, tmp);
+    }
+    mutex_unlock(&ts->mutex);
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, true);
+        }
+    }
+    memcpy(buf, tmp, count);
+
+    return count;
+}
+
+static DEVICE_ATTR(fts_fw_version, S_IRUGO|S_IWUSR, focal_fw_version_show, NULL);
+/* read and write register
+*   read example: echo 88 > rw_reg ---read register 0x88
+*   write example:echo 8807 > rw_reg ---write 0x07 into register 0x88
+*   note:the number of input must be 2 or 4.if it not enough,please fill in the 0.*/
+static DEVICE_ATTR(fts_rw_reg, S_IRUGO|S_IWUSR, focal_rw_reg_show, focal_rw_reg_store);
+static DEVICE_ATTR(fts_dump_reg, S_IRUGO|S_IWUSR, focal_dump_reg_show, NULL);
+static DEVICE_ATTR(fts_hw_reset, S_IRUGO|S_IWUSR, focal_hw_reset_show, NULL);
+static DEVICE_ATTR(fts_irq, S_IRUGO|S_IWUSR, NULL, focal_irq_store);
+static DEVICE_ATTR(fts_esd_check, S_IRUGO|S_IWUSR, focal_esdcheck_show, focal_esdcheck_store);
+
+static struct attribute *focal_attributes[] =
+{
+    &dev_attr_fts_fw_version.attr,
+    &dev_attr_fts_rw_reg.attr,
+    &dev_attr_fts_dump_reg.attr,
+    &dev_attr_fts_hw_reset.attr,
+    &dev_attr_fts_irq.attr,
+    &dev_attr_fts_esd_check.attr,
+    NULL
+};
+
+static struct attribute_group focal_attribute_group =
+{
+    .attrs = focal_attributes
+};
+
+int focal_create_sysfs(struct i2c_client * client)
+{
+    int err = -1;
+    err = sysfs_create_group(&client->dev.kobj, &focal_attribute_group);
+    if (0 != err) {
+        TPD_INFO("[EX]: sysfs_create_group() failed!\n");
+        sysfs_remove_group(&client->dev.kobj, &focal_attribute_group);
+        return -EIO;
+    } else {
+        TPD_INFO("[EX]: sysfs_create_group() succeeded!\n");
+    }
+    return err;
+}
+/******************************* End of device attribute file******************************************/
+
+/********************Start of apk debug file and it's operation callbacks******************************/
+unsigned char proc_operate_mode = 0;
+
+static ssize_t focal_debug_write(struct file *filp, const char __user *buff, size_t count, loff_t *ppos)
+{
+    unsigned char writebuf[WRITE_BUF_SIZE];
+    int buflen = count;
+    int writelen = 0;
+    int ret = 0;
+    char tmp[25];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(filp));
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (copy_from_user(&writebuf, buff, buflen)) {
+        TPD_INFO("[APK]: copy from user error!\n");
+        return -EFAULT;
+    }
+
+    mutex_lock(&ts->mutex);
+
+    proc_operate_mode = writebuf[0];
+    switch (proc_operate_mode)
+    {
+        case PROC_SET_TEST_FLAG:
+            TPD_INFO("[APK]: PROC_SET_TEST_FLAG = %x!\n", writebuf[1]);
+            if (ts->esd_handle_support && !ts->is_suspended) {
+                if (writebuf[1] == 1) {
+                    esd_handle_switch(&ts->esd_info, false);
+                } else {
+                    esd_handle_switch(&ts->esd_info, true);
+                }
+            }
+            break;
+        case PROC_READ_REGISTER:
+            writelen = 1;
+            ret = touch_i2c_write(ts->client, writebuf + 1, writelen);
+            if (ret < 0) {
+                TPD_INFO("[APK]: write iic error!\n");
+            }
+            break;
+        case PROC_WRITE_REGISTER:
+            writelen = 2;
+            ret = touch_i2c_write(ts->client, writebuf + 1, writelen);
+            if (ret < 0) {
+                TPD_INFO("[APK]: write iic error!\n");
+            }
+            break;
+        case PROC_HW_RESET:
+            sprintf(tmp, "%s", writebuf + 1);
+            tmp[buflen - 1] = '\0';
+            if (strncmp(tmp,"focal_driver",12) == 0) {
+                TPD_INFO("Begin HW Reset\n");
+                if (focal_debug_ops && focal_debug_ops->reset) {
+                    focal_debug_ops->reset(ts->chip_data, 1);
+                }
+            }
+            break;
+        case PROC_READ_DATA:
+        case PROC_WRITE_DATA:
+            writelen = count - 1;
+            if (writelen>0)
+            {
+                ret = touch_i2c_write(ts->client, writebuf + 1, writelen);
+                if (ret < 0) {
+                    TPD_INFO("[APK]: write iic error!\n");
+                }
+            }
+            break;
+        default:
+            break;
+    }
+
+    mutex_unlock(&ts->mutex);
+
+    if (ret < 0) {
+        return ret;
+    } else {
+        return count;
+    }
+}
+
+static ssize_t focal_debug_read(struct file *filp, char __user *buff, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    int num_read_chars = 0;
+    int readlen = 0;
+    unsigned char buf[READ_BUF_SIZE];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(filp));
+    struct focal_debug_func *focal_debug_ops = (struct focal_debug_func *)ts->private_data;
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, false);
+        }
+    }
+
+    mutex_lock(&ts->mutex);
+
+    switch (proc_operate_mode)
+    {
+        case PROC_READ_REGISTER:
+            readlen = 1;
+            ret = touch_i2c_read(ts->client, NULL, 0, buf, readlen);
+            if (ret < 0) {
+                if (ts->esd_handle_support) {
+                    if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+                        focal_debug_ops->esd_check_enable(ts->chip_data, true);
+                    }
+                }
+                TPD_INFO("[APK]: read i2c error!\n");
+                mutex_unlock(&ts->mutex);
+                return ret;
+            }
+            num_read_chars = 1;
+            break;
+        case PROC_READ_DATA:
+            readlen = count;
+            ret = touch_i2c_read(ts->client, NULL, 0, buf, readlen);
+            if (ret < 0) {
+                if (ts->esd_handle_support) {
+                    if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+                        focal_debug_ops->esd_check_enable(ts->chip_data, true);
+                    }
+                }
+                TPD_INFO("[APK]: read iic error!\n");
+                mutex_unlock(&ts->mutex);
+                return ret;
+            }
+
+            num_read_chars = readlen;
+            break;
+        case PROC_WRITE_DATA:
+            break;
+        default:
+            break;
+    }
+
+    mutex_unlock(&ts->mutex);
+
+    if (ts->esd_handle_support) {
+        if (focal_debug_ops && focal_debug_ops->esd_check_enable) {
+            focal_debug_ops->esd_check_enable(ts->chip_data, true);
+        }
+    }
+
+    if (copy_to_user(buff, buf, num_read_chars))
+    {
+        TPD_INFO("[APK]: copy to user error!\n");
+        return -EFAULT;
+    }
+
+    return num_read_chars;
+}
+static const struct file_operations focal_proc_fops =
+{
+    .owner  = THIS_MODULE,
+    .open  = simple_open,
+    .read   = focal_debug_read,
+    .write  = focal_debug_write,
+};
+
+int focal_create_apk_debug_channel(struct touchpanel_data *ts)
+{
+    struct proc_dir_entry *focal_proc_entry = NULL;
+    focal_proc_entry = proc_create_data("ftxxxx-debug", 0777, NULL, &focal_proc_fops, ts);
+    if (NULL == focal_proc_entry) {
+        TPD_INFO("%s: Couldn't create proc entry!\n", __func__);
+        return -ENOMEM;
+    }
+
+    return 0;
+}
+/**********************End of apk debug file and it's operation callbacks******************************/
\ No newline at end of file
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..aefe0c395caf4e2a5a365baec05e4cec3e060a68
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Focal/focal_common.h
@@ -0,0 +1,58 @@
+/***************************************************
+ * File:synaptics_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             focal common driver
+ * Version:1.0:
+ * Date created:2017/06/18
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef FOCAL_H
+#define FOCAL_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+
+/*********PART2:Define Area**********************/
+/*create apk debug channel*/
+#define PROC_UPGRADE                            0
+#define PROC_READ_REGISTER                      1
+#define PROC_WRITE_REGISTER                     2
+#define PROC_AUTOCLB                            4
+#define PROC_UPGRADE_INFO                       5
+#define PROC_WRITE_DATA                         6
+#define PROC_READ_DATA                          7
+#define PROC_SET_TEST_FLAG                      8
+#define PROC_SET_SLAVE_ADDR                     10
+#define PROC_HW_RESET                           11
+
+#define WRITE_BUF_SIZE                          512
+#define READ_BUF_SIZE                           512
+#define FILE_NAME_LENGTH                        128
+
+/*********PART3:Struct Area**********************/
+struct focal_debug_func
+{
+    void (*esd_check_enable)(void *chip_data, bool enable);
+    bool (*get_esd_check_flag)(void *chip_data);
+    void (*reset)(void *chip_data, int msecond);
+    int (*get_fw_version)(void *chip_data);
+    int (*dump_reg_sate)(void *chip_data, char *buf);
+};
+
+/*********PART4:function declare*****************/
+int focal_create_sysfs(struct i2c_client * client);
+int focal_create_apk_debug_channel(struct touchpanel_data *ts);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..75aa4e364b18aea7e0ca67df7c293764df595cb3
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Kconfig
@@ -0,0 +1,9 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for focal gt9286 ic driver
+
+config TOUCHPANEL_GOODIX_GT9286
+#   default y
+    bool "TP goodix gt9286 IC enable or not for OPPO"
+    ---help---
+    say Y to enable driver for Touchpanel useing goodix gt9286
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..22f0a7ec9fe75189e7f4d043cef14886fc6b3aa5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Makefile
@@ -0,0 +1,3 @@
+#gt9286 touchpanel driver
+
+obj-$(CONFIG_TOUCHPANEL_GOODIX_GT9286)  += goodix_drivers_gt9286.o
\ No newline at end of file
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.c b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.c
new file mode 100644
index 0000000000000000000000000000000000000000..d1368b8992fec92ce946814cd0640395bb26d1aa
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.c
@@ -0,0 +1,2583 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : goodix_drivers_gt9286.c
+ * Description: Source file for Goodix GT9286 driver
+ * Version   : 1.0
+ * Date        : 2017-08-01
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/regulator/consumer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/jiffies.h>
+
+#include "goodix_drivers_gt9286.h"
+
+struct chip_data_gt9286 *g_chip_info = NULL;
+unsigned long timeout = 0;
+extern int tp_register_times;
+
+#define TPD_DEVICE "Goodix-gt9286"
+#define TPD_INFO(fmt, arg...)        pr_err("[TP]"TPD_DEVICE ": " fmt, ##arg)
+#define TPD_DEBUG(fmt, arg...)       do{\
+    if (tp_debug)\
+    pr_err("[TP]"TPD_DEVICE ": " fmt, ##arg);\
+}while(0)
+
+
+//function delcare
+static int goodix_reset(void *chip_data);
+
+/********** Start of special i2c tranfer interface used for goodix read/write*****************/
+
+/*
+ *goodix_i2c_read_dbl_check----used to double read and check the reading data
+ *@client : Handle to slave device
+ *@addr   : address of register where to start read
+ *@buffer : buf used to store data read from register
+ *@len    : data length we want to read
+ return  0: success, non-0: failed
+*/
+static int goodix_i2c_read_dbl_check(struct i2c_client *client, u16 addr, u8 * buffer, s32 len)
+{
+    u8 buf[16] = {0};
+    u8 confirm_buf[16] = {0};
+    int ret = -1;
+
+    if (len > 16) {
+        TPD_INFO("i2c_read_dbl_check length %d is too long, exceed %zu\n", len, sizeof(buf));
+        return ret;
+    }
+
+    memset(buf, 0xAA, sizeof(buf));
+    ret = touch_i2c_read_block(client, addr, len, buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    msleep(5);
+    memset(confirm_buf, 0, sizeof(confirm_buf));
+    ret = touch_i2c_read_block(client, addr, len, confirm_buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    if (!memcmp(buf, confirm_buf, len)) {
+        memcpy(buffer, confirm_buf, len);
+        return 0;
+    }
+
+    TPD_INFO("i2c read 0x%04X, %d bytes, double check failed!\n", addr, len);
+
+    return 1;
+}
+
+/*
+ *goodix_i2c_write_with_readback----used to write and check the readback data
+ *@client : Handle to slave device
+ *@addr   : address of register where to start write
+ *@buffer : buf we want to send
+ *@len    : data length we want to send
+ return  0: success, non-0: failed
+*/
+static int goodix_i2c_write_with_readback(struct i2c_client *client, u16 addr, u8 * buffer, int length)
+{
+    u8 buf[100];
+
+    int ret = touch_i2c_write_block(client, addr, length, buffer);
+    if (ret < 0) {
+        return ret;
+    }
+
+    ret = touch_i2c_read_block(client, addr, length, buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    if (memcmp(buf, buffer, length)) {
+        return -1;
+    }
+
+    return 0;
+}
+
+/*
+ *goodix_recall_check----used to check register data with source data
+ *@client : Handle to slave device
+ *@chk_src: source data to be checked
+ *@addr   : start adress of reading
+ *@chk_len: total check length
+ return  0: success, non-0: failed
+*/
+static int goodix_recall_check(struct i2c_client* client, u8 *chk_src, u16 addr, u16 chk_len)
+{
+    u8 rd_buf[PACK_SIZE];
+    s32 ret = 0;
+    u16 len = 0;
+    u32 compared_len = 0;
+
+    while (chk_len > 0) {
+        len = (chk_len > PACK_SIZE ? PACK_SIZE : chk_len);
+
+        ret = touch_i2c_read_block(client, addr + compared_len, len, rd_buf);
+        if (ret < 0) {
+            TPD_INFO("recall i2c error, exit!\n");
+            return ret;
+        }
+
+        if (memcmp(rd_buf, &chk_src[compared_len], len)) {
+            TPD_INFO("Recall frame not equal(addr: 0x%04X)\n", addr + compared_len);
+            return -1;
+        }
+
+        chk_len -= len;
+        compared_len += len;
+    }
+
+    TPD_DEBUG("Recall check %d bytes(address: 0x%04X) success.\n", compared_len, addr);
+
+    return 0;
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int goodix_get_usb_state(void)
+{
+    int ret = 0;
+    ret = upmu_get_rgs_chrdet();
+    TPD_INFO("%s get usb status %d\n", __func__, ret);
+    return ret;
+}
+#else
+#endif
+
+/*
+ * goodix_send_cmd----send cmd to Goodix ic to control it's function
+ * @client: Handle to slave device
+ * @cmd: value for cmd reg(0x8040)
+ * @data:value for data reg(0x8041)
+ * Return  0: succeed, non-0: failed.
+ */
+static s32 goodix_send_cmd(void *chip_data, u8 cmd, u8 data)
+{
+    s32 ret;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    u8 buffer[3] = { cmd, data, 0 };
+    static DEFINE_MUTEX(cmd_mutex);
+
+    /* cmd format:
+     * reg:0x8040  cmd control(diffrent cmd indicates diffrent setting for touch IC )
+     * reg:0x8041  data reg(Correspond with 0x8040)
+     * reg:0x8042  checksum (sum(0x8040~0x8042) == 0) */
+    mutex_lock(&cmd_mutex);
+    buffer[2] = (u8) ((0 - cmd - data) & 0xFF);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.GTP_REG_CMD + 1, 2, &buffer[1]);
+    ret |= touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_CMD, buffer[0]);
+    if (ret < 0) {
+        TPD_INFO("send cmd failed, ret: %d\n", ret);
+    } else {
+        ret = 0;
+    }
+    msleep(50);
+    mutex_unlock(&cmd_mutex);
+
+    return ret;
+}
+/*********** End of special i2c tranfer interface used for goodix read/write******************/
+
+
+/********* Start of function that work for oppo_touchpanel_operations callbacks***************/
+static int goodix_clear_irq(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    if (!gt1x_rawdiff_mode) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 0);
+        if (ret < 0) {
+            TPD_INFO("I2C write end_cmd  error!\n");
+        }
+    }
+
+    return ret;
+}
+
+static void getSpecialCornerPoint(uint8_t *buf, int n, struct Coordinate *point)
+{
+    int x, y, i;
+
+    point[0].x = (buf[0] & 0xFF) | (buf[1] & 0x0F) << 8;
+    point[0].y = (buf[2] & 0xFF) | (buf[3] & 0x0F) << 8;
+    point[1] = point[0];
+    point[2] = point[0];
+    point[3] = point[0];
+    for (i = 0; i < n; i++) {
+        x = (buf[0 + 4*i] & 0xFF) | (buf[1 + 4*i] & 0x0F) << 8;
+        y = (buf[2 + 4*i] & 0xFF) | (buf[3 + 4*i] & 0x0F) << 8;
+        if (point[3].x < x) {   //xmax
+            point[3].x = x;
+            point[3].y = y;
+        }
+        if (point[1].x > x) {   //xmin
+            point[1].x = x;
+            point[1].y = y;
+        }
+        if (point[2].y < y) {   //ymax
+            point[2].y = y;
+            point[2].x = x;
+        }
+        if (point[0].y > y) {   //ymin
+            point[0].y = y;
+            point[0].x = x;
+        }
+    }
+}
+
+static int clockWise(uint8_t *buf, int n)
+{
+    int i, j, k;
+    int count = 0;
+    struct Coordinate p[3];
+    long int z;
+
+    if (n < 3)
+        return 1;
+    for (i = 0; i < n; i++) {
+        j = (i + 1) % n;
+        k = (i + 2) % n;
+        p[0].x = (buf[0 + 4*i] & 0xFF) | (buf[1 + 4*i] & 0x0F) << 8;
+        p[0].y = (buf[2 + 4*i] & 0xFF) | (buf[3 + 4*i] & 0x0F) << 8;
+        p[1].x = (buf[0 + 4*j] & 0xFF) | (buf[1 + 4*j] & 0x0F) << 8;
+        p[1].y = (buf[2 + 4*j] & 0xFF) | (buf[3 + 4*j] & 0x0F) << 8;
+        p[2].x = (buf[0 + 4*k] & 0xFF) | (buf[1 + 4*k] & 0x0F) << 8;
+        p[2].y = (buf[2 + 4*k] & 0xFF) | (buf[3 + 4*k] & 0x0F) << 8;
+        if ((p[0].x == p[1].x) && (p[1].x == p[1].y))
+            continue;
+        z = (p[1].x - p[0].x) * (p[2].y - p[1].y);
+        z -= (p[1].y - p[0].y) * (p[2].x - p[1].x);
+        if (z < 0)
+            count--;
+        else if (z > 0)
+            count++;
+    }
+
+    TPD_INFO("ClockWise count = %d\n", count);
+
+    if (count > 0)
+        return 1;
+    else
+        return 0;
+}
+
+static void goodix_esd_check_enable(struct chip_data_gt9286 *chip_info, bool enable)
+{
+    TPD_INFO("%s %s\n", __func__, enable ? "enable" : "disable");
+    /* enable/disable esd check flag */
+    chip_info->esd_check_enabled = enable;
+    /* update interrupt timer */
+    chip_info->irq_timer = jiffies;
+    /* clear esd_retry counter, if protect function is enabled */
+    chip_info->esd_retry = enable ? 0 : chip_info->esd_retry;
+}
+
+static int goodix_enter_sleep(struct chip_data_gt9286 *chip_info, bool config)
+{
+    s32 retry = 0;
+
+    if (config) {
+        while (retry++ < 3) {
+            if (!goodix_send_cmd(chip_info, GTP_CMD_SLEEP, 0)) {
+                chip_info->halt_status = true;
+                TPD_INFO("enter sleep mode!\n");
+                return 0;
+            }
+            msleep(10);
+        }
+    }
+
+    if (retry >= 3) {
+        TPD_INFO("Enter sleep mode failed.\n");
+    }
+
+    return -1;
+}
+
+static int goodix_enter_doze(struct chip_data_gt9286 *chip_info)
+{
+    int retry = 0;
+
+    while (retry++ < 5) {
+        if (!goodix_send_cmd(chip_info, GTP_CMD_GESTURE, 0)) {
+            chip_info->halt_status = true;
+            TPD_INFO("enter doze mode!\n");
+            return 0;
+        }
+        msleep(10);
+    }
+
+    TPD_INFO("enter doze mode failed.\n");
+    return -1;
+}
+
+static int goodix_enable_edge_limit(struct chip_data_gt9286 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    TPD_INFO("%s, edge limit enable = %d\n", __func__, enable);
+
+    if (enable) {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_ENABLE_EDGE, 0);
+    } else {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_DISABLE_EDGE, 0);
+    }
+
+    return ret;
+}
+
+static int goodix_enable_charge_mode(struct chip_data_gt9286 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    TPD_INFO("%s, charge mode enable = %d\n", __func__, enable);
+
+    if (enable) {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_CHARGER_ON, 0);
+    } else {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_CHARGER_OFF, 0);
+    }
+
+    return ret;
+}
+
+static int goodix_set_reset_status(struct chip_data_gt9286 *chip_info)
+{
+    /* 0x8040 ~ 0x8043 */
+    u8 value[] = {0xAA, 0x00, 0x56, 0xAA};
+    int ret;
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.GTP_REG_CMD + 1, 3, &value[1]);
+    if (ret < 0) {
+        TPD_INFO("%s: TP set_reset_status failed\n", __func__);
+        return ret;
+    }
+
+    return touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_CMD, value[0]);
+}
+
+static s32 goodix_read_version(struct chip_data_gt9286 *chip_info, struct panel_info *panel_data)
+{
+    s32 ret = -1;
+    u8 buf[12] = {0};
+    u32 mask_id = 0;
+    u32 patch_id = 0;
+    u8 product_id[5] = {0};
+    u8 sensor_id = 0;
+    u8 match_opt = 0;
+    int i, retry = 3;
+    u8 checksum = 0;
+    struct goodix_version_info * ver_info = &chip_info->ver_info;
+
+    while (retry--) {
+        ret = goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_PRODUCT_VER, buf, sizeof(buf));
+        if (!ret) {
+            checksum = 0;
+
+            for (i = 0; i < sizeof(buf); i++) {
+                checksum += buf[i];
+            }
+
+            if (checksum == 0 &&    /* first 3 bytes must be number or char */
+                    IS_NUM_OR_CHAR(buf[0]) && IS_NUM_OR_CHAR(buf[1]) && IS_NUM_OR_CHAR(buf[2]) && buf[10] != 0xFF) {    /*sensor id == 0xFF, retry */
+                break;
+            } else {
+                TPD_INFO("product version data is error\n");
+            }
+        } else {
+            TPD_INFO("Read product version from 0x8140 failed\n");
+        }
+
+        TPD_DEBUG("Read product version retry = %d\n", retry);
+        msleep(100);
+    }
+
+    if (retry <= 0) {
+        if (ver_info)
+            ver_info->sensor_id = 0;
+        TPD_INFO("Maybe the firmware of ic is error\n");
+        //return -1;
+    }
+
+    mask_id = (u32) ((buf[7] << 16) | (buf[8] << 8) | buf[9]);
+    patch_id = (u32) ((buf[4] << 16) | (buf[5] << 8) | buf[6]);
+    memcpy(product_id, buf, 4);
+    sensor_id = buf[10] & 0x0F;
+    match_opt = (buf[10] >> 4) & 0x0F;
+
+    TPD_INFO("goodix fw VERSION:GT%s(Product)_%06X(Patch)_%04X(Mask)_%02X(SensorID)\n", product_id, patch_id, mask_id >> 8, sensor_id);
+
+    if (panel_data->manufacture_info.version) {
+        snprintf(&(panel_data->manufacture_info.version[8]), MAX_DEVICE_VERSION_LENGTH - 6, "%6x", patch_id);//MAX_DEVICE_VERSION_LENGTH = 16
+    }
+    TPD_INFO("%s\n", panel_data->manufacture_info.version);
+
+    if (ver_info != NULL) {
+        ver_info->mask_id = mask_id;
+        ver_info->patch_id = patch_id;
+        memcpy(ver_info->product_id, product_id, 5);
+        ver_info->sensor_id = sensor_id;
+        ver_info->match_opt = match_opt;
+    }
+
+    return 0;
+}
+
+static s32 goodix_send_config(struct chip_data_gt9286 *chip_info, u8 * config, int cfg_len)
+{
+    int i;
+    s32 ret = 0;
+    s32 retry = 0;
+    u16 checksum = 0;
+
+    for (i = 0; i < cfg_len - 3; i += 2) {
+        checksum += (config[i] << 8) + config[i + 1];
+    }
+    if (!checksum) {
+        TPD_INFO("invalid config, all of the bytes is zero!\n");
+        return -1;
+    }
+
+    checksum = 0 - checksum;
+    TPD_DEBUG("Config checksum: 0x%04X\n", checksum);
+    config[cfg_len - 3] = (checksum >> 8) & 0xFF;
+    config[cfg_len - 2] = checksum & 0xFF;
+    config[cfg_len - 1] = 0x01;
+
+    while (retry++ < 5) {
+        ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.GTP_REG_CONFIG_DATA, cfg_len, config);
+        if (ret == cfg_len) {
+            msleep(200);    /* at least 200ms, wait for storing config into flash. */
+            TPD_INFO("%s: Send config successfully!\n", __func__);
+            return 0;
+        }
+    }
+
+    TPD_INFO("Send config failed!\n");
+
+    return ret;
+}
+
+static int goodix_init_panel(struct chip_data_gt9286 *chip_info)
+{
+    s32 ret = 0;
+
+    chip_info->config_info.goodix_config = GTP_CFG_GROUP_SAMSUNG;
+    chip_info->config_info.goodix_config_len = sizeof(GTP_CFG_GROUP_SAMSUNG);
+
+    TPD_DEBUG("config sizeof(chip_info->goodix_config) is %d\n", chip_info->config_info.goodix_config_len);
+
+    if (chip_info->config_info.goodix_config_len < GTP_CONFIG_MIN_LENGTH || chip_info->config_info.goodix_config_len > GTP_CONFIG_MAX_LENGTH) {
+        TPD_INFO("Config is INVALID! You need to check you header file CFG_GROUP section!\n");
+        return -1;
+    }
+
+    /* clear the flag, avoid failure when send the_config of driver. */
+    //chip_info->config_info.goodix_config[0] &= 0x7F;
+
+    /* match resolution when gt1x_abs_x_max & gt1x_abs_y_max have been set already */
+    if ((chip_info->config_info.goodix_abs_x_max == 0) && (chip_info->config_info.goodix_abs_y_max == 0)) {
+        chip_info->config_info.goodix_abs_x_max = (chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 1] << 8) + chip_info->config_info.goodix_config[RESOLUTION_LOCATION];
+        chip_info->config_info.goodix_abs_y_max = (chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 3] << 8) + chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 2];
+        chip_info->config_info.goodix_int_type = (chip_info->config_info.goodix_config[TRIGGER_LOCATION]) & 0x03;
+        chip_info->config_info.goodix_wakeup_level = !(chip_info->config_info.goodix_config[MODULE_SWITCH3_LOCATION] & 0x20);
+    } else {
+        chip_info->config_info.goodix_config[RESOLUTION_LOCATION] = (u8) chip_info->config_info.goodix_abs_x_max;
+        chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 1] = (u8) (chip_info->config_info.goodix_abs_x_max >> 8);
+        chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 2] = (u8) chip_info->config_info.goodix_abs_y_max;
+        chip_info->config_info.goodix_config[RESOLUTION_LOCATION + 3] = (u8) (chip_info->config_info.goodix_abs_y_max >> 8);
+        set_reg_bit(chip_info->config_info.goodix_config[MODULE_SWITCH3_LOCATION], 5, !chip_info->config_info.goodix_wakeup_level);
+        chip_info->config_info.goodix_config[TRIGGER_LOCATION] = (chip_info->config_info.goodix_config[TRIGGER_LOCATION] & 0xFC) | chip_info->config_info.goodix_int_type;
+    }
+
+    TPD_INFO("X_MAX = %d, Y_MAX = %d, TRIGGER = 0x%02x, WAKEUP_LEVEL = %d\n",
+            chip_info->config_info.goodix_abs_x_max, chip_info->config_info.goodix_abs_y_max,
+            chip_info->config_info.goodix_int_type, chip_info->config_info.goodix_wakeup_level);
+
+    ret = goodix_send_config(chip_info, chip_info->config_info.goodix_config, chip_info->config_info.goodix_config_len);
+
+    return ret;
+}
+
+static s32 goodix_request_event_handler(struct chip_data_gt9286 *chip_info)
+{
+    s32 ret = -1;
+    u8 rqst_data = 0;
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_RQST, 1, &rqst_data);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c transfer error.\n", __func__);
+        return -1;
+    }
+
+    TPD_INFO("%s: request state:0x%02x.\n", __func__, rqst_data);
+
+    switch (rqst_data & 0x0F) {
+        case GTP_RQST_CONFIG:
+            TPD_INFO("Request Config.\n");
+            ret = goodix_send_config(chip_info, chip_info->config_info.goodix_config, chip_info->config_info.goodix_config_len);
+            if (ret) {
+                TPD_INFO("Send goodix_config error.\n");
+            } else {
+                TPD_INFO("Send goodix_config success.\n");
+                rqst_data = GTP_RQST_RESPONDED;
+                ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.GTP_REG_RQST, 1, &rqst_data);
+            }
+            break;
+
+        case GTP_RQST_RESET:
+            TPD_INFO("%s: Request Reset.\n", __func__);
+            goodix_reset(chip_info);
+            //  gt1x_reset_guitar();
+            rqst_data = GTP_RQST_RESPONDED;
+            ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.GTP_REG_RQST, 1, &rqst_data);
+            break;
+
+        case GTP_RQST_BAK_REF:
+            TPD_INFO("%s: Request Ref.\n", __func__);
+            break;
+
+        case GTP_RQST_MAIN_CLOCK:
+            TPD_INFO("%s: Request main clock.\n", __func__);
+            break;
+
+        default:
+            break;
+    }
+
+    return 0;
+}
+
+#define getU32(a) ((u32)getUint((u8 *)(a), 4))
+#define getU16(a) ((u16)getUint((u8 *)(a), 2))
+static u32 getUint(u8 * buffer, int len)
+{
+    u32 num = 0;
+    int i;
+    for (i = 0; i < len; i++) {
+        num <<= 8;
+        num += buffer[i];
+    }
+
+    return num;
+}
+
+static void goodix_reset_via_gpio(struct chip_data_gt9286 *chip_info)
+{
+    if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+        gpio_direction_output(chip_info->hw_res->reset_gpio, 0);
+        msleep(2);
+        gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+        msleep(50);
+        msleep(10);
+
+        chip_info->halt_status = false; //reset this flag when ic reset
+    }
+}
+
+static int goodix_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+
+    goodix_reset_via_gpio(chip_info);
+    ret = goodix_set_reset_status(chip_info);
+    
+    if (ret < 0) {
+        TPD_INFO("goodix set reset status failed\n");
+        return ret;
+    }
+
+    return 0;
+}
+
+static u8 *goodix_get_fw_data(struct chip_data_gt9286 *chip_info, u32 offset, int length)
+{
+    memcpy(chip_info->update_info.buffer, chip_info->update_info.firmware_file_data + offset, length);
+
+    return chip_info->update_info.buffer;
+}
+
+
+static int goodix_check_firmware_data(struct chip_data_gt9286 *chip_info)
+{
+    u16 actual_checksum;
+    u16 checksum_in_header;
+    u8 *p;
+    struct fw_info *firmware;
+    int i;
+    int offset;
+
+    TPD_INFO("%s enter.\n", __func__);
+
+    // compare file length with the length field in the firmware header
+    if (chip_info->update_info.fw_length < FW_HEAD_SIZE) {
+        TPD_INFO("firmware error, (file length: %d) too short\n", chip_info->update_info.fw_length);
+        return -1;
+    }
+
+    p = goodix_get_fw_data(chip_info, 0, 6);
+    if (p == NULL) {
+        return -1;
+    }
+
+    if (getU32(p) + 6 != chip_info->update_info.fw_length) {
+        TPD_INFO("firmware error, (file actual length: %d, header define length: %d)\n", chip_info->update_info.fw_length, getU32(p));
+        return -1;
+    }
+    // check firmware's checksum
+    checksum_in_header = getU16(&p[4]);
+    actual_checksum = 0;
+    for (i = 6; i < chip_info->update_info.fw_length; i++) {
+        p = goodix_get_fw_data(chip_info, i, 1);
+        if (p == NULL) {
+            return -1;
+        }
+        actual_checksum += p[0];
+    }
+
+    TPD_INFO("firmware actual checksum: 0x%04X, header define checksum: 0x%04X\n", actual_checksum, checksum_in_header);
+
+    if (actual_checksum != checksum_in_header) {
+        return -1;
+    }
+
+    // parse firmware
+    p = goodix_get_fw_data(chip_info, 0, FW_HEAD_SIZE);
+    if (p == NULL) {
+        return -1;
+    }
+    // get fireware
+    memcpy((u8 *) chip_info->update_info.firmware, p, FW_HEAD_SIZE - 8 * 12);
+    chip_info->update_info.firmware->pid[5] = 0;
+
+    p = &p[FW_HEAD_OFFSET_SUBSYSTEM_INFO_BASE];
+    firmware = chip_info->update_info.firmware;
+    offset = FW_HEAD_SIZE;
+    for (i = 0; i < firmware->subsystem_count; i++) {
+        firmware->subsystem[i].type = p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE];
+        firmware->subsystem[i].length = getU16(&p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE + 1]);
+        firmware->subsystem[i].address = getU16(&p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE + 3]) * 256;
+        firmware->subsystem[i].offset = offset;
+        offset += firmware->subsystem[i].length;
+    }
+
+    // print update information
+    TPD_INFO("Firmware length: %d\n", chip_info->update_info.fw_length);
+    TPD_INFO("Firmware product: GT%s\n", chip_info->update_info.firmware->pid);
+    TPD_INFO("Firmware patch: %02X%02X%02X\n", chip_info->update_info.firmware->version[0], chip_info->update_info.firmware->version[1], chip_info->update_info.firmware->version[2]);
+    TPD_INFO("Firmware chip: 0x%02X\n", chip_info->update_info.firmware->chip_type);
+    TPD_INFO("Subsystem count: %d\n", chip_info->update_info.firmware->subsystem_count);
+    for (i = 0; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_DEBUG("------------------------------------------\n");
+        TPD_DEBUG("Subsystem: %d\n", i);
+        TPD_DEBUG("Type: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_DEBUG("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_DEBUG("Address: 0x%08X\n", chip_info->update_info.firmware->subsystem[i].address);
+        TPD_DEBUG("Offset: %d\n", chip_info->update_info.firmware->subsystem[i].offset);
+    }
+
+    TPD_INFO("%s end.\n", __func__);
+
+    return 0;
+}
+
+static int __goodix_hold_ss51_dsp_20(struct chip_data_gt9286 *chip_info)
+{
+    int ret = -1;
+    int retry = 0;
+    u8 buf[1];
+    int hold_times = 0;
+
+    while (retry++ < 30) {
+        // Hold ss51 & dsp
+        buf[0] = 0x0C;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info._rRW_MISCTL__SWRST_B0_, buf[0]);
+        if (ret < 0) {
+            TPD_INFO("Hold ss51 & dsp I2C error, retry:%d\n", retry);
+            continue;
+        }
+        // Confirm hold
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info._rRW_MISCTL__SWRST_B0_);
+        if (ret < 0) {
+            TPD_INFO("Hold ss51 & dsp I2C error, retry:%d\n", retry);
+            continue;
+        }
+        if (0x0C == ret) {
+            if (hold_times++ < 20) {
+                continue;
+            } else {
+                break;
+            }
+        }
+        TPD_INFO("Hold ss51 & dsp confirm 0x4180 failed, value:%d\n", buf[0]);
+    }
+
+    if (retry >= 30) {
+        TPD_INFO("Hold ss51&dsp failed!\n");
+        return -1;
+    }
+
+    TPD_INFO("Hold ss51&dsp successfully.\n");
+
+    return 0;
+}
+
+
+static int goodix_hold_ss51_dsp(struct chip_data_gt9286 *chip_info)
+{
+    int ret = 0, retry = 5;
+    u8 buffer[2];
+
+    do {
+        ret = touch_i2c_read_block(chip_info->client, 0x4220, 1, buffer);
+    } while (retry-- && ret < 0);
+
+    if (ret < 0)
+        return -1;
+
+    //hold ss51_dsp
+    ret = __goodix_hold_ss51_dsp_20(chip_info);
+    if (ret) {
+        return ret;
+    }
+    // enable dsp & mcu power
+    buffer[0] = 0x00;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__DSP_MCU_PWR_, buffer, 1);
+    if (ret) {
+        TPD_INFO("enabel dsp & mcu power fail!\n");
+        return ret;
+    }
+    // disable watchdog
+    buffer[0] = 0x00;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__TMR0_EN, buffer, 1);
+    if (ret) {
+        TPD_INFO("disable wdt fail!\n");
+        return ret;
+    }
+    // clear cache
+    buffer[0] = 0x00;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__CACHE_EN, buffer, 1);
+    if (ret) {
+        TPD_INFO("clear cache fail!\n");
+        return ret;
+    }
+    // soft reset
+    buffer[0] = 0x01;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info._bWO_MISCTL__CPU_SWRST_PULSE, 1, buffer);
+    if (ret < 0) {
+        TPD_INFO("software reset fail!\n");
+        return ret;
+    }
+    // set scramble
+    buffer[0] = 0x00;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._rRW_MISCTL__BOOT_OPT_B0_, buffer, 1);
+    if (ret) {
+        TPD_INFO("set scramble fail!\n");
+        return ret;
+    }
+
+    return 0;
+}
+
+static u16 goodix_calc_checksum(u8 * fw, u32 length)
+{
+    u32 i = 0;
+    u32 checksum = 0;
+
+    for (i = 0; i < length; i += 2) {
+        checksum += (((int)fw[i]) << 8);
+        checksum += fw[i + 1];
+    }
+
+    return (checksum & 0xFFFF);
+}
+
+static int goodix_run_ss51_isp(struct chip_data_gt9286 *chip_info, u8 * ss51_isp, int length)
+{
+    int ret;
+    u8 buffer[10];
+
+    ret = goodix_hold_ss51_dsp(chip_info);
+    if (ret) {
+        return ret;
+    }
+    // select bank4
+    buffer[0] = 0x04;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__SRAM_BANK, buffer, 1);
+    if (ret) {
+        TPD_INFO("select bank4 fail.\n");
+        return ret;
+    }
+    // enable patch area access
+    buffer[0] = 0x01;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__PATCH_AREA_EN_, buffer, 1);
+    if (ret) {
+        TPD_INFO("enable patch area access fail!\n");
+        return ret;
+    }
+
+    TPD_INFO("ss51_isp length: %d, checksum: 0x%04X\n", length, goodix_calc_checksum(ss51_isp, length));
+    // load ss51 isp
+    ret = touch_i2c_write_block(chip_info->client, 0xC000, length, ss51_isp);
+    if (ret < 0) {
+        TPD_INFO("load ss51 isp fail!\n");
+        return ret;
+    }
+    // recall compare
+    ret = goodix_recall_check(chip_info->client, ss51_isp, 0xC000, length);
+    if (ret) {
+        TPD_INFO("recall check ss51 isp fail!\n");
+        return ret;
+    }
+
+    memset(buffer, 0xAA, 10);
+    ret = goodix_i2c_write_with_readback(chip_info->client, 0x8140, buffer, 10);
+
+    // disable patch area access
+    buffer[0] = 0x00;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._bRW_MISCTL__PATCH_AREA_EN_, buffer, 1);
+    if (ret) {
+        TPD_INFO("disable patch area access fail!\n");
+        return ret;
+    }
+    // set 0x8006
+    memset(buffer, 0x55, 8);
+    ret = goodix_i2c_write_with_readback(chip_info->client, 0x8006, buffer, 8);
+    if (ret) {
+        TPD_INFO("set 0x8006[0~7] 0x55 fail!\n");
+        return ret;
+    }
+    // release ss51
+    buffer[0] = 0x08;
+    ret = goodix_i2c_write_with_readback(chip_info->client, chip_info->reg_info._rRW_MISCTL__SWRST_B0_, buffer, 1);
+    if (ret) {
+        TPD_INFO("release ss51 fail!\n");
+        return ret;
+    }
+
+    msleep(100);
+    // check run state
+    ret = touch_i2c_read_block(chip_info->client, 0x8006, 2, buffer);
+    if (ret < 0) {
+        TPD_INFO("read 0x8006 fail!\n");
+        return ret;
+    }
+    if (!(buffer[0] == 0xAA && buffer[1] == 0xBB)) {
+        TPD_INFO("ERROR: isp is not running! 0x8006: %02X %02X\n", buffer[0], buffer[1]);
+        return -1;
+    }
+
+    return 0;
+}
+
+static int goodix_error_erase(struct chip_data_gt9286 *chip_info)
+{
+    int block_len;
+    u16 checksum;
+    u16 erase_addr;
+    u8 buffer[10];
+    int ret;
+    int wait_time;
+    int burn_state = -1;
+    int retry = 5;
+    u8 *fw = NULL;
+
+    TPD_INFO("Erase flash area of ss51.\n");
+
+    goodix_reset(chip_info);
+
+    fw = goodix_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset,
+            chip_info->update_info.firmware->subsystem[0].length);
+    if (fw == NULL) {
+        TPD_INFO("get isp fail\n");
+        return -1;
+    }
+    ret = goodix_run_ss51_isp(chip_info, fw, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        return -1;
+    }
+
+    fw = kmalloc(1024 * 4, GFP_KERNEL);
+    if (!fw) {
+        TPD_INFO("error when alloc mem.\n");
+        return -1;
+    }
+
+    memset(fw, 0xFF, 1024 * 4);
+    erase_addr = 0x00;
+    block_len = 1024 * 4;
+
+    while (retry-- > 0) {
+
+        checksum = 0;
+        checksum += block_len;
+        checksum += erase_addr;
+        checksum += goodix_calc_checksum(fw, block_len);
+        checksum = (0 - checksum);
+
+        buffer[0] = ((block_len >> 8) & 0xFF);
+        buffer[1] = (block_len & 0xFF);
+        buffer[2] = ((erase_addr >> 8) & 0xFF);
+        buffer[3] = (erase_addr & 0xFF);
+
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8100, buffer, 4);
+        if (ret) {
+            TPD_INFO("write length & address fail!\n");
+            continue;
+        }
+
+        ret = touch_i2c_write_block(chip_info->client, 0x8100 + 4, block_len, fw);
+        if (ret < 0) {
+            TPD_INFO("write fw data fail!\n");
+            continue;
+        }
+
+        ret = goodix_recall_check(chip_info->client, fw, 0x8100 + 4, block_len);
+        if (ret) {
+            continue;
+        }
+
+        buffer[0] = ((checksum >> 8) & 0xFF);
+        buffer[1] = (checksum & 0xFF);
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8100 + 4 + block_len, buffer, 2);
+        if (ret) {
+            TPD_INFO("write checksum fail!\n");
+            continue;
+        }
+
+        buffer[0] = 0;
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8022, buffer, 1);
+        if (ret) {
+            TPD_INFO("clear control flag fail!\n");
+            continue;
+        }
+
+        buffer[0] = FW_SECTION_TYPE_SS51_PATCH;
+        buffer[1] = FW_SECTION_TYPE_SS51_PATCH;
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8020, buffer, 2);
+        if (ret) {
+            TPD_INFO("write subsystem type fail!\n");
+            continue;
+        }
+        burn_state = -1;
+        wait_time = 200;
+        while (wait_time > 0) {
+            wait_time--;
+            msleep(5);
+            ret = goodix_i2c_read_dbl_check(chip_info->client, 0x8022, buffer, 1);
+            if (ret) {
+                continue;
+            }
+
+            if (buffer[0] == 0xAA) {
+                TPD_DEBUG("burning.....\n");
+                continue;
+            } else if (buffer[0] == 0xDD) {
+                TPD_INFO("checksum error!\n");
+                break;
+            } else if (buffer[0] == 0xBB) {
+                TPD_INFO("burning success.\n");
+                burn_state = 0;
+                break;
+            } else if (buffer[0] == 0xCC) {
+                TPD_INFO("burning failed!\n");
+                break;
+            } else {
+                TPD_DEBUG("unknown state!(0x8022: 0x%02X)\n", buffer[0]);
+            }
+        }
+    }
+
+    kfree(fw);
+    if (burn_state == 0) {
+        return 0;
+    } else {
+        return -1;
+    }
+}
+
+static int goodix_burn_subsystem(struct chip_data_gt9286 *chip_info, struct fw_subsystem_info *subsystem)
+{
+    int block_len;
+    u16 checksum;
+    int burn_len = 0;
+    u16 cur_addr;
+    u32 length = subsystem->length;
+    u8 buffer[10];
+    int ret;
+    int k, pack_num = 0;
+    int wait_time;
+    int burn_state;
+    int retry = 5;
+    u8 *fw;
+
+    TPD_INFO("Subsystem: %d, Length: %d, Address: 0x%08X\n", subsystem->type, subsystem->length, subsystem->address);
+
+    while (length > 0 && retry > 0) {
+        retry--;
+
+        block_len = length > 4096 ? 4096 : length;
+
+        TPD_INFO("Burn block ==> length: %d, address: 0x%08X\n", block_len, subsystem->address + burn_len);
+        fw = goodix_get_fw_data(chip_info, subsystem->offset + burn_len, block_len);
+        if (fw == NULL) {
+            return -1;
+        }
+
+        cur_addr = ((subsystem->address + burn_len) >> 8);
+
+        checksum = 0;
+        checksum += block_len;
+        checksum += cur_addr;
+        checksum += goodix_calc_checksum(fw, block_len);
+        checksum = (0 - checksum);
+
+        buffer[0] = ((block_len >> 8) & 0xFF);
+        buffer[1] = (block_len & 0xFF);
+        buffer[2] = ((cur_addr >> 8) & 0xFF);
+        buffer[3] = (cur_addr & 0xFF);
+
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8100, buffer, 4);
+        if (ret) {
+            TPD_INFO("write length & address fail!\n");
+            continue;
+        }
+
+        pack_num = block_len/2048;
+        for (k = 0; k < pack_num; k++) {
+            ret = touch_i2c_write_block(chip_info->client, 0x8100 + 4 + 2048*k, 2048, fw + 2048*k);
+            if (ret < 0) {
+                TPD_INFO("the %d pack, write fw data fail!\n", k);
+            }
+        }
+        if (block_len%2048) {
+            ret = touch_i2c_write_block(chip_info->client, 0x8100 + 4 + 2048*k, block_len%2048, fw + 2048*k);
+            if (ret < 0) {
+                TPD_INFO("the last pack, write fw data fail!\n");
+            }
+        }
+
+        buffer[0] = ((checksum >> 8) & 0xFF);
+        buffer[1] = (checksum & 0xFF);
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8100 + 4 + block_len, buffer, 2);
+        if (ret) {
+            TPD_INFO("write checksum fail!\n");
+            continue;
+        }
+
+        buffer[0] = 0;
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8022, buffer, 1);
+        if (ret) {
+            TPD_INFO("clear control flag fail!\n");
+            continue;
+        }
+
+        buffer[0] = subsystem->type;
+        buffer[1] = subsystem->type;
+        ret = goodix_i2c_write_with_readback(chip_info->client, 0x8020, buffer, 2);
+        if (ret) {
+            TPD_INFO("write subsystem type fail!\n");
+            continue;
+        }
+        burn_state = -1;
+        wait_time = 200;
+        msleep(5);
+
+        while (wait_time-- > 0) {
+            u8 confirm = 0x55;
+
+            ret = touch_i2c_read_block(chip_info->client, 0x8022, 1, buffer);
+            if (ret < 0) {
+                continue;
+            }
+            msleep(5);
+            ret = touch_i2c_read_block(chip_info->client, 0x8022, 1, &confirm);
+            if (ret < 0) {
+                continue;
+            }
+            if (buffer[0] != confirm) {
+                continue;
+            }
+
+            if (buffer[0] == 0xAA) {
+                TPD_DEBUG("burning.....\n");
+                continue;
+            } else if (buffer[0] == 0xDD) {
+                TPD_INFO("checksum error!\n");
+                break;
+            } else if (buffer[0] == 0xBB) {
+                TPD_INFO("burning success.\n");
+                burn_state = 0;
+                break;
+            } else if (buffer[0] == 0xCC) {
+                TPD_INFO("burning failed!\n");
+                break;
+            } else {
+                TPD_DEBUG("unknown state!(0x8022: 0x%02X)\n", buffer[0]);
+            }
+        }
+
+        if (!burn_state) {
+            length -= block_len;
+            burn_len += block_len;
+            retry = 5;
+        }
+    }
+    if (length == 0) {
+        return 0;
+    } else {
+        return -1;
+    }
+}
+
+static int goodix_read_flash(struct i2c_client* client, u32 addr, int length)
+{
+    int wait_time;
+    int ret = 0;
+    u8 buffer[4];
+    u16 read_addr = (addr >> 8);
+
+    TPD_INFO("Read flash: 0x%04X, length: %d\n", addr, length);
+
+    buffer[0] = 0;
+    ret = goodix_i2c_write_with_readback(client, 0x8022, buffer, 1);
+
+    buffer[0] = ((length >> 8) & 0xFF);
+    buffer[1] = (length & 0xFF);
+    buffer[2] = ((read_addr >> 8) & 0xFF);
+    buffer[3] = (read_addr & 0xFF);
+    ret |= goodix_i2c_write_with_readback(client, 0x8100, buffer, 4);
+
+    buffer[0] = 0xAA;
+    buffer[1] = 0xAA;
+    ret |= touch_i2c_write_block(client, 0x8020, 2, buffer);
+    if (ret < 0) {
+        TPD_INFO("Error occured.\n");
+        return ret;
+    }
+
+    wait_time = 200;
+    while (wait_time > 0) {
+        wait_time--;
+        msleep(5);
+        ret = goodix_i2c_read_dbl_check(client, 0x8022, buffer, 1);
+        if (ret) {
+            continue;
+        }
+        if (buffer[0] == 0xBB) {
+            TPD_INFO("Read success(addr: 0x%04X, length: %d)\n", addr, length);
+            break;
+        }
+    }
+    if (wait_time == 0) {
+        TPD_INFO("Read Flash FAIL!\n");
+        return -1;
+    }
+
+    return 0;
+}
+
+static int goodix_check_subsystem_in_flash(struct chip_data_gt9286 *chip_info, struct fw_subsystem_info *subsystem)
+{
+    int block_len;
+    int checked_len = 0;
+    u32 length = subsystem->length;
+    int ret;
+    int check_state = 0;
+    u8 *fw;
+
+    TPD_INFO("Subsystem: %d, Length: %d, Address: 0x%08X", subsystem->type, subsystem->length, subsystem->address);
+
+    while (length > 0) {
+        block_len = length > 4096 ? 4096 : length;
+
+        TPD_INFO("Check block ==> length: %d, address: 0x%08X\n", block_len, subsystem->address + checked_len);
+        fw = goodix_get_fw_data(chip_info, subsystem->offset + checked_len, block_len);
+        if (fw == NULL) {
+            return -1;
+        }
+        ret = goodix_read_flash(chip_info->client, subsystem->address + checked_len, block_len);
+        if (ret) {
+            check_state |= ret;
+        }
+
+        ret = goodix_recall_check(chip_info->client, fw, 0x8100, block_len);
+        if (ret) {
+            TPD_INFO("Block in flash is broken!\n");
+            check_state |= ret;
+        }
+
+        length -= block_len;
+        checked_len += block_len;
+    }
+
+    if (check_state) {
+        TPD_INFO("Subsystem in flash is broken!\n");
+    } else {
+        TPD_INFO("Subsystem in flash is correct!\n");
+    }
+    return check_state;
+}
+
+static void goodix_finger_protect_data_get(struct chip_data_gt9286 *chip_info)
+{
+    int ret = -1;
+    int addr, i = 0, j = 0;
+    u8 raw_data[1024] = {0};
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    chip_info->spuri_fp_touch_raw_data = kzalloc(TX_NUM * RX_NUM * sizeof(u16), GFP_KERNEL);
+    addr = chip_info->reg_info.GTP_REG_RAWDATA;
+
+    TPD_INFO("%s start\n", __func__);
+    gt1x_rawdiff_mode = 1;
+    goodix_send_cmd(chip_info, 1, 0);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 0);
+
+    //wait for data ready
+    while(i++ < 10) {
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 1, raw_data);
+        TPD_INFO("ret = %d \t kernel_buf = %d\n", ret, raw_data[0]);
+        if((ret > 0) && ((raw_data[0] & 0x80) == 0x80)) {
+            TPD_INFO("Data ready OK");
+            break;
+        }
+        msleep(5);
+    }
+    if(i >= 10) {
+        TPD_INFO("data not ready, quit!\n");
+        goto read_data_exit;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, addr, TX_NUM * RX_NUM * 2, raw_data);
+
+    for(i = 0; i < RX_NUM; i++) {
+        //TPD_INFO("[%2d] ", i);
+        for(j = 0; j < TX_NUM; j++) {
+            chip_info->spuri_fp_touch_raw_data[i * TX_NUM + j] = (s16)(raw_data[i * TX_NUM * 2 + j * 2] << 8) + raw_data[i * TX_NUM * 2 + j * 2 + 1];
+            //printk("%d ",chip_info->spuri_fp_touch_raw_data[i * TX_NUM + j]);
+        }
+        //printk("\n");
+    }
+
+read_data_exit:
+    goodix_send_cmd(chip_info, 0, 0);
+    gt1x_rawdiff_mode = 0;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 0);
+    return;
+}
+
+/*********** End of function that work for oppo_touchpanel_operations callbacks***************/
+
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int goodix_ftm_process(void *chip_data)
+{
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    TPD_INFO("%s is called!\n", __func__);
+    tp_powercontrol_2v8(chip_info->hw_res, false);
+
+    return 0;
+}
+
+static int goodix_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    char manu_temp[MAX_DEVICE_MANU_LENGTH] = GOODIX_PREFIX;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+    strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+static int goodix_get_chip_info(void *chip_data)
+{
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    struct goodix_register   *reg_info = &chip_info->reg_info;
+
+    reg_info->GTP_REG_FW_CHK_MAINSYS        = 0x41E4;
+    reg_info->GTP_REG_FW_CHK_SUBSYS         = 0x5095;
+    reg_info->GTP_REG_CONFIG_DATA           = 0x8050;
+    reg_info->GTP_REG_READ_COOR             = 0x814E;
+    reg_info->GTP_REG_WAKEUP_GESTURE        = 0x814C;
+    reg_info->GTP_REG_GESTURE_COOR          = 0xBDA8;
+    reg_info->GTP_REG_CMD                   = 0x8040;
+    reg_info->GTP_REG_RQST                  = 0x8044;
+    reg_info->GTP_REG_NOISE_DETECT          = 0x804B;
+    reg_info->GTP_REG_WATER_PROTECT_QUERY   = 0x8F89;
+    reg_info->GTP_REG_PRODUCT_VER           = 0x8140;
+
+    reg_info->GTP_REG_RAWDATA               = 0xB53C;
+    reg_info->GTP_REG_DIFFDATA              = 0xAB6C;
+    reg_info->GTP_REG_BASEDATA              = 0xB054;
+
+    reg_info->_rRW_MISCTL__SWRST_B0_        = 0x4180;
+    reg_info->_bRW_MISCTL__DSP_MCU_PWR_     = 0x4010;
+    reg_info->_bRW_MISCTL__TMR0_EN          = 0x40B0;
+    reg_info->_bRW_MISCTL__CACHE_EN         = 0x404B;
+    reg_info->_bWO_MISCTL__CPU_SWRST_PULSE  = 0x4184;
+    reg_info->_rRW_MISCTL__BOOT_OPT_B0_     = 0x4218;
+    reg_info->_bRW_MISCTL__SRAM_BANK        = 0x4048;
+    reg_info->_bRW_MISCTL__PATCH_AREA_EN_   = 0x404D;
+
+    return goodix_set_reset_status(chip_info);
+}
+
+static int goodix_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+
+        msleep(20);
+        goodix_reset_via_gpio(chip_info);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+            gpio_direction_output(chip_info->hw_res->reset_gpio, 0);
+        }
+    }
+
+    return ret;
+}
+
+static fw_check_state goodix_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    int retry = 2;
+    int ret = -1;
+    u8 reg_val[2] = {0};
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    do {
+        goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_FW_CHK_MAINSYS, reg_val, 1);
+        goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_FW_CHK_SUBSYS, &reg_val[1], 1);
+
+        if (reg_val[0] != 0xBE || reg_val[1] == 0xAA) {
+            TPD_INFO("Check fw status failed: reg[0x41E4] = 0x%2X, reg[0x5095] = 0x%2X!\n", reg_val[0], reg_val[1]);
+        } else {
+            break;
+        }
+    } while(--retry);
+
+    if (!retry)
+        return FW_ABNORMAL;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.GTP_REG_CONFIG_DATA);
+    if (ret < 0) {
+        TPD_INFO("%s: read config version failed, need update firmware!\n", __func__);
+        return FW_ABNORMAL;
+    } else {
+        panel_data->TP_FW = ret & 0x7F; /*bit0-6 is fw version*/
+    }
+
+    ret = goodix_read_version(chip_info, panel_data);
+    ret = goodix_init_panel(chip_info);
+    if (ret != 0) {
+        TPD_INFO("%s: init panel failed\n", __func__);
+    }
+
+    TPD_INFO("%s: goodix config version = 0x%x \n", __func__, panel_data->TP_FW);
+    return FW_NORMAL;
+}
+
+static fw_update_state goodix_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int i = 0;
+    int ret = 0;
+    int retry = 2;
+    u8 *p;
+    u8 reg_val[2] = {0};
+    struct goodix_version_info fw_ver_info;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    struct goodix_version_info ver_info = chip_info->ver_info;
+
+    TPD_INFO("%s enter!\n", __func__);
+
+    if (chip_info->update_info.status != UPDATE_STATUS_IDLE) {
+        TPD_INFO("Update process is running!\n");
+        return FW_NO_NEED_UPDATE;
+    }
+    chip_info->update_info.status = UPDATE_STATUS_RUNNING;
+    chip_info->update_info.progress = 0;
+    chip_info->update_info.max_progress = 0;
+
+    chip_info->update_info.fw_length = fw->size;
+    chip_info->update_info.firmware_file_data = (u8 *)fw->data;
+
+    chip_info->update_info.firmware = (struct fw_info *)kzalloc(sizeof(struct fw_info), GFP_KERNEL);
+    if (chip_info->update_info.firmware == NULL) {
+        TPD_INFO("Alloc %zu bytes memory fail.\n", sizeof(struct fw_info));
+
+        return FW_NO_NEED_UPDATE;
+    }
+
+    chip_info->update_info.buffer = (u8 *) kzalloc(1024 * 4, GFP_KERNEL);
+    if (chip_info->update_info.buffer == NULL) {
+        TPD_INFO("Alloc %d bytes memory fail.\n", 1024 * 4);
+        kfree(chip_info->update_info.firmware);
+        return FW_NO_NEED_UPDATE;
+    }
+
+    goodix_esd_check_enable(chip_info, false);
+    ret = goodix_check_firmware_data(chip_info);
+    if (ret < 0) {
+        chip_info->update_info.status = UPDATE_STATUS_ABORT;
+         TPD_INFO("goodix_check_firmware_data fail\n");
+        goto no_update_exit;
+    }
+
+    chip_info->update_info.max_progress = 6 + chip_info->update_info.firmware->subsystem_count;
+    chip_info->update_info.progress++;
+
+    do {
+        goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_FW_CHK_MAINSYS, reg_val, 1);
+        goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_FW_CHK_SUBSYS, &reg_val[1], 1);
+
+        if (reg_val[0] != 0xBE || reg_val[1] == 0xAA) {
+            TPD_INFO("Check fw status reg not pass, reg[0x814E] = 0x%2X, reg[0x5095] = 0x%2X!, retry = %d\n", reg_val[0], reg_val[1], retry);
+        } else {
+            break;
+        }
+    } while(--retry);
+
+    if (retry) { // if tp firmware is ok, judge the fw id, else  update immediately
+        fw_ver_info.mask_id = (chip_info->update_info.firmware->target_mask_version[0] << 16)
+            | (chip_info->update_info.firmware->target_mask_version[1] << 8)
+            | (chip_info->update_info.firmware->target_mask_version[2]);
+        fw_ver_info.patch_id = (chip_info->update_info.firmware->version[0] << 16)
+            | (chip_info->update_info.firmware->version[1] << 8)
+            | (chip_info->update_info.firmware->version[2]);
+        memcpy(fw_ver_info.product_id, chip_info->update_info.firmware->pid, 4);
+        fw_ver_info.product_id[4] = 0;
+
+        if (memcmp(fw_ver_info.product_id, ver_info.product_id, 4)) {
+            TPD_INFO("Product id is not match!\n");
+            goto no_update_exit;
+        }
+
+        if ((fw_ver_info.mask_id & 0xFFFFFF00) != (ver_info.mask_id & 0xFFFFFF00)) {
+            TPD_INFO("Mask id is not match!\n");
+            goto no_update_exit;
+        }
+
+        if (!force) {
+            if (fw_ver_info.patch_id  == ver_info.patch_id)
+                goto no_update_exit;
+        }
+    }
+
+    chip_info->update_info.progress++;
+
+    p = goodix_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset, chip_info->update_info.firmware->subsystem[0].length);
+    if (p == NULL) {
+        TPD_INFO("get isp fail\n");
+        chip_info->update_info.status = UPDATE_STATUS_ABORT;
+        goto update_exit;
+    }
+
+    chip_info->update_info.progress++;
+    ret = goodix_run_ss51_isp(chip_info, p, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        goto update_exit;
+    }
+
+    chip_info->update_info.progress++;
+
+    msleep(800);
+
+    for (i = 1; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_INFO("subsystem: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_INFO("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_INFO("Address: %d\n", chip_info->update_info.firmware->subsystem[i].address);
+
+        ret = goodix_burn_subsystem(chip_info, &(chip_info->update_info.firmware->subsystem[i]));
+        if (ret) {
+            TPD_INFO("burn subsystem fail!\n");
+            goto update_exit;
+        }
+        chip_info->update_info.progress++;
+    }
+
+    goodix_reset(chip_data);
+
+    p = goodix_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset, chip_info->update_info.firmware->subsystem[0].length);
+    if (p == NULL) {
+        TPD_INFO("get isp fail\n");
+        goto update_exit;
+    }
+    chip_info->update_info.progress++;
+
+    ret = goodix_run_ss51_isp(chip_info, p, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        goto update_exit;
+    }
+    chip_info->update_info.progress++;
+
+    TPD_INFO("Reset guitar & check firmware in flash.\n");
+    for (i = 1; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_INFO("subsystem: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_INFO("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_INFO("Address: %d\n", chip_info->update_info.firmware->subsystem[i].address);
+
+        ret = goodix_check_subsystem_in_flash(chip_info, &(chip_info->update_info.firmware->subsystem[i]));
+        if (ret) {
+            goodix_error_erase(chip_info);
+            break;
+        }
+    }
+    chip_info->update_info.progress++;
+
+    TPD_INFO("%s end.\n", __func__);
+
+update_exit:
+    goodix_esd_check_enable(chip_info, true);
+    kfree(chip_info->update_info.buffer);
+    kfree(chip_info->update_info.firmware);
+    chip_info->update_info.status = UPDATE_STATUS_IDLE;
+
+    if (ret) {
+        chip_info->update_info.progress = 2 * chip_info->update_info.max_progress;
+        TPD_INFO("Update firmware failed!\n");
+        return FW_UPDATE_ERROR;
+    } else {
+        goodix_init_panel(chip_info);   //after update, need send config again
+        TPD_INFO("Update firmware succeefully!\n");
+        return FW_UPDATE_SUCCESS;
+    }
+
+no_update_exit:
+    goodix_esd_check_enable(chip_info, true);
+    kfree(chip_info->update_info.buffer);
+    kfree(chip_info->update_info.firmware);
+    chip_info->update_info.status = UPDATE_STATUS_IDLE;
+    return FW_NO_NEED_UPDATE;
+}
+
+static u8 goodix_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = -1;
+    u8 touch_num = 0;
+    u8 check_sum = 0;
+    int i;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    if (gesture_enable && is_suspended) {   //check whether the gesture trigger
+        return IRQ_GESTURE;
+    } else if (is_suspended) {
+        return IRQ_IGNORE;
+    }
+
+    memset(chip_info->touch_data, 0, MAX_GT_IRQ_DATA_LENGTH);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c transfer error!\n", __func__);
+        return IRQ_EXCEPTION;
+    }
+
+    chip_info->touch_data[0] = ret & 0xFF;
+    touch_num = chip_info->touch_data[0] & 0x0F;
+
+    if (chip_info->touch_data[0] == 0x00) {     //int request
+        return IRQ_FW_CONFIG;
+    }
+    if ((chip_info->touch_data[0] & 0x80) == 0) {   //touch data not ready, wait for next interrupt
+        return IRQ_IGNORE;
+    }
+
+    touch_num = touch_num < MAX_POINT_NUM ? touch_num : MAX_POINT_NUM;
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR + 1, \
+                                                    8 * touch_num + 2, &chip_info->touch_data[1]); //read out point data
+    if (ret < 0) {
+        TPD_INFO("read touch point data from coor_addr failed!\n");
+        return IRQ_IGNORE;
+    }
+
+    for (i = 0; i < 1 + 8 * touch_num + 2; i++) {   //do checksum
+        check_sum += chip_info->touch_data[i];
+    }
+    if (check_sum) { /* checksum should be zero, check again when it's no zero */
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 3 + 8 * touch_num, chip_info->touch_data);
+        if (ret < 0) {
+            return IRQ_IGNORE;
+        }
+
+        for (i = 0, check_sum = 0; i < 3 + 8 * touch_num; i++) {
+            check_sum += chip_info->touch_data[i];
+        }
+        if (check_sum) {
+            TPD_INFO("second checksum error: %x\n", check_sum);
+            goto IGNORE_CLEAR_IRQ;
+        }
+    }
+    return IRQ_TOUCH;
+
+IGNORE_CLEAR_IRQ:
+    ret = goodix_clear_irq(chip_info);
+    return IRQ_IGNORE;
+}
+
+static int goodix_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i;
+    int touch_map = 0;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    u8 touch_num = 0;
+    u8 finger_processed = 0;
+    u8 *coor_data = NULL;
+    s32 id = 0;
+
+    touch_num = chip_info->touch_data[0] & 0x0F;
+    if (touch_num == 0) { //Up event
+        goto END_TOUCH;
+    }
+
+    coor_data = &chip_info->touch_data[1];
+    id = coor_data[0] & 0x0F;
+    for (i = 0; i < max_num; i++) {
+        if (i == id) {
+            points[i].x = coor_data[1] | (coor_data[2] << 8);
+            points[i].y = coor_data[3] | (coor_data[4] << 8);
+            points[i].z = coor_data[5] | (coor_data[6] << 8);
+            points[i].width_major = 30; // any value
+            points[i].status = 1;
+            points[i].touch_major = max(coor_data[5], coor_data[6]);
+            touch_map |= 0x01 << i;
+            coor_data += 8;
+
+            if (finger_processed++ < touch_num) {
+                id = coor_data[0] & 0x0F;
+            }
+        }
+    }
+END_TOUCH:
+    ret = goodix_clear_irq(chip_info);
+    return touch_map;
+}
+
+static int goodix_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = -1;
+    uint8_t doze_buf[3] = {0};
+    uint8_t point_data[MAX_GESTURE_POINT_NUM*4];
+    uint8_t point_num = 0;
+    uint8_t gesture_id = 0;
+    struct Coordinate limitPoint[4];
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_WAKEUP_GESTURE, 2, doze_buf);
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture info i2c faild\n", __func__);
+        return -1;
+    }
+
+    gesture_id = doze_buf[0];
+    if (gesture_id == 0) { //no gesture type, no need handle
+        goto END_GESTURE;
+    }
+
+    memset(point_data, 0, MAX_GESTURE_POINT_NUM*4);
+    point_num = doze_buf[1];
+    point_num = point_num < MAX_GESTURE_POINT_NUM ? point_num : MAX_GESTURE_POINT_NUM;
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_GESTURE_COOR, point_num * 4, point_data);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_WAKEUP_GESTURE, 0x00);  //clear gesture int
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture data i2c faild\n", __func__);
+        return -1;
+    }
+
+    gesture->clockwise = 2;
+    switch (gesture_id)     //judge gesture type
+    {
+        case RIGHT_SLIDE_DETECT :
+            gesture->gesture_type  = Left2RightSwip;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case LEFT_SLIDE_DETECT :
+            gesture->gesture_type  = Right2LeftSwip;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case DOWN_SLIDE_DETECT  :
+            gesture->gesture_type  = Up2DownSwip;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case UP_SLIDE_DETECT :
+            gesture->gesture_type  = Down2UpSwip;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case DTAP_DETECT:
+            gesture->gesture_type  = DouTap;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            break;
+
+        case UP_VEE_DETECT :
+            gesture->gesture_type  = UpVee;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case DOWN_VEE_DETECT :
+            gesture->gesture_type  = DownVee;
+            getSpecialCornerPoint(&point_data[0], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case LEFT_VEE_DETECT:
+            gesture->gesture_type = LeftVee;
+            getSpecialCornerPoint(&point_data[0], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case RIGHT_VEE_DETECT ://this gesture is C
+        case RIGHT_VEE_DETECT2://this gesture is <
+            gesture->gesture_type  = RightVee;
+            getSpecialCornerPoint(&point_data[0], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            break;
+
+        case CIRCLE_DETECT  :
+            gesture->gesture_type = Circle;
+            gesture->clockwise = clockWise(&point_data[0], point_num);
+            getSpecialCornerPoint(&point_data[0], point_num, &limitPoint[0]);
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            gesture->Point_1st = limitPoint[0]; //ymin
+            gesture->Point_2nd = limitPoint[1]; //xmin
+            gesture->Point_3rd = limitPoint[2]; //ymax
+            gesture->Point_4th = limitPoint[3]; //xmax
+            break;
+
+        case DOUSWIP_DETECT  :
+            gesture->gesture_type  = DouSwip;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            break;
+
+        case M_DETECT  :
+            gesture->gesture_type  = Mgestrue;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_end.y = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_1st.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_2nd.x = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_2nd.y = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_3rd.x = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_3rd.y = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            break;
+
+        case W_DETECT :
+            gesture->gesture_type  = Wgestrue;
+            gesture->Point_start.x = (point_data[0] & 0xFF) | (point_data[1] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[2] & 0xFF) | (point_data[3] & 0x0F) << 8;
+            gesture->Point_end.x = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_end.y = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_1st.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_1st.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_2nd.x = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_2nd.y = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_3rd.x = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_3rd.y = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            break;
+
+        default:
+            gesture->gesture_type = UnkownGesture;
+            break;
+    }
+
+    TPD_INFO("%s: gesture_id = 0x%x, gesture_type = %d, clockWise = %d, point:(%d %d)(%d %d)(%d %d)(%d %d)(%d %d)(%d %d)\n",
+        __func__, gesture_id, gesture->gesture_type, gesture->clockwise,
+        gesture->Point_start.x, gesture->Point_start.y, gesture->Point_end.x, gesture->Point_end.y,
+        gesture->Point_1st.x, gesture->Point_1st.y, gesture->Point_2nd.x, gesture->Point_2nd.y,
+        gesture->Point_3rd.x, gesture->Point_3rd.y, gesture->Point_4th.x, gesture->Point_4th.y);
+
+END_GESTURE:
+    ret = goodix_clear_irq(chip_info);  //clear int
+    return 0;
+}
+
+static int goodix_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    if (chip_info->halt_status && (mode != MODE_NORMAL)) {
+        goodix_reset(chip_info);
+    }
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;    //after reset, it's already normal
+            break;
+
+        case MODE_SLEEP:
+            ret = goodix_enter_sleep(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: goodix enter sleep failed\n", __func__);
+            }
+            break;
+
+        case MODE_GESTURE:
+            if (flag) {
+                ret = goodix_enter_doze(chip_info);
+                if (ret < 0) {
+                    TPD_INFO("%s: goodix enter doze failed\n", __func__);
+                }
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = goodix_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: goodix enable:(%d) edge limit failed.\n", __func__, flag);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = goodix_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        default:
+            TPD_INFO("%s: mode %d not support.\n", __func__, mode);
+    }
+
+    return ret;
+}
+
+static int goodix_esd_handle(void *chip_data)
+{
+    s32 i = 0;
+    s32 ret = -1;
+    u8 esd_buf[4] = {0};
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    if (!chip_info->esd_check_enabled) {
+        TPD_INFO("goodix_esd_handle close\n");
+        return 0;
+    }
+
+    for (i = 0; i < 3; i++) {
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_CMD, 4, esd_buf);
+        TPD_INFO("[Esd]0x8040 = 0x%02X, 0x8043 = 0x%02X goodix_rawdiff_mode = %d\n", esd_buf[0], esd_buf[3], gt1x_rawdiff_mode);
+        if ((ret > 0) && esd_buf[0] != 0xAA && esd_buf[3] == 0xAA) {
+            break;
+        }
+        msleep(50);
+    }
+
+    if (likely(i < 3)) {
+        /* IC works normally, Write 0x8040 0xAA, feed the watchdog */
+        TPD_DEBUG("time_before(jiffies, timeout) is %d(%lu,%lu), 0x8040 = 0x%02X, 0x8043 = 0x%02X gt1x_rawdiff_mode = %d\n", time_before(jiffies, timeout), jiffies, timeout, esd_buf[0], esd_buf[3], gt1x_rawdiff_mode);
+        if (gt1x_rawdiff_mode == 1 || (time_before(jiffies, timeout) && esd_buf[0] == 0x00 && esd_buf[3] == 0xAA)) {
+            TPD_DEBUG("quit kick dog!\n");
+        } else {
+            TPD_DEBUG("kick dog! 0x8040 = 0x%02X\n", esd_buf[0]);
+            goodix_send_cmd(chip_info, GTP_CMD_ESD, 0);
+        }
+    } else {
+        TPD_INFO("IC works abnormally! Process esd reset.");
+
+        memset(esd_buf, 0x01, sizeof(esd_buf));
+        touch_i2c_write_block(chip_info->client, 0x4226, sizeof(esd_buf), esd_buf);
+        msleep(50);
+
+        disable_irq_nosync(chip_info->client->irq);
+
+        goodix_power_control(chip_info, false);
+        msleep(30);
+        goodix_power_control(chip_info, true);
+        msleep(10);
+
+        for (i = 0; i < 5; i++) {
+            if (goodix_reset(chip_data)) {
+                continue;
+            }
+            if (goodix_send_config(chip_info, chip_info->config_info.goodix_config, chip_info->config_info.goodix_config_len)) {
+                msleep(500);
+                continue;
+            }
+            tp_touch_btnkey_release();
+            break;
+        }
+
+        enable_irq(chip_info->client->irq);
+        TPD_INFO("Goodix esd reset over.");
+        return -1;
+    }
+
+    return 0;
+}
+
+static int goodix_fw_handle(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    ret = goodix_request_event_handler(chip_info);
+    return ret;
+}
+
+static void goodix_register_info_read(void * chip_data, uint16_t register_addr, uint8_t * result, uint8_t length)
+{
+    int ret = 0;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+
+    ret = touch_i2c_read_block(chip_info->client, register_addr, length, result);         /*read data*/
+}
+
+static void goodix_specific_resume_operate(void *chip_data)
+{
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    TPD_DEBUG("%s call\n", __func__);
+    goodix_esd_check_enable(chip_info, true);
+}
+
+struct oppo_touchpanel_operations goodix_ops = {
+    .ftm_process      = goodix_ftm_process,
+    .get_vendor       = goodix_get_vendor,
+    .get_chip_info    = goodix_get_chip_info,
+    .reset            = goodix_reset,
+    .power_control    = goodix_power_control,
+    .fw_check         = goodix_fw_check,
+    .fw_update        = goodix_fw_update,
+    .trigger_reason   = goodix_trigger_reason,
+    .get_touch_points = goodix_get_touch_points,
+    .get_gesture_info = goodix_get_gesture_info,
+    .mode_switch      = goodix_mode_switch,
+    .esd_handle       = goodix_esd_handle,
+    .fw_handle        = goodix_fw_handle,
+    .register_info_read = goodix_register_info_read,
+    .get_usb_state    = goodix_get_usb_state,
+    .specific_resume_operate = goodix_specific_resume_operate,
+};
+/********* End of implementation of oppo_touchpanel_operations callbacks**********************/
+
+/******** Start of implementation of debug_info_proc_operations callbacks*********************/
+static void goodix_debug_info_read(struct seq_file *s, void *chip_data, debug_type debug_type)
+{
+    int ret = -1, i = 0, j = 0;
+    u8 *kernel_buf = NULL;
+    int addr;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    kernel_buf = kzalloc(4096,GFP_KERNEL);
+    if(kernel_buf == NULL)
+    {
+        TPD_INFO("%s kmalloc error\n", __func__);
+        return ;
+    }
+    switch (debug_type) {
+        case GTP_RAWDATA:
+            addr = chip_info->reg_info.GTP_REG_RAWDATA;
+            break;
+        case GTP_DIFFDATA:
+            addr = chip_info->reg_info.GTP_REG_DIFFDATA;
+            break;
+        default:
+            addr = chip_info->reg_info.GTP_REG_BASEDATA;
+            break;
+    }
+    gt1x_rawdiff_mode = 1;
+    goodix_send_cmd(chip_info, 1, 0);
+    msleep(20);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 0);
+    TPD_INFO("%d,%s\n", __LINE__, __func__);
+
+    //wait for data ready
+    while(i++ < 10) {
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 1, kernel_buf);
+        TPD_INFO("ret = %d \t kernel_buf = %d\n", ret, kernel_buf[0]);
+        if((ret > 0) && ((kernel_buf[0] & 0x80)==0x80)) {
+            TPD_INFO("Data ready OK");
+            break;
+        }
+        msleep(20);
+    }
+    if(i >= 10) {
+        TPD_INFO("data not ready, quit!\n");
+        goto read_data_exit;
+    }
+
+    if (debug_type == GTP_DIFFDATA) {
+        ret = touch_i2c_read_block(chip_info->client, addr, TX_NUM * RX_NUM, kernel_buf);
+        msleep(5);
+
+        for(i = 0; i < RX_NUM; i++) {
+            seq_printf(s, "[%2d] ", i);
+            for(j = 0; j < TX_NUM; j++) {
+                seq_printf(s, "%4d ", kernel_buf[j * RX_NUM + i]);
+            }
+            //printk("\n");
+            seq_printf(s, "\n");
+        }
+    } else {
+        ret = touch_i2c_read_block(chip_info->client, addr, TX_NUM * RX_NUM * 2, kernel_buf);
+        msleep(5);
+
+        for(i = 0; i < RX_NUM; i++) {
+            seq_printf(s, "[%2d] ", i);
+            for(j = 0; j < TX_NUM; j++) {
+                //printk("%d ",(s16)(((s16)kernel_buf[i * TX_NUM * 2 + j * 2] << 8) + kernel_buf[i * TX_NUM * 2 + j * 2 + 1]));
+                seq_printf(s, "%4d ", (kernel_buf[j * RX_NUM * 2 + i * 2] << 8) + kernel_buf[j * RX_NUM * 2 + i * 2 + 1]);
+        }
+                //printk("\n");
+                seq_printf(s, "\n");
+        }
+    }
+read_data_exit:
+    goodix_send_cmd(chip_info, 0, 0);
+    gt1x_rawdiff_mode = 0;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.GTP_REG_READ_COOR, 0);
+    kfree(kernel_buf);
+    return ;
+}
+
+//proc/touchpanel/debug_info/delta
+static void goodix_delta_read(struct seq_file *s, void *chip_data)
+{
+    goodix_debug_info_read(s, chip_data, GTP_DIFFDATA);
+}
+
+//proc/touchpanel/debug_info/baseline
+static void goodix_baseline_read(struct seq_file *s, void *chip_data)
+{
+    goodix_debug_info_read(s, chip_data, GTP_RAWDATA);
+}
+
+//proc/touchpanel/debug_info/main_register
+static void goodix_main_register_read(struct seq_file *s, void *chip_data)
+{
+    uint8_t log_sector[65] = {0};
+    uint8_t noise_detect[392] = {0};
+    uint8_t noise_rawdata[128] = {0};
+    uint8_t XDATA1[256] = {0};
+    uint8_t* XDATA2_top = NULL;
+    uint8_t* XDATA2_bottom = NULL;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    int i = 0, j = 0, ret = 0;
+    u32 patch_id = 0;
+    int retry = 3;
+    u8 buf[12] = {0};
+    u8 checksum = 0;
+    struct goodix_version_info * ver_info = &chip_info->ver_info;
+
+    XDATA2_top = kzalloc(2464, GFP_KERNEL);
+    XDATA2_bottom = kzalloc(2432, GFP_KERNEL);
+    seq_printf(s, "==== GT1X LOG SECTOR 65 bytes FROM 0x8400====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8400, 65, log_sector);
+    for (i = 0; i < 65; i++) {
+        seq_printf(s, "0x%02x, ", log_sector[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X NOISE DETECT 392 bytes FROM 0x88B8====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x88B8, 392, noise_detect);
+    for (i = 0; i < 392; i++) {
+        seq_printf(s, "0x%02x, ", noise_detect[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X NOISE RAWDATA 128 bytes FROM 0xD62C====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0xD62C, 128, noise_rawdata);
+    for (i = 0; i < 128; i++) {
+        seq_printf(s, "0x%02x, ", noise_rawdata[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA1 256 bytes FROM 0x8200====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8200, 256, XDATA1);
+    for (i = 0; i < 256; i++) {
+        seq_printf(s, "0x%02x, ", XDATA1[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA2_TOP 2464 bytes FROM 0x84E0====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x84E0, 2464, XDATA2_top);
+    for (i = 0; i < 77; i++) {
+        seq_printf(s, "[%d]:", i);
+        for(j = 0; j < 32; j++){
+            seq_printf(s, "0x%02x, ", XDATA2_top[i * 32 + j]);
+        }
+        seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA2_BOTTOM 2432 bytes FROM 0x8E80====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8E80, 2432, XDATA2_bottom);
+    for (i = 0; i < 76; i++) {
+        seq_printf(s, "[%d]:", i);
+        for(j = 0; j < 32; j++){
+            seq_printf(s, "0x%02x, ", XDATA2_bottom[i * 32 + j]);
+        }
+        seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== water protect status ====\n");
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_WATER_PROTECT_QUERY, 1, XDATA1);
+    seq_printf(s, "0x%02x, ", XDATA1[0]);
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== Goodix default config setting in driver====\n");
+    for(i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
+        seq_printf(s, "0x%02X, ", chip_info->config_info.goodix_config[i]);
+        if(i % 10 == 9)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== Goodix fw version from tp ic====\n");
+    while (retry--) {
+        ret = goodix_i2c_read_dbl_check(chip_info->client, chip_info->reg_info.GTP_REG_PRODUCT_VER, buf, sizeof(buf));
+        if (!ret) {
+            checksum = 0;
+
+            for (i = 0; i < sizeof(buf); i++) {
+                checksum += buf[i];
+            }
+
+            if (checksum == 0 &&    /* first 3 bytes must be number or char */
+                IS_NUM_OR_CHAR(buf[0]) && IS_NUM_OR_CHAR(buf[1]) && IS_NUM_OR_CHAR(buf[2]) && buf[10] != 0xFF) {    /*sensor id == 0xFF, retry */
+                break;
+            } else {
+                TPD_INFO("product version data is error\n");
+            }
+        } else {
+            TPD_INFO("Read product version from 0x8140 failed\n");
+        }
+
+        TPD_DEBUG("Read product version retry = %d\n", retry);
+        msleep(100);
+    }
+
+    if (retry <= 0) {
+        if (ver_info)
+            ver_info->sensor_id = 0;
+        TPD_INFO("Maybe the firmware of ic is error\n");
+    }
+
+    patch_id = (u32) ((buf[4] << 16) | (buf[5] << 8) | buf[6]);
+    seq_printf(s, "fw version from tp ic : %06X, ", patch_id);
+    seq_printf(s, "\n");
+    seq_printf(s, "\n");
+
+    kfree(XDATA2_top);
+    kfree(XDATA2_bottom);
+    return;
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .delta_read    = goodix_delta_read,
+    .baseline_read = goodix_baseline_read,
+    .main_register_read = goodix_main_register_read,
+};
+/********* End of implementation of debug_info_proc_operations callbacks**********************/
+
+/************** Start of callback of proc/Goodix/config_version node**************************/
+static void goodix_config_info_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, i = 0;
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)chip_data;
+    char temp_data[GTP_CONFIG_MAX_LENGTH] = {0};
+
+    seq_printf(s, "==== Goodix default config setting in driver====\n");
+    for(i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
+        seq_printf(s, "0x%02X, ", chip_info->config_info.goodix_config[i]);
+        if(i % 10 == 9)
+            seq_printf(s, "\n");
+    }
+
+    seq_printf(s, "\n");
+    seq_printf(s, "==== Goodix config read from chip====\n");
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_CONFIG_DATA, GTP_CONFIG_MAX_LENGTH, temp_data);
+    TPD_INFO("I2C TRANSFER: %d", ret);
+
+    for(i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
+        seq_printf(s, "0x%02X, ", temp_data[i]);
+        if(i % 10 == 9)
+            seq_printf(s, "\n");
+    }
+
+    seq_printf(s, "\n");
+    seq_printf(s, "==== Goodix Version Info ====\n");
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.GTP_REG_PRODUCT_VER, 12, temp_data);
+    seq_printf(s, "ProductID: GT%c%c%c%c\n", temp_data[0], temp_data[1], temp_data[2], temp_data[3]);
+    seq_printf(s, "PatchID: %02X%02X%02X\n", temp_data[4], temp_data[5], temp_data[6]);
+    seq_printf(s, "MaskID: %02X%02X%02X\n", temp_data[7], temp_data[8], temp_data[9]);
+    seq_printf(s, "SensorID: %02X\n", chip_info->ver_info.sensor_id);
+
+    return;
+}
+/*************** End of callback of proc/Goodix/config_version node***************************/
+
+/************** Start of callback of proc/Goodix/waterproofing_mode mode**************************/
+
+static size_t goodix_water_protect_mode_read(struct file *file, char *buf, size_t len, loff_t *pos)
+{
+    int ret = 0;
+    char *temp_buf;
+    static bool send_flag = 0;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)ts->chip_data;
+
+    if (!send_flag) {
+        send_flag = true;
+        temp_buf = kzalloc(len,GFP_KERNEL);
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.GTP_REG_WATER_PROTECT_QUERY);
+        TPD_INFO("%s:%d read GTP_REG_WATER_PROTECT_QUERY = 0x%x\n", __func__, __LINE__, ret);
+
+        ret = snprintf(temp_buf, len, "[%s]water_protect_mode = 0x%x \n", TPD_DEVICE, ret);
+        if (copy_to_user(buf, temp_buf, ret))
+            TPD_INFO("%s:%d ok\n", __func__, __LINE__);
+
+        kfree(temp_buf);
+    } else {
+        send_flag = false;
+    }
+    return ret;
+}
+
+static size_t goodix_water_protect_mode_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    int ret = 0;
+    char buf_tmp[20];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct chip_data_gt9286 *chip_info = (struct chip_data_gt9286 *)ts->chip_data;
+
+    TPD_INFO("%s:%d\n",__func__,__LINE__);
+    if (len >= 20) {
+        TPD_INFO("%s: no command exceeds 20 chars.\n", __func__);
+        return -EFAULT;
+    }
+
+    if (copy_from_user(buf_tmp, buff, 20)) {
+        return -EFAULT;
+    }
+
+    if(buf_tmp[0] == '1') {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_ENTER_WATER_PROTECT, 0);
+        TPD_INFO("%s: GTP_CMD_ENTER_WATER_PROTECT\n", __func__);
+    } else {
+        ret = goodix_send_cmd(chip_info, GTP_CMD_EXIT_WATER_PROTECT, 0);
+        TPD_INFO("%s: GTP_CMD_EXIT_WATER_PROTECT\n", __func__);
+    }
+
+    return len;
+}
+/*************** End of callback of proc/Goodix/waterproofing_mode mode***************************/
+
+struct goodix_proc_operations goodix_gt9286_proc_ops = {
+    .goodix_config_info_read= goodix_config_info_read,
+    .goodix_water_protect_write = goodix_water_protect_mode_write,
+    .goodix_water_protect_read = goodix_water_protect_mode_read,
+};
+
+/*********** Start of I2C Driver and Implementation of it's callbacks*************************/
+static int goodix_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_gt9286 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+    bool read_cfg_from_dts = false;
+
+    TPD_INFO("%s is called\n", __func__);
+
+    if (tp_register_times > 0) {
+        TPD_INFO("TP driver have success loaded %d times, exit\n", tp_register_times);
+        return -1;
+    }
+
+    /* 1. Alloc chip_info */
+    chip_info = kzalloc(sizeof(struct chip_data_gt9286), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. alloc touch data space */
+    chip_info->touch_data = kzalloc(MAX_GT_IRQ_DATA_LENGTH, GFP_KERNEL);
+    if (chip_info->touch_data == NULL) {
+        TPD_INFO("touch_data kzalloc error\n");
+        goto err_touch_data_alloc;
+    }
+
+    /* 4. bind client and dev for easy operate */
+    chip_info->client = client;
+    chip_info->goodix_ops = &goodix_gt9286_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+    i2c_set_clientdata(client, ts);
+
+    /* 5. file_operations callbacks binding */
+    ts->ts_ops = &goodix_ops;
+
+    //read goodix cfg group from dts
+    read_cfg_from_dts = of_property_read_bool(ts->dev->of_node, "read_cfg_group_from_dts");
+    if (read_cfg_from_dts) {
+        ret = of_property_read_u8_array(ts->dev->of_node, "goodix,gtp_cfg_group",
+                                        GTP_CFG_GROUP_SAMSUNG, sizeof(GTP_CFG_GROUP_SAMSUNG));
+        if (ret) {
+            TPD_INFO("read goodix cfg group from dts error\n");
+            goto err_touch_data_alloc;
+        } else {
+            TPD_INFO("read goodix cfg group from dts ok\n");
+        }
+    }
+
+    /* 6. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    /* 7. collect data for supurious_fp_touch */
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        goodix_finger_protect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    /* 8. create goodix tool node */
+    gt1x_init_tool_node(ts, &chip_info->update_info);
+
+    /* 9. create goodix debug files */
+    Goodix_create_proc(ts , chip_info->goodix_ops);
+
+    goodix_esd_check_enable(chip_info, true);
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_touch_data_alloc:
+    kfree(chip_info->touch_data);
+    chip_info->touch_data = NULL;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int goodix_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int goodix_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int goodix_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = goodix_i2c_suspend,
+    .resume = goodix_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe = goodix_tp_probe,
+    .remove = goodix_tp_remove,
+    .id_table = tp_id,
+    .driver = {
+        .name = TPD_DEVICE,
+        .owner = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+/******************* End of I2C Driver and It's dev_pm_ops***********************/
+
+/***********************Start of module init and exit****************************/
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (i2c_add_driver(&tp_i2c_driver) != 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+
+    return 0;
+}
+
+
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+/***********************End of module init and exit*******************************/
+
+MODULE_DESCRIPTION("GTP Touchpanel Driver");
+MODULE_LICENSE("GPL v2");
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.h b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.h
new file mode 100644
index 0000000000000000000000000000000000000000..9a98fb5083077a0e455e3b0b5d816ba01c49e7f7
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/goodix_drivers_gt9286.h
@@ -0,0 +1,189 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : goodix_drivers_gt9286.h
+ * Description: header file for Goodix GT9286 driver
+ * Version   : 1.0
+ * Date        : 2017-08-01
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ ****************************************************************/
+
+#ifndef TOUCHPANEL_GOODIX_OPPO_H
+#define TOUCHPANEL_GOODIX_OPPO_H
+
+#include "../goodix_common.h"
+#include "../goodix_tool.h"
+
+/****************************Start of define declare****************************/
+
+#define set_reg_bit(reg, pos, val)        ((reg) = ((reg) & (~(1 << (pos)))) | (!!(val) << (pos)))
+
+#define MAX_POINT_NUM          10       //max touch point number this ic support
+#define MAX_GT_IRQ_DATA_LENGTH 90       //irq data(points,key,checksum) size read from irq
+#define MAX_GESTURE_POINT_NUM  64       //max point number of black gesture
+
+#define GTP_DRIVER_SEND_CFG   1         // send config to TP while initializing (for no config built in TP's flash)
+
+//Request type define
+#define GTP_RQST_CONFIG                 0x01
+#define GTP_RQST_BAK_REF                0x02
+#define GTP_RQST_RESET                  0x03
+#define GTP_RQST_MAIN_CLOCK             0x04
+#define GTP_RQST_HOTKNOT_CODE           0x20
+#define GTP_RQST_RESPONDED              0x00
+#define GTP_RQST_IDLE                   0xFF
+
+//command define
+#define GTP_CMD_SLEEP                   0x05
+#define GTP_CMD_GESTURE                 0x08
+#define GTP_CMD_CHARGER_ON              0x06
+#define GTP_CMD_CHARGER_OFF             0x07
+#define GTP_CMD_GESTURE_WAKEUP          0x08
+#define GTP_CMD_CLEAR_CFG               0x10
+#define GTP_CMD_ESD                     0xAA
+#define GTP_CMD_HN_TRANSFER             0x22
+#define GTP_CMD_HN_EXIT_SLAVE           0x28
+
+#define GTP_CMD_ENABLE_EDGE             0X41
+#define GTP_CMD_DISABLE_EDGE            0X42
+
+#define GTP_CMD_ENTER_WATER_PROTECT     0X44
+#define GTP_CMD_EXIT_WATER_PROTECT      0X45
+
+//gesture type fw send
+#define DTAP_DETECT                     0xCC
+#define UP_VEE_DETECT                   0x76
+#define DOWN_VEE_DETECT                 0x5e
+#define LEFT_VEE_DETECT                 0x3e
+#define RIGHT_VEE_DETECT                0x63 //this gesture is C
+#define RIGHT_VEE_DETECT2               0x3c //this gesture is <
+#define CIRCLE_DETECT                   0x6f
+#define DOUSWIP_DETECT                  0x48
+#define RIGHT_SLIDE_DETECT              0xAA
+#define LEFT_SLIDE_DETECT               0xbb
+#define DOWN_SLIDE_DETECT               0xAB
+#define UP_SLIDE_DETECT                 0xBA
+#define M_DETECT                        0x6D
+#define W_DETECT                        0x77
+/****************************End of define declare***************************/
+
+/****************************Start of config data****************************/
+#define GTP_CONFIG_MIN_LENGTH    186
+#define GTP_CONFIG_MAX_LENGTH    240
+
+//define offset in the config
+#define RESOLUTION_LOCATION      1
+#define TRIGGER_LOCATION         6
+#define MODULE_SWITCH3_LOCATION  8
+
+//Normal config setting
+u8 GTP_CFG_GROUP_SAMSUNG[] = {\
+    0x02,0x38,0x04,0x70,0x08,0x3A,0x3D,0x04,0xA8,0xE2,0x0E,0x6C,0x50,0x32,0x50,0x01,0x11,0x0C,0x10,0x00,\
+    0x46,0x80,0x96,0xDC,0x48,0x0A,0x03,0x75,0x1E,0x3C,0x00,0x44,0x00,0x51,0x00,0x00,0x12,0x14,0x00,0x40,\
+    0x3C,0x1E,0x17,0x28,0x48,0x00,0x87,0x28,0x1E,0x4D,0x4F,0xDF,0x07,0x38,0x7E,0x18,0x2D,0x54,0x24,0x44,\
+    0x03,0x28,0x7D,0xC0,0x54,0xF2,0x00,0x0B,0x04,0xC8,0x36,0xA3,0x44,0x8D,0x52,0x80,0x60,0x78,0x6E,0x74,\
+    0x42,0x4B,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0F,0x1E,0x08,0x00,0x46,0xF5,0x40,\
+    0x69,0x6C,0x6D,0x53,0x26,0x75,0x00,0x00,0x01,0x73,0x0A,0x32,0xFC,0x9C,0x84,0x00,0x00,0x00,0x00,0x00,\
+    0x00,0x00,0x00,0x20,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x56,0xDF,0x07,0x50,0x28,\
+    0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17,0x18,0x19,0x1A,0x1B,0x1C,0x1D,0x1E,0x1F,0x0F,0x0C,0x0D,0x0E,\
+    0x09,0x08,0x07,0x06,0x02,0x04,0x03,0x05,0x0A,0x0B,0xFF,0xFF,0x1A,0x18,0x19,0x04,0x05,0x06,0x07,0x08,\
+    0x09,0x0B,0x0F,0x0C,0x0E,0x0D,0x0A,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0x00,0x30,0x40,0x83,0x00,0x05,\
+    0x04,0x0C,0x81,0x23,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x14,0x88,0x34,0x65,\
+    0x78,0x00,0x14,0x50,0x6D,0x31,0x14,0x50,0x00,0x44,0x10,0x00,0x23,0x9D,0x09,0x26,0xF5,0xCF,0x01};
+
+/*****************************End of config data*****************************/
+
+/***************************Start of struct declare**************************/
+struct fw_subsystem_info {
+    int type;
+    int length;
+    u32 address;
+    int offset;
+};
+
+struct fw_info {
+    u32 length;
+    u16 checksum;
+    u8 target_mask[6];
+    u8 target_mask_version[3];
+    u8 pid[6];
+    u8 version[3];
+    u8 subsystem_count;
+    u8 chip_type;
+    u8 reserved[6];
+    struct fw_subsystem_info subsystem[12];
+};
+
+
+struct goodix_register {
+    uint16_t GTP_REG_FW_CHK_MAINSYS;        /*mainsys reg used to check fw status*/
+    uint16_t GTP_REG_FW_CHK_SUBSYS;         /*subsys reg used to check fw status*/
+    uint16_t GTP_REG_CONFIG_DATA;           /*configure firmware*/
+    uint16_t GTP_REG_READ_COOR;             /*touch state and info*/
+    uint16_t GTP_REG_PRODUCT_VER;           /*product id & version*/
+    uint16_t GTP_REG_WAKEUP_GESTURE;        /*gesture type*/
+    uint16_t GTP_REG_GESTURE_COOR;          /*gesture point data*/
+    uint16_t GTP_REG_CMD;                   /*recevice cmd from host*/
+    uint16_t GTP_REG_RQST;                  /*request from ic*/
+    uint16_t GTP_REG_NOISE_DETECT;          /*noise state*/
+    uint16_t GTP_REG_WATER_PROTECT_QUERY;    /*water protect state*/
+
+    uint16_t GTP_REG_RAWDATA;
+    uint16_t GTP_REG_DIFFDATA;
+    uint16_t GTP_REG_BASEDATA;
+
+    uint16_t _rRW_MISCTL__SWRST_B0_;
+    uint16_t _bRW_MISCTL__DSP_MCU_PWR_;
+    uint16_t _bRW_MISCTL__TMR0_EN;
+    uint16_t _bRW_MISCTL__CACHE_EN;
+    uint16_t _bWO_MISCTL__CPU_SWRST_PULSE;
+    uint16_t _rRW_MISCTL__BOOT_OPT_B0_;
+    uint16_t _bRW_MISCTL__SRAM_BANK;
+    uint16_t _bRW_MISCTL__PATCH_AREA_EN_;
+};
+
+
+struct config_info {
+    char    *goodix_config_ver;
+    u8      *goodix_config;
+    u8      goodix_int_type;
+    u8      goodix_wakeup_level;
+    u32     goodix_abs_x_max;
+    u32     goodix_abs_y_max;
+    u32     goodix_config_len;
+};
+
+struct goodix_version_info {
+    u8   product_id[5];
+    u32  patch_id;
+    u32  mask_id;
+    u8   sensor_id;
+    u8   match_opt;
+};
+
+struct  chip_data_gt9286 {
+    bool                                halt_status;                    //1: need ic reset
+    u8                                  *touch_data;
+    tp_dev                              tp_type;
+    u16                                 *spuri_fp_touch_raw_data;
+    struct i2c_client                   *client;
+    struct goodix_version_info          ver_info;
+    struct config_info                  config_info;
+    struct goodix_register              reg_info;
+    struct fw_update_info               update_info;
+    struct hw_resource                  *hw_res;
+    struct goodix_proc_operations       *goodix_ops;                    //goodix func provide for debug
+    bool                                esd_check_enabled;
+    unsigned long                       irq_timer;
+    uint8_t                             esd_retry;
+};
+
+/****************************End of struct declare***************************/
+
+extern int gt1x_rawdiff_mode;
+
+#endif/*TOUCHPANEL_GOODIX_OPPO_H*/
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..b63ef4c112bc70180cfa68d3a128f0bbff131a05
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Kconfig
@@ -0,0 +1,7 @@
+
+config TOUCHPANEL_GOODIX_GT5688
+#	default y
+	bool "TP TOUCHPANEL_GOODIX_GT5688 IC enable or not"
+	---help---
+	say Y to enable driver for Touchpanel useing TOUCHPANEL_GOODIX_GT5688
+	
\ No newline at end of file
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..e94c42438b868bd36ad4c80c1e4f12e8291c1bb1
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Makefile
@@ -0,0 +1,8 @@
+#gt915 touchpanel driver
+
+
+obj-$(CONFIG_TOUCHPANEL_GOODIX_GT5688)	+= gt1x_driver.o
+#obj-$(CONFIG_GT5688_TOUCHPANEL_DRIVER)	+= gt1x_extents.o
+#obj-$(CONFIG_GT5688_TOUCHPANEL_DRIVER)	+= gt1x_generic.o
+#obj-$(CONFIG_GT5688_TOUCHPANEL_DEBUG)	+= gt1x_tools.o
+#obj-$(CONFIG_GT5688_TOUCHPANEL_UPDATE)	+= gt1x_update.o
\ No newline at end of file
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_driver.h b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_driver.h
new file mode 100644
index 0000000000000000000000000000000000000000..61b550a15757cdf3f48ca4c893aa80262c437204
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_driver.h
@@ -0,0 +1,187 @@
+/***************************************************
+ * File:gt1x_oppo.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             goodix gt5688 driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef TOUCHPANEL_GOODIX_DRIVER_H
+#define TOUCHPANEL_GOODIX_DRIVER_H
+
+#include "../goodix_common.h"
+#include "../goodix_tool.h"
+#include "gt1x_generic_driver.h"
+
+#define set_reg_bit(reg, pos, val)        ((reg) = ((reg) & (~(1 << (pos)))) | (!!(val) << (pos)))
+
+#define MAX_GT_IRQ_DATA_LENGTH 90  //irq data(points,key,checksum) size read from irq.
+
+/****************************PART1:ON/OFF define****************************/
+#define GTP_DRIVER_SEND_CFG   1    // send config to TP while initializing (for no config built in TP's flash)
+
+/****************************PART2:Request type define*******************************/
+#define GTP_RQST_CONFIG                 0x01
+#define GTP_RQST_BAK_REF                0x02
+#define GTP_RQST_RESET                  0x03
+#define GTP_RQST_MAIN_CLOCK             0x04
+#define GTP_RQST_HOTKNOT_CODE           0x20
+#define GTP_RQST_RESPONDED              0x00
+#define GTP_RQST_IDLE                   0xFF
+
+/****************************PART3:CMD define*******************************/
+#define GTP_CMD_SLEEP                   0x05
+#define GTP_CMD_CHARGER_ON              0x06
+#define GTP_CMD_CHARGER_OFF             0x07
+#define GTP_CMD_GESTURE_WAKEUP          0x08
+#define GTP_CMD_CLEAR_CFG               0x10
+#define GTP_CMD_ESD                     0xAA
+#define GTP_CMD_HN_TRANSFER             0x22
+#define GTP_CMD_HN_EXIT_SLAVE           0x28
+
+/****************************PART4:Gesture detect****************************/
+#define DTAP_DETECT                     0xCC
+#define UP_VEE_DETECT                   0x76
+#define DOWN_VEE_DETECT                 0x5e
+#define LEFT_VEE_DETECT                 0x3e 
+#define RIGHT_VEE_DETECT                0x63
+#define CIRCLE_DETECT                   0x6f
+#define DOUSWIP_DETECT                  0x48
+#define DOUUPSWIP_DETECT                0x4E
+#define RIGHT_SLIDE_DETECT              0xAA
+#define LEFT_SLIDE_DETECT               0xbb
+#define DOWN_SLIDE_DETECT               0xAB
+#define UP_SLIDE_DETECT                 0xBA
+#define M_DETECT                        0x6D
+#define W_DETECT                        0x77
+
+/*****************************PART5:SPURIOUS_FP and edge_limit********************/
+#define SPURIOUS_FP_RX_NUM              6
+#define GOODIX_ENABLE_EDGE              0X51
+#define GOODIX_DISABLE_EDGE             0X52
+
+
+struct fw_subsystem_info {
+    int type;
+    int length;
+    u32 address;
+    int offset;
+};
+
+struct fw_info {
+    u32 length;
+    u16 checksum;
+    u8 target_mask[6];
+    u8 target_mask_version[3];
+    u8 pid[6];
+    u8 version[3];
+    u8 subsystem_count;
+    u8 chip_type;
+    u8 reserved[6];
+    struct fw_subsystem_info subsystem[12];
+};
+
+/****************************PART6:Reg *************************************/
+struct Goodix_register {
+    /*Register define */
+#define GTP_READ_COOR_ADDR              0x814E
+#define GTP_REG_CMD                     0x8040
+#define GTP_REG_SENSOR_ID               0x814A
+#define GTP_REG_CONFIG_DATA             0x8050
+#define GTP_REG_CONFIG_RESOLUTION       0x8051
+#define GTP_REG_CONFIG_TRIGGER          0x8056
+#define GTP_REG_CONFIG_CHECKSUM         0x813C
+#define GTP_REG_CONFIG_UPDATE           0x813E
+#define GTP_REG_VERSION                 0x8140
+#define GTP_REG_HW_INFO                 0x4220
+#define GTP_REG_REFRESH_RATE            0x8056
+#define GTP_REG_ESD_CHECK               0x8043
+#define GTP_REG_FLASH_PASSBY            0x8006
+#define GTP_REG_HN_PAIRED               0x81AA
+#define GTP_REG_HN_MODE                 0x81A8
+#define GTP_REG_MODULE_SWITCH3          0x8058
+#define GTP_REG_FW_CHK_MAINSYS          0x41E4
+#define GTP_REG_FW_CHK_SUBSYS           0x5095
+#define GTP_NOISE_DETECT_REG            0x804B
+
+#define GTP_REG_WAKEUP_GESTURE          0x814C
+#define GTP_REG_WAKEUP_GESTURE_DETAIL   0x8A40
+
+#define GTP_REG_MATRIX_DRVNUM           0x8069
+#define GTP_REG_MATRIX_SENNUM           0x806A
+#define GTP_REG_RQST                    0x8044
+#define GTP_REG_BAK_REF                 0x90EC
+#define GTP_REG_MAIN_CLK                0x8020
+#define GTP_REG_HAVE_KEY                0x8057
+#define GTP_REG_HN_STATE                0x8800
+
+#define _bRW_MISCTL__SRAM_BANK          0x4048
+#define _bRW_MISCTL__MEM_CD_EN          0x4049
+#define _bRW_MISCTL__CACHE_EN           0x404B
+#define _bRW_MISCTL__TMR0_EN            0x40B0
+#define _rRW_MISCTL__SWRST_B0_          0x4180
+#define _bWO_MISCTL__CPU_SWRST_PULSE    0x4184
+#define _rRW_MISCTL__BOOTCTL_B0_        0x4190
+#define _rRW_MISCTL__BOOT_OPT_B0_       0x4218
+#define _rRW_MISCTL__BOOT_CTL_          0x5094
+#define _bRW_MISCTL__DSP_MCU_PWR_       0x4010
+#define _bRW_MISCTL__PATCH_AREA_EN_     0x404D
+
+#define GTP_REG_RAWDATA                 0xCBB4
+#define GTP_REG_DIFFDATA                0xC8DC
+#define GTP_REG_BASEDATA                0x84D0
+};
+
+typedef enum {
+    CFG_NORMAL,
+    CFG_NOISE,
+    CFG_CHARGER,
+}cfg_config;
+
+struct config_info {
+    char *config_version;
+    u8   *gt1x_config;
+    u8   gt1x_int_type;
+    u8   gt1x_wakeup_level;
+    u32  gt1x_abs_x_max;
+    u32  gt1x_abs_y_max;
+    u32  gt1x_cfg_length;
+};
+
+struct gt1x_version_info {
+    u8   product_id[5];
+    u32  patch_id;
+    u32  mask_id;
+    u8   sensor_id;
+    u8   match_opt;
+};
+
+struct  chip_data_gt5688 {
+    bool halt_status;
+    u8   coor_base;
+    u8   vk_status ;         /*state of key "select|select(keycode)|menu|menu(keycode)|home|home(keycode)|back|back(keycode)"*/
+    u8   *touch_data;
+    u16  *spuri_fp_touch_raw_data;                  /*save spurious_finger_support raw data*/
+
+    tp_dev tp_type;
+    struct i2c_client           *client;
+
+    struct gt1x_version_info    ver_info;
+    struct config_info          config_info;
+    struct Goodix_register      reg_info;
+    struct fw_update_info       update_info;
+    struct hw_resource          *hw_res;
+    struct goodix_proc_operations *goodix_ops;     //goodix func provide for debug
+};
+
+extern int gt1x_rawdiff_mode;
+
+#endif/*TOUCHPANEL_GOODIX_DRIVER_H*/
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_drivr.c b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_drivr.c
new file mode 100644
index 0000000000000000000000000000000000000000..64f3587b325abc64b88e9c5188f351b0f6dafae8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_drivr.c
@@ -0,0 +1,2562 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : GT1x_oppo.c
+ * Description: Source file for Goodix GT5688 driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/regulator/consumer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/jiffies.h>
+
+#include "gt1x_oppo.h"
+
+#define GTP_I2C_NAME                "Goodix-TS"
+
+struct chip_data_gt5688 *g_chip_info = NULL;
+unsigned long timeout = 0;
+
+#define TPD_DEVICE "Goodix-gt5688"
+#define TPD_INFO(fmt, arg...)        pr_err("[TP]"TPD_DEVICE ": " fmt, ##arg)
+#define TPD_DEBUG(fmt, arg...)       do{\
+    if (tp_debug)\
+    pr_err("[TP]"TPD_DEVICE ": " fmt, ##arg);\
+}while(0)
+
+static int gpio_set_int_level(struct hw_resource *hw_res, bool level);
+
+/**
+ * gt1x_send_cmd -  send cmd to Goodix ic for spcial device control.
+ * @client: i2c device struct.
+ * @cmd: value for cmd reg(0x8040)
+ * @data:value for data reg(0x8041)
+ * Return  0: succeed, non-0: failed.
+ */
+static s32 gt1x_send_cmd(struct i2c_client *client, u8 cmd, u8 data)
+{
+    s32 ret;
+    u8 buffer[3] = { cmd, data, 0 };
+    static DEFINE_MUTEX(cmd_mutex);
+
+    /**
+     * cmd format:
+     * reg:0x8040  cmd control(diffrent cmd indicates diffrent setting for touch IC )
+     * reg:0x8041  data reg(Correspond with 0x8040)
+     * reg:0x8042  checksum (sum(0x8040~0x8042) == 0)
+     */
+    mutex_lock(&cmd_mutex);
+    buffer[2] = (u8) ((0 - cmd - data) & 0xFF);
+    ret = touch_i2c_write_block(client, GTP_REG_CMD + 1, 2, &buffer[1]);
+    ret = touch_i2c_write_byte(client, GTP_REG_CMD, buffer[0]);
+    msleep(50);
+    mutex_unlock(&cmd_mutex);
+
+    return ret;
+}
+
+static int gesture_enter_doze(struct i2c_client *client)
+{
+    int retry = 0;
+
+    TPD_DEBUG("Entering doze mode...\n");
+
+    while (retry++ < 5) {
+        if (!gt1x_send_cmd(client, 0x08, 0)) {
+            TPD_INFO("Working in doze mode!\n");
+            return 0;
+        }
+        msleep(10);
+    }
+
+    TPD_INFO("Send doze cmd failed.\n");
+    return -1;
+}
+
+static s32 gt1x_enter_sleep(struct chip_data_gt5688 *chip_info)
+{
+    s32 retry = 0;
+
+    gpio_set_int_level(chip_info->hw_res, false);
+    mdelay(5);
+    while (retry++ < 3) {
+        if (!gt1x_send_cmd(chip_info->client, GTP_CMD_SLEEP, 0)) {
+            TPD_INFO("Enter sleep mode!\n");
+            return 0;
+        }
+        msleep(10);
+    }
+
+    TPD_INFO("Enter sleep mode failed.\n");
+
+    return -1;
+}
+
+static int gpio_set_int_level(struct hw_resource *hw_res, bool level)
+{
+    int ret = -1;
+
+    if (level) {
+        ret = pinctrl_select_state(hw_res->pinctrl, hw_res->pin_set_high);
+        if (ret)
+            TPD_INFO("cannot set pin to high state");
+    } else {
+        ret = pinctrl_select_state(hw_res->pinctrl, hw_res->pin_set_low);
+        if (ret)
+            TPD_INFO("cannot set pin to low state");
+    }
+
+    return ret;
+}
+
+static int gpio_set_int_nopull(struct hw_resource *hw_res)
+{
+    int ret = -1;
+
+    ret = pinctrl_select_state(hw_res->pinctrl, hw_res->pin_set_nopull);
+    if (ret)
+        TPD_INFO("cannot set pin to input state");
+
+    return ret;
+}
+
+static void gt1x_select_addr(struct i2c_client *client, struct hw_resource *hw_res)
+{
+    gpio_direction_output(hw_res->reset_gpio, 0);
+    if (client->addr == 0x14) {
+        gpio_set_int_level(hw_res, true);
+    } else {
+        gpio_set_int_level(hw_res, false);
+    }
+    mdelay(2);
+    gpio_direction_output(hw_res->reset_gpio, 1);
+    mdelay(8);
+    gpio_set_int_nopull(hw_res);
+}
+
+/*
+ * Return 0: succeed, < 0 : failed.
+ */
+static s32 gt1x_set_reset_status(struct i2c_client* client)
+{
+    /* 0x8040 ~ 0x8043 */
+    u8 value[] = {0xAA, 0x00, 0x56, 0xAA};
+    int ret;
+
+    ret = touch_i2c_write_block(client, GTP_REG_CMD + 1, 3, &value[1]);
+    if (ret < 0) {
+        TPD_DEBUG("TP set_reset_status failed\n");
+        return ret;
+    }
+
+    return touch_i2c_write_byte(client, GTP_REG_CMD, value[0]);
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int goodix_reset(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    TPD_INFO("%s reset happened!\n", __func__);
+    gt1x_select_addr(chip_info->client, chip_info->hw_res);
+    msleep(50);
+    ret = gt1x_set_reset_status(chip_info->client);
+    chip_info->halt_status = false;
+    return ret;
+}
+
+/**
+ * gt1x_send_cfg - Send gt1x_config Function.
+ * @config: pointer of the configuration array.
+ * @cfg_len: length of configuration array.
+ * Return 0:success, non-0:fail.
+ */
+static s32 gt1x_send_cfg(struct i2c_client *client, u8 * config, int cfg_len)
+{
+    int i;
+    s32 ret = 0;
+    s32 retry = 0;
+    u16 checksum = 0;
+
+    TPD_DEBUG("Driver send config, length:%d\n", cfg_len);
+
+    for (i = 0; i < cfg_len - 3; i += 2) {
+        checksum += (config[i] << 8) + config[i + 1];
+    }
+    if (!checksum) {
+        TPD_INFO("Invalid config, all of the bytes is zero!\n");
+        return -1;
+    }
+
+    checksum = 0 - checksum;
+    TPD_DEBUG("Config checksum: 0x%04X\n", checksum);
+    config[cfg_len - 3] = (checksum >> 8) & 0xFF;
+    config[cfg_len - 2] = checksum & 0xFF;
+    config[cfg_len - 1] = 0x01;
+
+    while (retry++ < 5) {
+        ret = touch_i2c_write_block(client, GTP_REG_CONFIG_DATA, cfg_len, config);
+        if (ret == cfg_len) {
+            msleep(200);    /* at least 200ms, wait for storing config into flash. */
+            TPD_DEBUG("Send config successfully!\n");
+            return 0;
+        }
+    }
+
+    TPD_INFO("Send config failed!\n");
+
+    return ret;
+}
+
+/**
+ * gt1x_init_panel - Prepare config data for touch ic, don't call this function
+ * after initialization.
+ *
+ * Return 0:success, < 0:fail.
+ */
+static int gt1x_init_panel(struct chip_data_gt5688 *chip_info, cfg_config cfg_config)
+{
+    s32 ret = 0;
+
+    switch (cfg_config) {
+        case CFG_NORMAL:
+            chip_info->config_info.gt1x_config = GTP_CFG_GROUP_OFLIM;
+            chip_info->config_info.gt1x_cfg_length = sizeof(GTP_CFG_GROUP_OFLIM);
+            if (chip_info->tp_type == TP_BIEL) {
+                chip_info->config_info.gt1x_config = GTP_CFG_GROUP_BIEL;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_CFG_GROUP_BIEL);
+            } else if (chip_info->tp_type == TP_TRULY) {
+                chip_info->config_info.gt1x_config = GTP_CFG_GROUP_TRULY;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_CFG_GROUP_TRULY);
+            } else if (chip_info->tp_type == TP_BOE) {
+                chip_info->config_info.gt1x_config = GTP_CFG_GROUP_BOE;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_CFG_GROUP_BOE);
+            }
+            break;
+
+        case CFG_NOISE:
+            chip_info->config_info.gt1x_config = GTP_NOISE_CFG_GROUP_OFLIM;
+            chip_info->config_info.gt1x_cfg_length = sizeof(GTP_NOISE_CFG_GROUP_OFLIM);
+            if (chip_info->tp_type == TP_BIEL) {
+                chip_info->config_info.gt1x_config = GTP_NOISE_CFG_GROUP_BIEL;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_NOISE_CFG_GROUP_BIEL);
+            } else if (chip_info->tp_type == TP_TRULY) {
+                chip_info->config_info.gt1x_config = GTP_NOISE_CFG_GROUP_TRULY;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_NOISE_CFG_GROUP_TRULY);
+            } else if (chip_info->tp_type == TP_BOE) {
+                chip_info->config_info.gt1x_config = GTP_NOISE_CFG_GROUP_BOE;
+                chip_info->config_info.gt1x_cfg_length = sizeof(GTP_NOISE_CFG_GROUP_BOE);
+            }
+            break;
+
+        default:
+            break;
+    }
+    TPD_DEBUG("cfg_config %d sizeof(chip_info->gt1x_config) is %d\n", cfg_config, chip_info->config_info.gt1x_cfg_length);
+
+    if (chip_info->config_info.gt1x_cfg_length < GTP_CONFIG_MIN_LENGTH || chip_info->config_info.gt1x_cfg_length > GTP_CONFIG_MAX_LENGTH) {
+        TPD_INFO("Config is INVALID! You need to check you header file CFG_GROUP section!\n");
+        return -1;
+    }
+
+    /* clear the flag, avoid failure when send the_config of driver. */
+    chip_info->config_info.gt1x_config[0] &= 0x7F;
+
+    /* match resolution when gt1x_abs_x_max & gt1x_abs_y_max have been set already */
+    if ((chip_info->config_info.gt1x_abs_x_max == 0) && (chip_info->config_info.gt1x_abs_y_max == 0)) {
+        chip_info->config_info.gt1x_abs_x_max = (chip_info->config_info.gt1x_config[RESOLUTION_LOC + 1] << 8) + chip_info->config_info.gt1x_config[RESOLUTION_LOC];
+        chip_info->config_info.gt1x_abs_y_max = (chip_info->config_info.gt1x_config[RESOLUTION_LOC + 3] << 8) + chip_info->config_info.gt1x_config[RESOLUTION_LOC + 2];
+        chip_info->config_info.gt1x_int_type = (chip_info->config_info.gt1x_config[TRIGGER_LOC]) & 0x03;
+        chip_info->config_info.gt1x_wakeup_level = !(chip_info->config_info.gt1x_config[MODULE_SWITCH3_LOC] & 0x20);
+    } else {
+        chip_info->config_info.gt1x_config[RESOLUTION_LOC] = (u8) chip_info->config_info.gt1x_abs_x_max;
+        chip_info->config_info.gt1x_config[RESOLUTION_LOC + 1] = (u8) (chip_info->config_info.gt1x_abs_x_max >> 8);
+        chip_info->config_info.gt1x_config[RESOLUTION_LOC + 2] = (u8) chip_info->config_info.gt1x_abs_y_max;
+        chip_info->config_info.gt1x_config[RESOLUTION_LOC + 3] = (u8) (chip_info->config_info.gt1x_abs_y_max >> 8);
+        set_reg_bit(chip_info->config_info.gt1x_config[MODULE_SWITCH3_LOC], 5, !chip_info->config_info.gt1x_wakeup_level);
+        chip_info->config_info.gt1x_config[TRIGGER_LOC] = (chip_info->config_info.gt1x_config[TRIGGER_LOC] & 0xFC) | chip_info->config_info.gt1x_int_type;
+    }
+
+    TPD_INFO("X_MAX = %d, Y_MAX = %d, TRIGGER = 0x%02x, WAKEUP_LEVEL = %d\n",
+            chip_info->config_info.gt1x_abs_x_max, chip_info->config_info.gt1x_abs_y_max,
+            chip_info->config_info.gt1x_int_type, chip_info->config_info.gt1x_wakeup_level);
+
+    ret = gt1x_send_cfg(chip_info->client, chip_info->config_info.gt1x_config, chip_info->config_info.gt1x_cfg_length);
+
+    return ret;
+}
+
+/**
+ * Return 0: success, < 0: i2c read fail, >0: check fail
+ */
+s32 gt1x_i2c_read_dbl_check(struct i2c_client *client, u16 addr, u8 * buffer, s32 len)
+{
+    u8 buf[16] = {0};
+    u8 confirm_buf[16] = {0};
+    int ret = -1;
+
+    if (len > 16) {
+        TPD_INFO("i2c_read_dbl_check length %d is too long, exceed %zu\n", len, sizeof(buf));
+        return ret;
+    }
+
+    memset(buf, 0xAA, sizeof(buf));
+    ret = touch_i2c_read_block(client, addr, len, buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    msleep(5);
+    memset(confirm_buf, 0, sizeof(confirm_buf));
+    ret = touch_i2c_read_block(client, addr, len, confirm_buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    if (!memcmp(buf, confirm_buf, len)) {
+        memcpy(buffer, confirm_buf, len);
+        return 0;
+    }
+
+    TPD_INFO("i2c read 0x%04X, %d bytes, double check failed!\n", addr, len);
+
+    return 1;
+}
+
+static int gt1x_i2c_write_with_readback(struct i2c_client *client, u16 addr, u8 * buffer, int length)
+{
+    u8 buf[100];
+
+    int ret = touch_i2c_write_block(client, addr, length, buffer);
+    if (ret < 0) {
+        return ret;
+    }
+
+    ret = touch_i2c_read_block(client, addr, length, buf);
+    if (ret < 0) {
+        return ret;
+    }
+
+    if (memcmp(buf, buffer, length)) {
+        return -1;
+    }
+
+    return 0;
+}
+
+static s32 gt1x_read_version(struct chip_data_gt5688 *chip_info)
+{
+    s32 ret = -1;
+    u8 buf[12] = {0};
+    u32 mask_id = 0;
+    u32 patch_id = 0;
+    u8 product_id[5] = {0};
+    u8 sensor_id = 0;
+    u8 match_opt = 0;
+    int i, retry = 3;
+    u8 checksum = 0;
+    struct gt1x_version_info * ver_info = &chip_info->ver_info;
+
+    while (retry--) {
+        ret = gt1x_i2c_read_dbl_check(chip_info->client, GTP_REG_VERSION, buf, sizeof(buf));
+        if (!ret) {
+            checksum = 0;
+
+            for (i = 0; i < sizeof(buf); i++) {
+                checksum += buf[i];
+            }
+
+            if (checksum == 0 &&    /* first 3 bytes must be number or char */
+                    IS_NUM_OR_CHAR(buf[0]) && IS_NUM_OR_CHAR(buf[1]) && IS_NUM_OR_CHAR(buf[2]) && buf[10] != 0xFF) {    /*sensor id == 0xFF, retry */
+                break;
+            } else {
+                TPD_INFO("Read version failed!(checksum error)\n");
+            }
+        } else {
+            TPD_INFO("Read version failed!\n");
+        }
+
+        TPD_DEBUG("Read version retry = %d\n", retry);
+        msleep(100);
+    }
+
+    if (retry <= 0) {
+        if (ver_info)
+            ver_info->sensor_id = 0;
+        TPD_INFO("Maybe the firmware of ic is error\n");
+        //return -1;
+    }
+
+    mask_id = (u32) ((buf[7] << 16) | (buf[8] << 8) | buf[9]);
+    patch_id = (u32) ((buf[4] << 16) | (buf[5] << 8) | buf[6]);
+    memcpy(product_id, buf, 4);
+    sensor_id = buf[10] & 0x0F;
+    match_opt = (buf[10] >> 4) & 0x0F;
+
+    TPD_INFO("IC VERSION:GT%s(Product)_%06X(Patch)_%04X(Mask)_%02X(SensorID)\n", product_id, patch_id, mask_id >> 8, sensor_id);
+
+    if (ver_info != NULL) {
+        ver_info->mask_id = mask_id;
+        ver_info->patch_id = patch_id;
+        memcpy(ver_info->product_id, product_id, 5);
+        ver_info->sensor_id = sensor_id;
+        ver_info->match_opt = match_opt;
+    }
+
+    return 0;
+}
+
+static u16 gt1x_calc_checksum(u8 * fw, u32 length)
+{
+    u32 i = 0;
+    u32 checksum = 0;
+
+    for (i = 0; i < length; i += 2) {
+        checksum += (((int)fw[i]) << 8);
+        checksum += fw[i + 1];
+    }
+
+    return (checksum & 0xFFFF);
+}
+
+static int gt1x_read_flash(struct i2c_client* client, u32 addr, int length)
+{
+    int wait_time;
+    int ret = 0;
+    u8 buffer[4];
+    u16 read_addr = (addr >> 8);
+
+    TPD_INFO("Read flash: 0x%04X, length: %d\n", addr, length);
+
+    buffer[0] = 0;
+    ret = gt1x_i2c_write_with_readback(client, 0x8022, buffer, 1);
+
+    buffer[0] = ((length >> 8) & 0xFF);
+    buffer[1] = (length & 0xFF);
+    buffer[2] = ((read_addr >> 8) & 0xFF);
+    buffer[3] = (read_addr & 0xFF);
+    ret |= gt1x_i2c_write_with_readback(client, 0x8100, buffer, 4);
+
+    buffer[0] = 0xAA;
+    buffer[1] = 0xAA;
+    ret |= touch_i2c_write_block(client, 0x8020, 2, buffer);
+    if (ret < 0) {
+        TPD_INFO("Error occured.\n");
+        return ret;
+    }
+
+    wait_time = 200;
+    while (wait_time > 0) {
+        wait_time--;
+        msleep(5);
+        ret = gt1x_i2c_read_dbl_check(client, 0x8022, buffer, 1);
+        if (ret) {
+            continue;
+        }
+        if (buffer[0] == 0xBB) {
+            TPD_INFO("Read success(addr: 0x%04X, length: %d)\n", addr, length);
+            break;
+        }
+    }
+    if (wait_time == 0) {
+        TPD_INFO("Read Flash FAIL!\n");
+        return -1;
+    }
+
+    return 0;
+}
+
+static int gt1x_recall_check(struct i2c_client* client, u8 * chk_src, u16 start_addr, u16 chk_length)
+{
+    u8 rd_buf[PACK_SIZE];
+    s32 ret = 0;
+    u16 len = 0;
+    u32 compared_length = 0;
+
+    while (chk_length > 0) {
+        len = (chk_length > PACK_SIZE ? PACK_SIZE : chk_length);
+
+        ret = touch_i2c_read_block(client, start_addr + compared_length, len, rd_buf);
+        if (ret < 0) {
+            TPD_INFO("recall i2c error, exit!\n");
+            return ret;
+        }
+
+        if (memcmp(rd_buf, &chk_src[compared_length], len)) {
+            TPD_INFO("Recall frame not equal(addr: 0x%04X)\n", start_addr + compared_length);
+            return -1;
+        }
+
+        chk_length -= len;
+        compared_length += len;
+    }
+
+    TPD_DEBUG("Recall check %d bytes(address: 0x%04X) success.\n", compared_length, start_addr);
+
+    return 0;
+}
+
+#define getU32(a) ((u32)getUint((u8 *)(a), 4))
+#define getU16(a) ((u16)getUint((u8 *)(a), 2))
+static u32 getUint(u8 * buffer, int len)
+{
+    u32 num = 0;
+    int i;
+    for (i = 0; i < len; i++) {
+        num <<= 8;
+        num += buffer[i];
+    }
+
+    return num;
+}
+
+/*
+ * gt1x_get_fw_data - Read firmware file data to buffer
+ * Return: return a pointer pointed at the content of firmware
+ */
+static u8 *gt1x_get_fw_data(struct chip_data_gt5688 *chip_info, u32 offset, int length)
+{
+    memcpy(chip_info->update_info.buffer, chip_info->update_info.firmware_file_data + offset, length);
+
+    return chip_info->update_info.buffer;
+}
+
+static int __gt1x_hold_ss51_dsp_20(struct i2c_client* client)
+{
+    int ret = -1;
+    int retry = 0;
+    u8 buf[1];
+    int hold_times = 0;
+
+    while (retry++ < 30) {
+        // Hold ss51 & dsp
+        buf[0] = 0x0C;
+        ret = touch_i2c_write_byte(client, _rRW_MISCTL__SWRST_B0_, buf[0]);
+        if (ret < 0) {
+            TPD_INFO("Hold ss51 & dsp I2C error, retry:%d\n", retry);
+            continue;
+        }
+        // Confirm hold
+        ret = touch_i2c_read_byte(client, _rRW_MISCTL__SWRST_B0_);
+        if (ret < 0) {
+            TPD_INFO("Hold ss51 & dsp I2C error, retry:%d\n", retry);
+            continue;
+        }
+        if (0x0C == ret) {
+            if (hold_times++ < 20) {
+                continue;
+            } else {
+                break;
+            }
+        }
+        TPD_INFO("Hold ss51 & dsp confirm 0x4180 failed, value:%d\n", buf[0]);
+    }
+
+    if (retry >= 30) {
+        TPD_INFO("Hold ss51&dsp failed!\n");
+        return -1;
+    }
+
+    TPD_INFO("Hold ss51&dsp successfully.\n");
+
+    return 0;
+}
+
+/**
+ * Return 0: success, < 0: i2c read fail, >0: check fail
+ */
+static int gt1x_hold_ss51_dsp(struct i2c_client* client)
+{
+    int ret = 0, retry = 5;
+    u8 buffer[2];
+
+    do {
+        ret = touch_i2c_read_block(client, 0x4220, 1, buffer);
+    } while (retry-- && ret < 0);
+
+    if (ret < 0)
+        return -1;
+
+    //hold ss51_dsp
+    ret = __gt1x_hold_ss51_dsp_20(client);
+    if (ret) {
+        return ret;
+    }
+    // enable dsp & mcu power
+    buffer[0] = 0x00;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__DSP_MCU_PWR_, buffer, 1);
+    if (ret) {
+        TPD_INFO("enabel dsp & mcu power fail!\n");
+        return ret;
+    }
+    // disable watchdog
+    buffer[0] = 0x00;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__TMR0_EN, buffer, 1);
+    if (ret) {
+        TPD_INFO("disable wdt fail!\n");
+        return ret;
+    }
+    // clear cache
+    buffer[0] = 0x00;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__CACHE_EN, buffer, 1);
+    if (ret) {
+        TPD_INFO("clear cache fail!\n");
+        return ret;
+    }
+    // soft reset
+    buffer[0] = 0x01;
+    ret = touch_i2c_write_block(client, _bWO_MISCTL__CPU_SWRST_PULSE, 1, buffer);
+    if (ret < 0) {
+        TPD_INFO("software reset fail!\n");
+        return ret;
+    }
+    // set scramble
+    buffer[0] = 0x00;
+    ret = gt1x_i2c_write_with_readback(client, _rRW_MISCTL__BOOT_OPT_B0_, buffer, 1);
+    if (ret) {
+        TPD_INFO("set scramble fail!\n");
+        return ret;
+    }
+
+    return 0;
+}
+
+static int gt1x_run_ss51_isp(struct i2c_client* client, u8 * ss51_isp, int length)
+{
+    int ret;
+    u8 buffer[10];
+
+    ret = gt1x_hold_ss51_dsp(client);
+    if (ret) {
+        return ret;
+    }
+    // select bank4
+    buffer[0] = 0x04;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__SRAM_BANK, buffer, 1);
+    if (ret) {
+        TPD_INFO("select bank4 fail.\n");
+        return ret;
+    }
+    // enable patch area access
+    buffer[0] = 0x01;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__PATCH_AREA_EN_, buffer, 1);
+    if (ret) {
+        TPD_INFO("enable patch area access fail!\n");
+        return ret;
+    }
+
+    TPD_INFO("ss51_isp length: %d, checksum: 0x%04X\n", length, gt1x_calc_checksum(ss51_isp, length));
+    // load ss51 isp
+    ret = touch_i2c_write_block(client, 0xC000, length, ss51_isp);
+    if (ret < 0) {
+        TPD_INFO("load ss51 isp fail!\n");
+        return ret;
+    }
+    // recall compare
+    ret = gt1x_recall_check(client, ss51_isp, 0xC000, length);
+    if (ret) {
+        TPD_INFO("recall check ss51 isp fail!\n");
+        return ret;
+    }
+
+    memset(buffer, 0xAA, 10);
+    ret = gt1x_i2c_write_with_readback(client, 0x8140, buffer, 10);
+
+    // disable patch area access
+    buffer[0] = 0x00;
+    ret = gt1x_i2c_write_with_readback(client, _bRW_MISCTL__PATCH_AREA_EN_, buffer, 1);
+    if (ret) {
+        TPD_INFO("disable patch area access fail!\n");
+        return ret;
+    }
+    // set 0x8006
+    memset(buffer, 0x55, 8);
+    ret = gt1x_i2c_write_with_readback(client, 0x8006, buffer, 8);
+    if (ret) {
+        TPD_INFO("set 0x8006[0~7] 0x55 fail!\n");
+        return ret;
+    }
+    // release ss51
+    buffer[0] = 0x08;
+    ret = gt1x_i2c_write_with_readback(client, _rRW_MISCTL__SWRST_B0_, buffer, 1);
+    if (ret) {
+        TPD_INFO("release ss51 fail!\n");
+        return ret;
+    }
+
+    msleep(100);
+    // check run state
+    ret = touch_i2c_read_block(client, 0x8006, 2, buffer);
+    if (ret < 0) {
+        TPD_INFO("read 0x8006 fail!\n");
+        return ret;
+    }
+    if (!(buffer[0] == 0xAA && buffer[1] == 0xBB)) {
+        TPD_INFO("ERROR: isp is not running! 0x8006: %02X %02X\n", buffer[0], buffer[1]);
+        return -1;
+    }
+
+    return 0;
+}
+
+static int gt1x_error_erase(struct chip_data_gt5688 *chip_info)
+{
+    int block_len;
+    u16 checksum;
+    u16 erase_addr;
+    u8 buffer[10];
+    int ret;
+    int wait_time;
+    int burn_state = -1;
+    int retry = 5;
+    u8 *fw = NULL;
+
+    TPD_INFO("Erase flash area of ss51.\n");
+
+    goodix_reset(chip_info);
+
+    fw = gt1x_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset,
+            chip_info->update_info.firmware->subsystem[0].length);
+    if (fw == NULL) {
+        TPD_INFO("get isp fail\n");
+        return -1;
+    }
+    gt1x_select_addr(chip_info->client, chip_info->hw_res);
+    ret = gt1x_run_ss51_isp(chip_info->client, fw, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        return -1;
+    }
+
+    fw = kmalloc(1024 * 4, GFP_KERNEL);
+    if (!fw) {
+        TPD_INFO("error when alloc mem.\n");
+        return -1;
+    }
+
+    memset(fw, 0xFF, 1024 * 4);
+    erase_addr = 0x00;
+    block_len = 1024 * 4;
+
+    while (retry-- > 0) {
+
+        checksum = 0;
+        checksum += block_len;
+        checksum += erase_addr;
+        checksum += gt1x_calc_checksum(fw, block_len);
+        checksum = (0 - checksum);
+
+        buffer[0] = ((block_len >> 8) & 0xFF);
+        buffer[1] = (block_len & 0xFF);
+        buffer[2] = ((erase_addr >> 8) & 0xFF);
+        buffer[3] = (erase_addr & 0xFF);
+
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8100, buffer, 4);
+        if (ret) {
+            TPD_INFO("write length & address fail!\n");
+            continue;
+        }
+
+        ret = touch_i2c_write_block(chip_info->client, 0x8100 + 4, block_len, fw);
+        if (ret < 0) {
+            TPD_INFO("write fw data fail!\n");
+            continue;
+        }
+
+        ret = gt1x_recall_check(chip_info->client, fw, 0x8100 + 4, block_len);
+        if (ret) {
+            continue;
+        }
+
+        buffer[0] = ((checksum >> 8) & 0xFF);
+        buffer[1] = (checksum & 0xFF);
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8100 + 4 + block_len, buffer, 2);
+        if (ret) {
+            TPD_INFO("write checksum fail!\n");
+            continue;
+        }
+
+        buffer[0] = 0;
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8022, buffer, 1);
+        if (ret) {
+            TPD_INFO("clear control flag fail!\n");
+            continue;
+        }
+
+        buffer[0] = FW_SECTION_TYPE_SS51_PATCH;
+        buffer[1] = FW_SECTION_TYPE_SS51_PATCH;
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8020, buffer, 2);
+        if (ret) {
+            TPD_INFO("write subsystem type fail!\n");
+            continue;
+        }
+        burn_state = -1;
+        wait_time = 200;
+        while (wait_time > 0) {
+            wait_time--;
+            msleep(5);
+            ret = gt1x_i2c_read_dbl_check(chip_info->client, 0x8022, buffer, 1);
+            if (ret) {
+                continue;
+            }
+
+            if (buffer[0] == 0xAA) {
+                TPD_DEBUG("burning.....\n");
+                continue;
+            } else if (buffer[0] == 0xDD) {
+                TPD_INFO("checksum error!\n");
+                break;
+            } else if (buffer[0] == 0xBB) {
+                TPD_INFO("burning success.\n");
+                burn_state = 0;
+                break;
+            } else if (buffer[0] == 0xCC) {
+                TPD_INFO("burning failed!\n");
+                break;
+            } else {
+                TPD_DEBUG("unknown state!(0x8022: 0x%02X)\n", buffer[0]);
+            }
+        }
+    }
+
+    kfree(fw);
+    if (burn_state == 0) {
+        return 0;
+    } else {
+        return -1;
+    }
+}
+
+static int gt1x_burn_subsystem(struct chip_data_gt5688 *chip_info, struct fw_subsystem_info *subsystem)
+{
+    int block_len;
+    u16 checksum;
+    int burn_len = 0;
+    u16 cur_addr;
+    u32 length = subsystem->length;
+    u8 buffer[10];
+    int ret;
+    int wait_time;
+    int burn_state;
+    int retry = 5;
+    u8 *fw;
+
+    TPD_INFO("Subsystem: %d, Length: %d, Address: 0x%08X\n", subsystem->type, subsystem->length, subsystem->address);
+
+    while (length > 0 && retry > 0) {
+        retry--;
+
+        block_len = length > 1024 * 4 ? 1024 * 4 : length;
+
+        TPD_INFO("Burn block ==> length: %d, address: 0x%08X\n", block_len, subsystem->address + burn_len);
+        fw = gt1x_get_fw_data(chip_info, subsystem->offset + burn_len, block_len);
+        if (fw == NULL) {
+            return -1;
+        }
+
+        cur_addr = ((subsystem->address + burn_len) >> 8);
+
+        checksum = 0;
+        checksum += block_len;
+        checksum += cur_addr;
+        checksum += gt1x_calc_checksum(fw, block_len);
+        checksum = (0 - checksum);
+
+        buffer[0] = ((block_len >> 8) & 0xFF);
+        buffer[1] = (block_len & 0xFF);
+        buffer[2] = ((cur_addr >> 8) & 0xFF);
+        buffer[3] = (cur_addr & 0xFF);
+
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8100, buffer, 4);
+        if (ret) {
+            TPD_INFO("write length & address fail!\n");
+            continue;
+        }
+
+        ret = touch_i2c_write_block(chip_info->client, 0x8100 + 4, block_len, fw);
+        if (ret < 0) {
+            TPD_INFO("write fw data fail!\n");
+            continue;
+        }
+
+        buffer[0] = ((checksum >> 8) & 0xFF);
+        buffer[1] = (checksum & 0xFF);
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8100 + 4 + block_len, buffer, 2);
+        if (ret) {
+            TPD_INFO("write checksum fail!\n");
+            continue;
+        }
+
+        buffer[0] = 0;
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8022, buffer, 1);
+        if (ret) {
+            TPD_INFO("clear control flag fail!\n");
+            continue;
+        }
+
+        buffer[0] = subsystem->type;
+        buffer[1] = subsystem->type;
+        ret = gt1x_i2c_write_with_readback(chip_info->client, 0x8020, buffer, 2);
+        if (ret) {
+            TPD_INFO("write subsystem type fail!\n");
+            continue;
+        }
+        burn_state = -1;
+        wait_time = 200;
+        msleep(5);
+
+        while (wait_time-- > 0) {
+            u8 confirm = 0x55;
+
+            ret = touch_i2c_read_block(chip_info->client, 0x8022, 1, buffer);
+            if (ret < 0) {
+                continue;
+            }
+            msleep(5);
+            ret = touch_i2c_read_block(chip_info->client, 0x8022, 1, &confirm);
+            if (ret < 0) {
+                continue;
+            }
+            if (buffer[0] != confirm) {
+                continue;
+            }
+
+            if (buffer[0] == 0xAA) {
+                TPD_DEBUG("burning.....\n");
+                continue;
+            } else if (buffer[0] == 0xDD) {
+                TPD_INFO("checksum error!\n");
+                break;
+            } else if (buffer[0] == 0xBB) {
+                TPD_INFO("burning success.\n");
+                burn_state = 0;
+                break;
+            } else if (buffer[0] == 0xCC) {
+                TPD_INFO("burning failed!\n");
+                break;
+            } else {
+                TPD_DEBUG("unknown state!(0x8022: 0x%02X)\n", buffer[0]);
+            }
+        }
+
+        if (!burn_state) {
+            length -= block_len;
+            burn_len += block_len;
+            retry = 5;
+        }
+    }
+    if (length == 0) {
+        return 0;
+    } else {
+        return -1;
+    }
+}
+
+static int gt1x_check_subsystem_in_flash(struct chip_data_gt5688 *chip_info, struct fw_subsystem_info *subsystem)
+{
+    int block_len;
+    int checked_len = 0;
+    u32 length = subsystem->length;
+    int ret;
+    int check_state = 0;
+    int retry = 5;
+    u8 *fw;
+
+    TPD_INFO("Subsystem: %d, Length: %d, Address: 0x%08X", subsystem->type, subsystem->length, subsystem->address);
+
+    while (length > 0) {
+        block_len = length > 1024 * 4 ? 1024 * 4 : length;
+
+        TPD_INFO("Check block ==> length: %d, address: 0x%08X\n", block_len, subsystem->address + checked_len);
+        fw = gt1x_get_fw_data(chip_info, subsystem->offset + checked_len, block_len);
+        if (fw == NULL) {
+            return -1;
+        }
+        ret = gt1x_read_flash(chip_info->client, subsystem->address + checked_len, block_len);
+        if (ret) {
+            check_state |= ret;
+        }
+
+        ret = gt1x_recall_check(chip_info->client, fw, 0x8100, block_len);
+        if (ret) {
+            TPD_INFO("Block in flash is broken!\n");
+            check_state |= ret;
+        }
+
+        length -= block_len;
+        checked_len += block_len;
+        retry = 5;
+    }
+
+    if (check_state) {
+        TPD_INFO("Subsystem in flash is broken!\n");
+    } else {
+        TPD_INFO("Subsystem in flash is correct!\n");
+    }
+    return check_state;
+}
+
+static int gt1x_check_firmware_data(struct chip_data_gt5688 *chip_info)
+{
+    u16 checksum;
+    u16 checksum_in_firmware_image;
+    u8 *p;
+    struct fw_info *firmware;
+    int i;
+    int offset;
+
+    TPD_INFO("%s enter.\n", __func__);
+
+    // compare file length with the length field in the firmware header
+    if (chip_info->update_info.fw_length < FW_HEAD_SIZE) {
+        TPD_INFO("Bad firmware!(file length: %d)\n", chip_info->update_info.fw_length);
+        return -1;
+    }
+
+    p = gt1x_get_fw_data(chip_info, 0, 6);
+    if (p == NULL) {
+        return -1;
+    }
+
+    if (getU32(p) + 6 != chip_info->update_info.fw_length) {
+        TPD_INFO("Bad firmware!(file length: %d, header define: %d)\n", chip_info->update_info.fw_length, getU32(p));
+        return -1;
+    }
+    // check firmware's checksum
+    checksum_in_firmware_image = getU16(&p[4]);
+    checksum = 0;
+    for (i = 6; i < chip_info->update_info.fw_length; i++) {
+        p = gt1x_get_fw_data(chip_info, i, 1);
+        if (p == NULL) {
+            return -1;
+        }
+        checksum += p[0];
+    }
+
+    TPD_INFO("firmware checksum: 0x%04X, firmware image define: 0x%04X\n", checksum, checksum_in_firmware_image);
+
+    if (checksum != checksum_in_firmware_image) {
+        return -1;
+    }
+
+    // parse firmware
+    p = gt1x_get_fw_data(chip_info, 0, FW_HEAD_SIZE);
+    if (p == NULL) {
+        return -1;
+    }
+    // get fireware
+    memcpy((u8 *) chip_info->update_info.firmware, p, FW_HEAD_SIZE - 8 * 12);
+    chip_info->update_info.firmware->pid[5] = 0;
+
+    p = &p[FW_HEAD_OFFSET_SUBSYSTEM_INFO_BASE];
+    firmware = chip_info->update_info.firmware;
+    offset = FW_HEAD_SIZE;
+    for (i = 0; i < firmware->subsystem_count; i++) {
+        firmware->subsystem[i].type = p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE];
+        firmware->subsystem[i].length = getU16(&p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE + 1]);
+        firmware->subsystem[i].address = getU16(&p[i * FW_HEAD_SUBSYSTEM_INFO_SIZE + 3]) * 256;
+        firmware->subsystem[i].offset = offset;
+        offset += firmware->subsystem[i].length;
+    }
+
+    // print update information
+    TPD_INFO("Firmware length: %d\n", chip_info->update_info.fw_length);
+    TPD_INFO("Firmware product: GT%s\n", chip_info->update_info.firmware->pid);
+    TPD_INFO("Firmware patch: %02X%02X%02X\n", chip_info->update_info.firmware->version[0], chip_info->update_info.firmware->version[1], chip_info->update_info.firmware->version[2]);
+    TPD_INFO("Firmware chip: 0x%02X\n", chip_info->update_info.firmware->chip_type);
+    TPD_INFO("Subsystem count: %d\n", chip_info->update_info.firmware->subsystem_count);
+    for (i = 0; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_DEBUG("------------------------------------------\n");
+        TPD_DEBUG("Subsystem: %d\n", i);
+        TPD_DEBUG("Type: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_DEBUG("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_DEBUG("Address: 0x%08X\n", chip_info->update_info.firmware->subsystem[i].address);
+        TPD_DEBUG("Offset: %d\n", chip_info->update_info.firmware->subsystem[i].offset);
+    }
+
+    TPD_INFO("%s end.\n", __func__);
+
+    return 0;
+}
+
+s32 gt1x_request_event_handler(struct chip_data_gt5688 *chip_info)
+{
+    s32 ret = -1;
+    u8 rqst_data = 0;
+    u8 noise_data = 0;
+    ret = touch_i2c_read_block(chip_info->client, GTP_REG_RQST, 1, &rqst_data);
+    if (ret < 0) {
+        TPD_INFO("I2C transfer error. errno:%d\n", ret);
+        return -1;
+    }
+
+    TPD_INFO("Request state:0x%02x.\n", rqst_data);
+
+    switch (rqst_data & 0x0F) {
+        case GTP_RQST_CONFIG:
+            TPD_INFO("Request Config.\n");
+            ret = gt1x_send_cfg(chip_info->client, chip_info->config_info.gt1x_config, chip_info->config_info.gt1x_cfg_length);
+            if (ret) {
+                TPD_INFO("Send gt1x_config error.\n");
+            } else {
+                TPD_INFO("Send gt1x_config success.\n");
+                rqst_data = GTP_RQST_RESPONDED;
+                ret = touch_i2c_write_block(chip_info->client, GTP_REG_RQST, 1, &rqst_data);
+            }
+            break;
+
+        case GTP_RQST_RESET:
+            TPD_INFO("Request Reset.\n");
+            //  gt1x_reset_guitar();
+            rqst_data = GTP_RQST_RESPONDED;
+            ret = touch_i2c_write_block(chip_info->client, GTP_REG_RQST, 1, &rqst_data);
+            break;
+
+        case GTP_RQST_BAK_REF:
+            TPD_INFO("Request Ref.\n");
+            break;
+
+        case GTP_RQST_MAIN_CLOCK:
+            TPD_INFO("Request main clock.\n");
+            break;
+
+        case GTP_RQST_IDLE:
+            TPD_INFO("Idle, invalid request.\n");
+            return 0;
+        default:
+            break;
+    }
+
+    //noise
+    ret = touch_i2c_read_block(chip_info->client, GTP_NOISE_DETECT_REG, 1, &noise_data);
+    if (ret < 0) {
+        TPD_INFO("I2C transfer error. errno:%d\n", ret);
+        return -1;
+    }
+
+    TPD_INFO("randy:noise_data = 0x%x\n", noise_data);
+
+    if ((noise_data & 0x20) == 0x20) {
+        TPD_INFO("Send Noise config!\n");
+        if ((gt1x_init_panel(chip_info, CFG_NOISE)) != 0) {
+            TPD_INFO("Send Noise config failed.\n");
+        }
+    } else if ((noise_data & 0x40) == 0x40) {
+        TPD_DEBUG("Send normal config!\n");
+        if ((gt1x_init_panel(chip_info, CFG_NORMAL)) != 0) {
+            TPD_INFO("Send normal config failed.\n");
+        }
+    }
+
+    return 0;
+}
+
+static void goodix_finger_protect_data_get(struct chip_data_gt5688 *chip_info)
+{
+    int ret = -1;
+    int addr, i = 0, j = 0;
+    u8 raw_data[1024] = {0};
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    chip_info->spuri_fp_touch_raw_data = kzalloc(TX_NUM * RX_NUM * sizeof(u16), GFP_KERNEL);
+    addr = GTP_REG_RAWDATA;
+
+    TPD_INFO("%s start\n", __func__);
+    gt1x_rawdiff_mode = 1;
+    gt1x_send_cmd(chip_info->client, 1, 0);
+    touch_i2c_write_byte(chip_info->client, GTP_READ_COOR_ADDR, 0);
+
+    //wait for data ready
+    while(i++ < 10) {
+        ret = touch_i2c_read_block(chip_info->client, GTP_READ_COOR_ADDR, 1, raw_data);
+        TPD_INFO("ret = %d \t kernel_buf = %d\n", ret, raw_data[0]);
+        if(ret && ((raw_data[0] & 0x80) == 0x80)) {
+            TPD_INFO("Data ready OK");
+            break;
+        }
+        msleep(5);
+    }
+    if(i >= 10) {
+        TPD_INFO("data not ready, quit!\n");
+        goto read_data_exit;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, addr, TX_NUM * RX_NUM * 2, raw_data);
+
+    for(i = 0; i < RX_NUM; i++) {
+        //TPD_INFO("[%2d] ", i);
+        for(j = 0; j < TX_NUM; j++) {
+            chip_info->spuri_fp_touch_raw_data[i * TX_NUM + j] = (s16)(raw_data[i * TX_NUM * 2 + j * 2] << 8) + raw_data[i * TX_NUM * 2 + j * 2 + 1];
+            //printk("%d ",chip_info->spuri_fp_touch_raw_data[i * TX_NUM + j]);
+        }
+        //printk("\n");
+    }
+
+read_data_exit:
+    gt1x_send_cmd(chip_info->client, 0, 0);
+    gt1x_rawdiff_mode = 0;
+    touch_i2c_write_byte(chip_info->client, GTP_READ_COOR_ADDR, 0);
+    return;
+}
+
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int goodix_get_chip_info(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    /* read version information */
+    ret = gt1x_read_version(chip_info);
+    if (ret != 0) {
+        TPD_INFO("Get verision failed!\n");
+        return ret;
+    }
+
+    /* send config data */
+    ret = gt1x_init_panel(chip_info, CFG_NORMAL);
+    if (ret != 0) {
+        TPD_INFO("Init panel failed.\n");
+        return ret;
+    }
+
+    return ret;
+}
+
+static int goodix_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+
+        udelay(2);
+
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+
+        /*if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+            TPD_INFO("Set the reset_gpio.\n");
+            gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+        }*/
+
+        mdelay(20);
+
+        goodix_reset(chip_data);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+
+        udelay(2);
+
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return 0;
+}
+
+
+static int goodix_ftm_process(void *chip_data)
+{
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    TPD_INFO("FTM regulator_disable is called\n");
+    tp_powercontrol_2v8(chip_info->hw_res, false);
+
+    return 0;
+}
+
+static int goodix_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    chip_info->config_info.config_version = panel_data->manufacture_info.version;
+
+    return 0;
+}
+
+static fw_check_state goodix_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    int ret = 0;
+    int retry = 2;
+    u8 reg_val[2] = {0};
+    char fw_id[4] = {0};
+
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    do {
+        gt1x_i2c_read_dbl_check(chip_info->client, GTP_REG_FW_CHK_MAINSYS, reg_val, 1);
+        gt1x_i2c_read_dbl_check(chip_info->client, GTP_REG_FW_CHK_SUBSYS, &reg_val[1], 1);
+
+        if (reg_val[0] != 0xBE || reg_val[1] == 0xAA) {
+            TPD_INFO("Check fw status reg not pass, reg[0x814E] = 0x%2X, reg[0x5095] = 0x%2X!, retry = %d\n", reg_val[0], reg_val[1], retry);
+        } else {
+            break;
+        }
+    } while(--retry);
+
+    if (!retry)
+        return FW_ABNORMAL;
+
+    ret = touch_i2c_read_byte(chip_info->client, GTP_REG_CONFIG_DATA);
+
+    snprintf(fw_id, 4, "%02x", ret);
+    if (panel_data->manufacture_info.version)
+        strlcpy(&panel_data->manufacture_info.version[8], fw_id, MAX_DEVICE_VERSION_LENGTH - 8);
+
+    TPD_INFO("%s: TP_FW = 0x%x \n", __func__, panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/*
+ * Return 0 : updata firmware success; < 0 : updata failed; > 0 : no need to update
+ */
+static fw_update_state goodix_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int i = 0;
+    int ret = 0;
+    int retry = 2;
+    u8 *p;
+    u8 reg_val[2] = {0};
+    struct gt1x_version_info fw_ver_info;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    struct gt1x_version_info ver_info = chip_info->ver_info;
+
+    TPD_INFO("%s enter!\n", __func__);
+
+    if (chip_info->update_info.status != UPDATE_STATUS_IDLE) {
+        TPD_INFO("Update process is running!\n");
+        return FW_NO_NEED_UPDATE;
+    }
+    chip_info->update_info.status = UPDATE_STATUS_RUNNING;
+    chip_info->update_info.progress = 0;
+    chip_info->update_info.max_progress = 0;
+
+    chip_info->update_info.fw_length = fw->size;
+    chip_info->update_info.firmware_file_data = (u8 *)fw->data;
+
+    chip_info->update_info.firmware = (struct fw_info *)kzalloc(sizeof(struct fw_info), GFP_KERNEL);
+    if (chip_info->update_info.firmware == NULL) {
+        TPD_INFO("Alloc %zu bytes memory fail.\n", sizeof(struct fw_info));
+
+        return FW_NO_NEED_UPDATE;
+    }
+
+    chip_info->update_info.buffer = (u8 *) kzalloc(1024 * 4, GFP_KERNEL);
+    if (chip_info->update_info.buffer == NULL) {
+        TPD_INFO("Alloc %d bytes memory fail.\n", 1024 * 4);
+        kfree(chip_info->update_info.firmware);
+        return FW_NO_NEED_UPDATE;
+    }
+
+    ret = gt1x_check_firmware_data(chip_info);
+    if (ret < 0) {
+        chip_info->update_info.status = UPDATE_STATUS_ABORT;
+         TPD_INFO("gt1x_check_firmware_data fail\n");
+        goto gt1x_no_update_exit;
+    }
+
+    chip_info->update_info.max_progress = 6 + chip_info->update_info.firmware->subsystem_count;
+    chip_info->update_info.progress++;
+
+    do {
+        gt1x_i2c_read_dbl_check(chip_info->client, GTP_REG_FW_CHK_MAINSYS, reg_val, 1);
+        gt1x_i2c_read_dbl_check(chip_info->client, GTP_REG_FW_CHK_SUBSYS, &reg_val[1], 1);
+
+        if (reg_val[0] != 0xBE || reg_val[1] == 0xAA) {
+            TPD_INFO("Check fw status reg not pass, reg[0x814E] = 0x%2X, reg[0x5095] = 0x%2X!, retry = %d\n", reg_val[0], reg_val[1], retry);
+        } else {
+            break;
+        }
+    } while(--retry);
+
+    if (retry) { // if tp firmware is ok, judge the fw id, else  update immediately
+        fw_ver_info.mask_id = (chip_info->update_info.firmware->target_mask_version[0] << 16)
+            | (chip_info->update_info.firmware->target_mask_version[1] << 8)
+            | (chip_info->update_info.firmware->target_mask_version[2]);
+        fw_ver_info.patch_id = (chip_info->update_info.firmware->version[0] << 16)
+            | (chip_info->update_info.firmware->version[1] << 8)
+            | (chip_info->update_info.firmware->version[2]);
+        memcpy(fw_ver_info.product_id, chip_info->update_info.firmware->pid, 4);
+        fw_ver_info.product_id[4] = 0;
+
+        if (memcmp(fw_ver_info.product_id, ver_info.product_id, 4)) {
+            TPD_INFO("Product id is not match!\n");
+            goto gt1x_no_update_exit;
+        }
+
+        if ((fw_ver_info.mask_id & 0xFFFFFF00) != (ver_info.mask_id & 0xFFFFFF00)) {
+            TPD_INFO("Mask id is not match!\n");
+            goto gt1x_no_update_exit;
+        }
+
+        if (!force) {
+            if (fw_ver_info.patch_id  == ver_info.patch_id)
+                goto gt1x_no_update_exit;
+        }
+    }
+
+    chip_info->update_info.progress++;
+
+    p = gt1x_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset, chip_info->update_info.firmware->subsystem[0].length);
+    if (p == NULL) {
+        TPD_INFO("get isp fail\n");
+        chip_info->update_info.status = UPDATE_STATUS_ABORT;
+        goto gt1x_update_exit;
+    }
+
+    chip_info->update_info.progress++;
+    gt1x_select_addr(chip_info->client, chip_info->hw_res);
+    ret = gt1x_run_ss51_isp(chip_info->client, p, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        goto gt1x_update_exit;
+    }
+
+    chip_info->update_info.progress++;
+
+    msleep(800);
+
+    for (i = 1; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_INFO("subsystem: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_INFO("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_INFO("Address: %d\n", chip_info->update_info.firmware->subsystem[i].address);
+
+        ret = gt1x_burn_subsystem(chip_info, &(chip_info->update_info.firmware->subsystem[i]));
+        if (ret) {
+            TPD_INFO("burn subsystem fail!\n");
+            goto gt1x_update_exit;
+        }
+        chip_info->update_info.progress++;
+    }
+
+    goodix_reset(chip_data);
+
+    p = gt1x_get_fw_data(chip_info, chip_info->update_info.firmware->subsystem[0].offset, chip_info->update_info.firmware->subsystem[0].length);
+    if (p == NULL) {
+        TPD_INFO("get isp fail\n");
+        goto gt1x_update_exit;
+    }
+    chip_info->update_info.progress++;
+
+    gt1x_select_addr(chip_info->client, chip_info->hw_res);
+    ret = gt1x_run_ss51_isp(chip_info->client, p, chip_info->update_info.firmware->subsystem[0].length);
+    if (ret) {
+        TPD_INFO("run isp fail\n");
+        goto gt1x_update_exit;
+    }
+    chip_info->update_info.progress++;
+
+    TPD_INFO("Reset guitar & check firmware in flash.\n");
+    for (i = 1; i < chip_info->update_info.firmware->subsystem_count; i++) {
+        TPD_INFO("subsystem: %d\n", chip_info->update_info.firmware->subsystem[i].type);
+        TPD_INFO("Length: %d\n", chip_info->update_info.firmware->subsystem[i].length);
+        TPD_INFO("Address: %d\n", chip_info->update_info.firmware->subsystem[i].address);
+
+        ret = gt1x_check_subsystem_in_flash(chip_info, &(chip_info->update_info.firmware->subsystem[i]));
+        if (ret) {
+            gt1x_error_erase(chip_info);
+            break;
+        }
+    }
+    chip_info->update_info.progress++;
+
+    TPD_INFO("%s end.\n", __func__);
+
+gt1x_update_exit:
+    kfree(chip_info->update_info.buffer);
+    kfree(chip_info->update_info.firmware);
+    chip_info->update_info.status = UPDATE_STATUS_IDLE;
+
+    if (ret) {
+        chip_info->update_info.progress = 2 * chip_info->update_info.max_progress;
+        TPD_INFO("Update firmware failed!\n");
+        return FW_UPDATE_ERROR;
+    } else {
+        if (!retry){  // when firmware check fail , it need to init panel again.
+            /* send config data */
+            gt1x_init_panel(chip_info, CFG_NORMAL);
+        }
+        TPD_INFO("Update firmware succeefully!\n");
+        return FW_UPDATE_SUCCESS;
+    }
+
+gt1x_no_update_exit:
+    kfree(chip_info->update_info.buffer);
+    kfree(chip_info->update_info.firmware);
+    chip_info->update_info.status = UPDATE_STATUS_IDLE;
+    return FW_NO_NEED_UPDATE;
+}
+
+static int goodix_clear_irq(struct i2c_client*client)
+{
+    int ret = -1;
+
+    if (!gt1x_rawdiff_mode) {
+        ret = touch_i2c_write_byte(client, GTP_READ_COOR_ADDR, 0);
+        if (ret < 0) {
+            TPD_INFO("I2C write end_cmd  error!\n");
+        }
+    }
+
+    return ret;
+}
+
+static u8 goodix_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    static u8 trigger_event = 0;
+    u8 cur_event = 0;
+    u8 result_event = 0;
+    u8 touch_num = 0;
+    u8 check_sum = 0;
+    int i;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    //step1:detect whether gesture trigger irq
+    if (gesture_enable && is_suspended)
+        return IRQ_GESTURE;
+    else if ((!gesture_enable) && is_suspended)
+        return IRQ_IGNORE;
+    //step2:Read irq status reg detect trigger reason of IRQ_EXCEPTION/IRQ_FW_CONFIG/IRQ_IGNORE
+    memset(chip_info->touch_data, 0, MAX_GT_IRQ_DATA_LENGTH);
+    ret = touch_i2c_read_byte(chip_info->client, GTP_READ_COOR_ADDR);
+    if (ret < 0) {
+        TPD_INFO("I2C transfer error!\n");
+        trigger_event = 0;
+
+        return IRQ_EXCEPTION;
+    }
+    TPD_DEBUG("0x814e is 0x%x\n", ret);
+
+    chip_info->touch_data[0] = ret & 0xff;
+    touch_num = chip_info->touch_data[0] & 0x0F;
+
+    if (chip_info->touch_data[0] == 0x00) {
+        return IRQ_FW_CONFIG;
+    }
+    if ((chip_info->touch_data[0] & 0x80) == 0) {
+        goto IGNORE_CLEAR_IRQ;
+    }
+
+    //step3:Read COOR && do checksum
+
+    /* read the remaining coor data
+     * 0x814E(touch status) + 8(every coordinate consist of 8 bytes data) * touch num +
+     * keycode + checksum
+     */
+    ret = touch_i2c_read_block(chip_info->client, (GTP_READ_COOR_ADDR + 1), 8 * touch_num + 2, &chip_info->touch_data[1]);
+    if (ret < 0) {
+        TPD_INFO("read coor_addr failed!\n");
+        return IRQ_IGNORE;
+    }
+    /* cacl checksum */
+    for (i = 0; i < 1 + 8 * touch_num + 2; i++) {
+        check_sum += chip_info->touch_data[i];
+    }
+    if (check_sum) { /* checksum error*/
+        ret = touch_i2c_read_block(chip_info->client, GTP_READ_COOR_ADDR, 3 + 8 * touch_num, chip_info->touch_data);
+        if (ret < 0) {
+            return IRQ_IGNORE;
+        }
+
+        for (i = 0, check_sum = 0; i < 3 + 8 * touch_num; i++) {
+            check_sum += chip_info->touch_data[i];
+        }
+        if (check_sum) {
+            TPD_INFO("Checksum error[%x]\n", check_sum);
+            goto IGNORE_CLEAR_IRQ;
+        }
+    }
+
+    //step4:Touch /Key Trigger Bit setting
+    touch_num = chip_info->touch_data[0] & 0x0F;
+    chip_info->vk_status = chip_info->touch_data[8 * touch_num + 1];
+
+    if (touch_num && (!(chip_info->touch_data[0] & 0x10))) {
+        SET_BIT(cur_event, IRQ_TOUCH);
+    } else if ((chip_info->touch_data[0] & 0x10) && (chip_info->vk_status & 0x0F)) {
+        SET_BIT(cur_event, IRQ_BTN_KEY);
+    }
+
+    TPD_DEBUG("cur_event is %d\t trigger_event = %d\n", cur_event, trigger_event);
+
+    if (CHK_BIT(cur_event, IRQ_TOUCH) || CHK_BIT(trigger_event, IRQ_TOUCH)) {
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+
+    if ((chip_info->touch_data[0] & 0x10) || CHK_BIT(trigger_event, IRQ_BTN_KEY)) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+
+    if (result_event == IRQ_IGNORE) {
+        goto IGNORE_CLEAR_IRQ;
+    }
+
+    trigger_event = cur_event;
+    TPD_DEBUG("point data is 0x%2x %hhu, vk_status:%hhu\n", ret, result_event, chip_info->vk_status);
+
+    return result_event;
+
+IGNORE_CLEAR_IRQ:
+    ret = goodix_clear_irq(chip_info->client);
+    return IRQ_IGNORE;
+}
+
+static int goodix_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i;
+    int touch_map = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    u8 touch_num = 0;
+    u8 finger_processed = 0;
+    uint16_t input_x = 0;
+    uint16_t input_y = 0;
+    uint16_t input_w = 0;
+    u8 *coor_data = NULL;
+    s32 id = 0;
+
+    touch_num = chip_info->touch_data[0] & 0x0F;
+    if (touch_num > max_num) {
+        TPD_INFO("Illegal finger number!");
+        goto END_TOUCH;
+    }
+    if (touch_num == 0) { //Up event
+        goto END_TOUCH;
+    }
+
+    coor_data = &chip_info->touch_data[1];
+    id = coor_data[0] & 0x0F;
+    for (i = 0; i < max_num; i++) {
+        if (i == id) {
+            input_x = coor_data[1] | (coor_data[2] << 8);
+            input_y = coor_data[3] | (coor_data[4] << 8);
+            input_w = coor_data[5] | (coor_data[6] << 8);
+            points[i].x = input_x;
+            points[i].y = input_y;
+            points[i].z = input_w;
+            points[i].width_major = 30; // any value
+            points[i].status = 1;
+            touch_map |= 0x01 << i;
+            coor_data += 8;
+
+            if (finger_processed++ < touch_num) {
+                id = coor_data[0] & 0x0F;
+            }
+        }
+    }
+END_TOUCH:
+    ret = goodix_clear_irq(chip_info->client);
+    return touch_map;
+}
+
+static u8 goodix_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    bitmap = chip_info->vk_status & 0x0F;
+    if (bitmap & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (bitmap & 0x02)
+        SET_BIT(bitmap_result, BIT_HOME);
+    if (bitmap & 0x04)
+        SET_BIT(bitmap_result, BIT_BACK);
+    ret = goodix_clear_irq(chip_info->client);
+
+    return bitmap_result;
+}
+
+static int goodix_fw_handle(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    ret = gt1x_request_event_handler(chip_info);
+    return ret;
+}
+
+static int goodix_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    u8 doze_buf[3] = {0};
+    u8 coordinate_single[MAX_GESTURE_COORD*4];
+    u8 coordinate_size = 0;
+    int i = 0, j = 0, ret = 0;
+    struct Coordinate Point_output[6];
+    struct Coordinate Point_input[6];
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+
+    ret = touch_i2c_read_block(client, GTP_REG_WAKEUP_GESTURE, 2, doze_buf);
+    TPD_DEBUG("0x814C = 0x%02X, ret = %d\n", doze_buf[0], ret);
+    if (ret < 0) {
+        TPD_INFO("Read Gesture info i2c faild\n");
+        return -1;
+    }
+
+    if (doze_buf[0] != 0) {
+        memset(coordinate_single, 0, MAX_GESTURE_COORD*4);
+        memset(Point_output, 0, sizeof(Point_output));
+        memset(Point_input, 0, sizeof(Point_input));
+
+        coordinate_size = doze_buf[1];
+        if (coordinate_size > MAX_GESTURE_COORD)
+            coordinate_size = MAX_GESTURE_COORD;
+
+        ret = touch_i2c_read_block(client, GTP_REG_WAKEUP_GESTURE_DETAIL, coordinate_size*4, coordinate_single);
+        touch_i2c_write_byte(client, GTP_REG_WAKEUP_GESTURE, 0x00);
+        TPD_INFO("clear irq\n");
+        switch (doze_buf[0]) {
+            case DTAP_DETECT:
+                gesture->gesture_type  = DouTap;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1] << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3] << 8);
+                gesture->Point_end.x   = coordinate_single[8]  | (coordinate_single[9] << 8);
+                gesture->Point_end.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_1st.x   = 0;
+                gesture->Point_1st.y   = 0;
+                gesture->clockwise = 0 ;
+                break;
+
+            case UP_VEE_DETECT :
+                gesture->gesture_type  = UpVee;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_end.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_1st.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_1st.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                break;
+
+            case DOWN_VEE_DETECT :
+                gesture->gesture_type  = DownVee;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_end.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_1st.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_1st.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                break;
+
+            case LEFT_VEE_DETECT:
+                gesture->gesture_type = LeftVee;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_end.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_1st.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_1st.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                break;
+
+            case RIGHT_VEE_DETECT :
+                gesture->gesture_type  = RightVee;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[16] | (coordinate_single[17] << 8);
+                gesture->Point_end.y   = coordinate_single[18] | (coordinate_single[19] << 8);
+                gesture->Point_1st.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_1st.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                break;
+
+            case CIRCLE_DETECT  :
+                gesture->gesture_type = Circle;
+                j = 0;
+                for (i = 0; i < coordinate_size;i++) {
+                    Point_input[i].x = coordinate_single[j]   | (coordinate_single[j + 1] << 8);
+                    Point_input[i].y = coordinate_single[j + 2] | (coordinate_single[j + 3] << 8);
+                    j = j + 4;
+                    //TPD_INFO("Point_input[%d].x = %d, Point_input[%d].y = %d\n", i, Point_input[i].x, i, Point_input[i].y);
+                }
+
+                gesture->clockwise = ClockWise(&Point_input[0], coordinate_size - 2);
+                GetCirclePoints(&Point_input[0], coordinate_size, Point_output);
+                gesture->Point_start.x = Point_input[0].x;
+                gesture->Point_start.y = Point_input[0].y;
+                gesture->Point_end.x   = Point_input[coordinate_size-1].x;
+                gesture->Point_end.y   = Point_input[coordinate_size-1].y;
+                gesture->Point_1st.x   = Point_output[0].x;
+                gesture->Point_1st.y   = Point_output[0].y;
+                gesture->Point_2nd.x   = Point_output[1].x;
+                gesture->Point_2nd.y   = Point_output[1].y;
+                gesture->Point_3rd.x   = Point_output[2].x;
+                gesture->Point_3rd.y   = Point_output[2].y;
+                gesture->Point_4th.x   = Point_output[3].x;
+                gesture->Point_4th.y   = Point_output[3].y;
+                break;
+
+            case DOUSWIP_DETECT  :
+                gesture->gesture_type  = DouSwip;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_end.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                gesture->Point_1st.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_1st.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_2nd.x   = coordinate_single[12] | (coordinate_single[13] << 8);
+                gesture->Point_2nd.y   = coordinate_single[14] | (coordinate_single[15] << 8);
+                break;
+
+            case DOUUPSWIP_DETECT:
+                gesture->gesture_type  = DouSwip;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_end.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                gesture->Point_1st.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_1st.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_2nd.x   = coordinate_single[12] | (coordinate_single[13] << 8);
+                gesture->Point_2nd.y   = coordinate_single[14] | (coordinate_single[15] << 8);
+                break;
+
+            case RIGHT_SLIDE_DETECT :
+                gesture->gesture_type  = Left2RightSwip;
+                gesture->Point_start.x = coordinate_single[0] | (coordinate_single[1] << 8);
+                gesture->Point_start.y = coordinate_single[2] | (coordinate_single[3] << 8);
+                gesture->Point_end.x   = coordinate_single[4] | (coordinate_single[5] << 8);
+                gesture->Point_end.y   = coordinate_single[6] | (coordinate_single[7] << 8);
+                break;
+
+            case LEFT_SLIDE_DETECT :
+                gesture->gesture_type  = Right2LeftSwip;
+                gesture->Point_start.x = coordinate_single[0] | (coordinate_single[1] << 8);
+                gesture->Point_start.y = coordinate_single[2] | (coordinate_single[3] << 8);
+                gesture->Point_end.x   = coordinate_single[4] | (coordinate_single[5] << 8);
+                gesture->Point_end.y   = coordinate_single[6] | (coordinate_single[7] << 8);
+                break;
+
+            case DOWN_SLIDE_DETECT  :
+                gesture->gesture_type  = Up2DownSwip;
+                gesture->Point_start.x = coordinate_single[0] | (coordinate_single[1] << 8);
+                gesture->Point_start.y = coordinate_single[2] | (coordinate_single[3] << 8);
+                gesture->Point_end.x   = coordinate_single[4] | (coordinate_single[5] << 8);
+                gesture->Point_end.y   = coordinate_single[6] | (coordinate_single[7] << 8);
+                break;
+
+            case UP_SLIDE_DETECT :
+                gesture->gesture_type  = Down2UpSwip;
+                gesture->Point_start.x = coordinate_single[0] | (coordinate_single[1] << 8);
+                gesture->Point_start.y = coordinate_single[2] | (coordinate_single[3] << 8);
+                gesture->Point_end.x   = coordinate_single[4] | (coordinate_single[5] << 8);
+                gesture->Point_end.y   = coordinate_single[6] | (coordinate_single[7] << 8);
+                break;
+
+            case M_DETECT  :
+                gesture->gesture_type  = Mgestrue;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[16] | (coordinate_single[17] << 8);
+                gesture->Point_end.y   = coordinate_single[18] | (coordinate_single[19] << 8);
+                gesture->Point_1st.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_1st.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                gesture->Point_2nd.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_2nd.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_3rd.x   = coordinate_single[12] | (coordinate_single[13] << 8);
+                gesture->Point_3rd.y   = coordinate_single[14] | (coordinate_single[15] << 8);
+                break;
+
+            case W_DETECT :
+                gesture->gesture_type  = Wgestrue;
+                gesture->Point_start.x = coordinate_single[0]  | (coordinate_single[1]  << 8);
+                gesture->Point_start.y = coordinate_single[2]  | (coordinate_single[3]  << 8);
+                gesture->Point_end.x   = coordinate_single[16] | (coordinate_single[17] << 8);
+                gesture->Point_end.y   = coordinate_single[18] | (coordinate_single[19] << 8);
+                gesture->Point_1st.x   = coordinate_single[4]  | (coordinate_single[5]  << 8);
+                gesture->Point_1st.y   = coordinate_single[6]  | (coordinate_single[7]  << 8);
+                gesture->Point_2nd.x   = coordinate_single[8]  | (coordinate_single[9]  << 8);
+                gesture->Point_2nd.y   = coordinate_single[10] | (coordinate_single[11] << 8);
+                gesture->Point_3rd.x   = coordinate_single[12] | (coordinate_single[13] << 8);
+                gesture->Point_3rd.y   = coordinate_single[14] | (coordinate_single[15] << 8);
+                break;
+
+            default:
+                gesture->gesture_type = UnkownGesture;
+                break;
+        }
+
+        TPD_INFO("%s, gesture_sign = 0x%x, gesture_type = %d | %d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d\n",
+            __func__, doze_buf[0], gesture->gesture_type,
+            gesture->Point_start.x, gesture->Point_start.y, gesture->Point_end.x, gesture->Point_end.y,
+            gesture->Point_1st.x, gesture->Point_1st.y, gesture->Point_2nd.x, gesture->Point_2nd.y,
+            gesture->Point_3rd.x, gesture->Point_3rd.y, gesture->Point_4th.x, gesture->Point_4th.y,
+            gesture->clockwise);
+    }
+    ret = goodix_clear_irq(chip_info->client);      //add 9-17
+    return 0;
+}
+
+static int goodix_enable_edge_limit(struct chip_data_gt5688 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    TPD_INFO("%s, edge limit enable = %d\n", __func__, enable);
+
+    if (enable) {
+        ret = gt1x_send_cmd(chip_info->client, GOODIX_ENABLE_EDGE, 0);
+    } else  {
+        ret = gt1x_send_cmd(chip_info->client, GOODIX_DISABLE_EDGE, 0);
+    }
+
+    return ret;
+}
+
+static int goodix_set_charger_state(struct chip_data_gt5688 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = gt1x_send_cmd(chip_info->client, GTP_CMD_CHARGER_ON, 0);
+    } else {
+        ret = gt1x_send_cmd(chip_info->client, GTP_CMD_CHARGER_OFF, 0);
+    }
+
+    return ret;
+}
+
+static int goodix_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    if (chip_info->halt_status && (mode != MODE_NORMAL)) {
+        goodix_reset(chip_info);
+    }
+
+    switch(mode) {
+        case MODE_NORMAL:
+            //After reset no need to control the Touch IC
+            ret = 0;
+            break;
+
+        case MODE_SLEEP:
+            ret = gt1x_enter_sleep(chip_info);
+            chip_info->halt_status = true;
+            break;
+
+        case MODE_GESTURE:
+            if (flag) {
+                ret = gesture_enter_doze(chip_info->client);
+                chip_info->halt_status = true;
+            }
+            break;
+
+        case MODE_GLOVE:
+            break;
+
+        case MODE_EDGE:
+            ret = goodix_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: goodix enable edge limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+        case MODE_CHARGE:
+            ret = goodix_set_charger_state(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: set charger state failed %d\n", __func__, flag);
+            }
+            break;
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int goodix_esd_handle(void *chip_data)
+{
+    s32 i = 0;
+    s32 ret = -1;
+    u8 esd_buf[4] = {0};
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    for (i = 0; i < 3; i++) {
+        ret = touch_i2c_read_block(chip_info->client, GTP_REG_CMD, 4, esd_buf);
+        TPD_DEBUG("[Esd]0x8040 = 0x%02X, 0x8043 = 0x%02X gt1x_rawdiff_mode = %d\n", esd_buf[0], esd_buf[3], gt1x_rawdiff_mode);
+        if (ret && esd_buf[0] != 0xAA && esd_buf[3] == 0xAA) {
+            break;
+        }
+        TPD_INFO("[Esd]0x8040 = 0x%02X, 0x8043 = 0x%02X gt1x_rawdiff_mode = %d\n", esd_buf[0], esd_buf[3], gt1x_rawdiff_mode);
+        msleep(50);
+    }
+
+    if (likely(i < 3)) {
+        /* IC works normally, Write 0x8040 0xAA, feed the watchdog */
+        TPD_DEBUG("time_before(jiffies, timeout) is %d(%lu,%lu), 0x8040 = 0x%02X, 0x8043 = 0x%02X gt1x_rawdiff_mode = %d\n", time_before(jiffies, timeout), jiffies, timeout, esd_buf[0], esd_buf[3], gt1x_rawdiff_mode);
+        if (gt1x_rawdiff_mode == 1 || (time_before(jiffies, timeout) && esd_buf[0] == 0x00 && esd_buf[3] == 0xAA)) {
+            TPD_DEBUG("quit kick dog!\n");
+        } else {
+            TPD_DEBUG("kick dog! 0x8040 = 0x%02X\n", esd_buf[0]);
+            gt1x_send_cmd(chip_info->client, GTP_CMD_ESD, 0);
+        }
+    } else {
+        TPD_INFO("IC works abnormally! Process esd reset.");
+
+        memset(esd_buf, 0x01, sizeof(esd_buf));
+        touch_i2c_write_block(chip_info->client, 0x4226, sizeof(esd_buf), esd_buf);
+        msleep(50);
+
+        disable_irq_nosync(chip_info->client->irq);
+
+        tp_powercontrol_2v8(chip_info->hw_res, false);
+        msleep(30);
+        tp_powercontrol_2v8(chip_info->hw_res, true);
+        msleep(10);
+
+        for (i = 0; i < 5; i++) {
+            if (goodix_reset(chip_data)) {
+                continue;
+            }
+            if (gt1x_send_cfg(chip_info->client, chip_info->config_info.gt1x_config, chip_info->config_info.gt1x_cfg_length)) {
+                msleep(500);
+                continue;
+            }
+            tp_touch_btnkey_release();
+            break;
+        }
+
+        enable_irq(chip_info->client->irq);
+
+        TPD_INFO("Goodix esd reset over.");
+        return -1;
+    }
+
+    return 0;
+}
+
+static void goodix_debug_info_read(struct seq_file *s, void *chip_data, debug_type debug_type)
+{
+    int ret = -1, i = 0, j = 0;
+    u8 *kernel_buf = NULL;
+    int addr;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+    struct i2c_client *client = chip_info->client;
+
+    kernel_buf = kzalloc(4096,GFP_KERNEL);
+    if(kernel_buf == NULL)
+    {
+        TPD_INFO("%s kmalloc error\n", __func__);
+        return ;
+    }
+    switch (debug_type) {
+        case GTP_RAWDATA:
+            addr = GTP_REG_RAWDATA;
+            break;
+        case GTP_DIFFDATA:
+            addr = GTP_REG_DIFFDATA;
+            break;
+        default:
+            addr = GTP_REG_BASEDATA;
+            break;
+    }
+    gt1x_rawdiff_mode = 1;
+    gt1x_send_cmd(client, 1, 0);
+    msleep(20);
+    touch_i2c_write_byte(client, GTP_READ_COOR_ADDR, 0);
+    TPD_INFO("%d,%s\n", __LINE__, __func__);
+
+    //wait for data ready
+    while(i++ < 10) {
+        ret = touch_i2c_read_block(client, GTP_READ_COOR_ADDR, 1, kernel_buf);
+        TPD_INFO("ret = %d \t kernel_buf = %d\n", ret, kernel_buf[0]);
+        if(ret && ((kernel_buf[0] & 0x80)==0x80)) {
+            TPD_INFO("Data ready OK");
+            break;
+        }
+        msleep(20);
+    }
+    if(i >= 10) {
+        TPD_INFO("data not ready, quit!\n");
+        goto read_data_exit;
+    }
+
+    ret = touch_i2c_read_block(client, addr, TX_NUM * RX_NUM * 2, kernel_buf);
+    msleep(5);
+
+    for(i = 0; i < RX_NUM; i++) {
+        seq_printf(s, "[%2d] ", i);
+        for(j = 0; j < TX_NUM; j++) {
+            //printk("%d ",(s16)(((s16)kernel_buf[i * TX_NUM * 2 + j * 2] << 8) + kernel_buf[i * TX_NUM * 2 + j * 2 + 1]));
+            seq_printf(s, "%4d ", (s16)(((s16)kernel_buf[i * TX_NUM * 2 + j * 2] << 8) + kernel_buf[i * TX_NUM * 2 + j * 2 + 1]));
+    }
+            //printk("\n");
+            seq_printf(s, "\n");
+    }
+read_data_exit:
+    gt1x_send_cmd(client, 0, 0);
+    gt1x_rawdiff_mode = 0;
+    touch_i2c_write_byte(client, GTP_READ_COOR_ADDR, 0);
+    kfree(kernel_buf);
+    return ;
+}
+
+static void goodix_config_info_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, i = 0;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    char temp_data[GTP_CONFIG_MAX_LENGTH] = {0};
+
+    seq_printf(s, "==== GT1X default config setting in driver====\n");
+    for(i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
+        seq_printf(s, "0x%02X, ", chip_info->config_info.gt1x_config[i]);
+        if(i % 10 == 9)
+            seq_printf(s, "\n");
+    }
+
+    seq_printf(s, "\n");
+    seq_printf(s, "==== GT1X config read from chip====\n");
+    ret = touch_i2c_read_block(client, GTP_REG_CONFIG_DATA, GTP_CONFIG_MAX_LENGTH, temp_data);
+    TPD_INFO("I2C TRANSFER: %d", ret);
+
+    for(i = 0; i < GTP_CONFIG_MAX_LENGTH; i++) {
+        seq_printf(s, "0x%02X, ", temp_data[i]);
+        if(i % 10 == 9)
+            seq_printf(s, "\n");
+    }
+
+    seq_printf(s, "\n");
+    seq_printf(s, "==== GT1X Version Info ====\n");
+
+    touch_i2c_read_block(client, GTP_REG_VERSION, 12, temp_data);
+    seq_printf(s, "ProductID: GT%c%c%c%c\n", temp_data[0], temp_data[1], temp_data[2], temp_data[3]);
+    seq_printf(s, "PatchID: %02X%02X%02X\n", temp_data[4], temp_data[5], temp_data[6]);
+    seq_printf(s, "MaskID: %02X%02X%02X\n", temp_data[7], temp_data[8], temp_data[9]);
+    seq_printf(s, "SensorID: %02X\n", chip_info->ver_info.sensor_id);
+
+    return;
+}
+
+fp_touch_state goodix_spurious_fp_check(void *chip_data)
+{
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int addr = GTP_REG_RAWDATA, i = 0, j = 0;
+    int raw_data_get = 0, raw_data_base = 0, delta_data = 0;
+    int error_count = 0;
+    uint8_t raw_data[1024] = {0};
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    TPD_INFO("%s start!\n", __func__);
+    disable_irq_nosync(chip_info->client->irq);
+    goodix_reset(chip_info);
+    gt1x_rawdiff_mode = 1;
+    gt1x_send_cmd(chip_info->client, 1, 0);
+    touch_i2c_write_byte(chip_info->client, GTP_READ_COOR_ADDR, 0);
+
+    //wait for data ready
+    while(i++ < 10) {
+        ret = touch_i2c_read_block(chip_info->client, GTP_READ_COOR_ADDR, 1, raw_data);
+        TPD_INFO("ret = %d \t kernel_buf = %d\n", ret, raw_data[0]);
+        if(ret && ((raw_data[0] & 0x80) == 0x80)) {
+            TPD_INFO("Data ready OK");
+            break;
+        }
+        msleep(5);
+    }
+    if(i >= 10) {
+        TPD_INFO("data not ready, quit!\n");
+        goto read_data_exit;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, addr, TX_NUM * RX_NUM * 2, raw_data);
+
+    for(i = RX_NUM - SPURIOUS_FP_RX_NUM; i < RX_NUM - 1; i++) {
+        TPD_INFO("[%d]:", i);
+        for(j = 1; j < TX_NUM - 1; j++) {
+            raw_data_get = (s16)(raw_data [i * TX_NUM * 2 + j * 2] << 8) + raw_data [i * TX_NUM * 2 + j * 2 + 1];
+            raw_data_base = chip_info->spuri_fp_touch_raw_data[i * TX_NUM + j];
+            delta_data = raw_data_get - raw_data_base;
+            printk("%d ",delta_data);
+            if(delta_data + 90 < 0) {
+                TPD_INFO("delta_data too large, delta_data = %d\n", delta_data);
+                error_count++;
+            }
+        }
+        printk("\n");
+        if(error_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            TPD_INFO("finger protect trigger!report_finger_protect = %d\n", fp_touch_state);
+            error_count = 0;
+            break;
+        } else {
+            fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+        }
+    }
+read_data_exit:
+    enable_irq(chip_info->client->irq);
+    timeout = jiffies + 6 * HZ / 5;
+    gt1x_send_cmd(chip_info->client, 0, 0);
+    gt1x_rawdiff_mode = 0;
+    touch_i2c_write_byte(chip_info->client, GTP_READ_COOR_ADDR, 0);
+    return fp_touch_state;
+}
+
+//proc/touchpanel/debug_info/delta
+static void goodix_delta_read(struct seq_file *s, void *chip_data)
+{
+    goodix_debug_info_read(s, chip_data, GTP_DIFFDATA);
+}
+
+//proc/touchpanel/debug_info/baseline
+static void goodix_baseline_read(struct seq_file *s, void *chip_data)
+{
+    goodix_debug_info_read(s, chip_data, GTP_RAWDATA);
+}
+
+//proc/touchpanel/debug_info/main_register
+static void goodix_main_register_read(struct seq_file *s, void *chip_data)
+{
+    uint8_t log_sector[65] = {0};
+    uint8_t noise_detect[392] = {0};
+    uint8_t noise_rawdata[128] = {0};
+    uint8_t XDATA1[256] = {0};
+    uint8_t* XDATA2_top = NULL;
+    uint8_t* XDATA2_bottom = NULL;
+    struct chip_data_gt5688 *chip_info = (struct chip_data_gt5688 *)chip_data;
+    int i = 0, j = 0, ret = 0;
+
+    XDATA2_top = kzalloc(2464, GFP_KERNEL);
+    XDATA2_bottom = kzalloc(2432, GFP_KERNEL);
+    seq_printf(s, "==== GT1X LOG SECTOR 65 bytes FROM 0x8400====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8400, 65, log_sector);
+    for (i = 0; i < 65; i++) {
+        seq_printf(s, "0x%02x, ", log_sector[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X NOISE DETECT 392 bytes FROM 0x88B8====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x88B8, 392, noise_detect);
+    for (i = 0; i < 392; i++) {
+        seq_printf(s, "0x%02x, ", noise_detect[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X NOISE RAWDATA 128 bytes FROM 0xD62C====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0xD62C, 128, noise_rawdata);
+    for (i = 0; i < 128; i++) {
+        seq_printf(s, "0x%02x, ", noise_rawdata[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA1 256 bytes FROM 0x8200====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8200, 256, XDATA1);
+    for (i = 0; i < 256; i++) {
+        seq_printf(s, "0x%02x, ", XDATA1[i]);
+        if (i % 16 == 15)
+            seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA2_TOP 2464 bytes FROM 0x84E0====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x84E0, 2464, XDATA2_top);
+    for (i = 0; i < 77; i++) {
+        seq_printf(s, "[%d]:", i);
+        for(j = 0; j < 32; j++){
+            seq_printf(s, "0x%02x, ", XDATA2_top[i * 32 + j]);
+        }
+        seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    seq_printf(s, "==== GT1X XDATA2_BOTTOM 2432 bytes FROM 0x8E80====\n");
+    ret = touch_i2c_read_block(chip_info->client, 0x8E80, 2432, XDATA2_bottom);
+    for (i = 0; i < 76; i++) {
+        seq_printf(s, "[%d]:", i);
+        for(j = 0; j < 32; j++){
+            seq_printf(s, "0x%02x, ", XDATA2_bottom[i * 32 + j]);
+        }
+        seq_printf(s, "\n");
+    }
+    seq_printf(s, "\n");
+
+    kfree(XDATA2_top);
+    kfree(XDATA2_bottom);
+    return;
+}
+
+static void goodix_reserve_read(struct seq_file *s, void *chip_data)
+{
+    return;
+}
+
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int goodix_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+extern bool oppo_chg_is_usb_present(void);
+static int goodix_get_usb_state(void)
+{
+    return oppo_chg_is_usb_present();
+}
+#endif
+
+struct oppo_touchpanel_operations goodix_gt5688_ops = {
+    .ftm_process      = goodix_ftm_process,
+    .get_vendor       = goodix_get_vendor,
+    .get_chip_info    = goodix_get_chip_info,
+    .reset            = goodix_reset,
+    .power_control    = goodix_power_control,
+    .fw_check         = goodix_fw_check,
+    .fw_update        = goodix_fw_update,
+    .trigger_reason   = goodix_trigger_reason,
+    .get_touch_points = goodix_get_touch_points,
+    .get_gesture_info = goodix_get_gesture_info,
+    .get_keycode      = goodix_get_keycode,
+    .mode_switch      = goodix_mode_switch,
+    .esd_handle       = goodix_esd_handle,
+    .fw_handle        = goodix_fw_handle,
+    .spurious_fp_check= goodix_spurious_fp_check,
+    .get_usb_state    = goodix_get_usb_state,
+};
+
+struct goodix_proc_operations goodix_gt5688_proc_ops = {
+    .goodix_config_info_read= goodix_config_info_read,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .delta_read    = goodix_delta_read,
+    .baseline_read = goodix_baseline_read,
+    .main_register_read = goodix_main_register_read,
+    .reserve_read = goodix_reserve_read,
+};
+
+/**
+ * gt1x_ts_probe -   I2c probe.
+ * @client: i2c device struct.
+ * @id: device id.
+ * Return  0: succeed, -1: failed.
+ */
+static int gt1x_ts_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    s32 ret = -1;
+    struct chip_data_gt5688 *chip_info;
+    struct touchpanel_data *ts = NULL;
+
+    TPD_INFO("%s is called\n", __func__);
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_gt5688), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->touch_data = kzalloc(MAX_GT_IRQ_DATA_LENGTH, GFP_KERNEL);
+    if (chip_info->touch_data == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("chip_info->touch_data kzalloc error\n");
+        goto touch_data_malloc_failed;
+    }
+
+    chip_info->client = client;
+    chip_info->goodix_ops = &goodix_gt5688_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+    i2c_set_clientdata(client, ts);
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &goodix_gt5688_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto touch_data_alloc_err;
+    }
+
+    ts->tp_suspend_order = TP_LCD_SUSPEND; /* for oncell panel, set tp suspend first */
+    //step6: debug tools
+    gt1x_init_tool_node(ts, &chip_info->update_info);
+
+    //step7: TP_AUTO_TEST_ID for diffrent IC auto tet
+    Goodix_create_proc(ts , chip_info->goodix_ops);
+
+    //step8: get baseline data for finger protect
+    if(ts->spurious_fp_support){
+        mutex_lock(&ts->mutex);
+        goodix_finger_protect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+    return 0;
+
+touch_data_alloc_err:
+    kfree(chip_info->touch_data);
+    chip_info->touch_data = NULL;
+
+touch_data_malloc_failed:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+/**
+ * gt1x_ts_suspend - i2c suspend callback function.
+ * @dev: i2c device.
+ * Return  0: succeed, -1: failed.
+ */
+static int gt1x_pm_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+/**
+ * gt1x_ts_resume - i2c resume callback function.
+ * @dev: i2c device.
+ * Return  0: succeed, -1: failed.
+ */
+static int gt1x_pm_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+/* bus control the suspend/resume procedure */
+static const struct dev_pm_ops gt1x_ts_pm_ops = {
+    .suspend = gt1x_pm_suspend,
+    .resume = gt1x_pm_resume,
+};
+
+static const struct of_device_id gt1x_match_table[] = {
+    {.compatible = "goodix,gt1x", },
+    { },
+};
+
+static const struct i2c_device_id gt1x_ts_id[] = {
+    {GTP_I2C_NAME, 0},
+    {}
+};
+
+/**
+ * gt1x_ts_remove -  Goodix touchscreen driver release function.
+ * @client: i2c device struct.
+ * Return  0: succeed, -1: failed.
+ */
+static int gt1x_ts_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static struct i2c_driver gt1x_ts_driver = {
+    .probe = gt1x_ts_probe,
+    .remove = gt1x_ts_remove,
+    .id_table = gt1x_ts_id,
+    .driver = {
+        .name = GTP_I2C_NAME,
+        .owner = THIS_MODULE,
+        .of_match_table = gt1x_match_table,
+#if defined(CONFIG_FB)
+        .pm = &gt1x_ts_pm_ops,
+#endif
+    },
+};
+
+static int __init gt1x_ts_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    tp_judge_ic_match("gt5688");
+
+    if (i2c_add_driver(&gt1x_ts_driver) != 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+
+    return 0;
+}
+
+/* should never be called */
+static void __exit gt1x_ts_exit(void)
+{
+    i2c_del_driver(&gt1x_ts_driver);
+
+    return;
+}
+
+module_init(gt1x_ts_init);
+module_exit(gt1x_ts_exit);
+
+MODULE_DESCRIPTION("GTP Series Driver");
+MODULE_LICENSE("GPL");
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_generic_driver.h b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_generic_driver.h
new file mode 100644
index 0000000000000000000000000000000000000000..226eb3936b84c2ccf9fed1ec5fbc83dada54b1f0
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/gt1x_generic_driver.h
@@ -0,0 +1,61 @@
+/***************************************************
+ * File:gt1x_generic_driver.h
+ * Copyright (c)  2008- 2030  Mobile communication Corp.ltd.
+ * Description:
+ *             goodix gt5688 driver config
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+#ifndef _GT1X_GENERIC_DRIVER_H_
+#define _GT1X_GENERIC_DRIVER_H_
+
+/*********part1 CFG: Normal config setting *************/
+u8 GTP_CFG_GROUP_OFLIM[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0x61,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x35,0x37,0xA2,0x07,0x20,0x3A,0x60,0x9A,0x43,0x24,0x00,0x2D,0x2A,0x64,0xC8,0x14,0x03,0x28,0x42,0x54,0xB7,0x33,0x9D,0x3D,0x9D,0x46,0x80,0x50,0x7F,0x5A,0x6E,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x18,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0xF9,0x80,0x01\
+};
+
+u8 GTP_CFG_GROUP_TRULY[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0x61,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x35,0x37,0xA2,0x07,0x20,0x3A,0x60,0x9A,0x43,0x24,0x00,0x2D,0x2A,0x64,0xC8,0x14,0x03,0x28,0x42,0x54,0xB7,0x33,0x9D,0x3D,0x9D,0x46,0x80,0x50,0x7F,0x5A,0x6E,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x18,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0xF9,0x80,0x01\
+};
+
+u8 GTP_CFG_GROUP_BIEL[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0x61,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x35,0x37,0xA2,0x07,0x20,0x3A,0x60,0x9A,0x43,0x24,0x00,0x2D,0x2A,0x64,0xC8,0x14,0x03,0x28,0x42,0x54,0xB7,0x33,0x9D,0x3D,0x9D,0x46,0x80,0x50,0x7F,0x5A,0x6E,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x18,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0xF9,0x80,0x01\
+};
+
+u8 GTP_CFG_GROUP_BOE[] = {\
+	0x15,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0x61,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x35,0x37,0xA2,0x07,0x20,0x3A,0x60,0x9A,0x43,0x24,0x00,0x2D,0x2A,0x64,0xC8,0x14,0x03,0x28,0x42,0x54,0xB7,0x33,0x9D,0x3D,0x9D,0x46,0x80,0x50,0x7F,0x5A,0x6E,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x00,0x00,0x00,0x00,0x00,0x10,0x15,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0xF9,0x70,0x01\
+};
+
+/*********part2 CFG: Noise config setting *************/
+u8 GTP_NOISE_CFG_GROUP_OFLIM[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0xE1,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x64,0x66,0x0E,0x04,0x20,0x3A,0x60,0x99,0x43,0xA4,0x00,0x2D,0x50,0x9B,0xCC,0x14,0x02,0x28,0x41,0x54,0xA7,0x5C,0x97,0x68,0x89,0x75,0x80,0x81,0x77,0x8E,0x71,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x2F,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0x98,0xEC,0x01\
+};
+
+u8 GTP_NOISE_CFG_GROUP_TRULY[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0xE1,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x64,0x66,0x0E,0x04,0x20,0x3A,0x60,0x99,0x43,0xA4,0x00,0x2D,0x50,0x9B,0xCC,0x14,0x02,0x28,0x41,0x54,0xA7,0x5C,0x97,0x68,0x89,0x75,0x80,0x81,0x77,0x8E,0x71,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x2F,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0x98,0xEC,0x01\
+};
+
+u8 GTP_NOISE_CFG_GROUP_BIEL[] = {\
+	0x12,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0xE1,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x64,0x66,0x0E,0x04,0x20,0x3A,0x60,0x99,0x43,0xA4,0x00,0x2D,0x50,0x9B,0xCC,0x14,0x02,0x28,0x41,0x54,0xA7,0x5C,0x97,0x68,0x89,0x75,0x80,0x81,0x77,0x8E,0x71,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x2F,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0x98,0xEC,0x01\
+};
+
+u8 GTP_NOISE_CFG_GROUP_BOE[] = {\
+	0x15,0xD0,0x02,0x00,0x05,0x0A,0x34,0x21,0x08,0x00,0x44,0x0F,0x55,0x32,0xE1,0x11,0x00,0x00,0x11,0x12,0x14,0x14,0x14,0x22,0x0F,0x24,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x96,0x00,0x2F,0x34,0x00,0x00,0x50,0x3C,0x14,0xBE,0x5A,0x46,0x8C,0x2C,0x0D,0x64,0x66,0x0E,0x04,0x20,0x3A,0x60,0x99,0x43,0xA4,0x00,0x2D,0x50,0x96,0xCC,0x14,0x02,0x28,0x41,0x54,0xA7,0x5C,0x97,0x68,0x89,0x75,0x80,0x81,0x77,0x8E,0x71,0x00,0x00,0x00,0x18,0x38,0x58,0x00,0xF0,0x4B,0x3B,0xCC,0xCF,0x17,0xA0,0x01,0xDA,0x00,0x04,0x00,0x00,0x00,0x00,0x00,0x1D,0x26,0x34,0x50,0x50,0x98,0x40,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xA1,0x07,0x32,0x30,0x37,0x28,0x32,0x00,0x00,0x00,0x00,0x00,0x07,0x0A,0x01,0x04,0x08,0x0B,0x02,0x05,0x09,0x0C,0x03,0x06,0x0D,0xFF,0x11,0x12,0x10,0x13,0x0F,0x14,0x0C,0x15,0x0D,0x17,0x0E,0x16,0x05,0x0B,0x04,0x0A,0x03,0x09,0x02,0x08,0x01,0x07,0x00,0x06,0xFF,0xFF,0x50,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x50,0x00,0x00,0x00,0x3C,0x3C,0x08,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x34,0x12,0x00,0x00,0x00,0xFD,0x9E,0x44,0x33,0x02,0xA2,0x07,0x3A,0x00,0x0F,0x00,0x75,0x24,0x46,0x41,0x00,0x00,0xC7,0x13,0xA3,0xCF,0x01\
+};
+
+/* define offset in the config*/
+#define RESOLUTION_LOC      (GTP_REG_CONFIG_RESOLUTION - GTP_REG_CONFIG_DATA)
+#define TRIGGER_LOC         (GTP_REG_CONFIG_TRIGGER - GTP_REG_CONFIG_DATA)
+#define MODULE_SWITCH3_LOC  (GTP_REG_MODULE_SWITCH3 - GTP_REG_CONFIG_DATA)
+
+/* define MAX && MIN size of cfg*/
+#define GTP_CONFIG_MIN_LENGTH    186
+#define GTP_CONFIG_MAX_LENGTH    240
+
+#endif
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..29bd975cceec4e0c0faddc194883542db5a8486b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Kconfig
@@ -0,0 +1,3 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Goodix/Goodix_gt5688/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Goodix/GT9286/Kconfig"
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..8e9a473001db204a1926592a36b3f378eee4caee
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/Makefile
@@ -0,0 +1,12 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_GOODIX_GT5688) += Goodix_gt5688/
+obj-$(CONFIG_TOUCHPANEL_GOODIX_GT9286) += GT9286/
+obj-$(CONFIG_TOUCHPANEL_GOODIX) += goodix_common.o
+obj-$(CONFIG_TOUCHPANEL_GOODIX) += goodix_tool.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..e4a14ff613951c972c053a947cd88e9a737c2e4d
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.c
@@ -0,0 +1,254 @@
+/***************************************************
+ * File:goodix_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             goodix common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "goodix_common.h"
+
+#define TPD_DEVICE "goodix_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)    
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (tp_debug)\
+        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0) 
+
+void GetCirclePoints(struct Coordinate *input_points, int number, struct Coordinate *pPnts)
+{
+    int i = 0;
+    int k = 0, j = 0, m = 0, n = 0;
+    int max_y, min_y, max_x, min_x;
+
+    max_y = input_points[0].y;
+    min_y = input_points[0].y;
+    max_x = input_points[0].x;
+    min_x = input_points[0].x;
+
+    for (i = 0; i < number; i++) {
+        if (input_points[i].y > max_y) {
+            max_y = input_points[i].y;
+            k = i;
+        }
+    }
+    pPnts[2] = input_points[k];
+
+    for (i = 0; i < number; i++) {
+        if (input_points[i].y < min_y) {
+            min_y = input_points[i].y;
+            j = i;
+        }
+    }
+    pPnts[0] = input_points[j];
+
+    for (i = 0; i < number; i++) {
+        if (input_points[i].x > max_x) {
+            max_x = input_points[i].x;
+            m = i;
+        }
+    }
+    pPnts[3] = input_points[m];
+
+    for (i = 0; i < number; i++) {
+        if (input_points[i].x < min_x) {
+            min_x = input_points[i].x;
+            n = i;
+        }
+    }
+    pPnts[1] = input_points[n];
+}
+
+/**
+ * ClockWise -  calculate clockwise for circle gesture
+ * @p: coordinate array head point.
+ * @n: how many points need to be calculated
+ * Return 1--clockwise, 0--anticlockwise, not circle, report 2
+ */
+int ClockWise(struct Coordinate *p, int n)
+{
+    int i, j, k;
+    int count = 0;
+    long int z;
+
+    if (n < 3)
+        return 1;
+    for (i = 0; i < n; i++) {
+        j = (i + 1) % n;
+        k = (i + 2) % n;
+        if ((p[i].x == p[j].x) && (p[j].x == p[j].y))
+            continue;
+        z = (p[j].x - p[i].x) * (p[k].y - p[j].y);
+        z -= (p[j].y - p[i].y) * (p[k].x - p[j].x);
+        if (z < 0)
+            count--;
+        else if (z > 0)
+            count++;
+    }
+
+    TPD_INFO("ClockWise count = %d\n", count);
+
+    if (count > 0)
+        return 1; 
+    else
+        return 0;
+}
+
+static ssize_t tp_devices_check_read_func(struct file *file, char __user * page, size_t size, loff_t * ppos)
+{
+    char pagesize[64] = {0};
+    int ret = 0;
+    struct touchpanel_data *ts = (struct touchpanel_data *)PDE_DATA(file_inode(file));
+    if(!ts)
+        return 0;
+
+    ret = sprintf(pagesize, "%d\n", ts->panel_data.tp_type);
+    ret = simple_read_from_buffer(page, size, ppos, pagesize, strlen(pagesize));
+    return ret;
+}
+
+static const struct file_operations gt1x_devices_check = {
+    .owner = THIS_MODULE,
+    .read  = tp_devices_check_read_func,
+};
+
+//proc/touchpanel/Goodix/config_version
+static int gt1x_tp_config_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct goodix_proc_operations *goodix_ops;
+
+    if(!ts)
+        return 0;
+    goodix_ops = (struct goodix_proc_operations *)(ts->private_data);
+    if (!goodix_ops) {
+        return 0;
+    }
+    if (!goodix_ops->goodix_config_info_read) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+    disable_irq_nosync(ts->client->irq);
+    mutex_lock(&ts->mutex);
+
+    goodix_ops->goodix_config_info_read(s, ts->chip_data);
+
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->client->irq);
+    return 0;
+}
+
+static int proc_data_config_version_read(struct seq_file *s, void *v)
+
+{
+    gt1x_tp_config_read_func(s, v);
+    return 0;
+}
+
+static int gt1x_data_config_version_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, proc_data_config_version_read, PDE_DATA(inode));
+}
+
+static const struct file_operations gt1x_tp_config_version_proc_fops = {
+    .owner = THIS_MODULE,
+    .open = gt1x_data_config_version_open,
+    .read = seq_read,
+    .release = single_release,
+};
+
+static ssize_t goodix_water_protect_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct goodix_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct goodix_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->goodix_water_protect_read) {
+        if(copy_to_user(buff, "Not support auto-test proc node\n", strlen("Not support auto-test proc node\n")))
+                TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->goodix_water_protect_read(file, buff, len, pos);
+    return ret;
+}
+
+static ssize_t goodix_water_protect_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct goodix_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct goodix_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->goodix_water_protect_write) {
+            TPD_INFO("Not support dd proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->goodix_water_protect_write(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations goodix_water_protect_debug_ops =
+{
+	.owner = THIS_MODULE,
+	.read =  goodix_water_protect_read,
+	.write = goodix_water_protect_write,
+};
+
+int Goodix_create_proc(struct touchpanel_data *ts, struct goodix_proc_operations *goodix_ops)
+{
+    int ret = 0;
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    struct proc_dir_entry *prEntry_gt = NULL;
+    ts->private_data = goodix_ops;
+
+    prEntry_gt = proc_mkdir("Goodix", ts->prEntry_tp);
+    if (prEntry_gt == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create GT TP proc entry\n", __func__);
+    }
+
+    prEntry_tmp = proc_create_data("TP_AUTO_TEST_ID", 0777, ts->prEntry_tp, &gt1x_devices_check, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("init_synaptics_proc: Couldn't create proc entry\n");
+    }
+
+    //show config and firmware id interface
+    prEntry_tmp = proc_create_data("config_version", 0666, prEntry_gt, &gt1x_tp_config_version_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("water_protect", 0666, prEntry_gt, &goodix_water_protect_debug_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create water_protect proc entry, %d\n", __func__, __LINE__);
+    }
+
+    return ret;
+}
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..b4af27712d8bc4e29c791c98090b2d5051ab7141
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_common.h
@@ -0,0 +1,61 @@
+/***************************************************
+ * File:goodix_common.h
+ * Copyright(C) 2008-2012 OPPO Mobile Comm Corp., Ltd
+ * Description:
+ *             goodix common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef _TOUCHPANEL_COMMON_GOODIX_H_
+#define _TOUCHPANEL_COMMON_GOODIX_H_
+
+#include "../touchpanel_common.h"
+
+#define IS_NUM_OR_CHAR(x) (((x) >= 'A' && (x) <= 'Z') || ((x) >= '0' && (x) <= '9'))
+
+/****************************PART1:FW Update define*************************************/
+#define FW_HEAD_SIZE                         128
+#define FW_HEAD_SUBSYSTEM_INFO_SIZE          8
+#define FW_HEAD_OFFSET_SUBSYSTEM_INFO_BASE   32
+#define PACK_SIZE                            256
+#define UPDATE_STATUS_IDLE                   0
+#define UPDATE_STATUS_RUNNING                1
+#define UPDATE_STATUS_ABORT                  2
+#define FW_SECTION_TYPE_SS51_PATCH           0x02
+
+typedef enum {
+    GTP_RAWDATA,
+    GTP_DIFFDATA,
+    GTP_BASEDATA,
+}debug_type;
+
+struct goodix_proc_operations {
+    void (*goodix_config_info_read)(struct seq_file *s, void *chip_data);
+    size_t (*goodix_water_protect_write) (struct file *file, const char *buff,  size_t len, loff_t *pos);
+    size_t (*goodix_water_protect_read) (struct file *file, char *buff, size_t len, loff_t *pos);
+};
+
+struct fw_update_info {
+    u8 *buffer;
+    u8 *firmware_file_data;
+    u32 fw_length;
+
+    int status;
+    int progress;
+    int max_progress;
+    struct fw_info *firmware;
+};
+
+/****************************PART2:FUNCTION*************************************/
+void GetCirclePoints(struct Coordinate *input_points, int number, struct Coordinate  *pPnts);
+int  ClockWise(struct Coordinate *p, int n);
+int Goodix_create_proc(struct touchpanel_data *ts, struct goodix_proc_operations *goodix_ops);
+
+#endif
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.c b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.c
new file mode 100644
index 0000000000000000000000000000000000000000..734b204cea40e911d3c8bb7db741c05b1f073942
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.c
@@ -0,0 +1,474 @@
+/***************************************************
+ * File:goodix_tool.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             goodix debugging tool code
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "goodix_tool.h"
+
+int gt1x_rawdiff_mode ;
+
+/****************************PART1:Log TAG****************************/
+
+#define TPD_DEVICE "Goodix-TOOL"
+#define TPD_INFO(fmt, arg...)        pr_err(TPD_DEVICE ": " fmt, ##arg)
+#define TPD_DEBUG(fmt, arg...)       do{\
+    if (tp_debug)\
+    pr_err(TPD_DEVICE ": " fmt, ##arg);\
+}while(0)
+
+#define TPD_DEBUG_ARRAY(array, num)    do{\
+    s32 i;\
+    u8* a = array;\
+    if (tp_debug)\
+    {\
+        pr_err("<< GTP-TOOL-DBG >>");\
+        for (i = 0; i < (num); i++)\
+        {\
+            pr_err("%02x ", (a)[i]);\
+            if ((i + 1) % 10 == 0)\
+            {\
+                pr_err("\n<< GTP-DBG >>");\
+            }\
+        }\
+        pr_err("\n");\
+    }\
+}while(0)
+
+/****************************PART2:Code * && function****************************/
+
+static ssize_t gt1x_tool_read     (struct file *filp, char __user * buffer, size_t count, loff_t * ppos);
+static ssize_t gt1x_tool_write    (struct file *filp, const char *buffer, size_t count, loff_t * ppos);
+static int     gt1x_tool_release(struct inode *inode, struct file *filp);
+static int     gt1x_tool_open    (struct inode *inode, struct file *file);
+
+static struct file_operations gt1x_tool_fops = {
+    .read = gt1x_tool_read,
+    .write = gt1x_tool_write,
+    .open = gt1x_tool_open,
+    .release = gt1x_tool_release,
+    .owner = THIS_MODULE,
+};
+
+int gt1x_init_tool_node(struct touchpanel_data *ts, struct fw_update_info *update_info)
+{
+    struct proc_dir_entry *gt1x_tool_proc_entry;
+    struct Goodix_tool_info *gt_tool_info;
+    gt_tool_info = kzalloc(sizeof(struct Goodix_tool_info), GFP_KERNEL);
+
+    gt_tool_info->is_suspended = &ts->is_suspended;
+    gt_tool_info->esd_handle_support = ts->esd_handle_support;
+    gt_tool_info->esd_info = &ts->esd_info;
+    gt_tool_info->client = ts->client;
+    gt_tool_info->chip_data = ts->chip_data;
+    gt_tool_info->hw_res = &(ts->hw_res);
+    gt_tool_info->reset = ts->ts_ops->reset;
+    gt_tool_info->cmd_head.wr = 1;    //if the first operation is read, will return fail.
+
+    gt_tool_info->cmd_head.data = kzalloc(DATA_LENGTH_UINT, GFP_KERNEL);
+    gt_tool_info->update_info = update_info;
+
+    if (NULL == gt_tool_info->cmd_head.data) {
+        TPD_INFO("Apply for memory failed.");
+        return -1;
+    }
+    TPD_INFO("Alloc memory size:%d.", DATA_LENGTH_UINT);
+
+    gt1x_tool_proc_entry = proc_create_data("goodix_tool", 0666, NULL, &gt1x_tool_fops, gt_tool_info);
+    if (gt1x_tool_proc_entry == NULL) {
+        TPD_INFO("CAN't create proc entry /proc/goodix_tool.");
+        return -1;
+    } else {
+        TPD_INFO("Created proc entry /proc/goodix_tool.");
+    }
+
+    return 0;
+}
+
+#if 0
+void gt1x_deinit_tool_node(void)
+{
+    remove_proc_entry("goodix_tool", NULL);
+    kfree(cmd_head.data);
+    cmd_head.data = NULL;
+}
+#endif
+
+static s32 tool_i2c_read(struct i2c_client *client, u8 * buf, u16 len)
+{
+    int ret = 0;
+    u16 addr = (buf[0] << 8) + buf[1];
+
+    ret = touch_i2c_read_block(client, addr, len, &buf[2]);
+    if (ret < 0) {
+        return -1;
+    }
+
+    return 1;
+}
+
+static s32 tool_i2c_write(struct i2c_client *client, u8 * buf, u16 len)
+{
+    int ret = 0;
+    u16 addr = (buf[0] << 8) + buf[1];
+
+    ret = touch_i2c_write_block(client, addr, len-2, &buf[2]);
+    if (ret < 0) {
+        return -1;
+    }
+
+    return 1;
+}
+
+static u8 relation(u8 src, u8 dst, u8 rlt)
+{
+    u8 ret = 0;
+
+    switch (rlt) {
+        case 0:
+            ret = (src != dst) ? true : false;
+            break;
+
+        case 1:
+            ret = (src == dst) ? true : false;
+            TPD_DEBUG("equal:src:0x%02x   dst:0x%02x   ret:%d.", src, dst, (s32) ret);
+            break;
+
+        case 2:
+            ret = (src > dst) ? true : false;
+            break;
+
+        case 3:
+            ret = (src < dst) ? true : false;
+            break;
+
+        case 4:
+            ret = (src & dst) ? true : false;
+            break;
+
+        case 5:
+            ret = (!(src | dst)) ? true : false;
+            break;
+
+        default:
+            ret = false;
+            break;
+    }
+
+    return ret;
+}
+
+/*******************************************************
+Function:
+Comfirm function.
+Input:
+None.
+Output:
+Return write length.
+ ********************************************************/
+static u8 comfirm(struct Goodix_tool_info *gt_tool_info)
+{
+    s32 i = 0;
+    u8 buf[32];
+
+    memcpy(buf, gt_tool_info->cmd_head.flag_addr, gt_tool_info->cmd_head.addr_len);
+
+    for (i = 0; i < gt_tool_info->cmd_head.times; i++) {
+        if (tool_i2c_read(gt_tool_info->client, buf, 1) <= 0) {
+            TPD_INFO("Read flag data failed!");
+            return -1;
+        }
+
+        if (true == relation(buf[GTP_ADDR_LENGTH], gt_tool_info->cmd_head.flag_val, gt_tool_info->cmd_head.flag_relation)) {
+            TPD_DEBUG("value at flag addr:0x%02x.", buf[GTP_ADDR_LENGTH]);
+            TPD_DEBUG("flag value:0x%02x.", gt_tool_info->cmd_head.flag_val);
+            break;
+        }
+
+        msleep(gt_tool_info->cmd_head.circle);
+    }
+
+    if (i >= gt_tool_info->cmd_head.times) {
+        TPD_INFO("Didn't get the flag to continue!");
+        return -1;
+    }
+
+    return 0;
+}
+
+/*******************************************************
+Function:
+Goodix tool write function.
+Input:
+standard proc write function param.
+Output:
+Return write length.
+ ********************************************************/
+static ssize_t gt1x_tool_write(struct file *filp, const char __user * buff, size_t len, loff_t * data)
+{
+    struct Goodix_tool_info *gt_tool_info = PDE_DATA(file_inode(filp));
+    u64 ret = 0;
+    struct st_cmd_head *cmd_head = &gt_tool_info->cmd_head;
+    struct i2c_client *client = gt_tool_info->client;
+
+    TPD_DEBUG_ARRAY((u8 *) buff, len);
+
+    if (*(gt_tool_info->is_suspended)) {
+        TPD_INFO("IC halt");
+        gt1x_rawdiff_mode = 0;
+
+        return -1;
+    }
+
+    ret = copy_from_user(cmd_head, buff, CMD_HEAD_LENGTH);
+    if (ret) {
+        TPD_INFO("copy_from_user failed.");
+    }
+
+    TPD_DEBUG("wr  :0x%02x.", cmd_head->wr);
+
+    /*
+       TPD_DEBUG("flag:0x%02x.", cmd_head.flag);
+       TPD_DEBUG("flag addr:0x%02x%02x.", cmd_head.flag_addr[0], cmd_head.flag_addr[1]);
+       TPD_DEBUG("flag val:0x%02x.", cmd_head.flag_val);
+       TPD_DEBUG("flag rel:0x%02x.", cmd_head.flag_relation);
+       TPD_DEBUG("circle  :%d.", (s32)cmd_head.circle);
+       TPD_DEBUG("times   :%d.", (s32)cmd_head.times);
+       TPD_DEBUG("retry   :%d.", (s32)cmd_head.retry);
+       TPD_DEBUG("delay   :%d.", (s32)cmd_head.delay);
+       TPD_DEBUG("data len:%d.", (s32)cmd_head.data_len);
+       TPD_DEBUG("addr len:%d.", (s32)cmd_head.addr_len);
+       TPD_DEBUG("addr:0x%02x%02x.", cmd_head.addr[0], cmd_head.addr[1]);
+       TPD_DEBUG("len:%d.", (s32)len);
+       TPD_DEBUG("buf[20]:0x%02x.", buff[CMD_HEAD_LENGTH]);
+     */
+
+    if (1 == cmd_head->wr) {
+        u16 addr, data_len, pos;
+
+        if (1 == cmd_head->flag) {
+            if (comfirm(gt_tool_info)) {
+                TPD_INFO("[WRITE]Comfirm fail!");
+                return -1;
+            }
+        } else if (2 == cmd_head->flag) {
+            //Need interrupt!
+        }
+
+        addr = (cmd_head->addr[0] << 8) + cmd_head->addr[1];
+        data_len = cmd_head->data_len;
+        pos = 0;
+        while (data_len > 0) {
+            len = data_len > DATA_LENGTH ? DATA_LENGTH : data_len;
+            ret = copy_from_user(&cmd_head->data[GTP_ADDR_LENGTH], &buff[CMD_HEAD_LENGTH + pos], len);
+            if (ret) {
+                TPD_INFO("[WRITE]copy_from_user failed.");
+                return -1;
+            }
+            cmd_head->data[0] = ((addr >> 8) & 0xFF);
+            cmd_head->data[1] = (addr & 0xFF);
+
+            TPD_DEBUG_ARRAY(cmd_head->data, len + GTP_ADDR_LENGTH);
+
+            if (tool_i2c_write(client, cmd_head->data, len + GTP_ADDR_LENGTH) <= 0) {
+                TPD_INFO("[WRITE]Write data failed!");
+                return -1;
+            }
+            addr += len;
+            pos += len;
+            data_len -= len;
+        }
+
+        if (cmd_head->delay) {
+            msleep(cmd_head->delay);
+        }
+
+        return cmd_head->data_len + CMD_HEAD_LENGTH;
+    } else if (3 == cmd_head->wr) {    //gt1x unused
+
+        //memcpy(IC_TYPE, cmd_head->data, cmd_head->data_len);
+        return cmd_head->data_len + CMD_HEAD_LENGTH;
+    } else if (5 == cmd_head->wr) {    //?
+
+        //memcpy(IC_TYPE, cmd_head.data, cmd_head.data_len);
+        return cmd_head->data_len + CMD_HEAD_LENGTH;
+    } else if (7 == cmd_head->wr) {    //disable irq!
+        disable_irq_nosync(client->irq);
+
+        if(gt_tool_info->esd_handle_support)
+            esd_handle_switch(gt_tool_info->esd_info, false);  //disable esd check
+
+        return CMD_HEAD_LENGTH;
+    } else if (9 == cmd_head->wr) {    //enable irq!
+        enable_irq(client->irq);
+        if(gt_tool_info->esd_handle_support)
+            esd_handle_switch(gt_tool_info->esd_info, true);   //enable esd check
+        return CMD_HEAD_LENGTH;
+    } else if (17 == cmd_head->wr) {
+        ret = copy_from_user(&cmd_head->data[GTP_ADDR_LENGTH], &buff[CMD_HEAD_LENGTH], cmd_head->data_len);
+        if (ret) {
+            TPD_INFO("copy_from_user failed.");
+            return -1;
+        }
+
+        if (cmd_head->data[GTP_ADDR_LENGTH]) {
+            TPD_DEBUG("gtp enter rawdiff.");
+            gt1x_rawdiff_mode = true;
+        } else {
+            gt1x_rawdiff_mode = false;
+            TPD_DEBUG("gtp leave rawdiff.");
+        }
+
+        return CMD_HEAD_LENGTH;
+    } else if (11 == cmd_head->wr) {
+        if(gt_tool_info->esd_handle_support)        //add test tool
+            esd_handle_switch(gt_tool_info->esd_info, false);  //disable esd check
+  //      disable_irq_nosync(client->irq);
+    } else if (13 == cmd_head->wr) {
+        gt_tool_info->reset(gt_tool_info->chip_data);
+        if(gt_tool_info->esd_handle_support)
+            esd_handle_switch(gt_tool_info->esd_info, true); 
+        gt_tool_info->update_info->status = UPDATE_STATUS_IDLE;
+ //       enable_irq(client->irq);
+    } else if (15 == cmd_head->wr) {
+        
+      /*struct task_struct *thrd = NULL;
+        memset(cmd_head->data, 0, cmd_head->data_len + 1);
+        memcpy(cmd_head->data, &buff[CMD_HEAD_LENGTH], cmd_head->data_len);
+        TPD_DEBUG("update firmware, filename: %s", cmd_head->data);
+        thrd = kthread_run(gt1x_update_firmware, (void *)cmd_head->data, "GT1x FW Update");
+        if (IS_ERR(thrd)) {
+        return PTR_ERR(thrd);
+        }
+      */
+    }
+    return CMD_HEAD_LENGTH;
+}
+
+static int gt1x_tool_open(struct inode *inode, struct file *file)
+{
+    struct Goodix_tool_info *gt_tool_info = PDE_DATA(inode);
+
+    if (gt_tool_info->devicecount > 0) {
+        return -ERESTARTSYS;
+        TPD_INFO("tools open failed!");
+    }
+    gt_tool_info->devicecount++;
+
+    return 0;
+}
+
+static int gt1x_tool_release(struct inode *inode, struct file *filp)
+{
+    struct Goodix_tool_info *gt_tool_info = PDE_DATA(inode);
+
+    gt_tool_info->devicecount--;
+
+    return 0;
+}
+/*******************************************************
+Function:
+Goodix tool read function.
+Input:
+standard proc read function param.
+Output:
+Return read length.
+ ********************************************************/
+static ssize_t gt1x_tool_read(struct file *filp, char __user * buffer, size_t count, loff_t * ppos)
+{
+    struct Goodix_tool_info *gt_tool_info = PDE_DATA(file_inode(filp));
+    struct st_cmd_head *cmd_head = &gt_tool_info->cmd_head;
+
+    if (*ppos) {
+        TPD_DEBUG("[PARAM]size: %zd, *ppos: %d", count, (int)*ppos);
+        *ppos = 0;
+
+        return 0;
+    }
+
+    if (*(gt_tool_info->is_suspended)) {
+        TPD_INFO("IC halt");
+        gt1x_rawdiff_mode = 0;
+
+        return  -1;
+    }
+    if (cmd_head->wr % 2) {
+        TPD_INFO("[READ] invaild operator fail!");
+        return -1;
+    } else if (!cmd_head->wr) {
+        /* general  i2c read  */
+        u16 addr, data_len, len, loc;
+
+        if (1 == cmd_head->flag) {
+            if (comfirm(gt_tool_info)) {
+                TPD_INFO("[READ]Comfirm fail!");
+                return -1;
+            }
+        } else if (2 == cmd_head->flag) {
+            //Need interrupt!
+        }
+
+        addr = (cmd_head->addr[0] << 8) + cmd_head->addr[1];
+        data_len = cmd_head->data_len;
+        loc = 0;
+
+        TPD_DEBUG("[READ] ADDR:0x%04X.", addr);
+        TPD_DEBUG("[READ] Length: %d", data_len);
+
+        if (cmd_head->delay) {
+            msleep(cmd_head->delay);
+        }
+
+        while (data_len > 0) {
+            len = data_len > DATA_LENGTH ? DATA_LENGTH : data_len;
+            cmd_head->data[0] = (addr >> 8) & 0xFF;
+            cmd_head->data[1] = (addr & 0xFF);
+            if (tool_i2c_read(gt_tool_info->client, cmd_head->data, len) <= 0) {
+                TPD_INFO("[READ]Read data failed!");
+                return -1;
+            }
+
+            memcpy(&buffer[loc], &cmd_head->data[GTP_ADDR_LENGTH], len);
+            data_len -= len;
+            addr += len;
+            loc += len;
+            TPD_DEBUG_ARRAY(&cmd_head->data[GTP_ADDR_LENGTH], len);
+        }
+        *ppos += cmd_head->data_len;
+        return cmd_head->data_len;
+    } else if (2 == cmd_head->wr) {
+        TPD_DEBUG("Return ic type:%s len:%d.", buffer, (s32) cmd_head->data_len);
+        return -1;
+    } else if (4 == cmd_head->wr) {
+        /* read fw update progress */
+        buffer[0] = gt_tool_info->update_info->progress >> 8;
+        buffer[1] = gt_tool_info->update_info->progress & 0xff;
+        buffer[2] = gt_tool_info->update_info->max_progress >> 8;
+        buffer[3] = gt_tool_info->update_info->max_progress & 0xff;
+        *ppos += 4;
+
+        return 4;
+    } else if (6 == cmd_head->wr) {
+        //Read error code!
+        return -1;
+    } else if (8 == cmd_head->wr) {
+        /* Read driver version */
+        s32 tmp_len;
+        tmp_len = strlen(GTP_DRIVER_VERSION);
+        memcpy(buffer, GTP_DRIVER_VERSION, tmp_len);
+        buffer[tmp_len] = 0;
+        *ppos += tmp_len + 1;
+        return (tmp_len + 1);
+    }
+    *ppos += cmd_head->data_len;
+
+    return cmd_head->data_len;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.h b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.h
new file mode 100644
index 0000000000000000000000000000000000000000..6e0db1c3cc9b7cccf905072fac169fcccb0291b9
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Goodix/goodix_tool.h
@@ -0,0 +1,64 @@
+/***************************************************
+ * File:goodix_tool.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             goodix debugging tool code
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef _TOUCHPANEL_TOOL_GOODIX_H_
+#define _TOUCHPANEL_TOOL_GOODIX_H_
+
+#include "../touchpanel_common.h"
+#include "goodix_common.h"
+
+#pragma pack(1)
+struct st_cmd_head{
+    u8  wr;              //write read flag£¬0:R  1:W  2:PID 3:
+    u8  flag;            //0:no need flag/int 1: need flag  2:need int
+    u8  flag_addr[2];    //flag address
+    u8  flag_val;        //flag val
+    u8  flag_relation;   //flag_val:flag 0:not equal 1:equal 2:> 3:<
+    u16 circle;          //polling cycle
+    u8  times;           //plling times
+    u8  retry;           //I2C retry times
+    u16 delay;           //delay befor read or after write
+    u16 data_len;        //data length
+    u8  addr_len;        //address length
+    u8  addr[2];         //address
+    u8  res[3];          //reserved
+    u8  *data;           //data pointer
+} ;
+#pragma pack()
+
+struct Goodix_tool_info{
+    u8     devicecount;
+    bool   esd_handle_support;            /*esd handle support feature*/
+    int    *is_suspended;
+    void   *chip_data;
+    struct hw_resource *hw_res;
+    struct i2c_client  *client;
+    struct st_cmd_head cmd_head;
+    struct fw_update_info *update_info;
+    struct esd_information  *esd_info;
+
+    int  (*reset) (void *chip_data); /*Reset Touchpanel*/
+};
+
+int gt1x_init_tool_node(struct touchpanel_data *ts, struct fw_update_info *update_info);
+
+#define GTP_ESD_PROTECT 0
+#define GTP_DRIVER_VERSION          "V1.4<2015/07/10>"
+
+#define DATA_LENGTH_UINT    512
+#define GTP_ADDR_LENGTH     2
+#define DATA_LENGTH         (DATA_LENGTH_UINT - GTP_ADDR_LENGTH)
+#define CMD_HEAD_LENGTH     (sizeof(struct st_cmd_head) - sizeof(u8*))
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Himax/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..84b3c7c6342c163f70cfeb21418a723338c5d404
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/Kconfig
@@ -0,0 +1,3 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Kconfig"
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Himax/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..4cb2a07254228d7f58d7369bf87c07b6dadec07c
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_HIMAX) += himax_common.o
+obj-$(CONFIG_TOUCHPANEL_HIMAX_HX83112B) += hx83112b/
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..caf16be6e019a6f732995e33dda1f7d1493d0b9b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.c
@@ -0,0 +1,499 @@
+/***************************************************
+ * File:himax_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             himax common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "../touchpanel_common.h"
+#include "himax_common.h"
+
+/*******Part0:LOG TAG Declear********************/
+
+#define TPD_DEVICE "himax_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+
+/*******Part1:Call Back Function implement*******/
+void himax_parse_header(struct image_header_data *header, const unsigned char *fw_image)
+{
+    return;
+}
+
+void himax_limit_read(struct seq_file *s, struct touchpanel_data *ts)
+{
+    int ret = 0;
+    uint16_t *prow = NULL;
+    uint16_t *prowcbc = NULL;
+    const struct firmware *fw = NULL;
+    struct test_header *ph = NULL;
+    int i = 0;
+    int temp = 0;
+
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "Request failed, Check the path %d", temp);
+        return;
+    }
+
+    ph = (struct test_header *)(fw->data);
+    prow = (uint16_t *)(fw->data + ph->array_limit_offset);
+    prowcbc = (uint16_t *)(fw->data + ph->array_limitcbc_offset);
+    TPD_INFO("himax_test_limit_show:array_limit_offset = %x array_limitcbc_offset = %x \n",
+            ph->array_limit_offset, ph->array_limitcbc_offset);
+    TPD_DEBUG("test begin:\n");
+    seq_printf(s, "Without cbc:");
+
+    for (i = 0 ; i < (ph->array_limit_size / 2); i++) {
+        if (i % (2 * ts->hw_res.RX_NUM) == 0)
+            seq_printf(s, "\n[%2d] ", (i / ts->hw_res.RX_NUM) / 2);
+        seq_printf(s, "%4d, ", prow[i]);
+        TPD_DEBUG("%d, ", prow[i]);
+    }
+    if (ph->withCBC == 1) {
+        seq_printf(s, "\nWith cbc:");
+        for (i = 0 ; i < (ph->array_limitcbc_size / 2); i++) {
+            if (i % (2 * ts->hw_res.RX_NUM) == 0)
+                seq_printf(s, "\n[%2d] ", (i / ts->hw_res.RX_NUM) / 2);
+            seq_printf(s, "%4d, ", prowcbc[i]);
+            TPD_DEBUG("%d, ", prowcbc[i]);
+        }
+    }
+
+    seq_printf(s, "\n");
+    release_firmware(fw);
+}
+
+//proc/touchpanel/baseline_test
+static int tp_auto_test_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct himax_proc_operations *syna_ops;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    mm_segment_t old_fs;
+    uint8_t data_buf[64];
+//    int ret = 0;
+    int fd = -1;
+
+    struct syna_testdata syna_testdata =
+    {
+        .TX_NUM = 0,
+        .RX_NUM = 0,
+        .fd = -1,
+        .irq_gpio = -1,
+        .key_TX = 0,
+        .key_RX = 0,
+        .TP_FW = 0,
+        .fw = NULL,
+    };
+
+    if (!ts)
+        return 0;
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+    if (!syna_ops->auto_test) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+
+    //step1:disable_irq && get mutex locked
+    disable_irq_nosync(ts->client->irq);
+    mutex_lock(&ts->mutex);
+
+    //step2: create a file to store test data in /sdcard/Tp_Test
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    sprintf(data_buf, "/sdcard/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        enable_irq(ts->client->irq);
+
+        return 0;
+    }
+
+    //step4:init syna_testdata
+    syna_testdata.fd = fd;
+    syna_testdata.TX_NUM = ts->hw_res.TX_NUM;
+    syna_testdata.RX_NUM = ts->hw_res.RX_NUM;
+    syna_testdata.irq_gpio = ts->hw_res.irq_gpio;
+    syna_testdata.key_TX = ts->hw_res.key_TX;
+    syna_testdata.key_RX = ts->hw_res.key_RX;
+    syna_testdata.TP_FW = ts->panel_data.TP_FW;
+
+    syna_ops->auto_test(s, ts->chip_data, &syna_testdata);
+
+    //step5: close file && release test limit firmware
+    if (fd >= 0) {
+        sys_close(fd);
+        set_fs(old_fs);
+    }
+
+    //step6: return to normal mode
+    //ts->ts_ops->reset(ts->chip_data);
+    //operate_mode_switch(ts);
+
+    //step7: unlock the mutex && enable irq trigger
+    mutex_unlock(&ts->mutex);
+    //enable_irq(ts->client->irq);
+
+    return 0;
+}
+
+static int baseline_autotest_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_auto_test_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_auto_test_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = baseline_autotest_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+
+#define HX_TP_PROC_REGISTER
+#define HX_TP_PROC_DEBUG
+#define HX_TP_PROC_FLASH_DUMP
+#define HX_TP_PROC_SELF_TEST
+#define HX_TP_PROC_RESET
+#define HX_TP_PROC_SENSE_ON_OFF
+#define HX_TP_PROC_2T2R
+
+
+static ssize_t himax_proc_register_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_register_read) {
+        if(copy_to_user(buff, "Not support auto-test proc node\n", strlen("Not support auto-test proc node\n")))
+                TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    mutex_lock(&ts->mutex);
+    ret = syna_ops->himax_proc_register_read(file, buff, len, pos);
+    mutex_unlock(&ts->mutex);
+    return ret;
+}
+
+static ssize_t himax_proc_register_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_register_write) {
+            TPD_INFO("Not support auto-test proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    mutex_lock(&ts->mutex);
+    ret = syna_ops->himax_proc_register_write(file, buff, len, pos);
+    mutex_unlock(&ts->mutex);
+    return ret;
+}
+
+static struct file_operations himax_proc_register_ops =
+{
+    .owner = THIS_MODULE,
+    .read = himax_proc_register_read,
+    .write = himax_proc_register_write,
+};
+
+static ssize_t himax_proc_diag_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_diag_read) {
+        if(copy_to_user(buff, "Not support auto-test proc node\n", strlen("Not support auto-test proc node\n")))
+                TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_diag_read(file, buff, len, pos);
+    return ret;
+}
+
+static ssize_t himax_proc_diag_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_diag_write) {
+            TPD_INFO("Not support auto-test proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_diag_write(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations himax_proc_diag_ops =
+{
+    .owner = THIS_MODULE,
+    .read = himax_proc_diag_read,
+    .write = himax_proc_diag_write,
+};
+
+static ssize_t himax_proc_DD_debug_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_DD_debug_read) {
+        if(copy_to_user(buff, "Not support auto-test proc node\n", strlen("Not support auto-test proc node\n")))
+                TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_DD_debug_read(file, buff, len, pos);
+    return ret;
+}
+
+static ssize_t himax_proc_DD_debug_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_DD_debug_write) {
+            TPD_INFO("Not support dd proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_DD_debug_write(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations himax_proc_dd_debug_ops =
+{
+	.owner = THIS_MODULE,
+	.read = himax_proc_DD_debug_read,
+	.write = himax_proc_DD_debug_write,
+};
+
+static ssize_t himax_proc_FW_debug_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_FW_debug_read) {
+            TPD_INFO("Not support fw proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_FW_debug_read(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations himax_proc_fw_debug_ops =
+{
+	.owner = THIS_MODULE,
+	.read = himax_proc_FW_debug_read,
+};
+
+static ssize_t himax_proc_reset_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_reset_write) {
+            TPD_INFO("Not support reset proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_reset_write(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations himax_proc_reset_ops =
+{
+	.owner = THIS_MODULE,
+	.write = himax_proc_reset_write,
+};
+
+static ssize_t himax_proc_sense_on_off_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct himax_proc_operations *syna_ops;
+    ssize_t ret = 0;
+
+    if (!ts)
+        return 0;
+
+    syna_ops = (struct himax_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+
+    if (!syna_ops->himax_proc_sense_on_off_write) {
+            TPD_INFO("Not support senseonoff proc node %s %d\n",__func__,__LINE__);
+        return 0;
+    }
+
+    ret = syna_ops->himax_proc_sense_on_off_write(file, buff, len, pos);
+    return ret;
+}
+
+static struct file_operations himax_proc_sense_on_off_ops =
+{
+	.owner = THIS_MODULE,
+	.write = himax_proc_sense_on_off_write,
+};
+
+int himax_create_proc(struct touchpanel_data *ts, struct himax_proc_operations *syna_ops)
+{
+    int ret = 0;
+
+    // touchpanel_auto_test interface
+    struct proc_dir_entry *prEntry_himax = NULL;
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    ts->private_data = syna_ops;
+    prEntry_tmp = proc_create_data("baseline_test", 0666, ts->prEntry_tp, &tp_auto_test_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files:/proc/touchpanel/debug_info/himax
+    prEntry_himax = proc_mkdir("himax", ts->prEntry_debug_tp);
+    if (prEntry_himax == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create /proc/touchpanel/debug_info/himax proc entry\n", __func__);
+    }
+
+   //proc files: /proc/touchpanel/debug_info/himax/register
+    prEntry_tmp = proc_create_data("register", 0666, prEntry_himax, &himax_proc_register_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files: /proc/touchpanel/debug_info/himax/diag
+    prEntry_tmp = proc_create_data("diag", 0666, prEntry_himax, &himax_proc_diag_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files: /proc/touchpanel/debug_info/himax/dd
+    prEntry_tmp = proc_create_data("dd", 0666, prEntry_himax, &himax_proc_dd_debug_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files: /proc/touchpanel/debug_info/himax/fw
+    prEntry_tmp = proc_create_data("fw", 0666, prEntry_himax, &himax_proc_fw_debug_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files: /proc/touchpanel/debug_info/himax/reset
+    prEntry_tmp = proc_create_data("reset", 0666, prEntry_himax, &himax_proc_reset_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files: /proc/touchpanel/debug_info/himax/senseonoff
+    prEntry_tmp = proc_create_data("senseonoff", 0666, prEntry_himax, &himax_proc_sense_on_off_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+    return ret;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..80daed3f44357cef23d4c34450fcada8aa263930
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/himax_common.h
@@ -0,0 +1,144 @@
+/***************************************************
+ * File:himax_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             himax common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef HIMAX_COMMON_H
+#define HIMAX_COMMON_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+
+/*********PART2:Define Area**********************/
+#define SYNAPTICS_RMI4_PRODUCT_ID_SIZE 10
+#define SYNAPTICS_RMI4_PRODUCT_INFO_SIZE 2
+
+#define DiagonalUpperLimit  1100
+#define DiagonalLowerLimit  900
+
+
+
+/*********PART3:Struct Area**********************/
+struct image_header {
+    /* 0x00 - 0x0f */
+    unsigned char checksum[4];
+    unsigned char reserved_04;
+    unsigned char reserved_05;
+    unsigned char options_firmware_id:1;
+    unsigned char options_contain_bootloader:1;
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned char options_guest_code:1;
+    unsigned char options_tddi:1;
+    unsigned char options_reserved:4;
+    /* only available in s4322 , reserved in other ,  end*/
+    unsigned char bootloader_version;
+    unsigned char firmware_size[4];
+    unsigned char config_size[4];
+    /* 0x10 - 0x1f */
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE];
+    unsigned char package_id[2];
+    unsigned char package_id_revision[2];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+    /* 0x20 - 0x2f */
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned char bootloader_addr[4];
+    unsigned char bootloader_size[4];
+    unsigned char ui_addr[4];
+    unsigned char ui_size[4];
+    /* only available in s4322 , reserved in other ,  end*/
+    /* 0x30 - 0x3f */
+    unsigned char ds_id[16];
+    /* 0x40 - 0x4f */
+    /* only available in s4322 , reserved in other, begin*/
+    union {
+        struct {
+            unsigned char dsp_cfg_addr[4];
+            unsigned char dsp_cfg_size[4];
+            unsigned char reserved_48_4f[8];
+          };
+    };
+    /* only available in s4322 , reserved in other ,  end*/
+    /* 0x50 - 0x53 */
+    unsigned char firmware_id[4];
+};
+
+struct image_header_data {
+    bool contains_firmware_id;
+    unsigned int firmware_id;
+    unsigned int checksum;
+    unsigned int firmware_size;
+    unsigned int config_size;
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned int disp_config_offset;
+    unsigned int disp_config_size;
+    unsigned int bootloader_offset;
+    unsigned int bootloader_size;
+    /* only available in s4322 , reserved in other ,  end*/
+    unsigned char bootloader_version;
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE + 1];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+};
+
+
+struct test_header {
+    unsigned int magic1;
+    unsigned int magic2;
+    unsigned int withCBC;
+    unsigned int array_limit_offset;
+    unsigned int array_limit_size;
+    unsigned int array_limitcbc_offset;
+    unsigned int array_limitcbc_size;
+};
+
+struct syna_testdata{
+    int TX_NUM;
+    int RX_NUM;
+    int fd;
+    int irq_gpio;
+    int key_TX;
+    int key_RX;
+    uint64_t  TP_FW;
+    const struct firmware *fw;
+};
+
+//import from "android/bootable/bootloader/lk/platform/msm_shared/include/msm_panel.h"
+enum {
+    OPPO16037JDI_R63452_1080P_CMD_PANEL = 13,
+    OPPO16037SAMSUNG_S6E3FA5_1080P_CMD_PANEL = 14,
+    UNKNOWN_PANEL
+};
+
+struct himax_proc_operations {
+    void (*auto_test)    (struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata);
+    size_t (*himax_proc_register_write) (struct file *file, const char *buff,  size_t len, loff_t *pos);
+    size_t (*himax_proc_register_read) (struct file *file, char *buff, size_t len, loff_t *pos);
+    size_t (*himax_proc_diag_write) (struct file *file, const char *buff,  size_t len, loff_t *pos);
+    size_t (*himax_proc_diag_read) (struct file *file, char *buff, size_t len, loff_t *pos);
+    size_t (*himax_proc_DD_debug_read) (struct file *file, char *buf, size_t len, loff_t *pos);
+    size_t (*himax_proc_DD_debug_write) (struct file *file, const char *buff, size_t len, loff_t *pos);
+    size_t (*himax_proc_FW_debug_read) (struct file *file, char *buff, size_t len, loff_t *pos);
+    size_t (*himax_proc_reset_write) (struct file *file, const char *buff, size_t len, loff_t *pos);
+    size_t (*himax_proc_sense_on_off_write) (struct file *file, const char *buff, size_t len, loff_t *pos);
+};
+
+
+void himax_limit_read(struct seq_file *s, struct touchpanel_data *ts);
+int  himax_create_proc(struct touchpanel_data *ts, struct himax_proc_operations *syna_ops);
+void himax_parse_header(struct image_header_data *header, const unsigned char *fw_image);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..3b062edf2eb07d342adc4e18a16b261a6fc6334b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by MingQiang.Guo@Bsp.group.Tp for himax hx833112B ic driver
+
+config TOUCHPANEL_HIMAX_HX83112B
+#	default y
+	bool "TP himax hx83112b IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing himax hx83112b
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..276de6ef3460d7ef31e572bf8a5ed0d9b1c353fc
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/Makefile
@@ -0,0 +1,12 @@
+ccflags-y += -I$(srctree)/drivers/input/touchscreen/mediatek/hxchipset/
+ccflags-y += -I$(srctree)/drivers/input/touchscreen/mediatek/
+#ccflags-y += -I$(srctree)/drivers/misc/mediatek/include/mt-plat/
+#ccflags-y += -I$(srctree)/drivers/misc/mediatek/include/mt-plat/$(MTK_PLATFORM)/include/
+ccflags-y += -I$(srctree)/drivers/misc/mediatek/i2c/$(MTK_PLATFORM)/
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_HIMAX_HX83112B) += hx83112b.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.c b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.c
new file mode 100644
index 0000000000000000000000000000000000000000..80e4be53a8e98a2c93f0508dea62c6420c6fdb93
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.c
@@ -0,0 +1,4303 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+ * File       : hx83112b_drivers_s4322.c
+ * Description: Source file for hx83112b S4322 driver
+ * Version   : 1.0
+ * Date        : 2017-04-17
+ * Author    : MingQiang.Guo@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2017-04-17, MingQiang.Guo@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/326176)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "hx83112b.h"
+
+static struct chip_data_hx83112b *g_chip_info = NULL;
+
+#define OPPO17001TRULY_TD4322_1080P_CMD_PANEL 29
+
+/*******Part0:LOG TAG Declear********************/
+#define TPD_DEVICE "himax83112b"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+
+struct himax_report_data *hx_touch_data;
+int himax_touch_data_size = 128;
+int HX_HW_RESET_ACTIVATE = 0;
+static int HX_TOUCH_INFO_POINT_CNT   = 0;
+
+/*******Part1: Function Declearation*******/
+static int hx83112b_power_control(void *chip_data, bool enable);
+static int hx83112b_get_chip_info(void *chip_data);
+static int hx83112b_mode_switch(void *chip_data, work_mode mode, bool flag);
+
+/*******Part2:Call Back Function implement*******/
+
+//add for himax
+void himax_flash_write_burst(struct i2c_client *client, uint8_t * reg_byte, uint8_t * write_data)
+{
+    uint8_t data_byte[8];
+    int i = 0;
+    int j = 0;
+
+    for (i = 0; i < 4; i++) {
+        data_byte[i] = reg_byte[i];
+    }
+    for (j = 4; j < 8; j++) {
+        data_byte[j] = write_data[j - 4];
+    }
+
+    if (touch_i2c_write_block(client, 0x00, 8, data_byte) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return;
+    }
+}
+
+void himax_flash_write_burst_length(struct i2c_client *client, uint8_t *reg_byte, uint8_t *write_data, int length)
+{
+    uint8_t data_byte[256];
+    int i = 0;
+    int j = 0;
+
+    for (i = 0; i < 4; i++) {
+        data_byte[i] = reg_byte[i];
+    }
+    for (j = 4; j < length + 4; j++) {
+        data_byte[j] = write_data[j - 4];
+    }
+
+    if (touch_i2c_write_block(client, 0x00, length + 4, data_byte) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return;
+    }
+}
+
+void himax_burst_enable(struct i2c_client *client, uint8_t auto_add_4_byte)
+{
+    uint8_t tmp_data[4];
+    tmp_data[0] = 0x31;
+
+    if (touch_i2c_write_block(client, 0x13, 1, tmp_data) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return;
+    }
+
+    tmp_data[0] = (0x10 | auto_add_4_byte);
+    if (touch_i2c_write_block(client, 0x0D, 1, tmp_data) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return;
+    }
+    /*isBusrtOn = true;*/
+}
+
+void himax_register_read(struct i2c_client *client, uint8_t *read_addr, int read_length, uint8_t *read_data, bool cfg_flag)
+{
+    uint8_t tmp_data[4];
+    int ret;
+    if(cfg_flag == false) {
+        if(read_length>256) {
+            TPD_INFO("%s: read len over 256!\n", __func__);
+            return;
+        }
+        if (read_length > 4) {
+            himax_burst_enable(client, 1);
+        } else {
+            himax_burst_enable(client, 0);
+        }
+
+        tmp_data[0] = read_addr[0];
+        tmp_data[1] = read_addr[1];
+        tmp_data[2] = read_addr[2];
+        tmp_data[3] = read_addr[3];
+        ret = touch_i2c_write_block(client, 0x00, 4, tmp_data);
+        if (ret < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+        tmp_data[0] = 0x00;
+        ret = touch_i2c_write_block(client, 0x0C, 1, tmp_data);
+        if (ret < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+
+        if (touch_i2c_read_block(client, 0x08, read_length, read_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+        if (read_length > 4) {
+            himax_burst_enable(client, 0);
+        }
+    } else if(cfg_flag == true) {
+        if(touch_i2c_read_block(client, read_addr[0], read_length, read_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+    } else {
+        TPD_INFO("%s: cfg_flag = %d, value is wrong!\n", __func__,cfg_flag);
+        return;
+    }
+}
+
+void himax_register_write(struct i2c_client *client, uint8_t *write_addr, int write_length, uint8_t *write_data, bool cfg_flag)
+{
+    int i =0;
+    int address = 0;
+    if (cfg_flag == false) {
+        address = (write_addr[3] << 24) + (write_addr[2] << 16) + (write_addr[1] << 8) + write_addr[0];
+
+        for (i = address; i < address + write_length; i++) {
+            if (write_length > 4) {
+                himax_burst_enable(client, 1);
+            } else {
+                himax_burst_enable(client, 0);
+            }
+            himax_flash_write_burst_length(client, write_addr, write_data, write_length);
+        }
+    } else if(cfg_flag == true) {
+        if(touch_i2c_write_block(client, write_addr[0], write_length, write_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+    } else {
+        TPD_INFO("%s: cfg_flag = %d, value is wrong!\n", __func__,cfg_flag);
+        return;
+    }
+}
+
+bool himax_sense_off(struct i2c_client *client)
+{
+    uint8_t cnt = 0;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    do {
+        //===========================================
+        //  0x31 ==> 0x27
+        //===========================================
+        tmp_data[0] = 0x27;
+        if (touch_i2c_write_block(client, 0x31, 1, tmp_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return false;
+        }
+        //===========================================
+        //  0x32 ==> 0x95
+        //===========================================
+        tmp_data[0] = 0x95;
+        if (touch_i2c_write_block(client, 0x32, 1, tmp_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return false;
+        }
+
+        // ======================
+        // Check enter_save_mode
+        // ======================
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0xA8;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+        TPD_INFO("%s: Check enter_save_mode data[0]=%X \n", __func__,tmp_data[0]);
+
+        if (tmp_data[0] == 0x0C) {
+            //=====================================
+            // Reset TCON
+            //=====================================
+            tmp_addr[3] = 0x80;
+            tmp_addr[2] = 0x02;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x20;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x00;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+            msleep(1);
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x01;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+            //=====================================
+            // Reset ADC
+            //=====================================
+            tmp_addr[3] = 0x80;
+            tmp_addr[2] = 0x02;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x94;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x00;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+            msleep(1);
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x01;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+            return true;
+        } else {
+            msleep(10);
+            #ifdef HX_RST_PIN_FUNC
+            himax_ic_reset(false, false);
+            #endif
+        }
+    } while (cnt++ < 15);
+
+    return false;
+}
+
+void himax_interface_on(struct i2c_client *client)
+{
+    uint8_t tmp_data[5];
+    uint8_t tmp_data2[2];
+    int cnt = 0;
+
+    //Read a dummy register to wake up I2C.
+    if ( touch_i2c_read_block(client, 0x08, 4, tmp_data) < 0) { // to knock I2C
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return;
+    }
+
+    do {
+        //===========================================
+        // Enable continuous burst mode : 0x13 ==> 0x31
+        //===========================================
+        tmp_data[0] = 0x31;
+        if (touch_i2c_write_block(client, 0x13, 1, tmp_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+        //===========================================
+        // AHB address auto +4 : 0x0D ==> 0x11
+        // Do not AHB address auto +4 : 0x0D ==> 0x10
+        //===========================================
+        tmp_data[0] = (0x10);
+        if (touch_i2c_write_block(client, 0x0D, 1, tmp_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+
+        // Check cmd
+        touch_i2c_read_block(client, 0x13, 1, tmp_data);
+        touch_i2c_read_block(client, 0x0D, 1, tmp_data2);
+
+        if (tmp_data[0] == 0x31 && tmp_data2[0] == 0x10) {
+            //isBusrtOn = true;
+            break;
+        }
+        msleep(1);
+    } while (++cnt < 10);
+
+    if (cnt > 0) {
+        TPD_INFO("%s:Polling burst mode: %d times", __func__,cnt);
+    }
+}
+
+void himax_diag_register_set(struct i2c_client *client, uint8_t diag_command)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    TPD_INFO("diag_command = %d\n", diag_command );
+
+    himax_interface_on(client);
+
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x02;
+    tmp_addr[1] = 0x04;
+    tmp_addr[0] = 0xB4;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = diag_command;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    himax_register_read(client, tmp_addr, 4, tmp_data, false);
+    TPD_INFO("%s: tmp_data[3]=0x%02X,tmp_data[2]=0x%02X,tmp_data[1]=0x%02X,tmp_data[0]=0x%02X!\n",
+             __func__,tmp_data[3],tmp_data[2],tmp_data[1],tmp_data[0]);
+
+}
+
+
+bool wait_wip(struct i2c_client *client, int Timing)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t in_buffer[10];
+    //uint8_t out_buffer[20];
+    int retry_cnt = 0;
+
+    //=====================================
+    // SPI Transfer Format : 0x8000_0010 ==> 0x0002_0780
+    //=====================================
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x10;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x02;
+    tmp_data[1] = 0x07;
+    tmp_data[0] = 0x80;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    in_buffer[0] = 0x01;
+
+    do {
+        //=====================================
+        // SPI Transfer Control : 0x8000_0020 ==> 0x4200_0003
+        //=====================================
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x20;
+        tmp_data[3] = 0x42;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x03;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        //=====================================
+        // SPI Command : 0x8000_0024 ==> 0x0000_0005
+        // read 0x8000_002C for 0x01, means wait success
+        //=====================================
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x24;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x05;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        in_buffer[0] = in_buffer[1] = in_buffer[2] = in_buffer[3] = 0xFF;
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x2C;
+        himax_register_read(client, tmp_addr, 4, in_buffer, false);
+
+        if ((in_buffer[0] & 0x01) == 0x00) {
+            return true;
+        }
+
+        retry_cnt++;
+
+        if (in_buffer[0] != 0x00 || in_buffer[1] != 0x00 || in_buffer[2] != 0x00 || in_buffer[3] != 0x00) {
+            TPD_INFO("%s:Wait wip retry_cnt:%d, buffer[0]=%d, buffer[1]=%d, buffer[2]=%d, buffer[3]=%d \n", __func__,
+              retry_cnt,in_buffer[0],in_buffer[1],in_buffer[2],in_buffer[3]);
+        }
+
+        if (retry_cnt > 100) {
+            TPD_INFO("%s: Wait wip error!\n", __func__);
+            return false;
+        }
+        msleep(Timing);
+    } while ((in_buffer[0] & 0x01) == 0x01);
+    return true;
+}
+
+
+void himax_sense_on(struct i2c_client *client, uint8_t FlashMode)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    int retry = 0;
+
+    TPD_INFO("Enter %s  \n", __func__);
+
+    himax_interface_on(client);
+
+    if (!FlashMode) {
+        //===AHBI2C_SystemReset==========
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x18;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x55;
+        himax_register_write(client, tmp_addr, 4, tmp_data, false);
+    } else {
+        do {
+            tmp_addr[3] = 0x90;
+            tmp_addr[2] = 0x00;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x98;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x53;
+            himax_register_write(client, tmp_addr, 4, tmp_data, false);
+
+            tmp_addr[0] = 0xE4;
+            himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+            TPD_INFO("%s:Read status from IC = %X,%X\n", __func__, tmp_data[0],tmp_data[1]);
+        } while((tmp_data[1] != 0x01 || tmp_data[0] != 0x00) && retry++ < 5);
+
+        if (retry >= 5) {
+            TPD_INFO("%s: Fail:\n", __func__);
+
+            //===AHBI2C_SystemReset==========
+            tmp_addr[3] = 0x90;
+            tmp_addr[2] = 0x00;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x18;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x55;
+            himax_register_write(client, tmp_addr, 4, tmp_data, false);
+        } else {
+            TPD_INFO("%s:OK and Read status from IC = %X,%X\n", __func__, tmp_data[0],tmp_data[1]);
+
+            /* reset code*/
+            tmp_data[0] = 0x00;
+            if (touch_i2c_write_block(client, 0x31, 1, tmp_data) < 0) {
+                TPD_INFO("%s: i2c access fail!\n", __func__);
+            }
+            if (touch_i2c_write_block(client, 0x32, 1, tmp_data) < 0) {
+                TPD_INFO("%s: i2c access fail!\n", __func__);
+            }
+
+            tmp_addr[3] = 0x90;
+            tmp_addr[2] = 0x00;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x98;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x00;
+            himax_register_write(client, tmp_addr, 4, tmp_data, false);
+        }
+    }
+}
+
+bool himax_ic_package_check(struct i2c_client *client)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t ret_data = 0x00;
+    int i = 0;
+
+    for (i = 0; i < 5; i++) {
+        // Product ID
+        // Touch
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0xD0;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+        TPD_INFO("%s:Read driver IC ID = %X,%X,%X\n", __func__, tmp_data[3],tmp_data[2],tmp_data[1]);
+        if ((tmp_data[3] == 0x83) && (tmp_data[2] == 0x11) && ((tmp_data[1] == 0x2a)||(tmp_data[1] == 0x2b))) {
+            IC_TYPE = HX_83112A_SERIES_PWON;
+            IC_CHECKSUM = HX_TP_BIN_CHECKSUM_CRC;
+            //Himax: Set FW and CFG Flash Address
+            FW_VER_MAJ_FLASH_ADDR   = 49157;  //0x00C005
+            FW_VER_MAJ_FLASH_LENG   = 1;
+            FW_VER_MIN_FLASH_ADDR   = 49158;  //0x00C006
+            FW_VER_MIN_FLASH_LENG   = 1;
+            CFG_VER_MAJ_FLASH_ADDR = 49408;  //0x00C100
+            CFG_VER_MAJ_FLASH_LENG = 1;
+            CFG_VER_MIN_FLASH_ADDR = 49409;  //0x00C101
+            CFG_VER_MIN_FLASH_LENG = 1;
+            CID_VER_MAJ_FLASH_ADDR = 49154;  //0x00C002
+            CID_VER_MAJ_FLASH_LENG = 1;
+            CID_VER_MIN_FLASH_ADDR = 49155;  //0x00C003
+            CID_VER_MIN_FLASH_LENG = 1;
+            //PANEL_VERSION_ADDR = 49156;  //0x00C004
+            //PANEL_VERSION_LENG = 1;
+#ifdef HX_AUTO_UPDATE_FW
+            g_i_FW_VER = i_CTPM_FW[FW_VER_MAJ_FLASH_ADDR]<<8 |i_CTPM_FW[FW_VER_MIN_FLASH_ADDR];
+            g_i_CFG_VER = i_CTPM_FW[CFG_VER_MAJ_FLASH_ADDR]<<8 |i_CTPM_FW[CFG_VER_MIN_FLASH_ADDR];
+            g_i_CID_MAJ = i_CTPM_FW[CID_VER_MAJ_FLASH_ADDR];
+            g_i_CID_MIN = i_CTPM_FW[CID_VER_MIN_FLASH_ADDR];
+#endif
+            TPD_INFO("Himax IC package 83112_in\n");
+            ret_data = true;
+            break;
+        } else {
+            ret_data = false;
+            TPD_INFO("%s:Read driver ID register Fail:\n", __func__);
+        }
+    }
+
+    return ret_data;
+}
+
+
+void himax_power_on_init(struct i2c_client *client)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    TPD_INFO("%s:  client->addr = %d\n", __func__, client->addr );
+    //himax_touch_information(client);
+
+    /*RawOut select initial*/
+    tmp_addr[3] = 0x80;tmp_addr[2] = 0x02;tmp_addr[1] = 0x04;tmp_addr[0] = 0xB4;
+    tmp_data[3] = 0x00;tmp_data[2] = 0x00;tmp_data[1] = 0x00;tmp_data[0] = 0x00;
+    himax_register_write(client,tmp_addr, 4, tmp_data, false);
+
+    /*DSRAM func initial*/
+    tmp_addr[3] = 0x10;tmp_addr[2] = 0x00;tmp_addr[1] = 0x07;tmp_addr[0] = 0xFC;
+    tmp_data[3] = 0x00;tmp_data[2] = 0x00;tmp_data[1] = 0x00;tmp_data[0] = 0x00;
+    himax_register_write(client,tmp_addr, 4, tmp_data, false);
+
+    himax_sense_on(client, 0x00);
+}
+
+
+void himax_read_FW_ver(struct i2c_client *client)
+{
+    uint8_t cmd[4];
+    uint8_t data[64];
+    uint8_t data2[64];
+    int retry = 200;
+    int reload_status = 0;
+
+    while(reload_status == 0) {
+       cmd[3] = 0x10;  // oppo fw id bin address : 0xc014   , 49172    Tp ic address : 0x 10007014
+       cmd[2] = 0x00;
+       cmd[1] = 0x7f;
+       cmd[0] = 0x00;
+       himax_register_read(client, cmd, 4, data, false);
+
+       cmd[3] = 0x10;
+       cmd[2] = 0x00;
+       cmd[1] = 0x72;
+       cmd[0] = 0xc0;
+       himax_register_read(client, cmd, 4, data2, false);
+
+       if((data[3]==0x00 && data[2]==0x00 && data[1]==0x3A && data[0]==0xA3)
+            || (data2[3]==0x00 && data2[2]==0x00 && data2[1]==0x72 && data2[0]==0xC0)) {
+           TPD_INFO("reload OK! \n");
+           reload_status = 1;
+           break;
+       } else if(retry == 0) {
+           TPD_INFO("reload 20 times! fail \n");
+           //TPD_INFO("%s : data[0]=0x%2.2X,data[1]=0x%2.2X,data[2]=0x%2.2X,data[3]=0x%2.2X\n",__func__,data[0],data[1],data[2],data[3]);
+           //TPD_INFO("%s : data2[0]=0x%2.2X,data2[1]=0x%2.2X,data2[2]=0x%2.2X,data2[3]=0x%2.2X\n",__func__,data2[0],data2[1],data2[2],data2[3]);
+           return;
+       } else {
+           retry --;
+           msleep(10);
+           TPD_INFO("reload fail ,delay 10ms retry=%d\n",retry);
+       }
+    }
+    TPD_INFO("%s : data[0]=0x%2.2X,data[1]=0x%2.2X,data[2]=0x%2.2X,data[3]=0x%2.2X\n",__func__,data[0],data[1],data[2],data[3]);
+    TPD_INFO("%s : data2[0]=0x%2.2X,data2[1]=0x%2.2X,data2[2]=0x%2.2X,data2[3]=0x%2.2X\n",__func__,data2[0],data2[1],data2[2],data[3]);
+    TPD_INFO("reload_status=%d\n",reload_status);
+
+    himax_sense_off(client);
+
+    //=====================================
+    // Read FW version : 0x1000_7004  but 05,06 are the real addr for FW Version
+    //=====================================
+
+    cmd[3] = 0x10;
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x04;
+    himax_register_read(client, cmd, 4, data, false);
+
+
+    TPD_INFO("PANEL_VER : %X \n", data[0]);
+    TPD_INFO("FW_VER : %X \n", data[1] << 8 | data[2]);
+
+    cmd[3] = 0x10;
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x84;
+    himax_register_read(client, cmd, 4, data, false);
+
+    TPD_INFO("CFG_VER : %X \n", data[2] << 8 | data[3]);
+    TPD_INFO("TOUCH_VER : %X \n", data[2]);
+    TPD_INFO("DISPLAY_VER : %X \n", data[3]);
+
+    cmd[3] = 0x10;
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x00;
+    himax_register_read(client, cmd, 4, data, false);
+
+    TPD_INFO("CID_VER : %X \n",( data[2] << 8 | data[3]) );
+    return;
+}
+
+
+void himax_read_OPPO_FW_ver(struct i2c_client *client)
+{
+    uint8_t cmd[4];
+    uint8_t data[64];
+
+    cmd[3] = 0x10;  // oppo fw id bin address : 0xc014    Tp ic address : 0x 10007014
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x14;
+    himax_register_read(client, cmd, 4, data, false);
+
+
+    TPD_INFO("%s : data[0]=0x%2.2X,data[1]=0x%2.2X,data[2]=0x%2.2X,data[3]=0x%2.2X\n",__func__,data[0],data[1],data[2],data[3]);
+
+    return;
+}
+
+uint32_t himax_hw_check_CRC(struct i2c_client *client, uint8_t *start_addr, int reload_length)
+{
+    uint32_t result = 0;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    int cnt = 0;
+    int length = reload_length / 4;
+
+    //CRC4 // 0x8005_0020 <= from, 0x8005_0028 <= 0x0099_length
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x05;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x20;
+    //tmp_data[3] = 0x00; tmp_data[2] = 0x00; tmp_data[1] = 0xFB; tmp_data[0] = 0x00;
+    himax_flash_write_burst(client, tmp_addr, start_addr);
+
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x05;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x28;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x99;
+    tmp_data[1] = (length >> 8);
+    tmp_data[0] = length;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    cnt = 0;
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x05;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x00;
+    do {
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+        if ((tmp_data[0] & 0x01) != 0x01) {
+            tmp_addr[3] = 0x80;
+            tmp_addr[2] = 0x05;
+            tmp_addr[1] = 0x00;
+            tmp_addr[0] = 0x18;
+            himax_register_read(client, tmp_addr, 4, tmp_data, false);
+            TPD_INFO("%s: tmp_data[3]=%X, tmp_data[2]=%X, tmp_data[1]=%X, tmp_data[0]=%X  \n", __func__, tmp_data[3], tmp_data[2], tmp_data[1], tmp_data[0]);
+            result = ((tmp_data[3] << 24) + (tmp_data[2] << 16) + (tmp_data[1] << 8) + tmp_data[0]);
+            break;
+        }
+    } while (cnt++ < 100);
+
+    return result;
+}
+
+
+bool himax_calculateChecksum(struct i2c_client *client, bool change_iref)
+{
+    uint8_t CRC_result = 0;
+    uint8_t tmp_data[4];
+
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+
+    CRC_result = himax_hw_check_CRC(client,tmp_data, FW_SIZE_64k);
+
+    msleep(50);
+
+    return !CRC_result;
+}
+
+int cal_data_len(int raw_cnt_rmd, int HX_MAX_PT, int raw_cnt_max)
+{
+    int RawDataLen;
+    if (raw_cnt_rmd != 0x00) {
+        RawDataLen = 128 - ((HX_MAX_PT+raw_cnt_max + 3) *4) - 1;
+    } else {
+        RawDataLen = 128 - ((HX_MAX_PT+raw_cnt_max + 2) *4) - 1;
+    }
+    return RawDataLen;
+}
+
+
+int himax_report_data_init(int max_touch_point, int tx_num, int rx_num)
+{
+    if (hx_touch_data->hx_coord_buf!=NULL) {
+        kfree(hx_touch_data->hx_coord_buf);
+    }
+
+    if(hx_touch_data->diag_mutual != NULL) {
+        kfree(hx_touch_data->diag_mutual);
+    }
+
+//#if defined(HX_SMART_WAKEUP)
+    hx_touch_data->event_size = 128;
+//#endif*/
+
+    hx_touch_data->touch_all_size = 128; //himax_get_touch_data_size();
+
+    HX_TOUCH_INFO_POINT_CNT = max_touch_point * 4 ;
+
+    if ((max_touch_point % 4) == 0)
+        HX_TOUCH_INFO_POINT_CNT += (max_touch_point / 4) * 4 ;
+    else
+        HX_TOUCH_INFO_POINT_CNT += ((max_touch_point / 4) +1) * 4 ;
+
+    hx_touch_data->raw_cnt_max = max_touch_point/4;
+    hx_touch_data->raw_cnt_rmd = max_touch_point%4;
+
+    if (hx_touch_data->raw_cnt_rmd != 0x00) {//more than 4 fingers
+        hx_touch_data->rawdata_size = cal_data_len(hx_touch_data->raw_cnt_rmd, max_touch_point, hx_touch_data->raw_cnt_max);
+        hx_touch_data->touch_info_size = (max_touch_point+hx_touch_data->raw_cnt_max+2)*4;
+    } else {//less than 4 fingers
+        hx_touch_data->rawdata_size = cal_data_len(hx_touch_data->raw_cnt_rmd, max_touch_point, hx_touch_data->raw_cnt_max);
+        hx_touch_data->touch_info_size = (max_touch_point+hx_touch_data->raw_cnt_max+1)*4;
+    }
+
+    if ((tx_num * rx_num + tx_num + rx_num) % hx_touch_data->rawdata_size == 0) {
+        hx_touch_data->rawdata_frame_size = (tx_num * rx_num + tx_num + rx_num) / hx_touch_data->rawdata_size;
+    } else {
+        hx_touch_data->rawdata_frame_size = (tx_num * rx_num + tx_num + rx_num) / hx_touch_data->rawdata_size + 1;
+    }
+    TPD_INFO("%s: rawdata_frame_size = %d ",__func__,hx_touch_data->rawdata_frame_size);
+    TPD_INFO("%s: max_touch_point:%d,hx_raw_cnt_max:%d,hx_raw_cnt_rmd:%d,g_hx_rawdata_size:%d,hx_touch_data->touch_info_size:%d\n",
+             __func__, max_touch_point, hx_touch_data->raw_cnt_max, hx_touch_data->raw_cnt_rmd, hx_touch_data->rawdata_size, hx_touch_data->touch_info_size);
+
+    hx_touch_data->hx_coord_buf = kzalloc(sizeof(uint8_t)*(hx_touch_data->touch_info_size),GFP_KERNEL);
+    if (hx_touch_data->hx_coord_buf == NULL) {
+        goto mem_alloc_fail;
+    }
+
+    hx_touch_data->diag_mutual = kzalloc(tx_num * rx_num* sizeof(int32_t), GFP_KERNEL);
+    if (hx_touch_data->diag_mutual == NULL) {
+        goto mem_alloc_fail;
+    }
+
+    //#ifdef HX_TP_PROC_DIAG
+    hx_touch_data->hx_rawdata_buf = kzalloc(sizeof(uint8_t)*(hx_touch_data->touch_all_size - hx_touch_data->touch_info_size),GFP_KERNEL);
+    if (hx_touch_data->hx_rawdata_buf == NULL) {
+        goto mem_alloc_fail;
+    }
+    //#endif
+
+//#if defined(HX_SMART_WAKEUP)
+    hx_touch_data->hx_event_buf = kzalloc(sizeof(uint8_t)*(hx_touch_data->event_size),GFP_KERNEL);
+    if (hx_touch_data->hx_event_buf == NULL) {
+        goto mem_alloc_fail;
+    }
+//#endif
+
+    return NO_ERR;
+
+mem_alloc_fail:
+    kfree(hx_touch_data->hx_coord_buf);
+//#if defined(HX_TP_PROC_DIAG)
+    kfree(hx_touch_data->hx_rawdata_buf);
+//#endif
+//#if defined(HX_SMART_WAKEUP)
+    kfree(hx_touch_data->hx_event_buf);
+//#endif
+
+    TPD_INFO("%s: Memory allocate fail!\n",__func__);
+    return MEM_ALLOC_FAIL;
+
+}
+
+bool himax_read_event_stack(struct i2c_client *client, uint8_t *buf, uint8_t length) //Alice - Un
+{
+    uint8_t cmd[4];
+
+    //  AHB_I2C Burst Read Off
+    cmd[0] = 0x00;
+    if (touch_i2c_write_block(client, 0x11, 1, cmd) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return 0;
+    }
+
+    touch_i2c_read_block(client, 0x30, length, buf);
+
+    //  AHB_I2C Burst Read On
+    cmd[0] = 0x01;
+    if (touch_i2c_write_block(client, 0x11, 1, cmd) < 0) {
+        TPD_INFO("%s: i2c access fail!\n", __func__);
+        return 0;
+    }
+    return 1;
+}
+
+int g_zero_event_count = 0;
+int himax_ic_esd_recovery(int hx_esd_event, int hx_zero_event, int length)
+{
+    if (hx_esd_event == length) {
+        g_zero_event_count = 0;
+        goto checksum_fail;
+    } else if (hx_zero_event == length) {
+        g_zero_event_count++;
+        TPD_INFO("[HIMAX TP MSG]: ALL Zero event is %d times.\n", g_zero_event_count);
+        if (g_zero_event_count > 5) {
+            g_zero_event_count = 0;
+            TPD_INFO("[HIMAX TP MSG]: ESD event checked - ALL Zero.\n");
+            goto checksum_fail;
+        }
+        goto err_workqueue_out;
+    }
+
+checksum_fail:
+    return CHECKSUM_FAIL;
+err_workqueue_out:
+    return WORK_OUT;
+}
+
+static int hx83112b_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    int ret = 0;
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio on=%d \n", on);
+        ret = gpio_direction_output(hw_res->reset_gpio, on);
+        if (ret) {
+            TPD_INFO("Set the reset_gpio on=%d fail\n", on);
+        } else {
+            HX_RESET_STATE=on;
+        }
+        msleep(RESET_TO_NORMAL_TIME);
+        TPD_INFO("%s hw_res->reset_gpio = %d\n", __func__, hw_res->reset_gpio);
+    }
+
+    return ret;
+}
+
+void himax_esd_hw_reset(struct chip_data_hx83112b * chip_info)
+{
+    TPD_INFO("START_Himax TP: ESD - Reset\n");
+    HX_ESD_RESET_ACTIVATE = 1;
+
+    //himax_int_enable(chip_info->client->irq, 0);
+    hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+
+    hx83112b_resetgpio_set(chip_info->hw_res, false); // reset gpio
+
+    hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    //himax_int_enable(chip_info->client->irq, 1);
+    TPD_INFO("%s: ESD reset finished\n", __func__);
+}
+
+
+int himax_checksum_cal(struct chip_data_hx83112b * chip_info, uint8_t *buf,int ts_status)
+{
+//#if defined(HX_ESD_RECOVERY)
+    int hx_EB_event = 0;
+    int hx_EC_event = 0;
+    int hx_ED_event = 0;
+    int hx_esd_event = 0;
+    int hx_zero_event = 0;
+    int shaking_ret = 0;
+//#endif
+    uint16_t check_sum_cal = 0;
+    int32_t loop_i = 0;
+    int length = 0;
+
+    /* Normal */
+    if(ts_status == HX_REPORT_COORD) {
+        length = hx_touch_data->touch_info_size;
+    }
+
+    /* SMWP */
+    else if(ts_status == HX_REPORT_SMWP_EVENT) {
+        length = (GEST_PTLG_ID_LEN+GEST_PTLG_HDR_LEN);
+    }
+    else {
+        TPD_INFO("%s, Neither Normal Nor SMWP error!\n",__func__);
+    }
+    //TPD_INFO("Now status=%d,length=%d\n",ts_status,length);
+    for (loop_i = 0; loop_i < length; loop_i++) {
+        check_sum_cal+=buf[loop_i];
+        //#ifdef HX_ESD_RECOVERY
+        if(ts_status == HX_REPORT_COORD) {
+            /* case 1 ESD recovery flow */
+            if(buf[loop_i] == 0xEB) {
+                hx_EB_event++;
+            } else if(buf[loop_i] == 0xEC) {
+                hx_EC_event++;
+            } else if(buf[loop_i] == 0xED) {
+                hx_ED_event++;
+            } else if(buf[loop_i] == 0x00) {/* case 2 ESD recovery flow-Disable */
+                hx_zero_event++;
+            } else {
+                hx_EB_event = 0;
+                hx_EC_event = 0;
+                hx_ED_event = 0;
+                hx_zero_event = 0;
+                g_zero_event_count = 0;
+            }
+
+            if(hx_EB_event == length) {
+                hx_esd_event = length;
+                hx_EB_event_flag ++;
+                TPD_INFO("[HIMAX TP MSG]: ESD event checked - ALL 0xEB.\n");
+            } else if(hx_EC_event == length) {
+                hx_esd_event = length;
+                hx_EC_event_flag ++;
+                TPD_INFO("[HIMAX TP MSG]: ESD event checked - ALL 0xEC.\n");
+            } else if(hx_ED_event == length) {
+                hx_esd_event = length;
+                hx_ED_event_flag ++;
+                TPD_INFO("[HIMAX TP MSG]: ESD event checked - ALL 0xED.\n");
+            } else {
+                hx_esd_event = 0;
+            }
+        }
+//#endif
+    }
+
+    if(ts_status == HX_REPORT_COORD) {
+//#ifdef HX_ESD_RECOVERY
+        if ((hx_esd_event == length || hx_zero_event == length)
+           && (HX_HW_RESET_ACTIVATE == 0) && (HX_ESD_RESET_ACTIVATE == 0)) {
+            shaking_ret = himax_ic_esd_recovery(hx_esd_event,hx_zero_event,length);
+            if(shaking_ret == CHECKSUM_FAIL) {
+                 himax_esd_hw_reset(chip_info);
+                goto checksum_fail;
+            } else if(shaking_ret == ERR_WORK_OUT) {
+                goto err_workqueue_out;
+            } else {
+                //TPD_INFO("I2C running. Nothing to be done!\n");
+                goto workqueue_out;
+            }
+        } else if (HX_ESD_RESET_ACTIVATE) {
+            /* drop 1st interrupts after chip reset */
+            HX_ESD_RESET_ACTIVATE = 0;
+            TPD_INFO("[HX_ESD_RESET_ACTIVATE]:%s: Back from reset, ready to serve.\n", __func__);
+            goto checksum_fail;
+        } else if (HX_HW_RESET_ACTIVATE) {
+            /* drop 1st interrupts after chip reset */
+            HX_HW_RESET_ACTIVATE = 0;
+            TPD_INFO("[HX_HW_RESET_ACTIVATE]:%s: Back from reset, ready to serve.\n", __func__);
+            goto ready_to_serve;
+        }
+    }
+//#endif
+    if ((check_sum_cal % 0x100 != 0) ) {
+        TPD_INFO("[HIMAX TP MSG] checksum fail : check_sum_cal: 0x%02X\n", check_sum_cal);
+        goto checksum_fail;
+    }
+
+    /* TPD_INFO("%s:End\n",__func__); */
+    return NO_ERR;
+
+ready_to_serve:
+    return READY_TO_SERVE;
+checksum_fail:
+    return CHECKSUM_FAIL;
+//#ifdef HX_ESD_RECOVERY
+err_workqueue_out:
+    return ERR_WORK_OUT;
+workqueue_out:
+    return WORK_OUT;
+//#endif
+}
+
+void himax_log_touch_data(uint8_t *buf,struct himax_report_data *hx_touch_data)
+{
+    int loop_i = 0;
+    int print_size = 0;
+
+    if (!hx_touch_data->diag_cmd) {
+        print_size = hx_touch_data->touch_info_size;
+    } else {
+        print_size = hx_touch_data->touch_all_size;
+    }
+
+    for (loop_i = 0; loop_i < print_size; loop_i+=8) {
+        if ((loop_i + 7) >= print_size) {
+            TPD_INFO("%s: over flow\n",__func__);
+            break;
+        }
+        TPD_INFO("P %2d = 0x%2.2X P %2d = 0x%2.2X ", loop_i, buf[loop_i], loop_i + 1, buf[loop_i + 1]);
+        TPD_INFO("P %2d = 0x%2.2X P %2d = 0x%2.2X ", loop_i + 2, buf[loop_i + 2], loop_i + 3, buf[loop_i + 3]);
+        TPD_INFO("P %2d = 0x%2.2X P %2d = 0x%2.2X ", loop_i + 4, buf[loop_i + 4], loop_i + 5, buf[loop_i + 5]);
+        TPD_INFO("P %2d = 0x%2.2X P %2d = 0x%2.2X ", loop_i + 6, buf[loop_i + 6], loop_i + 7, buf[loop_i + 7]);
+        TPD_INFO("\n");
+    }
+}
+
+void himax_idle_mode(struct i2c_client *client,int disable)
+{
+    int retry = 20;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t switch_cmd = 0x00;
+
+    TPD_INFO("%s:entering\n",__func__);
+    do {
+        TPD_INFO("%s,now %d times\n!",__func__,retry);
+
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x70;
+        tmp_addr[0] = 0x88;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+        if(disable)
+            switch_cmd = 0x17;
+        else
+            switch_cmd = 0x1F;
+
+        tmp_data[0] = switch_cmd;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s:After turn ON/OFF IDLE Mode [0] = 0x%02X,[1] = 0x%02X,[2] = 0x%02X,[3] = 0x%02X\n", __func__,tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3]);
+
+        retry--;
+        msleep(10);
+    } while((tmp_data[0] != switch_cmd) && retry > 0);
+
+    TPD_INFO("%s: setting OK!\n",__func__);
+
+}
+
+
+void himax_reload_disable(struct i2c_client *client,int on)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    TPD_INFO("%s:entering\n",__func__);
+
+    if (on) {/*reload disable*/
+        tmp_addr[3] = 0x10; tmp_addr[2] = 0x00; tmp_addr[1] = 0x7F; tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x00; tmp_data[2] = 0x00; tmp_data[1] = 0xA5; tmp_data[0] = 0x5A;
+    } else {/*reload enable*/
+        tmp_addr[3] = 0x10; tmp_addr[2] = 0x00; tmp_addr[1] = 0x7F; tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x00; tmp_data[2] = 0x00; tmp_data[1] = 0x00; tmp_data[0] = 0x00;
+    }
+
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    TPD_INFO("%s: setting OK!\n",__func__);
+}
+
+int himax_get_rawdata(struct chip_data_hx83112b *chip_info, uint32_t *RAW, uint32_t datalen)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t *tmp_rawdata;
+    uint8_t retry = 0;
+    uint16_t checksum_cal;
+    uint32_t i = 0;
+
+    uint8_t max_i2c_size = 128;
+    int address = 0;
+    int total_read_times = 0;
+    int total_size = datalen * 2 + 4;
+    int total_size_temp;
+#if 1//def RAWDATA_DEBUG_PF
+    uint32_t j = 0;
+    uint32_t index = 0;
+    uint32_t Min_DATA = 0xFFFFFFFF;
+    uint32_t Max_DATA = 0x00000000;
+#endif
+
+    //1 Set Data Ready PWD
+    while (retry < 200) {
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = Data_PWD1;
+        tmp_data[0] = Data_PWD0;
+        himax_flash_write_burst_length(chip_info->client, tmp_addr, tmp_data, 4);
+
+        himax_register_read(chip_info->client, tmp_addr, 4, tmp_data, false);
+        if ((tmp_data[0] == Data_PWD0 && tmp_data[1] == Data_PWD1) ||
+            (tmp_data[0] == Data_PWD1 && tmp_data[1] == Data_PWD0)) {
+            break;
+        }
+
+        retry++;
+        msleep(1);
+    }
+
+    if (retry >= 200) {
+        return RET_ERR;
+    } else {
+        retry = 0;
+    }
+
+    while (retry < 200) {
+        if (tmp_data[0] == Data_PWD1 && tmp_data[1] == Data_PWD0) {
+            break;
+        }
+
+        retry++;
+        msleep(1);
+        himax_register_read(chip_info->client, tmp_addr, 4, tmp_data, false);
+    }
+
+    if (retry >= 200) {
+        return RET_ERR;
+    } else {
+        retry = 0;
+    }
+
+    tmp_rawdata = kzalloc(sizeof(uint8_t)*(datalen*2),GFP_KERNEL);
+    if (!tmp_rawdata) {
+        return RET_ERR;
+    }
+
+    //2 Read Data from SRAM
+    while (retry < 10) {
+        checksum_cal = 0;
+        total_size_temp = total_size;
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x00;
+
+        if (total_size % max_i2c_size == 0) {
+            total_read_times = total_size / max_i2c_size;
+        } else {
+            total_read_times = total_size / max_i2c_size + 1;
+        }
+
+        for (i = 0; i < (total_read_times); i++) {
+            if ( total_size_temp >= max_i2c_size) {
+                himax_register_read(chip_info->client, tmp_addr, max_i2c_size, &tmp_rawdata[i*max_i2c_size], false);
+                total_size_temp = total_size_temp - max_i2c_size;
+            } else {
+                //TPD_INFO("last total_size_temp=%d\n",total_size_temp);
+                himax_register_read(chip_info->client, tmp_addr, total_size_temp % max_i2c_size, &tmp_rawdata[i*max_i2c_size], false);
+            }
+
+            address = ((i+1)*max_i2c_size);
+            tmp_addr[1] = (uint8_t)((address>>8)&0x00FF);
+            tmp_addr[0] = (uint8_t)((address)&0x00FF);
+        }
+
+//
+        //3 Check Checksum
+        for (i = 2; i < datalen * 2 + 4; i = i + 2) {
+            checksum_cal += tmp_rawdata[i + 1] * 256 + tmp_rawdata[i];
+        }
+
+        if (checksum_cal == 0) {
+            break;
+        }
+
+        retry++;
+    }
+
+    //4 Copy Data
+    for (i = 0; i < chip_info->hw_res->RX_NUM * chip_info->hw_res->TX_NUM; i++) {
+        RAW[i] = tmp_rawdata[(i * 2) + 1 + 4] * 256 + tmp_rawdata[(i * 2) + 4];
+    }
+
+
+#if 1//def RAWDATA_DEBUG_PF
+    for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+        if (j == 0) {
+            printk("      RX%2d", j + 1);
+        } else {
+            printk("  RX%2d", j + 1);
+        }
+    }
+    printk("\n");
+
+    for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+        printk("TX%2d", i + 1);
+        for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+            if ((j == SKIPRXNUM) && (i >= SKIPTXNUM_START) && (i <= SKIPTXNUM_END)) {
+                continue;
+            } else {
+                printk("%5d ", RAW[index]);
+                if (RAW[index] > Max_DATA) {
+                    Max_DATA = RAW[index];
+                }
+
+                if (RAW[index] < Min_DATA) {
+                    Min_DATA = RAW[index];
+                }
+            }
+            index++;
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("Max = %5d, Min = %5d \n", Max_DATA, Min_DATA);
+#endif
+
+    kfree(tmp_rawdata);
+
+    return RET_OK;
+}
+
+void himax_switch_data_type(struct i2c_client *client, uint8_t checktype)
+{
+    uint8_t datatype;
+
+    switch (checktype) {
+        case HIMAX_INSPECTION_OPEN:
+            datatype = DATA_OPEN;
+            break;
+        case HIMAX_INSPECTION_MICRO_OPEN:
+            datatype = DATA_MICRO_OPEN;
+            break;
+        case HIMAX_INSPECTION_SHORT:
+            datatype = DATA_SHORT;
+            break;
+        case HIMAX_INSPECTION_RAWDATA:
+            datatype = DATA_RAWDATA;
+            break;
+        case HIMAX_INSPECTION_NOISE:
+            datatype = DATA_NOISE;
+            break;
+        case HIMAX_INSPECTION_BACK_NORMAL:
+            datatype = DATA_BACK_NORMAL;
+            break;
+        case HIMAX_INSPECTION_LPWUG_RAWDATA:
+            datatype = DATA_LPWUG_RAWDATA;
+            break;
+        case HIMAX_INSPECTION_LPWUG_NOISE:
+            datatype = DATA_LPWUG_NOISE;
+            break;
+        case HIMAX_INSPECTION_DOZE_RAWDATA:
+            datatype = DATA_DOZE_RAWDATA;
+            break;
+        case HIMAX_INSPECTION_DOZE_NOISE:
+            datatype = DATA_DOZE_NOISE;
+            break;
+        case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+            datatype = DATA_LPWUG_IDLE_RAWDATA;
+            break;
+        case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+            datatype = DATA_LPWUG_IDLE_NOISE;
+            break;
+        default:
+            TPD_INFO("Wrong type=%d\n",checktype);
+            break;
+    }
+    himax_diag_register_set(client, datatype);
+}
+
+int himax_switch_mode(struct i2c_client *client,int mode)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    TPD_INFO("%s: Entering\n",__func__);
+
+    //Stop Handshaking
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x00;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+    himax_flash_write_burst_length(client, tmp_addr, tmp_data, 4);
+
+    //Swtich Mode
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x7F;
+    tmp_addr[0] = 0x04;
+    switch (mode) {
+    case HIMAX_INSPECTION_SORTING:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_SORTING_START;
+        tmp_data[0] = PWD_SORTING_START;
+        break;
+    case HIMAX_INSPECTION_OPEN:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_OPEN_START;
+        tmp_data[0] = PWD_OPEN_START;
+        break;
+    case HIMAX_INSPECTION_MICRO_OPEN:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_OPEN_START;
+        tmp_data[0] = PWD_OPEN_START;
+        break;
+    case HIMAX_INSPECTION_SHORT:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_SHORT_START;
+        tmp_data[0] = PWD_SHORT_START;
+        break;
+    case HIMAX_INSPECTION_RAWDATA:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_RAWDATA_START;
+        tmp_data[0] = PWD_RAWDATA_START;
+        break;
+    case HIMAX_INSPECTION_NOISE:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_NOISE_START;
+        tmp_data[0] = PWD_NOISE_START;
+        break;
+    case HIMAX_INSPECTION_LPWUG_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_NOISE:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_LPWUG_START;
+        tmp_data[0] = PWD_LPWUG_START;
+        break;
+    case HIMAX_INSPECTION_DOZE_RAWDATA:
+    case HIMAX_INSPECTION_DOZE_NOISE:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_DOZE_START;
+        tmp_data[0] = PWD_DOZE_START;
+        break;
+    case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = PWD_LPWUG_IDLE_START;
+        tmp_data[0] = PWD_LPWUG_IDLE_START;
+        break;
+    }
+    himax_flash_write_burst_length(client, tmp_addr, tmp_data, 4);
+
+    TPD_INFO("%s: End of setting!\n",__func__);
+
+    return 0;
+
+}
+
+
+void himax_set_N_frame(struct i2c_client *client, uint16_t Nframe, uint8_t checktype)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x72;
+    tmp_addr[0] = 0x94;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = (uint8_t)((Nframe & 0xFF00) >> 8);
+    tmp_data[0] = (uint8_t)(Nframe & 0x00FF);
+    himax_flash_write_burst_length(client, tmp_addr, tmp_data, 4);
+
+    //SKIP FRMAE
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x70;
+    tmp_addr[0] = 0xF4;
+    himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+    switch (checktype) {
+    case HIMAX_INSPECTION_LPWUG_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_NOISE:
+        tmp_data[0] = BS_LPWUG;
+        break;
+    case HIMAX_INSPECTION_DOZE_RAWDATA:
+    case HIMAX_INSPECTION_DOZE_NOISE:
+        tmp_data[0] = BS_DOZE;
+        break;
+    case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+        tmp_data[0] = BS_LPWUG_dile;
+        break;
+    case HIMAX_INSPECTION_RAWDATA:
+    case HIMAX_INSPECTION_NOISE:
+        tmp_data[0] = BS_RAWDATANOISE;
+        break;
+    default:
+        tmp_data[0] = BS_OPENSHORT;
+        break;
+    }
+    himax_flash_write_burst_length(client, tmp_addr, tmp_data, 4);
+}
+
+
+uint32_t himax_check_mode(struct i2c_client *client, uint8_t checktype)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t wait_pwd[2];
+    // uint8_t count = 0;
+
+    switch (checktype) {
+    case HIMAX_INSPECTION_OPEN:
+        wait_pwd[0] = PWD_OPEN_END;
+        wait_pwd[1] = PWD_OPEN_END;
+        break;
+    case HIMAX_INSPECTION_MICRO_OPEN:
+        wait_pwd[0] = PWD_OPEN_END;
+        wait_pwd[1] = PWD_OPEN_END;
+        break;
+    case HIMAX_INSPECTION_SHORT:
+        wait_pwd[0] = PWD_SHORT_END;
+        wait_pwd[1] = PWD_SHORT_END;
+        break;
+    case HIMAX_INSPECTION_RAWDATA:
+        wait_pwd[0] = PWD_RAWDATA_END;
+        wait_pwd[1] = PWD_RAWDATA_END;
+        break;
+    case HIMAX_INSPECTION_NOISE:
+        wait_pwd[0] = PWD_NOISE_END;
+        wait_pwd[1] = PWD_NOISE_END;
+        break;
+    case HIMAX_INSPECTION_LPWUG_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_NOISE:
+        wait_pwd[0] = PWD_LPWUG_END;
+        wait_pwd[1] = PWD_LPWUG_END;
+        break;
+    case HIMAX_INSPECTION_DOZE_RAWDATA:
+    case HIMAX_INSPECTION_DOZE_NOISE:
+        wait_pwd[0] = PWD_DOZE_END;
+        wait_pwd[1] = PWD_DOZE_END;
+        break;
+    case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+    case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+        wait_pwd[0] = PWD_LPWUG_IDLE_END;
+        wait_pwd[1] = PWD_LPWUG_IDLE_END;
+        break;
+    default:
+        TPD_INFO("Wrong type=%d\n",checktype);
+        break;
+    }
+
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x7F;
+    tmp_addr[0] = 0x04;
+    himax_register_read(client, tmp_addr, 4, tmp_data, false);
+    TPD_INFO("%s: himax_wait_sorting_mode, tmp_data[0]=%x,tmp_data[1]=%x\n", __func__, tmp_data[0],tmp_data[1]);
+
+    if (wait_pwd[0] == tmp_data[0] && wait_pwd[1] == tmp_data[1]) {
+        TPD_INFO("Change to mode=%s\n",g_himax_inspection_mode[checktype]);
+        return 0;
+    }
+    else
+        return 1;
+}
+
+void himax_get_noise_base(struct i2c_client *client)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x70;
+    tmp_addr[0] = 0x8C;
+    himax_register_read(client, tmp_addr, 4, tmp_data, false);
+
+    TPD_INFO("tmp_data[0]=0x%x tmp_data[1]=0x%x tmp_data[2]=0x%x tmp_data[3]=0x%x\n",
+              tmp_data[0], tmp_data[1], tmp_data[2], tmp_data[3]);
+
+    NOISEMAX = tmp_data[3]*(NOISE_P/256);
+}
+
+uint32_t himax_wait_sorting_mode(struct i2c_client *client, uint8_t checktype)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t wait_pwd[2];
+    uint8_t count = 0;
+
+    switch (checktype) {
+        case HIMAX_INSPECTION_OPEN:
+            wait_pwd[0] = PWD_OPEN_END;
+            wait_pwd[1] = PWD_OPEN_END;
+            break;
+        case HIMAX_INSPECTION_MICRO_OPEN:
+            wait_pwd[0] = PWD_OPEN_END;
+            wait_pwd[1] = PWD_OPEN_END;
+            break;
+        case HIMAX_INSPECTION_SHORT:
+            wait_pwd[0] = PWD_SHORT_END;
+            wait_pwd[1] = PWD_SHORT_END;
+            break;
+        case HIMAX_INSPECTION_RAWDATA:
+            wait_pwd[0] = PWD_RAWDATA_END;
+            wait_pwd[1] = PWD_RAWDATA_END;
+            break;
+        case HIMAX_INSPECTION_NOISE:
+            wait_pwd[0] = PWD_NOISE_END;
+        wait_pwd[1] = PWD_NOISE_END;
+        break;
+        case HIMAX_INSPECTION_LPWUG_RAWDATA:
+        case HIMAX_INSPECTION_LPWUG_NOISE:
+            wait_pwd[0] = PWD_LPWUG_END;
+            wait_pwd[1] = PWD_LPWUG_END;
+            break;
+        case HIMAX_INSPECTION_DOZE_RAWDATA:
+        case HIMAX_INSPECTION_DOZE_NOISE:
+            wait_pwd[0] = PWD_DOZE_END;
+            wait_pwd[1] = PWD_DOZE_END;
+            break;
+        case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+        case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+            wait_pwd[0] = PWD_LPWUG_IDLE_END;
+            wait_pwd[1] = PWD_LPWUG_IDLE_END;
+            break;
+        default:
+            TPD_INFO("Wrong type=%d\n",checktype);
+        break;
+    }
+
+    do {
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x7F;
+        tmp_addr[0] = 0x04;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: himax_wait_sorting_mode, tmp_data[0]=%x,tmp_data[1]=%x\n", __func__, tmp_data[0],tmp_data[1]);
+
+        if (wait_pwd[0] == tmp_data[0] && wait_pwd[1] == tmp_data[1]) {
+            return 0;
+        }
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0xA8;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: 0x900000A8, tmp_data[0]=%x,tmp_data[1]=%x,tmp_data[2]=%x,tmp_data[3]=%x \n", __func__, tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3]);
+
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0xE4;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: 0x900000E4, tmp_data[0]=%x,tmp_data[1]=%x,tmp_data[2]=%x,tmp_data[3]=%x \n", __func__, tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3]);
+
+        tmp_addr[3] = 0x90;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0xF8;
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: 0x900000F8, tmp_data[0]=%x,tmp_data[1]=%x,tmp_data[2]=%x,tmp_data[3]=%x \n", __func__, tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3]);
+        TPD_INFO("Now retry %d times!\n",count++);
+        msleep(50);
+    } while (count < 200);
+
+    return 1;
+}
+
+int himax_check_notch(int index)
+{
+    if ((index >= SKIP_NOTCH_START) && (index <= SKIP_NOTCH_END))
+        return 1;
+    else if((index >= SKIP_DUMMY_START) && (index <= SKIP_DUMMY_END))
+        return 1;
+    else
+        return 0;
+}
+
+int mpTestFunc(struct chip_data_hx83112b *chip_info, uint8_t checktype, uint32_t datalen)
+{
+    uint32_t i/*, j*/, ret = 0;
+    uint32_t RAW[datalen];
+#ifdef RAWDATA_NOISE
+    uint32_t RAW_Rawdata[datalen];
+#endif
+    //uint16_t* pInspectGridData = &gInspectGridData[0];
+    //uint16_t* pInspectNoiseData = &gInspectNoiseData[0];
+    if (himax_check_mode(chip_info->client,checktype)) {
+        TPD_INFO("Need Change Mode ,target=%s",g_himax_inspection_mode[checktype]);
+
+        himax_sense_off(chip_info->client);
+
+        himax_reload_disable(chip_info->client,1);
+
+        himax_switch_mode(chip_info->client, checktype);
+
+        if (checktype == HIMAX_INSPECTION_NOISE) {
+            himax_set_N_frame(chip_info->client, NOISEFRAME, checktype);
+            himax_get_noise_base(chip_info->client);
+        } else if (checktype == HIMAX_INSPECTION_DOZE_RAWDATA || checktype == HIMAX_INSPECTION_DOZE_NOISE) {
+            TPD_INFO("N frame = %d\n",10);
+            himax_set_N_frame(chip_info->client, 10, checktype);
+        } else if(checktype >= HIMAX_INSPECTION_LPWUG_RAWDATA) {
+            TPD_INFO("N frame = %d\n",1);
+            himax_set_N_frame(chip_info->client, 1, checktype);
+        } else {
+        himax_set_N_frame(chip_info->client, 2, checktype);
+    }
+
+
+    himax_sense_on(chip_info->client, 1);
+
+    ret = himax_wait_sorting_mode(chip_info->client, checktype);
+    if (ret) {
+        TPD_INFO("%s: himax_wait_sorting_mode FAIL\n", __func__);
+        return ret;
+        }
+    }
+
+    himax_switch_data_type(chip_info->client, checktype);
+
+    ret = himax_get_rawdata(chip_info, RAW, datalen);
+    if (ret) {
+        TPD_INFO("%s: himax_get_rawdata FAIL\n", __func__);
+        return ret;
+    }
+
+    /* back to normal */
+    himax_switch_data_type(chip_info->client, HIMAX_INSPECTION_BACK_NORMAL);
+
+    //Check Data
+    switch (checktype) {
+        case HIMAX_INSPECTION_OPEN:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > OPENMAX || RAW[i] < OPENMIN) {
+                    TPD_INFO("%s: open test FAIL\n", __func__);
+                    return RET_ERR;
+                }
+            }
+            TPD_INFO("%s: open test PASS\n", __func__);
+            break;
+
+        case HIMAX_INSPECTION_MICRO_OPEN:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+            if (himax_check_notch(i)) {
+                continue;
+            }
+                if (RAW[i] > M_OPENMAX || RAW[i] < M_OPENMIN) {
+                    TPD_INFO("%s: micro open test FAIL\n", __func__);
+                    return RET_ERR;
+                }
+            }
+            TPD_INFO("M_OPENMAX = %d,M_OPENMIN = %d\n",M_OPENMAX, M_OPENMIN);
+            TPD_INFO("%s: micro open test PASS\n", __func__);
+            break;
+
+        case HIMAX_INSPECTION_SHORT:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+            if (himax_check_notch(i)) {
+                continue;
+            }
+                if (RAW[i] > SHORTMAX || RAW[i] < SHORTMIN) {
+                    TPD_INFO("%s: short test FAIL\n", __func__);
+                        return RET_ERR;
+                }
+            }
+            TPD_INFO("%s: short test PASS\n", __func__);
+            break;
+
+        case HIMAX_INSPECTION_RAWDATA:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+            if (himax_check_notch(i)) {
+                continue;
+            }
+                if (RAW[i] > RAWMAX || RAW[i] < RAWMIN) {
+                    TPD_INFO("%s: rawdata test FAIL\n", __func__);
+                    return RET_ERR;
+                }
+            }
+            TPD_INFO("%s: rawdata test PASS\n", __func__);
+            break;
+
+        case HIMAX_INSPECTION_NOISE:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > NOISEMAX) {
+                    TPD_INFO("%s: noise test FAIL\n", __func__);
+                    return RET_ERR;
+                }
+            }
+            TPD_INFO("%s: noise test PASS\n", __func__);
+
+#ifdef RAWDATA_NOISE
+            TPD_INFO("[MP_RAW_TEST_RAW]\n");
+
+            himax_switch_data_type(chip_info->client, HIMAX_INSPECTION_RAWDATA);
+            ret = himax_get_rawdata(chip_info, RAW, datalen);
+            if (ret == RET_ERR) {
+                TPD_INFO("%s: himax_get_rawdata FAIL\n", __func__);
+                return RET_ERR;
+            }
+
+            //Get inspect raw data
+            for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+                for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+                    if ((j == SKIPRXNUM) && (i >= SKIPTXNUM_START) && (i >= SKIPTXNUM_END)) {
+                        *(pInspectGridData + ((chip_info->hw_res->TX_NUM - j) * chip_info->hw_res->RX_NUM - i - 1)) = 0;
+                    } else {
+                        *(pInspectGridData + ((chip_info->hw_res->TX_NUM - j) * chip_info->hw_res->RX_NUM - i - 1)) = (uint16_t)RAW_Rawdata[i * chip_info->hw_res->TX_NUM + j];
+                    }
+                }
+            }
+#endif
+            break;
+
+        case HIMAX_INSPECTION_LPWUG_RAWDATA:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > LPWUG_RAWDATA_MAX || RAW[i] < LPWUG_RAWDATA_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_RAWDATA FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ERAW;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_RAWDATA PASS\n", __func__);
+            break;
+        case HIMAX_INSPECTION_LPWUG_NOISE:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > LPWUG_NOISE_MAX || RAW[i] < LPWUG_NOISE_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_NOISE FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ENOISE;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_NOISE PASS\n", __func__);
+            break;
+        case HIMAX_INSPECTION_DOZE_RAWDATA:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > DOZE_RAWDATA_MAX || RAW[i] < DOZE_RAWDATA_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_DOZE_RAWDATA FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ERAW;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_DOZE_RAWDATA PASS\n", __func__);
+            break;
+        case HIMAX_INSPECTION_DOZE_NOISE:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > DOZE_NOISE_MAX || RAW[i] < DOZE_NOISE_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_DOZE_NOISE FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ENOISE;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_DOZE_NOISE PASS\n", __func__);
+            break;
+        case HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > LPWUG_IDLE_RAWDATA_MAX || RAW[i] < LPWUG_IDLE_RAWDATA_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ERAW;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA PASS\n", __func__);
+            break;
+        case HIMAX_INSPECTION_LPWUG_IDLE_NOISE:
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (himax_check_notch(i)) {
+                    continue;
+                }
+                if (RAW[i] > LPWUG_IDLE_NOISE_MAX || RAW[i] < LPWUG_IDLE_NOISE_MIN) {
+                    TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_IDLE_NOISE FAIL\n", __func__);
+                        return THP_AFE_INSPECT_ENOISE;
+                }
+            }
+            TPD_INFO("%s: HIMAX_INSPECTION_LPWUG_IDLE_NOISE PASS\n", __func__);
+            break;
+
+        default:
+            TPD_INFO("Wrong type=%d\n",checktype);
+        break;
+    }
+
+    return RET_OK;
+}
+
+static void hx83112b_black_screen_test(void *chip_data, char *message)
+{
+    int error = 0;
+    int error_num = 0;
+    char buf[128] = {0};
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    TPD_INFO("%s\n", __func__);
+
+    //6. LPWUG RAWDATA
+    TPD_INFO("[MP_LPWUG_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_LPWUG_RAWDATA, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM)+chip_info->hw_res->TX_NUM+chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "6. MP_LPWUG_TEST_RAW: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    sprintf(message, "%s\n", buf);
+    error_num += error;
+
+    //7. LPWUG NOISE
+    TPD_INFO("[MP_LPWUG_TEST_NOISE]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_LPWUG_NOISE, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM)+chip_info->hw_res->TX_NUM+chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "7. MP_LPWUG_TEST_NOISE: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    sprintf(message, "%s\n", buf);
+    error_num += error;
+
+    //8. LPWUG IDLE RAWDATA
+    TPD_INFO("[MP_LPWUG_IDLE_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM)+chip_info->hw_res->TX_NUM+chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "8. MP_LPWUG_IDLE_TEST_RAW: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    sprintf(message, "%s\n", buf);
+    error_num += error;
+
+    //9. LPWUG IDLE RAWDATA
+    TPD_INFO("[MP_LPWUG_IDLE_TEST_NOISE]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_LPWUG_IDLE_NOISE, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM)+chip_info->hw_res->TX_NUM+chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "9. MP_LPWUG_IDLE_TEST_NOISE: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    sprintf(message, "%s\n", buf);
+    error_num += error;
+
+    sprintf(message, "%d errors. %s", error_num, error_num ? "" : "All test passed.");
+    TPD_INFO("%d errors. %s\n", error_num, error_num ? "" : "All test passed."); 
+
+    himax_sense_off(chip_info->client);
+    himax_set_N_frame(chip_info->client, 1, HIMAX_INSPECTION_NOISE);
+    himax_reload_disable(chip_info->client,0);
+    himax_sense_on(chip_info->client, 0);
+
+}
+
+int himax_chip_self_test(struct seq_file *s, struct chip_data_hx83112b *chip_info)
+{
+    int error = 0;
+    int error_num = 0;
+    char buf[128] = {0};
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t back_data[4];
+    uint8_t retry_cnt = 0;
+
+    TPD_INFO("%s:Entring\n", __func__);
+
+    //1. Open Test
+    TPD_INFO("[MP_OPEN_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_OPEN, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM) + chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "1. Open Test: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    seq_printf(s, buf);
+    error_num += error;
+
+    //2. Micro-Open Test
+    TPD_INFO("[MP_MICRO_OPEN_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_MICRO_OPEN, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM) + chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "2. Micro Open Test: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    seq_printf(s, buf);
+    error_num += error;
+
+    //3. Short Test
+    TPD_INFO("[MP_SHORT_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_SHORT, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM) + chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "3. Short Test: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    seq_printf(s, buf);
+    error_num += error;
+
+#ifndef RAWDATA_NOISE
+    //4. RawData Test
+    TPD_INFO("[MP_RAW_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_RAWDATA, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM)+chip_info->hw_res->TX_NUM+chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "4. Raw data Test: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    seq_printf(s, buf);
+    error_num += error;
+#endif
+
+    //5. Noise Test
+    TPD_INFO("[MP_NOISE_TEST_RAW]\n");
+    error = mpTestFunc(chip_info, HIMAX_INSPECTION_NOISE, (chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM) + chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM);
+    snprintf(buf, 128, "5. Noise Test: %s\n", error ? "Error" : "Ok");
+    TPD_INFO("%s", buf);
+    seq_printf(s, buf);
+    error_num += error;
+
+    //himax_set_SMWP_enable(chip_info->client,ts->SMWP_enable,suspended);
+    //Enable:0x10007F10 = 0xA55AA55A
+    do
+    {
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x7F;
+        tmp_addr[0] = 0x10;
+        tmp_data[3] = 0xA5;
+        tmp_data[2] = 0x5A;
+        tmp_data[1] = 0xA5;
+        tmp_data[0] = 0x5A;
+        himax_flash_write_burst(chip_info->client, tmp_addr, tmp_data);
+        back_data[3] = 0XA5;
+        back_data[2] = 0X5A;
+        back_data[1] = 0XA5;
+        back_data[0] = 0X5A;
+        himax_register_read(chip_info->client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: tmp_data[0]=0x%22X, retry_cnt=%d \n", __func__, tmp_data[0], retry_cnt);
+        retry_cnt++;
+    }
+	while((tmp_data[3] != back_data[3] || tmp_data[2] != back_data[2] || tmp_data[1] != back_data[1]  || tmp_data[0] != back_data[0] ) && retry_cnt < HIMAX_REG_RETRY_TIMES);
+
+    TPD_INFO("%s:End", __func__);
+    return error_num;
+}
+
+void himax_init_psl(struct i2c_client *client) //power saving level
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    //==============================================================
+    // SCU_Power_State_PW : 0x9000_00A0 ==> 0x0000_0000 (Reset PSL)
+    //==============================================================
+    tmp_addr[3] = 0x90;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0xA0;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+    himax_register_write(client, tmp_addr, 4, tmp_data, false);
+
+    TPD_INFO("%s: power saving level reset OK!\n",__func__);
+}
+
+
+void himax_chip_erase(struct i2c_client *client)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    himax_interface_on(client);
+
+    /* init psl */
+    himax_init_psl(client);
+
+    //=====================================
+    // SPI Transfer Format : 0x8000_0010 ==> 0x0002_0780
+    //=====================================
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x10;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x02;
+    tmp_data[1] = 0x07;
+    tmp_data[0] = 0x80;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    //=====================================
+    // Chip Erase
+    // Write Enable : 1. 0x8000_0020 ==> 0x4700_0000
+    //                2. 0x8000_0024 ==> 0x0000_0006
+    //=====================================
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x20;
+    tmp_data[3] = 0x47;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x24;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x06;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    //=====================================
+    // Chip Erase
+    // Erase Command : 0x8000_0024 ==> 0x0000_00C7
+    //=====================================
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x24;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0xC7;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    msleep(2000);
+
+    if (!wait_wip(client, 100)) {
+        TPD_INFO("%s:83112_Chip_Erase Fail\n", __func__);
+    }
+
+}
+
+void himax_flash_programming(struct i2c_client *client, uint8_t *FW_content, int FW_Size)
+{
+    int page_prog_start = 0;
+    int program_length = 48;
+    int i = 0, j = 0, k = 0;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t buring_data[256];    // Read for flash data, 128K
+    // 4 bytes for 0x80002C padding
+
+    himax_interface_on(client);
+
+    //=====================================
+    // SPI Transfer Format : 0x8000_0010 ==> 0x0002_0780
+    //=====================================
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x10;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x02;
+    tmp_data[1] = 0x07;
+    tmp_data[0] = 0x80;
+    himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+    for (page_prog_start = 0; page_prog_start < FW_Size; page_prog_start = page_prog_start + 256) {
+        //msleep(5);
+        //=====================================
+        // Write Enable : 1. 0x8000_0020 ==> 0x4700_0000
+        //                2. 0x8000_0024 ==> 0x0000_0006
+        //=====================================
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x20;
+        tmp_data[3] = 0x47;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x00;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x24;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x06;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        //=================================
+        // SPI Transfer Control
+        // Set 256 bytes page write : 0x8000_0020 ==> 0x610F_F000
+        // Set read start address   : 0x8000_0028 ==> 0x0000_0000
+        //=================================
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x20;
+        tmp_data[3] = 0x61;
+        tmp_data[2] = 0x0F;
+        tmp_data[1] = 0xF0;
+        tmp_data[0] = 0x00;
+        // data bytes should be 0x6100_0000 + ((word_number)*4-1)*4096 = 0x6100_0000 + 0xFF000 = 0x610F_F000
+        // Programmable size = 1 page = 256 bytes, word_number = 256 byte / 4 = 64
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x28;
+        //tmp_data[3] = 0x00; tmp_data[2] = 0x00; tmp_data[1] = 0x00; tmp_data[0] = 0x00; // Flash start address 1st : 0x0000_0000
+
+        if (page_prog_start < 0x100) {
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = (uint8_t)page_prog_start;
+        } else if (page_prog_start >= 0x100 && page_prog_start < 0x10000) {
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = (uint8_t)(page_prog_start >> 8);
+            tmp_data[0] = (uint8_t)page_prog_start;
+        } else if (page_prog_start >= 0x10000 && page_prog_start < 0x1000000) {
+            tmp_data[3] = 0x00;
+            tmp_data[2] = (uint8_t)(page_prog_start >> 16);
+            tmp_data[1] = (uint8_t)(page_prog_start >> 8);
+            tmp_data[0] = (uint8_t)page_prog_start;
+        }
+
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+
+        //=================================
+        // Send 16 bytes data : 0x8000_002C ==> 16 bytes data
+        //=================================
+        buring_data[0] = 0x2C;
+        buring_data[1] = 0x00;
+        buring_data[2] = 0x00;
+        buring_data[3] = 0x80;
+
+        for (i = /*0*/page_prog_start, j = 0; i < 16 + page_prog_start/**/; i++, j++) {
+            buring_data[j + 4] = FW_content[i];
+        }
+
+
+        if (touch_i2c_write_block(client, 0x00, 20, buring_data) < 0) {
+            TPD_INFO("%s: i2c access fail!\n", __func__);
+            return;
+        }
+        //=================================
+        // Write command : 0x8000_0024 ==> 0x0000_0002
+        //=================================
+        tmp_addr[3] = 0x80;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x24;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x02;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        //=================================
+        // Send 240 bytes data : 0x8000_002C ==> 240 bytes data
+        //=================================
+
+        for (j = 0; j < 5; j++) {
+            for (i = (page_prog_start + 16 + (j * 48)), k = 0; i < (page_prog_start + 16 + (j * 48)) + program_length; i++, k++) {
+                buring_data[k+4] = FW_content[i];//(byte)i;
+            }
+
+            if (touch_i2c_write_block(client, 0x00,program_length+4, buring_data) < 0) {
+                TPD_INFO("%s: i2c access fail!\n", __func__);
+                return;
+            }
+        }
+
+        if (!wait_wip(client, 1)) {
+            TPD_INFO("%s:83112_Flash_Programming Fail\n", __func__);
+        }
+    }
+}
+
+
+
+int fts_ctpm_fw_upgrade_with_sys_fs_64k(struct i2c_client *client, unsigned char *fw, int len, bool change_iref) //Alice - Un
+{
+
+    //int CRC_from_FW = 0;
+    int burnFW_success = 0;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    if (len != FW_SIZE_64k) {
+        TPD_INFO("%s: The file size is not 64K bytes\n", __func__);
+        return false;
+    }
+
+/*#ifdef HX_RST_PIN_FUNC
+    himax_ic_reset(false,false);
+#else*/
+    //===AHBI2C_SystemReset==========
+    tmp_addr[3] = 0x90;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x18;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x55;
+    himax_register_write(client, tmp_addr, 4, tmp_data, false);
+//#endif
+
+    himax_sense_off(client);
+    himax_chip_erase(client);
+    himax_flash_programming(client, fw, FW_SIZE_64k);
+
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+
+    if(himax_hw_check_CRC(client, tmp_data, FW_SIZE_64k) == 0) {
+        burnFW_success = 1;
+    } else {
+        burnFW_success = 0;
+    }
+    /*RawOut select initial*/
+    tmp_addr[3] = 0x80;
+    tmp_addr[2] = 0x02;
+    tmp_addr[1] = 0x04;
+    tmp_addr[0] = 0xB4;
+
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+    himax_register_write(client, tmp_addr, 4, tmp_data, false);
+
+    /*DSRAM func initial*/
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x07;
+    tmp_addr[0] = 0xFC;
+
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x00;
+    himax_register_write(client, tmp_addr, 4, tmp_data, false);
+
+#ifdef HX_RST_PIN_FUNC
+    himax_ic_reset(false,false);
+#else
+    //===AHBI2C_SystemReset==========
+    tmp_addr[3] = 0x90;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x18;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x00;
+    tmp_data[0] = 0x55;
+    himax_register_write(client, tmp_addr, 4, tmp_data, false);
+#endif
+    return burnFW_success;
+
+}
+
+
+static size_t hx83112b_proc_register_read(struct file *file, char *buf, size_t len, loff_t *pos)
+{
+    size_t ret = 0;
+    uint16_t loop_i;
+    uint8_t data[128];
+    char *temp_buf;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    memset(data, 0x00, sizeof(data));
+
+    if (!HX_PROC_SEND_FLAG) {
+        temp_buf = kzalloc(len,GFP_KERNEL);
+
+        TPD_INFO("himax_register_show: %02X,%02X,%02X,%02X\n", register_command[3],register_command[2],register_command[1],register_command[0]);
+        himax_register_read(ts->client, register_command, 128, data, cfg_flag);
+
+        ret += snprintf(temp_buf + ret, len - ret, "command:  %02X,%02X,%02X,%02X\n", register_command[3],register_command[2],register_command[1],register_command[0]);
+
+        for (loop_i = 0; loop_i < 128; loop_i++) {
+            ret += snprintf(temp_buf + ret, len - ret, "0x%2.2X ", data[loop_i]);
+            if ((loop_i % 16) == 15) {
+                ret += snprintf(temp_buf + ret, len - ret, "\n");
+            }
+        }
+        ret += snprintf(temp_buf + ret, len - ret, "\n");
+        if(copy_to_user(buf, temp_buf, len)) {
+            TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+        }
+        kfree(temp_buf);
+        HX_PROC_SEND_FLAG=1;
+    } else {
+        HX_PROC_SEND_FLAG=0;
+    }
+    return ret;
+}
+
+static size_t hx83112b_proc_register_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    char buf[80] = {0};
+    char buf_tmp[16];
+    uint8_t length = 0;
+    unsigned long result    = 0;
+    uint8_t loop_i          = 0;
+    uint16_t base           = 2;
+    char *data_str = NULL;
+    uint8_t w_data[20];
+    uint8_t x_pos[20];
+    uint8_t count = 0;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (len >= 80) {
+        TPD_INFO("%s: no command exceeds 80 chars.\n", __func__);
+        return -EFAULT;
+    }
+
+    if (copy_from_user(buf, buff, len)) {
+        return -EFAULT;
+    }
+
+    memset(buf_tmp, 0x0, sizeof(buf_tmp));
+    memset(w_data, 0x0, sizeof(w_data));
+    memset(x_pos, 0x0, sizeof(x_pos));
+
+    TPD_INFO("himax %s \n",buf);
+
+    if ((buf[0] == 'r' || buf[0] == 'w') && buf[1] == ':' && buf[2] == 'x') {
+        length = strlen(buf);
+
+        //TPD_INFO("%s: length = %d.\n", __func__,length);
+        for (loop_i = 0; loop_i < length; loop_i++) {//find postion of 'x'
+            if(buf[loop_i] == 'x') {
+                x_pos[count] = loop_i;
+                count++;
+            }
+        }
+
+        data_str = strrchr(buf, 'x');
+        TPD_INFO("%s: %s.\n", __func__,data_str);
+        length = strlen(data_str+1) - 1;
+
+        if (buf[0] == 'r') {
+            if (buf[3] == 'F' && buf[4] == 'E' && length == 4) {
+                length = length - base;
+                cfg_flag = true;
+                memcpy(buf_tmp, data_str + base +1, length);
+            } else {
+                cfg_flag = false;
+                memcpy(buf_tmp, data_str + 1, length);
+            }
+
+            byte_length = length/2;
+            if (!kstrtoul(buf_tmp, 16, &result)) {
+                for (loop_i = 0 ; loop_i < byte_length ; loop_i++) {
+                    register_command[loop_i] = (uint8_t)(result >> loop_i*8);
+                }
+            }
+        } else if (buf[0] == 'w') {
+            if (buf[3] == 'F' && buf[4] == 'E') {
+                cfg_flag = true;
+                memcpy(buf_tmp, buf + base + 3, length);
+            } else {
+                cfg_flag = false;
+                memcpy(buf_tmp, buf + 3, length);
+            }
+            if(count < 3) {
+                byte_length = length/2;
+                if (!kstrtoul(buf_tmp, 16, &result)) {//command
+                    for (loop_i = 0 ; loop_i < byte_length ; loop_i++) {
+                        register_command[loop_i] = (uint8_t)(result >> loop_i*8);
+                    }
+                }
+                if (!kstrtoul(data_str+1, 16, &result)) {//data
+                    for (loop_i = 0 ; loop_i < byte_length ; loop_i++) {
+                        w_data[loop_i] = (uint8_t)(result >> loop_i*8);
+                    }
+                }
+                himax_register_write(ts->client, register_command, byte_length, w_data, cfg_flag);
+            } else {
+                byte_length = x_pos[1] - x_pos[0] - 2;
+                for (loop_i = 0; loop_i < count; loop_i++) {//parsing addr after 'x'
+                    memcpy(buf_tmp, buf + x_pos[loop_i] + 1, byte_length);
+                    //TPD_INFO("%s: buf_tmp = %s\n", __func__,buf_tmp);
+                    if (!kstrtoul(buf_tmp, 16, &result)) {
+                        if(loop_i == 0) {
+                            register_command[loop_i] = (uint8_t)(result);
+                            //TPD_INFO("%s: register_command = %X\n", __func__,register_command[0]);
+                        } else {
+                            w_data[loop_i - 1] = (uint8_t)(result);
+                            //TPD_INFO("%s: w_data[%d] = %2X\n", __func__,loop_i - 1,w_data[loop_i - 1]);
+                        }
+                    }
+                }
+
+                byte_length = count - 1;
+                himax_register_write(ts->client, register_command, byte_length, &w_data[0], cfg_flag);
+            }
+        } else {
+            return len;
+        }
+
+    }
+    return len;
+}
+
+void himax_return_event_stack(struct i2c_client *client)
+{
+    int retry = 20;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+
+    TPD_INFO("%s:entering\n", __func__);
+    do {
+        TPD_INFO("%s,now %d times\n!", __func__, retry);
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x00;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        retry--;
+        msleep(10);
+
+    } while ((tmp_data[1] != 0x00 && tmp_data[0] != 0x00) && retry > 0);
+
+    TPD_INFO("%s: End of setting!\n", __func__);
+
+}
+/*IC_BASED_END*/
+
+int himax_write_read_reg(struct i2c_client *client,uint8_t *tmp_addr,uint8_t *tmp_data,uint8_t hb,uint8_t lb)
+{
+    int cnt = 0;
+
+    do
+    {
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+
+        msleep(20);
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s:Now tmp_data[0]=0x%02X,[1]=0x%02X,[2]=0x%02X,[3]=0x%02X\n",__func__,tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3]);
+    }
+    while((tmp_data[1] != hb && tmp_data[0] != lb) && cnt++ < 100);
+
+    if(cnt >= 99)  {
+        TPD_INFO("himax_write_read_reg ERR Now register 0x%08X : high byte=0x%02X,low byte=0x%02X\n",tmp_addr[3],tmp_data[1],tmp_data[0]);
+        return -1;
+    }
+
+    TPD_INFO("Now register 0x%08X : high byte=0x%02X,low byte=0x%02X\n",tmp_addr[3],tmp_data[1],tmp_data[0]);
+    return NO_ERR;
+}
+
+void himax_get_DSRAM_data(struct i2c_client *client, uint8_t *info_data, uint8_t x_num, uint8_t y_num)
+{
+    int i = 0;
+    //int cnt = 0;
+    unsigned char tmp_addr[4];
+    unsigned char tmp_data[4];
+    uint8_t max_i2c_size = 128;
+    int m_key_num = 0;
+    int total_size = (x_num * y_num + x_num + y_num) * 2 + 4;
+    int total_size_temp;
+    int mutual_data_size = x_num * y_num * 2;
+    int total_read_times = 0;
+    int address = 0;
+    uint8_t *temp_info_data; //max mkey size = 8
+    uint32_t check_sum_cal = 0;
+    int fw_run_flag = -1;
+    //uint16_t temp_check_sum_cal = 0;
+
+    temp_info_data = kzalloc(sizeof(uint8_t) * (total_size + 8), GFP_KERNEL);
+
+    /*1. Read number of MKey R100070E8H to determin data size*/
+    m_key_num = 0;
+    //TPD_INFO("%s,m_key_num=%d\n",__func__,m_key_num);
+    total_size += m_key_num * 2;
+
+    /* 2. Start DSRAM Rawdata and Wait Data Ready */
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x00;
+    tmp_data[3] = 0x00;
+    tmp_data[2] = 0x00;
+    tmp_data[1] = 0x5A;
+    tmp_data[0] = 0xA5;
+    fw_run_flag = himax_write_read_reg(client, tmp_addr, tmp_data, 0xA5, 0x5A);
+    if (fw_run_flag < 0) {
+        TPD_INFO("%s Data NOT ready => bypass \n", __func__);
+        kfree(temp_info_data);
+        return;
+    }
+
+    /* 3. Read RawData */
+    total_size_temp = total_size;
+    tmp_addr[3] = 0x10;
+    tmp_addr[2] = 0x00;
+    tmp_addr[1] = 0x00;
+    tmp_addr[0] = 0x00;
+
+    if (total_size % max_i2c_size == 0) {
+        total_read_times = total_size / max_i2c_size;
+    } else {
+        total_read_times = total_size / max_i2c_size + 1;
+    }
+
+    for (i = 0; i < (total_read_times); i++) {
+        if (total_size_temp >= max_i2c_size) {
+            himax_register_read(client, tmp_addr, max_i2c_size, &temp_info_data[i * max_i2c_size], false);
+            total_size_temp = total_size_temp - max_i2c_size;
+        } else {
+            //TPD_INFO("last total_size_temp=%d\n",total_size_temp);
+            himax_register_read(client, tmp_addr, total_size_temp % max_i2c_size,
+            &temp_info_data[i * max_i2c_size], false);
+        }
+
+        address = ((i + 1) * max_i2c_size);
+        tmp_addr[1] = (uint8_t)((address >> 8) & 0x00FF);
+        tmp_addr[0] = (uint8_t)((address) & 0x00FF);
+    }
+
+    /* 4. FW stop outputing */
+    //TPD_INFO("DSRAM_Flag=%d\n",DSRAM_Flag);
+    if (DSRAM_Flag == false) {
+        //TPD_INFO("Return to Event Stack!\n");
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x00;
+        tmp_data[2] = 0x00;
+        tmp_data[1] = 0x00;
+        tmp_data[0] = 0x00;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+    } else {
+        //TPD_INFO("Continue to SRAM!\n");
+        tmp_addr[3] = 0x10;
+        tmp_addr[2] = 0x00;
+        tmp_addr[1] = 0x00;
+        tmp_addr[0] = 0x00;
+        tmp_data[3] = 0x11;
+        tmp_data[2] = 0x22;
+        tmp_data[1] = 0x33;
+        tmp_data[0] = 0x44;
+        himax_flash_write_burst(client, tmp_addr, tmp_data);
+    }
+
+    /* 5. Data Checksum Check */
+    for (i = 2; i < total_size; i = i + 2)/* 2:PASSWORD NOT included */
+    {
+        check_sum_cal += (temp_info_data[i + 1] * 256 + temp_info_data[i]);
+        printk("0x%2x:0x%4x ", temp_info_data[i], check_sum_cal);
+        if(i%32 == 0)
+            printk("\n");
+    }
+
+    if (check_sum_cal % 0x10000 != 0) {
+        memcpy(info_data, &temp_info_data[4], mutual_data_size * sizeof(uint8_t));
+        TPD_INFO("%s check_sum_cal fail=%2x \n", __func__, check_sum_cal);
+        kfree(temp_info_data);
+        return;
+    } else {
+        memcpy(info_data, &temp_info_data[4], mutual_data_size * sizeof(uint8_t));
+        TPD_INFO("%s checksum PASS \n", __func__);
+    }
+    kfree(temp_info_data);
+}
+
+void himax_ts_diag_func(struct chip_data_hx83112b *chip_info, int32_t *mutual_data)
+{
+    int i = 0;
+    int j = 0;
+    unsigned int index = 0;
+    int total_size = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2;
+    uint8_t info_data[total_size];
+
+    int32_t new_data;
+    /* 1:common dsram,2:100 frame Max,3:N-(N-1)frame */
+    int dsram_type = 0;
+    //char temp_buf[20];
+    char write_buf[total_size * 3];
+
+    memset(write_buf, '\0', sizeof(write_buf));
+
+    dsram_type = g_diag_command / 10;
+
+    TPD_INFO("%s:Entering g_diag_command=%d\n!", __func__, g_diag_command);
+
+    if (dsram_type == 8) {
+        dsram_type = 1;
+        TPD_INFO("%s Sorting Mode run sram type1 ! \n", __func__);
+    }
+
+    himax_burst_enable(chip_info->client, 1);
+    himax_get_DSRAM_data(chip_info->client, info_data, chip_info->hw_res->RX_NUM, chip_info->hw_res->TX_NUM);
+
+    index = 0;
+    for (i = 0; i < chip_info->hw_res->TX_NUM; i++) {
+        for (j = 0; j < chip_info->hw_res->RX_NUM; j++) {
+            new_data = (info_data[index + 1] << 8 | info_data[index]);
+            mutual_data[i * chip_info->hw_res->RX_NUM + j] = new_data;
+            index += 2;
+        }
+    }
+}
+
+void diag_parse_raw_data(struct himax_report_data *hx_touch_data,int mul_num, int self_num,uint8_t diag_cmd, int32_t *mutual_data, int32_t *self_data)
+{
+    int RawDataLen_word;
+    int index = 0;
+    int temp1, temp2,i;
+
+    if (hx_touch_data->hx_rawdata_buf[0] == 0x3A
+            && hx_touch_data->hx_rawdata_buf[1] == 0xA3
+            && hx_touch_data->hx_rawdata_buf[2] > 0
+            && hx_touch_data->hx_rawdata_buf[3] == diag_cmd) {
+        RawDataLen_word = hx_touch_data->rawdata_size/2;
+        index = (hx_touch_data->hx_rawdata_buf[2] - 1) * RawDataLen_word;
+        //TPD_INFO("Header[%d]: %x, %x, %x, %x, mutual: %d, self: %d\n", index, buf[56], buf[57], buf[58], buf[59], mul_num, self_num);
+        //TPD_INFO("RawDataLen=%d , RawDataLen_word=%d , hx_touch_info_size=%d\n", RawDataLen, RawDataLen_word, hx_touch_info_size);
+        for (i = 0; i < RawDataLen_word; i++) {
+            temp1 = index + i;
+
+            if (temp1 < mul_num) {
+                //mutual
+                mutual_data[index + i] = hx_touch_data->hx_rawdata_buf[i*2 + 4 + 1]*256 + hx_touch_data->hx_rawdata_buf[i*2 + 4];    //4: RawData Header, 1:HSB
+            } else {
+                //self
+                temp1 = i + index;
+                temp2 = self_num + mul_num;
+
+                if (temp1 >= temp2) {
+                    break;
+                }
+                self_data[i+index-mul_num] = hx_touch_data->hx_rawdata_buf[i*2 + 4];    //4: RawData Header
+                self_data[i+index-mul_num+1] = hx_touch_data->hx_rawdata_buf[i*2 + 4 + 1];
+            }
+        }
+    }
+
+}
+
+bool diag_check_sum( struct himax_report_data *hx_touch_data ) //return checksum value
+{
+    uint16_t check_sum_cal = 0;
+    int i;
+
+    //Check 128th byte CRC
+    for (i = 0, check_sum_cal = 0; i < (hx_touch_data->touch_all_size - hx_touch_data->touch_info_size); i=i+2) {
+        check_sum_cal += (hx_touch_data->hx_rawdata_buf[i+1]*256 + hx_touch_data->hx_rawdata_buf[i]);
+    }
+    if (check_sum_cal % 0x10000 != 0) {
+        TPD_INFO("%s fail=%2X \n", __func__, check_sum_cal);
+        return 0;
+        //goto bypass_checksum_failed_packet;
+    }
+
+    return 1;
+}
+
+static size_t hx83112b_proc_diag_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+    char messages[80] = {0};
+    uint8_t command[2] = {0x00, 0x00};
+    uint8_t receive[1];
+
+   struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+   struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+    /* 0: common , other: dsram*/
+    int storage_type = 0;
+    /* 1:IIR,2:DC,3:Bank,4:IIR2,5:IIR2_N,6:FIR2,7:Baseline,8:dump coord */
+    int rawdata_type = 0;
+
+    memset(receive, 0x00, sizeof(receive));
+
+    if (len >= 80) {
+        TPD_INFO("%s: no command exceeds 80 chars.\n", __func__);
+        return -EFAULT;
+    }
+    if (copy_from_user(messages, buff, len)) {
+        return -EFAULT;
+    }
+
+    if (messages[1] == 0x0A) {
+        g_diag_command = messages[0] - '0';
+    } else {
+        g_diag_command = (messages[0] - '0')*10 + (messages[1] - '0');
+    }
+
+    storage_type = g_diag_command / 10;
+    rawdata_type = g_diag_command % 10;
+
+    TPD_INFO(" messages       = %s\n"
+             " g_diag_command = 0x%x\n"
+             " storage_type   = 0x%x\n"
+             " rawdata_type   = 0x%x\n",
+             messages, g_diag_command, storage_type, rawdata_type);
+
+    if(g_diag_command > 0 && rawdata_type == 0) {
+        TPD_INFO("[Himax]g_diag_command=0x%x ,storage_type=%d, rawdata_type=%d! Maybe no support!\n", g_diag_command,storage_type,rawdata_type);
+        g_diag_command = 0x00;
+    } else {
+        TPD_INFO("[Himax]g_diag_command=0x%x ,storage_type=%d, rawdata_type=%d\n",g_diag_command,storage_type,rawdata_type);
+    }
+
+    if (storage_type == 0 && rawdata_type > 0 && rawdata_type < 8) {
+        TPD_INFO("%s,common\n",__func__);
+        if (DSRAM_Flag) {
+            //(1) Clear DSRAM flag
+            DSRAM_Flag = false;
+            //(2) Enable ISR
+            enable_irq(chip_info->client->irq);
+            //(3) FW leave sram and return to event stack
+            himax_return_event_stack(chip_info->client);
+        }
+
+        command[0] = g_diag_command;
+        himax_diag_register_set(chip_info->client, command[0]);
+    } else if (storage_type > 0 && storage_type < 8 && rawdata_type > 0 && rawdata_type < 8) {
+        TPD_INFO("%s,dsram\n",__func__);
+
+        //0. set diag flag
+        if (DSRAM_Flag) {
+            //(1) Clear DSRAM flag
+            DSRAM_Flag = false;
+            //(2) Enable ISR
+            enable_irq(chip_info->client->irq);
+            //(3) FW leave sram and return to event stack
+            himax_return_event_stack(chip_info->client);
+        }
+
+        switch(rawdata_type) {
+            case 1:
+                command[0] = 0x09; //IIR
+            break;
+
+            case 2:
+                command[0] = 0x0A;//RAWDATA
+            break;
+
+            case 3:
+                command[0] = 0x08;//Baseline
+            break;
+
+            default:
+                command[0] = 0x00;
+                TPD_INFO("%s: Sram no support this type !\n",__func__);
+            break;
+        }
+        himax_diag_register_set(chip_info->client, command[0]);
+        TPD_INFO("%s: Start get raw data in DSRAM\n", __func__);
+        //1. Disable ISR
+        disable_irq(chip_info->client->irq);
+
+        //2. Set DSRAM flag
+        DSRAM_Flag = true;
+    } else {
+        //set diag flag
+        if(DSRAM_Flag) {
+            TPD_INFO("return and cancel sram thread!\n");
+            //(1) Clear DSRAM flag
+            DSRAM_Flag = false;
+            himax_return_event_stack(chip_info->client);
+        }
+        command[0] = 0x00;
+        g_diag_command = 0x00;
+        himax_diag_register_set(chip_info->client, command[0]);
+        TPD_INFO("return to normal g_diag_command=0x%x\n",g_diag_command);
+    }
+    return len;
+}
+
+static size_t hx83112b_proc_diag_read(struct file *file, char *buff, size_t len, loff_t *pos)
+{
+    size_t ret = 0;
+    char *temp_buf;
+    uint16_t mutual_num;
+    uint16_t self_num;
+    uint16_t width;
+    int dsram_type = 0;
+    int i = 0;
+    int j = 0;
+    int k = 0;
+
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+    if (!HX_PROC_SEND_FLAG) {
+        temp_buf = kzalloc(len, GFP_KERNEL);
+        if(!temp_buf) {
+            goto RET_OUT;
+        }
+
+        dsram_type = g_diag_command / 10;
+
+        mutual_num = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM;
+        self_num = chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM; //don't add KEY_COUNT
+        width = chip_info->hw_res->RX_NUM;
+        ret += snprintf(temp_buf + ret, len - ret, "ChannelStart (rx tx) : %4d, %4d\n\n", chip_info->hw_res->RX_NUM, chip_info->hw_res->TX_NUM);
+
+        // start to show out the raw data in adb shell
+        if ((g_diag_command >= 1 && g_diag_command <= 7) || dsram_type > 0) {
+            himax_ts_diag_func(chip_info, hx_touch_data->diag_mutual);
+
+            for(j=0; j < chip_info->hw_res->RX_NUM ; j++) {
+                    for(i=0; i < chip_info->hw_res->TX_NUM; i++) {
+                        k = ((mutual_num - j)- chip_info->hw_res->RX_NUM *i) - 1;
+                        ret += snprintf(temp_buf + ret, len - ret, "%6d", hx_touch_data->diag_mutual[k]);
+                    }
+                    ret += snprintf(temp_buf + ret, len - ret, " %6d\n", diag_self[j]);
+            }
+
+            ret += snprintf(temp_buf + ret, len - ret, "\n");
+            for (i=0; i < chip_info->hw_res->TX_NUM; i++) {
+                    ret += snprintf(temp_buf + ret, len - ret, "%6d", diag_self[i]);
+            }
+        }
+
+        ret += snprintf(temp_buf + ret, len - ret, "\n");
+        ret += snprintf(temp_buf + ret, len - ret, "ChannelEnd");
+        ret += snprintf(temp_buf + ret, len - ret, "\n");
+
+        //if ((g_diag_command >= 1 && g_diag_command <= 7) || dsram_type > 0)
+            {
+            /* print Mutual/Slef Maximum and Minimum */
+            //himax_get_mutual_edge();
+            for (i = 0; i < (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM); i++) {
+                if (hx_touch_data->diag_mutual[i] > g_max_mutual) {
+                    g_max_mutual = hx_touch_data->diag_mutual[i];
+                }
+                if (hx_touch_data->diag_mutual[i] < g_min_mutual) {
+                    g_min_mutual = hx_touch_data->diag_mutual[i];
+                }
+            }
+
+            //himax_get_self_edge();
+            for (i = 0; i < (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM); i++) {
+                if (diag_self[i] > g_max_self) {
+                    g_max_self = diag_self[i];
+                }
+                if (diag_self[i] < g_min_self) {
+                    g_min_self = diag_self[i];
+                }
+            }
+
+            ret += snprintf(temp_buf + ret, len - ret, "Mutual Max:%3d, Min:%3d\n", g_max_mutual, g_min_mutual);
+            ret += snprintf(temp_buf + ret, len - ret, "Self Max:%3d, Min:%3d\n", g_max_self, g_min_self);
+
+            /* recovery status after print*/
+            g_max_mutual = 0;
+            g_min_mutual = 255;
+            g_max_self = 0;
+            g_min_self = 255;
+        }
+        if (copy_to_user(buff, temp_buf, len)) {
+            TPD_INFO("%s,here:%d\n", __func__, __LINE__);
+        }
+        HX_PROC_SEND_FLAG = 1;
+RET_OUT:
+        if(temp_buf) {
+            kfree(temp_buf);
+        }
+    } else {
+        HX_PROC_SEND_FLAG = 0;
+    }
+
+    return ret;
+}
+
+uint8_t himax_read_DD_status(struct chip_data_hx83112b *chip_info, uint8_t *cmd_set, uint8_t *tmp_data)
+{
+	int cnt = 0;
+	uint8_t req_size = cmd_set[0];
+	uint8_t cmd_addr[4] = {0xFC, 0x00, 0x00, 0x90}; //0x900000FC -> cmd and hand shaking
+	uint8_t tmp_addr[4] = {0x80, 0x7F, 0x00, 0x10}; //0x10007F80 -> data space
+
+	cmd_set[3] = 0xAA;
+	himax_register_write(chip_info->client, cmd_addr, 4, cmd_set, 0);
+
+	TPD_INFO("%s: cmd_set[0] = 0x%02X,cmd_set[1] = 0x%02X,cmd_set[2] = 0x%02X,cmd_set[3] = 0x%02X\n", __func__,cmd_set[0],cmd_set[1],cmd_set[2],cmd_set[3]);
+
+	for (cnt = 0; cnt < 100; cnt++) {
+		himax_register_read(chip_info->client, cmd_addr, 4, tmp_data, false);
+		TPD_INFO("%s: tmp_data[0] = 0x%02X,tmp_data[1] = 0x%02X,tmp_data[2] = 0x%02X,tmp_data[3] = 0x%02X, cnt=%d\n", __func__,tmp_data[0],tmp_data[1],tmp_data[2],tmp_data[3],cnt);
+		msleep(10);
+		if (tmp_data[3] == 0xBB) {
+			TPD_INFO("%s Data ready goto moving data\n", __func__);
+			break;
+		} else if(cnt >= 99) {
+			TPD_INFO("%s Data not ready in FW \n", __func__);
+			return FW_NOT_READY;
+		}
+	}
+	himax_register_read(chip_info->client, tmp_addr, req_size, tmp_data, false);
+	return NO_ERR;
+}
+
+static size_t hx83112b_proc_DD_debug_read(struct file *file, char *buf, size_t len, loff_t *pos)
+{
+	int ret = 0;
+	uint8_t tmp_data[64];
+	uint8_t loop_i = 0;
+	char *temp_buf;
+
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+	struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+	if (!HX_PROC_SEND_FLAG) {
+		temp_buf = kzalloc(len,GFP_KERNEL);
+
+		if (mutual_set_flag == 1) {
+			if (himax_read_DD_status(chip_info, cmd_set, tmp_data) == NO_ERR) {
+				for (loop_i = 0; loop_i < cmd_set[0]; loop_i++) {
+					if ((loop_i % 8) == 0) {
+						ret += snprintf(temp_buf + ret, len - ret, "0x%02X : ", loop_i);
+                    }
+					ret += snprintf(temp_buf + ret, len - ret, "0x%02X ", tmp_data[loop_i]);
+					if ((loop_i % 8) == 7)
+						ret += snprintf(temp_buf + ret, len - ret, "\n");
+				}
+			}
+		}
+		//else
+		ret += snprintf(temp_buf + ret, len - ret, "\n");
+		if (copy_to_user(buf, temp_buf, len))
+			TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+		kfree(temp_buf);
+		HX_PROC_SEND_FLAG=1;
+	} else
+		HX_PROC_SEND_FLAG=0;
+	return ret;
+}
+
+static size_t hx83112b_proc_DD_debug_write(struct file *file, const char *buff, size_t len, loff_t *pos)
+{
+	uint8_t i = 0;
+	uint8_t cnt = 2;
+	unsigned long result = 0;
+	char buf_tmp[20];
+	char buf_tmp2[4];
+
+	if (len >= 20) {
+		TPD_INFO("%s: no command exceeds 20 chars.\n", __func__);
+		return -EFAULT;
+	}
+	if (copy_from_user(buf_tmp, buff, len)) {
+		return -EFAULT;
+	}
+	memset(buf_tmp2, 0x0, sizeof(buf_tmp2));
+
+	if (buf_tmp[2] == 'x' && buf_tmp[6] == 'x' && buf_tmp[10] == 'x') {
+		mutual_set_flag = 1;
+		for (i = 3; i < 12; i = i + 4) {
+			memcpy(buf_tmp2, buf_tmp + i, 2);
+			if (!kstrtoul(buf_tmp2, 16, &result))
+				cmd_set[cnt] = (uint8_t)result;
+			else
+				TPD_INFO("String to oul is fail in cnt = %d, buf_tmp2 = %s",cnt, buf_tmp2);
+			cnt--;
+		}
+		TPD_INFO("cmd_set[2] = %02X, cmd_set[1] = %02X, cmd_set[0] = %02X\n",cmd_set[2],cmd_set[1],cmd_set[0]);
+	} else
+		mutual_set_flag = 0;
+
+	return len;
+}
+
+int himax_read_FW_status(struct chip_data_hx83112b *chip_info, uint8_t *state_addr, uint8_t *tmp_addr)
+{
+	uint8_t req_size = 0;
+	uint8_t status_addr[4] = {0x44, 0x7F, 0x00, 0x10}; //0x10007F44
+	uint8_t cmd_addr[4] = {0xF8, 0x00, 0x00, 0x90}; //0x900000F8
+
+	if(state_addr[0]==0x01)
+		{
+			state_addr[1]= 0x04;
+			state_addr[2]= status_addr[0];state_addr[3]= status_addr[1];state_addr[4]= status_addr[2];state_addr[5]= status_addr[3];
+			req_size = 0x04;
+			himax_sense_off(chip_info->client);
+			himax_register_read(chip_info->client, status_addr, req_size, tmp_addr, false);
+			himax_sense_on(chip_info->client,1);
+		}
+	else if(state_addr[0]==0x02)
+		{
+			state_addr[1]= 0x30;
+			state_addr[2]= cmd_addr[0];state_addr[3]= cmd_addr[1];state_addr[4]= cmd_addr[2];state_addr[5]= cmd_addr[3];
+			req_size = 0x30;
+			himax_register_read(chip_info->client, cmd_addr, req_size, tmp_addr, false);
+		}
+
+	return NO_ERR;
+}
+
+static size_t hx83112b_proc_FW_debug_read(struct file *file, char *buf,
+										size_t len, loff_t *pos)
+{
+	int ret = 0;
+	uint8_t loop_i = 0;
+	uint8_t tmp_data[64];
+	char *temp_buf;
+
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+	struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+	if (!HX_PROC_SEND_FLAG) {
+		temp_buf = kzalloc(len,GFP_KERNEL);
+
+		cmd_set[0] = 0x01;
+		if (himax_read_FW_status(chip_info, cmd_set, tmp_data) == NO_ERR) {
+			ret += snprintf(temp_buf + ret, len - ret, "0x%02X%02X%02X%02X :\t",cmd_set[5],cmd_set[4],cmd_set[3],cmd_set[2]);
+			for (loop_i = 0; loop_i < cmd_set[1]; loop_i++) {
+				ret += snprintf(temp_buf + ret, len - ret, "%5d\t", tmp_data[loop_i]);
+			}
+			ret += snprintf(temp_buf + ret, len - ret, "\n");
+		}
+		cmd_set[0] = 0x02;
+		if (himax_read_FW_status(chip_info, cmd_set, tmp_data) == NO_ERR) {
+			for (loop_i = 0; loop_i < cmd_set[1]; loop_i = loop_i + 2) {
+				if ((loop_i % 16) == 0)
+					ret += snprintf(temp_buf + ret, len - ret, "0x%02X%02X%02X%02X :\t",
+							cmd_set[5],cmd_set[4],cmd_set[3]+(((cmd_set[2]+ loop_i)>>8)&0xFF), (cmd_set[2] + loop_i)&0xFF);
+
+				ret += snprintf(temp_buf + ret, len - ret, "%5d\t", tmp_data[loop_i] + (tmp_data[loop_i + 1] << 8));
+				if ((loop_i % 16) == 14)
+					ret += snprintf(temp_buf + ret, len - ret, "\n");
+			}
+
+		}
+		ret += snprintf(temp_buf + ret, len - ret, "\n");
+		if (copy_to_user(buf, temp_buf, len))
+			TPD_INFO("%s,here:%d\n",__func__,__LINE__);
+		kfree(temp_buf);
+		HX_PROC_SEND_FLAG=1;
+	} else
+		HX_PROC_SEND_FLAG=0;
+	return ret;
+}
+
+/**
+ * hx83112b_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int hx83112b_enable_interrupt(struct chip_data_hx83112b *chip_info, bool enable)
+{
+     TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+
+    if (enable) {
+        enable_irq(chip_info->client->irq);
+    } else {
+        disable_irq_nosync(chip_info->client->irq);
+    }
+     return 0;
+}
+
+static int hx83112b_configuration_init(struct chip_data_hx83112b *chip_info, bool config)
+{
+    int ret = 0;
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    return ret;
+}
+
+int himax_ic_reset(struct chip_data_hx83112b *chip_info, uint8_t loadconfig,uint8_t int_off)
+{
+    int ret = 0;
+	HX_HW_RESET_ACTIVATE = 1;
+
+	TPD_INFO("%s,status: loadconfig=%d,int_off=%d\n",__func__,loadconfig,int_off);
+
+	if (chip_info->hw_res->reset_gpio) {
+		if (int_off) {
+
+            ret = hx83112b_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable interrupt failed.\n", __func__);
+                return ret;
+            }
+        }
+
+        hx83112b_resetgpio_set(chip_info->hw_res, false); // reset gpio
+
+        hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+
+        if (loadconfig) {
+            ret = hx83112b_configuration_init(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = hx83112b_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b configuration init failed.\n", __func__);
+                return ret;
+            }
+		}
+		if (int_off) {
+            ret = hx83112b_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable interrupt failed.\n", __func__);
+                return ret;
+            }
+		}
+    }
+    return 0;
+}
+
+static size_t hx83112b_proc_reset_write(struct file *file, const char *buff,
+								 size_t len, loff_t *pos)
+{
+	char buf_tmp[12];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+	if (len >= 12) {
+		TPD_INFO("%s: no command exceeds 12 chars.\n", __func__);
+		return -EFAULT;
+	}
+	if (copy_from_user(buf_tmp, buff, len)) {
+		return -EFAULT;
+	}
+	if (buf_tmp[0] == '1')
+		himax_ic_reset(chip_info, false,false);
+	else if (buf_tmp[0] == '2')
+		himax_ic_reset(chip_info,false,true);
+	else if (buf_tmp[0] == '3')
+		himax_ic_reset(chip_info, true,false);
+	else if (buf_tmp[0] == '4')
+		himax_ic_reset(chip_info ,true,true);
+	return len;
+}
+
+static size_t hx83112b_proc_sense_on_off_write(struct file *file, const char *buff,
+										size_t len, loff_t *pos)
+{
+	char buf[80] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)ts->chip_data;
+
+	if (len >= 80) {
+		TPD_INFO("%s: no command exceeds 80 chars.\n", __func__);
+		return -EFAULT;
+	}
+	if (copy_from_user(buf, buff, len)) {
+		return -EFAULT;
+	}
+
+	if (buf[0] == '0') {
+		himax_sense_off(chip_info->client);
+		TPD_INFO("Sense off \n");
+	} else if(buf[0] == '1') {
+		if (buf[1] == 's') {
+			himax_sense_on(chip_info->client, 0x00);
+			TPD_INFO("Sense on re-map on, run sram \n");
+		} else {
+			himax_sense_on(chip_info->client, 0x01);
+			TPD_INFO("Sense on re-map off, run flash \n");
+		}
+	} else {
+		TPD_INFO("Do nothing \n");
+	}
+	return len;
+}
+//add for himax end
+
+static int hx83112b_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int i, x, y, obj_attention = 0;
+
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+    char buf[128];
+    uint16_t mutual_num;
+    uint16_t self_num;
+    int ret = 0;
+    int check_sum_cal;
+    int ts_status = HX_REPORT_COORD;
+    int hx_point_num;
+    uint8_t hx_state_info_pos;
+
+    if (!hx_touch_data) {
+        TPD_INFO("%s:%d hx_touch_data is NULL\n", __func__, __LINE__);
+    }
+
+    if (!hx_touch_data->hx_coord_buf) {
+        TPD_INFO("%s:%d hx_touch_data->hx_coord_buf is NULL\n", __func__, __LINE__);
+        return 0;
+    }
+
+    himax_burst_enable(chip_info->client, 0);
+    if (g_diag_command)
+        ret = himax_read_event_stack(chip_info->client, buf, 128);
+    else
+        ret = himax_read_event_stack(chip_info->client, buf, hx_touch_data->touch_info_size);
+    if (!ret) {
+        TPD_INFO("%s: can't read data from chip in normal!\n", __func__);
+        goto checksum_fail;
+    }
+    //himax_log_touch_data(buf, hx_touch_data);
+
+    check_sum_cal = himax_checksum_cal(chip_info, buf, ts_status);//????checksum
+    if (check_sum_cal == CHECKSUM_FAIL) {
+        goto checksum_fail;
+    } else if (check_sum_cal == ERR_WORK_OUT) {
+        goto err_workqueue_out;
+    } else if (check_sum_cal == WORK_OUT) {
+        goto workqueue_out;
+    }
+
+    //himax_assign_touch_data(buf,ts_status);//??buf??, ??hx_coord_buf
+
+    hx_state_info_pos = hx_touch_data->touch_info_size - 3;
+    if(ts_status == HX_REPORT_COORD) {
+        memcpy(hx_touch_data->hx_coord_buf,&buf[0],hx_touch_data->touch_info_size);
+        if(buf[hx_state_info_pos] != 0xFF && buf[hx_state_info_pos + 1] != 0xFF) {
+            memcpy(hx_touch_data->hx_state_info,&buf[hx_state_info_pos],2);
+        } else {
+            memset(hx_touch_data->hx_state_info, 0x00, sizeof(hx_touch_data->hx_state_info));
+        }
+    }
+    if (g_diag_command) {
+        mutual_num = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM;
+        self_num = chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM;
+        TPD_INFO("hx_touch_data->touch_all_size= %d hx_touch_data->touch_info_size = %d ,  %d\n",\
+            hx_touch_data->touch_all_size, hx_touch_data->touch_info_size, hx_touch_data->touch_all_size - hx_touch_data->touch_info_size);
+            memcpy(hx_touch_data->hx_rawdata_buf,&buf[hx_touch_data->touch_info_size],hx_touch_data->touch_all_size - hx_touch_data->touch_info_size);
+        if (!diag_check_sum(hx_touch_data)) {
+            goto checksum_fail;
+        }
+        diag_parse_raw_data(hx_touch_data, mutual_num, self_num, g_diag_command, hx_touch_data->diag_mutual, diag_self);
+    }
+
+    if (hx_touch_data->hx_coord_buf[HX_TOUCH_INFO_POINT_CNT] == 0xff)//HX_TOUCH_INFO_POINT_CNT buf???????
+        hx_point_num = 0;
+    else
+        hx_point_num= hx_touch_data->hx_coord_buf[HX_TOUCH_INFO_POINT_CNT] & 0x0f;
+
+
+    for (i = 0; i < 10; i++) {
+        x = hx_touch_data->hx_coord_buf[i*4] << 8 | hx_touch_data->hx_coord_buf[i*4 + 1];
+        y = (hx_touch_data->hx_coord_buf[i*4 + 2] << 8 | hx_touch_data->hx_coord_buf[i*4 + 3]);
+        if(x >= 0 && x <= 1080 && y >= 0 && y <= 2280) {
+            points[i].x = x;
+            points[i].y = y;
+            points[i].width_major = 1;
+            points[i].status = 1;
+            obj_attention = obj_attention | (0x0001 << i);
+        }
+    }
+
+    //TPD_DEBUG("%s:%d  obj_attention = 0x%x\n", __func__, __LINE__, obj_attention);
+
+checksum_fail:
+    return obj_attention;
+err_workqueue_out:
+workqueue_out:
+    //himax_ic_reset(chip_info, false, true);
+    return obj_attention;
+
+}
+
+static int hx83112b_ftm_process(void *chip_data)
+{
+    int ret = -1;
+    TPD_INFO("%s go to sleep in ftm\n",__func__);
+    hx83112b_get_chip_info(chip_data);
+    hx83112b_mode_switch(chip_data, MODE_SLEEP, true);
+    if (ret < 0) {
+        TPD_INFO("%s, Touchpanel operate mode switch failed\n", __func__);
+    }
+    return 0;
+}
+
+static int hx83112b_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    chip_info->p_tp_fw = &panel_data->TP_FW;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n",
+              chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+
+static int hx83112b_get_chip_info(void *chip_data)
+{
+    return 1;
+}
+
+/**
+ * hx83112b_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t hx83112b_get_fw_id(struct chip_data_hx83112b *chip_info)
+{
+    uint32_t current_firmware = 0;
+    uint8_t cmd[4];
+    uint8_t data[64];
+
+    cmd[3] = 0x10;  // oppo fw id bin address : 0xc014   , 49172    Tp ic address : 0x 10007014
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x14;
+    himax_register_read(chip_info->client, cmd, 4, data, false);
+
+    TPD_DEBUG("%s : data[0]=0x%2.2X,data[1]=0x%2.2X,data[2]=0x%2.2X,data[3]=0x%2.2X\n",__func__,data[0],data[1],data[2],data[3]);
+
+    current_firmware = (data[0] << 24) | (data[1] << 16) | (data[2] << 8) | data[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+
+}
+
+static fw_check_state hx83112b_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    //uint32_t bootloader_mode;
+    //int max_y_ic = 0;
+    //int max_x_ic = 0;
+    //uint8_t buf[4];
+
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+  /*  touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    TPD_INFO("chip_info->reg_info.F01_RMI_DATA_BASE =  0x%x , bootloader_mode = 0x%x\n", chip_info->reg_info.F01_RMI_DATA_BASE, bootloader_mode);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }*/
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = hx83112b_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+static u8 hx83112b_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    if ((gesture_enable == 1) && is_suspended) {
+        return IRQ_GESTURE;
+    } else {
+        return IRQ_TOUCH;
+    }
+}
+
+static int hx83112b_reset_for_prepare(void *chip_data)
+{
+    int ret = -1;
+    //int i2c_error_number = 0;
+    //struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    //hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+
+    return ret;
+}
+
+static void hx83112b_resume_prepare(void *chip_data)
+{
+    hx83112b_reset_for_prepare(chip_data);
+}
+
+static void hx83112b_exit_esd_mode(void *chip_data)
+{
+    TPD_INFO("exit esd mode ok\n");
+    return;
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int hx83112b_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    clear_view_touchdown_flag(); //clear touch download flag
+    hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+
+    //exit esd mode
+    hx83112b_exit_esd_mode(chip_data);
+
+    return ret;
+}
+
+static int hx83112b_enable_black_gesture(struct chip_data_hx83112b *chip_info, bool enable)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(chip_info->client);
+    int ret = 0;
+
+    TPD_INFO("%s:enable=%d, ts->is_suspended=%d \n", __func__, enable, ts->is_suspended);
+
+    if (ts->is_suspended) {
+        if (enable) {
+            himax_sense_on(chip_info->client, 0);
+            /*if (!HX_RESET_STATE) {
+                ret =  hx83112b_resetgpio_set(chip_info->hw_res, true); // reset gpio
+                if (ret < 0) {
+                    TPD_INFO("%s: hx83112b reset gpio failed.\n", __func__);
+                    return ret;
+                }
+            }*/
+            /*ret = hx83112b_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable interrupt failed.\n", __func__);
+                return ret;
+            }*/
+        } else {
+            /*ret = hx83112b_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable interrupt failed.\n", __func__);
+                return ret;
+            }*/
+            /*if (HX_RESET_STATE) {
+                ret =  hx83112b_resetgpio_set(chip_info->hw_res, false); // reset gpio
+                if (ret < 0) {
+                    TPD_INFO("%s: hx83112b reset gpio failed.\n", __func__);
+                    return ret;
+                }
+            }*/
+            himax_sense_off(chip_info->client);
+        }
+    } else {
+        himax_sense_on(chip_info->client, 0);
+    }
+    return ret;
+}
+
+static int hx83112b_enable_edge_limit(struct chip_data_hx83112b *chip_info, bool enable)
+{
+    int ret = 0;
+    return ret;
+}
+
+static int hx83112b_enable_charge_mode(struct chip_data_hx83112b *chip_info, bool enable)
+{
+    int ret = 0;
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    TPD_INFO("%s, charge mode enable = %d\n", __func__, enable);
+
+    //Enable:0x10007F38 = 0xA55AA55A
+    if(enable)
+    {
+       tmp_addr[3] = 0x10;
+       tmp_addr[2] = 0x00;
+       tmp_addr[1] = 0x7F;
+       tmp_addr[0] = 0x38;
+       tmp_data[3] = 0xA5;
+       tmp_data[2] = 0x5A;
+       tmp_data[1] = 0xA5;
+       tmp_data[0] = 0x5A;
+       himax_flash_write_burst(chip_info->client, tmp_addr, tmp_data);
+    }
+    else
+    {
+       tmp_addr[3] = 0x10;
+       tmp_addr[2] = 0x00;
+       tmp_addr[1] = 0x7F;
+       tmp_addr[0] = 0x38;
+       tmp_data[3] = 0x77;
+       tmp_data[2] = 0x88;
+       tmp_data[1] = 0x77;
+       tmp_data[0] = 0x88;
+       himax_flash_write_burst(chip_info->client, tmp_addr, tmp_data);
+    }
+
+    return ret;
+}
+
+static int hx83112b_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = hx83112b_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            /*device control: sleep mode*/
+            ret = hx83112b_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = hx83112b_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+
+            break;
+
+        case MODE_EDGE:
+            ret = hx83112b_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: hx83112b enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_CHARGE:
+            ret = hx83112b_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+void himax_set_SMWP_enable(struct i2c_client *client, uint8_t SMWP_enable, bool suspended)
+{
+    uint8_t tmp_addr[4];
+    uint8_t tmp_data[4];
+    uint8_t back_data[4];
+    uint8_t retry_cnt = 0;
+
+    himax_sense_off(client);
+
+    //Enable:0x10007F10 = 0xA55AA55A
+    do
+    {
+        if(SMWP_enable)
+        {
+            tmp_addr[3] = 0x10;
+            tmp_addr[2] = 0x00;
+            tmp_addr[1] = 0x7F;
+            tmp_addr[0] = 0x10;
+            tmp_data[3] = 0xA5;
+            tmp_data[2] = 0x5A;
+            tmp_data[1] = 0xA5;
+            tmp_data[0] = 0x5A;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+            back_data[3] = 0XA5;
+            back_data[2] = 0X5A;
+            back_data[1] = 0XA5;
+            back_data[0] = 0X5A;
+        }
+        else
+        {
+            tmp_addr[3] = 0x10;
+            tmp_addr[2] = 0x00;
+            tmp_addr[1] = 0x7F;
+            tmp_addr[0] = 0x10;
+            tmp_data[3] = 0x00;
+            tmp_data[2] = 0x00;
+            tmp_data[1] = 0x00;
+            tmp_data[0] = 0x00;
+            himax_flash_write_burst(client, tmp_addr, tmp_data);
+            back_data[3] = 0X00;
+            back_data[2] = 0X00;
+            back_data[1] = 0X00;
+            back_data[0] = 0x00;
+        }
+        himax_register_read(client, tmp_addr, 4, tmp_data, false);
+        TPD_INFO("%s: tmp_data[0]=%d, SMWP_enable=%d, retry_cnt=%d \n", __func__, tmp_data[0],SMWP_enable,retry_cnt);
+        retry_cnt++;
+    }
+    while((tmp_data[3] != back_data[3] || tmp_data[2] != back_data[2] || tmp_data[1] != back_data[1]  || tmp_data[0] != back_data[0] ) && retry_cnt < 10);
+
+    himax_sense_on(client,0);
+
+}
+
+
+static int hx83112b_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int i = 0;
+    int gesture_sign = 0;
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+    uint8_t *buf;
+    int gest_len;
+
+    int check_FC = 0;
+
+    int check_sum_cal;
+    int ts_status = HX_REPORT_SMWP_EVENT;
+
+    //TPD_DEBUG("%s:%d\n", __func__, __LINE__);
+
+    buf = kzalloc(hx_touch_data->event_size*sizeof(uint8_t),GFP_KERNEL);
+    if (!buf) {
+       TPD_INFO("%s:%d kzalloc buf error\n", __func__, __LINE__);
+       return -1;
+    }
+
+    himax_burst_enable(chip_info->client, 0);
+    if (!himax_read_event_stack(chip_info->client, buf, hx_touch_data->event_size))
+    {
+        TPD_INFO("%s: can't read data from chip in gesture!\n", __func__);
+        kfree(buf);
+        return -1;
+    }
+
+    /*for (i = 0; i < 56; i++)
+    {
+        if(i%8 == 0 && i != 56) {
+            printk(TPD_DEVICE);
+            printk(" %s:", __func__);
+        }
+        printk("0x%x ",  buf[i]);
+        if(i%8 == 0 && i != 0) {
+            printk("\n");
+        }
+    }*/
+
+    check_sum_cal = himax_checksum_cal(chip_info, buf, ts_status);//????checksum
+    if (check_sum_cal == CHECKSUM_FAIL) {
+        return -1;
+    } else if (check_sum_cal == ERR_WORK_OUT) {
+        goto err_workqueue_out;
+    }
+
+    for (i = 0; i < 4; i++) {
+        if (check_FC == 0) {
+            if((buf[0] != 0x00) && ((buf[0] < 0x0E))) {
+                check_FC = 1;
+                gesture_sign = buf[i];
+            } else {
+                check_FC = 0;
+                //TPD_DEBUG("ID START at %x , value = %x skip the event\n", i, buf[i]);
+                break;
+            }
+        } else {
+            if (buf[i] != gesture_sign) {
+                check_FC = 0;
+                //TPD_DEBUG("ID NOT the same %x != %x So STOP parse event\n", buf[i], gesture_sign);
+                break;
+            }
+        }
+        //TPD_DEBUG("0x%2.2X ", buf[i]);
+    }
+    //TPD_DEBUG("Himax gesture_sign= %x\n",gesture_sign );
+    //TPD_DEBUG("Himax check_FC is %d\n", check_FC);
+
+    if (buf[GEST_PTLG_ID_LEN] != GEST_PTLG_HDR_ID1 ||
+        buf[GEST_PTLG_ID_LEN+1] != GEST_PTLG_HDR_ID2) {
+        goto RET_OUT;
+    }
+
+    if (buf[GEST_PTLG_ID_LEN] == GEST_PTLG_HDR_ID1 &&
+        buf[GEST_PTLG_ID_LEN+1] == GEST_PTLG_HDR_ID2) {
+        gest_len = buf[GEST_PTLG_ID_LEN+2];
+
+        //TPD_DEBUG("gest_len = %d ",gest_len);
+
+        i = 0;
+        gest_pt_cnt = 0;
+        //TPD_DEBUG("gest doornidate start  %s\n",__func__);
+        while (i < (gest_len + 1)/2) {
+            if (i == 6) {
+                gest_pt_x[gest_pt_cnt] = buf[GEST_PTLG_ID_LEN+4+i*2];
+            } else {
+                gest_pt_x[gest_pt_cnt] = buf[GEST_PTLG_ID_LEN+4+i*2] * 1080 / 255;
+            }
+            gest_pt_y[gest_pt_cnt] =  buf[GEST_PTLG_ID_LEN+4+i*2+1] * 2280 / 255;
+            i++;
+            //TPD_DEBUG("gest_pt_x[%d]=%d \n",gest_pt_cnt,gest_pt_x[gest_pt_cnt]);
+            //TPD_DEBUG("gest_pt_y[%d]=%d \n",gest_pt_cnt,gest_pt_y[gest_pt_cnt]);
+            gest_pt_cnt +=1;
+        }
+        if (gest_pt_cnt) {
+             gesture->gesture_type = gesture_sign;//id
+             gesture->Point_start.x= gest_pt_x[0];//start x
+             gesture->Point_start.y= gest_pt_y[0];//start y
+             gesture->Point_end.x  = gest_pt_x[1];//end x
+             gesture->Point_end.y  = gest_pt_y[1];//end y
+             gesture->Point_1st.x  = gest_pt_x[2];//??1
+             gesture->Point_1st.y  = gest_pt_y[2];
+             gesture->Point_2nd.x  = gest_pt_x[3];//??2
+             gesture->Point_2nd.y  = gest_pt_y[3];
+             gesture->Point_3rd.x  = gest_pt_x[4];//??3
+             gesture->Point_3rd.y   = gest_pt_y[4];
+             gesture->Point_4th.x   = gest_pt_x[5];//??4
+             gesture->Point_4th.y   = gest_pt_y[5];
+             gesture->clockwise     = gest_pt_x[6]; //??? 1, ??? 0
+             //TPD_DEBUG("gesture->gesture_type = %d \n", gesture->gesture_type);
+             /*for (i = 0; i < 6; i++)
+                TPD_DEBUG("%d [ %d  %d ]\n", i, gest_pt_x[i], gest_pt_y[i]);*/
+        }
+    }
+    //TPD_DETAIL("%s, gesture_type = %d\n", __func__, gesture->gesture_type);
+
+RET_OUT:
+    if (buf) {
+        kfree(buf);
+    }
+    return 0;
+
+err_workqueue_out:
+    //himax_ic_reset(chip_info, false, true);
+    return -1;
+}
+
+static int hx83112b_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = hx83112b_resetgpio_set(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+    } else {
+        ret = hx83112b_resetgpio_set(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return ret;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static int hx83112b_int_pin_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int eint_status, eint_count = 0, read_gpio_num = 10;
+
+    TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        seq_printf(s, "TP EINT direct stort\n");
+        store_to_file(syna_testdata->fd, "eint_status is low, TP EINT direct stort, \n");
+        eint_count = 0;
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static void hx83112b_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int error_count = 0;
+    int ret = 0;
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+
+    ret = hx83112b_enable_interrupt(chip_info, false);
+
+    error_count += hx83112b_int_pin_test(s, chip_info, syna_testdata);
+    error_count += himax_chip_self_test(s, chip_info);
+
+    seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+}
+
+static void hx83112b_read_debug_data(struct seq_file *s, void *chip_data, int debug_data_type)
+{
+    uint16_t mutual_num;
+    uint16_t self_num;
+    uint16_t width;
+    int i = 0;
+    int j = 0;
+    int k = 0;
+    int32_t *data_mutual_sram;
+
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+    if (!chip_info)
+        return ;
+
+    data_mutual_sram = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * sizeof(int32_t), GFP_KERNEL);
+    if (!data_mutual_sram) {
+        goto RET_OUT;
+    }
+
+    mutual_num = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM;
+    self_num = chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM; //don't add KEY_COUNT
+    width = chip_info->hw_res->RX_NUM;
+    seq_printf(s, "ChannelStart (rx tx) : %4d, %4d\n\n", chip_info->hw_res->RX_NUM, chip_info->hw_res->TX_NUM);
+
+    //start to show debug data
+    switch (debug_data_type) {
+        case DEBUG_DATA_BASELINE:
+            seq_printf(s, "Baseline data: \n");
+            TPD_INFO("Baseline data: \n");
+        break;
+
+        case DEBUG_DATA_RAW:
+            seq_printf(s, "Raw data: \n");
+            TPD_INFO("Raw data: \n");
+        break;
+
+        case DEBUG_DATA_DELTA:
+            seq_printf(s, "Delta data: \n");
+            TPD_INFO("Raw data: \n");
+        break;
+
+        default :
+            seq_printf(s, "No this debug datatype \n");
+            TPD_INFO("No this debug datatype \n");
+            goto RET_OUT;
+        break;
+    }
+
+    himax_diag_register_set(chip_info->client, debug_data_type);
+    TPD_INFO("%s: Start get baseline data in DSRAM\n", __func__);
+    DSRAM_Flag = true;
+
+    himax_ts_diag_func(chip_info, data_mutual_sram);
+
+    for (j=0; j < chip_info->hw_res->RX_NUM ; j++) {
+        for (i=0; i < chip_info->hw_res->TX_NUM; i++) {
+            k = ((mutual_num - j)- chip_info->hw_res->RX_NUM *i) - 1;
+            seq_printf(s, "%6d", data_mutual_sram[k]);
+        }
+        seq_printf(s, " %6d\n", diag_self[j]);
+    }
+
+    seq_printf(s, "\n");
+    for (i=0; i < chip_info->hw_res->TX_NUM; i++) {
+        seq_printf(s, "%6d", diag_self[i]);
+    }
+    //Clear DSRAM flag
+    himax_diag_register_set(chip_info->client, 0x00);
+    DSRAM_Flag = false;
+    himax_return_event_stack(chip_info->client);
+
+    seq_printf(s, "\n");
+    seq_printf(s, "ChannelEnd");
+    seq_printf(s, "\n");
+
+    TPD_INFO("%s,here:%d\n", __func__, __LINE__);
+
+RET_OUT:
+    if (data_mutual_sram) {
+        kfree(data_mutual_sram);
+    }
+
+    return;
+}
+
+static void hx83112b_baseline_read(struct seq_file *s, void *chip_data)
+{
+    hx83112b_read_debug_data(s, chip_data, DEBUG_DATA_BASELINE);
+    hx83112b_read_debug_data(s, chip_data, DEBUG_DATA_RAW);
+    return;
+}
+
+static void hx83112b_delta_read(struct seq_file *s, void *chip_data)
+{
+    hx83112b_read_debug_data(s, chip_data, DEBUG_DATA_DELTA);
+    return;
+}
+
+static void hx83112b_main_register_read(struct seq_file *s, void *chip_data)
+{
+    return;
+}
+
+//Reserved node
+static void hx83112b_reserve_read(struct seq_file *s, void *chip_data)
+{
+    return;
+}
+
+
+static fw_update_state hx83112b_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+
+    uint8_t cmd[4];
+    uint8_t data[64];
+    struct chip_data_hx83112b *chip_info = (struct chip_data_hx83112b *)chip_data;
+    const uint8_t * p_fw_id = NULL ;
+    p_fw_id = fw->data  + 49172;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+
+    CURRENT_FIRMWARE_ID = (*p_fw_id << 24)|(*(p_fw_id + 1) << 16)|(*(p_fw_id + 2) << 8)| *(p_fw_id + 3);
+
+
+    cmd[3] = 0x10;  // oppo fw id bin address : 0xc014   , 49172    Tp ic address : 0x 10007014
+    cmd[2] = 0x00;
+    cmd[1] = 0x70;
+    cmd[0] = 0x14;
+    himax_register_read(chip_info->client, cmd, 4, data, false);
+    FIRMWARE_ID = (data[0] << 24)|(data[1] << 16)|(data[2] << 8)|data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+
+    //step 3:Get into program mode
+
+    /********************get into prog end************/
+
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    fts_ctpm_fw_upgrade_with_sys_fs_64k(chip_info->client, (unsigned char *)fw->data, fw->size, false);
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    himax_read_OPPO_FW_ver(chip_info->client);
+
+    hx83112b_reset(chip_info);
+    msleep(200);
+
+    return FW_UPDATE_SUCCESS;
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int hx83112b_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+#endif
+
+static struct oppo_touchpanel_operations hx83112b_ops = {
+    .ftm_process      = hx83112b_ftm_process,
+    .get_vendor       = hx83112b_get_vendor,
+    .get_chip_info    = hx83112b_get_chip_info,
+    .reset            = hx83112b_reset,
+    .power_control    = hx83112b_power_control,
+    .fw_check         = hx83112b_fw_check,
+    .fw_update        = hx83112b_fw_update,
+    .trigger_reason   = hx83112b_trigger_reason,
+    .get_touch_points = hx83112b_get_touch_points,
+    .get_gesture_info = hx83112b_get_gesture_info,
+    .mode_switch      = hx83112b_mode_switch,
+    .exit_esd_mode    = hx83112b_exit_esd_mode,
+    .resume_prepare   = hx83112b_resume_prepare,
+    .get_usb_state    = hx83112b_get_usb_state,
+    .black_screen_test = hx83112b_black_screen_test,
+};
+
+static struct himax_proc_operations hx83112b_proc_ops = {
+    .auto_test     = hx83112b_auto_test,
+    .himax_proc_register_write =  hx83112b_proc_register_write,
+    .himax_proc_register_read =  hx83112b_proc_register_read,
+    .himax_proc_diag_write =  hx83112b_proc_diag_write,
+    .himax_proc_diag_read =  hx83112b_proc_diag_read,
+    .himax_proc_DD_debug_read =  hx83112b_proc_DD_debug_read,
+    .himax_proc_DD_debug_write =  hx83112b_proc_DD_debug_write,
+    .himax_proc_FW_debug_read =  hx83112b_proc_FW_debug_read,
+    .himax_proc_reset_write =  hx83112b_proc_reset_write,
+    .himax_proc_sense_on_off_write =  hx83112b_proc_sense_on_off_write,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = himax_limit_read,
+    .delta_read    = hx83112b_delta_read,
+    .baseline_read = hx83112b_baseline_read,
+    .main_register_read = hx83112b_main_register_read,
+    .reserve_read = hx83112b_reserve_read,
+};
+
+static int hx83112b_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_hx83112b *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+    TPD_INFO("i2c address = 0x%x ,modify i2c address = 0x20\n", client->addr);
+    client->addr = 0x48;
+
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_hx83112b), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    /* allocate himax report data */
+    hx_touch_data = kzalloc(sizeof(struct himax_report_data),GFP_KERNEL);
+    if(hx_touch_data == NULL)
+    {
+        goto err_register_driver;
+    }
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto err_register_driver;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->client = client;
+    chip_info->p_spuri_fp_touch = &(ts->spuri_fp_touch);
+    chip_info->syna_ops = &hx83112b_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    disable_irq_nosync(client->irq);
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &hx83112b_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    if (himax_ic_package_check(client) == false)
+    {
+        TPD_INFO("Himax chip doesn NOT EXIST");
+        goto err_register_driver;
+    }
+
+    himax_read_FW_ver(client);
+    himax_calculateChecksum(client, false);
+
+    himax_power_on_init(client);
+
+    //touch data init
+    ret = himax_report_data_init(ts->max_num,  ts->hw_res.TX_NUM, ts->hw_res.RX_NUM);
+    if (ret ) {
+        goto err_register_driver;
+    }
+
+    ts->tp_resume_order = LCD_TP_RESUME;
+    ts->skip_suspend_operate = true;
+    ts->skip_reset_in_resume = true;
+
+    //step7:create hx83112b related proc files
+    himax_create_proc(ts, chip_info->syna_ops);
+    enable_irq(client->irq);
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    disable_irq_nosync(client->irq);
+
+    common_touch_data_free(ts);
+    ts = NULL;
+
+    if (hx_touch_data) {
+        kfree(hx_touch_data);
+    }
+
+    if (chip_info) {
+        kfree(chip_info);
+    }
+
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int hx83112b_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int hx83112b_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called gesture_enable =%d\n", __func__, ts->gesture_enable);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int hx83112b_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+   /* if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            TPD_INFO("himax_set_SMWP_enable 1\n");
+            himax_set_SMWP_enable(ts->client, 1, ts->is_suspended);
+        }
+    }*/
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE,},
+    { .compatible = "hx83112b-s4322",},
+    { }
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = hx83112b_i2c_suspend,
+    .resume = hx83112b_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = hx83112b_tp_probe,
+    .remove     = hx83112b_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.h b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.h
new file mode 100644
index 0000000000000000000000000000000000000000..60a3b738989ecaff753baddfbae0367cf196d170
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Himax/hx83112b/hx83112b.h
@@ -0,0 +1,370 @@
+/***************************************************
+ * File:hx83112b_drivers_s4322.h
+ * Copyright(C) 2008-2012 OPPO Mobile Comm Corp., Ltd
+ * Description:
+ *             hx83112b s4322 driver
+ * Version:1.0:
+ * Date created:2017/04/17
+ * Author: MingQiang.Guo@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+   <author >  <data>  <version>  <desc>
+****************************************************/
+
+#ifndef HX83112B_H
+#define HX83112B_H
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../himax_common.h"
+
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE    0x40
+#define ENABLE_VEE        0x20
+#define ENABLE_CIRCLE     0x08
+#define ENABLE_SWIPE      0x02
+#define ENABLE_DTAP       0x01
+
+#define UNICODE_DETECT    0x0b
+#define VEE_DETECT        0x0a
+#define CIRCLE_DETECT     0x08
+#define SWIPE_DETECT      0x07
+#define DTAP_DETECT       0x03
+
+#define RESET_TO_NORMAL_TIME         80    /*Sleep time after reset*/
+
+#define SPURIOUS_FP_LIMIT            100
+#define SPURIOUS_FP_RX_NUM           8
+#define SPURIOUS_FP_TX_NUM           9
+#define SPURIOUS_FP_BASE_DATA_RETRY  10
+
+#define I2C_ERROR_MAX_TIME           5
+
+#define EXTEND_EE_SHORT_RESET_DUR    60
+#define EXTEND_EE_SHORT_INT_DUR      150
+#define EXTEND_EE_SHORT_TX_ON_COUNT  146
+#define EXTEND_EE_SHORT_RX_ON_COUNT  146
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART1    160
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART2    80         // ( unit = ratio )
+
+/* tddi f54 test reporting - */
+#define ELEC_OPEN_TEST_TX_ON_COUNT      2
+#define ELEC_OPEN_TEST_RX_ON_COUNT      2
+#define ELEC_OPEN_INT_DUR_ONE           15
+#define ELEC_OPEN_INT_DUR_TWO           25
+#define ELEC_OPEN_TEST_LIMIT_ONE        500
+#define ELEC_OPEN_TEST_LIMIT_TWO        50
+
+#define COMMAND_FORCE_UPDATE            4
+
+//#define UPDATE_DISPLAY_CONFIG
+
+//Self Capacitance key test limite
+#define MENU_LOW_LIMITE        1630
+#define MENU_HIGH_LIMITE       3803
+
+#define BACK_LOW_LIMITE        3016
+#define BACK_HIGH_LIMITE       7039
+
+#define TEST_FAIL    1
+#define TEST_PASS    0
+
+#define LIMIT_DOZE_LOW     50
+#define LIMIT_DOZE_HIGH    975
+
+//gmq-himax
+
+/**COMMON USE   ***START***/
+unsigned long FW_VER_MAJ_FLASH_ADDR;
+unsigned long FW_VER_MIN_FLASH_ADDR;
+unsigned long CFG_VER_MAJ_FLASH_ADDR;
+unsigned long CFG_VER_MIN_FLASH_ADDR;
+unsigned long CID_VER_MAJ_FLASH_ADDR;
+unsigned long CID_VER_MIN_FLASH_ADDR;
+unsigned long FW_VER_MAJ_FLASH_LENG;
+unsigned long FW_VER_MIN_FLASH_LENG;
+unsigned long CFG_VER_MAJ_FLASH_LENG;
+unsigned long CFG_VER_MIN_FLASH_LENG;
+unsigned long CID_VER_MAJ_FLASH_LENG;
+unsigned long CID_VER_MIN_FLASH_LENG;
+unsigned long FW_CFG_VER_FLASH_ADDR;
+uint8_t HX_PROC_SEND_FLAG;
+
+struct proc_dir_entry *himax_proc_register_file = NULL;
+uint8_t byte_length = 0;
+uint8_t register_command[4];
+bool cfg_flag = false;
+
+//#ifdef HX_ESD_RECOVERY
+u8 HX_ESD_RESET_ACTIVATE;
+int hx_EB_event_flag;
+int hx_EC_event_flag;
+int hx_ED_event_flag;
+//#endif
+
+bool HX_RESET_STATE = false;
+
+unsigned char IC_TYPE = 11;
+unsigned char IC_CHECKSUM = 0;
+bool DSRAM_Flag = false;
+int g_diag_command = 0;
+uint8_t diag_coor[128];// = {0xFF};
+int32_t diag_self[100] = {0};
+
+int g_max_mutual = 0;
+int g_min_mutual = 255;
+int g_max_self = 0;
+int g_min_self = 255;
+
+int mutual_set_flag = 0;
+uint8_t cmd_set[8];
+
+/**GESTURE_TRACK*/
+static int gest_pt_cnt;
+static int gest_pt_x[10];
+static int gest_pt_y[10];
+
+
+#define HX_KEY_MAX_COUNT             4
+#define DEFAULT_RETRY_CNT            3
+#define HIMAX_REG_RETRY_TIMES        10
+
+#define HX_83112A_SERIES_PWON        16
+#define HX_83112B_SERIES_PWON        17
+
+#define HX_TP_BIN_CHECKSUM_SW        1
+#define HX_TP_BIN_CHECKSUM_HW        2
+#define HX_TP_BIN_CHECKSUM_CRC       3
+
+#define SHIFTBITS 5
+
+#define  FW_SIZE_64k          65536
+#define  FW_SIZE_128k         131072
+
+#define NO_ERR                0
+#define READY_TO_SERVE        1
+#define WORK_OUT              2
+#define I2C_FAIL              -1
+#define MEM_ALLOC_FAIL        -2
+#define CHECKSUM_FAIL         -3
+#define GESTURE_DETECT_FAIL   -4
+#define INPUT_REGISTER_FAIL   -5
+#define FW_NOT_READY          -6
+#define LENGTH_FAIL           -7
+#define OPEN_FILE_FAIL        -8
+#define ERR_WORK_OUT          -10
+
+#define HX_FINGER_ON          1
+#define HX_FINGER_LEAVE       2
+
+#define HX_REPORT_COORD       1
+#define HX_REPORT_SMWP_EVENT  2
+
+//gesture head information
+#define GEST_PTLG_ID_LEN     (4)
+#define GEST_PTLG_HDR_LEN    (4)
+#define GEST_PTLG_HDR_ID1    (0xCC)
+#define GEST_PTLG_HDR_ID2    (0x44)
+#define GEST_PT_MAX_NUM      (128)
+
+#define BS_RAWDATANOISE      10
+#define    BS_OPENSHORT      0
+
+#define    SKIPRXNUM         31
+/**COMMON USE*********END***/
+
+/** FOR DEBUG USE*****START***/
+typedef enum
+{
+    DEBUG_DATA_BASELINE = 0x08,
+    DEBUG_DATA_DELTA    = 0x09,
+    DEBUG_DATA_RAW      = 0x0A,
+}DEBUG_DATA_TYPE;
+
+//self test use
+typedef enum
+{
+    HIMAX_INSPECTION_OPEN,
+    HIMAX_INSPECTION_MICRO_OPEN,
+    HIMAX_INSPECTION_SHORT,
+    HIMAX_INSPECTION_RAWDATA,
+    HIMAX_INSPECTION_NOISE,
+    HIMAX_INSPECTION_SORTING,
+    HIMAX_INSPECTION_BACK_NORMAL,
+    HIMAX_INSPECTION_DOZE_RAWDATA,
+    HIMAX_INSPECTION_DOZE_NOISE,
+    HIMAX_INSPECTION_LPWUG_RAWDATA,
+    HIMAX_INSPECTION_LPWUG_NOISE,
+    HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA,
+    HIMAX_INSPECTION_LPWUG_IDLE_NOISE,
+}THP_INSPECTION_ENUM;
+
+/* Error code of AFE Inspection */
+enum RETURN_RESLUT
+{
+    RET_OK,
+    RET_ERR,
+};
+
+typedef enum
+{
+    SKIPTXNUM_START = 6,
+    SKIPTXNUM_6 = SKIPTXNUM_START,
+    SKIPTXNUM_7,
+    SKIPTXNUM_8,
+    SKIPTXNUM_9,
+    SKIPTXNUM_END = SKIPTXNUM_9,
+}SKIPTXNUMINDEX;
+
+char* g_himax_inspection_mode[]=
+{
+    "HIMAX_INSPECTION_OPEN",
+    "HIMAX_INSPECTION_MICRO_OPEN",
+    "HIMAX_INSPECTION_SHORT",
+    "HIMAX_INSPECTION_RAWDATA",
+    "HIMAX_INSPECTION_NOISE",
+    "HIMAX_INSPECTION_SORTING",
+    "HIMAX_INSPECTION_BACK_NORMAL",
+    "HIMAX_INSPECTION_LPWUG_RAWDATA",
+    "HIMAX_INSPECTION_LPWUG_NOISE",
+    "HIMAX_INSPECTION_DOZE_RAWDATA",
+    "HIMAX_INSPECTION_DOZE_NOISE",
+    "HIMAX_INSPECTION_LPWUG_IDLE_RAWDATA",
+    "HIMAX_INSPECTION_LPWUG_IDLE_NOISE",
+};
+
+/* Error code of AFE Inspection */
+typedef enum
+{
+    THP_AFE_INSPECT_OK      = 0,               /* OK */
+    THP_AFE_INSPECT_ESPI    = (1 << 0),        /* SPI communication error */
+    THP_AFE_INSPECT_ERAW    = (1 << 1),        /* Raw data error */
+    THP_AFE_INSPECT_ENOISE  = (1 << 2),        /* Noise error */
+    THP_AFE_INSPECT_EOPEN   = (1 << 3),        /* Sensor open error */
+    THP_AFE_INSPECT_EMOPEN  = (1 << 4),        /* Sensor micro open error */
+    THP_AFE_INSPECT_ESHORT  = (1 << 5),        /* Sensor short error */
+    THP_AFE_INSPECT_ERC     = (1 << 6),        /* Sensor RC error */
+    THP_AFE_INSPECT_EPIN    = (1 << 7),        /* Errors of TSVD!FTSHD!FTRCST!FTRCRQ and other PINs
+                                                  when Report Rate Switching between 60 Hz and 120 Hz */
+    THP_AFE_INSPECT_EOTHER  = (1 << 8)         /* All other errors */
+} THP_AFE_INSPECT_ERR_ENUM;
+
+
+//Himax MP Limit
+#define RAWMIN         677
+#define RAWMAX         13000
+#define SHORTMIN       0
+#define SHORTMAX       150
+#define OPENMIN        20
+#define OPENMAX        450
+#define M_OPENMIN      0
+#define M_OPENMAX      150
+#define NOISEFRAME     BS_RAWDATANOISE+1
+#define NOISE_P        256 //gmqtest
+#define UNIFMAX        500
+
+//Himax MP Password
+#define PWD_OPEN_START      0x77
+#define PWD_OPEN_END        0x88
+#define PWD_SHORT_START     0x11
+#define PWD_SHORT_END       0x33
+#define PWD_RAWDATA_START   0x00
+#define PWD_RAWDATA_END     0x99
+#define PWD_NOISE_START     0x00
+#define PWD_NOISE_END       0x99
+#define PWD_SORTING_START   0xAA
+#define PWD_SORTING_END     0xCC
+
+//Himax DataType
+#define DATA_OPEN           0x0B
+#define DATA_MICRO_OPEN     0x0C
+#define DATA_SHORT          0x0A
+#define DATA_RAWDATA        0x0A
+#define DATA_NOISE          0x0F
+#define DATA_BACK_NORMAL    0x00
+#define DATA_LPWUG_RAWDATA  0x0C
+#define DATA_LPWUG_NOISE    0x0F
+#define DATA_DOZE_RAWDATA   0x0A
+#define DATA_DOZE_NOISE     0x0F
+#define DATA_LPWUG_IDLE_RAWDATA    0x0A
+#define DATA_LPWUG_IDLE_NOISE      0x0F
+
+//Himax Data Ready Password
+#define Data_PWD0    0xA5
+#define Data_PWD1    0x5A
+
+static uint8_t NOISEMAX;
+
+#define BS_LPWUG           1
+#define BS_DOZE            1
+#define BS_LPWUG_dile      1
+
+#define LPWUG_NOISE_MAX          9999
+#define LPWUG_NOISE_MIN          0
+#define LPWUG_RAWDATA_MAX        9999
+#define LPWUG_RAWDATA_MIN        0
+#define DOZE_NOISE_MAX           9999
+#define DOZE_NOISE_MIN           0
+#define DOZE_RAWDATA_MAX         9999
+#define DOZE_RAWDATA_MIN         0
+#define LPWUG_IDLE_NOISE_MAX     9999
+#define LPWUG_IDLE_NOISE_MIN     0
+#define LPWUG_IDLE_RAWDATA_MAX   9999
+#define LPWUG_IDLE_RAWDATA_MIN   0
+
+#define PWD_LPWUG_START          0x55
+#define PWD_LPWUG_END            0x66
+#define PWD_DOZE_START           0x22
+#define PWD_DOZE_END             0x44
+#define PWD_LPWUG_IDLE_START     0x50
+#define PWD_LPWUG_IDLE_END       0x60
+
+#define SKIP_NOTCH_START         5
+#define SKIP_NOTCH_END           10
+#define SKIP_DUMMY_START         23    //TX+SKIP_NOTCH_START
+#define SKIP_DUMMY_END           28 // TX+SKIP_NOTCH_END
+
+/** FOR DEBUG USE ****END****/
+
+struct himax_report_data
+{
+    int touch_all_size;
+    int raw_cnt_max;
+    int raw_cnt_rmd;
+    int touch_info_size;
+    uint8_t finger_num;
+    uint8_t finger_on;
+    uint8_t *hx_coord_buf;
+    uint8_t hx_state_info[2];
+
+    int event_size;
+    uint8_t *hx_event_buf;
+
+    int rawdata_size;
+    uint8_t diag_cmd;
+    uint8_t *hx_rawdata_buf;
+    uint32_t *diag_mutual;
+    uint8_t rawdata_frame_size;
+};
+
+/*********PART3:Struct Area**********************/
+
+struct chip_data_hx83112b {
+    uint32_t *p_tp_fw;
+    tp_dev tp_type;
+    struct i2c_client *client;
+    struct himax_proc_operations *syna_ops; /*hx83112b func provide to hx83112b common driver*/
+
+    struct hw_resource *hw_res;
+    int16_t *spuri_fp_data;
+    struct spurious_fp_touch *p_spuri_fp_touch;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..a1d25a7738ee908bc0f2bc4a3826d67ea8ae4d77
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Kconfig
@@ -0,0 +1,80 @@
+config TOUCHPANEL_MTK_PLATFORM
+	bool "OPPO platform tp module used"
+	help
+	  Say Y here if you have mtk-platform.
+
+config TOUCHPANEL_ONEPLUS
+	bool "ONEPLUS tp module"
+	help
+	  Say Y here if you have touchscreen module.
+
+config TOUCHPANEL_SYNAPTICS
+#	default y
+	bool "TP Synaptics_IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using Synaptics_IC
+
+config TOUCHPANEL_FOCAL
+#	default y
+	bool "TP Synaptics_IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using FOCALTECK_IC
+
+config TOUCHPANEL_GOODIX
+#	default y
+	bool "TP Synaptics_IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using GOODIX_IC
+
+config TOUCHPANEL_NOVA
+#	default y
+	bool "TP Nova_IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using NOVATECK_IC
+config TOUCHPANEL_HIMAX
+#	default y
+	bool "TP HIMAX_IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using HIMAX_IC
+
+config TOUCHPANEL_SAMSUNG
+#	default y
+	bool "TP samsung IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using samsung IC
+
+config TOUCHPANEL_ST
+#	default y
+	bool "TP st IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using st IC
+
+source "drivers/input/touchscreen/oneplus_touchscreen/util_interface/Kconfig"
+
+if TOUCHPANEL_SYNAPTICS
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Kconfig"
+endif
+
+if TOUCHPANEL_GOODIX
+source "drivers/input/touchscreen/oneplus_touchscreen/Goodix/Kconfig"
+endif
+
+if TOUCHPANEL_FOCAL
+source "drivers/input/touchscreen/oneplus_touchscreen/Focal/Kconfig"
+endif
+
+if TOUCHPANEL_NOVA
+source "drivers/input/touchscreen/oneplus_touchscreen/Novatek/Kconfig"
+endif
+
+if TOUCHPANEL_HIMAX
+source "drivers/input/touchscreen/oneplus_touchscreen/Himax/Kconfig"
+endif
+
+if TOUCHPANEL_SAMSUNG
+source "drivers/input/touchscreen/oneplus_touchscreen/Samsung/Kconfig"
+endif
+
+if TOUCHPANEL_ST
+source "drivers/input/touchscreen/oneplus_touchscreen/St/Kconfig"
+endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..19fe202a36cd2daf40275ba77bb9c7dfccfe8c62
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Makefile
@@ -0,0 +1,15 @@
+#
+# Makefile for the touchscreen drivers.
+#
+subdir-ccflags-$(CONFIG_TOUCHPANEL_MTK_PLATFORM) += -I$(srctree)/drivers/misc/mediatek/include/
+
+obj-$(CONFIG_TOUCHPANEL_ONEPLUS) += util_interface/
+obj-$(CONFIG_TOUCHPANEL_ONEPLUS) += touchpanel_common_driver.o
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS) += Synaptics/
+obj-$(CONFIG_TOUCHPANEL_FOCAL) += Focal/
+obj-$(CONFIG_TOUCHPANEL_GOODIX) += Goodix/
+obj-$(CONFIG_TOUCHPANEL_NOVA) += Novatek/
+obj-$(CONFIG_TOUCHPANEL_HIMAX) += Himax/
+obj-$(CONFIG_TOUCHPANEL_SAMSUNG) += Samsung/
+obj-$(CONFIG_TOUCHPANEL_ST) += St/
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..5ffffa4372fa58b6eb71bd9da21194124f7e605c
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Kconfig
@@ -0,0 +1,4 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Kconfig"
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..98b0bd03ec8e0522287b932ffd3b67c4d23248de
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/Makefile
@@ -0,0 +1,11 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_NOVA) += novatek_common.o
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36672) += NT36672/
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36525) += NT36525/
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36672_NOFLASH) += NT36672_noflash/
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..9d3a16fdc49f269128a6222108719064def82392
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for nova nt36525 ic driver
+
+config TOUCHPANEL_NOVA_NT36525
+#	default y
+	bool "TP nova nt36525 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing nova nt36525
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..06263678d443b21faf2db32774d1df0aeeab1b47
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36525) += nvt_drivers_nt36525.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.c b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.c
new file mode 100644
index 0000000000000000000000000000000000000000..ac87abd0f8de15eee2855aef864c99772fa2a158
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.c
@@ -0,0 +1,3588 @@
+/*****************************************************************************************
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * File       : novatek_drivers_nt36525.c
+ * Description: Source file for novatek nt36525 driver
+ * Version   : 1.0
+ * Date        : 2017-11-11
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "nvt_drivers_nt36525.h"
+
+/****************** Start of Log Tag Declear and level define*******************************/
+#define TPD_DEVICE "nova-nt36525"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+/******************** End of Log Tag Declear and level define*********************************/
+
+static void nvt_change_mode(struct chip_data_nt36525 *chip_info, uint8_t mode);
+static int32_t nvt_read_fw_noise(struct chip_data_nt36525 *chip_info, int32_t config_Diff_Test_Frame, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len);
+static int8_t nvt_switch_FreqHopEnDis(struct chip_data_nt36525 *chip_info, uint8_t FreqHopEnDis);
+void nvt_read_mdata(struct chip_data_nt36525 *chip_info, uint32_t xdata_addr, int32_t *xdata, int32_t xdata_len);
+static uint8_t nvt_get_fw_pipe(struct chip_data_nt36525 *chip_info);
+static int32_t nvt_check_fw_status(struct chip_data_nt36525 *chip_info);
+static void nvt_change_mode(struct chip_data_nt36525 *chip_info, uint8_t mode);
+static int32_t nvt_clear_fw_status(struct chip_data_nt36525 *chip_info);
+static void store_to_file(int fd, char* format, ...);
+static int nvt_get_chip_info(void *chip_data);
+static bool nvt_fw_recovery(uint8_t *point_data);
+static void nvt_esd_check_enable(struct chip_data_nt36525 *chip_info, bool enable);
+
+/***************************** start of id map table******************************************/
+static const struct nvt_mem_map NT36772_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11E00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10E70,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12E70,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x10830,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x12830,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10E60,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12E60,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10E68,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12E68,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x143D0,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x11DF0,
+};
+
+static const struct nvt_mem_map NT36525_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11A00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10B08,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12B08,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x1064C,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x1264C,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10634,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12634,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10AFC,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12AFC,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x12B28,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x12BB0,
+};
+
+static const struct nvt_mem_map NT36870_memory_map = {
+    .EVENT_BUF_ADDR           = 0x25000,
+    .RAW_PIPE0_ADDR           = 0x20000,
+    .RAW_PIPE0_Q_ADDR         = 0x204C8,
+    .RAW_PIPE1_ADDR           = 0x23000,
+    .RAW_PIPE1_Q_ADDR         = 0x234C8,
+    .BASELINE_ADDR            = 0x21350,
+    .BASELINE_Q_ADDR          = 0x21818,
+    .BASELINE_BTN_ADDR        = 0x24350,
+    .BASELINE_BTN_Q_ADDR      = 0x24358,
+    .DIFF_PIPE0_ADDR          = 0x209B0,
+    .DIFF_PIPE0_Q_ADDR        = 0x20E78,
+    .DIFF_PIPE1_ADDR          = 0x239B0,
+    .DIFF_PIPE1_Q_ADDR        = 0x23E78,
+    .RAW_BTN_PIPE0_ADDR       = 0x20990,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0x20998,
+    .RAW_BTN_PIPE1_ADDR       = 0x23990,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0x23998,
+    .DIFF_BTN_PIPE0_ADDR      = 0x21340,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0x21348,
+    .DIFF_BTN_PIPE1_ADDR      = 0x24340,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0x24348,
+    .READ_FLASH_CHECKSUM_ADDR = 0x24000,
+    .RW_FLASH_DATA_ADDR       = 0x24002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x29910,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x29CC8,
+};
+
+static const struct nvt_mem_map NT36676F_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11A00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10B08,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12B08,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x1064C,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x1264C,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10634,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12634,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10AFC,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12AFC,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x12B28,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x12BB0,
+};
+
+static const struct nvt_trim_id_table trim_id_table[] = {
+    {.id = {0x55, 0x00, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0x55, 0x72, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xAA, 0x00, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xAA, 0x72, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x72, 0x67, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x67, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x72, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x25, 0x65, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36525_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x68, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36870_memory_map, .carrier_system = 1},
+    {.id = {0xFF, 0xFF, 0xFF, 0x76, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36676F_memory_map, .carrier_system = 0}
+};
+
+int32_t nvt_i2c_write(struct i2c_client *client, uint16_t address, uint8_t *buf, uint16_t len)
+{
+    int ret = -1;
+    uint16_t addr_cpy = client->addr;
+
+    client->addr = address;
+    ret = touch_i2c_write(client, buf, len);
+    if (ret < 0) {
+        TPD_INFO("%s %d failed\n", __func__, address);
+    }
+    client->addr = addr_cpy;
+
+    return ret;
+}
+
+int32_t nvt_i2c_read(struct i2c_client *client, uint16_t address, uint8_t *buf, uint16_t len)
+{
+    int ret = -1;
+    uint16_t addr_cpy = client->addr;
+
+    client->addr = address;
+    ret = touch_i2c_read(client, &buf[0], 1, &buf[1], len - 1);
+    if (ret < 0) {
+        TPD_INFO("%s %d failed\n", __func__, address);
+    }
+    client->addr = addr_cpy;
+
+    return ret;
+}
+/****************************** End of id map table*******************************************/
+
+/****** Start of other functions that work for oppo_touchpanel_operations callbacks***********/
+void nvt_bootloader_reset(struct chip_data_nt36525 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---write i2c cmds to reset---
+    buf[0] = 0x00;
+    buf[1] = 0x69;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("write bootloader reset cmds failed!\n");
+    }
+
+    // need 35ms delay after bootloader reset
+    msleep(35);
+}
+
+void nvt_sw_reset_idle(struct chip_data_nt36525 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[4]={0};
+
+    //---write i2c cmds to reset idle---
+    buf[0]=0x00;
+    buf[1]=0xA5;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("write reset idle cmds failed!\n");
+    }
+
+    msleep(15);
+}
+
+static int8_t nvt_check_chip_ver_trim(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t retry = 0;
+    int32_t list = 0;
+    int32_t i = 0;
+    int32_t found_nvt_chip = 0;
+    int32_t ret = -1;
+
+    //---Check for 5 times---
+    for (retry = 5; retry > 0; retry--) {
+        nvt_bootloader_reset(chip_info);
+        nvt_sw_reset_idle(chip_info);
+
+        buf[0] = 0x00;
+        buf[1] = 0x35;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        msleep(10);
+
+        buf[0] = 0xFF;
+        buf[1] = 0x01;
+        buf[2] = 0xF6;
+        ret |= nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+
+        buf[0] = 0x4E;
+        buf[1] = 0x00;
+        buf[2] = 0x00;
+        buf[3] = 0x00;
+        buf[4] = 0x00;
+        buf[5] = 0x00;
+        buf[6] = 0x00;
+        ret |= nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 7);
+        if (ret < 0) {
+            TPD_INFO("write or read failed in %s \n", __func__);
+        }
+        TPD_INFO("buf[1]=0x%02X, buf[2]=0x%02X, buf[3]=0x%02X, buf[4]=0x%02X, buf[5]=0x%02X, buf[6]=0x%02X\n",
+            buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
+
+        // compare read chip id on supported list
+        for (list = 0; list < (sizeof(trim_id_table) / sizeof(struct nvt_trim_id_table)); list++) {
+            found_nvt_chip = 0;
+
+            // compare each byte
+            for (i = 0; i < NVT_ID_BYTE_MAX; i++) {
+                if (trim_id_table[list].mask[i]) {
+                    if (buf[i + 1] != trim_id_table[list].id[i])
+                        break;
+                }
+            }
+
+            if (i == NVT_ID_BYTE_MAX) {
+                found_nvt_chip = 1;
+            }
+
+            if (found_nvt_chip) {
+                TPD_INFO("This is NVT touch IC\n");
+                chip_info->mmap = trim_id_table[list].mmap;
+                chip_info->carrier_system = trim_id_table[list].carrier_system;
+                ret = 0;
+                goto out;
+            } else {
+                chip_info->mmap = NULL;
+                ret = -1;
+            }
+        }
+
+        msleep(10);
+    }
+
+    if (chip_info->mmap == NULL) {  //set default value
+        chip_info->mmap = &NT36525_memory_map;
+        chip_info->carrier_system = 0;
+        ret = 0;
+    }
+out:
+    return ret;
+}
+
+int32_t nvt_check_fw_reset_state(struct chip_data_nt36525 *chip_info, RST_COMPLETE_STATE check_reset_state)
+{
+    uint8_t buf[8] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    while (1) {
+        msleep(10);
+
+        //---read reset state---
+        buf[0] = EVENT_MAP_RESET_COMPLETE;
+        buf[1] = 0x00;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 6);
+
+        if ((buf[1] >= check_reset_state) && (buf[1] <= RESET_STATE_MAX)) {
+            ret = 0;
+            break;
+        }
+
+        retry++;
+        if(unlikely(retry > 100)) {
+            TPD_INFO("error, retry=%d, buf[1]=0x%02X, 0x%02X, 0x%02X, 0x%02X, 0x%02X\n", retry, buf[1], buf[2], buf[3], buf[4], buf[5]);
+            ret = -1;
+            break;
+        }
+    }
+
+    return ret;
+}
+
+int32_t nvt_read_pid(struct chip_data_nt36525 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[3] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read project id---
+    buf[0] = EVENT_MAP_PROJECTID;
+    buf[1] = 0x00;
+    buf[2] = 0x00;
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("read pid failed\n");
+    } else {
+        chip_info->nvt_pid = (buf[2] << 8) + buf[1];
+    }
+
+    TPD_INFO("PID=%04X\n", chip_info->nvt_pid);
+
+    return ret;
+}
+
+int32_t nvt_get_fw_info(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[64] = {0};
+    uint32_t retry_count = 0;
+    int32_t ret = 0;
+
+info_retry:
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read fw info---
+    buf[0] = EVENT_MAP_FWINFO;
+    nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 17);
+    chip_info->fw_ver = buf[1];
+    // x_num = buf[3];
+    // y_num = buf[4];
+    // abs_x_max = (uint16_t)((buf[5] << 8) | buf[6]);
+    // abs_y_max = (uint16_t)((buf[7] << 8) | buf[8]);
+    // max_button_num = buf[11];
+
+    //---clear x_num, y_num if fw info is broken---
+    if ((buf[1] + buf[2]) != 0xFF) {
+        TPD_INFO("FW info is broken! fw_ver=0x%02X, ~fw_ver=0x%02X\n", buf[1], buf[2]);
+        chip_info->fw_ver = 0;
+
+        if(retry_count < 3) {
+            retry_count++;
+            TPD_INFO("%s retry_count=%d\n", __func__, retry_count);
+            goto info_retry;
+        } else {
+            TPD_INFO("Set default fw_ver=0, x_num=18, y_num=32, abs_x_max=1080, abs_y_max=1920, max_button_num=0!\n");
+            ret = -1;
+        }
+    } else {
+        ret = 0;
+    }
+
+    //---Get nvttek PID---
+    nvt_read_pid(chip_info);
+
+    return ret;
+}
+
+static int nvt_enter_sleep(struct chip_data_nt36525 *chip_info, bool config)
+{
+    int ret = -1;
+    uint8_t buf[3];
+
+    if (config) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0x11;
+        ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("%s: enter sleep mode failed!\n", __func__);
+            return -1;
+        } else {
+            chip_info->is_sleep_writed = true;
+            TPD_INFO("%s: enter sleep mode sucess!\n", __func__);
+        }
+    }
+
+    return ret;
+}
+
+static int nvt_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+
+    nvt_bootloader_reset(chip_info);
+    ret = nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+    if (ret < 0) {
+        TPD_INFO("%s: check reset state(INIT) failed\n", __func__);
+    } else {
+        chip_info->is_sleep_writed = false;
+    }
+
+    return ret;
+}
+
+static int8_t nvt_cmd_store(struct chip_data_nt36525 *chip_info, uint8_t u8Cmd)
+{
+    int i, retry = 5;
+    uint8_t buf[3] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    for (i = 0; i < retry; i++) {
+        //---set cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = u8Cmd;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        msleep(40);
+
+        //---read cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(i == retry)) {
+        TPD_INFO("send Cmd 0x%02X failed, buf[1]=0x%02X\n", u8Cmd, buf[1]);
+        return -1;
+    } else {
+        TPD_INFO("send Cmd 0x%02X success, tried %d times\n", u8Cmd, i);
+    }
+
+    return 0;
+}
+
+static int nvt_enable_black_gesture(struct chip_data_nt36525 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (enable) {
+        if (chip_info->is_sleep_writed) {
+            nvt_reset(chip_info);
+        }
+
+        ret = nvt_cmd_store(chip_info, 0x13);
+    } else {
+        ret = 0;
+    }
+
+    return ret;
+}
+
+static int nvt_enable_edge_limit(struct chip_data_nt36525 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_ON);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_OFF);
+    }
+
+    return ret;
+}
+
+static int nvt_enable_charge_mode(struct chip_data_nt36525 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_IN);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_OUT);
+    }
+
+    return ret;
+}
+
+int32_t Resume_PD(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // Resume Command
+    buf[0] = 0x00;
+    buf[1] = 0xAB;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("Write Resume Command Enable error!\n");
+        return ret;
+    }
+
+    // Check 0xAA (Resume Command)
+    retry = 0;
+    while(1) {
+        msleep(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Resume Command) error!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Resume Command) error!! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+    msleep(10);
+
+    TPD_INFO("Resume PD OK\n");
+    return 0;
+}
+
+int32_t Check_CheckSum(struct chip_data_nt36525 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->READ_FLASH_CHECKSUM_ADDR;
+    int32_t ret = 0;
+    int32_t i = 0;
+    int32_t k = 0;
+    uint16_t WR_Filechksum[BLOCK_64KB_NUM] = {0};
+    uint16_t RD_Filechksum[BLOCK_64KB_NUM] = {0};
+    size_t fw_bin_size = 0;
+    size_t len_in_blk = 0;
+    int32_t retry = 0;
+
+    if (Resume_PD(chip_info)) {
+        TPD_INFO("Resume PD error!!\n");
+        return -1;
+    }
+
+    fw_bin_size = fw->size;
+
+    for (i = 0; i < BLOCK_64KB_NUM; i++) {
+        if (fw_bin_size > (i * SIZE_64KB)) {
+            // Calculate WR_Filechksum of each 64KB block
+            len_in_blk = min(fw_bin_size - i * SIZE_64KB, (size_t)SIZE_64KB);
+            WR_Filechksum[i] = i + 0x00 + 0x00 + (((len_in_blk - 1) >> 8) & 0xFF) + ((len_in_blk - 1) & 0xFF);
+            for (k = 0; k < len_in_blk; k++) {
+                WR_Filechksum[i] += fw->data[k + i * SIZE_64KB];
+            }
+            WR_Filechksum[i] = 65535 - WR_Filechksum[i] + 1;
+
+            // Fast Read Command
+            buf[0] = 0x00;
+            buf[1] = 0x07;
+            buf[2] = i;
+            buf[3] = 0x00;
+            buf[4] = 0x00;
+            buf[5] = ((len_in_blk - 1) >> 8) & 0xFF;
+            buf[6] = (len_in_blk - 1) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 7);
+            if (ret < 0) {
+                TPD_INFO("write Fast Read Command error!\n");
+                return ret;
+            }
+            // Check 0xAA (Fast Read Command)
+            retry = 0;
+            while (1) {
+                msleep(80);
+                buf[0] = 0x00;
+                buf[1] = 0x00;
+                ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+                if (ret < 0) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) error!\n");
+                    return ret;
+                }
+                if (buf[1] == 0xAA) {
+                    break;
+                }
+                retry++;
+                if (unlikely(retry > 5)) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                    return -1;
+                }
+            }
+            // Read Checksum (write addr high byte & middle byte)
+            buf[0] = 0xFF;
+            buf[1] = XDATA_Addr >> 16;
+            buf[2] = (XDATA_Addr >> 8) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum (write addr high byte & middle byte) error!\n");
+                return ret;
+            }
+            // Read Checksum
+            buf[0] = (XDATA_Addr) & 0xFF;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum error!!(%d)\n", ret);
+                return ret;
+            }
+
+            RD_Filechksum[i] = (uint16_t)((buf[2] << 8) | buf[1]);
+            if (WR_Filechksum[i] != RD_Filechksum[i]) {
+                TPD_INFO("RD_Filechksum[%d]=0x%04X, WR_Filechksum[%d]=0x%04X\n", i, RD_Filechksum[i], i, WR_Filechksum[i]);
+                TPD_INFO("firmware checksum not match!!\n");
+                return 0;
+            }
+        }
+    }
+
+    TPD_INFO("firmware checksum match!\n");
+    return 1;
+}
+
+int32_t Check_FW_Ver(struct chip_data_nt36525 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[16] = {0};
+    int32_t ret = 0;
+
+    //write i2c index to EVENT BUF ADDR
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c write error!\n", __func__);
+        return ret;
+    }
+
+    //read Firmware Version
+    buf[0] = EVENT_MAP_FWINFO;
+    buf[1] = 0x00;
+    buf[2] = 0x00;
+    ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c read error!\n", __func__);
+        return ret;
+    }
+
+    TPD_INFO("IC FW Ver = 0x%02X, FW Ver Bar = 0x%02X\n", buf[1], buf[2]);
+    TPD_INFO("Bin FW Ver = 0x%02X, FW ver Bar = 0x%02X\n",
+            fw->data[FW_BIN_VER_OFFSET], fw->data[FW_BIN_VER_BAR_OFFSET]);
+
+    // check IC FW_VER + FW_VER_BAR equals 0xFF or not, need to update if not
+    if ((buf[1] + buf[2]) != 0xFF) {
+        TPD_INFO("IC FW_VER + FW_VER_BAR not equals to 0xFF!\n");
+        return 0;
+    }
+
+    // compare IC and binary FW version
+    if (buf[1] == fw->data[FW_BIN_VER_OFFSET])
+        return 1;
+    else
+        return 0;
+}
+
+int32_t Init_BootLoader(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[64] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // SW Reset & Idle
+    nvt_sw_reset_idle(chip_info);
+
+    // Initiate Flash Block
+    buf[0] = 0x00;
+    buf[1] = 0x00;
+    buf[2] = I2C_FW_Address;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("Inittial Flash Block error!!\n");
+        return ret;
+    }
+
+    // Check 0xAA (Initiate Flash Block)
+    retry = 0;
+    while(1) {
+        msleep(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Inittial Flash Block) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Inittial Flash Block) error!! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    TPD_INFO("Init OK \n");
+    msleep(20);
+
+    return 0;
+}
+
+int32_t Erase_Flash(struct chip_data_nt36525 *chip_info, uint32_t fw_len)
+{
+    uint8_t buf[64] = {0};
+    int32_t ret = 0;
+    int32_t count = 0;
+    int32_t i = 0;
+    int32_t Flash_Address = 0;
+    int32_t retry = 0;
+
+    // Write Enable
+    buf[0] = 0x00;
+    buf[1] = 0x06;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("Write Enable (for Write Status Register) error!\n");
+        return ret;
+    }
+    // Check 0xAA (Write Enable)
+    retry = 0;
+    while (1) {
+        mdelay(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Write Enable for Write Status Register) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Write Enable for Write Status Register) error! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    // Write Status Register
+    buf[0] = 0x00;
+    buf[1] = 0x01;
+    buf[2] = 0x00;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("Write Status Register error!\n");
+        return ret;
+    }
+    // Check 0xAA (Write Status Register)
+    retry = 0;
+    while (1) {
+        mdelay(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Write Status Register) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Write Status Register) error! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    // Read Status
+    retry = 0;
+    while (1) {
+        mdelay(5);
+        buf[0] = 0x00;
+        buf[1] = 0x05;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Read Status (for Write Status Register) error!!(%d)\n", ret);
+            return ret;
+        }
+
+        // Check 0xAA (Read Status)
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        buf[2] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Read Status for Write Status Register) error!\n");
+            return ret;
+        }
+        if ((buf[1] == 0xAA) && (buf[2] == 0x00)) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 100)) {
+            TPD_INFO("Check 0xAA (Read Status for Write Status Register) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+            return -1;
+        }
+    }
+
+    if (fw_len % FLASH_SECTOR_SIZE)
+        count = fw_len / FLASH_SECTOR_SIZE + 1;
+    else
+        count = fw_len / FLASH_SECTOR_SIZE;
+
+    for(i = 0; i < count; i++) {
+        // Write Enable
+        buf[0] = 0x00;
+        buf[1] = 0x06;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Write Enable error!!(%d)\n", i);
+            return ret;
+        }
+        // Check 0xAA (Write Enable)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Write Enable) error!!(%d)\n", i);
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Write Enable) error!! status=0x%02X\n", buf[1]);
+                return -1;
+            }
+        }
+
+        Flash_Address = i * FLASH_SECTOR_SIZE;
+
+        // Sector Erase
+        buf[0] = 0x00;
+        buf[1] = 0x20;    // Command : Sector Erase
+        buf[2] = ((Flash_Address >> 16) & 0xFF);
+        buf[3] = ((Flash_Address >> 8) & 0xFF);
+        buf[4] = (Flash_Address & 0xFF);
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 5);
+        if (ret < 0) {
+            TPD_INFO("Sector Erase error!!(%d)\n", i);
+            return ret;
+        }
+        // Check 0xAA (Sector Erase)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Sector Erase) error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Sector Erase) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                return -1;
+            }
+        }
+
+        // Read Status
+        retry = 0;
+        while (1) {
+            mdelay(5);
+            buf[0] = 0x00;
+            buf[1] = 0x05;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Read Status error!!(%d)\n", i);
+                return ret;
+            }
+
+            // Check 0xAA (Read Status)
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Read Status) error!!(%d)\n", i);
+                return ret;
+            }
+            if ((buf[1] == 0xAA) && (buf[2] == 0x00)) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 100)) {
+                TPD_INFO("Check 0xAA (Read Status) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+                return -1;
+            }
+        }
+    }
+
+    TPD_INFO("Erase OK \n");
+    return 0;
+}
+
+int32_t Write_Flash(struct chip_data_nt36525 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->RW_FLASH_DATA_ADDR;
+    uint32_t Flash_Address = 0;
+    int32_t i = 0, j = 0, k = 0;
+    uint8_t tmpvalue = 0;
+    int32_t count = 0;
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // change I2C buffer index
+    buf[0] = 0xFF;
+    buf[1] = XDATA_Addr >> 16;
+    buf[2] = (XDATA_Addr >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("change I2C buffer index error!!\n");
+        return ret;
+    }
+
+    if (fw->size % 256)
+        count = fw->size / 256 + 1;
+    else
+        count = fw->size / 256;
+
+    for (i = 0; i < count; i++) {
+        Flash_Address = i * 256;
+
+        // Write Enable
+        buf[0] = 0x00;
+        buf[1] = 0x06;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Write Enable error!\n");
+            return ret;
+        }
+        // Check 0xAA (Write Enable)
+        retry = 0;
+        while (1) {
+            udelay(100);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Write Enable) error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Write Enable) error! status=0x%02X\n", buf[1]);
+                return -1;
+            }
+        }
+
+        // Write Page : 256 bytes
+        for (j = 0; j < min(fw->size - i * 256, (size_t)256); j += 32) {
+            buf[0] = (XDATA_Addr + j) & 0xFF;
+            for (k = 0; k < 32; k++) {
+                buf[1 + k] = fw->data[Flash_Address + j + k];
+            }
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 33);
+            if (ret < 0) {
+                TPD_INFO("Write Page error!, j=%d\n", j);
+                return ret;
+            }
+        }
+        if (fw->size - Flash_Address >= 256)
+            tmpvalue=(Flash_Address >> 16) + ((Flash_Address >> 8) & 0xFF) + (Flash_Address & 0xFF) + 0x00 + (255);
+        else
+            tmpvalue=(Flash_Address >> 16) + ((Flash_Address >> 8) & 0xFF) + (Flash_Address & 0xFF) + 0x00 + (fw->size - Flash_Address - 1);
+
+        for (k = 0;k < min(fw->size - Flash_Address,(size_t)256); k++)
+            tmpvalue += fw->data[Flash_Address + k];
+
+        tmpvalue = 255 - tmpvalue + 1;
+
+        // Page Program
+        buf[0] = 0x00;
+        buf[1] = 0x02;
+        buf[2] = ((Flash_Address >> 16) & 0xFF);
+        buf[3] = ((Flash_Address >> 8) & 0xFF);
+        buf[4] = (Flash_Address & 0xFF);
+        buf[5] = 0x00;
+        buf[6] = min(fw->size - Flash_Address,(size_t)256) - 1;
+        buf[7] = tmpvalue;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 8);
+        if (ret < 0) {
+            TPD_INFO("Page Program error!, i=%d\n", i);
+            return ret;
+        }
+        // Check 0xAA (Page Program)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Page Program error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA || buf[1] == 0xEA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Page Program) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                return -1;
+            }
+        }
+        if (buf[1] == 0xEA) {
+            TPD_INFO("Page Program error! i=%d\n", i);
+            return -3;
+        }
+
+        // Read Status
+        retry = 0;
+        while (1) {
+            mdelay(5);
+            buf[0] = 0x00;
+            buf[1] = 0x05;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Read Status error!\n");
+                return ret;
+            }
+
+            // Check 0xAA (Read Status)
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Read Status) error!\n");
+                return ret;
+            }
+            if (((buf[1] == 0xAA) && (buf[2] == 0x00)) || (buf[1] == 0xEA)) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 100)) {
+                TPD_INFO("Check 0xAA (Read Status) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+                return -1;
+            }
+        }
+        if (buf[1] == 0xEA) {
+            TPD_INFO("Page Program error! i=%d\n", i);
+            return -4;
+        }
+
+        TPD_DEBUG("Programming...%2d%%\n", ((i * 100) / count));
+    }
+
+    TPD_INFO("Programming...%2d%%\n", 100);
+    TPD_INFO("Program OK         \n");
+    return 0;
+}
+
+int32_t Verify_Flash(struct chip_data_nt36525 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->READ_FLASH_CHECKSUM_ADDR;
+    int32_t ret = 0;
+    int32_t i = 0;
+    int32_t k = 0;
+    uint16_t WR_Filechksum[BLOCK_64KB_NUM] = {0};
+    uint16_t RD_Filechksum[BLOCK_64KB_NUM] = {0};
+    size_t fw_bin_size = fw->size;
+    size_t len_in_blk = 0;
+    int32_t retry = 0;
+
+    for (i = 0; i < BLOCK_64KB_NUM; i++) {
+        if (fw_bin_size > (i * SIZE_64KB)) {
+            // Calculate WR_Filechksum of each 64KB block
+            len_in_blk = min(fw_bin_size - i * SIZE_64KB, (size_t)SIZE_64KB);
+            WR_Filechksum[i] = i + 0x00 + 0x00 + (((len_in_blk - 1) >> 8) & 0xFF) + ((len_in_blk - 1) & 0xFF);
+            for (k = 0; k < len_in_blk; k++) {
+                WR_Filechksum[i] += fw->data[k + i * SIZE_64KB];
+            }
+            WR_Filechksum[i] = 65535 - WR_Filechksum[i] + 1;
+
+            // Fast Read Command
+            buf[0] = 0x00;
+            buf[1] = 0x07;
+            buf[2] = i;
+            buf[3] = 0x00;
+            buf[4] = 0x00;
+            buf[5] = ((len_in_blk - 1) >> 8) & 0xFF;
+            buf[6] = (len_in_blk - 1) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 7);
+            if (ret < 0) {
+                TPD_INFO("Fast Read Command error!\n");
+                return ret;
+            }
+            // Check 0xAA (Fast Read Command)
+            retry = 0;
+            while (1) {
+                msleep(80);
+                buf[0] = 0x00;
+                buf[1] = 0x00;
+                ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+                if (ret < 0) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) error!\n");
+                    return ret;
+                }
+                if (buf[1] == 0xAA) {
+                    break;
+                }
+                retry++;
+                if (unlikely(retry > 5)) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                    return -1;
+                }
+            }
+            // Read Checksum (write addr high byte & middle byte)
+            buf[0] = 0xFF;
+            buf[1] = XDATA_Addr >> 16;
+            buf[2] = (XDATA_Addr >> 8) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum (write addr high byte & middle byte) error!\n");
+                return ret;
+            }
+            // Read Checksum
+            buf[0] = (XDATA_Addr) & 0xFF;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum error!\n");
+                return ret;
+            }
+
+            RD_Filechksum[i] = (uint16_t)((buf[2] << 8) | buf[1]);
+            if (WR_Filechksum[i] != RD_Filechksum[i]) {
+                TPD_INFO("Verify Fail%d!\n", i);
+                TPD_INFO("RD_Filechksum[%d]=0x%04X, WR_Filechksum[%d]=0x%04X\n", i, RD_Filechksum[i], i, WR_Filechksum[i]);
+                return -1;
+            }
+        }
+    }
+
+    TPD_INFO("Verify OK \n");
+    return 0;
+}
+/****** End of other functions that work for oppo_touchpanel_operations callbacks*************/
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int nvt_ftm_process(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    TPD_INFO("%s is called!\n", __func__);
+    ret = nvt_get_chip_info(chip_info);
+    if (!ret) {
+        nvt_bootloader_reset(chip_info);
+        nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN);
+        ret = nvt_enter_sleep(chip_info, true);
+    }
+
+    return ret;
+}
+
+static int nvt_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+static int nvt_get_chip_info(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    //---check chip version trim---
+    ret = nvt_check_chip_ver_trim(chip_info);
+    if (ret) {
+        TPD_INFO("chip is not identified\n");
+        ret = -EINVAL;
+    }
+
+    return ret;
+}
+
+static int nvt_power_control(void *chip_data, bool enable)
+{
+    return 0;
+}
+
+static fw_check_state nvt_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint8_t ver_len = 0;
+    int ret = 0;
+    char dev_version[MAX_DEVICE_VERSION_LENGTH] = {0};
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    nvt_bootloader_reset(chip_info);
+    ret = nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+    ret |= nvt_get_fw_info(chip_info);
+    if (ret < 0) {
+        TPD_INFO("%s: get fw info failed\n", __func__);
+        return FW_ABNORMAL;
+    } else {
+        panel_data->TP_FW = chip_info->fw_ver;
+        sprintf(dev_version, "%02x", panel_data->TP_FW);
+        if (panel_data->manufacture_info.version) {
+            ver_len = strlen(panel_data->manufacture_info.version);
+            if (ver_len <= 8) {
+                strlcat(panel_data->manufacture_info.version, dev_version, MAX_DEVICE_VERSION_LENGTH);
+            } else {
+                strlcpy(&panel_data->manufacture_info.version[8], dev_version, MAX_DEVICE_VERSION_LENGTH - 8);
+            }
+        }
+    }
+
+    return FW_NORMAL;
+}
+
+static fw_update_state nvt_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret = -1;
+    fw_update_state update_state = FW_NO_NEED_UPDATE;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return FW_NO_NEED_UPDATE;
+    }
+
+    if (fw->size != FW_BIN_SIZE) {
+        TPD_INFO("bin file size not match\n");
+        return FW_NO_NEED_UPDATE;
+    }
+
+    if (*(fw->data + FW_BIN_VER_OFFSET) + *(fw->data + FW_BIN_VER_BAR_OFFSET) != 0xFF) {
+        TPD_INFO("bin file FW_VER(0x%02x) + FW_VER_BAR(0x%02x) should be 0xFF\n", *(fw->data+FW_BIN_VER_OFFSET), *(fw->data+FW_BIN_VER_BAR_OFFSET));
+        return FW_NO_NEED_UPDATE;
+    }
+
+    nvt_esd_check_enable(chip_info, false);
+
+    nvt_sw_reset_idle(chip_info);
+    if (!force) {
+        TPD_INFO("no force update!\n");
+        ret = Check_CheckSum(chip_info, fw);//-1:error, 0:not match, 1:match
+        if (((ret == 0) && (Check_FW_Ver(chip_info, fw) == 1)) || (ret == 1)) {
+            TPD_INFO("no need update!\n");
+            goto OUT;
+        }
+    }
+
+    // Step 1 : initial bootloader
+    TPD_INFO("Init BootLoader start\n");
+    ret = Init_BootLoader(chip_info);
+    if (ret) {
+        TPD_INFO("Init BootLoader failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 2 : Resume PD
+    TPD_INFO("Resume PD start\n");
+    ret = Resume_PD(chip_info);
+    if (ret) {
+        TPD_INFO("Resume PD failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 3 : Erase
+    TPD_INFO("Erase Flash start\n");
+    ret = Erase_Flash(chip_info, fw->size);
+    if (ret) {
+        TPD_INFO("Erase Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 4 : Program
+    TPD_INFO("Write Flash start\n");
+    ret = Write_Flash(chip_info, fw);
+    if (ret) {
+        TPD_INFO("Write Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 5 : Verify
+    TPD_INFO("Verify Flash start\n");
+    ret = Verify_Flash(chip_info, fw);
+    if (ret) {
+        TPD_INFO("Verify Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    update_state = FW_UPDATE_SUCCESS;
+
+OUT:
+    //Step 6 : Bootloader Reset
+    nvt_bootloader_reset(chip_info);
+    nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+
+    TPD_INFO("update firmware state: %s\n", (update_state == FW_UPDATE_SUCCESS)? "update success!":\
+                                            (update_state == FW_UPDATE_ERROR)? "update failed!": "no need update!");
+    return update_state;
+}
+
+static u8 nvt_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    //struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    if ((gesture_enable == 1) && is_suspended) {
+        return IRQ_GESTURE;
+    } else if (is_suspended) {
+        return IRQ_IGNORE;
+    }
+
+    return IRQ_TOUCH;
+}
+
+static int nvt_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int obj_attention = 0;
+    uint8_t pointid = 0;//range from 1 to 10
+    uint8_t point_state = 0;
+    uint32_t position = 0;
+    uint32_t input_x, input_y, input_w, input_p;
+    int ret = 0;
+    int i = 0;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    uint8_t buf[POINT_DATA_LEN + 1] = {0};
+
+    memset(buf, 0, sizeof(buf));
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, POINT_DATA_LEN + 1);
+    if (ret < 0) {
+        TPD_INFO("read touch data failed\n");
+        return -1;
+    }
+
+    if (nvt_fw_recovery(buf)) {  //receive 0x77
+        nvt_esd_check_enable(chip_info, true);
+        return -1;
+    }
+
+    for(i = 0; i < max_num; i++) {
+        position = 1 + 6 * i;
+        pointid = (uint8_t)(buf[position + 0] >> 3) - 1;
+        if (pointid >= max_num) {
+            continue;
+        }
+
+        point_state = buf[position] & 0x07;
+        if ((point_state == 0x01) || (point_state == 0x02)) {
+            chip_info->irq_timer = jiffies;    //reset esd check trigger base time
+
+            input_x = (uint32_t)(buf[position + 1] << 4) + (uint32_t) (buf[position + 3] >> 4);
+            input_y = (uint32_t)(buf[position + 2] << 4) + (uint32_t) (buf[position + 3] & 0x0F);
+            input_w = (uint32_t)(buf[position + 4]);
+            if (input_w == 0) {
+                input_w = 1;
+            }
+            if (i < 2) {
+                input_p = (uint32_t)(buf[position + 5]) + (uint32_t)(buf[i + 63] << 8);
+                if (input_p > 1000) {
+                    input_p = 1000;
+                }
+            } else {
+                input_p = (uint32_t)(buf[position + 5]);
+            }
+            if (input_p == 0) {
+                input_p = 1;
+            }
+
+            obj_attention = obj_attention | (1 << pointid);
+            points[pointid].x = input_x;
+            points[pointid].y = input_y;
+            points[pointid].z = input_p;
+            points[pointid].width_major = input_w;
+            points[pointid].status = 1;
+        }
+    }
+
+    return obj_attention;
+}
+
+static int nvt_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    uint8_t gesture_id = 0;
+    uint8_t func_type = 0;
+    int ret = -1;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    uint8_t point_data[POINT_DATA_LEN + 1] = {0};
+
+    memset(point_data, 0, sizeof(point_data));
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, point_data, POINT_DATA_LEN + 1);
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture data failed\n", __func__);
+        return -1;
+    }
+
+    if (nvt_fw_recovery(point_data)) {  //receive 0x77
+        TPD_INFO("receive all 0x77, no gesture interrupts\n");
+        return 0;
+    }
+
+    gesture_id = (uint8_t)(point_data[1] >> 3);
+    func_type = (uint8_t)point_data[2];
+    if ((gesture_id == 30) && (func_type == 1)) {
+        gesture_id = (uint8_t)point_data[3];
+    } else if (gesture_id > 30) {
+        TPD_INFO("invalid gesture id= %d, no gesture event\n", gesture_id);
+        return 0;
+    }
+    switch (gesture_id)     //judge gesture type
+    {
+        case RIGHT_SLIDE_DETECT :
+            gesture->gesture_type  = Left2RightSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_SLIDE_DETECT :
+            gesture->gesture_type  = Right2LeftSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_SLIDE_DETECT  :
+            gesture->gesture_type  = Up2DownSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case UP_SLIDE_DETECT :
+            gesture->gesture_type  = Down2UpSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DTAP_DETECT:
+            gesture->gesture_type  = DouTap;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end     = gesture->Point_start;
+            break;
+
+        case UP_VEE_DETECT :
+            gesture->gesture_type  = UpVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_VEE_DETECT :
+            gesture->gesture_type  = DownVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_VEE_DETECT:
+            gesture->gesture_type = LeftVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case RIGHT_VEE_DETECT :
+            gesture->gesture_type  = RightVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case CIRCLE_DETECT  :
+            gesture->gesture_type = Circle;
+            gesture->clockwise = (point_data[43] == 0x20) ? 1 : 0;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;    //ymin
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;  //xmin
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;  //ymax
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_4th.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;  //xmax
+            gesture->Point_4th.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[24] & 0xFF) | (point_data[25] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[26] & 0xFF) | (point_data[27] & 0x0F) << 8;
+            break;
+
+        case DOUSWIP_DETECT  :
+            gesture->gesture_type  = DouSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            break;
+
+        case M_DETECT  :
+            gesture->gesture_type  = Mgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        case W_DETECT :
+            gesture->gesture_type  = Wgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        default:
+            gesture->gesture_type = UnkownGesture;
+            break;
+    }
+
+    TPD_INFO("%s, gesture_id: 0x%x, func_type: 0x%x, gesture_type: %d, clockwise: %d, points: (%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)\n", \
+                __func__, gesture_id, func_type, gesture->gesture_type, gesture->clockwise, \
+                gesture->Point_start.x, gesture->Point_start.y, \
+                gesture->Point_end.x, gesture->Point_end.y, \
+                gesture->Point_1st.x, gesture->Point_1st.y, \
+                gesture->Point_2nd.x, gesture->Point_2nd.y, \
+                gesture->Point_3rd.x, gesture->Point_3rd.y, \
+                gesture->Point_4th.x, gesture->Point_4th.y);
+
+    return 0;
+}
+
+static int nvt_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;
+            break;
+
+        case MODE_SLEEP:
+            ret = nvt_enter_sleep(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enter sleep failed\n", __func__);
+            }
+            break;
+
+        case MODE_GESTURE:
+            ret = nvt_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable gesture failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = nvt_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable edg limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = nvt_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int nvt_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+#endif
+
+static void nvt_black_screen_test(void *chip_data, char *message)
+{
+    int32_t *raw_data = NULL, *raw_data_n = NULL;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    int tx_num = chip_info->hw_res->TX_NUM;
+    int rx_num = chip_info->hw_res->RX_NUM;
+    const struct firmware *fw = NULL;
+    struct nvt_test_header *ph = NULL;
+    int i, j, iArrayIndex, err_cnt = 0;
+    int fd = -1, ret = -1;
+    mm_segment_t old_fs;
+    char buf[128] = {0};
+    uint8_t data_buf[128];
+    int32_t buf_len = 0;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    int32_t *lpwg_rawdata_P = NULL, *lpwg_rawdata_N = NULL;
+    int32_t *lpwg_diff_rawdata_P = NULL, *lpwg_diff_rawdata_N = NULL;
+
+    if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+        TPD_INFO("switch frequency hopping disable failed!\n");
+        sprintf(message, "1 error, switch frequency hopping disable failed!\n");
+        return;
+    }
+
+    if (nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN)) {
+        TPD_INFO("check fw reset state failed!\n");
+        sprintf(message, "1 error, check fw reset state failed!\n");
+        return;
+    }
+
+    msleep(100);
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        TPD_INFO("clear fw status failed!\n");
+        sprintf(message, "1 error, clear fw status failed!\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, TEST_MODE_2);
+
+    if (nvt_check_fw_status(chip_info)) {
+        TPD_INFO("check fw status failed!\n");
+        sprintf(message, "1 error, clear fw status failed!\n");
+        return;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        TPD_INFO("get fw info failed!\n");
+        sprintf(message, "1 error, get fw info failed!\n");
+        return;
+    }
+
+    TPD_INFO("malloc raw_data space\n");
+    buf_len = tx_num * rx_num * sizeof(int32_t);
+    raw_data = kzalloc(buf_len, GFP_KERNEL);
+    raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+    if (!(raw_data && raw_data_n)) {
+        err_cnt++;
+        sprintf(buf, "kzalloc space failed\n");
+        goto KFREE_OUT;
+    }
+
+    ret = request_firmware(&fw, chip_info->test_limit_name, &chip_info->client->dev);
+    if (ret < 0) {
+        err_cnt++;
+        sprintf(buf, "Request firmware failed: %s\n", chip_info->test_limit_name);
+        goto KFREE_OUT;
+    }
+    ph = (struct nvt_test_header *)(fw->data);
+
+    //create a file to store test data in /sdcard/ScreenOffTpTestReport
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    snprintf(data_buf, 128, "/sdcard/TpTestReport/screenOff/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    sys_mkdir("/sdcard/TpTestReport/screenOff", 0666);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        err_cnt++;
+        sprintf(buf, "Open log file '%s' failed.\n", data_buf);
+        goto OUT;
+    }
+
+    lpwg_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_P_offset);
+    lpwg_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_N_offset);
+    lpwg_diff_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Diff_P_offset);
+    lpwg_diff_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Diff_N_offset);
+
+    //---FW Rawdata Test---
+    TPD_INFO("LPWG mode FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE0_ADDR, raw_data, buf_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE1_ADDR, raw_data, buf_len);
+    store_to_file(fd, "LPWG mode FW Rawdata:\n");
+    if ((ph->config_Lmt_LPWG_Rawdata_P != 0) && (ph->config_Lmt_LPWG_Rawdata_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Rawdata_N)) {
+                    TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Rawdata_N, ph->config_Lmt_LPWG_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_rawdata_N[iArrayIndex], lpwg_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+
+    //---Noise Test---
+    TPD_INFO("LPWG mode FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("LPWG mode read Noise data failed!\n");    // 1: ERROR
+        sprintf(buf, "LPWG mode read Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    TPD_INFO("LPWG Noise RawData_Diff_Max:\n");
+    store_to_file(fd, "LPWG Noise RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_LPWG_Diff_P != 0) && (ph->config_Lmt_LPWG_Diff_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Diff_N, ph->config_Lmt_LPWG_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data_n[iArrayIndex], ph->config_Lmt_LPWG_Diff_N, ph->config_Lmt_LPWG_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data_n[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+OUT:
+    if (fd >= 0) {
+        sys_close(fd);
+    }
+    set_fs(old_fs);
+    release_firmware(fw);
+
+KFREE_OUT:
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_n)
+        kfree(raw_data_n);
+    sprintf(message, "%d errors. %s", err_cnt, buf);
+    TPD_INFO("%d errors. %s\n", err_cnt, buf);
+}
+
+static bool nvt_fw_recovery(uint8_t *point_data)
+{
+    uint8_t i = 0;
+    bool detected = true;
+
+    /* check pattern */
+    for (i=1 ; i<7 ; i++) {
+        if (point_data[i] != 0x77) {
+            detected = false;
+            break;
+        }
+    }
+
+    return detected;
+}
+
+static void nvt_esd_check_enable(struct chip_data_nt36525 *chip_info, bool enable)
+{
+    /* enable/disable esd check flag */
+    chip_info->esd_check_enabled = enable;
+    /* update interrupt timer */
+    chip_info->irq_timer = jiffies;
+    /* clear esd_retry counter, if protect function is enabled */
+    chip_info->esd_retry = enable ? 0 : chip_info->esd_retry;
+}
+
+static int nvt_esd_handle(void *chip_data)
+{
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    unsigned int timer = jiffies_to_msecs(jiffies - chip_info->irq_timer);
+
+    //TPD_INFO("esd_check = %d (retry %d)\n", chip_info->esd_check_enabled, chip_info->esd_retry);    //DEBUG
+
+    // if (chip_info->esd_retry >= 5)
+        // nvt_esd_check_enable(chip_info, false);
+
+    if ((timer > NVT_TOUCH_ESD_CHECK_PERIOD) && chip_info->esd_check_enabled) {
+        TPD_INFO("do ESD recovery, timer = %d, retry = %d\n", timer, chip_info->esd_retry);
+        /* do esd recovery, bootloader reset */
+        tp_touch_btnkey_release();
+        nvt_bootloader_reset(chip_info);
+        /* update interrupt timer */
+        chip_info->irq_timer = jiffies;
+        /* update esd_retry counter */
+        chip_info->esd_retry++;
+    }
+
+    return 0;
+}
+
+void nvt_specific_resume_operate(void *chip_data)
+{
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    nvt_esd_check_enable(chip_info, false);
+}
+
+static struct oppo_touchpanel_operations nvt_ops = {
+    .ftm_process                = nvt_ftm_process,
+    .get_vendor                 = nvt_get_vendor,
+    .get_chip_info              = nvt_get_chip_info,
+    .reset                      = nvt_reset,
+    .power_control              = nvt_power_control,
+    .fw_check                   = nvt_fw_check,
+    .fw_update                  = nvt_fw_update,
+    .trigger_reason             = nvt_trigger_reason,
+    .get_touch_points           = nvt_get_touch_points,
+    .get_gesture_info           = nvt_get_gesture_info,
+    .mode_switch                = nvt_mode_switch,
+    .get_usb_state              = nvt_get_usb_state,
+    .black_screen_test          = nvt_black_screen_test,
+    .esd_handle                 = nvt_esd_handle,
+    .specific_resume_operate    = nvt_specific_resume_operate,
+};
+/********* End of implementation of oppo_touchpanel_operations callbacks**********************/
+
+/************** Start of function work for debug_info proc callbacks**************************/
+
+static int32_t nvt_clear_fw_status(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 20;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---clear fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if (buf[1] == 0x00)
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("%s failed, i=%d, buf[1]=0x%02X\n", __func__, i, buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static void nvt_change_mode(struct chip_data_nt36525 *chip_info, uint8_t mode)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---set mode---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = mode;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+    if (mode == NORMAL_MODE) {
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = HANDSHAKING_HOST_READY;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+        msleep(20);
+    }
+}
+
+static int32_t nvt_check_fw_status(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    int ret = -1;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        ret |= nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("%s write or read failed\n", __func__);
+        }
+
+        if ((buf[1] & 0xF0) == 0xA0)
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("%s failed, i=%d, buf[1]=0x%02X\n", __func__, i, buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static uint8_t nvt_get_fw_pipe(struct chip_data_nt36525 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8]= {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read fw status---
+    buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+    buf[1] = 0x00;
+    ret |= nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("%s: read or write failed\n", __func__);
+    }
+
+    return (buf[1] & 0x01);
+}
+
+void nvt_read_mdata(struct chip_data_nt36525 *chip_info, uint32_t xdata_addr, int32_t *xdata, int32_t xdata_len)
+{
+    int32_t i = 0;
+    int32_t j = 0;
+    int32_t k = 0;
+    uint8_t buf[I2C_TANSFER_LENGTH + 1] = {0};
+    uint32_t head_addr = 0;
+    int32_t dummy_len = 0;
+    int32_t data_len = 0;
+    int32_t residual_len = 0;
+    uint8_t *xdata_tmp = NULL;
+
+    //---set xdata sector address & length---
+    head_addr = xdata_addr - (xdata_addr % XDATA_SECTOR_SIZE);
+    dummy_len = xdata_addr - head_addr;
+    data_len = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2;
+    residual_len = (head_addr + dummy_len + data_len) % XDATA_SECTOR_SIZE;
+
+    if (xdata_len/sizeof(int32_t) < data_len/2) {
+        TPD_INFO("xdata read buffer(%d) less than max data size(%d), return\n", xdata_len, data_len);
+        return;
+    }
+
+    //malloc buffer space
+    xdata_tmp = kzalloc(2048 ,GFP_KERNEL);
+    if (xdata_tmp == NULL) {
+        TPD_INFO("%s malloc memory failed\n", __func__);
+        return;
+    }
+    //printk("head_addr=0x%05X, dummy_len=0x%05X, data_len=0x%05X, residual_len=0x%05X\n", head_addr, dummy_len, data_len, residual_len);
+
+    //read xdata : step 1
+    for (i = 0; i < ((dummy_len + data_len) / XDATA_SECTOR_SIZE); i++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((head_addr + XDATA_SECTOR_SIZE * i) >> 16) & 0xFF;
+        buf[2] = ((head_addr + XDATA_SECTOR_SIZE * i) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read xdata by I2C_TANSFER_LENGTH
+        for (j = 0; j < (XDATA_SECTOR_SIZE / I2C_TANSFER_LENGTH); j++) {
+            //---read data---
+            buf[0] = I2C_TANSFER_LENGTH * j;
+            nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, I2C_TANSFER_LENGTH + 1);
+
+            //---copy buf to xdata_tmp---
+            for (k = 0; k < I2C_TANSFER_LENGTH; k++) {
+                xdata_tmp[XDATA_SECTOR_SIZE * i + I2C_TANSFER_LENGTH * j + k] = buf[k + 1];
+                //printk("0x%02X, 0x%04X\n", buf[k+1], (XDATA_SECTOR_SIZE*i + I2C_TANSFER_LENGTH*j + k));
+            }
+        }
+        //printk("addr=0x%05X\n", (head_addr+XDATA_SECTOR_SIZE*i));
+    }
+
+    //read xdata : step2
+    if (residual_len != 0) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((xdata_addr + data_len - residual_len) >> 16) & 0xFF;
+        buf[2] = ((xdata_addr + data_len - residual_len) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read xdata by I2C_TANSFER_LENGTH
+        for (j = 0; j < (residual_len / I2C_TANSFER_LENGTH + 1); j++) {
+            //---read data---
+            buf[0] = I2C_TANSFER_LENGTH * j;
+            nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, I2C_TANSFER_LENGTH + 1);
+
+            //---copy buf to xdata_tmp---
+            for (k = 0; k < I2C_TANSFER_LENGTH; k++) {
+                xdata_tmp[(dummy_len + data_len - residual_len) + I2C_TANSFER_LENGTH * j + k] = buf[k + 1];
+                //printk("0x%02X, 0x%04x\n", buf[k+1], ((dummy_len+data_len-residual_len) + I2C_TANSFER_LENGTH*j + k));
+            }
+        }
+        //printk("addr=0x%05X\n", (xdata_addr+data_len-residual_len));
+    }
+
+    //---remove dummy data and 2bytes-to-1data---
+    for (i = 0; i < (data_len / 2); i++) {
+        xdata[i] = (int16_t)(xdata_tmp[dummy_len + i * 2] + 256 * xdata_tmp[dummy_len + i * 2 + 1]);
+    }
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    kfree(xdata_tmp);
+}
+
+static void nvt_data_read(struct seq_file *s, struct chip_data_nt36525 *chip_info, DEBUG_READ_TYPE read_type)
+{
+    int ret = -1;
+    int i, j;
+    uint8_t pipe;
+    int32_t *xdata = NULL;
+    int32_t buf_len = 0;
+
+    TPD_INFO("nvt clear fw status start\n");
+    ret = nvt_clear_fw_status(chip_info);
+    if (ret < 0) {
+        TPD_INFO("clear_fw_status error, return\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, TEST_MODE_2);
+
+    TPD_INFO("nvt check fw status start\n");
+    ret = nvt_check_fw_status(chip_info);
+    if (ret < 0) {
+        TPD_INFO("check_fw_status error, return\n");
+        return;
+    }
+
+    TPD_INFO("nvt get fw info start");
+    ret = nvt_get_fw_info(chip_info);
+    if (ret < 0) {
+        TPD_INFO("get_fw_info error, return\n");
+        return;
+    }
+
+    buf_len = chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM*sizeof(int32_t);
+    xdata = kzalloc(buf_len, GFP_KERNEL);
+    if (!xdata) {
+        TPD_INFO("%s, malloc memory failed\n", __func__);
+        return;
+    }
+
+    pipe = nvt_get_fw_pipe(chip_info);
+    TPD_INFO("nvt_get_fw_pipe:%d\n", pipe);
+    switch (read_type) {
+        case NVT_RAWDATA:
+            seq_printf(s, "raw_data:\n");
+            if (pipe == 0)
+                nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE0_ADDR, xdata, buf_len);
+            else
+                nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE1_ADDR, xdata, buf_len);
+            break;
+        case NVT_DIFFDATA:
+            seq_printf(s, "diff_data:\n");
+            if (pipe == 0)
+                nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, xdata, buf_len);
+            else
+                nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, xdata, buf_len);
+            break;
+        case NVT_BASEDATA:
+            seq_printf(s, "basline_data:\n");
+            nvt_read_mdata(chip_info, chip_info->mmap->BASELINE_ADDR, xdata, buf_len);
+            break;
+        default:
+            seq_printf(s, "read type not support\n");
+            break;
+    }
+
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    TPD_INFO("change normal mode end\n");
+
+    //print all data
+    for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+        seq_printf(s, "[%2d]", i);
+        for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+            seq_printf(s, "%5d, ", xdata[i * chip_info->hw_res->TX_NUM + j]);
+        }
+        seq_printf(s, "\n");
+    }
+
+    kfree(xdata);
+}
+
+/*************** End of function work for debug_info proc callbacks***************************/
+
+
+/************** Start of implementation of debug_info proc callbacks**************************/
+static void nvt_delta_read(struct seq_file *s, void *chip_data)
+{
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    nvt_esd_check_enable(chip_info, false);
+    nvt_data_read(s, chip_info, NVT_DIFFDATA);
+}
+
+static void nvt_baseline_read(struct seq_file *s, void *chip_data)
+{
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    nvt_esd_check_enable(chip_info, false);
+    nvt_data_read(s, chip_info, NVT_BASEDATA);
+    nvt_data_read(s, chip_info, NVT_RAWDATA);
+}
+
+static void nvt_main_register_read(struct seq_file *s, void *chip_data)
+{
+    uint8_t buf[3];
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    nvt_esd_check_enable(chip_info, false);
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read cmd status---
+    buf[0] = 0x5E;
+    buf[1] = 0xFF;
+    nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+    seq_printf(s, "PWR_FLAG:%d\n", (buf[1]>> PWR_FLAG) & 0x01);
+    seq_printf(s, "EDGE_REGECT:%d\n", (buf[1]>> EDGE_REGECT) & 0x01);
+    seq_printf(s, "[0x5f03-tianma/0x5f02-truly] :0x%04x\n", chip_info->nvt_pid);
+    seq_printf(s, "fw version :0x%02x\n", chip_info->fw_ver);
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = nvt_limit_read,
+    .delta_read    = nvt_delta_read,
+    .baseline_read = nvt_baseline_read,
+    .main_register_read = nvt_main_register_read,
+};
+/***************** End of implementation of debug_info proc callbacks*************************/
+
+/************** Start of implementation of baseline_test proc callbacks***********************/
+static int8_t nvt_switch_FreqHopEnDis(struct chip_data_nt36525 *chip_info, uint8_t FreqHopEnDis)
+{
+    uint8_t buf[8] = {0};
+    uint8_t retry = 0;
+    int8_t ret = 0;
+
+    for (retry = 0; retry < 20; retry++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---switch FreqHopEnDis---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = FreqHopEnDis;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        msleep(35);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(retry == 20)) {
+        TPD_INFO("switch FreqHopEnDis 0x%02X failed, buf[1]=0x%02X\n", FreqHopEnDis, buf[1]);
+        ret = -1;
+    }
+
+    return ret;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static void nvt_enable_noise_collect(struct chip_data_nt36525 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x47;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int32_t nvt_polling_hand_shake_status(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if ((buf[1] == 0xA0) || (buf[1] == 0xA1))
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("polling hand shake status failed, buf[1]=0x%02X\n", buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static int32_t nvt_read_fw_noise(struct chip_data_nt36525 *chip_info, int32_t config_Diff_Test_Frame, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint32_t x = 0;
+    uint32_t y = 0;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw nosie buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Diff_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Diff_Test_Frame * 8.3ms
+    msleep(frame_num * 83);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, xdata, xdata_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, xdata, xdata_len);
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF);
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF);
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_doze_noise_collect(struct chip_data_nt36525 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x4B;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int32_t nvt_read_doze_fw_noise(struct chip_data_nt36525 *chip_info, int32_t config_Doze_Noise_Test_Frame, int32_t doze_X_Channel, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint8_t buf[128] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < rx_num * doze_X_Channel) {
+        TPD_INFO("read doze nosie buffer(%d) less than data size(%d)\n", xdata_len, rx_num * doze_X_Channel);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Doze_Noise_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_doze_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Doze_Noise_Test_Frame * 16.7ms
+    msleep(frame_num * 250);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) >> 16) & 0xFF;
+        buf[2] = ((chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read data---
+        buf[0] = (chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) & 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, rx_num * 2 + 1);
+
+        for (y = 0; y < rx_num; y++) {
+            xdata[y * doze_X_Channel + x] = (uint16_t)(buf[y * doze_X_Channel + 1] + 256 * buf[y * doze_X_Channel + 2]);
+        }
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF) * 4;
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF) * 4;    //scaling up
+        }
+    }
+
+    //---Leave Test Mode---
+    //nvt_change_mode(NORMAL_MODE);    //No return to normal mode. Continuous to get doze rawdata
+
+    return 0;
+}
+
+static int32_t nvt_read_doze_baseline(struct chip_data_nt36525 *chip_info, int32_t doze_X_Channel, int32_t *xdata, int32_t xdata_len)
+{
+    uint8_t buf[128] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rm_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+
+    //---Enter Test Mode---
+    //nvt_change_mode(TEST_MODE_2);
+
+    //if (nvt_check_fw_status()) {
+    //    return -EAGAIN;
+    //}
+    if (xdata_len/sizeof(int32_t) < rm_num * doze_X_Channel) {
+        TPD_INFO("read doze baseline buffer(%d) less than data size(%d)\n", xdata_len, rm_num * doze_X_Channel);
+        return -1;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) >> 16) & 0xFF;
+        buf[2] = ((chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read data---
+        buf[0] = (chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) & 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, rm_num * 2 + 1);
+        for (y = 0; y < rm_num; y++) {
+            xdata[y * 2 + x] = (uint16_t)(buf[y * 2 + 1] + 256 * buf[y * 2 + 2]);
+        }
+    }
+
+    for (y = 0; y < rm_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata[iArrayIndex] = (int16_t)xdata[iArrayIndex];
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_short_test(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable short test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x43;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+}
+
+static int32_t nvt_read_fw_short(struct chip_data_nt36525 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint8_t buf[128] = {0};
+    int32_t iArrayIndex = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw short buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_short_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = (uint8_t)(((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) >> 16) & 0xFF);
+        buf[2] = (uint8_t)(((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) >> 8) & 0xFF);
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) & 0xFF);
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, chip_info->hw_res->TX_NUM * 2 + 1);
+        memcpy(rawdata_buf + y * chip_info->hw_res->TX_NUM * 2, buf + 1, chip_info->hw_res->TX_NUM * 2);
+    }
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata[iArrayIndex] = (int16_t)(rawdata_buf[iArrayIndex * 2] + 256 * rawdata_buf[iArrayIndex * 2 + 1]);
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_open_test(struct chip_data_nt36525 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable open test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x45;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+}
+
+static int32_t nvt_read_fw_open(struct chip_data_nt36525 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0, y = 0;
+    uint32_t tx_num = chip_info->hw_res->TX_NUM;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    uint8_t buf[128] = {0};
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw open buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_open_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(tx_num * rx_num * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < rx_num; y++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = (uint8_t)(((raw_pipe_addr + y * tx_num * 2) >> 16) & 0xFF);
+        buf[2] = (uint8_t)(((raw_pipe_addr + y * tx_num * 2) >> 8) & 0xFF);
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * tx_num * 2) & 0xFF);
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, tx_num * 2 + 1);
+        memcpy(rawdata_buf + y * tx_num * 2, buf + 1, tx_num * 2);
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < tx_num; x++) {
+            xdata[(rx_num-y-1) * tx_num + (tx_num-x-1)] = (int16_t)((rawdata_buf[(y*tx_num + x)*2] + 256 * rawdata_buf[(y*tx_num + x)*2 + 1]));
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_auto_test(struct seq_file *s, void *chip_data, struct nvt_testdata *nvt_testdata)
+{
+    int32_t *raw_data = NULL;
+    int32_t *raw_data_n = NULL;
+    int i, j, buf_len = 0;
+    int err_cnt = 0;
+    int32_t iArrayIndex = 0;
+    struct chip_data_nt36525 *chip_info = (struct chip_data_nt36525 *)chip_data;
+    struct nvt_test_header *ph = NULL;
+    int32_t *fw_rawdata_P = NULL, *fw_rawdata_N = NULL;
+    int32_t *open_rawdata_P = NULL, *open_rawdata_N = NULL;
+    int32_t *short_rawdata_P = NULL, *short_rawdata_N = NULL;
+    int32_t *diff_rawdata_P = NULL, *diff_rawdata_N = NULL;
+    int32_t *cc_data_P = NULL, *cc_data_N = NULL;
+    int32_t *doze_rawdata_P = NULL, *doze_rawdata_N = NULL;
+    int32_t *doze_diff_rawdata_P = NULL, *doze_diff_rawdata_N = NULL;
+
+    if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+        TPD_INFO("switch frequency hopping disable failed!\n");
+        store_to_file(nvt_testdata->fd, "switch frequency hopping disable failed!\n");
+        seq_printf(s, "switch frequency hopping disable failed!\n");
+        return;
+    }
+
+    if (nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN)) {
+        TPD_INFO("check fw reset state failed!\n");
+        store_to_file(nvt_testdata->fd, "check fw reset state failed!\n");
+        seq_printf(s, "check fw reset state failed!\n");
+        return;
+    }
+
+    msleep(100);
+
+    //---Enter Test Mode---
+    TPD_INFO("enter test mode\n");
+    if (nvt_clear_fw_status(chip_info)) {
+        TPD_INFO("clear fw status failed!\n");
+        store_to_file(nvt_testdata->fd, "clear fw status failed!\n");
+        seq_printf(s, "clear fw status failed!\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, MP_MODE_CC);
+
+    if (nvt_check_fw_status(chip_info)) {
+        TPD_INFO("check fw status failed!\n");
+        store_to_file(nvt_testdata->fd, "check fw status failed!\n");
+        seq_printf(s, "check fw status failed!\n");
+        return;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        TPD_INFO("get fw info failed!\n");
+        store_to_file(nvt_testdata->fd, "get fw info failed!\n");
+        seq_printf(s, "get fw info failed!\n");
+        return;
+    }
+
+    TPD_INFO("malloc raw_data space\n");
+    buf_len = nvt_testdata->TX_NUM * nvt_testdata->RX_NUM * sizeof(int32_t);
+    raw_data = kzalloc(buf_len, GFP_KERNEL);
+    raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+    if (!(raw_data && raw_data_n)) {
+        err_cnt++;
+        store_to_file(nvt_testdata->fd, "malloc memory failed!\n");
+        seq_printf(s, "malloc memory failed!\n");
+        goto OUT;
+    }
+
+    //get test data
+    ph = (struct nvt_test_header *)(nvt_testdata->fw->data);
+    fw_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_P_offset);
+    fw_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_N_offset);
+    open_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_P_offset);
+    open_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_N_offset);
+    short_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_P_offset);
+    short_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_N_offset);
+    diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_P_offset);
+    diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_N_offset);
+    cc_data_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_P_offset);
+    cc_data_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_N_offset);
+    doze_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_P_offset);
+    doze_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_N_offset);
+    doze_diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_P_offset);
+    doze_diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_N_offset);
+
+    //---FW Rawdata Test---
+    TPD_INFO("FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    nvt_read_mdata(chip_info, chip_info->mmap->BASELINE_ADDR, raw_data, buf_len);
+    store_to_file(nvt_testdata->fd, "rawData:\n");
+    for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+        for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+            iArrayIndex = j * nvt_testdata->TX_NUM + i;
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+            }
+            if((raw_data[iArrayIndex] > fw_rawdata_P[iArrayIndex]) \
+                    || (raw_data[iArrayIndex] < fw_rawdata_N[iArrayIndex])) {
+                TPD_INFO("rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                if (!err_cnt) {
+                    seq_printf(s, "rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                }
+                err_cnt++;
+            }
+        }
+        if (nvt_testdata->fd >= 0) {
+            store_to_file(nvt_testdata->fd, "\n");
+        }
+    }
+
+    TPD_INFO("FW cc data test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, raw_data, buf_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, raw_data, buf_len);
+    store_to_file(nvt_testdata->fd, "ccData:\n");
+    if ((ph->config_Lmt_FW_CC_P != 0) && (ph->config_Lmt_FW_CC_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_FW_CC_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_FW_CC_N)) {
+                    TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > cc_data_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < cc_data_N[iArrayIndex])) {
+                    TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+
+    //---Noise Test---
+    TPD_INFO("FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("read Noise data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Noise data failed!\n");
+        seq_printf(s, "read Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_FW_Diff_P != 0) && (ph->config_Lmt_FW_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                    TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                    TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Noise Test---
+    TPD_INFO("Doze FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_doze_fw_noise(chip_info, ph->config_Doze_Noise_Test_Frame, ph->doze_X_Channel, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("read Doze Noise data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Doze Noise data failed!\n");
+        seq_printf(s, "read Doze Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_Doze_Diff_P != 0) && (ph->config_Lmt_Doze_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                    TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                    TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Doze FW Rawdata Test---
+    TPD_INFO("Doze FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    if(nvt_read_doze_baseline(chip_info, ph->doze_X_Channel, raw_data, buf_len) != 0) {
+        TPD_INFO("read Doze FW Rawdata failed!\n");
+        store_to_file(nvt_testdata->fd, "read Doze FW Rawdata failed!\n");
+        seq_printf(s, "read Doze FW Rawdata failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "Doze FW Rawdata:\n");
+    if ((ph->config_Lmt_Doze_Rawdata_P != 0) && (ph->config_Lmt_Doze_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Rawdata_N)) {
+                    TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //--Short Test---
+    TPD_INFO("FW Short Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_read_fw_short(chip_info, raw_data, buf_len) != 0) {
+        TPD_INFO("read Short test data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Short test data failed!\n");
+        seq_printf(s, "read Short test data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Short:\n");
+    if ((ph->config_Lmt_Short_Rawdata_P != 0) && (ph->config_Lmt_Short_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Short_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Short_Rawdata_N)) {
+                    TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > short_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < short_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Open Test---
+    TPD_INFO("FW Open Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_read_fw_open(chip_info, raw_data, buf_len) != 0) {
+        TPD_INFO("read Open test data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Open test data failed!\n");
+        seq_printf(s, "read Open test data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Open:\n");
+    for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+        for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+            iArrayIndex = j * nvt_testdata->TX_NUM + i;
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+            }
+            if((raw_data[iArrayIndex] > open_rawdata_P[iArrayIndex]) \
+                    || (raw_data[iArrayIndex] < open_rawdata_N[iArrayIndex])) {
+                TPD_INFO("Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                if (!err_cnt) {
+                    seq_printf(s, "Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                }
+                err_cnt++;
+            }
+        }
+        if (nvt_testdata->fd >= 0) {
+            store_to_file(nvt_testdata->fd, "\n");
+        }
+    }
+
+OUT:
+    //---Reset IC---
+    nvt_bootloader_reset(chip_info);
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_n)
+        kfree(raw_data_n);
+
+    seq_printf(s, "FW:0x%llx\n", nvt_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+}
+
+static struct nvt_proc_operations nvt_proc_ops = {
+    .auto_test     = nvt_auto_test,
+};
+/*************** End of implementation of baseline_test proc callbacks************************/
+
+/*********** Start of I2C Driver and Implementation of it's callbacks*************************/
+static int nvt_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_nt36525 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    /* 1. alloc chip info */
+    chip_info = kzalloc(sizeof(struct chip_data_nt36525), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. bind client and dev for easy operate */
+    chip_info->client = client;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    /* 4. file_operations callbacks binding */
+    ts->ts_ops = &nvt_ops;
+
+    /* 5. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+    ts->tp_suspend_order = TP_LCD_SUSPEND;
+    ts->tp_resume_order = LCD_TP_RESUME;
+    chip_info->is_sleep_writed = false;
+    chip_info->test_limit_name = ts->panel_data.test_limit_name;
+
+    //reset esd handle time interval
+    if (ts->esd_handle_support) {
+        chip_info->esd_check_enabled = false;
+        ts->esd_info.esd_work_time = msecs_to_jiffies(NVT_TOUCH_ESD_CHECK_PERIOD); // change esd check interval to 1.5s
+        TPD_INFO("%s:change esd handle time to %d ms\n", __func__, ts->esd_info.esd_work_time/HZ);
+    }
+
+    /* 7. create nvt test files */
+    nvt_flash_proc_init(ts, "NVTflash");
+    nvt_create_proc(ts, &nvt_proc_ops);
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int nvt_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int nvt_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int nvt_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = nvt_i2c_suspend,
+    .resume = nvt_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver =
+{
+    .probe = nvt_tp_probe,
+    .remove = nvt_tp_remove,
+    .id_table = tp_id,
+    .driver = {
+        .name = TPD_DEVICE,
+        .owner = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+/******************* End of I2C Driver and It's dev_pm_ops***********************/
+
+/***********************Start of module init and exit****************************/
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+/***********************End of module init and exit*******************************/
+
+MODULE_AUTHOR("nvtTek Driver");
+MODULE_DESCRIPTION("nvtTek Touchscreen Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.h
new file mode 100644
index 0000000000000000000000000000000000000000..7b9967e6f22e82f898124b47151c483d63482db2
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36525/nvt_drivers_nt36525.h
@@ -0,0 +1,155 @@
+/***************************************************
+ * File:novatek_drivers_nt36525.h
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             novatek nt36525 driver
+ * Version:1.0:
+ * Date created:2017-11-11
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef NVT_H_nt36525
+#define NVT_H_nt36525
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../novatek_common.h"
+
+/*********PART2:Define Area**********************/
+#define I2C_HW_Address          0x62
+#define I2C_BLDR_Address        0x01
+#define I2C_FW_Address          0x01
+
+#define NVT_TOUCH_ESD_CHECK_PERIOD  1500
+#define POINT_DATA_LEN          65
+#define NVT_ID_BYTE_MAX         6
+#define XDATA_SECTOR_SIZE       256
+#define I2C_TANSFER_LENGTH      64
+#define FW_BIN_SIZE_116KB       118784
+#define FW_BIN_SIZE             FW_BIN_SIZE_116KB
+#define FW_BIN_VER_OFFSET       0x1A000
+#define FW_BIN_VER_BAR_OFFSET   0x1A001
+#define BLOCK_64KB_NUM          4
+#define SIZE_64KB               65536
+#define FLASH_SECTOR_SIZE       4096
+
+#define NORMAL_MODE             0x00
+#define TEST_MODE_1             0x21
+#define TEST_MODE_2             0x22
+#define MP_MODE_CC              0x41
+#define FREQ_HOP_DISABLE        0x66
+#define FREQ_HOP_ENABLE         0x65
+#define HANDSHAKING_HOST_READY  0xBB
+
+#define EVENTBUFFER_EDGE_LIMIT_ON  0x79
+#define EVENTBUFFER_EDGE_LIMIT_OFF 0x7A
+#define EVENTBUFFER_PWR_PLUG_IN    0x53
+#define EVENTBUFFER_PWR_PLUG_OUT   0x51
+
+#define DTAP_DETECT                     15
+#define UP_VEE_DETECT                   14
+#define DOWN_VEE_DETECT                 33
+#define LEFT_VEE_DETECT                 31
+#define RIGHT_VEE_DETECT                32
+#define CIRCLE_DETECT                   18
+#define DOUSWIP_DETECT                  34
+#define RIGHT_SLIDE_DETECT              24
+#define LEFT_SLIDE_DETECT               23
+#define DOWN_SLIDE_DETECT               22
+#define UP_SLIDE_DETECT                 21
+#define M_DETECT                        17
+#define W_DETECT                        13
+
+/*********PART3:Struct Area**********************/
+typedef enum
+{
+    PALM = 0,
+    GLOVE,
+    PWR_FLAG,
+    HOVER,
+    EDGE_REGECT
+}CMD_OFFSET;
+
+typedef enum {
+    RESET_STATE_INIT = 0xA0,    // IC reset
+    RESET_STATE_REK,            // ReK baseline
+    RESET_STATE_REK_FINISH,     // baseline is ready
+    RESET_STATE_NORMAL_RUN,     // normal run
+    RESET_STATE_MAX  = 0xAF
+} RST_COMPLETE_STATE;
+
+typedef enum {
+    NVT_RAWDATA,    //raw data
+    NVT_DIFFDATA,   //diff data
+    NVT_BASEDATA,   //baseline data
+}DEBUG_READ_TYPE;
+
+
+typedef enum {
+    EVENT_MAP_HOST_CMD                      = 0x50,
+    EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE   = 0x51,
+    EVENT_MAP_RESET_COMPLETE                = 0x60,
+    EVENT_MAP_FWINFO                        = 0x78,
+    EVENT_MAP_PROJECTID                     = 0x9A,
+} I2C_EVENT_MAP;
+
+struct nvt_mem_map {
+    uint32_t EVENT_BUF_ADDR;
+    uint32_t RAW_PIPE0_ADDR;
+    uint32_t RAW_PIPE0_Q_ADDR;
+    uint32_t RAW_PIPE1_ADDR;
+    uint32_t RAW_PIPE1_Q_ADDR;
+    uint32_t BASELINE_ADDR;
+    uint32_t BASELINE_Q_ADDR;
+    uint32_t BASELINE_BTN_ADDR;
+    uint32_t BASELINE_BTN_Q_ADDR;
+    uint32_t DIFF_PIPE0_ADDR;
+    uint32_t DIFF_PIPE0_Q_ADDR;
+    uint32_t DIFF_PIPE1_ADDR;
+    uint32_t DIFF_PIPE1_Q_ADDR;
+    uint32_t RAW_BTN_PIPE0_ADDR;
+    uint32_t RAW_BTN_PIPE0_Q_ADDR;
+    uint32_t RAW_BTN_PIPE1_ADDR;
+    uint32_t RAW_BTN_PIPE1_Q_ADDR;
+    uint32_t DIFF_BTN_PIPE0_ADDR;
+    uint32_t DIFF_BTN_PIPE0_Q_ADDR;
+    uint32_t DIFF_BTN_PIPE1_ADDR;
+    uint32_t DIFF_BTN_PIPE1_Q_ADDR;
+    uint32_t READ_FLASH_CHECKSUM_ADDR;
+    uint32_t RW_FLASH_DATA_ADDR;
+    uint32_t DOZE_GM_S1D_SCAN_RAW_ADDR;
+    uint32_t DOZE_GM_BTN_SCAN_RAW_ADDR;
+};
+
+struct nvt_trim_id_table {
+    uint8_t id[NVT_ID_BYTE_MAX];
+    uint8_t mask[NVT_ID_BYTE_MAX];
+    const struct nvt_mem_map *mmap;
+    uint8_t carrier_system;
+};
+
+struct chip_data_nt36525 {
+    tp_dev                          tp_type;
+    char                            *test_limit_name;
+    struct i2c_client               *client;
+    const struct nvt_mem_map       *mmap;
+    uint8_t                         carrier_system;
+    uint8_t                         fw_ver;
+    uint16_t                        nvt_pid;
+    struct hw_resource              *hw_res;
+    bool                            is_sleep_writed;
+    bool                            esd_check_enabled;
+    unsigned long                   irq_timer;
+    uint8_t                         esd_retry;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..272925020383e975f68cceb0f15b4fa78aa450fc
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for nova nt36672 ic driver
+
+config TOUCHPANEL_NOVA_NT36672
+#	default y
+	bool "TP nova nt36672 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing nova nt36672
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..e2ab7b1654bda4a9de763d6b9213d31b6abd5681
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36672) += nvt_drivers_nt36672.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.c b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.c
new file mode 100644
index 0000000000000000000000000000000000000000..4fde9c2f3150d6e8afd07abafbe1d693459d2774
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.c
@@ -0,0 +1,3680 @@
+/*****************************************************************************************
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * File       : novatek_drivers_nt36672.c
+ * Description: Source file for novatek nt36672 driver
+ * Version   : 1.0
+ * Date        : 2017-09-15
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "nvt_drivers_nt36672.h"
+
+/****************** Start of Log Tag Declear and level define*******************************/
+#define TPD_DEVICE "nova-nt36672"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+/******************** End of Log Tag Declear and level define*********************************/
+
+static void nvt_change_mode(struct chip_data_nt36672 *chip_info, uint8_t mode);
+static int32_t nvt_read_fw_noise(struct chip_data_nt36672 *chip_info, int32_t config_Diff_Test_Frame, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len);
+static int8_t nvt_switch_FreqHopEnDis(struct chip_data_nt36672 *chip_info, uint8_t FreqHopEnDis);
+void nvt_read_mdata(struct chip_data_nt36672 *chip_info, uint32_t xdata_addr, int32_t *xdata, int32_t xdata_len);
+static uint8_t nvt_get_fw_pipe(struct chip_data_nt36672 *chip_info);
+static int32_t nvt_check_fw_status(struct chip_data_nt36672 *chip_info);
+static void nvt_change_mode(struct chip_data_nt36672 *chip_info, uint8_t mode);
+static int32_t nvt_clear_fw_status(struct chip_data_nt36672 *chip_info);
+static void store_to_file(int fd, char* format, ...);
+static int nvt_get_chip_info(void *chip_data);
+
+/***************************** start of id map table******************************************/
+static const struct nvt_mem_map NT36772_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11E00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10E70,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12E70,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x10830,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x12830,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10E60,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12E60,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10E68,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12E68,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x143D0,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x11DF0,
+};
+
+static const struct nvt_mem_map NT36672A_memory_map = {
+    .EVENT_BUF_ADDR           = 0x21C00,
+    .RAW_PIPE0_ADDR           = 0x20000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x23000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x20BFC,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x23BFC,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x206DC,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x236DC,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x20510,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x23510,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x20BF0,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x23BF0,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x24000,
+    .RW_FLASH_DATA_ADDR       = 0x24002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x23C1C,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x23CAC,
+};
+
+static const struct nvt_mem_map NT36525_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11A00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10B08,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12B08,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x1064C,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x1264C,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10634,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12634,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10AFC,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12AFC,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x12B28,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x12BB0,
+};
+
+static const struct nvt_mem_map NT36870_memory_map = {
+    .EVENT_BUF_ADDR           = 0x25000,
+    .RAW_PIPE0_ADDR           = 0x20000,
+    .RAW_PIPE0_Q_ADDR         = 0x204C8,
+    .RAW_PIPE1_ADDR           = 0x23000,
+    .RAW_PIPE1_Q_ADDR         = 0x234C8,
+    .BASELINE_ADDR            = 0x21350,
+    .BASELINE_Q_ADDR          = 0x21818,
+    .BASELINE_BTN_ADDR        = 0x24350,
+    .BASELINE_BTN_Q_ADDR      = 0x24358,
+    .DIFF_PIPE0_ADDR          = 0x209B0,
+    .DIFF_PIPE0_Q_ADDR        = 0x20E78,
+    .DIFF_PIPE1_ADDR          = 0x239B0,
+    .DIFF_PIPE1_Q_ADDR        = 0x23E78,
+    .RAW_BTN_PIPE0_ADDR       = 0x20990,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0x20998,
+    .RAW_BTN_PIPE1_ADDR       = 0x23990,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0x23998,
+    .DIFF_BTN_PIPE0_ADDR      = 0x21340,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0x21348,
+    .DIFF_BTN_PIPE1_ADDR      = 0x24340,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0x24348,
+    .READ_FLASH_CHECKSUM_ADDR = 0x24000,
+    .RW_FLASH_DATA_ADDR       = 0x24002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x29910,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x29CC8,
+};
+
+static const struct nvt_mem_map NT36676F_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11A00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10B08,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12B08,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x1064C,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x1264C,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10634,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12634,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10AFC,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12AFC,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x12B28,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x12BB0,
+};
+
+static const struct nvt_trim_id_table trim_id_table[] = {
+    {.id = {0x0A, 0xFF, 0xFF, 0x72, 0x66, 0x03}, .mask = {1, 0, 0, 1, 1, 1},
+        .mmap = &NT36672A_memory_map, .carrier_system = 0},
+    {.id = {0x55, 0x00, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0x55, 0x72, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xAA, 0x00, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xAA, 0x72, 0xFF, 0x00, 0x00, 0x00}, .mask = {1, 1, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x72, 0x67, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x67, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x72, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x25, 0x65, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36525_memory_map, .carrier_system = 0},
+    {.id = {0xFF, 0xFF, 0xFF, 0x70, 0x68, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36870_memory_map, .carrier_system = 1},
+    {.id = {0xFF, 0xFF, 0xFF, 0x76, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36676F_memory_map, .carrier_system = 0}
+};
+
+int32_t nvt_i2c_write(struct i2c_client *client, uint16_t address, uint8_t *buf, uint16_t len)
+{
+    int ret = -1;
+    uint16_t addr_cpy = client->addr;
+
+    client->addr = address;
+    ret = touch_i2c_write(client, buf, len);
+    if (ret < 0) {
+        TPD_INFO("%s %d failed\n", __func__, address);
+    }
+    client->addr = addr_cpy;
+
+    return ret;
+}
+
+int32_t nvt_i2c_read(struct i2c_client *client, uint16_t address, uint8_t *buf, uint16_t len)
+{
+    int ret = -1;
+    uint16_t addr_cpy = client->addr;
+
+    client->addr = address;
+    ret = touch_i2c_read(client, &buf[0], 1, &buf[1], len - 1);
+    if (ret < 0) {
+        TPD_INFO("%s %d failed\n", __func__, address);
+    }
+    client->addr = addr_cpy;
+
+    return ret;
+}
+/****************************** End of id map table*******************************************/
+
+/****** Start of other functions that work for oppo_touchpanel_operations callbacks***********/
+void nvt_bootloader_reset(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---write i2c cmds to reset---
+    buf[0] = 0x00;
+    buf[1] = 0x69;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("write bootloader reset cmds failed!\n");
+    }
+
+    // need 35ms delay after bootloader reset
+    msleep(35);
+}
+
+void nvt_sw_reset_idle(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[4]={0};
+
+    //---write i2c cmds to reset idle---
+    buf[0]=0x00;
+    buf[1]=0xA5;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("write reset idle cmds failed!\n");
+    }
+
+    msleep(15);
+}
+
+void nvt_stop_crc_reboot(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t retry = 0;
+
+    TPD_INFO("%s: stop crc reboot\n", __func__);
+    //read dummy buffer to check CRC fail reboot is happening or not
+
+    //---change I2C index to prevent geting 0xFF, but not 0xFC---
+    buf[0] = 0xFF;
+    buf[1] = 0x01;
+    buf[2] = 0xF6;
+    nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+
+    //---read to check if buf is 0xFC which means IC is in CRC reboot ---
+    buf[0] = 0x4E;
+    nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 4);
+
+    if (((buf[1] == 0xFC) && (buf[2] == 0xFC) && (buf[3] == 0xFC)) ||
+        ((buf[1] == 0xFF) && (buf[2] == 0xFF) && (buf[3] == 0xFF))) {
+
+        //IC is in CRC fail reboot loop, needs to be stopped!
+        for (retry = 5; retry > 0; retry--) {
+            //---write i2c cmds to reset idle : 1st---
+            buf[0]=0x00;
+            buf[1]=0xA5;
+            nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+
+            //---write i2c cmds to reset idle : 2rd---
+            buf[0]=0x00;
+            buf[1]=0xA5;
+            nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+            msleep(1);
+
+            //---clear CRC_ERR_FLAG---
+            buf[0] = 0xFF;
+            buf[1] = 0x03;
+            buf[2] = 0xF1;
+            nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+
+            buf[0] = 0x35;
+            buf[1] = 0xA5;
+            nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 2);
+
+            //---check CRC_ERR_FLAG---
+            buf[0] = 0xFF;
+            buf[1] = 0x03;
+            buf[2] = 0xF1;
+            nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+
+            buf[0] = 0x35;
+            buf[1] = 0x00;
+            nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 2);
+
+            if (buf[1] == 0xA5)
+                break;
+        }
+
+        if (retry == 0)
+            TPD_INFO("CRC auto reboot is not able to be stopped! buf[1]=0x%02X\n", buf[1]);
+        }
+
+    return;
+}
+
+static int8_t nvt_check_chip_ver_trim(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t retry = 0;
+    int32_t list = 0;
+    int32_t i = 0;
+    int32_t found_nvt_chip = 0;
+    int32_t ret = -1;
+
+    nvt_bootloader_reset(chip_info);
+
+    //---Check for 5 times---
+    for (retry = 5; retry > 0; retry--) {
+        nvt_sw_reset_idle(chip_info);
+
+        buf[0] = 0x00;
+        buf[1] = 0x35;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        msleep(10);
+
+        buf[0] = 0xFF;
+        buf[1] = 0x01;
+        buf[2] = 0xF6;
+        ret |= nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+
+        buf[0] = 0x4E;
+        buf[1] = 0x00;
+        buf[2] = 0x00;
+        buf[3] = 0x00;
+        buf[4] = 0x00;
+        buf[5] = 0x00;
+        buf[6] = 0x00;
+        ret |= nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 7);
+        if (ret < 0) {
+            TPD_INFO("write or read failed in %s \n", __func__);
+        }
+        TPD_INFO("buf[1]=0x%02X, buf[2]=0x%02X, buf[3]=0x%02X, buf[4]=0x%02X, buf[5]=0x%02X, buf[6]=0x%02X\n",
+            buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
+
+        // compare read chip id on supported list
+        for (list = 0; list < (sizeof(trim_id_table) / sizeof(struct nvt_trim_id_table)); list++) {
+            found_nvt_chip = 0;
+
+            // compare each byte
+            for (i = 0; i < NVT_ID_BYTE_MAX; i++) {
+                if (trim_id_table[list].mask[i]) {
+                    if (buf[i + 1] != trim_id_table[list].id[i])
+                        break;
+                }
+            }
+
+            if (i == NVT_ID_BYTE_MAX) {
+                found_nvt_chip = 1;
+            }
+
+            if (found_nvt_chip) {
+                TPD_INFO("This is NVT touch IC, Chip Index %d\n", list);
+                chip_info->mmap = trim_id_table[list].mmap;
+                chip_info->carrier_system = trim_id_table[list].carrier_system;
+                memcpy(chip_info->id, trim_id_table[list].id, NVT_ID_BYTE_MAX); /* store id */
+                ret = 0;
+                goto out;
+            } else {
+                chip_info->mmap = NULL;
+                ret = -1;
+            }
+        }
+
+        /*stop crc check to prevent deivce reboot*/
+        if (((buf[1] == 0xFC) && (buf[2] == 0xFC) && (buf[3] == 0xFC))||
+            ((buf[1] == 0xFF) && (buf[2] == 0xFF) && (buf[3] == 0xFF))) {
+            nvt_stop_crc_reboot(chip_info);
+        }
+        msleep(10);
+    }
+
+    if (chip_info->mmap == NULL) {  //set default value
+        chip_info->mmap = &NT36772_memory_map;
+        chip_info->carrier_system = 0;
+        ret = 0;
+    }
+out:
+    return ret;
+}
+
+int32_t nvt_check_fw_reset_state(struct chip_data_nt36672 *chip_info, RST_COMPLETE_STATE check_reset_state)
+{
+    uint8_t buf[8] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    while (1) {
+        msleep(10);
+
+        //---read reset state---
+        buf[0] = EVENT_MAP_RESET_COMPLETE;
+        buf[1] = 0x00;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 6);
+
+        if ((buf[1] >= check_reset_state) && (buf[1] <= RESET_STATE_MAX)) {
+            ret = 0;
+            break;
+        }
+
+        retry++;
+        if(unlikely(retry > 100)) {
+            TPD_INFO("error, retry=%d, buf[1]=0x%02X, 0x%02X, 0x%02X, 0x%02X, 0x%02X\n", retry, buf[1], buf[2], buf[3], buf[4], buf[5]);
+            ret = -1;
+            break;
+        }
+    }
+
+    return ret;
+}
+
+int32_t nvt_read_pid(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[3] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read project id---
+    buf[0] = EVENT_MAP_PROJECTID;
+    buf[1] = 0x00;
+    buf[2] = 0x00;
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("read pid failed\n");
+    } else {
+        chip_info->nvt_pid = (buf[2] << 8) + buf[1];
+    }
+
+    TPD_INFO("PID=%04X\n", chip_info->nvt_pid);
+
+    return ret;
+}
+
+int32_t nvt_get_fw_info(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[64] = {0};
+    uint32_t retry_count = 0;
+    int32_t ret = 0;
+
+info_retry:
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read fw info---
+    buf[0] = EVENT_MAP_FWINFO;
+    nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 17);
+    chip_info->fw_ver = buf[1];
+    // x_num = buf[3];
+    // y_num = buf[4];
+    // abs_x_max = (uint16_t)((buf[5] << 8) | buf[6]);
+    // abs_y_max = (uint16_t)((buf[7] << 8) | buf[8]);
+    // max_button_num = buf[11];
+
+    //---clear x_num, y_num if fw info is broken---
+    if ((buf[1] + buf[2]) != 0xFF) {
+        TPD_INFO("FW info is broken! fw_ver=0x%02X, ~fw_ver=0x%02X\n", buf[1], buf[2]);
+        chip_info->fw_ver = 0;
+
+        if(retry_count < 3) {
+            retry_count++;
+            TPD_INFO("%s retry_count=%d\n", __func__, retry_count);
+            goto info_retry;
+        } else {
+            TPD_INFO("Set default fw_ver=0, x_num=18, y_num=32, abs_x_max=1080, abs_y_max=1920, max_button_num=0!\n");
+            ret = -1;
+        }
+    } else {
+        ret = 0;
+    }
+
+    //---Get nvttek PID---
+    nvt_read_pid(chip_info);
+
+    return ret;
+}
+
+static int nvt_enter_sleep(struct chip_data_nt36672 *chip_info, bool config)
+{
+    int ret = -1;
+    uint8_t buf[3];
+
+    if (config) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0x11;
+        ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("%s: enter sleep mode failed!\n", __func__);
+            return -1;
+        } else {
+            chip_info->is_sleep_writed = true;
+            TPD_INFO("%s: enter sleep mode sucess!\n", __func__);
+        }
+    }
+
+    return ret;
+}
+
+static int nvt_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+
+    nvt_bootloader_reset(chip_info);
+    ret = nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+    if (ret < 0) {
+        TPD_INFO("%s: check reset state(INIT) failed\n", __func__);
+    } else {
+        chip_info->is_sleep_writed = false;
+    }
+
+    return ret;
+}
+
+static int8_t nvt_cmd_store(struct chip_data_nt36672 *chip_info, uint8_t u8Cmd)
+{
+    int i, retry = 5;
+    uint8_t buf[3] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    for (i = 0; i < retry; i++) {
+        //---set cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = u8Cmd;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        msleep(20);
+
+        //---read cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(i == retry)) {
+        TPD_INFO("send Cmd 0x%02X failed, buf[1]=0x%02X\n", u8Cmd, buf[1]);
+        return -1;
+    } else {
+        TPD_INFO("send Cmd 0x%02X success, tried %d times\n", u8Cmd, i);
+    }
+
+    return 0;
+}
+
+static int nvt_enable_black_gesture(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (enable) {
+        if (chip_info->is_sleep_writed) {
+            nvt_reset(chip_info);
+        }
+
+        ret = nvt_cmd_store(chip_info, 0x13);
+    } else {
+        ret = 0;
+    }
+
+    return ret;
+}
+
+static int nvt_enable_edge_limit(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_ON);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_OFF);
+    }
+
+    return ret;
+}
+
+static int nvt_enable_charge_mode(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_IN);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_OUT);
+    }
+
+    return ret;
+}
+
+int32_t Resume_PD(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // Resume Command
+    buf[0] = 0x00;
+    buf[1] = 0xAB;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("Write Resume Command Enable error!\n");
+        return ret;
+    }
+
+    // Check 0xAA (Resume Command)
+    retry = 0;
+    while(1) {
+        msleep(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Resume Command) error!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Resume Command) error!! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+    msleep(10);
+
+    TPD_INFO("Resume PD OK\n");
+    return 0;
+}
+
+int32_t Check_CheckSum(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->READ_FLASH_CHECKSUM_ADDR;
+    int32_t ret = 0;
+    int32_t i = 0;
+    int32_t k = 0;
+    uint16_t WR_Filechksum[BLOCK_64KB_NUM] = {0};
+    uint16_t RD_Filechksum[BLOCK_64KB_NUM] = {0};
+    size_t fw_bin_size = 0;
+    size_t len_in_blk = 0;
+    int32_t retry = 0;
+
+    if (Resume_PD(chip_info)) {
+        TPD_INFO("Resume PD error!!\n");
+        return -1;
+    }
+
+    fw_bin_size = fw->size;
+
+    for (i = 0; i < BLOCK_64KB_NUM; i++) {
+        if (fw_bin_size > (i * SIZE_64KB)) {
+            // Calculate WR_Filechksum of each 64KB block
+            len_in_blk = min(fw_bin_size - i * SIZE_64KB, (size_t)SIZE_64KB);
+            WR_Filechksum[i] = i + 0x00 + 0x00 + (((len_in_blk - 1) >> 8) & 0xFF) + ((len_in_blk - 1) & 0xFF);
+            for (k = 0; k < len_in_blk; k++) {
+                WR_Filechksum[i] += fw->data[k + i * SIZE_64KB];
+            }
+            WR_Filechksum[i] = 65535 - WR_Filechksum[i] + 1;
+
+            // Fast Read Command
+            buf[0] = 0x00;
+            buf[1] = 0x07;
+            buf[2] = i;
+            buf[3] = 0x00;
+            buf[4] = 0x00;
+            buf[5] = ((len_in_blk - 1) >> 8) & 0xFF;
+            buf[6] = (len_in_blk - 1) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 7);
+            if (ret < 0) {
+                TPD_INFO("write Fast Read Command error!\n");
+                return ret;
+            }
+            // Check 0xAA (Fast Read Command)
+            retry = 0;
+            while (1) {
+                msleep(80);
+                buf[0] = 0x00;
+                buf[1] = 0x00;
+                ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+                if (ret < 0) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) error!\n");
+                    return ret;
+                }
+                if (buf[1] == 0xAA) {
+                    break;
+                }
+                retry++;
+                if (unlikely(retry > 5)) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                    return -1;
+                }
+            }
+            // Read Checksum (write addr high byte & middle byte)
+            buf[0] = 0xFF;
+            buf[1] = XDATA_Addr >> 16;
+            buf[2] = (XDATA_Addr >> 8) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum (write addr high byte & middle byte) error!\n");
+                return ret;
+            }
+            // Read Checksum
+            buf[0] = (XDATA_Addr) & 0xFF;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum error!!(%d)\n", ret);
+                return ret;
+            }
+
+            RD_Filechksum[i] = (uint16_t)((buf[2] << 8) | buf[1]);
+            if (WR_Filechksum[i] != RD_Filechksum[i]) {
+                TPD_INFO("RD_Filechksum[%d]=0x%04X, WR_Filechksum[%d]=0x%04X\n", i, RD_Filechksum[i], i, WR_Filechksum[i]);
+                TPD_INFO("firmware checksum not match!!\n");
+                return 0;
+            }
+        }
+    }
+
+    TPD_INFO("firmware checksum match!\n");
+    return 1;
+}
+
+int32_t Check_FW_Ver(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[16] = {0};
+    int32_t ret = 0;
+
+    //write i2c index to EVENT BUF ADDR
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c write error!\n", __func__);
+        return ret;
+    }
+
+    //read Firmware Version
+    buf[0] = EVENT_MAP_FWINFO;
+    buf[1] = 0x00;
+    buf[2] = 0x00;
+    ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c read error!\n", __func__);
+        return ret;
+    }
+
+    TPD_INFO("IC FW Ver = 0x%02X, FW Ver Bar = 0x%02X\n", buf[1], buf[2]);
+    TPD_INFO("Bin FW Ver = 0x%02X, FW ver Bar = 0x%02X\n",
+            fw->data[FW_BIN_VER_OFFSET], fw->data[FW_BIN_VER_BAR_OFFSET]);
+
+    // check IC FW_VER + FW_VER_BAR equals 0xFF or not, need to update if not
+    if ((buf[1] + buf[2]) != 0xFF) {
+        TPD_INFO("IC FW_VER + FW_VER_BAR not equals to 0xFF!\n");
+        return 0;
+    }
+
+    // compare IC and binary FW version
+    if (buf[1] == fw->data[FW_BIN_VER_OFFSET])
+        return 1;
+    else
+        return 0;
+}
+
+int32_t Init_BootLoader(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[64] = {0};
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // SW Reset & Idle
+    nvt_sw_reset_idle(chip_info);
+
+    // Initiate Flash Block
+    buf[0] = 0x00;
+    buf[1] = 0x00;
+    buf[2] = I2C_FW_Address;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("Inittial Flash Block error!!\n");
+        return ret;
+    }
+
+    // Check 0xAA (Initiate Flash Block)
+    retry = 0;
+    while(1) {
+        msleep(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Inittial Flash Block) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Inittial Flash Block) error!! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    TPD_INFO("Init OK \n");
+    msleep(20);
+
+    return 0;
+}
+
+int32_t Erase_Flash(struct chip_data_nt36672 *chip_info, uint32_t fw_len)
+{
+    uint8_t buf[64] = {0};
+    int32_t ret = 0;
+    int32_t count = 0;
+    int32_t i = 0;
+    int32_t Flash_Address = 0;
+    int32_t retry = 0;
+
+    // Write Enable
+    buf[0] = 0x00;
+    buf[1] = 0x06;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("Write Enable (for Write Status Register) error!\n");
+        return ret;
+    }
+    // Check 0xAA (Write Enable)
+    retry = 0;
+    while (1) {
+        mdelay(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Write Enable for Write Status Register) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Write Enable for Write Status Register) error! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    // Write Status Register
+    buf[0] = 0x00;
+    buf[1] = 0x01;
+    buf[2] = 0x00;
+    ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("Write Status Register error!\n");
+        return ret;
+    }
+    // Check 0xAA (Write Status Register)
+    retry = 0;
+    while (1) {
+        mdelay(1);
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Write Status Register) error!!\n");
+            return ret;
+        }
+        if (buf[1] == 0xAA) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 20)) {
+            TPD_INFO("Check 0xAA (Write Status Register) error! status=0x%02X\n", buf[1]);
+            return -1;
+        }
+    }
+
+    // Read Status
+    retry = 0;
+    while (1) {
+        mdelay(5);
+        buf[0] = 0x00;
+        buf[1] = 0x05;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Read Status (for Write Status Register) error!!(%d)\n", ret);
+            return ret;
+        }
+
+        // Check 0xAA (Read Status)
+        buf[0] = 0x00;
+        buf[1] = 0x00;
+        buf[2] = 0x00;
+        ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+        if (ret < 0) {
+            TPD_INFO("Check 0xAA (Read Status for Write Status Register) error!\n");
+            return ret;
+        }
+        if ((buf[1] == 0xAA) && (buf[2] == 0x00)) {
+            break;
+        }
+        retry++;
+        if (unlikely(retry > 100)) {
+            TPD_INFO("Check 0xAA (Read Status for Write Status Register) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+            return -1;
+        }
+    }
+
+    if (fw_len % FLASH_SECTOR_SIZE)
+        count = fw_len / FLASH_SECTOR_SIZE + 1;
+    else
+        count = fw_len / FLASH_SECTOR_SIZE;
+
+    for(i = 0; i < count; i++) {
+        // Write Enable
+        buf[0] = 0x00;
+        buf[1] = 0x06;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Write Enable error!!(%d)\n", i);
+            return ret;
+        }
+        // Check 0xAA (Write Enable)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Write Enable) error!!(%d)\n", i);
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Write Enable) error!! status=0x%02X\n", buf[1]);
+                return -1;
+            }
+        }
+
+        Flash_Address = i * FLASH_SECTOR_SIZE;
+
+        // Sector Erase
+        buf[0] = 0x00;
+        buf[1] = 0x20;    // Command : Sector Erase
+        buf[2] = ((Flash_Address >> 16) & 0xFF);
+        buf[3] = ((Flash_Address >> 8) & 0xFF);
+        buf[4] = (Flash_Address & 0xFF);
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 5);
+        if (ret < 0) {
+            TPD_INFO("Sector Erase error!!(%d)\n", i);
+            return ret;
+        }
+        // Check 0xAA (Sector Erase)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Sector Erase) error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Sector Erase) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                return -1;
+            }
+        }
+
+        // Read Status
+        retry = 0;
+        while (1) {
+            mdelay(5);
+            buf[0] = 0x00;
+            buf[1] = 0x05;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Read Status error!!(%d)\n", i);
+                return ret;
+            }
+
+            // Check 0xAA (Read Status)
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Read Status) error!!(%d)\n", i);
+                return ret;
+            }
+            if ((buf[1] == 0xAA) && (buf[2] == 0x00)) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 100)) {
+                TPD_INFO("Check 0xAA (Read Status) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+                return -1;
+            }
+        }
+    }
+
+    TPD_INFO("Erase OK \n");
+    return 0;
+}
+
+int32_t Write_Flash(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->RW_FLASH_DATA_ADDR;
+    uint32_t Flash_Address = 0;
+    int32_t i = 0, j = 0, k = 0;
+    uint8_t tmpvalue = 0;
+    int32_t count = 0;
+    int32_t ret = 0;
+    int32_t retry = 0;
+
+    // change I2C buffer index
+    buf[0] = 0xFF;
+    buf[1] = XDATA_Addr >> 16;
+    buf[2] = (XDATA_Addr >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+    if (ret < 0) {
+        TPD_INFO("change I2C buffer index error!!\n");
+        return ret;
+    }
+
+    if (fw->size % 256)
+        count = fw->size / 256 + 1;
+    else
+        count = fw->size / 256;
+
+    for (i = 0; i < count; i++) {
+        Flash_Address = i * 256;
+
+        // Write Enable
+        buf[0] = 0x00;
+        buf[1] = 0x06;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("Write Enable error!\n");
+            return ret;
+        }
+        // Check 0xAA (Write Enable)
+        retry = 0;
+        while (1) {
+            udelay(100);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Write Enable) error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Write Enable) error! status=0x%02X\n", buf[1]);
+                return -1;
+            }
+        }
+
+        // Write Page : 256 bytes
+        for (j = 0; j < min(fw->size - i * 256, (size_t)256); j += 32) {
+            buf[0] = (XDATA_Addr + j) & 0xFF;
+            for (k = 0; k < 32; k++) {
+                buf[1 + k] = fw->data[Flash_Address + j + k];
+            }
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 33);
+            if (ret < 0) {
+                TPD_INFO("Write Page error!, j=%d\n", j);
+                return ret;
+            }
+        }
+        if (fw->size - Flash_Address >= 256)
+            tmpvalue=(Flash_Address >> 16) + ((Flash_Address >> 8) & 0xFF) + (Flash_Address & 0xFF) + 0x00 + (255);
+        else
+            tmpvalue=(Flash_Address >> 16) + ((Flash_Address >> 8) & 0xFF) + (Flash_Address & 0xFF) + 0x00 + (fw->size - Flash_Address - 1);
+
+        for (k = 0;k < min(fw->size - Flash_Address,(size_t)256); k++)
+            tmpvalue += fw->data[Flash_Address + k];
+
+        tmpvalue = 255 - tmpvalue + 1;
+
+        // Page Program
+        buf[0] = 0x00;
+        buf[1] = 0x02;
+        buf[2] = ((Flash_Address >> 16) & 0xFF);
+        buf[3] = ((Flash_Address >> 8) & 0xFF);
+        buf[4] = (Flash_Address & 0xFF);
+        buf[5] = 0x00;
+        buf[6] = min(fw->size - Flash_Address,(size_t)256) - 1;
+        buf[7] = tmpvalue;
+        ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 8);
+        if (ret < 0) {
+            TPD_INFO("Page Program error!, i=%d\n", i);
+            return ret;
+        }
+        // Check 0xAA (Page Program)
+        retry = 0;
+        while (1) {
+            mdelay(1);
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Page Program error!\n");
+                return ret;
+            }
+            if (buf[1] == 0xAA || buf[1] == 0xEA) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 20)) {
+                TPD_INFO("Check 0xAA (Page Program) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                return -1;
+            }
+        }
+        if (buf[1] == 0xEA) {
+            TPD_INFO("Page Program error! i=%d\n", i);
+            return -3;
+        }
+
+        // Read Status
+        retry = 0;
+        while (1) {
+            mdelay(5);
+            buf[0] = 0x00;
+            buf[1] = 0x05;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 2);
+            if (ret < 0) {
+                TPD_INFO("Read Status error!\n");
+                return ret;
+            }
+
+            // Check 0xAA (Read Status)
+            buf[0] = 0x00;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Check 0xAA (Read Status) error!\n");
+                return ret;
+            }
+            if (((buf[1] == 0xAA) && (buf[2] == 0x00)) || (buf[1] == 0xEA)) {
+                break;
+            }
+            retry++;
+            if (unlikely(retry > 100)) {
+                TPD_INFO("Check 0xAA (Read Status) failed, buf[1]=0x%02X, buf[2]=0x%02X, retry=%d\n", buf[1], buf[2], retry);
+                return -1;
+            }
+        }
+        if (buf[1] == 0xEA) {
+            TPD_INFO("Page Program error! i=%d\n", i);
+            return -4;
+        }
+
+        TPD_DEBUG("Programming...%2d%%\n", ((i * 100) / count));
+    }
+
+    TPD_INFO("Programming...%2d%%\n", 100);
+    TPD_INFO("Program OK         \n");
+    return 0;
+}
+
+int32_t Verify_Flash(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+    uint8_t buf[64] = {0};
+    uint32_t XDATA_Addr = chip_info->mmap->READ_FLASH_CHECKSUM_ADDR;
+    int32_t ret = 0;
+    int32_t i = 0;
+    int32_t k = 0;
+    uint16_t WR_Filechksum[BLOCK_64KB_NUM] = {0};
+    uint16_t RD_Filechksum[BLOCK_64KB_NUM] = {0};
+    size_t fw_bin_size = fw->size;
+    size_t len_in_blk = 0;
+    int32_t retry = 0;
+
+    for (i = 0; i < BLOCK_64KB_NUM; i++) {
+        if (fw_bin_size > (i * SIZE_64KB)) {
+            // Calculate WR_Filechksum of each 64KB block
+            len_in_blk = min(fw_bin_size - i * SIZE_64KB, (size_t)SIZE_64KB);
+            WR_Filechksum[i] = i + 0x00 + 0x00 + (((len_in_blk - 1) >> 8) & 0xFF) + ((len_in_blk - 1) & 0xFF);
+            for (k = 0; k < len_in_blk; k++) {
+                WR_Filechksum[i] += fw->data[k + i * SIZE_64KB];
+            }
+            WR_Filechksum[i] = 65535 - WR_Filechksum[i] + 1;
+
+            // Fast Read Command
+            buf[0] = 0x00;
+            buf[1] = 0x07;
+            buf[2] = i;
+            buf[3] = 0x00;
+            buf[4] = 0x00;
+            buf[5] = ((len_in_blk - 1) >> 8) & 0xFF;
+            buf[6] = (len_in_blk - 1) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_HW_Address, buf, 7);
+            if (ret < 0) {
+                TPD_INFO("Fast Read Command error!\n");
+                return ret;
+            }
+            // Check 0xAA (Fast Read Command)
+            retry = 0;
+            while (1) {
+                msleep(80);
+                buf[0] = 0x00;
+                buf[1] = 0x00;
+                ret = nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2);
+                if (ret < 0) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) error!\n");
+                    return ret;
+                }
+                if (buf[1] == 0xAA) {
+                    break;
+                }
+                retry++;
+                if (unlikely(retry > 5)) {
+                    TPD_INFO("Check 0xAA (Fast Read Command) failed, buf[1]=0x%02X, retry=%d\n", buf[1], retry);
+                    return -1;
+                }
+            }
+            // Read Checksum (write addr high byte & middle byte)
+            buf[0] = 0xFF;
+            buf[1] = XDATA_Addr >> 16;
+            buf[2] = (XDATA_Addr >> 8) & 0xFF;
+            ret = nvt_i2c_write(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum (write addr high byte & middle byte) error!\n");
+                return ret;
+            }
+            // Read Checksum
+            buf[0] = (XDATA_Addr) & 0xFF;
+            buf[1] = 0x00;
+            buf[2] = 0x00;
+            ret = nvt_i2c_read(chip_info->client, I2C_BLDR_Address, buf, 3);
+            if (ret < 0) {
+                TPD_INFO("Read Checksum error!\n");
+                return ret;
+            }
+
+            RD_Filechksum[i] = (uint16_t)((buf[2] << 8) | buf[1]);
+            if (WR_Filechksum[i] != RD_Filechksum[i]) {
+                TPD_INFO("Verify Fail%d!\n", i);
+                TPD_INFO("RD_Filechksum[%d]=0x%04X, WR_Filechksum[%d]=0x%04X\n", i, RD_Filechksum[i], i, WR_Filechksum[i]);
+                return -1;
+            }
+        }
+    }
+
+    TPD_INFO("Verify OK \n");
+    return 0;
+}
+/****** End of other functions that work for oppo_touchpanel_operations callbacks*************/
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int nvt_ftm_process(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    TPD_INFO("%s is called!\n", __func__);
+    ret = nvt_get_chip_info(chip_info);
+    if (!ret) {
+        nvt_bootloader_reset(chip_info);
+        nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN);
+        ret = nvt_enter_sleep(chip_info, true);
+    }
+
+    return ret;
+}
+
+static int nvt_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+//return 0--success; return -EVODEV -- failed;
+int32_t nvt_detect_chip(struct chip_data_nt36672 *chip_info)
+{
+        uint8_t buf[2] = {0};
+
+        if (nvt_i2c_read(chip_info->client, I2C_HW_Address, buf, 2) < 0) {
+                return -ENODEV;
+        }
+
+        return 0;
+}
+
+static int nvt_get_chip_info(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    //check i2c ok, avoid too much i2c error log
+    ret = nvt_detect_chip(chip_info);
+    if(ret < 0) {
+        TPD_INFO("no find novatek chip or i2c fatal error\n");
+        return -EINVAL;
+    }
+
+    //---check chip version trim---
+    ret = nvt_check_chip_ver_trim(chip_info);
+    if (ret) {
+        TPD_INFO("chip is not identified\n");
+        ret = -EINVAL;
+    }
+
+    return ret;
+}
+
+static int nvt_power_control(void *chip_data, bool enable)
+{
+    return 0;
+}
+
+static int nvt_reset_gpio_control(void *chip_data, bool enable)
+{
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+        TPD_INFO("%s: set reset state %d\n", __func__, enable);
+        gpio_set_value(chip_info->hw_res->reset_gpio, enable);
+    }
+
+    return 0;
+}
+
+static fw_check_state nvt_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint8_t ver_len = 0;
+    int ret = 0;
+    char dev_version[MAX_DEVICE_VERSION_LENGTH] = {0};
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    nvt_bootloader_reset(chip_info);
+    ret = nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+    ret |= nvt_get_fw_info(chip_info);
+    if (ret < 0) {
+        TPD_INFO("%s: get fw info failed\n", __func__);
+        return FW_ABNORMAL;
+    } else {
+        panel_data->TP_FW = chip_info->fw_ver;
+        sprintf(dev_version, "%02x", panel_data->TP_FW);
+        if (panel_data->manufacture_info.version) {
+            ver_len = strlen(panel_data->manufacture_info.version);
+            if (ver_len <= 8) {
+                strlcat(panel_data->manufacture_info.version, dev_version, MAX_DEVICE_VERSION_LENGTH);
+            } else {
+                strlcpy(&panel_data->manufacture_info.version[8], dev_version, MAX_DEVICE_VERSION_LENGTH - 8);
+            }
+        }
+    }
+
+    return FW_NORMAL;
+}
+
+static fw_update_state nvt_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret = -1;
+    fw_update_state update_state = FW_NO_NEED_UPDATE;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return FW_NO_NEED_UPDATE;
+    }
+
+    if (fw->size != FW_BIN_SIZE) {
+        TPD_INFO("bin file size not match, size is %lu\n", fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+
+    if (*(fw->data + FW_BIN_VER_OFFSET) + *(fw->data + FW_BIN_VER_BAR_OFFSET) != 0xFF) {
+        TPD_INFO("bin file FW_VER(0x%02x) + FW_VER_BAR(0x%02x) should be 0xFF\n", *(fw->data+FW_BIN_VER_OFFSET), *(fw->data+FW_BIN_VER_BAR_OFFSET));
+        return FW_NO_NEED_UPDATE;
+    }
+
+    nvt_sw_reset_idle(chip_info);
+    if (!force) {
+        TPD_INFO("no force update!\n");
+        ret = Check_CheckSum(chip_info, fw);//-1:error, 0:not match, 1:match
+        if (((ret == 0) && (Check_FW_Ver(chip_info, fw) == 1)) || (ret == 1)) {
+            TPD_INFO("no need update!\n");
+            goto OUT;
+        }
+    }
+
+    // Step 1: stop crc check
+    nvt_stop_crc_reboot(chip_data);
+
+    // Step 2 : initial bootloader
+    TPD_INFO("Init BootLoader start\n");
+    ret = Init_BootLoader(chip_info);
+    if (ret) {
+        TPD_INFO("Init BootLoader failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 3 : Resume PD
+    TPD_INFO("Resume PD start\n");
+    ret = Resume_PD(chip_info);
+    if (ret) {
+        TPD_INFO("Resume PD failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 4 : Erase
+    TPD_INFO("Erase Flash start\n");
+    ret = Erase_Flash(chip_info, fw->size);
+    if (ret) {
+        TPD_INFO("Erase Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step 5 : Program
+    TPD_INFO("Write Flash start\n");
+    ret = Write_Flash(chip_info, fw);
+    if (ret) {
+        TPD_INFO("Write Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    // Step  6: Verify
+    TPD_INFO("Verify Flash start\n");
+    ret = Verify_Flash(chip_info, fw);
+    if (ret) {
+        TPD_INFO("Verify Flash failed, exit!\n");
+        update_state = FW_UPDATE_ERROR;
+        goto OUT;
+    }
+
+    update_state = FW_UPDATE_SUCCESS;
+
+OUT:
+    //Step 7 : Bootloader Reset
+    nvt_bootloader_reset(chip_info);
+    nvt_check_fw_reset_state(chip_info, RESET_STATE_INIT);
+
+    TPD_INFO("update firmware state: %s\n", (update_state == FW_UPDATE_SUCCESS)? "update success!":\
+                                            (update_state == FW_UPDATE_ERROR)? "update failed!": "no need update!");
+    return update_state;
+}
+
+static u8 nvt_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    //struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    if ((gesture_enable == 1) && is_suspended) {
+        return IRQ_GESTURE;
+    } else if (is_suspended) {
+        return IRQ_IGNORE;
+    }
+
+    return IRQ_TOUCH;
+}
+
+static int nvt_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int obj_attention = 0;
+    uint8_t pointid = 0;//range from 1 to 10
+    uint8_t point_state = 0;
+    uint32_t position = 0;
+    uint32_t input_x, input_y, input_w, input_p;
+    int ret = 0;
+    int i = 0;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    uint8_t buf[POINT_DATA_LEN + 1] = {0};
+
+    memset(buf, 0, sizeof(buf));
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, POINT_DATA_LEN + 1);
+    if (ret < 0) {
+        TPD_INFO("read touch data failed\n");
+        return -1;
+    }
+
+    for(i = 0; i < max_num; i++) {
+        position = 1 + 6 * i;
+        pointid = (uint8_t)(buf[position + 0] >> 3) - 1;
+        if (pointid >= max_num) {
+            continue;
+        }
+
+        point_state = buf[position] & 0x07;
+        if ((point_state == 0x01) || (point_state == 0x02)) {
+            input_x = (uint32_t)(buf[position + 1] << 4) + (uint32_t) (buf[position + 3] >> 4);
+            input_y = (uint32_t)(buf[position + 2] << 4) + (uint32_t) (buf[position + 3] & 0x0F);
+            input_w = (uint32_t)(buf[position + 4]);
+            if (input_w == 0) {
+                input_w = 1;
+            }
+            if (i < 2) {
+                input_p = (uint32_t)(buf[position + 5]) + (uint32_t)(buf[i + 63] << 8);
+                if (input_p > 1000) {
+                    input_p = 1000;
+                }
+            } else {
+                input_p = (uint32_t)(buf[position + 5]);
+            }
+            if (input_p == 0) {
+                input_p = 1;
+            }
+
+            obj_attention = obj_attention | (1 << pointid);
+            points[pointid].x = input_x;
+            points[pointid].y = input_y;
+            points[pointid].z = input_p;
+            points[pointid].width_major = input_w;
+            points[pointid].status = 1;
+        }
+    }
+
+    return obj_attention;
+}
+
+static int nvt_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    uint8_t gesture_id = 0;
+    uint8_t func_type = 0;
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    uint8_t point_data[POINT_DATA_LEN + 1] = {0};
+
+    memset(point_data, 0, sizeof(point_data));
+    ret = nvt_i2c_read(chip_info->client, I2C_FW_Address, point_data, POINT_DATA_LEN + 1);
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture data failed\n", __func__);
+        return -1;
+    }
+
+    gesture_id = (uint8_t)(point_data[1] >> 3);
+    func_type = (uint8_t)point_data[2];
+    if ((gesture_id == 30) && (func_type == 1)) {
+        gesture_id = (uint8_t)point_data[3];
+    } else if (gesture_id > 30) {
+        TPD_INFO("invalid gesture id= %d, no gesture event\n", gesture_id);
+        return 0;
+    }
+    switch (gesture_id)     //judge gesture type
+    {
+        case RIGHT_SLIDE_DETECT :
+            gesture->gesture_type  = Left2RightSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_SLIDE_DETECT :
+            gesture->gesture_type  = Right2LeftSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_SLIDE_DETECT  :
+            gesture->gesture_type  = Up2DownSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case UP_SLIDE_DETECT :
+            gesture->gesture_type  = Down2UpSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DTAP_DETECT:
+            gesture->gesture_type  = DouTap;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end     = gesture->Point_start;
+            break;
+
+        case UP_VEE_DETECT :
+            gesture->gesture_type  = UpVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_VEE_DETECT :
+            gesture->gesture_type  = DownVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_VEE_DETECT:
+            gesture->gesture_type = LeftVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case RIGHT_VEE_DETECT :
+            gesture->gesture_type  = RightVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case CIRCLE_DETECT  :
+            gesture->gesture_type = Circle;
+            gesture->clockwise = (point_data[43] == 0x20) ? 1 : 0;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;    //ymin
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;  //xmin
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;  //ymax
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_4th.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;  //xmax
+            gesture->Point_4th.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[24] & 0xFF) | (point_data[25] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[26] & 0xFF) | (point_data[27] & 0x0F) << 8;
+            break;
+
+        case DOUSWIP_DETECT  :
+            gesture->gesture_type  = DouSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            break;
+
+        case M_DETECT  :
+            gesture->gesture_type  = Mgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        case W_DETECT :
+            gesture->gesture_type  = Wgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        default:
+            gesture->gesture_type = UnkownGesture;
+            break;
+    }
+
+    TPD_INFO("%s, gesture_id: 0x%x, func_type: 0x%x, gesture_type: %d, clockwise: %d, points: (%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)\n", \
+                __func__, gesture_id, func_type, gesture->gesture_type, gesture->clockwise, \
+                gesture->Point_start.x, gesture->Point_start.y, \
+                gesture->Point_end.x, gesture->Point_end.y, \
+                gesture->Point_1st.x, gesture->Point_1st.y, \
+                gesture->Point_2nd.x, gesture->Point_2nd.y, \
+                gesture->Point_3rd.x, gesture->Point_3rd.y, \
+                gesture->Point_4th.x, gesture->Point_4th.y);
+
+    return 0;
+}
+
+static int nvt_enable_jitter_mode(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_JITTER_ON);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_JITTER_OFF);
+    }
+
+    return ret;
+}
+
+static int nvt_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;
+            break;
+
+        case MODE_SLEEP:
+            ret = nvt_enter_sleep(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enter sleep failed\n", __func__);
+            }
+            break;
+
+        case MODE_GESTURE:
+            ret = nvt_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable gesture failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = nvt_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable edg limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = nvt_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        case MODE_GAME:
+            ret = nvt_enable_jitter_mode(chip_info, flag);
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int nvt_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+#endif
+
+static void nvt_black_screen_test(void *chip_data, char *message)
+{
+    int32_t *raw_data = NULL, *raw_data_n = NULL;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    int tx_num = chip_info->hw_res->TX_NUM;
+    int rx_num = chip_info->hw_res->RX_NUM;
+    const struct firmware *fw = NULL;
+    struct nvt_test_header *ph = NULL;
+    int i, j, iArrayIndex, err_cnt = 0;
+    int fd = -1, ret = -1;
+    mm_segment_t old_fs;
+    char buf[128] = {0};
+    uint8_t data_buf[128];
+    int32_t buf_len = 0;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    int32_t *lpwg_rawdata_P = NULL, *lpwg_rawdata_N = NULL;
+    int32_t *lpwg_diff_rawdata_P = NULL, *lpwg_diff_rawdata_N = NULL;
+
+    if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+        TPD_INFO("switch frequency hopping disable failed!\n");
+        sprintf(message, "1 error, switch frequency hopping disable failed!\n");
+        return;
+    }
+
+    if (nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN)) {
+        TPD_INFO("check fw reset state failed!\n");
+        sprintf(message, "1 error, check fw reset state failed!\n");
+        return;
+    }
+
+    msleep(100);
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        TPD_INFO("clear fw status failed!\n");
+        sprintf(message, "1 error, clear fw status failed!\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, TEST_MODE_2);
+
+    if (nvt_check_fw_status(chip_info)) {
+        TPD_INFO("check fw status failed!\n");
+        sprintf(message, "1 error, check fw status failed!\n");
+        return;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        TPD_INFO("get fw info failed!\n");
+        sprintf(message, "1 error, get fw info failed!\n");
+        return;
+    }
+
+    TPD_INFO("malloc raw_data space\n");
+    buf_len = tx_num * rx_num * sizeof(int32_t);
+    raw_data = kzalloc(buf_len, GFP_KERNEL);
+    raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+    if (!(raw_data && raw_data_n)) {
+        err_cnt++;
+        sprintf(buf, "kzalloc space failed\n");
+        goto KFREE_OUT;
+    }
+
+    ret = request_firmware(&fw, chip_info->test_limit_name, &chip_info->client->dev);
+    if (ret < 0) {
+        err_cnt++;
+        sprintf(buf, "Request firmware failed: %s\n", chip_info->test_limit_name);
+        goto KFREE_OUT;
+    }
+    ph = (struct nvt_test_header *)(fw->data);
+
+    //create a file to store test data in /sdcard/ScreenOffTpTestReport
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    snprintf(data_buf, 128, "/sdcard/TpTestReport/screenOff/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    sys_mkdir("/sdcard/TpTestReport/screenOff", 0666);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        err_cnt++;
+        sprintf(buf, "Open log file '%s' failed.\n", data_buf);
+        goto OUT;
+    }
+
+    lpwg_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_P_offset);
+    lpwg_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_N_offset);
+    lpwg_diff_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Diff_P_offset);
+    lpwg_diff_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Diff_N_offset);
+
+    //---FW Rawdata Test---
+    TPD_INFO("LPWG mode FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE0_ADDR, raw_data, buf_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE1_ADDR, raw_data, buf_len);
+    store_to_file(fd, "LPWG mode FW Rawdata:\n");
+    if ((ph->config_Lmt_LPWG_Rawdata_P != 0) && (ph->config_Lmt_LPWG_Rawdata_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Rawdata_N)) {
+                    TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Rawdata_N, ph->config_Lmt_LPWG_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_rawdata_N[iArrayIndex], lpwg_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+
+    //---Noise Test---
+    TPD_INFO("LPWG mode FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("LPWG mode read Noise data failed!\n");    // 1: ERROR
+        sprintf(buf, "LPWG mode read Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    TPD_INFO("LPWG Noise RawData_Diff_Max:\n");
+    store_to_file(fd, "LPWG Noise RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_LPWG_Diff_P != 0) && (ph->config_Lmt_LPWG_Diff_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Diff_N, ph->config_Lmt_LPWG_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data_n[iArrayIndex], ph->config_Lmt_LPWG_Diff_N, ph->config_Lmt_LPWG_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data_n[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+OUT:
+    if (fd >= 0) {
+        sys_close(fd);
+    }
+    set_fs(old_fs);
+    release_firmware(fw);
+
+KFREE_OUT:
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_n)
+        kfree(raw_data_n);
+    sprintf(message, "%d errors. %s", err_cnt, buf);
+    TPD_INFO("%d errors. %s\n", err_cnt, buf);
+}
+
+static struct oppo_touchpanel_operations nvt_ops = {
+    .ftm_process                = nvt_ftm_process,
+    .get_vendor                 = nvt_get_vendor,
+    .get_chip_info              = nvt_get_chip_info,
+    .reset                      = nvt_reset,
+    .power_control              = nvt_power_control,
+    .fw_check                   = nvt_fw_check,
+    .fw_update                  = nvt_fw_update,
+    .trigger_reason             = nvt_trigger_reason,
+    .get_touch_points           = nvt_get_touch_points,
+    .get_gesture_info           = nvt_get_gesture_info,
+    .mode_switch                = nvt_mode_switch,
+    .get_usb_state              = nvt_get_usb_state,
+    .black_screen_test          = nvt_black_screen_test,
+    .reset_gpio_control         = nvt_reset_gpio_control,
+};
+/********* End of implementation of oppo_touchpanel_operations callbacks**********************/
+
+/************** Start of function work for debug_info proc callbacks**************************/
+
+static int32_t nvt_clear_fw_status(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 20;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---clear fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if (buf[1] == 0x00)
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("%s failed, i=%d, buf[1]=0x%02X\n", __func__, i, buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static void nvt_change_mode(struct chip_data_nt36672 *chip_info, uint8_t mode)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---set mode---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = mode;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+    if (mode == NORMAL_MODE) {
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = HANDSHAKING_HOST_READY;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+        msleep(20);
+    }
+}
+
+static int32_t nvt_check_fw_status(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    int ret = -1;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        ret |= nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("%s write or read failed\n", __func__);
+        }
+
+        if ((buf[1] & 0xF0) == 0xA0)
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("%s failed, i=%d, buf[1]=0x%02X\n", __func__, i, buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static uint8_t nvt_get_fw_pipe(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8]= {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read fw status---
+    buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+    buf[1] = 0x00;
+    ret |= nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("%s: read or write failed\n", __func__);
+    }
+
+    return (buf[1] & 0x01);
+}
+
+void nvt_read_mdata(struct chip_data_nt36672 *chip_info, uint32_t xdata_addr, int32_t *xdata, int32_t xdata_len)
+{
+    int32_t i = 0;
+    int32_t j = 0;
+    int32_t k = 0;
+    uint8_t buf[I2C_TANSFER_LENGTH + 1] = {0};
+    uint32_t head_addr = 0;
+    int32_t dummy_len = 0;
+    int32_t data_len = 0;
+    int32_t residual_len = 0;
+    uint8_t *xdata_tmp = NULL;
+
+    //---set xdata sector address & length---
+    head_addr = xdata_addr - (xdata_addr % XDATA_SECTOR_SIZE);
+    dummy_len = xdata_addr - head_addr;
+    data_len = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2;
+    residual_len = (head_addr + dummy_len + data_len) % XDATA_SECTOR_SIZE;
+
+    if (xdata_len/sizeof(int32_t) < data_len/2) {
+        TPD_INFO("xdata read buffer(%d) less than max data size(%d), return\n", xdata_len, data_len);
+        return;
+    }
+
+    //malloc buffer space
+    xdata_tmp = kzalloc(2048 ,GFP_KERNEL);
+    if (xdata_tmp == NULL) {
+        TPD_INFO("%s malloc memory failed\n", __func__);
+        return;
+    }
+    //printk("head_addr=0x%05X, dummy_len=0x%05X, data_len=0x%05X, residual_len=0x%05X\n", head_addr, dummy_len, data_len, residual_len);
+
+    //read xdata : step 1
+    for (i = 0; i < ((dummy_len + data_len) / XDATA_SECTOR_SIZE); i++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((head_addr + XDATA_SECTOR_SIZE * i) >> 16) & 0xFF;
+        buf[2] = ((head_addr + XDATA_SECTOR_SIZE * i) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read xdata by I2C_TANSFER_LENGTH
+        for (j = 0; j < (XDATA_SECTOR_SIZE / I2C_TANSFER_LENGTH); j++) {
+            //---read data---
+            buf[0] = I2C_TANSFER_LENGTH * j;
+            nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, I2C_TANSFER_LENGTH + 1);
+
+            //---copy buf to xdata_tmp---
+            for (k = 0; k < I2C_TANSFER_LENGTH; k++) {
+                xdata_tmp[XDATA_SECTOR_SIZE * i + I2C_TANSFER_LENGTH * j + k] = buf[k + 1];
+                //printk("0x%02X, 0x%04X\n", buf[k+1], (XDATA_SECTOR_SIZE*i + I2C_TANSFER_LENGTH*j + k));
+            }
+        }
+        //printk("addr=0x%05X\n", (head_addr+XDATA_SECTOR_SIZE*i));
+    }
+
+    //read xdata : step2
+    if (residual_len != 0) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((xdata_addr + data_len - residual_len) >> 16) & 0xFF;
+        buf[2] = ((xdata_addr + data_len - residual_len) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read xdata by I2C_TANSFER_LENGTH
+        for (j = 0; j < (residual_len / I2C_TANSFER_LENGTH + 1); j++) {
+            //---read data---
+            buf[0] = I2C_TANSFER_LENGTH * j;
+            nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, I2C_TANSFER_LENGTH + 1);
+
+            //---copy buf to xdata_tmp---
+            for (k = 0; k < I2C_TANSFER_LENGTH; k++) {
+                xdata_tmp[(dummy_len + data_len - residual_len) + I2C_TANSFER_LENGTH * j + k] = buf[k + 1];
+                //printk("0x%02X, 0x%04x\n", buf[k+1], ((dummy_len+data_len-residual_len) + I2C_TANSFER_LENGTH*j + k));
+            }
+        }
+        //printk("addr=0x%05X\n", (xdata_addr+data_len-residual_len));
+    }
+
+    //---remove dummy data and 2bytes-to-1data---
+    for (i = 0; i < (data_len / 2); i++) {
+        xdata[i] = (int16_t)(xdata_tmp[dummy_len + i * 2] + 256 * xdata_tmp[dummy_len + i * 2 + 1]);
+    }
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    kfree(xdata_tmp);
+}
+
+static void nvt_data_read(struct seq_file *s, struct chip_data_nt36672 *chip_info, DEBUG_READ_TYPE read_type)
+{
+    int ret = -1;
+    int i, j;
+    uint8_t pipe;
+    int32_t *xdata = NULL;
+    int32_t buf_len = 0;
+
+    TPD_INFO("nvt clear fw status start\n");
+    ret = nvt_clear_fw_status(chip_info);
+    if (ret < 0) {
+        TPD_INFO("clear_fw_status error, return\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, TEST_MODE_2);
+
+    TPD_INFO("nvt check fw status start\n");
+    ret = nvt_check_fw_status(chip_info);
+    if (ret < 0) {
+        TPD_INFO("check_fw_status error, return\n");
+        return;
+    }
+
+    TPD_INFO("nvt get fw info start");
+    ret = nvt_get_fw_info(chip_info);
+    if (ret < 0) {
+        TPD_INFO("get_fw_info error, return\n");
+        return;
+    }
+
+    buf_len = chip_info->hw_res->TX_NUM*chip_info->hw_res->RX_NUM*sizeof(int32_t);
+    xdata = kzalloc(buf_len, GFP_KERNEL);
+    if (!xdata) {
+        TPD_INFO("%s, malloc memory failed\n", __func__);
+        return;
+    }
+
+    pipe = nvt_get_fw_pipe(chip_info);
+    TPD_INFO("nvt_get_fw_pipe:%d\n", pipe);
+    switch (read_type) {
+        case NVT_RAWDATA:
+            seq_printf(s, "raw_data:\n");
+            if (pipe == 0)
+                nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE0_ADDR, xdata, buf_len);
+            else
+                nvt_read_mdata(chip_info, chip_info->mmap->RAW_PIPE1_ADDR, xdata, buf_len);
+            break;
+        case NVT_DIFFDATA:
+            seq_printf(s, "diff_data:\n");
+            if (pipe == 0)
+                nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, xdata, buf_len);
+            else
+                nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, xdata, buf_len);
+            break;
+        case NVT_BASEDATA:
+            seq_printf(s, "basline_data:\n");
+            nvt_read_mdata(chip_info, chip_info->mmap->BASELINE_ADDR, xdata, buf_len);
+            break;
+        default:
+            seq_printf(s, "read type not support\n");
+            break;
+    }
+
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    TPD_INFO("change normal mode end\n");
+
+    //print all data
+    for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+        seq_printf(s, "[%2d]", i);
+        for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+            seq_printf(s, "%5d, ", xdata[i * chip_info->hw_res->TX_NUM + j]);
+        }
+        seq_printf(s, "\n");
+    }
+
+    kfree(xdata);
+}
+
+/*************** End of function work for debug_info proc callbacks***************************/
+
+
+/************** Start of implementation of debug_info proc callbacks**************************/
+static void nvt_delta_read(struct seq_file *s, void *chip_data)
+{
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    nvt_data_read(s, chip_info, NVT_DIFFDATA);
+}
+
+static void nvt_baseline_read(struct seq_file *s, void *chip_data)
+{
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    nvt_data_read(s, chip_info, NVT_BASEDATA);
+    nvt_data_read(s, chip_info, NVT_RAWDATA);
+}
+
+static void nvt_main_register_read(struct seq_file *s, void *chip_data)
+{
+    uint8_t buf[3];
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---read cmd status---
+    buf[0] = 0x5E;
+    buf[1] = 0xFF;
+    nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+    seq_printf(s, "PWR_FLAG:%d\n", (buf[1]>> PWR_FLAG) & 0x01);
+    seq_printf(s, "EDGE_REGECT:%d\n", (buf[1]>> EDGE_REGECT) & 0x01);
+    seq_printf(s, "JITTER_FLAG:%d\n", (buf[1]>> JITTER_FLAG) & 0x01);
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = nvt_limit_read,
+    .delta_read    = nvt_delta_read,
+    .baseline_read = nvt_baseline_read,
+    .main_register_read = nvt_main_register_read,
+};
+/***************** End of implementation of debug_info proc callbacks*************************/
+
+/************** Start of implementation of baseline_test proc callbacks***********************/
+static int8_t nvt_switch_FreqHopEnDis(struct chip_data_nt36672 *chip_info, uint8_t FreqHopEnDis)
+{
+    uint8_t buf[8] = {0};
+    uint8_t retry = 0;
+    int8_t ret = 0;
+
+    for (retry = 0; retry < 20; retry++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---switch FreqHopEnDis---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = FreqHopEnDis;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 2);
+
+        msleep(35);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(retry == 20)) {
+        TPD_INFO("switch FreqHopEnDis 0x%02X failed, buf[1]=0x%02X\n", FreqHopEnDis, buf[1]);
+        ret = -1;
+    }
+
+    return ret;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static void nvt_enable_noise_collect(struct chip_data_nt36672 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x47;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int32_t nvt_polling_hand_shake_status(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        buf[0] = 0xFF;
+        buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+        buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, 2);
+
+        if ((buf[1] == 0xA0) || (buf[1] == 0xA1))
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("polling hand shake status failed, buf[1]=0x%02X\n", buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static int32_t nvt_read_fw_noise(struct chip_data_nt36672 *chip_info, int32_t config_Diff_Test_Frame, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint32_t x = 0;
+    uint32_t y = 0;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw nosie buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Diff_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Diff_Test_Frame * 8.3ms
+    msleep(frame_num * 83);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, xdata, xdata_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, xdata, xdata_len);
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF);
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF);
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_doze_noise_collect(struct chip_data_nt36672 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    ret = nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x4B;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int32_t nvt_read_doze_fw_noise(struct chip_data_nt36672 *chip_info, int32_t config_Doze_Noise_Test_Frame, int32_t doze_X_Channel,int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint8_t buf[128] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < rx_num * doze_X_Channel) {
+        TPD_INFO("read doze nosie buffer(%d) less than data size(%d)\n", xdata_len, rx_num * doze_X_Channel);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Doze_Noise_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_doze_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Doze_Noise_Test_Frame * 8.3ms
+    msleep(frame_num * 83);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) >> 16) & 0xFF;
+        buf[2] = ((chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read data---
+        buf[0] = (chip_info->mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) & 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, rx_num * 2 + 1);
+
+        for (y = 0; y < rx_num; y++) {
+            xdata[y * doze_X_Channel + x] = (uint16_t)(buf[y * doze_X_Channel + 1] + 256 * buf[y * doze_X_Channel + 2]);
+        }
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF) * 4;
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF) * 4;    //scaling up
+        }
+    }
+
+    //---Leave Test Mode---
+    //nvt_change_mode(NORMAL_MODE);    //No return to normal mode. Continuous to get doze rawdata
+
+    return 0;
+}
+
+static int32_t nvt_read_doze_baseline(struct chip_data_nt36672 *chip_info, int32_t doze_X_Channel, int32_t *xdata, int32_t xdata_len)
+{
+    uint8_t buf[128] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rm_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+
+    //---Enter Test Mode---
+    //nvt_change_mode(TEST_MODE_2);
+
+    //if (nvt_check_fw_status()) {
+    //    return -EAGAIN;
+    //}
+    if (xdata_len/sizeof(int32_t) < rm_num * doze_X_Channel) {
+        TPD_INFO("read doze baseline buffer(%d) less than data size(%d)\n", xdata_len, rm_num * doze_X_Channel);
+        return -1;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = ((chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) >> 16) & 0xFF;
+        buf[2] = ((chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) >> 8) & 0xFF;
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+        //---read data---
+        buf[0] = (chip_info->mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) & 0xFF;
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, rm_num * 2 + 1);
+        for (y = 0; y < rm_num; y++) {
+            xdata[y * 2 + x] = (uint16_t)(buf[y * 2 + 1] + 256 * buf[y * 2 + 2]);
+        }
+    }
+
+    for (y = 0; y < rm_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata[iArrayIndex] = (int16_t)xdata[iArrayIndex];
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_short_test(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable short test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x43;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+}
+
+static int32_t nvt_read_fw_short(struct chip_data_nt36672 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint8_t buf[128] = {0};
+    int32_t iArrayIndex = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw short buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_short_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = (uint8_t)(((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) >> 16) & 0xFF);
+        buf[2] = (uint8_t)(((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) >> 8) & 0xFF);
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) & 0xFF);
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, chip_info->hw_res->TX_NUM * 2 + 1);
+        memcpy(rawdata_buf + y * chip_info->hw_res->TX_NUM * 2, buf + 1, chip_info->hw_res->TX_NUM * 2);
+    }
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata[iArrayIndex] = (int16_t)(rawdata_buf[iArrayIndex * 2] + 256 * rawdata_buf[iArrayIndex * 2 + 1]);
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_open_test(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    buf[0] = 0xFF;
+    buf[1] = (chip_info->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
+    buf[2] = (chip_info->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+
+    //---enable open test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x45;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 5);
+}
+
+static bool nvt_is_NT36672A(struct chip_data_nt36672 *chip_inf)
+{
+    int i = 0;
+    uint8_t nvt_36672A[NVT_ID_BYTE_MAX] = {0x0A, 0xFF, 0xFF, 0x72, 0x66, 0x03};
+
+    for (i = 0; i < NVT_ID_BYTE_MAX; i++) {
+        if (chip_inf->id[i] != nvt_36672A[i]) {
+            return false;
+        }
+    }
+
+    return true;
+}
+
+static int32_t nvt_read_fw_open(struct chip_data_nt36672 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0, y = 0;
+    uint32_t tx_num = chip_info->hw_res->TX_NUM;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    uint8_t buf[128] = {0};
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw open buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_open_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(tx_num * rx_num * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < rx_num; y++) {
+        //---change xdata index---
+        buf[0] = 0xFF;
+        buf[1] = (uint8_t)(((raw_pipe_addr + y * tx_num * 2) >> 16) & 0xFF);
+        buf[2] = (uint8_t)(((raw_pipe_addr + y * tx_num * 2) >> 8) & 0xFF);
+        nvt_i2c_write(chip_info->client, I2C_FW_Address, buf, 3);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * tx_num * 2) & 0xFF);
+        nvt_i2c_read(chip_info->client, I2C_FW_Address, buf, tx_num * 2 + 1);
+        memcpy(rawdata_buf + y * tx_num * 2, buf + 1, tx_num * 2);
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < tx_num; x++) {
+            if (nvt_is_NT36672A(chip_info)) { /*for 36672A*/
+                xdata[(y*tx_num + x)] = (int16_t)((rawdata_buf[(y*tx_num + x)*2] + 256 * rawdata_buf[(y*tx_num + x)*2 + 1]));
+            } else {
+                xdata[(rx_num-y-1) * tx_num + (tx_num-x-1)] = (int16_t)((rawdata_buf[(y*tx_num + x)*2] + 256 * rawdata_buf[(y*tx_num + x)*2 + 1]));
+            }
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_auto_test(struct seq_file *s, void *chip_data, struct nvt_testdata *nvt_testdata)
+{
+    int32_t *raw_data = NULL;
+    int32_t *raw_data_n = NULL;
+    int i, j, buf_len = 0;
+    int err_cnt = 0;
+    int32_t iArrayIndex = 0;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    struct nvt_test_header *ph = NULL;
+    int32_t *fw_rawdata_P = NULL, *fw_rawdata_N = NULL;
+    int32_t *open_rawdata_P = NULL, *open_rawdata_N = NULL;
+    int32_t *short_rawdata_P = NULL, *short_rawdata_N = NULL;
+    int32_t *diff_rawdata_P = NULL, *diff_rawdata_N = NULL;
+    int32_t *cc_data_P = NULL, *cc_data_N = NULL;
+    int32_t *doze_rawdata_P = NULL, *doze_rawdata_N = NULL;
+    int32_t *doze_diff_rawdata_P = NULL, *doze_diff_rawdata_N = NULL;
+
+    if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+        TPD_INFO("switch frequency hopping disable failed!\n");
+        store_to_file(nvt_testdata->fd, "switch frequency hopping disable failed!\n");
+        seq_printf(s, "switch frequency hopping disable failed!\n");
+        return;
+    }
+
+    if (nvt_check_fw_reset_state(chip_info, RESET_STATE_NORMAL_RUN)) {
+        TPD_INFO("check fw reset state failed!\n");
+        store_to_file(nvt_testdata->fd, "check fw reset state failed!\n");
+        seq_printf(s, "check fw reset state failed!\n");
+        return;
+    }
+
+    msleep(100);
+
+    //---Enter Test Mode---
+    TPD_INFO("enter test mode\n");
+    if (nvt_clear_fw_status(chip_info)) {
+        TPD_INFO("clear fw status failed!\n");
+        store_to_file(nvt_testdata->fd, "clear fw status failed!\n");
+        seq_printf(s, "clear fw status failed!\n");
+        return;
+    }
+
+    nvt_change_mode(chip_info, MP_MODE_CC);
+
+    if (nvt_check_fw_status(chip_info)) {
+        TPD_INFO("check fw status failed!\n");
+        store_to_file(nvt_testdata->fd, "check fw status failed!\n");
+        seq_printf(s, "check fw status failed!\n");
+        return;
+    }
+
+    if (nvt_get_fw_info(chip_info)) {
+        TPD_INFO("get fw info failed!\n");
+        store_to_file(nvt_testdata->fd, "get fw info failed!\n");
+        seq_printf(s, "get fw info failed!\n");
+        return;
+    }
+
+    TPD_INFO("malloc raw_data space\n");
+    buf_len = nvt_testdata->TX_NUM * nvt_testdata->RX_NUM * sizeof(int32_t);
+    raw_data = kzalloc(buf_len, GFP_KERNEL);
+    raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+    if (!(raw_data && raw_data_n)) {
+        err_cnt++;
+        store_to_file(nvt_testdata->fd, "malloc memory failed!\n");
+        seq_printf(s, "malloc memory failed!\n");
+        goto OUT;
+    }
+
+    //get test data
+    ph = (struct nvt_test_header *)(nvt_testdata->fw->data);
+    fw_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_P_offset);
+    fw_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_N_offset);
+    open_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_P_offset);
+    open_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_N_offset);
+    short_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_P_offset);
+    short_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_N_offset);
+    diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_P_offset);
+    diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_N_offset);
+    cc_data_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_P_offset);
+    cc_data_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_N_offset);
+    doze_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_P_offset);
+    doze_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_N_offset);
+    doze_diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_P_offset);
+    doze_diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_N_offset);
+
+    //---FW Rawdata Test---
+    TPD_INFO("FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    nvt_read_mdata(chip_info, chip_info->mmap->BASELINE_ADDR, raw_data, buf_len);
+    store_to_file(nvt_testdata->fd, "rawData:\n");
+    for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+        for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+            iArrayIndex = j * nvt_testdata->TX_NUM + i;
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+            }
+            if((raw_data[iArrayIndex] > fw_rawdata_P[iArrayIndex]) \
+                    || (raw_data[iArrayIndex] < fw_rawdata_N[iArrayIndex])) {
+                TPD_INFO("rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                if (!err_cnt) {
+                    seq_printf(s, "rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                }
+                err_cnt++;
+            }
+        }
+        if (nvt_testdata->fd >= 0) {
+            store_to_file(nvt_testdata->fd, "\n");
+        }
+    }
+
+    TPD_INFO("FW cc data test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE1_ADDR, raw_data, buf_len);
+    else
+        nvt_read_mdata(chip_info, chip_info->mmap->DIFF_PIPE0_ADDR, raw_data, buf_len);
+    store_to_file(nvt_testdata->fd, "ccData:\n");
+    if ((ph->config_Lmt_FW_CC_P != 0) && (ph->config_Lmt_FW_CC_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_FW_CC_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_FW_CC_N)) {
+                    TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > cc_data_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < cc_data_N[iArrayIndex])) {
+                    TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+
+    //---Noise Test---
+    TPD_INFO("FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("read Noise data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Noise data failed!\n");
+        seq_printf(s, "read Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_FW_Diff_P != 0) && (ph->config_Lmt_FW_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                    TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                    TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Noise Test---
+    TPD_INFO("Doze FW Noise Test \n");
+    memset(raw_data, 0, buf_len);  //store max
+    memset(raw_data_n, 0, buf_len); //store min
+    if (nvt_read_doze_fw_noise(chip_info, ph->config_Doze_Noise_Test_Frame, ph->doze_X_Channel, raw_data, raw_data_n, buf_len) != 0) {
+        TPD_INFO("read Doze Noise data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Doze Noise data failed!\n");
+        seq_printf(s, "read Doze Noise data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_Doze_Diff_P != 0) && (ph->config_Lmt_Doze_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                    TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                        || (raw_data_n[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                    TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Doze FW Rawdata Test---
+    TPD_INFO("Doze FW Rawdata Test \n");
+    memset(raw_data, 0, buf_len);
+    if(nvt_read_doze_baseline(chip_info, ph->doze_X_Channel, raw_data, buf_len) != 0) {
+        TPD_INFO("read Doze FW Rawdata failed!\n");
+        store_to_file(nvt_testdata->fd, "read Doze FW Rawdata failed!\n");
+        seq_printf(s, "read Doze FW Rawdata failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "Doze FW Rawdata:\n");
+    if ((ph->config_Lmt_Doze_Rawdata_P != 0) && (ph->config_Lmt_Doze_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Rawdata_N)) {
+                    TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //--Short Test---
+    TPD_INFO("FW Short Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_read_fw_short(chip_info, raw_data, buf_len) != 0) {
+        TPD_INFO("read Short test data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Short test data failed!\n");
+        seq_printf(s, "read Short test data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Short:\n");
+    if ((ph->config_Lmt_Short_Rawdata_P != 0) && (ph->config_Lmt_Short_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Short_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Short_Rawdata_N)) {
+                    TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                    if (!err_cnt) {
+                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > short_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < short_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+    //---Open Test---
+    TPD_INFO("FW Open Test \n");
+    memset(raw_data, 0, buf_len);
+    if (nvt_read_fw_open(chip_info, raw_data, buf_len) != 0) {
+        TPD_INFO("read Open test data failed!\n");
+        store_to_file(nvt_testdata->fd, "read Open test data failed!\n");
+        seq_printf(s, "read Open test data failed!\n");
+        err_cnt++;
+        goto OUT;
+    }
+    store_to_file(nvt_testdata->fd, "RawData_Open:\n");
+    for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+        for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+            iArrayIndex = j * nvt_testdata->TX_NUM + i;
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+            }
+            if((raw_data[iArrayIndex] > open_rawdata_P[iArrayIndex]) \
+                    || (raw_data[iArrayIndex] < open_rawdata_N[iArrayIndex])) {
+                TPD_INFO("Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                if (!err_cnt) {
+                    seq_printf(s, "Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                }
+                err_cnt++;
+            }
+        }
+        if (nvt_testdata->fd >= 0) {
+            store_to_file(nvt_testdata->fd, "\n");
+        }
+    }
+
+OUT:
+    //---Reset IC---
+    nvt_bootloader_reset(chip_info);
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_n)
+        kfree(raw_data_n);
+
+    seq_printf(s, "FW:0x%llx\n", nvt_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+}
+
+static struct nvt_proc_operations nvt_proc_ops = {
+    .auto_test     = nvt_auto_test,
+};
+/*************** End of implementation of baseline_test proc callbacks************************/
+
+/*********** Start of I2C Driver and Implementation of it's callbacks*************************/
+static int nvt_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_nt36672 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    /* 1. alloc chip info */
+    chip_info = kzalloc(sizeof(struct chip_data_nt36672), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. bind client and dev for easy operate */
+    chip_info->client = client;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    /* 4. file_operations callbacks binding */
+    ts->ts_ops = &nvt_ops;
+
+    /* 5. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0 && (ret != -EFTM)) {
+        goto err_register_driver;
+    }
+    ts->tp_suspend_order = TP_LCD_SUSPEND;
+    ts->tp_resume_order = LCD_TP_RESUME;
+    chip_info->is_sleep_writed = false;
+    chip_info->test_limit_name = ts->panel_data.test_limit_name;
+
+    /* 7. create nvt test files */
+    nvt_flash_proc_init(ts, "NVTflash");
+    nvt_create_proc(ts, &nvt_proc_ops);
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int nvt_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int nvt_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int nvt_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = nvt_i2c_suspend,
+    .resume = nvt_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver =
+{
+    .probe = nvt_tp_probe,
+    .remove = nvt_tp_remove,
+    .id_table = tp_id,
+    .driver = {
+        .name = TPD_DEVICE,
+        .owner = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+/******************* End of I2C Driver and It's dev_pm_ops***********************/
+
+/***********************Start of module init and exit****************************/
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+/***********************End of module init and exit*******************************/
+
+MODULE_AUTHOR("nvtTek Driver");
+MODULE_DESCRIPTION("nvtTek Touchscreen Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.h
new file mode 100644
index 0000000000000000000000000000000000000000..78bd07bd17418c06bf6eb2ed512fba9fb63b34db
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672/nvt_drivers_nt36672.h
@@ -0,0 +1,155 @@
+/***************************************************
+ * File:novatek_drivers_nt36672.h
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             novatek nt36672 driver
+ * Version:1.0:
+ * Date created:2017-09-15
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef NVT_H_NT36672
+#define NVT_H_NT36672
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../novatek_common.h"
+
+/*********PART2:Define Area**********************/
+#define I2C_HW_Address          0x62
+#define I2C_BLDR_Address        0x01
+#define I2C_FW_Address          0x01
+
+#define POINT_DATA_LEN          65
+#define NVT_ID_BYTE_MAX         6
+#define XDATA_SECTOR_SIZE       256
+#define I2C_TANSFER_LENGTH      64
+#define FW_BIN_SIZE_116KB       118784
+#define FW_BIN_SIZE             FW_BIN_SIZE_116KB
+#define FW_BIN_VER_OFFSET       0x1A000
+#define FW_BIN_VER_BAR_OFFSET   0x1A001
+#define BLOCK_64KB_NUM          4
+#define SIZE_64KB               65536
+#define FLASH_SECTOR_SIZE       4096
+
+#define NORMAL_MODE             0x00
+#define TEST_MODE_1             0x21
+#define TEST_MODE_2             0x22
+#define MP_MODE_CC              0x41
+#define FREQ_HOP_DISABLE        0x66
+#define FREQ_HOP_ENABLE         0x65
+#define HANDSHAKING_HOST_READY  0xBB
+
+#define EVENTBUFFER_EDGE_LIMIT_ON  0x79
+#define EVENTBUFFER_EDGE_LIMIT_OFF 0x7A
+#define EVENTBUFFER_PWR_PLUG_IN    0x53
+#define EVENTBUFFER_PWR_PLUG_OUT   0x51
+#define EVENTBUFFER_JITTER_ON    0x7D
+#define EVENTBUFFER_JITTER_OFF   0x7E
+
+#define DTAP_DETECT                     15
+#define UP_VEE_DETECT                   14
+#define DOWN_VEE_DETECT                 33
+#define LEFT_VEE_DETECT                 31
+#define RIGHT_VEE_DETECT                32
+#define CIRCLE_DETECT                   18
+#define DOUSWIP_DETECT                  34
+#define RIGHT_SLIDE_DETECT              24
+#define LEFT_SLIDE_DETECT               23
+#define DOWN_SLIDE_DETECT               22
+#define UP_SLIDE_DETECT                 21
+#define M_DETECT                        17
+#define W_DETECT                        13
+
+/*********PART3:Struct Area**********************/
+typedef enum
+{
+    PALM = 0,
+    GLOVE,
+    PWR_FLAG,
+    HOVER,
+    EDGE_REGECT,
+    JITTER_FLAG = 6
+}CMD_OFFSET;
+
+typedef enum {
+    RESET_STATE_INIT = 0xA0,    // IC reset
+    RESET_STATE_REK,            // ReK baseline
+    RESET_STATE_REK_FINISH,     // baseline is ready
+    RESET_STATE_NORMAL_RUN,     // normal run
+    RESET_STATE_MAX  = 0xAF
+} RST_COMPLETE_STATE;
+
+typedef enum {
+    NVT_RAWDATA,    //raw data
+    NVT_DIFFDATA,   //diff data
+    NVT_BASEDATA,   //baseline data
+}DEBUG_READ_TYPE;
+
+
+typedef enum {
+    EVENT_MAP_HOST_CMD                      = 0x50,
+    EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE   = 0x51,
+    EVENT_MAP_RESET_COMPLETE                = 0x60,
+    EVENT_MAP_FWINFO                        = 0x78,
+    EVENT_MAP_PROJECTID                     = 0x9A,
+} I2C_EVENT_MAP;
+
+struct nvt_mem_map {
+    uint32_t EVENT_BUF_ADDR;
+    uint32_t RAW_PIPE0_ADDR;
+    uint32_t RAW_PIPE0_Q_ADDR;
+    uint32_t RAW_PIPE1_ADDR;
+    uint32_t RAW_PIPE1_Q_ADDR;
+    uint32_t BASELINE_ADDR;
+    uint32_t BASELINE_Q_ADDR;
+    uint32_t BASELINE_BTN_ADDR;
+    uint32_t BASELINE_BTN_Q_ADDR;
+    uint32_t DIFF_PIPE0_ADDR;
+    uint32_t DIFF_PIPE0_Q_ADDR;
+    uint32_t DIFF_PIPE1_ADDR;
+    uint32_t DIFF_PIPE1_Q_ADDR;
+    uint32_t RAW_BTN_PIPE0_ADDR;
+    uint32_t RAW_BTN_PIPE0_Q_ADDR;
+    uint32_t RAW_BTN_PIPE1_ADDR;
+    uint32_t RAW_BTN_PIPE1_Q_ADDR;
+    uint32_t DIFF_BTN_PIPE0_ADDR;
+    uint32_t DIFF_BTN_PIPE0_Q_ADDR;
+    uint32_t DIFF_BTN_PIPE1_ADDR;
+    uint32_t DIFF_BTN_PIPE1_Q_ADDR;
+    uint32_t READ_FLASH_CHECKSUM_ADDR;
+    uint32_t RW_FLASH_DATA_ADDR;
+    uint32_t DOZE_GM_S1D_SCAN_RAW_ADDR;
+    uint32_t DOZE_GM_BTN_SCAN_RAW_ADDR;
+};
+
+struct nvt_trim_id_table {
+    uint8_t id[NVT_ID_BYTE_MAX];
+    uint8_t mask[NVT_ID_BYTE_MAX];
+    const struct nvt_mem_map *mmap;
+    uint8_t carrier_system;
+};
+
+struct chip_data_nt36672 {
+    tp_dev                          tp_type;
+    char                            *test_limit_name;
+    struct i2c_client               *client;
+    const struct nvt_mem_map       *mmap;
+    uint8_t                        id[NVT_ID_BYTE_MAX];
+    uint8_t                         carrier_system;
+    uint8_t                         fw_ver;
+    uint16_t                        nvt_pid;
+    struct hw_resource              *hw_res;
+    bool                            is_sleep_writed;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..8766270248b6e2d31276c8e9a2b41a47721f9d63
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Kconfig
@@ -0,0 +1,18 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for nova nt36672 ic driver
+
+config TOUCHPANEL_NOVA_NT36672
+#	default y
+	bool "TP nova nt36672 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing nova nt36672
+
+
+config TOUCHPANEL_NOVA_NT36672_NOFLASH
+#	default y
+	bool "TP nova nt36672 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing nova nt36672
+
+#endif
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..406974f0373fece056611232738ed6276d510522
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/Makefile
@@ -0,0 +1,15 @@
+#
+# Makefile for the touchscreen drivers.
+#
+ifeq ($(CONFIG_TRUSTONIC_TEE_SUPPORT),y)
+subdir-ccflags-y += -I$(srctree)/drivers/spi/trustzone/spi/Tlspi/inc
+endif
+
+ifeq ($(CONFIG_TRUSTONIC_TEE_SUPPORT),y)
+	include $(srctree)/drivers/misc/mediatek/gud/Makefile.include
+endif
+subdir-ccflags-y += -I$(srctree)/drivers/spi/mediatek/mt6763/
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_NOVA_NT36672_NOFLASH) += nvt_drivers_nt36672_noflash.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/driver_spi.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/driver_spi.h
new file mode 100644
index 0000000000000000000000000000000000000000..fca04376f273311c08f7ba58f29c9fd49083a8f6
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/driver_spi.h
@@ -0,0 +1,118 @@
+/*
+* Copyright (C) 2016 MediaTek Inc.
+*
+* 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.
+*
+* This program is distributed in the hope that it will be useful,
+* but WITHOUT ANY WARRANTY; without even the implied warranty of
+* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
+* See http://www.gnu.org/licenses/gpl-2.0.html for more details.
+*/
+
+#ifndef __MTK_SPI_H__
+#define __MTK_SPI_H__
+
+
+#include <linux/types.h>
+#include <linux/io.h>
+#ifdef CONFIG_TRUSTONIC_TEE_SUPPORT
+#include <mobicore_driver_api.h>
+#include <tlspi_Api.h>
+#endif
+/*******************************************************************************
+* define struct for spi driver
+********************************************************************************/
+enum spi_sample_sel {
+	POSEDGE,
+	NEGEDGE
+};
+enum spi_cs_pol {
+	ACTIVE_LOW,
+	ACTIVE_HIGH
+};
+
+enum spi_cpol {
+	SPI_CPOL_0,
+	SPI_CPOL_1
+};
+
+enum spi_cpha {
+	SPI_CPHA_0,
+	SPI_CPHA_1
+};
+
+enum spi_mlsb {
+	SPI_LSB,
+	SPI_MSB
+};
+
+enum spi_endian {
+	SPI_LENDIAN,
+	SPI_BENDIAN
+};
+
+enum spi_transfer_mode {
+	FIFO_TRANSFER,
+	DMA_TRANSFER,
+	OTHER1,
+	OTHER2,
+};
+
+enum spi_pause_mode {
+	PAUSE_MODE_DISABLE,
+	PAUSE_MODE_ENABLE
+};
+enum spi_finish_intr {
+	FINISH_INTR_DIS,
+	FINISH_INTR_EN,
+};
+
+enum spi_deassert_mode {
+	DEASSERT_DISABLE,
+	DEASSERT_ENABLE
+};
+
+enum spi_ulthigh {
+	ULTRA_HIGH_DISABLE,
+	ULTRA_HIGH_ENABLE
+};
+
+enum spi_tckdly {
+	TICK_DLY0,
+	TICK_DLY1,
+	TICK_DLY2,
+	TICK_DLY3
+};
+
+struct mt_chip_conf {
+	u32 setuptime;
+	u32 holdtime;
+	u32 high_time;
+	u32 low_time;
+	u32 cs_idletime;
+	u32 ulthgh_thrsh;
+	enum spi_sample_sel sample_sel;
+	enum spi_cs_pol cs_pol;
+	enum spi_cpol cpol;
+	enum spi_cpha cpha;
+	enum spi_mlsb tx_mlsb;
+	enum spi_mlsb rx_mlsb;
+	enum spi_endian tx_endian;
+	enum spi_endian rx_endian;
+	enum spi_transfer_mode com_mod;
+	enum spi_pause_mode pause;
+	enum spi_finish_intr finish_intr;
+	enum spi_deassert_mode deassert;
+	enum spi_ulthigh ulthigh;
+	enum spi_tckdly tckdly;
+};
+
+//void secspi_enable_clk(struct spi_device *spidev);
+#ifdef CONFIG_TRUSTONIC_TEE_SUPPORT
+//int secspi_session_open(u32 spinum);
+//int secspi_execute(u32 cmd, tciSpiMessage_t *param);
+#endif
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.c b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.c
new file mode 100644
index 0000000000000000000000000000000000000000..ed75ad362f47c9e2c081f6fb93eed599d7528d94
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.c
@@ -0,0 +1,3628 @@
+/*****************************************************************************************
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * File       : novatek_drivers_nt36672.c
+ * Description: Source file for novatek nt36672 driver
+ * Version   : 1.0
+ * Date        : 2017/10/02
+ * Author    : Wanghao@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/delay.h>
+#include <linux/gpio.h>
+#include <linux/proc_fs.h>
+#include <asm/uaccess.h>
+#include <linux/input/mt.h>
+#include <linux/wakelock.h>
+#include <linux/of_gpio.h>
+#include <linux/of_irq.h>
+
+#if defined(CONFIG_FB)
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#elif defined(CONFIG_HAS_EARLYSUSPEND)
+#include <linux/earlysuspend.h>
+#endif
+
+#include "nvt_drivers_nt36672_noflash.h"
+
+/*******Part0:LOG TAG Declear********************/
+
+loff_t offset = 0;
+//static uint8_t ilm_dlm_num = 2;
+struct timeval start, end;
+
+/****************** Start of Log Tag Declear and level define*******************************/
+#define TPD_DEVICE "novatek,nf_nt36672"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+/******************** End of Log Tag Declear and level define*********************************/
+
+static fw_update_state nvt_fw_update(void *chip_data, const struct firmware *fw, bool force);
+static int nvt_reset(void *chip_data);
+static int nvt_get_chip_info(void *chip_data);
+
+static struct chip_data_nt36672 *g_chip_info = NULL;
+
+/***************************** start of id map table******************************************/
+static const struct nvt_ts_mem_map NT36672A_memory_map = {
+    .EVENT_BUF_ADDR           = 0x21C00,
+    .RAW_PIPE0_ADDR           = 0x20000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x23000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x20BFC,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x23BFC,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x206DC,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x236DC,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x20510,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x23510,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x20BF0,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x23BF0,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x24000,
+    .RW_FLASH_DATA_ADDR       = 0x24002,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x23C1C,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x23CAC,
+    /* Phase 2 Host Download */
+    .BOOT_RDY_ADDR            = 0x3F10D,
+    /* BLD CRC */
+    .BLD_LENGTH_ADDR          = 0x3F10E,    //0x3F10E ~ 0x3F10F (2 bytes)
+    .ILM_LENGTH_ADDR          = 0x3F118,    //0x3F118 ~ 0x3F119 (2 bytes)
+    .DLM_LENGTH_ADDR          = 0x3F130,    //0x3F130 ~ 0x3F131 (2 bytes)
+    .BLD_DES_ADDR             = 0x3F114,    //0x3F114 ~ 0x3F116 (3 bytes)
+    .ILM_DES_ADDR             = 0x3F128,    //0x3F128 ~ 0x3F12A (3 bytes)
+    .DLM_DES_ADDR             = 0x3F12C,    //0x3F12C ~ 0x3F12E (3 bytes)
+    .G_ILM_CHECKSUM_ADDR      = 0x3F100,    //0x3F100 ~ 0x3F103 (4 bytes)
+    .G_DLM_CHECKSUM_ADDR      = 0x3F104,    //0x3F104 ~ 0x3F107 (4 bytes)
+    .R_ILM_CHECKSUM_ADDR      = 0x3F120,    //0x3F120 ~ 0x3F123 (4 bytes)
+    .R_DLM_CHECKSUM_ADDR      = 0x3F124,    //0x3F124 ~ 0x3F127 (4 bytes)
+    .BLD_CRC_EN_ADDR          = 0x3F30E,
+    .DMA_CRC_EN_ADDR          = 0x3F132,
+    .BLD_ILM_DLM_CRC_ADDR     = 0x3F133,
+    .DMA_CRC_FLAG_ADDR        = 0x3F134,
+};
+
+static const struct nvt_ts_mem_map NT36772_memory_map = {
+    .EVENT_BUF_ADDR           = 0x11E00,
+    .RAW_PIPE0_ADDR           = 0x10000,
+    .RAW_PIPE0_Q_ADDR         = 0,
+    .RAW_PIPE1_ADDR           = 0x12000,
+    .RAW_PIPE1_Q_ADDR         = 0,
+    .BASELINE_ADDR            = 0x10E70,
+    .BASELINE_Q_ADDR          = 0,
+    .BASELINE_BTN_ADDR        = 0x12E70,
+    .BASELINE_BTN_Q_ADDR      = 0,
+    .DIFF_PIPE0_ADDR          = 0x10830,
+    .DIFF_PIPE0_Q_ADDR        = 0,
+    .DIFF_PIPE1_ADDR          = 0x12830,
+    .DIFF_PIPE1_Q_ADDR        = 0,
+    .RAW_BTN_PIPE0_ADDR       = 0x10E60,
+    .RAW_BTN_PIPE0_Q_ADDR     = 0,
+    .RAW_BTN_PIPE1_ADDR       = 0x12E60,
+    .RAW_BTN_PIPE1_Q_ADDR     = 0,
+    .DIFF_BTN_PIPE0_ADDR      = 0x10E68,
+    .DIFF_BTN_PIPE0_Q_ADDR    = 0,
+    .DIFF_BTN_PIPE1_ADDR      = 0x12E68,
+    .DIFF_BTN_PIPE1_Q_ADDR    = 0,
+    .READ_FLASH_CHECKSUM_ADDR = 0x14000,
+    .RW_FLASH_DATA_ADDR       = 0x14002,
+    /* Phase 2 Host Download */
+    .BOOT_RDY_ADDR            = 0x1F141,
+    .POR_CD_ADDR              = 0x1F61C,
+    /* BLD CRC */
+    .R_ILM_CHECKSUM_ADDR      = 0x1BF00,
+    .DOZE_GM_S1D_SCAN_RAW_ADDR= 0x143D0,
+    .DOZE_GM_BTN_SCAN_RAW_ADDR= 0x11DF0,
+};
+
+static const struct nvt_ts_trim_id_table trim_id_table[] = {
+    {.id = {0x0A, 0xFF, 0xFF, 0x72, 0x66, 0x03}, .mask = {1, 0, 0, 1, 1, 1},
+        .mmap = &NT36672A_memory_map, .carrier_system = 0,  .support_hw_crc = 1},
+    {.id = {0xFF, 0xFF, 0xFF, 0x72, 0x66, 0x03}, .mask = {0, 0, 0, 1, 1, 1},
+        .mmap = &NT36772_memory_map, .carrier_system = 0,  .support_hw_crc = 0},
+};
+
+#ifdef CONFIG_SPI_MT65XX
+const struct mtk_chip_config spi_ctrdata = {
+    .rx_mlsb = 1,
+    .tx_mlsb = 1,
+    .cs_pol = 0,
+};
+#else
+const struct mt_chip_conf spi_ctrdata = {
+        .setuptime = 25,
+        .holdtime = 25,
+        .high_time = 3, /* 16.6MHz */
+        .low_time = 3,
+        .cs_idletime = 2,
+        .ulthgh_thrsh = 0,
+
+        .cpol = 0,
+        .cpha = 0,
+
+        .rx_mlsb = 1,
+        .tx_mlsb = 1,
+
+        .tx_endian = 0,
+        .rx_endian = 0,
+
+        .com_mod = DMA_TRANSFER,
+
+        .pause = 0,
+        .finish_intr = 1,
+        .deassert = 0,
+        .ulthigh = 0,
+        .tckdly = 0,
+};
+#endif	//CONFIG_SPI_MT65XX
+
+/*******************************************************
+Description:
+    Novatek touchscreen write data to specify address.
+
+return:
+    Executive outcomes. 0---succeed. -5---access fail.
+*******************************************************/
+int32_t nvt_write_addr(struct spi_device *client, uint32_t addr, uint8_t data)
+{
+    int32_t ret = 0;
+    uint8_t buf[4] = {0};
+
+    //---set xdata index---
+    buf[0] = 0xFF;  //set index/page/addr command
+    buf[1] = (addr >> 15) & 0xFF;
+    buf[2] = (addr >> 7) & 0xFF;
+    ret = CTP_SPI_WRITE(client, buf, 3);
+    if (ret) {
+        TPD_INFO("set page 0x%06X failed, ret = %d\n", addr, ret);
+        return ret;
+    }
+
+    //---write data to index---
+    buf[0] = addr & (0x7F);
+    buf[1] = data;
+    ret = CTP_SPI_WRITE(client, buf, 2);
+    if (ret) {
+        TPD_INFO("write data to 0x%06X failed, ret = %d\n", addr, ret);
+        return ret;
+    }
+
+    return ret;
+}
+
+/*******************************************************
+Description:
+    Novatek touchscreen reset MCU (boot) function.
+
+return:
+    n.a.
+*******************************************************/
+void nvt_bootloader_reset_noflash(struct chip_data_nt36672 *chip_info)
+{
+    //---reset cmds to SWRST_N8_ADDR---
+    nvt_write_addr(chip_info->s_client, SWRST_N8_ADDR, 0x69);
+
+    mdelay(5);  //wait tBRST2FR after Bootload RST
+}
+
+/*******************************************************
+Description:
+    Novatek touchscreen set index/page/addr address.
+
+return:
+    Executive outcomes. 0---succeed. -5---access fail.
+*******************************************************/
+int32_t nvt_set_page(struct chip_data_nt36672 *chip_info, uint32_t addr)
+{
+    uint8_t buf[4] = {0};
+
+    buf[0] = 0xFF;      //set index/page/addr command
+    buf[1] = (addr >> 15) & 0xFF;
+    buf[2] = (addr >> 7) & 0xFF;
+
+    return CTP_SPI_WRITE(chip_info->s_client, buf, 3);
+}
+
+static uint8_t nvt_wdt_fw_recovery(struct chip_data_nt36672 *chip_info, uint8_t *point_data)
+{
+        uint32_t recovery_cnt_max = 10;
+        uint8_t recovery_enable = false;
+        uint8_t i = 0;
+
+        chip_info->recovery_cnt++;
+
+        /* Pattern Check */
+        for (i=1 ; i<7 ; i++) {
+                if ((point_data[i] != 0xFD) && (point_data[i] != 0xFE)) {
+                        chip_info->recovery_cnt = 0;
+                        break;
+                }
+        }
+
+        if (chip_info->recovery_cnt > recovery_cnt_max){
+                recovery_enable = true;
+                chip_info->recovery_cnt = 0;
+        }
+
+		if (chip_info->recovery_cnt) {
+			TPD_INFO("recovery_cnt is %d (0x%02X)\n", chip_info->recovery_cnt, point_data[1]);
+		}
+
+        return recovery_enable;
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen check chip version trim function.
+
+return:
+        Executive outcomes. 0---NVT IC. -1---not NVT IC.
+*******************************************************/
+static int8_t nvt_ts_check_chip_ver_trim(struct chip_data_nt36672 *chip_info)
+{
+        uint8_t buf[8] = {0};
+        int32_t retry = 0;
+        int32_t list = 0;
+        int32_t i = 0;
+        int32_t found_nvt_chip = 0;
+        int32_t ret = -1;
+
+        //---Check for 5 times---
+        for (retry = 5; retry > 0; retry--) {
+
+                nvt_bootloader_reset_noflash(chip_info);
+
+                //---set xdata index to 0x1F600---
+                nvt_set_page(chip_info, 0x1F600);       //read chip id
+
+                buf[0] = 0x4E;  //offset
+                buf[1] = 0x00;
+                buf[2] = 0x00;
+                buf[3] = 0x00;
+                buf[4] = 0x00;
+                buf[5] = 0x00;
+                buf[6] = 0x00;
+                CTP_SPI_READ(chip_info->s_client, buf, 7);
+                TPD_INFO("buf[1]=0x%02X, buf[2]=0x%02X, buf[3]=0x%02X, buf[4]=0x%02X, buf[5]=0x%02X, buf[6]=0x%02X\n",
+                        buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
+
+                // compare read chip id on supported list
+                for (list = 0; list < (sizeof(trim_id_table) / sizeof(struct nvt_ts_trim_id_table)); list++) {
+                        found_nvt_chip = 0;
+
+                        // compare each byte
+                        for (i = 0; i < NVT_ID_BYTE_MAX; i++) {
+                                if (trim_id_table[list].mask[i]) {
+                                        if (buf[i + 1] != trim_id_table[list].id[i])    //set parameter from chip id
+                                                break;
+                                }
+                        }
+
+                        if (i == NVT_ID_BYTE_MAX) {
+                                found_nvt_chip = 1;
+                        }
+
+                        if (found_nvt_chip) {
+                                TPD_INFO("This is NVT touch IC\n");
+                                chip_info->trim_id_table.mmap = trim_id_table[list].mmap;
+                                chip_info->trim_id_table.carrier_system = trim_id_table[list].carrier_system;
+                                chip_info->trim_id_table.support_hw_crc = trim_id_table[list].support_hw_crc;
+                                ret = 0;
+                                goto out;
+                        } else {
+                                chip_info->trim_id_table.mmap = NULL;
+                                ret = -1;
+                        }
+                }
+
+                msleep(10);
+        }
+
+        if (chip_info->trim_id_table.mmap == NULL) {  //set default value
+                chip_info->trim_id_table.mmap = &NT36772_memory_map;
+                chip_info->trim_id_table.carrier_system = 0;
+                ret = 0;
+        }
+
+out:
+		TPD_INFO("list = %d, support_hw_crc is %d\n", list, chip_info->trim_id_table.support_hw_crc);
+        return ret;
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen check FW reset state function.
+
+return:
+        Executive outcomes. 0---succeed. -1---failed.
+*******************************************************/
+static int32_t nvt_check_fw_reset_state_noflash(struct chip_data_nt36672 *chip_info, RST_COMPLETE_STATE check_reset_state)
+{
+        uint8_t buf[8] = {0};
+        int32_t ret = 0;
+        int32_t retry = 0;
+
+        while (1) {
+                msleep(10);
+
+                //---read reset state---
+                buf[0] = EVENT_MAP_RESET_COMPLETE;
+                buf[1] = 0x00;
+                CTP_SPI_READ(chip_info->s_client, buf, 6);
+
+                if ((buf[1] >= check_reset_state) && (buf[1] <= RESET_STATE_MAX)) {
+                        ret = 0;
+                        break;
+                }
+
+                retry++;
+                if(unlikely(retry > 100)) {
+                        TPD_INFO("error, retry=%d, buf[1]=0x%02X, 0x%02X, 0x%02X, 0x%02X, 0x%02X\n", retry, buf[1], buf[2], buf[3], buf[4], buf[5]);
+                        ret = -1;
+                        break;
+                }
+        }
+
+        return ret;
+}
+
+static int nvt_enter_sleep(struct chip_data_nt36672 *chip_info, bool config)
+{
+    int ret = -1;
+    uint8_t buf[3];
+
+    if (config) {
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0x11;
+        ret = CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+        if (ret < 0) {
+            TPD_INFO("%s: enter sleep mode failed!\n", __func__);
+            return -1;
+        } else {
+            chip_info->is_sleep_writed = true;
+            TPD_INFO("%s: enter sleep mode sucess!\n", __func__);
+        }
+    }
+
+    return ret;
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen get novatek project id information
+        function.
+
+return:
+        Executive outcomes. 0---success. -1---fail.
+*******************************************************/
+int32_t nvt_read_pid_noflash(struct chip_data_nt36672 *chip_info)
+{
+        uint8_t buf[3] = {0};
+        int32_t ret = 0;
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_PROJECTID);
+
+        //---read project id---
+        buf[0] = EVENT_MAP_PROJECTID;
+        buf[1] = 0x00;
+        buf[2] = 0x00;
+        CTP_SPI_READ(chip_info->s_client, buf, 3);
+
+        chip_info->nvt_pid = (buf[2] << 8) + buf[1];
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        TPD_INFO("PID=%04X\n", chip_info->nvt_pid);
+
+        return ret;
+}
+
+int32_t nvt_get_fw_info_noflash(struct chip_data_nt36672 *chip_info)
+{
+        uint8_t buf[64] = {0};
+        uint32_t retry_count = 0;
+        int32_t ret = 0;
+
+info_retry:
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_FWINFO);
+
+        //---read fw info---
+        buf[0] = EVENT_MAP_FWINFO;
+        CTP_SPI_READ(chip_info->s_client, buf, 17);
+        chip_info->fw_ver = buf[1];
+        chip_info->fw_sub_ver = buf[14];
+        TPD_INFO("fw_ver = 0x%x, fw_sub_ver = 0x%x\n", chip_info->fw_ver, chip_info->fw_sub_ver);
+
+        //---clear x_num, y_num if fw info is broken---
+        if ((buf[1] + buf[2]) != 0xFF) {
+                TPD_INFO("FW info is broken! fw_ver=0x%02X, ~fw_ver=0x%02X\n", buf[1], buf[2]);
+                chip_info->fw_ver = 0;
+
+                if(retry_count < 3) {
+                        retry_count++;
+                        TPD_INFO("retry_count=%d\n", retry_count);
+                        goto info_retry;
+                } else {
+                        TPD_INFO("Set default fw_ver=0, x_num=18, y_num=32, abs_x_max=1080, abs_y_max=1920, max_button_num=0!\n");
+                        ret = -1;
+                }
+        } else {
+                ret = 0;
+        }
+
+        //---Get Novatek PID---
+        nvt_read_pid_noflash(chip_info);
+
+        return ret;
+}
+
+static uint32_t byte_to_word(const uint8_t *data)
+{
+        return data[0] + (data[1] << 8) + (data[2] << 16) + (data[3] << 24);
+}
+
+static uint32_t CheckSum(const u8 *data, size_t len)
+{
+        uint32_t i = 0;
+        uint32_t checksum = 0;
+
+        for (i = 0 ; i < len+1 ; i++)
+                checksum += data[i];
+
+        checksum += len;
+        checksum = ~checksum +1;
+
+        return checksum;
+}
+
+static int32_t nvt_bin_header_parser(struct chip_data_nt36672 *chip_info, const u8 *fwdata, size_t fwsize)
+{
+        uint32_t list = 0;
+        uint32_t pos = 0x00;
+        uint32_t end = 0x00;
+        uint8_t info_sec_num = 0;
+        uint8_t ovly_sec_num = 0;
+        uint8_t ovly_info = 0;
+
+        /* Find the header size */
+        end = fwdata[0] + (fwdata[1] << 8) + (fwdata[2] << 16) + (fwdata[3] << 24);
+        pos = 0x30;     // info section start at 0x30 offset
+        while (pos < end) {
+                info_sec_num ++;
+                pos += 0x10;    /* each header info is 16 bytes */
+        }
+
+        /*
+         * Find the DLM OVLY section
+         * [0:3] Overlay Section Number
+         * [4]   Overlay Info
+         */
+        ovly_info = (fwdata[0x28] & 0x10) >> 4;
+        ovly_sec_num = (ovly_info) ? (fwdata[0x28] & 0x0F) : 0;
+
+        /*
+         * calculate all partition number
+         * ilm_dlm_num (ILM & DLM) + ovly_sec_num + info_sec_num
+         */
+        chip_info->partition = chip_info->ilm_dlm_num + ovly_sec_num + info_sec_num;
+        TPD_INFO("ovly_info = %d, ilm_dlm_num = %d, ovly_sec_num = %d, info_sec_num = %d, partition = %d\n",
+                        ovly_info, chip_info->ilm_dlm_num, ovly_sec_num, info_sec_num, chip_info->partition);
+
+        /* allocated memory for header info */
+        chip_info->bin_map = (struct nvt_ts_bin_map *)kzalloc((chip_info->partition+1) * sizeof(struct nvt_ts_bin_map), GFP_KERNEL);
+        if(chip_info->bin_map == NULL) {
+                TPD_INFO("kzalloc for bin_map failed!\n");
+                return -ENOMEM;
+        }
+
+        for (list = 0; list < chip_info->partition; list++) {
+                /*
+                 * [1] parsing ILM & DLM header info
+                 * BIN_addr : SRAM_addr : size (12-bytes)
+                 * crc located at 0x18 & 0x1C
+                 */
+                if (list < chip_info->ilm_dlm_num) {
+                        chip_info->bin_map[list].BIN_addr = byte_to_word(&fwdata[0 + list*12]);
+                        chip_info->bin_map[list].SRAM_addr = byte_to_word(&fwdata[4 + list*12]);
+                        chip_info->bin_map[list].size = byte_to_word(&fwdata[8 + list*12]);
+                        if (chip_info->trim_id_table.support_hw_crc)
+                                chip_info->bin_map[list].crc = byte_to_word(&fwdata[0x18 + list*4]);
+                        else { //ts->support_hw_crc
+                                if ((chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size) < fwsize)
+                                        chip_info->bin_map[list].crc = CheckSum(&fwdata[chip_info->bin_map[list].BIN_addr], chip_info->bin_map[list].size);
+                                else {
+                                        TPD_INFO("access range (0x%08X to 0x%08X) is larger than bin size!\n",
+                                                        chip_info->bin_map[list].BIN_addr, chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size);
+                                        return -EINVAL;
+                                }
+                        } //ts->support_hw_crc
+                        if (list == 0)
+                                sprintf(chip_info->bin_map[list].name, "ILM");
+                        else if (list == 1)
+                                sprintf(chip_info->bin_map[list].name, "DLM");
+                }
+
+                /*
+                 * [2] parsing others header info
+                 * SRAM_addr : size : BIN_addr : crc (16-bytes)
+                 */
+                if ((list >= chip_info->ilm_dlm_num) && (list < (chip_info->ilm_dlm_num + info_sec_num))) {
+                        /* others partition located at 0x30 offset */
+                        pos = 0x30 + (0x10 * (list - chip_info->ilm_dlm_num));
+
+                        chip_info->bin_map[list].SRAM_addr = byte_to_word(&fwdata[pos]);
+                        chip_info->bin_map[list].size = byte_to_word(&fwdata[pos+4]);
+                        chip_info->bin_map[list].BIN_addr = byte_to_word(&fwdata[pos+8]);
+                        if (chip_info->trim_id_table.support_hw_crc)
+                                chip_info->bin_map[list].crc = byte_to_word(&fwdata[pos+12]);
+                        else {
+                                if ((chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size) < fwsize)
+                                        chip_info->bin_map[list].crc = CheckSum(&fwdata[chip_info->bin_map[list].BIN_addr], chip_info->bin_map[list].size);
+                                else { //ts->support_hw_crc
+                                        TPD_INFO("access range (0x%08X to 0x%08X) is larger than bin size!\n",
+                                                        chip_info->bin_map[list].BIN_addr, chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size);
+                                        return -EINVAL;
+                                }
+                        } //ts->support_hw_crc
+                        /* detect header end to protect parser function */
+                        if ((chip_info->bin_map[list].BIN_addr == 0) && (chip_info->bin_map[list].size != 0)) {
+                                sprintf(chip_info->bin_map[list].name, "Header");
+                        } else {
+                                sprintf(chip_info->bin_map[list].name, "Info-%d", (list - chip_info->ilm_dlm_num));
+                        }
+                }
+
+                /*
+                 * [3] parsing overlay section header info
+                 * SRAM_addr : size : BIN_addr : crc (16-bytes)
+                 */
+                if (list >= (chip_info->ilm_dlm_num + info_sec_num)) {
+                        /* overlay info located at DLM (list = 1) start addr */
+                        pos = chip_info->bin_map[1].BIN_addr + (0x10 * (list- chip_info->ilm_dlm_num - info_sec_num));
+
+                        chip_info->bin_map[list].SRAM_addr = byte_to_word(&fwdata[pos]);
+                        chip_info->bin_map[list].size = byte_to_word(&fwdata[pos+4]);
+                        chip_info->bin_map[list].BIN_addr = byte_to_word(&fwdata[pos+8]);
+                        if (chip_info->trim_id_table.support_hw_crc)
+                                chip_info->bin_map[list].crc = byte_to_word(&fwdata[pos+12]);
+                        else { //ts->support_hw_crc
+                                if ((chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size) < fwsize)
+                                        chip_info->bin_map[list].crc = CheckSum(&fwdata[chip_info->bin_map[list].BIN_addr], chip_info->bin_map[list].size);
+                                else {
+                                        TPD_INFO("access range (0x%08X to 0x%08X) is larger than bin size!\n",
+                                                        chip_info->bin_map[list].BIN_addr, chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size);
+                                        return -EINVAL;
+                                }
+                        } //ts->support_hw_crc
+                        sprintf(chip_info->bin_map[list].name, "Overlay-%d", (list- chip_info->ilm_dlm_num - info_sec_num));
+                }
+
+                /* BIN size error detect */
+                if ((chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size) > fwsize) {
+                    TPD_INFO("access range (0x%08X to 0x%08X) is larger than bin size!\n",
+                            chip_info->bin_map[list].BIN_addr, chip_info->bin_map[list].BIN_addr + chip_info->bin_map[list].size);
+                    return -EINVAL;
+                }
+
+    }
+
+        return 0;
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen init variable and allocate buffer
+for download firmware function.
+
+return:
+        n.a.
+*******************************************************/
+static int32_t Download_Init(struct chip_data_nt36672 *chip_info)
+{
+        /* allocate buffer for transfer firmware */
+        //NVT_LOG("SPI_TANSFER_LEN = %ld\n", SPI_TANSFER_LEN);
+
+        if (chip_info->fwbuf == NULL) {
+                chip_info->fwbuf = (uint8_t *)kzalloc((SPI_TANSFER_LEN+1), GFP_KERNEL);
+                if(chip_info->fwbuf == NULL) {
+                        TPD_INFO("kzalloc for fwbuf failed!\n");
+                        return -ENOMEM;
+                }
+        }
+
+        return 0;
+}
+
+#if NVT_DUMP_SRAM
+/*******************************************************
+Description:
+        Novatek touchscreen dump flash partition function.
+
+return:
+        n.a.
+*******************************************************/
+static void nvt_read_ram_test(struct chip_data_nt36672 *chip_info, uint32_t addr, uint16_t len, char *name)
+{
+        char file[256] = "";
+        uint8_t *fbufp = NULL;
+        int32_t ret = 0;
+        struct file *fp = NULL;
+        mm_segment_t org_fs;
+
+        sprintf(file, "/sdcard/dump_%s.bin", name);
+        TPD_INFO("Dump [%s] from 0x%08X to 0x%08X\n", file, addr, addr+len);
+
+        fbufp = (uint8_t *)kzalloc(len + 1, GFP_KERNEL);
+        if(fbufp == NULL) {
+                TPD_INFO("kzalloc for fbufp failed!\n");
+                return;
+        }
+
+        org_fs = get_fs();
+        set_fs(KERNEL_DS);
+        fp = filp_open(file, O_WRONLY | O_CREAT | O_TRUNC, 0);
+        if (fp == NULL || IS_ERR(fp)) {
+                TPD_INFO("open file failed\n");
+                goto open_file_fail;
+        }
+
+        /* SPI read */
+        //---set xdata index to addr---
+        nvt_set_page(chip_info, addr);
+
+        fbufp[0] = addr & 0x7F; //offset
+        CTP_SPI_READ(chip_info->s_client, fbufp, len+1);
+
+        /* Write to file */
+        ret = vfs_write(fp, (char __user *)fbufp+1, len, &offset);
+        if (ret <= 0) {
+                TPD_INFO("write file failed\n");
+                goto open_file_fail;
+        }
+
+open_file_fail:
+        if (!IS_ERR(fp)) {
+                filp_close(fp, NULL);
+                set_fs(org_fs);
+                fp = NULL;
+        }
+
+        if (fbufp) {
+                kfree(fbufp);
+                fbufp = NULL;
+        }
+
+        return;
+}
+#endif
+
+/*******************************************************
+Description:
+        Novatek touchscreen Write_Partition function to write
+firmware into each partition.
+
+return:
+        n.a.
+*******************************************************/
+static int32_t Write_Partition(struct chip_data_nt36672 *chip_info, const u8 *fwdata, size_t fwsize)
+{
+        uint32_t list = 0;
+        char *name;
+        uint32_t BIN_addr, SRAM_addr, size;
+        uint32_t i = 0;
+        uint16_t len = 0;
+        int32_t count = 0;
+        int32_t ret = 0;
+
+        memset(chip_info->fwbuf, 0, (SPI_TANSFER_LEN+1));
+
+        for (list = 0; list < chip_info->partition; list++) {
+                /* initialize variable */
+                SRAM_addr = chip_info->bin_map[list].SRAM_addr;
+                size = chip_info->bin_map[list].size;
+                BIN_addr = chip_info->bin_map[list].BIN_addr;
+                name = chip_info->bin_map[list].name;
+
+//              TPD_INFO("[%d][%s] SRAM (0x%08X), SIZE (0x%08X), BIN (0x%08X)\n",
+//                              list, name, SRAM_addr, size, BIN_addr);
+
+                /* Check data size */
+                if ((BIN_addr + size) > fwsize) {
+                        TPD_INFO("access range (0x%08X to 0x%08X) is larger than bin size!\n",
+                                        BIN_addr, BIN_addr + size);
+                        ret = -1;
+                        goto out;
+                }
+
+                /* ignore reserved partition (Reserved Partition size is zero) */
+                if (!size)
+                        continue;
+                else
+                        size = size +1;
+
+                /* write data to SRAM */
+                if (size % SPI_TANSFER_LEN)
+                        count = (size / SPI_TANSFER_LEN) + 1;
+                else
+                        count = (size / SPI_TANSFER_LEN);
+
+                for (i = 0 ; i < count ; i++) {
+                        len = (size < SPI_TANSFER_LEN) ? size : SPI_TANSFER_LEN;
+
+                        //---set xdata index to start address of SRAM---
+                        nvt_set_page(chip_info, SRAM_addr);
+
+                        //---write data into SRAM---
+                        chip_info->fwbuf[0] = SRAM_addr & 0x7F; //offset
+                        memcpy(chip_info->fwbuf + 1, &fwdata[BIN_addr], len);   //payload
+                        CTP_SPI_WRITE(chip_info->s_client, chip_info->fwbuf, len + 1);
+
+#if NVT_DUMP_SRAM
+                        /* dump for debug download firmware */
+                        nvt_read_ram_test(chip_info, SRAM_addr, len, name);
+#endif
+                        SRAM_addr += SPI_TANSFER_LEN;
+                        BIN_addr += SPI_TANSFER_LEN;
+                        size -= SPI_TANSFER_LEN;
+                }
+
+#if NVT_DUMP_SRAM
+                offset = 0;
+#endif
+        }
+
+out:
+        return ret;
+}
+
+void nvt_bld_crc_enable(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[4] = {0};
+
+    //---set xdata index to BLD_CRC_EN_ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->BLD_CRC_EN_ADDR);
+
+    //---read data from index---
+    buf[0] = chip_info->trim_id_table.mmap->BLD_CRC_EN_ADDR & (0x7F);
+    buf[1] = 0xFF;
+    CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+    //---write data to index---
+    buf[0] = chip_info->trim_id_table.mmap->BLD_CRC_EN_ADDR & (0x7F);
+    buf[1] = buf[1] | (0x01 << 7);
+    CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+}
+
+/*******************************************************
+Description:
+    Novatek touchscreen clear status & enable fw crc function.
+
+return:
+    N/A.
+*******************************************************/
+void nvt_fw_crc_enable(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[4] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    //---clear fw reset status---
+    buf[0] = EVENT_MAP_RESET_COMPLETE & (0x7F);
+    buf[1] = 0x00;
+    CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+
+    //---enable fw crc---
+    buf[0] = EVENT_MAP_HOST_CMD & (0x7F);
+    buf[1] = 0xAE;  //enable fw crc command
+    CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen set boot ready function.
+
+return:
+        Executive outcomes. 0---succeed. -5---access fail.
+*******************************************************/
+void nvt_boot_ready(struct chip_data_nt36672 *chip_info, uint8_t ready)
+{
+        //---write BOOT_RDY status cmds---
+        nvt_write_addr(chip_info->s_client, chip_info->trim_id_table.mmap->BOOT_RDY_ADDR, 1);
+
+        mdelay(5);
+
+        if (!chip_info->trim_id_table.support_hw_crc) {
+                //---write BOOT_RDY status cmds---
+                nvt_write_addr(chip_info->s_client, chip_info->trim_id_table.mmap->BOOT_RDY_ADDR, 0);
+
+                //---write POR_CD cmds---
+                nvt_write_addr(chip_info->s_client, chip_info->trim_id_table.mmap->POR_CD_ADDR, 0xA0);
+        }
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen eng reset cmd
+    function.
+
+return:
+        n.a.
+*******************************************************/
+void nvt_eng_reset(struct chip_data_nt36672 *chip_info)
+{
+                //---eng reset cmds to ENG_RST_ADDR---
+                nvt_write_addr(chip_info->s_client, chip_info->ENG_RST_ADDR, 0x5A);
+
+                mdelay(1);      //wait tMCU_Idle2TP_REX_Hi after TP_RST
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen check checksum function.
+This function will compare file checksum and fw checksum.
+
+return:
+        n.a.
+*******************************************************/
+static int32_t Check_CheckSum(struct chip_data_nt36672 *chip_info)
+{
+        uint32_t fw_checksum = 0;
+        uint32_t len = chip_info->partition * 4;
+        uint32_t list = 0;
+        int32_t ret = 0;
+
+        memset(chip_info->fwbuf, 0, (len+1));
+
+        //---set xdata index to checksum---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->R_ILM_CHECKSUM_ADDR);
+
+        /* read checksum */
+        chip_info->fwbuf[0] = (chip_info->trim_id_table.mmap->R_ILM_CHECKSUM_ADDR) & 0x7F;
+        ret = CTP_SPI_READ(chip_info->s_client, chip_info->fwbuf, len+1);
+        if (ret) {
+                TPD_INFO("Read fw checksum failed\n");
+                return ret;
+        }
+
+        /*
+         * Compare each checksum from fw
+         * ILM + DLM + Overlay + Info
+         * ilm_dlm_num (ILM & DLM) + ovly_sec_num + info_sec_num
+         */
+        for (list = 0; list < chip_info->partition; list++) {
+                fw_checksum = byte_to_word(&chip_info->fwbuf[1+list*4]);
+
+                /* ignore reserved partition (Reserved Partition size is zero) */
+                if(!chip_info->bin_map[list].size)
+                        continue;
+
+                if (chip_info->bin_map[list].crc != fw_checksum) {
+                        TPD_INFO("[%d] BIN_checksum=0x%08X, FW_checksum=0x%08X\n",
+                                        list, chip_info->bin_map[list].crc, fw_checksum);
+
+                        TPD_INFO("firmware checksum not match!!\n");
+                        ret = -EIO;
+                        break;
+                }
+        }
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        return ret;
+}
+
+/*******************************************************
+Description:
+	Novatek touchscreen set bootload crc reg bank function.
+This function will set hw crc reg before enable crc function.
+
+return:
+	n.a.
+*******************************************************/
+static void nvt_set_bld_crc_bank(struct chip_data_nt36672 *chip_info,
+		uint32_t DES_ADDR, uint32_t SRAM_ADDR,
+		uint32_t LENGTH_ADDR, uint32_t size,
+		uint32_t G_CHECKSUM_ADDR, uint32_t crc)
+{
+	/* write destination address */
+	nvt_set_page(chip_info, DES_ADDR);
+	chip_info->fwbuf[0] = DES_ADDR & 0x7F;
+	chip_info->fwbuf[1] = (SRAM_ADDR) & 0xFF;
+	chip_info->fwbuf[2] = (SRAM_ADDR >> 8) & 0xFF;
+	chip_info->fwbuf[3] = (SRAM_ADDR >> 16) & 0xFF;
+	CTP_SPI_WRITE(chip_info->s_client, chip_info->fwbuf, 4);
+
+	/* write length */
+	chip_info->fwbuf[0] = LENGTH_ADDR & 0x7F;
+	chip_info->fwbuf[1] = (size) & 0xFF;
+	chip_info->fwbuf[2] = (size >> 8) & 0xFF;
+	CTP_SPI_WRITE(chip_info->s_client, chip_info->fwbuf, 3);
+
+	/* write golden dlm checksum */
+	chip_info->fwbuf[0] = G_CHECKSUM_ADDR & 0x7F;
+	chip_info->fwbuf[1] = (crc) & 0xFF;
+	chip_info->fwbuf[2] = (crc >> 8) & 0xFF;
+	chip_info->fwbuf[3] = (crc >> 16) & 0xFF;
+	chip_info->fwbuf[4] = (crc >> 24) & 0xFF;
+	CTP_SPI_WRITE(chip_info->s_client, chip_info->fwbuf, 5);
+
+	return;
+}
+
+/*******************************************************
+Description:
+	Novatek touchscreen check DMA hw crc function.
+This function will check hw crc result is pass or not.
+
+return:
+	n.a.
+*******************************************************/
+static void nvt_set_bld_hw_crc(struct chip_data_nt36672 *chip_info)
+{
+	/* [0] ILM */
+	/* write register bank */
+	nvt_set_bld_crc_bank(chip_info,
+			chip_info->trim_id_table.mmap->ILM_DES_ADDR, chip_info->bin_map[0].SRAM_addr,
+			chip_info->trim_id_table.mmap->ILM_LENGTH_ADDR, chip_info->bin_map[0].size,
+			chip_info->trim_id_table.mmap->G_ILM_CHECKSUM_ADDR, chip_info->bin_map[0].crc);
+
+	/* [1] DLM */
+	/* write register bank */
+	nvt_set_bld_crc_bank(chip_info,
+			chip_info->trim_id_table.mmap->DLM_DES_ADDR, chip_info->bin_map[1].SRAM_addr,
+			chip_info->trim_id_table.mmap->DLM_LENGTH_ADDR, chip_info->bin_map[1].size,
+			chip_info->trim_id_table.mmap->G_DLM_CHECKSUM_ADDR, chip_info->bin_map[1].crc);
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen Download_Firmware with HW CRC
+function. It's complete download firmware flow.
+
+return:
+        n.a.
+*******************************************************/
+static int32_t Download_Firmware_HW_CRC(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+        uint8_t retry = 0;
+        int32_t ret = 0;
+
+		TPD_INFO("Enter Download_Firmware_HW_CRC\n");
+        do_gettimeofday(&start);
+
+        while (1) {
+                /* bootloader reset to reset MCU */
+                nvt_bootloader_reset_noflash(chip_info);
+
+                /* Start Write Firmware Process */
+                ret = Write_Partition(chip_info, fw->data, fw->size);
+                if (ret) {
+                        TPD_INFO("Write_Firmware failed. (%d)\n", ret);
+                        goto fail;
+                }
+
+                /* set ilm & dlm reg bank */
+                nvt_set_bld_hw_crc(chip_info);
+
+                /* enable hw bld crc function */
+                nvt_bld_crc_enable(chip_info);
+
+                /* clear fw reset status & enable fw crc check */
+                nvt_fw_crc_enable(chip_info);
+
+                /* Set Boot Ready Bit */
+                nvt_boot_ready(chip_info, true);
+
+                ret = nvt_check_fw_reset_state_noflash(chip_info, RESET_STATE_INIT);
+                if (ret) {
+                        TPD_INFO("nvt_check_fw_reset_state_noflash failed. (%d)\n", ret);
+                        goto fail;
+                } else {
+                        break;
+                }
+
+fail:
+                retry++;
+                if(unlikely(retry > 2)) {
+                        TPD_INFO("error, retry=%d\n", retry);
+                        break;
+                }
+        }
+
+        do_gettimeofday(&end);
+
+        return ret;
+}
+
+/*******************************************************
+Description:
+        Novatek touchscreen Download_Firmware function. It's
+complete download firmware flow.
+
+return:
+        n.a.
+*******************************************************/
+static int32_t Download_Firmware(struct chip_data_nt36672 *chip_info, const struct firmware *fw)
+{
+        uint8_t retry = 0;
+        int32_t ret = 0;
+
+        do_gettimeofday(&start);
+
+        while (1) {
+                /*
+                 * Send eng reset cmd before download FW
+                 * Keep TP_RESX low when send eng reset cmd
+                 */
+                gpio_set_value(chip_info->hw_res->reset_gpio, 0);
+                mdelay(1);      //wait 1ms
+                nvt_eng_reset(chip_info);
+                gpio_set_value(chip_info->hw_res->reset_gpio, 1);
+                udelay(5);      //wait tRSTA2BRST after TP_RST
+                nvt_bootloader_reset_noflash(chip_info);
+
+                /* clear fw reset status */
+                nvt_write_addr(chip_info->s_client, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_RESET_COMPLETE, 0x00);
+
+                /* Start Write Firmware Process */
+                ret = Write_Partition(chip_info, fw->data, fw->size);
+                if (ret) {
+                        TPD_INFO("Write_Firmware failed. (%d)\n", ret);
+                        goto fail;
+                }
+
+                /* Set Boot Ready Bit */
+                nvt_boot_ready(chip_info, true);
+
+                ret = nvt_check_fw_reset_state_noflash(chip_info, RESET_STATE_INIT);
+                if (ret) {
+                        TPD_INFO("nvt_check_fw_reset_state_noflash failed. (%d)\n", ret);
+                        goto fail;
+                }
+
+                ret = Check_CheckSum(chip_info);        //Check FW checksum
+                if (ret) {
+                        TPD_INFO("check checksum failed, retry=%d\n", retry);
+                        goto fail;
+                } else {
+                        break;
+                }
+
+fail:
+                retry++;
+                if(unlikely(retry > 2)) {
+                        TPD_INFO("error, retry=%d\n", retry);
+                        break;
+                }
+        }
+
+        do_gettimeofday(&end);
+
+        return ret;
+}
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int nvt_ftm_process(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    const struct firmware *fw = NULL;
+
+    TPD_INFO("%s is called!\n", __func__);
+    ret = nvt_get_chip_info(chip_info);
+    if (!ret) {
+        ret = nvt_fw_update(chip_info, fw, 0);
+        if(ret > 0) {
+                TPD_INFO("%s fw update failed!\n", __func__);
+        } else {
+                ret = nvt_enter_sleep(chip_info, true);
+        }
+    }
+
+    return ret;
+}
+
+static int nvt_power_control(void *chip_data, bool enable)
+{
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    nvt_eng_reset(chip_info);       //make sure before nvt_bootloader_reset_noflash
+    gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+
+    return 0;
+}
+
+static int nvt_get_chip_info(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    //---check chip version trim---
+    ret = nvt_ts_check_chip_ver_trim(chip_info);
+    if (ret) {
+        TPD_INFO("chip is not identified\n");
+        ret = -EINVAL;
+    }
+
+    return ret;
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int nvt_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+static int nvt_get_usb_state(void)
+{
+    return 0;
+}
+#endif
+
+static int nvt_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+static u8 nvt_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    if ((gesture_enable == 1) && is_suspended) {
+        return IRQ_GESTURE;
+    } else if (is_suspended) {
+        return IRQ_IGNORE;
+    }
+
+    return IRQ_TOUCH;
+}
+
+static int nvt_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int obj_attention = 0;
+    int i = 0;
+    int32_t ret = -1;
+    uint32_t position = 0;
+    uint32_t input_x = 0;
+    uint32_t input_y = 0;
+    uint32_t input_w = 0;
+    uint32_t input_p = 0;
+    uint8_t pointid = 0;
+    uint8_t point_data[POINT_DATA_LEN + 1] = {0};
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    ret = CTP_SPI_READ(chip_info->s_client, point_data, POINT_DATA_LEN + 1);
+        if (ret < 0) {
+                TPD_INFO("CTP_SPI_READ failed.(%d)\n", ret);
+                return -1;
+        }
+
+    //some kind of protect mechanism, after WDT firware redownload and try to save tp
+    ret = nvt_wdt_fw_recovery(chip_info, point_data);
+        if (ret) {
+                TPD_INFO("Recover for fw reset %02X\n", point_data[1]);
+                nvt_reset(chip_info);
+                return -1;
+        }
+
+    for(i = 0; i < max_num; i++) {
+        position = 1 + 6 * i;
+        pointid = (uint8_t)(point_data[position + 0] >> 3) - 1;
+        if (pointid >= max_num) {
+            continue;
+        }
+
+        if (((point_data[position] & 0x07) == 0x01) || ((point_data[position] & 0x07) == 0x02)) {
+            input_x = (uint32_t)(point_data[position + 1] << 4) + (uint32_t) (point_data[position + 3] >> 4);
+            input_y = (uint32_t)(point_data[position + 2] << 4) + (uint32_t) (point_data[position + 3] & 0x0F);
+            if ((input_x < 0) || (input_y < 0)) {
+                continue;
+            }
+
+            input_w = (uint32_t)(point_data[position + 4]);
+            if (input_w == 0) {
+                input_w = 1;
+            }
+            if (i < 2) {
+                input_p = (uint32_t)(point_data[position + 5]) + (uint32_t)(point_data[i + 63] << 8);
+                if (input_p > 1000) {
+                    input_p = 1000;
+                }
+            } else {
+                input_p = (uint32_t)(point_data[position + 5]);
+            }
+            if (input_p == 0) {
+                input_p = 1;
+            }
+
+            obj_attention = obj_attention | (1 << pointid);
+            points[pointid].x = input_x;
+            points[pointid].y = input_y;
+            points[pointid].z = input_p;
+            points[pointid].width_major = input_w;
+            points[pointid].status = 1;
+        }
+    }
+
+    return obj_attention;
+}
+
+static int8_t nvt_cmd_store(struct chip_data_nt36672 *chip_info, uint8_t u8Cmd)
+{
+    int i, retry = 5;
+    uint8_t buf[3] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---(set page)
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    for (i = 0; i < retry; i++) {
+        //---set cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = u8Cmd;
+        CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+
+        msleep(20);
+
+        //---read cmd status---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        CTP_SPI_READ(chip_info->s_client, buf, 2);
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(i == retry)) {
+        TPD_INFO("send Cmd 0x%02X failed, buf[1]=0x%02X\n", u8Cmd, buf[1]);
+        return -1;
+    } else {
+        TPD_INFO("send Cmd 0x%02X success, tried %d times\n", u8Cmd, i);
+    }
+
+    return 0;
+}
+
+static int nvt_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    uint8_t gesture_id = 0;
+    uint8_t func_type = 0;
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    uint8_t point_data[POINT_DATA_LEN + 1] = {0};
+
+    memset(point_data, 0, sizeof(point_data));
+    ret = CTP_SPI_READ(chip_info->s_client, point_data, POINT_DATA_LEN + 1);
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture data failed\n", __func__);
+        return -1;
+    }
+
+    //some kind of protect mechanism, after WDT firware redownload and try to save tp
+    ret = nvt_wdt_fw_recovery(chip_info, point_data);
+    if (ret) {
+        TPD_INFO("receive all %02X, no gesture interrupts. recover for fw reset\n",
+                  point_data[1]);
+        nvt_reset(chip_info);
+        /* auto go back to wakeup gesture mode */
+        ret = nvt_cmd_store(chip_info, 0x13);
+        return 0;
+    }
+
+    gesture_id = (uint8_t)(point_data[1] >> 3);
+    func_type = (uint8_t)point_data[2];
+    if ((gesture_id == 30) && (func_type == 1)) {
+        gesture_id = (uint8_t)point_data[3];
+    } else if (gesture_id > 30) {
+        TPD_INFO("invalid gesture id= %d, no gesture event\n", gesture_id);
+        return 0;
+    }
+
+    switch (gesture_id)     //judge gesture type
+    {
+        case RIGHT_SLIDE_DETECT :
+            gesture->gesture_type  = Left2RightSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_SLIDE_DETECT :
+            gesture->gesture_type  = Right2LeftSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_SLIDE_DETECT  :
+            gesture->gesture_type  = Up2DownSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case UP_SLIDE_DETECT :
+            gesture->gesture_type  = Down2UpSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DTAP_DETECT:
+            gesture->gesture_type  = DouTap;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end     = gesture->Point_start;
+            break;
+
+        case UP_VEE_DETECT :
+            gesture->gesture_type  = UpVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case DOWN_VEE_DETECT :
+            gesture->gesture_type  = DownVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case LEFT_VEE_DETECT:
+            gesture->gesture_type = LeftVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case RIGHT_VEE_DETECT :
+            gesture->gesture_type  = RightVee;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            break;
+
+        case CIRCLE_DETECT  :
+            gesture->gesture_type = Circle;
+            gesture->clockwise = (point_data[43] == 0x20) ? 1 : 0;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;    //ymin
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;  //xmin
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;  //ymax
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_4th.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;  //xmax
+            gesture->Point_4th.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[24] & 0xFF) | (point_data[25] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[26] & 0xFF) | (point_data[27] & 0x0F) << 8;
+            break;
+
+        case DOUSWIP_DETECT  :
+            gesture->gesture_type  = DouSwip;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            break;
+
+        case M_DETECT  :
+            gesture->gesture_type  = Mgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        case W_DETECT :
+            gesture->gesture_type  = Wgestrue;
+            gesture->Point_start.x = (point_data[4] & 0xFF) | (point_data[5] & 0x0F) << 8;
+            gesture->Point_start.y = (point_data[6] & 0xFF) | (point_data[7] & 0x0F) << 8;
+            gesture->Point_1st.x   = (point_data[8] & 0xFF) | (point_data[9] & 0x0F) << 8;
+            gesture->Point_1st.y   = (point_data[10] & 0xFF) | (point_data[11] & 0x0F) << 8;
+            gesture->Point_2nd.x   = (point_data[12] & 0xFF) | (point_data[13] & 0x0F) << 8;
+            gesture->Point_2nd.y   = (point_data[14] & 0xFF) | (point_data[15] & 0x0F) << 8;
+            gesture->Point_3rd.x   = (point_data[16] & 0xFF) | (point_data[17] & 0x0F) << 8;
+            gesture->Point_3rd.y   = (point_data[18] & 0xFF) | (point_data[19] & 0x0F) << 8;
+            gesture->Point_end.x   = (point_data[20] & 0xFF) | (point_data[21] & 0x0F) << 8;
+            gesture->Point_end.y   = (point_data[22] & 0xFF) | (point_data[23] & 0x0F) << 8;
+            break;
+
+        default:
+            gesture->gesture_type = UnkownGesture;
+            break;
+    }
+
+    TPD_INFO("%s, gesture_id: 0x%x, gesture_type: %d, clockwise: %d, points: (%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)\n", \
+                __func__, gesture_id, gesture->gesture_type, gesture->clockwise, \
+                gesture->Point_start.x, gesture->Point_start.y, \
+                gesture->Point_end.x, gesture->Point_end.y, \
+                gesture->Point_1st.x, gesture->Point_1st.y, \
+                gesture->Point_2nd.x, gesture->Point_2nd.y, \
+                gesture->Point_3rd.x, gesture->Point_3rd.y, \
+                gesture->Point_4th.x, gesture->Point_4th.y);
+
+    return 0;
+}
+
+static int nvt_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    const struct firmware *fw = NULL;
+
+    TPD_INFO("%s.\n", __func__);
+
+    ret = request_firmware(&fw, chip_info->fw_name, chip_info->dev);
+    if (ret != 0) {
+        TPD_INFO("%s : request test firmware failed! ret = %d\n", __func__, ret);
+    }
+    ret = nvt_fw_update(chip_info, fw, 0);
+    if(ret > 0) {
+        TPD_INFO("fw update failed!\n");
+    }
+    if(fw != NULL) {
+        release_firmware(fw);
+    }
+
+    chip_info->is_sleep_writed = false;
+
+    return 0;
+}
+
+static int nvt_enable_black_gesture(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int ret = -1;
+    uint8_t buf[3];
+
+    TPD_INFO("%s, enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0x13;
+        ret = CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+        TPD_INFO("%s: enable gesture %s !\n", __func__, (ret < 0) ? "failed" : "success");
+    } else {
+        ret = 0;
+    }
+
+    return ret;
+}
+
+static int nvt_enable_edge_limit(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_ON);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_EDGE_LIMIT_OFF);
+    }
+
+    return ret;
+}
+
+static int nvt_enable_charge_mode(struct chip_data_nt36672 *chip_info, bool enable)
+{
+    int8_t ret = -1;
+
+    TPD_INFO("%s:enable = %d, chip_info->is_sleep_writed = %d\n", __func__, enable, chip_info->is_sleep_writed);
+
+    if (chip_info->is_sleep_writed) {
+        nvt_reset(chip_info);
+    }
+
+    if (enable) {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_IN);
+    } else {
+        ret = nvt_cmd_store(chip_info, EVENTBUFFER_PWR_PLUG_OUT);
+    }
+
+    return ret;
+}
+
+static int nvt_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;
+        break;
+
+        case MODE_SLEEP:
+            ret = nvt_enter_sleep(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enter sleep failed\n", __func__);
+            }
+        break;
+
+        case MODE_GESTURE:
+            ret = nvt_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable gesture failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = nvt_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: nvt enable edg limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = nvt_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static fw_check_state nvt_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint8_t ver_len = 0;
+    int ret = 0;
+    char dev_version[MAX_DEVICE_VERSION_LENGTH] = {0};
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    ret |= nvt_get_fw_info_noflash(chip_info);
+    if (ret < 0) {
+        TPD_INFO("%s: get fw info failed\n", __func__);
+        return FW_ABNORMAL;
+    } else {
+        panel_data->TP_FW = chip_info->fw_ver;
+        sprintf(dev_version, "%02x", panel_data->TP_FW);
+        if (panel_data->manufacture_info.version) {
+            ver_len = strlen(panel_data->manufacture_info.version);
+            if (ver_len <= 8) {
+                strlcat(panel_data->manufacture_info.version, dev_version, MAX_DEVICE_VERSION_LENGTH);
+            } else {
+                strlcpy(&panel_data->manufacture_info.version[8], dev_version, MAX_DEVICE_VERSION_LENGTH - 8);
+            }
+        }
+    }
+
+    return FW_NORMAL;
+}
+
+static int32_t nvt_clear_fw_status(struct chip_data_nt36672 *chip_info)
+{
+        uint8_t buf[8] = {0};
+        int32_t i = 0;
+        const int32_t retry = 20;
+
+        for (i = 0; i < retry; i++) {
+                //---set xdata index to EVENT BUF ADDR---
+                nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE);
+
+                //---clear fw status---
+                buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+                buf[1] = 0x00;
+                CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+
+                //---read fw status---
+                buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+                buf[1] = 0xFF;
+                CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+                if (buf[1] == 0x00)
+                        break;
+
+                msleep(10);
+        }
+
+        if (i >= retry) {
+                TPD_INFO("failed, i=%d, buf[1]=0x%02X\n", i, buf[1]);
+                return -1;
+        } else {
+                return 0;
+        }
+}
+
+static void nvt_enable_noise_collect(struct chip_data_nt36672 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    ret = nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HOST_CMD);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x47;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= CTP_SPI_WRITE(chip_info->s_client, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int8_t nvt_switch_FreqHopEnDis(struct chip_data_nt36672 *chip_info, uint8_t FreqHopEnDis)
+{
+    uint8_t buf[8] = {0};
+    uint8_t retry = 0;
+    int8_t ret = 0;
+
+    for (retry = 0; retry < 20; retry++) {
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        //---switch FreqHopEnDis---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = FreqHopEnDis;
+        CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+
+        msleep(35);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0xFF;
+        CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+        if (buf[1] == 0x00)
+            break;
+    }
+
+    if (unlikely(retry == 20)) {
+        TPD_INFO("switch FreqHopEnDis 0x%02X failed, buf[1]=0x%02X\n", FreqHopEnDis, buf[1]);
+        ret = -1;
+    }
+
+    return ret;
+}
+
+static void nvt_change_mode(struct chip_data_nt36672 *chip_info, uint8_t mode)
+{
+        uint8_t buf[8] = {0};
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HOST_CMD);
+
+        //---set mode---
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = mode;
+        CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+
+        if (mode == NORMAL_MODE) {
+                buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+                buf[1] = HANDSHAKING_HOST_READY;
+                CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+                msleep(20);
+        }
+}
+
+static uint8_t nvt_get_fw_pipe_noflash(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8]= {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE);
+
+    //---read fw status---
+    buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+    buf[1] = 0x00;
+    ret |= CTP_SPI_READ(chip_info->s_client, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("%s: read or write failed\n", __func__);
+    }
+
+    return (buf[1] & 0x01);
+}
+
+static void nvt_read_mdata(struct chip_data_nt36672 *chip_info, uint32_t xdata_addr, int32_t *xdata, int32_t xdata_len)
+{
+        int32_t i = 0;
+        int32_t j = 0;
+        int32_t k = 0;
+        uint8_t buf[SPI_TANSFER_LENGTH + 1] = {0};
+        uint32_t head_addr = 0;
+        int32_t dummy_len = 0;
+        int32_t data_len = 0;
+        int32_t residual_len = 0;
+        uint8_t *xdata_tmp = NULL;
+
+        //---set xdata sector address & length---
+        head_addr = xdata_addr - (xdata_addr % XDATA_SECTOR_SIZE);
+        dummy_len = xdata_addr - head_addr;
+        data_len = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2;
+        residual_len = (head_addr + dummy_len + data_len) % XDATA_SECTOR_SIZE;
+
+        if (xdata_len/sizeof(int32_t) < data_len/2) {
+                TPD_INFO("xdata read buffer(%d) less than max data size(%d), return\n", xdata_len, data_len);
+                return;
+        }
+
+        //malloc buffer space
+        xdata_tmp = kzalloc(2048 ,GFP_KERNEL);
+        if (xdata_tmp == NULL) {
+                TPD_INFO("%s malloc memory failed\n", __func__);
+                return;
+        }
+
+        //read xdata : step 1
+        for (i = 0; i < ((dummy_len + data_len) / XDATA_SECTOR_SIZE); i++) {
+                //---read xdata by SPI_TANSFER_LENGTH
+                for (j = 0; j < (XDATA_SECTOR_SIZE / SPI_TANSFER_LENGTH); j++) {
+                        //---change xdata index---
+                        nvt_set_page(chip_info, head_addr + (XDATA_SECTOR_SIZE * i) + (SPI_TANSFER_LENGTH * j));
+
+                        //---read data---
+                        buf[0] = SPI_TANSFER_LENGTH * j;
+                        CTP_SPI_READ(chip_info->s_client, buf, SPI_TANSFER_LENGTH + 1);
+
+                        //---copy buf to xdata_tmp---
+                        for (k = 0; k < SPI_TANSFER_LENGTH; k++) {
+                                xdata_tmp[XDATA_SECTOR_SIZE * i + SPI_TANSFER_LENGTH * j + k] = buf[k + 1];
+                                //printk("0x%02X, 0x%04X\n", buf[k+1], (XDATA_SECTOR_SIZE*i + SPI_TANSFER_LENGTH*j + k));
+                        }
+                }
+                //printk("addr=0x%05X\n", (head_addr+XDATA_SECTOR_SIZE*i));
+        }
+
+        //read xdata : step2
+        if (residual_len != 0) {
+                //---read xdata by SPI_TANSFER_LENGTH
+                for (j = 0; j < (residual_len / SPI_TANSFER_LENGTH + 1); j++) {
+                        //---change xdata index---
+                        nvt_set_page(chip_info, xdata_addr + data_len - residual_len + (SPI_TANSFER_LENGTH * j));
+
+                        //---read data---
+                        buf[0] = SPI_TANSFER_LENGTH * j;
+                        CTP_SPI_READ(chip_info->s_client, buf, SPI_TANSFER_LENGTH + 1);
+
+                        //---copy buf to xdata_tmp---
+                        for (k = 0; k < SPI_TANSFER_LENGTH; k++) {
+                                xdata_tmp[(dummy_len + data_len - residual_len) + SPI_TANSFER_LENGTH * j + k] = buf[k + 1];
+                                //printk("0x%02X, 0x%04x\n", buf[k+1], ((dummy_len+data_len-residual_len) + SPI_TANSFER_LENGTH*j + k));
+                        }
+                }
+                //printk("addr=0x%05X\n", (xdata_addr+data_len-residual_len));
+        }
+
+        //---remove dummy data and 2bytes-to-1data---
+        for (i = 0; i < (data_len / 2); i++) {
+                xdata[i] = (int16_t)(xdata_tmp[dummy_len + i * 2] + 256 * xdata_tmp[dummy_len + i * 2 + 1]);
+        }
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        kfree(xdata_tmp);
+}
+
+static int32_t nvt_polling_hand_shake_status(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+        if ((buf[1] == 0xA0) || (buf[1] == 0xA1))
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("polling hand shake status failed, buf[1]=0x%02X\n", buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static int32_t nvt_check_fw_status(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+    int32_t i = 0;
+    const int32_t retry = 50;
+
+    for (i = 0; i < retry; i++) {
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE);
+
+        //---read fw status---
+        buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+        buf[1] = 0x00;
+        CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+        if ((buf[1] & 0xF0) == 0xA0)
+            break;
+
+        msleep(10);
+    }
+
+    if (i >= retry) {
+        TPD_INFO("%s failed, i=%d, buf[1]=0x%02X\n", __func__, i, buf[1]);
+        return -1;
+    } else {
+        return 0;
+    }
+}
+
+static uint8_t nvt_get_fw_pipe(struct chip_data_nt36672 *chip_info)
+{
+    int ret = -1;
+    uint8_t buf[8]= {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    ret = nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR | EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE);
+
+    //---read fw status---
+    buf[0] = EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE;
+    buf[1] = 0x00;
+    ret |= CTP_SPI_READ(chip_info->s_client, buf, 2);
+    if (ret < 0) {
+        TPD_INFO("%s: read or write failed\n", __func__);
+    }
+
+    return (buf[1] & 0x01);
+}
+
+static int32_t nvt_read_fw_noise(struct chip_data_nt36672 *chip_info, int32_t config_Diff_Test_Frame, int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint32_t x = 0;
+    uint32_t y = 0;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw nosie buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Diff_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Diff_Test_Frame * 8.3ms
+    msleep(frame_num * 83);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_info_noflash(chip_info)) {
+        return -EAGAIN;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0) {
+        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE0_ADDR, xdata, xdata_len);
+    } else {
+        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE1_ADDR, xdata, xdata_len);
+    }
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF);
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF);
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+#if 0   //Roland
+/*******************************************************
+Description:
+        Novatek touchscreen release update firmware function.
+
+return:
+        n.a.
+*******************************************************/
+static void update_firmware_release(const struct firmware *fw)
+{
+        if (fw) {
+                release_firmware(fw);
+        }
+
+        fw = NULL;
+}
+#endif
+
+static fw_update_state nvt_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret = 0;
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+    struct firmware *request_fw_headfile = NULL;
+
+    //request firmware failed, get from headfile
+    if(fw == NULL) {
+        TPD_INFO("request firmware failed, get from headfile\n");
+        request_fw_headfile = kzalloc(sizeof(struct firmware), GFP_KERNEL);
+        if(request_fw_headfile == NULL) {
+                TPD_INFO("%s kzalloc failed!\n", __func__);
+                return FW_NO_NEED_UPDATE;
+        }
+
+        request_fw_headfile->size = sizeof(FIRMWARE_DATA);
+        request_fw_headfile->data = FIRMWARE_DATA;
+        fw = request_fw_headfile;
+    }
+
+    //check bin file size(116kb)
+    if(fw->size != FW_BIN_SIZE) {
+        TPD_INFO("bin file size not match. (%zu)\n", fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+
+    // check if FW version add FW version bar equals 0xFF
+        if (*(fw->data + FW_BIN_VER_OFFSET) + *(fw->data + FW_BIN_VER_BAR_OFFSET) != 0xFF) {
+                TPD_INFO("bin file FW_VER + FW_VER_BAR should be 0xFF!\n");
+                TPD_INFO("FW_VER=0x%02X, FW_VER_BAR=0x%02X\n", *(fw->data+FW_BIN_VER_OFFSET), *(fw->data+FW_BIN_VER_BAR_OFFSET));
+                return FW_NO_NEED_UPDATE;
+        }
+
+    /* BIN Header Parser */
+        ret = nvt_bin_header_parser(chip_info, fw->data, fw->size);
+        if (ret) {
+                TPD_INFO("bin header parser failed\n");
+                goto download_fail;
+        }
+
+    /* initial buffer and variable */
+    ret = Download_Init(chip_info);
+    if (ret) {
+        TPD_INFO("Download Init failed. (%d)\n", ret);
+        goto init_fail;
+    }
+
+    /* download firmware process */
+        if (chip_info->trim_id_table.support_hw_crc)
+                ret = Download_Firmware_HW_CRC(chip_info, fw);
+        else
+                ret = Download_Firmware(chip_info, fw);
+        if (ret) {
+                TPD_INFO("Download Firmware failed. (%d)\n", ret);
+                goto download_fail;
+        }
+
+        TPD_INFO("Update firmware success! <%ld us>\n",
+                        (end.tv_sec - start.tv_sec)*1000000L + (end.tv_usec - start.tv_usec));
+
+        /* Get FW Info */
+        ret = nvt_get_fw_info_noflash(chip_info);
+        if (ret) {
+                TPD_INFO("nvt_get_fw_info_noflash failed. (%d)\n", ret);
+                goto download_fail;
+        }
+
+        if(chip_info->bin_map != NULL) {
+                kfree(chip_info->bin_map);
+        }
+
+        if(request_fw_headfile != NULL) {
+                kfree(request_fw_headfile);
+                request_fw_headfile = NULL;
+                fw = NULL;
+        }
+        return FW_UPDATE_SUCCESS;
+
+download_fail:
+        if(chip_info->bin_map != NULL) {
+                kfree(chip_info->bin_map);
+        }
+init_fail:
+        if(request_fw_headfile != NULL) {
+                kfree(request_fw_headfile);
+                request_fw_headfile = NULL;
+                fw = NULL;
+        }
+        return FW_NO_NEED_UPDATE;
+}
+
+static void nvt_black_screen_test(void *chip_data, char *message)
+{
+        int ret = 0;
+        int32_t *raw_data = NULL, *raw_data_n = NULL;
+        struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+        int tx_num = chip_info->hw_res->TX_NUM;
+        int rx_num = chip_info->hw_res->RX_NUM;
+        int i, j, iArrayIndex, err_cnt = 0;
+        int fd = -1;
+        mm_segment_t old_fs;
+        char buf[128] = {0};
+        uint8_t data_buf[64];
+        struct timespec now_time;
+        struct rtc_time rtc_now_time;
+        int32_t *lpwg_rawdata_P = NULL, *lpwg_rawdata_N = NULL;
+        int32_t *lpwg_diff_rawdata_P = NULL, *lpwg_diff_rawdata_N = NULL;
+        char *p_node = NULL;
+        char *fw_name_test = NULL;
+        char *postfix = "_TEST.bin";
+        uint8_t copy_len = 0;
+        const struct firmware *fw = NULL;
+        struct nvt_test_header *ph = NULL;
+        int32_t buf_len = 0;
+
+        //update test firmware
+        fw_name_test = kzalloc(MAX_FW_NAME_LENGTH, GFP_KERNEL);
+        if(fw_name_test == NULL) {
+                TPD_INFO("fw_name_test kzalloc error!\n");
+                return;
+        }
+
+        p_node  = strstr(chip_info->fw_name, ".");
+        copy_len = p_node - chip_info->fw_name;
+        memcpy(fw_name_test, chip_info->fw_name, copy_len);
+        strlcat(fw_name_test, postfix, MAX_FW_NAME_LENGTH);
+        TPD_INFO("%s : fw_name_test is %s\n", __func__, fw_name_test);
+
+        //update test firmware
+        ret = request_firmware(&fw, fw_name_test, chip_info->dev);
+        if (ret != 0) {
+                TPD_INFO("request test firmware failed! ret = %d\n", ret);
+                kfree(fw_name_test);
+                fw_name_test = NULL;
+                return;
+        }
+
+        ret = nvt_fw_update(chip_info, fw, 0);
+        if(ret > 0) {
+                TPD_INFO("fw update failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        TPD_INFO("%s : update test firmware successed\n", __func__);
+
+        //---set xdata index to EVENT BUF ADDR---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+        buf[0] = EVENT_MAP_HOST_CMD;
+        buf[1] = 0x13;
+        ret = CTP_SPI_WRITE(chip_info->s_client, buf, 2);
+        TPD_INFO("%s: enable gesture %s !\n", __func__, (ret < 0) ? "failed" : "success");
+        msleep(100);
+
+        if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+                TPD_INFO("switch frequency hopping disable failed!\n");
+                sprintf(message, "1 error, switch frequency hopping disable failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        if (nvt_check_fw_reset_state_noflash(chip_info, RESET_STATE_NORMAL_RUN)) {
+                TPD_INFO("check fw reset state failed!\n");
+                sprintf(message, "1 error, check fw reset state failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        msleep(100);
+
+        //---Enter Test Mode---
+        if (nvt_clear_fw_status(chip_info)) {
+                TPD_INFO("clear fw status failed!\n");
+                sprintf(message, "1 error, clear fw status failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        nvt_change_mode(chip_info, TEST_MODE_2);
+
+        if (nvt_check_fw_status(chip_info)) {
+                TPD_INFO("check fw status failed!\n");
+                sprintf(message, "1 error, clear fw status failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        if (nvt_get_fw_info_noflash(chip_info)) {
+                TPD_INFO("get fw info failed!\n");
+                sprintf(message, "1 error, get fw info failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        TPD_INFO("malloc raw_data space\n");
+        buf_len = tx_num * rx_num * sizeof(int32_t);
+        raw_data = kzalloc(buf_len, GFP_KERNEL);
+        raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+        if (!(raw_data && raw_data_n)) {
+                TPD_INFO("kzalloc space failed\n");
+                sprintf(message, "1 error, kzalloc space failed\n");
+                if (raw_data)
+                    kfree(raw_data);
+                if (raw_data_n)
+                    kfree(raw_data_n);
+                return;
+        }
+
+        ret = request_firmware(&fw, chip_info->test_limit_name, &chip_info->s_client->dev);
+        TPD_INFO("Roland--->fw path is %s\n", chip_info->test_limit_name);
+        if (ret < 0) {
+                TPD_INFO("Request firmware failed - %s (%d)\n", chip_info->test_limit_name, ret);
+                sprintf(message, "1 error, Request firmware failed: %s\n", chip_info->test_limit_name);
+                kfree(raw_data);
+                kfree(raw_data_n);
+                raw_data = NULL;
+                raw_data_n = NULL;
+                return;
+        }
+        ph = (struct nvt_test_header *)(fw->data);
+
+        //create a file to store test data in /sdcard/ScreenOffTpTestReport
+        getnstimeofday(&now_time);
+        rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+        sprintf(data_buf, "/sdcard/TpTestReport/screenOff/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+        old_fs = get_fs();
+        set_fs(KERNEL_DS);
+        sys_mkdir("/sdcard/TpTestReport/screenOff", 0666);
+        fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+        if (fd < 0) {
+                TPD_INFO("Open log file '%s' failed.\n", data_buf);
+                err_cnt++;
+                sprintf(buf, "Open log file '%s' failed.\n", data_buf);
+                goto OUT;
+        }
+
+        lpwg_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_P_offset);
+        lpwg_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_N_offset);
+        lpwg_diff_rawdata_P = (int32_t *)(fw->data + ph->array_LPWG_Diff_P_offset);
+        lpwg_diff_rawdata_N = (int32_t *)(fw->data + ph->array_LPWG_Diff_N_offset);
+
+        //---FW Rawdata Test---
+        TPD_INFO("LPWG mode FW Rawdata Test \n");
+        memset(raw_data, 0, buf_len);
+        if (nvt_get_fw_pipe(chip_info) == 0)
+                nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->RAW_PIPE0_ADDR, raw_data, buf_len);
+        else
+                nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->RAW_PIPE1_ADDR, raw_data, buf_len);
+        store_to_file(fd, "LPWG mode FW Rawdata:\n");
+    if ((ph->config_Lmt_LPWG_Rawdata_P != 0) && (ph->config_Lmt_LPWG_Rawdata_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+                for (i = 0; i < tx_num; i++) {
+                        iArrayIndex = j * tx_num + i;
+                        TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                        if (fd >= 0) {
+                                store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Rawdata_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Rawdata_N)) {
+                                TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                                if (!err_cnt) {
+                                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                                                i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Rawdata_N, ph->config_Lmt_LPWG_Rawdata_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (fd >= 0) {
+                        store_to_file(fd, "\n");
+                }
+                TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG_Rawdata Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Rawdata[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_rawdata_N[iArrayIndex], lpwg_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+        //---Leave Test Mode---
+        nvt_change_mode(chip_info, NORMAL_MODE);
+
+        //---Noise Test---
+        TPD_INFO("LPWG mode FW Noise Test \n");
+        memset(raw_data, 0, buf_len);  //store max
+        memset(raw_data_n, 0, buf_len); //store min
+        if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+                TPD_INFO("LPWG mode read Noise data failed!\n");    // 1: ERROR
+                sprintf(buf, "LPWG mode read Noise data failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Max:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_LPWG_Diff_P != 0) && (ph->config_Lmt_LPWG_Diff_N != 0)) {
+        for (j = 0; j < rx_num; j++) {
+                for (i = 0; i < tx_num; i++) {
+                        iArrayIndex = j * tx_num + i;
+                        TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                        if (fd >= 0) {
+                                store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                                TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                                if (!err_cnt) {
+                                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                                                i, j, raw_data[iArrayIndex], ph->config_Lmt_LPWG_Diff_N, ph->config_Lmt_LPWG_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (fd >= 0) {
+                        store_to_file(fd, "\n");
+                }
+                TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+                for (i = 0; i < tx_num; i++) {
+                        iArrayIndex = j * tx_num + i;
+                        TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                        if (fd >= 0) {
+                                store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                        }
+                        if((raw_data_n[iArrayIndex] > ph->config_Lmt_LPWG_Diff_P) \
+                                || (raw_data_n[iArrayIndex] < ph->config_Lmt_LPWG_Diff_N)) {
+                                TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                                if (!err_cnt) {
+                                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                                                i, j, raw_data_n[iArrayIndex], ph->config_Lmt_LPWG_Diff_N,  ph->config_Lmt_LPWG_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (fd >= 0) {
+                        store_to_file(fd, "\n");
+                }
+                TPD_DEBUG_NTAG("\n");
+        }
+    } else {
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Max Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Max[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        TPD_INFO("LPWG Noise RawData_Diff_Min:\n");
+        store_to_file(fd, "LPWG Noise RawData_Diff_Min:\n");
+        for (j = 0; j < rx_num; j++) {
+            for (i = 0; i < tx_num; i++) {
+                iArrayIndex = j * tx_num + i;
+                TPD_DEBUG_NTAG("%d, ", raw_data_n[iArrayIndex]);
+                if (fd >= 0) {
+                    store_to_file(fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > lpwg_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < lpwg_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("LPWG Noise RawData_Diff_Min Test failed at rawdata[%d][%d] = %d\n", i, j, raw_data_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        sprintf(buf, "LPWG Noise RawData_Diff_Min[%d][%d] = %d[%d %d]\n",
+                            i, j, raw_data_n[iArrayIndex], lpwg_diff_rawdata_N[iArrayIndex], lpwg_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (fd >= 0) {
+                store_to_file(fd, "\n");
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+    }
+
+OUT:
+        if (fd >= 0) {
+                sys_close(fd);
+        }
+        set_fs(old_fs);
+
+        if (raw_data)
+                kfree(raw_data);
+        if (raw_data_n)
+                kfree(raw_data_n);
+        sprintf(message, "%d errors. %s", err_cnt, buf);
+        TPD_INFO("%d errors. %s", err_cnt, buf);
+RELEASE_FIRMWARE:
+        release_firmware(fw);
+        kfree(fw_name_test);
+        fw_name_test = NULL;
+}
+
+static struct oppo_touchpanel_operations nvt_ops = {
+    .ftm_process                = nvt_ftm_process,
+    .reset                      = nvt_reset,
+    .power_control              = nvt_power_control,
+    .get_chip_info              = nvt_get_chip_info,
+    .trigger_reason             = nvt_trigger_reason,
+    .get_touch_points           = nvt_get_touch_points,
+    .get_gesture_info           = nvt_get_gesture_info,
+    .mode_switch                = nvt_mode_switch,
+    .fw_check                   = nvt_fw_check,
+    .fw_update                  = nvt_fw_update,
+    .get_vendor                 = nvt_get_vendor,
+    .get_usb_state              = nvt_get_usb_state,
+    .black_screen_test          = nvt_black_screen_test,
+};
+
+static void nvt_data_read(struct seq_file *s, struct chip_data_nt36672 *chip_info, DEBUG_READ_TYPE read_type)
+{
+        int ret = -1;
+        int i, j;
+        uint8_t pipe;
+        int32_t *xdata = NULL;
+        int32_t buf_len = 0;
+
+        TPD_INFO("nvt clear fw status start\n");
+        ret = nvt_clear_fw_status(chip_info);
+        if (ret < 0) {
+                TPD_INFO("clear_fw_status error, return\n");
+                return;
+        }
+
+        nvt_change_mode(chip_info, TEST_MODE_2);
+        TPD_INFO("nvt check fw status start\n");
+        ret = nvt_check_fw_status(chip_info);
+        if (ret < 0) {
+                TPD_INFO("check_fw_status error, return\n");
+                return;
+        }
+
+        TPD_INFO("nvt get fw info start");
+        ret = nvt_get_fw_info_noflash(chip_info);
+        if (ret < 0) {
+                TPD_INFO("get_fw_info error, return\n");
+                return;
+        }
+
+        buf_len = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * sizeof(int32_t);
+        xdata = kzalloc(buf_len ,GFP_KERNEL);
+        if (!xdata) {
+                TPD_INFO("%s, malloc memory failed\n", __func__);
+                return;
+        }
+
+        pipe = nvt_get_fw_pipe_noflash(chip_info);
+        TPD_INFO("nvt_get_fw_pipe:%d\n", pipe);
+        switch (read_type) {
+        case NVT_RAWDATA:
+                seq_printf(s, "raw_data:\n");
+                if (pipe == 0)
+                        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->RAW_PIPE0_ADDR, xdata, buf_len);
+                else
+                        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->RAW_PIPE1_ADDR, xdata, buf_len);
+        break;
+        case NVT_DIFFDATA:
+                seq_printf(s, "diff_data:\n");
+                if (pipe == 0)
+                        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE0_ADDR, xdata, buf_len);
+                else
+                        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE1_ADDR, xdata, buf_len);
+        break;
+        case NVT_BASEDATA:
+                seq_printf(s, "basline_data:\n");
+                nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->BASELINE_ADDR, xdata, buf_len);
+                break;
+                default:
+                seq_printf(s, "read type not support\n");
+        break;
+        }
+
+        nvt_change_mode(chip_info, NORMAL_MODE);
+        TPD_INFO("change normal mode end\n");
+
+        //print all data
+        for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+                seq_printf(s, "[%2d]", i);
+                for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+                        seq_printf(s, "%5d, ", xdata[i * chip_info->hw_res->TX_NUM + j]);
+                }
+                seq_printf(s, "\n");
+        }
+
+        kfree(xdata);
+}
+
+static void nvt_delta_read(struct seq_file *s, void *chip_data)
+{
+        struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+        nvt_data_read(s, chip_info, NVT_DIFFDATA);
+}
+
+static void nvt_baseline_read(struct seq_file *s, void *chip_data)
+{
+        struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+        nvt_data_read(s, chip_info, NVT_BASEDATA);
+        nvt_data_read(s, chip_info, NVT_RAWDATA);
+}
+
+static void nvt_main_register_read(struct seq_file *s, void *chip_data)
+{
+    uint8_t buf[3];
+    struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //---set xdata index to EVENT BUF ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    //---read cmd status---
+    buf[0] = 0x5E;
+    buf[1] = 0xFF;
+    CTP_SPI_READ(chip_info->s_client, buf, 2);
+
+    seq_printf(s, "PWR_FLAG:%d\n", (buf[1]>> PWR_FLAG) & 0x01);
+    seq_printf(s, "EDGE_REGECT:%d\n", (buf[1]>> EDGE_REGECT) & 0x01);
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = nvt_limit_read,    
+    .baseline_read = nvt_baseline_read,
+    .delta_read = nvt_delta_read,
+    .main_register_read = nvt_main_register_read,
+};
+
+static void nvt_enable_doze_noise_collect(struct chip_data_nt36672 *chip_info, int32_t frame_num)
+{
+    int ret = -1;
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    ret = nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    //---enable noise collect---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x4B;
+    buf[2] = 0xAA;
+    buf[3] = frame_num;
+    buf[4] = 0x00;
+    ret |= CTP_SPI_WRITE(chip_info->s_client, buf, 5);
+    if (ret < 0) {
+        TPD_INFO("%s failed\n", __func__);
+    }
+}
+
+static int32_t nvt_read_doze_fw_noise(struct chip_data_nt36672 *chip_info, int32_t config_Doze_Noise_Test_Frame, int32_t doze_X_Channel,int32_t *xdata, int32_t *xdata_n, int32_t xdata_len)
+{
+    uint8_t buf[128] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+    int32_t frame_num = 0;
+
+    if (xdata_len/sizeof(int32_t) < rx_num * doze_X_Channel) {
+        TPD_INFO("read doze nosie buffer(%d) less than data size(%d)\n", xdata_len, rx_num * doze_X_Channel);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    frame_num = config_Doze_Noise_Test_Frame / 10;
+    if (frame_num <= 0)
+        frame_num = 1;
+    TPD_INFO("%s: frame_num=%d\n", __func__, frame_num);
+    nvt_enable_doze_noise_collect(chip_info, frame_num);
+    // need wait PS_Config_Doze_Noise_Test_Frame * 8.3ms
+    msleep(frame_num * 83);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x);
+
+        //---read data---
+        buf[0] = (chip_info->trim_id_table.mmap->DIFF_PIPE0_ADDR + rx_num * doze_X_Channel * x) & 0xFF;
+        CTP_SPI_READ(chip_info->s_client, buf, rx_num * 2 + 1);
+
+        for (y = 0; y < rx_num; y++) {
+            xdata[y * doze_X_Channel + x] = (uint16_t)(buf[y * doze_X_Channel + 1] + 256 * buf[y * doze_X_Channel + 2]);
+        }
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata_n[iArrayIndex] = (int8_t)(xdata[iArrayIndex] & 0xFF) * 4;
+            xdata[iArrayIndex] = (int8_t)((xdata[iArrayIndex] >> 8) & 0xFF) * 4;    //scaling up
+        }
+    }
+
+    //---Leave Test Mode---
+    //nvt_change_mode(NORMAL_MODE);    //No return to normal mode. Continuous to get doze rawdata
+
+    return 0;
+}
+
+static int32_t nvt_read_doze_baseline(struct chip_data_nt36672 *chip_info, int32_t doze_X_Channel, int32_t *xdata, int32_t xdata_len)
+{
+    uint8_t buf[256] = {0};
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t rm_num = chip_info->hw_res->RX_NUM;
+    int32_t iArrayIndex = 0;
+
+    //---Enter Test Mode---
+    //nvt_change_mode(TEST_MODE_2);
+
+    //if (nvt_check_fw_status()) {
+    //    return -EAGAIN;
+    //}
+    if (xdata_len/sizeof(int32_t) < rm_num * doze_X_Channel) {
+        TPD_INFO("read doze baseline buffer(%d) less than data size(%d)\n", xdata_len, rm_num * doze_X_Channel);
+        return -1;
+    }
+
+    for (x = 0; x < doze_X_Channel; x++) {
+        //---change xdata index---
+        nvt_set_page(chip_info, chip_info->trim_id_table.mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x);
+
+        //---read data---
+        buf[0] = (chip_info->trim_id_table.mmap->DOZE_GM_S1D_SCAN_RAW_ADDR + rm_num * doze_X_Channel * x) & 0xFF;
+        CTP_SPI_READ(chip_info->s_client, buf, rm_num * 2 + 1);
+        for (y = 0; y < rm_num; y++) {
+            xdata[y * 2 + x] = (uint16_t)(buf[y * 2 + 1] + 256 * buf[y * 2 + 2]);
+        }
+    }
+
+    for (y = 0; y < rm_num; y++) {
+        for (x = 0; x < doze_X_Channel; x++) {
+            iArrayIndex = y * doze_X_Channel + x;
+            xdata[iArrayIndex] = (int16_t)xdata[iArrayIndex];
+        }
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_short_test(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    //---enable short test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x43;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    CTP_SPI_WRITE(chip_info->s_client, buf, 5);
+}
+
+static int32_t nvt_read_fw_short(struct chip_data_nt36672 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint8_t buf[128] = {0};
+    int32_t iArrayIndex = 0;
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw short buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_short_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->trim_id_table.mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->trim_id_table.mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        //---change xdata index---
+        nvt_set_page(chip_info, raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * chip_info->hw_res->TX_NUM * 2) & 0xFF);
+        CTP_SPI_READ(chip_info->s_client, buf, chip_info->hw_res->TX_NUM * 2 + 1);
+        memcpy(rawdata_buf + y * chip_info->hw_res->TX_NUM * 2, buf + 1, chip_info->hw_res->TX_NUM * 2);
+    }
+
+    for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            iArrayIndex = y * chip_info->hw_res->TX_NUM + x;
+            xdata[iArrayIndex] = (int16_t)(rawdata_buf[iArrayIndex * 2] + 256 * rawdata_buf[iArrayIndex * 2 + 1]);
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_enable_open_test(struct chip_data_nt36672 *chip_info)
+{
+    uint8_t buf[8] = {0};
+
+    //---set xdata index to EVENT BUF ADDR---
+    nvt_set_page(chip_info, chip_info->trim_id_table.mmap->EVENT_BUF_ADDR);
+
+    //---enable open test---
+    buf[0] = EVENT_MAP_HOST_CMD;
+    buf[1] = 0x45;
+    buf[2] = 0xAA;
+    buf[3] = 0x02;
+    buf[4] = 0x00;
+    CTP_SPI_WRITE(chip_info->s_client, buf, 5);
+}
+
+static int32_t nvt_read_fw_open(struct chip_data_nt36672 *chip_info, int32_t *xdata, int32_t xdata_len)
+{
+    uint32_t raw_pipe_addr = 0;
+    uint8_t *rawdata_buf = NULL;
+    uint32_t x = 0;
+    uint32_t y = 0;
+    uint32_t tx_num = chip_info->hw_res->TX_NUM;
+    uint32_t rx_num = chip_info->hw_res->RX_NUM;
+    uint8_t buf[128] = {0};
+
+    if (xdata_len/sizeof(int32_t) < chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) {
+        TPD_INFO("read fw open buffer(%d) less than data size(%d)\n", xdata_len, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM);
+        return -1;
+    }
+
+    //---Enter Test Mode---
+    if (nvt_clear_fw_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    nvt_enable_open_test(chip_info);
+
+    if (nvt_polling_hand_shake_status(chip_info)) {
+        return -EAGAIN;
+    }
+
+    rawdata_buf = (uint8_t *)kzalloc(tx_num * rx_num * 2, GFP_KERNEL);
+    if (!rawdata_buf) {
+        TPD_INFO("kzalloc for rawdata_buf failed!\n");
+        return -ENOMEM;
+    }
+
+    if (nvt_get_fw_pipe(chip_info) == 0)
+        raw_pipe_addr = chip_info->trim_id_table.mmap->RAW_PIPE0_ADDR;
+    else
+        raw_pipe_addr = chip_info->trim_id_table.mmap->RAW_PIPE1_ADDR;
+
+    for (y = 0; y < rx_num; y++) {
+        //---change xdata index---
+        nvt_set_page(chip_info, raw_pipe_addr + y * tx_num * 2);
+        buf[0] = (uint8_t)((raw_pipe_addr + y * tx_num * 2) & 0xFF);
+        CTP_SPI_READ(chip_info->s_client, buf, tx_num * 2 + 1);
+        memcpy(rawdata_buf + y * tx_num * 2, buf + 1, tx_num * 2);
+    }
+
+    for (y = 0; y < rx_num; y++) {
+        for (x = 0; x < tx_num; x++) {
+            xdata[(rx_num-y-1) * tx_num + (tx_num-x-1)] = (int16_t)((rawdata_buf[(y*tx_num + x)*2] + 256 * rawdata_buf[(y*tx_num + x)*2 + 1]));
+        }
+    }
+
+    if (rawdata_buf) {
+        kfree(rawdata_buf);
+        rawdata_buf = NULL;
+    }
+
+    //---Leave Test Mode---
+    nvt_change_mode(chip_info, NORMAL_MODE);
+    return 0;
+}
+
+static void nvt_auto_test(struct seq_file *s, void *chip_data, struct nvt_testdata *nvt_testdata)
+{
+        int32_t *raw_data = NULL;
+        int32_t *raw_data_n = NULL;
+        int i, j, buf_len = 0;
+        int err_cnt = 0;
+        int32_t iArrayIndex = 0;
+        int ret = -1;
+        const struct firmware *fw = NULL;
+        struct chip_data_nt36672 *chip_info = (struct chip_data_nt36672 *)chip_data;
+        struct nvt_test_header *ph = NULL;
+        int32_t *fw_rawdata_P = NULL, *fw_rawdata_N = NULL;
+        int32_t *open_rawdata_P = NULL, *open_rawdata_N = NULL;
+        int32_t *short_rawdata_P = NULL, *short_rawdata_N = NULL;
+        int32_t *diff_rawdata_P = NULL, *diff_rawdata_N = NULL;
+        int32_t *cc_data_P = NULL, *cc_data_N = NULL;
+        int32_t *doze_rawdata_P = NULL, *doze_rawdata_N = NULL;
+        int32_t *doze_diff_rawdata_P = NULL, *doze_diff_rawdata_N = NULL;
+        char *p_node = NULL;
+        char *fw_name_test = NULL;
+        char *postfix = "_TEST.bin";
+        uint8_t copy_len = 0;
+
+        fw_name_test = kzalloc(MAX_FW_NAME_LENGTH, GFP_KERNEL);
+        if(fw_name_test == NULL) {
+                TPD_INFO("fw_name_test kzalloc error!\n");
+                return;
+        }
+
+        p_node  = strstr(chip_info->fw_name, ".");
+        copy_len = p_node - chip_info->fw_name;
+        memcpy(fw_name_test, chip_info->fw_name, copy_len);
+        strlcat(fw_name_test, postfix, MAX_FW_NAME_LENGTH);
+        TPD_INFO("fw_name_test is %s\n", fw_name_test);
+
+        //update test firmware
+        ret = request_firmware(&fw, fw_name_test, chip_info->dev);
+        if (ret != 0) {
+                TPD_INFO("request test firmware failed! ret = %d\n", ret);
+                kfree(fw_name_test);
+                fw_name_test = NULL;
+                return;
+        }
+
+        ret = nvt_fw_update(chip_info, fw, 0);
+        if(ret > 0) {
+                TPD_INFO("fw update failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+        TPD_INFO("update test firmware successed!\n");
+
+        if (nvt_switch_FreqHopEnDis(chip_info, FREQ_HOP_DISABLE)) {
+                TPD_INFO("switch frequency hopping disable failed!\n");
+                store_to_file(nvt_testdata->fd, "switch frequency hopping disable failed!\n");
+                seq_printf(s, "switch frequency hopping disable failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        if (nvt_check_fw_reset_state_noflash(chip_info, RESET_STATE_NORMAL_RUN)) {
+                TPD_INFO("check fw reset state failed!\n");
+                store_to_file(nvt_testdata->fd, "check fw reset state failed!\n");
+                seq_printf(s, "check fw reset state failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        msleep(100);
+
+        //---Enter Test Mode---
+        TPD_INFO("enter test mode\n");
+        if (nvt_clear_fw_status(chip_info)) {
+                TPD_INFO("clear fw status failed!\n");
+                store_to_file(nvt_testdata->fd, "clear fw status failed!\n");
+                seq_printf(s, "clear fw status failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        nvt_change_mode(chip_info, MP_MODE_CC);
+        if (nvt_check_fw_status(chip_info)) {
+                TPD_INFO("check fw status failed!\n");
+                store_to_file(nvt_testdata->fd, "check fw status failed!\n");
+                seq_printf(s, "check fw status failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        if (nvt_get_fw_info_noflash(chip_info)) {
+                TPD_INFO("get fw info failed!\n");
+                store_to_file(nvt_testdata->fd, "get fw info failed!\n");
+                seq_printf(s, "get fw info failed!\n");
+                goto RELEASE_FIRMWARE;
+        }
+
+        TPD_INFO("malloc raw_data space\n");
+        buf_len = nvt_testdata->TX_NUM * nvt_testdata->RX_NUM * sizeof(int32_t);
+        raw_data = kzalloc(buf_len, GFP_KERNEL);
+        raw_data_n = kzalloc(buf_len, GFP_KERNEL);
+        if (!(raw_data && raw_data_n)) {
+                err_cnt++;
+                store_to_file(nvt_testdata->fd, "malloc memory failed!\n");
+                seq_printf(s, "malloc memory failed!\n");
+                goto OUT;
+        }
+
+        //get test data
+        ph = (struct nvt_test_header *)(nvt_testdata->fw->data);
+        fw_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_P_offset);
+        fw_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_fw_rawdata_N_offset);
+        open_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_P_offset);
+        open_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_open_rawdata_N_offset);
+        short_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_P_offset);
+        short_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Short_Rawdata_N_offset);
+        diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_P_offset);
+        diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_Diff_N_offset);
+        cc_data_P = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_P_offset);
+        cc_data_N = (int32_t *)(nvt_testdata->fw->data + ph->array_FW_CC_N_offset);
+        doze_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_P_offset);
+        doze_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Rawdata_N_offset);
+        doze_diff_rawdata_P = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_P_offset);
+        doze_diff_rawdata_N = (int32_t *)(nvt_testdata->fw->data + ph->array_Doze_Diff_N_offset);
+
+        //---FW Rawdata Test---
+        TPD_INFO("FW Rawdata Test \n");
+        memset(raw_data, 0, buf_len);
+        nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->BASELINE_ADDR, raw_data, buf_len);
+        store_to_file(nvt_testdata->fd, "rawData:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > fw_rawdata_P[iArrayIndex]) \
+                                || (raw_data[iArrayIndex] < fw_rawdata_N[iArrayIndex])) {
+                                TPD_INFO("rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                                if (!err_cnt) {
+                                        seq_printf(s, "rawdata Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], fw_rawdata_N[iArrayIndex], fw_rawdata_P[iArrayIndex]);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+
+        TPD_INFO("FW cc data test \n");
+        memset(raw_data, 0, buf_len);
+        if (nvt_get_fw_pipe(chip_info) == 0) {
+                nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE1_ADDR, raw_data, buf_len);
+        } else {
+                nvt_read_mdata(chip_info, chip_info->trim_id_table.mmap->DIFF_PIPE0_ADDR, raw_data, buf_len);
+        }
+        store_to_file(nvt_testdata->fd, "ccData:\n");
+    if ((ph->config_Lmt_FW_CC_P != 0) && (ph->config_Lmt_FW_CC_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_FW_CC_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_FW_CC_N)) {
+                                TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_CC_N, ph->config_Lmt_FW_CC_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > cc_data_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < cc_data_N[iArrayIndex])) {
+                    TPD_INFO("cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "cc data Test failed at rawdata[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], cc_data_N[iArrayIndex], cc_data_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+        //---Leave Test Mode---
+        nvt_change_mode(chip_info, NORMAL_MODE);
+
+        //---Noise Test---
+        TPD_INFO("FW Noise Test \n");
+        memset(raw_data, 0, buf_len);  //store max
+        memset(raw_data_n, 0, buf_len); //store min
+        if (nvt_read_fw_noise(chip_info, ph->config_Diff_Test_Frame, raw_data, raw_data_n, buf_len) != 0) {
+                TPD_INFO("read Noise data failed!\n");
+                store_to_file(nvt_testdata->fd, "read Noise data failed!\n");
+                seq_printf(s, "read Noise data failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_FW_Diff_P != 0) && (ph->config_Lmt_FW_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                                TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                        }
+                        if((raw_data_n[iArrayIndex] > ph->config_Lmt_FW_Diff_P) \
+                                || (raw_data_n[iArrayIndex] < ph->config_Lmt_FW_Diff_N)) {
+                                TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_FW_Diff_N, ph->config_Lmt_FW_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], diff_rawdata_N[iArrayIndex], diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+        //---Doze Noise Test---
+        TPD_INFO("Doze FW Noise Test \n");
+        memset(raw_data, 0, buf_len);  //store max
+        memset(raw_data_n, 0, buf_len); //store min
+        if (nvt_read_doze_fw_noise(chip_info, ph->config_Doze_Noise_Test_Frame, ph->doze_X_Channel, raw_data, raw_data_n, buf_len) != 0) {
+                TPD_INFO("read Doze Noise data failed!\n");
+                store_to_file(nvt_testdata->fd, "read Doze Noise data failed!\n");
+                seq_printf(s, "read Doze Noise data failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Max:\n");
+    if ((ph->config_Lmt_Doze_Diff_P != 0) && (ph->config_Lmt_Doze_Diff_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < ph->doze_X_Channel; i++) {
+                        iArrayIndex = j * ph->doze_X_Channel + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                                TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < ph->doze_X_Channel; i++) {
+                        iArrayIndex = j * ph->doze_X_Channel + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                        }
+                        if((raw_data_n[iArrayIndex] > ph->config_Lmt_Doze_Diff_P) \
+                                || (raw_data_n[iArrayIndex] < ph->config_Lmt_Doze_Diff_N)) {
+                                TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], ph->config_Lmt_Doze_Diff_N, ph->config_Lmt_Doze_Diff_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Max Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+        store_to_file(nvt_testdata->fd, "Doze RawData_Diff_Min:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data_n[iArrayIndex]);
+                }
+                if((raw_data_n[iArrayIndex] > doze_diff_rawdata_P[iArrayIndex]) \
+                        || (raw_data_n[iArrayIndex] < doze_diff_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze Noise RawData_Diff_Min Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data_n[iArrayIndex], doze_diff_rawdata_N[iArrayIndex], doze_diff_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+        //---Doze FW Rawdata Test---
+        TPD_INFO("Doze FW Rawdata Test \n");
+        memset(raw_data, 0, buf_len);
+        if(nvt_read_doze_baseline(chip_info, ph->doze_X_Channel, raw_data, buf_len) != 0) {
+                TPD_INFO("read Doze FW Rawdata failed!\n");
+                store_to_file(nvt_testdata->fd, "read Doze FW Rawdata failed!\n");
+                seq_printf(s, "read Doze FW Rawdata failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+
+        store_to_file(nvt_testdata->fd, "Doze FW Rawdata:\n");
+    if ((ph->config_Lmt_Doze_Rawdata_P != 0) && (ph->config_Lmt_Doze_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > ph->config_Lmt_Doze_Rawdata_P) \
+                        || (raw_data[iArrayIndex] < ph->config_Lmt_Doze_Rawdata_N)) {
+                                TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Doze_Rawdata_N, ph->config_Lmt_Doze_Rawdata_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < ph->doze_X_Channel; i++) {
+                iArrayIndex = j * ph->doze_X_Channel + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > doze_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < doze_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Doze FW Rawdata Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], doze_rawdata_N[iArrayIndex], doze_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+        //--Short Test---
+        TPD_INFO("FW Short Test \n");
+        memset(raw_data, 0, buf_len);
+        if (nvt_read_fw_short(chip_info, raw_data, buf_len) != 0) {
+                TPD_INFO("read Short test data failed!\n");
+                store_to_file(nvt_testdata->fd, "read Short test data failed!\n");
+                seq_printf(s, "read Short test data failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Short:\n");
+    if ((ph->config_Lmt_Short_Rawdata_P != 0) && (ph->config_Lmt_Short_Rawdata_N != 0)) {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > ph->config_Lmt_Short_Rawdata_P) \
+                                || (raw_data[iArrayIndex] < ph->config_Lmt_Short_Rawdata_N)) {
+                                TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], ph->config_Lmt_Short_Rawdata_N, ph->config_Lmt_Short_Rawdata_P);
+                                }
+                                err_cnt++;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+    } else {
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+            for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                if (nvt_testdata->fd >= 0) {
+                    store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                }
+                if((raw_data[iArrayIndex] > short_rawdata_P[iArrayIndex]) \
+                        || (raw_data[iArrayIndex] < short_rawdata_N[iArrayIndex])) {
+                    TPD_INFO("Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Short Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], short_rawdata_N[iArrayIndex], short_rawdata_P[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (nvt_testdata->fd >= 0) {
+                store_to_file(nvt_testdata->fd, "\n");
+            }
+        }
+    }
+
+        //---Open Test---
+        TPD_INFO("FW Open Test \n");
+        memset(raw_data, 0, buf_len);
+        if (nvt_read_fw_open(chip_info, raw_data, buf_len) != 0) {
+                TPD_INFO("read Open test data failed!\n");
+                store_to_file(nvt_testdata->fd, "read Open test data failed!\n");
+                seq_printf(s, "read Open test data failed!\n");
+                err_cnt++;
+                goto OUT;
+        }
+        store_to_file(nvt_testdata->fd, "RawData_Open:\n");
+        for (j = 0; j < nvt_testdata->RX_NUM; j++) {
+                for (i = 0; i < nvt_testdata->TX_NUM; i++) {
+                        iArrayIndex = j * nvt_testdata->TX_NUM + i;
+                        if (nvt_testdata->fd >= 0) {
+                                store_to_file(nvt_testdata->fd, "%d, ", raw_data[iArrayIndex]);
+                        }
+                        if((raw_data[iArrayIndex] > open_rawdata_P[iArrayIndex]) \
+                                || (raw_data[iArrayIndex] < open_rawdata_N[iArrayIndex])) {
+                                TPD_INFO("Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                                if (!err_cnt) {
+                                        seq_printf(s, "Open Test failed at data[%d][%d] = %d [%d,%d]\n", i, j, raw_data[iArrayIndex], open_rawdata_N[iArrayIndex], open_rawdata_P[iArrayIndex]);
+                                }
+                                err_cnt++;
+                                goto OUT;
+                        }
+                }
+                if (nvt_testdata->fd >= 0) {
+                        store_to_file(nvt_testdata->fd, "\n");
+                }
+        }
+
+OUT:
+        if (raw_data) {
+                kfree(raw_data);
+        }
+        if (raw_data_n) {
+                kfree(raw_data_n);
+        }
+RELEASE_FIRMWARE:
+        seq_printf(s, "FW:0x%llx\n", nvt_testdata->TP_FW);
+        seq_printf(s, "%d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+        TPD_INFO(" TP auto test %d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+        release_firmware(fw);
+        kfree(fw_name_test);
+        return;
+}
+
+static struct nvt_proc_operations nvt_proc_ops = {
+    .auto_test     = nvt_auto_test,
+};
+
+/*********** Start of SPI Driver and Implementation of it's callbacks*************************/
+static int nvt_tp_probe(struct spi_device *client)
+{
+    struct chip_data_nt36672 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    /* 1. alloc chip info */
+    chip_info = kzalloc(sizeof(struct chip_data_nt36672), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. bind client and dev for easy operate */
+    chip_info->s_client = client;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->s_client = client;
+    ts->irq = client->irq;
+    spi_set_drvdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+    chip_info->ENG_RST_ADDR = 0x7FFF80;
+    chip_info->recovery_cnt = 0;
+    chip_info->partition = 0;
+    chip_info->ilm_dlm_num = 2;
+
+    //---prepare for spi parameter---
+    if (ts->s_client->master->flags & SPI_MASTER_HALF_DUPLEX) {
+        TPD_INFO("Full duplex not supported by master\n");
+        ret = -EIO;
+        goto err_spi_setup;
+    }
+    ts->s_client->bits_per_word = 8;
+    ts->s_client->mode = SPI_MODE_0;
+
+#ifdef CONFIG_SPI_MT65XX
+    /* new usage of MTK spi API */
+    memcpy(&chip_info->spi_ctrl, &spi_ctrdata, sizeof(struct mtk_chip_config));
+    ts->s_client->controller_data = (void *)&chip_info->spi_ctrl;
+#else
+    /* old usage of MTK spi API */
+    memcpy(&chip_info->spi_ctrl, &spi_ctrdata, sizeof(struct mt_chip_conf));
+    ts->s_client->controller_data = (void *)&chip_info->spi_ctrl;
+
+    ret = spi_setup(ts->s_client);
+    if (ret < 0) {
+        TPD_INFO("Failed to perform SPI setup\n");
+        goto err_spi_setup;
+    }
+#endif	//CONFIG_SPI_MT65XX
+
+    TPD_INFO("mode=%d, max_speed_hz=%d\n", ts->s_client->mode, ts->s_client->max_speed_hz);
+
+    /* 4. file_operations callbacks binding */
+    ts->ts_ops = &nvt_ops;
+
+    /* 5. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+    ts->tp_suspend_order = TP_LCD_SUSPEND;
+    ts->tp_resume_order = LCD_TP_RESUME;
+    chip_info->is_sleep_writed = false;
+    chip_info->fw_name = ts->panel_data.fw_name;
+    chip_info->dev = ts->dev;
+    chip_info->test_limit_name = ts->panel_data.test_limit_name;
+
+    /*6. create nvt test files*/
+    nvt_flash_proc_init(ts, "NVTSPI");
+    nvt_create_proc(ts, &nvt_proc_ops);
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+err_spi_setup:
+    spi_set_drvdata(client, NULL);
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int nvt_tp_remove(struct spi_device *client)
+{
+    struct touchpanel_data *ts = spi_get_drvdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+    kfree(ts);
+
+    return 0;
+}
+
+static int nvt_spi_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int nvt_spi_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct spi_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = nvt_spi_suspend,
+    .resume = nvt_spi_resume,
+#endif
+};
+
+static struct spi_driver tp_spi_driver = {
+    .probe      = nvt_tp_probe,
+    .remove     = nvt_tp_remove,
+    .id_table   = tp_id,
+    .driver = {
+        .name   = TPD_DEVICE,
+        .owner  = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+
+static int32_t __init nvt_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+        if (!tp_judge_ic_match(TPD_DEVICE))
+            return -1;
+#endif
+    if (spi_register_driver(&tp_spi_driver)!= 0) {
+        TPD_INFO("unable to add spi driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+static void __exit nvt_driver_exit(void)
+{
+    spi_unregister_driver(&tp_spi_driver);
+}
+
+module_init(nvt_driver_init);
+module_exit(nvt_driver_exit);
+
+MODULE_DESCRIPTION("Novatek Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.h
new file mode 100644
index 0000000000000000000000000000000000000000..d40c90a4ec11245371310f500d600f849b8ad304
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_drivers_nt36672_noflash.h
@@ -0,0 +1,198 @@
+/***************************************************
+ * File:novatek_drivers_nt36672.h
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             novatek nt36672 driver
+ * Version:1.0:
+ * Date created:2017-09-15
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+#ifndef NVT_H_NT36672_NOFLASH
+#define NVT_H_NT36672_NOFLASH
+
+/*********PART1:Head files**********************/
+#include <linux/spi/spi.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+#ifdef CONFIG_SPI_MT65XX
+#include <linux/platform_data/spi-mt65xx.h>
+#endif
+
+#include "../novatek_common.h"
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+#include "mtk_spi.h"
+#else
+#include "driver_spi.h"
+#endif
+#include "nvt_firmware.h"
+
+#define NVT_ID_BYTE_MAX 6
+#define POINT_DATA_LEN 65
+#define FW_BIN_SIZE_116KB               (118784)
+#define FW_BIN_SIZE FW_BIN_SIZE_116KB
+#define FW_BIN_VER_OFFSET               (0x1A000)
+#define FW_BIN_VER_BAR_OFFSET   (0x1A001)
+#define SPI_READ_FAST   (0x1F654)
+#define SWRST_N8_ADDR   (0x03F0FE)      /*672A*/
+
+#define DTAP_DETECT                     15
+#define UP_VEE_DETECT                   14
+#define DOWN_VEE_DETECT                 33
+#define LEFT_VEE_DETECT                 31
+#define RIGHT_VEE_DETECT                32
+#define CIRCLE_DETECT                   18
+#define DOUSWIP_DETECT                  34
+#define RIGHT_SLIDE_DETECT              24
+#define LEFT_SLIDE_DETECT               23
+#define DOWN_SLIDE_DETECT               22
+#define UP_SLIDE_DETECT                 21
+#define M_DETECT                        17
+#define W_DETECT                        13
+
+#define EVENTBUFFER_EDGE_LIMIT_ON  0x79
+#define EVENTBUFFER_EDGE_LIMIT_OFF 0x7A
+#define EVENTBUFFER_PWR_PLUG_IN    0x53
+#define EVENTBUFFER_PWR_PLUG_OUT   0x51
+
+#define NVT_DUMP_SRAM   (0)
+
+#define SPI_TANSFER_LENGTH 256
+
+#define XDATA_SECTOR_SIZE       256
+#define NORMAL_MODE             0x00
+#define TEST_MODE_1             0x21
+#define TEST_MODE_2             0x22
+#define MP_MODE_CC              0x41
+#define FREQ_HOP_DISABLE        0x66
+#define FREQ_HOP_ENABLE         0x65
+#define HANDSHAKING_HOST_READY  0xBB
+
+typedef enum {
+    NVT_RAWDATA,    //raw data
+    NVT_DIFFDATA,   //diff data
+    NVT_BASEDATA,   //baseline data
+}DEBUG_READ_TYPE;
+
+typedef enum
+{
+    PALM = 0,
+    GLOVE,
+    PWR_FLAG,
+    HOVER,
+    EDGE_REGECT
+}CMD_OFFSET;
+
+typedef enum {
+    EVENT_MAP_HOST_CMD                      = 0x50,
+    EVENT_MAP_HANDSHAKING_or_SUB_CMD_BYTE   = 0x51,
+    EVENT_MAP_RESET_COMPLETE                = 0x60,
+    EVENT_MAP_FWINFO                        = 0x78,
+    EVENT_MAP_PROJECTID                     = 0x9A,
+} SPI_EVENT_MAP;
+
+typedef enum {
+        RESET_STATE_INIT = 0xA0,// IC reset
+        RESET_STATE_REK,                // ReK baseline
+        RESET_STATE_REK_FINISH, // baseline is ready
+        RESET_STATE_NORMAL_RUN, // normal run
+        RESET_STATE_MAX  = 0xAF
+} RST_COMPLETE_STATE;
+
+struct nvt_ts_mem_map {
+        uint32_t EVENT_BUF_ADDR;
+        uint32_t RAW_PIPE0_ADDR;
+        uint32_t RAW_PIPE0_Q_ADDR;
+        uint32_t RAW_PIPE1_ADDR;
+        uint32_t RAW_PIPE1_Q_ADDR;
+        uint32_t BASELINE_ADDR;
+        uint32_t BASELINE_Q_ADDR;
+        uint32_t BASELINE_BTN_ADDR;
+        uint32_t BASELINE_BTN_Q_ADDR;
+        uint32_t DIFF_PIPE0_ADDR;
+        uint32_t DIFF_PIPE0_Q_ADDR;
+        uint32_t DIFF_PIPE1_ADDR;
+        uint32_t DIFF_PIPE1_Q_ADDR;
+        uint32_t RAW_BTN_PIPE0_ADDR;
+        uint32_t RAW_BTN_PIPE0_Q_ADDR;
+        uint32_t RAW_BTN_PIPE1_ADDR;
+        uint32_t RAW_BTN_PIPE1_Q_ADDR;
+        uint32_t DIFF_BTN_PIPE0_ADDR;
+        uint32_t DIFF_BTN_PIPE0_Q_ADDR;
+        uint32_t DIFF_BTN_PIPE1_ADDR;
+        uint32_t DIFF_BTN_PIPE1_Q_ADDR;
+        uint32_t READ_FLASH_CHECKSUM_ADDR;
+        uint32_t RW_FLASH_DATA_ADDR;
+        /* Phase 2 Host Download */
+        uint32_t BOOT_RDY_ADDR;
+        uint32_t POR_CD_ADDR;
+        /* BLD CRC */
+        uint32_t BLD_LENGTH_ADDR;
+        uint32_t ILM_LENGTH_ADDR;
+        uint32_t DLM_LENGTH_ADDR;
+        uint32_t BLD_DES_ADDR;
+        uint32_t ILM_DES_ADDR;
+        uint32_t DLM_DES_ADDR;
+        uint32_t G_ILM_CHECKSUM_ADDR;
+        uint32_t G_DLM_CHECKSUM_ADDR;
+        uint32_t R_ILM_CHECKSUM_ADDR;
+        uint32_t R_DLM_CHECKSUM_ADDR;
+		uint32_t BLD_CRC_EN_ADDR;
+        uint32_t DMA_CRC_EN_ADDR;
+        uint32_t BLD_ILM_DLM_CRC_ADDR;
+        uint32_t DMA_CRC_FLAG_ADDR;
+        uint32_t DOZE_GM_S1D_SCAN_RAW_ADDR;
+        uint32_t DOZE_GM_BTN_SCAN_RAW_ADDR;
+};
+
+struct nvt_ts_bin_map {
+        char name[12];
+        uint32_t BIN_addr;
+        uint32_t SRAM_addr;
+        uint32_t size;
+        uint32_t crc;
+};
+
+struct nvt_ts_trim_id_table {
+        uint8_t id[NVT_ID_BYTE_MAX];
+        uint8_t mask[NVT_ID_BYTE_MAX];
+        const struct nvt_ts_mem_map *mmap;
+        uint8_t carrier_system;
+        uint8_t support_hw_crc;
+};
+
+struct nvt_ts_firmware {
+        size_t size;
+        const u8 *data;
+};
+
+struct chip_data_nt36672 {
+    bool                            is_sleep_writed;
+    char                            *fw_name;
+    char                            *test_limit_name;
+    tp_dev                          tp_type;
+    uint8_t                         fw_ver;
+    uint8_t                         fw_sub_ver;
+    uint8_t                         recovery_cnt;
+    uint8_t                         ilm_dlm_num;
+    uint8_t                         *fwbuf;
+    uint16_t                        nvt_pid;
+    uint32_t                        ENG_RST_ADDR;
+    uint32_t                        partition;
+    struct spi_device               *s_client;
+    struct hw_resource              *hw_res;
+    struct nvt_ts_trim_id_table     trim_id_table;
+    struct nvt_ts_bin_map           *bin_map;
+    struct device                   *dev;
+#ifdef CONFIG_SPI_MT65XX
+    struct mtk_chip_config          spi_ctrl;
+#else
+    struct mt_chip_conf             spi_ctrl;
+#endif
+};
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_firmware.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_firmware.h
new file mode 100644
index 0000000000000000000000000000000000000000..cf72a753a3d8cf4e7f7ac133008436ad5bfd97e3
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_firmware.h
@@ -0,0 +1,7451 @@
+/*
+ * Copyright (C) 2010 - 2018 Novatek, Inc.
+ *
+ * $Revision: 
+ * $Date: 
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ */
+
+#ifndef 	_LINUX_NVT_FIRMWARE_H
+#define		_LINUX_NVT_FIRMWARE_H
+//[20180209]NT36672_NoFlash_BOE_0599_FHD_18_9_V06_20180209.bin
+static const uint8_t FIRMWARE_DATA[] =
+{
+0xB0,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x63,0xB1,0x00,0x00,0xC0,0xCE,0x00,0x00,
+0x00,0x80,0x01,0x00,0x47,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0xC0,0x02,0x28,0x86,0x13,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x48,0x01,0x00,0xFF,0x23,0x00,0x00,0x00,0x40,0x01,0x00,0x00,0x00,0x00,0x00,
+0x00,0xB8,0x01,0x00,0xEF,0x06,0x00,0x00,0x00,0xA0,0x01,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x50,0xBF,0x01,0x00,0xAF,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x48,0x00,0x01,0xE0,0x40,0x00,0x00,0x09,0x40,0x00,0x00,0x09,0x40,0x00,0x00,0x09,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x01,0x48,0x00,0x01,0x86,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x02,0x48,0x00,0x01,0x7E,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x03,0x48,0x00,0x01,0x76,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x04,0x48,0x00,0x01,0x6E,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x05,0x48,0x00,0x01,0x66,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x06,0x48,0x00,0x01,0x5E,
+0x3A,0xFF,0xBF,0xFC,0x3A,0x0F,0xA8,0x3C,0x44,0x00,0x00,0x07,0x48,0x00,0x01,0x56,
+0x48,0x00,0x00,0x00,0x40,0x00,0x00,0x09,0x40,0x00,0x00,0x09,0x40,0x00,0x00,0x09,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x00,0x48,0x00,0x01,0x67,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x01,0x48,0x00,0x01,0x6A,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x02,0x48,0x00,0x01,0x62,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x03,0x48,0x00,0x01,0x4F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x04,0x48,0x00,0x01,0x52,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x05,0x48,0x00,0x01,0x3F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x06,0x48,0x00,0x01,0x37,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x07,0x48,0x00,0x01,0x2F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x08,0x48,0x00,0x01,0x27,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x09,0x48,0x00,0x01,0x1F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0A,0x48,0x00,0x01,0x17,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0B,0x48,0x00,0x01,0x0F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0C,0x48,0x00,0x01,0x07,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0D,0x48,0x00,0x00,0xFF,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0E,0x48,0x00,0x00,0xF7,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x0F,0x48,0x00,0x00,0xFA,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x10,0x48,0x00,0x00,0xF2,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x11,0x48,0x00,0x00,0xDF,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x12,0x48,0x00,0x00,0xD7,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x13,0x48,0x00,0x00,0xCF,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x14,0x48,0x00,0x00,0xD2,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x15,0x48,0x00,0x00,0xCA,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x16,0x48,0x00,0x00,0xB7,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x17,0x48,0x00,0x00,0xAF,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x18,0x48,0x00,0x00,0xA7,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x19,0x48,0x00,0x00,0x9F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x1A,0x48,0x00,0x00,0x97,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x1B,0x48,0x00,0x00,0x8F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x1C,0x48,0x00,0x00,0x87,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x1D,0x48,0x00,0x00,0x7F,
+0x3A,0xFF,0xBC,0xBC,0x3A,0x0F,0x94,0x3C,0x44,0x00,0x00,0x1E,0x48,0x00,0x00,0x77,
+0xF6,0x9F,0x00,0x00,0xF6,0x9F,0x00,0x00,0xD0,0xA0,0x00,0x00,0x60,0xA6,0x00,0x00,
+0x60,0xA6,0x00,0x00,0x60,0xA6,0x00,0x00,0x60,0xA6,0x00,0x00,0x60,0xA6,0x00,0x00,
+0x60,0xA6,0x00,0x00,0x60,0xA6,0x00,0x00,0x00,0x00,0x00,0x00,0xEA,0xA2,0x00,0x00,
+0xF2,0xA2,0x00,0x00,0xFE,0xA2,0x00,0x00,0x66,0xA3,0x00,0x00,0xFC,0xA3,0x00,0x00,
+0x42,0xA4,0x00,0x00,0x78,0xA4,0x00,0x00,0x90,0xA4,0x00,0x00,0x98,0xA4,0x00,0x00,
+0xA0,0xA4,0x00,0x00,0xA8,0xA4,0x00,0x00,0xB0,0xA4,0x00,0x00,0xB8,0xA4,0x00,0x00,
+0xC0,0xA4,0x00,0x00,0xC8,0xA4,0x00,0x00,0xD0,0xA4,0x00,0x00,0x54,0xA5,0x00,0x00,
+0x60,0xA5,0x00,0x00,0x68,0xA5,0x00,0x00,0x70,0xA5,0x00,0x00,0x78,0xA5,0x00,0x00,
+0x80,0xA5,0x00,0x00,0x88,0xA5,0x00,0x00,0xA8,0xA5,0x00,0x00,0xBA,0xA5,0x00,0x00,
+0xD2,0xA5,0x00,0x00,0xDA,0xA5,0x00,0x00,0x20,0xA6,0x00,0x00,0x28,0xA6,0x00,0x00,
+0x30,0xA6,0x00,0x00,0x58,0xA6,0x00,0x00,0x64,0x12,0xA4,0x02,0x64,0x22,0x04,0x02,
+0x3A,0x1F,0x88,0x3C,0x80,0x3F,0x44,0x20,0x02,0x88,0x38,0x21,0x02,0x02,0x64,0x32,
+0x00,0x02,0x9E,0xD9,0x64,0x32,0x00,0x03,0xDD,0x22,0x64,0x02,0x00,0x43,0x64,0x00,
+0x00,0x08,0x3A,0x1F,0x88,0x04,0x64,0x12,0xA4,0x03,0x64,0x22,0x04,0x03,0x3A,0x0F,
+0xA8,0x04,0x3A,0xFF,0xBF,0xC4,0x64,0x00,0x00,0x04,0x44,0x20,0x02,0xAC,0x38,0x21,
+0x02,0x02,0xDD,0x22,0x3A,0x0F,0x94,0x04,0x3A,0xFF,0xBC,0x84,0x64,0x00,0x00,0x04,
+0x64,0x12,0xA4,0x02,0x64,0x22,0x04,0x02,0x3A,0x1F,0x88,0x3C,0x44,0x20,0x02,0xAC,
+0x38,0x21,0x02,0x02,0x64,0x32,0x00,0x02,0x9E,0xD9,0x64,0x32,0x00,0x03,0xDD,0x22,
+0x64,0x02,0x00,0x43,0x64,0x00,0x00,0x08,0x3A,0x1F,0x88,0x04,0x64,0x12,0xA4,0x03,
+0x64,0x22,0x04,0x03,0x3A,0x0F,0x94,0x04,0x3A,0xFF,0xBC,0x84,0x64,0x00,0x00,0x04,
+0x4F,0xF2,0x00,0x1D,0x3A,0x0F,0xA8,0x3C,0x3A,0xFF,0xBF,0xFC,0x45,0xD1,0x96,0xC0,
+0x80,0x1F,0x64,0x12,0x64,0x02,0x96,0x5F,0x9E,0x49,0xC1,0x05,0x3C,0xFD,0x9A,0xF0,
+0x48,0x00,0x00,0x04,0x3C,0xFD,0x9A,0xF1,0xE8,0x09,0xDD,0x2F,0xC8,0x07,0x3A,0xFF,
+0xBF,0xC4,0x3A,0x0F,0xA8,0x04,0x64,0x00,0x00,0x04,0x64,0x02,0x24,0x02,0x44,0x1F,
+0x3F,0xFF,0xFE,0x0E,0x58,0x00,0x40,0x00,0x64,0x02,0x24,0x03,0x64,0x00,0x00,0x08,
+0x45,0xD1,0x96,0xC0,0x45,0xF1,0xB8,0x00,0x44,0xF0,0x9F,0x6E,0x4E,0xF2,0x00,0x03,
+0xDD,0x2F,0x3C,0xFD,0x9A,0xF2,0xDD,0x2F,0x64,0x0F,0xFF,0xEA,0x3C,0x0F,0xFB,0x41,
+0xDD,0x9E,0x3C,0x0F,0xFB,0x40,0xDD,0x9E,0xFC,0x00,0xC0,0x08,0x5A,0x08,0x01,0x0B,
+0x49,0x00,0x27,0x7C,0x3C,0x0F,0xFB,0x43,0xD5,0x05,0x49,0x00,0x27,0x74,0x3C,0x0F,
+0xFB,0x42,0xFC,0x80,0x80,0x20,0xE6,0x29,0x3C,0x0D,0xFB,0x43,0xE8,0x25,0x44,0xF0,
+0x04,0x6C,0x38,0x17,0x84,0x00,0x40,0xF0,0xBC,0x00,0xDD,0x0F,0x0A,0x3C,0x10,0x16,
+0x1C,0x22,0x28,0x2E,0x34,0x00,0x3C,0x0D,0xFB,0x42,0xDD,0x9E,0x50,0x00,0x00,0x50,
+0xDD,0x9E,0x50,0x00,0x00,0xA0,0xDD,0x9E,0x50,0x00,0x00,0xF0,0xDD,0x9E,0x50,0x00,
+0x01,0x40,0xDD,0x9E,0x50,0x00,0x01,0xE0,0xDD,0x9E,0x50,0x00,0x02,0x80,0xDD,0x9E,
+0x50,0x00,0x03,0x20,0xDD,0x9E,0x84,0x00,0xDD,0x9E,0x92,0x00,0xFC,0x40,0x80,0xC2,
+0x81,0x21,0x3C,0x2D,0xFB,0x43,0x3C,0x1D,0xFB,0x42,0x80,0xE3,0x49,0x00,0x27,0x16,
+0x3C,0x1D,0xFB,0x40,0xA6,0x0A,0xA6,0x4B,0x49,0x00,0x27,0x2C,0x5C,0xF3,0x01,0x00,
+0x80,0x06,0xE9,0x03,0x44,0x00,0x00,0xFF,0x96,0x01,0x49,0x00,0x27,0x36,0x84,0xC0,
+0x3C,0x1D,0xFB,0x41,0x00,0x00,0x80,0x10,0xE2,0xC0,0xE8,0x10,0x80,0x06,0x38,0x10,
+0x98,0x00,0x49,0x00,0x27,0x37,0x3C,0x0D,0xFB,0x41,0x98,0x46,0x80,0x06,0x00,0x10,
+0x80,0x08,0x49,0x00,0x27,0x57,0x8C,0xC1,0xD5,0xEC,0x84,0x00,0x49,0x00,0x27,0x21,
+0x49,0x00,0x26,0xF9,0x84,0x01,0x49,0x00,0x27,0x1C,0x49,0x00,0x26,0xF4,0x84,0x03,
+0x49,0x00,0x27,0x17,0x49,0x00,0x26,0xEF,0x49,0x00,0x27,0x0B,0xAE,0x38,0x84,0x00,
+0xA6,0x78,0xE2,0x01,0xE8,0x2E,0x04,0x14,0x80,0x01,0x38,0x50,0x81,0x01,0xD0,0x27,
+0x04,0x14,0x80,0x05,0x94,0x82,0x95,0x6A,0x98,0xCA,0x88,0x25,0xA6,0xDA,0xA7,0x0A,
+0xE2,0x64,0xE8,0x02,0xAE,0xCA,0x04,0x14,0x80,0x05,0x98,0xCA,0x88,0x25,0xA6,0xDB,
+0xA7,0x0B,0xE2,0x83,0xE8,0x02,0xAE,0xCB,0x04,0x14,0x80,0x05,0x38,0x30,0x88,0x00,
+0x88,0x25,0xA7,0x08,0xE2,0x64,0xE8,0x02,0xAE,0xC8,0x04,0x34,0x80,0x05,0x88,0x43,
+0x88,0xA3,0xA6,0x51,0xA6,0xA9,0xE2,0x41,0xE8,0x02,0xAE,0x69,0x8C,0x01,0xD5,0xD1,
+0xFC,0xC0,0xFC,0x40,0x51,0xFF,0xFB,0x78,0xB6,0x5F,0xF3,0x81,0x84,0x40,0x38,0x30,
+0x09,0x01,0xB1,0x02,0x38,0x32,0x09,0x09,0x8C,0x41,0x5A,0x2A,0x40,0xFA,0xB4,0xE1,
+0x84,0xA0,0x44,0x90,0x00,0x32,0x44,0xA0,0x00,0x64,0x85,0x04,0x45,0xC0,0x04,0x80,
+0xB0,0x82,0x84,0x00,0x99,0xBD,0x99,0x15,0x38,0x23,0x01,0x00,0x5A,0x20,0xFF,0x17,
+0xA0,0xC9,0x38,0xF1,0x89,0x01,0xA0,0xCB,0x38,0x22,0x01,0x11,0x38,0x31,0xBD,0x01,
+0x42,0x31,0xA4,0x24,0x40,0x31,0xA8,0x77,0xE2,0x62,0xE9,0x08,0x5E,0xF1,0x00,0x65,
+0xE8,0x05,0x40,0x21,0x20,0x56,0x38,0x22,0x01,0x09,0x8C,0x01,0x5A,0x08,0x12,0xE6,
+0x50,0x52,0x80,0x24,0x4C,0x5E,0x7F,0xDE,0xB0,0x02,0xB4,0x5F,0xF3,0x01,0x49,0xFF,
+0xFF,0x4F,0x51,0xFF,0x84,0x88,0xFC,0xC0,0x3C,0x0F,0xFB,0x88,0xDD,0x9E,0x3C,0x0F,
+0xFB,0x87,0xDD,0x9E,0xFC,0x42,0x3C,0x1D,0xFB,0x87,0x3C,0x3D,0xFB,0x75,0xF1,0x83,
+0x3C,0x9D,0xFB,0x88,0x3C,0x1D,0xFB,0x74,0x44,0xA1,0x84,0xCC,0x8C,0x0C,0x44,0x21,
+0x84,0x98,0x44,0x61,0x83,0xD4,0x84,0xA0,0x45,0xE1,0x83,0xE4,0xF4,0x03,0x00,0x42,
+0x00,0x09,0xE2,0xA4,0x4E,0xF2,0x00,0xEA,0x04,0x40,0x7F,0xFD,0x4E,0x42,0x00,0xDE,
+0x00,0x70,0x00,0x0C,0xB6,0xFF,0x97,0xC6,0xC7,0x0C,0x84,0x81,0x10,0x45,0x00,0x00,
+0x22,0x40,0x00,0x00,0xAD,0x10,0x22,0x40,0x00,0x01,0xAD,0x11,0x48,0x00,0x00,0xCE,
+0x5A,0x40,0x04,0x04,0x48,0x00,0x00,0x8F,0x00,0x45,0x00,0x00,0xCC,0x38,0x44,0x11,
+0x84,0x80,0x38,0x10,0x94,0x00,0x5A,0x10,0x01,0x06,0xA6,0xF0,0x81,0x04,0x80,0xE4,
+0xD5,0x18,0x40,0x82,0x88,0x08,0x80,0x24,0x80,0x64,0x40,0x72,0x78,0x00,0x50,0x42,
+0x00,0x34,0x38,0xF3,0xA0,0x11,0x88,0xE8,0x88,0x6F,0x22,0x73,0x80,0x01,0x88,0x27,
+0x5A,0x48,0x9C,0xF5,0x84,0x83,0x40,0x31,0x90,0x76,0x40,0x10,0x90,0x36,0xD5,0x1B,
+0x85,0xED,0x80,0x25,0x42,0x13,0xBC,0x73,0x38,0xFF,0x06,0x11,0x94,0x4A,0x88,0x3E,
+0x8C,0xE1,0x22,0x10,0x80,0x01,0x97,0xF8,0x89,0x0F,0xE2,0x67,0x88,0x81,0xE8,0xF1,
+0x9C,0x59,0x40,0x34,0x04,0x76,0x40,0x12,0x04,0x36,0xD5,0x05,0x80,0x27,0x80,0x67,
+0x80,0x81,0xD5,0x09,0x80,0xE3,0x4E,0x34,0x00,0x03,0xFF,0xDA,0x80,0x81,0x4E,0x14,
+0x00,0x03,0xFF,0x0A,0x88,0xE4,0x04,0x44,0x80,0x01,0xE2,0x87,0x4E,0xF2,0x00,0x7E,
+0xB4,0x9F,0x00,0x84,0x80,0x02,0x54,0x72,0x00,0x04,0x00,0x44,0x80,0x00,0xC7,0x13,
+0xA5,0xD0,0xFF,0x1C,0x40,0x82,0x21,0x16,0x89,0x07,0x12,0x81,0x00,0x00,0x00,0x74,
+0x80,0x01,0x00,0x44,0x80,0x03,0xFF,0xCC,0x40,0x73,0x90,0xF6,0xA5,0x11,0x88,0x87,
+0xAD,0x11,0xD5,0x1C,0xE3,0x04,0x40,0x44,0x3C,0x1B,0x00,0x74,0x80,0x01,0xF4,0x82,
+0x00,0x44,0x80,0x03,0xE2,0x87,0xF4,0x81,0x40,0x72,0x3C,0x1B,0xF4,0x02,0xFF,0xCC,
+0xFF,0x1C,0x40,0x82,0x21,0x16,0xA5,0x10,0x89,0x04,0xF4,0x01,0x12,0x81,0x00,0x00,
+0x40,0x43,0x90,0x96,0xA5,0xD1,0x88,0xE4,0xAD,0xD1,0x22,0x41,0x00,0x00,0xAD,0x00,
+0x22,0x41,0x00,0x01,0xAD,0x01,0xB4,0x9F,0x58,0x42,0x00,0x02,0x10,0x40,0x00,0x0C,
+0xD5,0x3C,0x5A,0x40,0x05,0x3B,0x00,0x45,0x00,0x00,0x5A,0x48,0x01,0x0A,0x44,0x41,
+0x84,0x80,0xAF,0xF0,0x38,0x72,0x14,0x08,0x10,0x75,0x00,0x00,0xD5,0x15,0xA7,0x30,
+0xE6,0x82,0xE8,0x04,0x8C,0x81,0xAF,0x30,0xD5,0x02,0xAF,0xF0,0x44,0x41,0x84,0x80,
+0x38,0x42,0x14,0x00,0xCC,0x09,0xA7,0x30,0x5A,0x48,0x02,0x07,0x44,0x41,0x84,0x80,
+0x84,0xE1,0x38,0x72,0x14,0x08,0xA7,0x30,0x85,0x0D,0x80,0xE5,0x42,0x72,0x20,0x73,
+0x22,0xF0,0x00,0x00,0x80,0x87,0xA5,0xD0,0x40,0x77,0x9C,0x01,0x38,0x7F,0x12,0x09,
+0x22,0x80,0x00,0x01,0xA5,0xD1,0x95,0x22,0x88,0x9E,0x40,0x74,0x1C,0x01,0xAD,0xE1,
+0x12,0xF1,0x00,0x00,0x12,0x81,0x00,0x01,0x8C,0xA1,0x8D,0x41,0x50,0x00,0x00,0x5C,
+0x8C,0x44,0x8C,0xC1,0x48,0xFF,0xFF,0x14,0x3C,0x3F,0xFB,0x75,0x3C,0x1F,0xFB,0x74,
+0xFC,0xC2,0xB4,0x20,0x5A,0x18,0x03,0x06,0xA4,0x03,0x3C,0x0B,0xF6,0x89,0xDD,0x9E,
+0x5A,0x18,0x01,0x11,0xA4,0x83,0x3C,0x13,0xF6,0x89,0x8A,0x22,0x96,0x4B,0xE4,0x25,
+0xE9,0x09,0x50,0xF1,0x78,0x4B,0x5C,0xF7,0x80,0x94,0xE8,0x04,0x44,0x10,0x08,0x5C,
+0xAC,0x43,0xDD,0x9E,0x3C,0x0F,0xFC,0x34,0xDD,0x9E,0x3C,0x0F,0xFC,0x33,0xDD,0x9E,
+0xFC,0x40,0x51,0xFF,0xF9,0x88,0xF1,0x83,0x50,0x1F,0x81,0x30,0xF2,0x86,0xF3,0x8E,
+0xF4,0x8C,0xF1,0x81,0x84,0x40,0xF3,0x03,0x50,0x10,0x80,0x34,0xE2,0x43,0xF3,0x84,
+0xE8,0x13,0x22,0x30,0x00,0x01,0x22,0x40,0x00,0x00,0x12,0x30,0xFF,0xF1,0x12,0x30,
+0xFF,0xF3,0xA0,0xC5,0x12,0x40,0xFF,0xF0,0x12,0x40,0xFF,0xF2,0x14,0x30,0xFF,0xFE,
+0x8C,0x41,0x8C,0x18,0xD5,0xE9,0x2E,0x07,0xF0,0xC8,0x50,0xAF,0x80,0x60,0xF0,0x85,
+0xF0,0x82,0x84,0x00,0x80,0x20,0x50,0x9F,0x80,0x94,0xB1,0xF2,0xB1,0xBF,0x44,0x50,
+0x00,0x34,0x44,0x31,0x84,0xE4,0xF4,0x01,0x42,0x20,0x14,0x24,0x88,0x82,0x88,0x43,
+0x38,0x15,0x02,0x0A,0x38,0x14,0x82,0x0A,0x38,0x13,0x82,0x0A,0x38,0x13,0x02,0x0A,
+0x8C,0x01,0x10,0x12,0x00,0x2A,0x10,0x11,0x00,0x2A,0x5A,0x08,0x0D,0xEE,0xF2,0x05,
+0x44,0x00,0x00,0x34,0xFE,0x14,0xF0,0x8D,0x84,0x00,0x3C,0x1D,0xFC,0x34,0x50,0x8F,
+0x83,0xD4,0x04,0xAF,0x80,0x01,0xF0,0x87,0xF0,0x07,0xF2,0x03,0xE2,0x02,0x4E,0xF2,
+0x00,0xE2,0xF3,0x07,0xB0,0x18,0x84,0x41,0x38,0x20,0x0E,0x0A,0xF2,0x03,0xF3,0x05,
+0x44,0x01,0x84,0xE4,0xE2,0x43,0x87,0xC0,0x14,0xFF,0x80,0x0F,0xF2,0x0D,0x4D,0xE1,
+0x00,0xCA,0xF2,0x0F,0x22,0x35,0x00,0x0C,0xC2,0x09,0x22,0x20,0x00,0x0E,0x22,0x45,
+0x00,0x0D,0x8A,0x62,0x22,0x20,0x00,0x0F,0xD5,0x08,0x22,0x20,0x00,0x0C,0x22,0x45,
+0x00,0x0D,0x8A,0x62,0x22,0x20,0x00,0x0D,0x9A,0xA2,0x22,0x45,0x00,0x0C,0x04,0x90,
+0x00,0x09,0xF4,0x8A,0x22,0x45,0x00,0x0D,0x22,0x50,0x00,0x0C,0xF4,0x8B,0x22,0x60,
+0x00,0x0D,0xB4,0xE0,0x5A,0x98,0x04,0x08,0x00,0x40,0x00,0x28,0x5A,0x48,0x01,0x09,
+0x48,0x00,0x03,0x42,0x50,0x44,0xFF,0xFA,0xE6,0x82,0x4E,0xF3,0x03,0x3D,0xFE,0x94,
+0x42,0x21,0x8C,0x73,0xF2,0x88,0xF2,0x0A,0x9B,0x55,0xF2,0x0B,0x9B,0x96,0x04,0x20,
+0x00,0x0C,0x42,0x33,0x18,0x24,0x42,0x32,0x94,0x73,0xCA,0x4F,0xA0,0x89,0xE2,0x62,
+0x4E,0xF3,0x03,0x19,0xA4,0x89,0xFE,0xBC,0xE2,0x62,0xE8,0x2C,0xA0,0x8A,0xE2,0x62,
+0xE8,0x09,0xA1,0x04,0xA0,0x83,0xFF,0x34,0x42,0x42,0x88,0x73,0x4E,0x46,0x03,0x0B,
+0xD5,0x21,0xA0,0x8B,0xE2,0x62,0xE8,0x1E,0xA1,0x04,0xA0,0x83,0xFF,0x34,0x42,0x42,
+0x88,0x73,0x44,0x20,0x00,0x64,0xFE,0xA4,0x40,0x21,0x1C,0x57,0xFE,0x94,0xFE,0xBC,
+0x44,0x50,0x27,0x10,0x40,0xF1,0x15,0xF7,0x00,0x50,0x80,0x27,0x44,0x20,0x00,0x64,
+0xFF,0x5C,0x40,0x52,0x88,0xB7,0xE2,0xAF,0xE8,0x05,0x4E,0x47,0x00,0x04,0x4E,0x73,
+0x02,0xEA,0x00,0x20,0x00,0x29,0xA7,0x08,0xE2,0x82,0xE8,0x05,0xA0,0x8C,0xE2,0x62,
+0x4E,0xF3,0x02,0xE1,0x00,0x20,0x80,0x26,0x4E,0x22,0x02,0xEE,0xA0,0x8B,0xFE,0x94,
+0xE2,0x62,0x4E,0xF2,0x02,0xE9,0x5A,0x98,0x04,0x04,0x48,0x00,0x02,0xE5,0xF2,0x08,
+0x46,0x39,0x00,0x00,0x48,0x00,0x02,0xDE,0x5A,0x20,0x02,0x04,0x48,0x00,0x02,0xDC,
+0x5A,0x98,0x04,0x04,0x48,0x00,0x02,0xD8,0x04,0xF0,0x80,0x01,0xA0,0x83,0xE2,0x6F,
+0xF2,0x89,0x22,0x70,0x00,0x0E,0x22,0x20,0x00,0x0F,0xA1,0x04,0x4E,0xF3,0x02,0xBB,
+0x00,0x30,0x80,0x28,0x04,0x9F,0x80,0x09,0x85,0xEA,0x42,0x94,0x8C,0x24,0xFE,0xE4,
+0x40,0x94,0xBD,0x36,0x40,0xF1,0xBD,0xF6,0xF3,0x0B,0x88,0x44,0x8A,0x62,0x80,0x43,
+0xF3,0x09,0xFE,0x94,0x88,0xE3,0xF3,0x0A,0x8A,0x67,0x42,0x21,0x8C,0x73,0x42,0x37,
+0xBC,0x24,0x42,0x34,0xA4,0x73,0xE0,0x43,0x4E,0xF2,0x02,0xAE,0xF2,0x09,0xFF,0x34,
+0x42,0x42,0x88,0x73,0x4E,0x47,0x02,0xA8,0xF2,0x08,0x46,0x38,0x00,0x00,0x48,0x00,
+0x02,0xA1,0xF0,0x07,0x8D,0x04,0x8C,0x01,0xF0,0x87,0x50,0xA5,0x00,0x34,0x48,0xFF,
+0xFF,0x1D,0x84,0x00,0xB0,0xE5,0x84,0x21,0xF2,0x05,0xE2,0x02,0xE8,0x05,0x38,0x11,
+0x82,0x0A,0x8C,0x01,0xD5,0xFA,0x50,0x6F,0x83,0xD4,0xB1,0xD1,0x80,0x22,0xF0,0x03,
+0xB0,0x98,0xFD,0x23,0x49,0x00,0x02,0x8D,0x46,0x18,0xFF,0xFF,0x85,0x40,0x50,0x10,
+0x8F,0xFF,0xF0,0x8B,0x3C,0x8D,0xFC,0x34,0x80,0x6A,0xF7,0x87,0x44,0x00,0x00,0x34,
+0xF6,0x8A,0xF1,0x8D,0xF1,0x0B,0xE2,0x61,0x4E,0xF2,0x00,0xCC,0xF2,0x07,0x94,0x59,
+0x88,0x22,0x44,0x21,0x84,0xE4,0xA6,0x49,0x42,0x20,0x80,0x73,0x04,0x21,0x00,0x0C,
+0x5A,0x28,0x02,0x13,0xF2,0x07,0x84,0x8D,0x38,0x21,0x0D,0x00,0x42,0x20,0x90,0x73,
+0xF4,0x0A,0x38,0x22,0x0A,0x02,0x4E,0x25,0x00,0x08,0xB0,0xA5,0x84,0x81,0x38,0x41,
+0x06,0x0A,0x48,0x00,0x00,0xAC,0xF2,0x07,0x38,0x41,0x0D,0x00,0x50,0x2F,0x81,0x30,
+0x42,0x22,0x00,0x73,0x22,0x51,0x00,0x0C,0x50,0x91,0x00,0x18,0xF5,0x88,0x44,0x51,
+0x84,0xE4,0x42,0x50,0x80,0x73,0xF5,0x85,0x22,0x72,0x80,0x0C,0x22,0x54,0x80,0x01,
+0xF6,0x08,0xF5,0x89,0xF5,0x05,0x9B,0xF7,0x81,0xE2,0x22,0x62,0x80,0x0D,0xF5,0x09,
+0x9B,0xAE,0x43,0xE3,0x18,0x24,0x43,0xE3,0x9C,0x73,0x1D,0xE7,0x80,0x02,0xF5,0x08,
+0x14,0x77,0x80,0x01,0x88,0xE5,0xF5,0x09,0xA9,0x94,0x88,0xC5,0x12,0x64,0x80,0x03,
+0x80,0xA4,0x84,0xCD,0x42,0x50,0x98,0x73,0x80,0xC5,0xF5,0x0A,0x51,0xE1,0x00,0x10,
+0x12,0x74,0x80,0x02,0x38,0x62,0x9A,0x02,0xF5,0x0D,0xE2,0xA6,0xE8,0x0D,0xF5,0x05,
+0x84,0xC2,0x8C,0xB0,0x14,0x61,0x00,0x0C,0xA4,0xAA,0x12,0x2F,0x00,0x02,0xA4,0xAB,
+0x12,0x2F,0x00,0x03,0xD5,0x04,0x84,0xA0,0x14,0x51,0x00,0x0C,0x50,0x2F,0x81,0x30,
+0x44,0x51,0x84,0xE4,0x42,0x22,0x00,0x73,0x42,0x50,0x80,0x73,0x50,0x91,0x00,0x10,
+0x50,0x72,0x80,0x10,0x22,0x64,0x80,0x02,0x22,0xF3,0x80,0x02,0x22,0x73,0x80,0x03,
+0x8A,0xCF,0xA9,0x91,0x22,0x64,0x80,0x03,0x8A,0xC7,0x00,0x72,0x80,0x20,0xA9,0x92,
+0x10,0x71,0x00,0x20,0x04,0x72,0x80,0x09,0x50,0x61,0x00,0x20,0x5A,0x78,0x03,0x0C,
+0x00,0x52,0x80,0x28,0x8E,0xA1,0x97,0x68,0x10,0x51,0x00,0x28,0x84,0x41,0xC5,0x04,
+0xA9,0xF1,0xD5,0x03,0x84,0x42,0xA8,0xB1,0x44,0x21,0x84,0xE4,0x50,0x5F,0x81,0x30,
+0x42,0x52,0x00,0x73,0x42,0x20,0x80,0x73,0xB4,0xC5,0x00,0x11,0x00,0x29,0x50,0x22,
+0x80,0x28,0x04,0x54,0x00,0x05,0xAE,0x51,0xE2,0xA6,0xE8,0x05,0xE6,0x2A,0xE8,0x0A,
+0x8C,0x21,0xD5,0x07,0x04,0x54,0x00,0x06,0xE2,0xC5,0xE8,0x04,0xC1,0x03,0x8E,0x21,
+0xAE,0x51,0x50,0x1F,0x81,0x30,0x42,0x12,0x00,0x73,0x00,0x20,0x80,0x20,0xB1,0x7F,
+0x84,0x21,0x38,0x12,0x8A,0x0A,0xB0,0xB2,0x8D,0x41,0x38,0x11,0x12,0x0A,0xF1,0x04,
+0x8E,0x21,0xF1,0x84,0xF1,0x02,0x8E,0x21,0xF1,0x82,0x8C,0x61,0x48,0xFF,0xFF,0x34,
+0xB1,0xA5,0x44,0x01,0x84,0xE4,0x87,0xC0,0xB1,0xF2,0x2E,0x17,0xF0,0xC8,0x3C,0x3D,
+0xFC,0x33,0x40,0xFF,0x04,0x06,0xE8,0x03,0xF1,0x02,0xC9,0x0A,0x84,0x20,0x3C,0x5D,
+0xFC,0x34,0xF0,0x01,0x81,0x21,0x84,0x81,0x87,0xC3,0x48,0x00,0x00,0x9F,0x00,0x11,
+0x80,0x09,0xE3,0x41,0xE8,0xF4,0xA2,0x71,0x5A,0x10,0x01,0x04,0x48,0x00,0x00,0x82,
+0xF1,0x0C,0xC9,0x0C,0x04,0x10,0x00,0x09,0x5A,0x18,0x03,0x09,0xF1,0x0C,0x14,0x13,
+0x7F,0xFF,0xF1,0x02,0x8E,0x21,0xF1,0x82,0xD5,0x74,0x04,0x10,0x00,0x09,0x5A,0x10,
+0x03,0x0D,0x5A,0x10,0x06,0x0B,0x5A,0x10,0x07,0x09,0x9E,0x89,0xE6,0x42,0xE8,0x0B,
+0x04,0x20,0x00,0x0C,0x5A,0x28,0x02,0x04,0x84,0x40,0xD5,0x08,0x3C,0x2D,0xFC,0x34,
+0xA6,0x91,0xD5,0x04,0x00,0x20,0x00,0x28,0x8E,0x41,0x10,0x20,0x00,0x28,0x00,0x20,
+0x00,0x28,0x5A,0x28,0x01,0x08,0x00,0x40,0x00,0x2A,0x58,0x42,0x00,0x04,0x10,0x40,
+0x00,0x2A,0x00,0x31,0x80,0x19,0x85,0x20,0xE3,0x23,0xE8,0x0A,0x38,0x43,0xA6,0x02,
+0xCC,0x05,0xB1,0x18,0x38,0x42,0x26,0x02,0xC4,0x05,0x8D,0x21,0xD5,0xF6,0x85,0x20,
+0xD5,0x3E,0xC2,0x03,0x84,0x24,0xD5,0x0F,0x5A,0x18,0x03,0x04,0x84,0x26,0xD5,0x0B,
+0x5A,0x18,0x06,0x04,0x84,0x27,0xD5,0x07,0x5A,0x18,0x07,0x05,0x14,0x20,0x00,0x09,
+0xD5,0x04,0x84,0x25,0x14,0x10,0x00,0x09,0x44,0x20,0x00,0x34,0x50,0x1F,0x81,0x30,
+0x42,0x14,0x88,0x73,0x81,0x01,0x80,0x20,0x3A,0x20,0x94,0x04,0x3A,0x24,0x14,0x24,
+0x3A,0x20,0x94,0x04,0x3A,0x24,0x14,0x24,0x3A,0x20,0x94,0x04,0x3A,0x24,0x14,0x24,
+0xB4,0x21,0xB0,0xBF,0xB6,0x28,0x00,0x10,0x00,0x20,0x84,0x61,0x38,0x33,0xA6,0x0A,
+0x38,0x31,0x06,0x0A,0x84,0x20,0x14,0x13,0x7F,0xFF,0xF1,0x02,0x89,0x43,0x8E,0x21,
+0xF1,0x82,0xD5,0x07,0x38,0x43,0xA6,0x02,0xC4,0xC5,0x8D,0x21,0x4C,0x91,0xFF,0xFC,
+0x51,0xEF,0x00,0x01,0x50,0x00,0x00,0x34,0x48,0xFF,0xFF,0x61,0xF2,0x04,0xC2,0x61,
+0x00,0x71,0x80,0x09,0xE3,0x47,0xE8,0x5D,0xB0,0x98,0x38,0x21,0x06,0x02,0x5A,0x20,
+0x01,0x09,0x8C,0x21,0x50,0x00,0x00,0x34,0xF2,0x03,0xE2,0x22,0xE9,0xF0,0xD5,0x51,
+0xB0,0xB2,0x38,0x21,0x06,0x02,0xCA,0xF6,0xF6,0x0E,0x04,0xF0,0x00,0x0B,0x04,0x83,
+0x00,0x03,0x38,0x84,0x3D,0x01,0x02,0xF2,0x80,0x15,0x40,0xF7,0xA0,0x06,0xE8,0xEA,
+0xB1,0xBF,0x38,0xF3,0x0A,0x02,0xE9,0x3A,0x02,0x70,0x00,0x0C,0x80,0xC4,0x12,0x70,
+0x00,0x0E,0x02,0x70,0x00,0x0D,0x10,0x20,0x00,0x20,0x12,0x70,0x00,0x0F,0x40,0x72,
+0xA8,0x00,0x14,0xF0,0x00,0x00,0x00,0x73,0x80,0x1C,0x14,0xF0,0x00,0x01,0x40,0x6F,
+0x1C,0x1B,0x14,0x60,0x00,0x09,0x84,0xC0,0x14,0x60,0x00,0x0C,0xB1,0xBF,0x10,0x70,
+0x00,0x28,0x38,0x43,0x0A,0x0A,0xB0,0xB2,0x84,0xC0,0x38,0x41,0x06,0x0A,0xB0,0x98,
+0x00,0x70,0x00,0x2A,0x38,0x61,0x06,0x0A,0xF2,0x04,0x58,0x73,0x80,0x01,0x8E,0x41,
+0x14,0xF0,0x00,0x02,0x14,0xF0,0x00,0x03,0x14,0xF0,0x00,0x04,0x10,0x90,0x00,0x29,
+0x10,0x70,0x00,0x2A,0xF2,0x84,0x8D,0x41,0xD5,0xAD,0x8C,0x41,0xE2,0x47,0xD5,0xC0,
+0x84,0x00,0x3C,0x6D,0xFC,0x33,0xF1,0x06,0x80,0x40,0x00,0x33,0x00,0x09,0xE2,0x03,
+0xE8,0x08,0xB6,0x41,0x10,0x20,0x80,0x35,0x8C,0x01,0x50,0x10,0x80,0x5C,0xD5,0xF6,
+0x84,0x00,0x84,0x20,0x3E,0x07,0xF0,0xC8,0x44,0x70,0x00,0x5C,0x81,0x01,0x00,0x03,
+0x00,0x19,0xE2,0x20,0x4E,0xF2,0x00,0x8A,0xB0,0x32,0x38,0x00,0x06,0x02,0xF0,0x82,
+0x5A,0x08,0x01,0x6B,0xF0,0x01,0x04,0xA0,0x00,0x09,0x00,0x90,0x00,0x20,0x5A,0xA0,
+0x05,0x30,0x5A,0xA0,0x07,0x27,0x2E,0xF7,0xF0,0xC8,0x44,0x20,0x00,0x34,0x44,0x01,
+0x84,0xE4,0x42,0x07,0x88,0x73,0x83,0xC0,0xF0,0x01,0x3A,0x20,0x14,0x04,0x3A,0x2F,
+0x14,0x24,0x3A,0x20,0x14,0x04,0x3A,0x2F,0x14,0x24,0x3A,0x20,0x14,0x04,0x3A,0x2F,
+0x14,0x24,0xB4,0x00,0xB6,0x1E,0x50,0x07,0x80,0x01,0x3E,0x07,0xF0,0xC8,0x5A,0xA8,
+0x06,0x10,0xF0,0x06,0x42,0x04,0x9C,0x73,0x00,0x2F,0x80,0x08,0xB7,0x00,0xD5,0x0D,
+0xF0,0x06,0x42,0x04,0x9C,0x73,0xB7,0x00,0x10,0x80,0x00,0x35,0xD5,0x08,0xF0,0x06,
+0x42,0x04,0x9C,0x73,0x84,0x40,0xB7,0x40,0x10,0x20,0x00,0x35,0xF2,0x01,0xF0,0x06,
+0x42,0x04,0x9C,0x73,0x00,0x21,0x00,0x2A,0x10,0x20,0x00,0x18,0xF2,0x01,0x02,0x21,
+0x00,0x0A,0xAC,0x82,0xF2,0x01,0x02,0x21,0x00,0x0B,0xAC,0x83,0x00,0x20,0x00,0x35,
+0x5A,0x28,0x01,0x08,0xA4,0x86,0x12,0x20,0x00,0x08,0xA4,0x87,0x12,0x20,0x00,0x09,
+0xF2,0x01,0x50,0x30,0x00,0x24,0x04,0x21,0x00,0x0B,0xA8,0x87,0xF2,0x01,0xB4,0x42,
+0xB6,0x43,0xF2,0x01,0xA0,0x91,0xA8,0x99,0xF2,0x01,0xA0,0x92,0xA8,0x9A,0xF2,0x01,
+0x04,0x21,0x00,0x0C,0xA8,0x9B,0xF0,0x01,0x8C,0x21,0x50,0x00,0x00,0x34,0xF0,0x81,
+0xD5,0x87,0x5A,0x98,0x03,0x06,0xF2,0x08,0x46,0x31,0x00,0x00,0xD5,0x0A,0xF2,0x08,
+0x38,0x24,0x78,0x0A,0x50,0x00,0x00,0x34,0x51,0xEF,0x00,0x34,0x48,0xFF,0xFC,0x98,
+0x88,0x43,0xD5,0xF7,0x84,0x5F,0xD5,0xF5,0x51,0xFF,0x86,0x78,0xFC,0xC0,0xFC,0x43,
+0xF0,0x81,0x81,0x00,0x84,0x00,0xF4,0x84,0xF1,0x82,0xF5,0x85,0x80,0xE1,0x83,0x80,
+0x81,0x20,0x84,0x81,0x4E,0x82,0x00,0x3D,0xC7,0x3B,0x5A,0x48,0x01,0x3A,0x84,0xA0,
+0x80,0x85,0x85,0x5E,0xF1,0x01,0xD1,0x22,0x38,0x61,0x16,0x02,0x5A,0x68,0x01,0x1D,
+0xF1,0x04,0x95,0xAA,0x88,0xC1,0xF6,0x83,0x84,0xC0,0xF1,0x02,0x4C,0x60,0x80,0x15,
+0x39,0xE1,0x9A,0x02,0x5B,0xE8,0x01,0x0F,0x44,0x10,0x00,0x34,0x42,0xF3,0x04,0x24,
+0xF1,0x03,0x38,0x10,0xBC,0x02,0xE2,0x2A,0xE8,0x05,0x83,0x86,0x81,0x25,0x80,0x9E,
+0x81,0x41,0x8C,0xC1,0xD5,0xEB,0x8C,0xA1,0xD5,0xDE,0xC4,0xD5,0xF1,0x05,0x95,0x41,
+0x88,0xA1,0x8C,0x01,0x84,0x20,0x10,0x92,0x80,0x00,0x11,0xC2,0x80,0x01,0x96,0x00,
+0x38,0x11,0x26,0x0A,0x8F,0x01,0x38,0x11,0xF2,0x0A,0x8E,0xE1,0xD5,0xC4,0xFC,0xC3,
+0x3C,0x0F,0xFC,0xA6,0xDD,0x9E,0x3C,0x0F,0xFC,0xA5,0xDD,0x9E,0x3C,0x1D,0xFC,0xA6,
+0x44,0x01,0x88,0x0C,0x3C,0x0F,0xFC,0x3F,0xA6,0x4D,0x84,0x00,0x8E,0x21,0x96,0x48,
+0x3E,0x17,0xF1,0x02,0x3E,0x17,0xF1,0x03,0x84,0x21,0x3E,0x07,0xF1,0x00,0x3E,0x07,
+0xF1,0x01,0x3E,0x07,0xF1,0x04,0x3E,0x07,0xF1,0x05,0x3E,0x07,0xF1,0x06,0x3E,0x07,
+0xF0,0xD5,0x3E,0x07,0xF0,0xD4,0x3E,0x07,0xF0,0xD6,0x3C,0x1F,0xFA,0x5E,0x3E,0x07,
+0xEC,0x3F,0x44,0x11,0x87,0xC8,0x84,0x00,0x84,0x5F,0x38,0x20,0x80,0x08,0x8C,0x01,
+0x5A,0x08,0x41,0xFD,0xDD,0x9E,0xFC,0x00,0x49,0x00,0x29,0x34,0xFC,0x80,0xFC,0x00,
+0x80,0xC0,0x49,0x00,0x29,0x37,0xC0,0x04,0x84,0x00,0xAE,0x34,0xAE,0x35,0xFC,0x80,
+0x2E,0x07,0xF0,0xDC,0xDD,0x9E,0x44,0x31,0x87,0x94,0xAE,0x18,0xAE,0x59,0xAE,0x9A,
+0xDD,0x9E,0x3C,0x0F,0xFA,0x5E,0xDD,0x9E,0x3C,0x0D,0xFA,0x5E,0xDD,0x9E,0x3C,0x0D,
+0xFB,0x0F,0x46,0x5F,0xF0,0x0F,0x50,0x52,0x8F,0x00,0xFF,0x46,0x46,0x00,0x10,0x00,
+0xD8,0x06,0x84,0x00,0x3E,0x07,0xEC,0x3F,0x84,0x01,0xDD,0x9E,0x84,0x00,0xDD,0x9E,
+0x2E,0x17,0xF1,0x02,0x2E,0x57,0xF1,0x03,0x3C,0x0D,0xFC,0xA6,0x4C,0x12,0xC0,0x10,
+0x2E,0x27,0xF1,0x00,0x5A,0x28,0x01,0x0C,0xA6,0x05,0x9D,0x49,0x40,0x02,0x80,0xB6,
+0x97,0x68,0x3E,0x57,0xF1,0x02,0x3E,0x57,0xF1,0x03,0xDD,0x9E,0xA6,0x05,0x8C,0xA1,
+0x40,0x02,0x80,0xB6,0x97,0x68,0x3E,0x57,0xF1,0x03,0xD9,0x04,0x84,0x01,0x3E,0x07,
+0xF1,0x00,0xDD,0x9E,0x2E,0x57,0xF1,0x02,0x2E,0x17,0xF1,0x03,0xD9,0x04,0x2E,0x07,
+0xF1,0x00,0xC0,0x10,0x3C,0x0D,0xFC,0xA6,0x8C,0xA1,0xA6,0x05,0x40,0x02,0x80,0xB6,
+0x97,0x68,0x3E,0x57,0xF1,0x02,0x4C,0x12,0xC0,0x05,0x84,0x00,0x3E,0x07,0xF1,0x00,
+0x84,0x01,0xDD,0x9E,0x2E,0x57,0xF1,0x02,0x2E,0x07,0xF1,0x03,0xD8,0x08,0x2E,0x07,
+0xF1,0x00,0x84,0x20,0x8E,0x01,0x40,0x00,0x80,0x06,0xDD,0x9E,0x84,0x01,0xDD,0x9E,
+0x2E,0x57,0xF1,0x02,0x2E,0x07,0xF1,0x03,0xD8,0x07,0x2E,0x17,0xF1,0x00,0x84,0x00,
+0x40,0x00,0x04,0x06,0xDD,0x9E,0x84,0x01,0xDD,0x9E,0xFC,0x00,0x84,0xA0,0x8C,0x81,
+0xE2,0xA4,0xE8,0x07,0x38,0x60,0x08,0x04,0x38,0x60,0x8C,0x0C,0x8C,0xA1,0xD5,0xF9,
+0xFC,0x80,0xFC,0x40,0x81,0x20,0xA6,0x00,0x80,0xC1,0x84,0x20,0x3E,0x17,0xF1,0x05,
+0xC0,0x29,0x2E,0x07,0xF1,0x01,0x5A,0x08,0x01,0x0C,0x2E,0x27,0xF1,0x04,0x3E,0x17,
+0xF1,0x00,0x3E,0x27,0xF1,0x02,0x3E,0x27,0xF1,0x03,0x3E,0x07,0xF1,0x05,0x49,0xFF,
+0xFF,0x89,0x3C,0x0D,0xFC,0xA6,0x2E,0x77,0xF1,0x03,0x3C,0x1D,0xFC,0x3F,0xA7,0x04,
+0x84,0x41,0x04,0x04,0x80,0x01,0x42,0x13,0x90,0x73,0x80,0x62,0x8E,0x81,0x49,0xFF,
+0xFF,0xCE,0x2E,0x07,0xF1,0x06,0x5A,0x08,0x01,0x06,0x3E,0x07,0xF1,0x01,0x3E,0x77,
+0xF1,0x04,0x2E,0x17,0xF1,0x05,0xB4,0x06,0x5A,0x18,0x01,0x33,0xA6,0x05,0xC8,0x1B,
+0x49,0x00,0x28,0x74,0xC8,0x12,0x3C,0x0D,0xFC,0xA6,0x2E,0x27,0xF1,0x04,0xB4,0x26,
+0xA7,0x04,0x3C,0x0D,0xFC,0x3F,0x42,0x01,0x10,0x73,0x84,0x41,0xB4,0x21,0x80,0x62,
+0x8E,0x81,0x49,0xFF,0xFF,0xAC,0xD5,0x0A,0x49,0x00,0x28,0x60,0xC0,0xED,0x49,0x00,
+0x28,0x38,0xD5,0xFB,0x49,0x00,0x28,0x5A,0xC8,0x03,0x49,0x00,0x28,0x63,0xB4,0x26,
+0x84,0x00,0x3E,0x07,0xF1,0x05,0x3E,0x07,0xF1,0x01,0x84,0x01,0xAE,0x0D,0xB4,0x26,
+0xAE,0x0C,0x2E,0x17,0xF0,0xD4,0xC1,0x42,0xB4,0x26,0xAE,0x0F,0xD5,0x3F,0xA6,0x44,
+0xC9,0x05,0x49,0xFF,0xFF,0x7F,0xC0,0x3A,0xD5,0x0D,0xA6,0x05,0x5A,0x08,0x01,0x08,
+0x49,0x00,0x28,0x3C,0xC8,0x33,0x49,0x00,0x28,0x45,0xD5,0x30,0x49,0xFF,0xFF,0x64,
+0xC8,0xF8,0x49,0x00,0x28,0x33,0x80,0xE0,0xC8,0x29,0x49,0xFF,0xFF,0x45,0x3C,0x0D,
+0xFC,0xA6,0xB4,0x26,0x2E,0x97,0xF1,0x02,0xA7,0x04,0x84,0x41,0x3C,0x0D,0xFC,0x3F,
+0x42,0x04,0x90,0x73,0xB4,0x21,0x80,0x62,0x8E,0x81,0x49,0xFF,0xFF,0x68,0x2E,0x17,
+0xF1,0x01,0x5A,0x18,0x01,0x0F,0x2E,0x57,0xF1,0x04,0x4C,0x54,0xC0,0x0B,0xB4,0x06,
+0x3E,0x77,0xF1,0x01,0xAE,0x45,0x2E,0x07,0xF0,0xD4,0xC0,0x03,0xB4,0x06,0xAE,0x47,
+0x49,0x00,0x28,0x18,0xB4,0x06,0x84,0x21,0xAE,0x44,0xFC,0xC0,0x80,0x60,0x3C,0x0D,
+0xFA,0x5E,0x9E,0x41,0xE6,0x22,0xE8,0x25,0x3C,0x2D,0xFC,0xA5,0x84,0x20,0x00,0x41,
+0x00,0x0A,0xE2,0x24,0xE8,0x09,0xA1,0x59,0x38,0x52,0x87,0x02,0x5A,0x58,0x01,0x03,
+0x84,0x02,0x8C,0x21,0xD5,0xF7,0xFC,0x00,0x84,0x20,0x00,0x41,0x00,0x09,0x44,0x50,
+0x00,0x5C,0xE2,0x24,0xE8,0x0D,0xB4,0x43,0x42,0x20,0x94,0x73,0xB4,0x42,0x9F,0x91,
+0xE6,0xC2,0xE9,0x05,0x5A,0x20,0x04,0x04,0x8C,0x21,0xD5,0xF4,0x84,0x01,0xFC,0x80,
+0xDD,0x9E,0xFC,0x42,0x80,0xC1,0x84,0x3F,0x10,0x1F,0x80,0x0F,0x2E,0x10,0x21,0xD8,
+0x81,0x20,0xC1,0x08,0x2E,0x17,0xF0,0xDC,0xC9,0x05,0x49,0xFF,0xFF,0xC9,0x3C,0x0F,
+0xFA,0x5E,0x3C,0x1D,0xFA,0x5E,0x5A,0x10,0x01,0x04,0x48,0x00,0x00,0xC4,0x84,0xE0,
+0x3C,0x3D,0xFC,0xA5,0x3C,0x4D,0xFC,0xA6,0xB6,0xFF,0x00,0x01,0x80,0x09,0xB4,0x3F,
+0xE2,0x20,0x4E,0xF2,0x00,0xB0,0xB4,0x1F,0x44,0x10,0x00,0x5C,0xFE,0x0C,0xB4,0x29,
+0xF0,0x81,0x88,0x01,0xB4,0xA0,0x9E,0xA9,0xE6,0x42,0x00,0x20,0x00,0x35,0xE9,0x08,
+0x5A,0x50,0x04,0x07,0x5A,0x20,0x01,0x04,0x48,0x00,0x00,0x97,0xD5,0x03,0x5A,0x28,
+0x01,0x0A,0x02,0x20,0x00,0x08,0xAC,0x84,0xF2,0x01,0x88,0x22,0x02,0x20,0x80,0x09,
+0xAC,0x8D,0xA6,0x60,0x22,0x20,0x00,0x04,0xC1,0x05,0x02,0x51,0x80,0x09,0x8E,0xA1,
+0x9A,0xAA,0xA7,0x61,0x22,0x10,0x00,0x05,0xC5,0x05,0x02,0x01,0x80,0x0A,0x8E,0x01,
+0x9A,0x41,0xA6,0x23,0xC0,0x32,0xA7,0x62,0x02,0x01,0x80,0x09,0xCD,0x0F,0x02,0x81,
+0x80,0x02,0x8E,0x01,0x84,0xA2,0x50,0xA4,0x7F,0xFF,0x40,0x50,0x14,0xB6,0x42,0x51,
+0x28,0x73,0x40,0x22,0x80,0x57,0xA5,0x5B,0xD5,0x0E,0x02,0x81,0x80,0x03,0x8E,0x01,
+0x84,0xA2,0x50,0xA4,0x7F,0xFF,0x40,0x50,0x14,0xB6,0x42,0x51,0x28,0x73,0x40,0x22,
+0x80,0x57,0xA5,0x5A,0x02,0x01,0x80,0x0A,0x87,0xC2,0x50,0xF0,0x7F,0xFF,0x41,0xE7,
+0xFB,0xD6,0x9E,0x29,0x43,0xE0,0x80,0x73,0x40,0x1F,0x3C,0x37,0xE3,0x02,0x40,0x25,
+0x3C,0x1B,0xE2,0xA1,0x40,0x10,0x3C,0x1B,0xB4,0xBF,0x84,0x06,0xB5,0x46,0xFE,0x3C,
+0x8C,0xA1,0x96,0x00,0x95,0x6B,0x58,0x52,0x80,0x02,0x38,0x55,0x00,0x08,0xB4,0xA6,
+0x00,0xF2,0x00,0x02,0x40,0xA1,0x10,0x09,0x88,0xA0,0xE9,0x10,0x10,0xA2,0x80,0x01,
+0xB4,0xA6,0x40,0xA0,0x90,0x09,0x88,0xA0,0x94,0x94,0x10,0xA2,0x80,0x02,0xB4,0xA6,
+0x96,0x5F,0x88,0xA0,0xFE,0x8F,0xAE,0xAB,0xD5,0x0F,0x40,0x80,0x90,0x09,0x10,0x82,
+0x80,0x01,0xB4,0xA6,0x94,0x4C,0x88,0xA0,0x96,0x9F,0x10,0xA2,0x80,0x02,0xB4,0xA6,
+0xFE,0x57,0x88,0xA0,0xAE,0x6B,0xB4,0x49,0xF5,0x01,0xB4,0x26,0x88,0x45,0x88,0x20,
+0x02,0x21,0x00,0x0A,0x8C,0xE1,0xAE,0x8C,0xB4,0x26,0x97,0xF8,0x88,0x01,0xB4,0x29,
+0x88,0x25,0x02,0x10,0x80,0x0B,0xAE,0x45,0xB4,0x06,0x84,0x3F,0x10,0x10,0x00,0x3C,
+0xB4,0x06,0x10,0x10,0x00,0x3D,0xB4,0x1F,0x8C,0x01,0x96,0x00,0xB6,0x1F,0x48,0xFF,
+0xFF,0x4E,0xB4,0x26,0x84,0x1F,0x10,0x00,0x80,0x3E,0xB4,0x26,0x10,0x00,0x80,0x3F,
+0xD5,0x56,0xB4,0x66,0x5A,0x18,0x02,0x2A,0x84,0x18,0x10,0x01,0x80,0x3C,0xB4,0x06,
+0x84,0x20,0x84,0xE0,0x10,0x10,0x00,0x3D,0x3C,0x4D,0xFC,0xA5,0x80,0x07,0x00,0x12,
+0x00,0x0A,0xE2,0x01,0xE8,0x14,0x04,0x14,0x80,0x01,0x38,0x10,0x83,0x02,0x5A,0x18,
+0x01,0x0C,0xB4,0x66,0x40,0x10,0x80,0x0C,0x8C,0xE1,0x00,0x21,0x80,0x3D,0x97,0xF8,
+0xFE,0x57,0x10,0x11,0x80,0x3D,0x8C,0x01,0x96,0x00,0xD5,0xEA,0xB4,0x06,0x00,0x00,
+0x00,0x3D,0x3E,0x07,0xF0,0xD7,0xD5,0x2B,0x2E,0x27,0xF0,0xD4,0xC2,0x12,0x2E,0x07,
+0xF0,0xD5,0x2E,0x47,0xF0,0xD6,0xE6,0x1E,0xE8,0x03,0x94,0x03,0xD5,0x02,0x84,0x10,
+0xAE,0x18,0xB4,0x06,0xAE,0x81,0xB4,0x06,0xAF,0x02,0x84,0x01,0x3E,0x07,0xF0,0xDC,
+0x5A,0x10,0x03,0x04,0x84,0xE0,0xD5,0x13,0x84,0x00,0x44,0x31,0xA1,0x94,0xB4,0x26,
+0x38,0x21,0x80,0x01,0x88,0x20,0xAE,0x8B,0xB4,0x26,0x38,0x21,0x80,0x01,0x88,0x20,
+0x92,0x48,0x8C,0x02,0xAE,0x8C,0x5A,0x08,0x28,0xF4,0xD5,0xED,0x2E,0x07,0xF0,0xDC,
+0x5A,0x00,0xFF,0x0D,0xC0,0x0B,0xCF,0x0A,0x84,0x1F,0x3E,0x07,0xF0,0xDC,0x3C,0x0D,
+0xFC,0x36,0x8C,0x01,0x3C,0x0F,0xFC,0x36,0xD5,0x03,0x3E,0x77,0xF0,0xDC,0x3C,0x3D,
+0xFA,0x5E,0x5A,0x38,0x01,0x16,0x3C,0x0D,0xFC,0xA5,0x00,0x40,0x00,0x09,0xE2,0xE4,
+0xE8,0x0F,0x84,0x26,0xB4,0x46,0x84,0x06,0xFE,0x7C,0x8A,0x87,0xFF,0x04,0x96,0x48,
+0x88,0x22,0x50,0x0F,0x80,0x0F,0x84,0x40,0x8E,0x81,0x49,0xFF,0xFD,0xD0,0xB4,0x26,
+0x84,0x00,0x80,0xA1,0x50,0x20,0x80,0x40,0x08,0x32,0x80,0x01,0x88,0x03,0x96,0x00,
+0xDA,0xFC,0xFE,0x02,0x10,0x00,0x80,0x40,0x84,0x01,0xC7,0x02,0x84,0x00,0x3E,0x07,
+0xF1,0x06,0xFC,0xC2,0xFC,0x20,0x80,0x40,0x80,0xE1,0x44,0x01,0x87,0xB0,0xA0,0x51,
+0x44,0x61,0x87,0xC8,0xB6,0x20,0x2E,0x17,0xF0,0xDC,0x3C,0x6F,0xFC,0x3B,0x10,0x10,
+0x00,0x08,0xA0,0x52,0xA8,0x41,0x44,0x11,0x87,0xAC,0x49,0xFF,0xFE,0x84,0x44,0x01,
+0x87,0xA4,0x2E,0x17,0xF0,0xDC,0xA9,0x81,0xAE,0x40,0xB4,0x27,0x3C,0x1F,0xFC,0x38,
+0x44,0x11,0x87,0xA0,0x49,0xFF,0xFD,0xA7,0x44,0x01,0x87,0x94,0x84,0x20,0xAE,0x40,
+0xAE,0x41,0xAE,0x42,0x49,0xFF,0xFD,0x86,0xFC,0xA0,0x3C,0x0F,0xFE,0x0F,0xDD,0x9E,
+0x3C,0x0F,0xFE,0x0E,0xDD,0x9E,0xFC,0x41,0x44,0x70,0x00,0x5C,0x42,0x01,0x9C,0x73,
+0xF5,0x81,0x00,0x70,0x00,0x18,0x40,0x92,0x80,0x11,0x97,0xC6,0x22,0x60,0x80,0x00,
+0x90,0xB0,0x22,0x10,0x80,0x01,0x87,0x81,0x44,0xA1,0x8E,0x90,0x44,0x81,0x8E,0x74,
+0xC7,0x12,0x44,0x71,0x8E,0xD8,0x38,0x14,0x0D,0x09,0x38,0x63,0x8D,0x09,0x44,0x71,
+0x8E,0xBC,0x38,0x65,0x0D,0x09,0x38,0x13,0x8D,0x09,0x44,0x11,0x8E,0xAC,0x39,0xC0,
+0x8C,0x08,0xD5,0x65,0xB4,0xE0,0x5A,0x78,0x03,0x23,0x38,0x75,0x0D,0x01,0x45,0xE1,
+0x8E,0xAC,0x88,0xC7,0x38,0x74,0x0D,0x01,0x97,0xB3,0x88,0x27,0x38,0x7F,0x0C,0x00,
+0x96,0x4B,0x8C,0xE1,0x97,0xF8,0xE6,0xEF,0x38,0x65,0x0D,0x09,0x38,0x14,0x0D,0x09,
+0x38,0x7F,0x0C,0x08,0xE9,0x4C,0x40,0x63,0x1C,0xD6,0x40,0x10,0x9C,0x36,0x38,0x65,
+0x0D,0x09,0x38,0x14,0x0D,0x09,0x39,0xCF,0x0C,0x08,0xD5,0x41,0x5A,0x78,0x01,0x3C,
+0x44,0x71,0x8E,0xD8,0x3D,0xED,0xFE,0x0F,0x39,0xC3,0x8D,0x11,0x44,0x71,0x8E,0xBC,
+0x38,0x83,0x8D,0x11,0x00,0x7F,0x00,0x00,0x5A,0x70,0x01,0x04,0x48,0x00,0x00,0x78,
+0x40,0xFE,0x18,0x01,0x4E,0xF4,0x00,0x04,0x52,0xF7,0x80,0x00,0x40,0x74,0x04,0x01,
+0x4E,0x74,0x00,0x03,0xFF,0xFA,0x88,0xEF,0x02,0xFF,0x00,0x04,0x40,0xF7,0x9C,0x06,
+0xE8,0x66,0x03,0xEF,0x00,0x03,0x40,0xFE,0x78,0x07,0xE9,0x58,0x3C,0x7D,0xFE,0x0E,
+0x02,0xF3,0x80,0x09,0x50,0xF7,0xFF,0xFF,0x40,0xF7,0xF8,0x01,0x40,0xF7,0xF0,0x07,
+0xE9,0x4D,0xE1,0x1E,0xE9,0x4B,0x02,0x73,0x80,0x0A,0x8E,0xE1,0x8A,0xFE,0xE0,0xE8,
+0xE9,0x45,0xD5,0x4D,0x38,0x65,0x0D,0x09,0x38,0x14,0x0D,0x09,0x00,0x1F,0x80,0x28,
+0x44,0x71,0x8E,0x90,0x44,0x61,0x8E,0x74,0x5A,0x18,0x01,0x32,0xB4,0x00,0x5A,0x08,
+0x01,0x2F,0x3C,0x8D,0xFE,0x0F,0x02,0x04,0x00,0x05,0xE2,0x80,0xE8,0x28,0x38,0x03,
+0x8D,0x11,0x38,0xA3,0x0D,0x11,0x40,0x10,0x24,0x01,0x4E,0x14,0x00,0x03,0xFE,0x4A,
+0x40,0x45,0x14,0x01,0x4E,0x44,0x00,0x03,0xFF,0x22,0x88,0x81,0x02,0x14,0x00,0x06,
+0xE0,0x81,0xE8,0x15,0x02,0x44,0x00,0x07,0x50,0x82,0x7F,0xFF,0x40,0x12,0x04,0x09,
+0x42,0x04,0x24,0x73,0x42,0xA4,0x14,0x73,0x88,0x01,0x88,0x2A,0x40,0x00,0x10,0x16,
+0x40,0x10,0x90,0x36,0x38,0x03,0x8D,0x09,0x38,0x13,0x0D,0x09,0x38,0x03,0x8D,0x01,
+0xAC,0x10,0x38,0x03,0x0D,0x01,0xAC,0x11,0xFC,0xC1,0x44,0x11,0x8E,0x90,0x39,0xC0,
+0x8D,0x09,0x44,0x11,0x8E,0x74,0x38,0x80,0x8D,0x09,0xD5,0xB9,0x38,0x75,0x0D,0x01,
+0x44,0x81,0x8E,0x74,0x88,0xC7,0x44,0xF1,0x8E,0xAC,0x38,0x74,0x0D,0x01,0x97,0xB3,
+0x88,0x27,0x38,0x77,0x8C,0x00,0x96,0x4B,0x8C,0xE1,0x97,0xF8,0x40,0x63,0x1C,0xD6,
+0x38,0x77,0x8C,0x08,0x40,0x70,0x9C,0xF6,0x38,0x65,0x0D,0x09,0x38,0x74,0x0D,0x09,
+0xD5,0x9E,0xFC,0x41,0x3C,0x8D,0xFE,0x0F,0xF2,0x81,0x22,0x40,0x80,0x00,0x00,0x64,
+0x00,0x16,0x22,0x50,0x80,0x01,0xC6,0x05,0xE6,0xC9,0xE8,0x05,0x97,0xB1,0xD5,0x04,
+0x84,0xC1,0xD5,0x02,0x84,0xC8,0x00,0x14,0x00,0x17,0xC1,0x05,0xE6,0x29,0xE8,0x05,
+0x96,0x49,0xD5,0x04,0x84,0x21,0xD5,0x02,0x84,0x28,0x44,0x70,0x00,0x5C,0x42,0x01,
+0x9C,0x73,0xB4,0x00,0xB6,0x1F,0x5A,0x00,0x01,0x06,0x2E,0x07,0xF2,0x9C,0x5A,0x08,
+0x01,0x21,0x44,0x11,0x8E,0x40,0x84,0x00,0x38,0x00,0x8E,0x0A,0x44,0x11,0x8E,0x0C,
+0x38,0x00,0x8E,0x0A,0x44,0x01,0x8D,0xD8,0x44,0x11,0x8C,0x04,0x38,0x60,0x0E,0x0A,
+0x44,0x01,0x8D,0xA4,0x38,0x40,0x8E,0x09,0x38,0x60,0x0E,0x0A,0x94,0x1A,0x88,0x01,
+0x84,0x21,0xAD,0x41,0x44,0x01,0x8B,0xD0,0x38,0x10,0x0E,0x0A,0x48,0x00,0x00,0xD6,
+0xB4,0x1F,0x5A,0x08,0x03,0x04,0x48,0x00,0x00,0xCF,0x44,0x71,0x8B,0xD0,0x51,0xC0,
+0xFF,0xFF,0x38,0x03,0x8E,0x02,0x8C,0x01,0xE0,0x20,0x40,0x00,0xBC,0x1B,0x38,0x03,
+0x8E,0x0A,0x44,0x01,0x8E,0x0C,0x38,0x70,0x0E,0x02,0xE0,0xFC,0xE8,0x03,0x8C,0xE1,
+0xD5,0x02,0x84,0xE0,0x44,0x91,0x8E,0x40,0x38,0x70,0x0E,0x0A,0x38,0x74,0x8E,0x02,
+0xCF,0x08,0x38,0x70,0x0E,0x02,0x4C,0x7E,0x40,0x05,0x84,0xE1,0x38,0x74,0x8E,0x0A,
+0x38,0x00,0x0E,0x02,0x85,0xED,0x81,0x23,0x44,0x71,0x8C,0x04,0x42,0x90,0x3C,0x73,
+0x38,0x43,0xA6,0x09,0x40,0x94,0x88,0x08,0x89,0x27,0x45,0xE1,0x8D,0xA4,0x12,0x54,
+0x80,0x01,0x44,0x91,0x8D,0xD8,0x38,0xA4,0x8E,0x02,0x38,0xAF,0x0E,0x0A,0x4E,0x07,
+0x00,0x08,0x51,0xE0,0x7F,0xFF,0x80,0x43,0x42,0x2F,0x3C,0x73,0xD5,0x04,0x80,0x43,
+0x42,0x2E,0x3C,0x73,0x40,0xF1,0x08,0x08,0x40,0xF3,0xBC,0x00,0x39,0xE3,0x8A,0x11,
+0x22,0xF7,0x80,0x01,0x40,0x4F,0x10,0x01,0x40,0x57,0x94,0x01,0x4E,0x44,0x00,0x03,
+0xFF,0x22,0x4E,0x54,0x00,0x03,0xFF,0x6A,0x03,0xE4,0x00,0x0D,0x88,0xA4,0x40,0xFF,
+0x14,0x06,0x80,0x9E,0xE9,0x06,0x02,0x44,0x00,0x0C,0xE2,0xA4,0x40,0x42,0xBC,0x1A,
+0x44,0x51,0x8E,0x40,0x38,0x52,0x8E,0x02,0xCD,0x04,0x38,0x64,0x8E,0x0A,0xD5,0x10,
+0xB4,0x5F,0x5A,0x20,0x04,0x0E,0x02,0x84,0x00,0x0C,0x9B,0x4E,0x8A,0x88,0xFF,0x64,
+0x40,0x4F,0x20,0x01,0x40,0x42,0x90,0x97,0x9B,0x0C,0x38,0x44,0x8E,0x0A,0x38,0x44,
+0x8E,0x02,0x85,0x03,0x80,0x4A,0x42,0x24,0x10,0x73,0x80,0x82,0x8C,0x82,0x85,0x04,
+0x40,0x42,0x20,0x96,0xE1,0x44,0x44,0x51,0x8D,0xD8,0xE9,0x04,0x38,0x42,0x8E,0x0A,
+0xD5,0x04,0x8D,0x41,0x38,0xA2,0x8E,0x0A,0x38,0x54,0x8E,0x02,0x44,0x41,0x8D,0xD8,
+0xE0,0xA6,0xE8,0x04,0x38,0x62,0x0E,0x0A,0xD5,0x05,0xE0,0x25,0xE8,0x03,0x38,0x12,
+0x0E,0x0A,0x44,0x11,0x8B,0xD0,0x38,0x44,0x8E,0x02,0x38,0x10,0x8E,0x02,0xE0,0x24,
+0xE8,0x05,0x44,0x41,0x8D,0xD8,0x38,0x12,0x0E,0x0A,0x84,0xA0,0x38,0x94,0x8E,0x02,
+0x80,0xC5,0x80,0x85,0x85,0x4D,0x4C,0x54,0x80,0x13,0x80,0x23,0x42,0x10,0x28,0x73,
+0x38,0x83,0x86,0x11,0x94,0x4A,0x88,0x27,0x88,0x88,0x22,0x10,0x80,0x01,0x88,0xC1,
+0xC0,0x03,0x8E,0x01,0xD5,0x02,0x80,0x1C,0x8C,0xA1,0xD5,0xEE,0x84,0x22,0x40,0x02,
+0x84,0x16,0x88,0x80,0x88,0x06,0x40,0x42,0x14,0x96,0x40,0x50,0x14,0xB6,0x97,0x23,
+0x97,0x6B,0xD5,0x03,0x84,0xA0,0x80,0x85,0xF0,0x01,0xAD,0x00,0xAD,0x41,0xFC,0xC1,
+0xFC,0x41,0x44,0x70,0x00,0x5C,0x42,0x01,0x9C,0x73,0x23,0xC0,0x80,0x00,0x22,0x80,
+0x80,0x01,0x44,0x41,0x8B,0x9C,0x44,0x11,0x8B,0x68,0xB4,0xE0,0x38,0x62,0x0E,0x02,
+0x38,0x50,0x8E,0x02,0x45,0xE1,0x8B,0x34,0x44,0xF1,0x8B,0x14,0x5A,0x70,0x01,0x06,
+0x2E,0x77,0xF2,0x9C,0x5A,0x78,0x01,0x10,0x44,0x51,0x8B,0x24,0x84,0x00,0x39,0xC2,
+0x0E,0x0A,0x38,0x80,0x8E,0x0A,0x38,0x0F,0x0E,0x0A,0x38,0x02,0x8C,0x08,0x38,0x07,
+0x8C,0x08,0xD5,0x6F,0x40,0xA3,0x00,0x11,0x97,0x6B,0x40,0x7E,0x28,0x01,0xF5,0x81,
+0x40,0x64,0x14,0x01,0x81,0x27,0x4E,0x74,0x00,0x04,0x52,0x93,0x80,0x00,0x80,0xA6,
+0x4E,0x64,0x00,0x03,0xFF,0x72,0x88,0xA9,0x38,0x5F,0x0E,0x0A,0x39,0xE7,0x8C,0x10,
+0x5E,0xFF,0x00,0x14,0xE8,0x07,0x44,0xF1,0x8B,0x14,0x51,0xEF,0x00,0x01,0x39,0xE7,
+0x8C,0x08,0x02,0x00,0x00,0x0A,0xE6,0x0E,0xE9,0x06,0x44,0x01,0x8B,0x24,0x85,0xEA,
+0x38,0xF0,0x0C,0x08,0x3D,0xED,0xFE,0x0F,0x02,0x0F,0x00,0x0E,0xE0,0xA0,0xE8,0x3D,
+0x00,0xFF,0x00,0x1E,0x81,0x20,0x50,0x87,0xFF,0xFF,0x42,0x00,0x3C,0x24,0x44,0xF1,
+0x8B,0x24,0x42,0x94,0x14,0x73,0x39,0xC7,0x8C,0x10,0x81,0x09,0x4F,0xC2,0x00,0x10,
+0x44,0x51,0x8B,0x14,0x38,0x52,0x8C,0x10,0x5A,0x50,0x14,0x04,0x84,0xAA,0xD5,0x02,
+0x84,0xA1,0xFE,0x2C,0x50,0x5E,0x7F,0xFF,0x38,0x57,0x8C,0x08,0x42,0x54,0x1C,0x24,
+0x40,0xF0,0x04,0x0A,0x4E,0x75,0x00,0x04,0x88,0xAF,0xD5,0x02,0x8A,0xAF,0x40,0x52,
+0x80,0xB6,0x89,0x45,0x38,0xA2,0x0E,0x0A,0x42,0x54,0x18,0x24,0x4E,0x65,0x00,0x05,
+0x40,0x82,0xBC,0x00,0xD5,0x03,0x40,0x82,0xBC,0x01,0xF5,0x01,0x40,0x04,0x00,0x16,
+0x88,0xA0,0x38,0x50,0x8E,0x0A,0xD5,0x05,0x39,0xC2,0x0E,0x0A,0x38,0x80,0x8E,0x0A,
+0x38,0x02,0x0E,0x02,0xAC,0x10,0x38,0x00,0x8E,0x02,0xAC,0x11,0xFC,0xC1,0xFC,0x41,
+0x3C,0xAD,0xFE,0x0F,0x22,0x60,0x80,0x00,0x22,0x40,0x80,0x01,0x84,0x20,0x3E,0x17,
+0xF2,0x9C,0x00,0x15,0x00,0x10,0xC9,0x02,0x84,0x21,0x44,0x50,0x00,0x5C,0x42,0x01,
+0x94,0x73,0xB4,0xA0,0x44,0x81,0x8A,0xA0,0x45,0xC1,0x8A,0x84,0x44,0x71,0x8B,0x04,
+0x5A,0x58,0x01,0x4B,0x44,0x11,0x8A,0xE8,0x44,0xA1,0x8A,0x50,0x38,0x60,0x8D,0x09,
+0x44,0xF0,0x27,0x10,0x44,0x11,0x8A,0xCC,0x38,0xF5,0x0E,0x0A,0x44,0xA1,0x8A,0x40,
+0x38,0x40,0x8D,0x09,0x84,0x20,0x38,0x15,0x0C,0x08,0x02,0xA0,0x00,0x0A,0x44,0x01,
+0x8A,0x30,0x44,0x91,0x8A,0xBC,0x38,0xA0,0x0C,0x08,0x44,0x01,0x8A,0x20,0x85,0x45,
+0x38,0x10,0x0C,0x08,0x44,0x01,0x89,0xDC,0x42,0x01,0xA8,0x73,0xAE,0x40,0x44,0x01,
+0x89,0xCC,0x5E,0xF2,0x08,0x3D,0x38,0x14,0x8C,0x08,0x38,0x64,0x0D,0x09,0x38,0x4E,
+0x0D,0x09,0x38,0x53,0x8C,0x08,0x38,0x10,0x0C,0x08,0x4E,0xF3,0x01,0x39,0x5E,0xF2,
+0x08,0x80,0x38,0x54,0x8C,0x08,0x44,0x01,0x89,0xB0,0xE8,0x04,0x38,0x40,0x0D,0x09,
+0xD5,0x05,0x44,0x10,0x08,0x7F,0x38,0x10,0x0D,0x09,0x44,0x01,0x89,0x94,0x38,0x60,
+0x0D,0x09,0x48,0x00,0x01,0x25,0x44,0x51,0x89,0xB0,0x38,0xF2,0x8D,0x11,0x5E,0xF7,
+0x88,0x3D,0xE9,0x13,0x44,0x51,0x89,0x94,0x38,0x52,0x8D,0x11,0x8A,0xA6,0x8C,0xBD,
+0x5C,0xF2,0x80,0x3B,0xE8,0x0A,0x38,0x53,0x8C,0x00,0x50,0xF0,0xFF,0xFF,0xE0,0xAF,
+0xE9,0x04,0x9F,0x4A,0x38,0x53,0x8C,0x08,0x38,0x5E,0x0D,0x11,0x38,0x74,0x0D,0x11,
+0x8A,0xA4,0x8A,0xE6,0xFF,0x6C,0x42,0x53,0x9C,0x73,0x44,0x71,0x8A,0x30,0x02,0x90,
+0x00,0x0A,0x38,0xF3,0x8C,0x00,0x40,0xF7,0xA4,0x06,0xE8,0x03,0x38,0x93,0x8C,0x08,
+0x44,0x91,0x8A,0x20,0x14,0x9F,0x80,0x01,0x38,0x74,0x8C,0x00,0xE6,0xF4,0xE8,0x04,
+0x8C,0xE1,0x38,0x74,0x8C,0x08,0x44,0x71,0x8A,0x50,0x44,0x91,0x89,0xDC,0x38,0x73,
+0x8E,0x02,0xE2,0xA7,0x44,0x71,0x8B,0x04,0x38,0x53,0x8C,0x00,0xE8,0x09,0x85,0xE5,
+0x42,0x51,0xBC,0x73,0x88,0xA9,0x85,0x20,0x10,0x92,0x80,0x00,0xD5,0x07,0x85,0xE5,
+0x42,0x51,0xBC,0x73,0x85,0xE1,0x38,0xF4,0x94,0x08,0x44,0x91,0x8B,0x04,0x50,0xF0,
+0xFF,0xFF,0x38,0x54,0x8C,0x00,0x45,0xE1,0x89,0xCC,0x4C,0x57,0xC0,0x09,0x84,0xA0,
+0x38,0x54,0x8C,0x08,0x84,0xA1,0x38,0x5F,0x0C,0x08,0xD5,0x04,0x8C,0xA1,0x38,0x54,
+0x8C,0x08,0x38,0x5F,0x0C,0x00,0x44,0x91,0x89,0xDC,0xC5,0x07,0x84,0xE5,0x42,0x91,
+0x9C,0x73,0x84,0xE0,0x83,0xC7,0xD5,0x16,0x38,0x03,0x8C,0x00,0x84,0xE5,0x42,0x91,
+0x9C,0x73,0x80,0xE5,0xE2,0xE0,0x4E,0xF2,0x00,0xC3,0x38,0xF4,0x9C,0x00,0xE9,0x02,
+0x8C,0xA1,0x8C,0xE1,0xD5,0xF8,0x38,0xF4,0xF8,0x00,0xE9,0x02,0x8C,0xE1,0x51,0xEF,
+0x00,0x01,0x40,0xFF,0x04,0x06,0xE9,0xF8,0x5A,0x58,0x01,0x3B,0xE0,0xE1,0x45,0xE1,
+0x8A,0x50,0x44,0x91,0x8A,0x40,0xE8,0x08,0x02,0x05,0x00,0x0A,0x38,0x54,0x8C,0x08,
+0x38,0x0F,0x0E,0x0A,0xD5,0x2D,0x38,0x54,0x8C,0x00,0xCD,0x2A,0x02,0x50,0x00,0x0A,
+0x84,0x0D,0x85,0xEA,0xFE,0x2C,0x40,0x00,0x3C,0x16,0x44,0xF1,0x8A,0x30,0x38,0xF7,
+0x8C,0x00,0xE0,0x0F,0xE9,0x08,0xE6,0xAA,0xE9,0x06,0xF0,0x01,0x38,0x00,0x0C,0x00,
+0x5A,0x08,0x14,0x17,0x38,0x0F,0x0E,0x02,0x03,0xE5,0x00,0x09,0x44,0x51,0x8A,0x50,
+0x40,0xFF,0x00,0x06,0xE8,0x08,0x92,0x01,0xE2,0x1E,0x40,0x0F,0x3C,0x1B,0x38,0x02,
+0x8E,0x0A,0xD5,0x06,0x84,0x01,0x39,0xE2,0x8E,0x0A,0x38,0x04,0x8C,0x08,0x44,0x91,
+0x8A,0xE8,0x9A,0x0F,0x38,0xF4,0x8D,0x11,0x42,0x50,0x18,0x24,0x42,0x53,0xBC,0x73,
+0x40,0x52,0x84,0xB6,0x38,0x54,0x8D,0x09,0x44,0x51,0x8A,0xCC,0xFE,0x24,0x38,0x92,
+0x8D,0x11,0x42,0x03,0xA4,0x73,0x40,0x10,0x04,0x36,0x38,0x12,0x8D,0x09,0x44,0x01,
+0x8A,0xBC,0x44,0x71,0x8A,0xE8,0x38,0x00,0x0C,0x00,0x44,0x91,0x8A,0xCC,0x5A,0x08,
+0x02,0x06,0x38,0x44,0x8D,0x09,0x38,0x63,0x8D,0x09,0x44,0x11,0x8A,0x50,0x02,0xF5,
+0x00,0x09,0x38,0x50,0x8E,0x02,0xE2,0xAF,0xE9,0x32,0x5A,0x08,0x01,0x31,0x44,0x51,
+0x89,0xB0,0x38,0x52,0x8D,0x11,0x40,0xF2,0x90,0x01,0x5E,0xF7,0x80,0x1F,0xE9,0x27,
+0x50,0xF2,0xFF,0xF6,0x38,0xF4,0x8D,0x09,0x44,0x91,0x89,0x94,0x8A,0x85,0x38,0x94,
+0x8D,0x11,0x84,0xA2,0x40,0xF4,0x98,0x01,0x84,0xCA,0x42,0x67,0x98,0x24,0x40,0x43,
+0x10,0x96,0x88,0x89,0x38,0x43,0x8D,0x09,0x44,0x41,0x8A,0xBC,0x3E,0x07,0xF2,0x9C,
+0x38,0x52,0x0C,0x08,0xF5,0x01,0xFA,0x84,0x38,0x42,0x8C,0x08,0x02,0x45,0x00,0x0A,
+0x38,0x40,0x8E,0x0A,0x44,0x11,0x8A,0x40,0x38,0x00,0x8C,0x08,0x44,0x01,0x8A,0x40,
+0x44,0x11,0x8A,0xE8,0x38,0x40,0x0C,0x00,0x44,0x01,0x8A,0xCC,0xC4,0x09,0x38,0x40,
+0x8D,0x01,0x38,0x44,0x0D,0x09,0x38,0x40,0x0D,0x01,0x38,0x4E,0x0D,0x09,0x38,0x10,
+0x8D,0x01,0x38,0x00,0x0D,0x01,0xAC,0x50,0xAC,0x11,0xFC,0xC1,0x44,0x91,0x8A,0xE8,
+0x9B,0xC8,0x88,0xE5,0x38,0xF4,0x8D,0x11,0x9B,0x45,0x42,0x02,0x98,0x24,0x42,0x03,
+0xBC,0x73,0x40,0x00,0x04,0x16,0x38,0x04,0x8D,0x09,0x44,0x01,0x8A,0xCC,0xFF,0x64,
+0x38,0x90,0x0D,0x11,0x42,0x53,0xA4,0x73,0x40,0x12,0x84,0x36,0x38,0x10,0x0D,0x09,
+0x48,0xFF,0xFF,0x87,0xFC,0x41,0x22,0x60,0x80,0x00,0x22,0x70,0x80,0x01,0x44,0x10,
+0x00,0x5C,0x42,0x01,0x84,0x73,0xB4,0x20,0xB6,0x5F,0x44,0x81,0x89,0x60,0x41,0xE1,
+0x88,0x08,0x5A,0x10,0x01,0x06,0x2E,0x17,0xF2,0x9C,0x5A,0x18,0x01,0x07,0x38,0x64,
+0x0E,0x09,0x89,0x1E,0x48,0x00,0x00,0x82,0x00,0x00,0x00,0x18,0x96,0x0E,0xC0,0x79,
+0x3C,0x0D,0xFE,0x0E,0x80,0x26,0x02,0x40,0x00,0x09,0xE0,0xC4,0xE9,0x08,0x38,0xA4,
+0x0E,0x11,0xE1,0x44,0xE8,0x0F,0x50,0xA2,0x7F,0xFF,0xD5,0x0C,0x4E,0x64,0x00,0x08,
+0x38,0xA4,0x0E,0x11,0x4E,0xA5,0x00,0x07,0x85,0x40,0xD5,0x04,0x81,0x46,0x85,0x20,
+0xD5,0x02,0x85,0x21,0x02,0x50,0x00,0x0A,0x80,0x07,0xE0,0xE5,0xE9,0x0A,0x40,0x94,
+0x78,0x00,0x22,0x94,0x80,0x01,0xE1,0x25,0xE8,0x10,0x50,0x92,0xFF,0xFF,0xD5,0x0D,
+0x4E,0x74,0x00,0x09,0x40,0x94,0x78,0x00,0x22,0x94,0x80,0x01,0x4E,0x94,0x00,0x54,
+0xD5,0x04,0x5A,0x98,0x01,0x47,0x81,0x27,0x38,0x24,0x0E,0x11,0x41,0xE4,0x78,0x00,
+0xF2,0x81,0x41,0xC3,0x08,0x01,0x22,0x2F,0x00,0x01,0x40,0xF3,0x88,0x01,0x4F,0xC2,
+0x00,0x0D,0xF0,0x01,0x41,0xE5,0x00,0x01,0x84,0x02,0x40,0x0E,0x00,0x16,0x42,0x0F,
+0x3C,0x73,0x40,0x00,0x70,0x16,0x88,0x02,0xE8,0x0D,0x84,0x22,0x41,0xE4,0x88,0x01,
+0x40,0x17,0x84,0x36,0x42,0x1F,0x70,0x73,0xF2,0x01,0x40,0x10,0xBC,0x36,0x88,0x41,
+0x80,0x22,0xE0,0x24,0xE9,0x05,0x52,0x42,0x00,0x01,0x88,0x81,0xD5,0x05,0x84,0x80,
+0x4E,0x14,0x00,0x03,0xFF,0x0A,0xE0,0x05,0xE9,0x05,0x52,0x52,0x80,0x01,0x88,0xA0,
+0xD5,0x05,0x84,0xA0,0x4E,0x04,0x00,0x03,0xFF,0x42,0xE0,0xA4,0xE8,0x05,0x40,0x65,
+0x00,0x11,0x97,0xC3,0xD5,0x06,0xE0,0x85,0xE8,0x04,0x97,0x8B,0x40,0x74,0x80,0x11,
+0x38,0x64,0x0E,0x09,0x94,0xDA,0x89,0x03,0xB4,0x1F,0x12,0x74,0x00,0x01,0xAD,0x80,
+0xAD,0xC1,0xFC,0xC1,0x85,0x20,0xD5,0xB1,0xFC,0x42,0x3C,0xAD,0xFE,0x0F,0x80,0xC0,
+0x3C,0x0D,0xFA,0x5F,0x02,0x15,0x00,0x05,0xE2,0x01,0xE8,0x04,0x8C,0x01,0x3C,0x0F,
+0xFA,0x5F,0x50,0x93,0x00,0x08,0x84,0xE0,0x3C,0x8D,0xFE,0x0E,0x00,0x34,0x00,0x09,
+0xE2,0xE3,0xE8,0x68,0x04,0x04,0xFF,0xFE,0xC0,0x61,0x5A,0x00,0x05,0x60,0x02,0x04,
+0x80,0x02,0xB0,0x43,0x12,0x0F,0x80,0x06,0x02,0x04,0x80,0x03,0x80,0x41,0x12,0x0F,
+0x80,0x07,0x00,0x05,0x00,0x01,0x80,0x67,0xB6,0x1F,0x3C,0x4D,0xFA,0x5F,0x80,0x06,
+0x3C,0x5D,0xFE,0x0D,0x49,0xFF,0xFA,0xC9,0x00,0x05,0x00,0x02,0xC0,0x07,0xB0,0x43,
+0x80,0x06,0x80,0x41,0x80,0x67,0x49,0xFF,0xFD,0x6C,0x00,0x05,0x00,0x03,0xC0,0x07,
+0xB0,0x43,0x80,0x06,0x80,0x41,0x80,0x67,0x49,0xFF,0xFB,0xA5,0x00,0x05,0x00,0x04,
+0xC0,0x07,0xB0,0x43,0x80,0x06,0x80,0x41,0x80,0x67,0x49,0xFF,0xFC,0xBB,0xB0,0x43,
+0x80,0x06,0x80,0x41,0x80,0x67,0x49,0xFF,0xFF,0x0F,0x22,0x0F,0x80,0x06,0x4E,0x04,
+0x00,0x05,0x84,0x00,0x12,0x0F,0x80,0x06,0x02,0x04,0x00,0x09,0x22,0x1F,0x80,0x06,
+0xE0,0x20,0xE9,0x04,0x8E,0x01,0x12,0x0F,0x80,0x06,0x22,0x0F,0x80,0x07,0x4E,0x04,
+0x00,0x05,0x84,0x00,0x12,0x0F,0x80,0x07,0x02,0x04,0x00,0x0A,0x22,0x1F,0x80,0x07,
+0xE0,0x20,0xE9,0x04,0x8E,0x01,0x12,0x0F,0x80,0x07,0x02,0x0F,0x80,0x06,0x12,0x04,
+0x80,0x00,0x02,0x0F,0x80,0x07,0x12,0x04,0x80,0x01,0x8C,0xE1,0x50,0x94,0x80,0x5C,
+0xD5,0x94,0x44,0x40,0x00,0x5C,0x80,0xA6,0x42,0x61,0x90,0x73,0x3C,0x27,0xFC,0x1A,
+0x3C,0x17,0xFC,0x1B,0x3C,0x0D,0xFA,0x5F,0x80,0x66,0xD3,0x0C,0xB4,0x85,0x5A,0x48,
+0x05,0x07,0x22,0x22,0x80,0x04,0x22,0x12,0x80,0x05,0x84,0x00,0x50,0x52,0x80,0x5C,
+0xD5,0xF5,0x3C,0x2B,0xFC,0x1A,0x3C,0x1B,0xFC,0x1B,0x3C,0x0F,0xFA,0x5F,0xFC,0xC2,
+0x3C,0x0F,0xFE,0x10,0xDD,0x9E,0xFC,0x20,0x84,0x80,0x8E,0x41,0x84,0xC2,0xE0,0x44,
+0xE9,0x11,0x98,0xE2,0x40,0x31,0x98,0x76,0x38,0x70,0x0D,0x01,0x95,0x59,0xE0,0x27,
+0xE9,0x07,0x88,0xA0,0xA5,0x29,0xE0,0x24,0xE9,0x07,0x9D,0x19,0xD5,0xF1,0x9E,0x99,
+0xD5,0xEF,0x84,0x1F,0xD5,0x02,0x80,0x03,0xFC,0xA0,0xFC,0x42,0x3C,0x7D,0xFE,0x10,
+0xF1,0x82,0x50,0x13,0x80,0x0A,0xF1,0x81,0x50,0x83,0x80,0xB4,0x51,0xC0,0x00,0x02,
+0x85,0x40,0x85,0x3E,0xF0,0x02,0xE3,0x40,0x4E,0xF2,0x00,0xDB,0x22,0x6E,0x7F,0xFF,
+0xA4,0x3D,0xE0,0x06,0xE8,0x5C,0xA5,0x3C,0x9C,0x23,0x94,0x01,0x88,0x07,0x9E,0xA1,
+0xA4,0x01,0xE0,0xC0,0xE9,0x04,0xA5,0xB8,0x8E,0xC1,0xD5,0x52,0xF0,0x01,0x80,0x26,
+0xF4,0x83,0x49,0xFF,0xFF,0xC2,0x5A,0x07,0xFF,0x4C,0xA5,0x7B,0xA4,0xB9,0xE2,0x05,
+0x94,0x41,0xF4,0x03,0xE8,0x10,0x88,0x27,0xFE,0x14,0xA4,0xCD,0xA4,0x4E,0x8A,0xC3,
+0xFF,0x94,0x40,0x43,0x14,0x96,0x9B,0x8B,0x40,0x62,0x18,0xD6,0x40,0x50,0x14,0xB7,
+0x88,0xC5,0xD5,0x36,0x8A,0x85,0x8E,0x81,0xE2,0x04,0xE9,0x18,0x88,0x27,0xA4,0xFA,
+0xA5,0x0D,0x88,0x65,0x52,0xF1,0x80,0x01,0x88,0x0F,0x8A,0xC4,0xFF,0x94,0xFE,0x14,
+0x40,0x00,0x14,0x17,0xA4,0xF8,0x40,0x53,0x14,0xB6,0xA5,0x8E,0x8A,0x62,0x8A,0xC4,
+0x88,0x03,0x40,0x62,0x98,0xD6,0x88,0xC0,0xD5,0x1B,0x88,0x27,0xA4,0xF8,0x42,0x31,
+0x24,0x73,0x81,0xE3,0xA4,0xCD,0xA5,0x3A,0x8A,0x05,0x8A,0xC3,0x8E,0x81,0x42,0x67,
+0x98,0x24,0x42,0x00,0x3C,0x24,0x40,0x00,0x10,0x17,0x40,0x43,0x10,0x96,0xA5,0x8E,
+0x88,0x40,0x8A,0xC3,0x40,0x62,0x18,0xD6,0x88,0xC2,0xD5,0x02,0x84,0xC0,0x12,0x6E,
+0x7F,0xFF,0x02,0x03,0x80,0x5A,0x22,0x6E,0x00,0x00,0xE0,0x06,0xE8,0x6B,0x02,0x43,
+0x80,0x59,0x50,0x02,0x00,0x57,0x94,0x01,0x88,0x07,0x9E,0xA1,0xA4,0x02,0xE0,0xC0,
+0xE9,0x05,0x02,0x63,0x80,0x55,0x8E,0xC1,0xD5,0x5E,0x80,0x08,0x80,0x26,0xF4,0x83,
+0x49,0xFF,0xFF,0x5B,0x5A,0x07,0xFF,0x58,0x02,0x53,0x80,0x58,0x02,0x23,0x80,0x56,
+0xE2,0x05,0x94,0x41,0xF4,0x03,0xE8,0x12,0x88,0x27,0xFE,0x14,0x02,0x30,0x80,0x5A,
+0x02,0x10,0x80,0x5B,0x8A,0xC3,0xFF,0x94,0x40,0x43,0x14,0x96,0x9B,0x8B,0x40,0x62,
+0x18,0xD6,0x40,0x50,0x14,0xB7,0x88,0xC5,0xD5,0x3E,0x8A,0x85,0x8E,0x81,0xE2,0x04,
+0xE9,0x1C,0x88,0x27,0x02,0x33,0x80,0x57,0x02,0x40,0x80,0x5A,0x88,0x65,0x52,0xF1,
+0x80,0x01,0x88,0x0F,0x8A,0xC4,0xFF,0x94,0xFE,0x14,0x40,0x00,0x14,0x17,0x02,0x33,
+0x80,0x55,0x40,0x53,0x14,0xB6,0x02,0x60,0x80,0x5B,0x8A,0x62,0x8A,0xC4,0x88,0x03,
+0x40,0x62,0x98,0xD6,0x88,0xC0,0xD5,0x1F,0x88,0x27,0x02,0x33,0x80,0x55,0x42,0x31,
+0x24,0x73,0x81,0xE3,0x02,0x30,0x80,0x5A,0x02,0x43,0x80,0x57,0x8A,0x05,0x8A,0xC3,
+0x8E,0x81,0x42,0x67,0x98,0x24,0x42,0x00,0x3C,0x24,0x40,0x00,0x10,0x17,0x40,0x43,
+0x10,0x96,0x02,0x60,0x80,0x5B,0x88,0x40,0x8A,0xC3,0x40,0x62,0x18,0xD6,0x88,0xC2,
+0xD5,0x02,0x84,0xC0,0x1A,0x6E,0x00,0x0C,0x8D,0x41,0x48,0xFF,0xFF,0x25,0xFC,0xC2,
+0x3C,0x0F,0xFE,0x11,0xDD,0x9E,0xFC,0x46,0x3C,0x2D,0xFE,0x11,0xB6,0x5F,0xA6,0x92,
+0xF2,0x81,0xB4,0x5F,0xA6,0x93,0xF2,0x84,0x84,0x40,0x80,0x62,0xB4,0x9F,0x00,0x42,
+0x00,0x38,0xE0,0x44,0xE8,0x0D,0xA1,0x06,0x38,0x32,0x0A,0x0A,0xA1,0x07,0x38,0x32,
+0x0A,0x0A,0x04,0x40,0x00,0x08,0x38,0x32,0x0A,0x0A,0x8C,0x41,0xD5,0xF0,0xF2,0x01,
+0xF3,0x01,0x94,0x91,0xF2,0x85,0x84,0x5E,0xFE,0x9C,0x8A,0x41,0xF2,0x86,0xF1,0x83,
+0x84,0x80,0xF2,0x04,0xE2,0x82,0x4E,0xF2,0x00,0xA4,0x9E,0xA1,0xF2,0x8A,0x9C,0xA2,
+0x05,0xEF,0x80,0x03,0x84,0xA0,0xF2,0x8B,0xF2,0x01,0xE2,0xA2,0x4E,0xF2,0x00,0x92,
+0xB4,0x40,0x40,0x3F,0x04,0x01,0x88,0x62,0xA6,0x99,0x96,0x96,0x96,0x90,0x4E,0x23,
+0x00,0x84,0xA7,0x98,0xA0,0xC1,0x38,0x31,0x99,0x01,0xB4,0xDF,0x00,0x63,0x00,0x38,
+0xE2,0x66,0xE8,0x7A,0xA1,0x86,0x94,0xDA,0x88,0xC3,0x22,0x7F,0x00,0x00,0xB5,0x26,
+0x42,0x92,0x9C,0x73,0xB7,0x26,0xA1,0x87,0x04,0xAF,0x80,0x06,0x88,0xC3,0x81,0x3E,
+0xF2,0x82,0x38,0x84,0xA8,0x15,0xB5,0x46,0x42,0xA2,0x20,0x73,0xB7,0x46,0x04,0x60,
+0x00,0x08,0x50,0x24,0xFF,0xFE,0x88,0xC3,0xF2,0x88,0xB5,0x46,0x88,0xEA,0xB6,0xE6,
+0x9F,0xE9,0xF7,0x87,0x9D,0xEA,0xF6,0x0A,0xF7,0x89,0xF2,0x0B,0x4C,0x61,0x00,0x55,
+0x5A,0x67,0xFF,0x4D,0xF2,0x04,0xE2,0xC2,0xE8,0x49,0xF2,0x08,0x04,0x9F,0x80,0x02,
+0xF7,0x07,0x89,0x22,0x89,0x21,0xF2,0x09,0x4C,0x71,0x00,0x41,0x5A,0x77,0xFF,0x3C,
+0xF2,0x01,0xE2,0xE2,0xE8,0x38,0x4C,0x72,0xC0,0x04,0x4C,0x62,0x00,0x35,0xB5,0x00,
+0x40,0xA4,0x84,0x01,0x89,0x48,0x00,0x85,0x00,0x01,0x54,0xF4,0x00,0x04,0xE8,0x2B,
+0x22,0xF4,0x80,0x00,0x4E,0xF7,0x00,0x28,0x40,0x84,0x00,0x10,0x4E,0x85,0x00,0x24,
+0x04,0x80,0x00,0x06,0x41,0xC4,0x0C,0x00,0xB5,0x1C,0x42,0x83,0xBC,0x73,0xB7,0x1C,
+0x04,0x80,0x00,0x07,0x23,0xC4,0x80,0x00,0x89,0x03,0xB4,0x48,0x42,0x23,0x70,0x73,
+0xB6,0x48,0x04,0x80,0x00,0x08,0x44,0x2F,0xFF,0x80,0x89,0x03,0x05,0xC4,0x00,0x00,
+0x40,0xFE,0x3C,0x00,0x14,0xF4,0x00,0x00,0x00,0x85,0x00,0x01,0x40,0x84,0x08,0x04,
+0x10,0x85,0x00,0x01,0x8C,0xE1,0x8D,0x22,0xD5,0xBF,0xF7,0x02,0xF2,0x05,0x8C,0xC1,
+0x88,0xE2,0xF7,0x82,0xD5,0xAB,0x8C,0xA1,0x51,0xEF,0x00,0x02,0x48,0xFF,0xFF,0x6E,
+0xF2,0x03,0xF3,0x05,0x8C,0x81,0x88,0x43,0xF2,0x83,0x48,0xFF,0xFF,0x5C,0xFC,0xC6,
+0xFC,0x40,0x3C,0x7D,0xFE,0x11,0x80,0xC1,0x9B,0x31,0xE2,0x82,0xE8,0x1F,0xA1,0x07,
+0x04,0x90,0x00,0x08,0x04,0x80,0x00,0x06,0x08,0x53,0x00,0x01,0x00,0xA3,0x80,0x32,
+0x38,0x94,0x96,0x02,0x38,0x42,0x16,0x02,0x38,0x54,0x16,0x02,0x8C,0x78,0x42,0x55,
+0x14,0x24,0x40,0x52,0xA4,0xB7,0x12,0x51,0xFF,0xF4,0x00,0x53,0x80,0x33,0xFF,0x2C,
+0x40,0x42,0x24,0x97,0x12,0x41,0xFF,0xF5,0xD5,0xE0,0xFC,0xC0,0xFC,0x40,0x80,0xC4,
+0x81,0x20,0x81,0x42,0x80,0xE3,0x49,0xFF,0xFF,0x08,0x84,0x00,0xAE,0x30,0x84,0x20,
+0x3C,0x0D,0xFE,0x11,0x44,0x21,0x8F,0x08,0xE2,0x2A,0xE8,0x11,0x04,0x34,0x80,0x01,
+0x38,0x51,0x85,0x01,0xD9,0x18,0xA6,0xF0,0x38,0x11,0x0C,0x08,0xA7,0x30,0x8C,0x81,
+0x97,0x20,0xAF,0x30,0x00,0x30,0x00,0x19,0xE2,0x83,0xE9,0x0D,0x80,0x09,0xA6,0xB0,
+0x80,0x67,0x44,0x11,0x8F,0x08,0x49,0xFF,0xFF,0xB5,0x84,0x00,0xFA,0x48,0x44,0x31,
+0x8F,0x08,0xD5,0x03,0x8C,0x21,0xD5,0xE1,0xA6,0x70,0xE2,0x01,0xE8,0x09,0x80,0x27,
+0x42,0x10,0x08,0x73,0x38,0x41,0x80,0x00,0x8C,0x01,0xA9,0x0D,0xD5,0xF6,0xFC,0xC0,
+0xFC,0x00,0xC8,0x1A,0xCA,0x0E,0xCB,0x08,0x5A,0x10,0x04,0x1B,0x2E,0x00,0x21,0xDC,
+0x5A,0x08,0x01,0x2D,0xD5,0x27,0x5A,0x38,0x01,0x43,0x5A,0x18,0x04,0x30,0xD5,0x10,
+0x5A,0x28,0x01,0x41,0xCB,0x04,0x5A,0x18,0x04,0x17,0xD5,0x0A,0x5A,0x38,0x01,0x38,
+0x5A,0x18,0x04,0x25,0xD5,0x0A,0x5A,0x08,0x01,0x36,0xC9,0x0A,0xCB,0x04,0x3C,0x0C,
+0x02,0xA4,0xD5,0x2C,0x5A,0x38,0x01,0x2C,0x3C,0x0C,0x02,0xA7,0xD5,0x27,0x5A,0x18,
+0x01,0x27,0xCB,0x12,0x3C,0x0C,0x02,0xA2,0xB6,0x05,0x2E,0x00,0x21,0xDC,0x5A,0x08,
+0x01,0x1F,0x2E,0x07,0xEA,0xDF,0xE6,0x02,0xE8,0x04,0x3C,0x0C,0x02,0xA2,0xD5,0x16,
+0x3C,0x0C,0x02,0xA3,0xD5,0x13,0x5A,0x38,0x01,0x13,0x3C,0x0C,0x02,0xA5,0xB6,0x05,
+0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x0C,0x2E,0x07,0xEA,0xDF,0xE6,0x02,0xE8,0x04,
+0x3C,0x0C,0x02,0xA5,0xD5,0x03,0x3C,0x0C,0x02,0xA6,0xB6,0x05,0xB4,0x05,0x3C,0x0F,
+0xFA,0xD5,0xA4,0x68,0x44,0x01,0x48,0x00,0x97,0x20,0xAC,0x40,0x44,0x01,0xF4,0x48,
+0x44,0x10,0x48,0x00,0xAC,0x40,0x44,0x01,0xF4,0x47,0xAF,0x00,0xFC,0x80,0x84,0x00,
+0x3C,0x0F,0xFB,0x35,0x44,0x01,0xF4,0x4C,0x84,0x21,0xAE,0x40,0xDD,0x9E,0x44,0x01,
+0xF4,0x4C,0xA6,0x00,0x5C,0x00,0x00,0x01,0xDD,0x9E,0x44,0x11,0xF4,0x4C,0x84,0x00,
+0x3C,0x0F,0xFB,0x35,0xAE,0x08,0xDD,0x9E,0xFC,0x00,0x84,0xC0,0x3C,0x6F,0xFB,0x35,
+0x5A,0x08,0x01,0x09,0x49,0xFF,0xFF,0xE5,0x3C,0x6F,0xFB,0x35,0x3C,0x6B,0xF5,0x83,
+0xD5,0x03,0x49,0xFF,0xFF,0xEC,0xFC,0x80,0x44,0x11,0xF2,0xFB,0x84,0x00,0xAE,0x08,
+0x44,0x11,0xF2,0xFC,0xAE,0x08,0xDD,0x9E,0xFC,0x00,0x44,0x01,0xF2,0xD3,0x84,0xC1,
+0xAF,0x80,0x44,0x01,0xF2,0xD5,0x84,0x61,0xAF,0x80,0x44,0x01,0xF2,0xD6,0xAF,0x80,
+0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x1D,0xEA,0x44,0x01,0xF2,0xFE,0x84,0x62,
+0xAF,0x80,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x1D,0xE1,0xFC,0x80,0xB4,0x21,
+0xC8,0x0C,0x02,0x20,0x80,0x12,0x44,0x0F,0xDF,0xFF,0xFE,0x86,0x12,0x20,0x80,0x12,
+0x02,0x20,0x80,0x11,0xFE,0x16,0xD5,0x0B,0x02,0x00,0x80,0x12,0x58,0x00,0x20,0x00,
+0x12,0x00,0x80,0x12,0x02,0x00,0x80,0x11,0x58,0x00,0x20,0x00,0x12,0x00,0x80,0x11,
+0xDD,0x9E,0xFC,0x00,0x49,0xFF,0xFF,0xE5,0xFC,0x80,0xFC,0x00,0x44,0x01,0xF5,0xEA,
+0x84,0x24,0xAE,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0x00,0x1D,0xB7,
+0xFC,0x80,0xFC,0x00,0x44,0x11,0xF6,0xD6,0x84,0x01,0xAE,0x08,0x44,0x11,0xF6,0xDF,
+0x84,0x61,0xAE,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x1D,0xA8,0xFC,0x80,
+0xFC,0x01,0x44,0x11,0xF0,0x66,0x44,0x61,0xF0,0x67,0xA6,0x08,0x96,0x00,0x10,0x0F,
+0x80,0x07,0x00,0x0F,0x80,0x07,0x54,0x00,0x00,0xFC,0x10,0x0F,0x80,0x07,0x00,0x0F,
+0x80,0x07,0x58,0x00,0x00,0x01,0x10,0x0F,0x80,0x07,0xAE,0x08,0x84,0x00,0x10,0x0F,
+0x80,0x07,0x00,0x0F,0x80,0x07,0x5A,0x00,0x01,0x0E,0xA6,0x30,0x96,0x00,0x10,0x0F,
+0x80,0x07,0x00,0x0F,0x80,0x07,0x96,0x0F,0x10,0x0F,0x80,0x07,0x49,0x00,0x1D,0x39,
+0xD5,0xF1,0xFC,0x81,0x94,0x03,0x84,0x20,0x44,0x21,0xA6,0x5C,0x38,0x01,0x05,0x09,
+0x8C,0x21,0x5A,0x18,0x08,0xFD,0x3C,0x2D,0xFA,0xD5,0x44,0x01,0x00,0x00,0x44,0x41,
+0xA6,0x5C,0xA0,0x55,0x80,0x60,0xFE,0x47,0xA8,0x55,0x44,0x50,0x00,0x5C,0x84,0x20,
+0x97,0x21,0xA0,0x15,0x92,0x0A,0x96,0x2F,0xE2,0x20,0xE8,0x09,0x02,0x01,0x00,0x0C,
+0x88,0x03,0x42,0x00,0x94,0x73,0x8C,0x21,0xAD,0x04,0xD5,0xF4,0xDD,0x9E,0xFC,0x01,
+0x44,0x11,0xF0,0x66,0x44,0x61,0xF0,0x67,0xA6,0x08,0x96,0x00,0x10,0x0F,0x80,0x07,
+0x00,0x0F,0x80,0x07,0x54,0x00,0x00,0xFC,0x10,0x0F,0x80,0x07,0x00,0x0F,0x80,0x07,
+0x96,0x00,0xAE,0x08,0x84,0x1F,0x10,0x0F,0x80,0x07,0x00,0x0F,0x80,0x07,0xC0,0x0D,
+0xA6,0x30,0x96,0x00,0x10,0x0F,0x80,0x07,0x00,0x0F,0x80,0x07,0x96,0x0F,0x10,0x0F,
+0x80,0x07,0x49,0x00,0x1C,0xEE,0xD5,0xF2,0xFC,0x81,0xC0,0x05,0x3C,0x1D,0xFA,0xD5,
+0x10,0x00,0x80,0x28,0xDD,0x9E,0xC0,0x15,0x5C,0xF0,0x04,0x00,0x3C,0x2D,0xFA,0xD5,
+0x80,0x20,0xE9,0x03,0x44,0x10,0x03,0xFF,0x54,0x10,0x83,0xFF,0x04,0x31,0x00,0x0A,
+0x40,0x00,0xA0,0x08,0x44,0x1C,0x00,0xFF,0xFE,0x5E,0xFE,0x47,0x14,0x11,0x00,0x0A,
+0xDD,0x9E,0x44,0x11,0xA1,0x48,0xB4,0x01,0x00,0x20,0x00,0x28,0x04,0x00,0x00,0x0A,
+0x3E,0x27,0xEA,0xC8,0x92,0x08,0x54,0x00,0x03,0xFF,0x3C,0x0B,0xF5,0x80,0xA0,0x0A,
+0x00,0x10,0x00,0x28,0x04,0x00,0x00,0x0A,0x3E,0x17,0xEA,0xC4,0x92,0x08,0x54,0x00,
+0x03,0xFF,0x3C,0x0B,0xF5,0x84,0xDD,0x9E,0x3C,0x10,0x05,0x44,0x44,0x01,0x48,0x00,
+0xAC,0x40,0xDD,0x9E,0x3C,0x0C,0x02,0xA2,0x46,0x10,0x02,0xAA,0x50,0x10,0x8A,0xB6,
+0x02,0x50,0x00,0x0E,0x44,0x01,0x00,0x00,0xFF,0x47,0x46,0x00,0x7F,0xFF,0x50,0x22,
+0x80,0x78,0x50,0x00,0x0F,0xFF,0xB6,0x05,0xA8,0x29,0xA8,0x6A,0x8C,0xAC,0xDA,0xFC,
+0xDD,0x9E,0xB4,0x00,0x3C,0x0F,0xFA,0xD5,0xC9,0x0D,0x50,0x30,0x00,0x28,0xB4,0x43,
+0x46,0x18,0x00,0x00,0xFE,0x57,0xB6,0x23,0xB4,0x43,0x46,0x14,0x00,0x00,0xFE,0x57,
+0xD5,0x0D,0x50,0x30,0x00,0x28,0xB4,0x23,0x94,0x49,0x92,0x21,0xB6,0x23,0xB4,0x43,
+0x46,0x1B,0xFF,0xFF,0x50,0x10,0x8F,0xFF,0xFE,0x56,0x14,0x10,0x00,0x0A,0xDD,0x9E,
+0xFC,0x20,0xA6,0x01,0x5A,0x00,0x03,0x2C,0x9E,0x46,0xE6,0x22,0xE9,0x28,0x9E,0x44,
+0xE6,0x22,0xE8,0x0C,0x84,0x00,0x3E,0x07,0xEA,0xDD,0x84,0x04,0x3E,0x07,0xEA,0xD4,
+0x2E,0x77,0xEA,0xC4,0x3C,0x63,0xF5,0x84,0xD5,0x2E,0x50,0x10,0x7F,0xF7,0xE6,0x22,
+0xE8,0x0C,0x84,0x01,0x3E,0x07,0xEA,0xDD,0x84,0x00,0x3E,0x07,0xEA,0xD4,0x2E,0x70,
+0x25,0x4E,0x3C,0x60,0x12,0xA8,0xD5,0x1F,0x5A,0x00,0x0B,0x15,0x5A,0x00,0x0E,0x13,
+0x5A,0x08,0x10,0x33,0x49,0x00,0x11,0x50,0x5A,0x08,0x02,0x0D,0x84,0x00,0x3E,0x07,
+0xEA,0xDD,0x84,0x03,0x3E,0x07,0xEA,0xD4,0x2E,0x77,0xEA,0xC8,0x3C,0x63,0xF5,0x80,
+0xD5,0x0A,0x84,0x01,0x3E,0x07,0xEA,0xDD,0x2E,0x70,0x25,0x4F,0x3E,0x07,0xEA,0xD4,
+0x3C,0x60,0x12,0xA9,0x2E,0x07,0xEA,0xDD,0x84,0x81,0x2E,0x17,0xEA,0xD4,0x44,0x51,
+0x82,0xC0,0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,0xFD,0xEB,0x2E,0x17,
+0xEA,0xDD,0x44,0x01,0x82,0xC0,0x49,0xFF,0xFF,0x8E,0x80,0x07,0x49,0xFF,0xFF,0x37,
+0x80,0x06,0x49,0xFF,0xFF,0x3A,0xFC,0xA0,0xB4,0x40,0x96,0x6F,0x3C,0x2F,0xFA,0xD5,
+0xA0,0xD5,0x40,0x00,0xA8,0x08,0x44,0x1F,0x03,0xFF,0xFE,0x5E,0xFE,0x47,0xA8,0x55,
+0xDD,0x9E,0xFC,0x00,0x84,0x00,0x3E,0x07,0xEA,0xDD,0x84,0x03,0x3E,0x07,0xEA,0xD4,
+0x2E,0x07,0xEA,0xDF,0xE6,0x02,0x3E,0x07,0xEA,0xC3,0x84,0x00,0xE8,0x02,0x84,0x03,
+0x3E,0x07,0xEA,0xDF,0x84,0x81,0x2E,0x07,0xEA,0xDD,0x44,0x51,0x82,0xC0,0x2E,0x17,
+0xEA,0xD4,0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,0xFD,0xB3,0x44,0x01,
+0x9B,0xC8,0x49,0x00,0x21,0x93,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x05,0x84,0x00,
+0x49,0x00,0x05,0x64,0x2E,0x07,0xEA,0xC3,0x84,0x81,0x3E,0x07,0xEA,0xDF,0x44,0x51,
+0x82,0xC0,0x2E,0x07,0xEA,0xDD,0x2E,0x17,0xEA,0xD4,0x2E,0x27,0xEA,0xAA,0x2E,0x37,
+0xEA,0xC2,0x49,0xFF,0xFD,0x97,0x44,0x01,0x9B,0xC8,0x49,0x00,0x21,0x77,0x2E,0x00,
+0x21,0xDC,0x5A,0x08,0x01,0x05,0x84,0x00,0x49,0x00,0x05,0x48,0x2E,0x07,0xEA,0xC3,
+0xE6,0x02,0x84,0x03,0xE8,0x02,0x84,0x00,0x3E,0x07,0xEA,0xDF,0xFC,0x80,0xFC,0x40,
+0x3C,0x0D,0xFF,0x6B,0x2E,0x60,0x21,0x42,0xE6,0x13,0x2E,0x80,0x21,0x43,0xE9,0x40,
+0x2E,0x07,0xEA,0xA7,0xC8,0x3D,0x2E,0x17,0xEA,0xB5,0xC9,0x3A,0x40,0x73,0x04,0x09,
+0x3C,0x9C,0x02,0xF2,0x44,0x21,0xA7,0xD0,0x44,0x31,0xA0,0xF8,0x80,0xA1,0x81,0x41,
+0x4C,0x54,0x00,0x2C,0x12,0xA1,0x00,0x00,0x12,0xA1,0x80,0x00,0x84,0x80,0x96,0x20,
+0xE2,0x06,0xE8,0x13,0x98,0x21,0x94,0x01,0xE0,0x87,0x88,0x09,0xE8,0x07,0x02,0xF0,
+0x00,0x00,0xA4,0x10,0x88,0x0F,0xAC,0x10,0xD5,0x06,0x02,0xF0,0x00,0x00,0xA4,0x18,
+0x88,0x0F,0xAC,0x18,0x8C,0x81,0xD5,0xEC,0x22,0x01,0x00,0x00,0x8C,0xA1,0x40,0x00,
+0x1C,0x16,0x1A,0x01,0x00,0x01,0x22,0x01,0x80,0x00,0x97,0x68,0x40,0x00,0x1C,0x16,
+0x1A,0x01,0x80,0x01,0x88,0x26,0xD5,0xD5,0x84,0x01,0x3E,0x07,0xEA,0xB5,0x2E,0x07,
+0xEA,0xD3,0x8E,0x01,0xE6,0x01,0x3E,0xF7,0xEA,0xDB,0xFC,0xC0,0xFC,0x40,0x84,0x60,
+0x2E,0x40,0x21,0x42,0x2E,0x60,0x21,0x43,0x3C,0x7C,0x02,0xF0,0x80,0xA3,0x44,0x91,
+0xA0,0xF8,0x44,0xA1,0xA7,0xD0,0xD6,0x1D,0x84,0x20,0x96,0x08,0xE2,0x04,0xE8,0x15,
+0x2E,0x00,0x21,0x42,0x92,0x01,0xE0,0x20,0xE8,0x04,0x38,0x85,0x15,0x11,0xD5,0x03,
+0x38,0x84,0x95,0x11,0x98,0x0B,0x94,0x01,0x88,0x07,0x91,0x01,0xA4,0x80,0x8C,0x21,
+0x8A,0x48,0x96,0x91,0xAC,0x80,0xD5,0xEA,0x8C,0xA1,0x97,0x68,0x88,0x64,0xD5,0xE4,
+0xFC,0xC0,0x94,0x49,0x88,0x20,0x84,0x40,0x4C,0x00,0x80,0x05,0x1A,0x20,0x00,0x01,
+0xD5,0xFC,0xDD,0x9E,0xFC,0x40,0x2E,0x20,0x21,0x43,0x2E,0x70,0x21,0x6E,0x94,0x92,
+0x54,0x21,0x01,0xFC,0x40,0x90,0x88,0x00,0x84,0xA0,0xD7,0x15,0x80,0x61,0x81,0x40,
+0x4C,0x34,0x80,0x0E,0x2E,0x40,0x22,0x32,0x0A,0x65,0x00,0x01,0xFF,0x3C,0x40,0x43,
+0x10,0x96,0xA5,0x98,0x88,0x86,0x1A,0x41,0x80,0x01,0xD5,0xF3,0x8C,0xA1,0x97,0x68,
+0x88,0x02,0xD5,0xEC,0xFC,0xC0,0xFC,0x40,0x84,0x00,0x3C,0x0B,0xFE,0x09,0x3C,0x0B,
+0xFE,0x0B,0x2E,0x40,0x21,0x6F,0x2E,0x37,0xEA,0xDF,0x2E,0x50,0x21,0x6E,0x84,0x00,
+0x44,0x61,0x07,0xC0,0x44,0x71,0x07,0xC2,0x96,0x40,0xE2,0x24,0xE8,0x18,0xC3,0x03,
+0x5A,0x38,0x03,0x04,0xE2,0x25,0xE8,0x11,0x94,0x43,0x98,0x8E,0x88,0x27,0x02,0x91,
+0x00,0x00,0x3C,0x23,0xFE,0x09,0x88,0x49,0x3C,0x2B,0xFE,0x09,0xA4,0x88,0x3C,0x13,
+0xFE,0x0B,0x88,0x22,0x3C,0x1B,0xFE,0x0B,0x8C,0x01,0xD5,0xE7,0xFC,0xC0,0xFC,0x40,
+0x84,0x80,0x2E,0x67,0xEA,0xB3,0x80,0xE4,0x85,0x3F,0x97,0x60,0xE2,0xA3,0xE8,0x12,
+0x5A,0x60,0x01,0x0B,0x38,0x51,0x11,0x01,0x38,0x50,0x11,0x09,0x38,0x51,0x11,0x01,
+0x38,0x50,0x91,0x09,0xD5,0x05,0x38,0x70,0x11,0x09,0x38,0x90,0x91,0x09,0x8C,0x81,
+0xD5,0xED,0xFC,0xC0,0xFC,0x00,0x84,0x60,0x80,0xA0,0x80,0x03,0x97,0x18,0xE2,0x82,
+0xE8,0x0B,0x38,0x42,0x8D,0x01,0x38,0x60,0x8D,0x01,0x8A,0x86,0xE0,0x04,0xE8,0x02,
+0x96,0x21,0x8C,0x61,0xD5,0xF4,0xFC,0x80,0x95,0x21,0x88,0x83,0x4C,0x32,0x00,0x14,
+0xA4,0x40,0x0A,0x51,0x00,0x01,0xE2,0xA1,0xE8,0x04,0xA4,0x40,0x12,0x11,0x7F,0xFF,
+0xA5,0x40,0x0A,0x11,0x80,0x01,0xE2,0xA1,0xE8,0x04,0xA4,0x40,0x12,0x11,0xFF,0xFF,
+0x8C,0x02,0xD5,0xED,0xDD,0x9E,0xFC,0x00,0x80,0x60,0x3C,0x0D,0xFA,0xD5,0x02,0x00,
+0x00,0x12,0xC8,0x04,0x44,0x01,0x06,0x30,0xD5,0x03,0x44,0x01,0x26,0x30,0x2E,0x20,
+0x21,0x43,0x95,0x11,0xC9,0x1C,0xCB,0x07,0x80,0x23,0x44,0x21,0x95,0x14,0x44,0x31,
+0x97,0xA0,0xD5,0x2F,0x5A,0x38,0x01,0x0A,0x94,0x92,0x88,0x02,0x80,0x23,0x44,0x21,
+0x98,0xAC,0x44,0x31,0x97,0x20,0xD5,0x25,0x42,0x11,0x90,0x24,0x94,0x49,0x88,0x01,
+0x44,0x21,0x94,0x94,0x80,0x23,0x44,0x31,0x9A,0x2C,0xD5,0x1B,0xCB,0x07,0x80,0x23,
+0x44,0x21,0x98,0x2C,0x44,0x31,0x9B,0x38,0xD5,0x14,0x5A,0x38,0x01,0x0A,0x94,0x92,
+0x88,0x02,0x80,0x23,0x44,0x21,0x9A,0xAC,0x44,0x31,0x96,0x14,0xD5,0x0A,0x42,0x11,
+0x90,0x24,0x94,0x49,0x88,0x01,0x44,0x21,0x99,0xAC,0x80,0x23,0x44,0x31,0x96,0x94,
+0x54,0x42,0x00,0xFE,0x49,0xFF,0xFF,0xA2,0xFC,0x80,0xFC,0x40,0x2E,0x30,0x21,0x43,
+0x81,0x20,0x94,0xD9,0x84,0x00,0x3C,0x0B,0xFE,0x0A,0x80,0xC1,0x44,0x01,0x95,0x14,
+0x44,0x11,0x97,0xA0,0x44,0x21,0x90,0x38,0x54,0x31,0x80,0xFE,0x49,0xFF,0xFF,0x61,
+0x2E,0x07,0xEA,0x91,0x84,0xE0,0x5A,0x00,0x01,0x24,0x2E,0x00,0x21,0x6E,0x2E,0x40,
+0x21,0x43,0xE2,0xE0,0xE8,0x12,0x95,0x21,0x42,0x03,0x90,0x24,0x94,0x01,0x88,0x09,
+0x84,0x20,0x44,0x21,0x95,0x14,0x44,0x31,0x97,0xA0,0x54,0x42,0x00,0xFE,0x8C,0xE1,
+0x49,0xFF,0xFF,0x74,0x97,0xF8,0xD5,0xEA,0x94,0xA1,0x44,0x01,0x95,0x14,0x44,0x11,
+0x97,0xA0,0x54,0x21,0x00,0xFE,0x49,0xFF,0xFF,0x57,0x3C,0x0B,0xFE,0x0A,0x2E,0x47,
+0xEA,0xDF,0x3C,0x3D,0xFF,0x07,0xCC,0x0D,0x3C,0x1D,0xFB,0x0A,0x02,0x01,0x80,0x0E,
+0xA6,0x49,0x5A,0x10,0x0B,0x04,0x5A,0x18,0x0E,0x23,0x84,0x23,0xFE,0x0C,0xD5,0x1E,
+0x3C,0x53,0xF5,0x79,0xC5,0x14,0x3C,0x23,0xFC,0x38,0x02,0x11,0x80,0x0F,0x42,0x02,
+0x88,0x24,0xFE,0x54,0x44,0xFF,0xFF,0xCE,0x44,0x20,0x00,0x32,0x40,0x00,0x3C,0x16,
+0x40,0x20,0x88,0x56,0x88,0x40,0x98,0x2A,0x96,0x01,0xD5,0x03,0x02,0x01,0x80,0x0F,
+0x2E,0x17,0xEA,0xD3,0x5A,0x18,0x01,0x04,0x94,0x01,0x96,0x01,0x3C,0xF7,0xFE,0x0A,
+0xE0,0x0F,0x44,0x01,0x9B,0x2C,0xE9,0x0B,0xCC,0x10,0x3C,0x23,0xFE,0x09,0x3C,0x13,
+0xFE,0x0B,0x88,0x22,0x00,0x21,0x80,0x24,0xE0,0x41,0xE8,0x07,0x38,0x10,0x19,0x01,
+0x8C,0x21,0x38,0x10,0x19,0x09,0xD5,0x09,0x38,0x00,0x19,0x01,0xC0,0x06,0x44,0x11,
+0x9B,0x2C,0x8E,0x01,0x38,0x00,0x99,0x09,0xFC,0xC0,0xFC,0x00,0x3C,0xF7,0xFE,0x0A,
+0x5E,0xF7,0x81,0xF5,0xE9,0x05,0x3C,0x0D,0xFF,0x07,0xA6,0x00,0xD5,0x08,0x3C,0x03,
+0xFC,0x38,0x5C,0xF0,0x00,0x33,0xE9,0x05,0x49,0x00,0x13,0xA9,0x3C,0x0F,0xFA,0xE5,
+0xFC,0x80,0xFC,0x51,0x84,0x20,0x81,0x00,0x44,0x20,0x00,0x80,0xB0,0x02,0x2E,0x70,
+0x21,0x43,0x49,0x00,0x40,0xA5,0x3C,0x13,0xFC,0x38,0x2E,0x00,0x21,0x6E,0x5C,0xF0,
+0x80,0x33,0x2E,0x97,0xEA,0xB3,0xE8,0x03,0x5A,0x98,0x01,0x46,0x2E,0x17,0xFC,0x18,
+0x94,0xF9,0xB6,0x3F,0x84,0x80,0x9E,0x41,0x96,0xD8,0x2E,0xA7,0xEA,0xDF,0x80,0xA4,
+0xF1,0x81,0x44,0x71,0x90,0x38,0x87,0x83,0x45,0xE1,0x8F,0xB8,0x96,0x68,0xE2,0x20,
+0xE8,0x32,0x84,0x40,0x96,0x50,0xE2,0x23,0xE8,0x2B,0x98,0x54,0x94,0x49,0x88,0x28,
+0xB1,0x82,0xA4,0x48,0x40,0xF0,0x81,0xF6,0xB0,0x42,0x38,0x10,0x89,0x01,0x88,0x2F,
+0x96,0x49,0x38,0x13,0x09,0x09,0x5A,0x98,0x01,0x0E,0x40,0xF1,0x04,0x08,0x5A,0xA8,
+0x03,0x07,0xB4,0xDF,0xCE,0x04,0x38,0x1F,0x3C,0x09,0xD5,0x10,0x38,0x13,0xBC,0x09,
+0xD5,0x0D,0xF6,0x01,0xDE,0x0B,0x38,0xF3,0x89,0x01,0x92,0x22,0x42,0xF7,0xF0,0x24,
+0x40,0xF7,0x88,0x0A,0x88,0x2F,0x38,0x13,0x89,0x09,0x8C,0x41,0xD5,0xD4,0x8C,0xA1,
+0x88,0x83,0xD5,0xCD,0xFC,0xD1,0xFC,0x00,0x44,0x01,0x9B,0x2C,0x84,0x26,0x49,0xFF,
+0xFE,0x22,0x84,0x00,0x3E,0x07,0xEA,0x8A,0x84,0x00,0x3C,0x0B,0xFC,0x38,0xFC,0x80,
+0xFC,0x00,0x3C,0x03,0xFC,0x38,0x5C,0xF0,0x00,0x33,0xE9,0x06,0x49,0xFF,0xFF,0xED,
+0x84,0x00,0x3C,0x0B,0xF5,0x79,0x2E,0x07,0xF8,0x6E,0x5C,0xF0,0x00,0x33,0xE9,0x04,
+0x84,0x00,0x3E,0x07,0xF8,0x6E,0xFC,0x80,0x84,0x01,0x3E,0x07,0xFC,0x10,0xDD,0x9E,
+0x84,0x00,0x3E,0x07,0xEA,0x97,0x3E,0x07,0xF8,0x6E,0xDD,0x9E,0xFC,0x00,0x84,0x00,
+0x2E,0x17,0xEA,0x8E,0x3E,0x07,0xEA,0x95,0x44,0x01,0x9B,0x2C,0x38,0x00,0x05,0x01,
+0xE6,0x04,0xE9,0x04,0x84,0x01,0x3E,0x07,0xEA,0x95,0x3C,0xF7,0xFE,0x0A,0x5E,0xF7,
+0x81,0xF5,0xE8,0x1D,0x2E,0x07,0xEA,0xDF,0xC0,0x0F,0x3C,0x0C,0x05,0xA0,0x5A,0x00,
+0x01,0x06,0x2E,0x07,0xFD,0xBE,0x5A,0x08,0x01,0x08,0x2E,0x07,0xF8,0x6E,0x8C,0x01,
+0x3E,0x07,0xF8,0x6E,0xD5,0x03,0x49,0xFF,0xFF,0xD5,0x2E,0x07,0xEA,0xA7,0xC0,0x0C,
+0x3C,0x03,0xFC,0x38,0x8C,0x01,0x3C,0x0B,0xFC,0x38,0xD5,0x06,0x84,0x00,0x3C,0x0B,
+0xFC,0x38,0x49,0xFF,0xFF,0xC7,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xFD,0xEE,0x3C,0x00,
+0x00,0x2A,0x5C,0xF0,0x00,0xFA,0xE8,0x17,0x3C,0x13,0xFE,0x09,0x3C,0x03,0xFE,0x0B,
+0x88,0x01,0x3C,0x1D,0xFF,0x07,0x00,0x10,0x80,0x25,0xE0,0x01,0xE8,0x0C,0x2E,0x07,
+0xEA,0x97,0x8C,0x01,0x96,0x00,0x3E,0x07,0xEA,0x97,0xC0,0x09,0x49,0xFF,0xFF,0xAA,
+0x84,0x01,0xD5,0x05,0x84,0x00,0x3E,0x07,0xEA,0x97,0x84,0x00,0xFC,0x80,0x3C,0x3D,
+0xFA,0xD5,0x44,0x50,0x00,0x64,0x40,0x10,0xD0,0x08,0x02,0x41,0x80,0x0C,0x42,0x40,
+0x14,0x73,0x44,0x01,0x00,0x00,0xFE,0x27,0xA1,0x04,0x40,0x42,0x30,0x08,0x92,0x8C,
+0xFF,0x0F,0xA9,0x04,0xAC,0x84,0xA0,0x83,0x46,0x19,0xFF,0xFF,0x50,0x10,0x8F,0xFF,
+0xFE,0x56,0x46,0x22,0x00,0x00,0xFE,0x57,0xA8,0x43,0x2E,0x17,0xEA,0xDF,0x8E,0x22,
+0xE6,0x22,0xE8,0x0D,0x2E,0x17,0xEA,0x90,0xA1,0x05,0x40,0x20,0xD8,0x08,0x46,0x1C,
+0x03,0xFF,0x50,0x10,0x8F,0xFF,0xFE,0x66,0xFE,0x57,0xA8,0x45,0x3C,0x1D,0xFB,0x0A,
+0xA6,0x49,0x5A,0x18,0x10,0x0C,0xA0,0x9D,0x44,0x1E,0xFF,0xFF,0xFE,0x56,0xA8,0x5D,
+0xA0,0x82,0x44,0x1C,0xFF,0xFF,0xFE,0x56,0xA8,0x42,0xDD,0x9E,0xFC,0x40,0x84,0xC0,
+0x44,0x71,0x8F,0x1C,0x44,0x91,0x8F,0x28,0x2E,0x00,0x21,0x6E,0xE2,0xC0,0xE8,0x1F,
+0x2E,0x07,0xEA,0xDF,0x5A,0x08,0x01,0x05,0x38,0x14,0x99,0x11,0xD5,0x0B,0x2E,0x07,
+0xEA,0x93,0x5A,0x08,0x01,0x05,0x38,0x13,0x99,0x11,0xD5,0x04,0x9C,0x33,0x38,0x13,
+0x81,0x11,0x44,0x01,0x80,0x58,0x44,0x21,0x8F,0x18,0x38,0x00,0x18,0x00,0x38,0x21,
+0x18,0x00,0x8C,0xC1,0x49,0xFF,0xFF,0x9D,0x97,0xB0,0xD5,0xDF,0xFC,0xC0,0xFC,0x40,
+0x81,0x20,0x2E,0x07,0xEA,0xDF,0xC8,0x04,0x3C,0x77,0xFC,0x34,0xD5,0x05,0x44,0x01,
+0x8F,0x1C,0x38,0x70,0x25,0x11,0x3C,0x0D,0xFF,0x07,0x00,0x00,0x00,0x29,0x5A,0x08,
+0x01,0x04,0x3C,0x74,0x11,0x22,0x84,0xC0,0x2E,0x00,0x21,0x6F,0xE2,0xC0,0xE8,0x08,
+0xFD,0x03,0x84,0x40,0x8C,0xC1,0x49,0xFF,0xFF,0x7C,0x97,0xB0,0xD5,0xF6,0x3E,0x97,
+0xEA,0x8E,0xFC,0xC0,0xFC,0x00,0x49,0x00,0x0D,0x5F,0x5A,0x08,0x02,0x20,0x44,0x11,
+0xF0,0x66,0x2E,0x27,0xEA,0xD3,0xA6,0x08,0x54,0x00,0x00,0xFC,0x5A,0x28,0x01,0x0E,
+0x58,0x00,0x00,0x01,0xAE,0x08,0x44,0x61,0xF0,0x67,0xA6,0x30,0x96,0x0F,0x5A,0x00,
+0x01,0x0E,0x49,0x00,0x18,0x46,0xD5,0xFA,0xAE,0x08,0x44,0x61,0xF0,0x67,0xA6,0x30,
+0x96,0x0F,0xC0,0x04,0x49,0x00,0x18,0x3D,0xD5,0xFB,0xFC,0x80,0x44,0x01,0x50,0xD7,
+0x44,0x11,0x50,0xD6,0xA6,0x00,0xA6,0x48,0x40,0x00,0x20,0x08,0xFE,0x0F,0x54,0x00,
+0x01,0xFC,0x92,0x02,0xDD,0x9E,0x44,0x01,0x50,0xE3,0x44,0x11,0x50,0xE2,0xA6,0x00,
+0xA6,0x48,0x40,0x00,0x20,0x08,0xFE,0x0F,0x54,0x00,0x03,0xFF,0x92,0x06,0xDD,0x9E,
+0x44,0x01,0x48,0x6F,0x44,0x11,0x48,0x6E,0xA6,0x00,0xA6,0x48,0x40,0x00,0x20,0x08,
+0xFE,0x0F,0x54,0x00,0x01,0xFC,0x92,0x02,0xDD,0x9E,0x44,0x01,0x48,0x7B,0x44,0x11,
+0x48,0x7A,0xA6,0x00,0xA6,0x48,0x40,0x00,0x20,0x08,0xFE,0x0F,0x54,0x00,0x03,0xFF,
+0x92,0x06,0xDD,0x9E,0xFC,0x00,0x44,0x01,0xB8,0x00,0x84,0xC0,0x00,0x10,0x00,0xA7,
+0x22,0x20,0x00,0x81,0x3E,0x17,0xEA,0xDE,0x00,0x10,0x00,0xB0,0x3E,0x67,0xEA,0xDF,
+0x3E,0x17,0xEA,0xCD,0x00,0x10,0x00,0xC8,0x3E,0x67,0xEA,0x8E,0x3E,0x17,0xEA,0xD6,
+0x44,0x11,0x8F,0x28,0x3E,0x67,0xEA,0x8D,0xAC,0x88,0xAC,0x89,0xAC,0x8A,0x44,0x11,
+0x8F,0x1C,0x22,0x20,0x00,0x82,0x3E,0x67,0xEA,0xB3,0xAC,0x88,0x3C,0x2B,0xF5,0x78,
+0x02,0x20,0x00,0x83,0x3E,0x67,0xFD,0xBD,0xAC,0x89,0x02,0x20,0x00,0x84,0xAC,0x8A,
+0x02,0x20,0x00,0x85,0xAC,0x8B,0x02,0x20,0x00,0x86,0x02,0x00,0x00,0x87,0xAC,0x8C,
+0xAC,0x0D,0x49,0xFF,0xFF,0xBC,0x3E,0x07,0xEA,0x88,0x49,0xFF,0xFF,0xAB,0x3E,0x07,
+0xEA,0x89,0x49,0xFF,0xFF,0x9A,0x3E,0x07,0xEA,0x90,0x49,0xFF,0xFF,0x89,0x3E,0x07,
+0xEA,0x8B,0x3E,0x07,0xEA,0xA5,0x84,0x01,0x3E,0x07,0xFC,0x10,0x84,0x27,0x84,0x00,
+0x3E,0x67,0xEA,0xD3,0x3E,0x67,0xEA,0x8A,0x3C,0x0B,0xF5,0x79,0x3C,0x1F,0xFA,0xE5,
+0x3E,0x07,0xEA,0x8C,0xFC,0x80,0xFC,0x00,0x84,0x40,0x80,0xC0,0x44,0x30,0xFF,0xFF,
+0x80,0x02,0x97,0x10,0xE2,0x81,0xE8,0x0A,0x38,0x53,0x09,0x01,0x8C,0x41,0xE2,0xA3,
+0x40,0x32,0xBC,0x1B,0x40,0x02,0x3C,0x1B,0xD5,0xF5,0xFC,0x80,0x94,0x91,0x80,0xA0,
+0x88,0x40,0x84,0x00,0xD2,0x08,0x0A,0x32,0x80,0x01,0xE2,0x23,0xE8,0xFC,0x9C,0xC1,
+0x96,0x18,0xD5,0xF9,0xDD,0x9E,0xFC,0x00,0x84,0x00,0x3E,0x07,0xEA,0x94,0x2E,0x07,
+0xEA,0x93,0x5A,0x00,0x01,0x04,0x84,0x03,0xD5,0x02,0x84,0x00,0x44,0x11,0x97,0x14,
+0x94,0x01,0x88,0x01,0x84,0x43,0x44,0x10,0x01,0xF4,0x49,0xFF,0xFF,0xE1,0x8E,0x03,
+0x5C,0x00,0x00,0x01,0x3E,0x07,0xEA,0x94,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xFE,0x12,
+0x2E,0x17,0xFC,0x10,0x5A,0x18,0x01,0x1F,0x84,0x00,0x3E,0x07,0xEA,0x91,0x3E,0x07,
+0xEA,0x96,0x3E,0x07,0xFC,0x10,0x3E,0x17,0xEA,0x93,0x49,0xFF,0xFD,0xF6,0x3C,0x0D,
+0xFF,0x07,0x00,0x00,0x00,0x29,0x5A,0x08,0x01,0x0E,0x3C,0x00,0x11,0x22,0x3C,0x0B,
+0xF5,0x78,0x84,0x00,0x3C,0x0B,0xFD,0xC7,0x3E,0x07,0xEA,0xA7,0x84,0x00,0x3C,0x0F,
+0xFF,0x6B,0xFC,0x80,0xFC,0x00,0x3E,0x07,0xEA,0xDF,0x44,0x01,0x80,0x4C,0x49,0x00,
+0x1C,0xED,0x2E,0x07,0xEA,0x8A,0x49,0xFF,0xFE,0xC4,0x84,0x01,0x3E,0x07,0xFC,0x10,
+0xFC,0x80,0x2E,0x17,0xFD,0xBB,0x5A,0x18,0x01,0x05,0x2E,0x10,0x22,0x57,0xD5,0x03,
+0x3C,0x10,0x11,0x05,0x2E,0x27,0xEA,0xA7,0xCA,0x05,0x2E,0x20,0x22,0x58,0x88,0x22,
+0x96,0x49,0xAC,0x40,0x2E,0x10,0x22,0x57,0xAC,0x44,0xDD,0x9E,0x2E,0x00,0x21,0xDC,
+0x5A,0x08,0x01,0x18,0xFC,0x00,0x2E,0x00,0x22,0x60,0x49,0x00,0x0B,0x66,0x2E,0x00,
+0x22,0x60,0x49,0x00,0x0B,0x67,0x2E,0x00,0x22,0x62,0x49,0x00,0x0B,0x6D,0x2E,0x00,
+0x22,0x62,0x49,0x00,0x0B,0x64,0x44,0x00,0x03,0xE0,0x49,0x00,0x0B,0x6A,0xFC,0x80,
+0xDD,0x9E,0xFC,0x40,0x3C,0x5D,0xFA,0xD5,0x44,0x41,0x00,0x00,0x2E,0xA7,0xEA,0xCB,
+0x02,0x02,0x80,0x10,0x84,0x40,0xFE,0x27,0x44,0x60,0x00,0x64,0x02,0x30,0x00,0x42,
+0x44,0x7F,0xF0,0x00,0x54,0x31,0xFF,0xFF,0x50,0x31,0xFE,0xC5,0x44,0x90,0x00,0xD3,
+0x2E,0x00,0x21,0x6F,0xE2,0x40,0xE8,0x28,0x02,0x02,0x80,0x0C,0x42,0x01,0x18,0x73,
+0xFE,0x27,0xA0,0x44,0x4E,0x14,0x00,0x06,0xA0,0x44,0x92,0x34,0xFE,0x7F,0xD5,0x04,
+0xA0,0x44,0x92,0x34,0x96,0x4B,0x04,0xA0,0x00,0x05,0x81,0xE3,0x93,0x56,0x54,0xA5,
+0x00,0xFF,0x42,0xF0,0xA8,0x73,0x80,0x2F,0x96,0x49,0xAC,0x40,0xA4,0x40,0x5C,0xF0,
+0x80,0xD4,0xE9,0x04,0x12,0x90,0x00,0x01,0xD5,0x04,0xA4,0x41,0x96,0x49,0xAC,0x40,
+0x8C,0x41,0x96,0x90,0xD5,0xD6,0x3E,0xA7,0xEA,0xCB,0xFC,0xC0,0x3C,0x0F,0xFF,0x07,
+0xDD,0x9E,0x2E,0x37,0xFD,0xBB,0x5A,0x38,0x01,0x05,0x00,0x40,0x00,0x10,0xD5,0x02,
+0xA7,0x00,0x3E,0x40,0x24,0x9D,0x5A,0x38,0x01,0x04,0xA1,0x07,0xD5,0x02,0xA1,0x03,
+0x3C,0x4E,0x09,0x28,0x2E,0x47,0xEA,0xD9,0x5A,0x48,0x01,0x0A,0x5A,0x38,0x01,0x04,
+0xA0,0x07,0xD5,0x02,0xA0,0x03,0x94,0x04,0x3C,0x0E,0x09,0x28,0x5A,0x38,0x01,0x04,
+0xA6,0x0A,0xD5,0x02,0xA6,0x08,0x3E,0x00,0x24,0xF0,0x5A,0x38,0x01,0x04,0xA6,0x0B,
+0xD5,0x02,0xA6,0x09,0x3E,0x00,0x24,0xF1,0x5A,0x38,0x01,0x04,0xA4,0x12,0xD5,0x02,
+0xA4,0x10,0x3C,0x08,0x12,0x8D,0x84,0x04,0x5A,0x38,0x01,0x04,0x44,0x00,0x00,0x64,
+0x3C,0x08,0x12,0x8A,0x5A,0x30,0x01,0x05,0x44,0x00,0x02,0x71,0xD5,0x03,0x44,0x00,
+0x04,0xC9,0x3C,0x08,0x12,0x89,0xDD,0x9E,0xFC,0x01,0x84,0xC0,0xF0,0x81,0x2E,0x00,
+0x21,0x6F,0xE2,0xC0,0xE8,0x09,0x80,0x06,0xF1,0x01,0x84,0x40,0x8C,0xC1,0x49,0xFF,
+0xFD,0x90,0x97,0xB0,0xD5,0xF5,0xFC,0x81,0xFC,0x00,0x2E,0x07,0xEA,0xDD,0x84,0x81,
+0x2E,0x17,0xEA,0xD4,0x44,0x51,0x82,0xC0,0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,
+0x49,0xFF,0xF8,0x28,0x49,0x00,0x0B,0x68,0x5A,0x08,0x02,0x08,0x44,0x01,0x82,0xC0,
+0x84,0x20,0x49,0xFF,0xF9,0xC8,0xD5,0x0E,0x44,0x01,0x82,0xC0,0x84,0x21,0x49,0xFF,
+0xF9,0xC2,0x44,0x00,0x00,0xFF,0x49,0xFF,0xF9,0x6A,0x44,0x00,0x00,0xFF,0x49,0xFF,
+0xF9,0x6C,0x44,0x01,0x82,0xC0,0x2E,0x10,0x21,0x6F,0x49,0xFF,0xFA,0x2F,0xFC,0x80,
+0xFC,0x00,0x2E,0x07,0xEA,0xA7,0xC8,0x32,0x3C,0x1D,0xFF,0x6B,0xE6,0x34,0xE9,0x2E,
+0x2E,0x17,0xEA,0xDE,0x3C,0x08,0x08,0x3E,0x3E,0x10,0x21,0xE7,0x2E,0x17,0xEA,0xCD,
+0x44,0x21,0x1A,0xD8,0x3E,0x10,0x21,0xF0,0x80,0x60,0x3C,0x10,0x10,0xBA,0xE2,0x01,
+0xE8,0x06,0x98,0x42,0x8C,0x01,0xAE,0xC8,0x96,0x01,0xD5,0xF8,0x3C,0x0C,0x02,0xEE,
+0x3C,0x1C,0x02,0xF0,0x49,0x00,0x09,0xD3,0x44,0x00,0x00,0x33,0x3C,0x0B,0xFC,0x38,
+0x3C,0x0D,0xFA,0xE3,0xC0,0x04,0x44,0x01,0x26,0x30,0xD5,0x03,0x44,0x01,0x06,0x30,
+0x49,0xFF,0xFC,0x51,0x84,0x01,0x3E,0x07,0xEA,0xA7,0xFC,0x80,0xFC,0x20,0x2E,0x40,
+0x21,0x43,0x84,0x20,0x95,0x21,0x44,0x31,0x90,0x38,0x44,0x51,0x8F,0x38,0x44,0x60,
+0x03,0xE8,0xE0,0x24,0xE8,0x17,0x5A,0x08,0x03,0x0A,0x38,0x71,0x85,0x01,0x38,0x22,
+0x85,0x01,0xFE,0xBC,0x40,0x21,0x18,0x57,0xD5,0x08,0x38,0x21,0x85,0x01,0x38,0x72,
+0x85,0x01,0xFE,0xB4,0x40,0x21,0x1C,0x57,0x38,0x21,0x85,0x09,0x8C,0x21,0x96,0x49,
+0xD5,0xE9,0xFC,0xA0,0xFC,0x40,0x2E,0x27,0xEA,0xDF,0x2E,0x07,0xEA,0x8B,0x2E,0x17,
+0xEA,0x90,0x2E,0x37,0xEA,0x88,0x2E,0x47,0xEA,0x89,0xCA,0x04,0x80,0xA0,0x80,0xC1,
+0xD5,0x05,0x80,0xA4,0x80,0xC3,0x80,0x80,0x80,0x61,0x2E,0x07,0xFD,0xBD,0x5A,0x08,
+0x02,0x2F,0x3C,0x7D,0xFA,0xFB,0x3C,0x9D,0xFB,0x0B,0x3C,0xAC,0x02,0xF0,0x84,0x00,
+0x3C,0x10,0x10,0xBA,0xE2,0x01,0xE8,0x1D,0x2E,0x10,0x21,0x42,0x40,0x80,0x04,0x56,
+0x92,0x21,0xE0,0x41,0x94,0x81,0x40,0x85,0x08,0x00,0x80,0x27,0x02,0x24,0x00,0x00,
+0x40,0x14,0xBC,0x1B,0x40,0x21,0x14,0x56,0x9A,0x8A,0x40,0x21,0x18,0x57,0x42,0x11,
+0x0C,0x75,0xFE,0x64,0x96,0x49,0x8C,0x01,0x12,0x14,0x00,0x00,0x96,0x01,0xD5,0xE1,
+0x84,0x00,0x3E,0x07,0xEA,0xA7,0x84,0x00,0x3C,0x0F,0xFF,0x6B,0xFC,0xC0,0xFC,0x40,
+0x2E,0x27,0xFD,0xBC,0x2E,0x10,0x21,0x43,0x2E,0x30,0x21,0x6E,0x5A,0x28,0x01,0x10,
+0x94,0x49,0x80,0xC0,0x42,0x20,0x8C,0x24,0x2E,0x07,0xEA,0x91,0x2E,0x77,0xEA,0xDF,
+0x84,0x20,0x44,0x51,0x90,0xCC,0x85,0x26,0x85,0x4A,0xD5,0x10,0x94,0x89,0xFE,0x9C,
+0x44,0x11,0x90,0xCC,0x49,0x00,0x09,0x13,0xD5,0x19,0x38,0x33,0x05,0x01,0x5A,0x08,
+0x01,0x09,0x38,0x32,0x85,0x09,0x8C,0x21,0x96,0x48,0xE0,0x22,0xE9,0xF7,0xD5,0x0E,
+0x5A,0x70,0x04,0xF9,0x42,0x31,0xA4,0x24,0x40,0x41,0x90,0x0A,0x38,0x32,0x85,0x01,
+0x42,0x31,0xA8,0x24,0x90,0x64,0x88,0x64,0xD5,0xED,0xFC,0xC0,0x3C,0x0D,0xFB,0x35,
+0xC0,0xFE,0xFC,0x00,0x49,0x00,0x15,0x6D,0xFC,0x80,0xFC,0x00,0x80,0xC0,0x49,0xFF,
+0xFF,0xF7,0x3E,0x67,0xEA,0xDF,0x49,0xFF,0xFE,0xF1,0x44,0x01,0x80,0x40,0x49,0x00,
+0x1B,0x05,0x49,0xFF,0xFC,0xB5,0x84,0x01,0x3E,0x07,0xFC,0x10,0xFC,0x80,0xFC,0x40,
+0x81,0x20,0x2E,0x07,0xEA,0x93,0x85,0x43,0x5A,0x08,0x01,0x03,0x85,0x40,0x49,0xFF,
+0xFF,0xDF,0x3C,0x1D,0xFB,0x14,0x84,0x01,0x84,0xE0,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,
+0x50,0x84,0xFF,0xFF,0xAE,0x08,0x84,0x01,0x3C,0x7F,0xFB,0x24,0x49,0x00,0x0C,0x73,
+0x3E,0x77,0xFC,0x10,0x49,0xFF,0xFB,0xD1,0x4C,0x74,0x80,0x77,0x84,0x00,0x3E,0x07,
+0xEA,0xE3,0x49,0x00,0x19,0x8F,0x2E,0x17,0xEA,0xE3,0x2E,0x00,0x21,0x6F,0xE2,0x20,
+0xE8,0x63,0x49,0x00,0x15,0x2E,0x3C,0x6D,0xFB,0x24,0x5A,0x68,0x01,0xF6,0x84,0x00,
+0x3C,0x0F,0xFB,0x24,0x2E,0x07,0xEA,0xE3,0x80,0x2A,0x92,0x02,0x49,0xFF,0xFA,0x75,
+0x2E,0x07,0xEA,0xE3,0x2E,0x50,0x21,0x6F,0x8C,0x01,0x96,0x00,0x3E,0x07,0xEA,0xE3,
+0x2E,0x07,0xEA,0xE3,0x4C,0x74,0x40,0x43,0xD8,0xDF,0x2E,0x60,0x21,0x43,0x2E,0x07,
+0xEA,0x93,0x95,0xB1,0x97,0xB0,0x5A,0x08,0x01,0x1E,0x44,0x11,0x97,0xA0,0x80,0x46,
+0x44,0x01,0x95,0x14,0x49,0xFF,0xFA,0x30,0x3C,0x08,0x00,0x2A,0x44,0x11,0x97,0x20,
+0x80,0x46,0x44,0x01,0x98,0xAC,0x49,0xFF,0xFA,0x27,0x3C,0x08,0x00,0x2B,0x44,0x11,
+0x9A,0x2C,0x44,0x01,0x94,0x94,0x80,0x46,0x49,0xFF,0xFA,0x1E,0x3C,0x08,0x00,0x2C,
+0xD5,0xBB,0x44,0x11,0x9B,0x38,0x80,0x46,0x44,0x01,0x98,0x2C,0x49,0xFF,0xFA,0x14,
+0x3C,0x08,0x00,0x2D,0x44,0x11,0x96,0x14,0x80,0x46,0x44,0x01,0x9A,0xAC,0x49,0xFF,
+0xFA,0x0B,0x3C,0x08,0x00,0x2E,0x44,0x11,0x96,0x94,0x44,0x01,0x99,0xAC,0x80,0x46,
+0x49,0xFF,0xFA,0x02,0x3C,0x08,0x00,0x2F,0xD5,0x9F,0xD8,0x9E,0x3C,0x0D,0xFA,0xFF,
+0xAF,0x80,0x48,0xFF,0xFF,0x9A,0x44,0x0F,0xFF,0xAA,0x8C,0xE1,0x3E,0x07,0xEA,0xBD,
+0x97,0xF8,0x48,0xFF,0xFF,0x8B,0x84,0x00,0x49,0x00,0x0B,0xF5,0xFC,0xC0,0xFC,0x00,
+0x84,0x00,0x3C,0x0F,0xFB,0x35,0x3C,0x0D,0xFA,0xFF,0x84,0x21,0xAE,0x40,0x3C,0x1D,
+0xFB,0x14,0xA6,0x08,0x5A,0x08,0x01,0xFF,0x49,0x00,0x19,0x0C,0x3C,0x1D,0xFA,0xFF,
+0xA6,0x08,0x5A,0x00,0x01,0xFF,0x44,0x01,0xA2,0x78,0x44,0x11,0x81,0x9A,0x49,0x00,
+0x15,0xD3,0x2E,0x07,0xEA,0xA7,0x5A,0x08,0x01,0x0E,0x2E,0x07,0xEA,0xB5,0x5A,0x08,
+0x01,0x07,0x2E,0x07,0xFC,0x18,0xC8,0x03,0x49,0xFF,0xF9,0x2A,0x84,0x00,0x3E,0x07,
+0xEA,0xB5,0x49,0xFF,0xFE,0xA9,0x3C,0x0D,0xFB,0x35,0x5A,0x08,0x01,0xFE,0x3C,0x0D,
+0xFA,0xD5,0x02,0x00,0x00,0x12,0xC0,0x04,0x44,0x01,0x26,0x30,0xD5,0x03,0x44,0x01,
+0x06,0x30,0x49,0xFF,0xFE,0xDE,0xFC,0x80,0xFC,0x00,0x84,0x01,0x49,0xFF,0xFF,0x17,
+0x44,0x01,0x97,0x14,0x84,0x26,0x49,0xFF,0xF9,0x36,0x2E,0x30,0x21,0x43,0x44,0x11,
+0x97,0xA0,0x94,0xD9,0x44,0x21,0x90,0x38,0x54,0x31,0x80,0xFE,0x44,0x01,0x95,0x14,
+0x49,0xFF,0xF9,0x7F,0x84,0x01,0x49,0xFF,0xFF,0x14,0x49,0xFF,0xFB,0x5F,0x80,0xC0,
+0x5A,0x00,0x01,0x1B,0x44,0x01,0x80,0x4C,0x49,0x00,0x1A,0x08,0x84,0x03,0x3E,0x07,
+0xEA,0xDF,0x84,0x03,0x49,0xFF,0xFE,0x4C,0x49,0xFF,0xFD,0xE8,0x2E,0x07,0xEA,0x8E,
+0x84,0xC1,0x3E,0x07,0xEA,0x8A,0x3E,0x67,0xEA,0xD3,0x49,0xFF,0xFB,0xF5,0x84,0x03,
+0x49,0xFF,0xFD,0x02,0xD5,0x11,0x84,0x02,0x3E,0x07,0xFD,0xBD,0x84,0x00,0x49,0xFF,
+0xFC,0xFB,0x84,0x00,0x3E,0x07,0xEA,0xD3,0x49,0xFF,0xFF,0x83,0x84,0x00,0x3C,0x0F,
+0xFF,0x6B,0x3E,0x07,0xEA,0xA7,0x3E,0x67,0xFC,0x10,0xFC,0x80,0xFC,0x20,0x84,0xC1,
+0x44,0x71,0x97,0x14,0x3E,0x67,0xEA,0xD3,0x49,0xFF,0xFB,0xD6,0x3E,0x67,0xEA,0x93,
+0x49,0xFF,0xFA,0xE8,0x84,0x26,0x80,0x07,0x49,0xFF,0xF8,0xE5,0x84,0x02,0x49,0xFF,
+0xFE,0xBE,0x2E,0x30,0x21,0x43,0x44,0x01,0x95,0x14,0x94,0xD9,0x44,0x11,0x97,0xA0,
+0x44,0x21,0x90,0x38,0x54,0x31,0x80,0xFE,0x49,0xFF,0xF9,0x2B,0x2E,0x30,0x21,0x43,
+0x44,0x01,0x98,0xAC,0x94,0xD9,0x44,0x11,0x97,0x20,0x44,0x21,0x90,0x38,0x54,0x31,
+0x80,0xFE,0x49,0xFF,0xF9,0x1E,0x2E,0x30,0x21,0x43,0x44,0x11,0x9A,0x2C,0x94,0xD9,
+0x44,0x21,0x90,0x38,0x54,0x31,0x80,0xFE,0x44,0x01,0x94,0x94,0x49,0xFF,0xF9,0x11,
+0x3C,0x0D,0xFF,0x07,0xA6,0x01,0x49,0xFF,0xFE,0xA4,0x49,0xFF,0xFC,0x6E,0x84,0x02,
+0x3E,0x07,0xEA,0x93,0x3E,0x67,0xEA,0x94,0x3E,0x67,0xFC,0x10,0x49,0xFF,0xFB,0x48,
+0x2E,0x30,0x21,0x43,0x44,0x01,0x98,0x2C,0x94,0xD9,0x44,0x11,0x9B,0x38,0x44,0x21,
+0x90,0x38,0x54,0x31,0x80,0xFE,0x49,0xFF,0xF8,0xF4,0x2E,0x30,0x21,0x43,0x44,0x01,
+0x9A,0xAC,0x94,0xD9,0x44,0x11,0x96,0x14,0x44,0x21,0x90,0x38,0x54,0x31,0x80,0xFE,
+0x49,0xFF,0xF8,0xE7,0x2E,0x30,0x21,0x43,0x44,0x21,0x90,0x38,0x94,0xD9,0x44,0x11,
+0x96,0x94,0x54,0x31,0x80,0xFE,0x44,0x01,0x99,0xAC,0x49,0xFF,0xF8,0xDA,0x3C,0x0D,
+0xFF,0x07,0xA6,0x01,0x49,0xFF,0xFE,0x6D,0x49,0xFF,0xFC,0x37,0x84,0x26,0x80,0x07,
+0x49,0xFF,0xFC,0x13,0x3C,0x2D,0xFF,0x07,0x84,0x20,0x3C,0x1B,0xF5,0x79,0x38,0x53,
+0x81,0x01,0x02,0x11,0x00,0x0F,0xE2,0x25,0xE8,0x08,0x44,0x30,0x7F,0xFF,0xDB,0x03,
+0x95,0x49,0x97,0x69,0x3C,0x5B,0xF5,0x79,0x00,0x11,0x00,0x1A,0x5A,0x10,0x01,0x06,
+0x00,0x11,0x00,0x29,0x5A,0x18,0x01,0x03,0x84,0x00,0x3E,0x07,0xEA,0x8A,0x84,0x03,
+0x49,0xFF,0xFC,0x52,0x2E,0x07,0xEA,0xB3,0xC8,0x03,0x49,0xFF,0xFE,0xDA,0x84,0x00,
+0x84,0x21,0x3C,0x0F,0xFF,0x6B,0x3E,0x17,0xFD,0xBB,0x3E,0x07,0xEA,0xA7,0xFC,0xA0,
+0xFC,0x20,0x2E,0x07,0xEA,0xA7,0xC8,0x04,0x3E,0x00,0x21,0xE7,0xD5,0x07,0x2E,0x07,
+0xEA,0xDE,0x3E,0x00,0x21,0xE7,0x2E,0x07,0xEA,0xCD,0x2E,0x67,0xEA,0xDF,0x3E,0x00,
+0x21,0xF0,0xC6,0x05,0x5A,0x60,0x03,0x3C,0x48,0x00,0x00,0xC5,0x84,0x01,0x3E,0x07,
+0xFD,0xBC,0x49,0xFF,0xFC,0x04,0x44,0x01,0x90,0xCC,0x2E,0x17,0xEA,0x8E,0x80,0x46,
+0x49,0xFF,0xF9,0x0D,0x49,0xFF,0xFA,0x2C,0x3C,0x0D,0xFB,0x10,0x49,0xFF,0xF9,0xA3,
+0x2E,0x07,0xEA,0xD1,0x3E,0x67,0xFD,0xBB,0xC8,0x03,0x3E,0x07,0xEA,0x95,0x3C,0x0D,
+0xFF,0x07,0x00,0x00,0x00,0x29,0x5A,0x08,0x01,0x04,0x3E,0x07,0xEA,0x95,0x2E,0x67,
+0xEA,0x95,0x5A,0x60,0x01,0x04,0x48,0x00,0x00,0x9E,0x84,0x02,0x3E,0x07,0xFD,0xBD,
+0x84,0x00,0x3E,0x07,0xFD,0xBC,0x84,0x03,0x49,0xFF,0xFD,0x3A,0x49,0xFF,0xFF,0x10,
+0x3E,0x67,0xEA,0xD9,0x3E,0x67,0xFD,0xBC,0x48,0x00,0x00,0x8D,0x84,0x01,0x3E,0x07,
+0xFD,0xBC,0x49,0xFF,0xFB,0xCC,0x44,0x01,0x90,0xCC,0x2E,0x17,0xEA,0x8E,0x2E,0x27,
+0xEA,0x8D,0x49,0xFF,0xF8,0xD4,0x49,0xFF,0xF9,0xF3,0x3C,0x0D,0xFB,0x10,0x49,0xFF,
+0xF9,0x6A,0x3C,0x6D,0xFF,0x07,0x00,0x73,0x00,0x29,0x5A,0x78,0x01,0x0C,0x3C,0x57,
+0xF5,0x78,0x3C,0x04,0x11,0x22,0xD0,0x06,0x84,0x00,0x49,0xFF,0xFA,0xA2,0x3E,0x77,
+0xFC,0x10,0x00,0x03,0x00,0x1A,0x5A,0x00,0x01,0x06,0x00,0x03,0x00,0x29,0x5A,0x08,
+0x01,0x07,0x84,0x00,0x3E,0x07,0xEA,0x95,0x3E,0x07,0xF8,0x6E,0x2E,0x67,0xEA,0x95,
+0x5A,0x68,0x01,0x0D,0x84,0x00,0x3E,0x67,0xFD,0xBD,0x3E,0x07,0xFD,0xBC,0x49,0xFF,
+0xFE,0xCF,0x3E,0x67,0xEA,0xD9,0x3E,0x67,0xFD,0xBC,0x2E,0x67,0xFC,0x18,0xCE,0x4A,
+0x2E,0x77,0xEA,0xD1,0x5A,0x78,0x01,0x20,0x2E,0x07,0xF8,0x6E,0x5C,0xF0,0x00,0x32,
+0xE9,0x41,0x2E,0x07,0xEA,0xD3,0x3E,0x67,0xF8,0x6E,0x3E,0x67,0xFD,0xBC,0xC8,0x04,
+0x49,0xFF,0xFC,0xDE,0xD5,0x08,0x80,0x06,0x3E,0x67,0xEA,0xD3,0x49,0xFF,0xFC,0xD8,
+0x49,0xFF,0xFA,0x8A,0x49,0xFF,0xFE,0x62,0x84,0x01,0x3E,0x77,0xEA,0xD9,0x3E,0x07,
+0xFD,0xBC,0xD5,0x28,0x49,0xFF,0xFD,0x6C,0x3E,0x67,0xEA,0xDF,0x49,0xFF,0xFC,0x66,
+0x80,0x06,0x49,0xFF,0xFA,0x56,0x3C,0x1D,0xFA,0xFF,0x84,0x01,0x3E,0x07,0xFD,0xBD,
+0x3C,0x6F,0xFB,0x35,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xA6,0x08,0x5A,0x00,0x01,0xFF,
+0x3C,0x6D,0xFB,0x35,0x5A,0x68,0x01,0xFE,0x3C,0x0C,0x02,0xEE,0x3C,0x1C,0x02,0xF0,
+0x49,0x00,0x06,0x6D,0x84,0x00,0x49,0xFF,0xFC,0xAB,0x3E,0x67,0xFC,0x10,0x3E,0x67,
+0xEA,0xA7,0x3C,0x0D,0xFF,0x07,0x00,0x00,0x00,0x29,0x5A,0x08,0x01,0x13,0x3C,0x07,
+0xFE,0x0A,0x3C,0x17,0xFD,0xC7,0xE0,0x20,0xE8,0x03,0x3C,0x0B,0xFD,0xC7,0x44,0x11,
+0x1E,0x53,0x96,0x01,0x96,0x80,0xA6,0xC8,0x92,0x08,0xAE,0x88,0xA6,0x89,0xAE,0x09,
+0xFC,0xA0,0xFC,0x40,0x44,0x41,0xB8,0x00,0x2E,0x60,0x22,0xB0,0x2E,0x37,0xFD,0xBB,
+0x84,0x20,0x80,0xE4,0x96,0x88,0xE2,0x46,0xE8,0x19,0x98,0x81,0x5A,0x38,0x01,0x05,
+0x00,0x51,0x00,0x20,0xD5,0x03,0x38,0x50,0x04,0x00,0x40,0x92,0x04,0x00,0x10,0x54,
+0x81,0x60,0x5A,0x38,0x01,0x05,0x00,0x21,0x00,0x28,0xD5,0x03,0x00,0x21,0x00,0x08,
+0x99,0x79,0x8C,0x21,0x10,0x22,0x81,0x68,0xD5,0xE6,0xFC,0xC0,0xFC,0x41,0xA6,0x81,
+0x8E,0x43,0xE6,0x4C,0x4E,0xF2,0x02,0x28,0x80,0xC3,0x80,0xE0,0x44,0xF0,0x3E,0x6C,
+0x38,0x27,0x89,0x01,0x40,0xF1,0x3C,0x00,0x4A,0x00,0x3C,0x00,0x18,0x00,0x12,0x01,
+0x38,0x04,0x46,0x02,0xE0,0x02,0x38,0x04,0x38,0x04,0x00,0x03,0x46,0x03,0x38,0x04,
+0x38,0x04,0xA6,0x03,0x00,0x01,0x80,0x1C,0x5A,0x00,0x01,0x04,0x48,0x00,0x02,0x0C,
+0x3C,0x0D,0xFB,0x14,0xA6,0x00,0xC8,0x26,0x3C,0x0D,0xFA,0xFF,0xA6,0x00,0x5A,0x08,
+0x01,0x22,0x49,0x00,0x12,0x4E,0x2E,0x00,0x21,0xDA,0xC8,0x0A,0x2E,0x07,0xEA,0xBA,
+0x5A,0x08,0x01,0x10,0x44,0x01,0x81,0xC6,0x49,0x00,0x16,0xFD,0xD5,0x0A,0x5A,0x08,
+0x01,0xE9,0x04,0x93,0x00,0x03,0x49,0x00,0x18,0x69,0xE2,0x09,0xE8,0xF0,0xD5,0xE1,
+0x84,0x01,0x84,0x40,0x80,0x20,0x80,0x62,0x80,0x80,0x80,0xA2,0x49,0x00,0x12,0x39,
+0xD5,0xD8,0x2E,0x00,0x21,0xDA,0x5A,0x00,0x01,0x04,0x48,0x00,0x01,0xDD,0xA1,0xB3,
+0x49,0x00,0x18,0x54,0xE2,0x06,0x4E,0xF2,0x01,0xD7,0x49,0xFF,0xE9,0x1B,0x4E,0x03,
+0x01,0xD3,0x3C,0x0D,0xFA,0xFF,0x84,0x22,0xAE,0x40,0x2E,0x07,0xEA,0xD4,0x5A,0x00,
+0x04,0x0F,0x3C,0x0D,0xFB,0x14,0xA6,0x00,0xC8,0x04,0x49,0x00,0x12,0x12,0xD5,0xFA,
+0x84,0x04,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF5,0x94,0x84,0x01,0x49,0x00,
+0x09,0x4B,0x84,0x01,0x49,0x00,0x09,0x37,0x3C,0x1D,0xFA,0xD5,0x44,0x0F,0x03,0xFF,
+0x84,0xC0,0xA0,0x8D,0x84,0xE1,0xFE,0x16,0x58,0x00,0x04,0x00,0xA8,0x0D,0x84,0x00,
+0x3E,0x07,0xEA,0xD7,0x3C,0x0D,0xFA,0xFF,0x3C,0x6F,0xFA,0xE3,0xAF,0xC0,0x49,0x00,
+0x17,0xB6,0x49,0x00,0x17,0x23,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xEA,0xBD,0x3C,0x0D,
+0xFA,0xFF,0x84,0x28,0x80,0x46,0xAF,0xC0,0x84,0x02,0x48,0x00,0x00,0xC5,0x84,0x06,
+0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF5,0x65,0x2E,0x00,0x21,0x6F,0x3C,0x1D,
+0xFB,0x33,0x8E,0x01,0xE2,0x20,0xE8,0x14,0x49,0x00,0x11,0xD3,0x2E,0x07,0xEA,0xBA,
+0x5A,0x08,0x01,0x06,0x44,0x01,0x81,0xC6,0x49,0x00,0x16,0x85,0x84,0x01,0x84,0x40,
+0x80,0x20,0x80,0x62,0x80,0x80,0x80,0xA2,0x49,0x00,0x11,0xCB,0xD5,0xE7,0x84,0x04,
+0xAE,0x39,0x85,0x21,0x3C,0x0D,0xFB,0x0A,0x3E,0x97,0xEA,0xAB,0x49,0xFF,0xF5,0x42,
+0x3C,0x0D,0xFA,0xFF,0x84,0x40,0x80,0x62,0x10,0x90,0x00,0x00,0x84,0x01,0x80,0x20,
+0x80,0x80,0x80,0xA2,0x49,0x00,0x11,0xB5,0x49,0x00,0x17,0x71,0x80,0x07,0x44,0x11,
+0xA9,0x30,0x49,0x00,0x18,0x5B,0x2E,0x07,0xEA,0xC5,0x5A,0x08,0x01,0x54,0x84,0x20,
+0x3C,0x0D,0xFB,0x0A,0x49,0x00,0x14,0x60,0x84,0x03,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,
+0x49,0xFF,0xF5,0x20,0x84,0x00,0x49,0x00,0x08,0xC6,0x49,0x00,0x17,0xBF,0xE6,0x02,
+0x84,0x00,0xE9,0x04,0x49,0x00,0x17,0xBA,0x8E,0x02,0xA8,0x33,0x44,0x11,0x9C,0x68,
+0x44,0x01,0x9B,0xC8,0x84,0x43,0x84,0x61,0x49,0x00,0x17,0x3E,0x44,0x01,0x82,0xC0,
+0x84,0x29,0x49,0xFF,0xF5,0x63,0x49,0x00,0x12,0xA0,0x3C,0x0D,0xFB,0x37,0xE6,0x03,
+0xE8,0x04,0x49,0x00,0x11,0x76,0xD5,0xFA,0x44,0x11,0x82,0xC0,0x3C,0x0D,0xFA,0xE3,
+0x49,0xFF,0xF3,0xF1,0x84,0x01,0x49,0xFF,0xF3,0xA1,0x3C,0x1D,0xFB,0x14,0x44,0x0F,
+0xFF,0xAA,0x3E,0x07,0xEA,0xBD,0x84,0x00,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,
+0x44,0x01,0x9B,0xC8,0x49,0x00,0x17,0x02,0x44,0x01,0x82,0xC0,0x84,0x2C,0x49,0xFF,
+0xF5,0x3D,0x84,0x00,0x49,0x00,0x08,0x98,0x84,0x02,0x3E,0x07,0xEA,0xE0,0x48,0x00,
+0x01,0x03,0x84,0x06,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF4,0xD3,0x48,0x00,
+0x00,0xFB,0xA6,0x08,0x3C,0x1D,0xFB,0x14,0xC8,0x2A,0x2E,0x07,0xEA,0xC5,0xC8,0x27,
+0x00,0x21,0x80,0x22,0xCA,0x24,0x84,0x02,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xF2,0x81,
+0xAE,0x08,0x3C,0x0D,0xFB,0x0A,0x84,0x21,0x3C,0x2B,0xF5,0x7A,0x49,0x00,0x13,0xF4,
+0x84,0x04,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF4,0xB4,0x3C,0x1D,0xFB,0x14,
+0xF2,0x01,0x84,0x01,0x3C,0x2F,0xFA,0xE3,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,
+0x84,0x02,0x84,0x25,0x84,0x61,0x80,0x82,0x48,0x00,0x00,0xA7,0x84,0x02,0xAE,0x08,
+0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0x00,0x13,0xD4,
+0x84,0x03,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF4,0x94,0x84,0x00,0x49,0x00,
+0x08,0x4B,0x49,0x00,0x12,0x2A,0x49,0x00,0x17,0x31,0xE6,0x02,0x84,0x00,0xE9,0x04,
+0x49,0x00,0x17,0x2C,0x8E,0x02,0xA8,0x33,0x48,0x00,0x00,0xAE,0x44,0x01,0x9B,0xC8,
+0x49,0x00,0x16,0x9C,0x44,0x01,0x82,0xC0,0x84,0x2C,0x49,0xFF,0xF4,0xD7,0x84,0x00,
+0x49,0x00,0x08,0x32,0x84,0x03,0xAE,0x39,0x48,0x00,0x00,0x9E,0x84,0x20,0x3C,0x0D,
+0xFB,0x0A,0x49,0x00,0x13,0xA9,0x84,0x0E,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,
+0xF4,0x69,0x49,0x00,0x12,0x02,0x3C,0x0D,0xFA,0xE3,0x44,0x11,0x82,0xC0,0x49,0xFF,
+0xF3,0x5A,0x49,0x00,0x12,0xE7,0x84,0x01,0x49,0xFF,0xF3,0x08,0x49,0xFF,0xF2,0xF9,
+0xC8,0x04,0x49,0x00,0x10,0xCE,0xD5,0xFB,0x49,0x00,0x12,0xFE,0x49,0x00,0x11,0xED,
+0xD5,0x7A,0xA6,0x00,0x5A,0x08,0x02,0x26,0xA6,0x08,0xC8,0x04,0x2E,0x07,0xEA,0xC5,
+0xC0,0x04,0x2E,0x07,0xEA,0x9D,0xC8,0x68,0x04,0x93,0x00,0x03,0x49,0x00,0x0D,0x4C,
+0xE3,0x20,0xE8,0x04,0x2E,0x07,0xEA,0x9D,0xC8,0x66,0x3C,0x0D,0xFB,0x14,0xA6,0x00,
+0xC8,0x04,0x49,0x00,0x10,0xAE,0xD5,0xFA,0x85,0x20,0x84,0x0A,0x3C,0x9B,0xF5,0x7B,
+0x3C,0x9B,0xF5,0x7A,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF4,0x2B,0xD5,0x20,
+0x84,0x00,0x10,0x01,0x80,0x1D,0x84,0x40,0x84,0x01,0x84,0x2A,0x80,0x62,0x80,0x80,
+0xD5,0x23,0xA6,0x08,0xC8,0x04,0x2E,0x07,0xEA,0xC5,0xC0,0x04,0x2E,0x07,0xEA,0x9D,
+0xC8,0x1F,0x84,0x0A,0x85,0x20,0x3C,0x9B,0xF5,0x7A,0xAE,0x39,0x3C,0x0D,0xFB,0x0A,
+0x49,0xFF,0xF4,0x10,0x3C,0x0D,0xFB,0x0A,0x84,0x21,0x49,0x00,0x13,0x45,0x84,0xE0,
+0x10,0x93,0x00,0x1D,0xA9,0xF3,0x49,0x00,0x16,0x90,0xF0,0x81,0x84,0x61,0x84,0x02,
+0xF1,0x01,0x80,0x47,0x80,0x83,0x80,0xA2,0x49,0x00,0x10,0x7B,0xD5,0x24,0x84,0x0B,
+0xAE,0x39,0x49,0x00,0x11,0x92,0x3C,0x0D,0xFA,0xE3,0x44,0x11,0x82,0xC0,0x49,0xFF,
+0xF2,0xEA,0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0x00,0x13,0x26,0x49,0x00,0x12,0x72,
+0x84,0x01,0x49,0xFF,0xF2,0x93,0x49,0xFF,0xF2,0x84,0xC8,0x04,0x49,0x00,0x10,0x59,
+0xD5,0xFB,0x49,0x00,0x11,0x7A,0x84,0x00,0xA8,0x33,0x84,0x01,0x10,0x03,0x00,0x1D,
+0x49,0x00,0x0C,0xBC,0xFC,0xC1,0x92,0x00,0xFC,0x00,0x49,0xFF,0xF2,0x72,0xC8,0x04,
+0x49,0x00,0x10,0x47,0xD5,0xFB,0xFC,0x80,0xFC,0x40,0x81,0x20,0x80,0xC2,0x49,0x00,
+0x10,0x61,0x80,0xE0,0x49,0xFF,0xFF,0xF2,0x50,0x04,0xFF,0xFF,0xE6,0x0A,0x4E,0xF2,
+0x01,0x55,0x44,0xF0,0x42,0xE0,0x38,0x07,0x81,0x01,0x40,0xF0,0x3C,0x00,0xDD,0x0F,
+0x14,0x00,0x38,0x00,0xFA,0x00,0xCC,0x01,0x6A,0x00,0xF0,0x01,0x00,0x02,0x3C,0x02,
+0x34,0x02,0x64,0x02,0xFA,0x01,0xAE,0x31,0x84,0x05,0xAE,0x30,0x84,0x00,0x10,0x03,
+0x80,0x50,0x49,0x00,0x05,0x21,0x5A,0x08,0x02,0x05,0x49,0x00,0x10,0x1A,0xD5,0xFA,
+0x84,0x00,0x49,0x00,0x04,0xDB,0xD5,0x0F,0xFA,0x01,0xAE,0x31,0x84,0x06,0xAE,0x30,
+0x84,0x00,0x10,0x03,0x80,0x50,0x80,0xA7,0x50,0x03,0x80,0x41,0x84,0x3F,0x18,0x12,
+0x80,0x01,0xD8,0xFE,0x80,0x06,0x84,0x21,0x49,0x00,0x12,0xC6,0x84,0x20,0x84,0x02,
+0x80,0x41,0x84,0x61,0x80,0x81,0x48,0x00,0x01,0x16,0x49,0xFF,0xF3,0xEC,0x84,0xE0,
+0x84,0x01,0x3E,0x77,0xEA,0xDD,0xAE,0x30,0x2E,0x07,0xEA,0xDD,0x84,0x81,0x2E,0x17,
+0xEA,0xD4,0x44,0x51,0x82,0xC0,0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,
+0xF1,0xA9,0x2E,0x07,0xEA,0xC8,0x49,0xFF,0xF2,0xFA,0x3C,0x03,0xF5,0x80,0x49,0xFF,
+0xF2,0xFC,0x84,0x00,0x3E,0x77,0xFD,0xB9,0x3C,0x0F,0xFF,0x6A,0x49,0x00,0x27,0x45,
+0x2E,0x17,0xFD,0xBC,0x5A,0x00,0xA1,0x03,0xC9,0x04,0x84,0x01,0x3E,0x07,0xEA,0xB4,
+0x5A,0x10,0x01,0x08,0x84,0x01,0x3E,0x07,0xFC,0x10,0x84,0x00,0x49,0x00,0x06,0xFB,
+0x3C,0x1D,0xFB,0x14,0x84,0x02,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0xA6,0x31,
+0x50,0x10,0x7F,0xF7,0xE6,0x23,0xE9,0x05,0x5A,0x00,0x0E,0x04,0x48,0x00,0x00,0xD6,
+0x80,0x06,0x49,0x00,0x10,0xBC,0x48,0x00,0x00,0xD1,0x3C,0x1D,0xFB,0x16,0xA6,0x08,
+0x54,0x00,0x00,0xEF,0xAE,0x08,0x84,0x02,0xAE,0x30,0x84,0x00,0x49,0x00,0x06,0xEC,
+0xA6,0x31,0x9E,0x43,0xE6,0x25,0xE9,0x0A,0x5A,0x00,0x10,0x09,0x5A,0x08,0x11,0x09,
+0x49,0x00,0x14,0x22,0x84,0x00,0x49,0x00,0x11,0x78,0x84,0x09,0xD5,0x02,0x84,0x0A,
+0xAE,0x31,0x84,0x00,0x10,0x03,0x80,0x50,0x3E,0x07,0xEA,0xD7,0x49,0xFF,0xF3,0x83,
+0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF3,0x16,0x3C,0x1D,0xFA,0xD5,0x44,0x0F,0x03,0xFF,
+0xA0,0x8D,0xFE,0x16,0x58,0x00,0x04,0x00,0xA8,0x0D,0x84,0x02,0x3E,0x07,0xFC,0xD1,
+0x49,0x00,0x0E,0x7C,0x49,0x00,0x04,0x80,0x5A,0x08,0x02,0x05,0x49,0x00,0x0F,0x79,
+0xD5,0xFA,0x84,0x00,0x3E,0x07,0xFD,0xB9,0x84,0x00,0x3C,0x0F,0xFF,0x6A,0x2E,0x07,
+0xEA,0xEA,0xC8,0x04,0x84,0x01,0x3E,0x07,0xEA,0xB4,0x2E,0x07,0xFD,0xBC,0x5A,0x00,
+0x01,0x08,0x84,0x01,0x3E,0x07,0xFC,0x10,0x84,0x00,0x49,0x00,0x06,0x94,0x80,0x06,
+0x84,0x21,0x49,0x00,0x12,0x21,0x3C,0x0D,0xFB,0x0D,0x5A,0x00,0x04,0x04,0x5A,0x08,
+0x07,0x08,0x84,0x40,0x84,0x02,0x84,0x21,0x80,0x62,0x84,0x8F,0xD5,0x6B,0x84,0x40,
+0x84,0x02,0xFA,0x25,0x80,0x62,0x84,0x8F,0x84,0xA1,0xD5,0x65,0x3C,0x1D,0xFB,0x16,
+0xA6,0x08,0x54,0x00,0x00,0xEF,0xAE,0x08,0x84,0x0B,0xAE,0x31,0x84,0x03,0xAE,0x30,
+0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF2,0xC6,0x84,0x01,0x49,0xFF,0xE6,0x3C,0xD5,0x55,
+0x84,0x00,0x3E,0x07,0xEA,0xDD,0x3E,0x07,0xEA,0xC2,0x49,0xFF,0xF2,0x22,0xD5,0x25,
+0x84,0x00,0x3E,0x07,0xEA,0xDD,0x84,0x01,0x3E,0x07,0xEA,0xC2,0x49,0xFF,0xF1,0xCA,
+0x2E,0x07,0xEA,0xDD,0x84,0x81,0x2E,0x17,0xEA,0xD4,0x44,0x51,0x82,0xC0,0x2E,0x27,
+0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,0xF0,0xDD,0x44,0x00,0x00,0x40,0x49,0xFF,
+0xF1,0xE3,0xD5,0x33,0x84,0x00,0x3E,0x07,0xEA,0xDD,0xD5,0x05,0x84,0x00,0x3E,0x07,
+0xEA,0xDD,0x84,0x01,0x3E,0x07,0xEA,0xAA,0x2E,0x07,0xEA,0xDD,0x84,0x81,0x2E,0x17,
+0xEA,0xD4,0x44,0x51,0x82,0xC0,0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,
+0xF0,0xC1,0xD5,0x1B,0xFA,0x01,0xAE,0x31,0x84,0x06,0xAE,0x30,0x80,0xA7,0x50,0x03,
+0x80,0x41,0x84,0x3F,0x18,0x12,0x80,0x01,0xD8,0xFE,0x80,0x06,0x84,0x21,0x49,0x00,
+0x11,0xB3,0x84,0x00,0x84,0x20,0x84,0x61,0x10,0x03,0x80,0x50,0x80,0x41,0x84,0x02,
+0x80,0x83,0x80,0xA1,0x49,0x00,0x0E,0xED,0xFC,0xC0,0x92,0x00,0xFC,0x43,0x80,0xC0,
+0x2E,0x07,0xEA,0xE7,0x81,0x21,0xF2,0x83,0xF3,0x84,0xF4,0x85,0x80,0xE5,0x5A,0x08,
+0x01,0x0A,0x80,0x22,0x44,0x01,0x81,0xA7,0x80,0x43,0x80,0x64,0x80,0x85,0x49,0x00,
+0x28,0x47,0x44,0x0F,0xFF,0xAA,0x3C,0x1D,0xFB,0x0A,0x3E,0x07,0xEA,0xE4,0x44,0x21,
+0x81,0x7A,0xF3,0x03,0xF4,0x04,0xF5,0x05,0xB6,0xFF,0x44,0x01,0x82,0xF0,0x49,0x00,
+0x26,0xB5,0x96,0x00,0x3E,0x07,0xEA,0xDA,0x49,0x00,0x26,0x31,0x2E,0x17,0xEA,0xDA,
+0x5A,0x10,0x01,0x05,0x84,0x01,0x3C,0x0F,0xFB,0x25,0xA7,0xF1,0x5A,0x78,0x09,0x44,
+0xA6,0x30,0x5A,0x00,0x02,0x04,0x48,0x00,0x01,0x87,0x3C,0x0D,0xFB,0x0D,0x5A,0x08,
+0x06,0x29,0x49,0x00,0x03,0xA9,0xC8,0x1A,0x84,0x0A,0x84,0x20,0xAE,0x31,0x80,0x06,
+0x49,0x00,0x11,0x62,0x49,0x00,0x13,0x8E,0x80,0x06,0x84,0x20,0x49,0x00,0x11,0x5C,
+0x49,0x00,0x13,0x88,0x49,0x00,0x13,0xCA,0x84,0x00,0x3E,0x07,0xFC,0x20,0x3C,0x0D,
+0xFA,0xFF,0x84,0x21,0xAE,0x40,0x48,0x00,0x00,0x7D,0x49,0x00,0x0F,0xF6,0x84,0x00,
+0x49,0x00,0x03,0x4C,0x49,0x00,0x03,0x88,0xC0,0xE0,0x49,0x00,0x0E,0x82,0xD5,0xFB,
+0x5A,0x00,0x09,0x04,0x48,0x00,0x01,0x4E,0x49,0x00,0x03,0x7E,0x5A,0x00,0x02,0x04,
+0x48,0x00,0x01,0x48,0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0x00,0x11,0x35,0x84,0x03,
+0xAE,0x31,0xD5,0x48,0x5A,0x78,0x0A,0x6B,0xA6,0x30,0x5A,0x00,0x02,0x04,0x48,0x00,
+0x01,0x43,0x3C,0x0D,0xFB,0x0D,0x8E,0x06,0xE6,0x02,0x4E,0xF2,0x01,0x33,0x80,0x06,
+0x49,0x00,0x16,0x41,0x2E,0x07,0xEA,0xB4,0x5A,0x08,0x01,0x04,0x3E,0x07,0xEA,0xC5,
+0x2E,0x77,0xEA,0xC5,0x5A,0x78,0x01,0x32,0x84,0x20,0x3C,0x0D,0xFB,0x0A,0x49,0x00,
+0x11,0x13,0x84,0x0B,0xAE,0x31,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF1,0xD3,0x49,0x00,
+0x0F,0x6C,0x3C,0x0D,0xFA,0xE3,0x44,0x11,0x82,0xC0,0x49,0xFF,0xF0,0xC4,0x49,0x00,
+0x10,0x51,0x80,0x07,0x49,0xFF,0xF0,0x72,0x49,0xFF,0xF0,0x63,0xC8,0x04,0x49,0x00,
+0x0E,0x38,0xD5,0xFB,0x49,0x00,0x0F,0x59,0x84,0xC1,0x84,0x00,0x14,0x04,0x80,0x03,
+0x10,0x64,0x80,0x1D,0x3E,0x67,0xEA,0x9D,0x49,0x00,0x0A,0x98,0x3C,0x0D,0xFA,0xFF,
+0xAF,0x80,0x84,0x08,0x48,0x00,0x01,0x01,0x3C,0x73,0xF5,0x7B,0xA6,0x31,0x49,0x00,
+0x14,0x39,0xE2,0xE0,0xE9,0x03,0x49,0x00,0x13,0x2F,0x3C,0x73,0xF5,0x7A,0xA6,0x31,
+0x49,0x00,0x14,0x3A,0xE2,0xE0,0xE9,0x05,0x84,0x00,0x14,0x04,0x80,0x03,0xD5,0xEA,
+0x49,0x00,0x14,0x23,0xF0,0x83,0x84,0x40,0x84,0x61,0x84,0x02,0xF1,0x03,0x80,0x83,
+0x80,0xA2,0x49,0x00,0x0E,0x0E,0x48,0x00,0x00,0xD5,0x5A,0x78,0x0F,0x24,0xA7,0xF0,
+0x5A,0x70,0x01,0x04,0x48,0x00,0x00,0xD8,0x44,0x01,0x81,0x66,0x44,0x11,0x81,0xBE,
+0x49,0x00,0x0F,0xC4,0x44,0x01,0x81,0x7A,0x44,0x11,0x81,0x81,0x49,0x00,0x0F,0xAC,
+0x3C,0x0D,0xFB,0x0D,0x5A,0x08,0x09,0xC7,0x49,0x00,0x02,0xEE,0x5A,0x08,0x02,0xC3,
+0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0x00,0x10,0xA7,0x84,0x03,0xAE,0x31,0x80,0x07,
+0xD5,0x2F,0x5A,0x78,0x0B,0x27,0xA6,0x30,0x5A,0x00,0x03,0x04,0x48,0x00,0x00,0xB4,
+0x84,0x0A,0xAE,0x31,0x84,0x20,0x3C,0x0D,0xFB,0x0A,0x49,0x00,0x10,0x95,0xAF,0xF1,
+0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF1,0x56,0x49,0x00,0x0E,0xEF,0x3C,0x0D,0xFA,0xE3,
+0x44,0x11,0x82,0xC0,0x49,0xFF,0xF0,0x47,0x49,0x00,0x0F,0xD4,0x84,0x01,0x49,0xFF,
+0xEF,0xF5,0x49,0xFF,0xEF,0xE6,0x4E,0x03,0xFF,0x87,0x49,0x00,0x0D,0xBA,0xD5,0xFA,
+0x5A,0x78,0x03,0x0B,0xA6,0x30,0x5A,0x00,0x01,0x04,0x48,0x00,0x00,0x8D,0x49,0x00,
+0x05,0x02,0x48,0xFF,0xFF,0x88,0x5A,0x70,0x04,0x04,0x48,0x00,0x00,0x85,0xA6,0x30,
+0x5A,0x00,0x01,0x04,0x48,0x00,0x00,0x80,0x3C,0x0D,0xFB,0x0D,0x8E,0x06,0xE6,0x02,
+0x4E,0xF2,0xFF,0x79,0x80,0x06,0x49,0x00,0x15,0x7E,0x2E,0x07,0xEA,0xC5,0x5A,0x08,
+0x01,0x49,0x84,0x20,0x3C,0x0D,0xFB,0x0A,0x49,0x00,0x10,0x56,0x84,0x07,0xAE,0x31,
+0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xF1,0x16,0x84,0x00,0x49,0x00,0x04,0xBC,0x49,0x00,
+0x13,0xB5,0xE6,0x02,0x84,0x00,0xE9,0x04,0x49,0x00,0x13,0xB0,0x8E,0x02,0x14,0x04,
+0x80,0x03,0x44,0x11,0x9C,0x68,0x44,0x01,0x9B,0xC8,0x84,0x43,0x84,0x61,0x49,0x00,
+0x13,0x33,0x44,0x01,0x82,0xC0,0x84,0x29,0x49,0xFF,0xF1,0x58,0x49,0x00,0x0E,0x95,
+0x3C,0x0D,0xFB,0x37,0xE6,0x03,0xE8,0x04,0x49,0x00,0x0D,0x6B,0xD5,0xFA,0x44,0x11,
+0x82,0xC0,0x3C,0x0D,0xFA,0xE3,0x49,0xFF,0xEF,0xE6,0x84,0x01,0x49,0xFF,0xEF,0x96,
+0x3C,0x1D,0xFB,0x14,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xEA,0xBD,0x84,0x00,0xAE,0x08,
+0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x84,0x02,0x3E,0x07,0xEA,0xE0,0x48,0xFF,0xFF,0x2B,
+0x3C,0x73,0xF5,0x7B,0xA6,0x31,0x49,0x00,0x13,0x65,0xE2,0xE0,0xE9,0x03,0x49,0x00,
+0x12,0x5B,0x3C,0x0D,0xFA,0xFF,0x84,0x21,0xAE,0x40,0x3C,0x73,0xF5,0x7A,0xA6,0x31,
+0x49,0x00,0x13,0x62,0xE2,0xE0,0xE9,0x07,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xEA,0xBD,
+0x48,0xFF,0xFF,0x11,0x84,0x40,0x84,0x02,0x84,0x28,0x84,0x61,0x80,0x82,0xD5,0x06,
+0x84,0x61,0x84,0x02,0xFA,0x25,0x84,0x40,0x80,0x83,0x80,0xA2,0x49,0x00,0x0D,0x31,
+0x48,0xFF,0xFF,0x01,0x84,0x01,0xFC,0xC3,0x44,0x01,0x1F,0xC0,0x3C,0x0F,0xFA,0xE6,
+0x44,0x01,0xF0,0x89,0x44,0x1F,0xFF,0xC0,0xAE,0x40,0x44,0x01,0xF0,0x8A,0xFA,0x2F,
+0xAE,0x40,0xDD,0x9E,0x3C,0x1D,0xFA,0xE7,0xA6,0x82,0x10,0x20,0x80,0x0C,0xA6,0x83,
+0x10,0x20,0x80,0x0D,0xA6,0x80,0xA6,0x01,0x10,0x20,0x80,0x0E,0x10,0x00,0x80,0x0F,
+0xDD,0x9E,0x3C,0x1D,0xFA,0xE7,0xA6,0x82,0x10,0x20,0x80,0x10,0xA6,0x83,0x10,0x20,
+0x80,0x11,0xA6,0x80,0xA6,0x01,0x10,0x20,0x80,0x12,0x10,0x00,0x80,0x13,0xDD,0x9E,
+0x3C,0x1D,0xFA,0xE7,0xA6,0x82,0x10,0x20,0x80,0x14,0xA6,0x83,0x10,0x20,0x80,0x15,
+0xA6,0x80,0xA6,0x01,0x10,0x20,0x80,0x16,0x10,0x00,0x80,0x17,0xDD,0x9E,0xFC,0x01,
+0xB6,0x3F,0xF2,0x81,0x49,0xFF,0xFF,0xD0,0xB4,0x1F,0x49,0xFF,0xFF,0xDC,0xF0,0x01,
+0x49,0xFF,0xFF,0xE8,0xFC,0x81,0x3C,0x1D,0xFF,0x09,0x54,0x10,0x80,0x2F,0xFE,0x0F,
+0x3C,0x1D,0xFA,0xE7,0x3C,0x0F,0xFF,0x09,0x10,0x00,0x80,0x0A,0xDD,0x9E,0x3C,0x1D,
+0xFF,0x09,0x54,0x10,0x80,0xF0,0xFE,0x0F,0x3C,0x1D,0xFA,0xE7,0x3C,0x0F,0xFF,0x09,
+0x10,0x00,0x80,0x0A,0xDD,0x9E,0x3C,0x1D,0xFF,0x09,0x54,0x10,0x80,0xF0,0x5A,0x18,
+0x10,0x05,0x3C,0x1D,0xFA,0xE7,0xAC,0x0C,0xDD,0x9E,0xFC,0x02,0xF1,0x81,0x3C,0x1D,
+0xFA,0xE6,0x84,0xC0,0xF3,0x83,0xAD,0x8B,0xF2,0x82,0x3C,0x1F,0xFA,0xE7,0x49,0xFF,
+0xFF,0xD4,0xF0,0x01,0xF1,0x02,0xF2,0x03,0x49,0xFF,0xFF,0xC3,0x80,0x06,0x49,0xFF,
+0xFF,0xE4,0xFC,0x82,0xFC,0x40,0x81,0x40,0x84,0x01,0x81,0x21,0x80,0xE2,0x80,0xC3,
+0x49,0xFF,0xFF,0xCF,0x3C,0x4D,0xFA,0xE7,0x44,0x01,0xF0,0x88,0x84,0x21,0x12,0xA2,
+0x00,0x00,0x12,0x92,0x00,0x01,0xAD,0xE2,0x10,0x62,0x00,0x0B,0xAE,0x40,0xFC,0xC0,
+0xFC,0x40,0x81,0x20,0x84,0x02,0x80,0xE1,0x80,0xC2,0x49,0xFF,0xFF,0xBA,0x3C,0x3D,
+0xFA,0xE7,0x84,0x00,0x84,0x21,0xAC,0x19,0x44,0x01,0xF0,0x88,0x12,0x91,0x80,0x00,
+0xAD,0xDA,0x10,0x61,0x80,0x0B,0xAE,0x40,0xFC,0xC0,0xFC,0x02,0x96,0x90,0xB6,0x1F,
+0x10,0x2F,0x80,0x08,0x84,0x01,0x10,0x2F,0x80,0x0B,0x10,0x2F,0x80,0x0C,0x10,0x2F,
+0x80,0x0F,0xB0,0x83,0x80,0x62,0xF1,0x81,0x10,0x0F,0x80,0x0A,0xB0,0x42,0x10,0x0F,
+0x80,0x09,0x10,0x0F,0x80,0x0E,0x10,0x0F,0x80,0x0D,0xFA,0x00,0x49,0xFF,0xFF,0xA7,
+0x49,0x00,0x0C,0x5F,0xF1,0x01,0xB4,0x1F,0x84,0x40,0x49,0xFF,0xFF,0xCB,0x44,0x11,
+0xF0,0x88,0xA6,0x08,0x5A,0x00,0x01,0xFF,0xFC,0x82,0xFC,0x02,0xB6,0x1F,0x84,0x01,
+0x10,0x0F,0x80,0x0E,0x2E,0x00,0x21,0x4F,0xF1,0x81,0x10,0x0F,0x80,0x0C,0x10,0x0F,
+0x80,0x0F,0x2E,0x00,0x21,0x50,0xB0,0x43,0x80,0x41,0x80,0x61,0x10,0x0F,0x80,0x0D,
+0xFA,0x00,0x49,0xFF,0xFF,0x84,0x49,0x00,0x0C,0x3C,0xF1,0x01,0xB4,0x1F,0x84,0x40,
+0x49,0xFF,0xFF,0xA8,0x44,0x11,0xF0,0x88,0xA6,0x08,0x5A,0x00,0x01,0xFF,0xFC,0x82,
+0xFC,0x03,0xB6,0x1F,0x84,0x01,0x10,0x0F,0x80,0x16,0x2E,0x00,0x21,0x4F,0xF1,0x81,
+0x10,0x0F,0x80,0x14,0x10,0x0F,0x80,0x17,0x2E,0x00,0x21,0x50,0x84,0x20,0x10,0x0F,
+0x80,0x15,0x3C,0x0D,0xFA,0xE7,0xF2,0x82,0xF3,0x83,0x12,0x10,0x00,0x0C,0x12,0x10,
+0x00,0x0D,0xB0,0x45,0x80,0x41,0x80,0x61,0x84,0x00,0x49,0xFF,0xFF,0x58,0xF1,0x01,
+0xB4,0x1F,0xF2,0x02,0xF3,0x03,0x49,0xFF,0xFF,0x67,0x49,0x00,0x0C,0x0A,0x44,0x11,
+0xF0,0x88,0xA6,0x08,0xC8,0xFF,0xFC,0x83,0xFC,0x00,0x49,0x00,0x0C,0x02,0x44,0x11,
+0xF4,0x4C,0xA6,0x08,0x5A,0x00,0x01,0xFF,0x44,0x11,0xF6,0x8C,0x44,0x01,0xF6,0x91,
+0x84,0x41,0xAE,0x88,0xAE,0x80,0xA6,0x88,0xA6,0xC0,0xFE,0x9F,0xCA,0xFD,0xFC,0x80,
+0xFC,0x40,0x44,0x71,0xF6,0x8D,0x44,0x61,0xF6,0x92,0x94,0x4A,0xA7,0x78,0xFE,0x8F,
+0x00,0x93,0x00,0x00,0x94,0x07,0x84,0x90,0xFE,0x17,0x96,0x00,0xFF,0x66,0x40,0x44,
+0x90,0x02,0xFF,0x47,0xFF,0x07,0x44,0x01,0xF6,0x90,0x96,0xD8,0xAF,0x78,0xAF,0x30,
+0xAE,0xC0,0x44,0x01,0xF6,0x93,0xAE,0xC0,0xFC,0xC0,0xC8,0x04,0x44,0x01,0xF6,0x96,
+0xD5,0x03,0x44,0x01,0xF6,0x97,0xA6,0x00,0x96,0x00,0xDD,0x9E,0x44,0x11,0xF6,0x96,
+0x84,0x00,0xAE,0x08,0x44,0x11,0xF6,0x97,0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF6,0x30,
+0x84,0x21,0xAE,0x40,0xDD,0x9E,0x44,0x11,0xF1,0xE8,0x96,0x00,0xAE,0x08,0xDD,0x9E,
+0x44,0x11,0xF1,0xE9,0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x11,0xF1,0xEA,0x96,0x00,
+0xAE,0x08,0xDD,0x9E,0x44,0x11,0xF1,0xEB,0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x11,
+0xF1,0xF8,0x96,0x81,0xAC,0x88,0x80,0x02,0xDD,0x9E,0x44,0x11,0xF1,0x10,0xA6,0x08,
+0x58,0x00,0x00,0x01,0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF1,0x10,0xA6,0x00,0xFE,0x03,
+0x96,0x06,0xDD,0x9E,0x44,0x01,0xF1,0x11,0xA6,0x00,0x92,0x02,0x96,0x06,0xDD,0x9E,
+0x44,0x01,0xF1,0x11,0xA6,0x00,0x92,0x04,0x96,0x06,0xDD,0x9E,0xFC,0x20,0x00,0x30,
+0x00,0x09,0x44,0x11,0xF1,0x10,0x96,0xC6,0x95,0x19,0xA6,0xC8,0x00,0x20,0x00,0x0A,
+0x54,0x31,0x80,0xFD,0xFE,0xE7,0x3C,0x1F,0xFA,0xCE,0x96,0x86,0xAE,0xC8,0x94,0xD2,
+0xA6,0x88,0x80,0xC1,0x54,0x21,0x00,0xFB,0xFE,0x9F,0xAE,0x88,0xA4,0xC0,0x44,0x21,
+0xF1,0x14,0x84,0xFE,0xAC,0xD0,0xA4,0xC2,0x44,0x21,0xF1,0x16,0xAC,0xD0,0x00,0x20,
+0x00,0x08,0x44,0x01,0xF1,0x13,0xAE,0x80,0x49,0xFF,0xFF,0xD4,0x5A,0x00,0x01,0x05,
+0x49,0x00,0x0B,0x5F,0xD5,0xFA,0x49,0xFF,0xFF,0xBA,0x49,0xFF,0xFF,0xC5,0xC8,0x05,
+0xA6,0x30,0xFE,0x3E,0xAE,0x30,0xD5,0xF1,0x49,0xFF,0xFF,0xB8,0xC0,0xF7,0xFC,0xA0,
+0xFC,0x00,0x44,0x61,0x46,0x00,0xAE,0x70,0x44,0x11,0xA3,0x1C,0xB6,0x01,0x84,0x01,
+0x10,0x00,0x80,0x08,0x10,0x00,0x80,0x0A,0x80,0x01,0xA9,0x89,0x10,0x20,0x80,0x09,
+0x49,0xFF,0xFF,0xB6,0xA6,0x30,0xFC,0x80,0xC8,0x08,0x44,0x11,0x27,0xC5,0xA6,0x08,
+0x8C,0x01,0x96,0x00,0xAE,0x08,0xD5,0x0F,0x44,0x21,0x27,0xC6,0xA6,0x50,0x8C,0x21,
+0x96,0x48,0xAE,0x50,0x5A,0x08,0x01,0x08,0x44,0x11,0xF0,0x66,0xA6,0x08,0x58,0x00,
+0x00,0x04,0xD5,0x06,0x44,0x11,0xF0,0x66,0xA6,0x08,0x54,0x00,0x00,0xFB,0xAE,0x08,
+0xDD,0x9E,0x44,0x01,0xF0,0x67,0xA6,0x00,0x92,0x02,0x96,0x06,0xDD,0x9E,0x44,0x01,
+0xF0,0x67,0xA6,0x00,0x92,0x07,0xDD,0x9E,0x44,0x11,0xF0,0x6D,0x96,0x00,0xAE,0x08,
+0xDD,0x9E,0x44,0x11,0xF0,0x6E,0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x11,0xF0,0x70,
+0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x21,0xF0,0x5C,0xAC,0x10,0x44,0x01,0xF0,0x5E,
+0xAC,0x40,0xDD,0x9E,0xFC,0x00,0x49,0xFF,0xFF,0xE4,0xC8,0x07,0x49,0xFF,0xFF,0xDB,
+0x5A,0x00,0x01,0x06,0x84,0x01,0xD5,0x04,0x84,0x00,0xD5,0x02,0x84,0x02,0xFC,0x80,
+0xFC,0x00,0x44,0x61,0xF6,0x18,0xA4,0x30,0x54,0x00,0x01,0x00,0xC0,0x09,0x44,0x11,
+0x27,0xC4,0xA6,0x08,0x8C,0x01,0x96,0x00,0xAE,0x08,0x84,0x08,0xD5,0x42,0xA4,0x30,
+0x96,0x0E,0xC8,0x38,0xA4,0x30,0x96,0x1E,0xC0,0x09,0x44,0x11,0x27,0xC3,0xA6,0x08,
+0x8C,0x01,0x96,0x00,0xAE,0x08,0x84,0x03,0xD5,0x34,0xA4,0x30,0x96,0x16,0xC0,0x09,
+0x44,0x11,0x27,0xC2,0xA6,0x08,0x8C,0x01,0x96,0x00,0xAE,0x08,0x84,0x02,0xD5,0x29,
+0xA4,0x30,0x96,0x26,0xC0,0x09,0x44,0x11,0x27,0xC1,0xA6,0x08,0x8C,0x01,0x96,0x00,
+0xAE,0x08,0x84,0x04,0xD5,0x1E,0xA4,0x30,0x96,0x06,0xC8,0x03,0x84,0x0A,0xD5,0x19,
+0x49,0x00,0x28,0x6B,0xA4,0x30,0x96,0x36,0xC8,0x0F,0xA4,0x30,0x96,0x2E,0xC8,0x0E,
+0xA4,0x30,0x96,0x3E,0xC8,0x0D,0xA4,0x30,0x54,0x00,0x02,0x00,0xC0,0xF0,0x84,0x09,
+0xD5,0x08,0x84,0x01,0xD5,0x06,0x84,0x06,0xD5,0x04,0x84,0x05,0xD5,0x02,0x84,0x07,
+0x44,0x11,0xF6,0x18,0x84,0x40,0xAC,0x88,0xFC,0x80,0x44,0x01,0xF6,0x64,0x84,0x21,
+0xAE,0x40,0xDD,0x9E,0x44,0x11,0xF6,0x65,0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF6,0x65,
+0xA6,0x00,0xDD,0x9E,0xFC,0x20,0x44,0x71,0xF6,0xB4,0xF6,0x07,0xB6,0x07,0x44,0x01,
+0xF6,0xB8,0xB6,0x20,0x44,0x01,0xF6,0xBC,0xB6,0x40,0x44,0x01,0xF6,0xC0,0xB6,0x60,
+0x44,0x01,0xF6,0xC4,0xB6,0x80,0x44,0x01,0xF6,0xC8,0xB6,0xA0,0xF1,0x06,0x44,0x01,
+0xF6,0xCC,0xB6,0x20,0x44,0x01,0xF6,0xD0,0x96,0x70,0xAE,0x40,0x40,0x03,0x20,0x09,
+0x44,0x11,0xF6,0xD1,0x96,0x00,0xAE,0x08,0x92,0xD0,0x44,0x01,0xF6,0xD2,0x97,0xB0,
+0xAF,0x80,0xFC,0xA0,0xFC,0x00,0x44,0x11,0xF5,0xEC,0x44,0x01,0xF5,0xEE,0x3C,0x0F,
+0xFA,0xE1,0x3C,0x1F,0xFA,0xE2,0xA4,0x88,0x84,0x61,0x58,0x21,0x00,0x40,0xAC,0x88,
+0xA4,0x40,0x58,0x10,0x80,0x40,0xAC,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,
+0x0A,0x96,0xFC,0x80,0xFC,0x20,0x44,0x11,0xF5,0xEC,0x3C,0x1F,0xFA,0xE2,0x44,0x11,
+0xF5,0xEE,0x3C,0x1F,0xFA,0xE1,0x44,0x11,0xF5,0xF0,0x3C,0x1F,0xFA,0xE4,0x44,0x11,
+0xF5,0xF1,0x3C,0x1F,0xFA,0xDD,0x44,0x11,0xF5,0xF2,0x3C,0x1F,0xFA,0xDE,0x44,0x11,
+0xF5,0xF3,0x80,0xC0,0x3C,0x1F,0xFA,0xDF,0x5A,0x08,0x02,0x79,0x44,0x11,0xF6,0x00,
+0x84,0x01,0xAE,0x08,0x44,0x11,0xF6,0x04,0x44,0x20,0x00,0x3F,0xAE,0x88,0x44,0x11,
+0xF4,0xBD,0xAE,0x08,0x44,0x01,0xF6,0x0F,0x84,0x23,0xAE,0x40,0x84,0x00,0x80,0x20,
+0x80,0x40,0x80,0x60,0x49,0x00,0x0A,0x63,0x3C,0x2D,0xFA,0xE2,0x44,0x1F,0xFF,0xBF,
+0x84,0x61,0xA4,0x10,0x58,0x00,0x00,0x22,0xFE,0x0E,0xAC,0x10,0x3C,0x0D,0xFA,0xE1,
+0xA4,0x80,0xFE,0x56,0xAC,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x0A,0x4F,
+0x44,0x00,0x0D,0x02,0x49,0x00,0x07,0x01,0x3C,0x1D,0xFA,0xE1,0x84,0x61,0xA4,0x08,
+0x58,0x00,0x00,0x22,0xAC,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x0A,0x3F,
+0x44,0x00,0x1F,0x38,0x49,0x00,0x06,0xF1,0x3C,0x1D,0xFA,0xDF,0xA6,0x08,0x58,0x00,
+0x00,0x01,0xAE,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0x00,0x0A,0x2F,
+0x44,0x00,0x07,0xCE,0x49,0x00,0x06,0xE1,0x3C,0x1D,0xFA,0xE4,0xA6,0x08,0x58,0x00,
+0x00,0x01,0xAE,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0x00,0x0A,0x1F,
+0x3C,0x1D,0xFA,0xE2,0x84,0x61,0xA4,0x08,0x58,0x00,0x00,0x04,0xAC,0x08,0x3C,0x0D,
+0xFA,0xE1,0xA4,0x80,0x58,0x21,0x00,0x04,0xAC,0x80,0xA4,0x88,0x58,0x21,0x00,0x08,
+0xAC,0x88,0xA4,0x40,0x58,0x10,0x80,0x08,0xAC,0x40,0x84,0x00,0x80,0x20,0x80,0x40,
+0x49,0x00,0x0A,0x05,0x44,0x00,0x1A,0x04,0xD5,0x65,0xC8,0x67,0x44,0x21,0xF6,0x00,
+0x84,0x21,0xAE,0x50,0x44,0x21,0xF6,0x04,0x44,0x30,0x00,0x3F,0xAE,0xD0,0x44,0x21,
+0xF4,0xBD,0x80,0x60,0xAE,0x50,0x44,0x11,0xF6,0x0F,0x84,0x43,0xAE,0x88,0x80,0x20,
+0x80,0x40,0x49,0x00,0x09,0xEC,0x3C,0x5D,0xFA,0xE2,0x44,0x0F,0xFE,0xFF,0x80,0x46,
+0xA4,0x68,0x84,0x61,0xFE,0x46,0xAC,0x68,0x3C,0x4D,0xFA,0xE1,0xA4,0x60,0xFE,0x0E,
+0xAC,0x20,0xA4,0x68,0x44,0x0F,0xFF,0xEF,0xFE,0x46,0xAC,0x68,0xA4,0x60,0xFE,0x0E,
+0xAC,0x20,0xA4,0x28,0x80,0x26,0x58,0x00,0x00,0x02,0xAC,0x28,0xA4,0x20,0x58,0x00,
+0x00,0x02,0xAC,0x20,0xA4,0x28,0x58,0x00,0x00,0x20,0xAC,0x28,0xA4,0x20,0x58,0x00,
+0x00,0x20,0xAC,0x20,0xA4,0x28,0x58,0x00,0x00,0x04,0xAC,0x28,0xA4,0x20,0x58,0x00,
+0x00,0x04,0xAC,0x20,0xA4,0x28,0x58,0x00,0x00,0x08,0xAC,0x28,0xA4,0x20,0x58,0x00,
+0x00,0x08,0xAC,0x20,0x80,0x06,0x49,0x00,0x09,0xB2,0x3C,0x1D,0xFA,0xE4,0x80,0x46,
+0x80,0x66,0xA6,0x08,0x58,0x00,0x00,0x01,0xAE,0x08,0x3C,0x1D,0xFA,0xDF,0xA6,0x08,
+0x58,0x00,0x00,0x01,0xAE,0x08,0x80,0x06,0x80,0x26,0x49,0x00,0x09,0xA0,0x44,0x00,
+0x02,0x7F,0x49,0x00,0x06,0x52,0xD5,0x5F,0x5A,0x08,0x01,0x5E,0x44,0x01,0xF6,0x00,
+0x84,0xE0,0xAF,0xC0,0x44,0x01,0xF6,0x04,0xFA,0x3A,0xAE,0x40,0x3C,0x2D,0xFA,0xE4,
+0x84,0x1E,0xA6,0x50,0xFE,0x46,0xAE,0x50,0x3C,0x1D,0xFA,0xDF,0xA6,0x88,0xFE,0x16,
+0xAE,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0x00,0x09,0x80,0x3C,0x5D,
+0xFA,0xE2,0x80,0x66,0xA4,0x28,0x58,0x00,0x01,0x00,0xAC,0x28,0x3C,0x4D,0xFA,0xE1,
+0xA4,0x20,0x58,0x00,0x01,0x00,0xAC,0x20,0xA4,0x28,0x58,0x00,0x00,0x10,0xAC,0x28,
+0xA4,0x20,0x58,0x00,0x00,0x10,0xAC,0x20,0xA4,0x68,0x84,0x1D,0xFE,0x46,0xAC,0x68,
+0xA4,0x60,0xFE,0x0E,0xAC,0x20,0xA4,0x68,0x44,0x0F,0xFF,0xDF,0xFE,0x46,0xAC,0x68,
+0xA4,0x60,0xFE,0x0E,0xAC,0x20,0xA4,0x68,0x84,0x1B,0xFE,0x46,0xAC,0x68,0xA4,0x60,
+0xFE,0x0E,0xAC,0x20,0xA4,0x68,0x84,0x17,0xFE,0x46,0xAC,0x68,0xA4,0x60,0xFE,0x0E,
+0xAC,0x20,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x09,0x49,0x44,0x01,0xF4,0xBD,
+0xAF,0xC0,0x44,0x01,0xF6,0x0F,0xAF,0xC0,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,
+0x49,0x00,0x09,0x3D,0xFC,0xA0,0xFC,0x00,0x44,0x31,0xF5,0xF0,0x44,0x21,0xF5,0xF3,
+0x80,0x20,0x3C,0x3F,0xFA,0xE4,0x3C,0x2F,0xFA,0xDF,0xC8,0x0C,0xA7,0x18,0x58,0x42,
+0x00,0x01,0xAF,0x18,0xA6,0xD0,0x58,0x31,0x80,0x01,0xAE,0xD0,0x80,0x40,0x80,0x60,
+0xD5,0x0E,0x5A,0x08,0x01,0x0F,0xA6,0x58,0x84,0x1E,0xFE,0x46,0xAE,0x58,0xA6,0x50,
+0xFE,0x0E,0xAE,0x10,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0x00,0x09,0x17,
+0xFC,0x80,0x46,0x10,0x08,0x00,0x64,0x13,0x24,0x03,0x64,0x23,0x04,0x02,0x46,0x1F,
+0xF7,0xFF,0x50,0x10,0x8F,0xFF,0xFE,0x56,0x40,0x00,0x5C,0x08,0xFE,0x0F,0x64,0x03,
+0x04,0x03,0xDD,0x9E,0x44,0x11,0x00,0x00,0x64,0x13,0x24,0x03,0x64,0x23,0x04,0x02,
+0x44,0x1E,0xFF,0xFF,0xFE,0x56,0x40,0x00,0x40,0x08,0xFE,0x0F,0x64,0x03,0x04,0x03,
+0xDD,0x9E,0x44,0x10,0x80,0x00,0x64,0x13,0x24,0x03,0x64,0x23,0x04,0x02,0x44,0x1F,
+0x7F,0xFF,0xFE,0x56,0x40,0x00,0x3C,0x08,0xFE,0x0F,0x64,0x03,0x04,0x03,0xDD,0x9E,
+0xFC,0x00,0x3C,0x1D,0xFA,0xE2,0x84,0x61,0xA4,0x08,0x58,0x00,0x00,0x40,0xAC,0x08,
+0x3C,0x1D,0xFA,0xE1,0xA4,0x08,0x58,0x00,0x00,0x40,0xAC,0x08,0x84,0x00,0x80,0x20,
+0x80,0x40,0x49,0x00,0x08,0xD4,0xFC,0x80,0xFC,0x00,0x3C,0x2D,0xFA,0xE2,0x44,0x0F,
+0xFF,0xBF,0x84,0x61,0xA4,0x50,0xFE,0x46,0xAC,0x50,0x3C,0x1D,0xFA,0xE1,0xA4,0x88,
+0xFE,0x16,0xAC,0x08,0x84,0x00,0x80,0x20,0x80,0x40,0x49,0x00,0x08,0xC0,0xFC,0x80,
+0xFC,0x01,0xF2,0x81,0x44,0x21,0xF0,0x06,0xB6,0x3F,0xA6,0x50,0x44,0x31,0xF6,0x18,
+0x54,0x10,0x80,0x1C,0xFE,0x47,0x84,0x80,0x96,0x48,0xAD,0x18,0xAE,0x50,0x5A,0x08,
+0x02,0x05,0x84,0x00,0x64,0x03,0x04,0x03,0x44,0x01,0xF0,0x58,0xA6,0x40,0x54,0x10,
+0x80,0xF7,0xAE,0x40,0xA6,0x40,0x58,0x10,0x80,0x0F,0xAE,0x40,0x49,0x00,0x00,0xF7,
+0xC0,0x04,0x49,0x00,0x08,0x56,0xD5,0xFB,0x44,0x11,0xF0,0x58,0xA6,0x08,0x54,0x00,
+0x00,0xF7,0xAE,0x08,0xB4,0x1F,0xF1,0x01,0x49,0x00,0x00,0xE1,0x44,0x01,0xF0,0x07,
+0x44,0x10,0x00,0x55,0xAE,0x40,0xFC,0x81,0x94,0x4D,0x44,0x21,0xF0,0x08,0xFE,0x0F,
+0x96,0x00,0xA6,0xD0,0xAE,0x10,0xDD,0x9E,0x96,0x06,0x94,0x04,0x96,0x5F,0xFE,0x47,
+0x44,0x01,0xF0,0x09,0xAE,0x40,0xDD,0x9E,0x44,0x11,0xF0,0x0A,0xAC,0x08,0xDD,0x9E,
+0x44,0x11,0xF0,0x0C,0xAE,0x08,0xDD,0x9E,0x44,0x31,0xF0,0xCC,0x96,0x01,0xAC,0x18,
+0x44,0x01,0xF0,0xCE,0x96,0x49,0xAC,0x40,0x44,0x01,0xF0,0xD0,0x96,0x91,0xAC,0x80,
+0xDD,0x9E,0xFC,0x20,0x44,0x61,0xF0,0xD6,0xA7,0xF0,0x49,0x00,0x08,0x1A,0x54,0x73,
+0x80,0xFE,0x58,0x73,0x80,0x01,0xAF,0xF0,0xA6,0x30,0x96,0x06,0xC8,0xFE,0xFC,0xA0,
+0x44,0x21,0xF0,0xD2,0x96,0x00,0xAE,0x10,0x44,0x01,0xF0,0xD3,0x96,0x48,0xAE,0x40,
+0xDD,0x9E,0x44,0x01,0x3E,0xD0,0xDD,0x9E,0x44,0x01,0x3A,0xE4,0xDD,0x9E,0x44,0x01,
+0xF0,0xD7,0xA6,0x00,0xDD,0x9E,0x44,0x11,0xF0,0xD4,0xAC,0x08,0xDD,0x9E,0x44,0x21,
+0xF0,0xD6,0x94,0x01,0xA6,0x50,0x96,0x46,0xFE,0x47,0x96,0x48,0xAE,0x50,0xDD,0x9E,
+0xE6,0x08,0xE8,0x25,0x44,0xF0,0x53,0x74,0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,
+0x4A,0x00,0x3C,0x00,0x08,0x0E,0x14,0x1A,0x20,0x26,0x2C,0x32,0x44,0x01,0xF0,0xD8,
+0xD5,0x15,0x44,0x01,0xF0,0xDA,0xD5,0x12,0x44,0x01,0xF0,0xDC,0xD5,0x0F,0x44,0x01,
+0xF0,0xDE,0xD5,0x0C,0x44,0x01,0xF0,0xE0,0xD5,0x09,0x44,0x01,0xF0,0xE2,0xD5,0x06,
+0x44,0x01,0xF0,0xE4,0xD5,0x03,0x44,0x01,0xF0,0xE6,0xAE,0x40,0xDD,0x9E,0x92,0x00,
+0xE6,0x08,0xE8,0x25,0x44,0xF0,0x53,0xC4,0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,
+0x4A,0x00,0x3C,0x00,0x08,0x0E,0x14,0x1A,0x20,0x26,0x2C,0x32,0x44,0x01,0xF0,0xD9,
+0xD5,0x15,0x44,0x01,0xF0,0xDB,0xD5,0x12,0x44,0x01,0xF0,0xDD,0xD5,0x0F,0x44,0x01,
+0xF0,0xDF,0xD5,0x0C,0x44,0x01,0xF0,0xE1,0xD5,0x09,0x44,0x01,0xF0,0xE3,0xD5,0x06,
+0x44,0x01,0xF0,0xE5,0xD5,0x03,0x44,0x01,0xF0,0xE7,0xAE,0x40,0xDD,0x9E,0x92,0x00,
+0x44,0x01,0xF0,0x18,0xA6,0x00,0xDD,0x9E,0x44,0x11,0xF0,0x18,0x96,0x00,0xAE,0x08,
+0xDD,0x9E,0x44,0x01,0xF0,0x17,0xA6,0x00,0xDD,0x9E,0x44,0x11,0xF0,0x17,0x96,0x00,
+0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF0,0x22,0x44,0x11,0xF0,0x24,0xA4,0x00,0xA6,0x48,
+0x94,0x07,0xFE,0x0F,0x44,0x1E,0xE2,0x00,0x88,0x01,0x5C,0x00,0x00,0x80,0xDD,0x9E,
+0x44,0x01,0x1E,0x00,0xDD,0x9E,0x44,0x51,0x1E,0x00,0x44,0x11,0x1E,0x3E,0x18,0x02,
+0x80,0x01,0xD9,0xFE,0xDD,0x9E,0x44,0x01,0xF0,0x22,0x44,0x10,0x02,0x3C,0xAC,0x40,
+0x44,0x01,0xF0,0x24,0x84,0x20,0xAE,0x40,0xDD,0x9E,0x96,0x5F,0x94,0x04,0xFE,0x0F,
+0x44,0x11,0xF0,0x2E,0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF0,0x48,0xA6,0x00,
+0xDD,0x9E,0x44,0x01,0xF0,0x4B,0xA6,0x00,0xDD,0x9E,0x44,0x11,0xF0,0x4B,0x96,0x00,
+0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF0,0x4A,0xA6,0x00,0xDD,0x9E,0x44,0x11,0xF0,0x4A,
+0x96,0x00,0xAE,0x08,0xDD,0x9E,0x44,0x01,0xF0,0x51,0x44,0x10,0x00,0x55,0xAE,0x40,
+0xDD,0x9E,0x44,0x21,0xF0,0x58,0x96,0x17,0xA6,0x50,0x54,0x10,0x80,0xF8,0xFE,0x47,
+0xAE,0x50,0xDD,0x9E,0x44,0x21,0xF0,0x58,0x96,0x17,0xA6,0x50,0x94,0x04,0x54,0x10,
+0x80,0x8F,0xFE,0x47,0xAE,0x50,0xDD,0x9E,0x44,0x11,0xF0,0x58,0xA6,0x08,0x58,0x00,
+0x00,0x80,0xAE,0x08,0xDD,0x9E,0x44,0x11,0xF0,0x58,0xA6,0x08,0x96,0x37,0xAE,0x08,
+0xDD,0x9E,0xC8,0x04,0x44,0x11,0x00,0x00,0xD5,0x03,0x44,0x11,0x20,0x00,0x3C,0x1F,
+0xFA,0xD4,0xC8,0x04,0x44,0x11,0x0E,0x60,0xD5,0x03,0x44,0x11,0x2E,0x60,0x3C,0x1F,
+0xFA,0xD3,0xC8,0x04,0x44,0x11,0x08,0x30,0xD5,0x03,0x44,0x11,0x28,0x30,0x3C,0x1F,
+0xFA,0xCD,0xC8,0x04,0x44,0x01,0x0E,0x68,0xD5,0x03,0x44,0x01,0x2E,0x68,0x3C,0x0F,
+0xFA,0xCC,0xDD,0x9E,0xFC,0x00,0x49,0x00,0x07,0x04,0x44,0x01,0xF0,0x90,0x84,0x21,
+0xAE,0x40,0xA6,0x40,0x5A,0x10,0x01,0xFF,0xFC,0x80,0xC8,0x28,0x3C,0x53,0xF5,0xA8,
+0x44,0x41,0xF0,0x96,0x3C,0x3D,0xFA,0xCD,0x3C,0x2D,0xFA,0xD7,0x3C,0x1D,0xFA,0xD1,
+0x3C,0x0D,0xFA,0xD9,0xAD,0x60,0x44,0x41,0xF0,0x9E,0x96,0xD9,0xAC,0xE0,0x44,0x31,
+0xF0,0x98,0x96,0x91,0xAC,0x98,0x44,0x21,0xF0,0x9A,0x96,0x49,0xAC,0x50,0x44,0x11,
+0xF0,0x9C,0x96,0x01,0xAC,0x08,0x2E,0x20,0x21,0x4F,0x44,0x01,0xF0,0x94,0x2E,0x10,
+0x21,0x50,0xAE,0x80,0x44,0x01,0xF0,0x95,0xAE,0x40,0xDD,0x9E,0xFC,0x40,0x44,0x31,
+0xF0,0x92,0x44,0x71,0xF0,0x91,0x3C,0x3F,0xFA,0xD8,0x3C,0x7F,0xFA,0xCF,0xA7,0x40,
+0x84,0x81,0x40,0x62,0x90,0x02,0xA7,0x58,0x85,0x5E,0x40,0x52,0xA8,0x02,0xFF,0x77,
+0xAF,0x58,0xA7,0x41,0x85,0x3D,0xFF,0x66,0x40,0x62,0x90,0x0C,0xA7,0x58,0x40,0x52,
+0xA4,0x02,0xFF,0x77,0xAF,0x58,0xA7,0x42,0xFF,0x66,0x95,0xAA,0xA7,0x58,0x54,0x52,
+0x80,0xFB,0xFF,0x77,0xAF,0x58,0xA7,0x43,0xFF,0x66,0x95,0xAB,0xA7,0x58,0x54,0x52,
+0x80,0xF7,0xFF,0x77,0xAF,0x58,0xA7,0x44,0xFF,0x66,0x95,0xAC,0xA7,0x58,0x54,0x52,
+0x80,0xEF,0xFF,0x77,0xAF,0x58,0xA7,0x45,0xFF,0x66,0x95,0xAD,0xA7,0x58,0x54,0x52,
+0x80,0xDF,0xFF,0x77,0xAF,0x58,0xA6,0x06,0x95,0x46,0xA6,0x18,0x96,0x2F,0xFE,0x2F,
+0xAE,0x18,0xA6,0x10,0xA6,0xF8,0xFE,0x26,0x40,0x31,0xA8,0x02,0x40,0xA1,0x80,0x04,
+0x10,0xA3,0x80,0x00,0xA6,0x11,0xFF,0x06,0x94,0x21,0x54,0x45,0x00,0xFF,0x40,0x42,
+0x24,0x02,0xFF,0x07,0xAF,0x38,0x00,0x20,0x80,0x0E,0x44,0x01,0xF0,0x93,0xAE,0x80,
+0xA4,0x89,0x44,0x01,0xF0,0xA0,0xAC,0x80,0xA4,0x8A,0x44,0x01,0xF0,0xA2,0xAC,0x80,
+0xA6,0x8E,0x44,0x01,0xF0,0xA4,0xAE,0x80,0x02,0x20,0x80,0x08,0x44,0x01,0xF0,0xA6,
+0xAC,0x80,0xA4,0x8E,0x44,0x01,0xF0,0xA8,0xAC,0x80,0x00,0x20,0x80,0x08,0x44,0x01,
+0xF0,0xAE,0xAE,0x80,0x00,0x20,0x80,0x0B,0x44,0x01,0xF0,0xAF,0xAE,0x80,0x00,0x20,
+0x80,0x0A,0x44,0x01,0xF0,0xB0,0xAE,0x80,0x00,0x20,0x80,0x12,0x44,0x01,0xF0,0xB1,
+0xAE,0x80,0x02,0x10,0x80,0x0A,0x44,0x01,0xF0,0xB2,0xAC,0x40,0xFC,0xC0,0x44,0x11,
+0xF0,0xAA,0xA4,0x48,0xAC,0x40,0x44,0x11,0xF0,0xAC,0xA4,0x48,0xAC,0x41,0x44,0x11,
+0xF0,0xB4,0xA4,0x48,0xAC,0x42,0x44,0x11,0xF0,0xB6,0xA4,0x48,0xAC,0x43,0x44,0x11,
+0xF0,0xB8,0xA4,0x48,0xAC,0x44,0x44,0x11,0xF0,0xBA,0xA4,0x48,0xAC,0x45,0x44,0x11,
+0xF6,0x10,0xA6,0x48,0x10,0x10,0x00,0x0C,0xDD,0x9E,0x44,0x01,0xF6,0x10,0xA6,0x00,
+0x96,0x06,0xDD,0x9E,0x3C,0x0F,0xFF,0x0A,0xDD,0x9E,0x3C,0x0D,0xFF,0x0A,0xA6,0x00,
+0xDD,0x9E,0xFC,0x00,0xA6,0x48,0x8E,0x24,0xE6,0x22,0xE8,0x13,0xC8,0x04,0x44,0x11,
+0x00,0x00,0xD5,0x03,0x44,0x11,0x20,0x00,0x3C,0x1F,0xFA,0xC6,0xC8,0x04,0x44,0x11,
+0x20,0x00,0xD5,0x03,0x44,0x11,0x00,0x00,0x3C,0x1F,0xFA,0xC4,0xC0,0x16,0xD5,0x12,
+0xC8,0x04,0x44,0x11,0x20,0x00,0xD5,0x03,0x44,0x11,0x00,0x00,0x3C,0x1F,0xFA,0xC6,
+0xC8,0x04,0x44,0x11,0x00,0x00,0xD5,0x03,0x44,0x11,0x20,0x00,0x3C,0x1F,0xFA,0xC4,
+0xC8,0x04,0x44,0x01,0x00,0x00,0xD5,0x03,0x44,0x01,0x20,0x00,0x3C,0x0F,0xFA,0xCA,
+0xFC,0x80,0x84,0x00,0x3C,0x0F,0xFB,0x17,0x44,0x01,0xF0,0xBC,0x84,0x21,0xAE,0x40,
+0xDD,0x9E,0xFC,0x00,0x5A,0x00,0x02,0x05,0x5A,0x00,0x03,0x18,0xC8,0x2E,0x2E,0x20,
+0x21,0x4F,0x44,0x01,0xF0,0xBE,0x2E,0x10,0x21,0x50,0xAE,0x80,0x44,0x01,0xF0,0xBF,
+0x44,0x21,0xF0,0xC0,0xAE,0x40,0x3C,0x1D,0xFA,0xC4,0x3C,0x33,0xF5,0x8C,0x3C,0x0D,
+0xFA,0xCA,0x96,0x49,0xAC,0xD0,0xD5,0x12,0x2E,0x20,0x21,0x4F,0x44,0x01,0xF0,0xBE,
+0x2E,0x10,0x21,0x50,0xAE,0x80,0x44,0x01,0xF0,0xBF,0x44,0x21,0xF0,0xC0,0xAE,0x40,
+0x3C,0x13,0xF5,0x88,0x3C,0x0D,0xFA,0xCA,0xAC,0x50,0x44,0x21,0xF0,0xC2,0x96,0x01,
+0xAC,0x50,0x44,0x11,0xF0,0xC4,0xAC,0x08,0xFC,0x80,0xFC,0x20,0x2E,0x17,0xFD,0xBD,
+0x80,0xE0,0x3C,0x6D,0xFA,0x68,0xC1,0x02,0x84,0x03,0x49,0xFF,0xFF,0xC4,0x3C,0x1D,
+0xFA,0x68,0x5A,0x10,0x0F,0x13,0xC7,0x03,0x5A,0x78,0x02,0x03,0x80,0xC1,0x44,0x01,
+0xF0,0xBD,0x97,0xB0,0xAF,0x80,0x49,0x00,0x05,0x9C,0x49,0xFF,0xFF,0xAC,0x44,0x11,
+0xF0,0xBC,0xA6,0x08,0x5A,0x00,0x01,0xFF,0xFC,0xA0,0xC0,0x04,0x5A,0x00,0x02,0x09,
+0xDD,0x9E,0x3C,0x0D,0xFF,0x0A,0xA6,0x00,0x3C,0x0F,0xFA,0x68,0xDD,0x9E,0x3C,0x1F,
+0xFA,0x68,0xDD,0x9E,0xFC,0x40,0x04,0xAF,0x80,0x08,0x04,0xFF,0x80,0x09,0xCD,0x02,
+0x84,0xA1,0xE9,0x02,0x85,0xE1,0x84,0xE0,0x4C,0x71,0x80,0x12,0x38,0x60,0x9D,0x11,
+0x42,0x63,0x28,0x24,0x40,0x93,0x3D,0x37,0x38,0x60,0x1D,0x11,0xFF,0xA4,0x40,0x63,
+0x14,0xD7,0x88,0xC9,0x38,0x61,0x1D,0x09,0x8C,0xE1,0xD5,0xEF,0xFC,0xC0,0xFC,0x40,
+0x3C,0x6D,0xFA,0xD5,0xF7,0x08,0x04,0xAF,0x80,0x09,0x02,0xF3,0x00,0x0F,0x2E,0x60,
+0x21,0x6E,0x04,0x9F,0x80,0x0A,0x40,0x81,0x98,0x00,0x44,0x61,0x00,0x00,0x40,0x37,
+0x98,0x04,0x44,0x60,0x00,0x58,0x42,0x34,0x18,0x73,0xCF,0x02,0x84,0xE1,0x4E,0x93,
+0x00,0x03,0x85,0x21,0x44,0x61,0xA6,0xB8,0x51,0xC1,0x80,0x58,0x81,0xE6,0x0C,0x81,
+0x80,0x01,0x55,0xE4,0x03,0xFF,0x13,0xE7,0x80,0x00,0x41,0xE4,0x28,0x09,0x93,0x14,
+0x55,0xEF,0x03,0xFF,0x54,0x84,0x03,0xFF,0x13,0xE7,0x80,0x01,0x12,0x87,0x80,0x02,
+0x50,0xF7,0x80,0x06,0x4C,0x3E,0x7F,0xED,0x85,0xE0,0x4C,0xF2,0x00,0x29,0x0A,0x83,
+0x00,0x01,0x5A,0x83,0xFF,0x10,0x38,0x30,0xA1,0x11,0x42,0x31,0xA8,0x24,0x41,0xC1,
+0xA7,0x97,0x38,0x30,0x21,0x11,0xFE,0xEC,0x40,0x31,0x9C,0x77,0x88,0x7C,0x38,0x31,
+0x21,0x09,0x02,0x83,0x00,0x20,0x5A,0x83,0xFF,0x10,0x38,0x30,0xA1,0x11,0x42,0x31,
+0xA8,0x24,0x41,0xC1,0xA7,0x97,0x38,0x30,0x21,0x11,0xFE,0xEC,0x40,0x31,0x9C,0x77,
+0x88,0x7C,0x38,0x31,0x21,0x09,0x50,0xF7,0x80,0x01,0xD5,0xD8,0xFC,0xC0,0x3C,0x0F,
+0xFA,0xEF,0xDD,0x9E,0xFC,0x43,0x81,0x20,0x80,0xE1,0xA0,0x04,0x80,0x22,0x81,0x42,
+0x50,0x3F,0x80,0x17,0xFA,0x4E,0x49,0xFF,0xD5,0xB3,0x00,0x0F,0x80,0x17,0x84,0x20,
+0xF0,0x81,0x80,0xA1,0x84,0x1F,0xF2,0x01,0xE2,0xA2,0xE8,0x11,0x04,0x25,0x00,0x01,
+0x38,0x21,0x15,0x01,0xDA,0x0A,0x04,0x25,0x00,0x02,0x38,0x21,0x15,0x01,0xE2,0x22,
+0x40,0x11,0x3C,0x1B,0x40,0x02,0xBC,0x1B,0x8C,0xA1,0xD5,0xEE,0x5A,0x07,0xFF,0x58,
+0x50,0x35,0x00,0x18,0xB4,0x43,0x94,0x42,0x3C,0x6D,0xFA,0xEF,0x38,0x41,0x02,0x02,
+0xA0,0x99,0x38,0x51,0x02,0x02,0xA0,0x9A,0x38,0x31,0x02,0x02,0xC3,0x0C,0x00,0x23,
+0x00,0x32,0x00,0x03,0x00,0x33,0xFF,0x14,0xFE,0x2C,0x40,0x42,0x0C,0x97,0x40,0x30,
+0x0C,0x77,0xD5,0x02,0x80,0x83,0x04,0x55,0x00,0x05,0x84,0x40,0x88,0xA1,0x81,0x02,
+0xA6,0x6B,0xA6,0x2A,0xF1,0x82,0x83,0xC2,0xF1,0x02,0xE2,0x20,0xE9,0x22,0x00,0xA2,
+0x80,0x01,0xA6,0x68,0x14,0xAF,0x80,0x03,0x04,0xAF,0x80,0x03,0xE3,0x41,0xE9,0x17,
+0x00,0xA3,0x00,0x02,0x81,0xE1,0x42,0xF0,0x28,0x73,0x40,0xA7,0x84,0x08,0x04,0xF4,
+0x80,0x04,0x89,0x4F,0x02,0xA5,0x00,0x00,0x40,0xA5,0x00,0x11,0xE5,0x5E,0xE9,0x05,
+0x41,0xEF,0x04,0x00,0x89,0x00,0x8C,0x41,0x8C,0x21,0xD5,0xE7,0x8C,0x01,0xD5,0xDD,
+0xC2,0x13,0x00,0x03,0x00,0x32,0x42,0x0F,0x00,0x24,0x41,0xE0,0x0B,0xD7,0x00,0x03,
+0x00,0x33,0x42,0x04,0x00,0x24,0x40,0x20,0x08,0x57,0xD5,0x07,0x84,0x40,0x83,0xC2,
+0x80,0x62,0x80,0x82,0xD5,0x02,0x83,0xC2,0xA6,0x38,0x5A,0x00,0x01,0x05,0x44,0x10,
+0x00,0x3C,0xD5,0x02,0xFA,0x38,0x8A,0x9E,0x4E,0x44,0x00,0x03,0xFF,0x22,0xE2,0x24,
+0xE9,0x0D,0x9A,0x9A,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE2,0x22,0xE9,0x07,0x84,0x03,
+0xFE,0x0C,0x88,0x44,0x92,0x01,0xE2,0x02,0xE8,0x0F,0x44,0x00,0x00,0x3C,0x3E,0x07,
+0xFC,0x2C,0x84,0x01,0xAE,0x38,0x2E,0x07,0xFD,0x9A,0x8C,0x01,0x96,0x00,0xE6,0x0B,
+0xE9,0x0D,0x84,0x0A,0xD5,0x0B,0x2E,0x07,0xFC,0x2C,0xC0,0x07,0xF1,0x01,0xC9,0x08,
+0x8E,0x01,0x3E,0x07,0xFC,0x2C,0xD5,0x04,0xAE,0x38,0x3E,0x07,0xFD,0x9A,0xFC,0xC3,
+0xFC,0x41,0x3D,0xCD,0xFA,0xEF,0x84,0x20,0x02,0x2E,0x00,0x1A,0xE2,0x22,0xE8,0x0B,
+0xA0,0xC5,0xA1,0x04,0x94,0x89,0x88,0x62,0x88,0x44,0x8C,0x21,0xA4,0x90,0x96,0x93,
+0xAC,0x98,0xD5,0xF3,0x47,0xE7,0xFF,0xFF,0x84,0xE1,0x51,0xEF,0x0F,0xFF,0x00,0x1E,
+0x00,0x02,0x8E,0x21,0xE2,0xE1,0xE8,0x67,0x85,0x41,0x00,0x1E,0x00,0x03,0x8E,0x21,
+0xE3,0x41,0xE8,0x5F,0x00,0x3E,0x00,0x02,0x50,0x45,0x7F,0xFF,0x80,0xA7,0x42,0x52,
+0x0C,0x73,0x42,0x65,0x0C,0x24,0x80,0x85,0xA0,0x85,0x98,0x77,0x88,0x9E,0x40,0x90,
+0x84,0x08,0x95,0x21,0x40,0x11,0x24,0x00,0x99,0x54,0xA4,0x48,0xA5,0x68,0x88,0xC3,
+0x40,0xF2,0x80,0x11,0x9D,0x62,0x88,0xA2,0x8C,0x84,0xA5,0x68,0x88,0x82,0x97,0x6B,
+0xB6,0xBF,0xA5,0x60,0x88,0xC7,0x97,0x2B,0xF4,0x81,0x50,0x44,0xFF,0xFE,0x88,0x82,
+0x88,0xDE,0xA5,0x60,0x95,0xB1,0x50,0x44,0x80,0x02,0x98,0xD6,0x88,0x82,0x96,0x4B,
+0xA5,0x20,0xA4,0xD8,0x97,0x6B,0x40,0x81,0x80,0x11,0x9C,0xF2,0x8C,0xC4,0x88,0x62,
+0x88,0xC2,0xA4,0xD8,0xA4,0xB0,0x95,0x8A,0x40,0xF3,0x3C,0x00,0xB4,0xDF,0x97,0x23,
+0x95,0xB1,0x88,0xCF,0x04,0xFF,0x80,0x01,0x95,0x69,0x88,0xCF,0x88,0xC5,0x95,0x21,
+0x96,0xDB,0x88,0xC4,0x94,0xD9,0x89,0x06,0x89,0x03,0xA0,0xC4,0x96,0x93,0x89,0x23,
+0x88,0x48,0xFA,0x60,0x40,0x21,0x0C,0x56,0x84,0x63,0x42,0x11,0x0C,0x73,0x8C,0x22,
+0x84,0x44,0x40,0x10,0x88,0x36,0x96,0x4B,0x8D,0x41,0x12,0x14,0x80,0x00,0xD5,0x9E,
+0x8C,0xE1,0xD5,0x96,0xFC,0xC1,0x3C,0x0F,0xFF,0x0F,0xDD,0x9E,0x3C,0x0F,0xFF,0x0E,
+0xDD,0x9E,0x3C,0x0F,0xFF,0x0D,0xDD,0x9E,0x3C,0x1D,0xFF,0x0F,0xA0,0x03,0xA4,0x4C,
+0xE2,0x01,0xE9,0x06,0x84,0x00,0x3E,0x07,0xFD,0xB9,0x84,0x02,0xDD,0x9E,0x84,0x00,
+0xDD,0x9E,0xFC,0x41,0x84,0xC0,0x81,0x20,0x9F,0xD1,0xE0,0xE6,0xE9,0x16,0xF1,0x81,
+0x49,0x00,0x03,0xAF,0x98,0xF7,0x90,0x61,0xF1,0x01,0x4C,0x63,0xC0,0x05,0x38,0x54,
+0x8D,0x01,0xD1,0x11,0x38,0x54,0x8D,0x01,0x94,0x19,0xE2,0x25,0xE9,0x08,0x88,0x09,
+0xA4,0x01,0xE2,0x20,0xE8,0x06,0xD1,0x07,0x84,0x1F,0xD5,0x06,0x9F,0xD9,0xD5,0xE6,
+0x9D,0x99,0xD5,0xE4,0x80,0x03,0xFC,0xC1,0xFC,0x00,0x44,0x01,0x82,0xD8,0x84,0x20,
+0x44,0x2F,0xFF,0xAA,0xAE,0x81,0xAE,0x40,0xAE,0x42,0x3E,0x27,0xE9,0xA8,0x84,0x00,
+0x84,0x41,0x3E,0x17,0xFC,0x7E,0x3C,0x0F,0xFF,0x1D,0x3C,0x0F,0xFF,0x1C,0x3E,0x07,
+0xFC,0x7D,0x3C,0x0B,0xFE,0x3C,0x3C,0x2F,0xFA,0x69,0x3E,0x17,0xFC,0x7C,0x3C,0x0B,
+0xFE,0x3D,0x3E,0x07,0xFC,0x7F,0x3E,0x07,0xFC,0x46,0x3E,0x07,0xFC,0x45,0x3E,0x07,
+0xFC,0x44,0xFC,0x80,0x3C,0x0D,0xFF,0x0F,0xA4,0x04,0xDD,0x9E,0x2E,0x07,0xFC,0x7F,
+0xDD,0x9E,0x8E,0x21,0x94,0x49,0x40,0x20,0x04,0x0D,0x8E,0x22,0x40,0x00,0x04,0x0D,
+0x96,0x8F,0x96,0x0F,0xCA,0x04,0x5A,0x08,0x02,0x10,0xD5,0x0C,0x5A,0x28,0x01,0x04,
+0xC8,0x0B,0xD5,0x08,0x5A,0x28,0x02,0x05,0x5A,0x08,0x03,0x07,0xD5,0x03,0x5A,0x08,
+0x01,0x04,0xFA,0x00,0xDD,0x9E,0xFA,0x10,0xDD,0x9E,0x84,0x00,0x44,0x11,0xA1,0x94,
+0x84,0x5F,0x38,0x20,0x81,0x09,0x8C,0x01,0x5A,0x08,0x14,0xFD,0xDD,0x9E,0xFC,0x40,
+0x9C,0x81,0x96,0x86,0x2E,0x97,0xFC,0x7D,0x40,0x70,0x04,0x09,0x84,0x20,0x84,0x61,
+0x44,0x41,0xA1,0x94,0xE3,0x23,0xE9,0x1C,0xC7,0x0D,0x5A,0x78,0x01,0x17,0x95,0x89,
+0x95,0x59,0x88,0xC2,0x88,0xA2,0x38,0x62,0x19,0x01,0x38,0x52,0x15,0x01,0xE2,0xC5,
+0xD5,0x0A,0x95,0x89,0x95,0x59,0x88,0xC2,0x88,0xA2,0x38,0x62,0x19,0x01,0x38,0x52,
+0x15,0x01,0xE2,0xA6,0x40,0x11,0xBC,0x1B,0x8C,0x61,0x96,0xD8,0xD5,0xE4,0x94,0xC1,
+0x94,0x49,0x96,0x06,0x99,0x9A,0x44,0x51,0xA1,0x94,0x88,0x41,0x88,0x20,0x44,0x41,
+0x9B,0xB8,0x88,0x60,0x38,0x22,0x89,0x01,0x38,0x02,0x85,0x01,0x38,0x22,0x19,0x09,
+0x38,0x02,0x0D,0x09,0xFC,0xC0,0xEF,0xF8,0xF0,0x81,0xF0,0x01,0x8E,0x01,0xF0,0x81,
+0x44,0x01,0xF0,0x51,0x44,0x10,0x00,0x55,0xAE,0x40,0xF0,0x01,0xC8,0xF7,0xEC,0x08,
+0xDD,0x9E,0xFC,0x02,0xF3,0x82,0xF4,0x83,0xB6,0x3F,0xF2,0x81,0x49,0xFF,0xFB,0xF7,
+0xB4,0x1F,0xF1,0x01,0xF2,0x02,0x49,0xFF,0xFC,0x1B,0x49,0xFF,0xFB,0xE5,0xF0,0x03,
+0x49,0xFF,0xFC,0x9F,0xFC,0x82,0xFC,0x40,0xF6,0x09,0x22,0x7F,0x80,0x16,0xC8,0x65,
+0x00,0x93,0x00,0x0C,0x10,0x92,0x80,0x0E,0x02,0x93,0x00,0x01,0x12,0x92,0x80,0x01,
+0x02,0x93,0x00,0x02,0x12,0x92,0x80,0x02,0x00,0x93,0x00,0x01,0x10,0x92,0x80,0x06,
+0xA4,0xD8,0x12,0x32,0x80,0x08,0xA4,0xF5,0xAC,0xEE,0xA4,0xF3,0xAC,0xEC,0x00,0x33,
+0x00,0x09,0x10,0x32,0x80,0x0B,0x00,0x33,0x00,0x08,0x10,0x32,0x80,0x0A,0x2E,0x37,
+0xFD,0x99,0xCB,0x0F,0x2E,0x37,0xFD,0x98,0xCB,0x0C,0x2E,0x37,0xEA,0xD2,0xC3,0x06,
+0x8E,0x61,0x3E,0x37,0xEA,0xD2,0xA4,0xF5,0xD5,0x02,0xFA,0x78,0xAC,0xEE,0xD5,0x06,
+0xA4,0xF5,0xAC,0xEE,0x84,0x6A,0x3E,0x37,0xEA,0xD2,0xA6,0xD1,0x5A,0x38,0x01,0x11,
+0xF3,0x0A,0xA5,0x99,0x84,0x65,0xE4,0xCA,0xE9,0x03,0x9E,0xF5,0x96,0xD9,0xAC,0xE9,
+0xAC,0xEA,0xFA,0x78,0xAC,0xEE,0x84,0x61,0x12,0x62,0x80,0x08,0xAE,0xEE,0xF3,0x08,
+0x22,0x61,0x80,0x04,0xFE,0xFA,0xE0,0xC3,0xE8,0x02,0xAD,0xE9,0x2E,0x37,0xEA,0xDF,
+0x5A,0x38,0x03,0x06,0x44,0x30,0x00,0x5F,0xAC,0xEA,0xAC,0xE9,0x2E,0x37,0xFD,0xB9,
+0x5A,0x38,0x01,0x06,0xF3,0x0C,0xA4,0xDA,0x12,0x32,0x80,0x08,0x2E,0x37,0xFD,0x9B,
+0x5A,0x38,0x01,0x04,0x84,0x60,0xAE,0xEE,0xA6,0xC8,0x5A,0x38,0x02,0x08,0x84,0x61,
+0xAE,0xE4,0xC8,0x06,0x84,0x03,0xAE,0x08,0xD5,0x03,0x84,0x00,0xAE,0x24,0x00,0x11,
+0x00,0x1E,0x84,0x00,0x5A,0x18,0x01,0x07,0x10,0x01,0x00,0x1E,0xAE,0x62,0xAE,0x63,
+0xD5,0x03,0xAE,0x22,0xAE,0x23,0xFC,0xC0,0x2E,0x00,0x21,0xE7,0x5A,0x08,0x01,0x2A,
+0x3C,0x1C,0x05,0xA0,0xC9,0x27,0x2E,0x17,0xFD,0xBE,0xC9,0x24,0x3C,0x10,0x11,0x0F,
+0x3C,0x20,0x08,0x3E,0xE2,0x22,0xE9,0x05,0x3C,0x20,0x09,0x44,0xE2,0x22,0xE8,0x1A,
+0x84,0x20,0x3C,0x18,0x08,0x3E,0x3C,0x18,0x09,0x44,0x84,0x00,0x44,0x31,0x1A,0xD8,
+0x3C,0x20,0x10,0xBA,0xE2,0x02,0xE8,0x06,0x98,0x83,0x8C,0x01,0xAE,0x50,0x96,0x01,
+0xD5,0xF8,0x2E,0x07,0xFD,0xBF,0x8C,0x01,0x3E,0x07,0xFD,0xBF,0x84,0x02,0xDD,0x9E,
+0x84,0x01,0xDD,0x9E,0x3C,0x0F,0xFA,0xF1,0xDD,0x9E,0x3C,0x0F,0xFA,0xF0,0xDD,0x9E,
+0x2E,0x07,0xFC,0x81,0x8E,0x01,0x96,0x00,0x3E,0x07,0xFC,0x81,0xC8,0x03,0x3E,0x07,
+0xFC,0x80,0x2E,0x07,0xFC,0x80,0xDD,0x9E,0x84,0x1F,0x3C,0x0F,0xFA,0x8B,0x84,0x00,
+0x3E,0x07,0xFC,0x81,0x3E,0x07,0xFC,0x80,0xDD,0x9E,0xFC,0x43,0x81,0x00,0x81,0x41,
+0x84,0xC0,0xF6,0x81,0x3C,0x0D,0xFA,0xF0,0xA6,0x03,0xE0,0xC0,0xE8,0x6C,0xE4,0xC4,
+0x84,0x00,0xE9,0x02,0x9E,0x33,0xF0,0x82,0x9C,0x33,0x84,0xE0,0xF0,0x83,0x3C,0x0D,
+0xFA,0xF0,0xA6,0x02,0xE0,0xE0,0xE8,0x5D,0x49,0x00,0x02,0x03,0x3C,0x3D,0xFA,0xF0,
+0xB4,0x48,0x80,0x27,0xA6,0x1A,0x42,0x13,0x00,0x73,0x38,0x11,0x05,0x00,0x5A,0x10,
+0xFF,0x4F,0x04,0x44,0x00,0x01,0x38,0x12,0x05,0x11,0x4E,0x15,0x00,0x49,0xE4,0xE4,
+0x87,0xC0,0xE9,0x03,0x51,0xE3,0xFF,0xFD,0xA6,0x5B,0xF5,0x03,0x8E,0x21,0xE0,0x25,
+0x40,0x12,0xBC,0x1A,0x8E,0x01,0xF1,0x84,0x9C,0x7B,0xE0,0x01,0x40,0x00,0xBC,0x1A,
+0xF0,0x85,0xF1,0x02,0xF0,0x04,0xE0,0x01,0xE9,0x32,0x80,0x1E,0xF5,0x05,0xE0,0xA0,
+0xE9,0x2C,0x00,0x91,0x80,0x02,0x81,0xE0,0x42,0xF0,0xA4,0x73,0x40,0x57,0x84,0x08,
+0x38,0xF1,0x3D,0x00,0x5A,0xF0,0xFF,0x20,0x38,0xF2,0x3D,0x11,0x4E,0xF4,0x00,0x1C,
+0x04,0xF5,0x00,0x04,0x88,0xAF,0x3C,0xF0,0x05,0xC6,0xA5,0x68,0x97,0x6B,0xE0,0xAF,
+0xE9,0x12,0x80,0xA7,0x42,0x53,0x24,0x73,0x38,0x51,0x15,0x00,0x44,0xFF,0x80,0x00,
+0x95,0x69,0x88,0xA4,0x02,0x92,0x80,0x00,0x40,0x94,0xBC,0x04,0x12,0x92,0x80,0x00,
+0x84,0xA1,0xF5,0x81,0x8C,0x01,0xD5,0xD3,0x8C,0x21,0xD5,0xCD,0x8C,0xE1,0xD5,0xA0,
+0x8C,0xC1,0xD5,0x91,0xF0,0x01,0xC8,0x8D,0xFC,0xC3,0xFC,0x41,0x81,0x22,0x3C,0x3D,
+0xFA,0xF1,0xF1,0x81,0x00,0x14,0x80,0x00,0x80,0xE0,0x84,0x1F,0x3C,0x0F,0xFA,0x8B,
+0xA6,0x98,0xC9,0x03,0x80,0xC1,0xD5,0x15,0x84,0xC0,0x80,0xA6,0xE0,0xA1,0xE8,0x0F,
+0xA1,0x39,0x38,0x42,0x15,0x01,0xDC,0x09,0xA1,0x3A,0x38,0x42,0x15,0x01,0xE2,0xC4,
+0x40,0x02,0xBC,0x1B,0x40,0x62,0x3C,0x1B,0x8C,0xA1,0xD5,0xF1,0x3C,0x0F,0xFA,0x8B,
+0x40,0xA1,0x00,0x13,0xE3,0x46,0xE8,0x06,0x84,0x01,0x3E,0x07,0xFC,0x80,0xA6,0x19,
+0xD5,0x3F,0x84,0x03,0xFE,0x14,0x92,0x02,0xE2,0x06,0xE9,0x03,0x84,0x20,0xD5,0x4E,
+0x3C,0x3D,0xFA,0x8B,0x44,0x2F,0x80,0x00,0x84,0x20,0xFE,0x9F,0x00,0x04,0x80,0x00,
+0xE0,0x20,0xE8,0x09,0xA1,0x39,0x94,0x09,0x88,0x04,0xA5,0x40,0xDB,0x02,0xAC,0x80,
+0x8C,0x21,0xD5,0xF5,0x80,0x07,0xF1,0x01,0x49,0xFF,0xFF,0x41,0x00,0x24,0x80,0x00,
+0x3C,0x3D,0xFA,0x8B,0x84,0x00,0xE0,0x02,0xE8,0x13,0xA1,0x39,0x94,0x41,0x38,0x52,
+0x01,0x01,0x97,0x2B,0x4E,0x44,0x00,0x0B,0x54,0x52,0xFF,0xFF,0xD3,0x07,0xD8,0x06,
+0xA1,0x3A,0x38,0x12,0x04,0x01,0x88,0xC1,0x97,0xB1,0x8C,0x01,0xD5,0xED,0xE3,0x46,
+0xE8,0x0F,0x84,0x01,0x3E,0x07,0xFC,0x80,0x3C,0x0D,0xFA,0xF1,0xA6,0x01,0x2E,0x17,
+0xFD,0xBB,0x40,0x00,0x04,0x0E,0x3E,0x07,0xFC,0x81,0x84,0x21,0xD5,0x0F,0x84,0x00,
+0x00,0x14,0x80,0x00,0xE0,0x01,0xE8,0xBB,0xA0,0xB9,0x94,0x41,0x88,0x22,0x8C,0x01,
+0xA4,0x88,0x54,0x21,0x7F,0xFF,0xAC,0x88,0xD5,0xF4,0x2E,0x07,0xFC,0x81,0xC0,0x0D,
+0x5A,0x18,0x01,0x05,0x3E,0x17,0xFC,0x80,0xD5,0x08,0x8E,0x01,0x96,0x00,0x3E,0x07,
+0xFC,0x81,0xC8,0x03,0x3E,0x07,0xFC,0x80,0x2E,0x07,0xFC,0x80,0x5A,0x08,0x01,0x05,
+0x84,0x20,0x10,0x14,0x80,0x00,0x3C,0x1D,0xFA,0xF1,0xA6,0x4A,0xC9,0x05,0x5A,0x08,
+0x01,0x04,0x10,0x14,0x80,0x00,0xFC,0xC1,0xFC,0x40,0x2E,0x57,0xFC,0xD0,0x2E,0x07,
+0xFC,0xD1,0x3C,0x9D,0xFA,0x50,0xD0,0x40,0x49,0x00,0x00,0xFB,0x84,0xC0,0x44,0xA1,
+0x80,0x00,0x44,0x81,0x80,0xF0,0x40,0x23,0x24,0x00,0x44,0x71,0x80,0xF0,0xA6,0x50,
+0x2E,0x07,0xFC,0xD1,0x96,0x48,0x38,0x04,0x00,0x00,0x94,0x04,0x38,0x05,0x00,0x02,
+0x88,0x06,0xA6,0x00,0x96,0x00,0xAE,0x10,0x2E,0x07,0xFC,0xD1,0x38,0x04,0x00,0x00,
+0x94,0x04,0x38,0x05,0x00,0x02,0x88,0x06,0x8C,0xC1,0xAE,0x40,0x49,0x00,0x00,0xD9,
+0x44,0x00,0x0A,0x00,0x4C,0x60,0x7F,0xE1,0x49,0x00,0x00,0xD3,0x2E,0x07,0xFC,0xD0,
+0x38,0x13,0x80,0x00,0x2E,0x07,0xFC,0xD0,0x2E,0x27,0xFC,0xD1,0x38,0x23,0x88,0x00,
+0x38,0x23,0x80,0x08,0x2E,0x07,0xFC,0xD1,0x38,0x13,0x80,0x08,0x2E,0x07,0xFC,0xD1,
+0x96,0x00,0x3E,0x07,0xFC,0xD0,0xFC,0xC0,0xFC,0x00,0x49,0xFF,0xF5,0xCB,0xFC,0x80,
+0xFC,0x41,0x2E,0x00,0x21,0xFC,0x44,0x11,0x00,0x00,0x44,0x21,0x20,0x00,0x44,0x41,
+0x2E,0x60,0x44,0x31,0x0E,0x60,0x49,0x00,0x27,0xBF,0x2E,0x10,0x21,0x42,0x2E,0x47,
+0xEA,0x90,0xB6,0x3F,0x2E,0x10,0x21,0x43,0x2E,0x57,0xEA,0x88,0xF1,0x81,0x2E,0x17,
+0xEA,0x89,0x84,0x00,0x81,0x21,0x8A,0xA4,0x3C,0x0F,0xFB,0x0B,0x3C,0x0F,0xFA,0xFB,
+0x3C,0x0F,0xFA,0xFC,0x2E,0x77,0xEA,0x8B,0x97,0x21,0x80,0x20,0x80,0x40,0x44,0xA1,
+0x20,0x00,0x44,0x81,0x0E,0x70,0x3C,0x30,0x10,0xBA,0xE2,0x43,0xE8,0x2F,0x41,0xE1,
+0x04,0x08,0x44,0x31,0x2E,0x84,0x40,0x6F,0x0C,0x00,0x40,0x3F,0x28,0x00,0x41,0xEF,
+0x20,0x00,0x02,0xF1,0x80,0x00,0x03,0xEF,0x00,0x00,0x40,0xF7,0x9D,0xF6,0xA4,0xD8,
+0x41,0xEF,0x27,0xD6,0x41,0xE7,0xF8,0x01,0x41,0xEF,0x17,0xD6,0x40,0x31,0x9C,0x76,
+0x42,0x32,0x78,0x73,0x96,0xD9,0xAC,0xF0,0x2E,0x30,0x21,0x42,0x40,0xF1,0x0F,0xD6,
+0x92,0x61,0x40,0xFF,0x0C,0x07,0xA4,0xF0,0x50,0x31,0xFE,0x3E,0xE9,0x03,0x88,0x03,
+0xD5,0x02,0x88,0x23,0x8C,0x41,0x96,0x91,0xD5,0xCF,0xB4,0x7F,0xF2,0x01,0x44,0x41,
+0x8F,0xB8,0xFE,0x9C,0x40,0x31,0x08,0x0A,0x88,0x23,0x90,0x41,0x88,0x03,0x40,0x10,
+0x88,0x37,0x40,0x00,0x08,0x17,0x2E,0x20,0x21,0x43,0x50,0x00,0x01,0xC2,0x50,0x10,
+0x81,0xC2,0x3C,0x0F,0xFA,0xFB,0x3C,0x1F,0xFB,0x0B,0x94,0x91,0x84,0x00,0x44,0x31,
+0x8F,0x38,0x44,0x50,0x03,0xE8,0x44,0x61,0x92,0x50,0xE0,0x02,0xE8,0x0D,0x38,0x12,
+0x01,0x01,0x38,0x73,0x01,0x01,0xFE,0x6C,0x40,0x10,0x9C,0x37,0x38,0x11,0x81,0x09,
+0x8C,0x01,0x96,0x01,0xD5,0xF3,0x2E,0x67,0xEA,0xC3,0xCE,0x16,0x3E,0x67,0xEA,0xDF,
+0x49,0xFF,0xE9,0xB4,0x44,0x01,0x0E,0x70,0x44,0x11,0x00,0x00,0x49,0xFF,0xF3,0xCF,
+0x3E,0x67,0xEA,0xD3,0x49,0xFF,0xE7,0xC0,0x44,0x01,0x0E,0x70,0x44,0x11,0x20,0x00,
+0x49,0xFF,0xF3,0xC5,0xD5,0x12,0x84,0x03,0x3E,0x07,0xEA,0xDF,0x84,0x03,0x49,0xFF,
+0xE9,0xFF,0x44,0x01,0x20,0x00,0x44,0x11,0x0E,0x70,0x49,0xFF,0xF3,0xB8,0x84,0x01,
+0x3E,0x07,0xEA,0xD3,0x49,0xFF,0xE7,0xA8,0x49,0xFF,0xF8,0xB7,0xFC,0xC1,0xFC,0x00,
+0x49,0xFF,0xF8,0xB3,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xF9,0xD1,0xFC,0x80,0xFC,0x03,
+0xF0,0x81,0x80,0x05,0xF3,0x84,0xF4,0x85,0xF2,0x83,0xF1,0x82,0x49,0xFF,0xF4,0xE8,
+0xF0,0x02,0xF1,0x03,0x49,0xFF,0xF7,0xAA,0x49,0xFF,0xF8,0x9F,0xF0,0x01,0xF1,0x04,
+0xF2,0x05,0x49,0xFF,0xF7,0x6F,0x44,0x00,0x01,0xF4,0x49,0xFF,0xFC,0xDE,0xFC,0x83,
+0xFC,0x00,0x49,0xFF,0xF8,0x5F,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xF8,0x78,0xFC,0x80,
+0xFC,0x00,0x49,0xFF,0xF8,0x49,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xF4,0xBF,0xFC,0x80,
+0xFC,0x00,0x44,0x61,0xB8,0x00,0x00,0x03,0x00,0x0B,0x49,0xFF,0xF4,0xB7,0x44,0x00,
+0x00,0x32,0x49,0xFF,0xFC,0xC2,0x00,0x03,0x00,0x0B,0x52,0x00,0x00,0x01,0x49,0xFF,
+0xF4,0xAD,0xFC,0x80,0x3C,0x0D,0xFA,0xE3,0xDD,0x9E,0xFC,0x00,0x49,0xFF,0xF3,0xCA,
+0x49,0xFF,0xF8,0x6B,0x49,0xFF,0xF3,0xB2,0x44,0x31,0xF6,0x8C,0x44,0x21,0xF6,0x91,
+0xA6,0x18,0xA6,0x50,0xFE,0x0F,0xC8,0xFD,0x44,0x61,0xF6,0x8C,0x84,0x00,0x49,0xFF,
+0xF3,0xD6,0x5A,0x08,0x01,0x0F,0x49,0xFF,0xF3,0xDB,0x49,0xFF,0xF8,0x56,0x49,0xFF,
+0xF3,0x9D,0x44,0x21,0xF6,0x91,0xA6,0x30,0xA6,0x50,0xFE,0x0F,0xC8,0xFD,0xD5,0xEF,
+0x84,0x01,0x49,0xFF,0xF3,0xC4,0x5A,0x00,0x01,0xF0,0xFC,0x80,0xFC,0x00,0x49,0xFF,
+0xF9,0xFE,0xFC,0x80,0xC8,0x04,0x44,0x21,0x00,0x00,0xD5,0x03,0x44,0x21,0x20,0x00,
+0xB6,0x41,0xC8,0x04,0x44,0x21,0x0E,0x60,0xD5,0x03,0x44,0x21,0x2E,0x60,0xA8,0x89,
+0xC8,0x04,0x44,0x21,0x08,0x30,0xD5,0x03,0x44,0x21,0x28,0x30,0xA8,0x8C,0xC8,0x04,
+0x44,0x21,0x28,0x30,0xD5,0x03,0x44,0x21,0x08,0x30,0xA8,0x8D,0xC8,0x04,0x44,0x21,
+0x0E,0x68,0xD5,0x03,0x44,0x21,0x2E,0x68,0xA8,0x8E,0xC8,0x04,0x44,0x21,0x2E,0x68,
+0xD5,0x03,0x44,0x21,0x0E,0x68,0xA8,0x8F,0x44,0x21,0x0E,0x70,0xA8,0x8A,0x44,0x21,
+0x2E,0x70,0xA8,0x8B,0x2E,0x20,0x21,0xDC,0x5A,0x28,0x01,0x0A,0xC8,0x04,0x44,0x01,
+0x06,0x30,0xD5,0x03,0x44,0x01,0x26,0x30,0x3C,0x0F,0xFB,0x10,0x44,0x01,0x2E,0x84,
+0x14,0x00,0x80,0x10,0x44,0x01,0x34,0xB4,0x14,0x00,0x80,0x11,0xDD,0x9E,0x50,0x20,
+0x00,0x20,0x44,0x11,0x44,0xE8,0xA8,0x51,0x44,0x11,0x43,0xD0,0xB6,0x22,0x44,0x11,
+0x44,0x5C,0xA8,0x52,0x44,0x11,0x1D,0xF8,0xA8,0x55,0x44,0x11,0x1D,0xF4,0xA8,0x56,
+0x44,0x11,0x1D,0xF0,0xA8,0x54,0x44,0x11,0x45,0x74,0xA8,0x53,0x44,0x11,0x1D,0xFC,
+0xA8,0x57,0xDD,0x9E,0xFC,0x01,0x5A,0x08,0x01,0x15,0x3C,0x0C,0x08,0x6D,0x3C,0x1C,
+0x08,0x68,0xB6,0x1F,0x3C,0x0C,0x08,0x6E,0x3C,0x2C,0x08,0x69,0xF0,0x81,0x3C,0x3C,
+0x08,0x6A,0x3C,0x0C,0x08,0x67,0x3C,0x4C,0x08,0x6B,0x3C,0x5C,0x08,0x6C,0xD5,0x13,
+0x3C,0x0C,0x08,0x65,0x3C,0x1C,0x08,0x60,0xB6,0x1F,0x3C,0x0C,0x08,0x66,0x3C,0x2C,
+0x08,0x61,0xF0,0x81,0x3C,0x3C,0x08,0x62,0x3C,0x0C,0x08,0x5F,0x3C,0x4C,0x08,0x63,
+0x3C,0x5C,0x08,0x64,0x49,0xFF,0xF4,0x78,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,
+0x49,0xFF,0xF3,0x10,0x49,0xFF,0xF2,0xFA,0xFC,0x81,0xFC,0x00,0x84,0x2F,0xAE,0x41,
+0x84,0x00,0x3C,0x0F,0xFB,0x27,0x84,0x01,0x49,0xFF,0xF3,0xB8,0x3C,0x0D,0xFB,0x27,
+0xC0,0x0C,0x84,0x20,0x84,0x61,0x84,0x02,0x80,0x41,0x80,0x83,0x80,0xA3,0x3C,0x1F,
+0xFB,0x27,0x49,0xFF,0xFE,0xEE,0xFC,0x80,0x49,0xFF,0xF4,0x52,0x5A,0x08,0x01,0xF3,
+0x49,0xFF,0xF7,0x93,0xD5,0xEC,0x3C,0x0D,0xFA,0xE3,0x52,0x00,0x00,0x01,0x3C,0x0F,
+0xFA,0xE3,0xDD,0x9E,0xFC,0x01,0xB6,0x1F,0x3C,0x0D,0xFB,0x0A,0xF1,0x81,0xA6,0x01,
+0x5A,0x00,0x06,0x04,0x49,0xFF,0xFF,0xF1,0xB4,0x3F,0x3C,0x0D,0xFA,0xE3,0x49,0xFF,
+0xFF,0x3B,0x3C,0x0D,0xFA,0xE3,0x49,0xFF,0xF7,0x9E,0x3C,0x0D,0xFA,0xE3,0xF1,0x01,
+0x49,0xFF,0xF8,0xA1,0xFC,0x81,0xFC,0x00,0x44,0x01,0xF0,0x01,0xA6,0x00,0x5A,0x08,
+0x03,0x0C,0x44,0x01,0xF0,0x02,0xA6,0x00,0x5A,0x08,0x67,0x07,0x44,0x01,0xF0,0x03,
+0xA6,0x00,0x5A,0x00,0x70,0x0B,0x84,0x20,0x84,0x01,0x80,0x41,0x80,0x61,0x80,0x81,
+0x80,0xA1,0x49,0xFF,0xFE,0xAE,0xD5,0xF8,0x44,0x01,0xF6,0x50,0xA6,0x00,0xE6,0x02,
+0xE8,0x0A,0x84,0x20,0x84,0x01,0x80,0x41,0x80,0x61,0x80,0x81,0x80,0xA1,0x49,0xFF,
+0xFE,0xA0,0xD5,0xF8,0xFC,0x80,0xFC,0x00,0x49,0xFF,0xF3,0xF9,0x84,0x01,0x49,0xFF,
+0xF3,0xFB,0xFC,0x80,0x44,0x21,0xF6,0xD3,0x96,0x06,0xA6,0x50,0x54,0x10,0x80,0xFE,
+0xFE,0x0F,0xAE,0x10,0xDD,0x9E,0xA6,0x88,0x5A,0x28,0xAA,0x0A,0xFC,0x00,0xA6,0x80,
+0xAE,0x88,0x84,0x20,0xAE,0x40,0x49,0xFF,0xF7,0x50,0xFC,0x80,0xDD,0x9E,0xFC,0x00,
+0x3C,0x0D,0xFB,0x0D,0x5A,0x00,0x04,0x06,0x2E,0x07,0xEA,0xC0,0x5A,0x08,0x01,0x2B,
+0x49,0xFF,0xF6,0xF0,0x3C,0x0F,0xFF,0x35,0x49,0xFF,0xF3,0x6E,0x5A,0x00,0x02,0x1A,
+0x2E,0x00,0x21,0xDB,0x5A,0x08,0x01,0x16,0x3C,0x1D,0xFB,0x0A,0x84,0x00,0x3E,0x07,
+0xEA,0xC0,0xFA,0x41,0x3E,0x07,0xEA,0xA6,0x84,0x00,0xAE,0x89,0x3C,0x0B,0xF5,0x7F,
+0x44,0x11,0x81,0x81,0x44,0x01,0x81,0x7A,0x49,0xFF,0xFF,0xCF,0x84,0x03,0xD5,0x05,
+0x84,0x0A,0x3C,0x0F,0xFB,0x0D,0x84,0x05,0x84,0x20,0x3C,0x2D,0xFB,0x0A,0x49,0xFF,
+0xEE,0x05,0xFC,0x80,0xA6,0x88,0x5A,0x20,0xAA,0x10,0xFC,0x00,0xAE,0x80,0x44,0x2F,
+0xFF,0xAA,0xAE,0x88,0xA6,0x00,0x5A,0x08,0x01,0x05,0x49,0xFF,0xF7,0x07,0xD5,0x03,
+0x49,0xFF,0xF7,0x0B,0xFC,0x80,0xDD,0x9E,0x84,0x40,0xAE,0x80,0x84,0x00,0xAC,0x08,
+0xDD,0x9E,0xFC,0x00,0x84,0x20,0x84,0x01,0x49,0xFF,0xF5,0xF0,0x44,0x00,0x0C,0xD5,
+0x49,0xFF,0xF5,0xF4,0xFC,0x80,0xFC,0x00,0x5A,0x08,0x01,0x05,0x49,0xFF,0xF5,0x82,
+0xD5,0x03,0x49,0xFF,0xF5,0x93,0xFC,0x80,0x44,0x11,0xF6,0x36,0xA6,0x08,0x96,0x00,
+0xE4,0x1E,0xE8,0x08,0xA6,0x08,0x44,0x11,0xF6,0x87,0x8C,0x02,0x96,0x00,0xAE,0x08,
+0xDD,0x9E,0x44,0x01,0xF6,0x87,0xFA,0x2F,0xAE,0x40,0xDD,0x9E,0xFC,0x00,0x84,0x00,
+0x80,0x20,0x49,0xFF,0xF3,0x02,0x49,0xFF,0xF6,0x90,0x49,0x00,0x25,0x29,0x49,0xFF,
+0xFF,0xD2,0x49,0xFF,0xFF,0xE3,0x49,0x00,0x26,0x5D,0x49,0x00,0x25,0x46,0x49,0xFF,
+0xF0,0xD5,0x49,0x00,0x26,0x47,0x49,0xFF,0xF2,0x33,0x49,0x00,0x1B,0xA6,0xFC,0x80,
+0xFC,0x20,0x44,0x71,0xF4,0xBF,0x44,0x61,0xF4,0xC0,0x44,0x0F,0xFF,0xA4,0xAE,0x38,
+0xAE,0x30,0x84,0x00,0x80,0x20,0x80,0x40,0x84,0x67,0x49,0xFF,0xF1,0xF3,0x49,0xFF,
+0xF1,0xDD,0x44,0x0F,0xFF,0xB4,0xAE,0x38,0xAE,0x30,0x44,0x01,0xF4,0xBE,0x84,0x20,
+0xAE,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x84,0x67,0x49,0xFF,0xF1,0xE3,0x49,0xFF,
+0xF1,0xCD,0xFC,0xA0,0xFC,0x20,0x44,0x11,0xF4,0xA0,0x84,0x00,0xAE,0x08,0x44,0x11,
+0xF4,0xA1,0x84,0x62,0xAE,0x08,0x44,0x11,0xF4,0xA2,0x44,0x71,0xF4,0xBF,0xAE,0x08,
+0x44,0x11,0xF4,0xA3,0x44,0x61,0xF4,0xC0,0xAE,0x08,0x44,0x11,0xF4,0xA4,0xAE,0x08,
+0x44,0x11,0xF4,0xA5,0xAE,0x08,0x44,0x11,0xF4,0xA6,0xAE,0x08,0x44,0x11,0xF4,0xA7,
+0xAE,0x08,0x44,0x11,0xF4,0xA8,0xAE,0x08,0x44,0x11,0xF4,0xA9,0xAE,0x08,0x44,0x11,
+0xF4,0xAA,0xAE,0x08,0x44,0x11,0xF4,0xAB,0xAE,0x08,0x44,0x11,0xF4,0xAC,0xAE,0x08,
+0x44,0x11,0xF4,0xAE,0xAE,0x08,0x44,0x11,0xF4,0xAF,0xAE,0x08,0x44,0x11,0xF4,0xB0,
+0xAE,0x08,0x44,0x11,0xF4,0xB1,0xAE,0x08,0x44,0x11,0xF4,0xB2,0xAE,0x08,0x44,0x11,
+0xF4,0xB3,0xAE,0x08,0x44,0x11,0xF4,0xB4,0xAE,0x08,0x44,0x11,0xF4,0xB5,0xAE,0x08,
+0x44,0x11,0xF4,0xB6,0xAE,0x08,0x44,0x11,0xF4,0xB7,0xAE,0x08,0x44,0x11,0xF4,0xB8,
+0xAE,0x08,0x44,0x11,0xF4,0xB9,0xAE,0x08,0x44,0x11,0xF4,0xBA,0xAE,0x08,0x44,0x11,
+0xF4,0xBB,0xAE,0x08,0x44,0x11,0xF4,0xBC,0xAE,0x08,0x84,0x00,0x80,0x20,0x80,0x40,
+0x49,0xFF,0xF1,0x80,0x49,0xFF,0xF1,0x6A,0x44,0x01,0xF4,0xBE,0x84,0x21,0xAE,0x40,
+0x44,0x0F,0xFF,0xA4,0xAE,0x38,0xAE,0x30,0x84,0x00,0x80,0x20,0x80,0x40,0x84,0x67,
+0x49,0xFF,0xF1,0x70,0x49,0xFF,0xF1,0x5A,0x44,0x0F,0xFF,0xAC,0xAE,0x38,0xAE,0x30,
+0x84,0x00,0x80,0x20,0x80,0x40,0x84,0x67,0x49,0xFF,0xF1,0x64,0x49,0xFF,0xF1,0x4E,
+0xFC,0xA0,0xFC,0x00,0x44,0x01,0xF4,0x79,0x84,0x20,0xAE,0x40,0x44,0x01,0xF4,0x7A,
+0x84,0x23,0xAE,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0xFF,0xFD,0x87,
+0xFC,0x80,0x00,0x00,0xFC,0x40,0x81,0x20,0x80,0xE1,0x49,0xFF,0xF5,0xEE,0x44,0x11,
+0xF6,0x8C,0x44,0x01,0xF6,0x91,0xA6,0x88,0xA7,0x80,0xFF,0x97,0xCE,0xFD,0xCF,0x48,
+0x00,0x04,0x80,0x01,0x8E,0x01,0xE6,0x11,0x4E,0xF2,0x00,0x84,0x44,0xF0,0x68,0xFC,
+0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,0x4A,0x00,0x3C,0x00,0x12,0xF4,0x52,0x3E,
+0x52,0x3E,0xF4,0x3E,0x16,0x16,0x46,0x46,0x46,0x46,0x3E,0x52,0x5A,0x00,0x84,0x02,
+0xD5,0x16,0x84,0x01,0x49,0xFF,0xF2,0x07,0x84,0x40,0x84,0x01,0x80,0xA0,0x84,0x22,
+0x80,0x62,0x80,0x82,0x49,0xFF,0xFD,0x15,0x84,0x01,0x49,0xFF,0xF4,0xDB,0x84,0x01,
+0x49,0xFF,0xFE,0x7A,0x84,0x00,0x49,0xFF,0xFD,0xD7,0x84,0x00,0x49,0xFF,0xF2,0xB4,
+0xD5,0x58,0x84,0x01,0x49,0xFF,0xFE,0x70,0x84,0x00,0x49,0xFF,0xFD,0xCD,0x84,0x00,
+0x49,0xFF,0xF4,0x03,0xD5,0x4E,0x84,0x40,0x84,0x01,0x80,0xA0,0x84,0x22,0x80,0x62,
+0x80,0x82,0x49,0xFF,0xFC,0xF6,0x84,0x01,0x49,0xFF,0xF4,0xBC,0xD5,0xE7,0x5A,0x78,
+0x01,0x39,0x00,0x04,0x80,0x01,0x8E,0x03,0xE6,0x0F,0xE8,0x3B,0x44,0xF0,0x69,0x8C,
+0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,0x4A,0x00,0x3C,0x00,0x28,0x10,0x28,0x10,
+0x64,0x10,0x14,0x14,0x22,0x22,0x22,0x22,0x64,0x28,0x2C,0x00,0x84,0x01,0xD5,0xCF,
+0x84,0x01,0x49,0xFF,0xFD,0xA1,0x84,0x01,0x49,0xFF,0xF2,0x7E,0xD5,0x10,0x84,0x01,
+0x49,0xFF,0xFD,0x9A,0x84,0x01,0xD5,0xCD,0x84,0x01,0x49,0xFF,0xFD,0x95,0x49,0xFF,
+0xFF,0x72,0x84,0x01,0x49,0xFF,0xF2,0x70,0x49,0xFF,0xF4,0x1C,0x84,0x00,0x49,0xFF,
+0xFE,0x2B,0x84,0x00,0x49,0xFF,0xF4,0x86,0x84,0x00,0x49,0xFF,0xF1,0xA4,0xD5,0x09,
+0x5A,0x78,0x02,0x08,0x84,0x01,0x49,0xFF,0xF2,0x5F,0x80,0x06,0x49,0xFF,0xF4,0x7A,
+0xFC,0xC0,0x92,0x00,0xFC,0x40,0x84,0x01,0x3E,0x07,0xEA,0xB3,0x2E,0x00,0x21,0xDC,
+0x5A,0x08,0x01,0x2B,0x2E,0x07,0xEA,0xD1,0xC8,0x04,0x3E,0x07,0xEA,0xC3,0xD5,0x10,
+0x2E,0x07,0xEA,0xDF,0x2E,0x17,0xEA,0xD3,0x3E,0x07,0xEA,0xC3,0x5A,0x18,0x01,0x09,
+0x5A,0x08,0x03,0x07,0x84,0x00,0x3E,0x07,0xEA,0xD3,0x49,0xFF,0xE4,0x2D,0x2E,0x10,
+0x21,0x43,0x84,0x00,0x94,0x49,0x3E,0x07,0xEA,0xB2,0x3E,0x07,0xEA,0xB5,0x3E,0x07,
+0xFC,0x18,0x3E,0x07,0xFD,0xBD,0x3E,0x07,0xEA,0xDF,0x54,0x10,0x80,0xFE,0x44,0x01,
+0x92,0x50,0x49,0xFF,0xE1,0x30,0x3C,0x0D,0xFB,0x0A,0x84,0xC0,0x3C,0x6F,0xFA,0xE3,
+0xA6,0x01,0x3E,0x07,0xEA,0xE1,0x49,0xFF,0xF1,0x6F,0x3C,0x2D,0xFB,0x0A,0x5A,0x08,
+0x02,0x11,0x2E,0x07,0xEA,0xE1,0x5A,0x08,0x06,0x08,0x84,0x08,0xAE,0x11,0x80,0x26,
+0x80,0x02,0x49,0xFF,0xFF,0x21,0x3C,0x0D,0xFB,0x0A,0xFA,0x20,0xAE,0x41,0xD5,0x06,
+0xA6,0x11,0x5A,0x08,0x02,0x04,0x84,0x0B,0xAE,0x11,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,
+0xDF,0xD9,0x84,0x01,0x3E,0x07,0xFC,0xD1,0x49,0xFF,0xFB,0x48,0x84,0x08,0x49,0x00,
+0x13,0xB9,0x2E,0x00,0x21,0xE6,0x5A,0x08,0x01,0x04,0x49,0x00,0x0D,0x78,0x84,0x09,
+0x49,0x00,0x13,0xB0,0x2E,0x60,0x21,0xDC,0x5A,0x68,0x01,0x3A,0x49,0xFF,0xE2,0xEE,
+0x2E,0x07,0xFC,0x18,0xC8,0x21,0x49,0xFF,0xE5,0xC1,0x44,0x11,0x00,0x00,0x44,0x21,
+0x0E,0x70,0x44,0x31,0x0E,0x60,0x44,0x41,0x2E,0x70,0x2E,0x00,0x21,0xFC,0x49,0x00,
+0x23,0x3B,0x3E,0x67,0xEA,0xA7,0x3E,0x67,0xEA,0xD3,0x49,0xFF,0xE3,0xC5,0x84,0x03,
+0x3E,0x07,0xEA,0xDF,0x49,0xFF,0xE5,0xAA,0x44,0x0F,0xFF,0xE2,0x49,0xFF,0xE5,0x96,
+0x49,0xFF,0xFB,0x60,0xD5,0x20,0x2E,0x00,0x22,0x6A,0x44,0x11,0x00,0x00,0x44,0x21,
+0x0E,0x70,0x44,0x31,0x0E,0x60,0x44,0x41,0x2E,0x70,0x49,0x00,0x23,0x1D,0x2E,0x07,
+0xEA,0xD3,0x5A,0x08,0x01,0x11,0x3E,0x07,0xEA,0xB2,0xD5,0x0D,0x2E,0x00,0x21,0xFC,
+0x44,0x11,0x00,0x00,0x44,0x21,0x0E,0x70,0x44,0x31,0x0E,0x60,0x44,0x41,0x2E,0x70,
+0x49,0x00,0x23,0x0A,0x49,0xFF,0xF0,0xF8,0x3C,0x1D,0xFB,0x0A,0x2E,0x27,0xEA,0xE1,
+0x5A,0x08,0x02,0x06,0x9E,0x12,0xE6,0x02,0xE8,0x04,0xD5,0x05,0x5A,0x20,0x02,0x04,
+0xAE,0x89,0xD5,0x03,0xFA,0x00,0xAE,0x09,0x2E,0x00,0x21,0xDC,0x5A,0x00,0x01,0x0F,
+0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xDF,0x66,0x2E,0x07,0xEA,0xB4,0x5A,0x08,0x01,0x29,
+0x49,0xFF,0xF8,0x6A,0x3C,0x0F,0xFF,0x6A,0xD5,0x23,0x84,0xC0,0x44,0x91,0x06,0x30,
+0x44,0x71,0x90,0xCC,0x2E,0x00,0x21,0x6E,0xE2,0xC0,0xE8,0xEB,0x2E,0x20,0x21,0x43,
+0x44,0x01,0x90,0x38,0x94,0x91,0x42,0x13,0x08,0x24,0x94,0x49,0x88,0x29,0x49,0xFF,
+0xEF,0x46,0x2E,0x20,0x21,0x43,0x44,0x01,0x90,0x38,0x94,0x91,0x42,0x13,0x08,0x24,
+0x94,0x49,0x88,0x27,0x8C,0xC1,0x49,0xFF,0xEF,0x3A,0x97,0xB0,0xD5,0xE4,0x84,0x00,
+0x84,0x23,0x3E,0x07,0xEA,0xB4,0x3E,0x17,0xEA,0xA8,0x3E,0x07,0xEA,0xB3,0xFC,0xC0,
+0xFC,0x20,0x2E,0x07,0xEA,0xDD,0x5A,0x08,0x01,0x26,0x49,0xFF,0xF0,0xA5,0xC8,0x22,
+0x3C,0x0D,0xFB,0x14,0xA6,0x40,0x5A,0x18,0x01,0xFF,0xA6,0x00,0x5A,0x08,0x01,0x1B,
+0x3C,0x0D,0xFA,0xFF,0xA7,0x80,0x97,0xB0,0x5A,0x68,0x01,0x15,0x84,0xE0,0xAF,0xC0,
+0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0xFF,0xFE,0x4F,0x3C,0x0D,0xFA,0xE3,0x44,0x11,
+0x82,0xC0,0x49,0xFF,0xDE,0x08,0x3C,0x0D,0xFB,0x14,0xAF,0xC0,0x80,0x06,0x49,0xFF,
+0xDD,0xB5,0xFC,0xA0,0xFC,0x00,0x44,0x01,0xF4,0x79,0x84,0x23,0xAE,0x40,0x44,0x01,
+0xF4,0x7A,0x84,0x20,0xAE,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0xFF,
+0xFB,0xB6,0xFC,0x80,0xFC,0x00,0x44,0x21,0xA2,0x78,0x2E,0x30,0x22,0x08,0xB4,0x02,
+0xA0,0x52,0xA0,0x94,0x49,0xFF,0xEF,0x36,0xFC,0x80,0xFC,0x00,0x44,0x00,0x00,0xFD,
+0x49,0xFF,0xF3,0xE3,0x44,0x61,0xF0,0x6D,0xA6,0x30,0x52,0x00,0x00,0x01,0x49,0xFF,
+0xF0,0x45,0x44,0x00,0x00,0x32,0x49,0xFF,0xF8,0x50,0xA6,0x30,0x52,0x00,0x00,0x01,
+0x49,0xFF,0xF0,0x3C,0x44,0x00,0x07,0xD0,0x49,0xFF,0xF8,0x47,0x49,0xFF,0xF3,0xFD,
+0xD5,0xEC,0xA4,0x40,0x8C,0x21,0x96,0x49,0x5C,0xF0,0x81,0x90,0xAC,0x40,0xE9,0x08,
+0xFC,0x00,0x84,0x00,0x49,0xFF,0xDD,0x72,0x49,0xFF,0xFF,0xD9,0x92,0x00,0xDD,0x9E,
+0xA7,0x40,0xD9,0x10,0x8C,0xA1,0x97,0x68,0xE6,0xA5,0xE9,0x02,0x84,0xA0,0xAF,0x40,
+0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xEA,0xBD,0x44,0x01,0x27,0xC0,0xA6,0x00,0xC8,0x0F,
+0xDD,0x9E,0xFC,0x00,0x44,0x11,0x27,0xC0,0xA6,0x08,0x8C,0x01,0x96,0x00,0xAE,0x08,
+0x84,0x00,0x49,0xFF,0xDD,0x53,0x49,0xFF,0xFF,0xBA,0x92,0x00,0x84,0x01,0x3E,0x07,
+0xFD,0xC1,0xDD,0x9E,0x3C,0x0F,0xFA,0xF2,0xDD,0x9E,0x3C,0x0F,0xFA,0xF3,0xDD,0x9E,
+0xFC,0x00,0x49,0xFF,0xFD,0x1F,0x84,0x01,0x49,0xFF,0xDD,0x40,0x49,0xFF,0xDD,0x31,
+0xC8,0x17,0x3C,0x0D,0xFB,0x35,0xC8,0x14,0x49,0xFF,0xFB,0x03,0x2E,0x07,0xEA,0xBA,
+0x5A,0x08,0x01,0x06,0x44,0x01,0x81,0xC6,0x49,0xFF,0xFF,0xB5,0x84,0x40,0x84,0x01,
+0x80,0x20,0x80,0x62,0x80,0x82,0x80,0xA2,0x49,0xFF,0xFA,0xFB,0xD5,0xE8,0x49,0xFF,
+0xFD,0x23,0xFC,0x80,0xFC,0x40,0x84,0x00,0x3C,0x0B,0xF5,0x7B,0x3C,0x4D,0xFA,0xF2,
+0x3C,0x5C,0x02,0xF7,0x3C,0x6C,0x02,0xF8,0x84,0x40,0xA6,0x23,0x94,0x01,0xE0,0x40,
+0xE8,0x13,0x94,0x51,0x99,0xE9,0x88,0x26,0xA4,0xF8,0xA4,0x38,0xA4,0x48,0x40,0x90,
+0x08,0x09,0x40,0x01,0x84,0x09,0x88,0x09,0x92,0x22,0x88,0x01,0x96,0x01,0x8C,0x41,
+0xAC,0x38,0x96,0x90,0xD5,0xEB,0xFC,0xC0,0xFC,0x40,0x84,0x20,0x3C,0x1B,0xF5,0x7A,
+0x3E,0x17,0xEA,0xC5,0x3C,0x1B,0xF5,0x7B,0x3C,0x5D,0xFA,0xF2,0x3C,0x6D,0xFB,0x0A,
+0x3C,0x3C,0x02,0xF8,0x3C,0x7C,0x02,0xF6,0x3C,0x9C,0x02,0xF7,0x84,0x00,0x44,0x41,
+0xA5,0xC4,0x44,0xA1,0xA2,0xDC,0x80,0x41,0xA6,0x6B,0x94,0x49,0xE0,0x01,0xE8,0x27,
+0x00,0x83,0x00,0x01,0x94,0x41,0x5A,0x88,0x04,0x0D,0x38,0x82,0x01,0x01,0x40,0x84,
+0x00,0x13,0x38,0x82,0x01,0x09,0x38,0xF2,0x01,0x01,0x40,0x81,0x84,0x00,0xD5,0x07,
+0x40,0xF3,0x84,0x00,0x40,0x81,0x84,0x00,0x02,0xF7,0x80,0x00,0x40,0xF7,0x80,0x13,
+0x12,0xF4,0x00,0x00,0x40,0x84,0x84,0x00,0x88,0x23,0xA4,0x48,0x96,0x49,0x12,0x14,
+0x00,0x00,0x38,0x25,0x00,0x08,0x8C,0x01,0x96,0x00,0xD5,0xD7,0xFC,0xC0,0x52,0x31,
+0x00,0x20,0x96,0xD8,0x88,0x02,0x80,0x81,0x9A,0xA1,0x96,0x90,0xE2,0x43,0xE8,0x06,
+0x08,0x20,0x00,0x01,0x18,0x22,0x00,0x01,0xD5,0xF8,0x84,0x00,0x5C,0xF1,0x80,0x20,
+0xE8,0x06,0x38,0x00,0x8C,0x08,0x8C,0x61,0x96,0xD8,0xD5,0xF9,0xDD,0x9E,0x3C,0x3D,
+0xFA,0xD5,0x84,0xA0,0x9C,0x6E,0xA2,0x99,0x96,0x48,0x5A,0x58,0x20,0x06,0x80,0xA1,
+0x5A,0x18,0x24,0xFA,0xDD,0x9E,0x54,0x41,0x00,0x1F,0x38,0x40,0x14,0x08,0x8C,0xA1,
+0x97,0x68,0x92,0x45,0xD9,0xF3,0xD5,0xF4,0xFC,0x20,0x3C,0x5D,0xFA,0xD5,0x84,0xC5,
+0x50,0x42,0x80,0x14,0x84,0x20,0x80,0x41,0x38,0x30,0x04,0x00,0x42,0x70,0x98,0x24,
+0x40,0x31,0x9C,0x0C,0x8C,0x21,0x88,0x43,0x5A,0x18,0x06,0xF8,0xAA,0xA9,0x8C,0x06,
+0xDC,0xF2,0xFC,0xA0,0x5A,0x38,0x01,0x0A,0xFC,0x00,0x80,0xC1,0x49,0xFF,0xFF,0xB9,
+0x80,0x06,0x49,0xFF,0xFF,0xE3,0xFC,0x80,0xDD,0x9E,0xFC,0x20,0x84,0x01,0x49,0xFF,
+0xF1,0x7B,0x84,0x01,0x3E,0x07,0xEA,0xC9,0x44,0x61,0xA5,0xC4,0x2E,0x07,0xEA,0xC9,
+0xE6,0x02,0xE8,0x28,0x49,0xFF,0xFA,0x2D,0x3C,0x5D,0xFB,0x33,0x2E,0x27,0xEA,0xC9,
+0xDA,0xF6,0x3C,0x0D,0xFA,0xF2,0x3C,0x4C,0x02,0xF6,0xA6,0xC3,0x84,0x00,0x94,0xD9,
+0x80,0xA0,0xE0,0x03,0xE8,0x13,0x3C,0x1D,0xFB,0x33,0x5A,0x18,0x01,0x04,0x38,0x53,
+0x01,0x09,0x94,0x41,0x88,0x24,0xA5,0xC8,0x38,0x13,0x01,0x01,0x88,0x27,0x96,0x49,
+0x38,0x13,0x01,0x09,0x8C,0x01,0x96,0x00,0xD5,0xED,0x9C,0x11,0x3E,0x07,0xEA,0xC9,
+0xD5,0xD6,0xFC,0xA0,0xFC,0x00,0x3C,0x0D,0xFA,0xF2,0x3C,0x4C,0x02,0xF9,0x3C,0x5D,
+0xFA,0xF3,0xA6,0x83,0x84,0x20,0x94,0x91,0x84,0x01,0xE0,0x22,0xE8,0x0C,0x94,0xC9,
+0x88,0x64,0xA5,0xAA,0xA4,0xD8,0x96,0xDB,0xE0,0xC3,0xE8,0x02,0x84,0x00,0x8C,0x21,
+0x96,0x48,0xD5,0xF4,0xFC,0x80,0x3C,0x0D,0xFA,0xF3,0x00,0x00,0x00,0x14,0xDD,0x9E,
+0x5A,0x08,0x04,0x05,0x3C,0x03,0xFE,0x6D,0xDD,0x9E,0x3C,0x0D,0xFA,0xF3,0x02,0x00,
+0x00,0x08,0xDD,0x9E,0x5A,0x08,0x04,0x05,0x3C,0x03,0xFE,0x6C,0xDD,0x9E,0x3C,0x0D,
+0xFA,0xF3,0x02,0x00,0x00,0x09,0xDD,0x9E,0x3C,0x0D,0xFA,0xF3,0xA4,0x00,0xDD,0x9E,
+0xA6,0x00,0x92,0x01,0x96,0x06,0x5A,0x00,0x01,0x07,0xA6,0x08,0x92,0x01,0x96,0x06,
+0x5A,0x08,0x01,0x08,0x44,0x00,0x00,0x64,0x3C,0x0B,0xFE,0x6D,0x84,0x02,0xD5,0x07,
+0x3C,0x0D,0xFA,0xF3,0xA4,0x46,0xA4,0x07,0x3C,0x1B,0xFE,0x6D,0x3C,0x0B,0xFE,0x6C,
+0xDD,0x9E,0x2E,0x17,0xEA,0xAE,0xC9,0x0A,0x84,0x42,0x3E,0x17,0xEA,0x9D,0x3E,0x27,
+0xEA,0xA0,0x3E,0x17,0xEA,0xC5,0x10,0x10,0x00,0x1D,0xDD,0x9E,0xFC,0x40,0x80,0x20,
+0x2E,0x07,0xEA,0xA0,0x5A,0x08,0x02,0x0A,0x2E,0x07,0xEA,0x9D,0xC8,0x06,0x2E,0x37,
+0xEA,0x9E,0x5C,0x31,0x80,0x01,0xD5,0x02,0x84,0x60,0x3C,0x0D,0xFA,0xF2,0x3C,0x9C,
+0x02,0xF8,0x84,0xA0,0xA7,0x03,0x44,0xA1,0x9B,0xE8,0x95,0xA1,0x8E,0xC1,0x9F,0xE1,
+0x84,0x01,0x52,0x80,0x80,0x00,0xE0,0xA6,0xE8,0x1B,0xD7,0x17,0x40,0xF2,0x84,0x08,
+0x40,0x24,0xBC,0x00,0x50,0xF7,0x80,0x02,0x40,0xF4,0xBC,0x00,0xA4,0x90,0x02,0xF7,
+0x80,0x00,0x8A,0x4F,0x96,0x93,0xE0,0x22,0x38,0x25,0x15,0x09,0xE9,0x03,0xE0,0x48,
+0xE8,0x04,0x5A,0x38,0x01,0x03,0x84,0x02,0x8C,0xA1,0x97,0x68,0xD5,0xE5,0x5A,0x38,
+0x01,0x24,0x40,0x20,0x84,0x09,0x44,0x31,0x9B,0xE8,0x84,0x20,0x81,0x23,0xFF,0x52,
+0xE0,0x27,0xE8,0x16,0x38,0x61,0x85,0x11,0xE0,0x46,0xE8,0x07,0x40,0xA0,0x90,0x00,
+0x38,0xF1,0xA9,0x11,0xE0,0x4F,0xE9,0x08,0xE0,0xC5,0xE8,0x07,0x99,0x8C,0x38,0x64,
+0x99,0x11,0xE0,0xC5,0xE8,0x02,0x84,0x02,0x8C,0x21,0x96,0x48,0xD5,0xEA,0x5A,0x08,
+0x01,0x04,0x3E,0x07,0xEA,0x9D,0xFC,0xC0,0xFC,0x49,0x3C,0x9D,0xFA,0xF3,0xF0,0x8E,
+0x84,0x40,0x44,0x01,0x00,0x00,0xA8,0x8A,0xA8,0x0B,0x00,0x04,0x80,0x03,0xF1,0x81,
+0xE6,0x10,0xE8,0x04,0x52,0x20,0x00,0x10,0x96,0x90,0xE6,0x11,0xF2,0x82,0x80,0x40,
+0xE9,0x02,0xFA,0x40,0x96,0x10,0xF0,0x84,0x3C,0x0D,0xFA,0xF2,0x3C,0x4C,0x02,0xF9,
+0xF0,0x85,0xA7,0x83,0x3C,0x0D,0xFB,0x0A,0x95,0xF1,0xF0,0x89,0x3C,0x0C,0x02,0xF8,
+0x2E,0x37,0xEA,0xC5,0xF0,0x83,0x3C,0x0C,0x02,0xF6,0x45,0xE1,0xA5,0xC4,0xF0,0x8A,
+0x3C,0x0C,0x02,0xF7,0x44,0xA1,0xA2,0xDC,0xF0,0x8B,0x2E,0x07,0xEA,0x9D,0xF0,0x8C,
+0x2E,0x07,0xEA,0x9E,0xF0,0x8D,0x2E,0x07,0xEA,0x99,0xF0,0x88,0x9E,0x39,0xF0,0x87,
+0xF2,0x07,0x84,0x00,0x8A,0x46,0x94,0x91,0x88,0x44,0xF2,0x8F,0x9E,0xB1,0xF2,0x90,
+0x98,0xA7,0x80,0xA0,0xF2,0x91,0xF1,0x05,0xA6,0x8B,0x94,0x91,0xE0,0xA2,0x4E,0xF2,
+0x00,0xD7,0xF0,0x09,0xA6,0x01,0x5A,0x08,0x04,0x11,0x38,0x0F,0x15,0x01,0x94,0xA9,
+0x96,0x01,0x38,0x0F,0x15,0x09,0xF0,0x03,0xF1,0x04,0x88,0x40,0xA5,0xD0,0x38,0x0F,
+0x15,0x01,0xFE,0x0C,0xF1,0x02,0xD5,0x0B,0xF0,0x03,0x95,0xE9,0x98,0x87,0xF1,0x0A,
+0xA4,0x10,0x88,0xE1,0xF1,0x02,0xA5,0xF8,0xFE,0x0C,0xF1,0x04,0x42,0x03,0x84,0x73,
+0x92,0x04,0x96,0x01,0xAC,0x10,0xF1,0x0B,0xF0,0x03,0x94,0xA9,0x88,0x22,0x88,0x02,
+0x40,0x82,0x08,0x00,0xA5,0xC0,0x02,0xF0,0x80,0x00,0xF1,0x86,0x8A,0xEF,0x97,0xFB,
+0x12,0x74,0x00,0x00,0x02,0x74,0x00,0x00,0x40,0xF3,0x80,0x11,0x02,0x74,0x80,0x04,
+0xFF,0xFA,0x40,0xF7,0x9C,0x07,0xE8,0x1B,0xF1,0x0C,0x5A,0x10,0x01,0x04,0xF1,0x0D,
+0xC9,0x16,0x38,0x75,0x14,0x00,0x8C,0xE1,0x97,0xF8,0x38,0x75,0x14,0x08,0x02,0xF4,
+0x80,0x05,0x40,0xF7,0x9C,0x06,0xE8,0x11,0xA5,0xC0,0xF1,0x06,0x97,0xF9,0xAD,0xC8,
+0x84,0x20,0x38,0x15,0x14,0x08,0x84,0x21,0xF1,0x88,0xD5,0x07,0x38,0x75,0x14,0x00,
+0xC7,0x04,0x8E,0xE1,0x38,0x75,0x14,0x08,0xF1,0x01,0x02,0xF0,0x00,0x00,0xA1,0xCA,
+0xE2,0xEF,0xE8,0x03,0xA5,0xC0,0xA9,0xCA,0xF1,0x01,0xA5,0xC0,0x04,0xF0,0x80,0x03,
+0xE2,0xEF,0xE8,0x03,0xA4,0x00,0xA8,0x0B,0xF0,0x0E,0xA6,0x01,0x5A,0x08,0x04,0x05,
+0x02,0x04,0x80,0x03,0xD5,0x03,0x02,0x04,0x80,0x02,0x02,0x74,0x00,0x00,0x97,0xFB,
+0xE0,0x07,0xE8,0x59,0xE2,0xA6,0xE8,0x2B,0xCD,0x0B,0x8C,0x42,0x88,0x44,0xA5,0xD0,
+0x40,0x20,0x08,0x09,0x97,0xFB,0xE0,0x47,0xE9,0x4D,0xF1,0x11,0xD5,0x36,0x9F,0xD2,
+0x88,0xE4,0xF1,0x10,0xA5,0xF8,0xD9,0x0D,0x97,0xFB,0x40,0x20,0x08,0x09,0xE0,0x47,
+0xE9,0x41,0x99,0xEE,0x95,0xF9,0x88,0xE4,0xA5,0xF8,0x97,0xFB,0xE0,0x47,0xD5,0x39,
+0x40,0xF3,0x80,0x11,0x40,0x70,0x08,0x09,0xE0,0xEF,0xE9,0x34,0x8C,0x42,0x88,0x44,
+0xA4,0x90,0x96,0x93,0xE0,0xE2,0xE9,0x2E,0x98,0xAE,0xD5,0x26,0xDE,0x0B,0x8C,0x42,
+0x88,0x44,0xA5,0xD0,0x40,0x20,0x08,0x09,0x97,0xFB,0xE0,0x47,0xE9,0x23,0xA5,0xE0,
+0xD5,0xE5,0x9F,0xD2,0x88,0xE4,0xF1,0x07,0xA5,0xF8,0xD9,0x09,0x97,0xFB,0x40,0x20,
+0x08,0x09,0xE0,0x47,0xE9,0x17,0xF1,0x0F,0xA5,0xC8,0xD5,0xD8,0x40,0xF3,0x80,0x11,
+0x40,0x70,0x08,0x09,0xE0,0xEF,0xE9,0x0E,0x8C,0x42,0x88,0x44,0xA4,0x90,0x96,0x93,
+0xE0,0xE2,0xE9,0x08,0x9A,0xAE,0x94,0x91,0x88,0x44,0xA4,0x90,0x96,0x93,0xE0,0xE2,
+0xE8,0x02,0x84,0x61,0x8C,0xA1,0x97,0x68,0x48,0xFF,0xFF,0x27,0x00,0x1F,0x80,0x20,
+0x3E,0x37,0xEA,0xC5,0x3E,0x17,0xEA,0x99,0x49,0xFF,0xFE,0x7A,0x3E,0x07,0xEA,0xA0,
+0xFC,0xC9,0xFC,0x40,0x3C,0x23,0xF5,0x7B,0x80,0xE1,0x8C,0x41,0x3C,0x2B,0xF5,0x7B,
+0x3C,0x23,0xF5,0x7A,0x80,0xC0,0x8C,0x41,0x3C,0x2B,0xF5,0x7A,0xA6,0x41,0x50,0x93,
+0xFF,0xFC,0x5A,0x18,0x04,0x12,0x84,0x01,0x49,0xFF,0xEF,0x4E,0x84,0x01,0x49,0xFF,
+0xEF,0x5A,0x84,0x01,0x49,0xFF,0xEF,0x37,0xE7,0x24,0xE9,0x0B,0x5A,0x70,0x0C,0x0A,
+0x49,0xFF,0xFD,0xC5,0xD5,0x06,0x84,0x20,0x49,0xFF,0xFA,0xBE,0x49,0xFF,0xFC,0xEA,
+0x80,0x06,0x44,0x11,0xA9,0x30,0x49,0xFF,0xFE,0xA9,0x2E,0x07,0xEA,0xC5,0x5A,0x08,
+0x01,0x06,0x84,0x00,0x3E,0x07,0xEA,0xD7,0xD5,0x13,0x2E,0x77,0xEA,0x9D,0x5A,0x78,
+0x01,0x10,0x44,0x01,0xA9,0x30,0x3C,0x10,0x11,0x18,0x44,0x21,0x81,0x97,0x49,0x00,
+0x09,0xD3,0x5A,0x08,0x02,0x06,0x3E,0x77,0xEA,0xC5,0x3E,0x77,0xEA,0xEB,0x2E,0x07,
+0xEA,0x9D,0xC8,0x24,0xA6,0x30,0x5A,0x08,0x02,0x22,0x2E,0x07,0xEA,0x9E,0x5A,0x00,
+0x01,0x0A,0x2E,0x07,0xEA,0x99,0x5A,0x08,0x01,0x11,0x2E,0x07,0xEA,0xA0,0x5A,0x08,
+0x01,0x0D,0x49,0xFF,0xFD,0xC1,0xC8,0x06,0x3E,0x07,0xEA,0xC5,0x3C,0x0B,0xF5,0x7B,
+0xD5,0x04,0x84,0x01,0x3E,0x07,0xEA,0x9D,0x2E,0x07,0xEA,0x9E,0xC8,0x07,0x2E,0x17,
+0xEA,0xA0,0x5A,0x18,0x02,0x04,0x3E,0x07,0xEA,0xC5,0x44,0x0F,0xFF,0xAA,0xE7,0x22,
+0x3E,0x07,0xEA,0xBD,0xE8,0x0B,0x49,0x00,0x0E,0x79,0x84,0x00,0x3E,0x07,0xEA,0xC5,
+0x84,0x00,0x3C,0x0B,0xF5,0x7A,0x3C,0x0B,0xF5,0x7B,0x2E,0x07,0xEA,0xAE,0x5A,0x08,
+0x01,0x06,0x3E,0x07,0xEA,0xC5,0x3E,0x07,0xEA,0x9D,0xFC,0xC0,0x3C,0x0F,0xFF,0x3C,
+0xDD,0x9E,0x3C,0x0F,0xFF,0x3B,0xDD,0x9E,0xFC,0x00,0x84,0x00,0x84,0x20,0x3E,0x07,
+0xFC,0xEB,0x3E,0x07,0xFC,0xE7,0x3E,0x07,0xFC,0xE6,0x3C,0x1B,0xFE,0x72,0x3C,0x1B,
+0xFE,0x71,0x3E,0x17,0xFC,0xEA,0x3E,0x07,0xFC,0xE9,0x44,0x10,0x00,0x40,0x3E,0x07,
+0xFC,0xE8,0x84,0x00,0x3E,0x17,0xEA,0x35,0x3E,0x17,0xEA,0x34,0x3C,0x0F,0xFF,0x3D,
+0xFC,0x80,0x3C,0x0D,0xFF,0x3C,0xA4,0x41,0x3C,0x1B,0xFE,0x70,0xA4,0x44,0xA6,0x00,
+0x3C,0x1B,0xFE,0x6F,0x3E,0x07,0xFC,0xDC,0xDD,0x9E,0x3C,0x43,0xFE,0x70,0x3C,0x2D,
+0xFF,0x3C,0x3C,0x33,0xFE,0x6F,0xC0,0x09,0xE6,0x8F,0xE9,0x03,0x8E,0x85,0xAD,0x11,
+0xE6,0x6F,0xE9,0x05,0x8E,0x65,0xD5,0x02,0xAD,0x11,0xAC,0xD4,0xA6,0x09,0x5A,0x08,
+0x06,0x04,0x84,0x01,0xD5,0x03,0x2E,0x07,0xFC,0xDC,0xAE,0x10,0xDD,0x9E,0xFC,0x46,
+0x3C,0x0D,0xFF,0x3B,0x83,0xC1,0x84,0xC0,0xA6,0x42,0xA6,0x03,0xF3,0x87,0xF4,0x88,
+0xF1,0x81,0x40,0xA0,0x84,0x08,0xF2,0x86,0xF0,0x84,0x3C,0x3D,0xFF,0x3C,0x15,0xEF,
+0x80,0x05,0x80,0x86,0x80,0x26,0xF6,0x83,0x81,0x06,0xF6,0x82,0x80,0xA6,0xF0,0x04,
+0xD0,0x3B,0x97,0xEA,0xF0,0x05,0x84,0x40,0xF7,0x89,0xF7,0x01,0x4C,0x23,0x80,0x2F,
+0x02,0xF0,0x00,0x00,0x40,0xF7,0x80,0x11,0xE0,0xCF,0xE8,0x05,0xA5,0x80,0x96,0x52,
+0x97,0xB3,0xF4,0x09,0x02,0xF0,0x00,0x00,0x02,0x91,0x80,0x02,0x40,0xF7,0x80,0x11,
+0xE1,0x2F,0xE9,0x14,0x02,0xF0,0x00,0x00,0x02,0x91,0x80,0x01,0x40,0xF7,0x80,0x11,
+0xE1,0x2F,0xE9,0x0F,0x02,0x90,0x00,0x00,0x22,0xF1,0x80,0x03,0x40,0x94,0x80,0x11,
+0xE1,0x2F,0xE8,0x08,0x84,0xE1,0xF7,0x83,0xD5,0x05,0x84,0xE1,0xF7,0x82,0xD5,0x02,
+0x85,0x01,0x8C,0x41,0x96,0x90,0x8C,0x02,0xD5,0xD1,0xF0,0x05,0x8C,0xA1,0x88,0x0A,
+0x97,0x68,0xF0,0x85,0xD5,0xC5,0xA4,0x99,0x3C,0x07,0xFE,0x71,0xE0,0x46,0xE8,0x16,
+0x9A,0x30,0x4E,0x04,0x00,0x03,0xFE,0x02,0xFA,0x58,0xFE,0xB4,0x44,0xF0,0x00,0x64,
+0x96,0x03,0x40,0xF1,0x3D,0xF6,0xE0,0x0F,0xE8,0x12,0xE4,0x05,0xE8,0x10,0xE4,0xC8,
+0xE9,0x0E,0x84,0x01,0x3E,0x07,0xFC,0xEA,0xD5,0x0A,0xA4,0x1C,0xE0,0x06,0x4E,0xF3,
+0x01,0xB0,0x84,0x00,0x3E,0x07,0xFC,0xEA,0x48,0x00,0x01,0xAB,0x2E,0x2F,0xEA,0x35,
+0x5A,0x28,0x40,0x04,0x48,0x00,0x01,0x9F,0x9A,0x8A,0x2E,0x0F,0xEA,0x34,0x4E,0x24,
+0x00,0x03,0xFE,0x92,0x96,0x92,0xE4,0x42,0xE8,0x08,0x9A,0x20,0x4E,0x04,0x00,0x03,
+0xFE,0x02,0x96,0x02,0xE4,0x02,0xE9,0x04,0x84,0x01,0x3E,0x07,0xFC,0xE9,0x84,0x60,
+0x5A,0x88,0x01,0x51,0x85,0x40,0x4E,0x17,0x00,0x05,0x9E,0x09,0x54,0xA0,0x00,0xFF,
+0xF0,0x01,0x9F,0xC1,0xE0,0x27,0xE8,0x02,0x9D,0xC9,0x97,0xF8,0x84,0x60,0x4E,0x47,
+0x00,0x04,0x9E,0xE1,0x96,0xD8,0xF0,0x04,0x8E,0x01,0xE0,0x80,0xE8,0x02,0x9C,0x21,
+0x84,0x40,0x54,0x90,0x00,0xFF,0x80,0x02,0xE3,0x23,0xE9,0x19,0xF5,0x01,0x8A,0x0A,
+0xFF,0x5C,0xF5,0x85,0xF0,0x89,0x80,0xAA,0xF0,0x09,0xE2,0xE5,0x88,0x05,0x96,0x00,
+0xE9,0x0B,0xF0,0x05,0x88,0x05,0x94,0x01,0x88,0x1E,0x8C,0xA1,0xA4,0x00,0x97,0x68,
+0x88,0x40,0x96,0x93,0xD5,0xF2,0x8C,0x61,0x96,0xD8,0xD5,0xE7,0xF3,0x01,0x42,0x12,
+0x0C,0x73,0x3C,0x4D,0xFF,0x3C,0x94,0x49,0x88,0x3E,0xA5,0x65,0x84,0x69,0xFF,0x44,
+0xA4,0x48,0x40,0xF2,0x8D,0xF6,0xE0,0x4F,0x96,0x4B,0xE9,0x0B,0x8A,0x41,0xA4,0x66,
+0x8E,0x01,0xFE,0x0C,0x96,0x93,0x40,0x30,0x0C,0x76,0x40,0x31,0x0C,0x07,0xD5,0x02,
+0x84,0x61,0x3C,0x0D,0xFF,0x3D,0x5A,0x00,0x01,0x35,0xC0,0x05,0x5A,0x00,0x02,0x57,
+0x48,0x00,0x00,0x92,0x3C,0x0D,0xFF,0x3C,0x3C,0x17,0xFE,0x71,0xA4,0x81,0xE0,0x22,
+0xE8,0x03,0x84,0x20,0xD5,0x05,0xA4,0x82,0xE0,0x41,0xE8,0x04,0x84,0x21,0x3E,0x17,
+0xFC,0xE8,0x2E,0x17,0xFC,0xE8,0xC9,0x3A,0x5A,0x88,0x01,0x39,0xF1,0x02,0xC9,0x36,
+0xF1,0x03,0xC9,0x34,0xCB,0x33,0x2E,0x17,0xFC,0xEA,0x5A,0x10,0x01,0x06,0x2E,0x17,
+0xFC,0xE9,0x5A,0x18,0x01,0x2C,0x2E,0x17,0xFC,0xE7,0xA6,0x00,0x8C,0x21,0x8C,0x01,
+0x96,0x48,0x90,0x01,0xE0,0x01,0x3E,0x17,0xFC,0xE7,0x84,0x01,0xE9,0x1D,0xD5,0x63,
+0x5A,0x88,0x01,0x21,0xF0,0x02,0xC8,0x1E,0xF0,0x03,0xC8,0x1C,0xCB,0x1B,0x2E,0x07,
+0xFC,0xEA,0x5A,0x00,0x01,0x06,0x2E,0x07,0xFC,0xE9,0x5A,0x08,0x01,0x14,0x3C,0x1D,
+0xFF,0x3C,0x2E,0x07,0xFC,0xE7,0xA6,0x48,0x8C,0x01,0x96,0x00,0xE2,0x20,0x3E,0x07,
+0xFC,0xE7,0xE8,0x49,0x84,0x02,0x3C,0x0F,0xFF,0x3D,0x84,0x00,0x3E,0x07,0xFC,0xE7,
+0xD5,0x42,0x84,0x00,0x3C,0x0F,0xFF,0x3D,0xD5,0xFA,0xF1,0x02,0x3C,0x0D,0xFF,0x3C,
+0x5A,0x10,0x01,0x07,0xF1,0x03,0x5A,0x10,0x01,0x04,0x5A,0x38,0x01,0x20,0x2E,0x17,
+0xFC,0xE6,0xA6,0x81,0xE2,0x41,0xE9,0x04,0x8C,0x21,0x3E,0x17,0xFC,0xE6,0x3C,0x13,
+0xFE,0x72,0xA4,0x07,0xE2,0x01,0xE9,0x04,0x8C,0x21,0x3C,0x1B,0xFE,0x72,0x2E,0x17,
+0xFC,0xE6,0xE2,0x41,0xE9,0x05,0x3C,0x13,0xFE,0x72,0xE2,0x01,0xE8,0x1C,0x84,0x00,
+0x3C,0x0F,0xFF,0x3D,0x3E,0x07,0xFC,0xE6,0xD5,0x14,0x84,0x20,0x3E,0x17,0xFC,0xE6,
+0x84,0x20,0x5A,0x80,0x01,0x05,0x3C,0x13,0xFE,0x72,0x8C,0x21,0x3C,0x1B,0xFE,0x72,
+0x3C,0x13,0xFE,0x72,0xA4,0x07,0xE2,0x01,0xE8,0x06,0x84,0x00,0x3C,0x0F,0xFF,0x3D,
+0x3C,0x0B,0xFE,0x72,0x3C,0x0D,0xFF,0x3D,0x5A,0x08,0x02,0x04,0x84,0x01,0xD5,0x02,
+0x84,0x00,0x3E,0x07,0xFC,0xEB,0x2E,0x07,0xFC,0xEB,0x5A,0x00,0x01,0x04,0x48,0x00,
+0x00,0xA1,0x3C,0x2D,0xFF,0x3C,0xF0,0x08,0x04,0x8F,0x80,0x07,0xF7,0x06,0xF0,0x8B,
+0x80,0x27,0x80,0x1E,0xA4,0x94,0x80,0x68,0x15,0xEF,0x80,0x06,0x49,0xFF,0xC6,0x70,
+0x00,0x04,0x00,0x00,0x4E,0x02,0x00,0x8E,0x3C,0x0D,0xFF,0x3C,0x84,0x40,0xF0,0x83,
+0xF0,0x01,0x8E,0x01,0xF0,0x85,0xF0,0x04,0x8E,0x01,0xF0,0x84,0x00,0x0F,0x80,0x10,
+0xF0,0x89,0x00,0x0F,0x80,0x14,0xF0,0x8A,0x00,0x04,0x00,0x00,0xE2,0x40,0xE8,0x79,
+0xA0,0x79,0x94,0x11,0x41,0xE0,0x80,0x00,0x02,0x5F,0x00,0x00,0xDA,0x60,0xA0,0x7B,
+0x38,0x10,0x89,0x01,0xF1,0x82,0xF3,0x02,0xF1,0x0B,0xE2,0x23,0xE9,0x58,0xA0,0x7C,
+0x88,0x01,0xA6,0xC1,0xA7,0x00,0xC3,0x05,0x9E,0x19,0x54,0xA0,0x00,0xFF,0xD5,0x02,
+0x81,0x43,0xF0,0x05,0xE0,0x60,0xE8,0x04,0x8C,0x61,0x96,0xD8,0xD5,0x02,0xF3,0x0A,
+0xC4,0x04,0x9E,0x61,0x96,0x48,0xD5,0x02,0x80,0x24,0xF0,0x04,0xE0,0x80,0xE8,0x04,
+0x8C,0x81,0x97,0x20,0xD5,0x02,0xF4,0x09,0x84,0xA0,0x80,0x05,0xE2,0x81,0xE9,0x20,
+0x04,0x9F,0x80,0x01,0x8A,0x0A,0x42,0x90,0xA4,0x24,0x14,0x9F,0x80,0x07,0xF0,0x88,
+0x81,0x2A,0xF0,0x08,0xE2,0x69,0x88,0x09,0x96,0x00,0xE9,0x0F,0xF0,0x07,0x04,0xFF,
+0x80,0x06,0x88,0x09,0x94,0x01,0x88,0x0F,0xA4,0x00,0x88,0xA0,0x50,0x04,0x80,0x01,
+0x97,0x6B,0x54,0x90,0x00,0xFF,0xD5,0xEE,0x8C,0x21,0x96,0x48,0xD5,0xE0,0xF1,0x03,
+0xA4,0xCD,0x84,0x29,0xFE,0xC4,0x40,0xF1,0x85,0xF6,0xE0,0xAF,0xE9,0x0C,0xF3,0x02,
+0x8E,0x01,0x8A,0xA3,0xF3,0x03,0x97,0x6B,0xA4,0xDE,0xFE,0x1C,0x40,0xF0,0x05,0xF6,
+0xE0,0xAF,0xE8,0x05,0x44,0x0F,0x80,0x00,0x12,0x0F,0x00,0x00,0x8C,0x41,0x96,0x90,
+0xD5,0x94,0x3E,0x17,0xEA,0x35,0x3E,0x47,0xEA,0x34,0x48,0xFF,0xFE,0x72,0x44,0x00,
+0x00,0x40,0x3E,0x07,0xEA,0x35,0x3E,0x07,0xEA,0x34,0x84,0x00,0x48,0xFF,0xFE,0x67,
+0x3C,0x1D,0xFF,0x3D,0x84,0x00,0x40,0x00,0x04,0x06,0x3C,0x6B,0xFE,0x71,0xFC,0xC6,
+0xFC,0x48,0x3C,0x2C,0x02,0xCC,0x81,0x20,0x80,0xE1,0x80,0x1F,0x3C,0x1C,0x02,0xCB,
+0x49,0xFF,0xEC,0xEC,0x84,0x01,0xFA,0x30,0x49,0xFF,0xED,0x04,0xFA,0x0E,0x49,0xFF,
+0xED,0x14,0x84,0xC0,0x80,0x06,0x84,0x20,0x49,0xFF,0xED,0x1C,0x80,0x06,0x44,0x10,
+0x00,0x5A,0x8C,0xC1,0x49,0xFF,0xED,0x3E,0x5A,0x68,0x08,0xF6,0x85,0x40,0xFB,0x14,
+0x80,0x0A,0x42,0x10,0x20,0x24,0x38,0x14,0x84,0x01,0x38,0x1F,0x81,0x09,0x8C,0x01,
+0x5A,0x08,0x20,0xF9,0x44,0x61,0x9D,0xA4,0x84,0x00,0x49,0xFF,0xEC,0xFA,0x49,0xFF,
+0xEC,0xD2,0x84,0x01,0x49,0xFF,0xEC,0xF5,0x49,0xFF,0xEC,0xCD,0x84,0x03,0x49,0xFF,
+0xEC,0xF0,0x49,0xFF,0xEC,0xC8,0x49,0xFF,0xEC,0xE4,0xAE,0x30,0x84,0x00,0xA6,0xF0,
+0xE2,0x03,0xE8,0x19,0xA0,0x79,0x38,0x50,0x81,0x01,0xD0,0x13,0xA0,0x7D,0x94,0x82,
+0x95,0x6A,0x98,0xCA,0x88,0x25,0xA6,0xDA,0xA7,0x0A,0xE2,0x64,0xE8,0x02,0xAE,0xCA,
+0xA0,0xFD,0x88,0x43,0x88,0xA3,0xA6,0x53,0xA6,0xAB,0xE2,0x41,0xE8,0x02,0xAE,0x6B,
+0x8C,0x01,0xD5,0xE6,0x84,0x00,0xAE,0x31,0x84,0xA0,0xD3,0x1C,0xA0,0x39,0x38,0x00,
+0x15,0x01,0x4C,0x02,0xC0,0x16,0xA0,0xBD,0x94,0x2A,0x88,0x40,0xA6,0x53,0xA6,0x92,
+0x8C,0x21,0x8A,0x22,0xA6,0xB1,0x96,0x48,0xE2,0x41,0xE8,0x0A,0xAE,0x71,0xA0,0x7D,
+0x88,0x20,0xA6,0x4A,0xAE,0x72,0xA0,0x7D,0x88,0x01,0xA6,0x03,0xAE,0x33,0x8C,0xA1,
+0xD5,0xE5,0x84,0x20,0x50,0x43,0x00,0x24,0x80,0xA1,0xE2,0x23,0xE8,0x1F,0xA0,0x39,
+0x38,0x00,0x05,0x01,0x4C,0x00,0xC0,0x1B,0xA0,0xBD,0x94,0x0A,0x41,0xC1,0x00,0x00,
+0x40,0xF3,0x04,0x00,0x00,0x2E,0x00,0x03,0x01,0xCE,0x00,0x02,0x8C,0x41,0x8A,0x5C,
+0x10,0x27,0x80,0x24,0xA0,0xBD,0x88,0x40,0xA6,0x92,0x10,0x27,0x80,0x34,0xA0,0xBD,
+0x88,0x02,0xA6,0x03,0x10,0x07,0x80,0x44,0xD5,0x02,0xAF,0x60,0x8C,0x21,0x8C,0x81,
+0x5A,0x18,0x10,0xDD,0x8C,0xC4,0x84,0x00,0x84,0x5F,0xB4,0x27,0x38,0x10,0x81,0x00,
+0x5A,0x18,0xFF,0x04,0xAE,0xB0,0xD5,0x05,0xA0,0xF9,0x38,0x11,0x85,0x01,0xAE,0x70,
+0x8C,0x01,0x8C,0xC1,0x5A,0x08,0x20,0xF3,0x5A,0xA0,0x01,0x12,0x85,0x41,0x84,0x00,
+0x80,0x29,0x42,0x10,0x20,0x73,0x02,0x10,0x80,0x11,0x38,0x1F,0x81,0x09,0x8C,0x01,
+0x5A,0x08,0x20,0xF8,0x44,0x61,0x9F,0xDC,0x48,0xFF,0xFF,0x68,0xFC,0xC8,0xFC,0x40,
+0x84,0x60,0x50,0x50,0x00,0x3C,0x84,0x82,0x50,0x00,0x03,0xD4,0x84,0xC1,0x00,0x72,
+0xFF,0xDC,0x04,0x22,0xFF,0xF1,0x97,0xC6,0xC7,0x22,0xC2,0x21,0x04,0x22,0xFF,0xF8,
+0xA1,0xCD,0x94,0x92,0x88,0x47,0x00,0xF1,0x00,0x00,0xA7,0xD1,0xE9,0x06,0x5A,0x70,
+0x11,0x0A,0x14,0x62,0xFF,0xFF,0xD5,0x08,0x5A,0x78,0x11,0x05,0x14,0x42,0xFF,0xFF,
+0xD5,0x03,0x14,0x32,0xFF,0xFF,0xA7,0xD2,0xA6,0x93,0xCF,0x05,0x5A,0x20,0x1F,0x1C,
+0xB6,0xC5,0xD5,0x1A,0x5A,0x28,0x1F,0x18,0xB6,0x85,0xD5,0x16,0x8E,0x41,0xE6,0x43,
+0xE8,0x13,0x04,0x22,0xFF,0xF8,0xA1,0xCD,0x94,0x92,0x88,0x47,0xA7,0xD0,0xC7,0x06,
+0xA7,0xD1,0xE6,0xF1,0xE8,0x03,0x14,0x32,0xFF,0xFF,0xA7,0xD2,0xC7,0x05,0xA6,0x93,
+0xE6,0x5F,0xE8,0x02,0xB6,0x65,0x50,0x52,0x80,0x5C,0xD8,0xC2,0xFC,0xC0,0xFC,0x45,
+0x84,0x80,0x41,0xE2,0x08,0x06,0xF0,0x81,0x84,0x9F,0xC9,0x02,0x84,0x81,0x84,0xBF,
+0xCA,0x02,0x84,0xA1,0xFA,0xC2,0x42,0x71,0x18,0x24,0x40,0x93,0x84,0x00,0xF0,0x01,
+0x40,0x94,0x84,0x08,0x88,0x09,0xF0,0x83,0x22,0xF0,0x00,0x00,0x5E,0xF7,0x80,0x65,
+0x4E,0xF3,0x00,0x9C,0x40,0xA1,0x14,0x00,0x40,0x90,0x90,0x00,0xF0,0x01,0x42,0x95,
+0x18,0x73,0x38,0xF0,0x25,0x11,0x5E,0xF7,0x80,0x33,0x4E,0xF3,0x00,0x8F,0x40,0x91,
+0x88,0x00,0xFB,0x14,0x00,0x94,0x80,0x04,0x43,0xC2,0xA0,0x24,0x89,0x23,0x20,0x04,
+0x80,0x24,0x42,0x92,0x88,0x24,0x50,0xA4,0x80,0x01,0xF0,0x84,0x42,0x85,0x14,0x24,
+0x80,0x01,0x42,0x04,0x18,0x73,0x95,0x81,0xF0,0x01,0x85,0x00,0x88,0xC0,0xF0,0x04,
+0x14,0x8F,0x80,0x02,0x89,0x20,0xE1,0x49,0xE8,0x0B,0x38,0xF3,0x20,0x11,0x4E,0xF7,
+0x00,0x05,0xF0,0x02,0x88,0x0F,0xF0,0x82,0x8D,0x41,0x89,0x1C,0xD5,0xF5,0x52,0x90,
+0x80,0x11,0x42,0x02,0x24,0x24,0x42,0x62,0x04,0x24,0x8C,0xC1,0xF0,0x86,0x94,0x21,
+0xF0,0x87,0x42,0x73,0x10,0x73,0xF0,0x01,0x55,0xC2,0x00,0xFF,0x95,0xF9,0x88,0x07,
+0x42,0x7E,0x18,0x24,0x8A,0xFC,0xF0,0x89,0x85,0x40,0x96,0x38,0xF0,0x88,0x80,0xE1,
+0x81,0x2A,0x85,0x01,0xF0,0x06,0xE0,0x06,0xE9,0x0E,0xF0,0x09,0x89,0x3C,0x54,0x94,
+0x80,0xFF,0x38,0x00,0x28,0x11,0xF0,0x85,0xF0,0x07,0x89,0x40,0xF0,0x05,0x5E,0xF0,
+0x00,0x33,0xE8,0x0B,0xF0,0x02,0x84,0xCA,0xFE,0x34,0x40,0x80,0x21,0x16,0xE5,0x15,
+0x40,0x61,0xF8,0x00,0xE8,0x0E,0xD5,0x09,0xF0,0x05,0x8C,0xC1,0x89,0x00,0xF0,0x08,
+0x40,0x70,0x24,0x00,0x97,0xFA,0xD5,0xDF,0x00,0x93,0x01,0x14,0x5A,0x98,0x0A,0x26,
+0x04,0x9F,0x80,0x04,0x80,0x02,0x8F,0x21,0x00,0xF3,0x01,0x14,0x42,0x02,0xA4,0x73,
+0x85,0x4A,0x40,0x90,0x00,0x10,0x10,0xA3,0x01,0x14,0xE9,0x04,0x10,0x93,0x01,0x16,
+0xD5,0x12,0x20,0xA3,0x01,0x16,0x42,0xF2,0xA4,0x24,0x42,0x52,0xA8,0x24,0xE0,0xAF,
+0xE8,0x03,0x10,0x93,0x01,0x16,0x20,0x53,0x01,0x18,0x42,0xF2,0x1C,0x24,0xFF,0x64,
+0xE0,0xAF,0xE8,0x03,0x10,0x73,0x01,0x18,0xF0,0x03,0x22,0xF0,0x00,0x00,0x5E,0xF7,
+0x80,0x33,0xE9,0x32,0x88,0x43,0xA6,0x94,0x88,0x43,0x00,0x51,0x00,0x34,0x00,0x61,
+0x00,0x44,0xC5,0x02,0x8E,0xA1,0xE6,0xDF,0xE8,0x03,0x8C,0xC1,0xD5,0x02,0xFA,0xCF,
+0xFA,0x42,0xFE,0xAC,0x99,0xD1,0x88,0x24,0xF0,0x01,0x88,0x22,0x94,0x49,0x95,0xF9,
+0x84,0x40,0x88,0xE0,0x84,0x81,0x88,0x01,0x80,0x22,0xE0,0xC5,0xE9,0x0F,0x38,0x93,
+0x88,0x11,0x4E,0x97,0x00,0x03,0x88,0x29,0x38,0x90,0x08,0x11,0x4E,0x97,0x00,0x03,
+0x88,0x89,0x8C,0xA1,0x50,0x21,0x00,0x24,0xD5,0xF1,0x84,0x0A,0xFE,0x44,0x40,0x10,
+0x90,0x36,0xE4,0x28,0xE8,0x07,0x88,0x7E,0x00,0x01,0x81,0x14,0xC0,0x09,0x8E,0x01,
+0xD5,0x05,0x88,0x7E,0x00,0x11,0x81,0x14,0xC1,0x03,0x10,0x01,0x81,0x14,0xFC,0xC5,
+0xFC,0x46,0xFD,0x30,0x81,0x42,0xB0,0x04,0x84,0x20,0xFA,0x50,0x49,0x00,0x19,0xF8,
+0x84,0x7F,0xCE,0x02,0x84,0x61,0x80,0x07,0x84,0x80,0x08,0x50,0x00,0x24,0x85,0x21,
+0xE2,0x85,0xE8,0x1A,0x08,0x10,0x00,0x01,0xC1,0x15,0xE6,0x2D,0x4E,0xF2,0x00,0x83,
+0x00,0x20,0x00,0x0F,0x00,0x80,0x00,0x1F,0x88,0x47,0x9A,0x57,0xE1,0x01,0xE9,0x0A,
+0x20,0x11,0x00,0x54,0x5A,0x10,0x01,0x77,0x8C,0x41,0x00,0x11,0x00,0x73,0xC1,0xF6,
+0xD5,0x71,0x8C,0x81,0xD5,0xE6,0x3C,0x0C,0x05,0xA0,0x43,0xE1,0x98,0x24,0xF0,0x81,
+0x42,0x0F,0x0C,0x24,0x50,0x13,0x80,0x74,0xB6,0x1F,0x84,0xE0,0xB0,0x04,0x38,0x00,
+0x1C,0x10,0x10,0x00,0xFF,0xE0,0x5A,0x08,0x01,0x50,0xF0,0x01,0xC0,0x3B,0x00,0x00,
+0xFF,0x90,0x5A,0x00,0xFF,0x38,0xFA,0x02,0xB5,0x2A,0x42,0x23,0x80,0x24,0x98,0x16,
+0x38,0x04,0x81,0x00,0x5A,0x00,0xFF,0x2F,0x05,0xC5,0x00,0x01,0x38,0x5E,0x01,0x01,
+0x04,0x05,0x00,0x05,0x97,0x6F,0xCE,0x05,0x95,0x2A,0x88,0x80,0xA6,0x21,0xD5,0x03,
+0x38,0x00,0x16,0x00,0xFE,0x1C,0xF0,0x82,0xB4,0x1F,0x80,0x86,0x88,0x02,0x94,0x01,
+0x88,0x09,0x80,0x5E,0x85,0x20,0x04,0x8F,0x80,0x02,0xE1,0x02,0xE9,0x14,0xB5,0x1F,
+0x38,0xF0,0x25,0x00,0x89,0x09,0x14,0x8F,0x80,0x03,0x38,0x8E,0x3D,0x01,0x54,0x84,
+0x00,0x3F,0x4C,0x82,0xC0,0x05,0x5A,0xF0,0xFF,0x03,0xF4,0x03,0x8C,0x41,0x89,0x23,
+0xD5,0xEB,0x80,0x86,0x20,0x00,0x80,0x20,0x42,0x21,0x90,0x24,0xFE,0x1C,0xE0,0x40,
+0xE8,0x07,0xA6,0x08,0xC0,0x03,0x8E,0x01,0xAE,0x08,0xA6,0x08,0xC8,0x0E,0x10,0x40,
+0x80,0x20,0x84,0x0A,0xD5,0x09,0xA6,0x08,0xC0,0x03,0x8E,0x01,0xAE,0x08,0xA6,0x08,
+0xC8,0x04,0x10,0x00,0x80,0x20,0xAE,0x08,0x8C,0xE1,0x8C,0x21,0x5A,0x78,0x20,0xA0,
+0xFC,0xC6,0x00,0x10,0x00,0x0F,0x00,0x80,0x00,0x1F,0xE1,0x01,0xE9,0x8B,0xB0,0x84,
+0x38,0x91,0x04,0x08,0x8C,0x21,0xD5,0xFA,0xFC,0x43,0x84,0xDF,0xC8,0x02,0x84,0xC1,
+0x3C,0x4C,0x05,0xA0,0x43,0xC3,0x00,0x24,0xF4,0x82,0x50,0x10,0x80,0xD4,0x43,0xEE,
+0x18,0x24,0x85,0x20,0x38,0x41,0xA4,0x10,0x10,0x40,0xFF,0xE0,0x5A,0x48,0x01,0x52,
+0xF4,0x02,0xC4,0x3D,0x00,0x40,0xFF,0x30,0x5A,0x40,0xFF,0x3A,0xFA,0x82,0xB5,0x42,
+0x42,0x74,0x90,0x24,0x99,0x38,0x38,0x45,0x11,0x00,0x5A,0x40,0xFF,0x31,0xA1,0x51,
+0x04,0x81,0x00,0x05,0xF5,0x81,0x38,0x52,0x91,0x01,0x97,0x6F,0xC8,0x05,0x95,0x2A,
+0x88,0x88,0xA7,0x21,0xD5,0x03,0x38,0x44,0x16,0x00,0xFF,0x34,0xF4,0x83,0x40,0x43,
+0xF8,0x00,0x95,0x21,0x88,0x8A,0xF4,0x85,0x80,0xE0,0x81,0x1C,0x85,0x40,0xF4,0x03,
+0xE0,0x88,0xE9,0x16,0x40,0x45,0x78,0x00,0xF4,0x84,0xF4,0x05,0x04,0xFF,0x80,0x01,
+0x38,0x42,0x29,0x00,0x38,0xF7,0x91,0x01,0x54,0xF7,0x80,0x3F,0x4C,0xF2,0xC0,0x05,
+0x5A,0x40,0xFF,0x03,0xF7,0x04,0x8D,0x01,0x89,0x46,0xD5,0xEA,0x80,0xE0,0x20,0x40,
+0x80,0x20,0x42,0x53,0x1C,0x24,0xFF,0x34,0xE0,0xA4,0xE8,0x07,0xA7,0x08,0xC4,0x03,
+0x8E,0x81,0xAF,0x08,0xA7,0x08,0xCC,0x0E,0x10,0x70,0x80,0x20,0x84,0x8A,0xD5,0x09,
+0xA7,0x08,0xC4,0x03,0x8E,0x81,0xAF,0x08,0xA7,0x08,0xCC,0x04,0x10,0x40,0x80,0x20,
+0xAF,0x08,0x8D,0x21,0x8C,0x21,0x5A,0x98,0x20,0x9F,0xFC,0xC3,0xFC,0x4F,0xF0,0x84,
+0x80,0xC1,0x81,0x02,0x84,0x20,0xFA,0x50,0xB0,0x0E,0x49,0x00,0x18,0xE1,0xB0,0x16,
+0x84,0x20,0xFA,0x50,0x49,0x00,0x18,0xDC,0x2E,0x07,0xEA,0x36,0x5C,0xF0,0x00,0xC8,
+0xE8,0x04,0x8C,0x01,0x3E,0x07,0xEA,0x36,0x84,0x20,0x80,0x41,0x80,0x08,0x44,0x31,
+0x9D,0xA4,0x49,0xFF,0xFD,0xD6,0x80,0x08,0x84,0x20,0xFA,0x4F,0x44,0x31,0x9D,0xA4,
+0x49,0xFF,0xFD,0xCF,0x80,0x08,0xFA,0x21,0x84,0x40,0x44,0x31,0x9F,0xDC,0x49,0xFF,
+0xFD,0xC8,0x44,0x31,0x9F,0xDC,0x80,0x08,0xFA,0x21,0xFA,0x4F,0x49,0xFF,0xFD,0xC1,
+0x84,0x00,0x44,0x11,0x9D,0xA4,0x80,0x46,0x49,0xFF,0xFE,0xB4,0xFA,0x01,0x44,0x11,
+0x9F,0xDC,0x80,0x46,0x49,0xFF,0xFE,0xAE,0x2E,0x07,0xEA,0x36,0x05,0xCF,0x80,0x04,
+0x84,0x20,0xF1,0x81,0xF0,0x88,0x00,0xAF,0x80,0x04,0x80,0x1C,0xB4,0x60,0x4E,0x32,
+0x02,0x7B,0x5A,0x38,0x05,0x04,0x48,0x00,0x02,0x77,0x00,0x10,0x00,0x18,0x5A,0x38,
+0x04,0x04,0x48,0x00,0x02,0x28,0x00,0x20,0x00,0x1C,0x96,0x46,0xF2,0x87,0x94,0x91,
+0xF2,0x8B,0xF4,0x0B,0xA0,0xB4,0x88,0x44,0xA7,0x11,0xA6,0x90,0xF4,0x82,0xF2,0x83,
+0x00,0x2F,0x80,0x08,0x10,0x20,0x00,0x59,0x00,0x2F,0x80,0x0C,0x10,0x20,0x00,0x58,
+0xF2,0x07,0x95,0x12,0xA0,0xB5,0x88,0x44,0xA6,0x92,0x10,0x20,0x00,0x4A,0xA0,0xB5,
+0x88,0x44,0xA6,0x93,0x10,0x20,0x00,0x4B,0xA0,0xB5,0x88,0x82,0xA6,0xA1,0xA7,0x20,
+0x8C,0x41,0x8A,0x44,0x10,0x20,0x00,0x4E,0x84,0x81,0x04,0x20,0x00,0x0E,0xC1,0x3A,
+0xC2,0x0D,0x84,0x23,0x10,0x40,0x00,0x41,0x10,0x40,0x00,0x42,0x14,0x10,0x00,0x14,
+0x10,0xA0,0x00,0x4C,0x10,0xA0,0x00,0x4D,0xD5,0x0D,0x44,0x1F,0xFF,0xC8,0x10,0x10,
+0x00,0x41,0x10,0x10,0x00,0x42,0x84,0x21,0x14,0x10,0x00,0x14,0x10,0x10,0x00,0x4D,
+0xF2,0x88,0x22,0x10,0x00,0x06,0x10,0xA0,0x00,0x43,0x5E,0xF0,0x84,0x80,0x10,0xA0,
+0x00,0x45,0xE9,0x03,0x44,0x10,0x04,0x7F,0x12,0x10,0x00,0x2A,0x22,0x10,0x00,0x07,
+0x5E,0xF0,0x88,0x80,0xE9,0x03,0x44,0x10,0x08,0x7F,0x12,0x10,0x00,0x2B,0x84,0x20,
+0x10,0xA0,0x00,0x46,0x12,0x10,0x00,0x24,0x10,0x10,0x00,0x40,0x10,0xA0,0x00,0x4F,
+0xD5,0x25,0x00,0x10,0x00,0x41,0x5C,0xF0,0x80,0xC8,0xE8,0x04,0x8C,0x21,0x10,0x10,
+0x00,0x41,0x00,0x10,0x00,0x42,0x5C,0xF0,0x80,0xC8,0xE8,0x04,0x8C,0x21,0x10,0x10,
+0x00,0x42,0x5A,0x38,0x01,0x14,0x22,0x10,0x00,0x04,0x5E,0xF0,0x84,0x80,0xE9,0x03,
+0x44,0x10,0x04,0x7F,0x12,0x10,0x00,0x2A,0x22,0x10,0x00,0x05,0x5E,0xF0,0x88,0x80,
+0xE9,0x03,0x44,0x10,0x08,0x7F,0x12,0x10,0x00,0x2B,0x5A,0x20,0x01,0x08,0x87,0xDF,
+0xFA,0xA0,0xFA,0x81,0x44,0x31,0x9F,0xDC,0xD5,0x06,0x83,0xC2,0x80,0xA2,0x84,0x80,
+0x44,0x31,0x9D,0xA4,0xF1,0x03,0x88,0x23,0xA6,0x8C,0x88,0x43,0x00,0x91,0x00,0x24,
+0x00,0x11,0x00,0x34,0x00,0x21,0x00,0x44,0xF2,0x89,0xC1,0x03,0x9F,0xC9,0xD5,0x02,
+0x80,0xE1,0xF2,0x09,0xE6,0x5F,0xE8,0x03,0x8C,0x41,0xD5,0x02,0xFA,0x4F,0xF2,0x8A,
+0xFA,0x42,0xFE,0xBC,0x88,0x82,0x88,0x45,0x95,0x21,0x94,0x91,0x88,0x88,0x88,0x48,
+0xF4,0x8D,0xF2,0x8C,0x84,0x81,0x84,0x40,0xF4,0x86,0xF2,0x85,0xF4,0x0A,0xE0,0x87,
+0xE9,0x15,0xF4,0x0D,0x38,0xF2,0x08,0x11,0x4E,0xF7,0x00,0x05,0xF4,0x05,0x88,0x8F,
+0xF4,0x85,0xF4,0x0C,0x38,0xF2,0x08,0x11,0x4E,0xF7,0x00,0x05,0xF4,0x06,0x88,0x8F,
+0xF4,0x86,0x8C,0xE1,0x50,0x21,0x00,0x24,0xD5,0xEA,0xF7,0x05,0x84,0x4A,0xF4,0x06,
+0xFF,0xD4,0x95,0x69,0x40,0x23,0x90,0x56,0x88,0xA8,0x84,0x80,0xF7,0x09,0xE2,0xE1,
+0xE9,0x0B,0xFA,0xF4,0xFF,0xCC,0x38,0xF2,0x9C,0x11,0x5E,0xF7,0x80,0x33,0xE9,0x02,
+0x8C,0x81,0x8C,0x21,0xD5,0xF4,0x00,0x10,0x00,0x46,0xE2,0x29,0xE8,0x03,0x10,0x90,
+0x00,0x46,0x10,0xA0,0x00,0x40,0x00,0x11,0x81,0x14,0xC1,0x15,0xF1,0x02,0x42,0xFF,
+0x04,0x24,0x20,0x11,0x81,0x18,0x42,0x1F,0x04,0x24,0xE0,0x2F,0xE9,0x0C,0x20,0x11,
+0x81,0x16,0xF5,0x03,0xE0,0x25,0xE9,0x07,0x00,0x10,0x00,0x4D,0xC9,0x04,0x84,0x21,
+0x10,0x10,0x00,0x40,0x00,0x11,0x81,0x15,0xC1,0x17,0xF1,0x02,0x42,0xFF,0x04,0x24,
+0x20,0x11,0x81,0x19,0x42,0x1F,0x04,0x24,0xE0,0x2F,0xE9,0x0E,0xF1,0x03,0xFF,0x4A,
+0x20,0x11,0x81,0x17,0xFE,0x4A,0xE0,0x25,0xE9,0x07,0x00,0x10,0x00,0x4D,0xC9,0x04,
+0x84,0x21,0x10,0x10,0x00,0x40,0x00,0x10,0x00,0x40,0xC1,0x05,0x00,0x10,0x00,0x40,
+0xC1,0x39,0xD5,0x3D,0x04,0x10,0x00,0x0C,0x5A,0x10,0x02,0xFA,0x04,0x10,0x00,0x14,
+0x8E,0x22,0xE6,0x22,0xE8,0xF4,0x00,0x10,0x00,0x4D,0xC9,0xF1,0x00,0x50,0x00,0x4E,
+0xE6,0xA2,0xE9,0xED,0xE4,0x4D,0xE8,0xEB,0x42,0xF1,0x24,0x24,0x5C,0xF7,0x80,0x51,
+0xE8,0xE6,0xE7,0x27,0xE8,0xE4,0x84,0xAA,0x10,0x50,0x00,0x4C,0x84,0xA1,0x14,0x50,
+0x00,0x14,0x10,0x50,0x00,0x4D,0x00,0x50,0x00,0x4A,0xE6,0xA2,0xE9,0x02,0x9E,0x69,
+0x00,0x50,0x00,0x4B,0xE6,0xBE,0xE8,0x03,0x8C,0xA1,0xD5,0x02,0xFA,0xAF,0x88,0x23,
+0x9B,0xCB,0xE2,0xA7,0xE9,0xCC,0x10,0xA0,0x80,0xD4,0x10,0xA0,0x80,0xF4,0x8C,0x21,
+0xD5,0xF8,0x04,0x10,0x00,0x14,0x8E,0x22,0xE6,0x22,0xE9,0x06,0x04,0x10,0x00,0x0E,
+0xC9,0x3A,0x48,0x00,0x00,0x82,0x22,0x50,0x00,0x2B,0x22,0x10,0x00,0x07,0x9A,0x69,
+0x4E,0x14,0x00,0x03,0xFE,0x4A,0x00,0x50,0x00,0x46,0x44,0x70,0x00,0x44,0x8C,0xA1,
+0x90,0xA1,0xFF,0x7C,0xE0,0xA1,0xE8,0xEB,0x5E,0xF0,0x80,0x97,0xE9,0xE8,0x00,0x10,
+0x00,0x4D,0xC9,0x04,0x84,0x2A,0x10,0x10,0x00,0x4C,0x84,0x21,0x14,0x10,0x00,0x14,
+0x10,0x10,0x00,0x4D,0x00,0x10,0x00,0x4A,0xE6,0x22,0xE9,0x03,0x8E,0x21,0xD5,0x02,
+0x84,0x20,0x00,0x50,0x00,0x4B,0xE6,0xBE,0xE8,0x03,0x8C,0xA1,0xD5,0x02,0xFA,0xAF,
+0x88,0x23,0x9B,0xCB,0xE2,0xA7,0xE9,0xCB,0x10,0xA0,0x80,0xD4,0x10,0xA0,0x80,0xF4,
+0x8C,0x21,0xD5,0xF8,0x00,0x10,0x00,0x42,0xE6,0x35,0xE8,0x1C,0xF5,0x0B,0xA0,0x73,
+0x02,0x70,0x00,0x24,0x88,0x25,0xA5,0x48,0xE2,0xE5,0xE8,0x03,0x12,0x50,0x00,0x24,
+0xA4,0x48,0x5C,0xF0,0x80,0x65,0xE9,0x09,0x5E,0xF1,0x00,0x65,0xE8,0x06,0x42,0xF1,
+0x24,0x24,0x5C,0xF7,0x81,0x91,0xE9,0x06,0x00,0x10,0x00,0x45,0x8C,0x21,0x10,0x10,
+0x00,0x45,0x04,0x10,0x00,0x14,0x5A,0x18,0x03,0x40,0x00,0x50,0x00,0x41,0xE6,0xB5,
+0xE8,0x1B,0x00,0x10,0x00,0x40,0x5A,0x10,0x01,0x12,0x5E,0xF1,0x00,0x24,0xE8,0x0E,
+0x42,0x21,0x24,0x24,0x5C,0xF1,0x00,0x97,0xE8,0x09,0xA0,0x73,0xF2,0x07,0x38,0x10,
+0x89,0x01,0x5C,0xF0,0x80,0x33,0xE9,0x02,0xCC,0x27,0x00,0x10,0x00,0x43,0x8C,0x21,
+0x10,0x10,0x00,0x43,0xD5,0x21,0x00,0x10,0x00,0x43,0xE6,0x26,0xE9,0x0F,0x84,0x22,
+0x14,0x10,0x00,0x14,0xD5,0x19,0x04,0x10,0x00,0x0C,0x5A,0x10,0x02,0x16,0x04,0x10,
+0x00,0x14,0x5A,0x10,0x03,0x04,0x5A,0x18,0x02,0x09,0x00,0x10,0x00,0x4D,0xC9,0x07,
+0x84,0x2A,0x10,0x10,0x00,0x4C,0xD5,0x03,0x5A,0x18,0x04,0x07,0x84,0x21,0x14,0x10,
+0x00,0x14,0x10,0x10,0x00,0x4D,0xF1,0x03,0x88,0x61,0x00,0x11,0x80,0x74,0xC1,0x10,
+0xF1,0x02,0x42,0xF0,0xF8,0x24,0x20,0x11,0x80,0x94,0x42,0x10,0xF8,0x24,0xE0,0x2F,
+0xE9,0x07,0x04,0x10,0x00,0x14,0x5A,0x10,0x01,0x04,0x48,0x00,0x00,0xC7,0x04,0x10,
+0x00,0x14,0x5A,0x10,0x04,0x59,0x00,0x11,0x80,0xD4,0xC1,0x55,0xF1,0x02,0x20,0x21,
+0x80,0xF4,0x42,0x10,0xF8,0x24,0x42,0x21,0x78,0x24,0xE0,0x41,0x4E,0xF2,0x00,0xBB,
+0xD5,0x4A,0x96,0x56,0xC1,0x48,0x00,0x40,0x00,0x59,0x00,0x20,0x00,0x58,0xFA,0x62,
+0x80,0x24,0x42,0x11,0x0C,0x73,0x38,0x34,0x05,0x11,0x84,0x23,0xFE,0x5C,0x02,0x30,
+0x00,0x24,0x94,0xD9,0xE0,0x61,0x84,0x20,0xE9,0x05,0xF3,0x08,0xFA,0x24,0x40,0x10,
+0x8C,0x06,0x00,0x30,0x00,0x46,0xE6,0x6C,0xE9,0x02,0x84,0x20,0x00,0x50,0x00,0x45,
+0x00,0x30,0x00,0x42,0xE6,0xA6,0xE8,0x05,0x9D,0xD9,0x90,0xE1,0xE0,0xE5,0xE8,0x06,
+0x02,0x50,0x00,0x0A,0xE6,0xA5,0xE9,0x02,0x84,0x20,0x8E,0x62,0xE6,0x73,0xE9,0x02,
+0x84,0x20,0xE6,0x84,0xE8,0x04,0x44,0x31,0x9D,0xA4,0xD5,0x05,0xE6,0x8E,0xE9,0x08,
+0x44,0x31,0x9F,0xDC,0x88,0x43,0x00,0x21,0x00,0xD4,0xC2,0x02,0x84,0x20,0x04,0x20,
+0x00,0x14,0x8E,0x42,0xE6,0x42,0xE8,0x07,0x5A,0x18,0x01,0x06,0x14,0x10,0x00,0x14,
+0x10,0x10,0x00,0x4F,0xF1,0x01,0x50,0x00,0x00,0x5C,0x8C,0x21,0xF1,0x81,0x5A,0x10,
+0x0A,0x04,0x48,0xFF,0xFD,0x7D,0x00,0x0F,0x80,0x20,0x80,0x61,0x3E,0x07,0xEA,0x36,
+0xF0,0x04,0x50,0x50,0x00,0x4C,0x50,0x20,0x03,0xE4,0x04,0x02,0xFF,0xED,0xC0,0x1D,
+0xA6,0x28,0xC0,0x1B,0x22,0x12,0x80,0x04,0x22,0x72,0xFF,0xDE,0x52,0x40,0x00,0x0A,
+0xFE,0x44,0x42,0x12,0x1C,0x73,0x40,0x10,0x8C,0x36,0x12,0x12,0xFF,0xDE,0x22,0x12,
+0x80,0x05,0x22,0x72,0xFF,0xDF,0xFE,0x44,0x42,0x12,0x1C,0x73,0x40,0x10,0x8C,0x36,
+0x8E,0x01,0x12,0x12,0xFF,0xDF,0xAE,0x28,0x50,0x52,0x80,0x5C,0xDA,0xDF,0xF0,0x04,
+0xB0,0xD6,0x50,0x20,0x03,0x98,0x84,0x81,0xB4,0x1C,0x8E,0x01,0xE6,0x03,0xE9,0x14,
+0x51,0xCE,0x00,0x5C,0x4D,0xC1,0x7F,0xFA,0x80,0x46,0xB0,0xCE,0x84,0x00,0x44,0x11,
+0x9D,0xA4,0x49,0xFF,0xFC,0x83,0xFA,0x01,0x44,0x11,0x9F,0xDC,0x80,0x46,0xB0,0xD6,
+0x49,0xFF,0xFC,0x7C,0xFC,0xCF,0xB8,0x14,0x5A,0x00,0x02,0x04,0x5A,0x08,0x04,0xEA,
+0x00,0x0E,0x00,0x1C,0xA0,0x75,0x94,0x02,0x88,0x01,0xA6,0x42,0xA7,0x43,0xE2,0xA1,
+0xE9,0xE0,0xB8,0x0E,0x5A,0x08,0x01,0x06,0xB1,0xCE,0x38,0x03,0x84,0x08,0xD5,0x03,
+0x38,0x40,0x8C,0x08,0x8C,0x21,0xD5,0xF4,0x84,0x24,0x14,0x10,0x00,0x14,0x48,0xFF,
+0xFF,0x38,0x84,0x22,0x14,0x10,0x00,0x14,0xD5,0x8E,0xFC,0x42,0x2E,0x07,0xFD,0xC6,
+0xC8,0x14,0x2E,0x00,0x22,0x32,0x5A,0x00,0x0A,0x07,0x3C,0x90,0x11,0x1A,0x3C,0x70,
+0x11,0x1B,0xD5,0x04,0x44,0x70,0x01,0x00,0x81,0x27,0x2E,0x00,0x22,0x33,0x5A,0x00,
+0x0A,0x0A,0x3C,0x60,0x11,0x1C,0xD5,0x08,0x44,0x60,0x01,0x00,0x80,0xE6,0x81,0x26,
+0xD5,0x03,0x44,0x60,0x01,0x00,0x3C,0x00,0x11,0x16,0x85,0x40,0xB6,0x1F,0x2E,0x00,
+0x21,0x6D,0x3C,0x40,0x11,0x14,0x3C,0x50,0x11,0x15,0xF0,0x81,0x44,0x11,0x82,0xC0,
+0x44,0x01,0xA2,0xC0,0x80,0x49,0x80,0x67,0x3C,0xA8,0x06,0x0C,0x3C,0xA8,0x06,0x0D,
+0x49,0x00,0x16,0x8E,0x3C,0x0D,0xFB,0x0A,0x44,0x11,0x82,0xC0,0x2E,0x20,0x21,0x6F,
+0x49,0x00,0x18,0x0B,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x36,0x2E,0x80,0x21,0xEE,
+0x5A,0x88,0x01,0x32,0x2E,0x07,0xFC,0x18,0xC0,0x2E,0x2E,0x07,0xEA,0xDF,0xC8,0x2B,
+0xF0,0x83,0x3E,0xA7,0xFD,0xBC,0x3E,0x87,0xFD,0xBD,0x49,0xFF,0xDA,0x41,0xF0,0x03,
+0x44,0x11,0x82,0xC0,0x3C,0x0F,0xFF,0x6B,0x3C,0x00,0x11,0x16,0x80,0x49,0xB6,0x1F,
+0x2E,0x00,0x21,0x6D,0x3C,0x40,0x11,0x14,0xF0,0x81,0x3C,0x50,0x11,0x15,0x44,0x01,
+0xA2,0xC0,0x80,0x67,0x3E,0x87,0xFD,0xBC,0x3E,0x87,0xFD,0xBB,0x3E,0xA7,0xEA,0xA7,
+0x49,0x00,0x16,0x56,0x3C,0x0D,0xFB,0x0A,0x44,0x11,0x82,0xC0,0x2E,0x20,0x21,0x6F,
+0x49,0x00,0x17,0xD3,0x49,0xFF,0xE3,0x58,0x3C,0x1D,0xFB,0x0A,0x5A,0x08,0x02,0x09,
+0x84,0x05,0xAE,0x09,0x80,0x01,0x84,0x20,0x49,0xFF,0xF1,0x0E,0xD5,0x03,0x84,0x0A,
+0xAE,0x09,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xD1,0xCD,0x3C,0x00,0x11,0x16,0x84,0xE1,
+0x3C,0x40,0x11,0x14,0x3C,0x50,0x11,0x15,0xB6,0x1F,0x44,0x11,0x82,0xC0,0x44,0x01,
+0xA2,0xC0,0x80,0x46,0x80,0x66,0xF7,0x81,0x49,0x00,0x16,0x2A,0x3C,0x0D,0xFB,0x0A,
+0x44,0x11,0x82,0xC0,0x80,0x47,0x49,0x00,0x17,0xA8,0x84,0x00,0x3E,0x07,0xFD,0xC6,
+0x49,0xFF,0xE3,0x2A,0x5A,0x08,0x02,0x06,0xFA,0x20,0x3C,0x0D,0xFB,0x0A,0xD5,0x0D,
+0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0xFF,0xF0,0xDF,0x2E,0x17,0xEA,0xE1,0x3C,0x0D,
+0xFB,0x0A,0x5A,0x18,0x02,0x03,0x84,0x2B,0xAE,0x41,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,
+0xD1,0x99,0xFC,0xC2,0xFC,0x40,0x2E,0xA0,0x21,0xF0,0x5A,0xA0,0x01,0x05,0x84,0x01,
+0x48,0x00,0x00,0xAD,0x81,0x20,0x3C,0x0D,0xFB,0x0A,0x80,0xE2,0x80,0xC1,0xA6,0x01,
+0x5A,0x00,0x0A,0x04,0x5A,0x08,0x04,0x25,0x3C,0x00,0x06,0x0D,0x80,0xA9,0xE2,0xC0,
+0x40,0x60,0x3C,0x1B,0x3C,0x00,0x11,0x15,0xA0,0xEA,0x99,0x30,0x9A,0x46,0x3C,0x0D,
+0xFA,0xD5,0x97,0x21,0x96,0x49,0x02,0x20,0x00,0x0C,0x44,0x01,0x00,0x00,0xFE,0x17,
+0x3C,0x0F,0xFA,0xD2,0xA0,0x02,0xA0,0xAB,0x92,0x12,0x96,0x37,0x40,0x31,0x80,0x77,
+0x40,0x01,0x00,0x17,0x96,0xD9,0x96,0x01,0x2E,0x50,0x22,0x3D,0xD5,0x63,0x49,0xFF,
+0xE2,0xDB,0x5A,0x08,0x02,0x19,0x84,0x00,0x3E,0x07,0xEA,0xDD,0x84,0x03,0x3E,0x07,
+0xEA,0xD4,0x2E,0x07,0xEA,0xDD,0x80,0x8A,0x2E,0x17,0xEA,0xD4,0x44,0x51,0x82,0xC0,
+0x2E,0x27,0xEA,0xAA,0x2E,0x37,0xEA,0xC2,0x49,0xFF,0xCF,0x84,0x44,0x01,0x82,0xC0,
+0x84,0x20,0xD5,0x15,0x3E,0xA7,0xEA,0xDD,0x3E,0xA7,0xEA,0xD4,0x2E,0x07,0xEA,0xDD,
+0x80,0x8A,0x2E,0x17,0xEA,0xD4,0x44,0x51,0x82,0xC0,0x2E,0x27,0xEA,0xAA,0x2E,0x37,
+0xEA,0xC2,0x49,0xFF,0xCF,0x6F,0x44,0x01,0x82,0xC0,0x80,0x2A,0x49,0xFF,0xD1,0x13,
+0x3C,0x00,0x06,0x0C,0x44,0x11,0x00,0x00,0xE2,0xC0,0x40,0x60,0x3C,0x1B,0x3C,0x0D,
+0xFA,0xD5,0x02,0x00,0x00,0x0C,0x50,0x00,0x01,0x2C,0xFE,0x0F,0x3C,0x0F,0xFA,0xD2,
+0xA0,0x02,0x2E,0x17,0xEA,0xDF,0x92,0x12,0x96,0x37,0xC1,0x05,0x2E,0x17,0xFC,0x18,
+0x5A,0x18,0x01,0x08,0x3C,0x10,0x11,0x14,0x99,0x31,0x97,0x21,0x8A,0x26,0xD5,0x06,
+0x3C,0x20,0x11,0x1D,0x99,0x32,0x97,0x21,0x9A,0x56,0xB4,0x69,0x04,0x24,0x80,0x01,
+0x40,0x31,0x80,0x77,0x40,0x01,0x00,0x17,0x96,0x49,0x2E,0x50,0x22,0x3C,0x96,0xD9,
+0x96,0x01,0x5C,0xF2,0x04,0x01,0x80,0x44,0xE9,0x03,0x44,0x20,0x04,0x00,0x96,0x91,
+0xE2,0x43,0xE8,0x04,0xA6,0x38,0x8C,0x01,0xD5,0x04,0xE2,0x01,0xE9,0xFC,0x84,0x00,
+0xAE,0x38,0xA6,0x38,0xE2,0xA0,0x4E,0xF2,0xFF,0x5C,0x84,0x00,0xAE,0x38,0x2E,0x07,
+0xFD,0xC0,0x8C,0x01,0x3E,0x07,0xFD,0xC0,0x84,0x02,0xFC,0xC0,0x3C,0x0F,0xFA,0xF5,
+0xDD,0x9E,0x3C,0x0F,0xFA,0xF4,0xDD,0x9E,0x3C,0x0F,0xFA,0xF6,0xDD,0x9E,0x3C,0x0F,
+0xFA,0xF7,0xDD,0x9E,0xFC,0x00,0xA6,0x90,0x3C,0x40,0x11,0x05,0xC2,0x02,0x84,0x41,
+0xA8,0x82,0xA0,0x82,0xA0,0x03,0x96,0x86,0x3C,0x5D,0xFA,0xF6,0x96,0xD9,0x96,0x06,
+0xCA,0x12,0xC8,0x33,0xA6,0xA8,0x88,0x44,0x88,0x43,0xAC,0x88,0x2E,0x20,0x21,0x42,
+0xE2,0x02,0xE8,0x3C,0xA6,0xA8,0xA1,0x89,0x88,0x44,0x88,0x43,0x38,0x23,0x01,0x09,
+0x8C,0x01,0xD5,0xF5,0xC0,0x12,0xA6,0x2A,0x84,0x40,0x88,0x04,0x88,0x03,0xAC,0x08,
+0x2E,0x00,0x21,0x42,0xE2,0x40,0xE8,0x2A,0xA6,0x2A,0xA1,0x89,0x88,0x04,0x88,0x03,
+0x38,0x03,0x09,0x09,0x8C,0x41,0xD5,0xF5,0xA6,0xA9,0x88,0x44,0x88,0x43,0xAC,0x88,
+0x2E,0x20,0x21,0x42,0xE2,0x02,0xE8,0x1A,0xA6,0xA9,0xA1,0x89,0x88,0x44,0x88,0x43,
+0x38,0x23,0x01,0x09,0x8C,0x01,0xD5,0xF5,0xA6,0x2B,0x88,0x04,0x88,0x03,0xAC,0x08,
+0x80,0x02,0x2E,0x20,0x21,0x42,0xE2,0x02,0xE8,0x09,0xA6,0xAB,0xA1,0x89,0x88,0x44,
+0x88,0x43,0x38,0x23,0x01,0x09,0x8C,0x01,0xD5,0xF5,0xFC,0x80,0xFC,0x4A,0x50,0x8F,
+0x80,0x2C,0x80,0xC1,0x80,0xE0,0x81,0x22,0x84,0x20,0xFA,0x54,0x80,0x08,0xF3,0x85,
+0xF4,0x82,0x49,0x00,0x13,0xD5,0x84,0x20,0xFA,0x42,0xB0,0x06,0x49,0x00,0x13,0xD0,
+0x80,0x49,0x84,0x00,0x84,0x60,0x44,0x11,0x00,0x00,0xAC,0x30,0x12,0x03,0x00,0x09,
+0x12,0x03,0x00,0x08,0xAC,0x37,0xAC,0x36,0xAC,0x33,0xAC,0x32,0xAC,0x31,0xAC,0x34,
+0xAC,0x35,0xB6,0x69,0xA8,0x51,0x12,0x33,0x00,0x0A,0xA8,0x55,0x3C,0x1D,0xFA,0xCC,
+0xA8,0xD4,0x3E,0x07,0xEA,0xD0,0xA8,0x7E,0x3C,0x0D,0xFA,0xF4,0x3C,0x1D,0xFA,0xD3,
+0xF0,0x84,0xA8,0x79,0x2E,0x07,0xEA,0xB0,0x3C,0x1D,0xFA,0xD6,0xF0,0x81,0xA8,0x7B,
+0x44,0x40,0x27,0x10,0x80,0x43,0xFB,0x42,0x14,0x8F,0x80,0x03,0x3C,0x00,0x10,0xBA,
+0xE2,0x40,0x4E,0xF2,0x00,0x87,0xB4,0x07,0xA1,0x7A,0x41,0xE1,0x04,0x08,0x88,0x1E,
+0x88,0xBE,0xA4,0x40,0x02,0x82,0x80,0x00,0x96,0x4B,0x40,0x84,0x00,0x11,0x8A,0x28,
+0x04,0x8F,0x80,0x04,0x02,0xF0,0x00,0x00,0x00,0x84,0x00,0x0C,0x40,0xF7,0x80,0x11,
+0x40,0x10,0xA0,0x0E,0xB5,0x09,0x96,0x4B,0xE3,0x0F,0xE8,0x04,0x02,0x80,0x00,0x00,
+0xB7,0x09,0x02,0x80,0x00,0x00,0x04,0xF4,0x80,0x01,0x40,0x84,0x00,0x11,0xE3,0x0F,
+0xE8,0x04,0xA4,0x00,0x14,0x04,0x80,0x01,0xA0,0x3D,0xE4,0x3F,0x41,0xE0,0x78,0x00,
+0x12,0x1F,0x00,0x00,0xE9,0x11,0xF0,0x02,0x02,0x83,0x00,0x00,0x02,0xF0,0x00,0x00,
+0x8D,0x01,0xE0,0x2F,0x12,0x83,0x00,0x00,0xE9,0x2A,0x02,0x83,0x00,0x02,0x8D,0x01,
+0x12,0x83,0x00,0x02,0xD5,0x24,0xF0,0x05,0x02,0xF0,0x00,0x60,0x52,0xF7,0x80,0x00,
+0xE0,0x2F,0xE8,0x13,0xF0,0x02,0x02,0x83,0x00,0x01,0x02,0xF0,0x00,0x00,0x8D,0x01,
+0x12,0x83,0x00,0x01,0x52,0x80,0x80,0x00,0xE1,0x0F,0xE9,0x11,0x02,0x83,0x00,0x03,
+0x8D,0x01,0x12,0x83,0x00,0x03,0xD5,0x0B,0x5E,0xF0,0xFF,0xE2,0xE8,0x08,0x40,0xF1,
+0x28,0x17,0xC0,0x05,0x5A,0x00,0x11,0x04,0x8C,0x61,0x96,0xD8,0x22,0xF3,0x00,0x04,
+0xE0,0x2F,0xE8,0x02,0xAC,0x74,0x22,0x83,0x00,0x05,0xE1,0x01,0xE8,0x04,0x96,0x10,
+0xAC,0x75,0xF0,0x81,0xE4,0x3A,0xE9,0x0D,0x40,0x01,0x28,0x37,0xF0,0x03,0x02,0x8F,
+0x00,0x00,0x38,0x00,0x05,0x01,0x88,0x08,0x04,0x8F,0x80,0x03,0x38,0x04,0x05,0x09,
+0xA4,0x28,0xE2,0x80,0xE9,0x03,0xA5,0x28,0x97,0x21,0x8C,0x41,0x48,0xFF,0xFF,0x78,
+0x00,0x1F,0x80,0x04,0xE6,0x69,0x3E,0x17,0xEA,0xB0,0xE9,0x04,0x84,0x21,0x3E,0x17,
+0xFD,0xC5,0x84,0x20,0x3E,0x17,0xFD,0x98,0x2E,0x10,0x21,0x42,0x84,0x5E,0x42,0x00,
+0x88,0x73,0x40,0xA0,0x84,0x08,0x83,0xC0,0x80,0xAA,0x80,0x61,0xE2,0x7E,0xE8,0x1D,
+0x04,0xF3,0x80,0x05,0x40,0x82,0xA8,0x00,0x40,0x27,0x94,0x00,0x89,0x0F,0xA4,0x90,
+0x02,0xF4,0x00,0x00,0x8A,0x4F,0x96,0x93,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE4,0x5A,
+0xE9,0x09,0x40,0x21,0x85,0x17,0xB0,0x06,0x38,0x20,0x20,0x00,0x8C,0x41,0x38,0x20,
+0x20,0x08,0x8C,0x61,0x8C,0xA2,0xD5,0xE3,0x2E,0x37,0xFD,0x98,0x84,0x40,0xB1,0x4B,
+0xE2,0x41,0xE8,0x0D,0x38,0xF2,0x89,0x01,0x5C,0xF7,0x85,0xDD,0xE9,0x06,0xB0,0x06,
+0x38,0xF0,0x08,0x00,0xE9,0x02,0x84,0x61,0x8C,0x41,0xD5,0xF3,0x04,0x24,0x80,0x01,
+0x3E,0x37,0xFD,0x98,0x5C,0xF1,0x04,0x4D,0xE8,0x04,0x5C,0xF2,0x02,0xBC,0xE8,0x04,
+0x2E,0x27,0xEA,0xDF,0xC2,0x05,0xA4,0xB2,0x88,0x3E,0xE0,0x41,0xE9,0x04,0x84,0x01,
+0x3E,0x07,0xFD,0xC7,0x22,0x33,0x00,0x05,0x5E,0xF1,0x80,0xC9,0xE9,0x04,0x84,0x00,
+0xAC,0x30,0xD5,0x06,0x5A,0x30,0xC8,0x05,0x84,0x01,0x3E,0x07,0xEA,0xD0,0x2E,0x27,
+0xEA,0xB0,0x2E,0x57,0xEA,0xCF,0x4C,0x22,0x80,0x22,0xA0,0x7D,0x94,0x29,0x88,0x01,
+0xA4,0x00,0x96,0x03,0x5E,0xF0,0x04,0x01,0xE9,0x19,0x84,0x20,0x80,0x01,0x44,0x41,
+0xA8,0xE0,0x38,0x92,0x01,0x11,0x4C,0x92,0xC0,0x03,0x84,0x21,0x8C,0x01,0x5A,0x08,
+0x0A,0xFA,0xC9,0x0C,0x2E,0x07,0xEA,0xBC,0x44,0x11,0xA8,0xE0,0xE6,0x0A,0x38,0x50,
+0x81,0x09,0xE8,0x04,0x8C,0x01,0x3E,0x07,0xEA,0xBC,0x2E,0x17,0xEA,0xBC,0xC1,0x46,
+0x85,0x20,0x44,0xA1,0xA8,0xE0,0x80,0x89,0x81,0x0A,0xE2,0x81,0xE8,0x1E,0x38,0x05,
+0x11,0x11,0x04,0xF3,0x80,0x05,0x94,0x01,0x88,0x0F,0xA4,0x00,0x96,0x03,0x5E,0xF0,
+0x04,0x01,0x9C,0x21,0xE9,0x04,0x80,0x80,0x85,0x21,0xD5,0xF0,0x96,0x00,0xE2,0x01,
+0xE8,0x09,0x39,0xE4,0x01,0x11,0x50,0xF0,0x7F,0xFF,0x8C,0x01,0x39,0xE4,0x3D,0x09,
+0xD5,0xF6,0x8E,0x21,0x96,0x48,0xD5,0xE2,0x5E,0xF1,0x84,0x01,0x3E,0x17,0xEA,0xBC,
+0xE9,0x08,0xDA,0x07,0x2E,0x07,0xEA,0xE8,0xE6,0x0A,0xE8,0x06,0x8C,0x01,0xD5,0x1A,
+0x5A,0x98,0x01,0x18,0xD5,0xF8,0x84,0x00,0x3E,0x07,0xEA,0xBC,0x3E,0x07,0xEA,0xE8,
+0x84,0x00,0x44,0x11,0xA8,0xE0,0x80,0x60,0x38,0x30,0x81,0x09,0x8C,0x01,0x5A,0x08,
+0x0A,0xFD,0x84,0x01,0x3E,0x07,0xFD,0xC5,0xD5,0x07,0x5E,0xF1,0x84,0x01,0xE8,0x15,
+0x84,0x00,0x3E,0x07,0xEA,0xE8,0x2E,0x07,0xEA,0xAD,0x3E,0x27,0xEA,0xCF,0x5A,0x08,
+0x01,0x0F,0x22,0x13,0x00,0x05,0x44,0x01,0x46,0x00,0xAC,0x40,0x22,0x13,0x00,0x0A,
+0x44,0x01,0x46,0x02,0xAC,0x40,0xD5,0x03,0xDA,0xEC,0xD5,0xCD,0xFC,0xCA,0x3C,0x0F,
+0xFF,0x3E,0xDD,0x9E,0xFC,0x59,0x3C,0x4D,0xFF,0x3E,0xA6,0xA1,0x01,0xC2,0x00,0x03,
+0xF2,0x82,0x9C,0xD2,0x84,0x40,0x80,0xA2,0xB1,0x84,0x38,0x53,0x0A,0x0A,0x8C,0x41,
+0xE2,0x43,0xE9,0xFB,0x3C,0x27,0xF5,0x7C,0x84,0x60,0xF2,0x81,0x94,0x89,0x3C,0x67,
+0xF5,0x7D,0x81,0x40,0x40,0x90,0x08,0x00,0x80,0xA3,0x4C,0xA4,0x80,0x0F,0x2A,0x25,
+0x00,0x01,0x4E,0x24,0x00,0x05,0xF7,0x01,0xE0,0x47,0xD5,0x02,0xE0,0xC2,0xE9,0xF6,
+0x88,0x62,0x8C,0xA1,0x96,0xDB,0xD5,0xF2,0xC5,0x1D,0xD1,0x09,0x40,0x20,0x84,0x09,
+0x42,0x22,0xF0,0x73,0x40,0x21,0x04,0x57,0x55,0xC1,0x00,0xFF,0x97,0x6B,0x40,0x31,
+0x94,0x76,0x97,0x5B,0xA6,0xA2,0x4E,0x55,0x00,0x06,0x40,0x51,0x04,0x09,0x8A,0x65,
+0xD5,0x04,0x40,0x51,0x04,0x09,0x88,0x65,0x96,0xDB,0x9B,0x73,0x41,0xE2,0x8B,0xD6,
+0xD5,0x02,0x83,0xC5,0xF5,0x01,0x84,0x5E,0xFE,0xAC,0xF2,0x83,0x84,0x40,0x2E,0xA7,
+0xEA,0xA3,0x2E,0x97,0xEA,0xA4,0x80,0xA2,0xD1,0x32,0x38,0x80,0x15,0x11,0x4E,0x84,
+0x00,0x06,0xF7,0x01,0xE1,0x07,0xE8,0x04,0xD5,0x1C,0xE0,0xC8,0xE9,0x12,0xF7,0x03,
+0x00,0xF2,0x00,0x02,0x8B,0x03,0x89,0x07,0x40,0x84,0x3D,0x16,0x40,0xF4,0x78,0x01,
+0xB1,0xC4,0x8C,0x41,0x38,0x83,0xBE,0x02,0x8D,0x01,0x38,0x83,0xBE,0x0A,0xD5,0x12,
+0xB1,0xC4,0x81,0xEA,0x38,0x83,0xAA,0x02,0x8D,0x01,0x38,0x83,0xAA,0x0A,0xD5,0x0A,
+0xE0,0xC8,0xE9,0xF7,0xB1,0xC4,0x81,0xE9,0x38,0x83,0xA6,0x02,0x8D,0x01,0x38,0x83,
+0xA6,0x0A,0xB1,0xD1,0x38,0xF3,0x96,0x0A,0x8C,0xA1,0xD5,0xCF,0xC2,0x14,0x84,0x80,
+0xF3,0x04,0x80,0x44,0xF5,0x02,0xE2,0x45,0xE8,0x0B,0xB1,0x44,0x38,0x52,0x8A,0x02,
+0xE2,0x65,0x40,0x41,0x3C,0x1B,0x40,0x32,0xBC,0x1B,0x8C,0x41,0xD5,0xF4,0x40,0xFE,
+0x0C,0x06,0xE9,0x03,0x84,0x00,0xD5,0x11,0x84,0xA0,0x80,0x45,0xB1,0x91,0xD1,0x0A,
+0x38,0x73,0x16,0x02,0x4C,0x72,0x40,0x05,0x38,0x70,0x15,0x11,0x88,0x47,0x8C,0xA1,
+0xD5,0xF7,0x40,0x21,0x0C,0x56,0x96,0x13,0xFC,0xD9,0xFC,0x49,0x84,0xA0,0x80,0x80,
+0x9F,0xC9,0xD1,0x2E,0xCD,0x0C,0x22,0x20,0x00,0x00,0x22,0x30,0x00,0x01,0x8A,0x43,
+0x4E,0x24,0x00,0x03,0xFE,0x92,0x12,0x2F,0x80,0x02,0xD5,0x1F,0xDF,0x0A,0x22,0x22,
+0x00,0x00,0x22,0x32,0x7F,0xFF,0x8A,0x43,0x4E,0x24,0x00,0x15,0xFE,0x92,0xD5,0x12,
+0x22,0x32,0x00,0x00,0x22,0x22,0x00,0x01,0x9B,0x9A,0x4E,0x64,0x00,0x03,0xFF,0xB2,
+0x22,0x22,0x7F,0xFF,0x9A,0x9A,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE0,0x46,0x40,0x23,
+0x3C,0x1B,0xB0,0xC1,0x38,0x21,0x95,0x09,0x8C,0xA1,0x8C,0x82,0xD5,0xD3,0x84,0x60,
+0x3C,0x77,0xF5,0x7D,0x3C,0x97,0xF5,0x7C,0x3C,0x6D,0xFF,0x3E,0x80,0x43,0x80,0xA3,
+0x50,0xAF,0x80,0x04,0xD1,0x14,0x38,0x40,0x15,0x11,0xE0,0xE4,0xE9,0x0E,0xE0,0x89,
+0xE9,0x0C,0x38,0x85,0x15,0x11,0x00,0xF3,0x00,0x02,0x40,0xF7,0xA0,0x07,0xE9,0x05,
+0x88,0x44,0x8C,0x61,0x96,0x93,0x96,0xDB,0x8C,0xA1,0xD5,0xED,0xA6,0x34,0xE0,0x03,
+0x84,0x00,0xE8,0x04,0x40,0x01,0x0C,0x16,0x96,0x03,0xFC,0xC9,0x84,0x40,0x80,0x62,
+0xE2,0x61,0xE8,0x08,0x38,0x40,0x0D,0x01,0x8C,0x61,0x88,0x44,0x96,0x93,0x96,0xD8,
+0xD5,0xF8,0x44,0x00,0x00,0x32,0x40,0x01,0x00,0x16,0xDD,0x9E,0xFC,0x4A,0xB6,0x1F,
+0x84,0x00,0x3C,0xAD,0xFF,0x3E,0x3E,0x07,0xFD,0x9B,0x2E,0x07,0xEA,0xA7,0x81,0x01,
+0xF0,0x81,0x84,0x00,0x00,0x65,0x00,0x05,0x80,0xE0,0x50,0x9F,0x80,0x0C,0x2E,0x10,
+0x21,0x42,0xE2,0xE1,0xE8,0x7A,0x94,0xC9,0xB4,0x3F,0x94,0xB9,0x88,0x41,0x84,0x20,
+0xE2,0x26,0xE8,0x07,0x38,0x41,0x0C,0x05,0x38,0x44,0x85,0x09,0x8C,0x21,0xD5,0xF9,
+0x00,0x15,0x00,0x00,0xC9,0x06,0x80,0x09,0x80,0x26,0x49,0xFF,0xFE,0xC5,0xD5,0x15,
+0x5A,0x10,0x01,0x10,0x5A,0x18,0x02,0x07,0x80,0x09,0x80,0x26,0x49,0xFF,0xFF,0xC0,
+0xD5,0x0C,0x5A,0x18,0x03,0x0B,0x80,0x09,0x80,0x26,0x49,0xFF,0xFE,0xB5,0xC8,0x05,
+0x80,0x09,0x80,0x26,0x49,0xFF,0xFF,0x5B,0x80,0x20,0x4E,0x04,0x00,0x03,0xFE,0x42,
+0xE4,0x35,0xE9,0x04,0x84,0x21,0x3E,0x17,0xFD,0x9B,0x2E,0x30,0x22,0x08,0x84,0x9D,
+0x40,0x30,0x0C,0x0C,0x96,0x1B,0x40,0x40,0x10,0x96,0x97,0x21,0x84,0x40,0xE2,0x46,
+0xE8,0x3A,0x2E,0xF0,0x21,0xDC,0x2E,0x10,0x21,0x42,0x5A,0xF8,0x01,0x27,0x4E,0x04,
+0x00,0x25,0xF5,0x01,0xCD,0x22,0x80,0xA7,0x42,0x51,0x04,0x73,0xB4,0x3F,0x41,0xE2,
+0x84,0x08,0x88,0x3E,0x2E,0xF0,0x22,0x08,0xA4,0x48,0x40,0xF0,0x3C,0x0E,0x96,0x4B,
+0x40,0xF0,0xBC,0x01,0x40,0x14,0x78,0x00,0x4E,0xF7,0x00,0x07,0x02,0xF0,0x80,0x00,
+0x40,0xF7,0x90,0x00,0xD5,0x05,0x02,0xF0,0x80,0x00,0x40,0xF7,0x8C,0x01,0x40,0xF7,
+0x80,0x13,0x12,0xF0,0x80,0x00,0xD5,0x0D,0x80,0xA7,0x42,0x51,0x04,0x73,0x94,0x69,
+0x88,0x28,0x02,0xF0,0x80,0x00,0x40,0xF7,0x80,0x07,0xE8,0xEE,0x84,0xA0,0xAD,0x48,
+0x8C,0x41,0xD5,0xC6,0x8C,0xE1,0xD5,0x84,0xFC,0xCA,0x2E,0x07,0xFD,0xC7,0x3C,0x1D,
+0xFF,0x3E,0xC0,0x0E,0x3C,0x04,0x05,0xBF,0x84,0x4A,0x40,0x00,0x08,0x16,0xFA,0x45,
+0x96,0x00,0xAE,0x89,0xFA,0x44,0xAE,0x0A,0xFE,0x14,0x90,0x01,0xD5,0x2B,0x2E,0x07,
+0xFD,0x98,0x5A,0x08,0x01,0x0E,0xFA,0x06,0xAE,0x0A,0xA6,0x09,0xFA,0x46,0x8E,0x01,
+0xFE,0x14,0x84,0x42,0x40,0x00,0x08,0x16,0x8E,0x01,0x94,0x01,0xD5,0x1D,0x2E,0x07,
+0xEA,0xA7,0xA6,0x8E,0xC8,0x10,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x0D,0x94,0x11,
+0xAE,0x0A,0xA6,0x09,0x8E,0x01,0xFE,0x14,0x84,0x42,0x40,0x00,0x08,0x16,0x8E,0x01,
+0x94,0x01,0xD5,0x09,0xA6,0x09,0xAE,0x8A,0x8E,0x01,0xFE,0x14,0x84,0x42,0x40,0x00,
+0x08,0x16,0x8E,0x01,0x96,0x03,0x3C,0x0B,0xF5,0x7D,0xFE,0x03,0x3C,0x0B,0xF5,0x7C,
+0xA6,0x09,0x3E,0x07,0xEA,0xA3,0x8C,0x01,0x3E,0x07,0xEA,0xA4,0xDD,0x9E,0xFC,0x01,
+0xB6,0x1F,0xF2,0x81,0x49,0xFF,0xFF,0xB3,0xF0,0x01,0xB4,0x3F,0x49,0xFF,0xFF,0x20,
+0xFC,0x81,0xFC,0x00,0x49,0xFF,0xE9,0x66,0x84,0x20,0x3C,0x0F,0xFF,0x48,0x10,0x10,
+0x00,0x50,0x10,0x10,0x00,0x51,0x10,0x10,0x00,0x52,0x10,0x10,0x00,0x53,0x10,0x10,
+0x00,0x60,0x10,0x10,0x00,0x61,0xFC,0x80,0xFC,0x00,0x3C,0x0D,0xFB,0x14,0xA6,0x00,
+0xC8,0x04,0x49,0xFF,0xE9,0x2E,0xD5,0xFA,0x49,0xFF,0xE9,0x6E,0x3C,0x1D,0xFF,0x48,
+0xC8,0x04,0x44,0x0F,0xFF,0xA0,0xD5,0x03,0x44,0x0F,0xFF,0xA1,0x10,0x00,0x80,0x51,
+0x3C,0x0D,0xFB,0x0A,0xA6,0x01,0x5A,0x08,0x04,0x05,0x84,0x01,0x3E,0x07,0xEA,0xDC,
+0x3C,0x0D,0xFF,0x48,0x00,0x10,0x00,0x51,0x5A,0x10,0xBB,0x05,0x49,0xFF,0xE9,0x11,
+0xD5,0xF8,0x84,0x20,0x10,0x10,0x00,0x51,0xFC,0x80,0x00,0x00,0x8E,0x01,0xE6,0x04,
+0xE8,0x1F,0x44,0xF0,0x91,0x40,0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,0xDD,0x0F,
+0x04,0x14,0x18,0x2A,0x84,0x00,0xB6,0x01,0x3C,0x1D,0xFB,0x16,0xA6,0x08,0x54,0x00,
+0x00,0xFB,0xD5,0x0A,0x84,0x01,0xD5,0x0B,0x84,0x02,0xB6,0x01,0x3C,0x1D,0xFB,0x16,
+0xA6,0x08,0x58,0x00,0x00,0x04,0xAE,0x08,0xDD,0x9E,0x84,0x03,0xB6,0x01,0xDD,0x9E,
+0xFC,0x20,0x9E,0xC1,0xE6,0x6B,0xE8,0x48,0x80,0x01,0x44,0xF0,0x91,0x88,0x38,0x37,
+0x8C,0x00,0x40,0xF1,0xBC,0x00,0xDD,0x0F,0x0C,0x10,0x14,0x38,0x6E,0x58,0x7E,0x5E,
+0x6E,0x76,0x7A,0x00,0x84,0x06,0xD5,0x39,0x84,0x07,0xD5,0x37,0x44,0x61,0xF1,0x10,
+0x84,0xFE,0x49,0xFF,0xE8,0xCE,0x49,0xFF,0xDD,0x2A,0x49,0xFF,0xDD,0x35,0xC8,0x05,
+0xA6,0x30,0xFE,0x3E,0xAE,0x30,0xD5,0xF6,0x49,0xFF,0xDD,0x28,0xC0,0xF7,0xD5,0x24,
+0xFA,0x21,0xAE,0x41,0x84,0x26,0xAE,0x40,0x84,0x21,0x49,0xFF,0xEB,0x7D,0x84,0x20,
+0x84,0x02,0x80,0x41,0x84,0x61,0x80,0x81,0x80,0xA1,0x49,0xFF,0xE8,0xBA,0xD5,0x14,
+0x84,0x01,0xAE,0x10,0xD5,0x07,0x84,0xC1,0xAF,0x90,0x49,0xFF,0xCB,0xFD,0x3E,0x67,
+0xFC,0x18,0x84,0x0E,0xD5,0x0A,0x84,0x01,0xAE,0x10,0x84,0x0D,0xD5,0x06,0xFA,0x00,
+0xD5,0x04,0xFA,0x01,0xD5,0x02,0x84,0x01,0xFC,0xA0,0x92,0x00,0x3C,0x1D,0xFF,0x48,
+0x10,0x00,0x80,0x60,0xDD,0x9E,0x3C,0x0D,0xFF,0x48,0x00,0x00,0x00,0x60,0xDD,0x9E,
+0x3C,0x1D,0xFF,0x48,0x10,0x00,0x80,0x61,0xDD,0x9E,0xFC,0x00,0x5A,0x08,0x06,0x04,
+0x84,0x01,0xD5,0x04,0x5A,0x08,0x07,0x06,0x84,0x00,0x3E,0x07,0xEA,0xAE,0xD5,0x1C,
+0x5A,0x08,0x0D,0x07,0x84,0x00,0x3E,0x07,0xEA,0xAE,0x84,0x21,0xD5,0x07,0x5A,0x08,
+0x0E,0x0B,0x84,0x01,0x3E,0x07,0xEA,0xAE,0x84,0x20,0x3E,0x17,0xEA,0xD1,0x3E,0x07,
+0xEA,0xCE,0xD5,0x0A,0x5A,0x08,0x10,0x04,0x84,0x01,0xD5,0x04,0x5A,0x08,0x11,0x05,
+0x84,0x00,0x3E,0x07,0xEA,0xAD,0xFC,0x80,0x9E,0xC1,0xE6,0x6A,0xE8,0x2E,0xFC,0x01,
+0xF2,0x81,0x80,0x01,0x44,0xF0,0x92,0x94,0x38,0x37,0x8C,0x00,0x40,0xF1,0xBC,0x00,
+0x4A,0x00,0x3C,0x00,0x0A,0x12,0x22,0x2A,0x42,0x42,0x42,0x42,0x32,0x3A,0xA6,0x48,
+0x58,0x10,0x80,0x02,0xD5,0x04,0xA6,0x48,0x54,0x10,0x80,0xFD,0xAE,0x40,0xF1,0x01,
+0x49,0xFF,0xEE,0x78,0xD5,0x11,0xA6,0x48,0x58,0x10,0x80,0x01,0xD5,0x0C,0xA6,0x48,
+0x54,0x10,0x80,0xFE,0xD5,0x08,0xA6,0x48,0x58,0x10,0x80,0x10,0xD5,0x04,0xA6,0x48,
+0x54,0x10,0x80,0xEF,0xAE,0x40,0xFC,0x81,0xDD,0x9E,0x92,0x00,0x8E,0x01,0xE6,0x04,
+0xE8,0x23,0xFC,0x01,0x80,0x61,0xF3,0x81,0x80,0x22,0x44,0xF0,0x92,0xF8,0x38,0x07,
+0x80,0x00,0x40,0xF0,0x3C,0x00,0xDD,0x0F,0x04,0x0C,0x1C,0x24,0xA6,0x10,0x58,0x00,
+0x00,0x02,0xD5,0x04,0xA6,0x10,0x54,0x00,0x00,0xFD,0xAE,0x08,0xF0,0x01,0x49,0xFF,
+0xEE,0x49,0xD5,0x09,0xA6,0x10,0x58,0x00,0x00,0x01,0xD5,0x04,0xA6,0x10,0x54,0x00,
+0x00,0xFE,0xAE,0x08,0xFC,0x81,0xDD,0x9E,0xFC,0x42,0xF0,0x82,0xA6,0x09,0x80,0xE1,
+0xB6,0x5F,0x81,0x43,0xF4,0x83,0x81,0x25,0x5A,0x08,0x04,0x05,0x84,0x20,0x3E,0x17,
+0xEA,0xDC,0x3C,0x1D,0xFF,0x48,0x00,0x60,0x80,0x50,0xCE,0x0F,0xB4,0x1F,0x44,0x11,
+0x81,0x81,0x49,0xFF,0xE9,0xB1,0x44,0x00,0x00,0x55,0x3E,0x07,0xEA,0xE4,0x3E,0x67,
+0xEA,0xD8,0x84,0x01,0x48,0x00,0x00,0xC3,0x5A,0x00,0x01,0x09,0x49,0xFF,0xDC,0xEC,
+0x5A,0x08,0x02,0x05,0x84,0x01,0x49,0xFF,0xDF,0x36,0xB4,0x1F,0x44,0x11,0x81,0x81,
+0x49,0xFF,0xE9,0x5B,0x84,0x00,0x3E,0x07,0xEA,0xE6,0x3C,0x0D,0xFF,0x48,0x00,0x60,
+0x00,0x50,0x00,0x00,0x00,0x51,0x40,0x83,0x10,0x09,0xF0,0x81,0x84,0x00,0x3C,0x0F,
+0xFB,0x2A,0xA6,0x79,0x97,0x9F,0x5A,0x18,0x04,0x08,0x84,0x01,0x49,0xFF,0xDE,0xFB,
+0x49,0xFF,0xED,0x8D,0xD5,0x21,0xA6,0x78,0x5A,0x18,0x01,0x0E,0x3C,0x0F,0xFB,0x32,
+0x3C,0x0D,0xFB,0x32,0xC8,0x08,0x49,0xFF,0xDC,0xBF,0x5A,0x08,0x02,0x05,0x49,0xFF,
+0xE7,0xB8,0xD5,0xF7,0x3C,0x0D,0xFB,0x14,0xA6,0x40,0xC9,0x04,0x49,0xFF,0xE7,0xB1,
+0xD5,0xFA,0xA6,0x00,0x5A,0x00,0x02,0x09,0x3C,0x0D,0xFA,0xFF,0xA6,0x40,0x5A,0x18,
+0x02,0x04,0x84,0x20,0xAE,0x40,0x50,0x04,0x7F,0xFF,0xE6,0x08,0x4E,0xF2,0x00,0x75,
+0x44,0xF0,0x94,0x10,0x38,0x07,0x80,0x00,0x40,0xF0,0x3C,0x00,0x4A,0x00,0x3C,0x00,
+0x08,0x3A,0xD6,0xD6,0x6A,0x74,0x82,0x98,0x44,0x01,0x81,0x66,0x44,0x11,0x81,0xBE,
+0x49,0xFF,0xE9,0x5C,0xB4,0x1F,0x44,0x11,0x81,0x81,0x49,0xFF,0xE9,0x45,0x80,0x06,
+0xF1,0x01,0x80,0x47,0x49,0xFF,0xD7,0x42,0x3C,0x0D,0xFF,0x48,0x84,0x20,0x10,0x10,
+0x00,0x50,0x5A,0x68,0x0F,0x52,0x84,0xCC,0xD5,0x3A,0x84,0x01,0x3E,0x07,0xEA,0xE6,
+0x5A,0x60,0x01,0x09,0x5A,0x60,0x02,0x0A,0x84,0x01,0x5A,0x68,0x03,0x0A,0x84,0xC2,
+0xD5,0x08,0x84,0x00,0x84,0xC4,0xD5,0x05,0x84,0x00,0x84,0xC5,0xD5,0x02,0x80,0xC0,
+0x84,0x21,0x3E,0x17,0xEA,0xD8,0xC0,0x28,0xD5,0x22,0x80,0x06,0xF1,0x02,0x49,0xFF,
+0xFE,0x57,0xD5,0x32,0xFD,0x03,0x44,0x21,0x81,0xA6,0x49,0xFF,0xFE,0x73,0x97,0x80,
+0xD5,0x16,0x80,0x06,0x80,0x2A,0x80,0x49,0x49,0xFF,0xFE,0xF0,0xF1,0x03,0x00,0x05,
+0x00,0x00,0x84,0xCB,0xAE,0x08,0xD5,0x0B,0x80,0x06,0x80,0x2A,0x80,0x49,0x49,0xFF,
+0xFF,0x17,0xF0,0x0C,0x00,0x14,0x80,0x00,0x84,0xCF,0xAE,0x40,0x3C,0x0D,0xFF,0x48,
+0x84,0x20,0x10,0x10,0x00,0x50,0x2E,0x07,0xEA,0xE6,0xC8,0x0C,0x44,0x01,0x81,0x66,
+0x44,0x11,0x81,0xBE,0x49,0xFF,0xE9,0x02,0xB4,0x1F,0x44,0x11,0x81,0x81,0x49,0xFF,
+0xE8,0xEB,0x80,0x06,0xD5,0x03,0x84,0xC1,0xD5,0xEA,0xFC,0xC2,0x5A,0x08,0x07,0x2A,
+0x8E,0x21,0xE6,0x2C,0xE8,0x54,0x44,0xF0,0x95,0x04,0x38,0x17,0x84,0x00,0x40,0xF0,
+0xBC,0x00,0xDD,0x0F,0x0C,0x14,0x1C,0x24,0x98,0x98,0x98,0x98,0x2C,0x34,0x90,0x88,
+0xA6,0x10,0x58,0x00,0x00,0x02,0xD5,0x42,0xA6,0x10,0x54,0x00,0x00,0xFD,0xD5,0x3E,
+0xA6,0x10,0x58,0x00,0x00,0x01,0xD5,0x3A,0xA6,0x10,0x54,0x00,0x00,0xFE,0xD5,0x36,
+0xA6,0x10,0x58,0x00,0x00,0x10,0xD5,0x32,0xA6,0x10,0x54,0x00,0x00,0xEF,0xD5,0x2E,
+0x5A,0x08,0x08,0x1F,0x8E,0x21,0xE6,0x24,0xE8,0x2A,0x44,0xF0,0x95,0x58,0x38,0x17,
+0x84,0x00,0x40,0xF0,0xBC,0x00,0xDD,0x0F,0x04,0x0C,0x14,0x1C,0xA6,0x18,0x58,0x00,
+0x00,0x02,0xD5,0x0C,0xA6,0x18,0x54,0x00,0x00,0xFD,0xD5,0x08,0xA6,0x18,0x58,0x00,
+0x00,0x01,0xD5,0x04,0xA6,0x18,0x54,0x00,0x00,0xFE,0xAE,0x18,0xDD,0x9E,0x5A,0x08,
+0x05,0x0F,0x5A,0x10,0x01,0x05,0x5A,0x10,0x03,0x07,0xDD,0x9E,0xA6,0x10,0x54,0x00,
+0x00,0xFB,0xD5,0x04,0xA6,0x10,0x58,0x00,0x00,0x04,0xAE,0x10,0xDD,0x9E,0x92,0x00,
+0xFC,0x42,0xF2,0x82,0x44,0x21,0x1E,0x50,0xF0,0x81,0xF3,0x83,0x81,0x21,0x44,0x11,
+0x1E,0x51,0xA6,0x10,0xA7,0x90,0xA7,0xC8,0x92,0x04,0x97,0x9F,0x97,0xF8,0x5A,0x08,
+0x01,0x24,0x9E,0x71,0xE6,0x22,0xE9,0x0F,0x5A,0x60,0x03,0x04,0x5A,0x68,0x05,0x1D,
+0x3C,0x1D,0xFF,0x48,0x00,0x10,0x80,0x60,0x5A,0x10,0xA1,0x06,0x2E,0x17,0xFD,0xBC,
+0x5A,0x10,0x01,0x13,0x44,0x01,0x81,0x66,0x44,0x11,0x81,0xBE,0x49,0xFF,0xE8,0x76,
+0x44,0x01,0x81,0x7A,0x44,0x11,0x81,0x81,0x49,0xFF,0xE8,0x1F,0xFD,0x03,0xF2,0x01,
+0x49,0xFF,0xD6,0x5C,0xD5,0x13,0x9E,0x47,0xE6,0x22,0xE9,0x03,0x5A,0x08,0x05,0x0F,
+0x80,0x26,0xF2,0x02,0xF3,0x03,0x49,0xFF,0xFF,0x6B,0x84,0x01,0x10,0x04,0x80,0x00,
+0x3C,0x0D,0xFF,0x48,0x84,0x20,0x10,0x10,0x00,0x50,0xFC,0xC2,0xFC,0x40,0x80,0xC1,
+0x84,0x20,0xAE,0x40,0xA6,0x10,0x81,0x22,0x92,0x01,0x96,0x06,0x80,0xE3,0x81,0x44,
+0x5A,0x08,0x01,0x0A,0xA6,0x30,0x80,0x23,0x58,0x00,0x00,0x02,0xAE,0x30,0x80,0x06,
+0x49,0xFF,0xEC,0xA8,0x00,0x04,0x80,0x00,0x92,0x01,0x96,0x06,0xC8,0x09,0xA6,0x30,
+0x80,0x27,0x54,0x00,0x00,0xFD,0xAE,0x30,0x80,0x06,0x49,0xFF,0xEC,0x9B,0x00,0x04,
+0x80,0x00,0x96,0x06,0x5A,0x08,0x01,0x06,0xA6,0x30,0x58,0x00,0x00,0x01,0xAE,0x30,
+0x00,0x04,0x80,0x00,0x96,0x06,0xC8,0x05,0xA6,0x30,0x54,0x00,0x00,0xFE,0xAE,0x30,
+0x00,0x04,0x80,0x00,0x92,0x05,0x96,0x06,0x5A,0x08,0x01,0x08,0xA6,0x70,0x58,0x10,
+0x80,0x20,0xAE,0x70,0x3E,0x07,0xEB,0xEA,0x00,0x04,0x80,0x00,0x92,0x05,0x96,0x06,
+0xC8,0x05,0xA6,0x30,0x54,0x00,0x00,0xDF,0xAE,0x30,0x00,0x04,0x80,0x00,0x92,0x04,
+0x96,0x06,0x5A,0x08,0x01,0x06,0xA6,0x30,0x58,0x00,0x00,0x10,0xAE,0x30,0x00,0x04,
+0x80,0x00,0x92,0x04,0x96,0x06,0xC8,0x05,0xA6,0x30,0x54,0x00,0x00,0xEF,0xAE,0x30,
+0x00,0x04,0x80,0x00,0x92,0x02,0x96,0x06,0x5A,0x08,0x01,0x06,0xA6,0x30,0x58,0x00,
+0x00,0x04,0xAE,0x30,0x00,0x04,0x80,0x00,0x92,0x02,0x96,0x06,0xC8,0x05,0xA6,0x30,
+0x54,0x00,0x00,0xFB,0xAE,0x30,0x00,0x05,0x00,0x00,0x92,0x01,0x96,0x06,0x5A,0x08,
+0x01,0x0A,0xA6,0x38,0x80,0x27,0x58,0x00,0x00,0x02,0xAE,0x38,0x80,0x06,0x49,0xFF,
+0xEC,0x41,0x00,0x05,0x00,0x00,0x92,0x01,0x96,0x06,0xC8,0x09,0xA6,0x38,0x80,0x27,
+0x54,0x00,0x00,0xFD,0xAE,0x38,0x80,0x06,0x49,0xFF,0xEC,0x34,0x00,0x05,0x00,0x00,
+0x96,0x06,0x5A,0x08,0x01,0x06,0xA6,0x38,0x58,0x00,0x00,0x01,0xAE,0x38,0x00,0x05,
+0x00,0x00,0x96,0x06,0xC8,0x05,0xA6,0x38,0x54,0x00,0x00,0xFE,0xAE,0x38,0x00,0x05,
+0x00,0x00,0x92,0x02,0x96,0x06,0x5A,0x08,0x01,0x08,0xA6,0x78,0x58,0x10,0x80,0x04,
+0xAE,0x78,0x3E,0x07,0xEB,0xEA,0x00,0x05,0x00,0x00,0x92,0x02,0x96,0x06,0xC8,0x05,
+0xA6,0x38,0x54,0x00,0x00,0xFB,0xAE,0x38,0xFC,0xC0,0xFC,0x00,0x80,0xC0,0x49,0xFF,
+0xFD,0x4E,0x5A,0x68,0x03,0x06,0x49,0xFF,0xC9,0x21,0x80,0x06,0xD5,0x26,0x5A,0x68,
+0x0E,0x0C,0x2E,0x07,0xFC,0x18,0x5A,0x08,0x01,0x20,0x3C,0x0D,0xFB,0x0A,0xA6,0x01,
+0x5A,0x08,0x03,0x0A,0xD5,0x06,0x5A,0x60,0x0D,0xFA,0x5A,0x60,0x02,0xF8,0xD5,0x14,
+0x84,0x02,0xD5,0x13,0x84,0x00,0x49,0xFF,0xDC,0xFF,0x3C,0x0D,0xFB,0x0A,0x84,0x20,
+0x49,0xFF,0xE8,0x7A,0x49,0xFF,0xDA,0xB8,0x5A,0x08,0x02,0xF4,0x3C,0x1D,0xFB,0x0A,
+0x84,0x43,0xAE,0x89,0xD5,0x02,0x84,0x01,0x8E,0xC4,0xE6,0xC2,0xE8,0x07,0x84,0x21,
+0x3E,0x17,0xEA,0xC5,0x84,0x20,0x3C,0x1F,0xFF,0x6A,0xFC,0x80,0xFC,0x00,0x44,0x61,
+0x1E,0x50,0xA6,0x30,0x5A,0x08,0x13,0x0B,0x49,0xFF,0xDA,0x9E,0x5A,0x00,0x02,0x07,
+0x84,0x00,0xAE,0x30,0x84,0x01,0x3E,0x07,0xEA,0xC0,0xFC,0x80,0x3C,0x0F,0xFA,0xF8,
+0xDD,0x9E,0x3C,0x0F,0xFF,0x57,0xDD,0x9E,0x3C,0x0F,0xFF,0x56,0xDD,0x9E,0x84,0xA1,
+0xC2,0x02,0x84,0xBF,0xC9,0x09,0xFA,0x22,0xFE,0x0C,0xFA,0x21,0x42,0x01,0x04,0x73,
+0xB6,0x03,0x88,0x05,0xD5,0x0E,0x44,0x10,0x02,0x2E,0x81,0xE0,0x42,0xF1,0x04,0x73,
+0xFA,0x2F,0x42,0x51,0x04,0x73,0xFA,0x22,0x14,0xF1,0x80,0x00,0x42,0x02,0x84,0x73,
+0xB6,0x04,0xDD,0x9E,0xFC,0x40,0x44,0x30,0x27,0x10,0xFE,0x5C,0xFA,0x98,0x46,0x57,
+0xFF,0xFF,0x40,0x20,0x88,0x56,0xFB,0x24,0x50,0x52,0x8F,0xFF,0x80,0xC4,0x44,0x70,
+0x00,0x50,0x80,0x23,0x38,0x30,0x19,0x11,0x38,0x60,0x1D,0x11,0xFE,0xCC,0x40,0x31,
+0x98,0x76,0x8A,0x62,0x4E,0x34,0x00,0x03,0xFE,0xDA,0xE0,0x65,0x40,0x51,0xBC,0x1B,
+0x9C,0xE1,0x40,0x92,0x3C,0x1B,0x5A,0x30,0x79,0x0D,0x5C,0xF1,0x80,0x51,0xE9,0x04,
+0x52,0x62,0x00,0x9F,0xD5,0x02,0x80,0xC3,0x52,0x72,0x00,0x77,0x80,0x83,0xD5,0xE3,
+0x80,0x09,0xFC,0xC0,0x5C,0xF0,0x00,0x51,0xE9,0x05,0x52,0x30,0x00,0xA0,0xB6,0x61,
+0xD5,0x02,0xB6,0x01,0x50,0x10,0x7F,0xD8,0x5C,0xF0,0x80,0x51,0xE9,0x05,0x52,0x00,
+0x00,0xC8,0xB6,0x02,0xDD,0x9E,0xB6,0x22,0xDD,0x9E,0xFC,0x44,0x84,0xC0,0x81,0x05,
+0x83,0x80,0x81,0x41,0xF2,0x82,0xF3,0x81,0x80,0xE4,0x80,0xA3,0x81,0x26,0xE2,0xE5,
+0xE9,0x14,0x80,0x05,0xF1,0x10,0xF2,0x02,0xB0,0xC4,0xB1,0x05,0xF5,0x83,0x49,0xFF,
+0xFF,0x90,0xF0,0x04,0xF5,0x03,0x38,0x0E,0x01,0x11,0x8C,0xA1,0x89,0x20,0xF0,0x05,
+0x38,0x0E,0x01,0x11,0x88,0xC0,0xD5,0xEC,0xF0,0x01,0x80,0x46,0x8A,0xE0,0xFF,0xFB,
+0x84,0x05,0x42,0x23,0x80,0x73,0x4E,0x26,0x00,0x03,0x84,0x41,0x80,0x29,0x80,0x0A,
+0x49,0xFF,0xFF,0x92,0x00,0x14,0x00,0x00,0x5A,0x10,0xFF,0x05,0x8C,0x21,0x88,0x01,
+0x92,0x01,0x10,0x04,0x00,0x00,0xB0,0x46,0xB0,0x87,0x49,0xFF,0xFF,0xB5,0xF0,0x06,
+0x38,0x15,0x01,0x11,0xF0,0x07,0x38,0x25,0x01,0x11,0x84,0x02,0x40,0x00,0x80,0x16,
+0x42,0x04,0x88,0x73,0x40,0x00,0x04,0x16,0xFC,0xC4,0xFC,0x44,0x80,0xE1,0x3C,0x1D,
+0xFF,0x56,0xF2,0x82,0x50,0x60,0x00,0x20,0x00,0x20,0x80,0x32,0x84,0x00,0xF2,0x84,
+0x00,0x20,0x80,0x33,0x44,0x81,0x93,0xE4,0xF2,0x85,0x20,0x20,0x80,0x39,0x20,0x10,
+0x80,0x3A,0xF2,0x86,0xF1,0x87,0xF0,0x83,0x3C,0x0D,0xFF,0x56,0xF1,0x03,0x00,0x00,
+0x00,0x09,0xE2,0x20,0x4E,0xF2,0x00,0xD0,0x04,0x03,0x7F,0xF8,0x4E,0x02,0x00,0xB9,
+0x8E,0x04,0xE6,0x02,0x4E,0xF3,0x00,0xB5,0xA0,0x34,0x5A,0x08,0x02,0x04,0x48,0x00,
+0x00,0xB0,0x04,0x93,0x7F,0xFF,0xA0,0x3D,0x40,0xA4,0x88,0x08,0x88,0x0A,0xA6,0xC0,
+0xCB,0x18,0xA6,0x42,0xE6,0x22,0xE9,0x02,0x9E,0xC9,0xA7,0x03,0xE6,0x9E,0xE8,0x03,
+0x8C,0x81,0xD5,0x02,0xFA,0x8F,0x84,0x40,0x3C,0x1D,0xFF,0x57,0xB6,0x5F,0xF0,0x02,
+0x80,0xA6,0x49,0xFF,0xFF,0x74,0xA0,0x7E,0x38,0x10,0xA6,0x02,0x8A,0x20,0xD5,0x21,
+0xA6,0x41,0x5A,0x18,0x11,0x2B,0xA6,0xC2,0xE6,0x62,0xE9,0x03,0x8E,0x61,0xD5,0x02,
+0x84,0x60,0xA7,0x03,0xE6,0x9E,0xE8,0x03,0x8C,0x81,0xD5,0x02,0xFA,0x8F,0x3C,0x1D,
+0xFF,0x57,0x84,0x00,0xB6,0x1F,0x50,0x10,0x80,0xA2,0x84,0x41,0xF0,0x02,0x80,0xA6,
+0x49,0xFF,0xFF,0x55,0xA0,0x7E,0xFA,0x42,0x38,0x10,0xA6,0x02,0x42,0x10,0x08,0x73,
+0xF2,0x04,0xFE,0x54,0x04,0x23,0x80,0x08,0x38,0x21,0x26,0x02,0x88,0x02,0x40,0x00,
+0x80,0x16,0xF1,0x06,0x88,0x01,0xD5,0x05,0x84,0x1F,0xAE,0x30,0x02,0x03,0x7F,0xF2,
+0x12,0x03,0x7F,0xF6,0xA0,0x3D,0x89,0x40,0x00,0x35,0x00,0x02,0xCB,0x1D,0x00,0x05,
+0x00,0x00,0xE6,0x02,0xE9,0x02,0x9E,0xC1,0x00,0x45,0x00,0x01,0xE6,0x90,0xE8,0x03,
+0x8C,0x81,0xD5,0x02,0xFA,0x81,0x3C,0x1D,0xFF,0x57,0x84,0x01,0xB6,0x1F,0x50,0x10,
+0x81,0x44,0xF0,0x02,0x84,0x40,0x9D,0x71,0x49,0xFF,0xFF,0x21,0xA0,0x7F,0x38,0x10,
+0xA6,0x02,0x8A,0x20,0xD5,0x22,0x00,0x05,0x00,0x03,0x5A,0x08,0x1F,0x2B,0x00,0x35,
+0x00,0x00,0xE6,0x62,0xE9,0x03,0x8E,0x61,0xD5,0x02,0x84,0x60,0x00,0x45,0x00,0x01,
+0xE6,0x90,0xE8,0x03,0x8C,0x81,0xD5,0x02,0xFA,0x81,0x3C,0x1D,0xFF,0x57,0x84,0x41,
+0xB6,0x5F,0x50,0x10,0x81,0xE6,0x99,0x72,0xF0,0x02,0x49,0xFF,0xFF,0x00,0xA0,0x7F,
+0x94,0x85,0x38,0x10,0xA6,0x02,0x88,0x22,0xF2,0x05,0xFE,0x54,0x04,0x23,0x80,0x08,
+0x38,0x21,0x26,0x02,0x88,0x02,0x40,0x00,0x80,0x16,0xF1,0x07,0x88,0x01,0xD5,0x05,
+0x84,0x1F,0xAE,0x31,0x02,0x03,0x7F,0xF3,0x12,0x03,0x7F,0xF7,0x22,0x03,0x7F,0xF6,
+0x12,0x04,0x00,0x00,0x22,0x03,0x7F,0xF7,0x12,0x04,0x00,0x01,0xD5,0x0C,0x22,0x04,
+0x00,0x00,0x12,0x03,0x7F,0xF6,0x22,0x04,0x00,0x01,0x12,0x03,0x7F,0xF7,0x84,0x1F,
+0xAE,0x30,0xAE,0x31,0xF0,0x03,0x8D,0x04,0x8C,0x01,0xF0,0x83,0x50,0x63,0x00,0x5C,
+0x48,0xFF,0xFF,0x2C,0xFC,0xC4,0x3C,0x0F,0xFF,0x65,0xDD,0x9E,0xFC,0x40,0x84,0x60,
+0x44,0x41,0x94,0x20,0x80,0xA3,0x38,0x52,0x0D,0x09,0x8C,0x61,0x44,0x71,0x94,0x20,
+0x5A,0x38,0x19,0xFB,0x9F,0x52,0x3C,0x9D,0xFF,0x65,0x84,0x80,0x8E,0x22,0x5A,0x40,
+0x19,0x4D,0x80,0x41,0x84,0xC0,0x50,0x82,0xFF,0xFE,0x5A,0x60,0x05,0x44,0x01,0xC4,
+0x80,0x02,0x40,0xA3,0x10,0x00,0x4E,0x25,0x00,0x0E,0xE0,0x5C,0xE8,0x11,0x4E,0x55,
+0x00,0x10,0x00,0x34,0x80,0x03,0xE0,0xA3,0xE8,0x0B,0x80,0x62,0x42,0x32,0xF0,0x73,
+0xD5,0x29,0x84,0x61,0x5A,0x27,0xFF,0x11,0x84,0x62,0x5A,0x27,0xFE,0x0E,0x4C,0x2E,
+0x40,0x04,0x9E,0xD2,0xD5,0x09,0x50,0x3E,0x00,0x01,0x4C,0x21,0xC0,0x05,0x50,0x3E,
+0x7F,0xFD,0xD5,0x02,0x80,0x62,0x85,0xE1,0x5A,0x57,0xFF,0x13,0x85,0xE2,0x5A,0x57,
+0xFE,0x10,0x00,0xF4,0x80,0x03,0x4C,0x57,0xC0,0x04,0x81,0xE8,0xD5,0x09,0x51,0xE7,
+0x80,0x01,0x4C,0x5F,0x40,0x05,0x50,0xF7,0xFF,0xFD,0xD5,0x02,0x81,0xE5,0x42,0x37,
+0xF0,0x73,0x94,0xD9,0x88,0x60,0x8C,0x41,0xA4,0xD8,0x8C,0xC1,0x38,0x33,0xA9,0x09,
+0xD5,0xBD,0x8C,0xA1,0x8C,0x85,0xD5,0xB4,0x84,0x00,0x81,0xE0,0x44,0x21,0x80,0xF8,
+0x84,0x20,0x98,0xF9,0x38,0x41,0x80,0x11,0x98,0xCA,0x8C,0x2A,0x38,0x31,0x80,0x11,
+0x42,0xF2,0x0C,0x73,0x5A,0x18,0x32,0xF7,0x8C,0x02,0x5A,0x08,0x0A,0xF3,0x5E,0xF7,
+0x80,0xDD,0x84,0x00,0xE8,0x03,0x44,0x00,0x80,0x00,0xFC,0xC0,0xFC,0x4D,0xF2,0x92,
+0x44,0x20,0xB1,0x5C,0xB1,0x18,0xF3,0x89,0x3A,0x21,0x0C,0x00,0x3A,0x22,0x0C,0x20,
+0x46,0x27,0xFF,0xFF,0x87,0x80,0x50,0x21,0x0F,0xFF,0x81,0x3C,0xF4,0x8E,0xF2,0x95,
+0xF2,0x09,0xA6,0x90,0xE3,0x22,0x4E,0xF2,0x00,0xDC,0x04,0xA0,0x80,0x01,0x38,0x25,
+0x25,0x01,0xF2,0x81,0x4C,0x24,0xC0,0xD2,0xA0,0xCD,0x40,0x24,0x88,0x08,0x88,0x43,
+0xA6,0xD3,0xA7,0x12,0xF3,0x8F,0xA6,0xD0,0xA6,0x91,0xF3,0x90,0xF2,0x91,0xF2,0x0F,
+0xE2,0x44,0x4E,0xF3,0x00,0xC3,0x9E,0xA1,0xF3,0x10,0xB6,0x5F,0xF2,0x11,0xE2,0x43,
+0x4E,0xF3,0x00,0xB9,0xB4,0x41,0x2F,0xE0,0x21,0x42,0xF2,0x82,0x80,0x43,0xF5,0x02,
+0x42,0x22,0x78,0x73,0x94,0x91,0x99,0xAA,0xA7,0x71,0x97,0x56,0x4E,0x53,0x00,0xA8,
+0xA7,0x70,0xF6,0x01,0x38,0x55,0x15,0x01,0x4C,0x53,0x40,0xA2,0x99,0x82,0xF6,0x83,
+0x22,0x83,0x00,0x00,0x4E,0x87,0x00,0x9C,0xC4,0x08,0xB4,0xFF,0x80,0xC3,0x42,0x63,
+0xF8,0x73,0x38,0x60,0x19,0x01,0xD5,0x03,0x44,0x60,0x7F,0xFF,0x12,0x6F,0x80,0x2C,
+0xC3,0x0C,0x2E,0x60,0x21,0x42,0x80,0xE3,0x42,0x72,0x18,0x73,0x80,0xC7,0xF7,0x15,
+0x88,0xC7,0x38,0x60,0x19,0x01,0xD5,0x03,0x44,0x60,0x7F,0xFF,0x12,0x6F,0x80,0x2D,
+0x50,0x6F,0x7F,0xFF,0xE2,0x66,0xE8,0x04,0x88,0x40,0xA4,0x91,0xD5,0x03,0x44,0x20,
+0x7F,0xFF,0x12,0x2F,0x80,0x2E,0x2E,0x20,0x21,0x43,0x8E,0x41,0xE2,0x82,0xE8,0x08,
+0x9C,0xA1,0x80,0xC3,0x42,0x61,0x78,0x73,0x38,0x20,0x19,0x01,0xD5,0x03,0x44,0x20,
+0x7F,0xFF,0x12,0x2F,0x80,0x2F,0x84,0x46,0x42,0x74,0x08,0x24,0xF2,0x93,0x96,0xA8,
+0xF2,0x94,0x9E,0x99,0x84,0xCA,0xF2,0x8B,0x9C,0xA1,0x40,0x63,0x98,0xD6,0xF2,0x8C,
+0x9C,0x99,0xF6,0x8A,0xF2,0x8D,0x84,0xC0,0xF2,0x0E,0xB1,0x56,0x38,0x21,0x19,0x00,
+0x38,0x22,0x89,0x11,0xF5,0x0A,0xF2,0x84,0xE0,0x45,0xE8,0x46,0xF5,0x0E,0x94,0xB1,
+0x88,0x45,0xB1,0x56,0xA6,0x91,0x38,0x22,0x89,0x11,0xF5,0x0A,0xF2,0x85,0xE0,0x45,
+0xE8,0x3B,0x5A,0x60,0x02,0x0B,0x5A,0x60,0x03,0x0B,0x5A,0x60,0x01,0x04,0xF2,0x0B,
+0xD5,0x02,0xF2,0x0D,0xB4,0xBF,0xD5,0x05,0xF2,0x0B,0xD5,0x02,0xF2,0x0D,0xF5,0x0C,
+0x42,0x22,0xF8,0x73,0xF5,0x02,0x94,0x91,0x88,0xA2,0xF5,0x86,0xA7,0x69,0x97,0x56,
+0x97,0x68,0xCD,0x22,0x88,0x40,0xF7,0x13,0xF2,0x87,0x22,0x21,0x00,0x00,0x42,0xF1,
+0x1C,0x24,0xF2,0x88,0x84,0xEA,0xF2,0x04,0x40,0x77,0x9C,0xF6,0xE0,0x47,0xE8,0x14,
+0xF2,0x05,0xE0,0x47,0xE8,0x11,0xF2,0x06,0xA7,0xD0,0xF2,0x14,0x38,0x75,0x1D,0x00,
+0x4C,0x23,0xC0,0x0B,0xF2,0x08,0xE0,0x48,0xE9,0x03,0xF2,0x03,0xD5,0x02,0xF2,0x07,
+0xAD,0x50,0x87,0x81,0xD5,0x04,0x8C,0xC1,0x5A,0x68,0x04,0xB0,0x8C,0x61,0x48,0xFF,
+0xFF,0x47,0x8C,0x81,0x48,0xFF,0xFF,0x3D,0x8D,0x21,0x48,0xFF,0xFF,0x23,0x5B,0xC8,
+0x01,0x06,0xF3,0x09,0xF2,0x12,0x49,0xFF,0xB3,0x3B,0xFC,0xCD,0xFC,0x00,0x3C,0x1D,
+0xFB,0x14,0x84,0x02,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x84,0x01,0x3C,0x0F,
+0xFA,0xE3,0x44,0x00,0x00,0xA2,0x49,0xFF,0xF9,0xDB,0x3C,0x0D,0xFB,0x0A,0xA6,0x01,
+0x5A,0x08,0x10,0x06,0x44,0x00,0x00,0xFF,0x49,0xFF,0xDA,0xEF,0x49,0xFF,0xEA,0xD6,
+0x3E,0x07,0xFD,0x9D,0x84,0x00,0x3E,0x07,0xEA,0xA6,0x2E,0x00,0x21,0x4B,0x52,0x00,
+0x00,0x01,0x49,0xFF,0xE2,0x8B,0x84,0x01,0x3E,0x07,0xEA,0x9D,0x3E,0x07,0xEA,0xA0,
+0xFC,0x80,0xFC,0x00,0x44,0x01,0x81,0x48,0x44,0x21,0xAD,0x54,0x84,0x20,0x8A,0x40,
+0x49,0x00,0x09,0x36,0xFC,0x80,0xFC,0x00,0x84,0x00,0x3C,0x0F,0xFB,0x29,0x3C,0x0F,
+0xFB,0x2A,0x3C,0x0F,0xFB,0x36,0x3C,0x0F,0xFB,0x18,0x3C,0x0F,0xFB,0x35,0x3C,0x0F,
+0xFB,0x2E,0x3C,0x0F,0xFB,0x34,0x3C,0x0F,0xFB,0x28,0x3C,0x0F,0xFB,0x23,0x3C,0x0F,
+0xFB,0x17,0x3C,0x0F,0xFB,0x39,0x3C,0x0F,0xFB,0x21,0x3C,0x0F,0xFB,0x31,0x3C,0x0F,
+0xFB,0x2B,0x3C,0x0F,0xFB,0x37,0x3C,0x0F,0xFB,0x2C,0x3C,0x0F,0xFB,0x1A,0x3C,0x0F,
+0xFB,0x20,0x3C,0x0F,0xFB,0x1F,0x3C,0x0F,0xFB,0x1C,0x3C,0x0F,0xFB,0x2D,0x3C,0x0F,
+0xFB,0x33,0x3C,0x0F,0xFB,0x19,0x3C,0x0F,0xFB,0x26,0x3C,0x0F,0xFB,0x30,0x3C,0x0F,
+0xFB,0x22,0x3C,0x0F,0xFB,0x1E,0x3C,0x0F,0xFB,0x27,0x3C,0x0F,0xFB,0x24,0x3C,0x0F,
+0xFB,0x1D,0x64,0x03,0x00,0x03,0x64,0x03,0x04,0x03,0x64,0x12,0x24,0x02,0x96,0x46,
+0xC1,0x03,0x64,0x03,0x00,0x03,0x44,0x00,0x40,0x00,0x64,0x02,0x24,0x03,0x64,0x12,
+0x00,0x02,0x84,0x19,0xFE,0x0E,0x64,0x02,0x00,0x03,0x64,0x00,0x00,0x08,0x64,0x03,
+0x04,0x02,0x46,0x16,0x57,0x80,0x50,0x10,0x80,0x7C,0xFE,0x0F,0x64,0x03,0x04,0x03,
+0x64,0x02,0x00,0x02,0x58,0x00,0x00,0x01,0x64,0x02,0x00,0x03,0xFC,0x80,0x44,0x01,
+0xF6,0x44,0x84,0x21,0xAE,0x40,0x44,0x01,0xF6,0x45,0x44,0x1F,0xFF,0x83,0xAE,0x40,
+0x44,0x01,0xF0,0x58,0x44,0x21,0xF0,0x48,0xA6,0x40,0x44,0x31,0xF0,0x51,0x54,0x10,
+0x80,0xF7,0xAE,0x40,0xA6,0x40,0x44,0x40,0x00,0x55,0x58,0x10,0x80,0x0F,0xAE,0x40,
+0x44,0x51,0xF0,0x55,0x44,0x61,0xF0,0x14,0x44,0x11,0xF0,0x3D,0x44,0x7F,0xFF,0xA5,
+0x85,0x20,0xA6,0x10,0x96,0x00,0xC0,0x0D,0xAF,0x18,0xA6,0x28,0x5C,0xF0,0x00,0xF1,
+0xE9,0xF9,0xA6,0x30,0x96,0x1E,0xC0,0xF6,0xAF,0xC8,0x10,0x90,0x80,0x00,0xD5,0xF2,
+0x44,0x21,0xF0,0x58,0xA6,0x50,0x54,0x10,0x80,0xF7,0xAE,0x50,0x44,0x11,0xF0,0x2E,
+0xAE,0x08,0x44,0x01,0xF0,0x50,0x84,0x2B,0xAE,0x40,0x44,0x01,0xF0,0x51,0x44,0x10,
+0x00,0x55,0xAE,0x40,0xDD,0x9E,0xDD,0x9E,0xFC,0x41,0x44,0x01,0xF0,0x51,0x44,0x10,
+0x00,0x55,0xAE,0x40,0xAE,0x40,0x84,0x00,0x80,0xA0,0x44,0x61,0x81,0x2C,0x44,0x31,
+0xBF,0x50,0x44,0x71,0x81,0x38,0x44,0x40,0x6F,0xC0,0x38,0x13,0x00,0x00,0xF5,0x81,
+0x88,0x23,0x84,0x40,0xB5,0x21,0x8D,0x21,0xE2,0x49,0xE8,0x0F,0x38,0x93,0x80,0x00,
+0x89,0x23,0xB5,0x29,0x89,0x22,0x8C,0x41,0x00,0xA4,0x80,0x00,0x04,0x9F,0x80,0x01,
+0x89,0x2A,0x14,0x9F,0x80,0x01,0xD5,0xEF,0xB4,0x41,0xF1,0x01,0x88,0x22,0xF1,0x81,
+0xF1,0x01,0xFE,0x4A,0xF1,0x81,0x98,0x44,0x94,0x4A,0xF2,0x01,0x8C,0x01,0xB6,0x41,
+0x5A,0x08,0x0A,0xDD,0x44,0x01,0xF0,0x51,0x44,0x10,0x00,0x55,0x84,0x40,0xAE,0x40,
+0x44,0x51,0xBF,0x28,0xF2,0x81,0x44,0x41,0x80,0x00,0x44,0x69,0x03,0x64,0x44,0x79,
+0x03,0x60,0x44,0x31,0xBF,0x34,0x94,0x2A,0x88,0x04,0x98,0x47,0x38,0xA0,0x18,0x02,
+0xF2,0x81,0x50,0x85,0x00,0x01,0x84,0x00,0xE2,0x08,0xE8,0x0C,0xB5,0x21,0x89,0x20,
+0x8C,0x01,0x00,0xF4,0x80,0x00,0x04,0x9F,0x80,0x01,0x89,0x2F,0x14,0x9F,0x80,0x01,
+0xD5,0xF4,0xF0,0x01,0x88,0x0A,0xF0,0x81,0xF0,0x01,0xFE,0x02,0xF0,0x81,0xF0,0x01,
+0xAA,0x29,0xDB,0xE2,0x44,0x01,0xF0,0x51,0x44,0x10,0x00,0x55,0xAE,0x40,0xFC,0xC1,
+0x3A,0x6F,0x9E,0xBC,0x84,0x00,0x80,0x20,0x49,0xFF,0xD8,0xF0,0x84,0x00,0x64,0x05,
+0xE4,0x03,0x44,0x01,0xF6,0x44,0x84,0x21,0xAE,0x40,0x44,0x01,0xF6,0x45,0x44,0x1F,
+0xFF,0x83,0xAE,0x40,0x44,0x01,0xF6,0x18,0x80,0xC0,0xA4,0x40,0x96,0x66,0xC1,0x03,
+0x49,0xFF,0xE5,0xBD,0xA4,0x70,0x44,0x01,0xF6,0x18,0x96,0x66,0x4E,0x13,0x00,0xDC,
+0xA4,0x40,0x96,0x6E,0x4E,0x13,0x00,0xD8,0xA4,0x40,0x96,0x76,0x4E,0x13,0x00,0xD4,
+0xA4,0x40,0x96,0x7E,0x4E,0x13,0x00,0xD0,0xA5,0x80,0x54,0x63,0x02,0x00,0x97,0xB1,
+0x4E,0x63,0x00,0xCA,0xA4,0x00,0x96,0x0E,0xC8,0x11,0x49,0xFF,0xFE,0xAC,0x49,0xFF,
+0xFF,0x5D,0x44,0x11,0x1E,0x60,0x84,0x00,0xAC,0x08,0x44,0x11,0x1E,0x78,0x44,0x71,
+0xB8,0x00,0xAC,0x08,0x44,0x61,0xB8,0x01,0xD5,0x21,0x44,0x01,0x1E,0x50,0xAD,0x80,
+0x3E,0x67,0xEA,0xC0,0x49,0xFF,0xD6,0x88,0x44,0x01,0x27,0xC0,0xAF,0x80,0x44,0x01,
+0x27,0xC1,0xAF,0x80,0x44,0x01,0x27,0xC2,0xAF,0x80,0x44,0x01,0x27,0xC3,0xAF,0x80,
+0x44,0x01,0x27,0xC4,0xAF,0x80,0x44,0x01,0x27,0xC5,0xAF,0x80,0x44,0x01,0x27,0xC6,
+0xAF,0x80,0x44,0x01,0x27,0xC7,0xAF,0x80,0xD5,0xD1,0xA6,0x78,0xA6,0x30,0x88,0x01,
+0x5A,0x00,0xFF,0x05,0x49,0xFF,0xE0,0xCD,0xD5,0xF9,0x84,0x00,0x3C,0x0F,0xFB,0x25,
+0x3C,0x0F,0xFB,0x38,0x3C,0x0F,0xFB,0x32,0x44,0x01,0xBF,0x74,0x44,0x11,0xB8,0x1D,
+0xA6,0x00,0x44,0x51,0xB8,0x00,0x96,0x00,0xAE,0x08,0x44,0x01,0xBF,0x75,0x44,0x11,
+0xB8,0x1E,0xA6,0x00,0x44,0x3F,0x66,0x78,0x96,0x00,0xAE,0x08,0x44,0x01,0xBF,0x76,
+0x44,0x11,0xB8,0x1F,0xA6,0x00,0x96,0x00,0xAE,0x08,0x44,0x01,0xBF,0x77,0x44,0x11,
+0xB8,0x20,0xA6,0x00,0x96,0x00,0xAE,0x08,0x44,0x11,0xB8,0x24,0x98,0xAB,0x08,0x02,
+0x80,0x01,0x96,0x00,0xAE,0x10,0xD9,0xFB,0x44,0x31,0x1E,0x7C,0x44,0x21,0x1E,0x7D,
+0xA6,0x18,0xA6,0x50,0x96,0x02,0x96,0x4A,0xAE,0x58,0xAE,0x10,0x44,0x31,0x1E,0x7E,
+0x44,0x21,0x1E,0x7F,0xA6,0x18,0xA6,0x50,0x96,0x02,0x96,0x4A,0xAE,0x58,0xAE,0x10,
+0x44,0x00,0x00,0xFF,0x49,0xFF,0xD9,0x09,0x49,0xFF,0xD5,0x86,0x5A,0x08,0x02,0x44,
+0xFA,0x3E,0x84,0x41,0x44,0x00,0x04,0xA0,0x49,0xFF,0xD5,0x2C,0x44,0x10,0x00,0xB4,
+0x84,0x41,0x44,0x00,0x29,0xA0,0x49,0xFF,0xD5,0x25,0xFA,0x24,0x84,0x41,0x44,0x00,
+0x33,0xA0,0x49,0xFF,0xD5,0x1F,0x44,0x10,0x00,0xEA,0x84,0x41,0x44,0x00,0x34,0xA0,
+0x49,0xFF,0xD5,0x18,0x44,0x10,0x00,0xFA,0x84,0x41,0x44,0x00,0x36,0xA0,0x49,0xFF,
+0xD5,0x11,0xFA,0x24,0x84,0x41,0x44,0x00,0x37,0xA0,0x49,0xFF,0xD5,0x0B,0x44,0x10,
+0x00,0x71,0x84,0x41,0x44,0x00,0x38,0xA0,0x49,0xFF,0xD5,0x04,0xFA,0x32,0x84,0x41,
+0x44,0x00,0x42,0x90,0x49,0xFF,0xD4,0xFE,0x44,0x10,0x00,0x8E,0x84,0x41,0x44,0x00,
+0x43,0x90,0x49,0xFF,0xD4,0xF7,0x44,0x00,0x44,0x90,0x44,0x10,0x00,0x8E,0x84,0x41,
+0x49,0xFF,0xD4,0xF0,0x44,0x01,0xF4,0xC2,0x84,0x23,0xAE,0x40,0x44,0x01,0xF7,0x30,
+0x84,0x21,0xAE,0x40,0x64,0x00,0x00,0x09,0x49,0xFF,0xDF,0x78,0x3C,0x0F,0xFB,0x0D,
+0x49,0x00,0x01,0xC8,0x3A,0x6F,0x9E,0x84,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x29,
+0xDD,0x9E,0x3C,0x0D,0xFB,0x2A,0x8C,0x01,0x3C,0x0F,0xFB,0x2A,0xDD,0x9E,0x3A,0x6F,
+0x9A,0xBC,0xEF,0xFC,0x3C,0x0D,0xFB,0x36,0x8C,0x01,0x3C,0x0F,0xFB,0x36,0x3C,0x0D,
+0xFB,0x0A,0xA6,0x00,0x5A,0x08,0x01,0x22,0x2E,0x07,0xEA,0xC6,0x5A,0x00,0x55,0x06,
+0x2E,0x07,0xEA,0xBD,0x5A,0x08,0x55,0x10,0x3C,0x03,0xF5,0x7F,0x8C,0x01,0x96,0x01,
+0xE6,0x0A,0x3C,0x0B,0xF5,0x7F,0xE9,0x0A,0x84,0x00,0x49,0xFF,0xC2,0x37,0x49,0xFF,
+0xE4,0x9E,0xD5,0x04,0x84,0x00,0x3C,0x0B,0xF5,0x7F,0x44,0x00,0x00,0x55,0x3E,0x07,
+0xEA,0xC6,0x3E,0x07,0xEA,0xBD,0xD5,0x04,0x84,0x00,0x3C,0x0B,0xF5,0x7F,0xEC,0x04,
+0x3A,0x6F,0x9A,0x84,0xDD,0x9E,0x84,0x01,0x3A,0x6F,0xA0,0xBC,0x49,0xFF,0xD4,0xAE,
+0x44,0x01,0xF6,0x50,0xA6,0x00,0xE6,0x04,0xE8,0x0D,0x49,0xFF,0xC2,0x10,0x49,0xFF,
+0xC2,0x2D,0x3C,0x0D,0xFB,0x0A,0x84,0x22,0x49,0xFF,0xE2,0x9E,0x49,0xFF,0xC2,0x1E,
+0xD5,0x2B,0x44,0x61,0xF6,0x31,0x44,0x71,0xF6,0xF1,0xA6,0x30,0x58,0x00,0x00,0x04,
+0xAE,0x30,0x44,0x00,0x00,0x55,0xAE,0x38,0x44,0x20,0x00,0x00,0x44,0x30,0x00,0x0A,
+0x50,0x21,0x00,0x01,0x4C,0x21,0xFF,0xFE,0x49,0xFF,0xC1,0xF1,0x84,0x00,0xAE,0x38,
+0x44,0x20,0x00,0x00,0x44,0x30,0x00,0x0A,0x50,0x21,0x00,0x01,0x4C,0x21,0xFF,0xFE,
+0xA6,0x30,0x54,0x00,0x00,0xFB,0xAE,0x30,0x49,0xFF,0xC1,0xF8,0x3C,0x0D,0xFB,0x0A,
+0x84,0x22,0x49,0xFF,0xE2,0x71,0x84,0x20,0x84,0x02,0x84,0x46,0x80,0x61,0x80,0x81,
+0x80,0xA1,0x49,0xFF,0xDF,0xAE,0x3A,0x6F,0xA0,0x84,0xDD,0x9E,0x3A,0x6F,0x9A,0xBC,
+0xEF,0xFC,0x49,0xFF,0xD8,0x08,0xC0,0x11,0x84,0x01,0x3C,0x0F,0xFB,0x2F,0x84,0x00,
+0x49,0xFF,0xD8,0x05,0x3C,0x0D,0xFB,0x0A,0x44,0x11,0x81,0xA7,0x3C,0x2D,0xFB,0x15,
+0x3C,0x3D,0xFA,0xF9,0x49,0xFF,0xF8,0xBE,0x49,0xFF,0xD7,0xEC,0xC0,0x07,0x84,0x01,
+0x3C,0x0F,0xFB,0x1B,0x84,0x00,0x49,0xFF,0xD7,0xE9,0xEC,0x04,0x3A,0x6F,0x9A,0x84,
+0xDD,0x9E,0x3A,0x6F,0x9A,0xBC,0xEF,0xFC,0x3C,0x0D,0xFB,0x14,0x84,0x21,0x3C,0x1F,
+0xFB,0x35,0xAE,0x40,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xEA,0xC6,0x2E,0x07,0xEA,0xAB,
+0xC8,0x05,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xE2,0x2F,0x84,0x00,0x3E,0x07,0xEA,0xAB,
+0xEC,0x04,0x3A,0x6F,0x9A,0x84,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x2E,0x44,0x20,
+0x00,0x00,0x44,0x30,0x00,0x4B,0x50,0x21,0x00,0x01,0x4C,0x21,0xFF,0xFE,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x34,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x28,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x23,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x17,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x39,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x21,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x31,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x2B,0xDD,0x9E,
+0x3A,0x6F,0x9E,0xBC,0x84,0x01,0x3C,0x0F,0xFB,0x32,0x84,0x00,0x3C,0x0F,0xFB,0x37,
+0x3C,0x0D,0xFB,0x0A,0xA6,0x41,0x5A,0x10,0x10,0x08,0x9E,0x8A,0xE6,0x43,0xE9,0x04,
+0x9E,0x8E,0xE6,0x43,0xE8,0x2D,0xA6,0x80,0x5A,0x28,0x01,0x2B,0x5A,0x18,0x04,0x06,
+0x2E,0x17,0xEA,0xDC,0x5A,0x10,0x01,0x25,0x2E,0x67,0xEA,0xDD,0x97,0xB0,0xCE,0x20,
+0x3C,0x1D,0xFB,0x14,0xA6,0x48,0x5A,0x18,0x01,0x1C,0x3C,0x1D,0xFA,0xFF,0xA7,0xC8,
+0x97,0xF8,0x5A,0x78,0x01,0x16,0x80,0x26,0x3C,0x6F,0xFB,0x33,0x49,0xFF,0xE1,0xCC,
+0x3C,0x0D,0xFA,0xE3,0x44,0x11,0x82,0xC0,0x49,0xFF,0xC1,0x85,0x80,0x07,0x49,0xFF,
+0xC1,0x35,0x3C,0x0D,0xFB,0x14,0xAF,0x80,0x3C,0x0D,0xFA,0xFF,0xAF,0x80,0x3A,0x6F,
+0x9E,0x84,0xDD,0x9E,0x3C,0x0D,0xFB,0x37,0x8C,0x01,0x3C,0x0F,0xFB,0x37,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x2C,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x1A,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x20,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x1F,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x1C,0xDD,0x9E,0x3B,0xFF,0xFC,0xBC,0xEF,0xFC,0x84,0x01,
+0x3C,0x0F,0xFB,0x2D,0x49,0xFF,0xF6,0x41,0x5A,0x08,0xA1,0x04,0x49,0xFF,0xE3,0x6F,
+0xEC,0x04,0x3B,0xFF,0xFC,0x84,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x24,0x3C,0x0D,
+0xFB,0x33,0x8C,0x01,0x3C,0x0F,0xFB,0x33,0xDD,0x9E,0x3B,0xFF,0xFC,0xBC,0xEF,0xFC,
+0x84,0x01,0x3C,0x0F,0xFB,0x19,0x49,0xFF,0xE3,0x5A,0xEC,0x04,0x3B,0xFF,0xFC,0x84,
+0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x26,0xDD,0x9E,0x3A,0x6F,0x9A,0xBC,0xEF,0xFC,
+0x49,0xFF,0xD7,0x5A,0xC0,0x11,0x84,0x01,0x3C,0x0F,0xFB,0x25,0x84,0x00,0x49,0xFF,
+0xD7,0x57,0x3C,0x0D,0xFB,0x0A,0x44,0x11,0x81,0xA7,0x3C,0x2D,0xFB,0x15,0x3C,0x3D,
+0xFA,0xF9,0x49,0xFF,0xF7,0xCF,0x49,0xFF,0xD7,0x3E,0xC0,0x07,0x84,0x00,0x49,0xFF,
+0xD7,0x3E,0x84,0x01,0x3C,0x0F,0xFB,0x38,0xEC,0x04,0x3A,0x6F,0x9A,0x84,0xDD,0x9E,
+0x84,0x01,0x3C,0x0F,0xFB,0x30,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x22,0xDD,0x9E,
+0x3B,0xFF,0xFC,0xBC,0xEF,0xFC,0x84,0x01,0x3C,0x0F,0xFB,0x1E,0x49,0xFF,0xD2,0xB8,
+0x49,0xFF,0xC0,0xA7,0xC8,0x04,0x49,0xFF,0xC0,0xAA,0xD5,0x03,0x49,0xFF,0xD2,0x76,
+0xEC,0x04,0x3B,0xFF,0xFC,0x84,0xDD,0x9E,0x84,0x01,0x3C,0x0F,0xFB,0x27,0xDD,0x9E,
+0xB4,0x01,0xA6,0x80,0xC2,0x03,0x8C,0x02,0xD5,0x02,0x8C,0x04,0xB6,0x01,0xDD,0x9E,
+0xFC,0x44,0x49,0xFF,0xDF,0xAA,0x49,0xFF,0xF8,0xC3,0x2E,0x00,0x21,0xD9,0x5A,0x00,
+0x01,0x06,0x2E,0x00,0x21,0xDB,0x5A,0x08,0x01,0x19,0x3C,0x0D,0xFB,0x0D,0x9E,0x46,
+0xE6,0x22,0xE9,0x03,0x5A,0x08,0x09,0x12,0x3C,0x0D,0xFB,0x0A,0x44,0x11,0x94,0x5C,
+0x3C,0x2D,0xFB,0x16,0x3C,0x3D,0xFB,0x15,0x3C,0x4D,0xFB,0x09,0x3C,0x5D,0xFA,0xF9,
+0x49,0xFF,0xCF,0x66,0x5A,0x00,0x08,0x4F,0x84,0x00,0x3E,0x07,0xFC,0xD1,0x49,0xFF,
+0xDD,0x3D,0x49,0x00,0x07,0x6A,0x49,0xFF,0xE0,0x33,0x3C,0x0D,0xFB,0x0A,0x84,0x21,
+0xAE,0x41,0x49,0x00,0x09,0x93,0x44,0x00,0x00,0xA0,0x49,0xFF,0xF5,0x99,0x49,0xFF,
+0xC1,0x62,0x44,0x01,0x9B,0xC8,0x49,0xFF,0xE3,0xBC,0x44,0x01,0x82,0xF0,0x3C,0x1D,
+0xFB,0x0A,0x49,0x00,0x06,0xC2,0x44,0x00,0x00,0xA1,0x49,0xFF,0xF5,0x89,0x3C,0x0D,
+0xFB,0x0A,0x44,0x11,0x81,0xA7,0x3C,0x2D,0xFB,0x15,0x3C,0x3D,0xFA,0xF9,0x49,0xFF,
+0xF7,0x49,0x2E,0x07,0xEA,0xBA,0x5A,0x08,0x01,0x0A,0x44,0x01,0x81,0x66,0x44,0x11,
+0x81,0xBE,0x49,0xFF,0xDF,0xDB,0x49,0xFF,0xD6,0xE0,0x3C,0x1D,0xFB,0x14,0x84,0x00,
+0x3E,0x07,0xFD,0xC7,0x84,0x02,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x49,0xFF,
+0xE1,0x5B,0x2E,0x07,0xEA,0xBA,0x5A,0x08,0x01,0x04,0x49,0xFF,0xD6,0xC7,0x49,0xFF,
+0xFB,0x77,0x44,0x61,0xB8,0xBC,0x50,0x73,0x00,0xF0,0x84,0x0A,0x49,0xFF,0xF5,0x62,
+0x49,0xFF,0xDD,0xEF,0x49,0xFF,0xDF,0x75,0x2E,0x00,0x21,0xD9,0x5A,0x00,0x01,0x1A,
+0x2E,0x00,0x21,0xDB,0x5A,0x00,0x01,0x16,0x2E,0x07,0xEA,0xE7,0x5A,0x08,0x01,0x27,
+0x84,0x00,0x3C,0x0F,0xFB,0x25,0x3C,0x1D,0xFB,0x16,0x44,0x01,0x81,0xA7,0x3C,0x2D,
+0xFB,0x15,0x3C,0x3D,0xFB,0x09,0x3C,0x4D,0xFA,0xF9,0x49,0xFF,0xF7,0x49,0xD5,0x16,
+0x3C,0x0D,0xFB,0x0A,0xA6,0x41,0x5A,0x10,0x10,0x0D,0x2E,0x17,0xFD,0xB9,0xC9,0x09,
+0x44,0x11,0x81,0xAA,0x2E,0x20,0x21,0xE3,0x44,0x31,0x94,0x5C,0x49,0xFF,0xCB,0x48,
+0x2E,0x07,0xEA,0xB4,0x5A,0x08,0x01,0xDA,0xD5,0x97,0x3C,0x0D,0xFB,0x25,0x5A,0x08,
+0x01,0x36,0x84,0x00,0x3C,0x0F,0xFB,0x25,0x2E,0x07,0xEA,0xE4,0x5A,0x08,0x55,0x16,
+0x3C,0x0D,0xFA,0xF9,0x3C,0x1D,0xFB,0x0A,0xB6,0x1F,0x44,0x21,0x81,0x7A,0x44,0x01,
+0x82,0xF0,0x3C,0x3D,0xFB,0x16,0x3C,0x4D,0xFB,0x15,0x3C,0x5D,0xFB,0x09,0x49,0xFF,
+0xF5,0x95,0x3E,0x07,0xEA,0xDA,0xD5,0x05,0x44,0x00,0x00,0x55,0x3E,0x07,0xEA,0xE4,
+0x2E,0x07,0xEA,0xDA,0x49,0xFF,0xF7,0xBB,0x96,0x00,0x3E,0x07,0xEA,0xAF,0x5A,0x08,
+0x03,0x04,0x48,0xFF,0xFF,0x4B,0x5A,0x08,0x02,0x0A,0x3C,0x0D,0xFB,0x14,0xA6,0x00,
+0x4E,0x03,0xFF,0x63,0x49,0xFF,0xDD,0x85,0xD5,0xF9,0x3C,0x1D,0xFB,0x14,0xA6,0x08,
+0x5A,0x08,0x02,0x0C,0x3C,0x0D,0xFA,0xFF,0xA6,0x00,0x5A,0x08,0x02,0x07,0x84,0x01,
+0xAE,0x08,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x3C,0x0D,0xFB,0x0A,0xA6,0x01,0x5A,0x00,
+0x0E,0x04,0x49,0xFF,0xE1,0xC7,0x3C,0x0D,0xFA,0xFF,0xA6,0x40,0x96,0x48,0x4E,0x13,
+0xFF,0x76,0x2E,0x07,0xEA,0xBA,0x5A,0x08,0x01,0x06,0x44,0x01,0x81,0x66,0x49,0xFF,
+0xE2,0x29,0x44,0x01,0xA2,0x78,0x44,0x11,0x81,0x9A,0x49,0xFF,0xDE,0x85,0x2E,0x07,
+0xEA,0xDF,0x5A,0x08,0x03,0x0C,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x08,0x49,0xFF,
+0xC3,0x76,0x84,0x02,0x3C,0x1D,0xFA,0xE5,0xD5,0x06,0x49,0xFF,0xD7,0x28,0xF0,0x87,
+0xF1,0x07,0x84,0x00,0x49,0xFF,0xDD,0xB4,0x3C,0x0D,0xFB,0x0A,0xA6,0x41,0x5A,0x18,
+0x10,0x09,0x84,0x23,0xAE,0x41,0x44,0x00,0x00,0xA3,0x49,0xFF,0xF4,0xA1,0xD5,0x1C,
+0x44,0x00,0x00,0xA3,0x49,0xFF,0xF4,0x9C,0x2E,0x00,0x21,0xDD,0x5A,0x08,0x01,0x0F,
+0x3C,0x0D,0xFB,0x0A,0xA6,0x40,0x5A,0x18,0x01,0x0A,0xA6,0x01,0x8E,0x06,0xE6,0x02,
+0xE9,0x05,0x2E,0x07,0xEA,0xBE,0x49,0xFF,0xD7,0x72,0x2E,0x07,0xFD,0xBD,0xC0,0x04,
+0x84,0x00,0x3E,0x07,0xFD,0xBD,0x2E,0x90,0x21,0xDC,0x5A,0x98,0x01,0x09,0x84,0x00,
+0x3E,0x07,0xFD,0xBC,0x49,0xFF,0xC6,0xCE,0x3E,0x97,0xFD,0xBC,0x2E,0x07,0xEA,0xEC,
+0x44,0x11,0xA2,0x34,0x3E,0x00,0x22,0x08,0x44,0x21,0xA9,0x30,0x44,0x01,0xA2,0x78,
+0x44,0x31,0xB8,0x00,0x44,0x41,0xA2,0x4C,0x49,0xFF,0xF0,0x0A,0x2E,0x07,0xEA,0xDA,
+0x5A,0x08,0x04,0x06,0x49,0xFF,0xF3,0xCA,0x48,0x00,0x03,0xAA,0x2E,0x00,0x21,0xDE,
+0x5A,0x08,0x01,0x0A,0x3C,0x0C,0x02,0xEE,0x3C,0x1C,0x02,0xF0,0x3C,0x2C,0x02,0xF3,
+0x49,0xFF,0xF3,0x9F,0x2E,0x17,0xEA,0xBA,0x5A,0x18,0x01,0x06,0x44,0x01,0x81,0x66,
+0x49,0xFF,0xE1,0xB0,0x44,0x01,0xA2,0x34,0xB6,0x1F,0x3C,0x04,0x11,0x0E,0x44,0x11,
+0x81,0x68,0xF0,0x83,0x44,0x01,0xB9,0xC0,0xF0,0x84,0x44,0x21,0x94,0x5C,0x84,0x00,
+0x44,0x31,0xA2,0x4C,0x44,0x41,0x82,0xB4,0x44,0x51,0xA6,0xA0,0xF6,0x81,0xF7,0x82,
+0x49,0xFF,0xD9,0xEB,0x84,0x00,0x44,0x11,0x82,0xB4,0x44,0x21,0xA6,0xA0,0x44,0x31,
+0x82,0xD4,0x44,0x41,0xA7,0x3C,0x49,0xFF,0xD9,0xCE,0x3C,0xF4,0x05,0xBF,0x5E,0xF7,
+0x81,0xF5,0xE9,0x06,0x2E,0x00,0x22,0x08,0x8C,0x01,0x3E,0x00,0x22,0x08,0x49,0xFF,
+0xE1,0x4B,0x49,0xFF,0xDC,0xBA,0x3C,0x0E,0x05,0xA0,0x2E,0x07,0xEA,0xBA,0x5A,0x08,
+0x01,0x07,0x44,0x01,0x81,0x66,0x84,0x22,0x49,0xFF,0xE1,0x74,0x2E,0x00,0x21,0xDC,
+0x5A,0x08,0x01,0x08,0x44,0x01,0xA2,0x4C,0x44,0x11,0xA2,0x1C,0x49,0xFF,0xC5,0x63,
+0x2E,0x00,0x21,0xDF,0x5A,0x08,0x01,0x0C,0x44,0x01,0xAD,0x40,0x44,0x11,0xA2,0x4C,
+0x44,0x21,0x81,0xAA,0x2E,0x37,0xEA,0xCA,0x49,0xFF,0xEF,0x46,0x2E,0x00,0x21,0xE2,
+0x5A,0x08,0x01,0x13,0x2E,0x07,0xFD,0x9E,0xC8,0x0A,0x44,0x01,0xA2,0x78,0x44,0x11,
+0x94,0x5C,0x44,0x21,0xA1,0xEC,0x49,0xFF,0xD7,0x7F,0xD5,0x06,0x84,0x00,0x3E,0x07,
+0xFD,0x9C,0x3E,0x07,0xFD,0x9A,0x3C,0x10,0x05,0xBA,0x3C,0x00,0x11,0x05,0xE6,0x3E,
+0xE9,0x09,0x5C,0xF0,0x80,0x3C,0xE8,0x03,0x92,0x01,0xD5,0x04,0x84,0x23,0x40,0x00,
+0x04,0x17,0x3C,0x08,0x05,0xC6,0x3C,0x0D,0xFB,0x16,0xA6,0x00,0x92,0x04,0x96,0x06,
+0x5A,0x08,0x01,0x08,0x3C,0x0C,0x02,0xF2,0x44,0x11,0xA1,0xEC,0x49,0xFF,0xE7,0x42,
+0x2E,0x00,0x21,0xE2,0x5A,0x08,0x01,0x0A,0x2E,0x07,0xFD,0x9C,0x5A,0x08,0x01,0x06,
+0x44,0x01,0xA2,0x78,0x49,0xFF,0xD8,0x06,0x2E,0x00,0x21,0xDC,0x5A,0x00,0x01,0x06,
+0x2E,0x00,0x21,0xE2,0x5A,0x08,0x01,0x06,0x44,0x01,0xB9,0x78,0x49,0xFF,0xC9,0xAB,
+0x3C,0x0C,0x02,0xF2,0x44,0x11,0xA1,0xEC,0x3C,0x20,0x05,0xC6,0x44,0x31,0x81,0x8C,
+0x49,0xFF,0xAC,0xF6,0x2E,0x00,0x21,0xEC,0x5A,0x08,0x01,0x12,0x3C,0x03,0xFE,0xCE,
+0xC8,0x0E,0x2E,0x07,0xEA,0xDF,0xC8,0x0B,0x3C,0x0C,0x02,0xF2,0x44,0x11,0xA1,0xEC,
+0x3C,0x20,0x05,0xC6,0x44,0x31,0x81,0x8C,0x49,0xFF,0xF8,0xB2,0x2E,0x00,0x21,0xE1,
+0x5A,0x08,0x01,0x1D,0x3C,0x0D,0xFB,0x16,0xA6,0x00,0x96,0x06,0x5A,0x00,0x01,0x08,
+0x3C,0x0D,0xFB,0x09,0xA6,0x00,0x96,0x06,0x5A,0x08,0x01,0x11,0x2E,0x07,0xFD,0x9A,
+0xE6,0x0A,0xE8,0x0C,0x44,0x01,0xA1,0xEC,0x44,0x11,0xA2,0x78,0x44,0x21,0x81,0x8C,
+0x49,0xFF,0xDA,0x6D,0x3E,0x07,0xFD,0x9E,0xD5,0x06,0x84,0x00,0x3E,0x07,0xFD,0x9E,
+0x49,0xFF,0xD9,0xE4,0x2E,0x37,0xEA,0xCC,0x3C,0x4C,0x02,0xCC,0x3C,0x5C,0x02,0xCE,
+0x3C,0x90,0x07,0xF1,0x2E,0x17,0xEA,0xE2,0x84,0x00,0xE2,0x03,0xE8,0x13,0x38,0x22,
+0x01,0x01,0x4C,0x20,0x40,0x0E,0x38,0x22,0x81,0x01,0xE3,0x22,0xE8,0x09,0x5C,0xF1,
+0x00,0x5A,0xE8,0x06,0x5C,0xF0,0x80,0xFA,0xE8,0x03,0x8C,0x21,0x96,0x48,0x8C,0x01,
+0xD5,0xED,0x3C,0x0F,0xFB,0x3C,0x3E,0x17,0xEA,0xE2,0x3C,0x00,0x05,0xC6,0x3C,0x14,
+0x05,0xBF,0xE0,0x20,0xE8,0x0F,0x84,0x00,0x3E,0x07,0xEA,0xE2,0x2E,0x07,0xFD,0x9E,
+0x5A,0x08,0x01,0x06,0x49,0xFF,0xD9,0xA6,0x3E,0x07,0xFD,0x9E,0x84,0x00,0x3E,0x07,
+0xEA,0xCC,0x2E,0x07,0xEA,0xBA,0x5A,0x08,0x01,0x07,0x44,0x01,0x81,0x66,0x84,0x23,
+0x49,0xFF,0xE0,0x90,0x2E,0x00,0x21,0xE3,0x5A,0x08,0x01,0x35,0x3C,0x0D,0xFB,0x16,
+0x3C,0x1D,0xFB,0x09,0xA6,0x00,0x92,0x01,0x96,0x06,0x5A,0x00,0x01,0x07,0xA6,0x08,
+0x92,0x01,0x96,0x06,0x5A,0x08,0x01,0x27,0xA6,0x08,0x92,0x03,0x96,0x06,0xC8,0x22,
+0x2E,0x07,0xFD,0xBB,0x3C,0x1D,0xFB,0x0A,0x49,0xFF,0xE4,0x41,0x3C,0x0D,0xFB,0x0A,
+0xA6,0x01,0x5A,0x00,0x03,0x04,0x5A,0x08,0x06,0x12,0x2E,0x07,0xEA,0xA7,0xC0,0x0E,
+0x3C,0x1C,0x02,0xF2,0x44,0x21,0xA1,0xEC,0x44,0x31,0x81,0x8C,0x3C,0x40,0x05,0xC6,
+0x44,0x01,0xA2,0x78,0x49,0xFF,0xE4,0x45,0xD5,0x03,0x49,0xFF,0xE3,0xFF,0x3E,0x07,
+0xFD,0x9D,0x2E,0x07,0xFD,0x9E,0xC8,0x11,0x2E,0x17,0xFD,0x9D,0x3C,0x0C,0x02,0xF2,
+0xC1,0x04,0x3C,0x20,0x11,0x7A,0xD5,0x03,0x3C,0x20,0x05,0xC6,0x44,0x11,0xA1,0xEC,
+0x44,0x31,0x81,0x8C,0x49,0xFF,0xAC,0xA7,0x84,0x00,0x3C,0x0F,0xFB,0x3E,0x3C,0x0D,
+0xFB,0x3E,0x2E,0x27,0xEA,0xCC,0xE2,0x02,0xE8,0x1D,0x3C,0x2C,0x02,0xCC,0x94,0x41,
+0x38,0x51,0x01,0x01,0xD8,0x13,0x3C,0x2C,0x02,0xCF,0x3C,0x0C,0x02,0xF2,0x88,0x41,
+0xA6,0x51,0xA6,0x90,0x49,0xFF,0xF7,0x74,0x3C,0x1D,0xFB,0x3E,0x3C,0x2C,0x02,0xCC,
+0x94,0x49,0x88,0x22,0xA4,0x88,0xFE,0x17,0xAC,0x08,0x3C,0x0D,0xFB,0x3E,0x8C,0x01,
+0xD5,0xDD,0xCA,0x04,0x3E,0x27,0xEA,0xEA,0xD5,0x0B,0x44,0x01,0xA1,0xEC,0x3C,0x1C,
+0x02,0xF2,0x44,0x31,0xA4,0xA4,0x44,0x41,0x81,0xAA,0x49,0xFF,0xBC,0xD1,0x2E,0x17,
+0xEA,0xEA,0xC1,0x2B,0x2E,0x30,0x21,0x72,0x2E,0x40,0x21,0x73,0x92,0x61,0x92,0x81,
+0x44,0x01,0xA4,0xA4,0x84,0x40,0xE2,0x41,0xE8,0x0B,0xA5,0x40,0x8C,0x41,0x88,0xA3,
+0xAD,0x40,0xA5,0x41,0x8C,0x18,0x88,0xA4,0x12,0x50,0x7F,0xF5,0xD5,0xF5,0x2E,0x00,
+0x21,0xE5,0x3C,0x2F,0xFB,0x3C,0x5A,0x08,0x01,0x09,0x2E,0x00,0x0A,0xA8,0xC8,0x05,
+0x44,0x01,0xA4,0xA4,0x49,0xFF,0xBA,0xCB,0x84,0x00,0x3C,0x0F,0xFF,0x6A,0x3C,0x0F,
+0xFF,0x6B,0x3E,0x07,0xEA,0xBB,0xD5,0x34,0x2E,0x07,0xFD,0x9E,0xC8,0x31,0x3E,0x07,
+0xEA,0xCC,0x3E,0x07,0xEA,0xEA,0x3C,0x0F,0xFF,0x6D,0x3C,0x0D,0xFF,0x6A,0x44,0x10,
+0xEA,0x60,0xE2,0x20,0xE9,0x04,0x8C,0x01,0x3C,0x0F,0xFF,0x6A,0x3C,0x0D,0xFF,0x6B,
+0x44,0x10,0xEA,0x60,0xE2,0x20,0xE9,0x0F,0x3C,0xF7,0xFE,0x0A,0x5E,0xF7,0x83,0xE9,
+0xE9,0x04,0x2E,0x17,0xFC,0x18,0xC1,0x05,0x8C,0x01,0x3C,0x0F,0xFF,0x6B,0xD5,0x03,
+0x3C,0x1F,0xFF,0x6B,0x2E,0x07,0xEA,0xAE,0x5A,0x08,0x01,0x08,0x3E,0x07,0xEA,0xC5,
+0x84,0x00,0x3C,0x0F,0xFF,0x6A,0xD5,0x04,0x84,0x00,0x3E,0x07,0xEA,0xC5,0x2E,0x07,
+0xEA,0xCE,0xC8,0x45,0x2E,0x07,0xFD,0x9E,0xC8,0x22,0x2E,0x07,0xEA,0xEA,0xC8,0x1F,
+0x2E,0x07,0xEA,0xEB,0xC8,0x1C,0x2E,0x07,0xFC,0x18,0x5A,0x08,0x01,0x0B,0x3C,0x0D,
+0xFF,0x6B,0x5C,0xF0,0x00,0xC8,0xE9,0x05,0x84,0x01,0x3E,0x07,0xEA,0xEB,0xD5,0x0F,
+0x49,0xFF,0xD8,0x6C,0x5A,0x00,0x02,0xFA,0x44,0x01,0xA9,0x30,0x3C,0x10,0x11,0x17,
+0x44,0x21,0x81,0x7B,0x49,0xFF,0xEC,0xB8,0x5A,0x00,0x02,0xF0,0x2E,0x07,0xEA,0xEB,
+0x5A,0x00,0x01,0x06,0x2E,0x07,0xFD,0xC5,0x5A,0x08,0x01,0x1A,0x3C,0x0D,0xFB,0x0A,
+0xA6,0x01,0x5A,0x00,0x03,0x0E,0x5A,0x00,0x06,0x0C,0x84,0x00,0x3E,0x07,0xEA,0xEB,
+0x3E,0x07,0xFD,0xC5,0x84,0x01,0x3E,0x07,0xFD,0xC6,0x48,0xFF,0xFC,0x86,0x3C,0x0D,
+0xFB,0x14,0xA6,0x00,0xC8,0xF3,0x49,0xFF,0xDA,0xA4,0xD5,0xFA,0x2E,0x07,0xFD,0x9E,
+0x5A,0x08,0x01,0x07,0x84,0x00,0x3C,0x0F,0xFF,0x6A,0x3C,0x0F,0xFF,0x6B,0x2E,0x00,
+0x21,0xDC,0x5A,0x08,0x01,0x0A,0x44,0x01,0xBB,0x8C,0x50,0x10,0x00,0x30,0x50,0x20,
+0x00,0x58,0x49,0xFF,0xC3,0xC8,0x2E,0x07,0xFD,0x9D,0x2E,0x17,0xEA,0xEA,0xC8,0x0E,
+0xE6,0x22,0xE9,0x08,0x2E,0x07,0xEA,0xD0,0x5A,0x08,0x01,0x05,0x3C,0x00,0x05,0xC6,
+0xD5,0x03,0x44,0x00,0x00,0x64,0x3C,0x08,0x12,0x63,0x2E,0x37,0xEA,0xEC,0x2E,0x00,
+0x22,0x08,0x3C,0x20,0x12,0x63,0x8A,0x03,0x40,0x01,0x00,0x0E,0x3C,0x08,0x12,0x63,
+0x44,0x21,0xA9,0x88,0x44,0x01,0xA4,0xA4,0x44,0x31,0xA1,0xEC,0x84,0x80,0x49,0xFF,
+0xAD,0x01,0x44,0x01,0xA9,0x88,0x49,0xFF,0xAB,0xD7,0x2E,0x07,0xEA,0xBA,0x5A,0x08,
+0x01,0x07,0x44,0x01,0x81,0x66,0x84,0x24,0x49,0xFF,0xDF,0x24,0x2E,0x00,0x21,0xEB,
+0x5A,0x08,0x01,0x0B,0x44,0x01,0xA9,0x88,0x44,0x11,0xA1,0xEC,0x3C,0x2C,0x02,0xF2,
+0x49,0xFF,0xF5,0x6D,0xD5,0x12,0x2E,0x20,0x21,0x49,0x44,0x01,0xA9,0x88,0x84,0x20,
+0xE2,0x22,0xE8,0x0B,0xB4,0x60,0xC3,0x05,0xA4,0xC2,0xAC,0xC6,0xA4,0xC3,0xAC,0xC7,
+0x8C,0x21,0x50,0x00,0x00,0x5C,0xD5,0xF5,0x84,0x00,0x3C,0x0F,0xFB,0x3C,0x2E,0x30,
+0x21,0x49,0x3C,0x4C,0x02,0xCD,0x44,0x11,0xA9,0x9C,0x84,0xA1,0x44,0x90,0x00,0xFF,
+0xE2,0x03,0xE8,0x11,0x04,0x20,0xFF,0xFB,0xC2,0x0A,0xA0,0x8A,0x38,0x22,0x09,0x01,
+0xAD,0x49,0x5C,0xF1,0x01,0x00,0x40,0x24,0xBC,0x1A,0xAC,0x88,0x8C,0x01,0x50,0x10,
+0x80,0x5C,0xD5,0xEF,0x3C,0x0F,0xFB,0x3C,0x44,0x01,0xA9,0x88,0x49,0xFF,0xAC,0x93,
+0x44,0x01,0xA9,0x88,0x49,0xFF,0xB9,0x02,0x2E,0x00,0x21,0xDB,0x5A,0x08,0x01,0x40,
+0x2E,0x07,0xFD,0xB9,0x5A,0x08,0x01,0x3C,0x44,0x01,0x94,0x5C,0x49,0xFF,0xD6,0x46,
+0xC8,0x36,0x84,0x02,0x3E,0x07,0xFC,0xD1,0x49,0xFF,0xD9,0x00,0x44,0x01,0xA1,0xEC,
+0x44,0x11,0xA9,0x88,0x2E,0x27,0xEA,0xEA,0x44,0x31,0x82,0xD8,0x49,0x00,0x01,0x0C,
+0x49,0xFF,0xD6,0x8E,0x5A,0x08,0x01,0x19,0x44,0x01,0x94,0x5C,0x49,0xFF,0xE0,0x3B,
+0xD5,0x13,0x49,0xFF,0xD9,0xEE,0x2E,0x07,0xEA,0xBA,0x5A,0x08,0x01,0x06,0x44,0x01,
+0x81,0xC6,0x49,0xFF,0xDE,0xA0,0x84,0x01,0x84,0x40,0x80,0x20,0x80,0x62,0x80,0x80,
+0x80,0xA2,0x49,0xFF,0xD9,0xE6,0x3C,0x0D,0xFB,0x35,0xC0,0xEC,0x84,0x40,0x84,0x01,
+0x84,0x2A,0x80,0x62,0x80,0x80,0x80,0xA2,0x49,0xFF,0xD9,0xDB,0x3C,0x0D,0xFB,0x16,
+0xA6,0x00,0x92,0x04,0x96,0x06,0x5A,0x00,0x01,0x0B,0x84,0x00,0x3C,0x0F,0xFB,0x3C,
+0x3C,0x3D,0xFB,0x16,0x44,0x11,0xA9,0x88,0x80,0x80,0xD5,0x27,0x44,0x01,0xA9,0x88,
+0x44,0x11,0xA1,0xEC,0x49,0xFF,0xE5,0x65,0x44,0x01,0xA9,0x88,0x44,0x11,0xA1,0xEC,
+0x3C,0x2C,0x02,0xF2,0x49,0xFF,0xE7,0xB4,0x84,0x00,0x44,0x11,0xA9,0xBD,0x80,0x60,
+0x5A,0x00,0x0A,0xE5,0x00,0x20,0x80,0x24,0xC2,0x03,0x5A,0x28,0x11,0x03,0xAE,0xC8,
+0x8C,0x01,0x50,0x10,0x80,0x5C,0xD5,0xF5,0xA6,0x98,0x92,0x44,0x96,0x86,0x5A,0x20,
+0x01,0x08,0x8C,0x01,0x50,0x10,0x80,0x5C,0x5A,0x08,0x0A,0xF8,0xD5,0x09,0x04,0x20,
+0x80,0x14,0x5A,0x20,0x01,0xF8,0xB4,0x41,0xC2,0xF5,0xB6,0x81,0xD5,0xF3,0x3C,0x0F,
+0xFB,0x3C,0x3C,0x0D,0xFB,0x0A,0xA6,0x01,0x5A,0x00,0x03,0x40,0x49,0xFF,0xB0,0x8E,
+0xE6,0x03,0xE8,0x3B,0x84,0x00,0x3E,0x07,0xEC,0x3C,0x3E,0x07,0xEC,0x3D,0x3E,0x07,
+0xEC,0x3E,0x3C,0x0C,0x05,0xA0,0x3C,0x0E,0x05,0xA1,0x2E,0x07,0xEA,0xEA,0x3E,0x07,
+0xFD,0x99,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x1D,0x84,0x00,0x3E,0x07,0xEA,0xD9,
+0x3C,0x0D,0xFB,0x0A,0xA6,0x01,0x5A,0x00,0x06,0x0F,0x2E,0x07,0xEA,0xE0,0xC8,0x0B,
+0x49,0xFF,0xBD,0xA7,0x49,0xFF,0xBE,0x49,0x3C,0x0D,0xFB,0x10,0x49,0xFF,0xC3,0xB9,
+0x49,0xFF,0xC5,0xD0,0x2E,0x07,0xEA,0xE0,0xC0,0x04,0x8E,0x01,0x3E,0x07,0xEA,0xE0,
+0x2E,0x07,0xEA,0xDA,0x5A,0x08,0x05,0x04,0x48,0xFF,0xFC,0x56,0x3C,0x0D,0xFA,0xFF,
+0x84,0x21,0xAE,0x40,0x48,0xFF,0xFB,0x5B,0x3C,0x0D,0xFB,0x38,0x5A,0x08,0x01,0x09,
+0x84,0x00,0x3C,0x0F,0xFB,0x38,0x44,0x01,0x82,0xF8,0x49,0xFF,0xB0,0x32,0x44,0x11,
+0x83,0x0C,0x44,0x01,0xA4,0x04,0x49,0xFF,0xB2,0xEF,0x3E,0x07,0xEC,0x3E,0x49,0xFF,
+0xB0,0x40,0x81,0x20,0x5A,0x08,0x01,0x11,0x49,0xFF,0xB0,0x38,0x5A,0x08,0x03,0x05,
+0x80,0x09,0x49,0xFF,0xB0,0x30,0x49,0xFF,0xB0,0x31,0x5A,0x08,0x04,0xAC,0x84,0x01,
+0x49,0xFF,0xB0,0x29,0xD5,0xA7,0x49,0xFF,0xB0,0x29,0x5A,0x08,0x03,0xA4,0x84,0x00,
+0x3C,0x0F,0xFF,0x6A,0x3E,0x07,0xEA,0x9D,0xD5,0x9D,0x00,0x00,0x80,0x60,0x99,0x5A,
+0xD3,0x04,0x18,0x11,0x80,0x01,0xD5,0xFD,0xDD,0x9E,0x92,0x00,0x02,0x14,0x15,0x14,
+0x13,0x02,0x13,0x15,0x08,0x00,0x00,0x00,0x04,0x04,0x04,0x04,0x06,0x08,0x06,0x01,
+0x08,0x21,0x05,0x06,0x06,0x04,0x07,0x01,0x04,0x04,0x06,0x01,0x04,0x22,0x06,0x04,
+0x04,0x05,0x06,0x06,0x01,0x01,0x08,0x06,0x06,0x05,0x06,0x07,0x01,0x04,0x22,0x04,
+0x04,0x01,0x22,0x06,0x04,0x05,0x01,0x05,0x07,0x01,0x04,0x00,0x00,0x01,0x00,0x02,
+0x01,0x03,0x02,0x03,0xA4,0xC0,0x44,0x21,0xA1,0x48,0x44,0x11,0x00,0x00,0xFE,0xCF,
+0xB6,0x62,0xA4,0xC1,0xFE,0xCF,0xA8,0xD2,0xA4,0xC2,0xFE,0xCF,0xA8,0xD1,0xA4,0xC3,
+0xFE,0xCF,0xA8,0xD3,0xA4,0x03,0xFE,0x47,0xA8,0x57,0xDD,0x9E,0xFC,0x00,0x44,0x01,
+0x48,0x00,0x49,0xFF,0xFF,0xE9,0x3C,0x0C,0x02,0xA2,0x84,0x23,0x3C,0x0F,0xFA,0xD5,
+0x44,0x01,0xF4,0x54,0xAE,0x40,0x44,0x11,0xF4,0x4E,0x84,0x01,0xAE,0x08,0x44,0x11,
+0xF4,0x4F,0xAE,0x08,0x44,0x01,0xF4,0x4D,0x84,0x20,0xAE,0x40,0x44,0x01,0xF4,0x50,
+0x84,0x24,0xAE,0x40,0x49,0xFF,0xBB,0x43,0x49,0xFF,0xBB,0x4D,0x49,0xFF,0xC1,0xAB,
+0x49,0xFF,0xC1,0x8E,0xFC,0x80,0xFC,0x00,0x44,0x01,0xF4,0x11,0x84,0x43,0xAE,0x80,
+0x44,0x01,0xF4,0x0D,0x84,0x62,0xAE,0xC0,0x44,0x01,0xF4,0x29,0x84,0x9F,0xAE,0x80,
+0x44,0x01,0xF4,0x25,0xFA,0xB0,0xAE,0xC0,0x44,0x01,0xF4,0x37,0x44,0x11,0xF4,0x0A,
+0xAE,0x80,0x44,0x01,0xF4,0x33,0x44,0x61,0xF4,0x16,0xAE,0xC0,0x44,0x01,0xF4,0x0B,
+0xAF,0x00,0x44,0x01,0xF4,0x0F,0xAF,0x40,0x84,0x01,0xAE,0x08,0x44,0x11,0xF4,0x12,
+0xAE,0x08,0x44,0x11,0xF4,0x13,0xAE,0x08,0x44,0x11,0xF4,0x14,0xAE,0x08,0x44,0x11,
+0xF4,0x15,0xAE,0x08,0x84,0x20,0xAE,0x70,0x44,0x61,0xF4,0x17,0xAE,0x70,0x44,0x61,
+0xF4,0x18,0xAE,0x30,0x44,0x61,0xF4,0x19,0xAE,0x30,0x44,0x61,0xF4,0x1A,0xAE,0x30,
+0x44,0x61,0xF4,0x1B,0xAE,0x30,0x44,0x61,0xF4,0x1C,0xAE,0x30,0x44,0x61,0xF4,0x1D,
+0xAE,0x30,0x44,0x61,0xF4,0x1E,0xAE,0x30,0x44,0x61,0xF4,0x1F,0xAE,0x30,0x44,0x61,
+0xF4,0x20,0xAE,0x30,0x44,0x61,0xF4,0x21,0xAE,0x30,0x44,0x61,0xF4,0x23,0xAF,0x30,
+0x44,0x61,0xF4,0x27,0xAF,0x70,0x44,0x61,0xF4,0x22,0xAE,0x30,0x44,0x61,0xF4,0x2A,
+0xAE,0x30,0x44,0x61,0xF4,0x2B,0xAE,0x70,0x44,0x61,0xF4,0x2C,0xAE,0x30,0x44,0x61,
+0xF4,0x2D,0xAE,0x30,0x44,0x61,0xF4,0x2E,0xAE,0x70,0x44,0x61,0xF4,0x2F,0xAE,0x70,
+0x44,0x61,0xF4,0x31,0xAF,0x30,0x44,0x61,0xF4,0x35,0xAF,0x70,0x44,0x51,0xF4,0x30,
+0x44,0x61,0xF4,0x0E,0xAE,0x28,0x44,0x51,0xF4,0x38,0xAE,0x28,0x44,0x51,0xF4,0x39,
+0xAE,0x28,0x44,0x51,0xF4,0x3A,0xAE,0x28,0x44,0x51,0xF4,0x3B,0xAE,0x28,0x44,0x51,
+0xF4,0x3C,0xAE,0x68,0x44,0x51,0xF4,0x3D,0xAE,0x68,0x44,0x51,0xF4,0x0C,0xAF,0x28,
+0xFA,0xB1,0xAF,0x70,0x44,0x61,0xF4,0x10,0xAE,0x30,0x44,0x61,0xF4,0x24,0xAF,0x30,
+0x44,0x61,0xF4,0x26,0xAF,0x70,0x44,0x61,0xF4,0x28,0xAE,0x30,0x44,0x61,0xF4,0x32,
+0xAF,0x30,0x44,0x41,0xF4,0x34,0xAF,0x60,0x44,0x41,0xF4,0x36,0x84,0xA6,0xAE,0x20,
+0x44,0x41,0xF6,0xDD,0xAE,0xE0,0x44,0x41,0xF6,0xD4,0xAF,0x60,0x44,0x41,0xF5,0xFA,
+0xFA,0xB4,0xAE,0x60,0x44,0x41,0xF5,0xFB,0xAE,0x60,0x44,0x41,0xF5,0xFC,0xAE,0x20,
+0x44,0x41,0xF5,0xFD,0xAE,0x60,0x44,0x41,0xF5,0xFE,0xAE,0x60,0x44,0x41,0xF5,0xF8,
+0xAF,0x60,0x44,0x41,0xF5,0xF9,0xFA,0xAB,0xAF,0x60,0x44,0x41,0xF4,0x71,0xAE,0x20,
+0x44,0x41,0xF4,0x72,0xAE,0xA0,0x44,0x41,0xF4,0x73,0xAE,0xA0,0x44,0x41,0xF5,0xF5,
+0xAE,0x60,0x44,0x41,0xF4,0x74,0xAE,0xA0,0x44,0x41,0xF4,0x75,0xAE,0xA0,0x44,0x41,
+0xF4,0x76,0xAE,0xA0,0x44,0x41,0xF4,0x77,0xAE,0xA0,0x44,0x21,0xF5,0xF6,0xAE,0x50,
+0x44,0x21,0xF5,0xF7,0xAE,0x50,0x44,0x11,0xF4,0x78,0xAE,0x08,0x44,0x11,0xF4,0x6A,
+0x84,0x0E,0xAE,0x08,0x44,0x11,0xF4,0x6B,0xAE,0xC8,0x44,0x11,0xF4,0x6C,0xAE,0x08,
+0x44,0x01,0xF4,0x6D,0x44,0x11,0xF6,0x06,0xAE,0xC0,0x84,0x18,0xAE,0x08,0x44,0x11,
+0xF6,0x08,0xAE,0x08,0x44,0x11,0xF6,0x0A,0xAE,0x08,0x44,0x01,0xF6,0x04,0xFA,0x3A,
+0xAE,0x40,0x84,0x00,0x80,0x20,0x80,0x40,0x80,0x60,0x49,0xFF,0xD7,0xF8,0xFC,0x80,
+0xFC,0x00,0x84,0x07,0x49,0xFF,0xD0,0x67,0x44,0x01,0xF0,0x54,0x84,0x20,0xAE,0x40,
+0x84,0x07,0x49,0xFF,0xD0,0x69,0x44,0x01,0xF0,0x56,0x84,0x21,0xAE,0x40,0xFC,0x80,
+0xFC,0x00,0x84,0x00,0x49,0xFF,0xD0,0x77,0x44,0x01,0x0E,0x70,0x3C,0x0F,0xFA,0xD7,
+0x44,0x01,0x14,0xA0,0x3C,0x0F,0xFA,0xD1,0x44,0x01,0x1A,0xD8,0x3C,0x0F,0xFA,0xD9,
+0x44,0x01,0x82,0xB4,0x84,0x41,0x84,0x20,0xAE,0x80,0xAE,0x81,0xAE,0x42,0xAE,0x43,
+0xAE,0x44,0xAE,0x85,0xAE,0x46,0x44,0x01,0xA6,0xA0,0x44,0x30,0x00,0x5F,0xAC,0xC1,
+0xAC,0xC2,0x44,0x30,0x00,0x64,0x12,0x30,0x00,0x08,0x44,0x30,0x00,0x78,0xAC,0xC6,
+0x84,0x8A,0xFA,0x64,0x10,0x20,0x00,0x0E,0xAE,0x86,0xAC,0xC4,0x10,0x10,0x00,0x0B,
+0x10,0x40,0x00,0x0A,0x10,0x30,0x00,0x12,0x12,0x30,0x00,0x0A,0x44,0x01,0x82,0xD4,
+0xAE,0x80,0xAE,0x41,0xFC,0x80,0xFC,0x20,0x3C,0x0D,0xFB,0x0D,0x80,0xC1,0x5A,0x08,
+0x04,0x1F,0x2E,0x00,0x21,0xDB,0xC0,0x1B,0x44,0x01,0xF6,0x71,0xA6,0x00,0x96,0x0F,
+0x5A,0x08,0x03,0x1E,0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x49,0xFF,0xDA,0x15,0xD5,0x14,
+0x2E,0x77,0xEA,0xC0,0xCF,0xF2,0x84,0x01,0x49,0xFF,0xEE,0xBC,0x84,0x61,0x84,0x02,
+0x80,0x27,0x80,0x47,0x80,0x83,0x80,0xA3,0x49,0xFF,0xD7,0x4B,0x49,0xFF,0xCC,0x44,
+0x5A,0x08,0x02,0xF0,0xD5,0xE2,0x49,0xFF,0xCF,0xF0,0xD5,0xFE,0x84,0x02,0x49,0xFF,
+0xEE,0xA9,0x84,0x03,0x49,0xFF,0xEE,0xA6,0x3C,0x0D,0xFB,0x0D,0x5A,0x08,0x04,0x1D,
+0x49,0xFF,0xCC,0x32,0x5A,0x00,0x02,0x19,0x2E,0x70,0x21,0xDB,0x5A,0x78,0x01,0x15,
+0x80,0x07,0x49,0xFF,0xCC,0x91,0x84,0x00,0x49,0xFF,0xB9,0x58,0x80,0x07,0x49,0xFF,
+0xCB,0xE5,0xD5,0x0A,0x49,0xFF,0xCC,0x8C,0x5A,0x08,0x01,0x0A,0x84,0x04,0x49,0xFF,
+0xEE,0x89,0x49,0xFF,0xCF,0xCA,0x3C,0x0D,0xFB,0x27,0xC0,0xF5,0x84,0x05,0x49,0xFF,
+0xEE,0x81,0x84,0x06,0x49,0xFF,0xEE,0x7E,0x3C,0x0D,0xFB,0x0D,0x5A,0x08,0x04,0x06,
+0x49,0xFF,0xCC,0x0A,0x5A,0x08,0x02,0x07,0x2E,0x07,0xEA,0xC0,0x5A,0x08,0x01,0x1A,
+0xD5,0x05,0x2E,0x00,0x21,0xDB,0x5A,0x08,0x01,0xF9,0x49,0xFF,0xD8,0x66,0x84,0x00,
+0x49,0xFF,0xCB,0xBC,0x49,0xFF,0xCB,0xF8,0x80,0x20,0xC0,0x04,0x49,0xFF,0xCF,0xA5,
+0xD5,0xFA,0x3C,0x0D,0xFB,0x0A,0x49,0xFF,0xD9,0xAF,0x84,0x02,0xAE,0x31,0xD5,0x13,
+0x80,0x46,0x84,0x05,0x84,0x20,0x49,0xFF,0xC6,0xA1,0x3C,0x0D,0xFB,0x0A,0x84,0x20,
+0x49,0xFF,0xD9,0xA2,0x84,0x02,0xAE,0x31,0x84,0x01,0x49,0xFF,0xCE,0x2C,0x84,0x07,
+0x49,0xFF,0xEE,0x48,0xFC,0xA0,0xFC,0x40,0x2E,0x30,0x21,0x42,0x2E,0x10,0x21,0x72,
+0x2E,0x20,0x21,0x43,0x42,0x00,0x8C,0x24,0x3C,0x08,0x10,0xA9,0x2E,0x00,0x21,0x73,
+0x92,0x21,0x42,0x40,0x08,0x24,0x92,0x01,0x3E,0x00,0x21,0x7A,0x2E,0x00,0x21,0xD8,
+0x3C,0x48,0x10,0xAA,0x3E,0x10,0x21,0x79,0x3E,0x30,0x21,0x4F,0x3E,0x20,0x21,0x50,
+0xC8,0x0A,0x3E,0x00,0x21,0x4A,0x44,0x51,0xB8,0x00,0x44,0x3F,0x66,0x78,0x44,0x11,
+0xB8,0x24,0xD5,0x06,0x2E,0x00,0x21,0x4A,0xC8,0xF7,0x84,0x01,0xD5,0xF3,0x98,0xAB,
+0x08,0x02,0x80,0x01,0x96,0x02,0xAE,0x10,0xD9,0xFB,0x44,0x31,0x1E,0x7C,0x44,0x21,
+0x1E,0x7D,0xA6,0x18,0xA6,0x50,0x96,0x02,0x96,0x4A,0xAE,0x58,0xAE,0x10,0x44,0x31,
+0x1E,0x7E,0x44,0x21,0x1E,0x7F,0xA6,0x18,0xA6,0x50,0x96,0x02,0x96,0x4A,0xAE,0x58,
+0xAE,0x10,0x2E,0x10,0x21,0x43,0x2E,0x00,0x21,0x42,0x44,0x21,0x27,0xCE,0xFE,0x0C,
+0x3C,0x1C,0x02,0xA2,0x44,0x51,0x1E,0x5C,0x3C,0x1F,0xFB,0x00,0x44,0x41,0x27,0xCC,
+0x44,0x11,0x1E,0x5E,0x3C,0x08,0x10,0xBA,0x44,0x31,0x27,0xC8,0x84,0x00,0x3C,0x0F,
+0xFB,0x0C,0xAC,0x28,0xAC,0x08,0xAC,0x20,0xAC,0x10,0x3C,0x3F,0xFB,0x14,0x44,0x31,
+0x27,0xC9,0x3E,0x07,0xEA,0xCE,0x3C,0x3F,0xFA,0xFF,0x44,0x31,0x27,0xCA,0x3C,0x3F,
+0xFB,0x0A,0xA6,0xC8,0x3C,0x1F,0xFB,0x16,0x58,0x31,0x80,0x02,0x3C,0x2F,0xFB,0x09,
+0x3C,0x5F,0xFB,0x15,0x3C,0x4F,0xFA,0xF9,0xAE,0xC8,0xA6,0xC8,0x58,0x31,0x80,0x01,
+0xAE,0xC8,0xA6,0xC8,0x54,0x31,0x80,0xDF,0xAE,0xC8,0xA6,0xC8,0x58,0x31,0x80,0x10,
+0xAE,0xC8,0xA7,0x88,0x84,0x7B,0xFF,0x9E,0xAF,0x88,0xA6,0x48,0xAE,0x68,0xA6,0x50,
+0x58,0x10,0x80,0x02,0xAE,0x50,0xA6,0x50,0x58,0x10,0x80,0x01,0xAE,0x50,0xA6,0x50,
+0xFE,0xCE,0xAE,0xD0,0xA6,0x50,0x80,0x40,0xAE,0x60,0x84,0x21,0x3C,0x1F,0xFF,0x69,
+0x2E,0x10,0x22,0x08,0x3E,0x07,0xEA,0xE7,0x3E,0x17,0xEA,0xEC,0x2E,0x10,0x21,0xE8,
+0x3E,0x07,0xEA,0xEB,0x3E,0x17,0xEA,0xBA,0x44,0x1F,0xFF,0xAA,0x3E,0x17,0xEA,0xC1,
+0x44,0x10,0x00,0x55,0x3E,0x17,0xEA,0xC6,0x3E,0x17,0xEA,0xBD,0x3E,0x07,0xEA,0xBB,
+0x3E,0x07,0xEA,0xD7,0x3E,0x07,0xEA,0xE5,0x3E,0x07,0xFD,0xC6,0x3E,0x07,0xEA,0xA6,
+0x3C,0x0B,0xF5,0x7F,0x3C,0x0B,0xF5,0x83,0x3E,0x07,0xEA,0xE8,0x3E,0x07,0xEA,0xB0,
+0x3E,0x07,0xEA,0xBC,0x44,0x11,0xA8,0xE0,0x38,0x20,0x81,0x09,0x8C,0x01,0x84,0xE0,
+0x5A,0x08,0x0A,0xFC,0x84,0xC1,0x44,0x00,0x00,0x55,0x3E,0x77,0xEA,0xCF,0x3E,0x07,
+0xEA,0xE4,0x3E,0x67,0xEA,0xDA,0x3E,0x67,0xEA,0xAF,0x49,0xFF,0xEC,0xB4,0x2E,0x00,
+0x21,0xDC,0x3E,0x77,0xEA,0xAE,0x3E,0x77,0xEA,0xAD,0x3E,0x67,0xEA,0xD1,0x80,0xE6,
+0x5A,0x08,0x01,0x04,0x49,0xFF,0xBD,0xE8,0x3C,0x0D,0xFB,0x0A,0x84,0x20,0x3E,0x17,
+0xEA,0xBE,0x3E,0x77,0xFD,0xBC,0xAE,0x40,0xAE,0x41,0x2E,0x00,0x21,0xD9,0x3C,0x2D,
+0xFB,0x14,0x84,0xC0,0x85,0x21,0x3E,0x07,0xFD,0xB8,0x84,0x02,0x3E,0x17,0xEA,0xDD,
+0x3E,0x17,0xFD,0xBA,0x3E,0x17,0xEA,0xD4,0x3C,0x6E,0x05,0xA0,0x3E,0x17,0xEA,0xC2,
+0x3C,0x9E,0x05,0xA4,0x3E,0x17,0xEA,0xAA,0x3E,0x67,0xFD,0xB9,0xAE,0x10,0x3C,0x2D,
+0xFA,0xFF,0xAE,0x10,0x3E,0x07,0xEA,0xA8,0x44,0x01,0xA2,0x78,0x3E,0x17,0xEA,0xB4,
+0x49,0xFF,0xD6,0x77,0x44,0x01,0xA8,0x20,0x3C,0x0E,0x03,0x54,0x44,0x01,0xA8,0x80,
+0x3C,0x0E,0x03,0x55,0x44,0x01,0xA7,0x4C,0x3C,0x0E,0x03,0x56,0x44,0x01,0xA4,0x20,
+0x3C,0x0E,0x03,0x57,0x44,0x00,0x00,0x64,0x3C,0x08,0x05,0xC6,0x3C,0x08,0x05,0xCA,
+0x44,0x01,0xA9,0x58,0x3C,0x0E,0x02,0xE4,0x44,0x01,0xA1,0x3C,0x3C,0x0F,0xFB,0x12,
+0x84,0x0A,0x3E,0x07,0xEB,0xE8,0x2E,0x00,0x21,0x43,0x3C,0x6B,0xF5,0x86,0x3E,0x00,
+0x22,0x75,0x80,0x06,0x3C,0x6B,0xF5,0x85,0x3E,0x67,0xEA,0xAC,0x3E,0x67,0xEC,0x44,
+0x3E,0x67,0xEB,0xE9,0x3E,0x67,0xEB,0xEA,0x49,0xFF,0xA6,0x08,0x80,0x09,0x49,0xFF,
+0xA6,0x05,0x80,0x06,0x49,0xFF,0xA6,0x10,0x3C,0x0E,0x02,0xCB,0x80,0x09,0x49,0xFF,
+0xA6,0x0B,0x3C,0x0E,0x02,0xCC,0x84,0x02,0x49,0xFF,0xA6,0x06,0x3C,0x0E,0x02,0xCD,
+0x84,0x03,0x49,0xFF,0xA6,0x01,0x3C,0x0E,0x02,0xCE,0x84,0x04,0x49,0xFF,0xA5,0xFC,
+0x3C,0x0E,0x02,0xCF,0x84,0x05,0x49,0xFF,0xA5,0xF7,0x3C,0x0E,0x02,0xD0,0x84,0x06,
+0x49,0xFF,0xA5,0xF2,0x3C,0x0E,0x02,0xD1,0x84,0x07,0x49,0xFF,0xA5,0xED,0x3C,0x0E,
+0x02,0xD2,0x84,0x08,0x49,0xFF,0xA5,0xE8,0x3C,0x0E,0x02,0xD3,0x44,0x01,0xAD,0x20,
+0x3C,0x0F,0xFB,0x03,0x3C,0x00,0x10,0xA9,0x3C,0x10,0x11,0xA4,0x3C,0x08,0x11,0xA2,
+0x3C,0x00,0x10,0xAA,0x3C,0x6F,0xFF,0x6D,0x3C,0x08,0x11,0xF7,0x3C,0x00,0x11,0xA5,
+0x3E,0x67,0xEA,0xC5,0x40,0x00,0x24,0x0C,0x88,0x01,0x3C,0x08,0x11,0xA6,0x3C,0x00,
+0x11,0xFA,0x3C,0x10,0x11,0xF9,0x40,0x00,0x24,0x0C,0x88,0x01,0x3C,0x08,0x11,0xFB,
+0x2E,0x00,0x25,0x1E,0x3E,0x67,0xFD,0xB0,0x3E,0x07,0xEA,0xB8,0x3C,0x00,0x12,0x8A,
+0x3C,0x0B,0xF5,0x81,0x44,0x01,0xBB,0xEC,0x49,0xFF,0xAB,0xE4,0x44,0x01,0xB8,0x00,
+0x49,0xFF,0xAB,0xE3,0x49,0xFF,0xAC,0x11,0x3C,0x0F,0xFB,0x0E,0x49,0xFF,0xAB,0xE0,
+0x44,0x01,0xA9,0x88,0x3C,0x0E,0x03,0x52,0x44,0x01,0xA2,0x58,0x3C,0x0E,0x03,0x53,
+0x44,0x01,0x82,0xF8,0x3C,0x0F,0xFB,0x13,0x2E,0x00,0x21,0x43,0x3E,0x67,0xEC,0x3D,
+0x3E,0x67,0xEC,0x3C,0x3E,0x67,0xEC,0x3E,0x3E,0x60,0x0D,0x44,0x3C,0x6F,0xFF,0x6A,
+0x3C,0x6F,0xFF,0x6B,0x3E,0x67,0xFD,0xC0,0x3E,0x67,0xFD,0xBF,0x3E,0x67,0xFD,0xC1,
+0x3E,0x67,0xFD,0xC2,0x3E,0x67,0xEC,0x18,0x3E,0x67,0xEC,0x1A,0x3E,0x67,0xEC,0x19,
+0x3E,0x77,0xEA,0xC9,0x3E,0x67,0xEA,0xDC,0x40,0x00,0x24,0x0C,0x44,0x11,0xA5,0xC4,
+0x80,0x46,0xE0,0xC0,0xE8,0x06,0x38,0x20,0x99,0x09,0x8C,0xC1,0x97,0xB0,0xD5,0xFA,
+0x44,0x10,0x00,0x64,0x3C,0x18,0x06,0x36,0x44,0x10,0x00,0x5A,0x3C,0x18,0x06,0x38,
+0x44,0x10,0x00,0x96,0x84,0x00,0x3C,0x18,0x06,0x39,0x3C,0x18,0x06,0x3E,0xFA,0x38,
+0xFA,0x49,0x3E,0x07,0xEA,0xAB,0x3E,0x07,0xEA,0xE0,0x3E,0x07,0xFD,0xC5,0x3E,0x07,
+0xFD,0xC3,0x3E,0x00,0x0C,0x69,0x3E,0x00,0x0C,0x6A,0x3C,0x18,0x06,0x3F,0x84,0x00,
+0x84,0x25,0x3C,0x08,0x06,0x37,0x3C,0x08,0x06,0x3A,0x3C,0x08,0x06,0x3B,0x3C,0x08,
+0x06,0x3D,0x3C,0x28,0x06,0x3C,0x3C,0x08,0x06,0x40,0x3C,0x18,0x06,0x41,0x3C,0x08,
+0x06,0x42,0x44,0x11,0xA1,0x94,0x84,0x00,0x84,0x5F,0x38,0x20,0x81,0x09,0x8C,0x01,
+0x5A,0x08,0x14,0xFD,0x84,0x00,0x3E,0x07,0xEA,0xE2,0x3E,0x07,0xEA,0xD0,0x3E,0x07,
+0xEA,0xD2,0x3E,0x07,0xFD,0xC7,0xFC,0xC0,0xFC,0x01,0x44,0x61,0xB8,0xB8,0x80,0x06,
+0x49,0xFF,0xCE,0x7A,0x50,0x03,0x7F,0x48,0xF0,0x81,0x49,0xFF,0xE7,0x41,0x9C,0x34,
+0x49,0xFF,0xE7,0x41,0x50,0x03,0x00,0x78,0x49,0xFF,0xE9,0x53,0x50,0x03,0x00,0x84,
+0x49,0xFF,0xE7,0x3C,0x50,0x03,0x00,0x9C,0x49,0xFF,0xE7,0x3B,0x50,0x03,0x7F,0x48,
+0xF0,0x81,0x49,0xFF,0xF0,0x92,0x50,0x03,0x00,0xA8,0x49,0xFF,0xA4,0xF9,0x50,0x03,
+0x7F,0x48,0xF0,0x81,0x49,0xFF,0xA4,0xF7,0x50,0x03,0x7F,0x48,0xF0,0x81,0x49,0xFF,
+0xEE,0xE7,0x50,0x03,0x00,0x8C,0x49,0xFF,0xD2,0x3F,0x50,0x03,0x7F,0x48,0xF0,0x81,
+0x49,0xFF,0xD2,0x3D,0x50,0x03,0x7F,0x48,0xF0,0x81,0x49,0xFF,0xCF,0x62,0x50,0x03,
+0x00,0xF4,0x49,0xFF,0xDC,0xCD,0x50,0x03,0x7F,0x48,0xF0,0x81,0x49,0xFF,0xDC,0xCB,
+0x49,0xFF,0xDC,0xE9,0x50,0x03,0x01,0x08,0x49,0xFF,0xD0,0x8F,0x50,0x03,0x7F,0x48,
+0xF0,0x81,0x49,0xFF,0xD0,0x8D,0x50,0x03,0x03,0x34,0x49,0xFF,0xD0,0x8C,0x50,0x03,
+0x7F,0x48,0xF0,0x81,0x49,0xFF,0xB4,0xDE,0x50,0x03,0x01,0x4C,0x49,0xFF,0xB3,0xD2,
+0x50,0x03,0x02,0xA4,0x49,0xFF,0xA6,0xD8,0x50,0x03,0x7F,0x48,0xF0,0x81,0x49,0xFF,
+0xA6,0xD6,0x50,0x03,0x02,0xF8,0x49,0xFF,0xA5,0xA9,0x50,0x03,0x7F,0x48,0xF0,0x81,
+0x49,0xFF,0xA5,0xA7,0x50,0x03,0x03,0x08,0x49,0xFF,0xAE,0x11,0x50,0x03,0x7F,0x48,
+0xF0,0x81,0x49,0xFF,0xAE,0x0F,0x50,0x03,0x03,0x40,0x49,0xFF,0xD9,0x18,0x50,0x03,
+0x7F,0x48,0xF0,0x81,0x49,0xFF,0xD9,0x10,0x3C,0x1D,0xFB,0x09,0x3C,0x0D,0xFB,0x16,
+0x49,0xFF,0xDA,0x50,0x50,0x03,0x03,0x60,0x49,0xFF,0xEE,0x8D,0x50,0x03,0x7F,0x48,
+0xF0,0x81,0x49,0xFF,0xEE,0x8B,0x50,0x03,0x00,0x48,0x49,0xFF,0xBD,0x49,0xFC,0x81,
+0xFC,0x45,0x81,0x20,0xF1,0x84,0x3C,0x0D,0xFA,0xE3,0x44,0x11,0x82,0xC0,0xF2,0x85,
+0xF3,0x86,0x49,0xFF,0xBB,0x66,0x3C,0x1D,0xFB,0x14,0x84,0x01,0x81,0x09,0xAE,0x08,
+0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0x84,0x00,0x3C,0x0F,0xFB,0x24,0x84,0x01,0x49,0xFF,
+0xD0,0x08,0xE7,0x29,0xE9,0x02,0x85,0x08,0x84,0xC0,0x50,0x04,0x7F,0xFF,0x80,0xE6,
+0xF0,0x88,0x4C,0x64,0x00,0xBF,0x40,0x03,0x24,0x37,0xF0,0x87,0x84,0x00,0x3E,0x07,
+0xEA,0xE3,0x3C,0x0D,0xFB,0x0A,0xF1,0x89,0xA6,0x01,0x5A,0x00,0x0E,0x04,0x5A,0x08,
+0x0B,0x10,0x49,0xFF,0xBA,0xE4,0xC8,0x04,0x49,0xFF,0xD8,0xB9,0xD5,0xFB,0x3C,0x0D,
+0xFB,0x0A,0x84,0x20,0x49,0xFF,0xDB,0x76,0x84,0x01,0x49,0xFF,0xBA,0xE5,0x85,0x40,
+0x2E,0x17,0xEA,0xE3,0x2E,0x00,0x21,0x6F,0xE2,0x20,0x4E,0xF2,0x00,0x98,0x49,0xFF,
+0xD8,0xA6,0x3C,0x5D,0xFB,0x24,0x5A,0x58,0x01,0xF5,0x3C,0xAF,0xFB,0x24,0x2E,0x17,
+0xEA,0xE3,0x2E,0x00,0x21,0x6E,0xE2,0x20,0xE9,0x4A,0xF1,0x09,0xC9,0x10,0x2E,0x37,
+0xEA,0xE3,0xF1,0x07,0xF2,0x05,0x8A,0x60,0xF0,0x04,0x40,0x71,0x04,0x1A,0xB7,0x3F,
+0x14,0xAF,0x80,0x01,0x14,0xAF,0x80,0x02,0x80,0x20,0xD5,0x33,0x2E,0x37,0xEA,0xE3,
+0xFA,0x90,0x8A,0x60,0xF0,0x04,0xB7,0x3F,0x14,0xAF,0x80,0x01,0x14,0xAF,0x80,0x02,
+0x80,0x20,0x44,0x21,0x08,0x30,0x96,0xD8,0x49,0xFF,0xD3,0x11,0x2E,0x40,0x21,0xD8,
+0x5A,0x48,0x01,0x0E,0xF0,0x06,0x2E,0x30,0x21,0x4A,0xB7,0x5F,0x14,0xAF,0x80,0x01,
+0x80,0x20,0x44,0x21,0x0E,0x68,0x80,0xA9,0x49,0xFF,0xD2,0xE4,0xF0,0x07,0xC8,0x03,
+0xF7,0x05,0xD5,0x03,0x44,0x71,0x08,0x30,0x2E,0x07,0xEA,0xE3,0x2E,0x30,0x21,0x6E,
+0x84,0xA1,0x9A,0xC3,0xB6,0xBF,0xF5,0x81,0xF5,0x82,0x44,0x01,0x08,0x30,0x80,0x27,
+0x80,0x47,0x96,0xD8,0xFA,0x90,0x49,0xFF,0xD2,0xEA,0xD5,0x0D,0x2E,0x57,0xEA,0xE3,
+0x8E,0x01,0xD8,0x09,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x06,0x44,0x01,0x06,0x30,
+0x49,0xFF,0xBE,0x7F,0x2E,0x00,0x21,0xDC,0x5A,0x08,0x01,0x12,0x2E,0x17,0xEA,0xE3,
+0x2E,0x50,0x21,0x6E,0xD9,0x1B,0x3C,0x1D,0xFA,0xFF,0xAE,0x08,0xF0,0x08,0x4C,0x60,
+0x40,0x16,0x2E,0x07,0xEA,0xDF,0x5A,0x08,0x03,0x12,0xD5,0x0C,0x3C,0x0D,0xFA,0xFF,
+0x84,0x21,0xAE,0x40,0xF0,0x08,0x4C,0x60,0x40,0x0A,0x2E,0x07,0xEA,0xE1,0x5A,0x08,
+0x06,0x06,0x3C,0x0D,0xFA,0xFF,0x84,0x20,0xAE,0x40,0x2E,0x07,0xEA,0xE3,0x8C,0x01,
+0x96,0x00,0x3E,0x07,0xEA,0xE3,0x2E,0x00,0x21,0xDC,0x5A,0x00,0x01,0x04,0x48,0xFF,
+0xFF,0x69,0x2E,0x07,0xEA,0xE3,0x48,0xFF,0xFF,0x65,0x8C,0xC1,0x48,0xFF,0xFF,0x43,
+0x84,0x00,0x49,0xFF,0xCF,0x3E,0xFC,0xC5,0xFC,0x43,0x80,0xE0,0xB4,0x01,0xF4,0x81,
+0x02,0x10,0x00,0x0D,0x96,0x49,0xCA,0x09,0x02,0x0F,0x80,0x02,0xAD,0x7A,0xAC,0x38,
+0x02,0x0F,0x80,0x1C,0xAC,0x39,0xFC,0xC3,0x54,0x21,0x01,0xFF,0x40,0x41,0x24,0x08,
+0x54,0x81,0x81,0xFF,0x40,0x01,0x48,0x08,0x00,0x3F,0x80,0x3C,0x89,0x04,0x88,0x44,
+0x89,0x00,0x40,0x91,0x00,0x00,0x44,0x00,0x00,0x58,0xFE,0x1C,0x44,0x31,0x00,0x00,
+0x87,0x80,0xFE,0x5F,0x4D,0xC0,0x3F,0xE2,0x40,0x3E,0x04,0x00,0x84,0xC0,0xF1,0x85,
+0xF5,0x84,0xF0,0x83,0xF3,0x82,0x49,0xFF,0xD7,0xDA,0xF3,0x02,0x81,0x49,0x40,0xA4,
+0x18,0x1A,0x38,0xA1,0x9A,0x0A,0x8C,0xC1,0xF0,0x03,0xF5,0x04,0xF1,0x05,0x5A,0x68,
+0x16,0xF0,0x51,0xCE,0x00,0x58,0xD5,0xE7,0xFC,0x44,0x3C,0xAD,0xFA,0xD5,0x44,0x11,
+0x00,0x00,0xF2,0x83,0x02,0x45,0x00,0x12,0x2E,0x77,0xEA,0xD5,0x40,0x22,0x04,0x04,
+0x02,0x45,0x00,0x11,0xF2,0x84,0xFE,0x67,0xF1,0x85,0x3C,0x1C,0x02,0xA4,0x95,0x59,
+0xF1,0x81,0x2E,0x17,0xEA,0xA9,0x80,0x65,0x9F,0x0A,0xF4,0x82,0xF2,0x02,0x44,0x41,
+0xA3,0x48,0x50,0x80,0xFF,0xFF,0x88,0x85,0xE0,0xE2,0x44,0x51,0xA6,0xB6,0x5C,0x10,
+0x80,0x09,0x88,0x65,0x84,0xC0,0x14,0xFF,0x80,0x06,0x45,0xE1,0x20,0x00,0x45,0xC1,
+0x2E,0x60,0x44,0x91,0x3E,0xD0,0xF1,0x87,0xCE,0x0B,0x3C,0x10,0x08,0x1C,0x5A,0x18,
+0x0F,0x04,0x48,0x00,0x01,0x07,0x22,0x50,0x00,0x01,0xF2,0x05,0xD5,0x0F,0xA4,0x58,
+0x5A,0x1B,0xFF,0x04,0x48,0x00,0x00,0xFE,0xF2,0x01,0x4C,0xA1,0x40,0x05,0x22,0x50,
+0x00,0x02,0xD5,0x03,0x22,0x50,0x00,0x00,0xF2,0x04,0x38,0x11,0x05,0x01,0xF2,0x03,
+0x40,0x10,0x88,0x36,0xF2,0x06,0x9B,0x4D,0x97,0x6B,0xC2,0x53,0xF2,0x07,0xCA,0x19,
+0x3C,0x13,0xF5,0x7E,0x4E,0x55,0x00,0x0C,0xCE,0x06,0x3C,0x50,0x06,0x44,0x9A,0x69,
+0x48,0x00,0x00,0xC5,0xA5,0x60,0x88,0x25,0x48,0x00,0x00,0xCD,0xCE,0x06,0x3C,0x50,
+0x06,0x44,0x88,0x25,0x48,0x00,0x00,0xBB,0xA5,0x60,0x9A,0x69,0x48,0x00,0x00,0xC3,
+0xCF,0x0F,0xCE,0x09,0x3C,0x50,0x08,0x1C,0x44,0x21,0x2E,0x70,0x38,0x11,0x15,0x09,
+0x48,0x00,0x00,0xAA,0xA5,0x58,0x38,0x14,0x95,0x09,0x48,0x00,0x00,0xB2,0x5A,0x70,
+0x01,0x04,0x48,0x00,0x00,0xB1,0xCE,0x15,0x3C,0xF0,0x08,0x1C,0x44,0x21,0x2E,0x70,
+0x38,0xF1,0x3D,0x11,0x8A,0x2F,0x4E,0x14,0x00,0x03,0xFE,0x4A,0x96,0x4B,0x40,0x52,
+0x84,0xB6,0x3C,0x10,0x06,0x44,0x9B,0x4D,0x3C,0x58,0x06,0x44,0x48,0x00,0x00,0x9C,
+0x02,0xF1,0x80,0x00,0x38,0xF4,0xBD,0x11,0x8A,0x2F,0x4E,0x14,0x00,0x03,0xFE,0x4A,
+0x96,0x4B,0x40,0x52,0x84,0xB6,0xA4,0x60,0x88,0xA1,0xAD,0x60,0x48,0x00,0x00,0x8C,
+0xF2,0x02,0x4C,0x71,0x40,0x2E,0xCE,0x0A,0x3C,0x10,0x08,0x1C,0x38,0x5E,0x05,0x09,
+0x3C,0x10,0x06,0x44,0x4E,0x54,0x00,0x0E,0xD5,0x12,0x02,0xF1,0x80,0x00,0x38,0x5F,
+0x3D,0x09,0x02,0xF1,0x80,0x00,0x38,0x14,0xBD,0x09,0x4E,0x54,0x00,0x0D,0xD5,0x14,
+0x8E,0x21,0x3C,0x18,0x06,0x44,0x4C,0x74,0x40,0x6F,0xD5,0x17,0x8C,0x21,0x3C,0x18,
+0x06,0x44,0xD5,0x4C,0x02,0xF2,0x00,0x00,0x50,0xF7,0x80,0x01,0x12,0xF2,0x00,0x00,
+0x4C,0x74,0x40,0x62,0xD5,0x18,0xA4,0x60,0x8E,0x21,0xAC,0x60,0xD5,0x3F,0x4C,0x74,
+0x40,0x5B,0x4E,0x55,0x00,0x3E,0xCE,0x0F,0x3C,0x10,0x08,0x1C,0x38,0x1E,0x05,0x11,
+0x4E,0x14,0x00,0x52,0xFE,0x4A,0x96,0x4B,0xE0,0xA1,0xE9,0x4D,0x3C,0x10,0x06,0x44,
+0x8E,0x21,0xD5,0x3C,0x02,0xF1,0x80,0x00,0xF2,0x01,0x38,0xF4,0xBD,0x11,0x8A,0x2F,
+0x4C,0xA1,0x40,0x0E,0x4E,0x14,0x00,0x03,0xFE,0x4A,0x02,0x20,0x00,0x0D,0x40,0xF0,
+0x80,0x11,0xE0,0x4F,0xE8,0x0F,0x12,0x10,0x00,0x0D,0xD5,0x0C,0x4E,0x14,0x00,0x03,
+0xFE,0x4A,0x02,0x20,0x00,0x0C,0x40,0xF0,0x80,0x11,0xE0,0x4F,0xE8,0x03,0x12,0x10,
+0x00,0x0C,0xA4,0x58,0x38,0x1F,0x05,0x11,0x4E,0x14,0x00,0x26,0xFE,0x4A,0x96,0x4B,
+0xE0,0xA1,0xE9,0x21,0xA4,0x60,0x8C,0x21,0xD5,0x1D,0x4C,0x74,0x40,0x1D,0xFF,0x6A,
+0x97,0x6B,0xCE,0x0F,0x3C,0x10,0x08,0x1C,0x38,0x1E,0x05,0x11,0x4E,0x15,0x00,0x14,
+0xE0,0x25,0xE8,0x11,0x3C,0x10,0x06,0x44,0x8C,0x21,0x3C,0x18,0x06,0x44,0xD5,0x0B,
+0xA4,0x58,0x38,0x1F,0x05,0x11,0x4E,0x15,0x00,0x07,0xE0,0x25,0xE8,0x04,0xA4,0x60,
+0x8E,0x21,0xAC,0x60,0x22,0x12,0x00,0x00,0x4E,0x14,0x00,0x04,0x84,0x20,0xAC,0x60,
+0x22,0xF2,0x00,0x00,0x5E,0xF7,0x82,0x00,0xE9,0x04,0x44,0x10,0x01,0xFF,0xAC,0x60,
+0x8C,0xC1,0x97,0xB0,0x8C,0x82,0x8C,0x62,0x5A,0x60,0x21,0x04,0x48,0xFF,0xFE,0xEE,
+0xFC,0xC4,0xFC,0x42,0x81,0x00,0x84,0x01,0xF1,0x81,0x80,0xC2,0x49,0xFF,0xCD,0xB1,
+0x2E,0x00,0x21,0x6E,0x3C,0x5D,0xFA,0xD5,0xB6,0x1F,0x84,0x01,0x3E,0x07,0xEA,0xB1,
+0x3C,0x0C,0x02,0xA4,0xD0,0x07,0x84,0x00,0xF1,0x01,0x3C,0x0F,0xFA,0xE3,0x49,0xFF,
+0xB8,0xF0,0x3C,0x1D,0xFB,0x14,0x84,0x01,0x96,0xB1,0xAE,0x08,0x3C,0x1D,0xFA,0xFF,
+0x46,0x3E,0xFF,0xFF,0x44,0x40,0x00,0x64,0xAE,0x08,0x3C,0x5D,0xFA,0xD5,0x84,0x00,
+0x3E,0x07,0xEA,0xD5,0xA0,0x2D,0x44,0x61,0x00,0x00,0x92,0x10,0x96,0x06,0xF0,0x82,
+0xA0,0x6D,0x44,0x0E,0xFF,0xFF,0xFE,0x0E,0xA8,0x2D,0x3C,0x0D,0xFA,0xD2,0x84,0x20,
+0xF2,0x81,0x44,0x71,0xA6,0x50,0x50,0x31,0x8F,0xFF,0x04,0x9F,0x80,0x01,0x96,0x89,
+0xE2,0x49,0xE8,0x10,0x02,0x02,0x80,0x0C,0x42,0x00,0x90,0x73,0xFE,0x37,0xA0,0x83,
+0x92,0x5C,0x96,0x86,0x38,0x23,0x84,0x08,0xA0,0x83,0x8C,0x21,0xFE,0x9E,0xA8,0x83,
+0xD5,0xED,0x3C,0x0F,0xFA,0xD2,0x2E,0x07,0xFD,0xC6,0xC8,0x11,0x3C,0x0C,0x02,0xA4,
+0xD0,0x04,0x2E,0x00,0x22,0x32,0xD5,0x03,0x2E,0x00,0x22,0x33,0x3E,0x07,0xEA,0xA9,
+0x2E,0x07,0xEA,0xA9,0x85,0x41,0x5A,0x08,0x0A,0x08,0xD5,0x04,0x84,0x0A,0x3E,0x07,
+0xEA,0xA9,0x44,0xA0,0x00,0x80,0x84,0xC0,0x81,0x26,0x80,0xE6,0x48,0x00,0x00,0x9E,
+0x49,0xFF,0xD6,0x15,0x84,0x00,0x3E,0x07,0xEA,0xE3,0x84,0x00,0x3C,0x0F,0xFB,0x24,
+0x49,0xFF,0xCB,0x10,0x5A,0x00,0x02,0x04,0x48,0x00,0x00,0x98,0x84,0x01,0x3E,0x07,
+0xEA,0xAB,0x2E,0x07,0xEA,0xD5,0x40,0x05,0x00,0x0E,0x96,0x01,0xC8,0x02,0x84,0x01,
+0x3C,0x0B,0xF5,0x7E,0x3C,0x5D,0xFA,0xD5,0x3C,0x0C,0x02,0xA4,0x4C,0x50,0x00,0xA0,
+0x49,0xFF,0xCA,0xF8,0x5A,0x00,0x02,0x04,0x48,0x00,0x00,0x9A,0x3C,0x0D,0xFA,0xD5,
+0xA0,0x05,0x92,0x0A,0x96,0x2F,0xF0,0x83,0x2E,0x07,0xEA,0xE3,0xF1,0x03,0xE2,0x01,
+0xE8,0x5D,0x49,0xFF,0xD5,0xE4,0x3C,0x0D,0xFB,0x24,0x5A,0x00,0x01,0x04,0x48,0x00,
+0x00,0x98,0x2E,0x07,0xEA,0xA9,0x2E,0x17,0xEA,0xD5,0x8E,0x01,0xE0,0x20,0x4E,0xF3,
+0x00,0x96,0x84,0x00,0x3C,0x0F,0xFB,0x24,0x2E,0x07,0xEA,0xE3,0x2E,0x10,0x21,0x6E,
+0x8C,0x01,0x96,0x00,0x3E,0x07,0xEA,0xE3,0x2E,0x07,0xEA,0xE3,0x3C,0x5D,0xFA,0xD5,
+0xE2,0x20,0x3C,0x0C,0x02,0xA4,0x4E,0xF3,0x00,0x8E,0x4C,0x50,0x00,0x8C,0x2E,0x57,
+0xEA,0xE3,0x4C,0x50,0xC0,0xF0,0x2E,0x77,0xEA,0xDF,0x4E,0x73,0x00,0xEC,0x2E,0x00,
+0x21,0xDC,0x5A,0x00,0x01,0x04,0x48,0x00,0x00,0xE6,0x2E,0x00,0x21,0xEE,0x5A,0x00,
+0x01,0x04,0x48,0x00,0x00,0xE0,0x2E,0x07,0xEA,0xD1,0x5A,0x00,0x01,0x04,0x48,0x00,
+0x00,0xDA,0x44,0x01,0x06,0x30,0x44,0x11,0x92,0x50,0x49,0xFF,0xBA,0x63,0x44,0x01,
+0x06,0x30,0x80,0x27,0x80,0x47,0x49,0xFF,0xBB,0x38,0x49,0xFF,0xBA,0x7C,0x3C,0x13,
+0xFE,0x09,0x3C,0x03,0xFE,0x0B,0x88,0x01,0x2E,0x10,0x22,0x65,0xE0,0x20,0x4E,0xF2,
+0x00,0xAC,0x84,0x01,0x3E,0x07,0xFC,0x18,0x84,0xE0,0x2E,0x07,0xEA,0xD5,0x2E,0x17,
+0xEA,0xDF,0x8C,0x01,0x3E,0x07,0xEA,0xD5,0x2E,0x07,0xEA,0xA9,0x4E,0x12,0x00,0xEC,
+0x2E,0x57,0xEA,0xD5,0x4C,0x50,0x00,0xF0,0x2E,0x07,0xEA,0xB1,0x5A,0x08,0x01,0x04,
+0x48,0xFF,0xFF,0x60,0x48,0x00,0x01,0x03,0x2E,0x07,0xEA,0xD5,0x4E,0x03,0xFF,0x68,
+0x3C,0x0D,0xFB,0x0D,0x5A,0x08,0x04,0x05,0x84,0x0A,0x10,0x04,0x00,0x01,0x3C,0x0D,
+0xFB,0x0A,0x84,0x20,0x49,0xFF,0xD8,0x26,0x3C,0x0C,0x02,0xA4,0x3C,0x5D,0xFA,0xD5,
+0x4C,0x50,0x3F,0x56,0x49,0xFF,0xD7,0x6C,0x48,0xFF,0xFF,0x52,0x84,0x00,0x3C,0x0F,
+0xFB,0x33,0x49,0xFF,0xB7,0x7C,0xC8,0x04,0x49,0xFF,0xD5,0x51,0xD5,0xFB,0x84,0x01,
+0x3E,0x07,0xEA,0xAB,0x84,0x01,0x49,0xFF,0xB7,0x7F,0x48,0xFF,0xFF,0x59,0x5A,0x70,
+0x01,0x04,0x48,0xFF,0xFF,0x5B,0x48,0xFF,0xFF,0x66,0x3C,0x0C,0x02,0xA4,0x3C,0x5D,
+0xFA,0xD5,0x4C,0x50,0x3F,0x68,0x3C,0x0D,0xFA,0xFF,0x84,0x21,0xAE,0x40,0x48,0xFF,
+0xFF,0x62,0xD8,0x08,0x2E,0x07,0xEA,0xE3,0x84,0x40,0x8E,0x01,0x96,0x00,0xB6,0x5F,
+0xD5,0x05,0x2E,0x07,0xEA,0xE3,0x8A,0x01,0x96,0x00,0x02,0x22,0x80,0x0C,0x44,0x30,
+0x00,0x64,0x42,0x20,0x0C,0x73,0x44,0x31,0x00,0x00,0xFE,0x9F,0x3C,0x2F,0xFA,0xD2,
+0xA6,0x14,0xA7,0x16,0x54,0x90,0x00,0xFF,0xA1,0x92,0x44,0x20,0x00,0x58,0x02,0x02,
+0x80,0x0D,0x42,0x04,0x88,0x73,0x02,0x52,0x80,0x0F,0x42,0x52,0x08,0x73,0xFE,0x1F,
+0x92,0xD2,0xFF,0x5F,0x97,0xB7,0x44,0x31,0xA3,0x48,0x99,0x02,0xA2,0x81,0x54,0x71,
+0x01,0xFF,0xAD,0xD8,0x40,0x71,0x24,0x09,0x92,0x52,0x54,0x73,0x81,0xFF,0x54,0x21,
+0x01,0xFF,0xAD,0xD9,0xAC,0x9A,0x8C,0x66,0x4C,0x02,0x7F,0xF2,0x44,0x21,0xA6,0xB8,
+0x50,0x42,0x80,0x58,0xA2,0x29,0x54,0x30,0x03,0xFF,0xAC,0xD0,0x40,0x30,0x28,0x09,
+0x92,0x14,0x54,0x31,0x83,0xFF,0x54,0x00,0x03,0xFF,0xAC,0xD1,0xAC,0x12,0x8C,0x46,
+0xDC,0xF2,0x48,0xFF,0xFF,0x26,0x3C,0xF7,0xFE,0x0A,0x5E,0xF7,0x81,0xF5,0x4E,0xF2,
+0xFF,0x52,0x3C,0x0D,0xFB,0x33,0x2E,0x17,0xEA,0xE3,0x84,0xE0,0xE2,0x20,0x4E,0xF2,
+0xFE,0xED,0x2E,0x07,0xEA,0xE3,0x2E,0x70,0x21,0x6E,0x40,0x73,0x80,0x06,0x48,0xFF,
+0xFE,0xE5,0x2E,0x07,0xEA,0xE3,0xB4,0x3F,0xE2,0x20,0xE8,0xEC,0x44,0x01,0xA2,0xC0,
+0x44,0x11,0x81,0x71,0x80,0x46,0x84,0x60,0x49,0xFF,0xFC,0xF8,0x44,0x01,0xA2,0xC0,
+0x80,0x46,0xFA,0x71,0x44,0x11,0x81,0x71,0x49,0xFF,0xFC,0xF0,0x3C,0x0D,0xFA,0xD5,
+0x44,0x21,0xA3,0x48,0x02,0x50,0x00,0x0D,0x44,0x00,0x00,0x58,0x42,0x54,0x80,0x73,
+0x44,0x01,0x00,0x00,0xFF,0x47,0x50,0x32,0x80,0x58,0xA4,0x10,0x8C,0x46,0x54,0x10,
+0x01,0xFF,0x02,0x01,0x7F,0xFE,0x54,0x00,0x01,0xFF,0x40,0x00,0x24,0x08,0x88,0x01,
+0x02,0x11,0x7F,0xFF,0x54,0x10,0x81,0xFF,0x40,0x10,0xC8,0x08,0x88,0x01,0xAA,0x29,
+0xDB,0xED,0xD5,0xB8,0x2E,0x17,0xFC,0x18,0x4E,0x12,0xFF,0x14,0x3E,0x07,0xEA,0xD5,
+0x48,0xFF,0xFF,0x10,0x00,0x04,0x00,0x01,0x5A,0x08,0x0A,0x14,0x84,0x00,0x3C,0x0F,
+0xFB,0x33,0x49,0xFF,0xD4,0x84,0x84,0x01,0x49,0xFF,0xB6,0xB6,0x44,0x11,0xF4,0x4C,
+0xA6,0x08,0x5A,0x00,0x01,0xFF,0x49,0xFF,0xD9,0xAF,0x84,0x00,0x3C,0x0F,0xFF,0x6A,
+0x84,0x02,0x3E,0x07,0xEA,0xB1,0x48,0xFF,0xFE,0xF9,0x84,0x00,0x49,0xFF,0xCB,0xA1,
+0x3C,0x4D,0xFA,0xD5,0xF0,0x02,0x46,0x5E,0xFF,0xFF,0xA0,0xA5,0x40,0x10,0x40,0x08,
+0x44,0x0E,0xFF,0xFF,0xFE,0x16,0xFE,0x0F,0xA8,0x25,0x3C,0x2D,0xFA,0xD2,0x84,0x60,
+0x44,0x60,0x00,0x64,0x44,0x71,0x00,0x00,0x44,0x91,0xA6,0x50,0x50,0x52,0x8F,0xFF,
+0xF1,0x01,0x96,0x19,0xE2,0x01,0xE8,0x11,0x02,0x22,0x00,0x0C,0x38,0x04,0x8C,0x00,
+0x42,0x21,0x98,0x73,0xFE,0xBF,0x96,0x06,0x40,0x10,0x70,0x08,0xA0,0x13,0x8C,0x61,
+0xFE,0x2E,0xFE,0x0F,0xA8,0x13,0xD5,0xED,0x3C,0x2F,0xFA,0xD2,0xFC,0xC2,0xFC,0x41,
+0x80,0xE3,0x81,0x01,0x3C,0x6D,0xFF,0x0F,0x80,0x61,0x84,0xA0,0x85,0x25,0xD2,0x16,
+0xB4,0x23,0xC1,0x0F,0x8E,0x24,0xE6,0x22,0xE9,0x0C,0x04,0xA1,0x80,0x07,0xA0,0x42,
+0x38,0x10,0xA9,0x01,0x00,0xA3,0x00,0x06,0xE3,0x41,0xE8,0x03,0x10,0x93,0x80,0x02,
+0x8C,0xA1,0x97,0x68,0x50,0x31,0x80,0x5C,0xD5,0xEB,0x3C,0x1D,0xFF,0x0E,0x84,0x00,
+0x81,0x40,0x00,0x50,0x80,0x09,0x44,0x60,0x00,0x5C,0x96,0xC0,0xE2,0x65,0xE8,0x0F,
+0x42,0x20,0x18,0x24,0x38,0x24,0x08,0x02,0x8E,0x41,0xE6,0x42,0xE8,0x06,0x50,0x25,
+0x00,0x01,0x54,0xA1,0x00,0xFF,0x80,0x83,0x8C,0x01,0xD5,0xF0,0x4E,0xA3,0x00,0x07,
+0x10,0xA3,0x80,0x02,0x80,0xCA,0x81,0x2A,0xD5,0x20,0xA6,0x3A,0x5A,0x00,0x05,0x1C,
+0x5A,0xA8,0x01,0x18,0x2E,0x57,0xFC,0x30,0xD4,0x08,0x84,0x00,0x3E,0x47,0xFC,0x30,
+0x3E,0x07,0xFC,0x7E,0x3E,0x07,0xFC,0x46,0x44,0x00,0x00,0x5C,0x80,0x48,0x42,0x22,
+0x00,0x73,0x84,0x01,0x22,0x91,0x00,0x04,0x22,0x61,0x00,0x05,0xAE,0x3A,0xD5,0x05,
+0x84,0x03,0xAE,0x3A,0x84,0xC0,0x81,0x26,0xA6,0x3A,0x5A,0x08,0x01,0x23,0x3C,0x2D,
+0xFF,0x0D,0xA6,0xD3,0x5A,0x38,0x01,0x1E,0xA6,0x92,0xCA,0x1B,0x02,0x30,0x80,0x09,
+0xA5,0x4A,0x9F,0x19,0x84,0x42,0x40,0x32,0x08,0x76,0x8E,0xA1,0x42,0x34,0x94,0x73,
+0x40,0x31,0x90,0x77,0x40,0x91,0x80,0x11,0x02,0x30,0x80,0x0A,0xA4,0x4B,0x8E,0x61,
+0x8E,0x21,0x40,0x21,0x88,0x56,0x42,0x23,0x04,0x73,0x40,0x61,0x0C,0xD7,0x97,0xB3,
+0x2E,0x17,0xFC,0x7E,0xE6,0x26,0x4E,0xF2,0x00,0xB8,0x44,0xF0,0xB2,0x80,0x38,0x17,
+0x85,0x01,0x40,0xF0,0xBC,0x00,0x4A,0x00,0x3C,0x00,0x0C,0x00,0x78,0x00,0x84,0x00,
+0x96,0x00,0x9C,0x00,0x50,0x01,0x5A,0x08,0x01,0x04,0x48,0x00,0x00,0xA9,0x4E,0x02,
+0x00,0xA7,0x5A,0x00,0x03,0x04,0x48,0x00,0x00,0xA2,0x84,0x00,0x5A,0xA8,0x02,0x24,
+0x3C,0x0B,0xFE,0x3C,0x3C,0x03,0xFE,0x24,0x8C,0x01,0x3C,0x0B,0xFE,0x24,0x49,0xFF,
+0xD4,0xFB,0x22,0x44,0x00,0x04,0x22,0x34,0x00,0x05,0x22,0x24,0x00,0x32,0x22,0x04,
+0x00,0x33,0x3C,0x4B,0xFE,0x2A,0x3C,0x3B,0xFE,0x2B,0x3C,0x2B,0xFE,0x2C,0x3C,0x0B,
+0xFE,0x2D,0x3C,0x48,0x05,0x6A,0x3C,0x38,0x05,0x6B,0x3C,0x28,0x05,0x6C,0x3C,0x08,
+0x05,0x6D,0xD5,0x4A,0xF0,0x81,0x49,0xFF,0xD4,0xDF,0xF0,0x01,0x3C,0x0B,0xFE,0x24,
+0xD5,0x75,0x5A,0x00,0x01,0x6E,0xC0,0x6E,0x5A,0x08,0x03,0x71,0xD5,0x6D,0x5A,0x00,
+0x01,0x68,0xC0,0x68,0x5A,0x08,0x03,0x6B,0x3C,0x03,0xFE,0x3C,0xE6,0x0A,0xD5,0x02,
+0xE6,0x02,0xE9,0x62,0xD5,0x63,0xE7,0x43,0xE8,0x61,0xC8,0x2C,0x3C,0x27,0xFE,0x27,
+0x3C,0x17,0xFE,0x2B,0x9A,0xD1,0x5E,0xF1,0x82,0x1D,0xE9,0x21,0x3C,0x47,0xFE,0x29,
+0x9A,0xD4,0x50,0xF1,0x80,0xC7,0x5C,0xF7,0x81,0x8F,0xE8,0x19,0x3C,0xF7,0xFE,0x2D,
+0x8A,0x2F,0x50,0xF0,0x80,0xC7,0x5C,0xF7,0x81,0x8F,0xE8,0x11,0x84,0x21,0x3E,0x17,
+0xFC,0x47,0x3C,0x13,0xFE,0x26,0x3C,0x28,0x05,0x6F,0x3C,0x18,0x05,0x6E,0x3C,0x13,
+0xFE,0x28,0x3C,0x48,0x05,0x71,0x3C,0x18,0x05,0x70,0xD5,0x39,0x49,0xFF,0xD4,0x9C,
+0xD5,0x33,0x5A,0xA0,0x02,0x04,0x84,0x04,0xD5,0x32,0x02,0x14,0x00,0x05,0x3C,0x03,
+0xFE,0x24,0x3C,0x1B,0xFE,0x27,0x02,0x14,0x00,0x33,0x8C,0x01,0x3C,0x0B,0xFE,0x24,
+0x3C,0x1B,0xFE,0x29,0x22,0x04,0x00,0x04,0x3C,0x17,0xFE,0x2A,0x22,0x24,0x00,0x32,
+0x8A,0x20,0x3C,0x0B,0xFE,0x26,0x3C,0x2B,0xFE,0x28,0x4E,0x14,0x00,0x03,0xFE,0x4A,
+0x5E,0xF0,0x80,0xC9,0xE8,0x13,0x3C,0x07,0xFE,0x2C,0x8A,0x02,0x4E,0x04,0x00,0x03,
+0xFE,0x02,0x5E,0xF0,0x00,0xC9,0xE8,0x0A,0xD5,0xD7,0xC8,0x08,0xD5,0x08,0x84,0x02,
+0xD5,0x06,0x84,0x03,0xD5,0x04,0x84,0x00,0xD5,0x02,0x84,0x05,0x3E,0x07,0xFC,0x7E,
+0x8E,0x01,0xE6,0x05,0x84,0x20,0x4E,0xF2,0x02,0xDE,0x44,0xF0,0xB4,0x00,0x38,0x07,
+0x81,0x01,0x40,0xF0,0x3C,0x00,0x4A,0x00,0x3C,0x00,0x0A,0x00,0x6C,0x00,0x92,0x01,
+0xAC,0x05,0xA2,0x05,0x84,0x20,0x3C,0x1F,0xFF,0x1D,0x3C,0x1F,0xFF,0x1C,0x84,0x21,
+0x84,0x00,0x3C,0x1F,0xFA,0x69,0x44,0x1F,0xFF,0xAA,0x3C,0x0B,0xFE,0x3C,0x3E,0x07,
+0xFC,0x7D,0x3E,0x07,0xFC,0x7C,0x3E,0x17,0xE9,0xA8,0x3C,0x9B,0xFE,0x36,0x3C,0x6B,
+0xFE,0x37,0x3C,0x9B,0xFE,0x34,0x3C,0x6B,0xFE,0x35,0x3C,0x9B,0xFE,0x32,0x3C,0x6B,
+0xFE,0x33,0x3C,0x9B,0xFE,0x30,0x3C,0x6B,0xFE,0x31,0x3C,0x9B,0xFE,0x2E,0x3C,0x6B,
+0xFE,0x2F,0x3E,0x07,0xFC,0x45,0x49,0xFF,0xD4,0x27,0x3C,0x98,0x05,0x6A,0x3C,0x68,
+0x05,0x6B,0x48,0x00,0x02,0xA2,0x3C,0x4D,0xFF,0x0F,0x2E,0x07,0xFC,0x45,0x02,0x12,
+0x00,0x1A,0xE2,0x01,0xE8,0x04,0x8C,0x01,0x3E,0x07,0xFC,0x45,0x3C,0xF7,0xFE,0x30,
+0x3C,0x9B,0xFE,0x2E,0xE1,0x2F,0x3C,0x6B,0xFE,0x2F,0xE8,0x04,0x3C,0x9B,0xFE,0x30,
+0xD5,0x07,0x3C,0x07,0xFE,0x32,0xE0,0x09,0xE8,0x03,0x3C,0x9B,0xFE,0x32,0x3C,0xF7,
+0xFE,0x31,0xE0,0xCF,0xE8,0x04,0x3C,0x6B,0xFE,0x31,0xD5,0x07,0x3C,0x07,0xFE,0x33,
+0xE0,0x06,0xE8,0x03,0x3C,0x6B,0xFE,0x33,0x3C,0x27,0xFE,0x36,0x40,0x01,0x24,0x01,
+0x4E,0x04,0x00,0x03,0xFE,0x02,0x3C,0x17,0xFE,0x37,0x9A,0xCE,0x4E,0x34,0x00,0x03,
+0xFE,0xDA,0xA5,0x65,0x40,0xF1,0x80,0x00,0xE2,0xAF,0x4E,0xF2,0x02,0x66,0xA5,0x66,
+0xE2,0x05,0x4E,0xF3,0x02,0x62,0xA5,0x27,0xE2,0x64,0x4E,0xF3,0x02,0x5E,0xE0,0x49,
+0x2E,0x87,0xFC,0x7C,0xE8,0x05,0x58,0x54,0x00,0x02,0x84,0x80,0xD5,0x04,0x54,0x54,
+0x00,0x01,0x84,0x81,0xE0,0xC1,0xE8,0x04,0x58,0x52,0x80,0x01,0xD5,0x05,0x97,0x4E,
+0x8C,0x81,0x97,0x68,0x97,0x20,0x3C,0xFD,0xFF,0x1C,0x88,0x6F,0x3C,0x3F,0xFF,0x1C,
+0x3C,0x3D,0xFF,0x1D,0x88,0x03,0x3C,0x0F,0xFF,0x1D,0x5A,0x48,0x02,0x0E,0x2E,0x07,
+0xFC,0x7D,0xC8,0x0A,0x84,0x01,0x3E,0x07,0xFC,0x7D,0x3C,0x0D,0xFA,0x69,0x94,0x02,
+0x3C,0x0F,0xFA,0x69,0xD5,0x1E,0x4C,0x54,0x00,0x1D,0x2E,0x07,0xFC,0x7D,0xE6,0x07,
+0xE8,0x18,0x3C,0x3D,0xFA,0x69,0x8C,0x01,0x94,0xDA,0xFE,0xEF,0x96,0x00,0x3C,0x3F,
+0xFA,0x69,0x3E,0x07,0xFC,0x7D,0x3E,0x57,0xFC,0x7C,0x5A,0x00,0x01,0x0B,0x8E,0x01,
+0x94,0x01,0x44,0x31,0xA1,0x94,0x38,0x21,0x81,0x09,0x8C,0x01,0x38,0x11,0x81,0x09,
+0x3C,0x9B,0xFE,0x36,0x3C,0x6B,0xFE,0x37,0x48,0x00,0x02,0x0F,0x2E,0x57,0xFC,0x7D,
+0x3C,0x0D,0xFF,0x0F,0x3C,0x3D,0xFF,0x1C,0x3C,0x2D,0xFF,0x1D,0x3C,0x43,0xFE,0x2E,
+0x3C,0x63,0xFE,0x2F,0xC5,0x0C,0x94,0x69,0x44,0x91,0xA1,0x94,0xE6,0xA3,0x38,0x44,
+0x85,0x09,0x8C,0x21,0x38,0x64,0x85,0x09,0xE8,0x53,0xD5,0x05,0x3C,0x48,0x05,0x6C,
+0x3C,0x68,0x05,0x6D,0x3C,0x57,0xFE,0x34,0x02,0x10,0x00,0x0C,0xE0,0xA1,0xE9,0x46,
+0x02,0x10,0x00,0x0D,0xE0,0x25,0xE9,0x42,0x3C,0x17,0xFE,0x35,0x02,0x60,0x00,0x0E,
+0xE0,0x26,0xE9,0x3C,0x02,0x60,0x00,0x0F,0xE0,0xC1,0xE9,0x38,0x3C,0x67,0xFE,0x2F,
+0x02,0x90,0x00,0x0B,0x9A,0x71,0x52,0xF4,0x80,0x00,0xE0,0x2F,0xE8,0x07,0x02,0x10,
+0x00,0x0A,0xE2,0x41,0x84,0x29,0xE9,0x1F,0xD5,0x08,0xE1,0x21,0xE8,0x06,0x02,0x10,
+0x00,0x0A,0xE2,0x41,0x84,0x2A,0xE9,0x17,0x3C,0x17,0xFE,0x2E,0x8A,0x25,0x02,0x50,
+0x00,0x08,0x52,0xF2,0x80,0x00,0xE0,0x2F,0xE8,0x07,0x02,0x10,0x00,0x09,0xE2,0x61,
+0x84,0x2B,0xE9,0x09,0xD5,0x0A,0xE0,0xA1,0xE8,0x08,0x02,0x10,0x00,0x09,0xE2,0x61,
+0xE8,0x04,0x84,0x2C,0x3E,0x17,0xE9,0xA8,0x2E,0x17,0xE9,0xA8,0x5A,0x10,0xAA,0x09,
+0x3C,0x48,0x05,0x6C,0x3C,0x68,0x05,0x6D,0xD5,0x03,0x84,0x22,0xAE,0x7A,0x02,0x10,
+0x00,0x10,0x88,0x43,0xE2,0x22,0x4E,0xF2,0x01,0x15,0x2E,0x17,0xE9,0xA8,0x5A,0x10,
+0xAA,0x04,0x48,0x00,0x01,0x0F,0x3C,0x17,0xFE,0x34,0x02,0x20,0x00,0x11,0xE0,0x22,
+0x4E,0xF3,0x01,0x06,0x02,0x20,0x00,0x12,0xE0,0x41,0x4E,0xF3,0x01,0x01,0x3C,0x17,
+0xFE,0x35,0x02,0x20,0x00,0x13,0xE0,0x22,0x4E,0xF3,0x00,0xFA,0x02,0x00,0x00,0x14,
+0xE0,0x01,0x4E,0xF3,0x00,0xF5,0x44,0x01,0x80,0x6C,0x3C,0x1D,0xFA,0x69,0x44,0x20,
+0x00,0x3F,0x49,0xFF,0xD2,0x8D,0x5A,0x0F,0xFF,0x04,0x48,0x00,0x00,0xE4,0x44,0x10,
+0xB1,0x1C,0x38,0x00,0x80,0x00,0x3C,0x1D,0xFF,0x0F,0x3E,0x07,0xE9,0xA8,0x5A,0x08,
+0x21,0x20,0x3C,0x27,0xFE,0x2F,0x3C,0x07,0xFE,0x35,0xE0,0x40,0xE8,0x03,0x84,0x06,
+0xD5,0x7D,0x8A,0x02,0x4E,0x04,0x00,0x03,0xFE,0x02,0x44,0x30,0x00,0x64,0x42,0x20,
+0x0C,0x24,0x3C,0xF7,0xFE,0x31,0x3C,0x07,0xFE,0x33,0x8A,0x0F,0x40,0x01,0x00,0x16,
+0x00,0x20,0x80,0x2B,0x96,0x03,0xE0,0x40,0x84,0x00,0xE9,0x68,0xD5,0xE9,0x5A,0x08,
+0x22,0x36,0x3C,0x27,0xFE,0x2E,0x3C,0x07,0xFE,0x34,0xE0,0x40,0xE9,0xE1,0x8A,0x02,
+0x4E,0x04,0x00,0x03,0xFE,0x02,0x44,0x30,0x00,0x64,0x42,0x20,0x0C,0x24,0x3C,0xF7,
+0xFE,0x30,0x3C,0x07,0xFE,0x32,0x8A,0x0F,0x40,0x01,0x00,0x16,0x00,0x20,0x80,0x2D,
+0x96,0x03,0xE0,0x40,0xE9,0x19,0x3C,0x07,0xFE,0x35,0x3C,0x27,0xFE,0x2F,0x8A,0x02,
+0x4E,0x04,0x00,0x03,0xFE,0x02,0x44,0x30,0x00,0x64,0x42,0x20,0x0C,0x24,0x3C,0xF7,
+0xFE,0x31,0x3C,0x07,0xFE,0x33,0x8A,0x0F,0x40,0x01,0x00,0x16,0x00,0x20,0x80,0x2E,
+0x96,0x03,0xE0,0x40,0xE8,0xB5,0x84,0x07,0xD5,0x31,0x5A,0x00,0x02,0x04,0x5A,0x08,
+0x15,0x30,0x3C,0x07,0xFE,0x31,0x3C,0x47,0xFE,0x33,0x3C,0xF7,0xFE,0x30,0x8A,0x80,
+0x3C,0x07,0xFE,0x32,0x8A,0x0F,0x4E,0x04,0x00,0x03,0xFE,0x02,0x44,0x20,0x00,0x64,
+0xFE,0x14,0x00,0x30,0x80,0x30,0x40,0x00,0x10,0x16,0x96,0x03,0xFE,0x9C,0xE0,0x40,
+0xE9,0x13,0x3C,0x07,0xFE,0x35,0x3C,0x27,0xFE,0x2F,0x9A,0x82,0x4E,0x24,0x00,0x03,
+0xFE,0x92,0x44,0x30,0x00,0x64,0xFE,0x9C,0x40,0x01,0x10,0x16,0x00,0x20,0x80,0x2F,
+0x96,0x03,0xE0,0x40,0xE8,0x05,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xE9,0xA8,0x2E,0x07,
+0xE9,0xA8,0xC0,0x04,0x8E,0x13,0xE6,0x02,0xE8,0x2F,0x3C,0x07,0xFE,0x30,0x3C,0x47,
+0xFE,0x32,0x3C,0xF7,0xFE,0x31,0x8A,0x80,0x3C,0x07,0xFE,0x33,0x8A,0x0F,0x4E,0x04,
+0x00,0x03,0xFE,0x02,0x44,0x20,0x00,0x64,0xFE,0x14,0x00,0x30,0x80,0x2C,0x40,0x00,
+0x10,0x16,0x96,0x03,0xFE,0x9C,0xE0,0x40,0xE9,0x13,0x3C,0x07,0xFE,0x34,0x3C,0x27,
+0xFE,0x2E,0x9A,0x82,0x4E,0x24,0x00,0x03,0xFE,0x92,0x44,0x30,0x00,0x64,0xFE,0x9C,
+0x40,0x01,0x10,0x16,0x00,0x10,0x80,0x2A,0x96,0x03,0xE0,0x20,0xE8,0x05,0x44,0x0F,
+0xFF,0xAA,0x3E,0x07,0xE9,0xA8,0x2E,0x07,0xE9,0xA8,0x5A,0x08,0x06,0x23,0x3C,0x07,
+0xFE,0x34,0x3C,0x17,0xFE,0x2E,0x9A,0x41,0x4E,0x14,0x00,0x03,0xFE,0x4A,0x3C,0x07,
+0xFE,0x35,0x3C,0x27,0xFE,0x2F,0x8A,0x02,0x4E,0x04,0x00,0x03,0xFE,0x02,0x98,0x88,
+0x5E,0xF1,0x02,0x77,0xE8,0x07,0x5E,0xF0,0x81,0xC3,0xE8,0x04,0x5E,0xF0,0x01,0xC3,
+0xE9,0x08,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xE9,0xA8,0xD5,0x03,0x84,0x02,0xAE,0x3A,
+0x2E,0x47,0xE9,0xA8,0x3C,0x3D,0xFF,0x0F,0x5C,0xF2,0x00,0x20,0xE8,0x11,0xA4,0x18,
+0xA4,0x99,0x40,0x00,0x40,0x08,0x40,0x10,0x08,0x04,0x52,0x02,0x00,0x1F,0x40,0x00,
+0x80,0x0E,0x96,0x06,0xC8,0x05,0x44,0x0F,0xFF,0xAA,0x3E,0x07,0xE9,0xA8,0xA4,0x18,
+0x92,0x0C,0x96,0x06,0xC0,0x71,0x2E,0x07,0xE9,0xA8,0x5A,0x00,0x03,0x65,0x3C,0x0D,
+0xFA,0x69,0x5A,0x08,0x01,0x58,0x3C,0x07,0xFE,0x2F,0x02,0x11,0x80,0x1E,0xE0,0x01,
+0xE9,0x55,0x02,0x11,0x80,0x1F,0xE0,0x20,0xE9,0x51,0x3C,0x17,0xFE,0x2E,0x02,0x21,
+0x80,0x1C,0xE0,0x22,0xE9,0x4B,0x02,0x21,0x80,0x1D,0xE0,0x41,0xE9,0x47,0x2E,0x47,
+0xFC,0x45,0x02,0x21,0x80,0x1A,0xE2,0x82,0xE8,0x3D,0x3C,0x27,0xFE,0x34,0x02,0x41,
+0x80,0x19,0x9A,0x8A,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE0,0x44,0xE8,0x33,0x3C,0x27,
+0xFE,0x35,0x9A,0x82,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE0,0x44,0xE8,0x2B,0x2E,0x27,
+0xFC,0x46,0xCA,0x05,0x84,0x41,0x3E,0x27,0xFC,0x46,0xD5,0x1F,0x3C,0x27,0xFE,0x20,
+0x9A,0x8A,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE0,0x44,0xE8,0x17,0x3C,0x27,0xFE,0x21,
+0x9A,0x82,0x4E,0x24,0x00,0x03,0xFE,0x92,0xE0,0x44,0xE8,0x0F,0x2E,0x47,0xFC,0x44,
+0x02,0x21,0x80,0x1B,0xE2,0x82,0xE8,0x09,0x84,0x43,0x3E,0x27,0xE9,0xA8,0x3C,0x18,
+0x05,0x6C,0x3C,0x08,0x05,0x6D,0xD5,0x0F,0x3C,0x1B,0xFE,0x20,0x3C,0x0B,0xFE,0x21,
+0xD5,0x0A,0x84,0x00,0x3E,0x07,0xFC,0x46,0xD5,0x06,0x84,0x00,0x3E,0x07,0xFC,0x46,
+0x84,0x02,0xAE,0x3A,0x84,0x00,0x3E,0x07,0xFC,0x44,0xD5,0x06,0x3E,0x17,0xFC,0x46,
+0xD5,0x03,0x3E,0x17,0xFC,0x7E,0x3C,0x2D,0xFF,0x0F,0x3C,0x03,0xFE,0x3C,0x84,0x20,
+0xA4,0x94,0x3E,0x17,0xFC,0x7F,0xE2,0x02,0xE8,0x10,0x8C,0x01,0x3C,0x0B,0xFE,0x3C,
+0x2E,0x07,0xFC,0x46,0x5A,0x08,0x01,0x1C,0x4E,0xA3,0x00,0x1A,0x2E,0x07,0xFC,0x44,
+0x8C,0x01,0x3E,0x07,0xFC,0x44,0xD5,0x13,0x44,0x0F,0xFF,0xAA,0x3E,0x17,0xFC,0x7E,
+0x3E,0x07,0xE9,0xA8,0x3E,0x17,0xFC,0x46,0x4E,0xA2,0x00,0x0A,0x84,0x01,0x3E,0x07,
+0xFC,0x7F,0x84,0x04,0xAE,0x3A,0x84,0x05,0x3E,0x07,0xFC,0x7E,0x2E,0x07,0xFC,0x47,
+0xC0,0x0A,0xFA,0x06,0x3E,0x07,0xE9,0xA8,0x84,0x00,0x3E,0x07,0xFC,0x47,0x84,0x00,
+0x3C,0x0B,0xFE,0x24,0x2E,0x67,0xE9,0xA8,0x9E,0x35,0xE6,0x02,0xE9,0x03,0x5A,0x68,
+0x01,0x47,0x2E,0x07,0xFC,0x7D,0x44,0x91,0xA1,0x94,0x94,0x01,0x38,0xA4,0x81,0x01,
+0x8C,0x01,0x38,0x84,0x81,0x01,0x84,0x00,0x49,0xFF,0xD1,0x40,0x84,0x01,0x49,0xFF,
+0xD1,0x3D,0x84,0x02,0x49,0xFF,0xD1,0x3A,0x84,0x03,0x49,0xFF,0xD1,0x37,0x80,0x89,
+0x5A,0x68,0x06,0x20,0x84,0x00,0x44,0x21,0x9B,0xB8,0x98,0x60,0x38,0x31,0x00,0x01,
+0xAC,0xCA,0x98,0xC2,0x8C,0x04,0xA4,0xD9,0xAC,0xCB,0x5A,0x08,0x10,0xF8,0x3C,0x0D,
+0xFA,0x69,0x2E,0x17,0xFC,0x7D,0x3C,0xA8,0x05,0x74,0x3C,0x88,0x05,0x75,0x49,0xFF,
+0xD0,0xF7,0x40,0x00,0x20,0x08,0x58,0x00,0x00,0xFF,0x3C,0x08,0x05,0x7D,0xD5,0x12,
+0x5A,0x68,0x05,0x05,0x3C,0x00,0x02,0x7D,0xD5,0x05,0x5A,0x68,0x01,0x09,0x3C,0x00,
+0x02,0x81,0x3C,0x08,0x05,0x6D,0x3C,0x08,0x05,0x71,0xD5,0x04,0x5C,0xF3,0x00,0x20,
+0xE8,0x1A,0x50,0x23,0x00,0x0C,0x96,0x90,0x84,0x01,0xE6,0x5F,0xAE,0x38,0xAE,0xB9,
+0x84,0x01,0xE9,0x03,0xFA,0x2E,0xD5,0x02,0x80,0x22,0x49,0xFF,0xAB,0x33,0x84,0x03,
+0x49,0xFF,0xAB,0x36,0x84,0x00,0x3E,0x07,0xFC,0x7E,0x44,0x0F,0xFF,0xAA,0x3E,0x07,
+0xE9,0xA8,0xD5,0x03,0x84,0x00,0xAE,0x38,0xFC,0xC1,0x00,0x00,0x00,0x00,0x00,0x00,
+0x64,0xB1,0x00,0x00,0xBC,0x09,0x00,0x00,0x14,0xB2,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x6C,0x01,0x00,0x5E,0x09,0x00,0x00,0xD0,0xBB,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x76,0x01,0x00,0x8C,0x09,0x00,0x00,0x2E,0xC5,0x00,0x00,0x00,0x00,0x00,0x00,
+0x03,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x00,0x00,0x00,0xFF,0xFF,0xFF,0xFF,
+0x00,0x00,0x00,0x00,0x0A,0x0A,0x0A,0x0A,0x0B,0x0B,0x0B,0x0B,0x00,0x0A,0x0B,0x01,
+0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x00,0x0A,0x0B,0x00,0x03,0x00,0x00,0x00,
+0x07,0x00,0x00,0x00,0x01,0x00,0x00,0x00,0xAA,0x00,0x00,0x00,0x11,0x00,0x12,0x00,
+0x14,0x00,0x17,0x00,0x18,0x00,0x1B,0x00,0x1D,0x00,0x1E,0x00,0x48,0x00,0x4B,0x00,
+0x52,0x00,0x5E,0x00,0x62,0x00,0x63,0x00,0x72,0x00,0x73,0x00,0x1E,0x01,0x21,0x01,
+0x2D,0x01,0x3B,0x01,0x48,0x01,0x4B,0x01,0x6C,0x01,0x78,0x01,0x87,0x01,0x8B,0x01,
+0x92,0x01,0x9B,0x01,0xB2,0x01,0xB3,0x01,0xB4,0x01,0xBB,0x01,0xCB,0x01,0xD2,0x01,
+0xE1,0x01,0xE2,0x01,0xE3,0x01,0xEE,0x01,0x78,0x04,0xB4,0x04,0xBB,0x04,0xED,0x04,
+0x21,0x05,0x2D,0x05,0xE1,0x05,0xEE,0x05,0x1E,0x06,0x4B,0x06,0x6D,0x06,0xCB,0x06,
+0xD2,0x06,0xE2,0x06,0xE3,0x06,0xED,0x06,0x4B,0x07,0x87,0x07,0x8B,0x07,0xB8,0x07,
+0xED,0x12,0xB8,0x17,0x4B,0x1B,0x6D,0x1B,0x8B,0x1B,0x00,0x00,0xFF,0xFF,0xFF,0xFF,
+0x00,0x01,0x02,0x00,0x40,0x40,0xC8,0x00,0xFF,0xFF,0xFE,0xFF,0xFE,0xFF,0xFE,0xFF,
+0xFF,0xFF,0xFE,0xFF,0x02,0x00,0x04,0x00,0x02,0x00,0xFE,0xFF,0xFE,0xFF,0x04,0x00,
+0x04,0x00,0x04,0x00,0xFE,0xFF,0xFE,0xFF,0x02,0x00,0x04,0x00,0x02,0x00,0xFE,0xFF,
+0xFF,0xFF,0xFE,0xFF,0xFE,0xFF,0xFE,0xFF,0xFF,0xFF,0x00,0x00,0x08,0x14,0x34,0x44,
+0x54,0x64,0x74,0x84,0x94,0xA4,0x00,0x00,0x04,0x10,0x30,0x40,0x50,0x60,0x70,0x80,
+0x90,0xA0,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x08,0x48,0x04,0x4E,0x0C,0x50,0xAC,0x5D,0x40,0xAD,0x20,0x06,0xA4,0x98,0x83,0x12,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x30,0x00,0x11,
+0x64,0x48,0xA4,0x55,0x14,0x59,0x8C,0x59,0x78,0x4D,0x60,0x0E,0x00,0x00,0x10,0x00,
+0x69,0x2D,0xB4,0xC4,0x2D,0xB4,0x00,0x11,0x03,0x03,0x00,0x02,0x03,0x03,0x03,0x03,
+0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,0x03,0x03,0x03,0x03,
+0x01,0x01,0x01,0x01,0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x02,0x54,0x41,0x3B,0x09,
+0xD7,0x07,0x1E,0x18,0x0D,0x06,0xEE,0x00,0x09,0x09,0x00,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x00,0x00,0x03,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x01,0x01,0x04,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x02,0x02,0x05,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x03,0x03,0x06,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x04,0x04,0x07,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x05,0x05,0x08,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x06,0x06,0x09,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x07,0x07,0x0A,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x08,0x08,0x0B,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x09,0x09,0x01,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x8E,
+0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,
+0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x09,0x09,0x02,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,
+0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x09,0x09,0x02,0x00,0x00,0x00,0x0C,0xF8,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x3A,0x49,0x3B,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x47,0x07,0xB3,0x03,
+0x47,0x07,0xB3,0x03,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x04,0x00,0x22,0x60,0x4E,0xC4,0x4E,
+0x1C,0x4F,0xB4,0x4F,0x28,0x4F,0xF0,0x1D,0xD0,0x43,0x10,0x00,0x69,0x2D,0xB4,0x04,
+0x2D,0xB4,0x00,0x22,0x03,0x03,0x00,0x02,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,
+0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,0x03,0x03,0x03,0x03,0x01,0x01,0x01,0x01,
+0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x02,0x54,0x41,0x3B,0x09,0xD7,0x07,0x1E,0x18,
+0x0D,0x06,0xEE,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x04,0x78,0x00,0x00,0x00,0x00,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x11,0x54,0xC8,0x00,0x3D,0x82,0xFC,0x00,0x32,0x74,0xD8,0x00,
+0x2B,0x6C,0xF4,0x00,0x2C,0x58,0xE8,0x00,0x30,0x6A,0xEC,0x00,0x32,0x66,0xF8,0x00,
+0x30,0x6A,0xF4,0x00,0x2F,0x66,0xE4,0x00,0x38,0x5A,0xE8,0x00,0x39,0x68,0x40,0x01,
+0x11,0x50,0xA4,0x00,0x41,0x76,0xAC,0x00,0x4D,0x64,0xC0,0x00,0x40,0x58,0xB8,0x00,
+0x3A,0x60,0xC8,0x00,0x36,0x4E,0xAC,0x00,0x41,0x60,0xD8,0x00,0x36,0x60,0xAC,0x00,
+0x38,0x50,0xD4,0x00,0x31,0x62,0xB4,0x00,0x39,0x66,0x08,0x01,0x92,0x24,0x49,0x02,
+0x92,0x24,0x49,0x02,0xDB,0xFF,0x3F,0x00,0x3A,0x49,0x3B,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x47,0x07,0xB3,0x03,
+0x47,0x07,0xB3,0x03,0x3F,0xF8,0xD0,0x03,0x3C,0xEC,0xA0,0x03,0x39,0xE0,0x70,0x03,
+0x36,0xD4,0x40,0x03,0x33,0xC8,0x10,0x03,0x30,0xBC,0xE0,0x02,0x2D,0xB0,0xB0,0x02,
+0x2A,0xA4,0x80,0x02,0x27,0x98,0x50,0x02,0x24,0x8C,0x20,0x02,0x21,0x80,0xF0,0x00,
+0x00,0x04,0x20,0x00,0x03,0x10,0x50,0x00,0x06,0x1C,0x80,0x00,0x09,0x28,0xB0,0x00,
+0x0C,0x34,0xE0,0x00,0x0F,0x40,0x10,0x01,0x12,0x4C,0x40,0x01,0x15,0x58,0x70,0x01,
+0x18,0x64,0xA0,0x01,0x1B,0x70,0xD0,0x01,0x1E,0x7C,0xF0,0x3F,0x40,0xAD,0x20,0x06,
+0xA4,0x98,0x83,0x12,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x30,0x00,0x33,0x68,0x50,0xA4,0x55,0x14,0x59,0x8C,0x59,0x18,0x55,0x60,0x0E,
+0x00,0x00,0x10,0x00,0x69,0x2D,0xB4,0xC4,0x2D,0xB4,0x00,0x33,0x03,0x03,0x00,0x02,
+0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,
+0x03,0x03,0x03,0x03,0x01,0x01,0x01,0x01,0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x02,
+0x54,0x41,0x3B,0x09,0xD7,0x07,0x1E,0x18,0xEE,0x00,0xEE,0x00,0x09,0x09,0x00,0x00,
+0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,
+0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,
+0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xE1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,
+0x00,0x00,0x03,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0xEE,0x00,0xEE,0x00,0x01,0x01,0x04,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,0x02,0x02,0x05,0x00,0x00,0x00,0x50,0x7E,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,0x03,0x03,0x06,0x00,
+0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,
+0x04,0x04,0x07,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0xEE,0x00,0xEE,0x00,0x05,0x05,0x08,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,0x06,0x06,0x09,0x00,0x00,0x00,0x50,0x7E,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,0x07,0x07,0x0A,0x00,
+0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,
+0x08,0x08,0x0B,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xCE,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0xEE,0x00,0xEE,0x00,0x09,0x09,0x01,0x00,0x00,0x00,0x50,0x7E,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,
+0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0xEE,0x00,0xEE,0x00,0x09,0x09,0x02,0x00,0x00,0x00,0x50,0x7E,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x80,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xCE,0xE1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x3A,0x11,0x0A,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x20,0x81,0x9F,0x00,
+0x20,0x81,0x9F,0x00,0xB4,0x68,0xD1,0x02,0xB4,0x62,0xC1,0x02,0xB2,0x62,0xC9,0x02,
+0xB2,0x62,0xD1,0x02,0xB4,0x64,0xC9,0x02,0xB2,0x62,0xD1,0x02,0xB2,0x62,0xC9,0x02,
+0xB2,0x64,0xD1,0x02,0xAD,0x60,0xC9,0x02,0xB0,0x5E,0xC1,0x02,0xAD,0x5C,0xD9,0x02,
+0xB4,0x68,0xD1,0x02,0xAC,0x50,0x99,0x02,0xA8,0x50,0xA5,0x02,0xA9,0x52,0xA9,0x02,
+0xA9,0x56,0xA9,0x02,0xAD,0x4C,0xA9,0x02,0xAD,0x54,0xB5,0x02,0xAD,0x5C,0xB5,0x02,
+0xAD,0x52,0xA9,0x02,0xAA,0x58,0xAD,0x02,0xAE,0x5C,0xE9,0x02,0xA7,0x4E,0x9D,0x02,
+0xA7,0x4A,0x95,0x02,0xA7,0x4C,0x99,0x02,0xA6,0x4A,0xA5,0x02,0xA8,0x4C,0x99,0x02,
+0xA6,0x4C,0xA1,0x02,0xA6,0x4C,0xA1,0x02,0xA8,0x52,0xA5,0x02,0xA3,0x4C,0xA1,0x02,
+0xA6,0x4A,0x99,0x02,0xA3,0x48,0xB5,0x02,0xA7,0x4E,0x9D,0x02,0xA6,0x44,0x7D,0x02,
+0xA2,0x44,0x8D,0x02,0xA3,0x46,0x91,0x02,0xA3,0x4A,0x91,0x02,0xA6,0x3E,0x89,0x02,
+0xA5,0x44,0x95,0x02,0xA5,0x4E,0x95,0x02,0xA5,0x42,0x8D,0x02,0xA3,0x4C,0x91,0x02,
+0xA6,0x4C,0xB5,0x02,0xA4,0x48,0x91,0x02,0xA4,0x42,0x85,0x02,0xA3,0x44,0x8D,0x02,
+0xA3,0x42,0x95,0x02,0xA4,0x44,0x89,0x02,0xA3,0x44,0x95,0x02,0xA3,0x46,0x95,0x02,
+0xA5,0x4A,0x99,0x02,0x9F,0x46,0x95,0x02,0xA2,0x44,0x8D,0x02,0xA0,0x42,0xA9,0x02,
+0xA4,0x48,0x91,0x02,0xA4,0x40,0x75,0x02,0x9F,0x3E,0x81,0x02,0xA0,0x40,0x85,0x02,
+0xA1,0x44,0x85,0x02,0xA3,0x3A,0x81,0x02,0xA2,0x3E,0x89,0x02,0xA2,0x48,0x89,0x02,
+0xA2,0x3C,0x81,0x02,0xA0,0x46,0x85,0x02,0xA4,0x46,0xA5,0x02,0xA1,0x42,0x85,0x02,
+0xA1,0x3C,0x79,0x02,0xA0,0x3E,0x81,0x02,0xA0,0x3E,0x89,0x02,0xA2,0x40,0x81,0x02,
+0xA0,0x3E,0x89,0x02,0xA0,0x40,0x89,0x02,0xA2,0x44,0x8D,0x02,0x9C,0x40,0x85,0x02,
+0x9F,0x3E,0x81,0x02,0x9D,0x3A,0x99,0x02,0xA1,0x42,0x85,0x02,0xA0,0x38,0x69,0x02,
+0x9C,0x38,0x75,0x02,0x9D,0x3A,0x79,0x02,0x9D,0x3E,0x79,0x02,0xA1,0x34,0x75,0x02,
+0xA0,0x3A,0x81,0x02,0xA0,0x44,0x81,0x02,0xA0,0x38,0x79,0x02,0x9E,0x42,0x79,0x02,
+0xA2,0x42,0x9D,0x02,0x9D,0x3A,0x75,0x02,0x9D,0x34,0x69,0x02,0x9C,0x36,0x71,0x02,
+0x9C,0x34,0x7D,0x02,0x9D,0x36,0x75,0x02,0x9C,0x36,0x79,0x02,0x9B,0x34,0x71,0x02,
+0x99,0x32,0x69,0x02,0x91,0x28,0x59,0x02,0x91,0x20,0x49,0x02,0x8C,0x1A,0x51,0x02,
+0x9D,0x3A,0x75,0x02,0x8E,0x16,0x29,0x02,0x8E,0x1A,0x41,0x02,0x92,0x22,0x4D,0x02,
+0x95,0x2C,0x59,0x02,0x9B,0x28,0x61,0x02,0x9D,0x30,0x71,0x02,0x9C,0x3A,0x71,0x02,
+0x9C,0x30,0x69,0x02,0x9A,0x3A,0x6D,0x02,0x9D,0x3A,0x8D,0x02,0x8A,0x14,0x29,0x02,
+0x8A,0x0E,0x19,0x02,0x87,0x0A,0x15,0x02,0x84,0x04,0x15,0x02,0x86,0x0A,0x19,0x02,
+0x88,0x10,0x31,0x02,0x8B,0x1A,0x3D,0x02,0x8F,0x22,0x4D,0x02,0x8E,0x24,0x55,0x02,
+0x94,0x2A,0x59,0x02,0x95,0x2E,0x81,0x02,0x8A,0x14,0x29,0x02,0x9B,0x2E,0x4D,0x02,
+0x94,0x24,0x4D,0x02,0x91,0x20,0x41,0x02,0x8E,0x1E,0x35,0x02,0x8E,0x0C,0x21,0x02,
+0x8A,0x0A,0x21,0x02,0x86,0x0C,0x11,0x02,0x83,0xFC,0x08,0x02,0x83,0x0C,0x19,0x02,
+0x8A,0x12,0x3D,0x02,0x9A,0x34,0x69,0x02,0x9A,0x30,0x65,0x02,0x9B,0x34,0x6D,0x02,
+0x9B,0x34,0x79,0x02,0x9D,0x36,0x71,0x02,0x9D,0x36,0x79,0x02,0x9D,0x3A,0x79,0x02,
+0x9E,0x3E,0x81,0x02,0x9A,0x3A,0x7D,0x02,0x9D,0x3A,0x79,0x02,0x9B,0x38,0x91,0x02,
+0x9A,0x34,0x69,0x02,0x9F,0x38,0x65,0x02,0x9B,0x36,0x71,0x02,0x9C,0x36,0x71,0x02,
+0x9B,0x3A,0x71,0x02,0x9E,0x2E,0x69,0x02,0x9C,0x32,0x71,0x02,0x9B,0x3A,0x71,0x02,
+0x9B,0x2E,0x65,0x02,0x99,0x36,0x65,0x02,0x9B,0x34,0x81,0x02,0x9E,0x3C,0x79,0x02,
+0x9E,0x38,0x71,0x02,0x9E,0x3A,0x79,0x02,0x9E,0x3A,0x85,0x02,0xA0,0x3C,0x7D,0x02,
+0xA0,0x3C,0x85,0x02,0xA0,0x40,0x89,0x02,0xA2,0x44,0x8D,0x02,0x9D,0x42,0x89,0x02,
+0xA0,0x40,0x85,0x02,0x9E,0x40,0x9D,0x02,0x9E,0x3C,0x79,0x02,0xA3,0x40,0x71,0x02,
+0x9E,0x3C,0x7D,0x02,0x9E,0x3C,0x7D,0x02,0x9E,0x40,0x7D,0x02,0xA1,0x34,0x75,0x02,
+0x9F,0x36,0x79,0x02,0x9E,0x40,0x79,0x02,0x9D,0x34,0x71,0x02,0x9B,0x3C,0x71,0x02,
+0x9E,0x3A,0x89,0x02,0xA2,0x44,0x89,0x02,0xA2,0x3E,0x7D,0x02,0xA1,0x40,0x89,0x02,
+0xA2,0x40,0x91,0x02,0xA4,0x44,0x89,0x02,0xA3,0x44,0x95,0x02,0xA3,0x48,0x95,0x02,
+0xA5,0x4C,0x9D,0x02,0xA0,0x48,0x99,0x02,0xA4,0x48,0x95,0x02,0xA2,0x48,0xB1,0x02,
+0xA2,0x44,0x89,0x02,0xA9,0x4A,0x85,0x02,0xA3,0x44,0x8D,0x02,0xA2,0x44,0x8D,0x02,
+0xA2,0x48,0x89,0x02,0xA5,0x3A,0x81,0x02,0xA2,0x3E,0x89,0x02,0xA2,0x48,0x89,0x02,
+0xA1,0x3A,0x79,0x02,0x9E,0x42,0x79,0x02,0xA1,0x40,0x95,0x02,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0xB6,0x6D,0xDB,0x02,0xB6,0x6D,0xDB,0x02,0x80,0xAA,0x2A,0x00,
+0xB6,0x6D,0x5B,0x06,0xB6,0x6D,0x5B,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6D,0xCB,0x06,
+0xB6,0x6D,0xCB,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6D,0xD9,0x06,0xB6,0x6D,0xD9,0x06,
+0x80,0xAA,0x2A,0x00,0xB6,0x2D,0xDB,0x06,0xB6,0x2D,0xDB,0x06,0x80,0xAA,0x2A,0x00,
+0xB6,0x65,0xDB,0x06,0xB6,0x65,0xDB,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6C,0xDB,0x06,
+0xB6,0x6C,0xDB,0x06,0x80,0xAA,0x2A,0x00,0x96,0x6D,0xDB,0x06,0x96,0x6D,0xDB,0x06,
+0x80,0xAA,0x2A,0x00,0xB2,0x6D,0xDB,0x06,0xB2,0x6D,0xDB,0x06,0x80,0xAA,0x2A,0x00,
+0x92,0x24,0x49,0x02,0x92,0x24,0x49,0x02,0x40,0x55,0x15,0x00,0x57,0x5B,0x5D,0x35,
+0x54,0x4F,0x2D,0x35,0x51,0x43,0xFD,0x34,0x4E,0x37,0xCD,0x34,0x4B,0x2B,0x9D,0x34,
+0x48,0x1F,0x6D,0x34,0x45,0x13,0x3D,0x34,0x42,0x07,0x0D,0x34,0x3F,0xFB,0xDC,0x33,
+0x3C,0xEF,0xAC,0x33,0x39,0xE3,0xFC,0x00,0x18,0x67,0xAC,0x31,0x1B,0x73,0xDC,0x31,
+0x1E,0x7F,0x0C,0x32,0x21,0x8B,0x3C,0x32,0x24,0x97,0x6C,0x32,0x27,0xA3,0x9C,0x32,
+0x2A,0xAF,0xCC,0x32,0x2D,0xBB,0xFC,0x32,0x30,0xC7,0x2C,0x33,0x33,0xD3,0x5C,0x33,
+0x36,0xDF,0xFC,0x3F,0x97,0x5B,0x5E,0x39,0x94,0x4F,0x2E,0x39,0x91,0x43,0xFE,0x38,
+0x8E,0x37,0xCE,0x38,0x8B,0x2B,0x9E,0x38,0x88,0x1F,0x6E,0x38,0x85,0x13,0x3E,0x38,
+0x82,0x07,0x0E,0x38,0x7F,0xFB,0xDD,0x37,0x7C,0xEF,0xAD,0x37,0x79,0xE3,0xFD,0x00,
+0x58,0x67,0xAD,0x35,0x5B,0x73,0xDD,0x35,0x5E,0x7F,0x0D,0x36,0x61,0x8B,0x3D,0x36,
+0x64,0x97,0x6D,0x36,0x67,0xA3,0x9D,0x36,0x6A,0xAF,0xCD,0x36,0x6D,0xBB,0xFD,0x36,
+0x70,0xC7,0x2D,0x37,0x73,0xD3,0x5D,0x37,0x76,0xDF,0xFD,0x3F,0xD7,0x5B,0x5F,0x3D,
+0xD4,0x4F,0x2F,0x3D,0xD1,0x43,0xFF,0x3C,0xCE,0x37,0xCF,0x3C,0xCB,0x2B,0x9F,0x3C,
+0xC8,0x1F,0x6F,0x3C,0xC5,0x13,0x3F,0x3C,0xC2,0x07,0x0F,0x3C,0xBF,0xFB,0xDE,0x3B,
+0xBC,0xEF,0xAE,0x3B,0xB9,0xE3,0xFE,0x00,0x98,0x67,0xAE,0x39,0x9B,0x73,0xDE,0x39,
+0x9E,0x7F,0x0E,0x3A,0xA1,0x8B,0x3E,0x3A,0xA4,0x97,0x6E,0x3A,0xA7,0xA3,0x9E,0x3A,
+0xAA,0xAF,0xCE,0x3A,0xAD,0xBB,0xFE,0x3A,0xB0,0xC7,0x2E,0x3B,0xB3,0xD3,0x5E,0x3B,
+0xB6,0xDF,0xFE,0x3F,0x3F,0xB6,0xB8,0x21,0x09,0xDE,0x57,0x1E,0xD3,0x05,0xF7,0x1A,
+0x9D,0x2D,0x96,0x17,0x67,0x55,0x35,0x14,0x31,0x7D,0xD4,0x10,0xFB,0xA4,0x73,0x0D,
+0xC5,0xCC,0x12,0x0A,0x8F,0xF4,0xB1,0x06,0x59,0x1C,0x51,0x03,0x23,0x44,0xF0,0x00,
+0x00,0x48,0x40,0x02,0x36,0x20,0xA1,0x05,0x6C,0xF8,0x01,0x09,0xA2,0xD0,0x62,0x0C,
+0xD8,0xA8,0xC3,0x0F,0x0E,0x81,0x24,0x13,0x44,0x59,0x85,0x16,0x7A,0x31,0xE6,0x19,
+0xB0,0x09,0x47,0x1D,0xE6,0xE1,0xA7,0x20,0x1C,0xBA,0xF8,0x3F,0x3E,0xB2,0xA8,0x21,
+0x08,0xDA,0x47,0x1E,0xD2,0x01,0xE7,0x1A,0x9C,0x29,0x86,0x17,0x66,0x51,0x25,0x14,
+0x30,0x79,0xC4,0x10,0xFA,0xA0,0x63,0x0D,0xC4,0xC8,0x02,0x0A,0x8E,0xF0,0xA1,0x06,
+0x58,0x18,0x41,0x03,0x22,0x40,0xF0,0x00,0x01,0x4C,0x50,0x02,0x37,0x24,0xB1,0x05,
+0x6D,0xFC,0x11,0x09,0xA3,0xD4,0x72,0x0C,0xD9,0xAC,0xD3,0x0F,0x0F,0x85,0x34,0x13,
+0x45,0x5D,0x95,0x16,0x7B,0x35,0xF6,0x19,0xB1,0x0D,0x57,0x1D,0xE7,0xE5,0xB7,0x20,
+0x1D,0xBE,0xF8,0x3F,0x3D,0xAE,0x98,0x21,0x07,0xD6,0x37,0x1E,0xD1,0xFD,0xD6,0x1A,
+0x9B,0x25,0x76,0x17,0x65,0x4D,0x15,0x14,0x2F,0x75,0xB4,0x10,0xF9,0x9C,0x53,0x0D,
+0xC3,0xC4,0xF2,0x09,0x8D,0xEC,0x91,0x06,0x57,0x14,0x31,0x03,0x21,0x3C,0xF0,0x00,
+0x02,0x50,0x60,0x02,0x38,0x28,0xC1,0x05,0x6E,0x00,0x22,0x09,0xA4,0xD8,0x82,0x0C,
+0xDA,0xB0,0xE3,0x0F,0x10,0x89,0x44,0x13,0x46,0x61,0xA5,0x16,0x7C,0x39,0x06,0x1A,
+0xB2,0x11,0x67,0x1D,0xE8,0xE9,0xC7,0x20,0x1E,0xC2,0xF8,0x3F,0x3C,0xAA,0x88,0x21,
+0x06,0xD2,0x27,0x1E,0xD0,0xF9,0xC6,0x1A,0x9A,0x21,0x66,0x17,0x64,0x49,0x05,0x14,
+0x2E,0x71,0xA4,0x10,0xF8,0x98,0x43,0x0D,0xC2,0xC0,0xE2,0x09,0x8C,0xE8,0x81,0x06,
+0x56,0x10,0x21,0x03,0x20,0x38,0xF0,0x00,0x03,0x54,0x70,0x02,0x39,0x2C,0xD1,0x05,
+0x6F,0x04,0x32,0x09,0xA5,0xDC,0x92,0x0C,0xDB,0xB4,0xF3,0x0F,0x11,0x8D,0x54,0x13,
+0x47,0x65,0xB5,0x16,0x7D,0x3D,0x16,0x1A,0xB3,0x15,0x77,0x1D,0xE9,0xED,0xD7,0x20,
+0x1F,0xC6,0xF8,0x3F,0x3B,0xA6,0x78,0x21,0x05,0xCE,0x17,0x1E,0xCF,0xF5,0xB6,0x1A,
+0x99,0x1D,0x56,0x17,0x63,0x45,0xF5,0x13,0x2D,0x6D,0x94,0x10,0xF7,0x94,0x33,0x0D,
+0xC1,0xBC,0xD2,0x09,0x8B,0xE4,0x71,0x06,0x55,0x0C,0x11,0x03,0x1F,0x34,0xF0,0x00,
+0x04,0x58,0x80,0x02,0x3A,0x30,0xE1,0x05,0x70,0x08,0x42,0x09,0xA6,0xE0,0xA2,0x0C,
+0xDC,0xB8,0x03,0x10,0x12,0x91,0x64,0x13,0x48,0x69,0xC5,0x16,0x7E,0x41,0x26,0x1A,
+0xB4,0x19,0x87,0x1D,0xEA,0xF1,0xE7,0x20,0x20,0xCA,0xF8,0x3F,0x3A,0xA2,0x68,0x21,
+0x04,0xCA,0x07,0x1E,0xCE,0xF1,0xA6,0x1A,0x98,0x19,0x46,0x17,0x62,0x41,0xE5,0x13,
+0x2C,0x69,0x84,0x10,0xF6,0x90,0x23,0x0D,0xC0,0xB8,0xC2,0x09,0x8A,0xE0,0x61,0x06,
+0x54,0x08,0x01,0x03,0x1E,0x30,0xF0,0x00,0x05,0x5C,0x90,0x02,0x3B,0x34,0xF1,0x05,
+0x71,0x0C,0x52,0x09,0xA7,0xE4,0xB2,0x0C,0xDD,0xBC,0x13,0x10,0x13,0x95,0x74,0x13,
+0x49,0x6D,0xD5,0x16,0x7F,0x45,0x36,0x1A,0xB5,0x1D,0x97,0x1D,0xEB,0xF5,0xF7,0x20,
+0x21,0xCE,0xF8,0x3F,0x39,0x9E,0x58,0x21,0x03,0xC6,0xF7,0x1D,0xCD,0xED,0x96,0x1A,
+0x97,0x15,0x36,0x17,0x61,0x3D,0xD5,0x13,0x2B,0x65,0x74,0x10,0xF5,0x8C,0x13,0x0D,
+0xBF,0xB4,0xB2,0x09,0x89,0xDC,0x51,0x06,0x53,0x04,0xF1,0x02,0x1D,0x2C,0xF0,0x00,
+0x06,0x60,0xA0,0x02,0x3C,0x38,0x01,0x06,0x72,0x10,0x62,0x09,0xA8,0xE8,0xC2,0x0C,
+0xDE,0xC0,0x23,0x10,0x14,0x99,0x84,0x13,0x4A,0x71,0xE5,0x16,0x80,0x49,0x46,0x1A,
+0xB6,0x21,0xA7,0x1D,0xEC,0xF9,0x07,0x21,0x22,0xD2,0xF8,0x3F,0x38,0x9A,0x48,0x21,
+0x02,0xC2,0xE7,0x1D,0xCC,0xE9,0x86,0x1A,0x96,0x11,0x26,0x17,0x60,0x39,0xC5,0x13,
+0x2A,0x61,0x64,0x10,0xF4,0x88,0x03,0x0D,0xBE,0xB0,0xA2,0x09,0x88,0xD8,0x41,0x06,
+0x52,0x00,0xE1,0x02,0x1C,0x28,0xF0,0x00,0x07,0x64,0xB0,0x02,0x3D,0x3C,0x11,0x06,
+0x73,0x14,0x72,0x09,0xA9,0xEC,0xD2,0x0C,0xDF,0xC4,0x33,0x10,0x15,0x9D,0x94,0x13,
+0x4B,0x75,0xF5,0x16,0x81,0x4D,0x56,0x1A,0xB7,0x25,0xB7,0x1D,0xED,0xFD,0x17,0x21,
+0x23,0xD6,0xF8,0x3F,0x37,0x96,0x38,0x21,0x01,0xBE,0xD7,0x1D,0xCB,0xE5,0x76,0x1A,
+0x95,0x0D,0x16,0x17,0x5F,0x35,0xB5,0x13,0x29,0x5D,0x54,0x10,0xF3,0x84,0xF3,0x0C,
+0xBD,0xAC,0x92,0x09,0x87,0xD4,0x31,0x06,0x51,0xFC,0xD0,0x02,0x1B,0x24,0xF0,0x00,
+0x08,0x68,0xC0,0x02,0x3E,0x40,0x21,0x06,0x74,0x18,0x82,0x09,0xAA,0xF0,0xE2,0x0C,
+0xE0,0xC8,0x43,0x10,0x16,0xA1,0xA4,0x13,0x4C,0x79,0x05,0x17,0x82,0x51,0x66,0x1A,
+0xB8,0x29,0xC7,0x1D,0xEE,0x01,0x28,0x21,0x24,0xDA,0xF8,0x3F,0x40,0xAD,0x20,0x06,
+0xA4,0x98,0x83,0x12,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x30,0x00,0x44,0x08,0x5E,0xB8,0x62,0x28,0x66,0x2C,0x67,0xA0,0x66,0x60,0x0E,
+0x00,0x00,0x10,0x00,0x69,0x2D,0xB4,0x04,0x2D,0xB4,0x00,0x44,0x03,0x03,0x00,0x02,
+0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,
+0x03,0x03,0x03,0x03,0x01,0x01,0x01,0x01,0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x02,
+0x54,0x41,0x27,0x13,0xD7,0x07,0x1E,0x18,0x0D,0x06,0xEE,0x00,0x09,0x09,0x00,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,
+0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,
+0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xDC,0xE1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x00,0x00,0x03,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x01,0x01,0x04,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x02,0x02,0x05,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x03,0x03,0x06,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x04,0x04,0x07,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x05,0x05,0x08,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x06,0x06,0x09,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,
+0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x07,0x07,0x0A,0x00,
+0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,
+0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0x82,
+0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,
+0x08,0x08,0x0B,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,
+0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0x82,0x01,0x08,0x00,0x28,0x00,0x00,0x00,0x28,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xDC,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x0D,0x06,0xEE,0x00,0x09,0x09,0x01,0x00,0x00,0x00,0x0C,0x78,0x00,0x00,0x00,0x20,
+0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,0x01,0x08,0x00,0x03,
+0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2A,
+0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xE1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x0D,0x06,0xEE,0x00,0x09,0x09,0x02,0x00,0x00,0x00,0x0C,0x78,
+0x00,0x00,0x00,0x20,0x60,0x00,0x01,0x00,0x01,0x08,0x80,0x81,0x01,0x08,0x00,0x00,
+0x01,0x08,0x00,0x03,0x01,0x08,0x00,0x8E,0x01,0x08,0x00,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2A,0x01,0x08,0xC0,0x0E,0x00,0x00,0x00,0x2E,0x01,0x08,0x00,0x0E,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xDC,0xE1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x11,0x2A,0x58,0x00,0x19,0x30,0x5C,0x00,
+0x17,0x30,0x5C,0x00,0x16,0x2C,0x60,0x00,0x16,0xFC,0x55,0x00,0x16,0x2E,0x5C,0x00,
+0x17,0x2C,0x60,0x00,0x16,0x2E,0x5C,0x00,0x17,0x2C,0x58,0x00,0x16,0x2A,0x5C,0x00,
+0x16,0x2C,0x68,0x00,0x11,0x2A,0x54,0x00,0x19,0x30,0x54,0x00,0x1A,0x2E,0x5C,0x00,
+0x18,0x2C,0x58,0x00,0x18,0x2E,0x5C,0x00,0x18,0x2C,0x58,0x00,0x19,0x2E,0x5C,0x00,
+0x16,0x2E,0x58,0x00,0x18,0x2A,0x58,0x00,0x15,0x2C,0x54,0x00,0x15,0x2A,0x60,0x00,
+0x11,0x2A,0x58,0x00,0x18,0x30,0x58,0x00,0x16,0x2E,0x5C,0x00,0x15,0x2C,0x5C,0x00,
+0x16,0x2C,0x58,0x00,0x15,0x2E,0x5C,0x00,0x17,0x2C,0x5C,0x00,0x15,0x2C,0x54,0x00,
+0x16,0x2C,0x54,0x00,0x16,0x2A,0x58,0x00,0x15,0x2A,0x64,0x00,0x11,0x2A,0x54,0x00,
+0x18,0x2E,0x50,0x00,0x19,0x2C,0x58,0x00,0x18,0x2A,0x54,0x00,0x18,0x2E,0x58,0x00,
+0x17,0x2A,0x54,0x00,0x18,0x2C,0x5C,0x00,0x16,0x2C,0x58,0x00,0x18,0x2A,0x54,0x00,
+0x15,0x2A,0x54,0x00,0x15,0x2A,0x5C,0x00,0x11,0x2A,0x58,0x00,0x18,0x2E,0x58,0x00,
+0x16,0x2E,0x58,0x00,0x15,0x2A,0x5C,0x00,0x15,0x2A,0x58,0x00,0x15,0x2C,0x5C,0x00,
+0x16,0x2A,0x5C,0x00,0x15,0x2C,0x58,0x00,0x16,0x2C,0x54,0x00,0x15,0x28,0x58,0x00,
+0x15,0x2A,0x5C,0x00,0x11,0x2A,0x54,0x00,0x17,0x2E,0x50,0x00,0x19,0x2C,0x58,0x00,
+0x17,0x2A,0x54,0x00,0x17,0x2C,0x58,0x00,0x16,0x2A,0x50,0x00,0x18,0x2C,0x58,0x00,
+0x15,0x2C,0x54,0x00,0x17,0x28,0x54,0x00,0x14,0x2A,0x50,0x00,0x15,0x2A,0x5C,0x00,
+0x11,0x2A,0x58,0x00,0x17,0x2E,0x54,0x00,0x16,0x2E,0x58,0x00,0x15,0x2A,0x58,0x00,
+0x15,0x2A,0x58,0x00,0x15,0x2C,0x58,0x00,0x16,0x2A,0x5C,0x00,0x15,0x2C,0x58,0x00,
+0x15,0x2A,0x50,0x00,0x15,0x28,0x54,0x00,0x14,0x28,0x60,0x00,0x11,0x2A,0x54,0x00,
+0x17,0x2C,0x4C,0x00,0x18,0x2A,0x58,0x00,0x17,0x28,0x54,0x00,0x17,0x2C,0x58,0x00,
+0x16,0x28,0x50,0x00,0x17,0x2A,0x58,0x00,0x15,0x2A,0x54,0x00,0x17,0x28,0x50,0x00,
+0x14,0x2A,0x50,0x00,0x15,0x28,0x58,0x00,0x11,0x2A,0x58,0x00,0x18,0x2E,0x58,0x00,
+0x16,0x2E,0x58,0x00,0x15,0x2A,0x5C,0x00,0x15,0x2A,0x58,0x00,0x15,0x2C,0x58,0x00,
+0x16,0x2A,0x58,0x00,0x15,0x2C,0x54,0x00,0x15,0x2A,0x50,0x00,0x15,0x28,0x54,0x00,
+0x14,0x28,0x60,0x00,0x11,0x2A,0x54,0x00,0x17,0x2C,0x4C,0x00,0x18,0x2A,0x54,0x00,
+0x16,0x28,0x50,0x00,0x16,0x2A,0x54,0x00,0x16,0x28,0x50,0x00,0x17,0x2A,0x58,0x00,
+0x15,0x2A,0x54,0x00,0x16,0x26,0x50,0x00,0x13,0x28,0x4C,0x00,0x14,0x28,0x58,0x00,
+0x11,0x2A,0x58,0x00,0x18,0x30,0x58,0x00,0x16,0x2E,0x5C,0x00,0x15,0x2C,0x5C,0x00,
+0x16,0x2C,0x58,0x00,0x15,0x2C,0x5C,0x00,0x16,0x2A,0x5C,0x00,0x15,0x2C,0x58,0x00,
+0x16,0x2A,0x50,0x00,0x15,0x28,0x58,0x00,0x15,0x28,0x60,0x00,0x11,0x2A,0x54,0x00,
+0x17,0x2C,0x4C,0x00,0x18,0x2A,0x54,0x00,0x16,0x28,0x50,0x00,0x16,0x2A,0x54,0x00,
+0x16,0x28,0x50,0x00,0x17,0x2A,0x54,0x00,0x15,0x2A,0x50,0x00,0x16,0x26,0x50,0x00,
+0x13,0x28,0x4C,0x00,0x14,0x28,0x58,0x00,0x11,0x2A,0x58,0x00,0x19,0x30,0x5C,0x00,
+0x17,0x30,0x5C,0x00,0x16,0x2C,0x60,0x00,0x16,0x2C,0x5C,0x00,0x16,0x2E,0x5C,0x00,
+0x17,0x2C,0x5C,0x00,0x15,0x2E,0x58,0x00,0x16,0x2C,0x54,0x00,0x15,0x28,0x58,0x00,
+0x15,0x2A,0x60,0x00,0x11,0x2A,0x54,0x00,0x18,0x2E,0x50,0x00,0x19,0x2C,0x58,0x00,
+0x17,0x28,0x54,0x00,0x17,0x2C,0x58,0x00,0x16,0x28,0x50,0x00,0x17,0x2A,0x58,0x00,
+0x15,0x2A,0x54,0x00,0x16,0x26,0x50,0x00,0x13,0x28,0x4C,0x00,0x14,0x28,0x58,0x00,
+0x11,0x2A,0x58,0x00,0x19,0x30,0x5C,0x00,0x17,0x30,0x5C,0x00,0x16,0x2C,0x60,0x00,
+0x16,0x2E,0x5C,0x00,0x16,0x2E,0x60,0x00,0x17,0x2C,0x60,0x00,0x16,0x2E,0x5C,0x00,
+0x16,0x2C,0x54,0x00,0x16,0x2A,0x5C,0x00,0x15,0x2A,0x64,0x00,0x11,0x2A,0x54,0x00,
+0x18,0x2E,0x50,0x00,0x19,0x2C,0x58,0x00,0x17,0x2A,0x54,0x00,0x17,0x2C,0x58,0x00,
+0x16,0x2A,0x50,0x00,0x18,0x2A,0x58,0x00,0x15,0x2A,0x54,0x00,0x17,0x28,0x54,0x00,
+0x14,0x2A,0x50,0x00,0x15,0x28,0x5C,0x00,0x11,0x2A,0x58,0x00,0x19,0x32,0x5C,0x00,
+0x17,0x32,0x60,0x00,0x16,0x2E,0x60,0x00,0x17,0x2E,0x60,0x00,0x17,0x30,0x60,0x00,
+0x18,0x2E,0x64,0x00,0x17,0x30,0x5C,0x00,0x17,0x2E,0x58,0x00,0x17,0x2C,0x5C,0x00,
+0x16,0x2C,0x68,0x00,0x11,0x2A,0x54,0x00,0x1A,0x30,0x54,0x00,0x1A,0x2E,0x5C,0x00,
+0x18,0x2A,0x58,0x00,0x18,0x2E,0x5C,0x00,0x17,0x2A,0x54,0x00,0x18,0x2C,0x5C,0x00,
+0x16,0x2C,0x58,0x00,0x17,0x28,0x54,0x00,0x14,0x2A,0x50,0x00,0x15,0x2A,0x5C,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,
+0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0xB6,0x6D,0xDB,0x02,0xB6,0x6D,0xDB,0x02,
+0x80,0xAA,0x2A,0x00,0xB6,0x6D,0x5B,0x06,0xB6,0x6D,0x5B,0x06,0x80,0xAA,0x2A,0x00,
+0xB6,0x6D,0xCB,0x06,0xB6,0x6D,0xCB,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6D,0xD9,0x06,
+0xB6,0x6D,0xD9,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x2D,0xDB,0x06,0xB6,0x2D,0xDB,0x06,
+0x80,0xAA,0x2A,0x00,0xB6,0x65,0xDB,0x06,0xB6,0x65,0xDB,0x06,0x80,0xAA,0x2A,0x00,
+0xB6,0x6C,0xDB,0x06,0xB6,0x6C,0xDB,0x06,0x80,0xAA,0x2A,0x00,0x96,0x6D,0xDB,0x06,
+0x96,0x6D,0xDB,0x06,0x80,0xAA,0x2A,0x00,0xB2,0x6D,0xDB,0x06,0xB2,0x6D,0xDB,0x06,
+0x80,0xAA,0x2A,0x00,0x92,0x24,0x49,0x02,0x92,0x24,0x49,0x02,0x40,0x55,0x15,0x00,
+0x3A,0x49,0x3B,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x47,0x07,0xB3,0x03,0x47,0x07,0xB3,0x03,0x57,0x5B,0x5D,0x35,
+0x54,0x4F,0x2D,0x35,0x51,0x43,0xFD,0x34,0x4E,0x37,0xCD,0x34,0x4B,0x2B,0x9D,0x34,
+0x48,0x1F,0x6D,0x34,0x45,0x13,0x3D,0x34,0x42,0x07,0x0D,0x34,0x3F,0xFB,0xDC,0x33,
+0x3C,0xEF,0xAC,0x33,0x39,0xE3,0xFC,0x00,0x18,0x67,0xAC,0x31,0x1B,0x73,0xDC,0x31,
+0x1E,0x7F,0x0C,0x32,0x21,0x8B,0x3C,0x32,0x24,0x97,0x6C,0x32,0x27,0xA3,0x9C,0x32,
+0x2A,0xAF,0xCC,0x32,0x2D,0xBB,0xFC,0x32,0x30,0xC7,0x2C,0x33,0x33,0xD3,0x5C,0x33,
+0x36,0xDF,0xFC,0x3F,0x97,0x5B,0x5E,0x39,0x94,0x4F,0x2E,0x39,0x91,0x43,0xFE,0x38,
+0x8E,0x37,0xCE,0x38,0x8B,0x2B,0x9E,0x38,0x88,0x1F,0x6E,0x38,0x85,0x13,0x3E,0x38,
+0x82,0x07,0x0E,0x38,0x7F,0xFB,0xDD,0x37,0x7C,0xEF,0xAD,0x37,0x79,0xE3,0xFD,0x00,
+0x58,0x67,0xAD,0x35,0x5B,0x73,0xDD,0x35,0x5E,0x7F,0x0D,0x36,0x61,0x8B,0x3D,0x36,
+0x64,0x97,0x6D,0x36,0x67,0xA3,0x9D,0x36,0x6A,0xAF,0xCD,0x36,0x6D,0xBB,0xFD,0x36,
+0x70,0xC7,0x2D,0x37,0x73,0xD3,0x5D,0x37,0x76,0xDF,0xFD,0x3F,0xD7,0x5B,0x5F,0x3D,
+0xD4,0x4F,0x2F,0x3D,0xD1,0x43,0xFF,0x3C,0xCE,0x37,0xCF,0x3C,0xCB,0x2B,0x9F,0x3C,
+0xC8,0x1F,0x6F,0x3C,0xC5,0x13,0x3F,0x3C,0xC2,0x07,0x0F,0x3C,0xBF,0xFB,0xDE,0x3B,
+0xBC,0xEF,0xAE,0x3B,0xB9,0xE3,0xFE,0x00,0x98,0x67,0xAE,0x39,0x9B,0x73,0xDE,0x39,
+0x9E,0x7F,0x0E,0x3A,0xA1,0x8B,0x3E,0x3A,0xA4,0x97,0x6E,0x3A,0xA7,0xA3,0x9E,0x3A,
+0xAA,0xAF,0xCE,0x3A,0xAD,0xBB,0xFE,0x3A,0xB0,0xC7,0x2E,0x3B,0xB3,0xD3,0x5E,0x3B,
+0xB6,0xDF,0xFE,0x3F,0x3F,0xB6,0xB8,0x21,0x09,0xDE,0x57,0x1E,0xD3,0x05,0xF7,0x1A,
+0x9D,0x2D,0x96,0x17,0x67,0x55,0x35,0x14,0x31,0x7D,0xD4,0x10,0xFB,0xA4,0x73,0x0D,
+0xC5,0xCC,0x12,0x0A,0x8F,0xF4,0xB1,0x06,0x59,0x1C,0x51,0x03,0x23,0x44,0xF0,0x00,
+0x00,0x48,0x40,0x02,0x36,0x20,0xA1,0x05,0x6C,0xF8,0x01,0x09,0xA2,0xD0,0x62,0x0C,
+0xD8,0xA8,0xC3,0x0F,0x0E,0x81,0x24,0x13,0x44,0x59,0x85,0x16,0x7A,0x31,0xE6,0x19,
+0xB0,0x09,0x47,0x1D,0xE6,0xE1,0xA7,0x20,0x1C,0xBA,0xF8,0x3F,0x3E,0xB2,0xA8,0x21,
+0x08,0xDA,0x47,0x1E,0xD2,0x01,0xE7,0x1A,0x9C,0x29,0x86,0x17,0x66,0x51,0x25,0x14,
+0x30,0x79,0xC4,0x10,0xFA,0xA0,0x63,0x0D,0xC4,0xC8,0x02,0x0A,0x8E,0xF0,0xA1,0x06,
+0x58,0x18,0x41,0x03,0x22,0x40,0xF0,0x00,0x01,0x4C,0x50,0x02,0x37,0x24,0xB1,0x05,
+0x6D,0xFC,0x11,0x09,0xA3,0xD4,0x72,0x0C,0xD9,0xAC,0xD3,0x0F,0x0F,0x85,0x34,0x13,
+0x45,0x5D,0x95,0x16,0x7B,0x35,0xF6,0x19,0xB1,0x0D,0x57,0x1D,0xE7,0xE5,0xB7,0x20,
+0x1D,0xBE,0xF8,0x3F,0x3D,0xAE,0x98,0x21,0x07,0xD6,0x37,0x1E,0xD1,0xFD,0xD6,0x1A,
+0x9B,0x25,0x76,0x17,0x65,0x4D,0x15,0x14,0x2F,0x75,0xB4,0x10,0xF9,0x9C,0x53,0x0D,
+0xC3,0xC4,0xF2,0x09,0x8D,0xEC,0x91,0x06,0x57,0x14,0x31,0x03,0x21,0x3C,0xF0,0x00,
+0x02,0x50,0x60,0x02,0x38,0x28,0xC1,0x05,0x6E,0x00,0x22,0x09,0xA4,0xD8,0x82,0x0C,
+0xDA,0xB0,0xE3,0x0F,0x10,0x89,0x44,0x13,0x46,0x61,0xA5,0x16,0x7C,0x39,0x06,0x1A,
+0xB2,0x11,0x67,0x1D,0xE8,0xE9,0xC7,0x20,0x1E,0xC2,0xF8,0x3F,0x3C,0xAA,0x88,0x21,
+0x06,0xD2,0x27,0x1E,0xD0,0xF9,0xC6,0x1A,0x9A,0x21,0x66,0x17,0x64,0x49,0x05,0x14,
+0x2E,0x71,0xA4,0x10,0xF8,0x98,0x43,0x0D,0xC2,0xC0,0xE2,0x09,0x8C,0xE8,0x81,0x06,
+0x56,0x10,0x21,0x03,0x20,0x38,0xF0,0x00,0x03,0x54,0x70,0x02,0x39,0x2C,0xD1,0x05,
+0x6F,0x04,0x32,0x09,0xA5,0xDC,0x92,0x0C,0xDB,0xB4,0xF3,0x0F,0x11,0x8D,0x54,0x13,
+0x47,0x65,0xB5,0x16,0x7D,0x3D,0x16,0x1A,0xB3,0x15,0x77,0x1D,0xE9,0xED,0xD7,0x20,
+0x1F,0xC6,0xF8,0x3F,0x3B,0xA6,0x78,0x21,0x05,0xCE,0x17,0x1E,0xCF,0xF5,0xB6,0x1A,
+0x99,0x1D,0x56,0x17,0x63,0x45,0xF5,0x13,0x2D,0x6D,0x94,0x10,0xF7,0x94,0x33,0x0D,
+0xC1,0xBC,0xD2,0x09,0x8B,0xE4,0x71,0x06,0x55,0x0C,0x11,0x03,0x1F,0x34,0xF0,0x00,
+0x04,0x58,0x80,0x02,0x3A,0x30,0xE1,0x05,0x70,0x08,0x42,0x09,0xA6,0xE0,0xA2,0x0C,
+0xDC,0xB8,0x03,0x10,0x12,0x91,0x64,0x13,0x48,0x69,0xC5,0x16,0x7E,0x41,0x26,0x1A,
+0xB4,0x19,0x87,0x1D,0xEA,0xF1,0xE7,0x20,0x20,0xCA,0xF8,0x3F,0x3A,0xA2,0x68,0x21,
+0x04,0xCA,0x07,0x1E,0xCE,0xF1,0xA6,0x1A,0x98,0x19,0x46,0x17,0x62,0x41,0xE5,0x13,
+0x2C,0x69,0x84,0x10,0xF6,0x90,0x23,0x0D,0xC0,0xB8,0xC2,0x09,0x8A,0xE0,0x61,0x06,
+0x54,0x08,0x01,0x03,0x1E,0x30,0xF0,0x00,0x05,0x5C,0x90,0x02,0x3B,0x34,0xF1,0x05,
+0x71,0x0C,0x52,0x09,0xA7,0xE4,0xB2,0x0C,0xDD,0xBC,0x13,0x10,0x13,0x95,0x74,0x13,
+0x49,0x6D,0xD5,0x16,0x7F,0x45,0x36,0x1A,0xB5,0x1D,0x97,0x1D,0xEB,0xF5,0xF7,0x20,
+0x21,0xCE,0xF8,0x3F,0x39,0x9E,0x58,0x21,0x03,0xC6,0xF7,0x1D,0xCD,0xED,0x96,0x1A,
+0x97,0x15,0x36,0x17,0x61,0x3D,0xD5,0x13,0x2B,0x65,0x74,0x10,0xF5,0x8C,0x13,0x0D,
+0xBF,0xB4,0xB2,0x09,0x89,0xDC,0x51,0x06,0x53,0x04,0xF1,0x02,0x1D,0x2C,0xF0,0x00,
+0x06,0x60,0xA0,0x02,0x3C,0x38,0x01,0x06,0x72,0x10,0x62,0x09,0xA8,0xE8,0xC2,0x0C,
+0xDE,0xC0,0x23,0x10,0x14,0x99,0x84,0x13,0x4A,0x71,0xE5,0x16,0x80,0x49,0x46,0x1A,
+0xB6,0x21,0xA7,0x1D,0xEC,0xF9,0x07,0x21,0x22,0xD2,0xF8,0x3F,0x38,0x9A,0x48,0x21,
+0x02,0xC2,0xE7,0x1D,0xCC,0xE9,0x86,0x1A,0x96,0x11,0x26,0x17,0x60,0x39,0xC5,0x13,
+0x2A,0x61,0x64,0x10,0xF4,0x88,0x03,0x0D,0xBE,0xB0,0xA2,0x09,0x88,0xD8,0x41,0x06,
+0x52,0x00,0xE1,0x02,0x1C,0x28,0xF0,0x00,0x07,0x64,0xB0,0x02,0x3D,0x3C,0x11,0x06,
+0x73,0x14,0x72,0x09,0xA9,0xEC,0xD2,0x0C,0xDF,0xC4,0x33,0x10,0x15,0x9D,0x94,0x13,
+0x4B,0x75,0xF5,0x16,0x81,0x4D,0x56,0x1A,0xB7,0x25,0xB7,0x1D,0xED,0xFD,0x17,0x21,
+0x23,0xD6,0xF8,0x3F,0x37,0x96,0x38,0x21,0x01,0xBE,0xD7,0x1D,0xCB,0xE5,0x76,0x1A,
+0x95,0x0D,0x16,0x17,0x5F,0x35,0xB5,0x13,0x29,0x5D,0x54,0x10,0xF3,0x84,0xF3,0x0C,
+0xBD,0xAC,0x92,0x09,0x87,0xD4,0x31,0x06,0x51,0xFC,0xD0,0x02,0x1B,0x24,0xF0,0x00,
+0x08,0x68,0xC0,0x02,0x3E,0x40,0x21,0x06,0x74,0x18,0x82,0x09,0xAA,0xF0,0xE2,0x0C,
+0xE0,0xC8,0x43,0x10,0x16,0xA1,0xA4,0x13,0x4C,0x79,0x05,0x17,0x82,0x51,0x66,0x1A,
+0xB8,0x29,0xC7,0x1D,0xEE,0x01,0x28,0x21,0x24,0xDA,0xF8,0x3F,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x84,0x5C,0xCC,0x64,0x20,0x88,0x41,0x0A,0xE6,0x20,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x24,0x00,0xAA,0xE0,0x5C,0x64,0x60,
+0xBC,0x60,0xB4,0x61,0x28,0x61,0x60,0x0E,0x00,0x00,0x10,0x00,0x69,0x2D,0xB4,0xC4,
+0x2D,0xB4,0x00,0xAA,0x03,0x03,0x00,0x02,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,
+0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,0x03,0x03,0x03,0x03,0x01,0x01,0x01,0x01,
+0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x22,0x56,0x41,0x27,0x22,0xD7,0x07,0x1E,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xEE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x3F,
+0x01,0x08,0xC0,0x6E,0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x01,0x00,0x00,0x00,0x38,0x7E,
+0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x6E,0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,
+0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x02,0x02,0x00,
+0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,
+0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x6E,0x00,0x00,0xC0,0x2E,
+0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x03,0x03,0x00,0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,
+0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,
+0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x6E,
+0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x04,0x04,0x00,0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,
+0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x05,0x05,0x00,0x00,0x00,0x38,0x7E,
+0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,
+0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,
+0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x06,0x06,0x00,
+0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,
+0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,
+0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x07,0x07,0x00,0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x01,0x00,
+0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0xC0,0xAE,
+0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,0x01,0x08,0xC0,0x2E,
+0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x08,0x08,0x00,0x00,0x00,0x38,0x7E,0x00,0x00,0x00,0x00,
+0x60,0x00,0x01,0x00,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0xC0,0xAE,0x01,0x08,0xC0,0xAE,0x01,0x08,0x80,0x2A,0x00,0x00,0xC0,0x2B,
+0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,0x01,0x08,0xC0,0x2E,0x00,0x00,0xC0,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xFF,0x8E,0xE3,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x24,0x49,0x92,0x02,
+0x22,0x49,0x92,0x04,0x64,0x6A,0x2A,0x00,0x24,0x49,0x52,0x04,0x14,0x49,0x92,0x04,
+0xA4,0xA9,0x29,0x00,0x24,0x49,0x8A,0x04,0xA4,0x48,0x92,0x04,0xA4,0xA6,0x26,0x00,
+0x24,0x49,0x91,0x04,0x24,0x45,0x92,0x04,0xA4,0x9A,0x1A,0x00,0x24,0x29,0x92,0x04,
+0x24,0x29,0x92,0x04,0xA4,0xAA,0x2A,0x00,0x24,0x45,0x92,0x04,0x24,0x49,0x91,0x04,
+0xA4,0xAA,0x2A,0x00,0xA4,0x48,0x92,0x04,0x24,0x49,0x8A,0x04,0xA4,0xAA,0x2A,0x00,
+0x14,0x49,0x92,0x04,0x24,0x49,0x52,0x04,0xA4,0xAA,0x2A,0x00,0x22,0x49,0x92,0x04,
+0x24,0x49,0x92,0x02,0xA4,0xAA,0x2A,0x00,0x3A,0x11,0x0A,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0xF0,0x80,0x9F,0x00,
+0xF0,0x80,0x9F,0x00,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0x3F,0x00,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0x2F,0x00,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0x1F,0x00,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0x0F,0x00,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x00,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x00,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x00,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x00,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x00,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,
+0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0xFF,0xFF,0xFF,0x3F,0x20,0x88,0x41,0x0A,
+0xE6,0x20,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x24,0x00,0xBB,0x28,0x65,0xAC,0x68,0x04,0x69,0xFC,0x69,0x70,0x69,0x60,0x0E,
+0x00,0x00,0x10,0x00,0x69,0x2D,0xB4,0xC4,0x2D,0xB4,0x00,0xBB,0x03,0x03,0x00,0x00,
+0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x03,0x01,0x01,
+0x03,0x03,0x03,0x03,0x01,0x01,0x01,0x01,0x03,0x03,0x03,0x03,0x13,0x7D,0xFC,0x02,
+0x54,0x41,0x8E,0x2E,0xD7,0x07,0x1E,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,
+0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x40,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x01,0x01,0x00,0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,
+0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x40,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x02,0x02,0x00,0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,
+0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,
+0x01,0x08,0xC0,0x40,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x03,0x03,0x00,0x00,0x00,0x30,0x7E,
+0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,
+0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x40,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x04,0x04,0x00,
+0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,
+0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x05,0x05,0x00,0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,
+0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,
+0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x00,
+0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,
+0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x06,0x06,0x00,0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,
+0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,
+0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,
+0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,
+0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,
+0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x07,0x07,0x00,0x00,0x00,0x30,0x7E,
+0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,0x01,0x08,0x00,0x00,
+0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,0x01,0x08,0x80,0x28,
+0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,0x01,0x08,0x00,0x00,
+0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,0xB4,0xC8,0xC1,0x00,
+0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x08,0x08,0x00,
+0x00,0x00,0x30,0x7E,0x00,0x00,0x00,0x00,0x60,0x00,0x71,0xF9,0x01,0x08,0x40,0x00,
+0x01,0x08,0x00,0x00,0x01,0x08,0x80,0x01,0x01,0x08,0x00,0x80,0x01,0x08,0x00,0xC2,
+0x01,0x08,0x80,0x28,0x00,0x00,0xC0,0x3C,0x01,0x08,0xC0,0x00,0x00,0x00,0x00,0x02,
+0x01,0x08,0x00,0x00,0x00,0x00,0x00,0x2E,0x0C,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x20,0x08,0xBD,0x2D,0x12,0x0E,0x02,0x02,
+0xB4,0xC8,0xC1,0x00,0x00,0x00,0x00,0x00,0x10,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x24,0x49,0x92,0x02,0x22,0x49,0x92,0x04,0x64,0x6A,0x2A,0x00,
+0x24,0x49,0x52,0x04,0x14,0x49,0x92,0x04,0xA4,0xA9,0x29,0x00,0x24,0x49,0x8A,0x04,
+0xA4,0x48,0x92,0x04,0xA4,0xA6,0x26,0x00,0x24,0x49,0x91,0x04,0x24,0x45,0x92,0x04,
+0xA4,0x9A,0x1A,0x00,0x24,0x29,0x92,0x04,0x24,0x29,0x92,0x04,0xA4,0xAA,0x2A,0x00,
+0x24,0x45,0x92,0x04,0x24,0x49,0x91,0x04,0xA4,0xAA,0x2A,0x00,0xA4,0x48,0x92,0x04,
+0x24,0x49,0x8A,0x04,0xA4,0xAA,0x2A,0x00,0x14,0x49,0x92,0x04,0x24,0x49,0x52,0x04,
+0xA4,0xAA,0x2A,0x00,0x22,0x49,0x92,0x04,0x24,0x49,0x92,0x02,0xA4,0xAA,0x2A,0x00,
+0x3A,0x11,0x0A,0x00,0x5A,0xF8,0x02,0x00,0x5A,0xF8,0x02,0x00,0x39,0xC9,0x09,0x00,
+0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x5A,0xD0,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,
+0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x5A,0xD0,0x09,0x00,0x5A,0xD0,0x09,0x00,0x39,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,
+0x5A,0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,
+0x3A,0xD1,0x09,0x00,0xF0,0x80,0x9F,0x00,0xF0,0x80,0x9F,0x00,0x00,0x48,0x40,0x02,
+0x36,0x20,0xA1,0x05,0x6C,0xF8,0x01,0x09,0xA2,0xD0,0x62,0x0C,0xD8,0xA8,0xC3,0x0F,
+0x0E,0x81,0x24,0x13,0x44,0x59,0x85,0x16,0x7A,0x31,0xE6,0x19,0xB0,0x09,0x47,0x1D,
+0xE6,0xE1,0xA7,0x20,0x1C,0xBA,0x38,0x00,0x09,0x6C,0xD0,0x02,0x3F,0x44,0x31,0x06,
+0x75,0x1C,0x92,0x09,0xAB,0xF4,0xF2,0x0C,0xE1,0xCC,0x53,0x10,0x17,0xA5,0xB4,0x13,
+0x4D,0x7D,0x15,0x17,0x83,0x55,0x76,0x1A,0xB9,0x2D,0xD7,0x1D,0xEF,0x05,0x38,0x21,
+0x25,0xDE,0xF8,0x3F,0x01,0x4C,0x50,0x02,0x37,0x24,0xB1,0x05,0x6D,0xFC,0x11,0x09,
+0xA3,0xD4,0x72,0x0C,0xD9,0xAC,0xD3,0x0F,0x0F,0x85,0x34,0x13,0x45,0x5D,0x95,0x16,
+0x7B,0x35,0xF6,0x19,0xB1,0x0D,0x57,0x1D,0xE7,0xE5,0xB7,0x20,0x1D,0xBE,0x28,0x00,
+0x0A,0x70,0xE0,0x02,0x40,0x48,0x41,0x06,0x76,0x20,0xA2,0x09,0xAC,0xF8,0x02,0x0D,
+0xE2,0xD0,0x63,0x10,0x18,0xA9,0xC4,0x13,0x4E,0x81,0x25,0x17,0x84,0x59,0x86,0x1A,
+0xBA,0x31,0xE7,0x1D,0xF0,0x09,0x48,0x21,0x26,0xE2,0xF8,0x3F,0x02,0x50,0x60,0x02,
+0x38,0x28,0xC1,0x05,0x6E,0x00,0x22,0x09,0xA4,0xD8,0x82,0x0C,0xDA,0xB0,0xE3,0x0F,
+0x10,0x89,0x44,0x13,0x46,0x61,0xA5,0x16,0x7C,0x39,0x06,0x1A,0xB2,0x11,0x67,0x1D,
+0xE8,0xE9,0xC7,0x20,0x1E,0xC2,0x18,0x00,0x0B,0x74,0xF0,0x02,0x41,0x4C,0x51,0x06,
+0x77,0x24,0xB2,0x09,0xAD,0xFC,0x12,0x0D,0xE3,0xD4,0x73,0x10,0x19,0xAD,0xD4,0x13,
+0x4F,0x85,0x35,0x17,0x85,0x5D,0x96,0x1A,0xBB,0x35,0xF7,0x1D,0xF1,0x0D,0x58,0x21,
+0x27,0xE6,0xF8,0x3F,0x03,0x54,0x70,0x02,0x39,0x2C,0xD1,0x05,0x6F,0x04,0x32,0x09,
+0xA5,0xDC,0x92,0x0C,0xDB,0xB4,0xF3,0x0F,0x11,0x8D,0x54,0x13,0x47,0x65,0xB5,0x16,
+0x7D,0x3D,0x16,0x1A,0xB3,0x15,0x77,0x1D,0xE9,0xED,0xD7,0x20,0x1F,0xC6,0x08,0x00,
+0x0C,0x78,0x00,0x03,0x42,0x50,0x61,0x06,0x78,0x28,0xC2,0x09,0xAE,0x00,0x23,0x0D,
+0xE4,0xD8,0x83,0x10,0x1A,0xB1,0xE4,0x13,0x50,0x89,0x45,0x17,0x86,0x61,0xA6,0x1A,
+0xBC,0x39,0x07,0x1E,0xF2,0x11,0x68,0x21,0x28,0xEA,0xF8,0x3F,0x04,0x58,0x80,0x02,
+0x3A,0x30,0xE1,0x05,0x70,0x08,0x42,0x09,0xA6,0xE0,0xA2,0x0C,0xDC,0xB8,0x03,0x10,
+0x12,0x91,0x64,0x13,0x48,0x69,0xC5,0x16,0x7E,0x41,0x26,0x1A,0xB4,0x19,0x87,0x1D,
+0xEA,0xF1,0xE7,0x20,0x20,0xCA,0xF8,0x00,0x0D,0x7C,0x10,0x03,0x43,0x54,0x71,0x06,
+0x79,0x2C,0xD2,0x09,0xAF,0x04,0x33,0x0D,0xE5,0xDC,0x93,0x10,0x1B,0xB5,0xF4,0x13,
+0x51,0x8D,0x55,0x17,0x87,0x65,0xB6,0x1A,0xBD,0x3D,0x17,0x1E,0xF3,0x15,0x78,0x21,
+0x29,0xEE,0xF8,0x3F,0x05,0x5C,0x90,0x02,0x3B,0x34,0xF1,0x05,0x71,0x0C,0x52,0x09,
+0xA7,0xE4,0xB2,0x0C,0xDD,0xBC,0x13,0x10,0x13,0x95,0x74,0x13,0x49,0x6D,0xD5,0x16,
+0x7F,0x45,0x36,0x1A,0xB5,0x1D,0x97,0x1D,0xEB,0xF5,0xF7,0x20,0x21,0xCE,0xF8,0x00,
+0x0E,0x80,0x20,0x03,0x44,0x58,0x81,0x06,0x7A,0x30,0xE2,0x09,0xB0,0x08,0x43,0x0D,
+0xE6,0xE0,0xA3,0x10,0x1C,0xB9,0x04,0x14,0x52,0x91,0x65,0x17,0x88,0x69,0xC6,0x1A,
+0xBE,0x41,0x27,0x1E,0xF4,0x19,0x88,0x21,0x2A,0xF2,0xF8,0x3F,0x06,0x60,0xA0,0x02,
+0x3C,0x38,0x01,0x06,0x72,0x10,0x62,0x09,0xA8,0xE8,0xC2,0x0C,0xDE,0xC0,0x23,0x10,
+0x14,0x99,0x84,0x13,0x4A,0x71,0xE5,0x16,0x80,0x49,0x46,0x1A,0xB6,0x21,0xA7,0x1D,
+0xEC,0xF9,0x07,0x21,0x22,0xD2,0xF8,0x00,0x0F,0x84,0x30,0x03,0x45,0x5C,0x91,0x06,
+0x7B,0x34,0xF2,0x09,0xB1,0x0C,0x53,0x0D,0xE7,0xE4,0xB3,0x10,0x1D,0xBD,0x14,0x14,
+0x53,0x95,0x75,0x17,0x89,0x6D,0xD6,0x1A,0xBF,0x45,0x37,0x1E,0xF5,0x1D,0x98,0x21,
+0x2B,0xF6,0xF8,0x3F,0x07,0x64,0xB0,0x02,0x3D,0x3C,0x11,0x06,0x73,0x14,0x72,0x09,
+0xA9,0xEC,0xD2,0x0C,0xDF,0xC4,0x33,0x10,0x15,0x9D,0x94,0x13,0x4B,0x75,0xF5,0x16,
+0x81,0x4D,0x56,0x1A,0xB7,0x25,0xB7,0x1D,0xED,0xFD,0x17,0x21,0x23,0xD6,0xF8,0x00,
+0x10,0x88,0x40,0x03,0x46,0x60,0xA1,0x06,0x7C,0x38,0x02,0x0A,0xB2,0x10,0x63,0x0D,
+0xE8,0xE8,0xC3,0x10,0x1E,0xC1,0x24,0x14,0x54,0x99,0x85,0x17,0x8A,0x71,0xE6,0x1A,
+0xC0,0x49,0x47,0x1E,0xF6,0x21,0xA8,0x21,0x2C,0xFA,0xF8,0x3F,0x08,0x68,0xC0,0x02,
+0x3E,0x40,0x21,0x06,0x74,0x18,0x82,0x09,0xAA,0xF0,0xE2,0x0C,0xE0,0xC8,0x43,0x10,
+0x16,0xA1,0xA4,0x13,0x4C,0x79,0x05,0x17,0x82,0x51,0x66,0x1A,0xB8,0x29,0xC7,0x1D,
+0xEE,0x01,0x28,0x21,0x24,0xDA,0xF8,0x00,0x11,0x8C,0x50,0x03,0x47,0x64,0xB1,0x06,
+0x7D,0x3C,0x12,0x0A,0xB3,0x14,0x73,0x0D,0xE9,0xEC,0xD3,0x10,0x1F,0xC5,0x34,0x14,
+0x55,0x9D,0x95,0x17,0x8B,0x75,0xF6,0x1A,0xC1,0x4D,0x57,0x1E,0xF7,0x25,0xB8,0x21,
+0x2D,0xFE,0xF8,0x3F,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x06,0xF9,0x12,0x20,0x38,0x04,0x70,0x08,0x0E,0x0A,0x00,0x01,0x01,0x01,0x08,0x12,
+0x20,0x00,0x80,0x04,0x80,0x08,0x00,0x00,0x00,0x0C,0x02,0x08,0x00,0x00,0x00,0x00,
+0x00,0x00,0x06,0x5F,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x09,0x03,0x0C,
+0x00,0x01,0x40,0x44,0x40,0x02,0x00,0x00,0x28,0x20,0x22,0x00,0x60,0x74,0x00,0x00,
+0x04,0x71,0x00,0x00,0x04,0x71,0x00,0x00,0xFC,0x77,0x00,0x00,0x60,0x74,0x00,0x00,
+0x04,0x71,0x00,0x00,0x04,0x71,0x00,0x00,0xFC,0x77,0x00,0x00,0x60,0x04,0x00,0x00,
+0x04,0x71,0x00,0x00,0x04,0x71,0x00,0x00,0xFC,0x77,0x00,0x00,0x60,0x04,0x00,0x00,
+0x04,0x71,0x00,0x00,0x04,0x71,0x00,0x00,0xFC,0x77,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x01,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x01,0x01,0x01,0x00,
+0x00,0x01,0x01,0x00,0x00,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x00,0x00,0x01,0x00,
+0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x07,0x07,0x00,0x00,0x01,0x01,0x5F,0x00,
+0x5F,0x00,0x14,0x00,0x0A,0x00,0x78,0x00,0x01,0x00,0x64,0x00,0x01,0x01,0x5F,0x00,
+0x5F,0x00,0x14,0x00,0x0A,0x00,0x78,0x00,0x00,0x00,0x64,0x00,0x3C,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x2C,0x01,0xF4,0x01,0x2C,0x01,0xC8,0x00,
+0x2C,0x01,0x0A,0x0A,0x00,0x01,0x20,0x00,0x00,0x01,0xF4,0x01,0x05,0x05,0x00,0x00,
+0x07,0x01,0x00,0x00,0xFB,0xFF,0xF0,0xFF,0xE6,0xFF,0xDC,0xFF,0xD3,0xFF,0xCA,0xFF,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x64,0x0A,0x00,0x00,0x00,0xFA,0x00,0xEE,0x02,
+0xCE,0xCE,0x32,0x32,0x28,0x05,0x00,0x00,0x00,0x00,0x08,0x32,0x2B,0x02,0x00,0x00,
+0x01,0x0B,0x0D,0x10,0x00,0x20,0x0D,0x00,0x00,0x00,0x00,0x00,0x0A,0x05,0x00,0x0A,
+0x00,0x00,0x00,0x00,0x50,0x28,0x00,0x3C,0x28,0x3C,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x01,0x02,0x00,0x03,0x04,0x00,0xFA,0x0F,0x00,0x00,0x00,0x00,
+0x0F,0x23,0x32,0x46,0x50,0x00,0x00,0x00,0x6E,0x69,0x5F,0x5A,0x46,0x3C,0x3C,0x3C,
+0x08,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0F,0x23,0x32,0x46,0x50,0x00,0x00,0x00,
+0x6E,0x69,0x5F,0x5A,0x46,0x3C,0x3C,0x3C,0x0F,0x14,0x1E,0x28,0x00,0x00,0x00,0x00,
+0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0F,0x23,0x32,0x46,0x00,0x00,0x00,0x00,
+0x46,0x3C,0x32,0x28,0x1E,0x1E,0x1E,0x1E,0x00,0x00,0x00,0x00,0x0A,0x03,0x14,0x00,
+0x5F,0x00,0xF1,0xFF,0x14,0x00,0x0F,0x00,0x0A,0x00,0xBC,0x02,0x00,0x00,0x00,0x00,
+0x78,0x76,0x00,0x1E,0x46,0x00,0x1E,0x00,0xC8,0x00,0x28,0x00,0x0F,0x00,0x0F,0x00,
+0xFA,0x00,0xC8,0x00,0xC8,0x00,0xFA,0x00,0x00,0x00,0x37,0x04,0x00,0x00,0x6F,0x08,
+0xF4,0x01,0x00,0x00,0x37,0x04,0x00,0x00,0x6F,0x08,0x32,0x14,0x02,0x1E,0x1E,0x32,
+0x02,0x00,0x64,0x00,0x46,0x00,0x32,0x00,0x40,0x00,0xF8,0x03,0x00,0x00,0x6F,0x08,
+0x00,0x00,0x00,0x00,0x80,0x04,0x33,0x00,0x12,0x00,0x01,0x00,0x14,0x00,0x00,0x00,
+0x39,0x00,0x6E,0x00,0xAF,0x00,0xEA,0x00,0x27,0x01,0x65,0x01,0xA2,0x01,0xE0,0x01,
+0x1D,0x02,0x5B,0x02,0x98,0x02,0xD6,0x02,0x14,0x03,0x51,0x03,0x8F,0x03,0xCB,0x03,
+0x09,0x04,0x3E,0x04,0x7F,0x04,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x80,0x08,
+0x30,0x00,0x20,0x00,0x01,0x00,0x22,0x00,0x00,0x00,0x3C,0x00,0x75,0x00,0xB8,0x00,
+0xFB,0x00,0x3D,0x01,0x81,0x01,0xC3,0x01,0x06,0x02,0x4A,0x02,0x8C,0x02,0xCF,0x02,
+0x11,0x03,0x55,0x03,0x97,0x03,0xDA,0x03,0x1C,0x04,0x60,0x04,0xA2,0x04,0xE6,0x04,
+0x28,0x05,0x6B,0x05,0xAE,0x05,0xF1,0x05,0x34,0x06,0x77,0x06,0xBB,0x06,0xFD,0x06,
+0x40,0x07,0x84,0x07,0xC7,0x07,0x0A,0x08,0x45,0x08,0x7F,0x08,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x02,0x01,0x20,0x00,
+0x19,0x45,0x00,0x00,0xF1,0x6C,0x00,0x00,0x84,0xD9,0x06,0x00,0x29,0xB1,0x01,0x00,
+0x10,0x27,0x00,0x00,0xC4,0x09,0x00,0x00,0x01,0x01,0x01,0x03,0x03,0x05,0x05,0x05,
+0x05,0x05,0x01,0x4B,0x0F,0x00,0x64,0x00,0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x01,
+0x03,0x03,0x05,0x05,0x05,0x05,0x05,0x00,0x19,0x45,0x00,0x00,0x02,0x01,0x01,0x01,
+0x05,0x05,0x05,0x05,0x05,0x05,0x05,0x00,0x84,0xDE,0x01,0x00,0x00,0x00,0x00,0x00,
+0x14,0x14,0x0A,0x0A,0x14,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x14,0x14,0x00,0x00,
+0x01,0x01,0x01,0x01,0x01,0x00,0x40,0x00,0x32,0x00,0xE8,0x03,0x0F,0x00,0x08,0x00,
+0x05,0x00,0x71,0x02,0x04,0x00,0x05,0x05,0x14,0x00,0x32,0x00,0x64,0x00,0x10,0x00,
+0x00,0x00,0x00,0x00,0x32,0x00,0x64,0x00,0x64,0x00,0x90,0x01,0x00,0x00,0x00,0x01,
+0x41,0x05,0x00,0x00,0x00,0x00,0x00,0x00,0x78,0x00,0x08,0x0F,0xC8,0x00,0xC8,0x00,
+0x64,0x00,0x0A,0x00,0x3C,0x00,0xF0,0x00,0x3C,0x00,0xF0,0x00,0x0A,0x02,0xF0,0xFF,
+0xFF,0x00,0xFF,0x00,0x00,0x00,0x00,0x00,0xDB,0x00,0xED,0x00,0x00,0x01,0x14,0x01,
+0x29,0x01,0x40,0x01,0x58,0x01,0x72,0x01,0x8D,0x01,0xA9,0x01,0xC8,0x01,0xE8,0x01,
+0x0A,0x02,0x2D,0x02,0x52,0x02,0x7A,0x02,0xA3,0x02,0xCE,0x02,0xFB,0x02,0x2A,0x03,
+0x5C,0x03,0x8F,0x03,0xC5,0x03,0xFD,0x03,0x36,0x04,0x73,0x04,0xB1,0x04,0xF1,0x04,
+0x34,0x05,0x78,0x05,0xBF,0x05,0x08,0x06,0x53,0x06,0xA0,0x06,0xEF,0x06,0x3F,0x07,
+0x92,0x07,0xE6,0x07,0x3B,0x08,0x93,0x08,0xEB,0x08,0x45,0x09,0xA0,0x09,0xFC,0x09,
+0x58,0x0A,0xB6,0x0A,0x14,0x0B,0x72,0x0B,0xD1,0x0B,0x2F,0x0C,0x8D,0x0C,0xEB,0x0C,
+0x49,0x0D,0xA5,0x0D,0x01,0x0E,0x5B,0x0E,0xB4,0x0E,0x0C,0x0F,0x61,0x0F,0xB5,0x0F,
+0x06,0x10,0x55,0x10,0xA1,0x10,0xEA,0x10,0x31,0x11,0x74,0x11,0xB4,0x11,0xF0,0x11,
+0x28,0x12,0x5D,0x12,0x8D,0x12,0xB9,0x12,0xE1,0x12,0x05,0x13,0x24,0x13,0x3E,0x13,
+0x54,0x13,0x65,0x13,0x71,0x13,0x78,0x13,0x7B,0x13,0xDB,0x00,0xED,0x00,0x00,0x01,
+0x14,0x01,0x29,0x01,0x40,0x01,0x58,0x01,0x72,0x01,0x8D,0x01,0xA9,0x01,0xC8,0x01,
+0xE8,0x01,0x0A,0x02,0x2D,0x02,0x52,0x02,0x7A,0x02,0xA3,0x02,0xCE,0x02,0xFB,0x02,
+0x2A,0x03,0x5C,0x03,0x8F,0x03,0xC5,0x03,0xFD,0x03,0x36,0x04,0x73,0x04,0xB1,0x04,
+0xF1,0x04,0x34,0x05,0x78,0x05,0xBF,0x05,0x08,0x06,0x53,0x06,0xA0,0x06,0xEF,0x06,
+0x3F,0x07,0x92,0x07,0xE6,0x07,0x3B,0x08,0x93,0x08,0xEB,0x08,0x45,0x09,0xA0,0x09,
+0xFC,0x09,0x58,0x0A,0xB6,0x0A,0x14,0x0B,0x72,0x0B,0xD1,0x0B,0x2F,0x0C,0x8D,0x0C,
+0xEB,0x0C,0x49,0x0D,0xA5,0x0D,0x01,0x0E,0x5B,0x0E,0xB4,0x0E,0x0C,0x0F,0x61,0x0F,
+0xB5,0x0F,0x06,0x10,0x55,0x10,0xA1,0x10,0xEA,0x10,0x31,0x11,0x74,0x11,0xB4,0x11,
+0xF0,0x11,0x28,0x12,0x5D,0x12,0x8D,0x12,0xB9,0x12,0xE1,0x12,0x05,0x13,0x24,0x13,
+0x3E,0x13,0x54,0x13,0x65,0x13,0x71,0x13,0x78,0x13,0x7B,0x13,0x98,0x00,0xA6,0x00,
+0xB5,0x00,0xC5,0x00,0xD7,0x00,0xEA,0x00,0xFE,0x00,0x13,0x01,0x2B,0x01,0x43,0x01,
+0x5E,0x01,0x7A,0x01,0x98,0x01,0xB7,0x01,0xD9,0x01,0xFD,0x01,0x22,0x02,0x4A,0x02,
+0x75,0x02,0xA1,0x02,0xD0,0x02,0x01,0x03,0x35,0x03,0x6B,0x03,0xA4,0x03,0xDF,0x03,
+0x1D,0x04,0x5D,0x04,0xA0,0x04,0xE6,0x04,0x2E,0x05,0x79,0x05,0xC7,0x05,0x17,0x06,
+0x6A,0x06,0xBF,0x06,0x16,0x07,0x70,0x07,0xCC,0x07,0x2B,0x08,0x8B,0x08,0xED,0x08,
+0x51,0x09,0xB6,0x09,0x1D,0x0A,0x85,0x0A,0xEF,0x0A,0x59,0x0B,0xC4,0x0B,0x2F,0x0C,
+0x9A,0x0C,0x06,0x0D,0x71,0x0D,0xDC,0x0D,0x46,0x0E,0xAF,0x0E,0x17,0x0F,0x7D,0x0F,
+0xE1,0x0F,0x43,0x10,0xA3,0x10,0x01,0x11,0x5B,0x11,0xB2,0x11,0x06,0x12,0x56,0x12,
+0xA2,0x12,0xEB,0x12,0x2E,0x13,0x6D,0x13,0xA8,0x13,0xDD,0x13,0x0D,0x14,0x38,0x14,
+0x5E,0x14,0x7E,0x14,0x98,0x14,0xAD,0x14,0xBB,0x14,0xC4,0x14,0xC7,0x14,0x98,0x00,
+0xA6,0x00,0xB5,0x00,0xC5,0x00,0xD7,0x00,0xEA,0x00,0xFE,0x00,0x13,0x01,0x2B,0x01,
+0x43,0x01,0x5E,0x01,0x7A,0x01,0x98,0x01,0xB7,0x01,0xD9,0x01,0xFD,0x01,0x22,0x02,
+0x4A,0x02,0x75,0x02,0xA1,0x02,0xD0,0x02,0x01,0x03,0x35,0x03,0x6B,0x03,0xA4,0x03,
+0xDF,0x03,0x1D,0x04,0x5D,0x04,0xA0,0x04,0xE6,0x04,0x2E,0x05,0x79,0x05,0xC7,0x05,
+0x17,0x06,0x6A,0x06,0xBF,0x06,0x16,0x07,0x70,0x07,0xCC,0x07,0x2B,0x08,0x8B,0x08,
+0xED,0x08,0x51,0x09,0xB6,0x09,0x1D,0x0A,0x85,0x0A,0xEF,0x0A,0x59,0x0B,0xC4,0x0B,
+0x2F,0x0C,0x9A,0x0C,0x06,0x0D,0x71,0x0D,0xDC,0x0D,0x46,0x0E,0xAF,0x0E,0x17,0x0F,
+0x7D,0x0F,0xE1,0x0F,0x43,0x10,0xA3,0x10,0x01,0x11,0x5B,0x11,0xB2,0x11,0x06,0x12,
+0x56,0x12,0xA2,0x12,0xEB,0x12,0x2E,0x13,0x6D,0x13,0xA8,0x13,0xDD,0x13,0x0D,0x14,
+0x38,0x14,0x5E,0x14,0x7E,0x14,0x98,0x14,0xAD,0x14,0xBB,0x14,0xC4,0x14,0xC7,0x14,
+0x4A,0x00,0x45,0x00,0x45,0x00,0x42,0x00,0x00,0x00,0x00,0x00,0x01,0x03,0x64,0x00,
+0x64,0x02,0x64,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x1B,0x07,0x00,0x00,0x01,0x00,0x00,0x00,0x00,0x00,0x76,0x42,0x14,0xAE,0xED,0x42,
+0x37,0x89,0xC1,0x40,0x00,0x20,0x1A,0x45,0x10,0x00,0x10,0x00,0x10,0x24,0x10,0x00,
+0x00,0x00,0x00,0x54,0x00,0x00,0x40,0x01,0x00,0x48,0x01,0x05,0xC1,0xD8,0x00,0x00,
+0x08,0xC2,0x1F,0x04,0x21,0x08,0xC3,0xC8,0x00,0x00,0x08,0xC4,0x07,0x28,0x8A,0x01,
+0xC5,0xCF,0x28,0x8A,0x09,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x3F,0x0E,0x33,0x33,0xA3,0x40,
+0x2E,0x5C,0x74,0x18,0x03,0x00,0x33,0x33,0xA3,0x40,0xA2,0x19,0x64,0x18,0x03,0x02,
+0x00,0x00,0x00,0x00,0x2A,0x60,0x00,0x11,0x2A,0x00,0x33,0x33,0xA3,0x40,0x16,0x00,
+0x11,0x18,0x03,0x02,0x28,0x54,0x00,0x17,0x16,0x00,0x71,0x18,0x03,0x02,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x2E,0x5C,0x00,0x17,0x2A,0x54,0x00,0x18,
+0x2C,0x5C,0x00,0x16,0x2C,0x58,0x00,0x17,0x28,0x54,0x00,0x14,0x2A,0x50,0x00,0x15,
+0x2A,0x5C,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,
+0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,
+0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,
+0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,
+0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,
+0x22,0x44,0x00,0x11,0x22,0x44,0x00,0x11,0x22,0x44,0x00,0xB2,0x6D,0xDB,0x06,0xB6,
+0x6D,0xDB,0x02,0x40,0x6A,0x2A,0x00,0x96,0x6D,0xDB,0x06,0xB6,0x6D,0x5B,0x06,0x80,
+0xA9,0x29,0x00,0xB6,0x6C,0xDB,0x06,0xB6,0x6D,0xCB,0x06,0x80,0xA6,0x26,0x00,0xB6,
+0x65,0xDB,0x06,0xB6,0x6D,0xD9,0x06,0x80,0x9A,0x1A,0x00,0xB6,0x2D,0xDB,0x06,0xB6,
+0x2D,0xDB,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6D,0xD9,0x06,0xB6,0x65,0xDB,0x06,0x80,
+0xAA,0x2A,0x00,0xB6,0x6D,0xCB,0x06,0xB6,0x6C,0xDB,0x06,0x80,0xAA,0x2A,0x00,0xB6,
+0x6D,0x5B,0x06,0x96,0x6D,0xDB,0x06,0x80,0xAA,0x2A,0x00,0xB6,0x6D,0xDB,0x02,0xB2,
+0x6D,0xDB,0x06,0x80,0xAA,0x2A,0x00,0x92,0x24,0x49,0x02,0x92,0x24,0x49,0x02,0x40,
+0x55,0x15,0x00,0xFF,0xFF,0xFF,0x07,0xFF,0xFF,0xFF,0x07,0xFF,0xFF,0x3F,0x00,0x3A,
+0x49,0x3B,0x00,0x5A,0xD0,0x09,0x00,0x5A,0x00,0x00,0x80,0x40,0xC9,0x09,0x00,0x39,
+0xC9,0x09,0x00,0x5A,0xC8,0x02,0x00,0x00,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,
+0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,
+0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,
+0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,
+0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,
+0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0xC9,0x09,0x00,0x39,0xC9,0x09,0x00,0x5A,
+0xC8,0x02,0x00,0x5A,0xC8,0x02,0x00,0x3A,0xD1,0x09,0x00,0x3A,0xD1,0x09,0x00,0x3A,
+0xD1,0x09,0x00,0x2B,0x06,0xB3,0x03,0x2B,0x06,0xB3,0x03,0xFF,0xFF,0x7F,0x25,0x56,
+0x56,0x49,0x25,0x53,0x4A,0x19,0x25,0x50,0x3E,0xE9,0x24,0x4D,0x32,0xB9,0x24,0x4A,
+0x26,0x89,0x24,0x47,0x1A,0x59,0x24,0x44,0x0E,0x29,0x24,0x41,0x02,0xF9,0x23,0x3E,
+0xF6,0xC8,0x23,0x3B,0xEA,0xF8,0x00,0xFF,0xFF,0x9F,0x23,0x38,0xDE,0x68,0x23,0x35,
+0xD2,0x38,0x23,0x32,0xC6,0x08,0x23,0x2F,0xBA,0xD8,0x22,0x2C,0xAE,0xA8,0x22,0x29,
+0xA2,0x78,0x22,0x26,0x96,0x48,0x22,0x23,0x8A,0x18,0x22,0x20,0x7E,0xE8,0x21,0x1D,
+0x72,0xF8,0x3F,0xFF,0xFF,0x3F,0x29,0x92,0x46,0x0A,0x29,0x8F,0x3A,0xDA,0x28,0x8C,
+0x2E,0xAA,0x28,0x89,0x22,0x7A,0x28,0x86,0x16,0x4A,0x28,0x83,0x0A,0x1A,0x28,0x80,
+0xFE,0xE9,0x27,0x7D,0xF2,0xB9,0x27,0x7A,0xE6,0x89,0x27,0x77,0xDA,0xF9,0x00,0xFF,
+0xFF,0x5F,0x27,0x74,0xCE,0x29,0x27,0x71,0xC2,0xF9,0x26,0x6E,0xB6,0xC9,0x26,0x6B,
+0x00,0x00,0x90,0x41,0x00,0x00,0x2A,0x00,0x92,0x39,0x26,0x62,0x86,0x09,0x26,0x5F,
+0x7A,0xD9,0x25,0x5C,0x6E,0xA9,0x25,0x59,0x62,0xF9,0x3F,0xFF,0xFF,0xFF,0x2C,0xCE,
+0x36,0xCB,0x2C,0xCB,0x2A,0x9B,0x2C,0xC8,0x1E,0x6B,0x2C,0xC5,0x12,0x3B,0x2C,0xC2,
+0x06,0x0B,0x2C,0xBF,0xFA,0xDA,0x2B,0xBC,0xEE,0xAA,0x2B,0xB9,0xE2,0x7A,0x2B,0xB6,
+0xD6,0x4A,0x2B,0xB3,0xCA,0xFA,0x00,0xFF,0xFF,0x1F,0x2B,0xB0,0xBE,0xEA,0x2A,0xAD,
+0xB2,0xBA,0x2A,0xAA,0xA6,0x8A,0x2A,0xA7,0x9A,0x5A,0x2A,0xA4,0x8E,0x2A,0x2A,0xA1,
+0x82,0xFA,0x29,0x9E,0x76,0xCA,0x29,0x9B,0x6A,0x9A,0x29,0x98,0x5E,0x6A,0x29,0x95,
+0x52,0xFA,0x3F,0xFF,0xFF,0x3F,0x21,0x01,0xBE,0xD7,0x1D,0xCB,0xE5,0x76,0x1A,0x95,
+0x0D,0x16,0x17,0x5F,0x35,0xB5,0x13,0x29,0x5D,0x54,0x10,0xF3,0x84,0xF3,0x0C,0xBD,
+0xAC,0x92,0x09,0x87,0xD4,0x31,0x06,0x51,0xFC,0xD0,0x02,0x1B,0x24,0x00,0x00,0xFF,
+0xFF,0xAF,0x20,0xF8,0x99,0x47,0x1D,0xC2,0xC1,0xE6,0x19,0x8C,0xE9,0x85,0x16,0x56,
+0x11,0x25,0x13,0x20,0x39,0xC4,0x0F,0xEA,0x60,0x63,0x0C,0xB4,0x88,0x02,0x09,0x7E,
+0xB0,0xA1,0x05,0x48,0xD8,0x40,0x02,0x12,0x00,0xF0,0x3F,0xFF,0xFF,0x4F,0x21,0x02,
+0xC2,0xE7,0x1D,0xCC,0xE9,0x86,0x1A,0x96,0x11,0x26,0x17,0x60,0x39,0xC5,0x13,0x2A,
+0x61,0x64,0x10,0xF4,0x88,0x03,0x0D,0xBE,0xB0,0xA2,0x09,0x88,0xD8,0x41,0x06,0x52,
+0x00,0xE1,0x02,0x1C,0x28,0x10,0x00,0xFF,0xFF,0xBF,0x20,0xF9,0x9D,0x57,0x1D,0xC3,
+0xC5,0xF6,0x19,0x8D,0xED,0x95,0x16,0x57,0x15,0x35,0x13,0x21,0x00,0x00,0x00,0x00,
+0x64,0x73,0x0C,0xB5,0x8C,0x12,0x09,0x00,0xB4,0xB1,0x05,0x49,0xDC,0x50,0x02,0x13,
+0x04,0xF0,0x3F,0xFF,0xFF,0x5F,0x21,0x03,0xC6,0xF7,0x1D,0xCD,0xED,0x96,0x1A,0x97,
+0x15,0x36,0x17,0x61,0x3D,0xD5,0x13,0x2B,0x65,0x74,0x10,0xF5,0x8C,0x13,0x0D,0xBF,
+0xB4,0xB2,0x09,0x89,0xDC,0x51,0x06,0x53,0x04,0xF1,0x02,0x1D,0x2C,0x20,0x00,0xFF,
+0xFF,0xCF,0x20,0xFA,0xA1,0x67,0x1D,0xC4,0xC9,0x06,0x1A,0x8E,0xF1,0xA5,0x16,0x58,
+0x19,0x45,0x13,0x22,0x41,0xE4,0x0F,0xEC,0x68,0x83,0x0C,0xB6,0x90,0x22,0x09,0x80,
+0xB8,0xC1,0x05,0x4A,0xE0,0x60,0x02,0x14,0x08,0xF0,0x3F,0xFF,0xFF,0x6F,0x21,0x04,
+0xCA,0x07,0x1E,0xCE,0xF1,0xA6,0x1A,0x98,0x19,0x46,0x17,0x62,0x41,0xE5,0x13,0x2C,
+0x69,0x84,0x10,0xF6,0x90,0x23,0x0D,0xC0,0xB8,0xC2,0x09,0x8A,0xE0,0x61,0x06,0x54,
+0x08,0x01,0x03,0x1E,0x30,0x30,0x00,0xFF,0xFF,0xDF,0x20,0xFB,0xA5,0x77,0x1D,0xC5,
+0xCD,0x16,0x1A,0x8F,0xF5,0xB5,0x16,0x59,0x1D,0x55,0x13,0x23,0x45,0xF4,0x0F,0xED,
+0x6C,0x93,0x0C,0xB7,0x94,0x32,0x09,0x81,0xBC,0xD1,0x05,0x4B,0xE4,0x70,0x02,0x15,
+0x0C,0xF0,0x3F,0xFF,0xFF,0x7F,0x21,0x05,0xCE,0x17,0x1E,0xCF,0xF5,0xB6,0x1A,0x99,
+0x1D,0x56,0x17,0x63,0x45,0xF5,0x13,0x2D,0x6D,0x94,0x10,0xF7,0x94,0x33,0x0D,0xC1,
+0xBC,0xD2,0x09,0x8B,0xE4,0x71,0x06,0x55,0x0C,0x11,0x03,0x1F,0x34,0xF0,0x00,0xFF,
+0xFF,0xEF,0x20,0xFC,0xA9,0x87,0x1D,0xC6,0xD1,0x26,0x1A,0x90,0xF9,0xC5,0x16,0x5A,
+0x21,0x65,0x13,0x24,0x49,0x04,0x10,0xEE,0x70,0xA3,0x0C,0xB8,0x98,0x42,0x09,0x82,
+0xC0,0xE1,0x05,0x4C,0xE8,0x80,0x02,0x00,0x10,0xF0,0x3F,0xFF,0xFF,0x8F,0x21,0x06,
+0xD2,0x27,0x1E,0xD0,0xF9,0xC6,0x1A,0x9A,0x21,0x66,0x17,0x64,0x49,0x05,0x14,0x2E,
+0x71,0xA4,0x10,0xF8,0x98,0x43,0x0D,0xC2,0xC0,0xE2,0x09,0x8C,0xE8,0x81,0x06,0x56,
+0x10,0x21,0x03,0x20,0x38,0xF0,0x00,0xFF,0xFF,0xFF,0x20,0xFD,0xAD,0x97,0x1D,0xC7,
+0xD5,0x36,0x1A,0x91,0xFD,0xD5,0x16,0x5B,0x25,0x75,0x13,0x25,0x4D,0x14,0x10,0xEF,
+0x74,0xB3,0x0C,0xB9,0x9C,0x52,0x09,0x83,0xC4,0xF1,0x05,0x4D,0xEC,0x90,0x02,0x17,
+0x14,0xF0,0x3F,0xFF,0xFF,0x9F,0x21,0x07,0xD6,0x37,0x1E,0xD1,0xFD,0xD6,0x1A,0x9B,
+0x25,0x76,0x17,0x65,0x4D,0x15,0x14,0x2F,0x75,0xB4,0x10,0xF9,0x9C,0x53,0x0D,0xC3,
+0xC4,0xF2,0x09,0x8D,0xEC,0x91,0x06,0x57,0x14,0x31,0x03,0x21,0x3C,0xF0,0x00,0xFF,
+0xFF,0x0F,0x21,0xFE,0xB1,0xA7,0x1D,0xC8,0xD9,0x46,0x1A,0x92,0x01,0xE6,0x16,0x5C,
+0x29,0x85,0x13,0x26,0x51,0x24,0x10,0xF0,0x78,0xC3,0x0C,0xBA,0xA0,0x62,0x09,0x84,
+0xC8,0x01,0x06,0x4E,0xF0,0xA0,0x02,0x18,0x18,0xF0,0x3F,0xFF,0xFF,0xAF,0x21,0x08,
+0xDA,0x47,0x1E,0xD2,0x01,0xE7,0x1A,0x9C,0x29,0x86,0x17,0x66,0x51,0x25,0x14,0x30,
+0x79,0xC4,0x10,0xFA,0xA0,0x63,0x0D,0xC4,0xC8,0x02,0x0A,0x8E,0xF0,0xA1,0x06,0x58,
+0x18,0x41,0x03,0x22,0x40,0xF0,0x00,0xFF,0xFF,0x1F,0x21,0xFF,0xB5,0xB7,0x1D,0xC9,
+0xDD,0x56,0x1A,0x93,0x05,0xF6,0x16,0x5D,0x2D,0x95,0x13,0x27,0x55,0x34,0x10,0xF1,
+0x7C,0xD3,0x0C,0xBB,0xA4,0x72,0x09,0x85,0xCC,0x11,0x06,0x4F,0xF4,0xB0,0x02,0x19,
+0x1C,0xF0,0x3F,0xFF,0xFF,0xBF,0x21,0x01,0x00,0x00,0x00,0x00,0x7F,0x00,0x00,0x00,
+0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x01,0x00,0x00,0x00,0x04,0x01,0x00,0x00,0x00,0x76,0x00,0x00,
+0x6D,0x00,0xA7,0xFF,0x04,0x05,0x00,0x00,0x04,0x05,0x00,0x00,0x00,0x72,0x00,0x00,
+0x04,0x04,0x00,0x00,0x04,0x01,0x00,0x00,0x04,0x00,0x00,0x00,0x04,0x00,0x00,0x00,
+0x01,0x00,0x00,0x00,0x9B,0x01,0x00,0x00,0x30,0x1B,0x01,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x4C,0x23,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
+
+};
+
+#endif /* _LINUX_NVT_TOUCH_H */
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_limit_noflash.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_limit_noflash.h
new file mode 100644
index 0000000000000000000000000000000000000000..8cfa674a442d16d51184f55fc14f4d7b2c617664
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/NT36672_noflash/nvt_limit_noflash.h
@@ -0,0 +1,189 @@
+/***************************************************
+ * File:nvt_limit.h
+ * Copyright (c)  2017 - 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             nova nt36672 test limit data
+ * Version:1.0:
+ * Date created:2017-09-15
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef NVT_H_LIMIT_NOFLASH
+#define NVT_H_LIMIT_NOFLASH
+
+//---Screen on test---
+static uint32_t Doze_X_Channel = 2;
+/*Doze FW Rawdata Test*/
+static int32_t PS_Config_Lmt_Doze_Rawdata_P = 1000;
+static int32_t PS_Config_Lmt_Doze_Rawdata_N = 200;
+static int32_t PS_Config_Doze_Noise_Test_Frame = 50;
+/*Doze Noise Test*/
+static int32_t PS_Config_Lmt_Doze_Diff_P = 500;
+static int32_t PS_Config_Lmt_Doze_Diff_N = -500;
+/*FW cc data test*/
+static int32_t PS_Config_Lmt_FW_CC_P = 100;
+static int32_t PS_Config_Lmt_FW_CC_N = 70;
+/*Noise Test*/
+static int32_t PS_Config_Lmt_FW_Diff_P = 60;
+static int32_t PS_Config_Lmt_FW_Diff_N = -60;
+/*Short Test*/
+static int32_t PS_Config_Lmt_Short_Rawdata_N = 11000;
+static int32_t PS_Config_Lmt_Short_Rawdata_P = 14000;
+static int32_t PS_Config_Diff_Test_Frame = 50;
+
+//---LPWGModeTest---
+static int32_t PS_Config_Lmt_LPWG_Rawdata_P = 1300;
+static int32_t PS_Config_Lmt_LPWG_Rawdata_N = 500;
+static int32_t PS_Config_Lmt_LPWG_Diff_P = 60;
+static int32_t PS_Config_Lmt_LPWG_Diff_N = -60;
+
+static uint8_t AIN_X[40] = {17, 16, 15, 14, 13, 12, 11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0};
+static uint8_t AIN_Y[40] = {31, 30, 29, 28, 27, 26, 25, 24, 23, 22, 21, 20, 19, 18, 17, 16, 15, 14, 13, 12, 11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0};
+
+/*FW Rawdata Test*/
+static int32_t PS_Config_Lmt_FW_Rawdata_P[40 * 40] = {
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+    1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,1300,
+};
+
+static int32_t PS_Config_Lmt_FW_Rawdata_N[40 * 40] = {
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+    500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,500,
+};
+
+/*Open Test*/
+static int32_t PS_Config_Lmt_Open_Rawdata_P[40 * 40] = {
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+        13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,13000,
+};
+
+static int32_t PS_Config_Lmt_Open_Rawdata_N[40 * 40] = {
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+        6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,6500,
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..bdf970cb562a9436f68ed32896f2820c0383446f
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.c
@@ -0,0 +1,631 @@
+/***************************************************
+ * File:novatek_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             nova common driver
+ * Version:1.0:
+ * Date created:2017/09/18
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "../touchpanel_common.h"
+#include "novatek_common.h"
+
+/*******LOG TAG Declear*****************************/
+
+#define TPD_DEVICE "nvt_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (tp_debug)\
+        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+/*********** nvt tool operate content***********************/
+static ssize_t nvt_flash_read(struct file *filp, char __user *buff, size_t count, loff_t *offp)
+{
+    uint8_t str[68] = {0};
+    int32_t ret = -1;
+    int32_t retries = 0;
+    int8_t i2c_wr = 0;
+    unsigned short addr_tmp = 0;
+
+    struct touchpanel_data *ts = PDE_DATA(file_inode(filp));
+
+    if (count > sizeof(str)) {
+        TPD_INFO("error count=%zu\n", count);
+        return -EFAULT;
+    }
+
+    if (copy_from_user(str, buff, count)) {
+        TPD_INFO("copy from user error\n");
+        return -EFAULT;
+    }
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, false);
+    }
+
+    i2c_wr = str[0] >> 7;
+
+    if (i2c_wr == 0) {    //I2C write
+        while (retries < 20) {
+            addr_tmp = ts->client->addr;
+            ts->client->addr = str[0] & 0x7F;
+            ret = touch_i2c_write(ts->client, &str[2], str[1]);
+            ts->client->addr = addr_tmp;
+            if (ret == 1)
+                break;
+            else
+                TPD_INFO("error, retries=%d, ret=%d\n", retries, ret);
+
+            retries++;
+        }
+
+        if (unlikely(retries == 20)) {
+            TPD_INFO("error, ret = %d\n", ret);
+            return -EIO;
+        }
+
+        return ret;
+    } else if (i2c_wr == 1) {    //I2C read
+        while (retries < 20) {
+            addr_tmp = ts->client->addr;
+            ts->client->addr = str[0] & 0x7F;
+            ret = touch_i2c_read(ts->client, &str[2], 1, &str[3], str[1] - 1);
+            ts->client->addr = addr_tmp;
+            if (ret == 2)
+                break;
+            else
+                TPD_INFO("error, retries=%d, ret=%d\n", retries, ret);
+
+            retries++;
+        }
+
+        // copy buff to user if i2c transfer
+        if (retries < 20) {
+            if (copy_to_user(buff, str, count))
+                return -EFAULT;
+        }
+
+        if (unlikely(retries == 20)) {
+            TPD_INFO("error, ret = %d\n", ret);
+            return -EIO;
+        }
+
+        return ret;
+    } else {
+        TPD_INFO("Call error, str[0]=%d\n", str[0]);
+        return -EFAULT;
+    }
+}
+
+static const struct file_operations nvt_flash_fops = {
+    .owner = THIS_MODULE,
+    .open = simple_open,
+    .read = nvt_flash_read,
+};
+
+static ssize_t nvt_noflash_read(struct file *filp, char __user *buff, size_t count, loff_t *offp)
+{
+    uint8_t *str = NULL;
+    int32_t ret = -1;
+    int32_t retries = 0;
+    int8_t spi_wr = 0;
+    uint8_t *buf;
+
+    struct touchpanel_data *ts = PDE_DATA(file_inode(filp));
+
+    if (count > SPI_TANSFER_LEN)
+        return -EFAULT;
+
+    /* allocate buffer for spi transfer */
+    str = (uint8_t *)kzalloc((count), GFP_KERNEL | GFP_DMA);
+    if(str == NULL) {
+        TPD_INFO("kzalloc for buf failed!\n");
+        ret = -ENOMEM;
+        goto kzalloc_failed;
+    }
+
+    buf = (uint8_t *)kzalloc((count), GFP_KERNEL | GFP_DMA);
+    if(buf == NULL) {
+        TPD_INFO("kzalloc for buf failed!\n");
+        ret = -ENOMEM;
+        kfree(str);
+        str = NULL;
+        goto kzalloc_failed;
+    }
+
+    if (copy_from_user(str, buff, count)) {
+        TPD_INFO("copy from user error\n");
+        ret = -EFAULT;
+        goto out;
+    }
+
+    spi_wr = str[0] >> 7;
+    memcpy(buf, str+2, ((str[0] & 0x7F) << 8) | str[1]);
+
+    if (spi_wr == 0) {    //SPI write
+        while (retries < 20) {
+            ret = CTP_SPI_WRITE(ts->s_client, buf, ((str[0] & 0x7F) << 8) | str[1]);
+            if (!ret)
+                break;
+            else
+                TPD_INFO("error, retries=%d, ret=%d\n", retries, ret);
+
+            retries++;
+        }
+
+        if (unlikely(retries == 20)) {
+            TPD_INFO("error, ret = %d\n", ret);
+            ret = -EIO;
+            goto out;
+        }
+    } else if (spi_wr == 1) {    //SPI read
+         while (retries < 20) {
+            ret = CTP_SPI_READ(ts->s_client, buf, ((str[0] & 0x7F) << 8) | str[1]);
+            if (!ret)
+                break;
+            else
+                TPD_INFO("error, retries=%d, ret=%d\n", retries, ret);
+
+            retries++;
+        }
+
+        // copy buff to user if spi transfer
+        memcpy(str+2, buf, ((str[0] & 0x7F) << 8) | str[1]);
+        if (retries < 20) {
+            if (copy_to_user(buff, str, count)) {
+                ret = -EFAULT;
+                goto out;
+            }
+        }
+
+        if (unlikely(retries == 20)) {
+            TPD_INFO("error, ret = %d\n", ret);
+            ret = -EIO;
+            goto out;
+        }
+    } else {
+        TPD_INFO("Call error, str[0]=%d\n", str[0]);
+        ret = -EFAULT;
+        goto out;
+    }
+
+out:
+    kfree(str);
+    str = NULL;
+    kfree(buf);
+    buf = NULL;
+kzalloc_failed:
+        return ret;
+}
+
+static const struct file_operations nvt_noflash_fops = {
+    .owner = THIS_MODULE,
+    .open = simple_open,
+    .read = nvt_noflash_read,
+};
+
+void nvt_flash_proc_init(struct touchpanel_data *ts, const char *name)
+{
+    struct proc_dir_entry *nvt_proc_entry;
+
+    if (strstr(name, "SPI")) {
+        TPD_INFO("create /proc/NVTSPI!\n");
+        nvt_proc_entry = proc_create_data(name, 0444, NULL, &nvt_noflash_fops, ts);
+        if (nvt_proc_entry == NULL) {
+                TPD_INFO("%s Failed!\n", __func__);
+                return;
+        } else {
+                TPD_INFO("%s Succeeded!\n", __func__);
+        }
+    } else {
+        TPD_INFO("create /proc/NVTflash!\n");
+        nvt_proc_entry = proc_create_data(name, 0444, NULL,&nvt_flash_fops, ts);
+        if (nvt_proc_entry == NULL) {
+                TPD_INFO("%s Failed!\n", __func__);
+                return;
+        } else {
+                TPD_INFO("%s Succeeded!\n", __func__);
+        }
+    }
+
+    return;
+}
+
+void nvt_limit_read(struct seq_file *s, struct touchpanel_data *ts)
+{
+    int ret = 0;
+    int32_t *fw_rawdata_p = NULL, *fw_rawdata_n = NULL;
+    int32_t *open_rawdata_p = NULL, *open_rawdata_n = NULL;
+    int32_t *short_rawdata_p = NULL, *short_rawdata_n = NULL;
+    int32_t *diff_rawdata_p = NULL, *diff_rawdata_n = NULL;
+    int32_t *cc_data_p = NULL, *cc_data_n = NULL;
+    int32_t *doze_rawdata_p = NULL, *doze_rawdata_n = NULL;
+    int32_t *doze_diff_rawdata_p = NULL, *doze_diff_rawdata_n = NULL;
+    int32_t *lpwg_rawdata_p = NULL, *lpwg_rawdata_n = NULL;
+    int32_t *lpwg_diff_rawdata_p = NULL, *lpwg_diff_rawdata_n = NULL;
+    const struct firmware *fw = NULL;
+    struct nvt_test_header *ph = NULL;
+    int i = 0, j = 0;
+    int temp = 0;
+
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "Request failed, Check the path %d", temp);
+        return;
+    }
+
+    ph = (struct nvt_test_header *)(fw->data);
+    fw_rawdata_p = (int32_t *)(fw->data + ph->array_fw_rawdata_P_offset);
+    fw_rawdata_n = (int32_t *)(fw->data + ph->array_fw_rawdata_N_offset);
+    open_rawdata_p = (int32_t *)(fw->data + ph->array_open_rawdata_P_offset);
+    open_rawdata_n = (int32_t *)(fw->data + ph->array_open_rawdata_N_offset);
+    short_rawdata_p = (int32_t *)(fw->data + ph->array_Short_Rawdata_P_offset);
+    short_rawdata_n = (int32_t *)(fw->data + ph->array_Short_Rawdata_N_offset);
+    diff_rawdata_p = (int32_t *)(fw->data + ph->array_FW_Diff_P_offset);
+    diff_rawdata_n = (int32_t *)(fw->data + ph->array_FW_Diff_N_offset);
+    cc_data_p = (int32_t *)(fw->data + ph->array_FW_CC_P_offset);
+    cc_data_n = (int32_t *)(fw->data + ph->array_FW_CC_N_offset);
+    doze_rawdata_p = (int32_t *)(fw->data + ph->array_Doze_Rawdata_P_offset);
+    doze_rawdata_n = (int32_t *)(fw->data + ph->array_Doze_Rawdata_N_offset);
+    doze_diff_rawdata_p = (int32_t *)(fw->data + ph->array_Doze_Diff_P_offset);
+    doze_diff_rawdata_n = (int32_t *)(fw->data + ph->array_Doze_Diff_N_offset);
+    lpwg_rawdata_p = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_P_offset);
+    lpwg_rawdata_n = (int32_t *)(fw->data + ph->array_LPWG_Rawdata_N_offset);
+    lpwg_diff_rawdata_p = (int32_t *)(fw->data + ph->array_LPWG_Diff_P_offset);
+    lpwg_diff_rawdata_n = (int32_t *)(fw->data + ph->array_LPWG_Diff_N_offset);
+
+    seq_printf(s, "\n FW_Rawdata_P:");
+    for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+        seq_printf(s, "\n[%2d] ", i);
+        for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+            seq_printf(s, "%4d, ", fw_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+        }
+    }
+
+    seq_printf(s, "\n FW_Rawdata_N:");
+    for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+        seq_printf(s, "\n[%2d] ", i);
+        for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+            seq_printf(s, "%4d, ", fw_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+        }
+    }
+
+    seq_printf(s, "\n Open_Rawdata_P:");
+    for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+        seq_printf(s, "\n[%2d] ", i);
+        for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+            seq_printf(s, "%4d, ", open_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+        }
+    }
+
+    seq_printf(s, "\n Open_Rawdata_N:");
+    for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+        seq_printf(s, "\n[%2d] ", i);
+        for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+            seq_printf(s, "%4d, ", open_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+        }
+    }
+
+    if (ph->config_Lmt_Short_Rawdata_P != 0) {
+        seq_printf(s, "\n config_Lmt_Short_Rawdata_P: %4d", ph->config_Lmt_Short_Rawdata_P);
+    } else {
+        seq_printf(s, "\n Short_Rawdata_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", short_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_Short_Rawdata_N != 0) {
+        seq_printf(s, "\n config_Lmt_Short_Rawdata_N: %4d", ph->config_Lmt_Short_Rawdata_N);
+    } else {
+        seq_printf(s, "\n Short_Rawdata_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", short_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    seq_printf(s, "\n config_Diff_Test_Frame: %4d", ph->config_Diff_Test_Frame);
+
+    if (ph->config_Lmt_FW_Diff_P != 0) {
+        seq_printf(s, "\n config_Lmt_FW_Diff_P: %4d", ph->config_Lmt_FW_Diff_P);
+    } else {
+        seq_printf(s, "\n Diff_Rawdata_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", diff_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_FW_Diff_N != 0) {
+        seq_printf(s, "\n config_Lmt_FW_Diff_N: %4d", ph->config_Lmt_FW_Diff_N);
+    } else {
+        seq_printf(s, "\n Diff_Rawdata_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", diff_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_FW_CC_P != 0) {
+        seq_printf(s, "\n config_Lmt_FW_CC_P: %4d", ph->config_Lmt_FW_CC_P);
+    } else {
+        seq_printf(s, "\n FW_Cc_data_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", cc_data_p[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_FW_CC_N != 0) {
+        seq_printf(s, "\n config_Lmt_FW_CC_N: %4d", ph->config_Lmt_FW_CC_N);
+    } else {
+        seq_printf(s, "\n FW_Cc_data_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", cc_data_n[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    seq_printf(s, "\n doze_X_Channel: %4d", ph->doze_X_Channel);
+
+    if (ph->config_Lmt_Doze_Rawdata_P != 0) {
+        seq_printf(s, "\n config_Lmt_Doze_Rawdata_P: %4d", ph->config_Lmt_Doze_Rawdata_P);
+    } else {
+        seq_printf(s, "\n Doze_Rawdata_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ph->doze_X_Channel; j++) {
+                seq_printf(s, "%4d, ", doze_rawdata_p[i * ph->doze_X_Channel + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_Doze_Rawdata_N != 0) {
+        seq_printf(s, "\n config_Lmt_Doze_Rawdata_N: %4d", ph->config_Lmt_Doze_Rawdata_N);
+    } else {
+        seq_printf(s, "\n Doze_Rawdata_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ph->doze_X_Channel; j++) {
+                seq_printf(s, "%4d, ", doze_rawdata_n[i * ph->doze_X_Channel + j]);
+            }
+        }
+    }
+
+    seq_printf(s, "\n config_Doze_Noise_Test_Frame: %4d", ph->config_Doze_Noise_Test_Frame);
+
+    if (ph->config_Lmt_Doze_Diff_P != 0) {
+        seq_printf(s, "\n config_Lmt_Doze_Diff_P: %4d", ph->config_Lmt_Doze_Diff_P);
+    } else {
+        seq_printf(s, "\n Doze_Diff_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ph->doze_X_Channel; j++) {
+                seq_printf(s, "%4d, ", doze_diff_rawdata_p[i * ph->doze_X_Channel + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_Doze_Diff_N != 0) {
+        seq_printf(s, "\n config_Lmt_Doze_Diff_N: %4d", ph->config_Lmt_Doze_Diff_N);
+    } else {
+        seq_printf(s, "\n Doze_Diff_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ph->doze_X_Channel; j++) {
+                seq_printf(s, "%4d, ", doze_diff_rawdata_n[i * ph->doze_X_Channel + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_LPWG_Rawdata_P != 0) {
+        seq_printf(s, "\n config_Lmt_LPWG_Rawdata_P: %4d", ph->config_Lmt_LPWG_Rawdata_P);
+    } else {
+        seq_printf(s, "\n Lpwg_Rawdata_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", lpwg_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_LPWG_Rawdata_N != 0) {
+        seq_printf(s, "\n config_Lmt_LPWG_Rawdata_N: %4d", ph->config_Lmt_LPWG_Rawdata_N);
+    } else {
+        seq_printf(s, "\n Lpwg_Rawdata_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", lpwg_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_LPWG_Diff_P != 0) {
+        seq_printf(s, "\n config_Lmt_LPWG_Diff_P: %4d", ph->config_Lmt_LPWG_Diff_P);
+    } else {
+        seq_printf(s, "\n Lpwg_Diff_P:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", lpwg_diff_rawdata_p[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    if (ph->config_Lmt_LPWG_Diff_N != 0) {
+        seq_printf(s, "\n config_Lmt_LPWG_Diff_N: %4d", ph->config_Lmt_LPWG_Diff_N);
+    } else {
+        seq_printf(s, "\n Lpwg_Diff_N:");
+        for (i = 0 ; i < ts->hw_res.RX_NUM; i++) {
+            seq_printf(s, "\n[%2d] ", i);
+            for (j = 0 ; j < ts->hw_res.TX_NUM; j++) {
+                seq_printf(s, "%4d, ", lpwg_diff_rawdata_n[i * ts->hw_res.TX_NUM + j]);
+            }
+        }
+    }
+
+    seq_printf(s, "\n");
+    release_firmware(fw);
+}
+
+/************ nvt auto test content*************************/
+
+static int tp_auto_test_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct nvt_proc_operations *nvt_ops;
+    const struct firmware *fw = NULL;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    mm_segment_t old_fs;
+    uint8_t data_buf[128];
+    int fd = -1, ret = -1;
+
+    struct nvt_testdata nvt_testdata =
+    {
+        .TX_NUM = 0,
+        .RX_NUM = 0,
+        .fd = -1,
+        .irq_gpio = -1,
+        .key_TX = 0,
+        .key_RX = 0,
+        .TP_FW = 0,
+        .fw = NULL,
+    };
+
+    if (!ts)
+        return 0;
+    nvt_ops = (struct nvt_proc_operations *)ts->private_data;
+    if (!nvt_ops)
+        return 0;
+    if (!nvt_ops->auto_test) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+
+    //step1:disable_irq && get mutex locked
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, false);
+    }
+
+    //step2: create a file to store test data in /sdcard/Tp_Test
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    snprintf(data_buf, 128, "/sdcard/TpTestReport/screenOn/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    sys_mkdir("/sdcard/TpTestReport", 0666);
+    sys_mkdir("/sdcard/TpTestReport/screenOn", 0666);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        enable_irq(ts->irq);
+
+        return 0;
+    }
+
+    //step3:request test limit data from userspace
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "No limit IMG\n");
+        sys_close(fd);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        enable_irq(ts->irq);
+        return 0;
+    }
+
+    //step3:init syna_testdata
+    nvt_testdata.fd = fd;
+    nvt_testdata.TX_NUM = ts->hw_res.TX_NUM;
+    nvt_testdata.RX_NUM = ts->hw_res.RX_NUM;
+    nvt_testdata.irq_gpio = ts->hw_res.irq_gpio;
+    nvt_testdata.key_TX = ts->hw_res.key_TX;
+    nvt_testdata.key_RX = ts->hw_res.key_RX;
+    nvt_testdata.TP_FW = ts->panel_data.TP_FW;
+    nvt_testdata.fw = fw;
+
+    nvt_ops->auto_test(s, ts->chip_data, &nvt_testdata);
+
+    //step4: close file && release test limit firmware
+    if (fd >= 0) {
+        sys_close(fd);
+        set_fs(old_fs);
+    }
+    release_firmware(fw);
+
+    //step5: return to normal mode
+    ts->ts_ops->reset(ts->chip_data);
+    operate_mode_switch(ts);
+
+    //step6: unlock the mutex && enable irq trigger
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int baseline_autotest_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_auto_test_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_auto_test_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = baseline_autotest_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/baseline_test
+int nvt_create_proc(struct touchpanel_data *ts, struct nvt_proc_operations *nvt_ops)
+{
+    int ret = 0;
+
+    // touchpanel_auto_test interface
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    ts->private_data = nvt_ops;
+    prEntry_tmp = proc_create_data("baseline_test", 0666, ts->prEntry_tp, &tp_auto_test_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+    return ret;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..cb0103b2b7a5b932487023faa98356a0f8a89eac
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Novatek/novatek_common.h
@@ -0,0 +1,95 @@
+/***************************************************
+ * File:nova_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             nova common driver
+ * Version:1.0:
+ * Date created:2017/09/18
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef NOVA_H
+#define NOVA_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+
+/*********PART2:Define Area**********************/
+struct nvt_testdata{
+    int TX_NUM;
+    int RX_NUM;
+    int fd;
+    int irq_gpio;
+    int key_TX;
+    int key_RX;
+    uint64_t  TP_FW;
+    const struct firmware *fw;
+};
+
+struct nvt_test_header {
+    unsigned int magic1;
+    unsigned int magic2;
+    //normal mode test
+    unsigned int array_fw_rawdata_P_offset;
+    unsigned int array_fw_rawdata_N_offset;
+    unsigned int array_open_rawdata_P_offset;
+    unsigned int array_open_rawdata_N_offset;
+    signed int   config_Lmt_Short_Rawdata_P;
+    signed int   config_Lmt_Short_Rawdata_N;
+    unsigned int config_Diff_Test_Frame;
+    signed int   config_Lmt_FW_Diff_P;
+    signed int   config_Lmt_FW_Diff_N;
+    signed int   config_Lmt_FW_CC_P;
+    signed int   config_Lmt_FW_CC_N;
+    //doze mode test
+    unsigned int doze_X_Channel;
+    signed int   config_Lmt_Doze_Rawdata_P;
+    signed int   config_Lmt_Doze_Rawdata_N;
+    unsigned int config_Doze_Noise_Test_Frame;
+    signed int   config_Lmt_Doze_Diff_P;
+    signed int   config_Lmt_Doze_Diff_N;
+    //lpwg mode test
+    signed int   config_Lmt_LPWG_Rawdata_P;
+    signed int   config_Lmt_LPWG_Rawdata_N;
+    signed int   config_Lmt_LPWG_Diff_P;
+    signed int   config_Lmt_LPWG_Diff_N;
+    //offset
+    unsigned int   array_Short_Rawdata_P_offset;
+    unsigned int   array_Short_Rawdata_N_offset;
+    unsigned int   array_FW_CC_P_offset;
+    unsigned int   array_FW_CC_N_offset;
+    unsigned int   array_FW_Diff_P_offset;
+    unsigned int   array_FW_Diff_N_offset;
+    unsigned int   array_Doze_Diff_P_offset;
+    unsigned int   array_Doze_Diff_N_offset;
+    unsigned int   array_Doze_Rawdata_P_offset;
+    unsigned int   array_Doze_Rawdata_N_offset;
+    unsigned int   array_LPWG_Rawdata_P_offset;
+    unsigned int   array_LPWG_Rawdata_N_offset;
+    unsigned int   array_LPWG_Diff_P_offset;
+    unsigned int   array_LPWG_Diff_N_offset;
+    //reserve space
+    signed int   reserve[16];
+};
+
+/*********PART3:Struct Area**********************/
+struct nvt_proc_operations {
+    void (*auto_test)    (struct seq_file *s, void *chip_data, struct nvt_testdata *nvt_testdata);
+};
+
+/*********PART4:function declare*****************/
+int nvt_create_proc(struct touchpanel_data *ts, struct nvt_proc_operations *nvt_ops);
+void nvt_flash_proc_init(struct touchpanel_data *ts, const char *name);
+void nvt_limit_read(struct seq_file *s, struct touchpanel_data *ts);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..815b86320c6d0985ef8d73b222c445a2dd6589e7
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Kconfig
@@ -0,0 +1,3 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Kconfig"
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..b75ecacd6acf893cfb452c482c702d3d1e45f406
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/Makefile
@@ -0,0 +1,10 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_SAMSUNG_S6SY761) += S6SY761/
+obj-$(CONFIG_TOUCHPANEL_SAMSUNG) += sec_common.o
+
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..9633644fd3b85a0c4fc53f9936d6f6b04c2c9c18
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Cong.Dai@Bsp.group.Tp for Samsung s6sy761 ic driver
+
+config TOUCHPANEL_SAMSUNG_S6SY761
+#	default y
+	bool "TP Samsung s6sy761 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel using Samsung s6sy761
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..3257ed461738c4f13e50412a97533bfd783d99e5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_SAMSUNG_S6SY761) += sec_drivers_s6sy761.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.c b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.c
new file mode 100644
index 0000000000000000000000000000000000000000..0056f7f6d35e5dd6cf2535ab38eb7346cabed5b7
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.c
@@ -0,0 +1,3371 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : sec_drivers_s6sy761.c
+ * Description: Source file for samsung s6sy761 driver
+ * Version   : 1.0
+ * Date        : 2018-01-10
+ * Author    : Cong.Dai@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "sec_drivers_s6sy761.h"
+
+extern int tp_register_times;
+extern struct touchpanel_data *g_tp;
+/****************** Start of Log Tag Declear and level define*******************************/
+#define TPD_DEVICE "sec-s6sy761"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+/******************** End of Log Tag Declear and level define*********************************/
+
+/*************************** start of function delcare****************************************/
+void sec_mdelay(unsigned int ms);
+static int sec_reset(void *chip_data);
+static int sec_power_control(void *chip_data, bool enable);
+static int sec_get_verify_result(struct chip_data_s6sy761 *chip_info);
+static void sec_ts_read_info_work(struct work_struct *work);
+int opticalfp_irq_handler(struct fp_underscreen_info* tp_info);
+//int qbt1000_int2_callback(int event);
+
+/**************************** end of function delcare*****************************************/
+
+
+/****** Start of other functions that work for oppo_touchpanel_operations callbacks***********/
+static int sec_enable_black_gesture(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+    int i = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+
+    if (enable) {
+        for (i = 0; i < 20; i++)
+        {
+            touch_i2c_write_word(chip_info->client, SEC_CMD_WAKEUP_GESTURE_MODE, 0xFFFF);
+            touch_i2c_write_byte(chip_info->client, SEC_CMD_SET_POWER_MODE, 0x01);
+            sec_mdelay(10);
+            ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_SET_POWER_MODE);
+            if (0x01 == ret)
+                break;
+        }
+	} else {
+		for (i = 0; i < 20; i++)
+		{
+			touch_i2c_write_word(chip_info->client, SEC_CMD_WAKEUP_GESTURE_MODE, 0x0000);
+			touch_i2c_write_byte(chip_info->client, SEC_CMD_SET_POWER_MODE, 0x00);
+			sec_mdelay(10);
+			ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_SET_POWER_MODE);
+			if (0x00 == ret)
+			break;
+		}
+        return 0;
+    }
+
+    if (i >= 5) {
+        ret = -1;
+        TPD_INFO("%s: enter black gesture failed\n", __func__);
+    } else {
+        TPD_INFO("%s: %d times enter black gesture success\n", __func__, i);
+    }
+    return ret;
+}
+
+static int sec_enable_edge_limit(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_word(chip_info->client, SEC_CMD_GRIP_SWITCH, 0x2000);
+    } else {
+        ret = touch_i2c_write_word(chip_info->client, SEC_CMD_GRIP_SWITCH, 0x0000);
+    }
+
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_enable_charge_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, SET_CMD_SET_CHARGER_MODE, 0x02);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, SET_CMD_SET_CHARGER_MODE, 0x01);
+    }
+
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_enable_earsense_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_HOVER_DETECT, 1);
+        ret |= touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_DATA_DELTA);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_HOVER_DETECT, 0);
+        ret |= touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_SIGNAL_DATA);
+    }
+
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_enable_face_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_HOVER_DETECT, 1);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_HOVER_DETECT, 0);
+    }
+
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_face_reduce_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+
+	if (enable) {
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_TOUCHHOLD_CALIBRATE, 1);
+	}
+
+	TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+	return ret;
+}
+
+static int sec_enable_palm_reject(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_word(chip_info->client, SEC_CMD_PALM_SWITCH, 0x0061);
+    } else {
+        ret = touch_i2c_write_word(chip_info->client, SEC_CMD_PALM_SWITCH, 0x0041);
+    }
+
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_enable_game_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+    int ret = -1;
+    char buf[4] = {0x00, 0x00, 0x00, 0x00};
+
+    buf[3] = enable ? 0x01 : 0x18;  //default value 0x18
+    ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SENSETIVE_CTRL, sizeof(buf), buf);
+    TPD_INFO("%s: state: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_refresh_switch_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+
+	if (enable) {
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_REFRESH_RATE_SWITCH, 0x5A);
+	} else {
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_REFRESH_RATE_SWITCH, 0x3C);
+	}
+    TPD_INFO("%s: refresh_switch: %s %s!\n", __func__, enable == 0 ? "60HZ":"90HZ", ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_touchhold_switch_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+	int i = 0;
+
+	if (enable == 1) {
+		for(i = 0; i < 10; i++) {
+			ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH);
+			ret |= 0x01;
+			ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH, ret);
+			sec_mdelay(10);
+			ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH);
+			if (ret == 1)
+				break;
+		}
+	} else if (enable == 0){
+		ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH);
+		ret &= 0xFE;
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH, ret);
+	}
+    TPD_INFO("%s: touchhold_enable: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+static int sec_toucharea_switch_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+
+	if (enable) {
+		ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH);
+		ret |= 0x02;
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH, ret);
+		TPD_INFO("%s:cmd = 0x%x, touch area switch qualcom %s\n", __func__, ret, ret < 0 ? "failed" : "success");
+	} else {
+		ret = touch_i2c_read_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH);
+		ret &= 0xFD;
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_TOUCHHOLD_SWITCH, ret);
+		TPD_INFO("%s:cmd = 0x%x, touch area switch goodix %s\n", __func__, ret, ret < 0 ? "failed" : "success");
+	}
+
+    return ret;
+}
+static int sec_limit_switch_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+	unsigned char buf[4] = {0};
+	unsigned char cmd[3] = {0};
+
+		if (g_tp->limit_switch == 1) {		//LANDSPACE
+			ret = touch_i2c_write_byte(chip_info->client, 0x4B, 0);	//close wet mode
+			cmd[0] = 0x01;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_GRIPMODE_SWITCH, 3, cmd);	//change mode
+			buf[1] = 0x64;
+			buf[3] = 0x64;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_LANDSPACE_CORNER, 4, buf);
+		}  else if (g_tp->limit_switch == 3) {
+			ret = touch_i2c_write_byte(chip_info->client, 0x4B, 0);
+			cmd[0] = 0x02;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_GRIPMODE_SWITCH, 3, cmd);
+			buf[1] = 0x64;
+			buf[3] = 0x64;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_LANDSPACE_CORNER, 4, buf);
+		} else {	//portrait
+			ret = touch_i2c_write_byte(chip_info->client, 0x4B, 1);	//open wet mode
+			cmd[0] = 0;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_GRIPMODE_SWITCH, 3, cmd);
+			buf[1] = 0x64;
+			buf[3] = 0x64;
+			ret = touch_i2c_write_block(chip_info->client, SEC_CMD_PORTRAIT_CORNER, 4, buf);
+	}
+    return ret;
+
+}
+
+static int sec_gesture_switch_mode(struct chip_data_s6sy761 *chip_info, bool enable)
+{
+	int ret = -1;
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_WAKEUP_GESTURE_MODE, 1); //disable gesture
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_WAKEUP_GESTURE_MODE, 0); //enable gesture
+    }
+
+    TPD_INFO("%s: gesture_switch: %s %s!\n", __func__, enable == 0 ? "enable":"disable", ret < 0 ? "failed" : "success");
+    return ret;
+}
+
+void sec_mdelay(unsigned int ms)
+{
+    if (ms < 20)
+        usleep_range(ms * 1000, ms * 1000);
+    else
+        msleep(ms);
+}
+
+int sec_wait_for_ready(struct chip_data_s6sy761 *chip_info, unsigned int ack)
+{
+    int rc = -1;
+    int retry = 0, retry_cnt = 100;
+    int8_t status = -1;
+    u8 tBuff[SEC_EVENT_BUFF_SIZE] = {0,};
+
+    while (touch_i2c_read_block(chip_info->client, SEC_READ_ONE_EVENT, SEC_EVENT_BUFF_SIZE, tBuff) > 0) {
+        status = (tBuff[0] >> 2) & 0xF;
+        if ((status == TYPE_STATUS_EVENT_INFO) || (status == TYPE_STATUS_EVENT_VENDOR_INFO)) {
+            if (tBuff[1] == ack) {
+                rc = 0;
+                break;
+            }
+        }
+
+        if (retry++ > retry_cnt) {
+            TPD_INFO("%s: Time Over, event_buf: %02X, %02X, %02X, %02X, %02X, %02X, %02X, %02X \n", \
+                        __func__, tBuff[0], tBuff[1], tBuff[2], tBuff[3], tBuff[4], tBuff[5], tBuff[6], tBuff[7]);
+            break;
+        }
+        sec_mdelay(20);
+    }
+
+    return rc;
+}
+
+static int sec_enter_fw_mode(struct chip_data_s6sy761 *chip_info)
+{
+    int ret = -1;
+    u8 device_id[3] = {0};
+    u8 fw_update_mode_passwd[] = {0x55, 0xAC};
+
+    ret = touch_i2c_write_block(chip_info->client, SEC_CMD_ENTER_FW_MODE, sizeof(fw_update_mode_passwd), fw_update_mode_passwd);
+    sec_mdelay(20);
+    if (ret < 0) {
+        TPD_INFO("%s: write cmd to enter fw mode failed\n", __func__);
+        return -1;
+    }
+
+    //need soft reset or hard reset
+    if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+        gpio_direction_output(chip_info->hw_res->reset_gpio, false);
+        sec_mdelay(10);
+        gpio_direction_output(chip_info->hw_res->reset_gpio, true);
+    } else {
+        ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SOFT_RESET, 0, NULL);
+        if (ret < 0) {
+            TPD_INFO("%s: write soft reset failed\n", __func__);
+            return -1;
+        }
+    }
+    sec_mdelay(100);
+
+    ret = touch_i2c_read_byte(chip_info->client, SEC_READ_BOOT_STATUS);     //after reset, check bootloader again
+    if (ret < 0) {
+        TPD_INFO("%s: read boot status failed\n", __func__);
+        return -1;
+    }
+    if (ret != SEC_STATUS_BOOT_MODE) {
+        TPD_INFO("%s: read boot status, but no in boot mode(%d)\n", __func__, ret);
+        return -1;
+    }
+
+    sec_mdelay(10);
+
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_ID, 3, device_id);
+    if (ret < 0) {
+        TPD_INFO("%s: read 3 byte device id failed\n", __func__);
+        return -1;
+    }
+
+    chip_info->boot_ver[0] = device_id[0];
+    chip_info->boot_ver[1] = device_id[1];
+    chip_info->boot_ver[2] = device_id[2];
+    chip_info->flash_page_size = SEC_FW_BLK_DEFAULT_SIZE;
+    if ((device_id[1] == 0x37) && (device_id[2] == 0x61))
+        chip_info->flash_page_size = 512;
+
+    return 0;
+}
+
+static u8 sec_checksum(u8 *data, int offset, int size)
+{
+    int i;
+    u8 checksum = 0;
+
+    for (i = 0; i < size; i++)
+        checksum += data[i + offset];
+
+    return checksum;
+}
+
+static int sec_flash_page_erase(struct chip_data_s6sy761 *chip_info, u32 page_idx, u32 page_num)
+{
+    int ret = -1;
+    u8 tCmd[6] = {0};
+
+    tCmd[0] = SEC_CMD_FLASH_ERASE;
+    tCmd[1] = (u8)((page_idx >> 8) & 0xFF);
+    tCmd[2] = (u8)((page_idx >> 0) & 0xFF);
+    tCmd[3] = (u8)((page_num >> 8) & 0xFF);
+    tCmd[4] = (u8)((page_num >> 0) & 0xFF);
+    tCmd[5] = sec_checksum(tCmd, 1, 4);
+
+    ret = touch_i2c_write(chip_info->client, tCmd, 6);
+
+    return ret;
+}
+
+static int sec_flash_page_write(struct chip_data_s6sy761 *chip_info, u32 page_idx, u8 *page_data)
+{
+    int ret;
+    u8 tCmd[1 + 2 + SEC_FW_BLK_SIZE_MAX + 1];
+    int flash_page_size = (int)chip_info->flash_page_size;
+
+    tCmd[0] = SEC_CMD_FLASH_WRITE;
+    tCmd[1] = (u8)((page_idx >> 8) & 0xFF);
+    tCmd[2] = (u8)((page_idx >> 0) & 0xFF);
+
+    memcpy(&tCmd[3], page_data, flash_page_size);
+    tCmd[1 + 2 + flash_page_size] = sec_checksum(tCmd, 1, 2 + flash_page_size);
+
+    ret = touch_i2c_write(chip_info->client, tCmd, 1 + 2 + flash_page_size + 1);
+    return ret;
+}
+
+static bool sec_limited_flash_page_write(struct chip_data_s6sy761 *chip_info, u32 page_idx, u8 *page_data)
+{
+    int ret = -1;
+    u8 *tCmd = NULL;
+    u8 copy_data[3 + SEC_FW_BLK_SIZE_MAX];
+    int copy_left = (int)chip_info->flash_page_size + 3;
+    int copy_size = 0;
+    int copy_max = I2C_BURSTMAX - 1;
+    int flash_page_size = (int)chip_info->flash_page_size;
+
+    copy_data[0] = (u8)((page_idx >> 8) & 0xFF);    /* addH */
+    copy_data[1] = (u8)((page_idx >> 0) & 0xFF);    /* addL */
+
+    memcpy(&copy_data[2], page_data, flash_page_size);    /* DATA */
+    copy_data[2 + flash_page_size] = sec_checksum(copy_data, 0, 2 + flash_page_size);    /* CS */
+
+    while (copy_left > 0) {
+        int copy_cur = (copy_left > copy_max) ? copy_max : copy_left;
+
+        tCmd = kzalloc(copy_cur + 1, GFP_KERNEL);
+        if (!tCmd)
+            goto err_write;
+
+        if (copy_size == 0)
+            tCmd[0] = SEC_CMD_FLASH_WRITE;
+        else
+            tCmd[0] = SEC_CMD_FLASH_PADDING;
+
+        memcpy(&tCmd[1], &copy_data[copy_size], copy_cur);
+
+        ret = touch_i2c_write(chip_info->client, tCmd, 1 + copy_cur);
+        if (ret < 0) {
+            ret = touch_i2c_write(chip_info->client, tCmd, 1 + copy_cur);
+            if (ret < 0) {
+                TPD_INFO("%s: failed, ret:%d\n", __func__, ret);
+            }
+        }
+
+        copy_size += copy_cur;
+        copy_left -= copy_cur;
+        kfree(tCmd);
+    }
+    return ret;
+
+err_write:
+    TPD_INFO("%s: failed to alloc.\n", __func__);
+    return -ENOMEM;
+
+}
+
+static int sec_flash_write(struct chip_data_s6sy761 *chip_info, u32 mem_addr, u8 *mem_data, u32 mem_size)
+{
+    int ret = -1;
+    u32 page_idx = 0, size_copy = 0, flash_page_size = 0;
+    u32 page_idx_start = 0, page_idx_end = 0, page_num = 0;
+    u8 page_buf[SEC_FW_BLK_SIZE_MAX] = {0};
+
+    if (mem_size == 0)
+        return 0;
+
+    flash_page_size = chip_info->flash_page_size;
+    page_idx_start = mem_addr / flash_page_size;
+    page_idx_end = (mem_addr + mem_size - 1) / flash_page_size;
+    page_num = page_idx_end - page_idx_start + 1;
+
+    ret = sec_flash_page_erase(chip_info, page_idx_start, page_num);
+    if (ret < 0) {
+        TPD_INFO("%s: fw erase failed, mem_addr= %08X, pagenum = %d\n", __func__, mem_addr, page_num);
+        return -EIO;
+    }
+
+    sec_mdelay(page_num + 10);
+
+    size_copy = mem_size % flash_page_size;
+    if (size_copy == 0)
+        size_copy = flash_page_size;
+
+    memset(page_buf, 0, flash_page_size);
+
+    for (page_idx = page_num - 1;; page_idx--) {
+        memcpy(page_buf, mem_data + (page_idx * flash_page_size), size_copy);
+        if (chip_info->boot_ver[0] == 0xB2) {
+            ret = sec_flash_page_write(chip_info, (page_idx + page_idx_start), page_buf);
+            if (ret < 0) {
+                sec_mdelay(50);
+                ret = sec_flash_page_write(chip_info, (page_idx + page_idx_start), page_buf);                
+                if (ret < 0) {
+                    TPD_INFO("%s: fw write failed, page_idx = %u\n", __func__, page_idx);
+                    goto err;
+                }
+            }
+        } else {
+            ret = sec_limited_flash_page_write(chip_info, (page_idx + page_idx_start), page_buf);
+            if (ret < 0) {
+                sec_mdelay(50);
+                ret = sec_limited_flash_page_write(chip_info, (page_idx + page_idx_start), page_buf);
+                if (ret < 0) {
+                    TPD_INFO("%s: fw write failed, page_idx = %u\n", __func__, page_idx);
+                    goto err;
+                }
+            }
+
+        }
+
+        size_copy = flash_page_size;
+        sec_mdelay(5);
+
+        if (page_idx == 0) /* end condition (page_idx >= 0)   page_idx type unsinged int */
+            break;
+    }
+
+    return mem_size;
+err:
+    return -EIO;
+}
+
+static int sec_block_read(struct chip_data_s6sy761 *chip_info, u32 mem_addr, int mem_size, u8 *buf)
+{
+    int ret;
+    u8 cmd[5];
+    u8 *data;
+
+    if (mem_size >= 64 * 1024) {
+        TPD_INFO("%s: mem size over 64K\n", __func__);
+        return -EIO;
+    }
+
+    cmd[0] = (u8)SEC_CMD_FLASH_READ_ADDR;
+    cmd[1] = (u8)((mem_addr >> 24) & 0xff);
+    cmd[2] = (u8)((mem_addr >> 16) & 0xff);
+    cmd[3] = (u8)((mem_addr >> 8) & 0xff);
+    cmd[4] = (u8)((mem_addr >> 0) & 0xff);
+
+    ret = touch_i2c_write(chip_info->client, cmd, 5);
+    if (ret < 0) {
+        TPD_INFO("%s: send command failed, %02X\n", __func__, cmd[0]);
+        return -EIO;
+    }
+
+    udelay(10);
+    cmd[0] = (u8)SEC_CMD_FLASH_READ_SIZE;
+    cmd[1] = (u8)((mem_size >> 8) & 0xff);
+    cmd[2] = (u8)((mem_size >> 0) & 0xff);
+
+    ret = touch_i2c_write(chip_info->client, cmd, 3);
+    if (ret < 0) {
+        TPD_INFO("%s: send command failed, %02X\n", __func__, cmd[0]);
+        return -EIO;
+    }
+
+    udelay(10);
+    cmd[0] = (u8)SEC_CMD_FLASH_READ_DATA;
+    data = buf;
+
+    ret = touch_i2c_read(chip_info->client, cmd, 1, data, mem_size);
+    if (ret < 0) {
+        TPD_INFO("%s: memory read failed\n", __func__);
+        return -EIO;
+    }
+
+    return 0;
+}
+
+static int sec_memory_read(struct chip_data_s6sy761 *chip_info, u32 mem_addr, u8 *mem_data, u32 mem_size)
+{
+    int ret;
+    int retry = 3;
+    int read_size = 0;
+    int unit_size;
+    int max_size = I2C_BURSTMAX;
+    int read_left = (int)mem_size;
+    u8 *tmp_data;
+
+    tmp_data = kmalloc(max_size, GFP_KERNEL);
+    if (!tmp_data) {
+        TPD_INFO("%s: failed to kmalloc\n", __func__);
+        return -ENOMEM;
+    }
+
+    while (read_left > 0) {
+        unit_size = (read_left > max_size) ? max_size : read_left;
+        retry = 3;
+        do {
+            ret = sec_block_read(chip_info, mem_addr, unit_size, tmp_data);
+            if (retry-- == 0) {
+                TPD_INFO("%s: fw read fail mem_addr=%08X, unit_size=%d\n", __func__, mem_addr, unit_size);
+                kfree(tmp_data);
+                return -1;
+            }
+
+            memcpy(mem_data + read_size, tmp_data, unit_size);
+        } while (ret < 0);
+
+        mem_addr += unit_size;
+        read_size += unit_size;
+        read_left -= unit_size;
+    }
+
+    kfree(tmp_data);
+
+    return read_size;
+}
+
+static int sec_chunk_update(struct chip_data_s6sy761 *chip_info, u32 addr, u32 size, u8 *data)
+{
+    int ii = 0, ret = 0;
+    u8 *mem_rb = NULL;
+    u32 write_size = 0;
+    u32 fw_size = size;
+
+    write_size = sec_flash_write(chip_info, addr, data, fw_size);
+    if (write_size != fw_size) {
+        TPD_INFO("%s: fw write failed\n", __func__);
+        ret = -1;
+        goto err_write_fail;
+    }
+
+    mem_rb = vzalloc(fw_size);
+    if (!mem_rb) {
+        TPD_INFO("%s: vzalloc failed\n", __func__);
+        ret = -1;
+        goto err_write_fail;
+    }
+
+    if (sec_memory_read(chip_info, addr, mem_rb, fw_size) >= 0) {
+        for (ii = 0; ii < fw_size; ii++) {
+            if (data[ii] != mem_rb[ii])
+                break;
+        }
+
+        if (fw_size != ii) {
+            TPD_INFO("%s: fw verify fail at data[%d](%d, %d)\n", __func__, ii, data[ii], mem_rb[ii]);
+            ret = -1;
+            goto out;
+        }
+    } else {
+        ret = -1;
+        goto out;
+    }
+
+    TPD_INFO("%s: verify done(%d)\n", __func__, ret);
+
+out:
+    vfree(mem_rb);
+err_write_fail:
+    sec_mdelay(10);
+
+    return ret;
+}
+
+int sec_read_calibration_report(struct chip_data_s6sy761 *chip_info)
+{
+    int ret;
+    u8 buf[5] = { 0 };
+
+    buf[0] = SEC_CMD_READ_CALIBRATION_REPORT;
+
+    ret = touch_i2c_read(chip_info->client, &buf[0], 1, &buf[1], 4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed to read, ret = %d\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_INFO("%s: count:%d, pass count:%d, fail count:%d, status:0x%X\n",
+                __func__, buf[1], buf[2], buf[3], buf[4]);
+
+    return buf[4];
+}
+
+int sec_execute_force_calibration(struct chip_data_s6sy761 *chip_info)
+{
+    int rc = -1;
+
+    if (touch_i2c_write_block(chip_info->client, SEC_CMD_FACTORY_PANELCALIBRATION, 0, NULL) < 0) {
+        TPD_INFO("%s: Write Cal commend failed!\n", __func__);
+        return rc;
+    }
+
+    sec_mdelay(1000);
+    rc = sec_wait_for_ready(chip_info, SEC_VENDOR_ACK_OFFSET_CAL_DONE);
+
+    return rc;
+}
+
+static void handleFourCornerPoint(struct Coordinate *point, int n)
+{
+    int i = 0;
+    struct Coordinate left_most = point[0], right_most = point[0], top_most = point[0], down_most = point[0];
+
+    if (n < 4)
+        return;
+
+    for (i = 0; i < n; i++) {
+        if (right_most.x < point[i].x) {   //xmax
+            right_most = point[i];
+        }
+        if (left_most.x > point[i].x) {   //xmin
+            left_most = point[i];
+        }
+        if (down_most.y < point[i].y) {   //ymax
+            down_most = point[i];
+        }
+        if (top_most.y > point[i].y) {   //ymin
+            top_most = point[i];
+        }
+    }
+    point[0] = top_most;
+    point[1] = left_most;
+    point[2] = down_most;
+    point[3] = right_most;
+}
+/****** End of other functions that work for oppo_touchpanel_operations callbacks*************/
+
+/********* Start of implementation of oppo_touchpanel_operations callbacks********************/
+static int sec_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    TPD_INFO("%s is called\n", __func__);
+    if (chip_info->is_power_down) { //power off state, no need reset
+        return 0;
+    }
+
+    disable_irq_nosync(chip_info->client->irq);
+
+    if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {    //rsted by rst pin
+        TPD_INFO("reset by pull down rst pin");
+        gpio_direction_output(chip_info->hw_res->reset_gpio, false);
+        sec_mdelay(5);
+        gpio_direction_output(chip_info->hw_res->reset_gpio, true);
+    } else {    //otherwise by soft reset
+        touch_i2c_write_block(chip_info->client, SEC_CMD_SOFT_RESET, 0, NULL);
+    }
+
+    sec_mdelay(RESET_TO_NORMAL_TIME);
+    sec_wait_for_ready(chip_info, SEC_ACK_BOOT_COMPLETE);
+    ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SENSE_ON, 0, NULL);
+    TPD_INFO("%s: write sense on %s\n", __func__, (ret < 0) ? "failed" : "success");
+
+    enable_irq(chip_info->client->irq);
+
+    return 0;
+}
+
+static int sec_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    int len = 0;
+    char manu_temp[MAX_DEVICE_MANU_LENGTH] = "SEC_";
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    len = strlen(panel_data->fw_name);
+    if ((len > 3) && (panel_data->fw_name[len-3] == 'i') && \
+        (panel_data->fw_name[len-2] == 'm') && (panel_data->fw_name[len-1] == 'g')) {
+        panel_data->fw_name[len-3] = 'b';
+        panel_data->fw_name[len-2] = 'i';
+        panel_data->fw_name[len-1] = 'n';
+    }
+    chip_info->tp_type = panel_data->tp_type;
+    strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+    strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+    TPD_INFO("chip_info->tp_type = %d, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->fw_name);
+
+    return 0;
+}
+
+static int sec_get_chip_info(void *chip_data)
+{
+    return 0;
+}
+
+static int sec_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    TPD_INFO("%s enable :%d\n", __func__, enable);
+    if (true == enable) {
+		tp_powercontrol_1v8(chip_info->hw_res, true);
+		tp_powercontrol_2v8(chip_info->hw_res, true);
+		if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+			TPD_INFO("Set the reset_gpio \n");
+			gpio_direction_output(chip_info->hw_res->reset_gpio, 1);
+        }
+        msleep(RESET_TO_NORMAL_TIME);
+        sec_wait_for_ready(chip_info, SEC_ACK_BOOT_COMPLETE);
+        ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SENSE_ON, 0, NULL);
+        TPD_INFO("%s: write sense on %s\n", __func__, (ret < 0) ? "failed" : "success");
+        chip_info->is_power_down = false;
+    } else {
+        tp_powercontrol_2v8(chip_info->hw_res, false);
+		msleep(5);
+		tp_powercontrol_1v8(chip_info->hw_res, false);
+		if (gpio_is_valid(chip_info->hw_res->reset_gpio)) {
+			TPD_INFO("Set the reset_gpio \n");
+			gpio_direction_output(chip_info->hw_res->reset_gpio, 0);
+		}
+
+        chip_info->is_power_down = true;
+    }
+
+    return ret;
+}
+
+static fw_check_state sec_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    int ret = 0;
+    unsigned char data[5] = { 0 };
+    bool valid_fw_integrity = false;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    ret = touch_i2c_read_byte(chip_info->client, SEC_READ_FIRMWARE_INTEGRITY);  //judge whether fw is right
+    if (ret < 0) {
+        TPD_INFO("%s: failed to do integrity check (%d)\n", __func__, ret);
+    } else {
+        if (ret & 0x80) {
+            valid_fw_integrity = true;
+        } else {
+            valid_fw_integrity = false;
+            TPD_INFO("invalid firmware integrity (%d)\n", ret);
+        }
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, SEC_READ_BOOT_STATUS);
+    if (ret < 0) {
+        TPD_INFO("%s: failed to read boot status\n", __func__);
+    } else {
+        ret = touch_i2c_read_block(chip_info->client, SEC_READ_TS_STATUS, 4, &data[1]);
+        if (ret < 0) {
+            TPD_INFO("%s: failed to read touch status\n", __func__);
+        }
+    }
+    if ((((data[0] == SEC_STATUS_APP_MODE) && (data[2] == TOUCH_SYSTEM_MODE_FLASH)) || (ret < 0)) && (valid_fw_integrity == false)) {
+        TPD_INFO("%s: fw id abnormal, need update\n", __func__);
+        return FW_ABNORMAL;
+    }
+
+    memset(data, 0, 5);
+    touch_i2c_read_block(chip_info->client, SEC_READ_IMG_VERSION, 4, data);
+    panel_data->TP_FW = (data[0] << 24) | (data[1] << 16) | (data[2] << 8) | data[3];
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    // ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SENSE_ON, 0, NULL);
+    // TPD_INFO("%s: write sense on %s\n", (ret < 0) ? "failed" : "success");
+    return FW_NORMAL;
+}
+
+static fw_update_state sec_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int i = 0, ret = 0;
+    u8 buf[4] = {0};
+    u8 *fd = NULL;
+    uint8_t cal_status = 0;
+    sec_fw_chunk *fw_ch = NULL;
+    sec_fw_header *fw_hd = NULL;
+    uint32_t fw_version_in_bin = 0, fw_version_in_ic = 0;
+    uint32_t config_version_in_bin = 0, config_version_in_ic = 0;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called, force update:%d\n", __func__, force);
+
+    fd = (u8 *)(fw->data);
+    fw_hd = (sec_fw_header *)(fw->data);
+    buf[3] = (fw_hd->img_ver >> 24) & 0xff;
+    buf[2] = (fw_hd->img_ver >> 16) & 0xff;
+    buf[1] = (fw_hd->img_ver >> 8) & 0xff;
+    buf[0] = (fw_hd->img_ver >> 0) & 0xff;
+    fw_version_in_bin = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_IMG_VERSION, 4, buf);
+    fw_version_in_ic = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("img version in bin is 0x%04x, img version in ic is 0x%04x\n", fw_version_in_bin, fw_version_in_ic);
+
+    buf[3] = (fw_hd->para_ver >> 24) & 0xff;
+    buf[2] = (fw_hd->para_ver >> 16) & 0xff;
+    buf[1] = (fw_hd->para_ver >> 8) & 0xff;
+    buf[0] = (fw_hd->para_ver >> 0) & 0xff;
+    config_version_in_bin = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_CONFIG_VERSION, 4, buf);
+    config_version_in_ic = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("config version in bin is 0x%04x, config version in ic is 0x%04x\n", config_version_in_bin, config_version_in_ic);
+
+    ret = touch_i2c_read_byte(chip_info->client, SEC_READ_BOOT_STATUS);
+    if (ret == SEC_STATUS_BOOT_MODE) {
+        force = 1;
+        TPD_INFO("%s: still in bootloader mode, will do force update\n", __func__);
+    }
+
+    if (!force) {
+        if (fw_version_in_bin == fw_version_in_ic) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    if (sec_enter_fw_mode(chip_info)) {
+        TPD_INFO("%s: enter fw mode failed\n", __func__);
+        return FW_UPDATE_ERROR;
+    }
+
+    if (fw_hd->signature != SEC_FW_HEADER_SIGN) {
+        TPD_INFO("%s: firmware header error(0x%08x)\n", __func__, fw_hd->signature);
+        return FW_UPDATE_ERROR;
+    }
+
+    fd += sizeof(sec_fw_header);
+    for (i = 0; i < fw_hd->num_chunk; i++) {
+        fw_ch = (sec_fw_chunk *)fd;
+        TPD_INFO("update %d chunk(addr: 0x%08x, size: 0x%08x)\n", i, fw_ch->addr, fw_ch->size);
+        if (fw_ch->signature != SEC_FW_CHUNK_SIGN) {
+            TPD_INFO("%s: firmware chunk error(0x%08x)\n", __func__, fw_ch->signature);
+            return FW_UPDATE_ERROR;
+        }
+        fd += sizeof(sec_fw_chunk);
+        ret = sec_chunk_update(chip_info, fw_ch->addr, fw_ch->size, fd);
+        if (ret < 0) {
+            TPD_INFO("update chunk failed\n");
+            return FW_UPDATE_ERROR;
+        }
+        fd += fw_ch->size;
+    }
+
+    sec_reset(chip_info);
+    cal_status = sec_read_calibration_report(chip_info);    //read out calibration result
+    if ((cal_status == 0) || (cal_status == 0xFF) || (config_version_in_ic != config_version_in_bin)) {
+        TPD_INFO("start calibration.\n");
+        ret = sec_execute_force_calibration(chip_info);
+        if (ret < 0) {
+            TPD_INFO("calibration failed once, try again.\n");
+            ret = sec_execute_force_calibration(chip_info);
+        }
+        TPD_INFO("calibration %s\n", (ret < 0) ? "failed" : "success");
+    }
+    TPD_INFO("%s: update success\n", __func__);
+    return FW_UPDATE_SUCCESS;
+}
+
+static u8 sec_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    int event_id = 0;
+    u8 left_event_cnt = 0;
+    struct sec_event_status *p_event_status = NULL;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+	struct fp_underscreen_info tp_info;
+
+    memset(chip_info->first_event, 0, SEC_EVENT_BUFF_SIZE);
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_ONE_EVENT, SEC_EVENT_BUFF_SIZE, chip_info->first_event);
+    if (ret < 0) {
+        TPD_DETAIL("%s: read one event failed\n", __func__);
+        return IRQ_IGNORE;
+    }
+
+    TPD_DEBUG("first event: 0x%02x, 0x%02x, 0x%02x, 0x%02x, 0x%02x, 0x%02x, 0x%02x, 0x%02x\n", \
+        chip_info->first_event[0], chip_info->first_event[1], chip_info->first_event[2], chip_info->first_event[3],\
+        chip_info->first_event[4], chip_info->first_event[5], chip_info->first_event[6], chip_info->first_event[7]);
+
+    if (chip_info->first_event[0] == 0) {
+        TPD_DETAIL("%s: event buffer is empty\n", __func__);
+        return IRQ_IGNORE;
+    }
+
+    left_event_cnt = chip_info->first_event[7] & 0x3F;
+    if ((left_event_cnt > MAX_EVENT_COUNT - 1) || (left_event_cnt == 0xFF)) {
+        TPD_INFO("%s: event buffer overflow, do clear the buffer\n", __func__);
+        ret = touch_i2c_write_block(chip_info->client, SEC_CMD_CLEAR_EVENT_STACK, 0, NULL);
+        if (ret < 0) {
+            TPD_INFO("%s: clear event buffer failed\n", __func__);
+        }
+        return IRQ_IGNORE;
+    }
+
+    event_id = chip_info->first_event[0] & 0x3;
+    if (event_id == SEC_STATUS_EVENT) {
+        /* watchdog reset -> send SENSEON command */
+        p_event_status = (struct sec_event_status *)chip_info->first_event;
+        if ((p_event_status->stype == TYPE_STATUS_EVENT_INFO) &&
+            (p_event_status->status_id == SEC_ACK_BOOT_COMPLETE) && (p_event_status->status_data_1 == 0x20)) {
+
+            ret = touch_i2c_write_block(chip_info->client, SEC_CMD_SENSE_ON, 0, NULL);
+            if (ret < 0) {
+                TPD_INFO("%s: write sense on failed\n", __func__);
+            }
+            return IRQ_FW_AUTO_RESET;
+        }
+
+        /* event queue full-> all finger release */
+        if ((p_event_status->stype == TYPE_STATUS_EVENT_ERR) && (p_event_status->status_id == SEC_ERR_EVENT_QUEUE_FULL)) {
+            TPD_INFO("%s: IC Event Queue is full\n", __func__);
+            tp_touch_btnkey_release();
+        }
+
+        if ((p_event_status->stype == TYPE_STATUS_EVENT_ERR) && (p_event_status->status_id == SEC_ERR_EVENT_ESD)) {
+            TPD_INFO("%s: ESD detected. run reset\n", __func__);
+            return IRQ_EXCEPTION;
+        }
+
+        if ((p_event_status->stype == TYPE_STATUS_EVENT_VENDOR_INFO) && (p_event_status->status_id == SEC_STATUS_EARDETECTED)) {
+			chip_info->proximity_status = p_event_status->status_data_1;
+			TPD_INFO("%s: face detect status %d\n",__func__, chip_info->proximity_status);
+			return IRQ_FACE_STATE;
+        }
+
+		if ((p_event_status->stype == TYPE_STATUS_EVENT_VENDOR_INFO) && (p_event_status->status_id == SEC_STATUS_TOUCHHOLD)) {
+			if (p_event_status->status_data_1 == 1) {
+				tp_info.touch_state = 1;
+				tp_info.x = 720;
+				tp_info.y = 2728;
+				tp_info.area_rate = 90;
+				g_tp->touchold_event = 1;
+ 				gf_opticalfp_irq_handler(1);
+				opticalfp_irq_handler(&tp_info);
+				//qbt1000_int2_callback(1);
+			} else if (p_event_status->status_data_1 == 0) {
+				tp_info.touch_state = 0;
+				tp_info.x = 0;
+				tp_info.y = 0;
+				tp_info.area_rate = 0;
+				g_tp->touchold_event = 0;
+				gf_opticalfp_irq_handler(0);
+				//qbt1000_int2_callback(0);
+				opticalfp_irq_handler(&tp_info);
+			}
+			TPD_INFO("%s: touch_hold status %d\n",__func__, p_event_status->status_data_1);
+			return IRQ_IGNORE;
+		}
+
+        if ((p_event_status->stype == TYPE_STATUS_EVENT_INFO) && (p_event_status->status_id == SEC_TS_ACK_WET_MODE)) {
+			chip_info->wet_mode = p_event_status->status_data_1;
+            TPD_INFO("%s: water wet mode %d\n",__func__, chip_info->wet_mode);
+            return IRQ_IGNORE;
+        }
+		if ((p_event_status->stype == TYPE_STATUS_EVENT_VENDOR_INFO) && (p_event_status->status_id == SEC_TS_VENDOR_ACK_NOISE_STATUS_NOTI)) {
+			chip_info->touch_noise_status = !!p_event_status->status_data_1;
+            TPD_INFO("%s: TSP NOISE MODE %s[%d]\n",
+						__func__,chip_info->touch_noise_status == 0 ? "OFF" : "ON",
+						p_event_status->status_data_1);
+            return IRQ_IGNORE;
+        }
+    } else if (event_id == SEC_COORDINATE_EVENT) {
+        return IRQ_TOUCH;
+    } else if (event_id == SEC_GESTURE_EVENT) {
+        return IRQ_GESTURE;
+    }
+
+    return IRQ_IGNORE;
+}
+
+static int sec_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int i = 0;
+    int t_id = 0;
+    int ret = -1;
+    int left_event = 0;
+    struct sec_event_coordinate *p_event_coord = NULL;
+    uint32_t obj_attention = 0;
+    u8 *event_buff;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+	event_buff = kzalloc(MAX_EVENT_COUNT*SEC_EVENT_BUFF_SIZE * (sizeof(uint8_t)), GFP_KERNEL);
+	if (!event_buff) {
+		TPD_INFO("event_buff kzalloc failed\n");
+		return -ENOMEM;
+	}
+    p_event_coord = (struct sec_event_coordinate *)chip_info->first_event;
+    t_id = (p_event_coord->tid - 1);
+    if ((t_id < max_num) && ((p_event_coord->tchsta == SEC_COORDINATE_ACTION_PRESS) || (p_event_coord->tchsta == SEC_COORDINATE_ACTION_MOVE))) {
+        points[t_id].x = (p_event_coord->x_11_4 << 4) | (p_event_coord->x_3_0);
+        points[t_id].y = (p_event_coord->y_11_4 << 4) | (p_event_coord->y_3_0);
+        points[t_id].z = p_event_coord->z & 0x3F;
+        points[t_id].width_major = p_event_coord->major;
+        points[t_id].touch_major = p_event_coord->major;
+        points[t_id].status = 1;
+
+        if (points[t_id].z <= 0) {
+            points[t_id].z = 1;
+        }
+        obj_attention = obj_attention | (1 << t_id);    //set touch bit
+    }
+
+    left_event = chip_info->first_event[7] & 0x3F;
+    if (left_event == 0) {
+	kfree(event_buff);
+        return obj_attention;
+    } else if (left_event > max_num - 1) {
+        TPD_INFO("%s: read left event beyond max touch points\n", __func__);
+        left_event = max_num - 1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_ALL_EVENT, sizeof(u8) * (SEC_EVENT_BUFF_SIZE) * (left_event), &event_buff[0]);
+    if (ret < 0) {
+        TPD_INFO("%s: i2c read all event failed\n", __func__);
+	kfree(event_buff);
+        return obj_attention;
+    }
+
+    for (i = 0; i < left_event; i++) {
+        p_event_coord = (struct sec_event_coordinate *)&event_buff[i*SEC_EVENT_BUFF_SIZE];
+        t_id = (p_event_coord->tid - 1);
+        if ((t_id < max_num) && ((p_event_coord->tchsta == SEC_COORDINATE_ACTION_PRESS) || (p_event_coord->tchsta == SEC_COORDINATE_ACTION_MOVE))) {
+            points[t_id].x = (p_event_coord->x_11_4 << 4) | (p_event_coord->x_3_0);
+            points[t_id].y = (p_event_coord->y_11_4 << 4) | (p_event_coord->y_3_0);
+            points[t_id].z = p_event_coord->z & 0x3F;
+            points[t_id].width_major = p_event_coord->major;
+            points[t_id].touch_major = p_event_coord->major;
+            points[t_id].status = 1;
+
+            if (points[t_id].z <= 0) {
+                points[t_id].z = 1;
+            }
+            obj_attention = obj_attention | (1 << t_id);    //set touch bit
+        }
+    }
+	kfree(event_buff);
+
+    return obj_attention;
+}
+
+static int sec_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int i = 0, ret = -1;
+    uint8_t coord[18] = {0};
+    struct Coordinate limitPoint[4];
+    struct sec_gesture_status *p_event_gesture = NULL;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    
+    p_event_gesture = (struct sec_gesture_status *)chip_info->first_event;
+    if (p_event_gesture->coordLen > 18) {
+        p_event_gesture->coordLen = 18;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_GESTURE_EVENT, p_event_gesture->coordLen, coord);
+    if (ret < 0) {
+        TPD_INFO("%s: read gesture data failed\n", __func__);
+    }
+
+    if (LEVEL_BASIC != tp_debug) {
+        TPD_INFO("gesture points:");
+        for (i = 0; i < p_event_gesture->coordLen/3; i++) {
+            printk("(%d, %d) ",(coord[3*i] << 4) | ((coord[3*i+2] >> 0) & 0x0F), (coord[3*i+1] << 4) | ((coord[3*i+2] >> 4) & 0x0F));
+        }
+    }
+
+    switch (p_event_gesture->gestureId)     //judge gesture type
+    {
+        case GESTURE_RIGHT:
+            gesture->gesture_type  = Left2RightSwip;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_LEFT:
+            gesture->gesture_type  = Right2LeftSwip;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_DOWN:
+            gesture->gesture_type  = Up2DownSwip;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_UP:
+            gesture->gesture_type  = Down2UpSwip;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_DOUBLECLICK:
+            gesture->gesture_type  = DouTap;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end     = gesture->Point_start;
+            break;
+
+        case GESTURE_UP_V:
+            gesture->gesture_type  = UpVee;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_DOWN_V:
+            gesture->gesture_type  = DownVee;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_LEFT_V:
+            gesture->gesture_type = LeftVee;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_RIGHT_V:
+            gesture->gesture_type  = RightVee;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_O:
+            gesture->gesture_type = Circle;
+            gesture->clockwise = (p_event_gesture->data == 0) ? 1 : 0;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            limitPoint[0].x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);    //ymin
+            limitPoint[0].y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            limitPoint[1].x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);    //xmin
+            limitPoint[1].y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            limitPoint[2].x   = (coord[9] << 4) | ((coord[11] >> 4) & 0x0F);   //ymax
+            limitPoint[2].y   = (coord[10] << 4) | ((coord[11] >> 0) & 0x0F);
+            limitPoint[3].x   = (coord[12] << 4) | ((coord[14] >> 4) & 0x0F);  //xmax
+            limitPoint[3].y   = (coord[13] << 4) | ((coord[14] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[15] << 4) | ((coord[17] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[16] << 4) | ((coord[17] >> 0) & 0x0F);
+            handleFourCornerPoint(&limitPoint[0], 4);
+            gesture->Point_1st = limitPoint[0]; //ymin
+            gesture->Point_2nd = limitPoint[1]; //xmin
+            gesture->Point_3rd = limitPoint[2]; //ymax
+            gesture->Point_4th = limitPoint[3]; //xmax
+            break;
+
+        case GESTURE_DOUBLE_LINE:
+            gesture->gesture_type  = DouSwip;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_2nd.x   = (coord[9] << 4) | ((coord[11] >> 4) & 0x0F);
+            gesture->Point_2nd.y   = (coord[10] << 4) | ((coord[11] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_M:
+            gesture->gesture_type  = Mgestrue;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            gesture->Point_2nd.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_2nd.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_3rd.x   = (coord[9] << 4) | ((coord[11] >> 4) & 0x0F);
+            gesture->Point_3rd.y   = (coord[10] << 4) | ((coord[11] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[12] << 4) | ((coord[14] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[13] << 4) | ((coord[14] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_W:
+            gesture->gesture_type  = Wgestrue;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            gesture->Point_2nd.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_2nd.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_3rd.x   = (coord[9] << 4) | ((coord[11] >> 4) & 0x0F);
+            gesture->Point_3rd.y   = (coord[10] << 4) | ((coord[11] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[12] << 4) | ((coord[14] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[13] << 4) | ((coord[14] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_SINGLE_TAP:
+            gesture->gesture_type  = SingleTap;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            break;
+
+        case GESTURE_S:
+            gesture->gesture_type  = Sgestrue;
+            gesture->Point_start.x = (coord[0] << 4) | ((coord[2] >> 4) & 0x0F);
+            gesture->Point_start.y = (coord[1] << 4) | ((coord[2] >> 0) & 0x0F);
+            gesture->Point_1st.x   = (coord[3] << 4) | ((coord[5] >> 4) & 0x0F);
+            gesture->Point_1st.y   = (coord[4] << 4) | ((coord[5] >> 0) & 0x0F);
+            gesture->Point_2nd.x   = (coord[6] << 4) | ((coord[8] >> 4) & 0x0F);
+            gesture->Point_2nd.y   = (coord[7] << 4) | ((coord[8] >> 0) & 0x0F);
+            gesture->Point_end.x   = (coord[9] << 4) | ((coord[11] >> 4) & 0x0F);
+            gesture->Point_end.y   = (coord[10] << 4) | ((coord[11] >> 0) & 0x0F);
+            break;
+
+
+        default:
+            gesture->gesture_type = UnkownGesture;
+            break;
+    }
+
+    TPD_INFO("%s, gesture_id: 0x%x, gesture_type: %d, clockwise: %d, points: (%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)(%d, %d)\n", \
+                __func__, p_event_gesture->gestureId, gesture->gesture_type, gesture->clockwise, \
+                gesture->Point_start.x, gesture->Point_start.y, \
+                gesture->Point_end.x, gesture->Point_end.y, \
+                gesture->Point_1st.x, gesture->Point_1st.y, \
+                gesture->Point_2nd.x, gesture->Point_2nd.y, \
+                gesture->Point_3rd.x, gesture->Point_3rd.y, \
+                gesture->Point_4th.x, gesture->Point_4th.y);
+
+    return 0;
+}
+
+static int sec_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    if (chip_info->is_power_down) {
+        sec_power_control(chip_info, true);
+    }
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = 0;
+            break;
+
+        case MODE_SLEEP:
+            ret = sec_power_control(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: power down failed\n", __func__);
+            }
+            break;
+
+        case MODE_GESTURE:
+            ret = sec_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: sec enable gesture failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_EDGE:
+            ret = sec_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: sec enable edg limit failed.\n", __func__);
+                return ret;
+            }
+            break;
+
+        case MODE_CHARGE:
+            ret = sec_enable_charge_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable charge mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+        case MODE_EARSENSE:
+            ret = sec_enable_earsense_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable earsense mode : %d failed\n", __func__, flag);
+            }
+            break;
+
+		case MODE_FACE_DETECT:
+			ret = sec_enable_face_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: enable face detect mode : %d failed\n", __func__, flag);
+			}
+			break;
+
+		case MODE_FACE_CALIBRATE:
+			ret = sec_face_reduce_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: enable face reduce mode : %d failed\n", __func__, flag);
+			}
+			break;
+        case MODE_PALM_REJECTION:
+            ret = sec_enable_palm_reject(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable palm rejection: %d failed\n", __func__, flag);
+            }
+            break;
+
+        case MODE_GAME:
+            ret = sec_enable_game_mode(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: enable game mode: %d failed\n", __func__, flag);
+            }
+            break;
+
+		case MODE_REFRESH_SWITCH:
+			ret = sec_refresh_switch_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: swhitch refresh rate mode: %d failed\n", __func__, flag);
+			}
+			break;
+
+		case MODE_TOUCH_HOLD:
+			ret = sec_touchhold_switch_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: open touchhold mode: %d failed\n", __func__, flag);
+			}
+			break;
+
+		case MODE_TOUCH_AREA_SWITCH:
+			ret = sec_toucharea_switch_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: switch touchhold area: %d failed\n", __func__, flag);
+			}
+			break;
+
+		case MODE_LIMIT_SWITCH:
+			ret = sec_limit_switch_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: limit switch: %d failed\n", __func__, flag);
+			}
+			break;
+
+		case MODE_GESTURE_SWITCH:
+			ret = sec_gesture_switch_mode(chip_info, flag);
+			if (ret < 0) {
+				TPD_INFO("%s: switch gestrue mode: %d failed\n", __func__, flag);
+			}
+			break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int sec_get_face_detect(void * chip_data)
+{
+    int state = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+	if (chip_info->proximity_status == 0x2E) {
+		state = 0;		//far
+	} else if (chip_info->proximity_status == 0) {
+		state = 1;		//near
+	}
+    return state;
+}
+
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+static int sec_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+static int sec_get_usb_state(void)
+{
+    return 0;
+}
+#endif
+
+static struct oppo_touchpanel_operations sec_ops = {
+    .get_vendor                 = sec_get_vendor,
+    .get_chip_info              = sec_get_chip_info,
+    .reset                      = sec_reset,
+    .power_control              = sec_power_control,
+    .fw_check                   = sec_fw_check,
+    .fw_update                  = sec_fw_update,
+    .trigger_reason             = sec_trigger_reason,
+    .get_touch_points           = sec_get_touch_points,
+    .get_gesture_info           = sec_get_gesture_info,
+    .mode_switch                = sec_mode_switch,
+    .get_usb_state              = sec_get_usb_state,
+    .get_face_state				= sec_get_face_detect,
+};
+/********* End of implementation of oppo_touchpanel_operations callbacks**********************/
+
+
+/**************** Start of implementation of debug_info proc callbacks************************/
+int sec_fix_tmode(struct chip_data_s6sy761 *chip_info, u8 mode, u8 state)
+{
+    int ret = -1;
+    u8 tBuff[2] = { mode, state };
+
+    ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_STATEMANAGE_ON, STATE_MANAGE_OFF);
+    sec_mdelay(20);
+    ret |= touch_i2c_write_block(chip_info->client, SEC_CMD_CHG_SYSMODE, sizeof(tBuff), tBuff);
+    sec_mdelay(20);
+
+    return ret;
+}
+
+int sec_release_tmode(struct chip_data_s6sy761 *chip_info)
+{
+    int ret = -1;
+
+    ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_STATEMANAGE_ON, STATE_MANAGE_ON);
+    sec_mdelay(20);
+
+    return ret;
+}
+
+static int sec_read_self(struct chip_data_s6sy761 *chip_info, u8 type, char *data, int len)
+{
+    int ret = 0;
+    unsigned int data_len = (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2;
+
+    if (len != data_len) {
+        return -1;
+    }
+
+    ret = sec_fix_tmode(chip_info, TOUCH_SYSTEM_MODE_TOUCH, TOUCH_MODE_STATE_TOUCH);
+    if (ret < 0) {
+        TPD_INFO("%s: fix touch mode failed\n", __func__);
+        goto err_out;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SELF_RAW_TYPE, type);
+    if (ret < 0) {
+        TPD_INFO("%s: Set self type failed\n", __func__);
+        goto err_out;
+    }
+
+    sec_mdelay(50);
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_SELF_RAWDATA, data_len, data);
+    if (ret < 0) {
+        TPD_INFO("%s: read self failed!\n", __func__);
+    }
+
+    /* release data monitory (unprepare AFE data memory) */
+    ret |= touch_i2c_write_byte(chip_info->client, SEC_CMD_SELF_RAW_TYPE, TYPE_INVALID_DATA);
+    if (ret < 0) {
+        TPD_INFO("%s: Set self type failed\n", __func__);
+    }
+
+err_out:
+    ret |= sec_release_tmode(chip_info);
+
+    return ret;
+}
+
+static int sec_read_mutual(struct chip_data_s6sy761 *chip_info, u8 type, char *data, int len)
+{
+    int ret = 0;
+    u8 buf[2] = {0};
+    unsigned int data_len = (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) * 2;
+
+    if ((len > data_len) || (len % chip_info->hw_res->TX_NUM != 0)) {
+        return -1;
+    }
+
+    ret = sec_fix_tmode(chip_info, TOUCH_SYSTEM_MODE_TOUCH, TOUCH_MODE_STATE_TOUCH);
+    if (ret < 0) {
+        TPD_INFO("%s: fix touch mode failed\n", __func__);
+        goto err_out;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, type);
+    if (ret < 0) {
+        TPD_INFO("%s: Set mutual type failed\n", __func__);
+        goto err_out;
+    }
+
+    sec_mdelay(20);
+    buf[0] = (u8)((len >> 8) & 0xFF);
+    buf[1] = (u8)(len & 0xFF);
+    touch_i2c_write_block(chip_info->client, SEC_CMD_TOUCH_RAWDATA_SETLEN, 2, buf);
+    ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_RAWDATA, len, data);
+    if (ret < 0) {
+        TPD_INFO("%s: read mutual failed!\n", __func__);
+    }
+
+    /* release data monitory (unprepare AFE data memory) */
+    ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_INVALID_DATA);
+    if (ret < 0) {
+        TPD_INFO("%s: Set mutual type failed\n", __func__);
+    }
+
+err_out:
+    ret |= sec_release_tmode(chip_info);
+
+    return ret;
+}
+
+static void sec_delta_read(struct seq_file *s, void *chip_data)
+{
+    u8 *data = NULL;
+    int16_t x = 0, y = 0, z = 0, temp_delta = 0, ret = 0;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    int readbytes = chip_info->hw_res->TX_NUM * (chip_info->hw_res->RX_NUM) * 2;
+
+    data = kmalloc(readbytes, GFP_KERNEL);
+    if (!data) {
+        return;
+    }
+
+    memset(data, 0, readbytes);
+    ret = sec_read_mutual(chip_info, TYPE_SIGNAL_DATA, data, readbytes);
+    if (ret < 0) {
+        seq_printf(s, "read delta failed\n");
+        goto kfree_out;
+    }
+
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = chip_info->hw_res->RX_NUM - 1; y >= 0; y--) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = ((data[z * 2] << 8) | data[z * 2 + 1]);
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+kfree_out:
+    kfree(data);
+    return;
+}
+
+static void sec_baseline_read(struct seq_file *s, void *chip_data)
+{
+    u8 *data = NULL;
+    int16_t x = 0, y = 0, z = 0, temp_delta = 0, ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    int readbytes = (chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM) * 2;
+
+    data = kmalloc(readbytes, GFP_KERNEL);
+    if (!data) {
+        return;
+    }
+
+    //read decoded data
+    memset(data, 0, readbytes);
+    ret = sec_read_mutual(chip_info, TYPE_DECODED_DATA, data, readbytes);
+    if (ret < 0) {
+        seq_printf(s, "read rawdata failed\n");
+        goto kfree_out;
+    }
+
+    seq_printf(s, "DECODED DATA:");
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = chip_info->hw_res->RX_NUM - 1; y >= 0; y--) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (data[z * 2] << 8) | data[z * 2 + 1];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+    //read ambient data
+    memset(data, 0, readbytes);
+    ret = sec_read_mutual(chip_info, TYPE_AMBIENT_DATA, data, readbytes);
+    if (ret < 0) {
+        seq_printf(s, "read rawdata failed\n");
+        goto kfree_out;
+    }
+
+    seq_printf(s, "AMBIENT DATA:");
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = chip_info->hw_res->RX_NUM - 1; y >= 0; y--) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (data[z * 2] << 8) | data[z * 2 + 1];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+kfree_out:
+    kfree(data);
+    return;
+}
+
+static void sec_self_delta_read(struct seq_file *s, void *chip_data)
+{
+    u8 *data = NULL;
+    int16_t x = 0, rx_offset = 0, temp_delta = 0, ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    int readbytes = (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2;
+
+    data = kmalloc(readbytes, GFP_KERNEL);
+    if (!data) {
+        return;
+    }
+
+    memset(data, 0, readbytes);
+    ret = sec_read_self(chip_info, TYPE_SIGNAL_DATA, data, readbytes);
+    if (ret < 0) {
+        seq_printf(s, "read self delta failed\n");
+        goto kfree_out;
+    }
+
+    seq_printf(s, "TX:\n");
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        temp_delta = (data[x * 2] << 8) | data[x * 2 + 1];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+
+    seq_printf(s, "\nRX:\n");
+    rx_offset = chip_info->hw_res->TX_NUM * 2;
+    for (x = 0; x < chip_info->hw_res->RX_NUM; x++) {
+        temp_delta = (data[x * 2 + rx_offset] << 8) | data[x * 2 + 1 + rx_offset];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+    seq_printf(s, "\n");
+
+kfree_out:
+    kfree(data);
+    return;
+}
+
+static void sec_self_raw_read(struct seq_file *s, void *chip_data)
+{
+    u8 *data = NULL;
+    int16_t x = 0, rx_offset = 0, temp_delta = 0, ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    int readbytes = (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2;
+
+    data = kmalloc(readbytes, GFP_KERNEL);
+    if (!data) {
+        return;
+    }
+
+    memset(data, 0, readbytes);
+    ret = sec_read_self(chip_info, TYPE_RAW_DATA, data, readbytes);
+    if (ret < 0) {
+        seq_printf(s, "read self rawdata failed\n");
+        goto kfree_out;
+    }
+
+    seq_printf(s, "TX:\n");
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        temp_delta = (data[x * 2] << 8) | data[x * 2 + 1];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+
+    seq_printf(s, "\nRX:\n");
+    rx_offset = chip_info->hw_res->TX_NUM * 2;
+    for (x = 0; x < chip_info->hw_res->RX_NUM; x++) {
+        temp_delta = (data[x * 2 + rx_offset] << 8) | data[x * 2 + 1 + rx_offset];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+    seq_printf(s, "\n");
+
+kfree_out:
+    kfree(data);
+    return;
+}
+
+static void sec_main_register_read(struct seq_file *s, void *chip_data)
+{
+    u8 buf[4] = {0};
+    int state = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    state = sec_read_calibration_report(chip_info);
+    seq_printf(s, "calibration status: 0x%02x\n", state);
+
+    state = sec_get_verify_result(chip_info);
+    seq_printf(s, "calibration result: 0x%02x\n", state);
+
+    state = touch_i2c_read_byte(chip_info->client, SET_CMD_SET_CHARGER_MODE);
+    seq_printf(s, "charger state: 0x%02x\n", state);
+
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_ID, 3, buf);
+    seq_printf(s, "boot state: 0x%02x\n", buf[0]);
+
+    state = touch_i2c_read_byte(chip_info->client, 0x30);
+    seq_printf(s, "touch function: 0x%02x(proximity/wetmode/palm/stylus/glove/cover/hover/touch)\n", state);
+
+    state = touch_i2c_read_byte(chip_info->client, 0x3B);
+    seq_printf(s, "wetmode state: 0x%02x\n", state);
+
+    state = touch_i2c_read_word(chip_info->client, SEC_CMD_WAKEUP_GESTURE_MODE);
+    seq_printf(s, "gesture mode: 0x%04x\n", state);
+
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_IMG_VERSION, 4, buf);
+    seq_printf(s, "fw img version: 0x%08x\n", (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3]);
+
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_CONFIG_VERSION, 4, buf);
+    seq_printf(s, "config version: 0x%08x\n", (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3]);
+
+    state = touch_i2c_read_byte(chip_info->client, SEC_CMD_STATEMANAGE_ON);
+    seq_printf(s, "auto change enabled: 0x%02x\n", state);
+
+    state = touch_i2c_read_byte(chip_info->client, SEC_CMD_HOVER_DETECT);
+    seq_printf(s, "earsense state: 0x%02x\n", state);
+
+    state = touch_i2c_read_word(chip_info->client, SEC_CMD_PALM_SWITCH);
+    seq_printf(s, "palm state: 0x%04x(0x0041-off/0x0061-on)\n", state);
+
+    state = touch_i2c_read_word(chip_info->client, SEC_CMD_GRIP_SWITCH);
+    seq_printf(s, "grip state: 0x%04x(0x0000-off/0x2000-on)\n", state);
+
+    memset(buf, 0, 4);
+    touch_i2c_read_block(chip_info->client, SEC_READ_TS_STATUS, 4, buf);
+    seq_printf(s, "power mode: 0x%02x[normal-0x02/lpwg-0x05], 0x%02x[indle-0x00/active-0x02]\n", buf[1], buf[3]);
+    return;
+}
+
+static void sec_reserve_read(struct seq_file *s, void *chip_data)
+{
+    static int int_state = 1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    if (int_state) {
+        int_state = 0;
+        touch_i2c_write_byte(chip_info->client, SEC_CMD_INTERRUPT_SWITCH, 1);   //disable interrupt
+    } else {
+        int_state = 1;
+        touch_i2c_write_block(chip_info->client, SEC_CMD_CLEAR_EVENT_STACK, 0, NULL);   //clear event buffer
+        touch_i2c_write_byte(chip_info->client, SEC_CMD_INTERRUPT_SWITCH, 0);   //enable interrupt
+    }
+}
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read         = sec_limit_read,
+    .delta_read         = sec_delta_read,
+    .self_delta_read    = sec_self_delta_read,
+    .baseline_read      = sec_baseline_read,
+    .self_raw_read      = sec_self_raw_read,
+    .main_register_read = sec_main_register_read,
+    .reserve_read       = sec_reserve_read,
+};
+
+static void sec_earsese_rawdata_read(void *chip_data, char *rawdata, int read_len)
+{
+    int ret = 0;
+    u8 buf[2] = {0};
+    int i = 0, j = 0;
+    int8_t tmp_byte[2] = {0};
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    uint8_t len_y = chip_info->hw_res->EARSENSE_RX_NUM;
+	uint8_t len_x = chip_info->hw_res->EARSENSE_TX_NUM;
+
+	if ((!chip_info) || (!rawdata))
+        return;
+
+    buf[0] = (u8)((read_len >> 8) & 0xFF);
+    buf[1] = (u8)(read_len & 0xFF);
+    touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_DATA_RAWDATA);
+    touch_i2c_write_block(chip_info->client, SEC_CMD_TOUCH_RAWDATA_SETLEN, 2, buf);
+    ret = touch_i2c_read_block(chip_info->client, SEC_CMD_TOUCH_RAWDATA_READ, read_len, rawdata);
+    if (ret < 0) {
+        TPD_INFO("read rawdata failed\n");
+        return;
+    }
+	TPD_INFO("sec_earsese_rawdata_read lenx = %d, leny =%d\n",len_x,len_y);
+	for(i = 0; i < read_len; i++ ) {
+		TPD_INFO("rawdata = %d\n",rawdata[i]);
+	}
+    for (i = 0; i < len_y; i++) {
+        for (j = 0; j < len_x/2; j++) {
+            tmp_byte[0] = rawdata[2*(len_x*i+j)];
+            tmp_byte[1] = rawdata[2*(len_x*i+j)+1];
+            rawdata[2*(len_x*i+j)] = rawdata[2*(len_x*i+len_x-1-j)+1];
+            rawdata[2*(len_x*i+j)+1] = rawdata[2*(len_x*i+len_x-1-j)];
+            rawdata[2*(len_x*i+len_x-1-j)] = tmp_byte[1];
+            rawdata[2*(len_x*i+len_x-1-j)+1] = tmp_byte[0];
+        }
+    }
+    if (len_x%2) {
+        j = len_x/2;
+        for (i = 0; i < len_y; i++) {
+            tmp_byte[0] = rawdata[2*(len_x*i+j)];
+            rawdata[2*(len_x*i+j)] = rawdata[2*(len_x*i+j)+1];
+            rawdata[2*(len_x*i+j)+1] = tmp_byte[0];
+        }
+    }
+    return;
+}
+
+static void sec_earsese_delta_read(void *chip_data, char *earsense_delta, int read_len)
+{
+    int ret = 0, hover_status = 0, data_type = 0;
+    u8 buf[2] = {0};
+    int i = 0, j = 0;
+    int8_t tmp_byte[2] = {0};
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    uint8_t len_x = chip_info->hw_res->EARSENSE_TX_NUM;
+    uint8_t len_y = chip_info->hw_res->EARSENSE_RX_NUM;
+
+    if (!chip_info)
+        return ;
+
+    if (!earsense_delta) {
+        TPD_INFO("earsense_delta is NULL\n");
+        return;
+    }
+
+    buf[0] = (u8)((read_len >> 8) & 0xFF);
+    buf[1] = (u8)(read_len & 0xFF);
+    hover_status = touch_i2c_read_byte(chip_info->client, SEC_CMD_HOVER_DETECT); //read hover state
+    data_type = touch_i2c_read_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE); //read current data type
+    if (hover_status && (data_type != TYPE_DATA_DELTA)) {
+        touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_DATA_DELTA);
+        sec_mdelay(20);
+    } else if (!hover_status && (data_type != TYPE_SIGNAL_DATA)){
+        touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, TYPE_SIGNAL_DATA);
+        sec_mdelay(20);
+    }
+
+    touch_i2c_write_block(chip_info->client, SEC_CMD_TOUCH_RAWDATA_SETLEN, 2, buf);
+    ret = touch_i2c_read_block(chip_info->client, SEC_CMD_TOUCH_DELTA_READ, read_len, earsense_delta);
+    if (ret < 0) {
+        TPD_INFO("read delta failed\n");
+        return;
+    }
+	for(i = 0; i < read_len; i++ ) {
+		TPD_INFO("earsense_delta = %d\n",earsense_delta[i]);
+	}
+    for (i = 0; i < len_y; i++) {
+        for (j = 0; j < len_x/2; j++) {
+            tmp_byte[0] = earsense_delta[2*(len_x*i+j)];
+            tmp_byte[1] = earsense_delta[2*(len_x*i+j)+1];
+            earsense_delta[2*(len_x*i+j)] = earsense_delta[2*(len_x*i+len_x-1-j)+1];
+            earsense_delta[2*(len_x*i+j)+1] = earsense_delta[2*(len_x*i+len_x-1-j)];
+            earsense_delta[2*(len_x*i+len_x-1-j)] = tmp_byte[1];
+            earsense_delta[2*(len_x*i+len_x-1-j)+1] = tmp_byte[0];
+        }
+    }
+    if (len_x%2) {
+        j = len_x/2;
+        for (i = 0; i < len_y; i++) {
+            tmp_byte[0] = earsense_delta[2*(len_x*i+j)];
+            earsense_delta[2*(len_x*i+j)] = earsense_delta[2*(len_x*i+j)+1];
+            earsense_delta[2*(len_x*i+j)+1] = tmp_byte[0];
+        }
+    }
+    return;
+}
+
+static void sec_earsese_selfdata_read( void *chip_data, char *self_data, int read_len)
+{
+    int i = 0, ret = 0;
+    int8_t tmp = 0;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    if ((!chip_info) || (!self_data))
+        return ;
+
+    ret = touch_i2c_read_block(chip_info->client, SEC_CMD_TOUCH_SELFDATA_READ, read_len, self_data);
+    if (ret < 0) {
+        TPD_INFO("read selfdata failed\n");
+        return;
+    }
+	for(i = 0; i < read_len; i++ ) {
+		TPD_INFO("self_data = %d\n",self_data[i]);
+	}
+    for (i = 0; i < chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM; i++) {
+        tmp = self_data[2*i];
+        self_data[2*i] = self_data[2*i + 1];
+        self_data[2*i + 1] = tmp;
+    }
+    return;
+}
+
+
+static struct earsense_proc_operations earsense_proc_ops = {
+    .rawdata_read = sec_earsese_rawdata_read,
+    .delta_read   = sec_earsese_delta_read,
+    .self_data_read = sec_earsese_selfdata_read,
+};
+/***************** End of implementation of debug_info proc callbacks*************************/
+static void sec_swap(u8 *a, u8 *b)
+{
+    u8 temp = *a;
+    *a = *b;
+    *b = temp;
+}
+
+static void rearrange_sft_result(u8 *data, int length)
+{
+    int i = 0;
+
+    for(i = 0; i < length; i += 4) {
+        sec_swap(&data[i], &data[i + 3]);
+        sec_swap(&data[i + 1], &data[i + 2]);
+    }
+}
+
+static int sec_execute_selftest(struct seq_file *s, struct chip_data_s6sy761 *chip_info, struct sec_testdata *sec_testdata)
+{
+    int rc = -1;
+    u8 tpara[2] = {0x25, 0x40};
+    u8 *rBuff = NULL;
+    int i;
+    int result_size = SEC_SELFTEST_REPORT_SIZE + sec_testdata->TX_NUM * sec_testdata->RX_NUM * 2;
+
+    /* save selftest result in flash */
+    tpara[0] = 0x21;
+
+    rBuff = kzalloc(result_size, GFP_KERNEL);
+    if (!rBuff) {
+        seq_printf(s, "kzalloc space failed\n");
+        return -ENOMEM;
+    }
+
+    //send self test cmd
+    rc = touch_i2c_write_block(chip_info->client, SEC_CMD_SELFTEST, 2, tpara);
+    if (rc < 0) {
+        TPD_INFO("%s: Send selftest cmd failed!\n", __func__);
+        seq_printf(s, "Send selftest cmd failed!\n");
+        goto ERR_EXIT;
+    }
+
+    sec_mdelay(350);
+
+    rc = sec_wait_for_ready(chip_info, SEC_VENDOR_ACK_SELF_TEST_DONE);
+    if (rc < 0) {
+        TPD_INFO("%s: Selftest execution time out!\n", __func__);
+        seq_printf(s, "Selftest execution time out!\n");
+        goto ERR_EXIT;
+    }
+
+    rc = touch_i2c_read_block(chip_info->client, SEC_READ_SELFTEST_RESULT, result_size, rBuff);
+    if (rc < 0) {
+        TPD_INFO("%s: read selftest relest failed\n", __func__);
+        seq_printf(s, "read selftest relest failed\n");
+        goto ERR_EXIT;
+    }
+    rearrange_sft_result(rBuff, result_size);
+
+    TPD_INFO("sec_ts : \n");
+    for (i = 0; i < 80; i += 4) {
+        if (i / 4 == 0) TPD_DEBUG_NTAG("SIG");
+        else if (i / 4 == 1) TPD_DEBUG_NTAG("VER");
+        else if (i / 4 == 2) TPD_DEBUG_NTAG("SIZ");
+        else if (i / 4 == 3) TPD_DEBUG_NTAG("CRC");
+        else if (i / 4 == 4) TPD_DEBUG_NTAG("RES");
+        else if (i / 4 == 5) TPD_DEBUG_NTAG("COU");
+        else if (i / 4 == 6) TPD_DEBUG_NTAG("PAS");
+        else if (i / 4 == 7) TPD_DEBUG_NTAG("FAI");
+        else if (i / 4 == 8) TPD_DEBUG_NTAG("CHA");
+        else if (i / 4 == 9) TPD_DEBUG_NTAG("AMB");
+        else if (i / 4 == 10) TPD_DEBUG_NTAG("RXS");
+        else if (i / 4 == 11) TPD_DEBUG_NTAG("TXS");
+        else if (i / 4 == 12) TPD_DEBUG_NTAG("RXO");
+        else if (i / 4 == 13) TPD_DEBUG_NTAG("TXO");
+        else if (i / 4 == 14) TPD_DEBUG_NTAG("RXG");
+        else if (i / 4 == 15) TPD_DEBUG_NTAG("TXG");
+        else if (i / 4 == 16) TPD_DEBUG_NTAG("RXR");
+        else if (i / 4 == 17) TPD_DEBUG_NTAG("TXT");
+        else if (i / 4 == 18) TPD_DEBUG_NTAG("RXT");
+        else if (i / 4 == 19) TPD_DEBUG_NTAG("TXR");
+
+        TPD_DEBUG_NTAG(": %2X, %2X, %2X, %2X \n", rBuff[i], rBuff[i + 1], rBuff[i + 2], rBuff[i + 3]);
+
+        if (i / 4 == 4) {
+            /* RX, RX open check. */
+            if ((rBuff[i + 3] & 0x30) != 0) {
+                rc = 0;
+                seq_printf(s, "RX, RX open check failed\n");
+            }
+            /* TX, RX GND(VDD) short check. */
+            else if ((rBuff[i + 3] & 0xC0) != 0) {
+                rc = 0;
+                seq_printf(s, "TX, RX GND(VDD) short check failed\n");
+            }
+            /* RX-RX, TX-TX short check. */
+            else if ((rBuff[i + 2] & 0x03) != 0) {
+                rc = 0;
+                seq_printf(s, "RX-RX, TX-TX short check failed\n");
+            }
+            /* TX-RX short check. */
+            else if ((rBuff[i + 2] & 0x04) != 0) {
+                rc = 0;
+                seq_printf(s, "TX-RX short check failed\n");
+            }
+            else
+                rc = 1;
+        }
+
+    }
+
+ERR_EXIT:
+    kfree(rBuff);
+    return rc;
+}
+
+int sec_execute_p2ptest(struct seq_file *s, struct chip_data_s6sy761 *chip_info, struct sec_testdata *sec_testdata)
+{
+    int rc;
+    u8 tpara[2] = {0x0F, 0x11};
+
+    TPD_INFO("%s: P2P test start!\n", __func__);
+    rc = touch_i2c_write_block(chip_info->client, SEC_CMD_SET_P2PTEST_MODE, 2, tpara);
+    if (rc < 0) {
+        seq_printf(s, "%s: Send P2Ptest Mode cmd failed!\n", __func__);
+        goto err_exit;
+    }
+
+    sec_mdelay(15);
+
+    tpara[0] = 0x00;
+    tpara[1] = 0x64;
+    rc = touch_i2c_write_block(chip_info->client, SEC_CMD_P2PTEST, 2, tpara);
+    if (rc < 0) {
+        seq_printf(s, "%s: Send P2Ptest cmd failed!\n", __func__);
+        goto err_exit;
+    }
+
+    sec_mdelay(1000);
+
+    rc = sec_wait_for_ready(chip_info, SEC_VENDOR_ACK_P2P_TEST_DONE);
+    if (rc < 0) {
+        seq_printf(s, "%s: P2Ptest execution time out!\n", __func__);
+        goto err_exit;
+    }
+
+    TPD_INFO("%s: P2P test done!\n", __func__);
+
+err_exit:
+    return rc;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static uint32_t search_for_item(const struct firmware *fw, int item_cnt, uint8_t item_index)
+{
+    int i = 0;
+    uint32_t item_offset = 0;
+    struct sec_test_item_header *item_header = NULL;
+    uint32_t *p_item_offset = (uint32_t *)(fw->data + 16);
+
+    for (i = 0; i < item_cnt; i++) {
+        item_header = (struct sec_test_item_header *)(fw->data + p_item_offset[i]);
+        if (item_header->item_bit == item_index) {      //check the matched item offset
+            item_offset = p_item_offset[i];
+        }
+    }
+
+    return item_offset;
+}
+
+static void sec_auto_test(struct seq_file *s, void *chip_data, struct sec_testdata *sec_testdata)
+{
+    u8 type = 0;
+    uint32_t err_cnt = 0, item_offset = 0;
+    uint8_t *pRead = NULL;
+    int eint_status = 0, eint_count = 0, read_gpio_num = 0;
+    int16_t nodeData = 0, Buff16 = 0, Buff16_2 = 0, nodeGap = 0;
+    int i = 0, j = 0, item_cnt = 0, iArrayIndex = 0, iArrayIndex_2 = 0, ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+    const uint32_t readbytes = sec_testdata->TX_NUM * sec_testdata->RX_NUM * 2;
+    const uint32_t readselfbytes = (sec_testdata->TX_NUM + sec_testdata->RX_NUM) * 2;
+    struct sec_test_item_header *item_header = NULL;
+    int32_t *p_mutual_p = NULL, *p_mutual_n = NULL, *p_mutualGap_p = NULL, *p_mutualGap_n = NULL;
+    int32_t *p_tx_offset_p = NULL, *p_tx_offset_n = NULL, *p_rx_offset_p = NULL, *p_rx_offset_n = NULL;
+    int32_t *p_p2p_p = NULL, *p_p2p_n = NULL;
+
+
+    //interrupt pin short test
+    read_gpio_num = 10;
+    touch_i2c_write_byte(chip_info->client, SEC_CMD_INTERRUPT_SWITCH, 1);   //disable interrupt
+    touch_i2c_write_block(chip_info->client, SEC_CMD_CLEAR_EVENT_STACK, 0, NULL);   //clear event buffer
+    while (read_gpio_num--) {
+        sec_mdelay(5);
+        eint_status = gpio_get_value(sec_testdata->irq_gpio);
+        if (eint_status == 1) {
+            eint_count--;
+        } else {
+            eint_count++;
+        }
+    }
+    TPD_INFO("TP EINT PIN direct short test! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        seq_printf(s, "eint_status is low, TP EINT direct short\n");
+		return;
+    }
+    touch_i2c_write_byte(chip_info->client, SEC_CMD_INTERRUPT_SWITCH, 0);   //enable interrupt
+
+    for (i = 0; i < 8*sizeof(sec_testdata->test_item); i++) {
+        if ((sec_testdata->test_item >> i) & 0x01 ) {
+            item_cnt++;
+        }
+    }
+
+    pRead = kzalloc(readbytes, GFP_KERNEL);
+    if (!pRead) {
+        TPD_INFO("kzalloc space failed\n");
+        seq_printf(s, "kzalloc space failed\n");
+        return;
+    }
+
+    /* execute selftest */
+    ret = sec_execute_selftest(s, chip_info, sec_testdata);
+    if (ret <= 0) {
+        err_cnt++;
+        TPD_INFO("%s: execute selftest failed\n", __func__);
+        seq_printf(s, "execute selftest failed\n");
+        if (ret < 0)
+            goto ERR_OUT;
+    }
+
+    //test item mutual_raw offset_data_sec
+    if (sec_testdata->test_item & (1 << TYPE_MUTUAL_RAW_OFFSET_DATA_SDC)) {
+        TPD_INFO("do test item mutual_raw offset_data_sec\n");
+
+        item_offset = search_for_item(sec_testdata->fw, item_cnt, TYPE_MUTUAL_RAW_OFFSET_DATA_SDC);
+        if (item_offset == 0) {
+            err_cnt++;
+            TPD_INFO("search for item limit offset failed\n");
+            seq_printf(s, "search for item limit offset failed\n");
+            goto ERR_OUT;
+        }
+        item_header = (struct sec_test_item_header *)(sec_testdata->fw->data + item_offset);
+        if (item_header->item_magic != 0x4F50504F) {
+            err_cnt++;
+            TPD_INFO("test item: %d magic number(%4x) is wrong\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->item_magic);
+            seq_printf(s, "test item: %d magic number(%4x) is wrong\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->item_magic);
+            goto ERR_OUT;
+        }
+        if (item_header->item_limit_type == LIMIT_TYPE_EACH_NODE_DATA) {
+            p_mutual_p = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset);
+            p_mutualGap_p = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset + 4*sec_testdata->TX_NUM*sec_testdata->RX_NUM);
+            p_mutual_n = (int32_t *)(sec_testdata->fw->data + item_header->floor_limit_offset);
+            p_mutualGap_n = (int32_t *)(sec_testdata->fw->data + item_header->floor_limit_offset + 4*sec_testdata->TX_NUM*sec_testdata->RX_NUM);
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has invalid limit type(%d)\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->item_limit_type);
+            seq_printf(s, "item: %d has invalid limit type(%d)\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->item_limit_type);
+            goto ERR_OUT;
+        }
+        if (item_header->para_num == 0) {
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has %d parameter\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->para_num);
+            seq_printf(s, "item: %d has %d parameter\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->para_num);
+            goto ERR_OUT;
+        }
+
+        /* set reference data */
+        type = TYPE_OFFSET_DATA_SDC;
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, type);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: set OFFSET_DATA_SEC type failed\n", __func__);
+            seq_printf(s, "set OFFSET_DATA_SEC type failed\n");
+            goto ERR_OUT;
+        }
+
+        sec_mdelay(50);
+        /* read reference data */
+        ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_RAWDATA, readbytes, pRead);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: read mutual rawdata failed!\n", __func__);
+            seq_printf(s, "read mutual rawdata failed\n");
+            goto ERR_OUT;
+        }
+        /* store and judge reference data */
+        store_to_file(sec_testdata->fd, "TYPE_MUTUAL_RAW_OFFSET_DATA_SDC:\n");
+        for (j = 0; j <  sec_testdata->RX_NUM; j++) {
+            for (i = 0; i <  sec_testdata->TX_NUM; i++) {
+                iArrayIndex = i * sec_testdata->RX_NUM + j;
+                nodeData = (pRead[iArrayIndex*2] << 8) | pRead[iArrayIndex*2+1];
+                if (sec_testdata->fd >= 0) {
+                    store_to_file(sec_testdata->fd, "%d, ", nodeData);
+                }
+                if ((nodeData < p_mutual_n[iArrayIndex]) || (nodeData > p_mutual_p[iArrayIndex])) {
+                    TPD_INFO(" mutual offset_data failed at data[%d][%d] = %d [%d,%d]\n", i, j, nodeData, p_mutual_n[iArrayIndex], p_mutual_p[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Step 1: mutual offset_data failed at data[%d][%d] = %d [%d,%d]\n", i, j, nodeData, p_mutual_n[iArrayIndex], p_mutual_p[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (sec_testdata->fd >= 0) {
+                store_to_file(sec_testdata->fd, "\n");
+            }
+        }
+
+        /* CM Offseet gap (left-right)*/
+        for (j = 0; j < sec_testdata->RX_NUM; j++) {
+            for (i = 0; i < sec_testdata->TX_NUM - 1; i++) {
+                iArrayIndex = i * sec_testdata->RX_NUM + j;
+                iArrayIndex_2 = (i + 1) * sec_testdata->RX_NUM + j;
+                Buff16 = (pRead[iArrayIndex * 2] << 8) | pRead[iArrayIndex * 2 + 1];
+                Buff16_2 = (pRead[iArrayIndex_2 * 2] << 8) | pRead[iArrayIndex_2 * 2 + 1];
+                if (Buff16 > Buff16_2) {
+                     nodeGap = 100 - (Buff16_2 * 100 / Buff16);
+                } else {
+                    nodeGap = 100 - (Buff16 * 100 / Buff16_2);
+                }
+                if ((nodeGap > p_mutualGap_p[iArrayIndex]) || (nodeGap < p_mutualGap_n[iArrayIndex])) {
+                    TPD_INFO("mutual node[%d, %d]=%d and node[%d, %d]=%d gap beyond [%d, %d]\n", i, j, Buff16, i+1, j, Buff16_2, p_mutualGap_n[iArrayIndex], p_mutualGap_p[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Step 2-1:mutual node[%d, %d]=%d and node[%d, %d]=%d gap beyond [%d, %d]\n", i, j, Buff16, i+1, j, Buff16_2, p_mutualGap_n[iArrayIndex], p_mutualGap_p[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+        }
+        /* CM Offseet gap (up-down)*/
+        for (j = 0; j < sec_testdata->RX_NUM - 1; j++) {
+            for (i = 0; i < sec_testdata->TX_NUM; i++) {
+                iArrayIndex = i * sec_testdata->RX_NUM + j;
+                iArrayIndex_2 = i * sec_testdata->RX_NUM + j + 1;
+                Buff16 = (pRead[iArrayIndex * 2] << 8) | pRead[iArrayIndex * 2 + 1];
+                Buff16_2 = (pRead[iArrayIndex_2 * 2] << 8) | pRead[iArrayIndex_2 * 2 + 1];
+                if (Buff16 > Buff16_2) {
+                     nodeGap = 100 - (Buff16_2 * 100 / Buff16);
+                } else {
+                    nodeGap = 100 - (Buff16 * 100 / Buff16_2);
+                }
+                if ((nodeGap > p_mutualGap_p[iArrayIndex]) || (nodeGap < p_mutualGap_n[iArrayIndex])) {
+                    TPD_INFO("mutual node[%d, %d]=%d and node[%d, %d]=%d gap beyond [%d, %d]\n", j, i, Buff16, j+1, i, Buff16_2, p_mutualGap_n[iArrayIndex], p_mutualGap_p[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Step 2-2:mutual node[%d, %d]=%d and node[%d, %d]=%d gap beyond [%d, %d]\n", j, i, Buff16, j+1, i, Buff16_2, p_mutualGap_n[iArrayIndex], p_mutualGap_p[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+        }
+    }
+
+    //test item self_raw offset_data_sec
+    if (sec_testdata->test_item & (1 << TYPE_SELF_RAW_OFFSET_DATA_SDC)) {
+        TPD_INFO("do test item self_raw offset_data_sec\n");
+
+        item_offset = search_for_item(sec_testdata->fw, item_cnt, TYPE_SELF_RAW_OFFSET_DATA_SDC);
+        if (item_offset == 0) {
+            err_cnt++;
+            TPD_INFO("search for item limit offset failed\n");
+            seq_printf(s, "search for item limit offset failed\n");
+            goto ERR_OUT;
+        }
+        item_header = (struct sec_test_item_header *)(sec_testdata->fw->data + item_offset);
+        if (item_header->item_magic != 0x4F50504F) {
+            err_cnt++;
+            TPD_INFO("test item: %d magic number(%4x) is wrong\n", TYPE_SELF_RAW_OFFSET_DATA_SDC, item_header->item_magic);
+            seq_printf(s, "test item: %d magic number(%4x) is wrong\n", TYPE_SELF_RAW_OFFSET_DATA_SDC, item_header->item_magic);
+            goto ERR_OUT;
+        }
+        if (item_header->item_limit_type == LIMIT_TYPE_EACH_NODE_DATA) {
+            p_tx_offset_p = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset);
+            p_tx_offset_n = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset + 4*sec_testdata->TX_NUM);
+            p_rx_offset_p = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset + 2*4*sec_testdata->TX_NUM);
+            p_rx_offset_n = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset + 2*4*sec_testdata->TX_NUM + 4*sec_testdata->RX_NUM);
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has invalid limit type(%d)\n", TYPE_SELF_RAW_OFFSET_DATA_SDC, item_header->item_limit_type);
+            seq_printf(s, "item: %d has invalid limit type(%d)\n", TYPE_SELF_RAW_OFFSET_DATA_SDC, item_header->item_limit_type);
+            goto ERR_OUT;
+        }
+        if (item_header->para_num == 0) {
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has %d parameter\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->para_num);
+            seq_printf(s, "item: %d has %d parameter\n", TYPE_MUTUAL_RAW_OFFSET_DATA_SDC, item_header->para_num);
+            goto ERR_OUT;
+        }
+
+        /* check self offset data */
+        type = TYPE_OFFSET_DATA_SDC;
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SELF_RAW_TYPE, type);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: set self rawdata type failed\n", __func__);
+            seq_printf(s, "set self rawdata type failed\n");
+            goto ERR_OUT;
+        }
+
+        sec_mdelay(100);
+        /* read raw data */
+        memset(pRead, 0, readbytes); //clear buffer
+        ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_SELF_RAWDATA, readselfbytes, pRead);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: read self rawdata failed!\n", __func__);
+            seq_printf(s, "read self rawdata failed\n");
+            goto ERR_OUT;
+        }
+
+        /* store and judge self minimum frame data */
+        store_to_file(sec_testdata->fd, "TYPE_SELF_TX_OFFSET_DATA:\n");
+        /* check long channel of self data  */
+        for (i = 0; i < sec_testdata->TX_NUM; i++) {
+            nodeData = (pRead[i*2] << 8) | pRead[i*2+1];
+            if (sec_testdata->fd >= 0) {
+                store_to_file(sec_testdata->fd, "%d, ", nodeData);
+            }
+            if ((nodeData < p_tx_offset_n[i]) || (nodeData > p_tx_offset_p[i])) {
+                TPD_INFO("self_offset_tx_data failed at data[%d] = %d [%d,%d]\n", i, nodeData, p_tx_offset_n[i], p_tx_offset_p[i]);
+                if (!err_cnt) {
+                    seq_printf(s, "Step 3-1:self_offset_tx_data failed at data[%d] = %d [%d,%d]\n", i, nodeData, p_tx_offset_n[i], p_tx_offset_p[i]);
+                }
+                err_cnt++;
+            }
+        }
+        store_to_file(sec_testdata->fd, "\n");
+
+        store_to_file(sec_testdata->fd, "TYPE_SELF_RX_OFFSET_DATA:\n");
+        /* check short channel of self data */
+        for (i = 0; i < sec_testdata->RX_NUM; i++) {
+            nodeData = (pRead[sec_testdata->TX_NUM*2 + i*2] << 8) | pRead[sec_testdata->TX_NUM*2 + i*2 +1];  
+            if (sec_testdata->fd >= 0) {
+                store_to_file(sec_testdata->fd, "%d, ", nodeData);
+            }
+            if ((nodeData < p_rx_offset_n[i]) || (nodeData > p_rx_offset_p[i])) {
+                TPD_INFO("self_offset_rx_data failed at data[%d] = %d [%d,%d]\n", i, nodeData, p_rx_offset_n[i], p_rx_offset_p[i]);
+                if (!err_cnt) {
+                    seq_printf(s, "Step 3-2:self_offset_rx_data failed at data[%d] = %d [%d,%d]\n", i, nodeData, p_rx_offset_n[i], p_rx_offset_p[i]);
+                }
+                err_cnt++;
+            }
+        }
+        store_to_file(sec_testdata->fd, "\n");
+    }
+
+    ret = sec_execute_p2ptest(s, chip_info, sec_testdata);
+    if (ret < 0) {
+        err_cnt++;
+        TPD_INFO("%s: p2ptest failed\n", __func__);
+        seq_printf(s, "p2ptest failed\n");
+        goto ERR_OUT;
+    }
+
+    //test item mutual raw noise
+    if (sec_testdata->test_item & (1 << TYPE_MUTU_RAW_NOI_P2P)) {
+        TPD_INFO("do test item raw noise p2p\n");
+
+        item_offset = search_for_item(sec_testdata->fw, item_cnt, TYPE_MUTU_RAW_NOI_P2P);
+        if (item_offset == 0) {
+            err_cnt++;
+            TPD_INFO("search for item limit offset failed\n");
+            seq_printf(s, "search for item limit offset failed\n");
+            goto ERR_OUT;
+        }
+        item_header = (struct sec_test_item_header *)(sec_testdata->fw->data + item_offset);
+        if (item_header->item_magic != 0x4F50504F) {
+            err_cnt++;
+            TPD_INFO("test item: %d magic number(%4x) is wrong\n", TYPE_MUTU_RAW_NOI_P2P, item_header->item_magic);
+            seq_printf(s, "test item: %d magic number(%4x) is wrong\n", TYPE_MUTU_RAW_NOI_P2P, item_header->item_magic);
+            goto ERR_OUT;
+        }
+        if (item_header->item_limit_type == LIMIT_TYPE_EACH_NODE_DATA) {
+            p_p2p_p = (int32_t *)(sec_testdata->fw->data + item_header->top_limit_offset);
+            p_p2p_n = (int32_t *)(sec_testdata->fw->data + item_header->floor_limit_offset);
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has invalid limit type(%d)\n", TYPE_MUTU_RAW_NOI_P2P, item_header->item_limit_type);
+            seq_printf(s, "item: %d has invalid limit type(%d)\n", TYPE_MUTU_RAW_NOI_P2P, item_header->item_limit_type);
+            goto ERR_OUT;
+        }
+        if (item_header->para_num == 0) {
+        } else {
+            err_cnt++;
+            TPD_INFO("item: %d has %d parameter\n", TYPE_MUTU_RAW_NOI_P2P, item_header->para_num);
+            seq_printf(s, "item: %d has %d parameter\n", TYPE_MUTU_RAW_NOI_P2P, item_header->para_num);
+            goto ERR_OUT;
+        }
+
+        /* read minimum value frame from p2p test result */
+        type = TYPE_NOI_P2P_MIN;
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, type);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: set rawdata type failed\n", __func__);
+            seq_printf(s, "set rawdata type failed\n");
+            goto ERR_OUT;
+        }
+
+        sec_mdelay(100);
+        /* read raw data */
+        memset(pRead, 0, readbytes); //clear buffer
+        ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_RAWDATA, readbytes, pRead);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: read rawdata failed!\n", __func__);
+            seq_printf(s, "read rawdata failed\n");
+            goto ERR_OUT;
+        }
+
+        store_to_file(sec_testdata->fd, "TYPE_P2P_MIN_DATA:\n");
+        /* check minimum value */
+        for (j = 0; j < sec_testdata->RX_NUM; j++) {
+            for (i = 0; i < sec_testdata->TX_NUM; i++) {
+                iArrayIndex = i * sec_testdata->RX_NUM + j;
+                nodeData = (pRead[iArrayIndex*2] << 8) | pRead[iArrayIndex*2+1];
+                if (sec_testdata->fd >= 0) {
+                    store_to_file(sec_testdata->fd, "%d, ", nodeData);
+                }
+                if ((nodeData < p_p2p_n[iArrayIndex])) {
+                    TPD_INFO("p2p_min_data failed at data[%d][%d] = %d [%d]\n", i, j, nodeData, p_p2p_n[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Step 4-1:p2p_min_data failed at data[%d][%d] = %d [%d]\n", i, j, nodeData, p_p2p_n[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (sec_testdata->fd >= 0) {
+                store_to_file(sec_testdata->fd, "\n");
+            }
+        }
+
+        /* read maximum value frame from p2p test result */
+        type = TYPE_NOI_P2P_MAX;
+        ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, type);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: set rawdata type failed\n", __func__);
+            seq_printf(s, "set rawdata type failed\n");
+            goto ERR_OUT;
+        }
+
+        sec_mdelay(100);
+        /* read raw data */
+        memset(pRead, 0, readbytes); //clear buffer
+        ret = touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_RAWDATA, readbytes, pRead);
+        if (ret < 0) {
+            err_cnt++;
+            TPD_INFO("%s: read rawdata failed!\n", __func__);
+            seq_printf(s, "read rawdata failed\n");
+            goto ERR_OUT;
+        }
+
+        store_to_file(sec_testdata->fd, "TYPE_P2P_MAX_DATA:\n");
+        /* check maximum value */
+        for (j = 0; j < sec_testdata->RX_NUM; j++) {
+            for (i = 0; i < sec_testdata->TX_NUM; i++) {
+                iArrayIndex = i * sec_testdata->RX_NUM + j;
+                nodeData = (pRead[iArrayIndex*2] << 8) | pRead[iArrayIndex*2+1];
+                if (sec_testdata->fd >= 0) {
+                    store_to_file(sec_testdata->fd, "%d, ", nodeData);
+                }
+                if ((nodeData > p_p2p_p[iArrayIndex])) {
+                    TPD_INFO("p2p_max_data failed at data[%d][%d] = %d [%d]\n", i, j, nodeData, p_p2p_p[iArrayIndex]);
+                    if (!err_cnt) {
+                        seq_printf(s, "Step 4-2:p2p_max_data failed at data[%d][%d] = %d [%d]\n", i, j, nodeData, p_p2p_p[iArrayIndex]);
+                    }
+                    err_cnt++;
+                }
+            }
+            if (sec_testdata->fd >= 0) {
+                store_to_file(sec_testdata->fd, "\n");
+            }
+        }
+    }
+
+ERR_OUT:
+    if (pRead) {
+        kfree(pRead);
+        pRead = NULL;
+    }
+
+    seq_printf(s, "FW:0x%llx\n", sec_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", err_cnt, err_cnt?"":"All test passed.");
+}
+
+static int sec_get_verify_result(struct chip_data_s6sy761 *chip_info)
+{
+    int ret = -1;
+
+    sec_fix_tmode(chip_info, TOUCH_SYSTEM_MODE_TOUCH, TOUCH_MODE_STATE_TOUCH);
+    touch_i2c_write_block(chip_info->client, 0xA7, 0, NULL);    //set to verify calibration
+    sec_mdelay(100);
+    //get calibration result, 0x0F:FAIL(bit[0]:data condition FAIL, bit[1]:RX gap FAIL, bit[2]:TX gap FAIL, bit[3]:TX/RX peak FAIL)
+    ret = touch_i2c_read_byte(chip_info->client, 0xA8);
+    sec_release_tmode(chip_info);
+
+    return ret;
+}
+
+
+int execute_selftest(struct chip_data_s6sy761 *chip_info, bool save_result)
+{
+	u8 pStr[50] = {0};
+	u8 pTmp[20];
+	int rc = 0;
+	u8 tpara[2] = {0x25, 0x40};
+	u8 *rBuff;
+	int i;
+	int result_size = SEC_SELFTEST_REPORT_SIZE + chip_info->hw_res->TX_NUM* chip_info->hw_res->RX_NUM * 2;
+
+	/* save selftest result in flash */
+	if (save_result)
+		tpara[0] = 0x25;
+	else
+		tpara[0] = 0xA5;
+
+	rBuff = kzalloc(result_size, GFP_KERNEL);
+	if (!rBuff)
+		return -ENOMEM;
+
+	TPD_INFO("%s: Self test start!\n", __func__);
+	rc = touch_i2c_write_block(chip_info->client, SEC_CMD_SELFTEST, 2, tpara);
+	if (rc < 0) {
+		TPD_INFO("%s: Send selftest cmd failed!\n", __func__);
+		goto err_exit;
+	}
+
+	sec_mdelay(350);
+
+	rc = sec_wait_for_ready(chip_info, SEC_VENDOR_ACK_SELF_TEST_DONE);
+	if (rc < 0) {
+		TPD_INFO("%s: Selftest execution time out!\n", __func__);
+		goto err_exit;
+	}
+
+	TPD_INFO("%s: Self test done!\n", __func__);
+
+	rc = touch_i2c_read_block(chip_info->client, SEC_READ_SELFTEST_RESULT, result_size, rBuff);
+	if (rc < 0) {
+		TPD_INFO("%s: Selftest execution time out!\n", __func__);
+		goto err_exit;
+	}
+
+	rearrange_sft_result(rBuff, result_size);
+
+	for (i = 0; i < 80; i += 4) {
+		if (i / 4 == 0)
+			strncat(pStr, "SIG ", 5);
+		else if (i / 4 == 1)
+			strncat(pStr, "VER ", 5);
+		else if (i / 4 == 2)
+			strncat(pStr, "SIZ ", 5);
+		else if (i / 4 == 3)
+			strncat(pStr, "CRC ", 5);
+		else if (i / 4 == 4)
+			strncat(pStr, "RES ", 5);
+		else if (i / 4 == 5)
+			strncat(pStr, "COU ", 5);
+		else if (i / 4 == 6)
+			strncat(pStr, "PAS ", 5);
+		else if (i / 4 == 7)
+			strncat(pStr, "FAI ", 5);
+		else if (i / 4 == 8)
+			strncat(pStr, "CHA ", 5);
+		else if (i / 4 == 9)
+			strncat(pStr, "AMB ", 5);
+		else if (i / 4 == 10)
+			strncat(pStr, "RXS ", 5);
+		else if (i / 4 == 11)
+			strncat(pStr, "TXS ", 5);
+		else if (i / 4 == 12)
+			strncat(pStr, "RXO ", 5);
+		else if (i / 4 == 13)
+			strncat(pStr, "TXO ", 5);
+		else if (i / 4 == 14)
+			strncat(pStr, "RXG ", 5);
+		else if (i / 4 == 15)
+			strncat(pStr, "TXG ", 5);
+		else if (i / 4 == 16)
+			strncat(pStr, "RXR ", 5);
+		else if (i / 4 == 17)
+			strncat(pStr, "TXT ", 5);
+		else if (i / 4 == 18)
+			strncat(pStr, "RXT ", 5);
+		else if (i / 4 == 19)
+			strncat(pStr, "TXR ", 5);
+
+		snprintf(pTmp, sizeof(pTmp), "%2X, %2X, %2X, %2X",
+			rBuff[i], rBuff[i + 1], rBuff[i + 2], rBuff[i + 3]);
+		strncat(pStr, pTmp, strnlen(pTmp, sizeof(pTmp)));
+
+		if (i / 4 == 4) {
+			if ((rBuff[i + 3] & 0x30) != 0)// RX, RX open check.
+				rc = 0;
+			else
+				rc = 1;
+
+		}
+		if (i % 8 == 4) {
+			TPD_INFO("%s\n", pStr);
+			memset(pStr, 0x00, sizeof(pStr));
+		} else {
+			strncat(pStr, "  ", 3);
+		}
+	}
+
+err_exit:
+	kfree(rBuff);
+	return rc;
+}
+
+
+static void sec_ts_print_channel(struct chip_data_s6sy761 *chip_info)
+{
+	unsigned char *pStr = NULL;
+	unsigned char pTmp[16] = { 0 };
+	int i = 0, j = 0, k = 0;
+
+	if (!chip_info->hw_res->TX_NUM)
+		return;
+
+	pStr = vzalloc(7 * (chip_info->hw_res->TX_NUM + 1));
+	if (!pStr)
+		return;
+
+	memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+	snprintf(pTmp, sizeof(pTmp), " TX");
+	strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+
+	for (k = 0; k < chip_info->hw_res->TX_NUM; k++) {
+		snprintf(pTmp, sizeof(pTmp), "    %02d", k);
+		strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+	}
+	TPD_INFO("%s\n", pStr);
+
+	memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+	snprintf(pTmp, sizeof(pTmp), " +");
+	strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+
+	for (k = 0; k < chip_info->hw_res->TX_NUM; k++) {
+		snprintf(pTmp, sizeof(pTmp), "------");
+		strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+	}
+	TPD_INFO("%s\n", pStr);
+
+	memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+	snprintf(pTmp, sizeof(pTmp), " | ");
+	strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+
+	for (i = 0; i < (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2; i += 2) {
+		if (j == chip_info->hw_res->TX_NUM) {
+			TPD_INFO("%s\n", pStr);
+			TPD_INFO("\n");
+			memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+			snprintf(pTmp, sizeof(pTmp), " RX");
+			strncat(pStr, pTmp, 7 *chip_info->hw_res->TX_NUM);
+
+			for (k = 0; k < chip_info->hw_res->TX_NUM; k++) {
+				snprintf(pTmp, sizeof(pTmp), "    %02d", k);
+				strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+			}
+
+			TPD_INFO("%s\n", pStr);
+
+			memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+			snprintf(pTmp, sizeof(pTmp), " +");
+			strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+
+			for (k = 0; k < chip_info->hw_res->TX_NUM; k++) {
+				snprintf(pTmp, sizeof(pTmp), "------");
+				strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+			}
+			TPD_INFO("%s\n", pStr);
+
+			memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+			snprintf(pTmp, sizeof(pTmp), " | ");
+			strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+		} else if (j && !(j % chip_info->hw_res->TX_NUM)) {
+			TPD_INFO("%s\n", pStr);
+			memset(pStr, 0x0, 7 * (chip_info->hw_res->TX_NUM + 1));
+			snprintf(pTmp, sizeof(pTmp), " | ");
+			strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+		}
+
+		snprintf(pTmp, sizeof(pTmp), " %5d", chip_info->pFrame[j]);
+		strncat(pStr, pTmp, 7 * chip_info->hw_res->TX_NUM);
+
+		j++;
+	}
+	TPD_INFO("%s\n", pStr);
+	vfree(pStr);
+}
+
+static int sec_ts_read_channel(struct chip_data_s6sy761 *chip_info, u8 type,
+				short *min, short *max, bool save_result)
+{
+	unsigned char *pRead = NULL;
+	u8 mode = TYPE_INVALID_DATA;
+	int ret = 0;
+	int ii = 0;
+	int jj = 0;
+	unsigned int data_length = (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2;
+	u8 w_data;
+
+	TPD_INFO("%s: type %d\n", __func__, type);
+
+	pRead = kzalloc(data_length, GFP_KERNEL);
+	if (!pRead)
+		return -ENOMEM;
+
+	/* set OPCODE and data type */
+	w_data = type;
+
+	ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SELF_RAW_TYPE, type);
+	if (ret < 0) {
+		TPD_DEBUG("%s: Set rawdata type failed\n", __func__);
+		goto out_read_channel;
+	}
+
+	sec_mdelay(50);
+
+	if (type == TYPE_OFFSET_DATA_SDC) {
+		/* execute selftest for real cap offset data,
+		 * because real cap data is not memory data in normal touch.
+		 */
+		char para = 0;// 0 for return touch mode
+		disable_irq(chip_info->client->irq);
+		ret = execute_selftest(chip_info, save_result);
+		if (ret < 0) {
+			TPD_DEBUG("%s: execute_selftest failed!\n", __func__);
+			enable_irq(chip_info->client->irq);
+			goto err_read_data;
+		}
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SET_POWER_MODE, para);
+		if (ret < 0) {
+			TPD_DEBUG("%s: set rawdata type failed!\n", __func__);
+			enable_irq(chip_info->client->irq);
+			goto err_read_data;
+		}
+		enable_irq(chip_info->client->irq);
+		/* end */
+	}
+	/* read data */
+	ret =  touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_SELF_RAWDATA, data_length, pRead);
+	if (ret < 0) {
+		TPD_DEBUG("%s: read rawdata failed!\n", __func__);
+		goto err_read_data;
+	}
+
+	/* clear all pFrame data */
+	memset(chip_info->pFrame, 0x00, data_length);
+
+	for (ii = 0; ii < data_length; ii += 2) {
+		chip_info->pFrame[jj] = ((pRead[ii] << 8) | pRead[ii + 1]);
+
+		if (ii == 0)
+			*min = *max =chip_info->pFrame[jj];
+
+		if(chip_info->pFrame[jj] < *min ) *min = chip_info->pFrame[jj];
+		if(chip_info->pFrame[jj] > *max ) *max = chip_info->pFrame[jj];
+		jj++;
+	}
+
+	sec_ts_print_channel(chip_info);
+
+err_read_data:
+	/* release data monitory (unprepare AFE data memory) */
+	ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SELF_RAW_TYPE, mode);
+	if (ret < 0)
+		TPD_DEBUG("%s: Set rawdata type failed\n", __func__);
+
+out_read_channel:
+	kfree(pRead);
+
+	return ret;
+}
+
+static void sec_ts_print_frame(struct chip_data_s6sy761 *chip_info, short *min, short *max)
+{
+	int i = 0;
+	int j = 0;
+	unsigned char *pStr = NULL;
+	unsigned char pTmp[16] = { 0 };
+	int lsize = 7 * (chip_info->hw_res->TX_NUM + 1);
+
+	TPD_INFO("%s\n", __func__);
+
+	pStr = kzalloc(lsize * (sizeof(int)), GFP_KERNEL);
+	if (pStr == NULL)
+		return;
+
+	memset(pStr, 0x0, lsize);
+	snprintf(pTmp, sizeof(pTmp), "      TX");
+	strncat(pStr, pTmp, lsize);
+
+	for (i = 0; i < chip_info->hw_res->TX_NUM; i++) {
+		snprintf(pTmp, sizeof(pTmp), " %02d ", i);
+		strncat(pStr, pTmp, lsize);
+	}
+
+	TPD_DEBUG("%s\n", pStr);
+	memset(pStr, 0x0, lsize);
+	snprintf(pTmp, sizeof(pTmp), " +");
+	strncat(pStr, pTmp, lsize);
+
+	for (i = 0; i < chip_info->hw_res->TX_NUM; i++) {
+		snprintf(pTmp, sizeof(pTmp), "----");
+		strncat(pStr, pTmp, lsize);
+	}
+
+	TPD_DEBUG("%s\n", pStr);
+
+	for (i = 0; i < chip_info->hw_res->RX_NUM; i++) {
+		memset(pStr, 0x0, lsize);
+		snprintf(pTmp, sizeof(pTmp), "Rx%02d | ", i);
+		strncat(pStr, pTmp, lsize);
+
+		for (j = 0; j < chip_info->hw_res->TX_NUM; j++) {
+			snprintf(pTmp, sizeof(pTmp), " %3d", chip_info->pFrame[(j * chip_info->hw_res->RX_NUM) + i]);
+
+			if (chip_info->pFrame[(j * chip_info->hw_res->RX_NUM) + i] < *min)
+				*min = chip_info->pFrame[(j * chip_info->hw_res->RX_NUM) + i];
+
+			if (chip_info->pFrame[(j * chip_info->hw_res->RX_NUM) + i] > *max)
+				*max = chip_info->pFrame[(j * chip_info->hw_res->RX_NUM) + i];
+
+			strncat(pStr, pTmp, lsize);
+		}
+		TPD_DEBUG("%s\n", pStr);
+	}
+	kfree(pStr);
+}
+
+static int sec_ts_read_frame(struct chip_data_s6sy761 *chip_info, u8 type, short *min,
+		short *max, bool save_result)
+{
+	unsigned int readbytes = 0xFF;
+	unsigned char *pRead = NULL;
+	u8 mode = TYPE_INVALID_DATA;
+	int ret = 0;
+	int i = 0;
+	int j = 0;
+	short *temp = NULL;
+
+	TPD_INFO("%s: type %d\n", __func__, type);
+
+	/* set data length, allocation buffer memory */
+	readbytes = chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2;
+
+	pRead = kzalloc(readbytes, GFP_KERNEL);
+	if (!pRead)
+		return -ENOMEM;
+
+	/* set OPCODE and data type */
+	ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, type);
+	if (ret < 0) {
+		TPD_INFO("%s: Set rawdata type failed\n", __func__);
+		goto ErrorExit;
+	}
+
+	sec_mdelay(50);
+
+	if (type == TYPE_OFFSET_DATA_SDC) {
+		/* excute selftest for real cap offset data, because real cap data is not memory data in normal touch. */
+		char para = 0;//0 for return touch mode
+
+		disable_irq(chip_info->client->irq);
+
+		ret = execute_selftest(chip_info, save_result);
+		if (ret < 0) {
+			TPD_DEBUG("%s: execute_selftest failed\n", __func__);
+			enable_irq(chip_info->client->irq);
+			goto ErrorRelease;
+		}
+
+		ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_SET_POWER_MODE, para);
+		if (ret < 0) {
+			TPD_DEBUG( "%s: Set power mode failed\n", __func__);
+			enable_irq(chip_info->client->irq);
+			goto ErrorRelease;
+		}
+
+		enable_irq(chip_info->client->irq);
+	}
+
+	/* read data */
+	ret =  touch_i2c_read_block(chip_info->client, SEC_READ_TOUCH_RAWDATA, readbytes, pRead);
+	if (ret < 0) {
+		TPD_DEBUG("%s: read rawdata failed!\n", __func__);
+		goto ErrorRelease;
+	}
+
+	memset(chip_info->pFrame, 0x00, readbytes);
+
+	for (i = 0; i < readbytes; i += 2)
+		chip_info->pFrame[i / 2] = pRead[i + 1] + (pRead[i] << 8);
+
+	*min = *max = chip_info->pFrame[0];
+
+#ifdef DEBUG_MSG
+	TPD_INFO("%s: 02X%02X%02X readbytes=%d\n", __func__,
+			pRead[0], pRead[1], pRead[2], readbytes);
+#endif
+	sec_ts_print_frame(chip_info, min, max);
+
+	temp = kzalloc(readbytes, GFP_KERNEL);
+	if (!temp)
+		goto ErrorRelease;
+
+	memcpy(temp, chip_info->pFrame, readbytes);
+	memset(chip_info->pFrame, 0x00, readbytes);
+
+	for (i = 0; i < chip_info->hw_res->TX_NUM; i++) {
+		for (j = 0; j < chip_info->hw_res->RX_NUM; j++)
+			chip_info->pFrame[(j * chip_info->hw_res->TX_NUM) + i] = temp[(i * chip_info->hw_res->RX_NUM) + j];
+	}
+
+	kfree(temp);
+
+ErrorRelease:
+	/* release data monitory (unprepare AFE data memory) */
+	ret = touch_i2c_write_byte(chip_info->client, SEC_CMD_MUTU_RAW_TYPE, mode);
+	if (ret < 0)
+		TPD_DEBUG("%s: Set rawdata type failed\n", __func__);
+
+ErrorExit:
+	kfree(pRead);
+
+	return ret;
+}
+
+/*
+ * sec_ts_run_rawdata_all : read all raw data
+ *
+ * when you want to read full raw data (full_read : true)
+ * "mutual/self 3, 5, 29, 1, 19" data will be saved in log
+ *
+ * otherwise, (full_read : false, especially on boot time)
+ * only "mutual 3, 5, 29" data will be saved in log
+ */
+void sec_ts_run_rawdata_all(void *chip_data, bool full_read)
+{
+	short min = 0, max = 0;
+	int ret = 0, i = 0, read_num = 0;
+	u8 test_type[5] = {TYPE_AMBIENT_DATA, TYPE_DECODED_DATA,
+		TYPE_SIGNAL_DATA, TYPE_OFFSET_DATA_SEC, TYPE_OFFSET_DATA_SDC};
+	
+	struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+	chip_info->pFrame = kzalloc(chip_info->hw_res->TX_NUM* chip_info->hw_res->RX_NUM* 2, GFP_KERNEL);
+	if (!chip_info->pFrame) {
+		TPD_INFO("%s: chip_info->pFrame kzalloc fail\n", __func__);
+		return;
+	}
+	TPD_INFO("%s: start (noise:%d, wet:%d)##\n",
+			__func__, chip_info->touch_noise_status, chip_info->wet_mode);
+
+	ret = sec_fix_tmode(chip_info, TOUCH_SYSTEM_MODE_TOUCH, TOUCH_MODE_STATE_TOUCH);
+	if (ret < 0) {
+		TPD_INFO("%s: failed to fix tmode\n",__func__);
+		goto out;
+	}
+
+	if (full_read) {
+		read_num = 5;
+	} else {
+		read_num = 3;
+		test_type[read_num - 1] = TYPE_OFFSET_DATA_SEC;
+	}
+
+	for (i = 0; i < read_num; i++) {
+		ret = sec_ts_read_frame(chip_info, test_type[i], &min, &max, false);
+		if (ret < 0) {
+			TPD_INFO("%s: mutual %d : error ## ret:%d\n",
+					__func__, test_type[i], ret);
+			goto out;
+		} else {
+			TPD_INFO("%s: mutual %d : Max/Min %d,%d ##\n",
+					__func__, test_type[i], max, min);
+		}
+		sec_mdelay(20);
+
+		if (full_read) {
+			ret = sec_ts_read_channel(chip_info, test_type[i], &min, &max, false);
+			if (ret < 0) {
+				TPD_INFO("%s: self %d : error ## ret:%d\n",
+						__func__, test_type[i], ret);
+				goto out;
+			} else {
+				TPD_INFO("%s: self %d : Max/Min %d,%d ##\n",
+						__func__, test_type[i], max, min);
+			}
+			sec_mdelay(20);
+		}
+	}
+
+	sec_release_tmode(chip_info);
+
+out:
+	TPD_INFO("%s: done (noise:%d, wet:%d)##\n",
+			__func__, chip_info->touch_noise_status, chip_info->wet_mode);
+
+	tp_touch_btnkey_release();
+
+}
+
+
+static void sec_ts_read_info_work(struct work_struct *work)
+{
+	struct touchpanel_data *ts = container_of(work, struct touchpanel_data,
+			work_read_info.work);
+
+	TPD_INFO("%s\n", __func__);
+	mutex_lock(&ts->mutex);
+	sec_ts_run_rawdata_all(ts->chip_data, false);
+	mutex_unlock(&ts->mutex);
+}
+
+static void sec_calibrate(struct seq_file *s, void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    ret = sec_execute_force_calibration(chip_info);
+    if (ret < 0) {
+		TPD_INFO("%s calibration failed\n", __func__);
+        seq_printf(s, "1 error, calibration failed\n");
+    } else {
+		TPD_INFO("%s calibration successed\n", __func__);
+        seq_printf(s, "0 error, calibration successed\n");
+    }
+
+    return;
+}
+
+static void sec_verify_calibration(struct seq_file *s, void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s6sy761 *chip_info = (struct chip_data_s6sy761 *)chip_data;
+
+    ret = sec_get_verify_result(chip_info);
+    if (ret != 0) {
+		TPD_INFO("%s verify calibration failed\n", __func__);
+        seq_printf(s, "1 error, verify calibration result failed(0x%02x)\n", ret);
+    } else {
+		TPD_INFO("%s verify calibration successed\n", __func__);
+        seq_printf(s, "0 error, verify calibration result successed\n");
+    }
+
+    return;
+}
+
+static struct sec_proc_operations sec_proc_ops = {
+    .auto_test          = sec_auto_test,
+    .calibrate          = sec_calibrate,
+    .verify_calibration = sec_verify_calibration,
+};
+
+/*********** Start of I2C Driver and Implementation of it's callbacks*************************/
+static int sec_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    struct chip_data_s6sy761 *chip_info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+	if (tp_register_times > 0) {
+		TPD_INFO("TP driver have success loaded %d times, exit\n", tp_register_times);
+		return -1;
+	}
+    /* 1. alloc chip info */
+    chip_info = kzalloc(sizeof(struct chip_data_s6sy761), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+
+    /* 2. Alloc common ts */
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* 3. bind client and dev for easy operate */
+    chip_info->client = client;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+    /* 4. file_operations callbacks binding */
+    ts->ts_ops = &sec_ops;
+    ts->earsense_ops = &earsense_proc_ops;
+
+    /* 5. register common touch device*/
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+    //ts->tp_resume_order = LCD_TP_RESUME;
+	INIT_DELAYED_WORK(&ts->work_read_info, sec_ts_read_info_work);
+    /* 6. create debug interface*/
+    sec_raw_device_init(ts);
+    sec_create_proc(ts, &sec_proc_ops);
+	schedule_delayed_work(&ts->work_read_info, msecs_to_jiffies(50));
+    TPD_INFO("%s, probe normal end\n", __func__);
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;	
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+    return ret;
+}
+
+static int sec_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+
+	cancel_delayed_work_sync(&ts->work_read_info);
+	flush_delayed_work(&ts->work_read_info);
+    kfree(ts);
+
+    return 0;
+}
+
+static int sec_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int sec_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static void sec_tp_shutdown(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+	int ret = 0;
+
+    TPD_INFO("%s is called\n", __func__);
+	if (!ts->ts_ops->power_control) {
+		ret = -EINVAL;
+		TPD_INFO("tp power_control NULL!\n");
+		return;
+    }
+    ret = ts->ts_ops->power_control(ts->chip_data, false);
+}
+
+
+static const struct i2c_device_id tp_id[] =
+{
+    {TPD_DEVICE, 0},
+    {},
+};
+
+static struct of_device_id tp_match_table[] =
+{
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = sec_i2c_suspend,
+    .resume = sec_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver =
+{
+    .probe = sec_tp_probe,
+    .remove = sec_tp_remove,
+    .shutdown = sec_tp_shutdown,
+    .id_table = tp_id,
+    .driver = {
+        .name = TPD_DEVICE,
+        .owner = THIS_MODULE,
+        .of_match_table = tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+/******************* End of I2C Driver and It's dev_pm_ops***********************/
+
+/***********************Start of module init and exit****************************/
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+/***********************End of module init and exit*******************************/
+
+MODULE_AUTHOR("Samsung Driver");
+MODULE_DESCRIPTION("Samsung Electronics TouchScreen driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.h b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.h
new file mode 100644
index 0000000000000000000000000000000000000000..0e1f6b8f62fe3a77a47fd1f5964c99388bae4279
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/S6SY761/sec_drivers_s6sy761.h
@@ -0,0 +1,285 @@
+/***************************************************
+ * File:sec_drivers_s6sy761.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             samsung s6sy761 driver
+ * Version:1.0:
+ * Date created:2018/01/10
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SEC_H_S6SY761
+#define SEC_H_S6SY761
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+#include "../sec_common.h"
+
+/*********PART2:Define Area**********************/
+#define GESTURE_DOUBLECLICK                     0x00
+#define GESTURE_UP_V                            0x01
+#define GESTURE_DOWN_V                          0x02
+#define GESTURE_LEFT_V                          0x03
+#define GESTURE_RIGHT_V                         0x04
+#define GESTURE_O                               0x05
+#define GESTURE_UP                              0x06
+#define GESTURE_DOWN                            0x07
+#define GESTURE_LEFT                            0x08
+#define GESTURE_RIGHT                           0x09
+#define GESTURE_M                               0x0A
+#define GESTURE_W                               0x0B
+#define GESTURE_DOUBLE_LINE                     0x0C
+#define GESTURE_SINGLE_TAP                      0x0E
+#define GESTURE_S                               0x0F
+
+
+#define GESTURE_EARSENSE                        0x0E
+
+#define RESET_TO_NORMAL_TIME                    (70)
+#define SEC_EVENT_BUFF_SIZE                     8
+#define MAX_EVENT_COUNT                         32
+#define SEC_FW_BLK_DEFAULT_SIZE                 (256)
+#define SEC_FW_BLK_SIZE_MAX                     (512)
+#define SEC_FW_HEADER_SIGN                      0x53494654
+#define SEC_FW_CHUNK_SIGN                       0x53434654
+#define SEC_SELFTEST_REPORT_SIZE                80
+
+#define SEC_COORDINATE_ACTION_NONE              0
+#define SEC_COORDINATE_ACTION_PRESS             1
+#define SEC_COORDINATE_ACTION_MOVE              2
+#define SEC_COORDINATE_ACTION_RELEASE           3
+
+/* SEC event id */
+#define SEC_COORDINATE_EVENT                    0
+#define SEC_STATUS_EVENT                        1
+#define SEC_GESTURE_EVENT                       2
+#define SEC_EMPTY_EVENT                         3
+
+//sec status type
+#define TYPE_STATUS_EVENT_ERR                   1
+#define TYPE_STATUS_EVENT_INFO                  2
+#define TYPE_STATUS_EVENT_VENDOR_INFO           7
+
+/* SEC_TS_INFO : Info acknowledge event */
+#define SEC_ACK_BOOT_COMPLETE                   0x00
+#define SEC_ACK_WET_MODE                        0x01
+#define SEC_VENDOR_ACK_OFFSET_CAL_DONE          0x40
+#define SEC_VENDOR_ACK_SELF_TEST_DONE           0x41
+#define SEC_VENDOR_ACK_P2P_TEST_DONE            0x42
+
+/* SEC_TS_ERROR : Error event */
+#define SEC_ERR_EVNET_CORE_ERR                  0x0
+#define SEC_ERR_EVENT_QUEUE_FULL                0x01
+#define SEC_ERR_EVENT_ESD                       0x2
+
+//earsense status
+#define SEC_STATUS_EARDETECTED                  0x6A		//84 (70.4 change to 6A)
+
+//touchhold status
+#define SEC_STATUS_TOUCHHOLD					0x6B
+
+//wet and noise mode
+#define SEC_TS_ACK_WET_MODE						0x1
+#define SEC_TS_VENDOR_ACK_NOISE_STATUS_NOTI		0x64
+
+//boot status
+#define SEC_STATUS_BOOT_MODE                    0x10
+#define SEC_STATUS_APP_MODE                     0x20
+
+#define STATE_MANAGE_ON                         1
+#define STATE_MANAGE_OFF                        0
+
+//cmd
+#define SEC_READ_ONE_EVENT                      0x60
+#define SEC_READ_ALL_EVENT                      0x61
+#define SEC_CMD_CLEAR_EVENT_STACK               0x62
+#define SEC_READ_GESTURE_EVENT                  0x63
+#define SEC_READ_DEVICE_ID                      0x22    //for custom to print IC info
+#define SEC_READ_ID                             0x52    //for debug with IC touch mode
+#define SEC_READ_FIRMWARE_INTEGRITY             0x21
+#define SEC_READ_BOOT_STATUS                    0x55
+#define SEC_READ_TS_STATUS                      0xAF
+#define SEC_READ_FW_VERSION                     0xA3
+#define SEC_READ_CONFIG_VERSION                 0xA4
+#define SEC_CMD_SENSE_ON                        0x10
+#define SEC_CMD_SENSE_OFF                       0x11
+#define SEC_READ_IMG_VERSION                    0xA5
+#define SEC_CMD_ENTER_FW_MODE                   0x57
+#define SEC_CMD_SOFT_RESET                      0x12
+#define SEC_CMD_FLASH_ERASE                     0xD8
+#define SEC_CMD_FLASH_WRITE                     0xD9
+#define SEC_CMD_FLASH_PADDING                   0xDA
+#define SEC_CMD_FLASH_READ_ADDR                 0xD0
+#define SEC_CMD_FLASH_READ_SIZE                 0xD1
+#define SEC_CMD_FLASH_READ_DATA                 0xD2
+#define SEC_CMD_WAKEUP_GESTURE_MODE             0x65
+#define SEC_CMD_SET_POWER_MODE                  0xE4
+#define SET_CMD_SET_CHARGER_MODE                0x32
+#define SEC_CMD_READ_CALIBRATION_REPORT         0xF1
+#define SEC_CMD_FACTORY_PANELCALIBRATION        0x14
+#define SEC_CMD_MUTU_RAW_TYPE                   0x70
+#define SEC_CMD_SELF_RAW_TYPE                   0x71
+#define SEC_READ_TOUCH_RAWDATA                  0x72    //read all frame rawdata(ordered by RX len)
+#define SEC_READ_TOUCH_SELF_RAWDATA             0x73
+#define SEC_READ_TOUCH_SETLEN_RAWDATA           0x74    //read out self define length rawdata(ordered by TX len)
+#define SEC_CMD_TOUCH_RAWDATA_SETLEN            0x75    //set rawdata length of reading
+#define SEC_CMD_TOUCH_DELTA_READ                0x76    //cmd to read delta data
+#define SEC_CMD_TOUCH_RAWDATA_READ              0x77    //cmd to read rawdata data
+#define SEC_CMD_TOUCH_SELFDATA_READ             0x78    //cmd to read self data
+#define SEC_CMD_SELFTEST                        0xAE
+#define SEC_READ_SELFTEST_RESULT                0x80
+#define SEC_CMD_STATEMANAGE_ON                  0x8E
+#define SEC_CMD_CHG_SYSMODE                     0xD7
+#define SEC_CMD_HOVER_DETECT                    0xEE	//proximity function
+#define SEC_CMD_SET_P2PTEST_MODE                0x83
+#define SEC_CMD_P2PTEST                         0x82
+#define SEC_CMD_INTERRUPT_SWITCH                0x89
+#define SEC_CMD_PALM_SWITCH                     0x30
+#define SEC_CMD_GRIP_SWITCH                     0xAA
+#define SEC_CMD_SENSETIVE_CTRL                  0x3F
+#define SEC_CMD_REFRESH_RATE_SWITCH				0x40
+#define SEC_CMD_TOUCHHOLD_SWITCH				0x43
+#define SEC_CMD_TOUCHHOLD_CALIBRATE				0x44
+#define SEC_CMD_GRIPMODE_SWITCH					0xAD	//0 is portrait,1 is landscape
+#define SEC_CMD_PORTRAIT_CORNER					0xAB
+#define SEC_CMD_LANDSPACE_CORNER				0xAC
+
+
+
+
+/*********PART3:Struct Area**********************/
+typedef struct {
+    u32 signature;          /* signature */
+    u32 version;            /* version */
+    u32 totalsize;          /* total size */
+    u32 checksum;           /* checksum */
+    u32 img_ver;            /* image file version */
+    u32 img_date;           /* image file date */
+    u32 img_description;    /* image file description */
+    u32 fw_ver;             /* firmware version */
+    u32 fw_date;            /* firmware date */
+    u32 fw_description;     /* firmware description */
+    u32 para_ver;           /* parameter version */
+    u32 para_date;          /* parameter date */
+    u32 para_description;   /* parameter description */
+    u32 num_chunk;          /* number of chunk */
+    u32 reserved1;
+    u32 reserved2;
+} sec_fw_header;
+
+typedef struct {
+    u32 signature;
+    u32 addr;
+    u32 size;
+    u32 reserved;
+} sec_fw_chunk;
+
+struct sec_gesture_status {
+    u8 eid:2;
+    u8 gtype:4;
+    u8 stype:2;
+    u8 gestureId;
+    u8 coordLen;
+    u8 data;
+    u8 reserved[4];
+} __attribute__ ((packed));
+
+/* 8 byte */
+struct sec_event_status {
+    u8 eid:2;
+    u8 stype:4;
+    u8 sf:2;
+    u8 status_id;
+    u8 status_data_1;
+    u8 status_data_2;
+    u8 status_data_3;
+    u8 status_data_4;
+    u8 status_data_5;
+    u8 left_event_5_0:6;
+    u8 reserved_2:2;
+} __attribute__ ((packed));
+
+/* 8 byte */
+struct sec_event_coordinate {
+    u8 eid:2;
+    u8 tid:4;
+    u8 tchsta:2;
+    u8 x_11_4;
+    u8 y_11_4;
+    u8 y_3_0:4;
+    u8 x_3_0:4;
+    u8 major;
+    u8 minor;
+    u8 z:6;
+    u8 ttype_3_2:2;
+    u8 left_event:6;
+    u8 ttype_1_0:2;
+} __attribute__ ((packed));
+
+typedef enum {
+    TOUCH_SYSTEM_MODE_BOOT          = 0,
+    TOUCH_SYSTEM_MODE_CALIBRATION   = 1,
+    TOUCH_SYSTEM_MODE_TOUCH         = 2,
+    TOUCH_SYSTEM_MODE_SELFTEST      = 3,
+    TOUCH_SYSTEM_MODE_FLASH         = 4,
+    TOUCH_SYSTEM_MODE_LOWPOWER      = 5,
+    TOUCH_SYSTEM_MODE_LISTEN
+} TOUCH_SYSTEM_MODE;
+
+typedef enum {
+    TOUCH_MODE_STATE_IDLE           = 0,
+    TOUCH_MODE_STATE_HOVER          = 1,
+    TOUCH_MODE_STATE_TOUCH          = 2,
+    TOUCH_MODE_STATE_NOISY          = 3,
+    TOUCH_MODE_STATE_CAL            = 4,
+    TOUCH_MODE_STATE_CAL2           = 5,
+    TOUCH_MODE_STATE_WAKEUP         = 10
+} TOUCH_MODE_STATE;
+
+enum {
+    TYPE_RAW_DATA               = 0,    /* Total - Offset : delta data */
+    TYPE_SIGNAL_DATA            = 1,    /* Signal - Filtering & Normalization */
+    TYPE_AMBIENT_BASELINE       = 2,    /* Cap Baseline */
+    TYPE_AMBIENT_DATA           = 3,    /* Cap Ambient */
+    TYPE_REMV_BASELINE_DATA     = 4,
+    TYPE_DECODED_DATA           = 5,    /* Raw */
+    TYPE_REMV_AMB_DATA          = 6,    /*  TYPE_RAW_DATA - TYPE_AMBIENT_DATA */
+    TYPE_OFFSET_DATA_SEC        = 19,    /* Cap Offset in SEC Manufacturing Line */
+    TYPE_OFFSET_DATA_SDC        = 29,    /* Cap Offset in SDC Manufacturing Line */
+    TYPE_NOI_P2P_MIN            = 30,    /* Peak-to-peak noise Min */
+    TYPE_NOI_P2P_MAX            = 31,     /* Peak-to-peak noise Max */
+    TYPE_DATA_DELTA             = 60,    /* delta */
+    TYPE_DATA_RAWDATA           = 61,    /* rawdata */
+    TYPE_INVALID_DATA           = 0xFF,    /* Invalid data type for release factory mode */
+};
+
+struct chip_data_s6sy761 {
+    tp_dev                          tp_type;
+    struct i2c_client               *client;
+    u8                              boot_ver[3];
+    bool                            is_power_down;
+    struct hw_resource              *hw_res;
+    uint32_t                        flash_page_size;
+    u8                              first_event[SEC_EVENT_BUFF_SIZE];
+	u8								wet_mode;
+	u8								proximity_status;
+	u8								touch_noise_status;
+	short 							*pFrame;
+};
+
+struct fp_underscreen_info {
+    uint8_t touch_state;
+    uint8_t area_rate;
+    uint16_t x;
+    uint16_t y;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..edd1fdb2b556b0b542a961f4a24cd69af67109a1
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.c
@@ -0,0 +1,542 @@
+/***************************************************
+ * File:sec_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             sec common driver
+ * Version:1.0:
+ * Date created:2018/01/22
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "sec_common.h"
+
+/*******LOG TAG Declear*****************************/
+
+#define TPD_DEVICE "sec_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (tp_debug)\
+        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+/*********** sec tool operate content***********************/
+u8 lv1cmd;
+static int lv1_readsize;
+
+static ssize_t sec_ts_reg_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size);
+static ssize_t sec_ts_regreadsize_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size);
+static ssize_t sec_ts_regread_show(struct device *dev, struct device_attribute *attr, char *buf);
+
+static DEVICE_ATTR(sec_ts_reg, (S_IWUSR | S_IWGRP), NULL, sec_ts_reg_store);
+static DEVICE_ATTR(sec_ts_regreadsize, (S_IWUSR | S_IWGRP), NULL, sec_ts_regreadsize_store);
+static DEVICE_ATTR(sec_ts_regread, S_IRUGO, sec_ts_regread_show, NULL);
+
+static struct attribute *cmd_attributes[] = {
+    &dev_attr_sec_ts_reg.attr,
+    &dev_attr_sec_ts_regreadsize.attr,
+    &dev_attr_sec_ts_regread.attr,
+    NULL,
+};
+
+static struct attribute_group cmd_attr_group = {
+    .attrs = cmd_attributes,
+};
+
+static ssize_t sec_ts_reg_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    if (size > 0) {
+        mutex_lock(&ts->mutex);
+        touch_i2c_write(ts->client, (u8 *)buf, size);
+        mutex_unlock(&ts->mutex);
+    }
+
+    TPD_DEBUG("%s: 0x%x, 0x%x, size %d\n", __func__, buf[0], buf[1], (int)size);
+    return size;
+}
+
+static ssize_t sec_ts_regread_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    int ret = -1;
+    u8 *read_lv1_buff = NULL;
+    int length = 0, remain = 0, offset = 0;
+
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+
+    read_lv1_buff = kzalloc(lv1_readsize, GFP_KERNEL);
+    if (!read_lv1_buff)
+        goto malloc_err;
+
+    remain = lv1_readsize;
+    offset = 0;
+    do {
+        if (remain >= I2C_BURSTMAX)
+            length = I2C_BURSTMAX;
+        else
+            length = remain;
+
+        if (offset == 0)
+            ret = touch_i2c_read_block(ts->client, lv1cmd, length, &read_lv1_buff[offset]);
+        else
+            ret = touch_i2c_read(ts->client, NULL, 0, &read_lv1_buff[offset], length);
+
+        if (ret < 0) {
+            TPD_INFO("%s: i2c read %x command, remain =%d\n", __func__, lv1cmd, remain);
+            goto i2c_err;
+        }
+
+        remain -= length;
+        offset += length;
+    } while (remain > 0);
+
+    TPD_DEBUG("%s: lv1_readsize = %d\n", __func__, lv1_readsize);
+    memcpy(buf, read_lv1_buff, lv1_readsize);
+
+i2c_err:
+    kfree(read_lv1_buff);
+malloc_err:
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return lv1_readsize;
+}
+
+static ssize_t sec_ts_regreadsize_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    mutex_lock(&ts->mutex);
+
+    lv1cmd = buf[0];
+    lv1_readsize = ((unsigned int)buf[4] << 24) |
+            ((unsigned int)buf[3] << 16) | ((unsigned int) buf[2] << 8) | ((unsigned int)buf[1] << 0);
+
+    mutex_unlock(&ts->mutex);
+
+    return size;
+}
+
+//create sec debug interfaces
+void sec_raw_device_init(struct touchpanel_data *ts)
+{
+    int ret = -1;
+    struct class *sec_class = NULL;
+
+    sec_class = class_create(THIS_MODULE, "sec");
+    ret = IS_ERR_OR_NULL(sec_class);
+    if (ret) {
+        TPD_INFO("%s: fail to create class\n", __func__);
+        return;
+    }
+
+    ts->dev = device_create(sec_class, NULL, 0, ts, "sec_ts");
+    ret = IS_ERR(ts->dev);
+    if (ret) {
+        TPD_INFO("%s: fail - device_create\n", __func__);
+        return;
+    }
+
+    ret = sysfs_create_group(&ts->dev->kobj, &cmd_attr_group);
+    if (ret < 0) {
+        TPD_INFO("%s: fail - sysfs_create_group\n", __func__);
+        goto err_sysfs;
+    }
+
+    TPD_INFO("create debug interface success\n");
+    return;
+err_sysfs:
+    TPD_INFO("%s: fail\n", __func__);
+    return;
+}
+
+
+void sec_limit_read(struct seq_file *s, struct touchpanel_data *ts)
+{
+    int ret = 0, m = 0, i = 0, j = 0, item_cnt = 0, array_index = 0;
+    const struct firmware *fw = NULL;
+    struct sec_test_header *ph = NULL;
+    struct sec_test_item_header *item_head = NULL;
+    uint32_t *p_item_offset = NULL;
+    int32_t *p_data32 = NULL;
+
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "Request failed, Check the path\n");
+        return;
+    }
+
+    ph = (struct sec_test_header *)(fw->data);
+    p_item_offset = (uint32_t *)(fw->data + 16);
+    if ((ph->magic1 != 0x494D494C) || (ph->magic2 != 0x474D4954)) {
+        TPD_INFO("limit image is not generated by oppo\n");
+        seq_printf(s, "limit image is not generated by oppo\n");
+        release_firmware(fw);
+        return;
+    }
+
+    for (i = 0; i < 8*sizeof(ph->test_item); i++) {
+        if ((ph->test_item >> i) & 0x01 ) {
+            item_cnt++;
+        }
+    }
+    if (!item_cnt) {
+        TPD_INFO("limit image has no test item\n");
+        seq_printf(s, "limit image has no test item\n");
+    }
+
+    for (m = 0; m < item_cnt; m++) {
+        item_head = (struct sec_test_item_header *)(fw->data + p_item_offset[m]);
+        if (item_head->item_magic != 0x4F50504F) {
+            seq_printf(s, "item: %d limit data has some problem\n", item_head->item_bit);
+            continue;
+        }
+
+        seq_printf(s, "item %d[size %d, limit type %d, para num %d] :\n", item_head->item_bit, item_head->item_size, item_head->item_limit_type, item_head->para_num);
+        if (item_head->item_limit_type == LIMIT_TYPE_NO_DATA) {
+            seq_printf(s, "no limit data\n");
+        } else if (item_head->item_limit_type == LIMIT_TYPE_CERTAIN_DATA) {
+            p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset);
+            seq_printf(s, "top limit data: %d\n", *p_data32);
+            p_data32 = (int32_t *)(fw->data + item_head->floor_limit_offset);
+            seq_printf(s, "floor limit data: %d\n", *p_data32);
+        } else if (item_head->item_limit_type == LIMIT_TYPE_EACH_NODE_DATA) {
+            if (item_head->item_bit == TYPE_MUTUAL_RAW_OFFSET_DATA_SDC) {
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset);
+                seq_printf(s, "mutual raw top data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset + 4 * ts->hw_res.TX_NUM * ts->hw_res.RX_NUM);
+                seq_printf(s, "mutual gap top data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+
+                p_data32 = (int32_t *)(fw->data + item_head->floor_limit_offset);
+                seq_printf(s, "mutual raw floor data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+
+                p_data32 = (int32_t *)(fw->data + item_head->floor_limit_offset + 4 * ts->hw_res.TX_NUM * ts->hw_res.RX_NUM);
+                seq_printf(s, "mutual gap floor data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+            } else if(item_head->item_bit == TYPE_SELF_RAW_OFFSET_DATA_SDC){
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset);
+                seq_printf(s, "tx top data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "%4d, ", p_data32[i]);
+                }
+                seq_printf(s, "\n");
+
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset + 4*ts->hw_res.TX_NUM);
+                seq_printf(s, "tx floor data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "%4d, ", p_data32[i]);
+                }
+                seq_printf(s, "\n");
+
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset + 2*4*ts->hw_res.TX_NUM);
+                seq_printf(s, "rx top data: \n");
+                for (i = 0; i < ts->hw_res.RX_NUM; i++) {
+                    seq_printf(s, "%4d, ", p_data32[i]);
+                }
+                seq_printf(s, "\n");
+
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset + 2*4*ts->hw_res.TX_NUM + 4*ts->hw_res.RX_NUM);
+                seq_printf(s, "rx floor data: \n");
+                for (i = 0; i < ts->hw_res.RX_NUM; i++) {
+                    seq_printf(s, "%4d, ", p_data32[i]);
+                }
+                seq_printf(s, "\n");
+            } else if (item_head->item_bit == TYPE_MUTU_RAW_NOI_P2P) {
+                p_data32 = (int32_t *)(fw->data + item_head->top_limit_offset);
+                seq_printf(s, "noise top data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+
+                p_data32 = (int32_t *)(fw->data + item_head->floor_limit_offset);
+                seq_printf(s, "noise floor data: \n");
+                for (i = 0; i < ts->hw_res.TX_NUM; i++) {
+                    seq_printf(s, "[%02d] ", i);
+                    for (j = 0; j < ts->hw_res.RX_NUM; j++) {
+                        array_index = i * ts->hw_res.RX_NUM + j;
+                        seq_printf(s, "%4d, ", p_data32[array_index]);
+                    }
+                    seq_printf(s, "\n");
+                }
+            }
+        }
+
+        p_data32 = (int32_t *)(fw->data + p_item_offset[m] + sizeof(struct sec_test_item_header));
+        if (item_head->para_num) {
+            seq_printf(s, "parameter:");
+            for (j = 0; j < item_head->para_num; j++) {
+                seq_printf(s, "%d, ", p_data32[j]);
+            }
+            seq_printf(s, "\n");
+        }
+        seq_printf(s, "\n");
+    }
+
+    release_firmware(fw);
+}
+
+/************ sec auto test content*************************/
+
+static int tp_auto_test_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct sec_proc_operations *sec_ops;
+    const struct firmware *fw = NULL;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    mm_segment_t old_fs;
+    uint8_t data_buf[128];
+    int fd = -1, ret = -1;
+    struct sec_test_header *test_head = NULL;
+    uint32_t *p_data32 = NULL;
+
+    struct sec_testdata sec_testdata =
+    {
+        .TX_NUM = 0,
+        .RX_NUM = 0,
+        .fd = -1,
+        .irq_gpio = -1,
+        .TP_FW = 0,
+        .fw = NULL,
+        .test_item = 0,
+    };
+
+    if (!ts)
+        return 0;
+    sec_ops = (struct sec_proc_operations *)ts->private_data;
+    if (!sec_ops)
+        return 0;
+    if (!sec_ops->auto_test) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+
+    //step1:disable_irq && get mutex locked
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, false);
+    }
+
+    //step2: create a file to store test data in /sdcard/Tp_Test
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    snprintf(data_buf, 128, "/sdcard/TpTestReport/screenOn/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    sys_mkdir("/sdcard/TpTestReport", 0666);
+    sys_mkdir("/sdcard/TpTestReport/screenOn", 0666);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        enable_irq(ts->irq);
+        return 0;
+    }
+
+    //step3:request test limit data from userspace
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "No limit IMG\n");
+        sys_close(fd);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        enable_irq(ts->irq);
+        return 0;
+    }
+
+    //step4: decode the limit image
+    test_head = (struct sec_test_header *)fw->data;
+    p_data32 = (uint32_t *)(fw->data + 16);
+    if ((test_head->magic1 != 0x494D494C) || (test_head->magic2 != 0x474D4954)) {
+        TPD_INFO("limit image is not generated by oppo\n");
+        seq_printf(s, "limit image is not generated by oppo\n");
+        goto OUT;
+    }
+    TPD_INFO("current test item: %llx\n", test_head->test_item);
+
+    //init syna_testdata
+    sec_testdata.fd = fd;
+    sec_testdata.TX_NUM = ts->hw_res.TX_NUM;
+    sec_testdata.RX_NUM = ts->hw_res.RX_NUM;
+    sec_testdata.irq_gpio = ts->hw_res.irq_gpio;
+    sec_testdata.TP_FW = ts->panel_data.TP_FW;
+    sec_testdata.fw = fw;
+    sec_testdata.test_item = test_head->test_item;
+
+    sec_ops->auto_test(s, ts->chip_data, &sec_testdata);
+
+OUT:
+    //step4: close file && release test limit firmware
+    if (fd >= 0) {
+        sys_close(fd);
+        set_fs(old_fs);
+    }
+    release_firmware(fw);
+
+    //step5: return to normal mode
+    ts->ts_ops->reset(ts->chip_data);
+    operate_mode_switch(ts);
+
+    //step6: unlock the mutex && enable irq trigger
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int baseline_autotest_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_auto_test_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_auto_test_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = baseline_autotest_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int calibrate_fops_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct sec_proc_operations *sec_ops = (struct sec_proc_operations *)ts->private_data;
+
+    if (!sec_ops->calibrate)
+        return 0;
+
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+    if (!ts->touch_count) {
+        sec_ops->calibrate(s, ts->chip_data);
+    } else {
+        seq_printf(s, "1 error, release touch on the screen\n");
+    }
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int proc_calibrate_fops_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, calibrate_fops_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations proc_calibrate_fops = {
+    .owner = THIS_MODULE,
+    .open  = proc_calibrate_fops_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int verify_fops_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct sec_proc_operations *sec_ops = (struct sec_proc_operations *)ts->private_data;
+
+    if (!sec_ops->verify_calibration)
+        return 0;
+
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+    if (!ts->touch_count) {
+        sec_ops->verify_calibration(s, ts->chip_data);
+    } else {
+        seq_printf(s, "1 error, skip verify when touch on screen\n");
+    }
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int proc_verify_fops_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, verify_fops_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations proc_verify_fops = {
+    .owner = THIS_MODULE,
+    .open  = proc_verify_fops_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/baseline_test
+int sec_create_proc(struct touchpanel_data *ts, struct sec_proc_operations *sec_ops)
+{
+    int ret = 0;
+
+    // touchpanel_auto_test interface
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    ts->private_data = sec_ops;
+    prEntry_tmp = proc_create_data("baseline_test", 0666, ts->prEntry_tp, &tp_auto_test_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("calibration", 0666, ts->prEntry_tp, &proc_calibrate_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("calibration_verify", 0666, ts->prEntry_tp, &proc_verify_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+    return ret;
+}
\ No newline at end of file
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..c935c8f0f650c474e31dda10576335f2dcb0c011
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Samsung/sec_common.h
@@ -0,0 +1,85 @@
+/***************************************************
+ * File:sec_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             sec common driver
+ * Version:1.0:
+ * Date created:2018/01/22
+ * Author: Cong.Dai@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SEC_H
+#define SEC_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+
+#define I2C_BURSTMAX                        (256)
+/*********PART2:Define Area**********************/
+struct sec_testdata{
+    int TX_NUM;
+    int RX_NUM;
+    int fd;
+    int irq_gpio;
+    uint64_t  TP_FW;
+    const struct firmware *fw;
+    uint64_t test_item;
+};
+
+struct sec_test_header {
+    uint32_t magic1;
+    uint32_t magic2;
+    uint64_t test_item;
+};
+
+enum {
+    LIMIT_TYPE_NO_DATA          = 0x00,     //means no limit data
+    LIMIT_TYPE_CERTAIN_DATA     = 0x01,     //means all nodes limit data is a certain data
+    LIMIT_TYPE_EACH_NODE_DATA   = 0x02,     //means all nodes have it's own limit
+    LIMIT_TYPE_INVALID_DATA     = 0xFF,     //means wrong limit data type
+};
+
+//test item
+enum {
+    TYPE_ERROR                              = 0x00,
+    TYPE_MUTUAL_RAW_OFFSET_DATA_SDC         = 0x01,
+    TYPE_MUTUAL_RAW_DATA                    = 0x02,
+    TYPE_SELF_RAW_OFFSET_DATA_SDC           = 0x03,
+    TYPE_MUTU_RAW_NOI_P2P                   = 0x04,
+    TYPE_MAX                                = 0xFF,
+};
+
+struct sec_test_item_header {
+    uint32_t    item_magic;
+    uint32_t    item_size;
+    uint16_t    item_bit;
+    uint16_t    item_limit_type;
+    uint32_t    top_limit_offset;
+    uint32_t    floor_limit_offset;
+    uint32_t    para_num;
+};
+
+/*********PART3:Struct Area**********************/
+struct sec_proc_operations {
+    void (*auto_test)    (struct seq_file *s, void *chip_data, struct sec_testdata *sec_testdata);
+    void (*calibrate)    (struct seq_file *s, void *chip_data);
+    void (*verify_calibration)    (struct seq_file *s, void *chip_data);
+};
+
+/*********PART4:function declare*****************/
+int sec_create_proc(struct touchpanel_data *ts, struct sec_proc_operations *sec_ops);
+void sec_flash_proc_init(struct touchpanel_data *ts, const char *name);
+void sec_limit_read(struct seq_file *s, struct touchpanel_data *ts);
+void sec_raw_device_init(struct touchpanel_data *ts);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/St/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..c7d2fef618ea4c5afd589e4f904a063c657e41fe
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/Kconfig
@@ -0,0 +1,3 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Kconfig"
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/St/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..1a70d2c29c6931b56729259ad228e40dea9b9b09
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_ST_FST1BA90A) += fst1ba90a/
+obj-$(CONFIG_TOUCHPANEL_ST) += st_common.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..9935f7327ad2f9c16f8c79a973f39be90365e644
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Zengpeng.Chen@Bsp.group.Tp for ST ic driver
+
+config TOUCHPANEL_ST_FST1BA90A
+#	default y
+	bool "TP ST_FST1BA90A IC enable or not for OPPO"
+	---help---
+	  say Y to enable driver for Touchpanel using ST FST1BA90A IC
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..01478cdc122bff77deaa21f69f5ad5984723350a
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/Makefile
@@ -0,0 +1,6 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+obj-$(CONFIG_TOUCHPANEL_ST_FST1BA90A) += fts.o fts_proc.o fts_lib/
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.c
new file mode 100644
index 0000000000000000000000000000000000000000..8d19a4e94eeaef37f4b7ddff44c5ed1b608d64b9
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.c
@@ -0,0 +1,1900 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : fts.c
+ * Description: Source file for ST fst1ba90a driver
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+#include <linux/device.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/input.h>
+#include <linux/input/mt.h>
+#include <linux/interrupt.h>
+#include <linux/hrtimer.h>
+#include <linux/delay.h>
+#include <linux/firmware.h>
+#include <linux/i2c.h>
+#include <linux/i2c-dev.h>
+#include <linux/spi/spi.h>
+#include <linux/completion.h>
+#include <linux/device.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/regulator/consumer.h>
+
+#include "fts.h"
+#include "fts_lib/ftsCompensation.h"
+#include "fts_lib/ftsCore.h"
+#include "fts_lib/ftsIO.h"
+#include "fts_lib/ftsError.h"
+#include "fts_lib/ftsFlash.h"
+#include "fts_lib/ftsFrame.h"
+#include "fts_lib/ftsGesture.h"
+#include "fts_lib/ftsTest.h"
+#include "fts_lib/ftsTime.h"
+#include "fts_lib/ftsTool.h"
+#include "../st_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "ST-fst1ba90a"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+extern int tp_register_times;
+
+/* system related info */
+extern SysInfo systemInfo;
+
+/* test iterm related info */
+extern TestToDo tests;
+
+/* gesture related info */
+#ifdef GESTURE_MODE
+extern u16 gesture_coordinates_x[GESTURE_MAX_COORDS_PAIRS_REPORT];
+extern u16 gesture_coordinates_y[GESTURE_MAX_COORDS_PAIRS_REPORT];
+extern int gesture_coords_reported;
+extern struct mutex gestureMask_mutex;
+#endif
+
+/* fun declaration */
+static int fts_mode_switch(void *chip_data, work_mode mode, bool flag);
+static int fts_chip_initialization(struct fts_ts_info *info, int init_type);
+static int fts_esd_handle(void *chip_data);
+
+/* TODO: define if need to do the full mp at the boot */
+/**
+  * Execute the initialization of the IC (supporting a retry mechanism),
+  * checking also the resulting data
+  * @see  production_test_main()
+  */
+static int fts_chip_initialization(struct fts_ts_info *info, int init_type)
+{
+    int ret2 = 0;
+    int retry;
+    int initretrycnt = 0;
+
+    /* initialization error, retry initialization */
+    for (retry = 0; retry < RETRY_INIT_BOOT; retry++) {
+#ifndef COMPUTE_INIT_METHOD
+        ret2 = production_test_initialization(init_type);
+#else
+        ret2 = production_test_main(info->test_limit_name, 1, init_type, &tests, MP_FLAG_BOOT);
+#endif
+        if (ret2 == OK)
+            break;
+        initretrycnt++;
+        TPD_INFO("%s: initialization cycle count = %04d - ERROR %08X\n", __func__, initretrycnt, ret2);
+        fts_chip_powercycle(info);
+    }
+    if (ret2 < OK)    /* initialization error */
+        TPD_INFO("%s: fts initialization failed %d times\n", __func__, RETRY_INIT_BOOT);
+
+    return ret2;
+}
+
+/**
+  * This function try to attempt to communicate with the IC for the first time
+  * during the boot up process in order to read the necessary info for the
+  * following stages.
+  * The function execute a system reset, read fundamental info (system info)
+  * @return OK if success or an error code which specify the type of error
+  */
+static int fts_init(struct fts_ts_info *info)
+{
+    int error = 0;
+
+    fts_resetDisableIrqCount();
+
+    error = fts_system_reset();
+    if (error < OK && isI2cError(error)) {
+        TPD_INFO("%s: Cannot reset the device! ERROR %08X\n", __func__, error);
+        return error;
+    } else {
+        if (error == (ERROR_TIMEOUT | ERROR_SYSTEM_RESET_FAIL)) {
+            TPD_INFO("%s: Setting default Sys INFO!\n", __func__);
+            error = defaultSysInfo(0);
+        } else {
+            error = readSysInfo(0);    /* system reset OK */
+            if (error < OK) {
+                if (!isI2cError(error))
+                    error = OK;
+                TPD_INFO("%s: Cannot read Sys Info! ERROR %08X\n", __func__, error);
+            }
+        }
+    }
+
+    return error;
+}
+
+/* fts powercycle func */
+int fts_chip_powercycle(struct fts_ts_info *info)
+{
+    int error = 0;
+
+    TPD_INFO("%s: Power Cycle Starting...\n", __func__);
+
+    error = tp_powercontrol_1v8(info->hw_res, false);
+    if (error < 0) {
+        TPD_INFO("%s: Failed to disable DVDD regulator\n", __func__);
+    }
+
+    msleep(5);
+
+    error = tp_powercontrol_2v8(info->hw_res, false);
+    if (error < 0) {
+        TPD_INFO("%s: Failed to disable AVDD regulator\n", __func__);
+    }
+
+    msleep(10);
+
+    if (info->hw_res->reset_gpio != GPIO_NOT_DEFINED)
+         gpio_direction_output(info->hw_res->reset_gpio, 0);
+    else
+        msleep(300);
+
+    /* in FTI power up first the digital and then the analog */
+    error = tp_powercontrol_1v8(info->hw_res, true);
+    if (error < 0) {
+        TPD_INFO("%s: Failed to enable 1v8 regulator\n", __func__);
+    }
+
+    msleep(5);
+
+    error = tp_powercontrol_2v8(info->hw_res, true);
+    if (error < 0) {
+        TPD_INFO("%s: Failed to enable 2v8 regulator\n", __func__);
+    }
+
+    msleep(10);    /* time needed by the regulators for reaching the regime values */
+
+    if (info->hw_res->reset_gpio != GPIO_NOT_DEFINED) {
+         gpio_direction_output(info->hw_res->reset_gpio, 1);
+         msleep(50);
+    }
+
+    TPD_INFO("%s: Power Cycle Finished! ERROR CODE = %08x\n", __func__, error);
+
+    return error;
+}
+
+/* fts mode switch func */
+static int fts_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = 0;
+    u8 settings[4] = { 0 };
+    u8 gesture_mask[GESTURE_MASK_SIZE] = { 0xBF, 0x11, 0x07, 0x00 };/* gesture mask which we want to set */
+    u8 cmd_eare_on[4] = { 0xc0, 0x04, 0x01, 0x01};
+	u8 cmd_eare_off[4] = {0xc0, 0x04, 0x00, 0x00};
+	u8 fingerprint_int_high[3] = {0xC0, 0x05, 0x01};
+	u8 fingerprint_int_low[3] = {0xC0, 0x05, 0x00};
+
+
+    switch(mode) {
+    case MODE_NORMAL:
+        TPD_DEBUG("%s: enter in normal mode !\n", __func__);
+        settings[0] = 0x01;    /* enable all the possible scans mode supported by the config */
+        TPD_DEBUG("%s: Sense ON!\n", __func__);
+        ret = setScanMode(SCAN_MODE_ACTIVE, settings[0]);
+        if (ret < OK) {
+            TPD_INFO("%s error during setting NORMAL_MODE! ERROR %08X\n", __func__, ret);
+        }
+        break;
+
+    case MODE_SLEEP:
+        TPD_DEBUG("%s: enter in sleep mode !\n", __func__);
+        TPD_DEBUG("%s: Screen OFF...\n", __func__);
+        ret = setScanMode(SCAN_MODE_ACTIVE, 0x00);
+        if (ret < OK) {
+            TPD_INFO("%s error during setting SLEEP_MODE! ERROR %08X\n", __func__, ret);
+        }
+        break;
+
+#ifdef GESTURE_MODE
+    case MODE_GESTURE:
+		gesture_mask[0] = 0xff;
+		gesture_mask[1] = 0xff;
+		gesture_mask[2] = 0xff;
+		gesture_mask[3] = 0xff;
+        TPD_DEBUG("%s: Gesture mode setting...\n", __func__);
+        if (flag) {
+        ret = enableGesture(gesture_mask, GESTURE_MASK_SIZE);
+        if (ret < OK) {
+            TPD_INFO("%s: enableGesture failed! ERROR %08X\n", __func__, ret);
+        }
+			ret = setScanMode(SCAN_MODE_LOW_POWER, 0);
+    		if (ret < OK) {
+        		TPD_INFO("enterGestureMode: enter gesture mode ERROR %08X\n",ret);
+    		}	
+        } else {
+        	gesture_mask[0] = 0;
+			gesture_mask[1] = 0;
+			gesture_mask[2] = 0;
+			gesture_mask[3] = 0x01;
+            ret = disableGesture(gesture_mask, GESTURE_MASK_SIZE);
+            if (ret < OK) {
+                TPD_INFO("%s: disableGesture failed! ERROR %08X\n", __func__, ret);
+            }
+        }
+        break;
+#endif
+
+#ifdef GLOVE_MODE
+    case MODE_GLOVE:
+        TPD_DEBUG("%s: Glove Mode setting...\n", __func__);
+        if (flag) {
+            settings[0] = 1;
+        }
+        ret = setFeatures(FEAT_SEL_GLOVE, settings, 1);
+        if (ret < OK) {
+            TPD_INFO("%s: error during setting GLOVE_MODE! ERROR %08X\n", __func__, ret);
+        }
+        break;
+#endif
+
+#ifdef CHARGER_MODE
+    case MODE_CHARGE:
+        TPD_DEBUG("%s: Charger Mode setting...\n", __func__);
+        if (flag) {
+            settings[0] = 1;
+        }
+        ret = setFeatures(FEAT_SEL_CHARGER, settings, 1);
+        if (ret < OK) {
+            TPD_INFO("%s: error during setting CHARGER_MODE! ERROR %08X\n", __func__, ret);
+        }
+        break;
+#endif
+	    case MODE_TOUCH_HOLD:
+        TPD_DEBUG("%s: enter in touchhold mode !\n", __func__);
+		gesture_mask[0] = 0xff;
+		gesture_mask[1] = 0xff;
+		gesture_mask[2] = 0xff;
+		gesture_mask[3] = 0xff;
+		ret = setFeatures(FEAT_SEL_GESTURE, gesture_mask,GESTURE_MASK_SIZE);
+		if (ret < OK) {
+			TPD_INFO("%s: touchhold switch Faild\n", __func__);
+		}
+        break;
+
+		case MODE_FACE_DETECT:
+			if (flag){
+				if(fts_write(cmd_eare_on, ARRAY_SIZE(cmd_eare_on)) < 0) {
+					TPD_DEBUG("%s: open face detect fail\n");	
+				}
+			} else {
+				if(fts_write(cmd_eare_off, ARRAY_SIZE(cmd_eare_off)) < 0) {
+					TPD_DEBUG("%s: close face detect fail\n");	
+				}
+			}	
+			break;
+		case MODE_FINGERPRINT_TEST:
+			if (flag) {
+				if(fts_write(fingerprint_int_high, ARRAY_SIZE(fingerprint_int_high)) < 0) {
+					TPD_DEBUG("%s: fingerprint int pin pull high fail\n");
+				}
+			}else {
+				if(fts_write(fingerprint_int_low, ARRAY_SIZE(fingerprint_int_low)) < 0) {
+					TPD_DEBUG("%s: fingerprint int pin pull down fail\n");
+				}
+			}
+    default:
+        TPD_DEBUG("%s: unsupport mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+/* fts get key info func */
+#ifdef PHONE_KEY
+static u8 fts_get_keycode(void *chip_data)
+{
+    struct fts_ts_info *info = (struct fts_ts_info *)chip_data;
+    int count = 0, i = 0;
+    unsigned char data[FIFO_EVENT_SIZE] = { 0 };
+    u8 bitmap_result = 0;
+
+    for (count = 0; count < FIFO_DEPTH && info->data[count][0] != EVT_ID_NOEVENT; count++) {
+        for (i = 0; i < FIFO_EVENT_SIZE; i++) {
+            data[i] = info->data[count][i];/* read data from the buf save in fts_trigger_reason fun */
+        }
+        if (data[0] == EVT_ID_USER_REPORT && data[1] == EVT_TYPE_USER_KEY) {/* classify the different key code */
+            if ((data[2] & FTS_KEY_0) == 0 && (info->key_mask & FTS_KEY_0) > 0) {
+                SET_BIT(bitmap_result, BIT_HOME);
+                TPD_DEBUG("%s: Button HOME pressed and released!\n", __func__);
+            }
+
+            if ((data[2] & FTS_KEY_1) == 0 && (info->key_mask & FTS_KEY_1) > 0) {
+                SET_BIT(bitmap_result, BIT_BACK);
+                TPD_DEBUG("%s: Button Back pressed and released!\n", __func__);
+            }
+
+            if ((data[2] & FTS_KEY_2) == 0 && (info->key_mask & FTS_KEY_2) > 0) {
+                SET_BIT(bitmap_result, BIT_MENU);
+                TPD_DEBUG("%s: Button Menu pressed!\n", __func__);
+            }
+            info->key_mask = data[2];/* store the last key code */
+        } else {
+            TPD_INFO("%s: Invalid event passed as argument!\n", __func__);
+        }
+    }
+    return bitmap_result;
+}
+#endif
+
+/* fts get gesture info func */
+#ifdef GESTURE_MODE
+static int fts_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    struct fts_ts_info *info = (struct fts_ts_info *)chip_data;
+    int count = 0, i = 0;
+    unsigned char data[FIFO_EVENT_SIZE] = { 0 };
+
+    for (count = 0; count < FIFO_DEPTH && info->data[count][0] != EVT_ID_NOEVENT; count++) {
+        for (i = 0; i < FIFO_EVENT_SIZE; i++) {
+            data[i] = info->data[count][i];/* read data from the buf save in fts_trigger_reason fun */
+        }
+        if (data[0] == EVT_ID_USER_REPORT && data[1] == EVT_TYPE_USER_GESTURE) {/* comfirm the trigger event is gesture */
+            switch (data[2]) { /* classify the different gesture event */
+            case GEST_ID_DBLTAP:
+                gesture->gesture_type = DouTap;
+                TPD_DEBUG("%s: double tap !\n", __func__);
+                break;
+
+            case GEST_ID_O:
+                gesture->gesture_type = Circle;
+                TPD_DEBUG("%s: O !\n", __func__);
+                break;
+
+            case GEST_ID_RIGHT_1F:
+                gesture->gesture_type = Left2RightSwip;
+                TPD_DEBUG("%s:  -> !\n", __func__);
+                break;
+
+            case GEST_ID_LEFT_1F:
+                gesture->gesture_type = Right2LeftSwip;
+                TPD_DEBUG("%s:  <- !\n", __func__);
+                break;
+
+            case GEST_ID_UP_1F:
+                gesture->gesture_type = Down2UpSwip;
+                TPD_DEBUG("%s:  UP !\n", __func__);
+                break;
+
+            case GEST_ID_DOWN_1F:
+                gesture->gesture_type = Up2DownSwip;
+                TPD_DEBUG("%s:  DOWN !\n", __func__);
+                break;
+
+            case GEST_ID_CARET:
+                gesture->gesture_type = DownVee;
+                TPD_DEBUG("%s:  ^ !\n", __func__);
+                break;
+
+            case GEST_ID_LEFTBRACE:
+                gesture->gesture_type = RightVee;
+                TPD_DEBUG("%s:  < !\n", __func__);
+                break;
+
+            case GEST_ID_RIGHTBRACE:
+                gesture->gesture_type = LeftVee;
+                TPD_DEBUG("%s:  > !\n", __func__);
+                break;
+
+            case GEST_ID_M:
+                gesture->gesture_type = Mgestrue;
+                TPD_DEBUG("%s: M !\n", __func__);
+                break;
+
+            case GEST_ID_W:
+                gesture->gesture_type = Wgestrue;
+                TPD_DEBUG("%s:  W !\n", __func__);
+                break;
+
+            case GEST_ID_V:
+                gesture->gesture_type = UpVee;
+                TPD_DEBUG("%s:  V !\n", __func__);
+                break;
+
+			case GEST_ID_S:
+				gesture->gesture_type = Sgestrue;
+                TPD_DEBUG("%s:  S !\n", __func__);
+				break;
+
+			case GEST_ID_SINGLE:
+				gesture->gesture_type = SingleTap;
+                TPD_DEBUG("%s:  single !\n", __func__);
+				break;
+
+			case GEST_ID_DOU_DOWN:
+				gesture->gesture_type = DouSwip;
+                TPD_DEBUG("%s:  || !\n", __func__);
+				break;
+
+            default:
+                gesture->gesture_type = UnkownGesture;
+                TPD_DEBUG("%s:  No valid GestureID!\n", __func__);
+            }
+        }
+    }
+
+    return 0;
+}
+#endif
+
+/* fts get touch ponit func */
+static int fts_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    struct fts_ts_info *info = (struct fts_ts_info *)chip_data;
+    int count = 0, i = 0;
+    unsigned char data[FIFO_EVENT_SIZE] = { 0 };
+    int obj_attention = 0;
+    unsigned char eventId;
+    int touchId;
+    u8 touchType;
+
+    for (count = 0; count < FIFO_DEPTH && info->data[count][0] != EVT_ID_NOEVENT; count++) {
+        if ((info->data[count][0] & 0xF0) != (EVT_ID_ENTER_POINT & 0xF0)
+            && (info->data[count][0] & 0xF0) != (EVT_ID_MOTION_POINT & 0xF0)
+           /* && (info->data[count][0] & 0xF0) != (EVT_ID_LEAVE_POINT & 0xF0)*/) {
+            continue;
+        }
+        /* read data from the buf save in fts_trigger_reason func */
+        for (i = 0; i < FIFO_EVENT_SIZE; i++) {
+            data[i] = info->data[count][i];
+        }
+        TPD_DETAIL("%s event get = %02X %02X %02X %02X %02X %02X %02X %02X\n",__func__, data[0],
+            data[1], data[2], data[3], data[4], data[5], data[6], data[7]);
+        eventId = data[0];
+        touchId = (int)((data[1] & 0xF0) >> 4);
+        touchType = data[1] & 0x0F;
+
+        if (touchId >= max_num)/* only suppurt max_num fingers */
+            continue;
+
+        if ((eventId == EVT_ID_ENTER_POINT) || ((eventId & 0xF0)==(EVT_ID_MOTION_POINT & 0xF0))) {/* touch down event */
+            obj_attention |= (0x0001 << touchId);/* setting touch down flag */
+        }
+        points[touchId].x = (((int)data[3] & 0x0F) << 8) | (data[2]);/* filling the point_info struct */
+        points[touchId].y = ((int)data[4] << 4) | ((data[3] & 0xF0) >> 4);
+        points[touchId].status = 1;
+
+        switch (touchType) {
+        case TOUCH_TYPE_FINGER:
+            /* TPD_DEBUG(" %s : It is a finger!\n",__func__); */
+        case TOUCH_TYPE_GLOVE:
+            /* TPD_DEBUG(" %s : It is a glove!\n",__func__); */
+        case TOUCH_TYPE_PALM:
+            /* TPD_DEBUG(" %s : It is a palm!\n",__func__); */
+            points[touchId].z = 0;
+            break;
+
+        case TOUCH_TYPE_HOVER:
+            //points[touchId].z = 0;    /* no pressure */
+            break;
+
+        case TOUCH_TYPE_INVALID:
+            points[touchId].status = 0;
+            break;
+
+        default:
+            break;
+        }
+
+        points[touchId].touch_major = ((((int)data[0]&0x0C) << 2) | (((int)data[6]&0xF0) >> 4));
+        points[touchId].width_major = 30;
+
+    }
+
+    return obj_attention;
+}
+
+/**
+  * Event handler for status events (EVT_ID_STATUS_UPDATE)
+  * Handle status update events
+  */
+static void fts_status_event_handler(struct fts_ts_info *info, unsigned char *event)
+{
+    switch (event[1]) {
+    case EVT_TYPE_STATUS_ECHO:
+        TPD_INFO("%s :Echo event of command = %02X %02X %02X %02X %02X %02X\n",
+             __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        break;
+
+    case EVT_TYPE_STATUS_FORCE_CAL:
+        switch (event[2]) {
+        case 0x00:
+            TPD_INFO("%s :Continuous frame drop Force cal = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x01:
+            TPD_INFO("%s :Mutual negative detect Force cal = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x02:
+            TPD_INFO("%s :Mutual calib deviation Force cal = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x11:
+            TPD_INFO("%s :SS negative detect Force cal = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x12:
+            TPD_INFO("%s :SS negative detect Force cal in Low Power mode = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x13:
+            TPD_INFO("%s :SS negative detect Force cal in Idle mode = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x20:
+            TPD_INFO("%s :SS invalid Mutual Strength soft Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x21:
+            TPD_INFO("%s :SS invalid Self Strength soft Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x22:
+            TPD_INFO("%s :SS invalid Self Island soft Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x30:
+            TPD_INFO("%s :MS invalid Mutual Strength soft Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x31:
+            TPD_INFO("%s :MS invalid Self Strength soft Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        default:
+            TPD_INFO("%s :Force cal = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        }
+        break;
+
+    case EVT_TYPE_STATUS_FRAME_DROP:
+        switch (event[2]) {
+        case 0x01:
+            TPD_INFO("%s :Frame drop noisy frame = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x02:
+            TPD_INFO("%s :Frame drop bad R = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        case 0x03:
+            TPD_INFO("%s :Frame drop invalid processing state = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+            break;
+
+        default:
+            TPD_INFO("%s :Frame drop = %02X %02X %02X %02X %02X %02X\n",
+                __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        }
+        break;
+
+    case EVT_TYPE_STATUS_SS_RAW_SAT:
+        if (event[2] == 1)
+            TPD_INFO("%s :SS Raw Saturated = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        else
+            TPD_INFO("%s :SS Raw No more Saturated = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        break;
+
+    case EVT_TYPE_STATUS_WATER:
+        if (event[2] == 1)
+            TPD_INFO("%s :Enter Water mode = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        else
+            TPD_INFO("%s :Exit Water mode = %02X %02X %02X %02X %02X %02X\n",
+                 __func__, event[2], event[3], event[4], event[5], event[6], event[7]);
+        break;
+
+    default:
+        TPD_INFO("%s :Received unhandled status event = %02X %02X %02X %02X %02X %02X %02X %02X\n",
+             __func__, event[0], event[1], event[2], event[3], event[4], event[5], event[6], event[7]);
+        break;
+    }
+}
+
+/* fts event trigger reason func */
+static u8 fts_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+	struct fts_ts_info *info = (struct fts_ts_info *)chip_data;
+	int error = 0, count = 0, i = 0;
+	unsigned char regAdd;
+	unsigned char data[FIFO_EVENT_SIZE * FIFO_DEPTH] = { 0 };
+	unsigned char eventId;
+	u8 result = IRQ_IGNORE;
+	const unsigned char EVENTS_REMAINING_POS = 7;
+	const unsigned char EVENTS_REMAINING_MASK = 0x1F;
+	unsigned char events_remaining = 0;
+	int offset =0;
+
+	/* read the FIFO and parsing events */
+	regAdd = FIFO_CMD_READONE;
+
+	memset(info->data, 0, sizeof(info->data));
+
+	/* Read the first FIFO event and the number of events remaining */
+	error = fts_writeReadU8UX(regAdd, 0, 0, data, FIFO_EVENT_SIZE,DUMMY_FIFO);
+	events_remaining = data[EVENTS_REMAINING_POS] & EVENTS_REMAINING_MASK;
+	events_remaining = (events_remaining > FIFO_DEPTH - 1) ? FIFO_DEPTH - 1 : events_remaining;
+
+	/* Drain the rest of the FIFO, up to 31 events */
+	if (error == OK && events_remaining > 0) {
+		error = fts_writeReadU8UX(regAdd, 0, 0, &data[FIFO_EVENT_SIZE],FIFO_EVENT_SIZE * events_remaining,DUMMY_FIFO);
+	}
+
+	if (error != OK) {
+		TPD_INFO("Error (%08X) while reading from FIFO in fts_event_handler\n", error);
+	} else {
+		for (count = 0; count < events_remaining + 1; count++) {
+			offset = count* FIFO_EVENT_SIZE;
+			if(data[offset] != EVT_ID_NOEVENT){
+				eventId = data[offset];/* eventId is the main event trigger reason */
+				for (i = 0; i < FIFO_EVENT_SIZE; i++) {
+					info->data[count][i] = data[i+offset];/* store the event data */
+				}
+				TPD_DEBUG("%s event get = %02X %02X %02X %02X %02X %02X %02X %02X\n",__func__, data[0+offset],
+					data[1+offset], data[2+offset], data[3+offset], data[4+offset], data[5+offset], data[6+offset], data[7+offset]);
+			}else{
+				TPD_INFO("%s:data is null,continue\n",__func__);
+				continue;
+			}
+			TPD_DEBUG("eventId = %x,data[offset] = %x, gesture_enable = %d, is_suspended = %d\n", eventId, data[offset], gesture_enable, is_suspended);
+			if ((eventId & 0xF0) <= (EVT_ID_ERROR & 0xF0)) {
+				if ((eventId & 0xF0) == (EVT_ID_ENTER_POINT & 0xF0) || (eventId & 0xF0) == (EVT_ID_MOTION_POINT & 0xF0) 
+					|| (eventId & 0xF0) == (EVT_ID_LEAVE_POINT & 0xF0)) {/* touch event */
+					SET_BIT(result, IRQ_TOUCH);
+				} else if ((eventId & 0xF0) == (EVT_ID_USER_REPORT & 0xF0)) {
+					if(data[offset+1] == EVT_TYPE_USER_GESTURE && gesture_enable && is_suspended) {/* gesture event */
+#ifdef GESTURE_MODE
+						SET_BIT(result, IRQ_GESTURE);
+#endif
+					} else if (data[offset] == EVT_TYPE_USER_KEY) {/* key event */
+#ifdef PHONE_KEY
+						SET_BIT(result, IRQ_BTN_KEY);
+#endif
+					}
+				} else if ((eventId & 0xF0) == (EVT_ID_ERROR & 0xF0)) {
+					if (data[offset+1] == EVT_TYPE_ERROR_HARD_FAULT || data[offset+1] == EVT_TYPE_ERROR_WATCHDOG) {/* other unexcept event */
+						dumpErrorInfo(NULL, 0);
+						SET_BIT(result, IRQ_EXCEPTION);
+					} else if (data[offset+1] == EVT_TYPE_ERROR_ESD) {
+						SET_BIT(result, IRQ_EXCEPTION);
+						error = fts_esd_handle(info);
+						if (error < 0) {
+							TPD_INFO("%s: esd handle fail !", __func__);
+						}
+					}
+				} else if ((eventId & 0xF0) == (EVT_ID_STATUS_UPDATE & 0xF0)) {
+					fts_status_event_handler(info, &data[offset]);
+					if (data[offset +1] == 0x05) {
+						SET_BIT(result, IRQ_FACE_STATE);
+						if(data[offset +2] == 0x42) {
+							info->proximity_status = 1; //near
+						} else if (data[offset +2] ==0x44) {
+							info->proximity_status = 0; //far
+						}
+					}
+					 
+				}
+			}
+		}
+	}
+	
+	return result;
+
+}
+
+/* fts system reset func */
+static int fts_reset(void *chip_data)
+{
+    return fts_system_reset();
+}
+
+/* fts resetgpio setting func */
+static int fts_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_DEBUG("%s: Set the reset_gpio \n", __func__);
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+    else {
+        return -1;
+    }
+
+    return 0;
+}
+
+/* fts power control func */
+static int fts_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        msleep(5);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        msleep(15);
+        fts_resetgpio_set(chip_info->hw_res, true);
+        msleep(50);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        msleep(5);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        msleep(10);
+        fts_resetgpio_set(chip_info->hw_res, false);
+    }
+
+    return ret;
+}
+
+/* fts get chip relate info and init the chip func */
+static int fts_get_chip_info(void *chip_data)
+{
+    struct fts_ts_info *chip_info = (struct fts_ts_info *)chip_data;
+    int error = 0;
+
+    /* init the core lib */
+    TPD_INFO("%s: Init Core Lib:\n", __func__);
+    initCore(chip_info->client, chip_info->hw_res->reset_gpio);
+
+    /* init the fts relate func */
+    TPD_INFO("%s: Init fts fun:\n", __func__);
+    error = fts_init(chip_info);
+    if (error < OK) {
+        TPD_INFO("%s: Cannot initialize the device ERROR %08X\n", __func__, error);
+        return -1;
+    }
+
+    return 0;
+}
+
+/* fts get vendor relate info func */
+static int fts_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+	int len = 0;
+    char manu_temp[MAX_DEVICE_MANU_LENGTH] = "ST_";
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+
+    /* get limit data path */
+	len = strlen(panel_data->test_limit_name);
+	if ((len > 3) && (panel_data->test_limit_name[len-3] == 'i') && \
+        (panel_data->test_limit_name[len-2] == 'm') && (panel_data->test_limit_name[len-1] == 'g')) {
+        panel_data->test_limit_name[len-3] = 'c';
+        panel_data->test_limit_name[len-2] = 's';
+        panel_data->test_limit_name[len-1] = 'v';
+    }
+	chip_info->test_limit_name = panel_data->test_limit_name;
+
+    /* get fw path */
+    chip_info->fw_name = panel_data->fw_name;
+
+    /* get panel manufacture */
+    chip_info->tp_type = panel_data->tp_type;
+    strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+    strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+    TPD_DEBUG("%s: chip_info->tp_type = %d, chip_info->test_limit_name = %s, chip_info->fw_name = %s\n", __func__, chip_info->tp_type, chip_info->test_limit_name, chip_info->fw_name);
+    return 0;
+}
+
+/* firmware update check func */
+static fw_check_state fts_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    int ret;
+    int crc_status = 0;
+
+    TPD_INFO("%s: Fw Check is starting...\n", __func__);
+
+    /* check CRC status */
+    ret = fts_crc_check();
+    if (ret > OK) {
+        TPD_INFO("%s: CRC Error or NO FW!\n", __func__);
+        crc_status = ret;
+    } else {
+        crc_status = 0;
+        TPD_INFO("%s: NO CRC Error or Impossible to read CRC register!\n", __func__);
+    }
+    if(crc_status != 0) {
+        return FW_ABNORMAL;
+    }
+    /*fw check normal need update TP_FW  && device info*/
+    panel_data->TP_FW = systemInfo.u16_fwVer;
+    if (panel_data->manufacture_info.version) {
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+    }
+
+    return FW_NORMAL;
+}
+
+/* fts flash procedure fun */
+static int fts_flashProcedure(const struct firmware *raw_fw, bool force, int keep_cx)
+{
+    int res;
+    int data_size;
+    Firmware fw;
+    u8 *data;
+
+    /* init the fw struct */
+    fw.data = NULL;
+    data_size = raw_fw->size;
+    data = (u8 *)kzalloc( data_size * sizeof(u8), GFP_KERNEL);
+    memcpy(data, (u8 *)raw_fw->data, data_size);
+
+    /* parse the fw data */
+    res = parseBinFile(data, data_size, &fw, keep_cx);
+    if (res < OK) {
+        TPD_INFO("%s: readFwFile: impossible parse ERROR %08X\n", __func__, ERROR_MEMH_READ);
+        res |= ERROR_MEMH_READ;
+        goto updateFw_fail;
+    }
+    TPD_DEBUG("%s: Fw file parse COMPLETED!\n", __func__);
+
+    /* burn the fw data */
+    TPD_DEBUG("%s: Starting flashing procedure...\n", __func__);
+    res = flash_burn(fw, force, keep_cx);
+    if (res < OK && res != (ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED)) {
+        TPD_INFO("%s: flashProcedure: ERROR %08X\n", __func__, ERROR_FLASH_PROCEDURE);
+        res |= ERROR_FLASH_PROCEDURE;
+        goto updateFw_fail;
+    }
+    TPD_DEBUG("%s: flashing procedure Finished!\n", __func__);
+
+updateFw_fail:
+    if (fw.data != NULL)
+        kfree(fw.data);
+
+    return res;
+}
+
+/* fts firmware update func */
+static fw_update_state fts_fw_update(void *chip_data, const struct firmware *raw_fw, bool force)
+	{
+	
+		u8 error_to_search[4] = { EVT_TYPE_ERROR_CRC_CX_HEAD,
+					  EVT_TYPE_ERROR_CRC_CX,
+					  EVT_TYPE_ERROR_CRC_CX_SUB_HEAD,
+					  EVT_TYPE_ERROR_CRC_CX_SUB };
+		int retval = 0;
+		int retval1 = 0;
+		int ret;
+		int error = 0;
+		int init_type = NO_INIT;
+		int crc_status = 0;
+		struct fts_ts_info *info = (struct fts_ts_info*)chip_data;
+	
+#if defined(PRE_SAVED_METHOD) || defined (COMPUTE_INIT_METHOD)
+    int keep_cx = 1;
+#else
+    int keep_cx = 0;
+#endif
+
+    /* Procedure the fw using retry method */
+	TPD_INFO( "%s Fw Auto Update is starting...\n", __func__);
+
+	/* check CRC status */
+	ret = fts_crc_check();
+	if (ret > OK) {
+		TPD_INFO("%s: CRC Error or NO FW!\n", __func__);
+		crc_status = ret;
+	} else {
+		crc_status = 0;
+		TPD_INFO("%s: NO CRC Error or Impossible to read CRC register!\n", __func__);
+		if(force == 1)
+			crc_status = 1;
+	}
+
+    /* Procedure the fw using retry method */
+    retval = fts_flashProcedure(raw_fw, crc_status, keep_cx);
+    if ((retval & 0xFF000000) == ERROR_FLASH_PROCEDURE) {
+        TPD_INFO("%s: firmware update failed and retry! ERROR %08X\n", __func__, retval);
+        fts_chip_powercycle(info);    /* power reset */
+        retval1 = fts_flashProcedure(raw_fw, crc_status, keep_cx);
+        if ((retval1 & 0xFF000000) == ERROR_FLASH_PROCEDURE) {
+            TPD_INFO("%s: firmware update failed again!  ERROR %08X\n", __func__, retval1);
+            TPD_INFO("%s: Fw Auto Update Failed!\n", __func__);
+            //return FW_UPDATE_ERROR;
+        }
+    } else if (retval == (ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED)) {
+        //return FW_NO_NEED_UPDATE;
+    }
+
+    TPD_INFO( "%s: Verifying if CX CRC Error...\n", __func__);
+    ret = fts_system_reset();
+    if (ret >= OK) {
+        ret = pollForErrorType(error_to_search, 4);
+        if (ret < OK) {
+            TPD_INFO("%s: No Cx CRC Error Found!\n", __func__);
+            TPD_INFO("%s: Verifying if Panel CRC Error...\n", __func__);
+            error_to_search[0] = EVT_TYPE_ERROR_CRC_PANEL_HEAD;
+            error_to_search[1] = EVT_TYPE_ERROR_CRC_PANEL;
+            ret = pollForErrorType(error_to_search, 2);
+            if (ret < OK) {
+                TPD_INFO("%s: No Panel CRC Error Found!\n", __func__);
+                init_type = NO_INIT;
+            } else {
+                TPD_INFO("%s: Panel CRC Error FOUND! CRC ERROR = %02X\n", __func__, ret);
+                init_type = SPECIAL_PANEL_INIT;
+            }
+        } else {
+            TPD_INFO("%s: Cx CRC Error FOUND! CRC ERROR = %02X\n", __func__, ret);
+            /* this path of the code is used only in case there is a
+             * CRC error in code or config which not allow the fw to
+             * compute the CRC in the CX before */
+            /* the only way to recover is to have CX in fw file...
+             * */
+#ifndef COMPUTE_INIT_METHOD
+				TPD_INFO( "%s: Try to recovery with CX in fw file...\n", __func__);
+				fts_flashProcedure(raw_fw, CRC_CX, 0);
+				TPD_INFO("%s: Refresh panel init data...\n", __func__);
+#else
+				TPD_INFO("%s: Select Full Panel Init...\n", __func__);
+				init_type = SPECIAL_FULL_PANEL_INIT;
+#endif
+			}
+		} else
+			TPD_INFO("%s: Error while executing system reset! ERROR %08X\n", __func__, ret);	/* better skip initialization because the real state is unknown */
+	
+		if (init_type == NO_INIT) {
+#if defined(PRE_SAVED_METHOD) || defined(COMPUTE_INIT_METHOD)
+			if ((systemInfo.u8_cfgAfeVer != systemInfo.u8_cxAfeVer)
+#ifdef COMPUTE_INIT_METHOD
+				|| ((systemInfo.u8_mpFlag != MP_FLAG_BOOT) && (systemInfo.u8_mpFlag != MP_FLAG_FACTORY))
+#endif
+				) {
+				init_type = SPECIAL_FULL_PANEL_INIT;
+				TPD_DEBUG("%s: Different CX AFE Ver: %02X != %02X or invalid MpFlag = %02X... Execute FULL Panel Init!\n", __func__, systemInfo.u8_cfgAfeVer,
+					 systemInfo.u8_cxAfeVer, systemInfo.u8_mpFlag);
+			} else
+#endif
+			if (systemInfo.u8_cfgAfeVer != systemInfo.u8_panelCfgAfeVer) {
+				init_type = SPECIAL_PANEL_INIT;
+				TPD_DEBUG("%s: Different Panel AFE Ver: %02X != %02X... Execute Panel Init!\n", __func__, systemInfo.u8_cfgAfeVer,
+					 systemInfo.u8_panelCfgAfeVer);
+			} else
+				init_type = NO_INIT;
+		}
+	
+		if (init_type != NO_INIT) {    /* initialization status not correct or after FW complete update, do initialization. */
+			error = fts_chip_initialization(info, init_type);
+			if (error < OK) {
+				TPD_INFO("%s: Cannot initialize the chip ERROR %08X\n", __func__, error);
+			}
+		}
+		
+		if (retval == (ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED)){
+			TPD_INFO("%s: no need fW update  ERROR %08X\n", __func__, retval1);
+			return FW_NO_NEED_UPDATE;
+		} 
+		if (((retval1 & 0xFF000000) == ERROR_FLASH_PROCEDURE) || (error < OK)) {
+	
+			TPD_INFO("%s: Fw Auto Update Failed!\n", __func__);
+			return FW_UPDATE_ERROR;
+		}
+	
+		return FW_UPDATE_SUCCESS;
+	}
+
+
+
+/* fts esd handle func */
+static int fts_esd_handle(void *chip_data)
+{
+    struct fts_ts_info *info = (struct fts_ts_info*)chip_data;
+    int error = 0;
+
+    disable_irq_nosync(info->client->irq);
+
+    fts_chip_powercycle(info);
+
+    error = fts_system_reset();
+    if (error < OK) {
+        TPD_INFO("%s: Cannot restore the device ERROR %08X\n", __func__, error);
+        return error;
+    }
+
+    enable_irq(info->client->irq);
+
+    return 0;
+}
+
+static int fts_get_face_detect(void * chip_data)
+{
+    int state = -1;
+    struct fts_ts_info *chip_info = (struct fts_ts_info *)chip_data;
+
+	if (chip_info->proximity_status == 0) {
+		state = 0;		//far
+	} else if (chip_info->proximity_status == 1) {
+		state = 1;		//near
+	}
+    return state;
+}
+
+/* fts callback func file ops */
+static struct oppo_touchpanel_operations fts_ops = {
+    .get_vendor       = fts_get_vendor,
+    .get_chip_info    = fts_get_chip_info,
+    .reset            = fts_reset,
+    .power_control    = fts_power_control,
+    .fw_check         = fts_fw_check,
+    .fw_update        = fts_fw_update,
+    .trigger_reason   = fts_trigger_reason,
+    .get_touch_points = fts_get_touch_points,
+#ifdef GESTURE_MODE
+    .get_gesture_info = fts_get_gesture_info,
+#endif
+    .mode_switch      = fts_mode_switch,
+#ifdef PHONE_KEY
+    .get_keycode      = fts_get_keycode,
+#endif
+    .get_usb_state    = st_get_usb_state,
+    .get_face_state	  = fts_get_face_detect,
+};
+
+
+static void fts_reserve_read(struct seq_file *s, void *chip_data)
+{
+    return;
+}
+
+/* fts delta data read func */
+static void fts_delta_read(struct seq_file *s, void *chip_data)
+{
+    int x = 0, y = 0, z = 0;
+    int res = 0;
+    int16_t temp_delta = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+    MutualSenseFrame frameMS;
+
+    if (!chip_info)
+        return;
+
+    /* lock the mode to avoid IC enter idle mode */
+    setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    flushFIFO();    /* delete the events related to some
+                     * touch (allow to call this function
+                     * while touching the screen without
+                     * having a flooding of the FIFO) */
+
+    /* get delta data */
+    res = getMSFrame3(MS_STRENGTH, &frameMS);
+    if (res < 0) {
+        TPD_INFO("%s: Error while taking the MS_STRENGTH frame... ERROR %08X\n", __func__, res);
+        seq_printf(s, "getMSFrame3 error!\n");
+        goto error;
+    }
+
+    /* check the Tx and Rx num */
+    if (chip_info->hw_res->TX_NUM != frameMS.header.force_node || chip_info->hw_res->RX_NUM != frameMS.header.sense_node) {
+        seq_printf(s, "Tx Rx is not match !\n");
+        goto error;
+    }
+
+    /* print the data */
+    for (x = 0; x < frameMS.header.force_node; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < frameMS.header.sense_node; y++) {
+            z = frameMS.header.sense_node * x + y;
+            temp_delta = frameMS.node_data[z];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+error:
+    setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+
+    if (frameMS.node_data != NULL)
+        kfree(frameMS.node_data);
+}
+
+/* fts baseline data read func */
+static void fts_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    int res = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+    MutualSenseFrame frameMS;
+
+    if (!chip_info)
+        return;
+
+    /* lock the mode to avoid IC enter idle mode */
+    setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    flushFIFO();    /* delete the events related to some
+                     * touch (allow to call this function
+                     * while touching the screen without
+                     * having a flooding of the FIFO) */
+
+    /* get baseline data */
+    res = getMSFrame3(MS_RAW, &frameMS);
+    if (res < 0) {
+        TPD_INFO("%s: Error while taking the MS_RAW frame... ERROR %08X\n", __func__, res);
+        seq_printf(s, "getMSFrame3 error!\n");
+        goto error;
+    }
+
+    /* check the Tx and Rx num */
+    if (chip_info->hw_res->TX_NUM != frameMS.header.force_node || chip_info->hw_res->RX_NUM != frameMS.header.sense_node) {
+        seq_printf(s, "Tx Rx is not match !\n");
+        goto error;
+    }
+
+    /* print the data */
+    for (x = 0; x < frameMS.header.force_node; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < frameMS.header.sense_node; y++) {
+            z = frameMS.header.sense_node * x + y;
+            temp_delta = frameMS.node_data[z];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+error:
+    setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+
+    if (frameMS.node_data != NULL)
+        kfree(frameMS.node_data);
+}
+
+/* fts self_delta data read func */
+static void fts_self_delta_read(struct seq_file *s, void *chip_data)
+{
+    int x = 0;
+    int res = 0;
+    int16_t temp_delta = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+    SelfSenseFrame frameSS;
+
+    if (!chip_info)
+        return;
+
+    /* lock the mode to avoid IC enter idle mode */
+    setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    flushFIFO();    /* delete the events related to some
+                     * touch (allow to call this function
+                     * while touching the screen without
+                     * having a flooding of the FIFO) */
+
+    /* get self_delta data */
+    res = getSSFrame3(SS_STRENGTH, &frameSS);
+    if (res < 0) {
+        TPD_INFO("%s: Error while taking the SS_STRENGTH frame... ERROR %08X\n", __func__, res);
+        seq_printf(s, "getSSFrame3 error!\n");
+        goto error;
+    }
+
+    /* check the Tx and Rx num */
+    if (chip_info->hw_res->TX_NUM != frameSS.header.force_node || chip_info->hw_res->RX_NUM != frameSS.header.sense_node) {
+        seq_printf(s, "Tx Rx is not match !\n");
+        goto error;
+    }
+
+    /* print the data */
+    seq_printf(s, "\n[force_data]");
+    for (x = 0; x < frameSS.header.force_node; x++) {
+        seq_printf(s, "\n[%d]", x);
+        temp_delta = frameSS.force_data[x];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+
+    seq_printf(s, "\n[sense_data]");
+    for (x = 0; x < frameSS.header.sense_node; x++) {
+        temp_delta = frameSS.sense_data[x];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+    seq_printf(s, "\n");
+
+error:
+    setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+
+    if (frameSS.sense_data != NULL)
+        kfree(frameSS.sense_data);
+    if (frameSS.force_data != NULL)
+        kfree(frameSS.force_data);
+}
+
+/* fts self_raw data read func */
+static void fts_self_raw_read(struct seq_file *s, void *chip_data)
+{
+    int x = 0;
+    int16_t temp_delta = 0;
+    int res = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+    SelfSenseFrame frameSS;
+
+    if (!chip_info)
+        return;
+
+    /* lock the mode to avoid IC enter idle mode */
+    setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    flushFIFO();    /* delete the events related to some
+                     * touch (allow to call this function
+                     * while touching the screen without
+                     * having a flooding of the FIFO) */
+
+    /* get self_raw data */
+    res = getSSFrame3(SS_RAW, &frameSS);
+    if (res < 0) {
+        TPD_INFO("%s: Error while taking the SS_RAW frame... ERROR %08X\n", __func__, res);
+        seq_printf(s, "getSSFrame3 error!\n");
+        goto error;
+    }
+
+    /* check the Tx and Rx num */
+    if (chip_info->hw_res->TX_NUM != frameSS.header.force_node || chip_info->hw_res->RX_NUM != frameSS.header.sense_node) {
+        seq_printf(s, "Tx Rx is not match !\n");
+        goto error;
+    }
+
+    /* print the data */
+    seq_printf(s, "\n[force_data]");
+    for (x = 0; x < frameSS.header.force_node; x++) {
+        seq_printf(s, "\n[%d]", x);
+        temp_delta = frameSS.force_data[x];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+
+    seq_printf(s, "\n[sense_data]");
+    for (x = 0; x < frameSS.header.sense_node; x++) {
+        temp_delta = frameSS.sense_data[x];
+        seq_printf(s, "%4d, ", temp_delta);
+    }
+    seq_printf(s, "\n");
+
+error:
+    setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+
+    if (frameSS.sense_data != NULL)
+        kfree(frameSS.sense_data);
+    if (frameSS.force_data != NULL)
+        kfree(frameSS.force_data);
+}
+
+/* fts baseline_blackscreen read func */
+static void fts_baseline_blackscreen_read(struct seq_file *s, void *chip_data)
+{
+    int x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    int res = 0;
+    struct fts_ts_info *chip_info = (struct fts_ts_info*)chip_data;
+    MutualSenseFrame frameMS;
+
+    if (!chip_info)
+        return;
+
+    /* lock the mode to avoid IC enter idle mode */
+    setScanMode(SCAN_MODE_LOCKED, LOCKED_LP_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    flushFIFO();    /* delete the events related to some
+                     * touch (allow to call this function
+                     * while touching the screen without
+                     * having a flooding of the FIFO) */
+
+    /* get baseline_blackscreen data */
+    res = getMSFrame3(MS_RAW, &frameMS);
+    if (res < 0) {
+        TPD_INFO("%s: Error while taking the MS_RAW frame... ERROR %08X\n", __func__, res);
+        seq_printf(s, "getMSFrame3 error!\n");
+        goto error;
+    }
+
+    /* check the Tx and Rx num */
+    if (chip_info->hw_res->TX_NUM != frameMS.header.force_node || chip_info->hw_res->RX_NUM != frameMS.header.sense_node) {
+        seq_printf(s, "Tx Rx is not match !\n");
+        goto error;
+    }
+
+    /* print the data */
+    for (x = 0; x < frameMS.header.force_node; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < frameMS.header.sense_node; y++) {
+            z = frameMS.header.sense_node * x + y;
+            temp_delta = frameMS.node_data[z];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+error:
+    setScanMode(SCAN_MODE_LOW_POWER, 0xFF);
+
+    if (frameMS.node_data != NULL)
+        kfree(frameMS.node_data);
+}
+
+/* fts main register read func */
+static void fts_main_register_read(struct seq_file *s, void *chip_data)
+{
+    struct fts_ts_info *chip_info = (struct fts_ts_info *)chip_data;
+    char temp[256] = { 0 };
+
+    if (!chip_info)
+        return ;
+    TPD_INFO("%s start\n", __func__);
+    /*disable irq when read data from IC*/
+    seq_printf(s, "====================================================\n");
+    seq_printf(s, "FW VER = %04X\n", systemInfo.u16_fwVer);
+    seq_printf(s, "%s\n", printHex("Release Info =  ", systemInfo.u8_releaseInfo, RELEASE_INFO_SIZE, temp));
+    seq_printf(s, "====================================================\n");
+}
+
+/* fts debug node file ops */
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .delta_read         = fts_delta_read,
+    .baseline_read      = fts_baseline_read,
+    .self_delta_read    = fts_self_delta_read,
+    .self_raw_read      = fts_self_raw_read,
+    .baseline_blackscreen_read  = fts_baseline_blackscreen_read,
+    .main_register_read = fts_main_register_read,
+    .reserve_read       = fts_reserve_read,
+};
+
+/* fts full panel auto test func */
+static void fts_auto_test(struct seq_file *s, void *chip_data, char *path_limits)
+{
+    int res = 0;
+    int init_type = NO_INIT;
+    int temp = 0, error_num = 0, i = 0;
+
+#ifndef COMPUTE_INIT_METHOD
+    if (systemInfo.u8_cfgAfeVer != systemInfo.u8_cxAfeVer) {
+        res = ERROR_OP_NOT_ALLOW;
+        TPD_DEBUG("%s: Miss match in CX version! MP test not allowed with wrong CX memory! ERROR %08X\n", __func__, res);
+        error_num = 1;
+        seq_printf(s, "%d error(s). %s\n", error_num, error_num?"":"All test passed.");
+    }
+#else
+    if (systemInfo.u8_mpFlag != MP_FLAG_FACTORY) {
+        init_type = SPECIAL_FULL_PANEL_INIT;
+        TPD_DEBUG("%s: Select Full Panel Init!\n", __func__);
+    } else {
+        init_type = NO_INIT;
+        TPD_DEBUG("%s: Skip Full Panel Init!\n", __func__);
+    }
+#endif
+
+    /* main full panel test, no stop on fail */
+    res = production_test_main(path_limits, 0, init_type, &tests, MP_FLAG_FACTORY);
+    if (res != OK) {
+        TPD_INFO("%s: fts full panel test fail ! ERROR : %08X\n", __func__, res);
+    }else {
+        TPD_INFO("%s: fts full panel test success ! ERROR : %08X\n", __func__, res);
+    }
+
+    /* counting the error item num */
+    for (i = 24; i < 29; i++) {
+        temp = res >> i;
+        temp &= 0x01;
+        if (temp)
+            error_num++;
+    }
+
+    seq_printf(s, "%d error(s). %s\n", error_num, error_num?"":"All test passed.");
+}
+
+/* setting full panel test items */
+static int fts_init_test_todo(char *limit_file_path)
+{
+    char *token = NULL;
+    char *line2 = NULL;
+    char line[800];
+    char *buf = NULL;
+    int n, size, pointer = 0, ret = OK;
+    char *data_file = NULL;
+    LimitFile limit_file;
+
+    /* init limit_file struct */
+    limit_file.size = 0;
+    limit_file.data = NULL;
+    strlcpy(limit_file.name, " ", MAX_LIMIT_FILE_NAME);
+
+    /* read limit data */
+    if (limit_file_path != NULL) {
+        ret = getLimitsFile(limit_file_path, &limit_file);
+        if (ret < OK) {
+            TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_FILE_NOT_FOUND);
+            ret = ERROR_FILE_NOT_FOUND;
+            goto END;
+        }
+        size = limit_file.size;
+        data_file = limit_file.data;
+    } else {
+        TPD_INFO("%s: Empty limit file path!\n", __func__);
+        ret = ERROR_FILE_NOT_FOUND;
+        goto END;
+    }
+
+    TPD_DEBUG("%s: The size of the limits file is %d bytes...\n",__func__, size);
+
+    /* read the first line of limit data file */
+    if (readLine(&data_file[pointer], line, size - pointer, &n) < 0) {
+        TPD_INFO("%s: No limit data loaded!\n", __func__);
+        ret = ERROR_FILE_NOT_FOUND;
+        goto END;
+    }
+
+    line2 = kstrdup(line, GFP_KERNEL);
+    if (line2 == NULL) {
+        TPD_INFO("%s: kstrdup ERROR %08X\n", __func__, ERROR_ALLOC);
+        ret = ERROR_ALLOC;
+        goto END;
+    }
+
+    /* setting test items */
+    buf = line2;
+    token = strsep(&line2, ",");
+    while (token != NULL) {
+        TPD_DEBUG("%s: token = %s \n",__func__, token);
+        if(strcmp(token, "MutualRaw") == 0)
+            tests.MutualRaw = 1;
+        else if(strcmp(token, "MutualRawMap") == 0)
+            tests.MutualRawMap = 1;
+        else if(strcmp(token, "MutualRawGap") == 0)
+            tests.MutualRawGap = 1;
+        else if(strcmp(token, "MutualRawAdj") == 0)
+            tests.MutualRawAdj = 1;
+        else if(strcmp(token, "MutualRawAdjGap") == 0)
+            tests.MutualRawAdjGap = 1;
+        else if(strcmp(token, "MutualRawAdjPeak") == 0)
+            tests.MutualRawAdjPeak = 1;
+        else if(strcmp(token, "MutualRawLP") == 0)
+            tests.MutualRawLP = 1;
+        else if(strcmp(token, "MutualRawMapLP") == 0)
+            tests.MutualRawMapLP = 1;
+        else if(strcmp(token, "MutualRawGapLP") == 0)
+            tests.MutualRawGapLP = 1;
+        else if(strcmp(token, "MutualRawAdjLP") == 0)
+            tests.MutualRawAdjLP = 1;
+        else if(strcmp(token, "MutualRawAdjITO") == 0)
+            tests.MutualRawAdjITO = 1;
+        else if(strcmp(token, "MutualCx1") == 0)
+            tests.MutualCx1 = 1;
+        else if(strcmp(token, "MutualCx2") == 0)
+            tests.MutualCx2 = 1;
+        else if(strcmp(token, "MutualCx2Adj") == 0)
+            tests.MutualCx2Adj = 1;
+        else if(strcmp(token, "MutualCxTotal") == 0)
+            tests.MutualCxTotal = 1;
+        else if(strcmp(token, "MutualCxTotalAdj") == 0)
+            tests.MutualCxTotalAdj = 1;
+        else if(strcmp(token, "MutualCx1LP") == 0)
+            tests.MutualCx1LP = 1;
+        else if(strcmp(token, "MutualCx2LP") == 0)
+            tests.MutualCx2LP = 1;
+        else if(strcmp(token, "MutualCx2AdjLP") == 0)
+            tests.MutualCx2AdjLP = 1;
+        else if(strcmp(token, "MutualCxTotalLP") == 0)
+            tests.MutualCxTotalLP = 1;
+        else if(strcmp(token, "MutualCxTotalAdjLP") == 0)
+            tests.MutualCxTotalAdjLP = 1;
+        else if(strcmp(token, "MutualKeyRaw") == 0)
+            tests.MutualKeyRaw = 1;
+        else if(strcmp(token, "MutualKeyCx1") == 0)
+            tests.MutualKeyCx1 = 1;
+        else if(strcmp(token, "MutualKeyCx2") == 0)
+            tests.MutualKeyCx2 = 1;
+        else if(strcmp(token, "MutualKeyCxTotal") == 0)
+            tests.MutualKeyCxTotal = 1;
+        else if(strcmp(token, "SelfForceRaw") == 0)
+            tests.SelfForceRaw = 1;
+        else if(strcmp(token, "SelfForceRawGap") == 0)
+            tests.SelfForceRawGap = 1;
+        else if(strcmp(token, "SelfForceRawMap") == 0)
+            tests.SelfForceRawMap = 1;
+        else if(strcmp(token, "SelfForceRawLP") == 0)
+            tests.SelfForceRawLP = 1;
+        else if(strcmp(token, "SelfForceRawGapLP") == 0)
+            tests.SelfForceRawGapLP = 1;
+        else if(strcmp(token, "SelfForceRawMapLP") == 0)
+            tests.SelfForceRawMapLP = 1;
+        else if(strcmp(token, "SelfForceIx1") == 0)
+            tests.SelfForceIx1 = 1;
+        else if(strcmp(token, "SelfForceIx2") == 0)
+            tests.SelfForceIx2 = 1;
+        else if(strcmp(token, "SelfForceIx2Adj") == 0)
+            tests.SelfForceIx2Adj = 1;
+        else if(strcmp(token, "SelfForceIxTotal") == 0)
+            tests.SelfForceIxTotal = 1;
+        else if(strcmp(token, "SelfForceIxTotalAdj") == 0)
+            tests.SelfForceIxTotalAdj = 1;
+        else if(strcmp(token, "SelfForceCx1") == 0)
+            tests.SelfForceCx1 = 1;
+        else if(strcmp(token, "SelfForceCx2") == 0)
+            tests.SelfForceCx2 = 1;
+        else if(strcmp(token, "SelfForceCx2Adj") == 0)
+            tests.SelfForceCx2Adj = 1;
+        else if(strcmp(token, "SelfForceCxTotal") == 0)
+            tests.SelfForceCxTotal = 1;
+        else if(strcmp(token, "SelfForceCxTotalAdj") == 0)
+            tests.SelfForceCxTotalAdj = 1;
+        else if(strcmp(token, "SelfForceIx1LP") == 0)
+            tests.SelfForceIx1LP = 1;
+        else if(strcmp(token, "SelfForceIx2LP") == 0)
+            tests.SelfForceIx2LP = 1;
+        else if(strcmp(token, "SelfForceIx2AdjLP") == 0)
+            tests.SelfForceIx2AdjLP = 1;
+        else if(strcmp(token, "SelfForceIxTotalLP") == 0)
+            tests.SelfForceIxTotalLP = 1;
+        else if(strcmp(token, "SelfForceIxTotalAdjLP") == 0)
+            tests.SelfForceIxTotalAdjLP = 1;
+        else if(strcmp(token, "SelfForceCx1LP") == 0)
+            tests.SelfForceCx1LP = 1;
+        else if(strcmp(token, "SelfForceCx2LP") == 0)
+            tests.SelfForceCx2LP = 1;
+        else if(strcmp(token, "SelfForceCx2AdjLP") == 0)
+            tests.SelfForceCx2AdjLP = 1;
+        else if(strcmp(token, "SelfForceCxTotalLP") == 0)
+            tests.SelfForceCxTotalLP = 1;
+        else if(strcmp(token, "SelfForceCxTotalAdjLP") == 0)
+            tests.SelfForceCxTotalAdjLP = 1;
+        else if(strcmp(token, "SelfSenseRaw") == 0)
+            tests.SelfSenseRaw = 1;
+        else if(strcmp(token, "SelfSenseRawGap") == 0)
+            tests.SelfSenseRawGap = 1;
+        else if(strcmp(token, "SelfSenseRawMap") == 0)
+            tests.SelfSenseRawMap = 1;
+        else if(strcmp(token, "SelfSenseRawLP") == 0)
+            tests.SelfSenseRawLP = 1;
+        else if(strcmp(token, "SelfSenseRawGapLP") == 0)
+            tests.SelfSenseRawGapLP = 1;
+        else if(strcmp(token, "SelfSenseRawMapLP") == 0)
+            tests.SelfSenseRawMapLP = 1;
+        else if(strcmp(token, "SelfSenseIx1") == 0)
+            tests.SelfSenseIx1 = 1;
+        else if(strcmp(token, "SelfSenseIx2") == 0)
+            tests.SelfSenseIx2 = 1;
+        else if(strcmp(token, "SelfSenseIx2Adj") == 0)
+            tests.SelfSenseIx2Adj = 1;
+        else if(strcmp(token, "SelfSenseIxTotal") == 0)
+            tests.SelfSenseIxTotal = 1;
+        else if(strcmp(token, "SelfSenseIxTotalAdj") == 0)
+            tests.SelfSenseIxTotalAdj = 1;
+        else if(strcmp(token, "SelfSenseCx1") == 0)
+            tests.SelfSenseCx1 = 1;
+        else if(strcmp(token, "SelfSenseCx2") == 0)
+            tests.SelfSenseCx2 = 1;
+        else if(strcmp(token, "SelfSenseCx2Adj") == 0)
+            tests.SelfSenseCx2Adj = 1;
+        else if(strcmp(token, "SelfSenseCxTotal") == 0)
+            tests.SelfSenseCxTotal = 1;
+        else if(strcmp(token, "SelfSenseCxTotalAdj") == 0)
+            tests.SelfSenseCxTotalAdj = 1;
+        else if(strcmp(token, "SelfSenseIx1LP") == 0)
+            tests.SelfSenseIx1LP = 1;
+        else if(strcmp(token, "SelfSenseIx2LP") == 0)
+            tests.SelfSenseIx2LP = 1;
+        else if(strcmp(token, "SelfSenseIx2AdjLP") == 0)
+            tests.SelfSenseIx2AdjLP = 1;
+        else if(strcmp(token, "SelfSenseIxTotalLP") == 0)
+            tests.SelfSenseIxTotalLP = 1;
+        else if(strcmp(token, "SelfSenseIxTotalAdjLP") == 0)
+            tests.SelfSenseIxTotalAdjLP = 1;
+        else if(strcmp(token, "SelfSenseCx1LP") == 0)
+            tests.SelfSenseCx1LP = 1;
+        else if(strcmp(token, "SelfSenseCx2LP") == 0)
+            tests.SelfSenseCx2LP = 1;
+        else if(strcmp(token, "SelfSenseCx2AdjLP") == 0)
+            tests.SelfSenseCx2AdjLP = 1;
+        else if(strcmp(token, "SelfSenseCxTotalLP") == 0)
+            tests.SelfSenseCxTotalLP = 1;
+        else if(strcmp(token, "SelfSenseCxTotalAdjLP") == 0)
+            tests.SelfSenseCxTotalAdjLP = 1;
+        else
+            TPD_INFO("%s: Unknow or unsupport test iterm !", __func__);
+        token = strsep(&line2, ",");
+    };
+
+END:
+    if (buf != NULL) {
+        kfree(buf);
+        buf = NULL;
+    }
+    if (limit_file.data != NULL) {
+        kfree(limit_file.data);
+        limit_file.data = NULL;
+    }
+
+    return ret;
+}
+
+static void fts_calibrate(struct seq_file *s, void *chip_data)
+{
+    int ret = -1;
+	u8 saveInit = RETRY_INIT_BOOT;
+
+    ret = production_test_initialization((u8)saveInit);
+    if (ret < 0) {
+		TPD_INFO("%s calibration failed\n", __func__);
+        seq_printf(s, "1 error, calibration failed\n");
+    } else {
+		TPD_INFO("%s calibration successed\n", __func__);
+        seq_printf(s, "0 error, calibration successed\n");
+    }
+
+    return;
+}
+
+static void fts_verify_calibration(struct seq_file *s, void *chip_data)
+{
+    int ret = -1;
+
+ 	ret = 0;
+    if (ret != 0) {
+		TPD_INFO("%s verify calibration failed\n", __func__);
+        seq_printf(s, "1 error, verify calibration result failed(0x%02x)\n", ret);
+    } else {
+		TPD_INFO("%s verify calibration successed\n", __func__);
+        seq_printf(s, "0 error, verify calibration result successed\n");
+    }
+
+    return;
+}
+
+/* st common proc ops */
+static struct st_proc_operations st_proc_ops = {
+    .auto_test          = fts_auto_test,
+    .init_test_iterm    = fts_init_test_todo,
+    .calibrate          = fts_calibrate,
+    .verify_calibration = fts_verify_calibration,
+};
+
+/* fts driver probe func */
+static int fts_probe(struct i2c_client *client, const struct i2c_device_id *idp)
+{
+
+    struct fts_ts_info *info = NULL;
+    struct touchpanel_data *ts = NULL;
+    int ret = 0;
+
+    TPD_INFO("%s : driver probe begin!\n", __func__);
+	if (tp_register_times > 0) {
+		TPD_INFO("TP driver have success loaded %d times, exit\n", tp_register_times);
+		return -1;
+	}
+    /* step1:Alloc chip_info */
+    info = kzalloc(sizeof(struct fts_ts_info), GFP_KERNEL);
+    if (!info) {
+        TPD_INFO("%s : Out of memory... Impossible to allocate struct info!\n", __func__);
+        ret = -ENOMEM;
+        goto Alloc_chip_info_fail;
+    }
+    memset(info, 0, sizeof(*info));
+
+    /* step2:Alloc common ts */
+    ts =  kzalloc(sizeof(struct touchpanel_data), GFP_KERNEL);
+    if (!ts) {
+        TPD_INFO("%s : Out of memory... Impossible to allocate struct common ts!\n", __func__);
+        ret = -ENOMEM;
+        goto Alloc_common_ts_fail;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    /* step3:building client && dev for callback building */
+    info->client = client;
+    info->st_ops = &st_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    info->dev = &info->client->dev;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = info;
+    info->hw_res = &ts->hw_res;
+
+    /* step4:file_operations callback building */
+    ts->ts_ops = &fts_ops;
+
+    /* step5:register common touch */
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto register_common_touch_fail;
+    }
+
+    /* step6:create st common related proc files */
+    ret = st_create_proc(ts, info->st_ops);
+    if (ret < OK)
+        TPD_INFO("%s : Error: can not create st related proc file!\n", __func__);
+
+    /* step7:create fts related proc files */
+    ret = fts_proc_init(ts);
+    if (ret < OK)
+        TPD_INFO("%s : Error: can not create fts related proc file!\n", __func__);
+
+    /* step8:others */
+#ifdef GESTURE_MODE
+    mutex_init(&gestureMask_mutex);
+#endif
+    info->key_mask = 0;
+
+    /* probe success */
+    TPD_INFO("%s : Probe Finished!\n", __func__);
+    return OK;
+
+
+register_common_touch_fail:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+Alloc_common_ts_fail:
+    kfree(info);
+    info = NULL;
+
+Alloc_chip_info_fail:
+    TPD_INFO("%s : Probe Failed!\n", __func__);
+
+    return ret;
+}
+
+static int fts_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(&(client->dev));
+
+    /* proc file stuff */
+    fts_proc_remove(ts);
+    st_proc_remove(ts);
+
+    /* free all */
+
+    common_touch_data_free(ts);
+
+    return OK;
+}
+
+static struct of_device_id fts_of_match_table[] = {
+    {
+        .compatible = "st,fts",
+    },
+    {},
+};
+
+static int fts_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called gesture_enable =%d\n", __func__, ts->gesture_enable);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int fts_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id fts_device_id[] = {
+    { FTS_TS_DRV_NAME, 0 },
+    {}
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = fts_i2c_suspend,
+    .resume  = fts_i2c_resume,
+#endif
+};
+
+static struct i2c_driver fts_i2c_driver = {
+    .driver          = {
+        .name           = FTS_TS_DRV_NAME,
+        .of_match_table = fts_of_match_table,
+        .pm = &tp_pm_ops,
+    },
+    .probe           = fts_probe,
+    .remove          = fts_remove,
+    .id_table        = fts_device_id,
+};
+
+static int __init fts_driver_init(void)
+{
+	TPD_INFO("%s is called\n", __func__);
+    return i2c_add_driver(&fts_i2c_driver);
+}
+
+static void __exit fts_driver_exit(void)
+{
+    i2c_del_driver(&fts_i2c_driver);
+}
+
+
+MODULE_DESCRIPTION("STMicroelectronics MultiTouch IC Driver");
+MODULE_AUTHOR("STMicroelectronics");
+MODULE_LICENSE("GPL");
+
+module_init(fts_driver_init);
+module_exit(fts_driver_exit);
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.h
new file mode 100644
index 0000000000000000000000000000000000000000..b145ea3b026f71be3b3e7d29be177c16e86a8c09
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts.h
@@ -0,0 +1,94 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : fts.h
+ * Description:  ST fst1ba90a driver
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+#ifndef _LINUX_FTS_I2C_H_
+#define _LINUX_FTS_I2C_H_
+
+#include <linux/device.h>
+#include "fts_lib/ftsSoftware.h"
+#include "fts_lib/ftsHardware.h"
+#include "../../touchpanel_common.h"
+
+
+/****************** CONFIGURATION SECTION ******************/
+/** @defgroup conf_section     Driver Configuration Section
+  * Settings of the driver code in order to suit the HW set up and the
+  * application behavior
+  */
+/* **** CODE CONFIGURATION **** */
+#define FTS_TS_DRV_NAME        "fts"    /*  driver name */
+
+/* If both COMPUTE_INIT_METHOD and PRE_SAVED_METHOD are not defined, driver will be automatically configured as GOLDEN_VALUE_METHOD */
+#define COMPUTE_INIT_METHOD     /* Allow to compute init data on phone during production */
+#ifndef COMPUTE_INIT_METHOD
+#define PRE_SAVED_METHOD        /* Pre-Saved Method used during production */
+#endif
+
+
+/* **** FEATURES USED IN THE IC **** */
+//#define PHONE_KEY               /* Enable the support of keys */
+
+#define GESTURE_MODE            /* enable the support of the gestures */
+#ifdef GESTURE_MODE
+#define USE_GESTURE_MASK        /* the gestures to select are referred using a gesture bitmask instead of their gesture IDs */
+#endif
+
+
+#define CHARGER_MODE    /* enable the support to charger mode feature (comment to disable) */
+
+#define GLOVE_MODE      /* enable the support to glove mode feature (comment to disable) */
+
+//#define COVER_MODE    /* enable the support to cover mode feature (comment to disable) */
+
+//#define STYLUS_MODE   /* enable the support to stylus mode feature (comment to disable) */
+
+//#define GRIP_MODE     /* enable the support to grip mode feature (comment to disable) */
+/***** END **** */
+
+
+/* **** PANEL SPECIFICATION **** */
+#define PRESSURE_MIN    0       /* min value of pressure reported */
+#define PRESSURE_MAX    127     /* Max value of pressure reported */
+
+#define DISTANCE_MIN    0       /* min distance between the tool and the display */
+#define DISTANCE_MAX    127     /* Max distance between the tool and the display */
+/* **** END **** */
+
+struct fts_ts_info {
+    struct device               *dev;                                   /* Pointer to the structure device */
+
+    struct i2c_client           *client;                                /* I2C client structure */
+
+    struct hw_resource          *hw_res;                                /* hw res parse from device trees */
+
+    unsigned char               data[FIFO_DEPTH][FIFO_EVENT_SIZE];      /* event data from FIFO */
+
+    struct st_proc_operations   *st_ops;                                /* st common ops */
+
+    char                        *fw_name;                               /* FW path name */
+
+    char                        *test_limit_name;                       /* test limit item name */
+
+    tp_dev                      tp_type;                                /* tp type */
+
+    u8                          key_mask;                               /* key mask of key event */
+	int							proximity_status;
+};
+
+
+int fts_chip_powercycle(struct fts_ts_info *info);
+
+/* export declaration of functions in fts_proc.c */
+extern int fts_proc_init(struct touchpanel_data *ts);
+extern void fts_proc_remove(struct touchpanel_data *ts);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..423311c0c7b273e0bf7507090009ff5ae4267239
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/Makefile
@@ -0,0 +1,6 @@
+#
+# Makefile for the FTS touchscreen driver.
+#
+
+obj-$(CONFIG_TOUCHPANEL_ST_FST1BA90A) += ftsCompensation.o ftsCore.o ftsError.o ftsFrame.o ftsIO.o ftsTest.o ftsTime.o ftsTool.o ftsFlash.o ftsGesture.o
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.c
new file mode 100644
index 0000000000000000000000000000000000000000..50462e8afb3189fee58edb2527de42ded124e6a2
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.c
@@ -0,0 +1,715 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsCompensation.c
+ * Description: Source file for ST fst1ba90a driver
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsCompensation.c
+  * \brief Contains all the function to work with Initialization Data
+  */
+
+#include "ftsCompensation.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsFrame.h"
+#include "ftsHardware.h"
+#include "ftsIO.h"
+#include "ftsSoftware.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/serio.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+/**
+  * Request to the FW to load the specified Initialization Data
+  * @param type type of Initialization data to load @link load_opt Load Host
+  * Data Option @endlink
+  * @return OK if success or an error code which specify the type of error
+  */
+int requestCompensationData(u8 type)
+{
+    int ret = ERROR_OP_NOT_ALLOW;
+    int retry = 0;
+
+    TPD_DEBUG("%s: Requesting compensation data... attemp = %d\n", __func__, retry + 1);
+    while (retry < RETRY_COMP_DATA_READ) {
+        ret = writeSysCmd(SYS_CMD_LOAD_DATA,  &type, 1);
+        /* send request to load in memory the Compensation Data */
+        if (ret < OK) {
+            TPD_INFO("%s: failed at %d attemp!\n", __func__, retry + 1);
+            retry += 1;
+        } else {
+            TPD_DEBUG("%s: Request Compensation data FINISHED!\n", __func__);
+            return OK;
+        }
+    }
+
+    TPD_INFO("%s: Requesting compensation data... ERROR %08X\n", __func__, ret | ERROR_REQU_COMP_DATA);
+    return ret | ERROR_REQU_COMP_DATA;
+}
+
+
+/**
+  * Read Initialization Data Header and check that the type loaded match
+  * with the one previously requested
+  * @param type type of Initialization data requested @link load_opt Load Host
+  * Data Option @endlink
+  * @param header pointer to DataHeader variable which will contain the header
+  * @param address pointer to a variable which will contain the updated address
+  * to the next data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readCompensationDataHeader(u8 type, DataHeader *header, u64 *address)
+{
+    u64 offset = ADDR_FRAMEBUFFER;
+    u8 data[COMP_DATA_HEADER];
+    int ret;
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, offset, data, COMP_DATA_HEADER, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {    /* i2c function have already a retry mechanism */
+        TPD_INFO("%s: error while reading data header ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("Read Data Header done!\n");
+
+    if (data[0] != HEADER_SIGNATURE) {
+        TPD_INFO("%s: The Header Signature was wrong! %02X != %02X ERROR %08X\n", __func__, data[0], HEADER_SIGNATURE, ERROR_WRONG_DATA_SIGN);
+        return ERROR_WRONG_DATA_SIGN;
+    }
+
+    if (data[1] != type) {
+        TPD_INFO("%s: Wrong type found! %02X!=%02X ERROR %08X\n", __func__, data[1], type, ERROR_DIFF_DATA_TYPE);
+        return ERROR_DIFF_DATA_TYPE;
+    }
+
+    TPD_DEBUG("Type = %02X of Compensation data OK!\n", type);
+
+    header->type = type;
+
+    *address = offset + COMP_DATA_HEADER;
+
+    return OK;
+}
+
+
+/**
+  * Read MS Global Initialization data from the buffer such as Cx1
+  * @param address pointer to a variable which contain the address from where
+  * to read the data and will contain the updated address to the next data
+  * @param global pointer to MutualSenseData variable which will contain the MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readMutualSenseGlobalData(u64 *address, MutualSenseData *global)
+{
+    u8 data[COMP_DATA_GLOBAL];
+    int ret;
+
+    TPD_DEBUG("Address for Global data= %08llX\n", *address);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, *address, data,
+                COMP_DATA_GLOBAL, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading info data ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+    TPD_DEBUG("Global data Read !\n");
+
+    global->header.force_node = data[0];
+    global->header.sense_node = data[1];
+    global->cx1 = data[2];
+    /* all other bytes are reserved atm */
+
+    TPD_DEBUG("force_len = %d sense_len = %d CX1 = %d\n", global->header.force_node, global->header.sense_node, global->cx1);
+
+    *address += COMP_DATA_GLOBAL;
+    return OK;
+}
+
+
+/**
+  * Read MS Initialization data for each node from the buffer
+  * @param address a variable which contain the address from where to read the
+  * data
+  * @param node pointer to MutualSenseData variable which will contain the MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readMutualSenseNodeData(u64 address, MutualSenseData *node)
+{
+    int ret;
+    int size = node->header.force_node * node->header.sense_node;
+
+    TPD_DEBUG("Address for Node data = %08llX\n", address);
+
+    node->node_data = (i8 *)kzalloc(size * (sizeof(i8)), GFP_KERNEL);
+
+    if (node->node_data == NULL) {
+        TPD_INFO("%s: can not allocate node_data... ERROR %08X", __func__, ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    TPD_DEBUG("Node Data to read %d bytes\n", size);
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, node->node_data, size, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading node data ERROR %08X\n", __func__, ret);
+        kfree(node->node_data);
+        return ret;
+    }
+    node->node_data_size = size;
+
+    TPD_DEBUG("Read node data OK!\n");
+
+    return size;
+}
+
+/**
+  * Perform all the steps to read the necessary info for MS Initialization data
+  * from the buffer and store it in a MutualSenseData variable
+  * @param type type of MS Initialization data to read @link load_opt Load Host
+  * Data Option @endlink
+  * @param data pointer to MutualSenseData variable which will contain the MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readMutualSenseCompensationData(u8 type, MutualSenseData *data)
+{
+    int ret;
+    u64 address;
+
+    data->node_data = NULL;
+
+    if (!(type == LOAD_CX_MS_TOUCH || type == LOAD_CX_MS_LOW_POWER || type == LOAD_CX_MS_KEY || type == LOAD_CX_MS_FORCE)) {
+        TPD_INFO("%s: Choose a MS type of compensation data ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    ret = requestCompensationData(type);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_REQU_COMP_DATA);
+        return ret | ERROR_REQU_COMP_DATA;
+    }
+
+    ret = readCompensationDataHeader(type, &(data->header), &address);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_HEADER);
+        return ret | ERROR_COMP_DATA_HEADER;
+    }
+
+    ret = readMutualSenseGlobalData(&address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_GLOBAL);
+        return ret | ERROR_COMP_DATA_GLOBAL;
+    }
+
+    ret = readMutualSenseNodeData(address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_NODE);
+        return ret | ERROR_COMP_DATA_NODE;
+    }
+
+    return OK;
+}
+
+/**
+  * Read SS Global Initialization data from the buffer such as Ix1/Cx1 for force
+  * and sense
+  * @param address pointer to a variable which contain the address from where
+  * to read the data and will contain the updated address to the next data
+  * @param global pointer to MutualSenseData variable which will contain the SS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readSelfSenseGlobalData(u64 *address, SelfSenseData *global)
+{
+    int ret;
+    u8 data[COMP_DATA_GLOBAL];
+
+    TPD_DEBUG("Address for Global data= %08llX\n", *address);
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, *address, data, COMP_DATA_GLOBAL, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading the data... ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("Global data Read !\n");
+
+    global->header.force_node = data[0];
+    global->header.sense_node = data[1];
+    global->f_ix1 = data[2];
+    global->s_ix1 = data[3];
+    global->f_cx1 = (i8)data[4];
+    global->s_cx1 = (i8)data[5];
+    global->f_max_n = data[6];
+    global->s_max_n = data[7];
+
+    TPD_DEBUG("force_len = %d sense_len = %d  f_ix1 = %d   s_ix1 = %d   f_cx1 = %d   s_cx1 = %d\n", global->header.force_node, global->header.sense_node,
+         global->f_ix1, global->s_ix1, global->f_cx1, global->s_cx1);
+    TPD_DEBUG("max_n = %d   s_max_n = %d\n", global->f_max_n,
+         global->s_max_n);
+
+
+    *address += COMP_DATA_GLOBAL;
+
+    return OK;
+}
+
+/**
+  * Read SS Initialization data for each node of force and sense channels from
+  * the buffer
+  * @param address a variable which contain the address from where to read the
+  * data
+  * @param node pointer to SelfSenseData variable which will contain the SS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readSelfSenseNodeData(u64 address, SelfSenseData *node)
+{
+    int size = node->header.force_node * 2 + node->header.sense_node * 2;
+    u8 data[size];
+    int ret;
+
+    node->ix2_fm = (u8 *)kzalloc(node->header.force_node * (sizeof(u8)), GFP_KERNEL);
+    if (node->ix2_fm == NULL) {
+        TPD_INFO("%s: can not allocate memory for ix2_fm... ERROR %08X", __func__, ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    node->cx2_fm = (i8 *)kzalloc(node->header.force_node * (sizeof(i8)), GFP_KERNEL);
+    if (node->cx2_fm == NULL) {
+        TPD_INFO("%s: can not allocate memory for cx2_fm ... ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix2_fm);
+        return ERROR_ALLOC;
+    }
+    node->ix2_sn = (u8 *)kzalloc(node->header.sense_node * (sizeof(u8)), GFP_KERNEL);
+    if (node->ix2_sn == NULL) {
+        TPD_INFO("%s: can not allocate memory for ix2_sn ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix2_fm);
+        kfree(node->cx2_fm);
+        return ERROR_ALLOC;
+    }
+    node->cx2_sn = (i8 *)kzalloc(node->header.sense_node * (sizeof(i8)), GFP_KERNEL);
+    if (node->cx2_sn == NULL) {
+        TPD_INFO("%s: can not allocate memory for cx2_sn ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix2_fm);
+        kfree(node->cx2_fm);
+        kfree(node->ix2_sn);
+        return ERROR_ALLOC;
+    }
+
+
+    TPD_DEBUG("Address for Node data = %08llX\n", address);
+
+    TPD_DEBUG("Node Data to read %d bytes\n", size);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, data, size, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading data... ERROR %08X\n", __func__, ret);
+        kfree(node->ix2_fm);
+        kfree(node->cx2_fm);
+        kfree(node->ix2_sn);
+        kfree(node->cx2_sn);
+        return ret;
+    }
+
+    TPD_DEBUG("Read node data ok!\n");
+
+    memcpy(node->ix2_fm, data, node->header.force_node);
+    memcpy(node->ix2_sn, &data[node->header.force_node], node->header.sense_node);
+    memcpy(node->cx2_fm, &data[node->header.force_node + node->header.sense_node], node->header.force_node);
+    memcpy(node->cx2_sn, &data[node->header.force_node * 2 + node->header.sense_node], node->header.sense_node);
+
+    return OK;
+}
+
+/**
+  * Perform all the steps to read the necessary info for SS Initialization data
+  * from the buffer and store it in a SelfSenseData variable
+  * @param type type of SS Initialization data to read @link load_opt Load Host
+  * Data Option @endlink
+  * @param data pointer to SelfSenseData variable which will contain the SS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readSelfSenseCompensationData(u8 type, SelfSenseData *data)
+{
+    int ret;
+    u64 address;
+
+    data->ix2_fm = NULL;
+    data->cx2_fm = NULL;
+    data->ix2_sn = NULL;
+    data->cx2_sn = NULL;
+
+    if (!(type == LOAD_CX_SS_TOUCH || type == LOAD_CX_SS_TOUCH_IDLE || type == LOAD_CX_SS_KEY || type == LOAD_CX_SS_FORCE)) {
+        TPD_INFO("%s: Choose a SS type of compensation data ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    ret = requestCompensationData(type);
+    if (ret < 0) {
+        TPD_INFO("%s: error while requesting data... ERROR %08X\n", __func__, ERROR_REQU_COMP_DATA);
+        return ret | ERROR_REQU_COMP_DATA;
+    }
+
+    ret = readCompensationDataHeader(type, &(data->header), &address);
+    if (ret < 0) {
+        TPD_INFO("%s: error while reading data header... ERROR %08X\n", __func__, ERROR_COMP_DATA_HEADER);
+        return ret | ERROR_COMP_DATA_HEADER;
+    }
+
+    ret = readSelfSenseGlobalData(&address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_GLOBAL);
+        return ret | ERROR_COMP_DATA_GLOBAL;
+    }
+
+    ret = readSelfSenseNodeData(address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_NODE);
+        return ret | ERROR_COMP_DATA_NODE;
+    }
+
+    return OK;
+}
+
+/**
+  * Read TOT MS Global Initialization data from the buffer such as number of
+  * force and sense channels
+  * @param address pointer to a variable which contain the address from where
+  * to read the data and will contain the updated address to the next data
+  * @param global pointer to a variable which will contain the TOT MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotMutualSenseGlobalData(u64 *address, TotMutualSenseData *global)
+{
+    int ret;
+    u8 data[COMP_DATA_GLOBAL];
+
+    TPD_DEBUG("Address for Global data= %04llX\n", *address);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, *address, data,
+                COMP_DATA_GLOBAL, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading info data ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+    TPD_DEBUG("Global data Read !\n");
+
+    global->header.force_node = data[0];
+    global->header.sense_node = data[1];
+    /* all other bytes are reserved atm */
+
+    TPD_DEBUG("force_len = %d sense_len = %d\n", global->header.force_node, global->header.sense_node);
+
+    *address += COMP_DATA_GLOBAL;
+    return OK;
+}
+
+
+/**
+  * Read TOT MS Initialization data for each node from the buffer
+  * @param address a variable which contain the address from where to read the
+  * data
+  * @param node pointer to MutualSenseData variable which will contain the TOT
+  * MS initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotMutualSenseNodeData(u64 address, TotMutualSenseData *node)
+{
+    int ret, i;
+    int size = node->header.force_node * node->header.sense_node;
+    int toRead = size * sizeof(u16);
+    u8 data[toRead];
+
+    TPD_DEBUG("Address for Node data = %04llX\n", address);
+
+    node->node_data = (short *)kzalloc(size * (sizeof(short)), GFP_KERNEL);
+
+    if (node->node_data == NULL) {
+        TPD_INFO("%s: can not allocate node_data... ERROR %08X", __func__, ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    TPD_DEBUG("Node Data to read %d bytes\n", size);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, data, toRead, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading node data ERROR %08X\n", __func__, ret);
+        kfree(node->node_data);
+        return ret;
+    }
+    node->node_data_size = size;
+
+    for (i = 0; i < size; i++)
+        node->node_data[i] = ((short)data[i * 2 + 1]) << 8 | data[i * 2];
+
+    TPD_DEBUG("Read node data OK!\n");
+
+    return size;
+}
+
+/**
+  * Perform all the steps to read the necessary info for TOT MS Initialization
+  * data from the buffer and store it in a TotMutualSenseData variable
+  * @param type type of TOT MS Initialization data to read @link load_opt Load
+  * Host Data Option @endlink
+  * @param data pointer to a variable which will contain the TOT MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotMutualSenseCompensationData(u8 type, TotMutualSenseData *data)
+{
+    int ret;
+    u64 address;
+
+    data->node_data = NULL;
+
+    if (!(type == LOAD_PANEL_CX_TOT_MS_TOUCH || type == LOAD_PANEL_CX_TOT_MS_LOW_POWER
+            || type == LOAD_PANEL_CX_TOT_MS_KEY || type == LOAD_PANEL_CX_TOT_MS_FORCE)) {
+        TPD_INFO("%s: Choose a TOT MS type of compensation data ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    ret = requestCompensationData(type);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_REQU_COMP_DATA);
+        return ret | ERROR_REQU_COMP_DATA;
+    }
+
+    ret = readCompensationDataHeader(type, &(data->header), &address);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_HEADER);
+        return ret | ERROR_COMP_DATA_HEADER;
+    }
+
+    ret = readTotMutualSenseGlobalData(&address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_GLOBAL);
+        return ret | ERROR_COMP_DATA_GLOBAL;
+    }
+
+    ret = readTotMutualSenseNodeData(address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_NODE);
+        return ret | ERROR_COMP_DATA_NODE;
+    }
+
+    return OK;
+}
+
+/**
+  * Read TOT SS Global Initialization data from the buffer such as number of
+  * force and sense channels
+  * @param address pointer to a variable which contain the address from where
+  * to read the data and will contain the updated address to the next data
+  * @param global pointer to a variable which will contain the TOT SS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotSelfSenseGlobalData(u64 *address, TotSelfSenseData *global)
+{
+    int ret;
+    u8 data[COMP_DATA_GLOBAL];
+
+    TPD_DEBUG("Address for Global data= %04llX\n", *address);
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, *address, data, COMP_DATA_GLOBAL, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading the data... ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("Global data Read !\n");
+
+    global->header.force_node = data[0];
+    global->header.sense_node = data[1];
+
+    TPD_DEBUG("force_len = %d sense_len = %d\n", global->header.force_node, global->header.sense_node);
+
+    *address += COMP_DATA_GLOBAL;
+
+    return OK;
+}
+
+/**
+  * Read TOT SS Global Initialization data from the buffer such as number of
+  * force and sense channels
+  * @param address pointer to a variable which contain the address from where
+  * to read the data and will contain the updated address to the next data
+  * @param node pointer to a variable which will contain the TOT SS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotSelfSenseNodeData(u64 address, TotSelfSenseData *node)
+{
+    int size = node->header.force_node * 2 + node->header.sense_node * 2;
+    int toRead = size * 2;    /* *2 2 bytes each node */
+    u8 data[toRead];
+    int ret, i, j = 0;
+
+    node->ix_fm = (u16 *)kzalloc(node->header.force_node * (sizeof(u16)), GFP_KERNEL);
+    if (node->ix_fm == NULL) {
+        TPD_INFO("%s: can not allocate memory for ix2_fm... ERROR %08X", __func__, ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    node->cx_fm = (short *)kzalloc(node->header.force_node * (sizeof(short)), GFP_KERNEL);
+    if (node->cx_fm == NULL) {
+        TPD_INFO("%s: can not allocate memory for cx2_fm ... ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix_fm);
+        return ERROR_ALLOC;
+    }
+    node->ix_sn = (u16 *)kzalloc(node->header.sense_node * (sizeof(u16)), GFP_KERNEL);
+    if (node->ix_sn == NULL) {
+        TPD_INFO("%s: can not allocate memory for ix2_sn ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix_fm);
+        kfree(node->cx_fm);
+        return ERROR_ALLOC;
+    }
+    node->cx_sn = (short *)kzalloc(node->header.sense_node * (sizeof(short)), GFP_KERNEL);
+    if (node->cx_sn == NULL) {
+        TPD_INFO("%s: can not allocate memory for cx2_sn ERROR %08X", __func__, ERROR_ALLOC);
+        kfree(node->ix_fm);
+        kfree(node->cx_fm);
+        kfree(node->ix_sn);
+        return ERROR_ALLOC;
+    }
+
+    TPD_DEBUG("Address for Node data = %04llX\n", address);
+
+    TPD_DEBUG("Node Data to read %d bytes\n", size);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, data, toRead, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading data... ERROR %08X\n", __func__, ret);
+        kfree(node->ix_fm);
+        kfree(node->cx_fm);
+        kfree(node->ix_sn);
+        kfree(node->cx_sn);
+        return ret;
+    }
+
+    TPD_DEBUG("Read node data ok!\n");
+
+    j = 0;
+    for (i = 0; i < node->header.force_node; i++) {
+        node->ix_fm[i] = ((u16)data[j + 1]) << 8 | data[j];
+        j += 2;
+    }
+
+    for (i = 0; i < node->header.sense_node; i++) {
+        node->ix_sn[i] = ((u16)data[j + 1]) << 8 | data[j];
+        j += 2;
+    }
+
+    for (i = 0; i < node->header.force_node; i++) {
+        node->cx_fm[i] = ((short)data[j + 1]) << 8 | data[j];
+        j += 2;
+    }
+
+    for (i = 0; i < node->header.sense_node; i++) {
+        node->cx_sn[i] = ((short)data[j + 1]) << 8 | data[j];
+        j += 2;
+    }
+
+    if (j != toRead)
+        TPD_INFO("%s: parsed a wrong number of bytes %d!=%d\n", __func__, j, toRead);
+
+    return OK;
+}
+
+/**
+  * Perform all the steps to read the necessary info for TOT SS Initialization
+  * data from the buffer and store it in a TotSelfSenseData variable
+  * @param type type of TOT MS Initialization data to read @link load_opt Load
+  * Host Data Option @endlink
+  * @param data pointer to a variable which will contain the TOT MS
+  * initialization data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readTotSelfSenseCompensationData(u8 type, TotSelfSenseData *data)
+{
+    int ret;
+    u64 address;
+
+    data->ix_fm = NULL;
+    data->cx_fm = NULL;
+    data->ix_sn = NULL;
+    data->cx_sn = NULL;
+
+    if (!(type == LOAD_PANEL_CX_TOT_SS_TOUCH || type == LOAD_PANEL_CX_TOT_SS_TOUCH_IDLE || type == LOAD_PANEL_CX_TOT_SS_KEY ||
+          type == LOAD_PANEL_CX_TOT_SS_FORCE)) {
+        TPD_INFO("%s: Choose a TOT SS type of compensation data ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    ret = requestCompensationData(type);
+    if (ret < 0) {
+        TPD_INFO("%s: error while requesting data... ERROR %08X\n", __func__, ERROR_REQU_COMP_DATA);
+        return ret | ERROR_REQU_COMP_DATA;
+    }
+
+    ret = readCompensationDataHeader(type, &(data->header), &address);
+    if (ret < 0) {
+        TPD_INFO("%s: error while reading data header... ERROR %08X\n", __func__, ERROR_COMP_DATA_HEADER);
+        return ret | ERROR_COMP_DATA_HEADER;
+    }
+
+    ret = readTotSelfSenseGlobalData(&address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_GLOBAL);
+        return ret | ERROR_COMP_DATA_GLOBAL;
+    }
+
+    ret = readTotSelfSenseNodeData(address, data);
+    if (ret < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_COMP_DATA_NODE);
+        return ret | ERROR_COMP_DATA_NODE;
+    }
+
+    return OK;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.h
new file mode 100644
index 0000000000000000000000000000000000000000..60864bef42f0eaeba4158125b8f712f8b1a680fc
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCompensation.h
@@ -0,0 +1,118 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsCompensation.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsCompensation.h
+  * \brief Contains all the definitions and structs to work with Initialization
+  * Data
+  */
+
+#ifndef FTS_COMPENSATION_H
+#define FTS_COMPENSATION_H
+
+#include "ftsCore.h"
+#include "ftsSoftware.h"
+
+#define RETRY_COMP_DATA_READ 2                          /* /< max number of attempts to read initialization data */
+
+/* Bytes dimension of Compensation Data Format */
+#define COMP_DATA_HEADER    DATA_HEADER                 /* /< size in bytes of initialization data header */
+#define COMP_DATA_GLOBAL    (16 - COMP_DATA_HEADER)     /* /< size in bytes of initialization data general info */
+#define HEADER_SIGNATURE    0xA5                        /* /< signature used as starting byte of data loaded in memory */
+
+/**
+  * Struct which contains the general info about Frames and Initialization Data
+  */
+typedef struct {
+    int force_node;    /* /< Number of Force Channels in the
+                        * frame/Initialization data */
+    int sense_node;    /* /< Number of Sense Channels in the
+                        * frame/Initialization data */
+    int type;          /* /< Type of frame/Initialization data */
+} DataHeader;
+
+/**
+  * Struct which contains the MS Initialization data
+  */
+typedef struct {
+    DataHeader  header;         /* /< Header */
+    i8          cx1;            /* /< Cx1 value (can be negative)) */
+    i8          *node_data;     /* /< Pointer to an array of bytes which contains the
+                                 * CX2 data (can be negative) */
+    int         node_data_size; /* /< size of the data */
+} MutualSenseData;
+
+
+/**
+  * Struct which contains the SS Initialization data
+  */
+typedef struct {
+    DataHeader  header;     /* /< Header */
+    u8          f_ix1;      /* /< IX1 Force */
+    u8          s_ix1;      /* /< IX1 Sense */
+    i8          f_cx1;      /* /< CX1 Force (can be negative) */
+    i8          s_cx1;      /* /< CX1 Sense (can be negative) */
+    u8          f_max_n;    /* /< Force MaxN */
+    u8          s_max_n;    /* /< Sense MaxN */
+
+    u8          *ix2_fm;    /* /< pointer to an array of bytes which contains Force
+                             * Ix2 data node */
+    u8          *ix2_sn;    /* /< pointer to an array of bytes which contains Sense
+                             * Ix2 data node */
+    i8          *cx2_fm;    /* /< pointer to an array of bytes which contains Force
+                             * Cx2 data node (can be negative) */
+    i8          *cx2_sn;    /* /< pointer to an array of bytes which contains Sense
+                             * Cx2 data node (can be negative)) */
+} SelfSenseData;
+
+/**
+  * Struct which contains the TOT MS Initialization data
+  */
+typedef struct {
+    DataHeader  header;         /* /< Header */
+    short       *node_data;     /* /< pointer to an array of ushort which
+                                 * contains TOT MS Initialization data */
+    int         node_data_size; /* /< size of data */
+} TotMutualSenseData;
+
+/**
+  * Struct which contains the TOT SS Initialization data
+  */
+typedef struct {
+    DataHeader  header;    /* /< Header */
+
+    u16         *ix_fm;    /* /< pointer to an array of ushort which contains TOT
+                            * SS IX Force data */
+    u16         *ix_sn;    /* /< pointer to an array of ushort which contains TOT
+                            * SS IX Sense data */
+    short       *cx_fm;    /* /< pointer to an array of ushort which contains TOT
+                            * SS CX Force data (can be negative) */
+    short       *cx_sn;    /* /< pointer to an array of ushort which contains TOT
+                            * SS CX Sense data (can be negative) */
+} TotSelfSenseData;
+
+int requestCompensationData(u8 type);
+int readCompensationDataHeader(u8 type, DataHeader *header, u64 *address);
+int readMutualSenseGlobalData(u64 *address, MutualSenseData *global);
+int readMutualSenseNodeData(u64 address, MutualSenseData *node);
+int readMutualSenseCompensationData(u8 type, MutualSenseData *data);
+int readSelfSenseGlobalData(u64 *address, SelfSenseData *global);
+int readSelfSenseNodeData(u64 address, SelfSenseData *node);
+int readSelfSenseCompensationData(u8 type, SelfSenseData *data);
+int readToTMutualSenseGlobalData(u64 *address, TotMutualSenseData *global);
+int readToTMutualSenseNodeData(u64 address, TotMutualSenseData *node);
+int readTotMutualSenseCompensationData(u8 type, TotMutualSenseData *data);
+int readTotSelfSenseGlobalData(u64 *address, TotSelfSenseData *global);
+int readTotSelfSenseNodeData(u64 address, TotSelfSenseData *node);
+int readTotSelfSenseCompensationData(u8 type, TotSelfSenseData *data);
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.c
new file mode 100644
index 0000000000000000000000000000000000000000..612be1ee272210aa2d7c965aceaa902b05128577
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.c
@@ -0,0 +1,943 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsCore.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsCore.c
+  * \brief Contains the implementation of the Core functions
+  */
+
+#include <linux/spinlock.h>
+#include <linux/delay.h>
+#include <linux/slab.h>
+#include <linux/interrupt.h>
+#include <linux/gpio.h>
+#include "ftsCompensation.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsIO.h"
+#include "ftsTest.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+
+SysInfo     systemInfo;    /* /< Global System Info variable, accessible in all the driver */
+
+static int  reset_gpio = GPIO_NOT_DEFINED;    /* /< gpio number of the rest
+                                             * pin, the value is
+                                             *  GPIO_NOT_DEFINED if the
+                                             * reset pin is not connected */
+static int  disable_irq_count = 1;    /* /< count the number of call to
+                                     * disable_irq, start with 1 because at
+                                     * the boot IRQ are already disabled */
+
+/**
+  * Initialize core variables of the library.
+  * Must be called during the probe before any other lib function
+  * @param info pointer to fts_ts_info which contains info about the device and
+  * its hw setup
+  * @return OK if success or an error code which specify the type of error
+  */
+int initCore(struct i2c_client *client, int reset_gpio)
+{
+    int ret = OK;
+
+    TPD_DEBUG("%s: Initialization of the Core...\n", __func__);
+    ret |= openChannel(client);
+    ret |= resetErrorList();
+    ret |= initTestToDo();
+    if (gpio_is_valid(reset_gpio)) {
+        setResetGpio(reset_gpio);
+    }
+    if (ret < OK)
+        TPD_DEBUG("%s: Initialization Core ERROR %08X!\n", __func__, ret);
+    else
+        TPD_DEBUG("%s: Initialization Finished!\n", __func__);
+    return ret;
+}
+
+/**
+  * Set the reset_gpio variable with the actual gpio number of the board link to
+  * the reset pin
+  * @param gpio gpio number link to the reset pin of the IC
+  */
+void setResetGpio(int gpio)
+{
+    reset_gpio = gpio;
+    TPD_INFO("setResetGpio: reset_gpio = %d\n", reset_gpio);
+}
+
+/**
+  * Perform a system reset of the IC.
+  * If the reset pin is associated to a gpio, the function execute an hw reset
+  * (toggling of reset pin) otherwise send an hw command to the IC
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_system_reset(void)
+{
+    u8 readData[FIFO_EVENT_SIZE];
+    int event_to_search;
+    int res = -1;
+    int i = 0;
+    u8 data[1] = { SYSTEM_RESET_VALUE };
+
+    event_to_search = (int)EVT_ID_CONTROLLER_READY;
+
+    fts_disableInterruptNoSync();
+
+    TPD_DEBUG("System resetting...\n");
+    for (i = 0; i < RETRY_SYSTEM_RESET && res < 0; i++) {
+
+        resetErrorList();
+
+        if (reset_gpio == GPIO_NOT_DEFINED)
+            res = fts_writeU8UX(FTS_CMD_HW_REG_W, ADDR_SIZE_HW_REG, ADDR_SYSTEM_RESET, data, ARRAY_SIZE(data));
+        else {
+            gpio_direction_output(reset_gpio, 0);
+            msleep(10);
+            gpio_direction_output(reset_gpio, 1);
+            res = OK;
+        }
+        if (res < OK)
+            TPD_INFO("fts_system_reset: ERROR %08X\n", ERROR_BUS_W);
+        else {
+            res = pollForEvent(&event_to_search, 1, readData, GENERAL_TIMEOUT);
+            if (res < OK)
+                TPD_INFO("fts_system_reset: ERROR %08X\n", res);
+        }
+    }
+
+    fts_enableInterrupt();
+
+    if (res < OK) {
+        TPD_INFO("fts_system_reset...failed after 3 attempts: ERROR %08X\n", (res | ERROR_SYSTEM_RESET_FAIL));
+        return res | ERROR_SYSTEM_RESET_FAIL;
+    } else {
+        TPD_DEBUG("System reset DONE!\n");
+        return OK;
+    }
+}
+
+/**
+  * Poll the FIFO looking for a specified event within a timeout. Support a
+  * retry mechanism.
+  * @param event_to_search pointer to an array of int where each element
+  * correspond to a byte of the event to find.
+  * If the element of the array has value -1, the byte of the event,
+  * in the same position of the element is ignored.
+  * @param event_bytes size of event_to_search
+  * @param readData pointer to an array of byte which will contain the event
+  * found
+  * @param time_to_wait time to wait before going in timeout
+  * @return OK if success or an error code which specify the type of error
+  */
+int pollForEvent(int *event_to_search, int event_bytes, u8 *readData, int time_to_wait)
+{
+    int i, find, retry, count_err;
+    int time_to_count;
+    int err_handling = OK;
+    StopWatch clock;
+
+    u8 cmd[1] = { FIFO_CMD_READONE };
+
+    find = 0;
+    retry = 0;
+    count_err = 0;
+    time_to_count = time_to_wait / TIMEOUT_RESOLUTION;
+
+    startStopWatch(&clock);
+    while (find != 1 && retry < time_to_count &&
+        fts_writeReadU8UX(cmd[0], 0, 0, readData, FIFO_EVENT_SIZE, DUMMY_FIFO) >= OK) {
+        /* Log of errors */
+        if (readData[0] == EVT_ID_ERROR) {
+			TPD_INFO("ERROR EVENT = %02X %02X %02X %02X %02X %02X %02X %02X\n",
+			readData[0],readData[1],readData[2],readData[3],readData[4],readData[5],readData[6],readData[7]);
+            count_err++;
+            err_handling = errorHandler(readData, FIFO_EVENT_SIZE);
+            if ((err_handling & 0xF0FF0000) == ERROR_HANDLER_STOP_PROC) {
+                TPD_INFO("pollForEvent: forced to be stopped! ERROR %08X\n", err_handling);
+                return err_handling;
+            }
+        } else {
+            if (readData[0] != EVT_ID_NOEVENT) {
+				TPD_INFO("READ EVENT = %02X %02X %02X %02X %02X %02X %02X %02X\n",
+				readData[0],readData[1],readData[2],readData[3],readData[4],readData[5],readData[6],readData[7]);
+            }
+            if (readData[0] == EVT_ID_CONTROLLER_READY && event_to_search[0] != EVT_ID_CONTROLLER_READY) {
+                TPD_INFO("pollForEvent: Unmanned Controller Ready Event! Setting reset flags...\n");
+            }
+        }
+
+        find = 1;
+
+        for (i = 0; i < event_bytes; i++) {
+            if (event_to_search[i] != -1 && (int)readData[i] != event_to_search[i]) {
+                find = 0;
+                break;
+            }
+        }
+
+        retry++;
+        msleep(TIMEOUT_RESOLUTION);
+    }
+    stopStopWatch(&clock);
+    if ((retry >= time_to_count) && find != 1) {
+        TPD_INFO("pollForEvent: ERROR %08X\n", ERROR_TIMEOUT);
+        return ERROR_TIMEOUT;
+    } else if (find == 1) {
+		TPD_INFO("FOUND EVENT = %02X %02X %02X %02X %02X %02X %02X %02X\n",
+		readData[0],readData[1],readData[2],readData[3],readData[4],readData[5],readData[6],readData[7]);
+        TPD_DEBUG("Event found in %d ms (%d iterations)! Number of errors found = %d\n", elapsedMillisecond(&clock), retry, count_err);
+        return count_err;
+    } else {
+        TPD_INFO("pollForEvent: ERROR %08X\n", ERROR_BUS_R);
+        return ERROR_BUS_R;
+    }
+}
+
+/**
+  * Check that the FW sent the echo even after a command was sent
+  * @param cmd pointer to an array of byte which contain the command previously
+  * sent
+  * @param size size of cmd
+  * @return OK if success or an error code which specify the type of error
+  */
+int checkEcho(u8 *cmd, int size)
+{
+    int ret, i;
+    int event_to_search[FIFO_EVENT_SIZE];
+    u8 readData[FIFO_EVENT_SIZE];
+
+
+    if (size < 1) {
+        TPD_INFO("checkEcho: Invalid Size = %d not valid! ERROR %08X\n", size, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    } else {
+        if ((size + 3) > FIFO_EVENT_SIZE)
+            size = FIFO_EVENT_SIZE - 3;
+        /* Echo event 0x43 0x01 xx xx xx xx xx fifo_status
+         * therefore command with more than 5 bytes will be trunked */
+
+        event_to_search[0] = EVT_ID_STATUS_UPDATE;
+        event_to_search[1] = EVT_TYPE_STATUS_ECHO;
+        for (i = 2; i < size + 2; i++)
+            event_to_search[i] = cmd[i - 2];
+        ret = pollForEvent(event_to_search, size + 2, readData, TIEMOUT_ECHO);
+        if (ret < OK) {
+            TPD_INFO("checkEcho: Echo Event not found! ERROR %08X\n", ret);
+            return ret | ERROR_CHECK_ECHO_FAIL;
+        } else if (ret > OK) {
+            TPD_INFO("checkEcho: Echo Event found but with some error events before! num_error = %d\n", ret);
+            return ERROR_CHECK_ECHO_FAIL;
+        }
+
+        TPD_DEBUG("ECHO OK!\n");
+        return ret;
+    }
+}
+
+/**
+  * Set a scan mode in the IC
+  * @param mode scan mode to set; possible values @link scan_opt Scan Mode
+  * Option @endlink
+  * @param settings option for the selected scan mode
+  * (for example @link active_bitmask Active Mode Bitmask @endlink)
+  * @return OK if success or an error code which specify the type of error
+  */
+int setScanMode(u8 mode, u8 settings)
+{
+    u8 cmd[3] = { FTS_CMD_SCAN_MODE, mode, settings };
+    int ret, size = 3;
+
+    TPD_DEBUG("%s: Setting scan mode: mode = %02X settings = %02X !\n", __func__, mode, settings);
+    if (mode == SCAN_MODE_LOW_POWER)
+        size = 2;
+    ret = fts_write(cmd, size);    /* use write instead of writeFw because
+                                 * can be called while the interrupt are
+                                 * enabled */
+    if (ret < OK) {
+        TPD_INFO("%s: write failed...ERROR %08X !\n", __func__, ret);
+        return ret | ERROR_SET_SCAN_MODE_FAIL;
+    }
+    TPD_DEBUG("%s: Setting scan mode OK!\n", __func__);
+    return OK;
+}
+
+/**
+  * Set a feature and its option in the IC
+  * @param feat feature to set; possible values @link feat_opt Feature Selection
+  * Option @endlink
+  * @param settings pointer to an array of byte which store the options for
+  * the selected feature (for example the gesture mask to activate
+  * @link gesture_opt Gesture IDs @endlink)
+  * @param size in bytes of settings
+  * @return OK if success or an error code which specify the type of error
+  */
+int setFeatures(u8 feat, u8 *settings, int size)
+{
+    u8 cmd[2 + size];
+    int i = 0;
+    int ret;
+
+    TPD_DEBUG("%s: Setting feature: feat = %02X !\n", __func__,
+         feat);
+    cmd[0] = FTS_CMD_FEATURE;
+    cmd[1] = feat;
+    TPD_DEBUG("%s: Settings = ", __func__);
+    for (i = 0; i < size; i++) {
+        cmd[2 + i] = settings[i];
+        TPD_DEBUG( "%02X ", settings[i]);
+    }
+    TPD_DEBUG( "\n");
+    ret = fts_write(cmd, 2 + size);    /* use write instead of writeFw because
+                     * can be called while the interrupts
+                     * are enabled */
+    if (ret < OK) {
+        TPD_INFO("%s: write failed...ERROR %08X !\n", __func__, ret);
+        return ret | ERROR_SET_FEATURE_FAIL;
+    }
+    TPD_DEBUG("%s: Setting feature OK!\n", __func__);
+    return OK;
+}
+
+/**
+  * Write a system command to the IC
+  * @param sys_cmd System Command to execute; possible values
+  * @link sys_opt System Command Option @endlink
+  * @param sett settings option for the selected system command
+  * (@link sys_special_opt Special Command Option @endlink, @link ito_opt
+  * ITO Test Option @endlink, @link load_opt Load Host Data Option @endlink)
+  * @param size in bytes of settings
+  * @return OK if success or an error code which specify the type of error
+  */
+int writeSysCmd(u8 sys_cmd, u8 *sett, int size)
+{
+    u8 cmd[2 + size];
+    int ret;
+
+    cmd[0] = FTS_CMD_SYSTEM;
+    cmd[1] = sys_cmd;
+
+    TPD_DEBUG("%s: Command = %02X %02X ", __func__, cmd[0], cmd[1]);
+    for (ret = 0; ret < size; ret++) {
+        cmd[2 + ret] = sett[ret];
+        TPD_DEBUG( "%02X ", cmd[2 + ret]);
+    }
+    TPD_DEBUG( "\n");
+    TPD_DEBUG("%s: Writing Sys command...\n", __func__);
+    if (sys_cmd != SYS_CMD_LOAD_DATA)
+        ret = fts_writeFwCmd(cmd, 2 + size);
+    else {
+        if (size >= 1)
+            ret = requestSyncFrame(sett[0]);
+        else {
+            TPD_INFO("%s: No setting argument! ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+            return ERROR_OP_NOT_ALLOW;
+        }
+    }
+    if (ret < OK)
+        TPD_INFO("%s: ERROR %08X\n", __func__, ret);
+
+    else
+        TPD_DEBUG("%s: FINISHED!\n", __func__);
+
+    return ret;
+}
+
+/**
+  * Initialize the System Info Struct with default values according to the error
+  * found during the reading
+  * @param i2cError 1 if there was an I2C error while reading the System Info
+  * data from memory, other value if another error occurred
+  * @return OK if success or an error code which specify the type of error
+  */
+int defaultSysInfo(int i2cError)
+{
+    int i;
+
+    TPD_DEBUG("Setting default System Info...\n");
+
+    if (i2cError == 1) {
+        systemInfo.u16_fwVer = 0xFFFF;
+        systemInfo.u16_cfgProjectId = 0xFFFF;
+        for (i = 0; i < RELEASE_INFO_SIZE; i++)
+            systemInfo.u8_releaseInfo[i] = 0xFF;
+        systemInfo.u16_cxVer = 0xFFFF;
+    } else {
+        systemInfo.u16_fwVer = 0x0000;
+        systemInfo.u16_cfgProjectId = 0x0000;
+        for (i = 0; i < RELEASE_INFO_SIZE; i++)
+            systemInfo.u8_releaseInfo[i] = 0x00;
+        systemInfo.u16_cxVer = 0x0000;
+    }
+
+    systemInfo.u8_scrRxLen = 0;
+    systemInfo.u8_scrTxLen = 0;
+
+    TPD_DEBUG("default System Info DONE!\n");
+    return OK;
+}
+
+/**
+  * Read the System Info data from memory. System Info is loaded automatically
+  * after every system reset.
+  * @param request if 1, will be asked to the FW to reload the data, otherwise
+  * attempt to read it directly from memory
+  * @return OK if success or an error code which specify the type of error
+  */
+int readSysInfo(int request)
+{
+    int ret, i, index = 0;
+    u8 sett = LOAD_SYS_INFO;
+    u8 data[SYS_INFO_SIZE] = { 0 };
+    char temp[256] = { 0 };
+
+    if (request == 1) {
+        TPD_DEBUG("%s: Requesting System Info...\n", __func__);
+
+        ret = writeSysCmd(SYS_CMD_LOAD_DATA, &sett, 1);
+        if (ret < OK) {
+            TPD_INFO("%s: error while writing the sys cmd ERROR %08X\n",__func__, ret);
+            goto FAIL;
+        }
+    }
+
+    TPD_DEBUG("%s: Reading System Info...\n", __func__);
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, ADDR_FRAMEBUFFER, data, SYS_INFO_SIZE, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading the system data ERROR %08X\n",__func__, ret);
+        goto FAIL;
+    }
+
+    TPD_DEBUG("%s: Parsing System Info...\n", __func__);
+
+    if (data[0] != HEADER_SIGNATURE) {
+        TPD_INFO("%s: The Header Signature is wrong!  sign: %02X != %02X ERROR %08X\n", __func__, data[0], HEADER_SIGNATURE, ERROR_WRONG_DATA_SIGN);
+        ret = ERROR_WRONG_DATA_SIGN;
+        goto FAIL;
+    }
+
+    if (data[1] != LOAD_SYS_INFO) {
+        TPD_INFO("%s: The Data ID is wrong!  ids: %02X != %02X ERROR %08X\n", __func__, data[3], LOAD_SYS_INFO, ERROR_DIFF_DATA_TYPE);
+        ret = ERROR_DIFF_DATA_TYPE;
+        goto FAIL;
+    }
+
+    index += 4;
+    u8ToU16(&data[index], &systemInfo.u16_apiVer_rev);
+    index += 2;
+    systemInfo.u8_apiVer_minor = data[index++];
+    systemInfo.u8_apiVer_major = data[index++];
+    u8ToU16(&data[index], &systemInfo.u16_chip0Ver);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_chip0Id);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_chip1Ver);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_chip1Id);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_fwVer);
+    index += 2;
+    TPD_INFO("FW VER = %04X\n", systemInfo.u16_fwVer);
+    u8ToU16(&data[index], &systemInfo.u16_svnRev);
+    index += 2;
+    TPD_INFO("SVN REV = %04X\n", systemInfo.u16_svnRev);
+    u8ToU16(&data[index], &systemInfo.u16_cfgVer);
+    index += 2;
+    TPD_INFO("CONFIG VER = %04X\n", systemInfo.u16_cfgVer);
+    u8ToU16(&data[index], &systemInfo.u16_cfgProjectId);
+    index += 2;
+    TPD_INFO("CONFIG PROJECT ID = %04X\n", systemInfo.u16_cfgProjectId);
+    u8ToU16(&data[index], &systemInfo.u16_cxVer);
+    index += 2;
+    TPD_INFO("CX VER = %04X\n", systemInfo.u16_cxVer);
+    u8ToU16(&data[index], &systemInfo.u16_cxProjectId);
+    index += 2;
+    TPD_INFO("CX PROJECT ID = %04X\n", systemInfo.u16_cxProjectId);
+    systemInfo.u8_cfgAfeVer = data[index++];
+    systemInfo.u8_cxAfeVer =  data[index++];
+    systemInfo.u8_panelCfgAfeVer = data[index++];
+    TPD_INFO("AFE VER: CFG = %02X - CX = %02X - PANEL = %02X\n",
+         systemInfo.u8_cfgAfeVer, systemInfo.u8_cxAfeVer, systemInfo.u8_panelCfgAfeVer);
+    systemInfo.u8_protocol = data[index++];
+    TPD_INFO("Protocol = %02X\n", systemInfo.u8_protocol);
+    /* index+= 1;
+     * reserved area */
+    for (i = 0; i < DIE_INFO_SIZE; i++)
+        systemInfo.u8_dieInfo[i] = data[index++];
+    /* TPD_INFO( "%02X ", systemInfo.u8_dieInfo[i]); */
+    /* TPD_INFO( "\n"); */
+    TPD_INFO("%s\n", printHex("Die Info =  ", systemInfo.u8_dieInfo, DIE_INFO_SIZE, temp));
+    memset(temp, 0, 256);
+
+    /* TPD_INFO("Release Info =  "); */
+    for (i = 0; i < RELEASE_INFO_SIZE; i++)
+        systemInfo.u8_releaseInfo[i] = data[index++];
+    /* TPD_INFO( "%02X ", systemInfo.u8_releaseInfo[i]); */
+    /* TPD_INFO( "\n"); */
+
+    TPD_INFO("%s\n", printHex("Release Info =  ", systemInfo.u8_releaseInfo, RELEASE_INFO_SIZE, temp));
+    memset(temp, 0, 256);
+
+    u8ToU32(&data[index], &systemInfo.u32_fwCrc);
+    index += 4;
+    u8ToU32(&data[index], &systemInfo.u32_cfgCrc);
+    index += 4;
+
+    index += 4;    /* skip reserved area */
+
+    systemInfo.u8_mpFlag = data[index];
+    TPD_INFO("MP FLAG = %02X\n", systemInfo.u8_mpFlag);
+	index +=4; 
+	u8ToU32(&data[index], &systemInfo.u32_flash_org_info);
+	TPD_INFO("Flash Organization Information= 0X%08X \n", systemInfo.u32_flash_org_info);
+
+    index += 4; /* +3 remaining from mp flag address */
+
+    systemInfo.u8_ssDetScanSet = data[index];
+    TPD_INFO("SS Detect Scan Select = %d \n", systemInfo.u8_ssDetScanSet);
+    index += 4;
+
+    u8ToU16(&data[index], &systemInfo.u16_scrResX);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_scrResY);
+    index += 2;
+    TPD_INFO("Screen Resolution = %d x %d\n", systemInfo.u16_scrResX, systemInfo.u16_scrResY);
+    systemInfo.u8_scrTxLen = data[index++];
+    TPD_INFO("TX Len = %d\n", systemInfo.u8_scrTxLen);
+    systemInfo.u8_scrRxLen = data[index++];
+    TPD_INFO("RX Len = %d\n", systemInfo.u8_scrRxLen);
+    systemInfo.u8_keyLen = data[index++];
+    TPD_INFO("Key Len = %d\n", systemInfo.u8_keyLen);
+    systemInfo.u8_forceLen = data[index++];
+    TPD_INFO("Force Len = %d\n", systemInfo.u8_forceLen);
+
+    index += 40;    /* skip reserved area */
+
+    u8ToU16(&data[index], &systemInfo.u16_dbgInfoAddr);
+    index += 2;
+
+    index += 6;    /* skip reserved area */
+
+    u8ToU16(&data[index], &systemInfo.u16_msTchRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_msTchFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_msTchStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_msTchBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssTchTxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchTxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchTxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchTxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssTchRxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchRxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchRxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssTchRxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_keyRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_keyFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_keyStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_keyBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_frcRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_frcFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_frcStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_frcBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrTxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrTxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrTxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrTxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrRxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrRxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrRxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssHvrRxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxTxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxTxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxTxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxTxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxRxRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxRxFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxRxStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssPrxRxBaselineAddr);
+    index += 2;
+
+    u8ToU16(&data[index], &systemInfo.u16_ssDetRawAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssDetFilterAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssDetStrenAddr);
+    index += 2;
+    u8ToU16(&data[index], &systemInfo.u16_ssDetBaselineAddr);
+    index += 2;
+
+    TPD_INFO("Parsed %d bytes!\n", index);
+
+    if (index != SYS_INFO_SIZE) {
+        TPD_INFO("%s: index = %d different from %d ERROR %08X\n",__func__, index, SYS_INFO_SIZE, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    TPD_INFO("System Info Read DONE!\n");
+    return OK;
+
+FAIL:
+    defaultSysInfo(isI2cError(ret));
+    return ret;
+}
+
+/**
+  * Read data from the Config Memory
+  * @param offset Starting address in the Config Memory of data to read
+  * @param outBuf pointer of a byte array which contain the bytes to read
+  * @param len number of bytes to read
+  * @return OK if success or an error code which specify the type of error
+  */
+int readConfig(u16 offset, u8 *outBuf, int len)
+{
+    int ret;
+    u64 final_address = offset + ADDR_CONFIG_OFFSET;
+
+    TPD_DEBUG("%s: Starting to read config memory at %08llX ...\n", __func__, final_address);
+    ret = fts_writeReadU8UX(FTS_CMD_CONFIG_R, BITS_16, final_address,
+                outBuf, len, DUMMY_CONFIG);
+    if (ret < OK) {
+        TPD_INFO("%s: Impossible to read Config Memory... ERROR %08X!\n",__func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("%s: Read config memory FINISHED!\n", __func__);
+    return OK;
+}
+
+/**
+  * Write data into the Config Memory
+  * @param offset Starting address in the Config Memory where write the data
+  * @param data pointer of a byte array which contain the data to write
+  * @param len number of bytes to write
+  * @return OK if success or an error code which specify the type of error
+  */
+int writeConfig(u16 offset, u8 *data, int len)
+{
+    int ret;
+    u64 final_address = offset + ADDR_CONFIG_OFFSET;
+
+    TPD_DEBUG("%s: Starting to write config memory at %08llX ...\n",__func__, final_address);
+    ret = fts_writeU8UX(FTS_CMD_CONFIG_W, BITS_16, final_address, data, len);
+    if (ret < OK) {
+        TPD_INFO("%s: Impossible to write Config Memory... ERROR %08X!\n",__func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("%s: Write config memory FINISHED!\n", __func__);
+    return OK;
+}
+
+/**
+  * Disable the interrupt so the ISR of the driver can not be called
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_disableInterrupt(void)
+{
+    if (getClient() != NULL) {
+        TPD_DEBUG("Number of disable = %d\n", disable_irq_count);
+        if (disable_irq_count == 0) {
+            TPD_DEBUG("Executing Disable...\n");
+            disable_irq(getClient()->irq);
+            disable_irq_count++;
+        }
+        /* disable_irq is re-entrant so it is required to keep track
+         * of the number of calls of this when reenabling */
+        TPD_DEBUG("Interrupt Disabled!\n");
+        return OK;
+    } else {
+        TPD_INFO("%s: Impossible get client irq... ERROR %08X\n",__func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+
+/**
+  * Disable the interrupt async so the ISR of the driver can not be called
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_disableInterruptNoSync(void)
+{
+    if (getClient() != NULL) {
+        TPD_DEBUG("Number of disable = %d\n", disable_irq_count);
+        if (disable_irq_count == 0) {
+            TPD_DEBUG("Executing Disable...\n");
+            disable_irq_nosync(getClient()->irq);
+            disable_irq_count++;
+        }
+        /* disable_irq is re-entrant so it is required to keep track
+         * of the number of calls of this when reenabling */
+        TPD_DEBUG("Interrupt No Sync Disabled!\n");
+        return OK;
+    } else {
+        TPD_INFO("%s: Impossible get client irq... ERROR %08X\n",__func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+
+/**
+  * Reset the disable_irq count
+  * @return OK
+  */
+int fts_resetDisableIrqCount(void)
+{
+    disable_irq_count = 0;
+    return OK;
+}
+
+/**
+  * Enable the interrupt so the ISR of the driver can be called
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_enableInterrupt(void)
+{
+
+    if (getClient() != NULL) {
+        TPD_DEBUG("Number of re-enable = %d\n", disable_irq_count);
+        while (disable_irq_count > 0) {
+            /* loop N times according on the pending number of
+             * disable_irq to truly re-enable the int */
+            TPD_DEBUG("Executing Enable...\n");
+            enable_irq(getClient()->irq);
+            disable_irq_count--;
+        }
+        TPD_DEBUG("Interrupt Enabled!\n");
+        return OK;
+    } else {
+        TPD_INFO("%s: Impossible get client irq... ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  *    Check if there is a crc error in the IC which prevent the fw to run.
+  *    @return  OK if no CRC error, or a number >OK according the CRC error
+  * found
+  */
+int fts_crc_check(void)
+{
+    u8 val;
+    u8 crc_status;
+    int res;
+    u8 error_to_search[6] = { EVT_TYPE_ERROR_CRC_CFG_HEAD,
+                  EVT_TYPE_ERROR_CRC_CFG,
+                  EVT_TYPE_ERROR_CRC_CX,
+                  EVT_TYPE_ERROR_CRC_CX_HEAD,
+                  EVT_TYPE_ERROR_CRC_CX_SUB,
+                  EVT_TYPE_ERROR_CRC_CX_SUB_HEAD };
+
+    res = fts_writeReadU8UX(FTS_CMD_HW_REG_R, ADDR_SIZE_HW_REG, ADDR_CRC, &val, 1, DUMMY_HW_REG);/* read 2 bytes because the first one is a dummy byte! */
+    if (res < OK) {
+        TPD_INFO("%s: Cannot read crc status ERROR %08X\n", __func__, res);
+        return res;
+    }
+
+    crc_status = val & CRC_MASK;
+    if (crc_status != OK) {    /* CRC error if crc_status!=0 */
+        TPD_INFO("%s:CRC ERROR = %02X\n", __func__, crc_status);
+        return CRC_CODE;
+    }
+
+    TPD_INFO("%s: Verifying if Config CRC Error...\n", __func__);
+    res = fts_system_reset();
+    if (res >= OK) {
+        res = pollForErrorType(error_to_search, 2);
+        if (res < OK) {
+            TPD_INFO("%s: No Config CRC Error Found!\n", __func__);
+            TPD_INFO("%s: Verifying if Cx CRC Error...\n", __func__);
+            res = pollForErrorType(&error_to_search[2], 4);
+            if (res < OK) {
+                TPD_INFO("%s: No Cx CRC Error Found!\n", __func__);
+                return OK;
+            } else {
+                TPD_INFO("%s: Cx CRC Error found! CRC ERROR = %02X\n", __func__, res);
+                return CRC_CX;
+            }
+        } else {
+            TPD_INFO("%s: Config CRC Error found! CRC ERROR = %02X\n", __func__, res);
+            return CRC_CONFIG;
+        }
+    } else {
+        TPD_INFO("%s: Error while executing system reset! ERROR %08X\n",__func__, res);
+        return res;
+    }
+
+    return OK;
+}
+
+/**
+  * Request a host data and use the sync method to understand when the FW load
+  * it
+  * @param type the type ID of host data to load (@link load_opt Load Host Data
+  * Option  @endlink)
+  * @return OK if success or an error code which specify the type of error
+  */
+int requestSyncFrame(u8 type)
+{
+    u8 request[3] = { FTS_CMD_SYSTEM, SYS_CMD_LOAD_DATA, type };
+    u8 readData[DATA_HEADER] = { 0 };
+    int ret, retry = 0, retry2 = 0, time_to_count;
+    int count, new_count;
+
+    TPD_DEBUG("%s: Starting to get a sync frame...\n", __func__);
+
+    while (retry2 < RETRY_MAX_REQU_DATA) {
+        TPD_DEBUG("%s: Reading count...\n", __func__);
+
+        ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, ADDR_FRAMEBUFFER, readData, DATA_HEADER, DUMMY_FRAMEBUFFER);
+        if (ret < OK) {
+            TPD_DEBUG("%s: Error while reading count! ERROR %08X\n",__func__, ret | ERROR_REQU_DATA);
+            ret |= ERROR_REQU_DATA;
+            retry2++;
+            continue;
+        }
+
+        if (readData[0] != HEADER_SIGNATURE)
+            TPD_INFO("%s: Invalid Signature while reading count! ERROR %08X\n",__func__, ret | ERROR_REQU_DATA);
+
+        count = (readData[3] << 8) | readData[2];
+        new_count = count;
+        TPD_DEBUG("%s: Base count = %d\n", __func__, count);
+
+        TPD_DEBUG("%s: Requesting frame %02X  attempt = %d\n",__func__,  type, retry2 + 1);
+        ret = fts_write(request, ARRAY_SIZE(request));
+        if (ret >= OK) {
+            TPD_DEBUG("%s: Polling for new count...\n", __func__);
+            time_to_count = TIMEOUT_REQU_DATA / TIMEOUT_RESOLUTION;
+            while (count == new_count && retry < time_to_count) {
+                ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, ADDR_FRAMEBUFFER, readData, DATA_HEADER, DUMMY_FRAMEBUFFER);
+                if ((ret >= OK) && (readData[0] == HEADER_SIGNATURE) && (readData[1] == type))
+                    new_count = ((readData[3] << 8) | readData[2]);
+                else
+                    TPD_DEBUG("%s: invalid Signature or can not read count... ERROR %08X\n",__func__, ret);
+                retry++;
+                msleep(TIMEOUT_RESOLUTION);
+            }
+
+            if (count == new_count) {
+                TPD_INFO("%s: New count not received! ERROR %08X\n", __func__, ERROR_TIMEOUT | ERROR_REQU_DATA);
+                ret = ERROR_TIMEOUT | ERROR_REQU_DATA;
+            } else {
+                TPD_DEBUG("%s: New count found! count = %d! Frame ready!\n", __func__, new_count);
+                return OK;
+            }
+        }
+        retry2++;
+    }
+    TPD_INFO("%s: Request Data failed! ERROR %08X\n", __func__,
+         ret);
+    return ret;
+}
+
+
+/**
+  * Save MP flag value into the flash
+  * @param mpflag Value to write in the MP Flag field
+  * @return OK if success or an error code which specify the type of error
+  */
+int saveMpFlag(u8 mpflag)
+{
+    int ret;
+
+    TPD_INFO("%s: Saving MP Flag = %02X\n", __func__, mpflag);
+    ret = writeSysCmd(SYS_CMD_MP_FLAG, &mpflag, 1);
+    if (ret < OK) {
+        TPD_INFO("%s: Error while writing MP flag on ram... ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    mpflag = SAVE_PANEL_CONF;
+    ret = writeSysCmd(SYS_CMD_SAVE_FLASH, &mpflag, 1);
+    if (ret < OK) {
+        TPD_INFO("%s: Error while saving MP flag on flash... ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    ret = readSysInfo(1);
+    if (ret < OK) {
+        TPD_INFO("%s: Error while refreshing SysInfo... ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_INFO("%s: Saving MP Flag OK!\n", __func__);
+    return OK;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.h
new file mode 100644
index 0000000000000000000000000000000000000000..b210a532ffee92d62cf6dee66f91b351a23cb679
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsCore.h
@@ -0,0 +1,174 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsCore.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsCore.h
+  * \brief Contains all the definitions and structs of Core functionalities
+  */
+
+#ifndef FTS_CORE_H
+#define FTS_CORE_H
+
+#include "ftsHardware.h"
+#include "ftsSoftware.h"
+#include <linux/i2c.h>
+
+/* HW DATA */
+#define GPIO_NOT_DEFINED        -1         /* /< value assumed by reset_gpio when
+                                            * the reset pin of the IC is not connected */
+
+#define ADDR_SIZE_HW_REG        BITS_32    /* /< value of AddrSize for Hw register
+                                            * in FTI @see AddrSize */
+
+#define DATA_HEADER             4          /* /< size in byte of the header loaded
+                                            * with the data in the frambuffer */
+
+/**
+  * Type of CRC errors
+  */
+typedef enum {
+    CRC_CODE        = 1,    /* /< CRC in the code section */
+    CRC_CONFIG      = 2,    /* /< CRC in the config section */
+    CRC_CX          = 3,    /* /< CRC in the cx section */
+    CRC_PANEL       = 4     /* /< CRC in the panel section */
+} CRC_Error;
+
+/* CHIP INFO */
+/** @defgroup system_info    System Info
+  * System Info Data collect the most important informations about hw and fw
+  */
+/* Size in bytes of System Info data */
+#define SYS_INFO_SIZE               216     /* Num bytes of die info */
+#define DIE_INFO_SIZE               16      /* Num bytes of external release in config */
+
+#define EXTERNAL_RELEASE_INFO_SIZE  8       /* Num bytes of release info in sys info
+                                             *  (first bytes are external release) */
+#define RELEASE_INFO_SIZE           (EXTERNAL_RELEASE_INFO_SIZE)
+
+/* RETRY MECHANISM */
+#define RETRY_MAX_REQU_DATA         2       /* /< Max number of attemps performed
+                                             * when requesting data */
+#define RETRY_SYSTEM_RESET          3       /* /< Max number of attemps performed
+                                             * to reset the IC */
+
+/**
+  * Struct which contains fundamental informations about the chip and its
+  *configuration
+  */
+typedef struct {
+    u16 u16_apiVer_rev;     /* /< API revision version */
+    u8 u8_apiVer_minor;     /* /< API minor version */
+    u8 u8_apiVer_major;     /* /< API major version */
+    u16 u16_chip0Ver;       /* /< Dev0 version */
+    u16 u16_chip0Id;        /* /< Dev0 ID */
+    u16 u16_chip1Ver;       /* /< Dev1 version */
+    u16 u16_chip1Id;        /* /< Dev1 ID */
+    u16 u16_fwVer;          /* /< Fw version */
+    u16 u16_svnRev;         /* /< SVN Revision */
+    u16 u16_cfgVer;         /* /< Config Version */
+    u16 u16_cfgProjectId;   /* /< Config Project ID */
+    u16 u16_cxVer;          /* /< Cx Version */
+    u16 u16_cxProjectId;    /* /< Cx Project ID */
+    u8 u8_cfgAfeVer;        /* /< AFE version in Config */
+    u8 u8_cxAfeVer;         /* /< AFE version in CX */
+    u8 u8_panelCfgAfeVer;   /* /< AFE version in PanelMem */
+    u8 u8_protocol;         /* /< Touch Report Protocol */
+    u8 u8_dieInfo[DIE_INFO_SIZE];               /* /< Die information */
+    u8 u8_releaseInfo[RELEASE_INFO_SIZE];       /* /< Release information */
+    u32 u32_fwCrc;      /* /< Crc of FW */
+    u32 u32_cfgCrc;     /* /< Crc of config */
+    u8 u8_mpFlag;       /* /< MP Flag */
+    u8 u8_ssDetScanSet; /* /< Type of Detect Scan Selected */
+	u32 u32_flash_org_info; 	/* /< u32_flash_org_info*/
+
+    u16 u16_scrResX;    /* /< X resolution on main screen */
+    u16 u16_scrResY;    /* /< Y resolution on main screen */
+    u8 u8_scrTxLen;     /* /< Tx length */
+    u8 u8_scrRxLen;     /* /< Rx length */
+    u8 u8_keyLen;       /* /< Key Len */
+    u8 u8_forceLen;     /* /< Force Len */
+
+    u16 u16_dbgInfoAddr;        /* /< Offset of debug Info structure */
+
+    u16 u16_msTchRawAddr;       /* /< Offset of MS touch raw frame */
+    u16 u16_msTchFilterAddr;    /* /< Offset of MS touch filter frame */
+    u16 u16_msTchStrenAddr;     /* /< Offset of MS touch strength frame */
+    u16 u16_msTchBaselineAddr;  /* /< Offset of MS touch baseline frame */
+
+    u16 u16_ssTchTxRawAddr;     /* /< Offset of SS touch force raw frame */
+    u16 u16_ssTchTxFilterAddr;  /* /< Offset of SS touch force filter frame */
+    u16 u16_ssTchTxStrenAddr;   /* /< Offset of SS touch force strength frame */
+    u16 u16_ssTchTxBaselineAddr;/* /< Offset of SS touch force baseline frame */
+
+    u16 u16_ssTchRxRawAddr;     /* /< Offset of SS touch sense raw frame */
+    u16 u16_ssTchRxFilterAddr;  /* /< Offset of SS touch sense filter frame */
+    u16 u16_ssTchRxStrenAddr;   /* /< Offset of SS touch sense strength frame */
+    u16 u16_ssTchRxBaselineAddr;/* /< Offset of SS touch sense baseline frame */
+
+    u16 u16_keyRawAddr;         /* /< Offset of key raw frame */
+    u16 u16_keyFilterAddr;      /* /< Offset of key filter frame */
+    u16 u16_keyStrenAddr;       /* /< Offset of key strength frame */
+    u16 u16_keyBaselineAddr;    /* /< Offset of key baseline frame */
+
+    u16 u16_frcRawAddr;         /* /< Offset of force touch raw frame */
+    u16 u16_frcFilterAddr;      /* /< Offset of force touch filter frame */
+    u16 u16_frcStrenAddr;       /* /< Offset of force touch strength frame */
+    u16 u16_frcBaselineAddr;    /* /< Offset of force touch baseline frame */
+
+    u16 u16_ssHvrTxRawAddr;     /* /< Offset of SS hover Force raw frame */
+    u16 u16_ssHvrTxFilterAddr;  /* /< Offset of SS hover Force filter frame */
+    u16 u16_ssHvrTxStrenAddr;   /* /< Offset of SS hover Force strength frame */
+    u16 u16_ssHvrTxBaselineAddr;/* /< Offset of SS hover Force baseline frame */
+
+    u16 u16_ssHvrRxRawAddr;     /* /< Offset of SS hover Sense raw frame */
+    u16 u16_ssHvrRxFilterAddr;  /* /< Offset of SS hover Sense filter frame */
+    u16 u16_ssHvrRxStrenAddr;   /* /< Offset of SS hover Sense strength frame */
+    u16 u16_ssHvrRxBaselineAddr;/* /< Offset of SS hover Sense baseline frame */
+
+    u16 u16_ssPrxTxRawAddr;         /* /< Offset of SS proximity force raw frame */
+    u16 u16_ssPrxTxFilterAddr;      /* /< Offset of SS proximity force filter frame */
+    u16 u16_ssPrxTxStrenAddr;       /* /< Offset of SS proximity force strength frame */
+    u16 u16_ssPrxTxBaselineAddr;    /* /< Offset of SS proximity force baseline frame */
+
+    u16 u16_ssPrxRxRawAddr;         /* /< Offset of SS proximity sense raw frame */
+    u16 u16_ssPrxRxFilterAddr;      /* /< Offset of SS proximity sense filter frame */
+    u16 u16_ssPrxRxStrenAddr;       /* /< Offset of SS proximity sense strength frame */
+    u16 u16_ssPrxRxBaselineAddr;    /* /< Offset of SS proximity sense baseline frame */
+
+    u16 u16_ssDetRawAddr;           /* /< Offset of SS detect raw frame */
+    u16 u16_ssDetFilterAddr;        /* /< Offset of SS detect filter frame */
+    u16 u16_ssDetStrenAddr;         /* /< Offset of SS detect strength frame */
+    u16 u16_ssDetBaselineAddr;      /* /< Offset of SS detect baseline frame */
+} SysInfo;
+
+int initCore(struct i2c_client *client, int reset_gpio);
+void setResetGpio(int gpio);
+int fts_system_reset(void);
+int pollForEvent(int *event_to_search, int event_bytes, u8 *readData, int time_to_wait);
+int checkEcho(u8 *cmd, int size);
+int setScanMode(u8 mode, u8 settings);
+int setFeatures(u8 feat, u8 *settings, int size);
+int defaultSysInfo(int i2cError);
+int writeSysCmd(u8 sys_cmd, u8 *sett, int size);
+int readSysInfo(int request);
+int readConfig(u16 offset, u8 *outBuf, int len);
+int writeConfig(u16 offset, u8 *data, int len);
+int fts_disableInterrupt(void);
+int fts_disableInterruptNoSync(void);
+int fts_resetDisableIrqCount(void);
+int fts_enableInterrupt(void);
+int fts_crc_check(void);
+int requestSyncFrame(u8 type);
+int saveMpFlag(u8 mpflag);
+
+#endif    /* FTS_CORE_H */
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.c
new file mode 100644
index 0000000000000000000000000000000000000000..8b7edd27cfaf8c85c6c8ab0964a9347120e4efa3
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.c
@@ -0,0 +1,320 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsError.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsError.c
+  * \brief Contains all the function which handle with Error conditions
+  */
+
+#include <linux/device.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/delay.h>
+
+
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsIO.h"
+#include "ftsTool.h"
+#include "ftsCompensation.h"
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+static ErrorList errors;    /* /< private variable which implement the Error List */
+
+
+/**
+  * Check if an error code is related to an I2C failure
+  * @param error error code to check
+  * @return 1 if the first level error code is I2C related otherwise 0
+  */
+int isI2cError(int error)
+{
+    if (((error & 0x000000FF) >= (ERROR_BUS_R & 0x000000FF)) &&
+        ((error & 0x000000FF) <= (ERROR_BUS_O & 0x000000FF)))
+        return 1;
+    else
+        return 0;
+}
+
+
+/**
+  * Dump in the kernel log some debug info in case of FW hang
+  * @param outBuf (optional)pointer to bytes array where to copy the debug info,
+  * if NULL the data will just printed on the kernel log
+  * @param size dimension in bytes of outBuf,
+  * if > ERROR_DUMP_ROW_SIZE*ERROR_DUMP_COL_SIZE, only the first
+  * ERROR_DUMP_ROW_SIZE*ERROR_DUMP_COL_SIZE bytes will be copied
+  * @return OK if success or an error code which specify the type of error
+  */
+int dumpErrorInfo(u8 *outBuf, int size)
+{
+    int ret, i;
+    u8 data[ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE] = { 0 };
+    u32 sign = 0;
+
+    TPD_DEBUG("%s: Starting dump of error info...\n", __func__);
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, ADDR_ERROR_DUMP,
+                data, ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("%s: reading data ERROR %08X\n", __func__,
+             ret);
+        return ret;
+    } else {
+        if (outBuf != NULL) {
+            sign = size > ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE ? ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE : size;
+            memcpy(outBuf, data, sign);
+            TPD_DEBUG("%s: error info copied in the buffer!\n", __func__);
+        }
+        TPD_INFO("%s: Error Info =\n", __func__);
+        u8ToU32(data, &sign);
+        if (sign != ERROR_DUMP_SIGNATURE)
+            TPD_INFO("%s: Wrong Error Signature! Data may be invalid!\n", __func__);
+        else
+            TPD_INFO("%s: Error Signature OK! Data are valid!\n", __func__);
+
+        for (i = 0; i < ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE; i++) {
+            if (i % ERROR_DUMP_COL_SIZE == 0)
+                TPD_INFO( KERN_ERR "\n%s: %d) ", __func__, i / ERROR_DUMP_COL_SIZE);
+            TPD_INFO("%02X ", data[i]);
+        }
+        TPD_INFO("\n");
+
+        TPD_DEBUG("%s: dump of error info FINISHED!\n", __func__);
+        return OK;
+    }
+}
+
+
+/**
+  * Implement recovery strategies to be used when an error event is found
+  * while polling the FIFO
+  * @param event error event found during the polling
+  * @param size size of event
+  * @return OK if the error event doesn't require any action or the recovery
+  * strategy doesn't have any impact in the possible procedure that trigger the
+  * error, otherwise return an error code which specify the kind of error
+  * encountered. If ERROR_HANDLER_STOP_PROC the calling function must stop!
+  */
+int errorHandler(u8 *event, int size)
+{
+    int res = OK;
+
+    if (event != NULL && size > 1 && event[0] == EVT_ID_ERROR) {
+        TPD_INFO("errorHandler: Starting handling...\n");
+        addErrorIntoList(event, size);
+        switch (event[1]) {    /* TODO: write an error log for undefined command subtype 0xBA */
+        case EVT_TYPE_ERROR_ESD:    /* esd */
+            res = fts_system_reset();
+            if (res < OK)
+                TPD_INFO("errorHandler: Cannot reset the device ERROR %08X\n", res);
+            res = (ERROR_HANDLER_STOP_PROC | res);
+            break;
+
+        case EVT_TYPE_ERROR_WATCHDOG:    /* watchdog */
+            dumpErrorInfo(NULL, 0);
+            res = fts_system_reset();
+            if (res < OK)
+                TPD_INFO("errorHandler: Cannot reset the device ERROR %08X\n", res);
+            res = (ERROR_HANDLER_STOP_PROC | res);
+            break;
+
+        case EVT_TYPE_ERROR_ITO_FORCETOGND:
+            TPD_INFO("errorHandler: Force Short to GND!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_SENSETOGND:
+            TPD_INFO("errorHandler: Sense short to GND!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_FORCETOVDD:
+            TPD_INFO("errorHandler: Force short to VDD!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_SENSETOVDD:
+            TPD_INFO("errorHandler: Sense short to VDD!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_FORCE_P2P:
+            TPD_INFO("errorHandler: Force Pin to Pin Short!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_SENSE_P2P:
+            TPD_INFO("errorHandler: Sense Pin to Pin Short!\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_FORCEOPEN:
+            TPD_INFO("errorHandler: Force Open !\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_SENSEOPEN:
+            TPD_INFO("errorHandler: Sense Open !\n");
+            break;
+        case EVT_TYPE_ERROR_ITO_KEYOPEN:
+            TPD_INFO("errorHandler: Key Open !\n");
+            break;
+
+        default:
+            TPD_INFO("errorHandler: No Action taken!\n");
+            break;
+        }
+        TPD_INFO("errorHandler: handling Finished! res = %08X\n",res);
+        return res;
+    } else {
+        TPD_INFO("errorHandler: event Null or not correct size! ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+
+/**
+  * Add an error event into the Error List
+  * @param event error event to add
+  * @param size size of event
+  * @return OK
+  */
+int addErrorIntoList(u8 *event, int size)
+{
+    int i = 0;
+
+    TPD_DEBUG("Adding error in to ErrorList...\n");
+
+    memcpy(&errors.list[errors.last_index * FIFO_EVENT_SIZE], event, size);
+    i = FIFO_EVENT_SIZE - size;
+    if (i > 0) {
+        TPD_DEBUG("Filling last %d bytes of the event with zero...\n", i);
+        memset(&errors.list[errors.last_index * FIFO_EVENT_SIZE + size], 0, i);
+    }
+    TPD_DEBUG("Adding error in to ErrorList... FINISHED!\n");
+
+    errors.count += 1;
+    if (errors.count > FIFO_DEPTH)
+        TPD_INFO("ErrorList is going in overflow... the first %d event(s) were override!\n", errors.count - FIFO_DEPTH);
+    errors.last_index = (errors.last_index + 1) % FIFO_DEPTH;
+
+    return OK;
+}
+
+/**
+  * Reset the Error List setting the count and last_index to 0.
+  * @return OK
+  */
+int resetErrorList(void)
+{
+    errors.count = 0;
+    errors.last_index = 0;
+    memset(errors.list, 0, FIFO_DEPTH * FIFO_EVENT_SIZE);
+    /* if count is not considered is better reset also the list in order to
+      * avoid to read data previously copied into the list */
+    return OK;
+}
+
+/**
+  * Get the number of error events copied into the Error List
+  * @return the number of error events into the Error List
+  */
+int getErrorListCount(void)
+{
+    if (errors.count > FIFO_DEPTH)
+        return FIFO_DEPTH;
+    else
+        return errors.count;
+}
+
+/* in case of success return the index of the event found */
+/**
+  * Scroll the Error List looking for the event specified
+  * @param event_to_search event_to_search pointer to an array of int where
+  * each element correspond to a byte of the event to find. If the element
+  * of the array has value -1, the byte of the event, in the same position
+  * of the element is ignored.
+  * @param event_bytes size of event_to_search
+  * @return a value >=0 if the event is found which represent the index of
+  * the Error List where the event is located otherwise an error code
+  */
+int pollErrorList(int *event_to_search, int event_bytes)
+{
+    int i = 0, j = 0, find = 0;
+    int count = getErrorListCount();
+
+    TPD_INFO("Starting to poll ErrorList...\n");
+    while (find != 1 && i < count) {
+        find = 1;
+        for (j = 0; j < event_bytes; j++) {
+            if ((event_to_search[i] != -1) && ((int)errors.list[i * FIFO_EVENT_SIZE + j] != event_to_search[i])) {
+                find = 0;
+                break;
+            }
+        }
+        i++;
+    }
+    if (find == 1) {
+        TPD_INFO("Error Found into ErrorList!\n");
+        return i - 1;    /* there is i++ at the end of the while */
+    } else {
+        TPD_INFO("Error Not Found into ErrorList! ERROR %08X\n", ERROR_TIMEOUT);
+        return ERROR_TIMEOUT;
+    }
+}
+
+
+
+/**
+  * Poll the Error List looking for any error types passed in the arguments.
+  * Return at the first match!
+  * @param list pointer to a list of error types to look for
+  * @param size size of list
+  * @return error type found if success or ERROR_TIMEOUT
+  */
+int pollForErrorType(u8 *list, int size)
+{
+    int i = 0, j = 0, find = 0;
+    int count = getErrorListCount();
+
+    TPD_INFO("%s: Starting to poll ErrorList... count = %d\n", __func__, count);
+    while (find != 1 && i < count) {
+        for (j = 0; j < size; j++) {
+            if (list[j] == errors.list[i * FIFO_EVENT_SIZE + 1]) {
+                find = 1;
+                break;
+            }
+        }
+        i++;
+    }
+    if (find == 1) {
+        TPD_INFO("%s: Error Type %02X into ErrorList!\n", __func__, list[j]);
+        return list[j];
+    } else {
+        TPD_INFO("%s: Error Type Not Found into ErrorList! ERROR %08X\n", __func__, ERROR_TIMEOUT);
+        return ERROR_TIMEOUT;
+    }
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.h
new file mode 100644
index 0000000000000000000000000000000000000000..5c16cc5b7db760fbd8a2c0075356033c2ec1cac4
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsError.h
@@ -0,0 +1,203 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsError.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsError.h
+  * \brief Contains all the definitions and structs which refer to Error
+  * conditions
+  */
+
+#ifndef FTS_ERROR_H
+#define FTS_ERROR_H
+
+#include "ftsHardware.h"
+#include "ftsSoftware.h"
+
+
+/** @defgroup error_codes Error Codes
+  * Error codes that can be reported by the driver functions.
+  * An error code is made up by 4 bytes, each byte indicate a logic error
+  * level.\n
+  * From the LSB to the MSB, the logic level increase going from a low level
+  * error (I2C,TIMEOUT) to an high level error (flashing procedure fail,
+  * production test fail etc)
+  */
+
+/* FIRST LEVEL ERROR CODE */
+/** @defgroup first_level    First Level Error Code
+  * @ingroup error_codes
+  * Errors related to low level operation which are not under control of driver,
+  * such as: communication protocol (I2C/SPI), timeout, file operations ...
+  */
+#define OK                  ((int)0x00000000)       /* /< No ERROR */
+#define ERROR_ALLOC         ((int)0x80000001)       /* /< allocation of
+                                                     * memory failed */
+#define ERROR_BUS_R         ((int)0x80000002)       /* /< i2c/spi read
+                                                     * failed */
+#define ERROR_BUS_W         ((int)0x80000003)       /* /< i2c/spi write
+                                                     * failed */
+#define ERROR_BUS_WR        ((int)0x80000004)       /* /< i2c/spi write/read
+                                                     * failed */
+#define ERROR_BUS_O         ((int)0x80000005)       /* /< error during
+                                                     * opening an i2c device */
+#define ERROR_OP_NOT_ALLOW  ((int)0x80000006)       /* /< operation not
+                                                     * allowed */
+#define ERROR_TIMEOUT       ((int)0x80000007)       /* /< timeout expired!
+                                                     * exceed the max number
+                                                     * of retries or the max
+                                                     * waiting time */
+#define ERROR_FILE_NOT_FOUND        ((int)0x80000008)       /* /< the file that i
+                                                             * want to open is not
+                                                             * found */
+#define ERROR_FILE_PARSE            ((int)0x80000009)       /* /< error during
+                                                             * parsing the file */
+#define ERROR_FILE_READ             ((int)0x8000000A)       /* /< error during
+                                                             * reading the file */
+#define ERROR_LABEL_NOT_FOUND       ((int)0x8000000B)       /* /< label not found */
+#define ERROR_FW_NO_UPDATE          ((int)0x8000000C)       /* /< fw in the chip
+                                                             * newer than the one in
+                                                             * the memmh */
+#define ERROR_FLASH_UNKNOWN         ((int)0x8000000D)       /* /< flash status busy
+                                                             * or unknown */
+
+/* SECOND LEVEL ERROR CODE */
+/** @defgroup second_level Second Level Error Code
+  * @ingroup error_codes
+  * Errors related to simple logic operations in the IC which require one
+  * command or which are part of a more complex procedure
+  */
+#define ERROR_DISABLE_INTER         ((int)0x80000200)   /* /< unable to disable
+                                                         * the interrupt */
+#define ERROR_ENABLE_INTER          ((int)0x80000300)   /* /< unable to activate
+                                                         * the interrup */
+#define ERROR_READ_CONFIG           ((int)0x80000400)   /* /< failed to read
+                                                         * config memory */
+#define ERROR_GET_OFFSET            ((int)0x80000500)   /* /< unable to read an
+                                                         * offset from memory */
+#define ERROR_GET_FRAME_DATA        ((int)0x80000600)   /* /< unable to
+                                                         *  retrieve the data of
+                                                         *  a required frame */
+#define ERROR_DIFF_DATA_TYPE        ((int)0x80000700)   /* /< FW answers with
+                                                         *  an event that has a
+                                                         * different address
+                                                         * respect the request
+                                                         * done */
+#define ERROR_WRONG_DATA_SIGN       ((int)0x80000800)   /* /< the signature of
+                                                         * the host data is not
+                                                         * HEADER_SIGNATURE */
+#define ERROR_SET_SCAN_MODE_FAIL    ((int)0x80000900)   /* /< setting the
+                                                         * scanning mode failed
+                                                         * (sense on/off etc...) */
+#define ERROR_SET_FEATURE_FAIL      ((int)0x80000A00)   /* /< setting a
+                                                         * specific feature
+                                                         * failed */
+#define ERROR_SYSTEM_RESET_FAIL     ((int)0x80000B00)   /* /< the comand
+                                                         * SYSTEM RESET
+                                                         * failed */
+#define ERROR_FLASH_NOT_READY       ((int)0x80000C00)   /* /< flash
+                                                         * status not
+                                                         * ready within
+                                                         * a timeout */
+#define ERROR_FW_VER_READ           ((int)0x80000D00)   /* /< unable to read
+                                                         * fw_vers or the
+                                                         * config_id */
+#define ERROR_GESTURE_ENABLE_FAIL   ((int)0x80000E00)   /* /< unable to
+                                                         * enable/disable the
+                                                         * gesture */
+#define ERROR_GESTURE_START_ADD     ((int)0x80000F00)   /* /< unable to start
+                                                         * add custom gesture */
+#define ERROR_GESTURE_FINISH_ADD    ((int)0x80001000)   /* /< unable to finish
+                                                         * to add custom gesture */
+#define ERROR_GESTURE_DATA_ADD      ((int)0x80001100)   /* /< unable to add
+                                                         * custom gesture data */
+#define ERROR_GESTURE_REMOVE        ((int)0x80001200)   /* /< unable to remove
+                                                         * custom gesture data */
+#define ERROR_FEATURE_ENABLE_DISABLE   ((int)0x80001300)/* /< unable to
+                                                         * enable/disable a
+                                                         * feature mode in the IC */
+#define ERROR_NOISE_PARAMETERS      ((int)0x80001400)   /* /< unable to
+                                                         * set/read noise
+                                                         * parameter in
+                                                         * the IC */
+#define ERROR_CH_LEN                ((int)0x80001500)   /* /< unable to read
+                                                         * the force and/or
+                                                         * sense length */
+/* THIRD LEVEL ERROR CODE */
+/** @defgroup third_level    Third Level Error Code
+  * @ingroup error_codes
+  * Errors related to logic operations in the IC which require more
+  * commands/steps or which are part of a more complex procedure
+  */
+#define ERROR_REQU_COMP_DATA        ((int)0x80010000)   /* /< compensation data
+                                                         * request failed */
+#define ERROR_REQU_DATA             ((int)0x80020000)   /* /< data request failed */
+#define ERROR_COMP_DATA_HEADER      ((int)0x80030000)   /* /< unable to retrieve
+                                                         * compensation data header */
+#define ERROR_COMP_DATA_GLOBAL      ((int)0x80040000)   /* /< unable to retrieve the
+                                                         * global compensation data */
+#define ERROR_COMP_DATA_NODE        ((int)0x80050000)   /* /< unable to retrieve
+                                                         * the compensation data
+                                                         * for each node */
+#define ERROR_TEST_CHECK_FAIL       ((int)0x80060000)   /* /< check of
+                                                         * production limits or
+                                                         * of fw answers failed */
+#define ERROR_MEMH_READ             ((int)0x80070000)   /* /< memh reading failed */
+#define ERROR_FLASH_BURN_FAILED     ((int)0x80080000)   /* /< flash burn failed */
+#define ERROR_MS_TUNING             ((int)0x80090000)   /* /< ms tuning failed */
+#define ERROR_SS_TUNING             ((int)0x800A0000)   /* /< ss tuning failed */
+#define ERROR_LP_TIMER_TUNING       ((int)0x800B0000)   /* /< lp timer calibration failed */
+#define ERROR_SAVE_CX_TUNING        ((int)0x800C0000)   /* /< save cx data to flash failed */
+#define ERROR_HANDLER_STOP_PROC     ((int)0x800D0000)   /* /< stop the poll of the FIFO if
+                                                         * particular errors are found */
+#define ERROR_CHECK_ECHO_FAIL       ((int)0x800E0000)   /* /< unable to retrieve echo event */
+#define ERROR_GET_FRAME             ((int)0x800F0000)   /* /< unable to get frame */
+
+/* FOURTH LEVEL ERROR CODE */
+/** @defgroup fourth_level    Fourth Level Error Code
+  * @ingroup error_codes
+  * Errors related to the highest logic operations in the IC which have an
+  * important impact on the driver flow or which require several commands and
+  * steps to be executed
+  */
+#define ERROR_PROD_TEST_DATA            ((int)0x81000000)    /* /< production  data test failed */
+#define ERROR_FLASH_PROCEDURE           ((int)0x82000000)    /* /< fw update procedure failed */
+#define ERROR_PROD_TEST_ITO             ((int)0x83000000)    /* /< production ito test failed */
+#define ERROR_PROD_TEST_INITIALIZATION  ((int)0x84000000)    /* /< production initialization test failed */
+#define ERROR_GET_INIT_STATUS           ((int)0x85000000)    /* /< mismatch of MS or SS tuning_version */
+/* end of error_commands section */
+
+/**
+  * Struct which store an ordered list of the errors events encountered during
+  * the polling of a FIFO.
+  * The max number of error events that can be stored is equal to FIFO_DEPTH
+  */
+typedef struct {
+    u8  list[FIFO_DEPTH * FIFO_EVENT_SIZE];    /* /< byte array which contains
+                                                * the series of error events
+                                                * encountered from the last
+                                                * reset of the list. */
+    int count;                                 /* /< number of error events stored in the list */
+    int last_index;                            /* /< index of the list where will be stored the next
+                                                * error event. Subtract -1 to have the index of the
+                                                * last error event! */
+} ErrorList;
+
+int isI2cError(int error);
+int dumpErrorInfo(u8 *outBuf, int size);
+int errorHandler(u8 *event, int size);
+int addErrorIntoList(u8 *event, int size);
+int getErrorListCount(void);
+int resetErrorList(void);
+int pollErrorList(int *event_to_search, int event_bytes);
+int pollForErrorType(u8 *list, int size);
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.c
new file mode 100644
index 0000000000000000000000000000000000000000..4f05dcc1f8d03e969fa0b9f26772b85a8d1aafe0
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.c
@@ -0,0 +1,903 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsFlash.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsFlash.c
+  * \brief Contains all the functions to handle the FW update process
+  */
+
+#include "ftsCore.h"
+#include "ftsCompensation.h"
+#include "ftsError.h"
+#include "ftsFlash.h"
+#include "ftsFrame.h"
+#include "ftsIO.h"
+#include "ftsSoftware.h"
+#include "ftsTest.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/serio.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include <linux/fs.h>
+#include <linux/uaccess.h>
+#include <linux/firmware.h>
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+extern SysInfo systemInfo;    /* /< forward declaration of the global variable
+                               *  of containing System Info Data */
+
+
+/**
+  * Retrieve the actual FW data from the system (bin file or header file)
+  * @param pathToFile name of FW file to load or "NULL" if the FW data should be
+  * loaded by a .h file
+  * @param data pointer to the pointer which will contains the FW data
+  * @param size pointer to a variable which will contain the size of the loaded
+  * data
+  * @return OK if success or an error code which specify the type of error
+  */
+int getFWdata(const char *pathToFile, u8 **data, int *size)
+{
+    const struct firmware *fw = NULL;
+    struct device *dev = NULL;
+    int res = 0;
+    char *path = (char *)pathToFile;
+
+    TPD_INFO("getFWdata starting ...\n");
+    /* keep the switch case because if the argument passed is null but
+     * the option from .h is not set we still try to load from bin */
+    TPD_INFO("Read FW from BIN file %s !\n", path);
+    dev = getDev();
+
+    if (dev != NULL) {
+        res = request_firmware(&fw, path, dev);
+        if (res == 0) {
+            *size = fw->size;
+            *data = (u8 *)kzalloc((*size) * sizeof(u8), GFP_KERNEL);
+            if (*data == NULL) {
+                TPD_INFO("getFWdata: Impossible to allocate memory! ERROR %08X\n",ERROR_ALLOC);
+                release_firmware(fw);
+                return ERROR_ALLOC;
+            }
+            memcpy(*data, (u8 *)fw->data, (*size));
+            release_firmware(fw);
+        } else {
+            TPD_INFO("getFWdata: No File found! ERROR %08X\n", ERROR_FILE_NOT_FOUND);
+            return ERROR_FILE_NOT_FOUND;
+        }
+    } else {
+        TPD_INFO("getFWdata: No device found! ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    TPD_INFO("getFWdata Finished!\n");
+    return OK;
+}
+
+
+/**
+  * Perform all the steps to read the FW that should be burnt in the IC from
+  * the system and parse it in order to fill a Firmware struct with the relevant
+  * info
+  * @param path name of FW file to load or "NULL" if the FW data should be
+  * loaded by a .h file
+  * @param fw pointer to a Firmware variable which will contains the FW data and
+  * info
+  * @param keep_cx if 1, the CX area will be loaded otherwise will be skipped
+  * @return OK if success or an error code which specify the type of error
+  */
+int readFwFile(const char *path, Firmware *fw, int keep_cx)
+{
+    int res;
+    int orig_size;
+    u8 *orig_data = NULL;
+
+
+    res = getFWdata(path, &orig_data, &orig_size);
+    if (res < OK) {
+        TPD_INFO("readFwFile: impossible retrieve FW... ERROR %08X\n", ERROR_MEMH_READ);
+        return res | ERROR_MEMH_READ;
+    }
+    res = parseBinFile(orig_data, orig_size, fw, keep_cx);
+    if (res < OK) {
+        TPD_INFO("readFwFile: impossible parse ERROR %08X\n", ERROR_MEMH_READ);
+        return res | ERROR_MEMH_READ;
+    }
+
+    return OK;
+}
+
+/**
+  * Perform all the steps necessary to burn the FW into the IC
+  * @param path name of FW file to load or "NULL" if the FW data should be
+  * loaded by a .h file
+  * @param force if 1, the flashing procedure will be forced and executed
+  * regardless the additional info, otherwise the FW in the file will be burnt
+  * only if it is newer than the one running in the IC
+  * @param keep_cx if 1, the CX area will be loaded and burnt otherwise will be
+  * skipped and the area will be untouched
+  * @return OK if success or an error code which specify the type of error
+  */
+int flashProcedure(const char *path, int force, int keep_cx)
+{
+    Firmware fw;
+    int res;
+
+    fw.data = NULL;
+
+    TPD_DEBUG("Reading Fw file...\n");
+    res = readFwFile(path, &fw, keep_cx);
+    if (res < OK) {
+        TPD_INFO("flashProcedure: ERROR %08X\n", (res | ERROR_FLASH_PROCEDURE));
+        if(fw.data != NULL)
+            kfree(fw.data);
+        return res | ERROR_FLASH_PROCEDURE;
+    }
+    TPD_DEBUG("Fw file read COMPLETED!\n");
+
+    TPD_DEBUG("Starting flashing procedure...\n");
+    res = flash_burn(fw, force, keep_cx);
+    if (res < OK && res != (ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED)) {
+        TPD_INFO("flashProcedure: ERROR %08X\n", ERROR_FLASH_PROCEDURE);
+        if(fw.data != NULL)
+            kfree(fw.data);
+        return res | ERROR_FLASH_PROCEDURE;
+    }
+    TPD_DEBUG("flashing procedure Finished!\n");
+
+    if(fw.data != NULL)
+        kfree(fw.data);
+
+    return res;
+}
+
+/**
+  * Poll the Flash Status Registers after the execution of a command to check
+  * if the Flash becomes ready within a timeout
+  * @param type register to check according to the previous command sent
+  * @return OK if success or an error code which specify the type of error
+  */
+int wait_for_flash_ready(u8 type)
+{
+    u8 cmd[5] = { FTS_CMD_HW_REG_R, 0x20, 0x00, 0x00, type };
+
+    u8 readData[2] = { 0 };
+    int i, res = -1;
+
+    TPD_DEBUG("Waiting for flash ready ...\n");
+    for (i = 0; i < FLASH_RETRY_COUNT && res != 0; i++) {
+        res = fts_writeRead(cmd, ARRAY_SIZE(cmd), readData, 2);
+        if (res < OK)
+            TPD_INFO("wait_for_flash_ready: ERROR %08X\n", ERROR_BUS_W);
+        else {
+            res = readData[0] & 0x80;
+            TPD_DEBUG("flash status = %d\n", res);
+        }
+        msleep(FLASH_WAIT_BEFORE_RETRY);
+    }
+
+    if (i == FLASH_RETRY_COUNT && res != 0) {
+        TPD_INFO("Wait for flash TIMEOUT! ERROR %08X\n", ERROR_TIMEOUT);
+        return ERROR_TIMEOUT;
+    }
+
+    TPD_DEBUG("Flash READY!\n");
+    return OK;
+}
+
+/**
+  * Put the M3 in hold
+  * @return OK if success or an error code which specify the type of error
+  */
+int hold_m3(void)
+{
+    int ret;
+    u8 cmd[1] = { 0x01 };
+
+    TPD_DEBUG("Command m3 hold...\n");
+    ret = fts_writeU8UX(FTS_CMD_HW_REG_W, ADDR_SIZE_HW_REG, ADDR_SYSTEM_RESET, cmd, 1);
+    if (ret < OK) {
+        TPD_INFO("hold_m3: ERROR %08X\n", ret);
+        return ret;
+    }
+    TPD_DEBUG("Hold M3 DONE!\n");
+
+    return OK;
+}
+
+/**
+  * Parse the raw data read from a FW file in order to fill properly the fields
+  * of a Firmware variable
+  * @param fw_data raw FW data loaded from system
+  * @param fw_size size of fw_data
+  * @param fwData pointer to a Firmware variable which will contain the
+  * processed data
+  * @param keep_cx if 1, the CX area will be loaded and burnt otherwise will be
+  * skipped and the area will be untouched
+  * @return OK if success or an error code which specify the type of error
+  */
+int parseBinFile(u8 *fw_data, int fw_size, Firmware *fwData, int keep_cx)
+{
+    int dimension, index = 0;
+    u32 temp;
+    int res, i;
+
+    /* the file should contain at least the header plus the content_crc */
+    if (fw_size < FW_HEADER_SIZE + FW_BYTES_ALLIGN || fw_data == NULL) {
+        TPD_INFO("parseBinFile: Read only %d instead of %d... ERROR %08X\n", fw_size, FW_HEADER_SIZE + FW_BYTES_ALLIGN, ERROR_FILE_PARSE);
+        res = ERROR_FILE_PARSE;
+        goto END;
+    } else {
+        /* start parsing of bytes */
+        u8ToU32(&fw_data[index], &temp);
+        if (temp != FW_HEADER_SIGNATURE) {
+            TPD_INFO("parseBinFile: Wrong Signature %08X ... ERROR %08X\n", temp, ERROR_FILE_PARSE);
+            res = ERROR_FILE_PARSE;
+            goto END;
+        }
+        TPD_DEBUG("parseBinFile: Fw Signature OK!\n");
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        if (temp != FW_FTB_VER) {
+            TPD_INFO("parseBinFile: Wrong ftb_version %08X ... ERROR %08X\n", temp, ERROR_FILE_PARSE);
+            res = ERROR_FILE_PARSE;
+            goto END;
+        }
+        TPD_DEBUG("parseBinFile: ftb_version OK!\n");
+        index += FW_BYTES_ALLIGN;
+        if (fw_data[index] != DCHIP_ID_0 || fw_data[index + 1] != DCHIP_ID_1) {
+            TPD_INFO("parseBinFile: Wrong target %02X != %02X  %02X != %02X ... ERROR %08X\n", fw_data[index], DCHIP_ID_0, fw_data[index + 1], DCHIP_ID_1, ERROR_FILE_PARSE);
+            res = ERROR_FILE_PARSE;
+            goto END;
+        }
+		if((fw_data[FW_ORG_INFO_OFFSET] == 0x00) && (fw_data[FW_ORG_INFO_OFFSET+1] == 0x00) &&
+			(fw_data[FW_ORG_INFO_OFFSET+2] == 0x00) && (fw_data[FW_ORG_INFO_OFFSET+3] == 0x00)){
+			fwData->flash_org_info[0]= FLASH_FW_CODE_COUNT;
+			fwData->flash_org_info[1]= FLASH_PANEL_CFG_COUNT;
+			fwData->flash_org_info[2]= FLASH_CX_CFG_COUNT;
+			fwData->flash_org_info[3]= FLASH_FW_CFG_COUNT;
+
+		}else{
+			for (i = 0; i < 4; i++) {
+				fwData->flash_org_info[i] = fw_data[FW_ORG_INFO_OFFSET+i];
+			}
+
+		}
+		 TPD_INFO("parseBinFile: Flash Organization Info fw_code:%02X,panel_cfg:%02X,cx_cfg:%02X,fw_cfg:%02X\n",
+		 	fwData->flash_org_info[0],fwData->flash_org_info[1],fwData->flash_org_info[2],fwData->flash_org_info[3]);
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        TPD_INFO("parseBinFile: FILE SVN REV = %08X\n", temp);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        fwData->fw_ver = temp;
+        TPD_INFO("parseBinFile: FILE Fw Version = %04X\n", fwData->fw_ver);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        fwData->config_id = temp;
+        TPD_INFO("parseBinFile: FILE Config Project ID = %08X\n", temp);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        TPD_INFO("parseBinFile: FILE Config Version = %08X\n", temp);
+
+        index += FW_BYTES_ALLIGN * 2;    /* skip reserved data */
+
+        index += FW_BYTES_ALLIGN;
+        TPD_INFO("parseBinFile: File External Release =  ");
+        for (i = 0; i < EXTERNAL_RELEASE_INFO_SIZE; i++) {
+            fwData->externalRelease[i] = fw_data[index++];
+            TPD_INFO( "%02X ", fwData->externalRelease[i]);
+        }
+        TPD_INFO( "\n");
+
+        /* index+=FW_BYTES_ALLIGN; */
+        u8ToU32(&fw_data[index], &temp);
+        fwData->sec0_size = temp;
+        TPD_INFO("parseBinFile:  sec0_size = %08X (%d bytes)\n", fwData->sec0_size, fwData->sec0_size);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        fwData->sec1_size = temp;
+        TPD_INFO("parseBinFile:  sec1_size = %08X (%d bytes)\n", fwData->sec1_size, fwData->sec1_size);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        fwData->sec2_size = temp;
+        TPD_INFO("parseBinFile:  sec2_size = %08X (%d bytes)\n", fwData->sec2_size, fwData->sec2_size);
+
+        index += FW_BYTES_ALLIGN;
+        u8ToU32(&fw_data[index], &temp);
+        fwData->sec3_size = temp;
+        TPD_INFO("parseBinFile:  sec3_size = %08X (%d bytes)\n", fwData->sec3_size, fwData->sec3_size);
+
+        index += FW_BYTES_ALLIGN;/* skip header crc */
+
+        dimension = fwData->sec0_size + fwData->sec1_size + fwData->sec2_size + fwData->sec3_size;
+        temp = fw_size;
+
+        if (dimension + FW_HEADER_SIZE + FW_BYTES_ALLIGN != temp) {
+            TPD_INFO("parseBinFile: Read only %d instead of %d... ERROR %08X\n", fw_size, dimension + FW_HEADER_SIZE +
+                 FW_BYTES_ALLIGN, ERROR_FILE_PARSE);
+            res = ERROR_FILE_PARSE;
+            goto END;
+        }
+
+        fwData->data = (u8 *)kzalloc(dimension * sizeof(u8), GFP_KERNEL);
+        if (fwData->data == NULL) {
+            TPD_INFO("parseBinFile: ERROR %08X\n", ERROR_ALLOC);
+            res = ERROR_ALLOC;
+            goto END;
+        }
+
+        index += FW_BYTES_ALLIGN;
+        memcpy(fwData->data, &fw_data[index], dimension);
+        if (fwData->sec2_size != 0)
+            u8ToU16(&fwData->data[fwData->sec0_size + fwData->sec1_size + FW_CX_VERSION], &fwData->cx_ver);
+        else {
+            TPD_INFO("parseBinFile: Initialize cx_ver to default value!\n");
+            fwData->cx_ver = systemInfo.u16_cxVer;
+        }
+
+        TPD_INFO("parseBinFile: CX Version = %04X\n", fwData->cx_ver);
+
+        fwData->data_size = dimension;
+
+        TPD_DEBUG("READ FW DONE %d bytes!\n", fwData->data_size);
+        res = OK;
+        goto END;
+    }
+
+END:
+    kfree(fw_data);
+    return res;
+}
+
+/**
+  * Enable UVLO and Auto Power Down Mode
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_enable_uvlo_autopowerdown(void)
+{
+	u8 cmd[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_UVLO_ENABLE_CODE0,
+			FLASH_UVLO_ENABLE_CODE1 };
+	u8 cmd1[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_AUTOPOWERDOWN_ENABLE_CODE0,
+			FLASH_AUTOPOWERDOWN_ENABLE_CODE1 };
+	TPD_INFO("%s Command enable uvlo ...\n", __func__);
+	if (fts_write(cmd, ARRAY_SIZE(cmd)) < OK) {
+		TPD_INFO("%s flash_enable_uvlo_autopowerdown: ERROR %08X\n", __func__, ERROR_BUS_W);
+		return ERROR_BUS_W;
+	}
+	if (fts_write(cmd1, ARRAY_SIZE(cmd1)) < OK) {
+		TPD_INFO("%s flash_enable_uvlo_autopowerdown: ERROR %08X\n", __func__, ERROR_BUS_W);
+		return ERROR_BUS_W;
+	}
+	TPD_INFO("%s Enable uvlo and flash auto power down  DONE!\n", __func__);
+	return OK;
+}
+/**
+  * Unlock the flash to be programmed
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_unlock(void)
+{
+    u8 cmd[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_UNLOCK_CODE0,
+              FLASH_UNLOCK_CODE1 };
+
+	u8 cmd1[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_UNLOCK_CODE2,
+		      FLASH_UNLOCK_CODE3 };
+    TPD_DEBUG("Command unlock ...\n");
+    if (fts_write(cmd, ARRAY_SIZE(cmd)) < OK) {
+        TPD_INFO("flash_unlock: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+	if (fts_write(cmd1, ARRAY_SIZE(cmd1)) < OK) {
+		TPD_DEBUG("%s Command unlock: ERROR %08X\n", __func__, ERROR_BUS_W);
+		return ERROR_BUS_W;
+	}
+    TPD_DEBUG("Unlock flash DONE!\n");
+
+    return OK;
+}
+
+/**
+  * Unlock the flash to be erased
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_erase_unlock(void)
+{
+    u8 cmd[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00,0x00, FLASH_ERASE_UNLOCK_CODE0, FLASH_ERASE_UNLOCK_CODE1 };
+
+    TPD_DEBUG("Try to erase unlock flash...\n");
+
+    TPD_DEBUG("Command erase unlock ...\n");
+    if (fts_write(cmd, ARRAY_SIZE(cmd)) < 0) {
+        TPD_INFO("flash_erase_unlock: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    TPD_DEBUG("Erase Unlock flash DONE!\n");
+
+    return OK;
+}
+
+/**
+  * Erase the full flash
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_full_erase(void)
+{
+    int status;
+
+    u8 cmd1[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_ERASE_CODE0 + 1, 0x00 };
+    u8 cmd[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_ERASE_CODE0, FLASH_ERASE_CODE1 };
+
+    if (fts_write(cmd1, ARRAY_SIZE(cmd1)) < OK) {
+        TPD_INFO("flash_erase_page_by_page: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+
+    TPD_DEBUG("Command full erase sent ...\n");
+    if (fts_write(cmd, ARRAY_SIZE(cmd)) < OK) {
+        TPD_INFO("flash_full_erase: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    status = wait_for_flash_ready(FLASH_ERASE_CODE0);
+
+    if (status != OK) {
+        TPD_INFO("flash_full_erase: ERROR %08X\n", ERROR_FLASH_NOT_READY);
+        return status | ERROR_FLASH_NOT_READY;
+        /* Flash not ready within the chosen time, better exit! */
+    }
+
+    TPD_DEBUG("Full Erase flash DONE!\n");
+
+    return OK;
+}
+
+/**
+  * Erase the flash page by page, giving the possibility to skip the CX area and
+  * maintain therefore its value
+  * @param keep_cx if SKIP_PANEL_INIT the Panel Init pages will be skipped,
+  * if > SKIP_PANEL_CX_INIT Cx and Panel Init pages otherwise all the pages will
+  * be deleted
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_erase_page_by_page(Firmware fw,ErasePage keep_cx)
+{
+    u8 status, i = 0;
+    u8 cmd1[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_ERASE_CODE0 + 1, 0x00 };
+    u8 cmd[6] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x00, FLASH_ERASE_CODE0, 0xA0 };
+    u8 cmd2[9] = { FTS_CMD_HW_REG_W, 0x20, 0x00, 0x01, 0x28, 0xFF, 0xFF, 0xFF, 0xFF };
+    u8 mask[4] = { 0 };
+	int start=0,end=0;
+	
+	start = (int)(fw.flash_org_info[0]+fw.flash_org_info[1]);
+	end = (int)(fw.flash_org_info[0]+fw.flash_org_info[1] + fw.flash_org_info[2]) ;
+
+	 TPD_INFO("%s Cx page start:%d end:%d\n",__func__,start,end-1);
+    for (i = start; i < end && keep_cx >= SKIP_PANEL_CX_INIT; i++) {
+        TPD_DEBUG("Skipping erase CX page %d!\n", i);
+        fromIDtoMask(i, mask, 4);
+    }
+	start = (int)(fw.flash_org_info[0]);
+	end = (int)(fw.flash_org_info[0]+fw.flash_org_info[1]);
+	TPD_INFO("%s Panel Configuration page start:%d end:%d\n",__func__,start,end-1);
+    for (i = start; i < end && keep_cx >= SKIP_PANEL_INIT; i++) {
+        TPD_DEBUG("Skipping erase Panel Init page %d!\n", i);
+        fromIDtoMask(i, mask, 4);
+    }
+
+    TPD_DEBUG("Setting the page mask = ");
+    for (i = 0; i < 4; i++) {
+        cmd2[5 + i] = cmd2[5 + i] & (~mask[i]);
+        TPD_DEBUG( "%02X ", cmd2[5 + i]);
+    }
+
+    TPD_DEBUG( "\nWriting page mask...\n");
+    if (fts_write(cmd2, ARRAY_SIZE(cmd2)) < OK) {
+        TPD_INFO("flash_erase_page_by_page: Page mask ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    if (fts_write(cmd1, ARRAY_SIZE(cmd1)) < OK) {
+        TPD_INFO("flash_erase_page_by_page: Disable info ERROR %08X\n",ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    TPD_DEBUG("Command erase pages sent ...\n");
+    if (fts_write(cmd, ARRAY_SIZE(cmd)) < OK) {
+        TPD_INFO("flash_erase_page_by_page: Erase ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    status = wait_for_flash_ready(FLASH_ERASE_CODE0);
+
+    if (status != OK) {
+        TPD_INFO("flash_erase_page_by_page: ERROR %08X\n", ERROR_FLASH_NOT_READY);
+        return status | ERROR_FLASH_NOT_READY;
+        /* Flash not ready within the chosen time, better exit! */
+    }
+
+    TPD_DEBUG("Erase flash page by page DONE!\n");
+
+    return OK;
+}
+
+
+/**
+  * Start the DMA procedure which actually transfer and burn the data loaded
+  * from memory into the Flash
+  * @return OK if success or an error code which specify the type of error
+  */
+int start_flash_dma(void)
+{
+    int status;
+	u8 cmd[12] = { FLASH_CMD_WRITE_REGISTER, 0x20, 0x00, 0x00,
+		      0x6B, 0x00, 0x40, 0x42, 0x0F, 0x00, 0x00,	FLASH_DMA_CODE1 };
+
+    /* write the command to erase the flash */
+    TPD_DEBUG("Command flash DMA ...\n");
+    if (fts_write(cmd, ARRAY_SIZE(cmd)) < OK) {
+        TPD_INFO("start_flash_dma: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+
+    status = wait_for_flash_ready(FLASH_DMA_CODE0);
+
+    if (status != OK) {
+        TPD_INFO("start_flash_dma: ERROR %08X\n", ERROR_FLASH_NOT_READY);
+        return status | ERROR_FLASH_NOT_READY;
+        /* Flash not ready within the chosen time, better exit! */
+    }
+
+    TPD_DEBUG("flash DMA DONE!\n");
+
+    return OK;
+}
+
+/**
+  * Copy the FW data that should be burn in the Flash into the memory and then
+  * the DMA will take care about burning it into the Flash
+  * @param address address in memory where to copy the data, possible values
+  * are FLASH_ADDR_CODE, FLASH_ADDR_CONFIG, FLASH_ADDR_CX
+  * @param data pointer to an array of byte which contain the data that should
+  * be copied into the memory
+  * @param size size of data
+  * @return OK if success or an error code which specify the type of error
+  */
+int fillFlash(u32 address, u8 *data, int size)
+{
+    int remaining = size, index = 0;
+    int toWrite = 0;
+    int byteBlock = 0;
+    int wheel = 0;
+    u32 addr = 0;
+    int res;
+    int delta;
+    u8 *buff = NULL;
+    u8 buff2[12] = { 0 };
+
+    buff = (u8 *)kzalloc((DMA_CHUNK + 5) * sizeof(u8), GFP_KERNEL);
+    if (buff == NULL) {
+        TPD_INFO("fillFlash: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    while (remaining > 0) {
+        byteBlock = 0;
+
+        addr = 0x00100000;
+
+        while (byteBlock < FLASH_CHUNK && remaining > 0) {
+            index = 0;
+            if (remaining >= DMA_CHUNK) {
+                if ((byteBlock + DMA_CHUNK) <= FLASH_CHUNK) {
+                    toWrite = DMA_CHUNK;
+                    remaining -= DMA_CHUNK;
+                    byteBlock += DMA_CHUNK;
+                } else {
+                    delta = FLASH_CHUNK - byteBlock;
+                    toWrite = delta;
+                    remaining -= delta;
+                    byteBlock += delta;
+                }
+            } else {
+                if ((byteBlock + remaining) <= FLASH_CHUNK) {
+                    toWrite = remaining;
+                    byteBlock += remaining;
+                    remaining = 0;
+                } else {
+                    delta = FLASH_CHUNK - byteBlock;
+                    toWrite = delta;
+                    remaining -= delta;
+                    byteBlock += delta;
+                }
+            }
+
+
+            buff[index++] = FTS_CMD_HW_REG_W;
+            buff[index++] = (u8)((addr & 0xFF000000) >> 24);
+            buff[index++] = (u8)((addr & 0x00FF0000) >> 16);
+            buff[index++] = (u8)((addr & 0x0000FF00) >> 8);
+            buff[index++] = (u8)(addr & 0x000000FF);
+
+            memcpy(&buff[index], data, toWrite);
+            /* TPD_DEBUG("Command = %02X , address = %02X %02X
+             * , bytes = %d, data =  %02X %02X, %02X %02X\n",
+             * buff[0], buff[1], buff[2], toWrite, buff[3],
+             * buff[4], buff[3 + toWrite-2],
+             * buff[3 + toWrite-1]); */
+            if (fts_write(buff, index + toWrite) < OK) {
+                TPD_INFO("fillFlash: ERROR %08X\n", ERROR_BUS_W);
+                kfree(buff);
+                return ERROR_BUS_W;
+            }
+
+            /* msleep(10); */
+            addr += toWrite;
+            data += toWrite;
+        }
+
+        /* configuring the DMA */
+        byteBlock = byteBlock / 4 - 1;
+        index = 0;
+
+        buff2[index++] = FLASH_CMD_WRITE_REGISTER;
+        buff2[index++] = 0x20;
+        buff2[index++] = 0x00;
+        buff2[index++] = 0x00;
+        buff2[index++] = FLASH_DMA_CONFIG;
+        buff2[index++] = 0x00;
+        buff2[index++] = 0x00;
+
+        addr = address + ((wheel * FLASH_CHUNK) / 4);
+        buff2[index++] = (u8)((addr & 0x000000FF));
+        buff2[index++] = (u8)((addr & 0x0000FF00) >> 8);
+        buff2[index++] = (u8)(byteBlock & 0x000000FF);
+        buff2[index++] = (u8)((byteBlock & 0x0000FF00) >> 8);
+        buff2[index++] = 0x00;
+
+        TPD_DEBUG("DMA Command = %02X , address = %02X %02X, words =  %02X %02X\n",buff2[0], buff2[8], buff2[7], buff2[10], buff2[9]);
+
+        if (fts_write(buff2, index) < OK) {
+            TPD_INFO(" Error during filling Flash! ERROR %08X\n", ERROR_BUS_W);
+            kfree(buff);
+            return ERROR_BUS_W;
+        }
+
+        res = start_flash_dma();
+        if (res < OK) {
+            TPD_INFO("Error during flashing DMA! ERROR %08X\n", res);
+            kfree(buff);
+            return res;
+        }
+        wheel++;
+    }
+    kfree(buff);
+    return OK;
+}
+
+
+/**
+  * Execute the procedure to burn a FW in FTM4/FTI IC
+  * @param fw structure which contain the FW to be burnt
+  * @param force_burn if >0, the flashing procedure will be forced and executed
+  * regardless the additional info, otherwise the FW in the file will be burnt
+  * only if it is newer than the one running in the IC
+  * @param keep_cx if 1, the function preserve the CX/Panel Init area otherwise
+  * will be cleared
+  * @return OK if success or an error code which specify the type of error
+  */
+int flash_burn(Firmware fw, int force_burn, int keep_cx)
+{
+    int res;
+	u32 addr_cx =0x00;
+	u32 addr_config =0x00;
+
+    if (!force_burn) {
+        for (res = EXTERNAL_RELEASE_INFO_SIZE - 1; res >= 0; res--)
+            if (fw.externalRelease[res] > systemInfo.u8_releaseInfo[res])
+                goto start;
+        TPD_INFO("flash_burn: Firmware in the chip matches(or later) the firmware to flash! NO UPDATE ERROR %08X\n",ERROR_FW_NO_UPDATE);
+        return ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED;
+    } else {
+        /* burn procedure to update the CX memory, if not present just
+         * skip it if there isn't a new fw release. */
+        if (force_burn == CRC_CX && fw.sec2_size == 0) {
+            for (res = EXTERNAL_RELEASE_INFO_SIZE - 1; res >= 0; res--) {
+                if (fw.externalRelease[res] > systemInfo.u8_releaseInfo[res]) {
+                    force_burn = 0;
+                /* Avoid loading the CX because it is missing
+                  * in the bin file, it just need to update
+                  * to last fw+cfg because a new release */
+                    goto start;
+                }
+            }
+        TPD_INFO("flash_burn: CRC in CX but fw does not contain CX data! NO UPDATE ERROR %08X\n",ERROR_FW_NO_UPDATE);
+        return ERROR_FW_NO_UPDATE | ERROR_FLASH_BURN_FAILED;
+        }
+    }
+
+    /* programming procedure start */
+start:
+    TPD_DEBUG("Programming Procedure for flashing started:\n\n");
+	addr_config = (u32)((fw.flash_org_info[0] + fw.flash_org_info[1] +fw.flash_org_info[2])*0x400);
+	addr_cx = (u32)((fw.flash_org_info[0] + fw.flash_org_info[1])*0x400);
+	TPD_INFO("FTS The addr config:0X%X,CX:0X%X\n",addr_config,addr_cx);
+
+    TPD_DEBUG("1) SYSTEM RESET:\n");
+    res = fts_system_reset();
+    if (res < 0) {
+        TPD_INFO("system reset FAILED!\n");
+        /* If there is no firmware, there is no controller ready event
+          * and there will be a timeout, we can keep going. But if
+          * there is an I2C error, we must exit.
+          */
+        if (res != (ERROR_SYSTEM_RESET_FAIL | ERROR_TIMEOUT))
+            return res | ERROR_FLASH_BURN_FAILED;
+    } else
+        TPD_DEBUG("system reset COMPLETED!\n\n");
+
+    msleep(100); /* required by hw during flash procedure */
+
+    TPD_DEBUG("2) HOLD M3 :\n");
+    res = hold_m3();
+    if (res < OK) {
+        TPD_INFO("hold_m3 FAILED!\n");
+        return res | ERROR_FLASH_BURN_FAILED;
+    } else
+        TPD_DEBUG("hold_m3 COMPLETED!\n\n");
+
+
+	TPD_INFO("%s 3) ENABLE UVLO AND AUTO POWER DOWN MODE :\n", __func__);
+	res = flash_enable_uvlo_autopowerdown();
+	if (res < OK) {
+		TPD_DEBUG("%s    flash_enable_uvlo_autopowerdown FAILED!\n", __func__);
+		return res | ERROR_FLASH_BURN_FAILED;
+	} else
+		TPD_DEBUG("%s    flash_enable_uvlo_autopowerdown COMPLETED!\n\n", __func__);
+
+	TPD_DEBUG("%s 4) FLASH UNLOCK:\n", __func__);
+    res = flash_unlock();
+    if (res < OK) {
+        TPD_INFO("flash unlock FAILED! ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    } else
+        TPD_DEBUG("flash unlock COMPLETED!\n\n");
+
+
+	TPD_DEBUG("%s 5) FLASH ERASE UNLOCK:\n", __func__);
+    res = flash_erase_unlock();
+    if (res < 0) {
+        TPD_INFO("  flash unlock FAILED! ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    } else
+        TPD_DEBUG("flash unlock COMPLETED!\n\n");
+
+	TPD_DEBUG("%s 6) FLASH ERASE:\n", __func__);
+    if (keep_cx > 0) {
+        if (fw.sec2_size != 0 && force_burn == CRC_CX)
+            res = flash_erase_page_by_page(fw,SKIP_PANEL_INIT);
+        else
+            res = flash_erase_page_by_page(fw,SKIP_PANEL_CX_INIT);
+    } else {
+        /* res = flash_full_erase(); */
+        res = flash_erase_page_by_page(fw,SKIP_PANEL_INIT);
+        if (fw.sec2_size == 0)
+            TPD_INFO("WARNING!!! Erasing CX memory but no CX in fw file! touch will not work right after fw update!\n");
+    }
+
+    if (res < OK) {
+        TPD_INFO("flash erase FAILED! ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    } else
+        TPD_DEBUG("flash erase COMPLETED!\n\n");
+
+	TPD_DEBUG("%s 7) LOAD PROGRAM:\n", __func__);
+	
+    res = fillFlash(FLASH_ADDR_CODE, &fw.data[0], fw.sec0_size);
+    if (res < OK) {
+        TPD_INFO("load program ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    }
+    TPD_INFO("load program DONE!\n");
+
+	TPD_DEBUG("%s 8) LOAD CONFIG:\n", __func__);
+    res = fillFlash(addr_config, &(fw.data[fw.sec0_size]), fw.sec1_size);
+    if (res < OK) {
+        TPD_INFO("load config ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    }
+    TPD_INFO("load config DONE!\n");
+
+    if (fw.sec2_size != 0 && (force_burn == CRC_CX || keep_cx <= 0)) {
+		TPD_DEBUG("%s 8.1) LOAD CX:\n", __func__);
+        res = fillFlash(addr_cx, &(fw.data[fw.sec0_size + fw.sec1_size]), fw.sec2_size);
+        if (res < OK) {
+            TPD_INFO("load cx ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+            return res | ERROR_FLASH_BURN_FAILED;
+        }
+        TPD_INFO("load cx DONE!\n");
+    }
+
+    TPD_DEBUG("Flash burn COMPLETED!\n\n");
+
+	TPD_DEBUG("%s 9) SYSTEM RESET:\n", __func__);
+    res = fts_system_reset();
+    if (res < 0) {
+        TPD_INFO("system reset FAILED! ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    }
+    TPD_DEBUG("system reset COMPLETED!\n\n");
+
+
+	TPD_DEBUG("%s 10) FINAL CHECK:\n", __func__);
+    res = readSysInfo(0);
+    if (res < 0) {
+        TPD_INFO("flash_burn: Unable to retrieve Chip INFO! ERROR %08X\n", ERROR_FLASH_BURN_FAILED);
+        return res | ERROR_FLASH_BURN_FAILED;
+    }
+
+    for (res = 0; res < EXTERNAL_RELEASE_INFO_SIZE; res++) {
+        if (fw.externalRelease[res] != systemInfo.u8_releaseInfo[res]) {
+            /* External release is printed during readSysInfo */
+            TPD_INFO("Firmware in the chip different from the one that was burn!\n");
+            return ERROR_FLASH_BURN_FAILED;
+        }
+    }
+
+    TPD_DEBUG("Final check OK!\n");
+
+    return OK;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.h
new file mode 100644
index 0000000000000000000000000000000000000000..c91cd1fd808ef5c83373ff3c29a918b5ff6a21b2
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFlash.h
@@ -0,0 +1,90 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsFlash.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsFlash.h
+  * \brief Contains all the definitions and structs to handle the FW update
+  * process
+  */
+
+#ifndef FTS_FLASH_H
+#define FTS_FLASH_H
+
+#include "ftsSoftware.h"
+
+/* Flash possible status */
+#define FLASH_READY         0   /* /< value to indicate that the flash
+                                 * is ready */
+#define FLASH_BUSY          1   /* /< value to indicate that the flash
+                                 * is busy */
+#define FLASH_UNKNOWN      -1   /* /< value to indicate an unknown
+                                 * status of the flash */
+
+#define FLASH_STATUS_BYTES  1   /* /< number of bytes to check for read
+                                 * the flash status */
+
+/* Flash timing parameters */
+#define FLASH_RETRY_COUNT       200     /* /< number of attemps to read the
+                                         * flash status */
+#define FLASH_WAIT_BEFORE_RETRY 50      /* /< time to wait in ms between status readings */
+
+#define FLASH_CHUNK             (64 * 1024)    /* /< Max number of bytes that
+                                                * the DMA can burn on the flash
+                                                * in one shot in FTI */
+#define DMA_CHUNK               32      /* /< Max number of bytes that can be
+                                         * written in I2C to the DMA */
+
+/**
+  * Define which kind of erase page by page should be performed
+  */
+typedef enum {
+    ERASE_ALL               = 0,    /* /< erase all the pages */
+    SKIP_PANEL_INIT         = 1,    /* /< skip erase Panel Init Pages */
+    SKIP_PANEL_CX_INIT      = 2     /* /< skip erase Panel Init and CX Pages */
+} ErasePage;
+
+/**
+  * Struct which contains information and data of the FW that should be burnt
+  *into the IC
+  */
+typedef struct {
+    u8  *data;      /* /< pointer to an array of bytes which represent the FW data */
+    u16 fw_ver;     /* /< FW version of the FW file */
+    u16 config_id;  /* /< Config ID of the FW file */
+    u16 cx_ver;     /* /< Cx version of the FW file */
+	u8 flash_org_info[4]; //Flash Organization Information
+    u8	externalRelease[EXTERNAL_RELEASE_INFO_SIZE];    /* /< External Release  Info of the FW file */
+    int data_size;    /* /< dimension of data (the actual data to be burnt) */
+    u32 sec0_size;    /* /< dimension of section 0 (FW) in .ftb file */
+    u32 sec1_size;    /* /< dimension of section 1 (Config) in .ftb file */
+    u32 sec2_size;    /* /< dimension of section 2 (Cx) in .ftb file */
+    u32 sec3_size;    /* /< dimension of section 3 (TBD) in .ftb file */
+} Firmware;
+
+int wait_for_flash_ready(u8 type);
+int hold_m3(void);
+int flash_erase_unlock(void);
+int flash_full_erase(void);
+int flash_erase_page_by_page(Firmware fw,ErasePage keep_cx);
+int start_flash_dma(void);
+int fillFlash(u32 address, u8 *data, int size);
+
+int flash_unlock(void);
+int getFWdata(const char *pathToFile, u8 **data, int *size);
+int parseBinFile(u8 *fw_data, int fw_size, Firmware *fw, int keep_cx);
+int readFwFile(const char *path, Firmware *fw, int keep_cx);
+int flash_burn(Firmware fw, int force_burn, int keep_cx);
+int flashProcedure(const char *path, int force, int keep_cx);
+int flash_enable_uvlo_autopowerdown(void);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.c
new file mode 100644
index 0000000000000000000000000000000000000000..b742913ecfd59919a35ba33a349d505ff3f637f5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.c
@@ -0,0 +1,635 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsFrame.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsFrame.c
+  * \brief Contains all the functions to work with frames
+  */
+
+#include "ftsCompensation.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsFrame.h"
+#include "ftsHardware.h"
+#include "ftsIO.h"
+#include "ftsSoftware.h"
+#include "ftsTool.h"
+#include "ftsTime.h"
+
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/serio.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+extern SysInfo systemInfo;      /* /< forward declaration of the global variable
+                                 * of containing System Info Data */
+
+/**
+  * Read the channels lengths from the config memory
+  * @return OK if success or an error code which specify the type of error
+  */
+int getChannelsLength(void)
+{
+    int ret;
+    u8 data[2];
+
+    ret = readConfig(ADDR_CONFIG_SENSE_LEN, data, 2);
+    if (ret < OK) {
+        TPD_INFO("getChannelsLength: ERROR %08X\n", ret);
+
+        return ret;
+    }
+
+    systemInfo.u8_scrRxLen = (int)data[0];
+    systemInfo.u8_scrTxLen = (int)data[1];
+
+    TPD_DEBUG("Force_len = %d   Sense_Len = %d\n", systemInfo.u8_scrTxLen, systemInfo.u8_scrRxLen);
+
+    return OK;
+}
+
+
+
+/**
+  * Read and pack the frame data related to the nodes
+  * @param address address in memory when the frame data node start
+  * @param size amount of data to read
+  * @param frame pointer to an array of bytes which will contain the frame node
+  * data
+  * @return OK if success or an error code which specify the type of error
+  */
+int getFrameData(u16 address, int size, short *frame)
+{
+    int i, j, ret;
+    u8 *data = (u8 *)kzalloc(size * sizeof(u8), GFP_KERNEL);
+
+    if (data == NULL) {
+        TPD_INFO("getFrameData: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, data, size, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {
+        TPD_INFO("getFrameData: ERROR %08X\n", ERROR_BUS_R);
+        kfree(data);
+        return ERROR_BUS_R;
+    }
+    j = 0;
+    for (i = 0; i < size; i += 2) {
+        frame[j] = (short)((data[i + 1] << 8) + data[i]);
+        j++;
+    }
+    kfree(data);
+    return OK;
+}
+
+
+/**
+  * Return the number of Sense Channels (Rx)
+  * @return number of Rx channels
+  */
+int getSenseLen(void)
+{
+    if (systemInfo.u8_scrRxLen == 0)
+        getChannelsLength();
+    return systemInfo.u8_scrRxLen;
+}
+
+/**
+  * Return the number of Force Channels (Tx)
+  * @return number of Tx channels
+  */
+int getForceLen(void)
+{
+    if (systemInfo.u8_scrTxLen == 0)
+        getChannelsLength();
+    return systemInfo.u8_scrTxLen;
+}
+
+
+/********************    New API     **************************/
+
+/**
+  * Read a MS Frame from frame buffer memory
+  * @param type type of MS frame to read
+  * @param frame pointer to MutualSenseFrame variable which will contain the
+  * data
+  * @return > 0 if success specifying the number of node into the frame or
+  * an error code which specify the type of error
+  */
+int getMSFrame3(MSFrameType type, MutualSenseFrame *frame)
+{
+    u16 offset;
+    int ret, force_len, sense_len;
+
+    force_len = getForceLen();
+    sense_len = getSenseLen();
+
+    frame->node_data = NULL;
+
+    TPD_DEBUG("%s: Starting to get frame %02X\n", __func__, type);
+    switch (type) {
+    case MS_RAW:
+        offset = systemInfo.u16_msTchRawAddr;
+        goto LOAD_NORM;
+    case MS_FILTER:
+        offset = systemInfo.u16_msTchFilterAddr;
+        goto LOAD_NORM;
+    case MS_STRENGTH:
+        offset = systemInfo.u16_msTchStrenAddr;
+        goto LOAD_NORM;
+    case MS_BASELINE:
+        offset = systemInfo.u16_msTchBaselineAddr;
+LOAD_NORM:
+        if (force_len == 0 || sense_len == 0) {
+            TPD_INFO("%s: number of channels not initialized ERROR %08X\n",__func__, ERROR_CH_LEN);
+            return ERROR_CH_LEN | ERROR_GET_FRAME;
+        }
+
+        break;
+
+    case MS_KEY_RAW:
+        offset = systemInfo.u16_keyRawAddr;
+        goto LOAD_KEY;
+    case MS_KEY_FILTER:
+        offset = systemInfo.u16_keyFilterAddr;
+        goto LOAD_KEY;
+    case MS_KEY_STRENGTH:
+        offset = systemInfo.u16_keyStrenAddr;
+        goto LOAD_KEY;
+    case MS_KEY_BASELINE:
+        offset = systemInfo.u16_keyBaselineAddr;
+LOAD_KEY:
+        if (systemInfo.u8_keyLen == 0) {
+            TPD_INFO("%s: number of channels not initialized ERROR %08X\n", __func__, ERROR_CH_LEN);
+            return ERROR_CH_LEN | ERROR_GET_FRAME;
+        }
+        force_len = 1;
+        sense_len = systemInfo.u8_keyLen;
+        break;
+
+    case FRC_RAW:
+        offset = systemInfo.u16_frcRawAddr;
+        goto LOAD_FRC;
+    case FRC_FILTER:
+        offset = systemInfo.u16_frcFilterAddr;
+        goto LOAD_FRC;
+    case FRC_STRENGTH:
+        offset = systemInfo.u16_frcStrenAddr;
+        goto LOAD_FRC;
+    case FRC_BASELINE:
+        offset = systemInfo.u16_frcBaselineAddr;
+LOAD_FRC:
+        if (force_len == 0) {
+            TPD_INFO("%s: number of channels not initialized ERROR %08X\n", __func__, ERROR_CH_LEN);
+            return ERROR_CH_LEN | ERROR_GET_FRAME;
+        }
+        sense_len = 1;
+        break;
+    default:
+        TPD_INFO("%s: Invalid type ERROR %08X\n", __func__,
+             ERROR_OP_NOT_ALLOW | ERROR_GET_FRAME);
+        return ERROR_OP_NOT_ALLOW | ERROR_GET_FRAME;
+    }
+
+    frame->node_data_size = ((force_len) * sense_len);
+    frame->header.force_node = force_len;
+    frame->header.sense_node = sense_len;
+    frame->header.type = type;
+
+    TPD_DEBUG("%s: Force_len = %d Sense_len = %d Offset = %04X\n", __func__, force_len, sense_len, offset);
+
+    frame->node_data = (short *)kzalloc(frame->node_data_size * sizeof(short), GFP_KERNEL);
+    if (frame->node_data == NULL) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        return ERROR_ALLOC | ERROR_GET_FRAME;
+    }
+
+    ret = getFrameData(offset, frame->node_data_size * BYTES_PER_NODE, (frame->node_data));
+    if (ret < OK) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_GET_FRAME_DATA);
+        kfree(frame->node_data);
+        frame->node_data = NULL;
+        return ret | ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+    }
+    /* if you want to access one node i,j,
+     * compute the offset like: offset = i*columns + j = > frame[i, j] */
+
+    TPD_DEBUG("Frame acquired!\n");
+    return frame->node_data_size;
+    /* return the number of data put inside frame */
+}
+
+/**
+  * Read a SS Frame from frame buffer
+  * @param type type of SS frame to read
+  * @param frame pointer to SelfSenseFrame variable which will contain the data
+  * @return > 0 if success specifying the number of node into frame or an
+  *  error code which specify the type of error
+  */
+int getSSFrame3(SSFrameType type, SelfSenseFrame *frame)
+{
+    u16 offset_force, offset_sense;
+    int ret;
+
+    frame->force_data = NULL;
+    frame->sense_data = NULL;
+
+    frame->header.force_node = getForceLen();    /* use getForce/SenseLen
+                                                  * because introduce a
+                                                  * recover mechanism in
+                                                  * case of len =0 */
+    frame->header.sense_node = getSenseLen();
+
+    if (frame->header.force_node == 0 || frame->header.sense_node == 0) {
+        TPD_INFO("%s: number of channels not initialized ERROR %08X\n", __func__, ERROR_CH_LEN);
+        return ERROR_CH_LEN | ERROR_GET_FRAME;
+    }
+
+
+    TPD_DEBUG("%s: Starting to get frame %02X\n", __func__, type);
+    switch (type) {
+    case SS_RAW:
+        offset_force = systemInfo.u16_ssTchTxRawAddr;
+        offset_sense = systemInfo.u16_ssTchRxRawAddr;
+        break;
+    case SS_FILTER:
+        offset_force = systemInfo.u16_ssTchTxFilterAddr;
+        offset_sense = systemInfo.u16_ssTchRxFilterAddr;
+        break;
+    case SS_STRENGTH:
+        offset_force = systemInfo.u16_ssTchTxStrenAddr;
+        offset_sense = systemInfo.u16_ssTchRxStrenAddr;
+        break;
+    case SS_BASELINE:
+        offset_force = systemInfo.u16_ssTchTxBaselineAddr;
+        offset_sense = systemInfo.u16_ssTchRxBaselineAddr;
+        break;
+
+    case SS_HVR_RAW:
+        offset_force = systemInfo.u16_ssHvrTxRawAddr;
+        offset_sense = systemInfo.u16_ssHvrRxRawAddr;
+        break;
+    case SS_HVR_FILTER:
+        offset_force = systemInfo.u16_ssHvrTxFilterAddr;
+        offset_sense = systemInfo.u16_ssHvrRxFilterAddr;
+        break;
+    case SS_HVR_STRENGTH:
+        offset_force = systemInfo.u16_ssHvrTxStrenAddr;
+        offset_sense = systemInfo.u16_ssHvrRxStrenAddr;
+        break;
+    case SS_HVR_BASELINE:
+        offset_force = systemInfo.u16_ssHvrTxBaselineAddr;
+        offset_sense = systemInfo.u16_ssHvrRxBaselineAddr;
+        break;
+
+    case SS_PRX_RAW:
+        offset_force = systemInfo.u16_ssPrxTxRawAddr;
+        offset_sense = systemInfo.u16_ssPrxRxRawAddr;
+        break;
+    case SS_PRX_FILTER:
+        offset_force = systemInfo.u16_ssPrxTxFilterAddr;
+        offset_sense = systemInfo.u16_ssPrxRxFilterAddr;
+        break;
+    case SS_PRX_STRENGTH:
+        offset_force = systemInfo.u16_ssPrxTxStrenAddr;
+        offset_sense = systemInfo.u16_ssPrxRxStrenAddr;
+        break;
+    case SS_PRX_BASELINE:
+        offset_force = systemInfo.u16_ssPrxTxBaselineAddr;
+        offset_sense = systemInfo.u16_ssPrxRxBaselineAddr;
+        break;
+    case SS_DETECT_RAW:
+        if (systemInfo.u8_ssDetScanSet == 0) {
+            offset_force = systemInfo.u16_ssDetRawAddr;
+            offset_sense = 0;
+            frame->header.sense_node = 0;
+        } else {
+            offset_sense = systemInfo.u16_ssDetRawAddr;
+            offset_force = 0;
+            frame->header.force_node = 0;
+        }
+        break;
+
+    case SS_DETECT_FILTER:
+        if (systemInfo.u8_ssDetScanSet == 0) {
+            offset_force = systemInfo.u16_ssDetFilterAddr;
+            offset_sense = 0;
+            frame->header.sense_node = 0;
+        } else {
+            offset_sense = systemInfo.u16_ssDetFilterAddr;
+            offset_force = 0;
+            frame->header.force_node = 0;
+        }
+        break;
+
+    case SS_DETECT_BASELINE:
+        if (systemInfo.u8_ssDetScanSet == 0) {
+            offset_force = systemInfo.u16_ssDetBaselineAddr;
+            offset_sense = 0;
+            frame->header.sense_node = 0;
+        } else {
+            offset_sense = systemInfo.u16_ssDetBaselineAddr;
+            offset_force = 0;
+            frame->header.force_node = 0;
+        }
+        break;
+
+    case SS_DETECT_STRENGTH:
+        if (systemInfo.u8_ssDetScanSet == 0) {
+            offset_force = systemInfo.u16_ssDetStrenAddr;
+            offset_sense = 0;
+            frame->header.sense_node = 0;
+        } else {
+            offset_sense = systemInfo.u16_ssDetStrenAddr;
+            offset_force = 0;
+            frame->header.force_node = 0;
+        }
+        break;
+
+    default:
+        TPD_INFO("%s: Invalid type ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW | ERROR_GET_FRAME);
+        return ERROR_OP_NOT_ALLOW | ERROR_GET_FRAME;
+    }
+
+    frame->header.type = type;
+
+    TPD_DEBUG("%s: Force_len = %d Sense_len = %d Offset_force = %04X Offset_sense = %04X\n",__func__, frame->header.force_node,
+         frame->header.sense_node, offset_force, offset_sense);
+
+    frame->force_data = (short *)kzalloc(frame->header.force_node * sizeof(short), GFP_KERNEL);
+    if (frame->force_data == NULL) {
+        TPD_INFO("%s: can not allocate force_data ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        return ERROR_ALLOC | ERROR_GET_FRAME;
+    }
+
+    frame->sense_data = (short *)kzalloc(frame->header.sense_node * sizeof(short), GFP_KERNEL);
+    if (frame->sense_data == NULL) {
+        kfree(frame->force_data);
+        frame->force_data = NULL;
+        TPD_INFO("%s: can not allocate sense_data ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        return ERROR_ALLOC | ERROR_GET_FRAME;
+    }
+
+    ret = getFrameData(offset_force, frame->header.force_node * BYTES_PER_NODE, (frame->force_data));
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading force data ERROR %08X\n",
+             __func__, ERROR_GET_FRAME_DATA);
+        kfree(frame->force_data);
+        frame->force_data = NULL;
+        kfree(frame->sense_data);
+        frame->sense_data = NULL;
+        return ret | ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+    }
+
+    ret = getFrameData(offset_sense, frame->header.sense_node * BYTES_PER_NODE, (frame->sense_data));
+    if (ret < OK) {
+        TPD_INFO("%s: error while reading sense data ERROR %08X\n", __func__, ERROR_GET_FRAME_DATA);
+        kfree(frame->force_data);
+        frame->force_data = NULL;
+        kfree(frame->sense_data);
+        frame->sense_data = NULL;
+        return ret | ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+    }
+    /* if you want to access one node i,j, you should compute the offset
+     * like: offset = i*columns + j = > frame[i, j] */
+
+    TPD_DEBUG("Frame acquired!\n");
+    return frame->header.force_node + frame->header.sense_node;
+    /* return the number of data put inside frame */
+}
+
+
+/**
+  * Read Initialization Data Header and check that the type loaded match with
+  * the one previously requested
+  * @param type type of Initialization data requested @link load_opt Load Host
+  * Data Option @endlink
+  * @param msHeader pointer to DataHeader variable which will contain the header
+  * info for the MS frame
+  * @param ssHeader pointer to DataHeader variable which will contain the header
+  * info for the SS frame
+  * @param address pointer to a variable which will contain the updated address
+  * to the next data
+  * @return OK if success or an error code which specify the type of error
+  */
+int readSyncDataHeader(u8 type, DataHeader *msHeader, DataHeader *ssHeader,
+               u64 *address)
+{
+    u64 offset = ADDR_FRAMEBUFFER;
+    u8 data[SYNCFRAME_DATA_HEADER];
+    int ret;
+
+    ret = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, offset, data, SYNCFRAME_DATA_HEADER, DUMMY_FRAMEBUFFER);
+    if (ret < OK) {    /* i2c function have already a retry mechanism */
+        TPD_INFO("%s: error while reading data header ERROR %08X\n", __func__, ret);
+        return ret;
+    }
+
+    TPD_DEBUG("Read Data Header done!\n");
+
+    if (data[0] != HEADER_SIGNATURE) {
+        TPD_INFO("%s: The Header Signature was wrong! %02X != %02X ERROR %08X\n",__func__, data[0], HEADER_SIGNATURE, ERROR_WRONG_DATA_SIGN);
+        return ERROR_WRONG_DATA_SIGN;
+    }
+
+
+    if (data[1] != type) {
+        TPD_INFO("%s: Wrong type found! %02X!=%02X ERROR %08X\n",__func__, data[1], type, ERROR_DIFF_DATA_TYPE);
+        return ERROR_DIFF_DATA_TYPE;
+    }
+
+    TPD_DEBUG("Type = %02X of SyncFrame data OK!\n", type);
+
+    msHeader->force_node = data[5];
+    msHeader->sense_node = data[6];
+    TPD_DEBUG("MS Frame force_node = %d, sense_node = %d\n", msHeader->force_node, msHeader->sense_node);
+
+    ssHeader->force_node = data[7];
+    ssHeader->sense_node = data[8];
+    TPD_DEBUG("SS Frame force_node = %d, sense_node = %d\n", ssHeader->force_node, ssHeader->sense_node);
+
+    *address = offset + SYNCFRAME_DATA_HEADER + data[4];
+
+    return OK;
+}
+
+/**
+  * Read a Sync Frame from frame buffer which contain MS and SS data collected
+  * for the same scan
+  * @param type type of Sync frame to read, possible values:
+  * LOAD_SYNC_FRAME_RAW, LOAD_SYNC_FRAME_FILTER, LOAD_SYNC_FRAME_BASELINE,
+  * LOAD_SYNC_FRAME_STRENGTH
+  * @param msFrame pointer to MutualSenseFrame variable which will contain the
+  * MS data
+  * @param ssFrame pointer to SelfSenseFrame variable which will contain the SS
+  * data
+  * @return >0 if success specifying the total number of nodes copied into
+  * msFrame and ssFrame or an error code which specify the type of error
+  */
+int getSyncFrame(u8 type, MutualSenseFrame *msFrame, SelfSenseFrame *ssFrame)
+{
+    int res;
+    u64 address;
+
+    msFrame->node_data = NULL;
+    ssFrame->force_data = NULL;
+    ssFrame->sense_data = NULL;
+
+    TPD_DEBUG("%s: Starting to get Sync Frame %02X...\n", __func__, type);
+    switch (type) {
+    case LOAD_SYNC_FRAME_RAW:
+        msFrame->header.type = MS_RAW;
+        ssFrame->header.type = SS_RAW;
+        break;
+
+    case LOAD_SYNC_FRAME_FILTER:
+        msFrame->header.type = MS_FILTER;
+        ssFrame->header.type = SS_FILTER;
+        break;
+
+    case LOAD_SYNC_FRAME_BASELINE:
+        msFrame->header.type = MS_BASELINE;
+        ssFrame->header.type = SS_BASELINE;
+        break;
+
+    case LOAD_SYNC_FRAME_STRENGTH:
+        msFrame->header.type = MS_STRENGTH;
+        ssFrame->header.type = SS_STRENGTH;
+        break;
+
+    default:
+        return ERROR_OP_NOT_ALLOW | ERROR_GET_FRAME;
+    }
+
+    TPD_DEBUG("%s: Requesting Sync Frame %02X...\n", __func__,type);
+    res = requestSyncFrame(type);
+    if (res < OK) {
+        TPD_INFO("%s: error while requesting Sync Frame ERROR %08X\n", __func__, res | ERROR_GET_FRAME_DATA);
+        return res | ERROR_GET_FRAME_DATA;
+    }
+
+    res = readSyncDataHeader(type, &(msFrame->header), &(ssFrame->header),&address);
+    if (res < OK) {
+        TPD_INFO("%s: error while reading Sync Frame header... ERROR %08X\n", __func__, res | ERROR_GET_FRAME_DATA);
+        return res | ERROR_GET_FRAME_DATA;
+    }
+
+    msFrame->node_data_size = msFrame->header.force_node * msFrame->header.sense_node;
+
+    msFrame->node_data = (short *)kzalloc(msFrame->node_data_size * sizeof(short), GFP_KERNEL);
+    if (msFrame->node_data == NULL) {
+        TPD_INFO("%s: impossible allocate memory for MS frame... ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        return ERROR_ALLOC | ERROR_GET_FRAME;
+    }
+
+    TPD_DEBUG("%s: Getting MS frame at %04llX...\n", __func__, address);
+    res = getFrameData(address, (msFrame->node_data_size) * BYTES_PER_NODE, (msFrame->node_data));
+    if (res < OK) {
+        TPD_INFO("%s: error while getting MS data...ERROR %08X\n", __func__, res);
+        res |= ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+        goto ERROR;
+    }
+
+    /* move the offset */
+    address += (msFrame->node_data_size) * BYTES_PER_NODE;
+
+    ssFrame->force_data = (short *)kzalloc(ssFrame->header.force_node * sizeof(short), GFP_KERNEL);
+    if (ssFrame->force_data == NULL) {
+        TPD_INFO("%s: impossible allocate memory for SS force frame...ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        res = ERROR_ALLOC | ERROR_GET_FRAME;
+        goto ERROR;
+    }
+
+    TPD_DEBUG("%s: Getting SS force frame at %04llX...\n", __func__, address);
+    res = getFrameData(address, (ssFrame->header.force_node) * BYTES_PER_NODE, (ssFrame->force_data));
+    if (res < OK) {
+        TPD_INFO("%s: error while getting SS force data...ERROR %08X\n", __func__, res);
+        res |= ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+        goto ERROR;
+    }
+
+    /* move the offset */
+    address += (ssFrame->header.force_node) * BYTES_PER_NODE;
+
+    ssFrame->sense_data = (short *)kzalloc(ssFrame->header.sense_node * sizeof(short), GFP_KERNEL);
+    if (ssFrame->sense_data == NULL) {
+        TPD_INFO("%s: impossible allocate memory for SS sense frame...ERROR %08X\n", __func__, ERROR_ALLOC | ERROR_GET_FRAME);
+        res = ERROR_ALLOC | ERROR_GET_FRAME;
+        goto ERROR;
+    }
+
+    TPD_DEBUG("%s: Getting SS sense frame at %04llX...\n", __func__, address);
+    res = getFrameData(address, (ssFrame->header.sense_node) * BYTES_PER_NODE, (ssFrame->sense_data));
+    if (res < OK) {
+        TPD_INFO("%s: error while getting SS sense data...ERROR %08X\n", __func__, res);
+        res |= ERROR_GET_FRAME_DATA | ERROR_GET_FRAME;
+        goto ERROR;
+    }
+
+ERROR:
+    if (res < OK) {
+        if (msFrame->node_data != NULL) {
+            kfree(msFrame->node_data);
+            msFrame->node_data = NULL;
+        }
+
+        if (ssFrame->force_data != NULL) {
+            kfree(ssFrame->force_data);
+            ssFrame->force_data = NULL;
+        }
+
+        if (ssFrame->sense_data != NULL) {
+            kfree(ssFrame->sense_data);
+            ssFrame->sense_data = NULL;
+        }
+        TPD_DEBUG("Getting Sync Frame FAILED! ERROR %08X!\n", res);
+    } else {
+        TPD_DEBUG("Getting Sync Frame FINISHED!\n");
+        res = msFrame->node_data_size + ssFrame->header.force_node + ssFrame->header.sense_node;
+    }
+    return res;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.h
new file mode 100644
index 0000000000000000000000000000000000000000..c302b7508d49ea456f934a506a67e9fe228a5574
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsFrame.h
@@ -0,0 +1,98 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsFrame.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsFrame.h
+  * \brief Contains all the definitions and structs to work with frames
+  */
+
+
+#ifndef FTS_FRAME_H
+#define FTS_FRAME_H
+
+#include "ftsSoftware.h"
+#include "ftsCore.h"
+
+
+/* Number of data bytes for each node */
+#define BYTES_PER_NODE              2                       /* /< number of data bytes for each node */
+#define RETRY_FRAME_DATA_READ       2                       /* /< max number of attempts to read a frame */
+#define SYNCFRAME_DATA_HEADER       (DATA_HEADER + 12)      /* /< number of bytes of Sync Frame Header */
+
+/**
+  * Possible types of MS frames
+  */
+typedef enum {
+    MS_RAW          = 0,    /* /< Mutual Sense Raw Frame */
+    MS_FILTER       = 1,    /* /< Mutual Sense Filtered Frame */
+    MS_STRENGTH     = 2,    /* /< Mutual Sense Strength Frame (Baseline-Raw) */
+    MS_BASELINE     = 3,    /* /< Mutual Sense Baseline Frame */
+    MS_KEY_RAW      = 4,    /* /< Mutual Sense Key Raw Frame */
+    MS_KEY_FILTER   = 5,    /* /< Mutual Sense Key Filter Frame */
+    MS_KEY_STRENGTH = 6,    /* /< Mutual Sense Key Strength Frame (Baseline-Raw) */
+    MS_KEY_BASELINE = 7,    /* /< Mutual Sense Key Baseline Frame */
+    FRC_RAW         = 8,    /* /< Force Raw Frame */
+    FRC_FILTER      = 9,    /* /< Force Filtered Frame */
+    FRC_STRENGTH    = 10,   /* /< Force Strength Frame (Baseline-Raw) */
+    FRC_BASELINE    = 11    /* /< Force Baseline Frame */
+} MSFrameType;
+
+/**
+  * Possible types of SS frames
+  */
+typedef enum {
+    SS_RAW              = 0,    /* /< Self Sense Raw Frame */
+    SS_FILTER           = 1,    /* /< Self Sense Filtered Frame */
+    SS_STRENGTH         = 2,    /* /< Self Sense Strength Frame (Baseline-Raw) */
+    SS_BASELINE         = 3,    /* /< Self Sense Baseline Frame */
+    SS_HVR_RAW          = 4,    /* /< Self Sense Hover Raw Frame */
+    SS_HVR_FILTER       = 5,    /* /< Self Sense Hover Filter Frame */
+    SS_HVR_STRENGTH     = 6,    /* /< Self Sense Hover Strength Frame (Baseline-Raw) */
+    SS_HVR_BASELINE     = 7,    /* /< Self Sense Hover Baseline Frame */
+    SS_PRX_RAW          = 8,    /* /< Self Sense Proximity Raw Frame */
+    SS_PRX_FILTER       = 9,    /* /< Self Sense Proximity Filtered Frame */
+    SS_PRX_STRENGTH     = 10,   /* /< Self Sense Proximity Strength Frame (Baseline-Raw) */
+    SS_PRX_BASELINE     = 11,   /* /< Self Sense Proximity Baseline Frame */
+    SS_DETECT_RAW       = 12,   /* /< Self Sense Detect Raw Frame */
+    SS_DETECT_FILTER    = 13,   /* /< Self Sense Detect Filter Frame */
+    SS_DETECT_STRENGTH  = 14,   /* /< Self Sense Detect Strength Frame */
+    SS_DETECT_BASELINE  = 15    /* /< Self Sense Detect Baseline Frame */
+} SSFrameType;
+
+/**
+  * Struct which contains the data of a MS Frame
+  */
+typedef struct {
+    DataHeader  header;         /* /< Header which contain basic info of the frame */
+    short       *node_data;     /* /< Data of the frame */
+    int         node_data_size; /* /< Dimension of the data of the frame */
+} MutualSenseFrame;
+
+/**
+  * Struct which contains the data of a SS Frame
+  */
+typedef struct {
+    DataHeader  header;         /* /< Header which contain basic info of the frame */
+    short       *force_data;    /* /< Force Channels Data */
+    short       *sense_data;    /* /< Sense Channels Data */
+} SelfSenseFrame;
+
+
+int getChannelsLength(void);
+int getFrameData(u16 address, int size, short *frame);
+int getSenseLen(void);
+int getForceLen(void);
+int getMSFrame3(MSFrameType type, MutualSenseFrame *frame);
+int getSSFrame3(SSFrameType type, SelfSenseFrame *frame);
+int getSyncFrame(u8 type, MutualSenseFrame *msFrame, SelfSenseFrame *ssFrame);
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.c
new file mode 100644
index 0000000000000000000000000000000000000000..ad78690e33a82a23a409d663da8c813719663a38
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.c
@@ -0,0 +1,358 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsGesture.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsGesture.c
+  * \brief Contains all the functions and variable to handle the Gesture
+  *Detection features
+  */
+
+#include "ftsSoftware.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsGesture.h"
+#include "ftsIO.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+/* /< store the gesture bitmask which the host want to enable.
+  * If bit set 1 the corresponding gesture will be detected in Gesture Mode */
+static u8 gesture_mask[GESTURE_MASK_SIZE] = { 0 };
+/* /< store the x coordinates of the points draw by the user
+  * when a gesture is detected */
+u16 gesture_coordinates_x[GESTURE_MAX_COORDS_PAIRS_REPORT] = { 0 };
+/* /< store the y coordinates of the points draw by the user
+  * when a gesture is detected */
+u16 gesture_coordinates_y[GESTURE_MAX_COORDS_PAIRS_REPORT] = { 0 };
+/* /< number of coordinates pairs (points) reported with the detected gesture */
+int gesture_coords_reported = ERROR_OP_NOT_ALLOW;
+static u8 refreshGestureMask;       /* /< flag which indicate if there is
+                                    * the need to set the gesture mask in the FW */
+struct mutex gestureMask_mutex;    /* /< mutex used to control access on gesture
+                                    * shared variables */
+
+/**
+  * Update the gesture mask stored in the driver and have to be used in gesture
+  * mode
+  * @param mask pointer to a byte array which store the gesture mask update
+  * that want to be performed.
+  * @param size dimension in byte of mask. This size can be <=
+  * GESTURE_MASK_SIZE.
+  * If size < GESTURE_MASK_SIZE the bytes of mask are considering continuos
+  * and starting from the less significant byte.
+  * @param en 0 = enable the gestures set in mask, 1 = disable the gestures set
+  *in mask
+  * @return OK if success or an error code which specify the type of error
+  */
+int updateGestureMask(u8 *mask, int size, int en)
+{
+    u8 temp;
+    int i;
+
+    if (mask != NULL) {
+        if (size <= GESTURE_MASK_SIZE) {
+            if (en == FEAT_ENABLE) {
+                mutex_lock(&gestureMask_mutex);
+                TPD_DEBUG("updateGestureMask: setting gesture mask to enable...\n");
+                if (mask != NULL)
+                    for (i = 0; i < size; i++)
+                        gesture_mask[i] = gesture_mask[i] | mask[i];
+                /* back up of the gesture enabled */
+                refreshGestureMask = 1;
+                TPD_DEBUG("updateGestureMask: gesture mask to enable SET!\n");
+                mutex_unlock(&gestureMask_mutex);
+                return OK;
+            } else if (en == FEAT_DISABLE) {
+                mutex_lock(&gestureMask_mutex);
+                TPD_DEBUG("updateGestureMask: setting gesture mask to disable...\n");
+                for (i = 0; i < size; i++) {
+                    temp = gesture_mask[i] ^ mask[i];
+                    /* enabled XOR disabled */
+                    gesture_mask[i] = temp & gesture_mask[i];
+                    /* temp AND enabled
+                      * disable the gestures that were
+                      * enabled */
+                }
+                TPD_DEBUG("updateGestureMask: gesture mask to disable SET!\n");
+                refreshGestureMask = 1;
+                mutex_unlock(&gestureMask_mutex);
+                return OK;
+            } else {
+                TPD_INFO("updateGestureMask: Enable parameter Invalid! %d != %d or %d ERROR %08X\n", en, FEAT_DISABLE, FEAT_ENABLE, ERROR_OP_NOT_ALLOW);
+                return ERROR_OP_NOT_ALLOW;
+            }
+        } else {
+            TPD_INFO("updateGestureMask: Size not valid! %d > %d ERROR %08X\n",size, GESTURE_MASK_SIZE, ERROR_OP_NOT_ALLOW);
+            return ERROR_OP_NOT_ALLOW;
+        }
+    } else {
+        TPD_INFO("updateGestureMask: Mask NULL! ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  * Enable in the FW the gesture mask to be used in gesture mode
+  * @param mask pointer to a byte array which store the gesture mask update
+  * that want to be sent to the FW, if NULL, will be used gesture_mask
+  * set previously without any changes.
+  * @param size dimension in byte of mask. This size can be <=
+  * GESTURE_MASK_SIZE.
+  * If size < GESTURE_MASK_SIZE the bytes of mask are considering continuos and
+  * starting from the less significant byte.
+  * @return OK if success or an error code which specify the type of error
+  */
+int enableGesture(u8 *mask, int size)
+{
+    int i, res;
+
+    TPD_DEBUG("Trying to enable gesture...\n");
+
+    if (size <= GESTURE_MASK_SIZE) {
+        mutex_lock(&gestureMask_mutex);
+        if (mask != NULL)
+            for (i = 0; i < size; i++)
+                gesture_mask[i] = gesture_mask[i] | mask[i];
+        /* back up of the gesture enabled */
+
+        res = setFeatures(FEAT_SEL_GESTURE, gesture_mask, GESTURE_MASK_SIZE);
+        if (res < OK) {
+            TPD_INFO("enableGesture: ERROR %08X\n", res);
+            goto END;
+        }
+
+        TPD_DEBUG("enableGesture DONE!\n");
+        res = OK;
+
+END:
+        mutex_unlock(&gestureMask_mutex);
+        return res;
+    } else {
+        TPD_INFO("enableGesture: Size not valid! %d > %d ERROR %08X\n", size, GESTURE_MASK_SIZE, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  * Disable in the FW the gesture mask to be used in gesture mode
+  * @param mask pointer to a byte array which store the gesture mask update that
+  *  want to be sent to the FW, if NULL, all the gestures will be disabled.
+  * @param size dimension in byte of mask. This size can be <=
+  * GESTURE_MASK_SIZE.
+  * If size < GESTURE_MASK_SIZE the bytes of mask are considering continuos and
+  * starting from the less significant byte.
+  * @return OK if success or an error code which specify the type of error
+  */
+int disableGesture(u8 *mask, int size)
+{
+    u8 temp;
+    int i, res;
+    u8 *pointer;
+
+    TPD_DEBUG("Trying to disable gesture...\n");
+
+    if (size <= GESTURE_MASK_SIZE) {
+        mutex_lock(&gestureMask_mutex);
+        if (mask != NULL) {
+            for (i = 0; i < size; i++) {
+                temp = gesture_mask[i] ^ mask[i];
+                /* enabled mask XOR disabled mask */
+                gesture_mask[i] = temp & gesture_mask[i];
+                /* temp AND enabled
+                  * disable the gestures that are specified and
+                  *  previously enabled */
+            }
+
+            pointer = gesture_mask;
+        } else {
+            i = 0;    /* if NULL is passed disable all the possible gestures */
+            pointer = (u8 *)&i;
+        }
+
+        res = setFeatures(FEAT_SEL_GESTURE, pointer, GESTURE_MASK_SIZE);
+        if (res < OK) {
+            TPD_INFO("disableGesture: ERROR %08X\n", res);
+            goto END;
+        }
+
+        TPD_DEBUG("disableGesture DONE!\n");
+
+        res = OK;
+
+END:
+        mutex_unlock(&gestureMask_mutex);
+        return res;
+    } else {
+        TPD_INFO("disableGesture: Size not valid! %d > %d ERROR %08X\n", size, GESTURE_MASK_SIZE, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  * Perform all the steps required to put the chip in gesture mode
+  * @param reload if set to 1, before entering in gesture mode it will re-enable
+  *  in the FW the last defined gesture mask
+  * @return OK if success or an error code which specify the type of error
+  */
+int enterGestureMode(int reload)
+{
+    int res = 1, ret = 1;
+
+    res = fts_disableInterruptNoSync();
+    if (res < OK) {
+        TPD_INFO("enterGestureMode: ERROR %08X\n", res | ERROR_DISABLE_INTER);
+        return res | ERROR_DISABLE_INTER;
+    }
+
+    if (reload == 1 || refreshGestureMask == 1) {
+        res = enableGesture(NULL, 0);
+        if (res < OK) {
+            TPD_INFO("enterGestureMode: enableGesture ERROR %08X\n",res);
+            goto END;
+        }
+
+        refreshGestureMask = 0;
+    }
+
+    res = setScanMode(SCAN_MODE_LOW_POWER, 0);
+    if (res < OK) {
+        TPD_INFO("enterGestureMode: enter gesture mode ERROR %08X\n",res);
+        goto END;
+    }
+
+    res = OK;
+END:
+    ret = fts_enableInterrupt();
+    if (ret < OK) {
+        TPD_INFO("enterGestureMode: fts_enableInterrupt ERROR %08X\n", res | ERROR_ENABLE_INTER);
+        res |= ret | ERROR_ENABLE_INTER;
+    }
+
+    return res;
+}
+
+/**
+  * Check if one or more Gesture IDs are currently enabled in gesture_mask
+  * @return FEAT_ENABLE if one or more gesture ids are enabled, FEAT_DISABLE if
+  * all the gesture ids are currently disabled
+  */
+int isAnyGestureActive(void)
+{
+    int res = 0;
+
+    while (res < (GESTURE_MASK_SIZE - 1) && gesture_mask[res] == 0)
+        /* -1 because in any case the last gesture mask byte will
+          * be evaluated with the following if */
+        res++;
+
+    if (gesture_mask[res] != 0) {
+        TPD_DEBUG("%s: Active Gestures Found! gesture_mask[%d] = %02X !\n", __func__, res, gesture_mask[res]);
+        return FEAT_ENABLE;
+    } else {
+        TPD_DEBUG("%s: All Gestures Disabled!\n", __func__);
+        return FEAT_DISABLE;
+    }
+}
+
+
+/**
+  * Read from the frame buffer the gesture coordinates pairs of the points draw
+  * by an user when a gesture is detected
+  * @param event pointer to a byte array which contains the gesture event
+  * reported
+  *  by the fw when a gesture is detected
+  * @return OK if success or an error code which specify the type of error
+  */
+int readGestureCoords(u8 *event)
+{
+    int i = 0;
+    u64 address = 0;
+    int res;
+
+    u8 val[GESTURE_MAX_COORDS_PAIRS_REPORT * 4];
+
+    /* the max coordinates to read are GESTURE_COORDS_REPORT_MAX*4
+      * (because each coordinate is a short(*2) and we have x and y) */
+    if (event[0] == EVT_ID_USER_REPORT && event[1] == EVT_TYPE_USER_GESTURE) {
+        address = (event[4] << 8) | event[3]; /* Offset in framebuff */
+        gesture_coords_reported = event[5];    /* number of pairs coords reported */
+        if (gesture_coords_reported > GESTURE_MAX_COORDS_PAIRS_REPORT) {
+            TPD_INFO("%s:  FW reported more than %d points for the gestures! Decreasing to %d\n", __func__, gesture_coords_reported, GESTURE_MAX_COORDS_PAIRS_REPORT);
+            gesture_coords_reported = GESTURE_MAX_COORDS_PAIRS_REPORT;
+        }
+
+        TPD_INFO("%s: Offset: %08llX , coords pairs = %d\n", __func__, address, gesture_coords_reported);
+
+        res = fts_writeReadU8UX(FTS_CMD_FRAMEBUFFER_R, BITS_16, address, val, (gesture_coords_reported * 2 * 2), DUMMY_FRAMEBUFFER);
+        /* *2 because each coord is made by 2 bytes, 2 because there are x and y */
+        if (res < OK) {
+            TPD_INFO("%s: Cannot read the coordinates! ERROR %08X\n",__func__, res);
+            gesture_coords_reported = ERROR_OP_NOT_ALLOW;
+            return res;
+        }
+
+        /* all the points of the gesture are stored in val */
+        for (i = 0; i < gesture_coords_reported; i++) {
+            gesture_coordinates_x[i] =  (((u16)val[i * 2 + 1]) &0x0F) << 8 | (((u16)val[i * 2]) & 0xFF);
+            gesture_coordinates_y[i] = (((u16)val[gesture_coords_reported * 2 + i * 2 + 1]) &0x0F) << 8 | (((u16)val[gesture_coords_reported * 2 + i * 2]) & 0xFF);
+        }
+
+        TPD_INFO("%s: Reading Gesture Coordinates DONE!\n", __func__);
+        return OK;
+    } else {
+        TPD_INFO("%s: The event passsed as argument is invalid! ERROR %08X\n", __func__, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  * Return the coordinates of the points stored during the last detected gesture
+  * @param x output parameter which will store the address of the array
+  * containing the x coordinates
+  * @param y output parameter which will store the address of the array
+  * containing the y coordinates
+  * @return the number of points (x,y) stored and therefore the size of the x
+  * and y array returned.
+  */
+int getGestureCoords(u16 **x, u16 **y)
+{
+    *x = gesture_coordinates_x;
+    *y = gesture_coordinates_y;
+    TPD_INFO("%s: Number of gesture coordinates pairs returned = %d\n", __func__, gesture_coords_reported);
+    return gesture_coords_reported;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.h
new file mode 100644
index 0000000000000000000000000000000000000000..aad52ae7bdd7a528bb04ccaa71273800dc9adcfd
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsGesture.h
@@ -0,0 +1,43 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsGesture.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsGesture.h
+  * \brief Contains all the macro and prototypes to handle the Gesture Detection
+  * features
+  */
+
+
+#ifndef FTS_GESTURE_H_
+#define FTS_GESTURE_H_
+
+
+
+#include "ftsHardware.h"
+
+#define GESTURE_MASK_SIZE               4       /* /< number of bytes of the
+                                                 * gesture mask */
+
+#define GESTURE_MAX_COORDS_PAIRS_REPORT 100     /* /< max number of gestures
+                                                 * coordinates pairs reported */
+
+
+int updateGestureMask(u8 *mask, int size, int en);
+int disableGesture(u8 *mask, int size);
+int enableGesture(u8 *mask, int size);
+int enterGestureMode(int reload);
+int isAnyGestureActive(void);
+int readGestureCoords(u8 *event);
+int getGestureCoords(u16 **x, u16 **y);
+
+#endif    /* ! _GESTURE_H_ */
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsHardware.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsHardware.h
new file mode 100644
index 0000000000000000000000000000000000000000..05bc124010fc36a7f2b59ac41e13f8fd8bda30c5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsHardware.h
@@ -0,0 +1,211 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsHardware.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+/*!
+  * \file ftsHardware.h
+  * \brief Contains all the definitions and information related to the IC
+  * from an hardware point of view
+  */
+
+#ifndef FTS_HARDWARE_H
+#define FTS_HARDWARE_H
+
+
+/* DIGITAL CHIP INFO */
+#define DCHIP_ID_0            0x36      /* /< LSB chip ID for FTM5 */
+#define DCHIP_ID_1            0x39      /* /< MSB chip ID for FTM5 */
+
+#define DCHIP_FW_VER_BYTE     2         /* /< number of bytes of the fw versions */
+
+/* CHUNKS */
+#define READ_CHUNK            1024      /* /< chunk dimension of
+                                         * a single i2c read,
+                                         * max allowed value is 2kB */
+#define WRITE_CHUNK           1024      /* /< chunk dimension of
+                                         * a single i2c write,
+                                         * max allowed value is 2kB */
+#define MEMORY_CHUNK          1024      /* /< chunk dimenasion of
+                                         * a single i2c write on mem,
+                                         * max allowed value is 2kB */
+
+/* PROTOCOL INFO */
+#define I2C_INTERFACE                   /* /< comment if the chip use SPI bus */
+
+#define I2C_SAD                 0x49    /* /< slave address of the IC */
+
+
+
+#define IER_ENABLE              0x41    /* /< value to write in IER_ADDR
+                                         * to enable the interrupts */
+#define IER_DISABLE             0x00    /* /< value to write in IER_ADDR
+                                         * to disable the interrupts */
+
+/* FLASH COMMAND */
+/** @defgroup flash_command Flash Commands
+  * All the commands that works with the flash of the IC
+  */
+#define FLASH_CMD_UNLOCK                0xF7
+
+#define FLASH_CMD_READ_REGISTER         0xFA
+#define FLASH_CMD_WRITE_REGISTER        0xFA
+
+
+/* FLASH UNLOCK PARAMETER */
+#define FLASH_UNLOCK_CODE0              0x25
+#define FLASH_UNLOCK_CODE1              0x20
+#define FLASH_UNLOCK_CODE2		0x6B
+#define FLASH_UNLOCK_CODE3		0x00
+#define FLASH_UVLO_ENABLE_CODE0		0x1B
+#define FLASH_UVLO_ENABLE_CODE1		0x66
+#define FLASH_AUTOPOWERDOWN_ENABLE_CODE0 0x68
+#define FLASH_AUTOPOWERDOWN_ENABLE_CODE1 0x13
+
+/* FLASH ERASE and DMA PARAMETER */
+#define FLASH_ERASE_START               0x80
+#define FLASH_ERASE_CODE1               0xC0
+#define FLASH_DMA_CODE1                 0xC0
+#define FLASH_ERASE_UNLOCK_CODE0        0xDE
+#define FLASH_ERASE_UNLOCK_CODE1        0x03
+#define FLASH_ERASE_CODE0               0x6A
+#define FLASH_DMA_CODE0                 0x71
+#define FLASH_DMA_CONFIG                0x72
+#define FLASH_NUM_PAGE                  32    /* /< number of pages in main flash */
+
+#define FLASH_CX_PAGE_START             28    /* /< starting page which contain Cx data */
+#define FLASH_CX_PAGE_END               30    /* /< last page which contain Cx data */
+#define FLASH_PANEL_PAGE_START          26    /* /< starting page which contain Panel Init data */
+#define FLASH_PANEL_PAGE_END            27    /* /< last page which contain Panel Init data */
+
+#define FLASH_FW_CODE_COUNT             0x1A    /* /< fw_code_size - Firmware Code page count  */
+#define FLASH_PANEL_CFG_COUNT           0x02    /* /< panel_cfg_size - Panel Configuration page count */
+#define FLASH_CX_CFG_COUNT          	0x03    /* /< cx_cfg_size - CX Configuration page count  */
+#define FLASH_FW_CFG_COUNT              0x01    /* /< fw_cfg_size - FW Configuration page count  */
+
+
+/* FLASH ADDRESS */
+
+#define FLASH_ADDR_CODE         0x00000000    /* /< starting address (words)
+                                               * in the flash of the code in FTI */
+#define FLASH_ADDR_CONFIG       0x00007C00    /* /< starting address (words)
+                                               * in the flash of the config in FTI */
+#define FLASH_ADDR_CX           0x00007000    /* /< starting address (words)
+                                               * in the flash of the Init data in FTI */
+
+/* SIZES FW, CODE, CONFIG, MEMH */
+/** @defgroup fw_file FW file info
+  * All the info related to the fw file
+  */
+
+#define FW_HEADER_SIZE          64              /* /< dimension of the header of the .fts file */
+#define FW_HEADER_SIGNATURE     0xAA55AA55      /* /< header signature */
+#define FW_FTB_VER              0x00000001      /* /< .ftb version */
+#define FW_BYTES_ALLIGN         4               /* /< allignment of the info */
+#define FW_BIN_VER_OFFSET       16              /* /< offset of the fw version in the .ftb file */
+#define FW_BIN_CONFIG_ID_OFFSET 20              /* /< offset of the config id in the .ftb file */
+#define FW_CX_VERSION           (16 + 4)        /* /< offset of CX version in the sec2 of FW file */
+#define FW_ORG_INFO_OFFSET      (16*17 + 8)        /* /< Flash allocation Info */
+
+
+/* FIFO */
+#define FIFO_EVENT_SIZE     8       /* /< number of bytes of one event */
+#define FIFO_DEPTH          32      /* /< max number of events that the FIFO can
+                                     * collect before going in overflow in FTM5 */
+
+#define FIFO_CMD_READALL    0x86    /* /< command to read all the events in the FIFO */
+
+#define FIFO_CMD_READONE    FIFO_CMD_READALL    /* /< commad to read one event from FIFO */
+
+#define FTS_CMD_HW_REG_R    0xFA    /* /< command to read an hw register if FTI */
+#define FTS_CMD_HW_REG_W    0xFA    /* /< command to write an hw register if FTI */
+#define FTS_CMD_FRAMEBUFFER_R    0xA6           /* /< command to read the framebuffer if FTI */
+#define FTS_CMD_CONFIG_R    0xA8    /* /< command to read the config memory if FTI */
+#define FTS_CMD_CONFIG_W    0xA8    /* /< command to write the config memory if FTI */
+
+
+/* DUMMY BYTES DATA */
+#define DUMMY_HW_REG            0    /* /< 1 if the first byte read from HW
+                                      * register is dummy */
+#define DUMMY_FRAMEBUFFER       0    /* /< 1 if the first byte read from
+                                      * Frame buffer is dummy */
+#define DUMMY_CONFIG            0    /* /< 1 if the first byte read from
+                                      * Config Memory is dummy */
+#define DUMMY_FIFO              0    /* /< 1 if the first byte read from FIFO
+                                      * is dummy */
+
+
+/** @defgroup hw_adr HW Address
+  * @ingroup address
+  * Important addresses of hardware registers (and sometimes their important
+  * values)
+  */
+
+/* IMPORTANT HW ADDRESSES (u64) */
+#define ADDR_FRAMEBUFFER        ((u64)0x0000000000000000)   /* /< frame buffer
+                                                             * address in memory */
+#define ADDR_ERROR_DUMP         ((u64)0x000000000000EF80)   /* /< start address
+                                                             *  dump error log */
+
+/* SYSTEM RESET INFO */
+#define ADDR_SYSTEM_RESET       ((u64)0x0000000020000024)   /* /< address of
+                                                             * System control reg
+                                                             * in FTI */
+#define SYSTEM_RESET_VALUE      0x80    /* /< value to write in
+                                         * SYSTEM_RESET_ADDRESS to perform a
+                                         * system reset in FTM5 */
+
+
+/* REMAP REGISTER */
+#define ADDR_BOOT_OPTION        ((u64)0x0000000020000025)   /* /< address of Boot
+                                                            * option register */
+
+
+/* INTERRUPT INFO */
+#define ADDR_IER                ((u64)0x0000000020000029)   /* /< address of the
+                                                             * Interrupt enable
+                                                             * register in FTMI */
+
+/* Chip ID/Fw Version */
+#define ADDR_DCHIP_ID           ((u64)0x0000000020000000)   /* /< chip id address
+                                                             * for FTI */
+#define ADDR_DCHIP_FW_VER       ((u64)0x0000000020000004)   /* /< fw version
+                                                             * address for FTI */
+
+/* INTERFACE REGISTER */
+#define ADDR_ICR                ((u64)0x000000002000002D)   /* /< address of Device
+                                                             * control register to
+                                                             * set the comunication
+                                                             * protocol (SPI/I2C) */
+
+/* CRC ADDR */
+#define ADDR_CRC                ((u64)0x0000000020000078)   /* /< address of CRC
+                                                             * control register in
+                                                             * FTI */
+#define CRC_MASK                0x03                        /* /< bitmask which reveal if there is a
+                                                             * CRC error in the flash */
+
+#define ADDR_CONFIG_OFFSET      ((u64)0x0000000000000000)   /* /< config address
+                                                             * in memory if FTI */
+
+#define ADDR_GPIO_INPUT         ((u64)0x0000000020000030)   /* /< address of GPIO
+                                                             * input register */
+#define ADDR_GPIO_DIRECTION     ((u64)0x0000000020000032)   /* /< address of GPIO
+                                                             * direction register */
+#define ADDR_GPIO_PULLUP        ((u64)0x0000000020000034)   /* /< address of GPIO
+                                                             * pullup register */
+#define ADDR_GPIO_CONFIG_REG0   ((u64)0x000000002000003D)   /* /< address of
+                                                             *  GPIO config register */
+#define ADDR_GPIO_CONFIG_REG2   ((u64)0x000000002000003F)   /* /< address of
+                                                             *  GPIO config register */
+
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.c
new file mode 100644
index 0000000000000000000000000000000000000000..07bfec1119b1902ca5e958c94c7533ff86376d73
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.c
@@ -0,0 +1,513 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsIO.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsIO.c
+  * \brief Contains all the functions which handle with the I2C/SPI
+  *communication
+  */
+
+
+#include "ftsSoftware.h"
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include <linux/of_gpio.h>
+
+#include <linux/i2c.h>
+#include <linux/i2c-dev.h>
+
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+static void *client;    /* /< bus client retrived by the OS and used to execute the bus transfers */
+
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsHardware.h"
+#include "ftsIO.h"
+#include "../../../util_interface/touch_interfaces.h"
+
+
+/**
+  * Initialize the static client variable of the fts_lib library in order
+  * to allow any i2c/spi transaction in the driver (Must be called in the probe)
+  * @param clt pointer to i2c_client or spi_device struct which identify the bus
+  * slave device
+  * @return OK
+  */
+int openChannel(void *clt)
+{
+    client = clt;
+
+    return OK;
+}
+
+/**
+  * Retrieve the pointer to the device struct of the IC
+  * @return a the device struct pointer if client was previously set
+  * or NULL in all the other cases
+  */
+struct device *getDev(void)
+{
+    if (client != NULL)
+        return &(getClient()->dev);
+    else
+        return NULL;
+}
+
+/**
+  * Retrieve the pointer of the i2c_client struct representing the IC as i2c
+  *slave
+  * @return client if it was previously set or NULL in all the other cases
+  */
+struct i2c_client *getClient()
+{
+    if (client != NULL)
+        return (struct i2c_client *)client;
+    else
+        return NULL;
+}
+
+/****************** New I2C API *********************/
+
+/**
+  * Perform a direct bus read
+  * @param outBuf pointer of a byte array which should contain the byte read
+  *from the IC
+  * @param byteToRead number of bytes to read
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_read(u8 *outBuf, int byteToRead)
+{
+    int ret = 0;
+
+    if (client == NULL)
+        return ERROR_BUS_O;
+
+    ret = touch_i2c_read(client, NULL, 0, (__u8 *)outBuf, byteToRead);
+    if(ret < 0) {
+        return ERROR_BUS_WR;
+    }
+
+    return OK;
+}
+
+
+/**
+  * Perform a bus write followed by a bus read without a stop condition
+  * @param cmd byte array containing the command to write
+  * @param cmdLength size of cmd
+  * @param outBuf pointer of a byte array which should contain the bytes read
+  *from the IC
+  * @param byteToRead number of bytes to read
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_writeRead(u8 *cmd, int cmdLength, u8 *outBuf, int byteToRead)
+{
+    int ret = 0;
+
+    if (client == NULL)
+        return ERROR_BUS_O;
+
+    ret = touch_i2c_read(client, (__u8 *)cmd, (__u16)cmdLength, (__u8 *)outBuf, byteToRead);
+    if(ret < 0) {
+        return ERROR_BUS_WR;
+    }
+
+    return OK;
+}
+
+/**
+  * Perform a bus write
+  * @param cmd byte array containing the command to write
+  * @param cmdLength size of cmd
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_write(u8 *cmd, int cmdLength)
+{
+    int ret = 0;
+
+    if (client == NULL)
+        return ERROR_BUS_O;
+
+    ret = touch_i2c_write(client, (__u8 *)cmd, (__u16)cmdLength);
+    if(ret < 0) {
+        return ERROR_BUS_WR;
+    }
+
+    return OK;
+}
+
+/**
+  * Write a FW command to the IC and check automatically the echo event
+  * @param cmd byte array containing the command to send
+  * @param cmdLength size of cmd
+  * @return OK if success, or an error code which specify the type of error
+  */
+int fts_writeFwCmd(u8 *cmd, int cmdLength)
+{
+    int ret = -1;
+    int ret2 = -1;
+    int retry = 0;
+
+    if (client == NULL)
+        return ERROR_BUS_O;
+
+    resetErrorList();
+
+    fts_disableInterruptNoSync();
+
+    while (retry < I2C_RETRY && (ret < OK || ret2 < OK)) {
+
+        ret = touch_i2c_write(client, (__u8 *)cmd, (__u16)cmdLength);
+
+        retry++;
+        if (ret >= 0)
+            ret2 = checkEcho(cmd, cmdLength);
+        if (ret < OK || ret2 < OK)
+            msleep(I2C_WAIT_BEFORE_RETRY);
+        /* TPD_INFO("fts_writeCmd: attempt %d\n", retry); */
+    }
+
+    fts_enableInterrupt();
+
+    if (ret < 0) {
+        TPD_INFO("fts_writeFwCmd: ERROR %08X\n", ERROR_BUS_W);
+        return ERROR_BUS_W;
+    }
+    if (ret2 < OK) {
+        TPD_INFO("fts_writeFwCmd: check echo ERROR %08X\n", ret2);
+        return ret2;
+    }
+    return OK;
+}
+
+
+/**
+  * Perform two bus write and one bus read without any stop condition
+  * In case of FTI this function is not supported and the same sequence
+  * can be achieved calling fts_write followed by an fts_writeRead.
+  * @param writeCmd1 byte array containing the first command to write
+  * @param writeCmdLength size of writeCmd1
+  * @param readCmd1 byte array containing the second command to write
+  * @param readCmdLength size of readCmd1
+  * @param outBuf pointer of a byte array which should contain the bytes read
+  * from the IC
+  * @param byteToRead number of bytes to read
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_writeThenWriteRead(u8 *writeCmd1, int writeCmdLength, u8 *readCmd1, int
+               readCmdLength, u8 *outBuf, int byteToRead)
+{
+    int ret = -1;
+
+    if (client == NULL)
+        return ERROR_BUS_O;
+
+    ret = touch_i2c_write(client, (__u8 *)writeCmd1, (__u16)writeCmdLength);
+    if(ret < 0) {
+        return ERROR_BUS_WR;
+    }
+    ret = touch_i2c_read(client, (__u8 *)readCmd1, (__u16)readCmdLength, (__u8 *)outBuf, byteToRead);
+    if(ret < 0) {
+        return ERROR_BUS_WR;
+    }
+
+    return OK;
+}
+
+/**
+  * Perform a chunked write with one byte op code and 1 to 8 bytes address
+  * @param cmd byte containing the op code to write
+  * @param addrSize address size in byte
+  * @param address the starting address
+  * @param data pointer of a byte array which contain the bytes to write
+  * @param dataSize size of data
+  * @return OK if success or an error code which specify the type of error
+  */
+/* this function works only if the address is max 8 bytes */
+int fts_writeU8UX(u8 cmd, AddrSize addrSize, u64 address, u8 *data, int
+          dataSize)
+{
+    u8 finalCmd[1 + addrSize + WRITE_CHUNK];
+    int remaining = dataSize;
+    int toWrite = 0, i = 0;
+
+    if (addrSize <= sizeof(u64)) {
+        while (remaining > 0) {
+            if (remaining >= WRITE_CHUNK) {
+                toWrite = WRITE_CHUNK;
+                remaining -= WRITE_CHUNK;
+            } else {
+                toWrite = remaining;
+                remaining = 0;
+            }
+
+            finalCmd[0] = cmd;
+            TPD_DEBUG("%s: addrSize = %d\n", __func__,
+                 addrSize);
+            for (i = 0; i < addrSize; i++) {
+                finalCmd[i + 1] = (u8)((address >> ((addrSize - 1 - i) * 8)) & 0xFF);
+                TPD_INFO("%s: cmd[%d] = %02X\n", __func__, i + 1, finalCmd[i + 1]);
+            }
+
+            memcpy(&finalCmd[addrSize + 1], data, toWrite);
+
+            if (fts_write(finalCmd, 1 + addrSize + toWrite) < OK) {
+                TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_BUS_W);
+                return ERROR_BUS_W;
+            }
+
+            address += toWrite;
+
+            data += toWrite;
+        }
+    } else
+        TPD_INFO("%s: address size bigger than max allowed %ld... ERROR %08X\n",__func__, sizeof(u64), ERROR_OP_NOT_ALLOW);
+
+    return OK;
+}
+
+/**
+  * Perform a chunked write read with one byte op code and 1 to 8 bytes address
+  * and dummy byte support.
+  * @param cmd byte containing the op code to write
+  * @param addrSize address size in byte
+  * @param address the starting address
+  * @param outBuf pointer of a byte array which contain the bytes to read
+  * @param byteToRead number of bytes to read
+  * @param hasDummyByte  if the first byte of each reading is dummy (must be
+  * skipped)
+  * set to 1, otherwise if it is valid set to 0 (or any other value)
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_writeReadU8UX(u8 cmd, AddrSize addrSize, u64 address, u8 *outBuf, int
+              byteToRead, int hasDummyByte)
+{
+    u8 finalCmd[1 + addrSize];
+    u8 *buff = NULL;/* worst case has dummy byte */
+    int remaining = byteToRead;
+    int toRead = 0, i = 0;
+	buff = kzalloc(sizeof(u8) *(READ_CHUNK + 1), GFP_KERNEL);
+	if(buff == NULL) {
+		TPD_INFO("kzalloc buff failed\n");
+		return ERROR_BUS_WR;
+	}
+
+    while (remaining > 0) {
+        if (remaining >= READ_CHUNK) {
+            toRead = READ_CHUNK;
+            remaining -= READ_CHUNK;
+        } else {
+            toRead = remaining;
+            remaining = 0;
+        }
+
+        finalCmd[0] = cmd;
+        for (i = 0; i < addrSize; i++)
+            finalCmd[i + 1] = (u8)((address >> ((addrSize - 1 - i) * 8)) & 0xFF);
+
+        if (hasDummyByte == 1) {
+            if (fts_writeRead(finalCmd, 1 + addrSize, buff, toRead + 1) < OK) {
+                TPD_INFO("%s: read error... ERROR %08X\n", __func__, ERROR_BUS_WR);
+                return ERROR_BUS_WR;
+            }
+            memcpy(outBuf, buff + 1, toRead);
+        } else {
+            if (fts_writeRead(finalCmd, 1 + addrSize, buff, toRead) < OK) {
+                TPD_INFO("%s: read error... ERROR %08X\n", __func__, ERROR_BUS_WR);
+                return ERROR_BUS_WR;
+            }
+            memcpy(outBuf, buff, toRead);
+        }
+
+        address += toRead;
+
+        outBuf += toRead;
+    }
+	kfree(buff);
+
+    return OK;
+}
+
+/**
+  * Perform a chunked write followed by a second write with one byte op code
+  * for each write and 1 to 8 bytes address (the sum of the 2 address size of
+  * the two writes can not exceed 8 bytes)
+  * @param cmd1 byte containing the op code of first write
+  * @param addrSize1 address size in byte of first write
+  * @param cmd2 byte containing the op code of second write
+  * @param addrSize2 address size in byte of second write
+  * @param address the starting address
+  * @param data pointer of a byte array which contain the bytes to write
+  * @param dataSize size of data
+  * @return OK if success or an error code which specify the type of error
+  */
+/* this function works only if the sum of two addresses in the two commands is
+ * max 8 bytes */
+int fts_writeU8UXthenWriteU8UX(u8 cmd1, AddrSize addrSize1, u8 cmd2, AddrSize
+                   addrSize2, u64 address, u8 *data, int dataSize)
+{
+    u8 finalCmd1[1 + addrSize1];
+    u8 finalCmd2[1 + addrSize2 + WRITE_CHUNK];
+    int remaining = dataSize;
+    int toWrite = 0, i = 0;
+
+    while (remaining > 0) {
+        if (remaining >= WRITE_CHUNK) {
+            toWrite = WRITE_CHUNK;
+            remaining -= WRITE_CHUNK;
+        } else {
+            toWrite = remaining;
+            remaining = 0;
+        }
+
+        finalCmd1[0] = cmd1;
+        for (i = 0; i < addrSize1; i++)
+            finalCmd1[i + 1] = (u8)((address >> ((addrSize1 + addrSize2 - 1 - i) * 8)) & 0xFF);
+
+        finalCmd2[0] = cmd2;
+        for (i = addrSize1; i < addrSize1 + addrSize2; i++)
+            finalCmd2[i - addrSize1 + 1] = (u8)((address >> ((addrSize1 + addrSize2 - 1 - i) * 8)) & 0xFF);
+
+        memcpy(&finalCmd2[addrSize2 + 1], data, toWrite);
+
+        if (fts_write(finalCmd1, 1 + addrSize1) < OK) {
+            TPD_INFO("%s: first write error... ERROR %08X\n",__func__, ERROR_BUS_W);
+            return ERROR_BUS_W;
+        }
+
+        if (fts_write(finalCmd2, 1 + addrSize2 + toWrite) < OK) {
+            TPD_INFO("%s: second write error... ERROR %08X\n", __func__, ERROR_BUS_W);
+            return ERROR_BUS_W;
+        }
+
+        address += toWrite;
+
+        data += toWrite;
+    }
+
+    return OK;
+}
+
+/**
+  * Perform a chunked write  followed by a write read with one byte op code
+  * and 1 to 8 bytes address for each write and dummy byte support.
+  * @param cmd1 byte containing the op code of first write
+  * @param addrSize1 address size in byte of first write
+  * @param cmd2 byte containing the op code of second write read
+  * @param addrSize2 address size in byte of second write    read
+  * @param address the starting address
+  * @param outBuf pointer of a byte array which contain the bytes to read
+  * @param byteToRead number of bytes to read
+  * @param hasDummyByte  if the first byte of each reading is dummy (must be
+  * skipped) set to 1,
+  *  otherwise if it is valid set to 0 (or any other value)
+  * @return OK if success or an error code which specify the type of error
+  */
+/* this function works only if the sum of two addresses in the two commands is
+ * max 8 bytes */
+int fts_writeU8UXthenWriteReadU8UX(u8 cmd1, AddrSize addrSize1, u8 cmd2,
+                   AddrSize addrSize2, u64 address, u8 *outBuf,
+                   int byteToRead, int hasDummyByte)
+{
+    u8 finalCmd1[1 + addrSize1];
+    u8 finalCmd2[1 + addrSize2];
+    u8 *buff=NULL;//[READ_CHUNK + 1];/* worst case has dummy byte */
+    int remaining = byteToRead;
+    int toRead = 0, i = 0;
+
+	buff = kzalloc(sizeof(u8) *(READ_CHUNK + 1), GFP_KERNEL);
+	if(buff == NULL) {
+		TPD_INFO("kzalloc buff failed\n");
+		return ERROR_BUS_WR;
+	}
+    while (remaining > 0) {
+        if (remaining >= READ_CHUNK) {
+            toRead = READ_CHUNK;
+            remaining -= READ_CHUNK;
+        } else {
+            toRead = remaining;
+            remaining = 0;
+        }
+
+
+        finalCmd1[0] = cmd1;
+        for (i = 0; i < addrSize1; i++)
+            finalCmd1[i + 1] = (u8)((address >> ((addrSize1 + addrSize2 - 1 - i) * 8)) & 0xFF);
+        /* TPD_INFO("%s: finalCmd1[%d] =  %02X\n",
+          *     __func__, i+1, finalCmd1[i + 1]); */
+
+        finalCmd2[0] = cmd2;
+        for (i = addrSize1; i < addrSize1 + addrSize2; i++)
+            finalCmd2[i - addrSize1 + 1] = (u8)((address >> ((addrSize1 + addrSize2 - 1 - i) * 8)) & 0xFF);
+
+        if (fts_write(finalCmd1, 1 + addrSize1) < OK) {
+            TPD_INFO("%s: first write error... ERROR %08X\n",__func__, ERROR_BUS_W);
+			kfree(buff);
+            return ERROR_BUS_W;
+        }
+
+        if (hasDummyByte == 1) {
+            if (fts_writeRead(finalCmd2, 1 + addrSize2, buff, toRead + 1) < OK) {
+                TPD_INFO("%s: read error... ERROR %08X\n", __func__, ERROR_BUS_WR);
+				kfree(buff);
+                return ERROR_BUS_WR;
+            }
+            memcpy(outBuf, buff + 1, toRead);
+        } else {
+            if (fts_writeRead(finalCmd2, 1 + addrSize2, buff, toRead) < OK) {
+                TPD_INFO("%s: read error... ERROR %08X\n", __func__, ERROR_BUS_WR);
+				kfree(buff);
+                return ERROR_BUS_WR;
+            }
+            memcpy(outBuf, buff, toRead);
+        }
+
+        address += toRead;
+
+        outBuf += toRead;
+    }
+	kfree(buff);
+    return OK;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.h
new file mode 100644
index 0000000000000000000000000000000000000000..2607d01f5f7cb67404f16efc16583ecb46951105
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsIO.h
@@ -0,0 +1,44 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsIO.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+/*!
+  * \file ftsIO.h
+  * \brief Contains all the definitions and prototypes used and implemented in
+  * ftsIO.c
+  */
+
+#ifndef FTS_IO_H
+#define FTS_IO_H
+
+#include "ftsSoftware.h"
+#include <linux/i2c.h>
+#include <linux/i2c-dev.h>
+
+#define I2C_RETRY                   3    /* /< number of retry in case of i2c failure */
+#define I2C_WAIT_BEFORE_RETRY       2    /* /< wait in ms before retry an i2c transaction */
+
+struct i2c_client *getClient(void);
+int openChannel(void *clt);
+struct device *getDev(void);
+
+/*************** NEW I2C API ****************/
+int changeSAD(u8 sad);
+int fts_read(u8 *outBuf, int byteToRead);
+int fts_writeRead(u8 *cmd, int cmdLength, u8 *outBuf, int byteToRead);
+int fts_write(u8 *cmd, int cmdLength);
+int fts_writeFwCmd(u8 *cmd, int cmdLenght);
+int fts_writeThenWriteRead(u8 *writeCmd1, int writeCmdLength, u8 *readCmd1, int readCmdLength, u8 *outBuf, int byteToRead);
+int fts_writeU8UX(u8 cmd, AddrSize addrSize, u64 address, u8 *data, int dataSize);
+int fts_writeReadU8UX(u8 cmd, AddrSize addrSize, u64 address, u8 *outBuf, int byteToRead, int hasDummyByte);
+int fts_writeU8UXthenWriteU8UX(u8 cmd1, AddrSize addrSize1, u8 cmd2, AddrSize addrSize2, u64 address, u8 *data, int dataSize);
+int fts_writeU8UXthenWriteReadU8UX(u8 cmd1, AddrSize addrSize1, u8 cmd2,
+                   AddrSize addrSize2, u64 address, u8 *outBuf, int count, int hasDummyByte);
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsSoftware.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsSoftware.h
new file mode 100644
index 0000000000000000000000000000000000000000..cf54c9b87a9a92d2daa62851c97737fd3147fc1f
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsSoftware.h
@@ -0,0 +1,390 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsSoftware.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsSoftware.h
+  * \brief Contains all the definitions and information related to the IC from a
+  *fw/driver point of view
+  */
+
+
+#ifndef FTS_SOFTWARE_H
+#define FTS_SOFTWARE_H
+#include <linux/types.h>
+#include "ftsHardware.h"
+
+
+/* unsigned types */
+//typedef uint8_t u8;    /* /< basic type that represent one byte (or 8 bits) */
+//typedef uint16_t u16;    /* /< basic type that represent 2 bytes (or 16 bits) */
+//typedef uint32_t u32;    /* /< basic type that represent 4 bytes (or 32 bits) */
+//typedef uint64_t u64;    /* /< basic type that represent 8 bytes (or 64 bits) */
+
+/* signed type */
+typedef signed char i8;    /* /< basic type that represent one signed byte (or 8
+             * bits) */
+
+/**
+  *    Enumerator which contains all the possible address length expressed in
+  *bytes.
+  */
+typedef enum {
+    NO_ADDR = 0,
+    BITS_8    = 1,
+    BITS_16 = 2,
+    BITS_24 = 3,
+    BITS_32 = 4,
+    BITS_40 = 5,
+    BITS_48 = 6,
+    BITS_56 = 7,
+    BITS_64 = 8
+} AddrSize;
+
+
+/********************  NEW API  *********************/
+
+/* HOST COMMAND */
+/** @defgroup host_command Fw Host op codes
+  * Valid op codes for fw commands
+  */
+
+/** @defgroup scan_mode    Scan Mode
+  * @ingroup host_command
+  * Set the scanning mode required according to the parameters
+  */
+#define FTS_CMD_SCAN_MODE     0xA0    /* /< OP Code to set scan mode */
+
+/** @defgroup feat_sel     Feature Select
+  * @ingroup host_command
+  * Set the system defined features to enable/disable according the parameters
+  */
+#define FTS_CMD_FEATURE       0xA2    /* /< OP code to set features */
+
+/** @defgroup sys_cmd  System Command
+  * @ingroup host_command
+  * Execute a system command to perform core tasks
+  */
+#define FTS_CMD_SYSTEM        0xA4    /* /< OP code to write s system command */
+/* end host_command group */
+
+/* SCAN MODE OPTION (0xA0) */
+/* Scan mode selection */
+/** @defgroup scan_opt     Scan Mode Option
+  * @ingroup scan_mode
+  * Valid scanning modes and their options
+  */
+#define SCAN_MODE_ACTIVE        0x00    /* /< Select the Active scanning mode */
+#define SCAN_MODE_LOW_POWER     0x01    /* /< Select the low power scanning mode */
+#define SCAN_MODE_JIG_1         0x02    /* /< Select the Jig test 1 */
+#define SCAN_MODE_LOCKED        0x03    /* /< Select the Scan mode which will be locked */
+
+/* Active mode option (bitmask) */
+/** @defgroup active_bitmask Active Mode Bitmask
+  * @ingroup scan_opt
+  * Bitmask to use to enables the specific scanning with the SCAN_MODE_ACTIVE
+  * option
+  */
+#define ACTIVE_MULTI_TOUCH    0x01    /* /< Bit 0 MS/SS scan */
+#define ACTIVE_KEY            0x02    /* /< Bit 1 Key scan */
+#define ACTIVE_HOVER          0x04    /* /< Bit 2 Hover scan */
+#define ACTIVE_PROXIMITY      0x08    /* /< Bit 3 Proximity scan */
+#define ACTIVE_FORCE          0x10    /* /< Bit 4 Force scan */
+
+
+/* Locked mode option (locked mode) */
+/** @defgroup locked_opt Locked Mode Option
+  * @ingroup scan_opt
+  * Options to enable and lock specific scanning with the SCAN_MODE_LOCKED
+  *option
+  */
+#define LOCKED_ACTIVE        0x00    /* /< Active Scan Mode */
+#define LOCKED_HOVER         0x01    /* /< Hover Scan Mode */
+#define LOCKED_IDLE          0x02    /* /< Idle Scan Mode */
+#define LOCKED_LP_DETECT     0x10    /* /< Low Power SS */
+#define LOCKED_LP_ACTIVE     0x11    /* /< Low Power MS */
+
+/* FEATURE SELECT OPTION (0xA2) */
+/* Feature Selection */
+/** @defgroup feat_opt     Feature Selection Option
+  * @ingroup feat_sel
+  * System defined features that can be enable/disable
+  */
+#define FEAT_SEL_GLOVE        0x00    /* /< Glove Mode */
+#define FEAT_SEL_COVER        0x01    /* /< Cover Mode */
+#define FEAT_SEL_CHARGER      0x02    /* /< Charger Mode */
+#define FEAT_SEL_GESTURE      0x03    /* /< Gesture Mode */
+#define FEAT_SEL_GRIP         0x04    /* /< Grip Detection */
+#define FEAT_SEL_STYLUS       0x07    /* /< Stylus Mode (this is a driver define, not available in FW) */
+
+/* Feature Settings */
+#define FEAT_ENABLE         1    /* /< General value to enable a feature */
+#define FEAT_DISABLE        0    /* /< General value to disable a feature */
+
+
+/* Charger */
+/** @defgroup charger_opt     Charger Mode Option
+  * @ingroup feat_sel
+  * Option for Charger Mode, it is a bitmask where the each bit indicate a
+  *different kind of chager
+  */
+#define CHARGER_CABLE    0x01    /* /< normal usb charger */
+#define CHARGER_WIRLESS  0x02    /* /< wireless charger */
+
+/* Gestures */
+/** @defgroup gesture_opt     Gesture Mode Option
+  * @ingroup feat_sel
+  * Gesture IDs of the predefined gesture recognized by the fw.
+  * The ID represent also the position of the corresponding bit in the gesture
+  * mask
+  */
+#define GEST_ID_UP_1F          0x01    /* /< Bottom to Top line */
+#define GEST_ID_DOWN_1F        0x02    /* /< Top to bottom line */
+#define GEST_ID_LEFT_1F        0x03    /* /< Right to left line */
+#define GEST_ID_RIGHT_1F       0x04    /* /< Left to right line */
+#define GEST_ID_DBLTAP         0x05    /* /< Double Tap */
+#define GEST_ID_O              0x06    /* /< 'O' */
+#define GEST_ID_C              0x07    /* /< 'C' */
+#define GEST_ID_M              0x08    /* /< 'M' */
+#define GEST_ID_W              0x09    /* /< 'W' */
+#define GEST_ID_E              0x0A    /* /< 'e' */
+#define GEST_ID_L              0x0B    /* /< 'L' */
+#define GEST_ID_F              0x0C    /* /< 'F' */
+#define GEST_ID_V              0x0D    /* /< 'V' */
+#define GEST_ID_AT             0x0E    /* /< '@' */
+#define GEST_ID_S              0x0F    /* /< 'S' */
+#define GEST_ID_Z              0x10    /* /< 'Z' */
+#define GEST_ID_LEFTBRACE      0x11    /* /< '<' */
+#define GEST_ID_RIGHTBRACE     0x12    /* /< '>' */
+#define GEST_ID_CARET          0x13    /* /< '^' */
+#define GEST_ID_SINGLE		   0x19	   /*single tap*/
+#define GEST_ID_DOU_DOWN	   0x15		/*||*/
+
+/* WRYTE SYSTEM COMMAND (0xA4) */
+/* System command */
+/** @defgroup sys_opt     System Command Option
+  * @ingroup sys_cmd
+  * Valid System Command Parameters
+  */
+#define SYS_CMD_SPECIAL        0x00    /* /< Special Commands */
+#define SYS_CMD_INT            0x01    /* /< FW Interrupt Control */
+#define SYS_CMD_FORCE_CAL      0x02    /* /< Force Calibration */
+#define SYS_CMD_CX_TUNING      0x03    /* /< CX initialization */
+#define SYS_CMD_ITO            0x04    /* /< ITO test */
+#define SYS_CMD_SAVE_FLASH     0x05    /* /< Saving to flash */
+#define SYS_CMD_LOAD_DATA      0x06    /* /< Load Host data memory */
+#define SYS_CMD_SPECIAL_TUNING 0x08    /* /< Perform some special tuning */
+#define SYS_CMD_MP_FLAG        0x0C    /* /< Update value of MP flag in RAM */
+
+/* System command settings */
+/* Special commands */
+/** @defgroup sys_special_opt     Special Command Option
+  * @ingroup sys_cmd
+  * Valid special command
+  */
+#define SPECIAL_SYS_RESET       0x00    /* /< System Reset triggered by the FW */
+#define SPECIAL_FIFO_FLUSH      0x01    /* /< Flush of the FIFO */
+#define SPECIAL_PANEL_INIT      0x02    /* /< Panel Initialization */
+#define SPECIAL_FULL_PANEL_INIT 0x03    /* /< Full panel initialization */
+
+/* Force Cal and Cx auto tuning */
+/** @defgroup forcecal_cx_opt     Force Cal and Tuning Option
+  * @ingroup sys_cmd
+  * Valid bitmask for triggering forcecal or performing manual autotune
+  */
+#define CAL_MS_TOUCH        0x01    /* /< Mutual Sense Touch */
+#define CAL_MS_LOW_POWER    0x02    /* /< Mutual Sense Touch in low power mode */
+#define CAL_SS_TOUCH        0x04    /* /< Self Sense Touch */
+#define CAL_SS_IDLE         0x08    /* /< Self Sense Touch in idle mode */
+#define CAL_MS_KEY          0x10    /* /< Mutual Sense Key */
+#define CAL_SS_KEY          0x20    /* /< Self Sense Key */
+#define CAL_MS_FORCE        0x40    /* /< Mutual Sense Force */
+#define CAL_SS_FORCE        0x80    /* /< Self Sense Force */
+
+/* ITO checks (position of the bit in the mask) */
+/** @defgroup ito_opt     ITO Test Option
+  * @ingroup sys_cmd
+  * Valid option for the ITO test
+  */
+#define ITO_FORCE_OPEN        0x00    /* /< Check if some force channels is open */
+#define ITO_SENSE_OPEN        0x01    /* /< Check if some sense channels is open */
+#define ITO_FORCE_GROUND      0x02    /* /< Check if some force channels is short to ground */
+#define ITO_SENSE_GROUND      0x03    /* /< Check if some sense channels is short to ground */
+#define ITO_FORCE_VDD         0x04    /* /< Check if some force channels is short to VDD */
+#define ITO_SENSE_VDD         0x05    /* /< Check if some sense channels is short to VDD */
+#define ITO_FORCE_FORCE       0x06    /* /< Check force to force channels */
+#define ITO_FORCE_SENSE       0x07    /* /< Check force to sense channels */
+#define ITO_SENSE_SENSE       0x08    /* /< Check sense to sense channels */
+#define ITO_KEY_FORCE_OPEN    0x09    /* /< Check if some force channels used for the key is open */
+#define ITO_KEY_SENSE_OPEN    0x0A    /* /< Check if some sense channels used for the key is open */
+
+/* Save flash */
+/** @defgroup save_opt     Save to Flash Option
+  * @ingroup sys_cmd
+  * Valid option for saving data to the Flash
+  */
+#define SAVE_FW_CONF    0x01    /* /< Save the confing to the flash */
+#define SAVE_CX         0x02    /* /< Save the CX to the flash */
+#define SAVE_PANEL_CONF 0x04    /* /< Save the Panel configuration to the flash */
+
+/* Load Data */
+/** @defgroup load_opt     Load Host Data Option
+  * @ingroup sys_cmd
+  * Valid option to ask to the FW to load host data into the memory
+  */
+#define LOAD_SYS_INFO                   0x01    /* /< Load System Info */
+#define LOAD_CX_MS_TOUCH                0x10    /* /< Load MS Init Data for Active Mode */
+#define LOAD_CX_MS_LOW_POWER            0x11    /* /< Load MS Init Data for Low Power Mode */
+#define LOAD_CX_SS_TOUCH                0x12    /* /< Load SS Init Data for Active Mode */
+#define LOAD_CX_SS_TOUCH_IDLE           0x13    /* /< Load SS Init Data for Low Power Mode */
+#define LOAD_CX_MS_KEY                  0x14    /* /< Load MS Init Data for Key */
+#define LOAD_CX_SS_KEY                  0x15    /* /< Load SS Init Data for Key */
+#define LOAD_CX_MS_FORCE                0x16    /* /< Load MS Init Data for Force */
+#define LOAD_CX_SS_FORCE                0x17    /* /< Load SS Init Data for Force */
+#define LOAD_SYNC_FRAME_RAW             0x30    /* /< Load a Synchronized Raw Frame */
+#define LOAD_SYNC_FRAME_FILTER          0x31    /* /< Load a Synchronized Filter Frame */
+#define LOAD_SYNC_FRAME_STRENGTH        0x33    /* /< Load a Synchronized Strength Frame */
+#define LOAD_SYNC_FRAME_BASELINE        0x32    /* /< Load a Synchronized Baseline Frame */
+#define LOAD_PANEL_CX_TOT_MS_TOUCH      0x50    /* /< Load TOT MS Init Data for Active Mode */
+#define LOAD_PANEL_CX_TOT_MS_LOW_POWER  0x51    /* /< Load TOT MS Init Data for Low Power Mode */
+#define LOAD_PANEL_CX_TOT_SS_TOUCH      0x52    /* /< Load TOT SS Init Data for Active Mode */
+#define LOAD_PANEL_CX_TOT_SS_TOUCH_IDLE 0x53    /* /< Load TOT SS Init Data for Low Power Mode */
+#define LOAD_PANEL_CX_TOT_MS_KEY        0x54    /* /< Load TOT MS Init Data for Key */
+#define LOAD_PANEL_CX_TOT_SS_KEY        0x55    /* /< Load TOT SS Init Data for Key */
+#define LOAD_PANEL_CX_TOT_MS_FORCE      0x56    /* /< Load TOT MS Init Data for Force */
+#define LOAD_PANEL_CX_TOT_SS_FORCE      0x57    /* /< Load TOT SS Init Data for Force */
+
+/* Special Tuning */
+/** @defgroup spcl_tun_opt     Special Tuning Option
+  * @ingroup sys_cmd
+  * Valid special tuning operations which the fw can perform (bitmask)
+  */
+#define SPECIAL_TUNING_LP_TIMER 0x01    /* /< Perform LP Timer calibration */
+#define SPECIAL_TUNING_IOFF     0x02    /* /< Perform Ioff calibration */
+
+
+/* EVENT ID */
+/** @defgroup events_group     FW Event IDs and Types
+  * Event IDs and Types pushed by the FW into the FIFO
+  */
+#define EVT_ID_NOEVENT          0x00    /* /< No Events */
+#define EVT_ID_CONTROLLER_READY 0x03    /* /< Controller ready, issued after a system reset. */
+#define EVT_ID_ENTER_POINT      0x13    /* /< Touch enter in the sensing area */
+#define EVT_ID_MOTION_POINT     0x23    /* /< Touch motion (a specific touch changed position) */
+#define EVT_ID_LEAVE_POINT      0x33    /* /< Touch leave the sensing area */
+#define EVT_ID_STATUS_UPDATE    0x43    /* /< FW report a system condition change */
+#define EVT_ID_USER_REPORT      0x53    /* /< User related events triggered (keys, gestures, proximity etc) */
+#define EVT_ID_DEBUG            0xE3    /* /< Debug Info */
+#define EVT_ID_ERROR            0xF3    /* /< Error Event */
+#define EVT_ID_MOTION_POINT_MAJOR  0x27
+
+
+/* /< Max number of unique event IDs supported */
+#define NUM_EVT_ID        (((EVT_ID_ERROR & 0xF0) >> 4)+1)
+
+/* STATUS TYPE */
+/** @defgroup status_type     Status Event Types
+  * @ingroup events_group
+  * Types of EVT_ID_STATUS_UPDATE events
+  */
+#define EVT_TYPE_STATUS_ECHO            0x01    /* /< Echo event, contain the first 5 bytes of the FW command sent */
+#define EVT_TYPE_STATUS_FRAME_DROP      0x03    /* /< Some frame was skipped during the elaboration */
+#define EVT_TYPE_STATUS_FORCE_CAL       0x05    /* /< Force Calibration has triggered */
+#define EVT_TYPE_STATUS_WATER           0x06    /* /< Water Mode */
+#define EVT_TYPE_STATUS_SS_RAW_SAT      0x07    /* /< Self Sense data saturated */
+
+/* USER TYPE */
+/** @defgroup user_type     User Event Types
+  * @ingroup events_group
+  * Types of EVT_ID_USER_REPORT events generated by the FW
+  */
+#define EVT_TYPE_USER_KEY       0x00    /* /< Keys pressed/relesed event report */
+#define EVT_TYPE_USER_PROXIMITY 0x01    /* /< Proximity detection event report */
+#define EVT_TYPE_USER_GESTURE   0x02    /* /< Gesture detection event report */
+
+/* ERROR TYPE */
+/** @defgroup error_type  Error Event Types
+  * @ingroup events_group
+  * Types of EVT_ID_ERROR events reported by the FW
+  */
+#define EVT_TYPE_ERROR_HARD_FAULT       0x02    /* /< Hard Fault */
+#define EVT_TYPE_ERROR_WATCHDOG         0x06    /* /< Watchdog timer expired */
+
+#define EVT_TYPE_ERROR_CRC_CFG_HEAD     0x20    /* /< CRC error in the Config Area Header */
+#define EVT_TYPE_ERROR_CRC_CFG          0x21    /* /< CRC error in the Config Area */
+#define EVT_TYPE_ERROR_CRC_PANEL_HEAD   0x22    /* /< CRC error in the Panel Area Header */
+#define EVT_TYPE_ERROR_CRC_PANEL        0x23    /* /< CRC error in the Panel Area */
+
+#define EVT_TYPE_ERROR_ITO_FORCETOGND   0x60    /* /< Force channel/s short to ground */
+#define EVT_TYPE_ERROR_ITO_SENSETOGND   0x61    /* /< Sense channel/s short to ground */
+#define EVT_TYPE_ERROR_ITO_FORCETOVDD   0x62    /* /< Force channel/s short to VDD */
+#define EVT_TYPE_ERROR_ITO_SENSETOVDD   0x63    /* /< Sense channel/s short to VDD */
+#define EVT_TYPE_ERROR_ITO_FORCE_P2P    0x64    /* /< Pin to Pin short Force channel/s */
+#define EVT_TYPE_ERROR_ITO_SENSE_P2P    0x65    /* /< Pin to Pin short Sense channel/s */
+#define EVT_TYPE_ERROR_ITO_FORCEOPEN    0x66    /* /< Force Panel open */
+#define EVT_TYPE_ERROR_ITO_SENSEOPEN    0x67    /* /< Sense Panel open */
+#define EVT_TYPE_ERROR_ITO_KEYOPEN      0x68    /* /< Key open */
+
+#define EVT_TYPE_ERROR_CRC_CX_HEAD      0xA0    /* /< CRC error in the CX Area Header */
+#define EVT_TYPE_ERROR_CRC_CX           0xA1    /* /< CRC error in the CX Area */
+#define EVT_TYPE_ERROR_CRC_CX_SUB_HEAD  0xA5    /* /< CRC error in the CX Subsection Area Header */
+#define EVT_TYPE_ERROR_CRC_CX_SUB       0xA6    /* /< CRC error in the CX Subsection Area */
+#define EVT_TYPE_ERROR_ESD              0xF0    /* /< ESD error */
+
+
+/** @defgroup address Chip Address
+  * Collection of HW and SW Addresses useful to collect different kind of data
+  */
+
+/** @defgroup config_adr SW Address
+  * @ingroup address
+  * Important addresses of data stored into Config memory (and sometimes their
+  *dimensions)
+  */
+#define ADDR_CONFIG_ID              0x0010    /* /< Starting Address of the config ID */
+#define CONFIG_ID_BYTE              2         /* /< Number of bytes of config ID */
+#define ADDR_CONFIG_SENSE_LEN       0x0030    /* /< Address where is stored the number of sense channels */
+#define ADDR_CONFIG_FORCE_LEN       0x0031    /* /< Address where is stored the number of force channels */
+
+/** @defgroup mp_flags MP Flags value
+  * @ingroup mp_test
+  * Specify the MP flags value which are written into the flash after performing
+  * a full panel initialization which pass all the tests.
+  */
+
+#define MP_FLAG_FACTORY         0xA5    /* /< Full Panel Init done in factory */
+#define MP_FLAG_BOOT            0x5A    /* /< Full Panel Init done at boot */
+#define MP_FLAG_OTHERS          0xFF    /* /< Full Panel Init done somewhere else */
+
+/* ERROR INFO */
+#define ERROR_DUMP_ROW_SIZE    32           /* /< number of rows of the error memory */
+#define ERROR_DUMP_COL_SIZE    4            /* /< number of bytes for each row of the error memory */
+#define ERROR_DUMP_SIGNATURE   0xFA5005AF   /* /< first row signature of a proper dump */
+
+/* Touch Types */
+#define TOUCH_TYPE_INVALID      0x00    /* /< Invalid touch type */
+#define TOUCH_TYPE_FINGER       0x01    /* /< Finger touch */
+#define TOUCH_TYPE_GLOVE        0x02    /* /< Glove touch */
+#define TOUCH_TYPE_STYLUS       0x03    /* /< Stylus touch */
+#define TOUCH_TYPE_PALM         0x04    /* /< Palm touch */
+#define TOUCH_TYPE_HOVER        0x05    /* /< Hovering touch */
+
+/* Keys code */
+#define FTS_KEY_0        0x01    /* /< Key 0 bit */
+#define FTS_KEY_1        0x02    /* /< Key 1 bit */
+#define FTS_KEY_2        0x04    /* /< Key 2 bit */
+#define FTS_KEY_3        0x08    /* /< Key 3 bit */
+#define FTS_KEY_4        0x10    /* /< Key 4 bit */
+#define FTS_KEY_5        0x20    /* /< Key 5 bit */
+#define FTS_KEY_6        0x40    /* /< Key 6 bit */
+#define FTS_KEY_7        0x80    /* /< Key 7 bit */
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.c
new file mode 100644
index 0000000000000000000000000000000000000000..20d32177948805334a0f3fbc10e460d33379f39f
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.c
@@ -0,0 +1,5290 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTest.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTest.c
+  * \brief Contains all the functions related to the Mass Production Test
+  */
+
+#include "ftsCompensation.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsFrame.h"
+#include "ftsHardware.h"
+#include "ftsIO.h"
+#include "ftsSoftware.h"
+#include "ftsTest.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/serio.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include <linux/firmware.h>
+#include "../fts.h"
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+TestToDo tests;    /* /< global variable that specify the tests to perform during
+                    * the Mass Production Test */
+static LimitFile limit_file;    /* /< variable which contains the limit file
+                                 * during test */
+//extern ErrorList errors;
+
+/**
+  * Initialize the testToDo variable with the default tests to perform during
+  * the Mass Production Test
+  * @return OK
+  */
+int initTestToDo(void)
+{
+    /*** Initialize Limit File ***/
+    limit_file.size = 0;
+    limit_file.data = NULL;
+    strlcpy(limit_file.name, " ", MAX_LIMIT_FILE_NAME);
+
+
+	tests.MutualRawAdjITO = 1;
+
+	tests.MutualRaw = 1;  /* in case of YOCTA please use Map */
+    tests.MutualRawMap = 0;
+    tests.MutualRawGap = 0;
+    tests.MutualRawAdj = 0;
+	tests.MutualRawAdjGap = 0;
+    tests.MutualRawAdjPeak = 0;
+
+    tests.MutualRawLP = 0; /* in case of YOCTA please use Map */
+    tests.MutualRawGapLP = 0;
+    tests.MutualRawMapLP = 0;
+    tests.MutualRawAdjLP = 0;
+
+    tests.MutualCx1 = 0;
+    tests.MutualCx2 = 0;
+    tests.MutualCx2Adj = 0;
+	tests.MutualCxTotal = 0;
+	tests.MutualCxTotalAdj = 0;
+
+    tests.MutualCx1LP = 0;
+	tests.MutualCx2LP = 0;
+	tests.MutualCx2AdjLP = 0;
+	tests.MutualCxTotalLP = 1;
+    tests.MutualCxTotalAdjLP = 0;
+
+#ifdef PHONE_KEY
+	tests.MutualKeyRaw = 1;
+#else
+    tests.MutualKeyRaw = 0;
+#endif
+    tests.MutualKeyCx1 = 0;
+    tests.MutualKeyCx2 = 0;
+#ifdef PHONE_KEY
+	tests.MutualKeyCxTotal = 1;
+#else
+    tests.MutualKeyCxTotal = 0;
+#endif
+
+	tests.SelfForceRaw = 1; /* in case of YOCTA please use Map */
+    tests.SelfForceRawGap = 0;
+    tests.SelfForceRawMap = 0;
+
+	tests.SelfForceRawLP = 1; /* in case of YOCTA please use Map */
+    tests.SelfForceRawGapLP = 0;
+    tests.SelfForceRawMapLP = 0;
+
+    tests.SelfForceIx1 = 0;
+    tests.SelfForceIx2 = 0;
+    tests.SelfForceIx2Adj = 0;
+	tests.SelfForceIxTotal = 1;
+    tests.SelfForceIxTotalAdj = 0;
+    tests.SelfForceCx1 = 0;
+    tests.SelfForceCx2 = 0;
+    tests.SelfForceCx2Adj = 0;
+    tests.SelfForceCxTotal = 0;
+    tests.SelfForceCxTotalAdj = 0;
+    tests.SelfForceIx1LP = 0;
+    tests.SelfForceIx2LP = 0;
+    tests.SelfForceIx2AdjLP = 0;
+    tests.SelfForceIxTotalLP = 0;
+    tests.SelfForceIxTotalAdjLP = 0;
+    tests.SelfForceCx1LP = 0;
+    tests.SelfForceCx2LP = 0;
+    tests.SelfForceCx2AdjLP = 0;
+    tests.SelfForceCxTotalLP = 0;
+    tests.SelfForceCxTotalAdjLP = 0;
+
+	tests.SelfSenseRaw = 1;
+    tests.SelfSenseRawGap = 0;
+    tests.SelfSenseRawMap = 0;
+
+	tests.SelfSenseRawLP = 1;
+    tests.SelfSenseRawGapLP = 0;
+    tests.SelfSenseRawMapLP = 0;
+
+    tests.SelfSenseIx1 = 0;
+    tests.SelfSenseIx2 = 0;
+    tests.SelfSenseIx2Adj = 0;
+	tests.SelfSenseIxTotal = 1;
+    tests.SelfSenseIxTotalAdj = 0;
+    tests.SelfSenseCx1 = 0;
+    tests.SelfSenseCx2 = 0;
+    tests.SelfSenseCx2Adj = 0;
+    tests.SelfSenseCxTotal = 0;
+    tests.SelfSenseCxTotalAdj = 0;
+    tests.SelfSenseIx1LP = 0;
+    tests.SelfSenseIx2LP = 0;
+    tests.SelfSenseIx2AdjLP = 0;
+    tests.SelfSenseIxTotalLP = 0;
+    tests.SelfSenseIxTotalAdjLP = 0;
+    tests.SelfSenseCx1LP = 0;
+    tests.SelfSenseCx2LP = 0;
+    tests.SelfSenseCx2AdjLP = 0;
+    tests.SelfSenseCxTotalLP = 0;
+    tests.SelfSenseCxTotalAdjLP = 0;
+
+    return OK;
+}
+
+/**
+  * Compute the Horizontal adjacent matrix doing the abs of the difference
+  * between the column i with the i-1 one. \n
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of signed bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  * contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjHoriz(i8 *data, int row, int column, u8 **result)
+{
+    int i, j;
+    int size = row * (column - 1);
+
+    if (column < 2) {
+        TPD_INFO("computeAdjHoriz: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u8 *)kzalloc(size * sizeof(u8), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjHoriz: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 0; i < row; i++)
+        for (j = 1; j < column; j++)
+            *(*result + (i * (column - 1) + (j - 1))) = abs(data[i * column + j] - data[i * column + (j - 1)]);
+
+    return OK;
+}
+
+/**
+  * Compute the Horizontal adjacent matrix of short values doing the abs of
+  * the difference between the column i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  *  array one row after the other \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of signed bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which
+  * will contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjHorizTotal(short *data, int row, int column, u16 **result)
+{
+    int i, j;
+    int size = row * (column - 1);
+
+    if (column < 2) {
+        TPD_INFO("computeAdjHorizTotal: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u16 *)kzalloc(size * sizeof(u16), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjHorizTotal: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 0; i < row; i++)
+        for (j = 1; j < column; j++)
+            *(*result + (i * (column - 1) + (j - 1))) = abs(data[i * column + j] - data[i * column + (j - 1)]);
+
+    return OK;
+}
+
+/**
+  * Compute the Vertical adjacent matrix doing the abs of the difference between
+  * the row i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other. \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of signed bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  * contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjVert(i8 *data, int row, int column, u8 **result)
+{
+    int i, j;
+    int size = (row - 1) * (column);
+
+    if (row < 2) {
+        TPD_INFO("computeAdjVert: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u8 *)kzalloc(size * sizeof(u8), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjVert: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 1; i < row; i++)
+        for (j = 0; j < column; j++)
+            *(*result + ((i - 1) * column + j)) = abs(data[i * column + j] - data[(i - 1) * column + j]);
+
+    return OK;
+}
+
+/**
+  * Compute the Vertical adjacent matrix of short values doing the abs of
+  * the difference between the row i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other. \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of signed bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  * contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjVertTotal(short *data, int row, int column, u16 **result)
+{
+    int i, j;
+    int size = (row - 1) * (column);
+
+    if (row < 2) {
+        TPD_INFO("computeAdjVertTotal: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u16 *)kzalloc(size * sizeof(u16), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjVertTotal: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 1; i < row; i++)
+        for (j = 0; j < column; j++) *(*result + ((i - 1) * column + j)) = abs(data[i * column + j] - data[(i - 1) * column + j]);
+
+    return OK;
+}
+
+/**
+  * Compute the Horizontal adjacent matrix doing the abs of the difference
+  * between the column i with the i-1 one. \n
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of unsigned bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  *  contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjHorizFromU(u8 *data, int row, int column, u8 **result)
+{
+    int i, j;
+    int size = row * (column - 1);
+
+    if (column < 2) {
+        TPD_INFO("computeAdjHoriz: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u8 *)kzalloc(size * sizeof(u8), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjHoriz: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 0; i < row; i++)
+        for (j = 1; j < column; j++)
+            *(*result + (i * (column - 1) + (j - 1))) = abs(data[i * column + j] - data[i * column + (j - 1)]);
+
+    return OK;
+}
+
+/**
+  * Compute the Horizontal adjacent matrix of u16 values doing the abs of
+  * the difference between the column i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  *  array one row after the other \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of unsigned bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  * contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjHorizTotalFromU(u16 *data, int row, int column, u16 **result)
+{
+    int i, j;
+    int size = row * (column - 1);
+
+    if (column < 2) {
+        TPD_INFO("computeAdjHorizTotal: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u16 *)kzalloc(size * sizeof(u16), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjHorizTotal: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 0; i < row; i++)
+        for (j = 1; j < column; j++)
+            *(*result + (i * (column - 1) + (j - 1))) = abs(data[i * column + j] - data[i * column + (j - 1)]);
+
+    return OK;
+}
+
+/**
+  * Compute the Vertical adjacent matrix doing the abs of the difference between
+  *  the row i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other. \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of unsigned bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  *  contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjVertFromU(u8 *data, int row, int column, u8 **result)
+{
+    int i, j;
+    int size = (row - 1) * (column);
+
+    if (row < 2) {
+        TPD_INFO("computeAdjVert: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u8 *)kzalloc(size * sizeof(u8), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjVert: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 1; i < row; i++)
+        for (j = 0; j < column; j++)
+            *(*result + ((i - 1) * column + j)) = abs(data[i * column + j] - data[(i - 1) * column + j]);
+
+    return OK;
+}
+
+/**
+  * Compute the Vertical adjacent matrix of u16 values doing the abs of
+  * the difference between the row i with the i-1 one.
+  * Both the original data matrix and the adj matrix are disposed as 1 dimension
+  * array one row after the other. \n
+  * The resulting matrix has one column less than the starting original one \n
+  * @param data pointer to the array of unsigned bytes containing the original
+  * data
+  * @param row number of rows of the original data
+  * @param column number of columns of the original data
+  * @param result pointer of a pointer to an array of unsigned bytes which will
+  * contain the adj matrix
+  * @return OK if success or an error code which specify the type of error
+  */
+int computeAdjVertTotalFromU(u16 *data, int row, int column, u16 **result)
+{
+    int i, j;
+    int size = (row - 1) * (column);
+
+    if (row < 2) {
+        TPD_INFO("computeAdjVertTotal: ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    *result = (u16 *)kzalloc(size * sizeof(u16), GFP_KERNEL);
+    if (*result == NULL) {
+        TPD_INFO("computeAdjVertTotal: ERROR %08X\n", ERROR_ALLOC);
+        return ERROR_ALLOC;
+    }
+
+    for (i = 1; i < row; i++)
+        for (j = 0; j < column; j++)
+            *(*result + ((i - 1) * column + j)) = abs(data[i * column + j] - data[(i - 1) * column + j]);
+
+    return OK;
+}
+
+
+
+/**
+  * Check that each value of a matrix of short doesn't exceed a min and a Max
+  * value (these values are included in the interval). \n
+  * The matrix is stored as 1 dimension array one row after the other. \n
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param min minimum value allowed
+  * @param max Maximum value allowed
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMinMax(short *data, int row, int column, int min, int max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min || data[i * column + j] > max) {
+                TPD_INFO("checkLimitsMinMax: Node[%d,%d] = %d exceed limit [%d, %d]\n", i, j, data[i * column + j], min, max);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that the difference between the max and min of a matrix of short is
+  * less or equal to a threshold.\n
+  * The matrix is stored as 1 dimension array one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param threshold threshold value allowed
+  * @return OK if the difference is <= to threshold otherwise
+  * ERROR_TEST_CHECK_FAIL
+  */
+int checkLimitsGap(short *data, int row, int column, int threshold)
+{
+    int i, j;
+    int min_node;
+    int max_node;
+
+    if (row == 0 || column == 0) {
+        TPD_INFO("checkLimitsGap: invalid number of rows = %d or columns = %d  ERROR %08X\n",row, column, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    min_node = data[0];
+    max_node = data[0];
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min_node)
+                min_node = data[i * column + j];
+            else if (data[i * column + j] > max_node)
+                max_node = data[i * column + j];
+        }
+    }
+
+    if (max_node - min_node > threshold) {
+        TPD_INFO("checkLimitsGap: GAP = %d exceed limit  %d\n", max_node - min_node, threshold);
+        return ERROR_TEST_CHECK_FAIL;
+    } else
+        return OK;
+}
+
+/**
+  * Check that the difference between the max and min of a matrix of short is
+  * less or equal to a threshold.\n
+  * The matrix is stored as 1 dimension array one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param threshold threshold value allowed
+  * @param row_start index of the starting column which should be considered
+  * @param column_start index of the starting column which should be considered
+  * @param row_end number of index to subtract to row to identify last
+  *        valid row to check
+  * @param column_end number of index to subtract to column to identify last
+  *        valid column to check
+  * @return OK if the difference is <= to threshold otherwise
+  * ERROR_TEST_CHECK_FAIL
+  */
+int checkLimitsGapOffsets(short *data, int row, int column, int threshold,
+    int row_start, int column_start, int row_end, int column_end)
+{
+    int i, j;
+    int min_node;
+    int max_node;
+
+    if (row == 0 || column == 0) {
+        TPD_INFO("checkLimitsGap: invalid number of rows = %d or columns = %d  ERROR %08X\n", row, column, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+
+    min_node = data[row_start*column+column_start];
+    max_node = data[row_start*column+column_start];
+
+    for (i = row_start; i < row-row_end; i++) {
+        for (j = column_start; j < column-column_end; j++) {
+            if (data[i * column + j] < min_node)
+                min_node = data[i * column + j];
+            else if (data[i * column + j] > max_node)
+                max_node = data[i * column + j];
+        }
+    }
+
+    if (max_node - min_node > threshold) {
+        TPD_INFO("checkLimitsGap: GAP = %d exceed limit  %d\n", max_node - min_node, threshold);
+        return ERROR_TEST_CHECK_FAIL;
+    } else
+        return OK;
+}
+
+/**
+  * Check that each value of a matrix of i8 doesn't exceed a specific min and
+  *Max value  set for each node (these values are included in the interval). \n
+  * The matrixes of data, min and max values are stored as 1 dimension arrays
+  *one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param min pointer to a matrix which specify the minimum value allowed for
+  *each node
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  *each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMap(i8 *data, int row, int column, int *min, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min[i * column + j] || data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMap: Node[%d,%d] = %d exceed limit [%d, %d]\n", i, j, data[i * column + j], min[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that each value of a matrix of short doesn't exceed a specific min and
+  *  Max value  set for each node (these values are included in the interval).
+  * The matrixes of data, min and max values are stored as 1 dimension arrays
+  * one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param min pointer to a matrix which specify the minimum value allowed for
+  * each node
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  * each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMapTotal(short *data, int row, int column, int *min, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min[i * column + j] || data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMapTotal: Node[%d,%d] = %d exceed limit [%d, %d]\n", i, j, data[i * column + j], min[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that each value of a matrix of u8 doesn't exceed a specific min and
+  * Max value  set for each node (these values are included in the interval). \n
+  * The matrixes of data, min and max values are stored as 1 dimension arrays
+  * one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param min pointer to a matrix which specify the minimum value allowed for
+  * each node
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  * each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMapFromU(u8 *data, int row, int column, int *min, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min[i * column + j] || data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMap: Node[%d,%d] = %d exceed limit [%d, %d]\n", i, j, data[i * column + j], min[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that each value of a matrix of u16 doesn't exceed a specific min and
+  * Max value  set for each node (these values are included in the interval).
+  * The matrixes of data, min and max values are stored as 1 dimension arrays
+  * one row after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param min pointer to a matrix which specify the minimum value allowed for
+  * each node
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  * each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMapTotalFromU(u16 *data, int row, int column, int *min, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] < min[i * column + j] || data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMapTotal: Node[%d,%d] = %d exceed limit [%d, %d]\n", i, j, data[i * column + j], min[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that each value of a matrix of u8 doesn't exceed a specific Max value
+  * set for each node (max value is included in the interval).
+  * The matrixes of data and max values are stored as 1 dimension arrays one row
+  * after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  *each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMapAdj(u8 *data, int row, int column, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMapAdj: Node[%d,%d] = %d exceed limit > %d\n", i, j, data[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Check that each value of a matrix of u16 doesn't exceed a specific Max value
+  * set for each node (max value is included in the interval).
+  * The matrixes of data and max values are stored as 1 dimension arrays one row
+  * after the other.
+  * @param data pointer to the array of short containing the data to check
+  * @param row number of rows of data
+  * @param column number of columns of data
+  * @param max pointer to a matrix which specify the Maximum value allowed for
+  * each node
+  * @return the number of elements that overcome the specified interval (0 = OK)
+  */
+int checkLimitsMapAdjTotal(u16 *data, int row, int column, int *max)
+{
+    int i, j;
+    int count = 0;
+
+    for (i = 0; i < row; i++) {
+        for (j = 0; j < column; j++) {
+            if (data[i * column + j] > max[i * column + j]) {
+                TPD_INFO("checkLimitsMapAdjTotal: Node[%d,%d] = %d exceed limit > %d\n", i, j, data[i * column + j], max[i * column + j]);
+                count++;
+            }
+        }
+    }
+
+    return count;    /* if count is 0 = OK, test completed successfully */
+}
+
+/**
+  * Perform an ITO test setting all the possible options
+  * (see @link ito_opt ITO Options @endlink) and checking MS Raw ADJ if enabled
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ito(char *path_limits, TestToDo *todo)
+{
+    int res = OK;
+    u8 sett[2] = { 0x00, 0x00 };
+    MutualSenseFrame msRawFrame;
+    int *thresholds = NULL;
+    u16 *adj = NULL;
+    int trows, tcolumns;
+
+    msRawFrame.node_data = NULL;
+
+    TPD_DEBUG("ITO Production test is starting...\n");
+
+    res = fts_system_reset();
+    if (res < 0) {
+        TPD_INFO("%s: ERROR %08X\n", __func__, ERROR_PROD_TEST_ITO);
+        return res | ERROR_PROD_TEST_ITO;
+    }
+
+    sett[0] = SPECIAL_TUNING_IOFF;
+    TPD_DEBUG("Trimming Ioff...\n");
+    res = writeSysCmd(SYS_CMD_SPECIAL_TUNING, sett, 2);
+    if (res < OK) {
+        TPD_INFO("production_test_ito: Trimm Ioff ERROR %08X\n", (res | ERROR_PROD_TEST_ITO));
+        return res | ERROR_PROD_TEST_ITO;
+    }
+
+    sett[0] = 0xFF;
+    sett[1] = 0xFF;
+    TPD_DEBUG("ITO Check command sent...\n");
+    res = writeSysCmd(SYS_CMD_ITO, sett, 2);
+    if (res < OK) {
+        TPD_INFO("production_test_ito: ERROR %08X\n", (res | ERROR_PROD_TEST_ITO));
+        return res | ERROR_PROD_TEST_ITO;
+    }
+
+    TPD_DEBUG("ITO Command = OK!\n");
+
+    TPD_DEBUG("MS RAW ITO ADJ TEST:\n");
+    if (todo->MutualRawAdjITO == 1) {
+        TPD_DEBUG("Collecting MS Raw data...\n");
+        res |= getMSFrame3(MS_RAW, &msRawFrame);
+        if (res < OK) {
+            TPD_INFO("%s: getMSFrame failed... ERROR %08X\n", __func__, ERROR_PROD_TEST_ITO);
+            goto ERROR;
+        }
+        TPD_DEBUG("MS RAW ITO ADJ HORIZONTAL TEST:\n");
+        res = computeAdjHorizTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+        if (res < OK) {
+            TPD_INFO("%s: computeAdjHoriz failed... ERROR %08X\n", __func__, ERROR_PROD_TEST_ITO);
+            goto ERROR;
+        }
+
+        res = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ITO_ADJH, &thresholds, &trows, &tcolumns);
+        if (res < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node - 1)) {
+            TPD_INFO("%s: parseProductionTestLimits MS_RAW_ITO_ADJH failed... ERROR %08X\n", __func__, ERROR_PROD_TEST_DATA);
+            goto ERROR;
+        }
+
+        res = checkLimitsMapAdjTotal(adj, msRawFrame.header.force_node, msRawFrame.header.sense_node - 1, thresholds);
+        if (res != OK) {
+            TPD_INFO("production_test_data: checkLimitsAdj MS RAW ITO ADJH failed... ERROR COUNT = %d\n", res);
+            TPD_DEBUG("MS RAW ITO ADJ HORIZONTAL TEST:.................FAIL\n\n");
+            print_frame_short("MS Raw ITO frame =",
+                      array1dTo2d_short( msRawFrame.node_data, msRawFrame. node_data_size, msRawFrame.header. sense_node),
+                      msRawFrame.header.force_node, msRawFrame.header.sense_node);
+            res = ERROR_PROD_TEST_ITO;
+            goto ERROR;
+        } else
+            TPD_DEBUG("MS RAW ITO ADJ HORIZONTAL TEST:.................OK\n");
+
+        kfree(thresholds);
+        thresholds = NULL;
+
+        kfree(adj);
+        adj = NULL;
+
+        TPD_DEBUG("MS RAW ITO ADJ VERTICAL TEST:\n");
+        res = computeAdjVertTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+        if (res < OK) {
+            TPD_INFO("%s: computeAdjVert failed... ERROR %08X\n", __func__, ERROR_PROD_TEST_ITO);
+            goto ERROR;
+        }
+
+        res = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ITO_ADJV, &thresholds, &trows, &tcolumns);
+        if (res < OK || (trows != msRawFrame.header.force_node - 1 || tcolumns != msRawFrame.header.sense_node)) {
+            TPD_INFO("%s: parseProductionTestLimits MS_RAW_ITO_ADJV failed... ERROR %08X\n", __func__, ERROR_PROD_TEST_ITO);
+            goto ERROR;
+        }
+
+        res = checkLimitsMapAdjTotal(adj, msRawFrame.header.force_node - 1, msRawFrame.header.sense_node, thresholds);
+        if (res != OK) {
+            TPD_INFO("%s: checkLimitsAdj MS RAW ITO ADJV failed... ERROR COUNT = %d\n", __func__, res);
+            TPD_DEBUG("MS RAW ITO ADJ VERTICAL TEST:.................FAIL\n\n");
+            print_frame_short("MS Raw ITO frame =", array1dTo2d_short(msRawFrame.node_data, msRawFrame. node_data_size, msRawFrame.header. sense_node),
+                      msRawFrame.header.force_node, msRawFrame.header.sense_node);
+            res = ERROR_PROD_TEST_ITO;
+            goto ERROR;
+        } else
+            TPD_DEBUG("MS RAW ITO ADJ VERTICAL TEST:.................OK\n");
+
+        kfree(thresholds);
+        thresholds = NULL;
+
+        kfree(adj);
+        adj = NULL;
+    } else
+        TPD_DEBUG("MS RAW ITO ADJ TEST:.................SKIPPED\n");
+
+ERROR:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (adj != NULL)
+        kfree(adj);
+    if (msRawFrame.node_data != NULL)
+        kfree(msRawFrame.node_data);
+    freeLimitsFile(&limit_file);
+    res |= fts_system_reset();
+    if (res < OK) {
+        TPD_INFO("production_test_ito: ERROR %08X\n",
+             ERROR_PROD_TEST_ITO);
+        res = (res | ERROR_PROD_TEST_ITO);
+    }
+    return res;
+}
+
+/**
+  * Perform the Initialization of the IC
+  * @param type type of initialization to do
+  * (see @link sys_special_opt Initialization Options (Full or Panel) @endlink)
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_initialization(u8 type)
+{
+    int res = 0;
+	
+    TPD_DEBUG("INITIALIZATION Production test is starting...\n");
+    if (type != SPECIAL_PANEL_INIT && type != SPECIAL_FULL_PANEL_INIT) {
+        TPD_INFO("production_test_initialization: Type incompatible! Type = %02X ERROR %08X\n", type, ERROR_OP_NOT_ALLOW | ERROR_PROD_TEST_INITIALIZATION);
+        return ERROR_OP_NOT_ALLOW | ERROR_PROD_TEST_INITIALIZATION;
+    }
+
+    res = fts_system_reset();
+    if (res < 0) {
+        TPD_INFO("production_test_initialization: ERROR %08X\n",ERROR_PROD_TEST_INITIALIZATION);
+        return res | ERROR_PROD_TEST_INITIALIZATION;
+    }
+
+    TPD_DEBUG("INITIALIZATION command sent... %02X\n", type);
+
+    res = writeSysCmd(SYS_CMD_SPECIAL, &type, 1);
+    if (res < OK) {
+        TPD_INFO("production_test_initialization: ERROR %08X\n", (res | ERROR_PROD_TEST_INITIALIZATION));
+        return res | ERROR_PROD_TEST_INITIALIZATION;
+    }
+    TPD_DEBUG("Refresh Sys Info...\n");
+    res |= readSysInfo(1);    /* need to update the chipInfo in order
+                  * to refresh several versions */
+
+    if (res < 0) {
+        TPD_INFO("production_test_initialization: read sys info ERROR %08X\n", ERROR_PROD_TEST_INITIALIZATION);
+        res = (res | ERROR_PROD_TEST_INITIALIZATION);
+    }
+
+    return res;
+}
+
+
+/**
+  * Perform a FULL (ITO + INIT + DATA CHECK) Mass Production Test of the IC
+  * @param pathThresholds name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param saveInit if >0 (possible values: NO_INIT, SPECIAL_PANEL_INIT or
+  * SPECIAL_FULL_PANEL_INIT),
+  * the Initialization of the IC is executed otherwise it is skipped
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @param mpflag MP flag value to write in case of successful test
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_main(char *pathThresholds, int stop_on_fail, int saveInit,
+             TestToDo *todo, u8 mpflag)
+{
+    int res, ret;
+
+    TPD_DEBUG("MAIN Production test is starting...\n");
+
+    TPD_DEBUG("ITO TEST:\n");
+    res = production_test_ito(pathThresholds, todo);
+    if (res < 0) {
+        TPD_DEBUG("Error during ITO TEST! ERROR %08X\n", res);
+		if (stop_on_fail)
+        goto END;/* in case of ITO TEST failure is no sense keep going
+             * */
+    } else
+        TPD_DEBUG("ITO TEST OK!\n");
+
+    TPD_DEBUG("INITIALIZATION TEST :\n");
+    if (saveInit != NO_INIT) {
+        res = production_test_initialization((u8)saveInit);
+        if (res < 0) {
+            TPD_DEBUG("Error during  INITIALIZATION TEST! ERROR %08X\n", res);
+            if (stop_on_fail)
+                goto END;
+        } else
+            TPD_DEBUG("INITIALIZATION TEST OK!\n");
+    } else
+        TPD_DEBUG("INITIALIZATION TEST :................. SKIPPED\n");
+
+    if (saveInit != NO_INIT) {
+        TPD_DEBUG("Cleaning up...\n");
+        ret = fts_system_reset();
+        if (ret < 0) {
+            TPD_INFO("production_test_main: system reset ERROR %08X\n", ret);
+            res |= ret;
+            if (stop_on_fail)
+                goto END;
+        }
+    }
+
+    TPD_DEBUG("PRODUCTION DATA TEST:\n");
+    ret = production_test_data(pathThresholds, stop_on_fail, todo);
+    if (ret < OK)
+        TPD_DEBUG("Error during PRODUCTION DATA TEST! ERROR %08X\n", ret);
+    else {
+        TPD_DEBUG("PRODUCTION DATA TEST OK!\n");
+
+#ifdef COMPUTE_INIT_METHOD
+        if (saveInit != NO_INIT) {
+            /* save the mp flag to desired value
+             * because data check OK */
+            ret = saveMpFlag(mpflag);
+            if (ret < OK)
+                TPD_DEBUG("Error while saving MP FLAG! ERROR %08X\n", ret);
+            else
+                TPD_DEBUG("MP FLAG saving OK!\n");
+        }
+#endif
+
+    }
+
+    res |= ret;
+    /* the OR is important because if the data test is OK but
+      * the init test fail, the main production test result should = FAIL */
+
+
+END:
+    if (res < OK) {
+        TPD_DEBUG("MAIN Production test finished.................FAILED\n");
+        return res;
+    } else {
+        TPD_DEBUG("MAIN Production test finished.................OK\n");
+        return OK;
+    }
+}
+
+/**
+  * Perform all the test selected in a TestTodo variable related to MS raw data
+  * (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_raw(char *path_limits, int stop_on_fail, TestToDo *todo)
+{
+    int ret, count_fail = 0;
+    MutualSenseFrame msRawFrame;
+
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+    u16 *adj = NULL;
+
+    int maxAdjH = 0, maxAdjV = 0;
+    int i, z;
+
+    msRawFrame.node_data = NULL;
+
+    /************** Mutual Sense Test *************/
+    TPD_DEBUG("MS RAW DATA TEST is starting...\n");
+    if (todo->MutualRaw == 1 || todo->MutualRawGap == 1 ||
+        todo->MutualRawAdj == 1 || todo->MutualRawMap == 1 ||
+        todo->MutualRawAdjGap == 1 || todo->MutualRawAdjPeak == 1) {
+        ret = setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+        msleep(WAIT_FOR_FRESH_FRAMES);
+        ret |= setScanMode(SCAN_MODE_ACTIVE, 0x00);
+        msleep(WAIT_AFTER_SENSEOFF);
+        ret |= getMSFrame3(MS_RAW, &msRawFrame);
+        if (ret < OK) {
+            TPD_INFO("production_test_data: getMSFrame failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            return ret | ERROR_PROD_TEST_DATA;
+        }
+
+        TPD_DEBUG("MS RAW MIN MAX TEST:\n");
+        if (todo->MutualRaw == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < OK || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node,
+                        thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax MS RAW failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS RAW MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW MIN MAX TEST:.................OK\n");
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("MS RAW MIN MAX TEST:.................SKIPPED\n");
+        TPD_DEBUG("MS RAW MAP MIN MAX TEST:\n");
+        if (todo->MutualRawMap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_EACH_NODE_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_EACH_NODE_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = checkLimitsMapTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMaxEachNodeData failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS RAW MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else{
+                TPD_DEBUG("MS RAW MAP MIN MAX TEST:.................OK\n");
+            }
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else {
+            TPD_DEBUG("MS RAW MAP MIN MAX TEST:.................SKIPPED\n");
+        }
+        TPD_DEBUG("MS RAW GAP TEST:\n");
+        if (todo->MutualRawGap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_GAP failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(msRawFrame.node_data,
+                         msRawFrame.header.force_node,
+                         msRawFrame.header.sense_node,
+                         thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap MS RAW failed... ERROR = %08X\n", ret);
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW GAP TEST:.................OK\n\n");
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("MS RAW GAP TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("MS RAW ADJ TEST:\n");
+        if ((todo->MutualRawAdj == 1) || (todo->MutualRawAdjGap == 1) || (todo->MutualRawAdjPeak == 1)) {
+            TPD_DEBUG("MS RAW ADJ HORIZONTAL TESTs:\n");
+            ret = computeAdjHorizTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+            if (ret < OK) {
+                TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            if (todo->MutualRawAdj) {
+                TPD_DEBUG("MS RAW ADJ HORIZONTAL min/Max:\n");
+
+                ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ADJH, &thresholds, &trows, &tcolumns);
+                if (ret < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node - 1)) {
+                    TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                    ret |= ERROR_PROD_TEST_DATA;
+                    goto ERROR_LIMITS;
+                }
+
+                ret = checkLimitsMapAdjTotal(adj, msRawFrame.header. force_node, msRawFrame.header. sense_node - 1, thresholds);
+                if (ret != OK) {
+                    TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJH failed... ERROR COUNT = %d\n", ret);
+                    TPD_DEBUG("MS RAW ADJ HORIZONTAL min/Max:.................FAIL\n\n");
+                    count_fail += 1;
+                    if (stop_on_fail == 1)
+                        goto ERROR;
+                } else
+                    TPD_DEBUG("MS RAW ADJ HORIZONTAL min/Max:.................OK\n");
+
+                if (thresholds != NULL) {
+                    kfree(thresholds);
+                    thresholds = NULL;
+                }
+            }
+
+
+            if (todo->MutualRawAdjGap) {
+                TPD_DEBUG("MS RAW ADJ HORIZONTAL GAP:\n");
+
+                ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ADJH_GAP, &thresholds, &trows, &tcolumns);
+                if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                    TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                    ret |= ERROR_PROD_TEST_DATA;
+                    goto ERROR_LIMITS;
+                }
+
+                ret = checkLimitsGapOffsets(adj, msRawFrame.header.force_node, msRawFrame.header.sense_node - 1, thresholds[0], 1, 1, 1, 1);
+                if (ret != OK) {
+                    TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJH GAP failed...\n");
+                    TPD_DEBUG("MS RAW ADJ HORIZONTAL GAP:.................FAIL\n\n");
+                    count_fail += 1;
+                    if (stop_on_fail == 1)
+                        goto ERROR;
+                } else
+                    TPD_DEBUG("MS RAW ADJ HORIZONTAL GAP:.................OK\n");
+
+                if (thresholds != NULL) {
+                    kfree(thresholds);
+                    thresholds = NULL;
+                }
+            }
+
+
+            if (todo->MutualRawAdjPeak) {
+                TPD_DEBUG("MS RAW ADJ Peak: Getting max ADJH\n");
+                maxAdjH = abs(adj[msRawFrame.header.force_node + 1]);
+                /* skip nodes on the edges */
+                for (i = 1; i < msRawFrame.header.force_node - 1; i++) {
+                    for (z = 1; z < (msRawFrame.header.sense_node - 2); z++){
+                        if (maxAdjH < abs(adj[(i * msRawFrame.header.force_node) + z]))
+                        maxAdjH = abs(adj[(i * msRawFrame.header.force_node) + z]);
+                    }
+
+                }
+            }
+
+            kfree(adj);
+            adj = NULL;
+
+            TPD_DEBUG("MS RAW ADJ VERTICAL TESTs:\n");
+            ret = computeAdjVertTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+            if (ret < OK) {
+                TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            if (todo->MutualRawAdj) {
+                TPD_DEBUG("MS RAW ADJ VERTICAL min/Max:\n");
+                ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ADJV, &thresholds, &trows, &tcolumns);
+                if (ret < OK || (trows != msRawFrame.header.force_node - 1 || tcolumns != msRawFrame.header.sense_node)) {
+                    TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJV failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                    ret |= ERROR_PROD_TEST_DATA;
+                    goto ERROR_LIMITS;
+                }
+
+                ret = checkLimitsMapAdjTotal(adj,msRawFrame.header.force_node - 1, msRawFrame.header.sense_node, thresholds);
+                if (ret != OK) {
+                    TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJV failed... ERROR COUNT = %d\n", ret);
+                    TPD_DEBUG("MS RAW ADJ VERTICAL min/Max:.................FAIL\n\n");
+                    count_fail += 1;
+                    if (stop_on_fail == 1)
+                        goto ERROR;
+                } else
+                    TPD_DEBUG("MS RAW ADJ VERTICAL min/Max:.................OK\n");
+
+                if (thresholds != NULL) {
+                    kfree(thresholds);
+                    thresholds = NULL;
+                }
+            }
+
+            if (todo->MutualRawAdjGap) {
+                TPD_DEBUG("MS RAW ADJ VERTICAL GAP:\n");
+                ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ADJV_GAP, &thresholds, &trows, &tcolumns);
+                if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                    TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJV_GAP failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                    ret |= ERROR_PROD_TEST_DATA;
+                    goto ERROR_LIMITS;
+                }
+
+                ret = checkLimitsGapOffsets(adj, msRawFrame.header.force_node - 1, msRawFrame.header.sense_node, thresholds[0], 1, 1, 1, 1);
+                if (ret != OK) {
+                    TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJV GAP failed... ERROR COUNT = %d\n", ret);
+                    TPD_DEBUG("MS RAW ADJ VERTICAL GAP:.................FAIL\n\n");
+                    count_fail += 1;
+                    if (stop_on_fail == 1)
+                        goto ERROR;
+                } else
+                    TPD_DEBUG("MS RAW ADJ VERTICAL GAP:.................OK\n");
+
+                if (thresholds != NULL) {
+                    kfree(thresholds);
+                    thresholds = NULL;
+                }
+            }
+
+
+            if (todo->MutualRawAdjPeak) {
+                TPD_DEBUG("MS RAW ADJ Peak: Getting max ADJV\n");
+                maxAdjV = abs(adj[(msRawFrame.header.force_node) + 1]);
+
+                /* skip nodes on the edges */
+                for (i = 1; i < (msRawFrame.header.force_node - 2); i++) {
+                    for (z = 1; z < msRawFrame.header.sense_node - 1; z++) {
+                        if (maxAdjH < abs(adj[(i * msRawFrame.header.force_node) + z]))
+                            maxAdjH = abs(adj[(i * msRawFrame.header.force_node) + z]);
+
+                    }
+                }
+
+                ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_ADJ_PEAK, &thresholds, &trows, &tcolumns);
+                if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                    TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJV_PEAK failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                    ret |= ERROR_PROD_TEST_DATA;
+                    goto ERROR_LIMITS;
+                }
+
+                TPD_INFO("maxAdjH = %d  maxAdjV = %d  threshold = %d\n",maxAdjH, maxAdjV, thresholds[0]);
+
+                ret = OK;
+                if (maxAdjH > maxAdjV) {
+                    if (maxAdjH > thresholds[0])
+                        ret = ERROR_PROD_TEST_DATA;
+                } else {
+                    if (maxAdjV > thresholds[0])
+                        ret = ERROR_PROD_TEST_DATA;
+                }
+
+                if (ret != OK) {
+                    TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJV GAP failed... ERROR COUNT = %d\n", ret);
+                    TPD_DEBUG("MS RAW ADJ PEAK:.................FAIL\n\n");
+                    count_fail += 1;
+                    if (stop_on_fail == 1)
+                        goto ERROR;
+                } else
+                    TPD_DEBUG("MS RAW ADJ PEAK:.................OK\n");
+
+                if (thresholds != NULL) {
+                    kfree(thresholds);
+                    thresholds = NULL;
+                }
+
+            }
+
+
+            kfree(adj);
+            adj = NULL;
+        } else
+            TPD_DEBUG("MS RAW ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("MS RAW DATA TEST:.................SKIPPED\n");
+
+    TPD_DEBUG("MS KEY RAW TEST:\n");
+    if (todo->MutualKeyRaw == 1) {
+        ret = production_test_ms_key_raw(path_limits);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: production_test_ms_key_raw failed... ERROR = %08X\n", ret);
+            count_fail += 1;
+            if (count_fail == 1) {
+                TPD_DEBUG("MS RAW DATA TEST:.................FAIL fails_count = %d\n\n", count_fail);
+                goto ERROR_LIMITS;
+            }
+        }
+    } else
+        TPD_DEBUG("MS KEY RAW TEST:.................SKIPPED\n");
+
+    ret = production_test_ms_raw_lp(path_limits, stop_on_fail, todo);
+    if (ret < 0) {
+        TPD_INFO("production_test_data: production_test_ms_raw_lp failed... ERROR = %08X\n",ret);
+        count_fail += 1;
+        if (count_fail == 1) {
+            TPD_DEBUG("MS RAW DATA TEST:.................FAIL fails_count = %d\n\n",count_fail);
+            goto ERROR_LIMITS;
+        }
+    }
+
+ERROR:
+    if (count_fail == 0) {
+        if (msRawFrame.node_data != NULL) {
+            kfree(msRawFrame.node_data);
+            msRawFrame.node_data = NULL;
+        }
+        TPD_DEBUG("MS RAW DATA TEST finished!.................OK\n");
+        return OK;
+    } else {
+        print_frame_short("MS Raw frame =", array1dTo2d_short(msRawFrame.node_data, msRawFrame.node_data_size, msRawFrame.header.sense_node),
+                  msRawFrame.header.force_node, msRawFrame.header.sense_node);
+
+        if (msRawFrame.node_data != NULL)
+            kfree(msRawFrame.node_data);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (adj != NULL)
+            kfree(adj);
+        if (thresholds_min != NULL) {
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+        }
+        if (thresholds_max != NULL) {
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        }
+        TPD_DEBUG("MS RAW DATA TEST:.................FAIL fails_count = %d\n\n",count_fail);
+        return ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+    }
+
+
+ERROR_LIMITS:
+    if (msRawFrame.node_data != NULL)
+        kfree(msRawFrame.node_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    return ret;
+}
+
+
+/**
+  * Perform all the test selected in a TestTodo variable related to MS low power
+  * raw data
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_raw_lp(char *path_limits, int stop_on_fail,
+                  TestToDo *todo)
+{
+    int ret, count_fail = 0;
+    MutualSenseFrame msRawFrame;
+
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+
+    u16 *adj = NULL;
+
+    msRawFrame.node_data = NULL;
+
+    /************** Mutual Sense Test **************/
+    TPD_DEBUG("MS RAW LP DATA TEST:\n");
+    if (todo->MutualRawLP == 1 || todo->MutualRawGapLP == 1 ||
+        todo->MutualRawAdjLP == 1) {
+        ret = setScanMode(SCAN_MODE_LOCKED, LOCKED_LP_ACTIVE);
+        msleep(WAIT_FOR_FRESH_FRAMES);
+        ret |= setScanMode(SCAN_MODE_ACTIVE, 0x00);
+        msleep(WAIT_AFTER_SENSEOFF);
+        ret |= getMSFrame3(MS_RAW, &msRawFrame);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: getMSFrame failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            return ret | ERROR_PROD_TEST_DATA;
+        }
+
+        TPD_DEBUG("MS RAW LP MIN MAX TEST:\n");
+        if (todo->MutualRawLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_LP_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node,
+                        thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax MS RAW LP failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS RAW LP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW LP MIN MAX TEST:.................OK\n");
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("MS RAW LP MIN MAX TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("MS RAW LP MAP MIN MAX TEST:\n");
+        if (todo->MutualRawMapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_LP_EACH_NODE_MIN failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_LP_EACH_NODE_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = checkLimitsMapTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMaxEachNodeData failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS RAW LP MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else{
+                TPD_DEBUG("MS RAW LP MAP MIN MAX TEST:.................OK\n");
+            }
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else {
+            TPD_DEBUG("MS RAW LP MAP MIN MAX TEST:.................SKIPPED\n");
+        }
+
+        TPD_DEBUG("MS RAW LP GAP TEST:\n");
+        if (todo->MutualRawGapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_LP_GAP failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap MS RAW LP failed... ERROR = %08X\n", ret);
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW LP GAP TEST:.................OK\n\n");
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("MS RAW LP GAP TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("MS RAW LP ADJ TEST:\n");
+        if (todo->MutualRawAdjLP == 1) {
+            TPD_DEBUG("MS RAW LP ADJ HORIZONTAL TEST:\n");
+            ret = computeAdjHorizTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_ADJH, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != msRawFrame.header.force_node || tcolumns != msRawFrame.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_LP_ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(adj, msRawFrame.header.force_node, msRawFrame.header.sense_node - 1, thresholds);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsAdj MS RAW LP ADJH failed... ERROR COUNT = %d\n",ret);
+                TPD_DEBUG("MS RAW LP ADJ HORIZONTAL TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW LP ADJ HORIZONTAL TEST:.................OK\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+
+            kfree(adj);
+            adj = NULL;
+
+            TPD_DEBUG("MS RAW LP ADJ VERTICAL TEST:\n");
+            ret = computeAdjVertTotal(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node, &adj);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_RAW_LP_ADJV, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != msRawFrame.header.force_node - 1 || tcolumns != msRawFrame.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_RAW_ADJV failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(adj, msRawFrame.header.force_node - 1, msRawFrame.header.sense_node, thresholds);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsAdj MS RAW ADJV failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS RAW LP ADJ VERTICAL TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail == 1)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS RAW LP ADJ VERTICAL TEST:.................OK\n");
+            kfree(thresholds);
+            thresholds = NULL;
+
+            kfree(adj);
+            adj = NULL;
+        } else
+            TPD_DEBUG("MS RAW LP ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("MS RAW LP DATA TEST:.................SKIPPED\n");
+
+ERROR:
+    if (count_fail == 0) {
+        if (msRawFrame.node_data != NULL) {
+            kfree(msRawFrame.node_data);
+            msRawFrame.node_data = NULL;
+        }
+        TPD_DEBUG("MS RAW DATA TEST finished!.................OK\n");
+        return OK;
+    } else {
+        if (msRawFrame.node_data != NULL) {
+            print_frame_short("MS Raw LP frame =",
+                      array1dTo2d_short(msRawFrame.node_data, msRawFrame.node_data_size, msRawFrame.header.sense_node),
+                      msRawFrame.header.force_node, msRawFrame.header.sense_node);
+            kfree(msRawFrame.node_data);
+        }
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (adj != NULL)
+            kfree(adj);
+        if (thresholds_min != NULL) {
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+        }
+        if (thresholds_max != NULL) {
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        }
+        TPD_DEBUG("MS RAW LP DATA TEST:.................FAIL fails_count = %d\n\n", count_fail);
+        return ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+    }
+
+
+ERROR_LIMITS:
+    if (msRawFrame.node_data != NULL)
+        kfree(msRawFrame.node_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    return ret;
+}
+
+/**
+  * Perform MS raw test for keys data
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_key_raw(char *path_limits)
+{
+    int ret;
+    MutualSenseFrame msRawFrame;
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+
+    msRawFrame.node_data = NULL;
+
+    /************** Mutual Sense Test **************/
+    TPD_DEBUG("MS KEY RAW DATA TEST is starting...\n");
+    ret = setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    ret |= setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    ret |= getMSFrame3(MS_KEY_RAW, &msRawFrame);
+    if (ret < 0) {
+        TPD_INFO("production_test_data: getMSKeyFrame failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    ret = parseProductionTestLimits(path_limits, &limit_file,
+                    MS_KEY_RAW_MIN_MAX, &thresholds, &trows, &tcolumns);
+    if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+        TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_RAW_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        ret |= ERROR_PROD_TEST_DATA;
+        goto ERROR_LIMITS;
+    }
+
+    ret = checkLimitsMinMax(msRawFrame.node_data, msRawFrame.header.force_node, msRawFrame.header.sense_node,
+                thresholds[0], thresholds[1]);
+    if (ret != OK) {
+        TPD_INFO("production_test_data: checkLimitsMinMax MS KEY RAW failed... ERROR COUNT = %d\n", ret);
+        goto ERROR;
+    } else
+        TPD_DEBUG("MS KEY RAW TEST:.................OK\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+
+    kfree(msRawFrame.node_data);
+    msRawFrame.node_data = NULL;
+    return OK;
+
+ERROR:
+    print_frame_short("MS Key Raw frame =", array1dTo2d_short(msRawFrame.node_data, msRawFrame.node_data_size, msRawFrame.header.sense_node),
+              msRawFrame.header.force_node, msRawFrame.header.sense_node);
+    if (msRawFrame.node_data != NULL)
+        kfree(msRawFrame.node_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    TPD_DEBUG("MS KEY RAW TEST:.................FAIL\n\n");
+    return ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+
+ERROR_LIMITS:
+    if (msRawFrame.node_data != NULL)
+        kfree(msRawFrame.node_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    return ret;
+}
+
+/**
+  * Perform all the tests selected in a TestTodo variable related to MS Init
+  * data (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_cx(char *path_limits, int stop_on_fail, TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+
+    int *thresholds = NULL;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+    int trows, tcolumns;
+
+    MutualSenseData msCompData;
+    TotMutualSenseData totCompData;
+
+    u8 *adjhor = NULL;
+
+    u8 *adjvert = NULL;
+
+    u16 container;
+    /* u16 *total_cx = NULL; */
+    u16 *total_adjhor = NULL;
+    u16 *total_adjvert = NULL;
+
+    msCompData.node_data = NULL;
+    totCompData.node_data = NULL;
+
+    /* MS CX TEST */
+    TPD_DEBUG("MS CX Testes are starting...\n");
+
+    ret = readMutualSenseCompensationData(LOAD_CX_MS_TOUCH, &msCompData);
+    /* read MS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readMutualSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    ret = readTotMutualSenseCompensationData(LOAD_PANEL_CX_TOT_MS_TOUCH, &totCompData);
+    /* read  TOT MS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readTotMutualSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        kfree(msCompData.node_data);
+        msCompData.node_data = NULL;
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    TPD_DEBUG("MS CX1 TEST:\n");
+    if (todo->MutualCx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX1_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX1_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (u16)msCompData.cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);
+        /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax MS CX1 failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS CX1 TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS CX1 TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("MS CX1 TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+
+    TPD_DEBUG("MS CX2 MIN MAX TEST:\n");
+    if (todo->MutualCx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_MAP_MIN, &thresholds_min, &trows, &tcolumns);
+                        /* load min thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load max thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, thresholds_min, thresholds_max);
+                     /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap MS CX2 MIN MAX failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS CX2 MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG(" MS CX2 MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("MS CX2 MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("MS CX2 ADJ TEST:\n");
+    if (todo->MutualCx2Adj == 1) {
+        /* MS CX2 ADJ HORIZ */
+        TPD_DEBUG("MS CX2 ADJ HORIZ TEST:\n");
+
+        ret = computeAdjHoriz(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, &adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("MS CX2 ADJ HORIZ computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_ADJH_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, msCompData.header.force_node, msCompData.header.sense_node - 1, thresholds_max);
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj CX2 ADJH failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS CX2 ADJ HORIZ TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS CX2 ADJ HORIZ TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+
+        /* MS CX2 ADJ VERT */
+        TPD_DEBUG("MS CX2 ADJ VERT TEST:\n");
+
+        ret = computeAdjVert(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, &adjvert);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("MS CX2 ADJ VERT computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+        if (ret < 0 || (trows != msCompData.header.force_node - 1 || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, msCompData.header.force_node - 1, msCompData.header.sense_node - 1, thresholds_max);
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj CX2 ADJV failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS CX2 ADJ HORIZ TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS CX2 ADJ VERT TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("MS CX2 ADJ TEST:.................SKIPPED\n\n");
+
+    /* START OF TOTAL CHECK */
+    TPD_DEBUG("MS TOTAL CX TEST:\n");
+
+    if (todo->MutualCxTotal == 1 || todo->MutualCxTotalAdj == 1) {
+        TPD_DEBUG("MS TOTAL CX MIN MAX TEST:\n");
+        if (todo->MutualCxTotal == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_MAP_MIN, &thresholds_min, &trows, &tcolumns);
+            /* load min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node)) {
+				TPD_INFO("ret = %d, trows = %d, force_node =%d, tcolumns =%d, sense_node =%d\n", ret, trows, totCompData.header.force_node, tcolumns, totCompData.header.sense_node);
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+            /* load max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node)) {
+				TPD_INFO("ret = %d, trows = %d, force_node =%d, tcolumns =%d, sense_node =%d\n", ret, trows, totCompData.header.force_node, tcolumns, totCompData.header.sense_node);
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, thresholds_min, thresholds_max);
+            /* check the limits */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap  MS TOTAL CX TEST failed... ERROR COUNT = %d\n",ret);
+                TPD_DEBUG(" MS TOTAL CX MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("MS TOTAL CX MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("MS TOTAL CX ADJ TEST:\n");
+        if (todo->MutualCxTotalAdj == 1) {
+            /* MS TOTAL CX ADJ HORIZ */
+            TPD_DEBUG("MS TOTAL CX ADJ HORIZ TEST:\n");
+
+            ret = computeAdjHorizTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("MS TOTAL CX ADJ HORIZ computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, totCompData.header.force_node, totCompData.header.sense_node - 1, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj MS TOTAL CX ADJH failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+
+            /* MS TOTAL CX ADJ VERT */
+            TPD_DEBUG("MS TOTAL CX ADJ VERT TEST:\n");
+
+            ret = computeAdjVertTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, &total_adjvert);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("MS TOTAL CX ADJ VERT computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, totCompData.header.sense_node - 1, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj MS TOTAL CX ADJV failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ TEST:.................FAIL\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX ADJ VERT TEST:.................OK\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("MS TOTAL CX ADJ TEST:.................SKIPPED\n");
+
+        kfree(totCompData.node_data);
+        totCompData.node_data = NULL;
+    } else
+        TPD_DEBUG("MS TOTAL CX TEST:.................SKIPPED\n");
+
+
+
+    if ((todo->MutualCx1LP | todo->MutualCx2LP | todo->MutualCx2AdjLP | todo->MutualCxTotalLP | todo->MutualCxTotalAdjLP) == 1) {
+        ret = production_test_ms_cx_lp(path_limits, stop_on_fail, todo);
+        if (ret < OK) {
+            count_fail += 1;
+            TPD_INFO("production_test_data: production_test_cx_lp failed... ERROR = %08X\n", ret);
+            TPD_DEBUG("MS CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+            return ret;
+        }
+    } else
+        TPD_DEBUG("MS CX LP TEST:.................SKIPPED\n");
+
+
+    if ((todo->MutualKeyCx1 | todo->MutualKeyCx2 | todo->MutualKeyCxTotal) == 1) {
+        ret = production_test_ms_key_cx(path_limits, stop_on_fail, todo);
+        if (ret < 0) {
+            count_fail += 1;
+            TPD_INFO("production_test_data: production_test_ms_key_cx failed... ERROR = %08X\n", ret);
+            TPD_DEBUG("MS CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+            return ret;
+        }
+    } else
+        TPD_DEBUG("MS KEY CX TEST:.................SKIPPED\n");
+
+
+
+ERROR:
+    if (count_fail == 0) {
+        TPD_DEBUG("MS CX testes finished!.................OK\n");
+        kfree(msCompData.node_data);
+        msCompData.node_data = NULL;
+        return OK;
+    } else {
+        print_frame_i8("MS Init Data (Cx2) =", array1dTo2d_i8(msCompData.node_data, msCompData.node_data_size, msCompData.header.sense_node),
+                   msCompData.header.force_node, msCompData.header.sense_node);
+        print_frame_short(" TOT MS Init Data (Cx) =", array1dTo2d_short(totCompData.node_data, totCompData.node_data_size, totCompData.header.sense_node),
+                  totCompData.header.force_node, totCompData.header.sense_node);
+        TPD_DEBUG("MS CX testes finished!.................FAILED  fails_count = %d\n\n",count_fail);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (thresholds_min != NULL)
+            kfree(thresholds_min);
+        if (thresholds_max != NULL)
+            kfree(thresholds_max);
+        if (adjhor != NULL)
+            kfree(adjhor);
+        if (adjvert != NULL)
+            kfree(adjvert);
+        if (totCompData.node_data != NULL)
+            kfree(totCompData.node_data);
+        if (total_adjhor != NULL)
+            kfree(total_adjhor);
+        if (total_adjvert != NULL)
+            kfree(total_adjvert);
+        if (msCompData.node_data != NULL)
+            kfree(msCompData.node_data);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    if (adjhor != NULL)
+        kfree(adjhor);
+    if (adjvert != NULL)
+        kfree(adjvert);
+    if (totCompData.node_data != NULL)
+        kfree(totCompData.node_data);
+    if (total_adjhor != NULL)
+        kfree(total_adjhor);
+    if (total_adjvert != NULL)
+        kfree(total_adjvert);
+    if (msCompData.node_data != NULL)
+        kfree(msCompData.node_data);
+    return ret;
+}
+
+/**
+  * Perform all the tests selected in a TestTodo variable related to MS Init
+  * data of the keys
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  *  otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_key_cx(char *path_limits, int stop_on_fail,
+                  TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+    int num_keys = 0;
+
+    int *thresholds = NULL;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+    int trows, tcolumns;
+
+    MutualSenseData msCompData;
+    TotMutualSenseData totCompData;
+
+
+    short container;
+
+    msCompData.node_data = NULL;
+    totCompData.node_data = NULL;
+
+    /* MS CX TEST */
+    TPD_DEBUG("MS KEY CX Testes are starting...\n");
+
+    ret = readMutualSenseCompensationData(LOAD_CX_MS_KEY, &msCompData);
+    /* read MS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readMutualSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    if (msCompData.header.force_node > msCompData.header.sense_node)
+        /* the meaningful data are only in the first row,
+          * the other rows are only a copy of the first one */
+        num_keys = msCompData.header.force_node;
+    else
+        num_keys = msCompData.header.sense_node;
+
+    TPD_DEBUG("MS KEY CX1 TEST:\n");
+    if (todo->MutualKeyCx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_KEY_CX1_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_CX1_MIN_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)msCompData.cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);    /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax MS CX1 failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS KEY CX1 TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS KEY CX1 TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("MS KEY CX1 TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+
+    TPD_DEBUG("MS KEY CX2 TEST:\n");
+    if (todo->MutualKeyCx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_KEY_CX2_MAP_MIN, &thresholds_min, &trows, &tcolumns);
+        /* load min thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node  || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_CX2_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_KEY_CX2_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+        /* load max thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node  || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_CX2_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, thresholds_min, thresholds_max);
+        /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap MS KEY CX2 failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS KEY CX2 TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS KEY CX2 TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("MS CX2 TEST:.................SKIPPED\n\n");
+
+    /* START OF TOTAL CHECK */
+    TPD_DEBUG("MS KEY TOTAL CX TEST:\n");
+
+    if (todo->MutualKeyCxTotal == 1) {
+        ret = readTotMutualSenseCompensationData(LOAD_PANEL_CX_TOT_MS_KEY, &totCompData);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeTotalCx failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_KEY_TOTAL_CX_MAP_MIN, &thresholds_min, &trows, &tcolumns);
+        /* load min thresholds */
+        if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_TOTAL_CX_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_KEY_TOTAL_CX_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load max thresholds */
+        if (ret < 0 || (trows != totCompData.header.force_node  || tcolumns != totCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_KEY_TOTAL_CX_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, thresholds_min, thresholds_max); /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap  MS TOTAL KEY CX TEST failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS KEY TOTAL CX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS KEY TOTAL CX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+
+        kfree(totCompData.node_data);
+        totCompData.node_data = NULL;
+    } else
+        TPD_DEBUG("MS KEY TOTAL CX TEST:.................SKIPPED\n");
+
+
+ERROR:
+    if (count_fail == 0) {
+        TPD_DEBUG("MS KEY CX testes finished!.................OK\n");
+        kfree(msCompData.node_data);
+        msCompData.node_data = NULL;
+        return OK;
+    } else {
+        print_frame_i8("MS Key Init Data (Cx2) =", array1dTo2d_i8(msCompData.node_data, msCompData.node_data_size, msCompData.header.sense_node),
+                   msCompData.header.force_node, msCompData.header.sense_node);
+        TPD_DEBUG("MS Key CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (thresholds_min != NULL)
+            kfree(thresholds_min);
+        if (thresholds_max != NULL)
+            kfree(thresholds_max);
+        if (msCompData.node_data != NULL)
+            kfree(msCompData.node_data);
+        if (totCompData.node_data != NULL)
+            kfree(totCompData.node_data);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    if (msCompData.node_data != NULL)
+        kfree(msCompData.node_data);
+    if (totCompData.node_data != NULL)
+        kfree(totCompData.node_data);
+    return ret;
+}
+
+/**
+  * Perform all the tests selected in a TestTodo variable related to MS LowPower
+  * Init data (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ms_cx_lp(char *path_limits, int stop_on_fail, TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+
+    int *thresholds = NULL;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+    int trows, tcolumns;
+
+    MutualSenseData msCompData;
+    TotMutualSenseData totCompData;
+
+    u8 *adjhor = NULL;
+
+    u8 *adjvert = NULL;
+
+    u16 container;
+    /* u16 *total_cx = NULL; */
+    u16 *total_adjhor = NULL;
+    u16 *total_adjvert = NULL;
+
+    msCompData.node_data = NULL;
+    totCompData.node_data = NULL;
+
+    /* MS CX TEST */
+    TPD_DEBUG("MS LP CX Testes are starting...\n");
+
+    ret = readMutualSenseCompensationData(LOAD_CX_MS_LOW_POWER, &msCompData);/* read MS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readMutualSenseCompensationData failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    ret = readTotMutualSenseCompensationData(LOAD_PANEL_CX_TOT_MS_LOW_POWER, &totCompData);/* read  TOT MS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readTotMutualSenseCompensationData failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+        kfree(msCompData.node_data);
+        msCompData.node_data = NULL;
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    TPD_DEBUG("MS LP CX1 TEST:\n");
+    if (todo->MutualCx1LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX1_LP_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX1_LP_MIN_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (u16)msCompData.cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax MS LP CX1 failed... ERROR COUNT = %d\n",ret);
+            TPD_DEBUG("MS LP CX1 TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS LP CX1 TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("MS LP CX1 TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+
+    TPD_DEBUG("MS LP CX2 MIN MAX TEST:\n");
+    if (todo->MutualCx2LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_LP_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load min thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_LP_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_LP_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load max thresholds */
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_LP_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, thresholds_min, thresholds_max);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap MS LP CX2 MIN MAX failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG(" MS LP CX2 MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS LP CX2 MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("MS LP CX2 MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("MS LP CX2 ADJ TEST:\n");
+    if (todo->MutualCx2AdjLP == 1) {
+        /* MS CX2 ADJ HORIZ */
+        TPD_DEBUG("MS LP CX2 ADJ HORIZ TEST:\n");
+
+        ret = computeAdjHoriz(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, &adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("MS LP CX2 ADJ HORIZ computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_ADJH_LP_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+        if (ret < 0 || (trows != msCompData.header.force_node || tcolumns != msCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_ADJH_LP_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, msCompData.header.force_node, msCompData.header.sense_node - 1, thresholds_max);
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj CX2 ADJH LP failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("MS LP CX2 ADJ HORIZ TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS LP CX2 ADJ HORIZ TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+
+        /* MS CX2 ADJ VERT */
+        TPD_DEBUG("MS LP CX2 ADJ VERT TEST:\n");
+
+        ret = computeAdjVert(msCompData.node_data, msCompData.header.force_node, msCompData.header.sense_node, &adjvert);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("MS LP CX2 ADJ VERT computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, MS_CX2_ADJV_LP_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+        if (ret < 0 || (trows != msCompData.header.force_node - 1 || tcolumns != msCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits MS_CX2_ADJV_LP_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, msCompData.header.force_node - 1, msCompData.header.sense_node - 1, thresholds_max);
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj CX2 ADJV LP failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG(" MS LP CX2 ADJ HORIZ TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("MS LP CX2 ADJ VERT TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("MS LP CX2 ADJ TEST:.................SKIPPED\n\n");
+
+    /* START OF TOTAL CHECK */
+    TPD_DEBUG("MS TOTAL LP CX TEST:\n");
+
+    if (todo->MutualCxTotalLP == 1 || todo->MutualCxTotalAdjLP == 1) {
+        TPD_DEBUG("MS TOTAL LP CX MIN MAX TEST:\n");
+        if (todo->MutualCxTotalLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_LP_MAP_MIN, &thresholds_min, &trows, &tcolumns);
+            /* load min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_LP_MAP_MIN failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_LP_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_LP_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, thresholds_min, thresholds_max);/* check the limits */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap  MS TOTAL CX LP TEST failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS TOTAL CX LP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX LP MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("MS TOTAL CX LP MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("MS TOTAL CX ADJ LP TEST:\n");
+        if (todo->MutualCxTotalAdjLP == 1) {
+            /* MS TOTAL CX ADJ HORIZ */
+            TPD_DEBUG("MS TOTAL CX ADJ HORIZ LP TEST:\n");
+
+            ret = computeAdjHorizTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("MS TOTAL CX ADJ HORIZ LP computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_ADJH_LP_MAP_MAX,
+                            &thresholds_max, &trows, &tcolumns);
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_ADJH_LP_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, totCompData.header.force_node, totCompData.header.sense_node - 1, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj MS TOTAL CX ADJH LP failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ LP TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ LP TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+
+            /* MS TOTAL CX ADJ VERT */
+            TPD_DEBUG("MS TOTAL CX ADJ VERT LP TEST:\n");
+
+            ret = computeAdjVertTotal(totCompData.node_data, totCompData.header.force_node, totCompData.header.sense_node, &total_adjvert);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("MS TOTAL CX ADJ VERT LP computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, MS_TOTAL_CX_ADJV_LP_MAP_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits MS_TOTAL_CX_ADJV_LP_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, totCompData.header.sense_node - 1, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj MS TOTAL CX ADJV failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("MS TOTAL CX ADJ HORIZ LP TEST:.................FAIL\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("MS TOTAL CX ADJ VERT LP TEST:.................OK\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("MS TOTAL CX ADJ LP TEST:.................SKIPPED\n");
+
+        kfree(totCompData.node_data);
+        totCompData.node_data = NULL;
+    } else
+        TPD_DEBUG("MS TOTAL CX LP TEST:.................SKIPPED\n");
+
+
+
+ERROR:
+
+    if (count_fail == 0) {
+        TPD_DEBUG("MS LP CX testes finished!.................OK\n");
+        kfree(msCompData.node_data);
+        msCompData.node_data = NULL;
+        return OK;
+    } else {
+        print_frame_i8("MS LP Init Data (Cx2) =", array1dTo2d_i8(msCompData.node_data, msCompData.node_data_size, msCompData.header.sense_node),
+                   msCompData.header.force_node, msCompData.header.sense_node);
+        print_frame_short(" TOT MS LP Init Data (Cx) =", array1dTo2d_short(totCompData.node_data,totCompData.node_data_size,totCompData.header.sense_node),
+                  totCompData.header.force_node, totCompData.header.sense_node);
+        TPD_DEBUG("MS LP CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (thresholds_min != NULL)
+            kfree(thresholds_min);
+        if (thresholds_max != NULL)
+            kfree(thresholds_max);
+        if (adjhor != NULL)
+            kfree(adjhor);
+        if (adjvert != NULL)
+            kfree(adjvert);
+        if (totCompData.node_data != NULL)
+            kfree(totCompData.node_data);
+        if (total_adjhor != NULL)
+            kfree(total_adjhor);
+        if (total_adjvert != NULL)
+            kfree(total_adjvert);
+        if (msCompData.node_data != NULL)
+            kfree(msCompData.node_data);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    if (adjhor != NULL)
+        kfree(adjhor);
+    if (adjvert != NULL)
+        kfree(adjvert);
+    if (totCompData.node_data != NULL)
+        kfree(totCompData.node_data);
+    if (total_adjhor != NULL)
+        kfree(total_adjhor);
+    if (total_adjvert != NULL)
+        kfree(total_adjvert);
+    if (msCompData.node_data != NULL)
+        kfree(msCompData.node_data);
+    return ret;
+}
+
+/**
+  * Perform all the test selected in a TestTodo variable related to SS raw data
+  * (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ss_raw(char *path_limits, int stop_on_fail, TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+    int rows, columns;
+
+    SelfSenseFrame ssRawFrame;
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+
+    ssRawFrame.sense_data = NULL;
+    ssRawFrame.force_data = NULL;
+
+    /* SS TEST */
+
+    TPD_DEBUG("SS RAW Testes are starting...\n");
+
+    /************** Self Sense Test **************/
+
+    TPD_DEBUG("Getting SS Frame...\n");
+    ret = setScanMode(SCAN_MODE_LOCKED, LOCKED_ACTIVE);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    ret |= setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    ret |= getSSFrame3(SS_RAW, &ssRawFrame);
+    if (ret < 0) {
+        TPD_INFO("production_test_data: getSSFrame failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    /* SS RAW (PROXIMITY) FORCE TEST */
+    TPD_DEBUG("SS RAW FORCE TEST:\n");
+
+
+
+    if (todo->SelfForceRaw == 1 || todo->SelfForceRawGap == 1 || todo->SelfForceRawMap == 1) {
+        columns = 1;    /* there are no data for the sense channels
+                  * because is a force frame */
+        rows = ssRawFrame.header.force_node;
+
+        TPD_DEBUG("SS RAW FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceRaw == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(ssRawFrame.force_data, rows, columns, thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW FORCE failed... ERROR COUNT = %d\n",ret);
+                TPD_DEBUG("SS RAW (PROXIMITY) FORCE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw force frame =", array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows,columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW FORCE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW FORCE MIN MAX TEST:.................SKIPPED\n\n");
+
+        TPD_DEBUG("SS RAW FORCE MAP MIN MAX TEST:\n");
+        if (todo->SelfForceRawMap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_FORCE_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_FORCE_EACH_NODE_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_FORCE_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_FORCE_EACH_NODE_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(ssRawFrame.force_data, rows, columns, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW FORCE MAP failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW FORCE MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw force frame =", array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW FORCE MAP MIN MAX TEST:.................OK\n\n");
+
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else
+            TPD_DEBUG("SS RAW FORCE MAP MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("SS RAW FORCE GAP TEST:\n");
+        if (todo->SelfForceRawGap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_FORCE_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_FORCE_GAP failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(ssRawFrame.force_data, rows, columns, thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap SS RAW FORCE GAP failed... ERROR = %08X\n", ret);
+                TPD_DEBUG("SS RAW FORCE GAP TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw force frame =", array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW FORCE GAP TEST:.................OK\n\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW FORCE GAP TEST:.................SKIPPED\n\n");
+
+        kfree(ssRawFrame.force_data);
+        ssRawFrame.force_data = NULL;
+    } else
+        TPD_DEBUG("SS RAW FORCE TEST:.................SKIPPED\n\n");
+
+
+    /* SS RAW (PROXIMITY) SENSE TEST */
+    TPD_DEBUG("SS RAW SENSE TEST:\n");
+
+    if (todo->SelfSenseRaw == 1 || todo->SelfSenseRawGap == 1 || todo->SelfSenseRawMap == 1) {
+        columns = ssRawFrame.header.sense_node;
+        rows = 1; /* there are no data for the force channels
+              *  because is a sense frame */
+
+        TPD_DEBUG("SS RAW SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseRaw == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_SENSE_MIN_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(ssRawFrame.sense_data, rows, columns, thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW SENSE MIN MAX TEST:.................FAIL\n");
+                count_fail += 1;
+                print_frame_short("SS Raw sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW SENSE MIN MAX TEST:.................OK\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW SENSE MIN MAX TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("SS RAW SENSE MAP MIN MAX TEST:\n");
+        if (todo->SelfSenseRawMap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_SENSE_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_SENSE_EACH_NODE_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_SENSE_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_SENSE_EACH_NODE_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(ssRawFrame.sense_data, rows, columns, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW SENSE MAP failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW SENSE MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW SENSE MAP MIN MAX TEST:.................OK\n\n");
+
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else
+            TPD_DEBUG("SS RAW SENSE MAP MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("SS RAW SENSE GAP TEST:\n");
+        if (todo->SelfSenseRawGap == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_SENSE_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_SENSE_GAP failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(ssRawFrame.sense_data, rows, columns, thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap SS RAW SENSE GAP failed... ERROR = %08X\n", ret);
+                TPD_DEBUG("SS RAW SENSE GAP TEST:.................FAIL\n");
+                count_fail += 1;
+                print_frame_short("SS Raw sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW SENSE GAP TEST:.................OK\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW SENSE GAP TEST:.................SKIPPED\n");
+
+        kfree(ssRawFrame.sense_data);
+        ssRawFrame.sense_data = NULL;
+    } else
+        TPD_DEBUG("SS RAW SENSE TEST:.................SKIPPED\n\n");
+
+    ret = production_test_ss_raw_lp(path_limits, stop_on_fail, todo);
+    if (ret < OK) {
+        TPD_INFO("production_test_data: production_test_ss_raw_lp failed... ERROR = %08X\n", ret);
+        count_fail += 1;
+    }
+
+    if (count_fail == 0) {
+        TPD_DEBUG("SS RAW testes finished!.................OK\n\n");
+        return OK;
+    } else {
+        TPD_DEBUG("SS RAW testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (ssRawFrame.force_data != NULL)
+        kfree(ssRawFrame.force_data);
+    if (ssRawFrame.sense_data != NULL)
+        kfree(ssRawFrame.sense_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+
+    return ret;
+}
+
+
+/**
+  * Perform all the test selected in a TestTodo variable related to SS raw data
+  * low power
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  *  otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ss_raw_lp(char *path_limits, int stop_on_fail,
+                  TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+    int rows, columns;
+
+    SelfSenseFrame ssRawFrame;
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+
+    ssRawFrame.sense_data = NULL;
+    ssRawFrame.force_data = NULL;
+    /* SS TEST */
+
+    TPD_DEBUG("SS RAW LP Testes are starting...\n");
+
+    /************** Self Sense Test **************/
+
+    TPD_DEBUG("Getting SS LP Frame...\n");
+    ret = setScanMode(SCAN_MODE_LOCKED, LOCKED_LP_DETECT);
+    msleep(WAIT_FOR_FRESH_FRAMES);
+    ret |= setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    msleep(WAIT_AFTER_SENSEOFF);
+    ret |= getSSFrame3(SS_DETECT_RAW, &ssRawFrame);
+    if (ret < 0) {
+        TPD_INFO("production_test_data: getSSFrame failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    /* SS RAW (PROXIMITY) FORCE TEST */
+    TPD_DEBUG("SS RAW LP FORCE TEST:\n");
+
+
+
+    if ((todo->SelfForceRawLP == 1 || todo->SelfForceRawGapLP == 1 || todo->SelfForceRawMapLP == 1) &&
+        ssRawFrame.header.force_node != 0) {
+        columns = 1;    /* there are no data for the sense channels
+                  *  because is a force frame */
+        rows = ssRawFrame.header.force_node;
+
+        TPD_DEBUG("SS RAW LP FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceRawLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO(" production_test_data: parseProductionTestLimits SS_RAW_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(ssRawFrame.force_data, rows,columns, thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO(" production_test_data: checkLimitsMinMax SS RAW FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW LP FORCE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP force frame =", array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW LP FORCE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW LP FORCE MIN MAX TEST:.................SKIPPED\n\n");
+
+        TPD_DEBUG("SS RAW LP FORCE MAP MIN MAX TEST:\n");
+        if (todo->SelfForceRawMapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_FORCE_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_FORCE_EACH_NODE_MIN failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_FORCE_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_FORCE_EACH_NODE_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(ssRawFrame.force_data, rows, columns, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW LP FORCE MAP failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW LP FORCE MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP force frame =",
+                          array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW FORCE LP MAP MIN MAX TEST:.................OK\n\n");
+
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else
+            TPD_DEBUG("SS RAW FORCE LP MAP MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("SS RAW LP FORCE GAP TEST:\n");
+        if (todo->SelfForceRawGapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_FORCE_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_FORCE_GAP failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(ssRawFrame.force_data, rows, columns, thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap SS RAW FORCE GAP failed... ERROR = %08X\n", ret);
+                TPD_DEBUG("SS RAW LP FORCE GAP TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP force frame =", array1dTo2d_short(ssRawFrame.force_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW LP FORCE GAP TEST:.................OK\n\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW LP FORCE GAP TEST:.................SKIPPED\n\n");
+
+        kfree(ssRawFrame.force_data);
+        ssRawFrame.force_data = NULL;
+    } else
+        TPD_DEBUG("SS RAW LP FORCE TEST:.................SKIPPED\n\n");
+
+
+    /* SS RAW (PROXIMITY) SENSE TEST */
+    TPD_DEBUG("SS RAW LP SENSE TEST:\n");
+
+    if ((todo->SelfSenseRawLP == 1 || todo->SelfSenseRawGapLP == 1 || todo->SelfSenseRawMapLP == 1) && ssRawFrame.header.sense_node != 0) {
+        columns = ssRawFrame.header.sense_node;
+        rows = 1; /* there are no data for the force channels
+              * because is a sense frame */
+
+        TPD_DEBUG("SS RAW LP SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseRawLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+            if (ret < OK || (trows != 1 || tcolumns != 2)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_SENSE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMinMax(ssRawFrame.sense_data, rows, columns, thresholds[0], thresholds[1]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW LP SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS RAW LP SENSE MIN MAX TEST:.................FAIL\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW SENSE MIN MAX TEST:.................OK\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW LP SENSE MIN MAX TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("SS RAW LP SENSE MAP MIN MAX TEST:\n");
+        if (todo->SelfSenseRawMapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_SENSE_EACH_NODE_MIN, &thresholds_min, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_SENSE_EACH_NODE_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_SENSE_EACH_NODE_MAX, &thresholds_max, &trows, &tcolumns);
+            if (ret < OK || (trows != rows || tcolumns != columns)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_SENSE_EACH_NODE_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(ssRawFrame.sense_data, rows, columns, thresholds_min, thresholds_max);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMinMax SS RAW LP SENSE MAP failed... ERROR COUNT = %d\n",ret);
+                TPD_DEBUG("SS RAW LP SENSE MAP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW LP SENSE MAP MIN MAX TEST:.................OK\n\n");
+
+            if (thresholds_min != NULL) {
+                kfree(thresholds_min);
+                thresholds_min = NULL;
+            }
+            if (thresholds_max != NULL) {
+                kfree(thresholds_max);
+                thresholds_max = NULL;
+            }
+        } else
+            TPD_DEBUG("SS RAW LP SENSE MAP MIN MAX TEST:.................SKIPPED\n\n");
+
+
+        TPD_DEBUG("SS RAW LP SENSE GAP TEST:\n");
+        if (todo->SelfSenseRawGapLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_RAW_LP_SENSE_GAP, &thresholds, &trows, &tcolumns);
+            if (ret < OK || (trows != 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_RAW_LP_SENSE_GAP failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsGap(ssRawFrame.sense_data, rows, columns, thresholds[0]);
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsGap SS RAW LP SENSE GAP failed... ERROR = %08X\n", ret);
+                TPD_DEBUG("SS RAW LP SENSE GAP TEST:.................FAIL\n");
+                count_fail += 1;
+                print_frame_short("SS Raw LP sense frame =", array1dTo2d_short(ssRawFrame.sense_data, rows * columns, columns), rows, columns);
+                if (stop_on_fail) {
+                    ret = ERROR_PROD_TEST_DATA | ERROR_TEST_CHECK_FAIL;
+                    goto ERROR_LIMITS;
+                }
+            } else
+                TPD_DEBUG("SS RAW LP SENSE GAP TEST:.................OK\n");
+
+            kfree(thresholds);
+            thresholds = NULL;
+        } else
+            TPD_DEBUG("SS RAW LP SENSE GAP TEST:.................SKIPPED\n");
+
+        kfree(ssRawFrame.sense_data);
+        ssRawFrame.sense_data = NULL;
+    } else
+        TPD_DEBUG("SS RAW LP SENSE TEST:.................SKIPPED\n\n");
+
+
+    if (count_fail == 0) {
+        TPD_DEBUG("SS RAW LP testes finished!.................OK\n\n");
+        return OK;
+    } else {
+        TPD_DEBUG("SS RAW LP testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (ssRawFrame.force_data != NULL)
+        kfree(ssRawFrame.force_data);
+    if (ssRawFrame.sense_data != NULL)
+        kfree(ssRawFrame.sense_data);
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    return ret;
+}
+
+/**
+  * Perform all the tests selected in a TestTodo variable related to SS Init
+  * data (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ss_ix_cx(char *path_limits, int stop_on_fail,
+                 TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+
+    SelfSenseData ssCompData;
+    TotSelfSenseData totCompData;
+
+    u8 *adjhor = NULL;
+    u8 *adjvert = NULL;
+
+    short container;
+
+    u16 *total_adjhor = NULL;
+    u16 *total_adjvert = NULL;
+
+    ssCompData.ix2_fm = NULL;
+    ssCompData.ix2_sn = NULL;
+    ssCompData.cx2_fm = NULL;
+    ssCompData.cx2_sn = NULL;
+
+    totCompData.ix_fm = NULL;
+    totCompData.ix_sn = NULL;
+    totCompData.cx_fm = NULL;
+    totCompData.cx_sn = NULL;
+
+    TPD_DEBUG("SS IX CX testes are starting...\n");
+    ret = readSelfSenseCompensationData(LOAD_CX_SS_TOUCH, &ssCompData);
+    /* read the SS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readSelfSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    ret = readTotSelfSenseCompensationData(LOAD_PANEL_CX_TOT_SS_TOUCH, &totCompData);
+    /* read the TOT SS compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readTotSelfSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        kfree(ssCompData.ix2_fm);
+        kfree(ssCompData.ix2_sn);
+        kfree(ssCompData.cx2_fm);
+        kfree(ssCompData.cx2_sn);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    /************* SS FORCE IX **************/
+    /* SS IX1 FORCE TEST */
+    TPD_DEBUG("SS IX1 FORCE TEST:\n");
+    if (todo->SelfForceIx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX1_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO(" production_test_data: parseProductionTestLimits SS_IX1_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        container = (short)ssCompData.f_ix1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);
+        /* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS IX1 FORCE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX1 FORCE TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG(" SS IX1 FORCE TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+    /* SS IX2 FORCE TEST */
+    TPD_DEBUG("SS IX2 FORCE MIN MAX TEST:\n");
+    if (todo->SelfForceIx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node ||
+                tcolumns != 1)) {
+            TPD_INFO(
+                 "production_test_data: parseProductionTestLimits SS_IX2_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapFromU(ssCompData.ix2_fm, ssCompData.header.force_node, 1, thresholds_min,thresholds_max);    /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 FORCE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 FORCE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS IX2 FORCE MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("SS IX2 FORCE ADJ TEST:\n");
+    if (todo->SelfForceIx2Adj == 1) {
+        /* SS IX2 FORCE ADJV TEST */
+        TPD_DEBUG("SS IX2 FORCE ADJVERT TEST:\n");
+        ret = computeAdjVertFromU(ssCompData.ix2_fm, ssCompData.header.force_node, 1, &adjvert);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert SS IX2 FORCE ADJV failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS IX2 FORCE ADJV computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);    /* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node - 1 || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, ssCompData.header.force_node - 1, 1, thresholds_max);    /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 FORCE ADJV TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 FORCE ADJV TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("SS IX2 FORCE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL FORCE IX */
+    TPD_DEBUG("SS TOTAL IX FORCE TEST:\n");
+    if (todo->SelfForceIxTotal == 1 || todo->SelfForceIxTotalAdj == 1) {
+        TPD_DEBUG("SS TOTAL IX FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceIxTotal == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotalFromU(totCompData.ix_fm, totCompData.header.force_node, 1, thresholds_min, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap  SS TOTAL IX FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX FORCE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX FORCE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX FORCE MIN MAX TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("SS TOTAL IX FORCE ADJ TEST:\n");
+        if (todo->SelfForceIxTotalAdj == 1) {
+            /* SS TOTAL IX FORCE ADJV TEST */
+            TPD_DEBUG("SS TOTAL IX FORCE ADJVERT TEST:\n");
+            ret = computeAdjVertTotalFromU(totCompData.ix_fm, totCompData.header.force_node, 1, &total_adjvert);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert SS TOTAL IX FORCE ADJV failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL IX FORCE ADJV computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_FORCE_ADJV_MAP_MAX... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL IX FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX FORCE ADJV TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX FORCE ADJV TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX FORCE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL IX FORCE TEST:.................SKIPPED\n\n");
+
+
+    /************** SS SENSE IX **************/
+    /* SS IX1 SENSE TEST */
+    TPD_DEBUG("SS IX1 SENSE TEST:\n");
+    if (todo->SelfSenseIx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX1_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX1_SENSE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.s_ix1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS IX1 SENSE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX1 SENSE TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("SS IX1 SENSE TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+    /* SS IX2 SENSE TEST */
+    TPD_DEBUG("SS IX2 SENSE MIN MAX TEST:\n");
+    if (todo->SelfSenseIx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapFromU(ssCompData.ix2_sn, 1, ssCompData.header.sense_node, thresholds_min, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 SENSE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 SENSE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 SENSE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS IX2 SENSE MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("SS IX2 SENSE ADJ TEST:\n");
+    if (todo->SelfSenseIx2Adj == 1) {
+        /* SS IX2 SENSE ADJH TEST */
+        TPD_DEBUG("SS IX2 SENSE ADJHORIZ TEST:\n");
+        ret = computeAdjHorizFromU(ssCompData.ix2_sn, 1, ssCompData.header.sense_node, &adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz SS IX2 SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS IX2 SENSE ADJ HORIZ computed!\n");
+
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, 1, ssCompData.header.sense_node - 1, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj SS IX2 SENSE ADJH failed... ERROR COUNT = %d\n",ret);
+            TPD_DEBUG("SS IX2 SENSE ADJH TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 SENSE ADJH TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+    } else
+        TPD_DEBUG("SS IX2 SENSE ADJ TEST:.................SKIPPED\n");
+
+    /* SS TOTAL IX SENSE */
+    TPD_DEBUG("SS TOTAL IX SENSE TEST:\n");
+    if (todo->SelfSenseIxTotal == 1 || todo->SelfSenseIxTotalAdj == 1) {
+        TPD_DEBUG("SS TOTAL IX SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseIxTotal == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotalFromU(totCompData.ix_sn, 1, totCompData.header.sense_node, thresholds_min, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL IX SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX SENSE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX SENSE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX SENSE MIN MAX TEST:.................SKIPPED\n");
+
+
+        TPD_DEBUG("SS TOTAL IX SENSE ADJ TEST:\n");
+        if (todo->SelfSenseIxTotalAdj == 1) {
+            /* SS TOTAL IX SENSE ADJH TEST */
+            TPD_DEBUG("SS TOTAL IX SENSE ADJHORIZ TEST:\n");
+            ret = computeAdjHorizTotalFromU(totCompData.ix_sn, 1, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz SS TOTAL IX SENSE ADJH failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL IX SENSE ADJ HORIZ computed!\n");
+
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, 1, totCompData.header.sense_node - 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj SS TOTAL IX SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX SENSE ADJH TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX SENSE ADJH TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX SENSE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL IX SENSE TEST:.................SKIPPED\n");
+
+    /************* SS SENSE CX **************/
+    /* SS CX1 FORCE TEST */
+    TPD_DEBUG("SS CX1 FORCE TEST:\n");
+    if (todo->SelfForceCx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX1_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX1_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.f_cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS CX1 FORCE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX1 FORCE TEST:.................OK\n\n");
+        kfree(thresholds);
+        thresholds = NULL;
+    } else
+        TPD_DEBUG("SS CX1 FORCE TEST:.................SKIPPED\n\n");
+
+    /* SS CX2 FORCE TEST */
+    TPD_DEBUG("SS CX2 FORCE MIN MAX TEST:\n");
+    if (todo->SelfForceCx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(ssCompData.cx2_fm, ssCompData.header.force_node, 1, thresholds_min, thresholds_max); /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS CX2 FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 FORCE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 FORCE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS CX2 FORCE MIN MAX TEST:.................SKIPPED\n");
+
+    TPD_DEBUG("SS CX2 FORCE ADJ TEST:\n");
+    if (todo->SelfForceCx2Adj == 1) {
+        /* SS CX2 FORCE ADJV TEST */
+        TPD_DEBUG("SS CX2 FORCE ADJVERT TEST:\n");
+        ret = computeAdjVert(ssCompData.cx2_fm, ssCompData.header.force_node, 1, &adjvert);/* compute the ADJV for CX2  FORCE */
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert SS CX2 FORCE ADJV failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS CX2 FORCE ADJV computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node - 1 || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, ssCompData.header.force_node - 1, 1, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 FORCE ADJV TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 FORCE ADJV TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("SS CX2 FORCE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL CX FORCE */
+    TPD_DEBUG("SS TOTAL CX FORCE TEST:\n");
+    if (todo->SelfForceCxTotal == 1 || todo->SelfForceCxTotalAdj == 1) {
+        TPD_DEBUG("SS TOTAL CX FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceCxTotal == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.cx_fm, totCompData.header.force_node, 1, thresholds_min, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL FORCE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL FORCE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX FORCE MIN MAX TEST:.................SKIPPED\n");
+
+        /* SS TOTAL CX FORCE ADJV TEST */
+        TPD_DEBUG("SS TOTAL CX FORCE ADJ TEST:\n");
+        if (todo->SelfForceCxTotalAdj == 1) {
+            TPD_DEBUG("SS TOTAL CX FORCE ADJVERT TEST:\n");
+            ret = computeAdjVertTotal(totCompData.cx_fm, totCompData.header.force_node, 1, &total_adjvert);/* compute the ADJV for CX2  FORCE */
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert SS TOTAL CX FORCE ADJV failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL CX FORCE ADJV computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, 1,thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL CX FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL CX FORCE ADJV TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX FORCE ADJV TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX FORCE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL CX FORCE TEST:.................SKIPPED\n\n");
+
+
+
+    /************* SS SENSE CX *************/
+    /* SS CX1 SENSE TEST */
+    TPD_DEBUG("SS CX1 SENSE TEST:\n");
+    if (todo->SelfSenseCx1 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX1_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX1_SENSE_MIN_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.s_cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS CX1 SENSE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX1 SENSE TEST:.................OK\n\n");
+        kfree(thresholds);
+        thresholds = NULL;
+    } else
+        TPD_DEBUG("SS CX1 SENSE TEST:.................SKIPPED\n\n");
+
+    /* SS CX2 SENSE TEST */
+    TPD_DEBUG("SS CX2 SENSE MIN MAX TEST:\n");
+    if (todo->SelfSenseCx2 == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(ssCompData.cx2_sn, 1, ssCompData.header.sense_node, thresholds_min, thresholds_max); /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS CX2 SENSE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 SENSE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 SENSE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS CX2 SENSE MIN MAX TEST:.................SKIPPED\n");
+
+    TPD_DEBUG("SS CX2 SENSE ADJ TEST:\n");
+    if (todo->SelfSenseCx2Adj == 1) {
+        /* SS CX2 SENSE ADJH TEST */
+        TPD_DEBUG("SS CX2 SENSE ADJHORIZ TEST:\n");
+        ret = computeAdjHoriz(ssCompData.cx2_sn, 1, ssCompData.header.sense_node, &adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz SS CX2 SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS CX2 SENSE ADJH computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, 1, ssCompData.header.sense_node - 1, thresholds_max); /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj SS CX2 SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 SENSE ADJH TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 SENSE ADJH TEST:.................OK\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+    } else
+        TPD_DEBUG("SS CX2 SENSE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL CX SENSE */
+    TPD_DEBUG("SS TOTAL CX SENSE TEST:\n");
+    if (todo->SelfSenseCxTotal == 1 || todo->SelfSenseCxTotalAdj == 1) {
+        TPD_DEBUG("SS TOTAL CX SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseCxTotal == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns); /* load the min thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.cx_sn, 1, totCompData.header.sense_node, thresholds_min, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL CX SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL CX SENSE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX SENSE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX SENSE MIN MAX TEST:.................SKIPPED\n");
+
+        /* SS TOTAL IX SENSE ADJH TEST */
+        TPD_DEBUG("SS TOTAL CX SENSE ADJ TEST:\n");
+        if (todo->SelfSenseCxTotalAdj == 1) {
+            TPD_DEBUG("SS TOTAL CX SENSE ADJHORIZ TEST:\n");
+            ret = computeAdjHorizTotal(totCompData.cx_sn, 1, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz SS TOTAL CX SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL CX SENSE ADJ HORIZ computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, 1, totCompData.header.sense_node - 1,thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj SS TOTAL CX SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL CX SENSE ADJH TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX SENSE ADJH TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX SENSE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL CX SENSE TEST:.................SKIPPED\n");
+
+
+    if ((todo->SelfSenseCx1LP | todo->SelfSenseCx2LP |
+        todo->SelfSenseCx2AdjLP | todo->SelfSenseCxTotalLP |
+        todo->SelfSenseCxTotalAdjLP | todo->SelfSenseIx1LP |
+        todo->SelfSenseIx2LP | todo->SelfSenseIx2AdjLP |
+        todo->SelfSenseIxTotalLP | todo->SelfSenseIxTotalAdjLP) == 1) {
+        ret = production_test_ss_ix_cx_lp(path_limits, stop_on_fail, todo);
+        if (ret < OK) {
+            count_fail += 1;
+            TPD_INFO("production_test_data: production_test_ss_ix_cx_lp failed... ERROR = %08X\n", ret);
+            goto ERROR;
+        }
+    } else
+        TPD_DEBUG("SS IX CX LP TEST:.................SKIPPED\n");
+
+ERROR:
+
+    if (count_fail == 0) {
+        kfree(ssCompData.ix2_fm);
+        ssCompData.ix2_fm = NULL;
+        kfree(ssCompData.ix2_sn);
+        ssCompData.ix2_sn = NULL;
+        kfree(ssCompData.cx2_fm);
+        ssCompData.cx2_fm = NULL;
+        kfree(ssCompData.cx2_sn);
+        ssCompData.cx2_sn = NULL;
+        kfree(totCompData.ix_fm);
+        totCompData.ix_fm = NULL;
+        kfree(totCompData.ix_sn);
+        totCompData.ix_sn = NULL;
+        kfree(totCompData.cx_fm);
+        totCompData.cx_fm = NULL;
+        kfree(totCompData.cx_sn);
+        totCompData.cx_sn = NULL;
+        TPD_DEBUG("SS IX CX testes finished!.................OK\n\n");
+        return OK;
+    } else {
+    /* print all kind of data in just one row for readability reason */
+        print_frame_u8("SS Init Data Ix2_fm = ", array1dTo2d_u8(ssCompData.ix2_fm, ssCompData.header.force_node, 1), ssCompData.header.force_node, 1);
+        print_frame_i8("SS Init Data Cx2_fm = ", array1dTo2d_i8(ssCompData.cx2_fm, ssCompData.header.force_node, 1), ssCompData.header.force_node, 1);
+        print_frame_u8("SS Init Data Ix2_sn = ", array1dTo2d_u8(ssCompData.ix2_sn, ssCompData.header.sense_node, ssCompData.header.sense_node), 1, ssCompData.header.sense_node);
+        print_frame_i8("SS Init Data Cx2_sn = ", array1dTo2d_i8(ssCompData.cx2_sn, ssCompData.header.sense_node, ssCompData.header.sense_node), 1, ssCompData.header.sense_node);
+        print_frame_u16("TOT SS Init Data Ix_fm = ", array1dTo2d_u16(totCompData.ix_fm, totCompData.header.force_node, 1), totCompData.header.force_node, 1);
+        print_frame_short("TOT SS Init Data Cx_fm = ", array1dTo2d_short(totCompData.cx_fm, totCompData.header.force_node, 1), totCompData.header.force_node, 1);
+        print_frame_u16("TOT SS Init Data Ix_sn = ", array1dTo2d_u16(totCompData.ix_sn, totCompData.header.sense_node, totCompData.header.sense_node), 1, totCompData.header.sense_node);
+        print_frame_short("TOT SS Init Data Cx_sn = ", array1dTo2d_short(totCompData.cx_sn, totCompData.header.sense_node, totCompData.header.sense_node), 1, totCompData.header.sense_node);
+        TPD_DEBUG("SS IX CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (thresholds_min != NULL)
+            kfree(thresholds_min);
+        if (thresholds_max != NULL)
+            kfree(thresholds_max);
+        if (adjhor != NULL)
+            kfree(adjhor);
+        if (adjvert != NULL)
+            kfree(adjvert);
+        if (total_adjhor != NULL)
+            kfree(total_adjhor);
+        if (total_adjvert != NULL)
+            kfree(total_adjvert);
+        if (ssCompData.ix2_fm != NULL)
+            kfree(ssCompData.ix2_fm);
+        if (ssCompData.ix2_sn != NULL)
+            kfree(ssCompData.ix2_sn);
+        if (ssCompData.cx2_fm != NULL)
+            kfree(ssCompData.cx2_fm);
+        if (ssCompData.cx2_sn != NULL)
+            kfree(ssCompData.cx2_sn);
+        if (totCompData.ix_fm != NULL)
+            kfree(totCompData.ix_fm);
+        if (totCompData.ix_sn != NULL)
+            kfree(totCompData.ix_sn);
+        if (totCompData.cx_fm != NULL)
+            kfree(totCompData.cx_fm);
+        if (totCompData.cx_sn != NULL)
+            kfree(totCompData.cx_sn);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    if (adjhor != NULL)
+        kfree(adjhor);
+    if (adjvert != NULL)
+        kfree(adjvert);
+    if (total_adjhor != NULL)
+        kfree(total_adjhor);
+    if (total_adjvert != NULL)
+        kfree(total_adjvert);
+    if (ssCompData.ix2_fm != NULL)
+        kfree(ssCompData.ix2_fm);
+    if (ssCompData.ix2_sn != NULL)
+        kfree(ssCompData.ix2_sn);
+    if (ssCompData.cx2_fm != NULL)
+        kfree(ssCompData.cx2_fm);
+    if (ssCompData.cx2_sn != NULL)
+        kfree(ssCompData.cx2_sn);
+    if (totCompData.ix_fm != NULL)
+        kfree(totCompData.ix_fm);
+    if (totCompData.ix_sn != NULL)
+        kfree(totCompData.ix_sn);
+    if (totCompData.cx_fm != NULL)
+        kfree(totCompData.cx_fm);
+    if (totCompData.cx_sn != NULL)
+        kfree(totCompData.cx_sn);
+    return ret;
+}
+
+/**
+  * Perform all the tests selected in a TestTodo variable related to SS Init
+  * data for LP mode (touch, keys etc..)
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure
+  * otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_ss_ix_cx_lp(char *path_limits, int stop_on_fail,
+                 TestToDo *todo)
+{
+    int ret;
+    int count_fail = 0;
+
+    int *thresholds = NULL;
+    int trows, tcolumns;
+    int *thresholds_min = NULL;
+    int *thresholds_max = NULL;
+
+    SelfSenseData ssCompData;
+    TotSelfSenseData totCompData;
+
+    u8 *adjhor = NULL;
+    u8 *adjvert = NULL;
+
+    short container;
+
+    u16 *total_adjhor = NULL;
+    u16 *total_adjvert = NULL;
+
+    ssCompData.ix2_fm = NULL;
+    ssCompData.ix2_sn = NULL;
+    ssCompData.cx2_fm = NULL;
+    ssCompData.cx2_sn = NULL;
+
+    totCompData.ix_fm = NULL;
+    totCompData.ix_sn = NULL;
+    totCompData.cx_fm = NULL;
+    totCompData.cx_sn = NULL;
+
+    TPD_DEBUG("SS LP IX CX testes are starting...\n");
+    ret = readSelfSenseCompensationData(LOAD_CX_SS_TOUCH_IDLE, &ssCompData);/* read the SS LP compensation data */
+    if (ret < 0) {
+        TPD_INFO("production_test_data: readSelfSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    ret = readTotSelfSenseCompensationData(LOAD_PANEL_CX_TOT_SS_TOUCH_IDLE, &totCompData);/* read the TOT SS LP compensation data */
+    if (ret < 0) {
+        TPD_INFO(" production_test_data: readTotSelfSenseCompensationData failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+        kfree(ssCompData.ix2_fm);
+        kfree(ssCompData.ix2_sn);
+        kfree(ssCompData.cx2_fm);
+        kfree(ssCompData.cx2_sn);
+        return ret | ERROR_PROD_TEST_DATA;
+    }
+
+    /************* SS FORCE IX LP **************/
+    /* SS IX1 LP FORCE TEST */
+    TPD_DEBUG("SS IX1 LP FORCE TEST:\n");
+    if (todo->SelfForceIx1LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX1_LP_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX1_LP_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        container = (short)ssCompData.f_ix1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS IX1 LP FORCE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX1 LP FORCE TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("SS IX1 LP FORCE TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+    /* SS IX2 LP FORCE TEST */
+    TPD_DEBUG("SS IX2 LP FORCE MIN MAX TEST:\n");
+    if (todo->SelfForceIx2LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_LP_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns); /* load the min thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_LP_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapFromU(ssCompData.ix2_fm, ssCompData.header.force_node, 1, thresholds_min, thresholds_max);    /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 LP FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 LP FORCE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 LP FORCE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS IX2 LP FORCE MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("SS IX2 LP FORCE ADJ TEST:\n");
+    if (todo->SelfForceIx2AdjLP == 1) {
+        /* SS IX2 FORCE ADJV TEST */
+        TPD_DEBUG("SS IX2 LP FORCE ADJVERT TEST:\n");
+        ret = computeAdjVertFromU(ssCompData.ix2_fm, ssCompData.header.force_node, 1, &adjvert);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert SS IX2 LP FORCE ADJV failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS IX2 LP FORCE ADJV computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_LP_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);    /* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node - 1 || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, ssCompData.header.force_node - 1, 1, thresholds_max); /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 LP FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 LP FORCE ADJV TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 LP FORCE ADJV TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("SS IX2 LP FORCE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL FORCE IX */
+    TPD_DEBUG("SS TOTAL IX LP FORCE TEST:\n");
+    if (todo->SelfForceIxTotalLP == 1 || todo->SelfForceIxTotalAdjLP == 1) {
+        TPD_DEBUG("SS TOTAL IX LP FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceIxTotalLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns); /* load the min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_FORCE_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotalFromU(totCompData.ix_fm, totCompData.header.force_node, 1, thresholds_min, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap  SS TOTAL IX LP FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX LP FORCE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX LP FORCE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX LP FORCE MIN MAX TEST:.................SKIPPED\n");
+
+        TPD_DEBUG("SS TOTAL IX LP FORCE ADJ TEST:\n");
+        if (todo->SelfForceIxTotalAdjLP == 1) {
+            /* SS TOTAL IX FORCE ADJV TEST */
+            TPD_DEBUG("SS TOTAL IX LP FORCE ADJVERT TEST:\n");
+            ret = computeAdjVertTotalFromU(totCompData.ix_fm, totCompData.header.force_node, 1, &total_adjvert);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert SS TOTAL IX LP FORCE ADJV failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL IX LP FORCE ADJV computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_FORCE_ADJV_MAP_MAX... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL IX LP FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX LP FORCE ADJV TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX LP FORCE ADJV TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX LP FORCE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL IX LP FORCE TEST:.................SKIPPED\n\n");
+
+
+    /************** SS SENSE IX LP **************/
+    /* SS IX1 LP SENSE TEST */
+    TPD_DEBUG("SS IX1 LP SENSE TEST:\n");
+    if (todo->SelfSenseIx1LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX1_LP_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX1_LP_SENSE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.s_ix1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS IX1 SENSE LP TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX1 LP SENSE TEST:.................OK\n\n");
+    } else
+        TPD_DEBUG("SS IX1 LP SENSE TEST:.................SKIPPED\n\n");
+
+    kfree(thresholds);
+    thresholds = NULL;
+    /* SS IX2 SENSE TEST */
+    TPD_DEBUG("SS IX2 LP SENSE MIN MAX TEST:\n");
+    if (todo->SelfSenseIx2LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_LP_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_LP_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapFromU(ssCompData.ix2_sn, 1, ssCompData.header.sense_node, thresholds_min, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 LP SENSE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 LP SENSE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 LP SENSE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS IX2 LP SENSE MIN MAX TEST:.................SKIPPED\n\n");
+
+    TPD_DEBUG("SS IX2 LP SENSE ADJ TEST:\n");
+    if (todo->SelfSenseIx2AdjLP == 1) {
+        /* SS IX2 SENSE ADJH TEST */
+        TPD_DEBUG("SS IX2 SENSE ADJHORIZ TEST:\n");
+        ret = computeAdjHorizFromU(ssCompData.ix2_sn, 1, ssCompData.header.sense_node,&adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz SS IX2 SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS IX2 SENSE ADJ HORIZ computed!\n");
+
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_IX2_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_LP_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, 1, ssCompData.header.sense_node - 1, thresholds_max); /* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj SS IX2 LP SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS IX2 LP SENSE ADJH TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS IX2 LP SENSE ADJH TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+    } else
+        TPD_DEBUG("SS IX2 LP SENSE ADJ TEST:.................SKIPPED\n");
+
+    /* SS TOTAL IX SENSE */
+    TPD_DEBUG("SS TOTAL IX LP SENSE TEST:\n");
+    if (todo->SelfSenseIxTotalLP == 1 || todo->SelfSenseIxTotalAdjLP == 1) {
+        TPD_DEBUG("SS TOTAL IX LP SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseIxTotalLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotalFromU(totCompData.ix_sn, 1, totCompData.header.sense_node, thresholds_min, thresholds_max); /* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL IX LP SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX LP SENSE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX LP SENSE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX LP SENSE MIN MAX TEST:.................SKIPPED\n");
+
+
+        TPD_DEBUG("SS TOTAL IX LP SENSE ADJ TEST:\n");
+        if (todo->SelfSenseIxTotalAdjLP == 1) {
+            /* SS TOTAL IX SENSE ADJH TEST */
+            TPD_DEBUG("SS TOTAL IX LP SENSE ADJHORIZ TEST:\n");
+            ret = computeAdjHorizTotalFromU(totCompData.ix_sn, 1, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz SS TOTAL IX LP SENSE ADJH failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL IX LP SENSE ADJ HORIZ computed!\n");
+
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_IX_LP_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_IX_LP_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, 1, totCompData.header.sense_node - 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj SS TOTAL IX LP SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL IX LP SENSE ADJH TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL IX LP SENSE ADJH TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL IX LP SENSE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL IX LP SENSE TEST:.................SKIPPED\n");
+
+    /************* SS SENSE CX LP **************/
+    /* SS CX1 LP FORCE TEST */
+    TPD_DEBUG("SS CX1 LP FORCE TEST:\n");
+    if (todo->SelfForceCx1LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX1_LP_FORCE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX1_LP_FORCE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.f_cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS CX1 LP FORCE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX1 LP FORCE TEST:.................OK\n\n");
+        kfree(thresholds);
+        thresholds = NULL;
+    } else
+        TPD_DEBUG("SS CX1 LP FORCE TEST:.................SKIPPED\n\n");
+
+    /* SS CX2 LP FORCE TEST */
+    TPD_DEBUG("SS CX2 LP FORCE MIN MAX TEST:\n");
+    if (todo->SelfForceCx2LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_LP_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_LP_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(ssCompData.cx2_fm, ssCompData.header.force_node, 1, thresholds_min, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS CX2 LP FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 LP FORCE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 LP FORCE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS CX2 LP FORCE MIN MAX TEST:.................SKIPPED\n");
+
+    TPD_DEBUG("SS CX2 LP FORCE ADJ TEST:\n");
+    if (todo->SelfForceCx2AdjLP == 1) {
+        /* SS CX2 FORCE ADJV TEST */
+        TPD_DEBUG("SS CX2 LP FORCE ADJVERT TEST:\n");
+        ret = computeAdjVert(ssCompData.cx2_fm, ssCompData.header.force_node, 1, &adjvert);/* compute the ADJV for CX2  FORCE */
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjVert SS CX2 LP FORCE ADJV failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS CX2 LP FORCE ADJV computed!\n");
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != ssCompData.header.force_node - 1 || tcolumns != 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_LP_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjvert, ssCompData.header.force_node - 1, 1, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS IX2 LP FORCE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 LP FORCE ADJV TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 LP FORCE ADJV TEST:.................OK\n\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjvert);
+        adjvert = NULL;
+    } else
+        TPD_DEBUG("SS CX2 LP FORCE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL CX LP FORCE */
+    TPD_DEBUG("SS TOTAL CX LP FORCE TEST:\n");
+    if (todo->SelfForceCxTotalLP == 1 || todo->SelfForceCxTotalAdjLP == 1) {
+        TPD_DEBUG("SS TOTAL CX LP FORCE MIN MAX TEST:\n");
+        if (todo->SelfForceCxTotalLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_FORCE_MAP_MIN, &thresholds_min, &trows, &tcolumns); /* load the min thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_FORCE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_FORCE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_FORCE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.cx_fm, totCompData.header.force_node, 1, thresholds_min, thresholds_max); /* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL LP FORCE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL FORCE LP MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL FORCE LP MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX LP FORCE MIN MAX TEST:.................SKIPPED\n");
+
+        /* SS TOTAL CX LP FORCE ADJV TEST */
+        TPD_DEBUG("SS TOTAL CX LP FORCE ADJ TEST:\n");
+        if (todo->SelfForceCxTotalAdjLP == 1) {
+            TPD_DEBUG("SS TOTAL CX LP FORCE ADJVERT TEST:\n");
+            ret = computeAdjVertTotal(totCompData.cx_fm, totCompData.header.force_node, 1, &total_adjvert);/* compute the ADJV for CX2  FORCE */
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjVert SS TOTAL CX LP FORCE ADJV failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL CX LP FORCE ADJV computed!\n");
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_FORCE_ADJV_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != totCompData.header.force_node - 1 || tcolumns != 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_FORCE_ADJV_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjvert, totCompData.header.force_node - 1, 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL CX LP FORCE failed... ERROR COUNT = %d\n",ret);
+                TPD_DEBUG("SS TOTAL CX LP FORCE ADJV TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX LP FORCE ADJV TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjvert);
+            total_adjvert = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX LP FORCE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL CX LP FORCE TEST:.................SKIPPED\n\n");
+
+
+
+    /************* SS SENSE CX *************/
+    /* SS CX1 SENSE TEST */
+    TPD_DEBUG("SS CX1 LP SENSE TEST:\n");
+    if (todo->SelfSenseCx1LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX1_LP_SENSE_MIN_MAX, &thresholds, &trows, &tcolumns);
+        if (ret < 0 || (trows != 1 || tcolumns != 2)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX1_LP_SENSE_MIN_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        container = (short)ssCompData.s_cx1;
+        ret = checkLimitsMinMax(&container, 1, 1, thresholds[0], thresholds[1]);/* check the limits */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMinMax SS CX1 LP SENSE TEST failed... ERROR COUNT = %d\n", ret);
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX1 LP SENSE TEST:.................OK\n\n");
+        kfree(thresholds);
+        thresholds = NULL;
+    } else
+        TPD_DEBUG("SS CX1 LP SENSE TEST:.................SKIPPED\n\n");
+
+    /* SS CX2 LP SENSE TEST */
+    TPD_DEBUG("SS CX2 LP SENSE MIN MAX TEST:\n");
+    if (todo->SelfSenseCx2LP == 1) {
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns);/* load the min thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_LP_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns != ssCompData.header.sense_node)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_CX2_LP_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMap(ssCompData.cx2_sn, 1, ssCompData.header.sense_node, thresholds_min, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMap SS CX2 LP SENSE failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 LP SENSE MIN MAX TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 LP SENSE MIN MAX TEST:.................OK\n\n");
+
+        kfree(thresholds_min);
+        thresholds_min = NULL;
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+    } else
+        TPD_DEBUG("SS CX2 LP SENSE MIN MAX TEST:.................SKIPPED\n");
+
+    TPD_DEBUG("SS CX2 LP SENSE ADJ TEST:\n");
+    if (todo->SelfSenseCx2AdjLP == 1) {
+        /* SS CX2 SENSE ADJH TEST */
+        TPD_DEBUG("SS CX2 LP SENSE ADJHORIZ TEST:\n");
+        ret = computeAdjHoriz(ssCompData.cx2_sn, 1, ssCompData.header.sense_node, &adjhor);
+        if (ret < 0) {
+            TPD_INFO("production_test_data: computeAdjHoriz SS CX2 LP SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+        TPD_DEBUG("SS CX2 LP SENSE ADJH computed!\n");
+
+
+        ret = parseProductionTestLimits(path_limits, &limit_file, SS_CX2_LP_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+        if (ret < 0 || (trows != 1 || tcolumns !=
+                ssCompData.header.sense_node - 1)) {
+            TPD_INFO("production_test_data: parseProductionTestLimits SS_IX2_SENSE_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+            ret |= ERROR_PROD_TEST_DATA;
+            goto ERROR_LIMITS;
+        }
+
+        ret = checkLimitsMapAdj(adjhor, 1, ssCompData.header.sense_node - 1, thresholds_max);/* check the values with thresholds */
+        if (ret != OK) {
+            TPD_INFO("production_test_data: checkLimitsMapAdj SS CX2 LP SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+            TPD_DEBUG("SS CX2 LP SENSE ADJH TEST:.................FAIL\n\n");
+            count_fail += 1;
+            if (stop_on_fail)
+                goto ERROR;
+        } else
+            TPD_DEBUG("SS CX2 LP SENSE ADJH TEST:.................OK\n");
+
+        kfree(thresholds_max);
+        thresholds_max = NULL;
+        kfree(adjhor);
+        adjhor = NULL;
+    } else
+        TPD_DEBUG("SS CX2 LP SENSE ADJ TEST:.................SKIPPED\n\n");
+
+    /* SS TOTAL CX SENSE */
+    TPD_DEBUG("SS TOTAL CX LP SENSE TEST:\n");
+    if (todo->SelfSenseCxTotalLP == 1 || todo->SelfSenseCxTotalAdjLP == 1) {
+        TPD_DEBUG("SS TOTAL CX LP SENSE MIN MAX TEST:\n");
+        if (todo->SelfSenseCxTotalLP == 1) {
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_SENSE_MAP_MIN, &thresholds_min, &trows, &tcolumns); /* load the min thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_SENSE_MAP_MIN failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_SENSE_MAP_MAX, &thresholds_max, &trows, &tcolumns);/* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_SENSE_MAP_MAX failed... ERROR %08X\n",ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapTotal(totCompData.cx_sn, 1, totCompData.header.sense_node, thresholds_min, thresholds_max); /* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMap SS TOTAL CX LP SENSE failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG("SS TOTAL CX LP SENSE MIN MAX TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX LP SENSE MIN MAX TEST:.................OK\n\n");
+
+            kfree(thresholds_min);
+            thresholds_min = NULL;
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX LP SENSE MIN MAX TEST:.................SKIPPED\n");
+
+
+        /* SS TOTAL IX SENSE ADJH TEST */
+        TPD_DEBUG("SS TOTAL CX LP SENSE ADJ TEST:\n");
+        if (todo->SelfSenseCxTotalAdjLP == 1) {
+            TPD_DEBUG("SS TOTAL CX LP SENSE ADJHORIZ TEST:\n");
+            ret = computeAdjHorizTotal(totCompData.cx_sn, 1, totCompData.header.sense_node, &total_adjhor);
+            if (ret < 0) {
+                TPD_INFO("production_test_data: computeAdjHoriz SS TOTAL CX LP SENSE ADJH failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+            TPD_DEBUG("SS TOTAL CX LP SENSE ADJ HORIZ computed!\n");
+
+
+            ret = parseProductionTestLimits(path_limits, &limit_file, SS_TOTAL_CX_LP_SENSE_ADJH_MAP_MAX, &thresholds_max, &trows, &tcolumns); /* load the max thresholds */
+            if (ret < 0 || (trows != 1 || tcolumns != totCompData.header.sense_node - 1)) {
+                TPD_INFO("production_test_data: parseProductionTestLimits SS_TOTAL_CX_LP_SENSE_ADJH_MAP_MAX failed... ERROR %08X\n", ERROR_PROD_TEST_DATA);
+                ret |= ERROR_PROD_TEST_DATA;
+                goto ERROR_LIMITS;
+            }
+
+            ret = checkLimitsMapAdjTotal(total_adjhor, 1, totCompData.header.sense_node - 1, thresholds_max);/* check the values with thresholds */
+            if (ret != OK) {
+                TPD_INFO("production_test_data: checkLimitsMapAdj SS TOTAL CX LP SENSE ADJH failed... ERROR COUNT = %d\n", ret);
+                TPD_DEBUG(" SS TOTAL CX LP SENSE ADJH TEST:.................FAIL\n\n");
+                count_fail += 1;
+                if (stop_on_fail)
+                    goto ERROR;
+            } else
+                TPD_DEBUG("SS TOTAL CX LP SENSE ADJH TEST:.................OK\n\n");
+
+            kfree(thresholds_max);
+            thresholds_max = NULL;
+            kfree(total_adjhor);
+            total_adjhor = NULL;
+        } else
+            TPD_DEBUG("SS TOTAL CX LP SENSE ADJ TEST:.................SKIPPED\n");
+    } else
+        TPD_DEBUG("SS TOTAL CX LP SENSE TEST:.................SKIPPED\n");
+
+
+
+ERROR:
+
+    if (count_fail == 0) {
+        kfree(ssCompData.ix2_fm);
+        ssCompData.ix2_fm = NULL;
+        kfree(ssCompData.ix2_sn);
+        ssCompData.ix2_sn = NULL;
+        kfree(ssCompData.cx2_fm);
+        ssCompData.cx2_fm = NULL;
+        kfree(ssCompData.cx2_sn);
+        ssCompData.cx2_sn = NULL;
+        kfree(totCompData.ix_fm);
+        totCompData.ix_fm = NULL;
+        kfree(totCompData.ix_sn);
+        totCompData.ix_sn = NULL;
+        kfree(totCompData.cx_fm);
+        totCompData.cx_fm = NULL;
+        kfree(totCompData.cx_sn);
+        totCompData.cx_sn = NULL;
+        TPD_DEBUG("SS LP IX CX  testes finished!.................OK\n\n");
+        return OK;
+    } else {
+    /* print all kind of data in just one row for readability reason */
+        print_frame_u8("SS LP Init Data Ix2_fm = ", array1dTo2d_u8(ssCompData.ix2_fm, ssCompData.header.force_node, 1), ssCompData.header.force_node, 1);
+        print_frame_i8("SS LP Init Data Cx2_fm = ", array1dTo2d_i8(ssCompData.cx2_fm, ssCompData.header.force_node, 1), ssCompData.header.force_node, 1);
+        print_frame_u8("SS LP Init Data Ix2_sn = ", array1dTo2d_u8(ssCompData.ix2_sn, ssCompData.header.sense_node, ssCompData.header.sense_node), 1, ssCompData.header.sense_node);
+        print_frame_i8("SS LP Init Data Cx2_sn = ", array1dTo2d_i8(ssCompData.cx2_sn, ssCompData.header.sense_node, ssCompData.header.sense_node), 1, ssCompData.header.sense_node);
+        print_frame_u16("TOT SS LP Init Data Ix_fm = ", array1dTo2d_u16(totCompData.ix_fm, totCompData.header.force_node, 1), totCompData.header.force_node, 1);
+        print_frame_short("TOT SS LP Init Data Cx_fm = ", array1dTo2d_short(totCompData.cx_fm,totCompData.header.force_node, 1), totCompData.header.force_node, 1);
+        print_frame_u16("TOT SS LP Init Data Ix_sn = ", array1dTo2d_u16(totCompData.ix_sn, totCompData.header.sense_node, totCompData.header.sense_node), 1, totCompData.header.sense_node);
+        print_frame_short("TOT SS LP Init Data Cx_sn = ", array1dTo2d_short(totCompData.cx_sn, totCompData.header.sense_node, totCompData.header.sense_node), 1, totCompData.header.sense_node);
+        TPD_DEBUG("SS LP IX CX testes finished!.................FAILED  fails_count = %d\n\n", count_fail);
+        if (thresholds != NULL)
+            kfree(thresholds);
+        if (thresholds_min != NULL)
+            kfree(thresholds_min);
+        if (thresholds_max != NULL)
+            kfree(thresholds_max);
+        if (adjhor != NULL)
+            kfree(adjhor);
+        if (adjvert != NULL)
+            kfree(adjvert);
+        if (total_adjhor != NULL)
+            kfree(total_adjhor);
+        if (total_adjvert != NULL)
+            kfree(total_adjvert);
+        if (ssCompData.ix2_fm != NULL)
+            kfree(ssCompData.ix2_fm);
+        if (ssCompData.ix2_sn != NULL)
+            kfree(ssCompData.ix2_sn);
+        if (ssCompData.cx2_fm != NULL)
+            kfree(ssCompData.cx2_fm);
+        if (ssCompData.cx2_sn != NULL)
+            kfree(ssCompData.cx2_sn);
+        if (totCompData.ix_fm != NULL)
+            kfree(totCompData.ix_fm);
+        if (totCompData.ix_sn != NULL)
+            kfree(totCompData.ix_sn);
+        if (totCompData.cx_fm != NULL)
+            kfree(totCompData.cx_fm);
+        if (totCompData.cx_sn != NULL)
+            kfree(totCompData.cx_sn);
+        return ERROR_TEST_CHECK_FAIL | ERROR_PROD_TEST_DATA;
+    }
+
+ERROR_LIMITS:
+    if (thresholds != NULL)
+        kfree(thresholds);
+    if (thresholds_min != NULL)
+        kfree(thresholds_min);
+    if (thresholds_max != NULL)
+        kfree(thresholds_max);
+    if (adjhor != NULL)
+        kfree(adjhor);
+    if (adjvert != NULL)
+        kfree(adjvert);
+    if (total_adjhor != NULL)
+        kfree(total_adjhor);
+    if (total_adjvert != NULL)
+        kfree(total_adjvert);
+    if (ssCompData.ix2_fm != NULL)
+        kfree(ssCompData.ix2_fm);
+    if (ssCompData.ix2_sn != NULL)
+        kfree(ssCompData.ix2_sn);
+    if (ssCompData.cx2_fm != NULL)
+        kfree(ssCompData.cx2_fm);
+    if (ssCompData.cx2_sn != NULL)
+        kfree(ssCompData.cx2_sn);
+    if (totCompData.ix_fm != NULL)
+        kfree(totCompData.ix_fm);
+    if (totCompData.ix_sn != NULL)
+        kfree(totCompData.ix_sn);
+    if (totCompData.cx_fm != NULL)
+        kfree(totCompData.cx_fm);
+    if (totCompData.cx_sn != NULL)
+        kfree(totCompData.cx_sn);
+    return ret;
+}
+
+/**
+  * Perform a complete Data Test check of the IC
+  * @param path_limits name of Production Limit file to load or
+  * "NULL" if the limits data should be loaded by a .h file
+  * @param stop_on_fail if 1, the test flow stops at the first data check
+  * failure otherwise it keeps going performing all the selected test
+  * @param todo pointer to a TestToDo variable which select the test to do
+  * @return OK if success or an error code which specify the type of error
+  */
+int production_test_data(char *path_limits, int stop_on_fail, TestToDo *todo)
+{
+    int res = OK, ret;
+
+    if (todo == NULL) {
+        TPD_INFO("production_test_data: No TestToDo specified!! ERROR = %08X\n", (ERROR_OP_NOT_ALLOW | ERROR_PROD_TEST_DATA));
+        return ERROR_OP_NOT_ALLOW | ERROR_PROD_TEST_DATA;
+    }
+
+    TPD_DEBUG("DATA Production test is starting...\n");
+
+    ret = production_test_ms_raw(path_limits, stop_on_fail, todo);
+    res |= ret;
+    if (ret < 0) {
+        TPD_INFO("production_test_data: production_test_ms_raw failed... ERROR = %08X\n", ret);
+        if (stop_on_fail == 1)
+            goto END;
+    }
+
+    ret = production_test_ms_cx(path_limits, stop_on_fail, todo);
+    res |= ret;
+    if (ret < 0) {
+        TPD_INFO("production_test_data: production_test_ms_cx failed... ERROR = %08X\n", ret);
+        if (stop_on_fail == 1)
+            goto END;
+    }
+
+    ret = production_test_ss_raw(path_limits, stop_on_fail, todo);
+    res |= ret;
+    if (ret < 0) {
+        TPD_INFO("production_test_data: production_test_ss_raw failed... ERROR = %08X\n", ret);
+        if (stop_on_fail == 1)
+            goto END;
+    }
+
+    ret = production_test_ss_ix_cx(path_limits, stop_on_fail, todo);
+    res |= ret;
+    if (ret < 0) {
+        TPD_INFO("production_test_data: production_test_ss_ix_cx failed... ERROR = %08X\n", ret);
+        if (stop_on_fail == 1)
+            goto END;
+    }
+
+END:
+    freeLimitsFile(&limit_file);    /* /< release the limit file loaded during the test */
+    if (res < OK)
+        TPD_DEBUG("DATA Production test failed!\n");
+    else
+        TPD_DEBUG("DATA Production test finished!\n");
+    return res;
+}
+
+
+/**
+  * Retrieve the actual Test Limit data from the system (bin file or header
+  *file)
+  * @param path name of Production Test Limit file to load or "NULL" if the
+  *limits data should be loaded by a .h file
+  * @param file pointer to the LimitFile struct which will contains the limits
+  *data
+  * @return OK if success or an error code which specify the type of error
+  *encountered
+  */
+int getLimitsFile(char *path, LimitFile *file)
+{
+    const struct firmware *fw = NULL;
+    struct device *dev = NULL;
+    int fd = -1;
+
+    TPD_DEBUG("Get Limits File starting... %s\n", path);
+
+    if (file->data != NULL) {/* to avoid memory leak on consecutive call of the function with the same pointer */
+        TPD_DEBUG(
+             "Pointer to Limits Data already contains something... freeing its content!\n");
+        kfree(file->data);
+        file->data = NULL;
+        file->size = 0;
+    }
+
+    strlcpy(file->name, path, MAX_LIMIT_FILE_NAME);
+    if (strncmp(path, "NULL", 4) == 0) {
+        return ERROR_FILE_NOT_FOUND;
+    } else {
+        dev = getDev();
+        if (dev != NULL) {
+            TPD_DEBUG("Loading Limits File from .csv!\n");
+            fd = request_firmware(&fw, path, dev);
+            if (fd == 0) {
+                TPD_DEBUG("Start to copy %s...\n",
+                     path);
+                file->size = fw->size;
+                file->data = (char *)kzalloc((file->size) * sizeof(char), GFP_KERNEL);
+                if (file->data != NULL) {
+                    memcpy(file->data, (char *)fw->data, file->size);
+                    TPD_DEBUG("Limit file Size = %d\n", file->size);
+                    release_firmware(fw);
+                    return OK;
+                } else {
+                    TPD_INFO("Error while allocating data... ERROR %08X\n", ERROR_ALLOC);
+                    release_firmware(fw);
+                    return ERROR_ALLOC;
+                }
+            } else {
+                TPD_INFO("Request the file %s failed... ERROR %08X\n", path, ERROR_FILE_NOT_FOUND);
+                return ERROR_FILE_NOT_FOUND;
+            }
+        } else {
+            TPD_INFO("Error while getting the device ERROR %08X\n",
+                 ERROR_FILE_READ);
+            return ERROR_FILE_READ;
+        }
+    }
+}
+
+/**
+  * Reset and release the memory which store a Production Limit File previously
+  *loaded
+  * @param file pointer to the LimitFile struct to free
+  * @return OK if success or an error code which specify the type of error
+  *encountered
+  */
+
+int freeLimitsFile(LimitFile *file)
+{
+    TPD_DEBUG("Freeing Limit File ...\n");
+    if (file != NULL) {
+        if (file->data != NULL) {
+            kfree(file->data);
+            file->data = NULL;
+        } else
+            TPD_DEBUG("Limit File was already freed!\n");
+        file->size = 0;
+        strlcpy(file->name, " ", MAX_LIMIT_FILE_NAME);
+        return OK;
+    } else {
+        TPD_INFO("Passed a NULL argument! ERROR %08X\n", ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
+
+/**
+  * Reset and release the memory which store the current Limit File previously
+  *loaded
+  * @return OK if success or an error code which specify the type of error
+  *encountered
+  */
+
+int freeCurrentLimitsFile(void)
+{
+    return freeLimitsFile(&limit_file);
+}
+
+
+/**
+  * Parse the raw data read from a Production test limit file in order to find
+  *the specified information
+  * If no limits file data are passed, the function loads and stores the limit
+  *file from the system
+  * @param path name of Production Test Limit file to load or "NULL" if the
+  *limits data should be loaded by a .h file
+  * @param file pointer to LimitFile struct that should be parsed or NULL if the
+  *limit file in the system should be loaded and then parsed
+  * @param label string which identify a particular set of data in the file that
+  *want to be loaded
+  * @param data pointer to the pointer which will contains the specified limits
+  *data as 1 dimension matrix with data arranged row after row
+  * @param row pointer to a int variable which will contain the number of row of
+  *data
+  * @param column pointer to a int variable which will contain the number of
+  *column of data
+  * @return OK if success or an error code which specify the type of error
+  */
+int parseProductionTestLimits(char *path, LimitFile *file, char *label, int **data, int *row, int *column)
+{
+    int find = 0;
+    char *token = NULL;
+    int i = 0;
+    int j = 0;
+    int z = 0;
+
+    char *line2 = NULL;
+    char line[800];
+    char *buf = NULL;
+    int n, size, pointer = 0, ret = OK;
+    char *data_file = NULL;
+
+
+    if (file == NULL || strcmp(path, file->name) != 0 || file->size == 0) {
+        TPD_DEBUG("No limit File data passed... try to get them from the system!\n");
+        ret = getLimitsFile(path, &limit_file);
+        if (ret < OK) {
+            TPD_INFO("parseProductionTestLimits: ERROR %08X\n", ERROR_FILE_NOT_FOUND);
+            return ERROR_FILE_NOT_FOUND;
+        }
+        size = limit_file.size;
+        data_file = limit_file.data;
+    } else {
+        TPD_DEBUG("Limit File data passed as arguments!\n");
+        size = file->size;
+        data_file = file->data;
+    }
+
+    TPD_DEBUG("The size of the limits file is %d bytes...\n", size);
+
+    while (find == 0) {
+        /* start to look for the wanted label */
+        if (readLine(&data_file[pointer], line, size - pointer, &n) < 0) {
+            find = -1;
+            break;
+        }
+        pointer += n;
+        if (line[0] == '*') {    /* each header row start with *  ex.* *label,n_row,n_colum */
+            line2 = kstrdup(line, GFP_KERNEL);
+            if (line2 == NULL) {
+                TPD_INFO("parseProductionTestLimits: kstrdup ERROR %08X\n", ERROR_ALLOC);
+                ret = ERROR_ALLOC;
+                goto END;
+            }
+            buf = line2;
+            line2 += 1;
+            token = strsep(&line2, ",");
+            if (strcmp(token, label) == 0) {/* if the row is the wanted one i retrieve rows and columns info */
+                find = 1;
+                token = strsep(&line2, ",");
+                if (token != NULL) {
+                    if (sscanf(token, "%d", row) == 1)
+                        TPD_DEBUG("Row = %d\n", *row);
+                    else {
+                        TPD_DEBUG("ERROR while reading the row value! ERROR %08X\n", ERROR_FILE_PARSE);
+                        ret = ERROR_FILE_PARSE;
+                        goto END;
+                    }
+
+                } else {
+                    TPD_INFO("parseProductionTestLimits 1: ERROR %08X\n", ERROR_FILE_PARSE);
+                    ret = ERROR_FILE_PARSE;
+                    goto END;
+                }
+                token = strsep(&line2, ",");
+                if (token != NULL) {
+                    if (sscanf(token, "%d", column) == 1)
+                        TPD_DEBUG("Column = %d\n", *column);
+                    else {
+                        TPD_DEBUG("ERROR while reading the column value! ERROR %08X\n",ERROR_FILE_PARSE);
+                        ret = ERROR_FILE_PARSE;
+                        goto END;
+                    }
+                } else {
+                    TPD_INFO("parseProductionTestLimits 2: ERROR %08X\n", ERROR_FILE_PARSE);
+                    ret = ERROR_FILE_PARSE;
+                    goto END;
+                }
+
+                kfree(buf);
+                buf = NULL;
+                *data = (int *)kzalloc(((*row) * (*column)) * sizeof(int), GFP_KERNEL);/* allocate the memory for containing the data */
+                j = 0;
+                if (*data == NULL) {
+                    TPD_INFO("parseProductionTestLimits: ERROR %08X\n", ERROR_ALLOC);
+                    ret = ERROR_ALLOC;
+                    goto END;
+                }
+
+                /* start to read the data */
+                for (i = 0; i < *row; i++) {
+                    if (readLine(&data_file[pointer], line, size - pointer, &n) < 0) {
+                        TPD_INFO("parseProductionTestLimits : ERROR %08X\n", ERROR_FILE_READ);
+                        ret = ERROR_FILE_READ;
+                        goto END;
+                    }
+                    pointer += n;
+                    line2 = kstrdup(line, GFP_KERNEL);
+                    if (line2 == NULL) {
+                        TPD_INFO("parseProductionTestLimits: kstrdup ERROR %08X\n", ERROR_ALLOC);
+                        ret = ERROR_ALLOC;
+                        goto END;
+                    }
+                    buf = line2;
+                    token = strsep(&line2, ",");
+                    for (z = 0; (z < *column) && (token != NULL); z++) {
+                        if (sscanf(token, "%d", ((*data) + j)) == 1) {
+                            j++;
+                            token = strsep(&line2, ",");
+                        }
+                    }
+                    kfree(buf);
+                    buf = NULL;
+                }
+                if (j == ((*row) * (*column))) {/* check that all the data are read */
+                    TPD_DEBUG("READ DONE!\n");
+                    ret = OK;
+                    goto END;
+                }
+                TPD_INFO("parseProductionTestLimits 3: ERROR %08X\n", ERROR_FILE_PARSE);
+                ret = ERROR_FILE_PARSE;
+                goto END;
+            }
+            kfree(buf);
+            buf = NULL;
+        }
+    }
+    TPD_INFO("parseProductionTestLimits: ERROR %08X\n", ERROR_LABEL_NOT_FOUND);
+    ret = ERROR_LABEL_NOT_FOUND;
+END:
+    if (buf != NULL)
+        kfree(buf);
+    return ret;
+}
+
+
+/**
+  * Read one line of a text file passed as array of byte and terminate it with a
+  *termination character '\0'
+  * @param data text file as array of bytes
+  * @param line pointer to an array of char that will contain the line read
+  * @param size size of data
+  * @param n pointer to a int variable which will contain the number of
+  *characters of the line
+  * @return OK if success or an error code which specify the type of error
+  */
+int readLine(char *data, char *line, int size, int *n)
+{
+    int i = 0;
+
+    if (size < 1)
+        return ERROR_OP_NOT_ALLOW;
+
+    while (data[i] != '\n' && i < size) {
+        line[i] = data[i];
+        i++;
+    }
+    *n = i + 1;
+    line[i] = '\0';
+
+    return OK;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.h
new file mode 100644
index 0000000000000000000000000000000000000000..ce3c09fdfb78e17aafc3b29e722b3647863d32a7
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTest.h
@@ -0,0 +1,366 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTest.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTest.h
+  * \brief Contains all the definitions and structs related to the Mass
+  *Production Test
+  */
+
+#ifndef FTS_TEST_H
+#define FTS_TEST_H
+
+#include "ftsSoftware.h"
+
+#define WAIT_FOR_FRESH_FRAMES    200    /* /< Time in ms to wait after start to
+                                    * sensing before reading a frame */
+#define WAIT_AFTER_SENSEOFF        50    /* /< Time in ms to wait after stop
+                                    * sensing and before reading a frame
+                                    * from memory */
+
+#define NO_INIT                    0    /* /< No Initialization required during
+                                    * the MP */
+
+#define RETRY_INIT_BOOT            3    /* /< number of retry of the
+                                    * initialization process at boot */
+
+/** @defgroup mp_test Mass Production Test
+  * Mass production test API.
+  * Mass Production Test (MP) should be executed at least one time in the life
+  * of every device \n
+  * It used to verify that tit is not present any hardware damage and
+  * initialize some value of the chip in order to guarantee the working
+  * performance \n
+  * The MP test is made up by 3 steps:
+  * - ITO test = production_test_ito() \n
+  * - Initialization = production_test_initialization() \n
+  * - Data Test = production_test_data(),
+  * it is possible to select which items test thanks to the TestToDo struct\n
+  * To execute the Data Test it is mandatory load some thresholds that
+  * are stored in the Limit File.
+  * @{
+  */
+
+/** @defgroup limit_file Limit File
+  * @ingroup mp_test
+  * Production Test Limit File is a csv which contains thresholds of the data to
+  * test.
+  * This file can be loaded from the file system or stored as a header file
+  * according to the LIMITS_H_FILE define \n
+  * For each selectable test item there can be one or more associated labels
+  * which store the corresponding thresholds \n
+  * @{
+  */
+/* LABELS PRODUCTION TEST LIMITS FILE */
+/** @defgroup test_labels Test Items Labels
+  * @ingroup limit_file
+  * Labels present in the Limit File and associated to the test items of
+  *TestToDo
+  */
+#define MS_RAW_MIN_MAX                    "MS_RAW_DATA_MIN_MAX"
+#define MS_RAW_EACH_NODE_MIN             "MS_RAW_DATA_EACH_MIN"
+#define MS_RAW_EACH_NODE_MAX            "MS_RAW_DATA_EACH_MAX"
+#define MS_RAW_GAP                        "MS_RAW_DATA_GAP"
+#define MS_RAW_ADJH                        "MS_RAW_DATA_ADJ_HORIZONTAL"
+#define MS_RAW_ADJV                        "MS_RAW_DATA_ADJ_VERTICAL"
+#define MS_RAW_ITO_ADJH                    "MS_RAW_ITO_DATA_ADJ_HORIZONTAL"
+#define MS_RAW_ITO_ADJV                    "MS_RAW_ITO_DATA_ADJ_VERTICAL"
+#define MS_RAW_LP_MIN_MAX                "MS_RAW_LOWPOWER_DATA_MIN_MAX"
+#define MS_RAW_LP_EACH_NODE_MIN         "MS_RAW_LOWPOWER_DATA_EACH_MIN"
+#define MS_RAW_LP_EACH_NODE_MAX            "MS_RAW_LOWPOWER_DATA_EACH_MAX"
+#define MS_RAW_LP_GAP                    "MS_RAW_LOWPOWER_DATA_GAP"
+#define MS_RAW_LP_ADJH                    "MS_RAW_LOWPOWER_DATA_ADJ_HORIZONTAL"
+#define MS_RAW_LP_ADJV                    "MS_RAW_LOWPOWER_DATA_ADJ_VERTICAL"
+#define MS_RAW_ADJH_GAP                    "MS_RAW_DATA_ADJ_HORIZONTAL_P2P"
+#define MS_RAW_ADJV_GAP                    "MS_RAW_DATA_ADJ_VERTICAL_P2P"
+#define MS_RAW_ADJ_PEAK                    "MS_RAW_DATA_ADJ_PEAK"
+#define MS_CX1_MIN_MAX                    "MS_TOUCH_ACTIVE_CX1_MIN_MAX"
+#define MS_CX2_MAP_MIN                    "MS_TOUCH_ACTIVE_CX2_MIN"
+#define MS_CX2_MAP_MAX                    "MS_TOUCH_ACTIVE_CX2_MAX"
+#define MS_CX2_ADJH_MAP_MAX                "MS_TOUCH_ACTIVE_CX2_ADJ_HORIZONTAL"
+#define MS_CX2_ADJV_MAP_MAX                "MS_TOUCH_ACTIVE_CX2_ADJ_VERTICAL"
+#define MS_TOTAL_CX_MAP_MIN                "MS_TOUCH_ACTIVE_TOTAL_CX_MIN"
+#define MS_TOTAL_CX_MAP_MAX                "MS_TOUCH_ACTIVE_TOTAL_CX_MAX"
+#define MS_TOTAL_CX_ADJH_MAP_MAX        "MS_TOUCH_ACTIVE_TOTAL_CX_ADJ_HORIZONTAL"
+#define MS_TOTAL_CX_ADJV_MAP_MAX        "MS_TOUCH_ACTIVE_TOTAL_CX_ADJ_VERTICAL"
+#define MS_CX1_LP_MIN_MAX                "MS_TOUCH_LOWPOWER_CX1_MIN_MAX"
+#define MS_CX2_LP_MAP_MIN                "MS_TOUCH_LOWPOWER_CX2_MIN"
+#define MS_CX2_LP_MAP_MAX                "MS_TOUCH_LOWPOWER_CX2_MAX"
+#define MS_CX2_ADJH_LP_MAP_MAX            "MS_TOUCH_LOWPOWER_CX2_ADJ_HORIZONTAL"
+#define MS_CX2_ADJV_LP_MAP_MAX            "MS_TOUCH_LOWPOWER_CX2_ADJ_VERTICAL"
+#define MS_TOTAL_CX_LP_MAP_MIN            "MS_TOUCH_LOWPOWER_TOTAL_CX_MIN"
+#define MS_TOTAL_CX_LP_MAP_MAX            "MS_TOUCH_LOWPOWER_TOTAL_CX_MAX"
+#define MS_TOTAL_CX_ADJH_LP_MAP_MAX     "MS_TOUCH_LOWPOWER_TOTAL_CX_ADJ_HORIZONTAL"
+#define MS_TOTAL_CX_ADJV_LP_MAP_MAX     "MS_TOUCH_LOWPOWER_TOTAL_CX_ADJ_VERTICAL"
+#define SS_RAW_FORCE_MIN_MAX            "SS_RAW_DATA_FORCE_MIN_MAX"
+#define SS_RAW_FORCE_EACH_NODE_MIN      "SS_RAW_DATA_FORCE_EACH_MIN"
+#define SS_RAW_FORCE_EACH_NODE_MAX        "SS_RAW_DATA_FORCE_EACH_MAX"
+#define SS_RAW_SENSE_MIN_MAX            "SS_RAW_DATA_SENSE_MIN_MAX"
+#define SS_RAW_SENSE_EACH_NODE_MIN         "SS_RAW_DATA_SENSE_EACH_MIN"
+#define SS_RAW_SENSE_EACH_NODE_MAX        "SS_RAW_DATA_SENSE_EACH_MAX"
+#define SS_RAW_FORCE_GAP                "SS_RAW_DATA_FORCE_GAP"
+#define SS_RAW_SENSE_GAP                "SS_RAW_DATA_SENSE_GAP"
+#define SS_RAW_LP_FORCE_MIN_MAX            "SS_RAW_LOWPOWER_DATA_FORCE_MIN_MAX"
+#define SS_RAW_LP_SENSE_MIN_MAX            "SS_RAW_LOWPOWER_DATA_SENSE_MIN_MAX"
+#define SS_RAW_LP_FORCE_EACH_NODE_MIN     "SS_RAW_LOWPOWER_DATA_FORCE_EACH_MIN"
+#define SS_RAW_LP_FORCE_EACH_NODE_MAX    "SS_RAW_LOWPOWER_DATA_FORCE_EACH_MAX"
+#define SS_RAW_LP_SENSE_MIN_MAX            "SS_RAW_LOWPOWER_DATA_SENSE_MIN_MAX"
+#define SS_RAW_LP_SENSE_EACH_NODE_MIN     "SS_RAW_LOWPOWER_DATA_SENSE_EACH_MIN"
+#define SS_RAW_LP_SENSE_EACH_NODE_MAX     "SS_RAW_LOWPOWER_DATA_SENSE_EACH_MAX"
+#define SS_RAW_LP_FORCE_GAP                "SS_RAW_LOWPOWER_DATA_FORCE_GAP"
+#define SS_RAW_LP_SENSE_GAP                "SS_RAW_LOWPOWER_DATA_SENSE_GAP"
+#define SS_IX1_FORCE_MIN_MAX            "SS_TOUCH_ACTIVE_IX1_FORCE_MIN_MAX"
+#define SS_IX1_SENSE_MIN_MAX            "SS_TOUCH_ACTIVE_IX1_SENSE_MIN_MAX"
+#define SS_CX1_FORCE_MIN_MAX            "SS_TOUCH_ACTIVE_CX1_FORCE_MIN_MAX"
+#define SS_CX1_SENSE_MIN_MAX            "SS_TOUCH_ACTIVE_CX1_SENSE_MIN_MAX"
+#define SS_IX2_FORCE_MAP_MIN            "SS_TOUCH_ACTIVE_IX2_FORCE_MIN"
+#define SS_IX2_FORCE_MAP_MAX            "SS_TOUCH_ACTIVE_IX2_FORCE_MAX"
+#define SS_IX2_SENSE_MAP_MIN            "SS_TOUCH_ACTIVE_IX2_SENSE_MIN"
+#define SS_IX2_SENSE_MAP_MAX            "SS_TOUCH_ACTIVE_IX2_SENSE_MAX"
+#define SS_IX2_FORCE_ADJV_MAP_MAX        "SS_TOUCH_ACTIVE_IX2_ADJ_VERTICAL"
+#define SS_IX2_SENSE_ADJH_MAP_MAX        "SS_TOUCH_ACTIVE_IX2_ADJ_HORIZONTAL"
+#define SS_CX2_FORCE_MAP_MIN            "SS_TOUCH_ACTIVE_CX2_FORCE_MIN"
+#define SS_CX2_FORCE_MAP_MAX            "SS_TOUCH_ACTIVE_CX2_FORCE_MAX"
+#define SS_CX2_SENSE_MAP_MIN            "SS_TOUCH_ACTIVE_CX2_SENSE_MIN"
+#define SS_CX2_SENSE_MAP_MAX            "SS_TOUCH_ACTIVE_CX2_SENSE_MAX"
+#define SS_CX2_FORCE_ADJV_MAP_MAX        "SS_TOUCH_ACTIVE_CX2_ADJ_VERTICAL"
+#define SS_CX2_SENSE_ADJH_MAP_MAX        "SS_TOUCH_ACTIVE_CX2_ADJ_HORIZONTAL"
+
+/* TOTAL SS */
+#define SS_TOTAL_IX_FORCE_MAP_MIN        "SS_TOUCH_ACTIVE_TOTAL_IX_FORCE_MIN"
+#define SS_TOTAL_IX_FORCE_MAP_MAX        "SS_TOUCH_ACTIVE_TOTAL_IX_FORCE_MAX"
+#define SS_TOTAL_IX_SENSE_MAP_MIN        "SS_TOUCH_ACTIVE_TOTAL_IX_SENSE_MIN"
+#define SS_TOTAL_IX_SENSE_MAP_MAX        "SS_TOUCH_ACTIVE_TOTAL_IX_SENSE_MAX"
+#define SS_TOTAL_IX_FORCE_ADJV_MAP_MAX    "SS_TOUCH_ACTIVE_TOTAL_IX_ADJ_VERTICAL"
+#define SS_TOTAL_IX_SENSE_ADJH_MAP_MAX  "SS_TOUCH_ACTIVE_TOTAL_IX_ADJ_HORIZONTAL"
+#define SS_TOTAL_CX_FORCE_MAP_MIN        "SS_TOUCH_ACTIVE_TOTAL_CX_FORCE_MIN"
+#define SS_TOTAL_CX_FORCE_MAP_MAX        "SS_TOUCH_ACTIVE_TOTAL_CX_FORCE_MAX"
+#define SS_TOTAL_CX_SENSE_MAP_MIN        "SS_TOUCH_ACTIVE_TOTAL_CX_SENSE_MIN"
+#define SS_TOTAL_CX_SENSE_MAP_MAX        "SS_TOUCH_ACTIVE_TOTAL_CX_SENSE_MAX"
+#define SS_TOTAL_CX_FORCE_ADJV_MAP_MAX    "SS_TOUCH_ACTIVE_TOTAL_CX_ADJ_VERTICAL"
+#define SS_TOTAL_CX_SENSE_ADJH_MAP_MAX  "SS_TOUCH_ACTIVE_TOTAL_CX_ADJ_HORIZONTAL"
+
+/* Idle (LP)  version*/
+#define SS_IX1_LP_FORCE_MIN_MAX            "SS_TOUCH_IDLE_IX1_FORCE_MIN_MAX"
+#define SS_IX1_LP_SENSE_MIN_MAX            "SS_TOUCH_IDLE_IX1_SENSE_MIN_MAX"
+#define SS_CX1_LP_FORCE_MIN_MAX            "SS_TOUCH_IDLE_CX1_FORCE_MIN_MAX"
+#define SS_CX1_LP_SENSE_MIN_MAX            "SS_TOUCH_IDLE_CX1_SENSE_MIN_MAX"
+#define SS_IX2_LP_FORCE_MAP_MIN            "SS_TOUCH_IDLE_IX2_FORCE_MIN"
+#define SS_IX2_LP_FORCE_MAP_MAX            "SS_TOUCH_IDLE_IX2_FORCE_MAX"
+#define SS_IX2_LP_SENSE_MAP_MIN            "SS_TOUCH_IDLE_IX2_SENSE_MIN"
+#define SS_IX2_LP_SENSE_MAP_MAX            "SS_TOUCH_IDLE_IX2_SENSE_MAX"
+#define SS_IX2_LP_FORCE_ADJV_MAP_MAX    "SS_TOUCH_IDLE_IX2_ADJ_VERTICAL"
+#define SS_IX2_LP_SENSE_ADJH_MAP_MAX    "SS_TOUCH_IDLE_IX2_ADJ_HORIZONTAL"
+#define SS_CX2_LP_FORCE_MAP_MIN            "SS_TOUCH_IDLE_CX2_FORCE_MIN"
+#define SS_CX2_LP_FORCE_MAP_MAX            "SS_TOUCH_IDLE_CX2_FORCE_MAX"
+#define SS_CX2_LP_SENSE_MAP_MIN            "SS_TOUCH_IDLE_CX2_SENSE_MIN"
+#define SS_CX2_LP_SENSE_MAP_MAX            "SS_TOUCH_IDLE_CX2_SENSE_MAX"
+#define SS_CX2_LP_FORCE_ADJV_MAP_MAX    "SS_TOUCH_IDLE_CX2_ADJ_VERTICAL"
+#define SS_CX2_LP_SENSE_ADJH_MAP_MAX    "SS_TOUCH_IDLE_CX2_ADJ_HORIZONTAL"
+
+
+/* TOTAL SS */
+#define SS_TOTAL_IX_LP_FORCE_MAP_MIN        "SS_TOUCH_IDLE_TOTAL_IX_FORCE_MIN"
+#define SS_TOTAL_IX_LP_FORCE_MAP_MAX        "SS_TOUCH_IDLE_TOTAL_IX_FORCE_MAX"
+#define SS_TOTAL_IX_LP_SENSE_MAP_MIN        "SS_TOUCH_IDLE_TOTAL_IX_SENSE_MIN"
+#define SS_TOTAL_IX_LP_SENSE_MAP_MAX        "SS_TOUCH_IDLE_TOTAL_IX_SENSE_MAX"
+#define SS_TOTAL_IX_LP_FORCE_ADJV_MAP_MAX   "SS_TOUCH_IDLE_TOTAL_IX_ADJ_VERTICAL"
+#define SS_TOTAL_IX_LP_SENSE_ADJH_MAP_MAX   "SS_TOUCH_IDLE_TOTAL_IX_ADJ_HORIZONTAL"
+#define SS_TOTAL_CX_LP_FORCE_MAP_MIN        "SS_TOUCH_IDLE_TOTAL_CX_FORCE_MIN"
+#define SS_TOTAL_CX_LP_FORCE_MAP_MAX        "SS_TOUCH_IDLE_TOTAL_CX_FORCE_MAX"
+#define SS_TOTAL_CX_LP_SENSE_MAP_MIN        "SS_TOUCH_IDLE_TOTAL_CX_SENSE_MIN"
+#define SS_TOTAL_CX_LP_SENSE_MAP_MAX        "SS_TOUCH_IDLE_TOTAL_CX_SENSE_MAX"
+#define SS_TOTAL_CX_LP_FORCE_ADJV_MAP_MAX   "SS_TOUCH_IDLE_TOTAL_CX_ADJ_VERTICAL"
+#define SS_TOTAL_CX_LP_SENSE_ADJH_MAP_MAX   "SS_TOUCH_IDLE_TOTAL_CX_ADJ_HORIZONTAL"
+
+/* KEYS */
+#define MS_KEY_RAW_MIN_MAX            "MS_KEY_RAW_DATA_MIN_MAX"
+#define MS_KEY_CX1_MIN_MAX            "MS_KEY_CX1_MIN_MAX"
+#define MS_KEY_CX2_MAP_MIN            "MS_KEY_CX2_MIN"
+#define MS_KEY_CX2_MAP_MAX            "MS_KEY_CX2_MAX"
+#define MS_KEY_TOTAL_CX_MAP_MIN        "MS_KEY_TOTAL_CX_MIN"
+#define MS_KEY_TOTAL_CX_MAP_MAX        "MS_KEY_TOTAL_CX_MAX"
+
+/* CONSTANT TOTAL IX */
+#define SS_IX1_FORCE_W            "IX1_FORCE_W"
+#define SS_IX2_FORCE_W            "IX2_FORCE_W"
+#define SS_IX1_SENSE_W            "IX1_SENSE_W"
+#define SS_IX2_SENSE_W            "IX2_SENSE_W"
+
+/**
+  * Struct used to specify which test perform during the Mass Production Test.
+  * For each test item selected in this structure, there should be one or
+  * more labels associated in the Limit file from where load the thresholds
+  */
+typedef struct {
+    int MutualRaw;            /* /< MS Raw min/Max test */
+    int MutualRawMap;        /* /< MS Raw min/Max test for each node */
+    int MutualRawGap;        /* /< MS Raw Gap(max-min) test */
+    int MutualRawAdj;        /* /< MS Raw Adjacent test */
+    int MutualRawAdjGap;    /* /< MS Raw Adjacent Gap (max-min) test */
+    int MutualRawAdjPeak;    /* /< MS Raw Adjacent Peak
+                             * max(max(adjv),max(adjh)) test */
+    int MutualRawLP;        /* /< MS Low Power Raw min/Max test */
+    int MutualRawMapLP;        /* /< MS Low Power Raw min/Max test
+                             * for each node */
+    int MutualRawGapLP;        /* /< MS Low Power Raw Gap(max-min) test */
+    int MutualRawAdjLP;        /* /< MS Low Power Raw Adjacent test */
+    int MutualRawAdjITO;    /* /< MS Raw Adjacent test during ITO test */
+
+    int MutualCx1;            /* /< MS Cx1 min/Max test */
+    int MutualCx2;            /* /< MS Cx2 min/Max (for each node) test */
+    int MutualCx2Adj;        /* /< MS Vertical and Horizontal Adj Cx2 min/Max
+                             * (for each node) test */
+    int MutualCxTotal;        /* /< MS Total Cx min/Max (for each node) test */
+    int MutualCxTotalAdj;    /* /< MS Total vertical and Horizontal Adj Cx2
+                             * min/Max (for each node) test */
+
+    int MutualCx1LP;        /* /< MS LowPower Cx1 min/Max test */
+    int MutualCx2LP;        /* /< MS LowPower Cx2 min/Max (for each node) test */
+    int MutualCx2AdjLP;        /* /< MS LowPower Vertical and Horizontal Adj Cx2 min/Max
+                             * (for each node) test */
+    int MutualCxTotalLP;    /* /< MS Total LowPower Cx min/Max (for each node) test */
+    int MutualCxTotalAdjLP;    /* /< MS Total LowPower vertical and Horizontal Adj Cx2
+                             * min/Max (for each node) test */
+
+    int MutualKeyRaw;        /* /< MS Raw Key min/Max test */
+    int MutualKeyCx1;        /* /< MS Cx1 Key min/Max test */
+    int MutualKeyCx2;        /* /< MS Cx2 Key min/Max (for each node) test */
+    int MutualKeyCxTotal;    /* /< MS Total Cx Key min/Max (for each node) test */
+
+    int SelfForceRaw;        /* /< SS Force Raw min/Max test */
+    int SelfForceRawGap;    /* /< SS Force Raw Gap(max-min) test */
+    int SelfForceRawMap;    /* /< SS Force Raw min/Max Map test */
+    int SelfForceRawLP;        /* /< SS Low Power Force Raw min/Max test */
+    int SelfForceRawGapLP;    /* /< SS Low Power Force Raw Gap(max-min)test */
+    int SelfForceRawMapLP;    /* /< SS Low Power Force Raw min/Max Map test */
+
+    int SelfForceIx1;            /* /< SS Force Ix1 min/Max test */
+    int SelfForceIx2;            /* /< SS Force Ix2 min/Max (for each node) test */
+    int SelfForceIx2Adj;        /* /< SS Vertical Adj Force Ix2 min/Max (for each node) test */
+    int SelfForceIxTotal;        /* /< SS Total Force Ix min/Max (for each node) test */
+    int SelfForceIxTotalAdj;    /* /< SS Total Vertical Adj Force Ix min/Max (for each node) test */
+    int SelfForceCx1;            /* /< SS Force Cx1 min/Max test */
+    int SelfForceCx2;           /* /< SS Force Cx2 min/Max (for each node) test */
+    int SelfForceCx2Adj;        /* /< SS Vertical Adj Force Cx2 min/Max (for each node) test */
+    int SelfForceCxTotal;        /* /< SS Total Force Cx min/Max (for each node) test */
+    int SelfForceCxTotalAdj;    /* /< SS Total Vertical Adj Force Cx min/Max (for each node) test */
+
+    int SelfForceIx1LP;            /* /< SS LP Force Ix1 min/Max test */
+    int SelfForceIx2LP;            /* /< SS LP Force Ix2 min/Max (for each node) test */
+    int SelfForceIx2AdjLP;        /* /< SS LP Vertical Adj Force Ix2 min/Max (for each node) test */
+    int SelfForceIxTotalLP;        /* /< SS LP Total Force Ix min/Max (for each node) test */
+    int SelfForceIxTotalAdjLP;    /* /< SS LP Total Vertical Adj Force Ix min/Max (for each node) test */
+    int SelfForceCx1LP;            /* /< SS LP Force Cx1 min/Max test */
+    int SelfForceCx2LP;         /* /< SS LP Force Cx2 min/Max (for each node) test */
+    int SelfForceCx2AdjLP;        /* /< SS LP Vertical Adj Force Cx2 min/Max (for each node) test */
+    int SelfForceCxTotalLP;        /* /< SS LP Total Force Cx min/Max (for each node) test */
+    int SelfForceCxTotalAdjLP;    /* /< SS LP Total Vertical Adj Force Cx min/Max (for each node) test */
+
+    int SelfSenseRaw;        /* /< SS Sense Raw min/Max test */
+    int SelfSenseRawGap;    /* /< SS Sense Raw Gap(max-min) test */
+    int SelfSenseRawMap;    /* /< SS Sense Raw min/Max test for each node */
+    int SelfSenseRawLP;        /* /< SS Low Power Sense Raw min/Max test */
+    int SelfSenseRawGapLP;  /* /< SS Low Power Sense Raw Gap(max-min) test */
+    int SelfSenseRawMapLP;    /* /< SS Low Power Sense Raw min/Max test for each node */
+
+    int SelfSenseIx1;            /* /< SS Sense Ix1 min/Max test */
+    int SelfSenseIx2;           /* /< SS Sense Ix2 min/Max (for each node) test */
+    int SelfSenseIx2Adj;        /* /< SS Horizontal Adj Sense Ix2 min/Max (for each node) test */
+    int SelfSenseIxTotal;        /* /< SS Total Horizontal Sense Ix min/Max (for each node) test */
+    int SelfSenseIxTotalAdj;    /* /< SS Total Horizontal Adj Sense Ix min/Max (for each node) test */
+    int SelfSenseCx1;            /* /< SS Sense Cx1 min/Max test */
+    int SelfSenseCx2;           /* /< SS Sense Cx2 min/Max (for each node) test */
+    int SelfSenseCx2Adj;        /* /< SS Horizontal Adj Sense Cx2 min/Max (for each node) test */
+    int SelfSenseCxTotal;        /* /< SS Total Sense Cx min/Max (for each node) test */
+    int SelfSenseCxTotalAdj;    /* /< SS Total Horizontal Adj Sense Cx min/Max (for each node) test */
+
+    int SelfSenseIx1LP;            /* /< SS LP Sense Ix1 min/Max test */
+    int SelfSenseIx2LP;         /* /< SS LP Sense Ix2 min/Max (for each node) test */
+    int SelfSenseIx2AdjLP;        /* /< SS LP Horizontal Adj Sense Ix2 min/Max (for each node) test */
+    int SelfSenseIxTotalLP;        /* /< SS LP Total Horizontal Sense Ix min/Max (for each node) test */
+    int SelfSenseIxTotalAdjLP;  /* /< SS LP Total Horizontal Adj Sense Ix min/Max (for each node) test */
+    int SelfSenseCx1LP;            /* /< SS LP Sense Cx1 min/Max test */
+    int SelfSenseCx2LP;         /* /< SS LP Sense Cx2 min/Max (for each node) test */
+    int SelfSenseCx2AdjLP;        /* /< SS LP Horizontal Adj Sense Cx2 min/Max (for each node) test */
+    int SelfSenseCxTotalLP;        /* /< SS LP Total Sense Cx min/Max (for each node) test */
+    int SelfSenseCxTotalAdjLP;  /* /< SS LP Total Horizontal Adj Sense Cx min/Max (for each node) test */
+} TestToDo;
+
+
+#define MAX_LIMIT_FILE_NAME 100    /* /< max number of chars of the limit file name**/
+
+/**
+  * Struct which store the data coming from a Production Limit File
+  */
+typedef struct {
+    char    *data;    /* /< pointer to an array of char which contains
+                     * the content of the Production Limit File */
+    int     size;    /* /< size of data */
+    char    name[MAX_LIMIT_FILE_NAME];    /* /< identifier of the source from
+                                         * where the limits data were loaded (if
+                                         * loaded from a file it will be the
+                                         * file name, while if loaded from .h
+                                         * will be "NULL") */
+} LimitFile;
+
+int initTestToDo(void);
+int computeAdjHoriz(i8 *data, int row, int column, u8 **result);
+int computeAdjHorizTotal(short *data, int row, int column, u16 **result);
+int computeAdjVert(i8 *data, int row, int column, u8 **result);
+int computeAdjVertTotal(short *data, int row, int column, u16 **result);
+int computeAdjHorizFromU(u8 *data, int row, int column, u8 **result);
+int computeAdjHorizTotalFromU(u16 *data, int row, int column, u16 **result);
+int computeAdjVertFromU(u8 *data, int row, int column, u8 **result);
+int computeAdjVertTotalFromU(u16 *data, int row, int column, u16 **result);
+int checkLimitsMinMax(short *data, int row, int column, int min, int max);
+int checkLimitsMap(i8 *data, int row, int column, int *min, int *max);
+int checkLimitsMapTotal(short *data, int row, int column, int *min, int *max);
+int checkLimitsMapFromU(u8 *data, int row, int column, int *min, int *max);
+int checkLimitsMapTotalFromU(u16 *data, int row, int column, int *min,int *max);
+int checkLimitsMapAdj(u8 *data, int row, int column, int *max);
+int checkLimitsMapAdjTotal(u16 *data, int row, int column, int *max);
+int checkLimitsGap(short *data, int row, int column, int threshold);
+int checkLimitsGapOffsets(short *data, int row, int column, int threshold,
+        int row_start, int column_start, int row_end, int column_end);
+
+/**  @defgroup mp_api MP API
+  * @ingroup mp_test
+  * Functions to execute the MP test.
+  * The parameters of these functions allow to customize their behavior
+  * in order to satisfy different scenarios
+  */
+int production_test_ito(char *path_limits, TestToDo *todo);
+int production_test_initialization(u8 type);
+int production_test_main(char *pathThresholds, int stop_on_fail, int saveInit, TestToDo *todo, u8 mpflag);
+int production_test_ms_raw(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ms_raw_lp(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ms_cx(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ms_cx_lp(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ss_raw(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ss_raw_lp(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ss_ix_cx(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ss_ix_cx_lp(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_data(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ms_key_cx(char *path_limits, int stop_on_fail, TestToDo *todo);
+int production_test_ms_key_raw(char *path_limits);
+
+/**
+  * @addtogroup limit_file
+  */
+int parseProductionTestLimits(char *path, LimitFile *file, char *label, int **data, int *row, int *column);
+int readLine(char *data, char *line, int size, int *n);
+int getLimitsFile(char *path, LimitFile *file);
+int freeLimitsFile(LimitFile *file);
+int freeCurrentLimitsFile(void);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.c
new file mode 100644
index 0000000000000000000000000000000000000000..b120b8dfa6e07608cde43c374ceab2bbe27619a7
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.c
@@ -0,0 +1,101 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTime.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTime.c
+  * \brief Contains all functions to handle and measure the time in the driver
+  */
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+
+#include "ftsTime.h"
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+/**
+  * Take the starting time and save it in a StopWatch variable
+  * @param w pointer of a StopWatch struct
+  */
+void startStopWatch(StopWatch *w)
+{
+    w->start = current_kernel_time();
+}
+
+/**
+  * Take the stop time and save it in a StopWatch variable
+  * @param w pointer of a StopWatch struct
+  */
+void stopStopWatch(StopWatch *w)
+{
+    w->end = current_kernel_time();
+}
+
+/**
+  * Compute the amount of time spent from when the startStopWatch and then
+  * the stopStopWatch were called on the StopWatch variable
+  * @param w pointer of a StopWatch struct
+  * @return amount of time in ms (the return value is meaningless
+  * if the startStopWatch and stopStopWatch were not called before)
+  */
+int elapsedMillisecond(StopWatch *w)
+{
+    int result;
+
+    result = ((w->end.tv_sec - w->start.tv_sec) * 1000) + (w->end.tv_nsec - w->start.tv_nsec) / 1000000;
+    return result;
+}
+
+/**
+  * Compute the amount of time spent from when the startStopWatch and
+  * then the stopStopWatch were called on the StopWatch variable
+  * @param w pointer of a StopWatch struct
+  * @return amount of time in ns (the return value is meaningless
+  * if the startStopWatch and stopStopWatch were not called before)
+  */
+int elapsedNanosecond(StopWatch *w)
+{
+    int result;
+
+    result = ((w->end.tv_sec - w->start.tv_sec) * 1000000000) + (w->end.tv_nsec - w->start.tv_nsec);
+    return result;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.h
new file mode 100644
index 0000000000000000000000000000000000000000..46e038b14bce476681c4964fe55c355a06b9b664
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTime.h
@@ -0,0 +1,53 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTime.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTime.h
+  * \brief Contains all the definitions and structs to handle and measure the
+  * time in the driver
+  */
+
+#ifndef FTS_TIME_H
+#define FTS_TIME_H
+
+
+#include <linux/time.h>
+
+/* TIMEOUT */
+/** @defgroup timeouts     Timeouts
+  * Definitions of all the Timeout used in several operations
+  */
+#define TIMEOUT_RESOLUTION                 2                            /* /< timeout resolution in ms (all timeout should be multiples of this unit) */
+#define GENERAL_TIMEOUT                   (50 * TIMEOUT_RESOLUTION)     /* /< general timeout in ms */
+#define RELEASE_INFO_TIMEOUT              (15 * TIMEOUT_RESOLUTION)     /* /< timeout to request release info in ms */
+
+#define TIMEOUT_REQU_COMP_DATA            (100 * TIMEOUT_RESOLUTION)    /* /< timeout to request compensation data in ms */
+#define TIMEOUT_REQU_DATA                 (200 * TIMEOUT_RESOLUTION)    /* /< timeout to request data in ms */
+#define TIMEOUT_ITO_TEST_RESULT           (100 * TIMEOUT_RESOLUTION)    /* /< timeout to perform ito test in ms */
+#define TIMEOUT_INITIALIZATION_TEST_RESULT    (5000 * TIMEOUT_RESOLUTION)     /* /< timeout to perform initialization test in ms */
+#define TIEMOUT_ECHO                      (500 * TIMEOUT_RESOLUTION)   /* /< timeout of the echo command, should be the max of
+                                                                               * all the possible commands (used in worst case) */
+
+/**
+  * Struct used to measure the time elapsed between a starting and ending point.
+  */
+typedef struct {
+    struct timespec start;      /* /< store the starting time */
+    struct timespec end;        /* /< store the finishing time */
+} StopWatch;
+
+void startStopWatch(StopWatch *w);
+void stopStopWatch(StopWatch *w);
+int elapsedMillisecond(StopWatch *w);
+int elapsedNanosecond(StopWatch *w);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.c
new file mode 100644
index 0000000000000000000000000000000000000000..bab984f0b0c0ff0a652214f8484add27b6f4d160
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.c
@@ -0,0 +1,698 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTool.c
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTool.c
+  * \brief Contains all the functions to support common operation inside the
+  *driver
+  */
+
+#include "ftsCompensation.h"
+#include "ftsCore.h"
+#include "ftsError.h"
+#include "ftsHardware.h"
+#include "ftsIO.h"
+#include "ftsSoftware.h"
+#include "ftsTime.h"
+#include "ftsTool.h"
+
+#include <linux/errno.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <stdarg.h>
+#include <linux/serio.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+
+#include "../../../touchpanel_common.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "fts-lib"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+/**
+  * Print an array of byte in a HEX string and attach at the beginning a label.
+  * The function allocate memory that should be free outside the function itself
+  * @param label string to attach at the beginning
+  * @param buff pointer to the byte array that should be printed as HEX string
+  * @param count size of buff
+  * @param result pointer to the array of characters that compose the HEX final
+  * string
+  * @return pointer to the array of characters that compose the HEX string,
+  * (same address of result)
+  * @warning result MUST be allocated outside the function and should be
+  * big enough to contain the data converted as HEX!
+  */
+char *printHex(char *label, u8 *buff, int count, u8 *result)
+{
+    int i, offset;
+
+    offset = strlen(label);
+    strlcpy(result, label, offset+1); /* +1 for terminator char */
+
+    for (i = 0; i < count; i++) {
+        snprintf(&result[offset], 4, "%02X ", buff[i]);
+        /* this append automatically a null terminator char */
+        offset += 3;
+    }
+    return result;
+}
+
+/**
+  * Clear the FIFO from any event
+  * @return OK if success or an error code which specify the type of error
+  */
+int flushFIFO(void)
+{
+    int ret;
+    u8 sett = SPECIAL_FIFO_FLUSH;
+
+    ret = writeSysCmd(SYS_CMD_SPECIAL, &sett, 1);    /* flush the FIFO */
+    if (ret < OK) {
+        TPD_INFO("flushFIFO: ERROR %08X\n", ret);
+        return ret;
+    }
+
+    TPD_DEBUG("FIFO flushed!\n");
+    return OK;
+}
+
+/**
+  * Convert an array of bytes to an array of u16 taking two bytes at time,
+  * src has LSB first.
+  * @param src pointer to the source byte array
+  * @param src_length size of src
+  * @param dst pointer to the destination array.
+  * @return the final size of dst (half of the source) or ERROR_OP_NOT_ALLOW
+  * if the size of src is not multiple of 2.
+  */
+int u8ToU16n(u8 *src, int src_length, u16 *dst)
+{
+    int i, j;
+
+    if (src_length % 2 != 0)
+        return ERROR_OP_NOT_ALLOW;
+    else {
+        j = 0;
+        dst = (u16 *)kzalloc((src_length / 2) * sizeof(u16), GFP_KERNEL);
+        for (i = 0; i < src_length; i += 2) {
+            dst[j] = ((src[i + 1] & 0x00FF) << 8) + (src[i] & 0x00FF);
+            j++;
+        }
+    }
+	kfree(dst);
+    return src_length / 2;
+}
+
+/**
+  * Convert an array of 2 bytes to a u16, src has LSB first (little endian).
+  * @param src pointer to the source byte array
+  * @param dst pointer to the destination u16.
+  * @return OK
+  */
+int u8ToU16(u8 *src, u16 *dst)
+{
+    *dst = (u16)(((src[1] & 0x00FF) << 8) + (src[0] & 0x00FF));
+    return OK;
+}
+
+/**
+  * Convert an array of 2 bytes to a u16, src has MSB first (big endian).
+  * @param src pointer to the source byte array
+  * @param dst pointer to the destination u16.
+  * @return OK
+  */
+int u8ToU16_be(u8 *src, u16 *dst)
+{
+    *dst = (u16)(((src[0] & 0x00FF) << 8) + (src[1] & 0x00FF));
+    return OK;
+}
+
+/**
+  * Convert an array of u16 to an array of u8, dst has MSB first (big endian).
+  * @param src pointer to the source array of u16
+  * @param src_length size of src
+  * @param dst pointer to the destination array of u8. This array should be free
+  * when no need anymore
+  * @return size of dst (src size multiply by 2)
+  */
+int u16ToU8n_be(u16 *src, int src_length, u8 *dst)
+{
+    int i, j;
+
+    dst = (u8 *)kzalloc((2 * src_length) * sizeof(u8), GFP_KERNEL);
+    j = 0;
+    for (i = 0; i < src_length; i++) {
+        dst[j] = (u8)(src[i] & 0xFF00) >> 8;
+        dst[j + 1] = (u8)(src[i] & 0x00FF);
+        j += 2;
+    }
+	kfree(dst);
+    return src_length * 2;
+}
+
+/**
+  * Convert a u16 to an array of 2 u8, dst has MSB first (big endian).
+  * @param src u16 to convert
+  * @param dst pointer to the destination array of 2 u8.
+  * @return OK
+  */
+int u16ToU8_be(u16 src, u8 *dst)
+{
+    dst[0] = (u8)((src & 0xFF00) >> 8);
+    dst[1] = (u8)(src & 0x00FF);
+    return OK;
+}
+
+/**
+  * Convert a u16 to an array of 2 u8, dst has LSB first (little endian).
+  * @param src u16 to convert
+  * @param dst pointer to the destination array of 2 u8.
+  * @return OK
+  */
+int u16ToU8(u16 src, u8 *dst)
+{
+    dst[1] = (u8)((src & 0xFF00) >> 8);
+    dst[0] = (u8)(src & 0x00FF);
+    return OK;
+}
+
+/**
+  * Convert an array of bytes to a u32, src has LSB first (little endian).
+  * @param src array of bytes to convert
+  * @param dst pointer to the destination u32 variable.
+  * @return OK
+  */
+int u8ToU32(u8 *src, u32 *dst)
+{
+    *dst = (u32)(((src[3] & 0xFF) << 24) + ((src[2] & 0xFF) << 16) + ((src[1] & 0xFF) << 8) + (src[0] & 0xFF));
+    return OK;
+}
+
+/**
+  * Convert an array of bytes to a u32, src has MSB first (big endian).
+  * @param src array of bytes to convert
+  * @param dst pointer to the destination u32 variable.
+  * @return OK
+  */
+int u8ToU32_be(u8 *src, u32 *dst)
+{
+    *dst = (u32)(((src[0] & 0xFF) << 24) + ((src[1] & 0xFF) << 16) + ((src[2] & 0xFF) << 8) + (src[3] & 0xFF));
+    return OK;
+}
+
+
+/**
+  * Convert a u32 to an array of 4 bytes, dst has LSB first (little endian).
+  * @param src u32 value to convert
+  * @param dst pointer to the destination array of 4 bytes.
+  * @return OK
+  */
+int u32ToU8(u32 src, u8 *dst)
+{
+    dst[3] = (u8)((src & 0xFF000000) >> 24);
+    dst[2] = (u8)((src & 0x00FF0000) >> 16);
+    dst[1] = (u8)((src & 0x0000FF00) >> 8);
+    dst[0] = (u8)(src & 0x000000FF);
+    return OK;
+}
+
+/**
+  * Convert a u32 to an array of 4 bytes, dst has MSB first (big endian).
+  * @param src u32 value to convert
+  * @param dst pointer to the destination array of 4 bytes.
+  * @return OK
+  */
+int u32ToU8_be(u32 src, u8 *dst)
+{
+    dst[0] = (u8)((src & 0xFF000000) >> 24);
+    dst[1] = (u8)((src & 0x00FF0000) >> 16);
+    dst[2] = (u8)((src & 0x0000FF00) >> 8);
+    dst[3] = (u8)(src & 0x000000FF);
+    return OK;
+}
+
+/**
+  * Execute a function passed as argment and retry it defined number of times if
+  *not successfull
+  * @param code pointer to a function which return an int and doesn't have any
+  *parameters
+  * @param wait_before_retry interval of time in ms to wait between one trial
+  *and another one
+  * @param retry_count max number of retry to attemp
+  * @return last return value obtained from the last execution of the code
+  *function
+  */
+int attempt_function(int (*code)(void), unsigned long wait_before_retry, int
+             retry_count)
+{
+    int result;
+    int count = 0;
+
+    do {
+        result = code();
+        count++;
+        msleep(wait_before_retry);
+    } while (count < retry_count && result < 0);
+
+
+    if (count == retry_count)
+        return result | ERROR_TIMEOUT;
+    else
+        return result;
+}
+
+/**
+  * Enable all the possible sensing mode supported by the FW
+  * @return OK if success or an error code which specify the type of error
+  */
+int senseOn(void)
+{
+    int ret;
+
+    ret = setScanMode(SCAN_MODE_ACTIVE, 0xFF);    /* enable all */
+    if (ret < OK) {
+        TPD_INFO("senseOn: ERROR %08X\n", ret);
+        return ret;
+    }
+
+    TPD_DEBUG("senseOn: SENSE ON\n");
+    return OK;
+}
+
+/**
+  * Disable  all the sensing mode
+  * @return  OK if success or an error code which specify the type of error
+  */
+int senseOff(void)
+{
+    int ret;
+
+    ret = setScanMode(SCAN_MODE_ACTIVE, 0x00);
+    if (ret < OK) {
+        TPD_INFO("senseOff: ERROR %08X\n", ret);
+        return ret;
+    }
+
+    TPD_DEBUG("senseOff: SENSE OFF\n");
+    return OK;
+}
+
+/**
+  * Clean up the IC status executing a system reset and giving
+  * the possibility to re-enabling the sensing
+  * @param enableTouch if 1, re-enable the sensing and the interrupt of the IC
+  * @return OK if success or an error code which specify the type of error
+  */
+int cleanUp(int enableTouch)
+{
+    int res;
+
+    TPD_DEBUG("cleanUp: system reset...\n");
+    res = fts_system_reset();
+    if (res < OK)
+        return res;
+    if (enableTouch) {
+        TPD_DEBUG("cleanUp: enabling touches...\n");
+        res = senseOn();    /* already enable everything */
+        if (res < OK)
+            return res;
+        TPD_DEBUG("cleanUp: enabling interrupts...\n");
+        res = fts_enableInterrupt();
+        if (res < OK)
+            return res;
+    }
+    return OK;
+}
+
+/**
+  * Transform an array of short in a matrix of short with a defined number of
+  * columns and the resulting number of rows
+  * @param data array of bytes to convert
+  * @param size size of data
+  * @param columns number of columns that the resulting matrix should have.
+  * @return a reference to a matrix of short where for each row there are
+  * columns elements
+  * @warning If size = 0 it will be allocated a matrix 1*1 wich still should
+  * be free
+  */
+short **array1dTo2d_short(short *data, int size, int columns)
+{
+    int i;
+    short **matrix = NULL;
+    if (size == 0) {
+        matrix = (short **)kzalloc(1 * sizeof(short *), GFP_KERNEL);
+        matrix[0] = (short *)kzalloc(0 * sizeof(short), GFP_KERNEL);
+    } else {
+        matrix = (short **)kzalloc(((int)(size / columns)) * sizeof(short *), GFP_KERNEL);
+
+        if (matrix != NULL) {
+            for (i = 0; i < (int)(size / columns); i++)
+                matrix[i] = (short *)kzalloc(columns * sizeof(short), GFP_KERNEL);
+
+            for (i = 0; i < size; i++)
+                matrix[i / columns][i % columns] = data[i];
+        }
+    }
+
+    return matrix;
+}
+
+/**
+  * Transform an array of u16 in a matrix of u16 with a defined number of
+  * columns and the resulting number of rows
+  * @param data array of bytes to convert
+  * @param size size of data
+  * @param columns number of columns that the resulting matrix should have.
+  * @return a reference to a matrix of u16 where for each row there are columns
+  * elements
+  * @warning If size = 0 it will be allocated a matrix 1*1 wich still should
+  * be free
+  */
+u16 **array1dTo2d_u16(u16 *data, int size, int columns)
+{
+    int i;
+    u16 **matrix = NULL;
+
+
+    if (size == 0) {
+        matrix = (u16 **)kzalloc(1 * sizeof(u16 *), GFP_KERNEL);
+        matrix[0] = (u16 *)kzalloc(0 * sizeof(u16), GFP_KERNEL);
+    } else {
+        matrix = (u16 **)kzalloc(((int)(size / columns)) * sizeof(u16 *), GFP_KERNEL);
+
+        if (matrix != NULL) {
+            for (i = 0; i < (int)(size / columns); i++)
+                matrix[i] = (u16 *)kzalloc(columns * sizeof(u16), GFP_KERNEL);
+
+            for (i = 0; i < size; i++)
+                matrix[i / columns][i % columns] = data[i];
+        }
+    }
+
+    return matrix;
+}
+
+/**
+  * Transform an array of u8 in a matrix of u8 with a defined number of
+  * columns and the resulting number of rows
+  * @param data array of bytes to convert
+  * @param size size of data
+  * @param columns number of columns that the resulting matrix should have.
+  * @return a reference to a matrix of short where for each row there are
+  * columns elements
+  * @warning If size = 0 it will be allocated a matrix 1*1 wich still should
+  * be free
+  */
+u8 **array1dTo2d_u8(u8 *data, int size, int columns)
+{
+    int i;
+    u8 **matrix = NULL;
+
+
+    if (size == 0) {
+        matrix = (u8 **)kzalloc(1 * sizeof(u8 *), GFP_KERNEL);
+        matrix[0] = (u8 *)kzalloc(0 * sizeof(u8), GFP_KERNEL);
+    } else {
+        matrix = (u8 **)kzalloc(((int)(size / columns)) * sizeof(u8 *), GFP_KERNEL);
+        if (matrix != NULL) {
+            for (i = 0; i < (int)(size / columns); i++)
+                matrix[i] = (u8 *)kzalloc(columns * sizeof(u8), GFP_KERNEL);
+
+            for (i = 0; i < size; i++)
+                matrix[i / columns][i % columns] = data[i];
+        }
+    }
+
+    return matrix;
+}
+
+/**
+  * Transform an array of i8 in a matrix of i8 with a defined number of
+  * columns and the resulting number of rows
+  * @param data array of bytes to convert
+  * @param size size of data
+  * @param columns number of columns that the resulting matrix should have.
+  * @return a reference to a matrix of short where for each row there are
+  * columns elements
+  * @warning If size = 0 it will be allocated a matrix 1*1 wich still should
+  * be free
+  */
+i8 **array1dTo2d_i8(i8 *data, int size, int columns)
+{
+    int i;
+    i8 **matrix = NULL;
+
+    if (size == 0) {
+        matrix = (i8 **)kzalloc(1 * sizeof(i8 *), GFP_KERNEL);
+        matrix[0] = (i8 *)kzalloc(0 * sizeof(i8), GFP_KERNEL);
+    } else {
+        matrix = (i8 **)kzalloc(((int)(size / columns)) * sizeof(i8 *), GFP_KERNEL);
+
+        if (matrix != NULL) {
+            for (i = 0; i < (int)(size / columns); i++)
+                matrix[i] = (i8 *)kzalloc(columns * sizeof(i8), GFP_KERNEL);
+
+            for (i = 0; i < size; i++)
+                matrix[i / columns][i % columns] = data[i];
+        }
+    }
+
+    return matrix;
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of short row x columns
+  * and free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of short which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_short(char *label, short **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of u16 row x columns
+  * and free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of u16 which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_u16(char *label, u16 **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of u8 row x columns and
+  * free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of u8 which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_u8(char *label, u8 **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of i8 row x columns and
+  * free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of u8 which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_i8(char *label, i8 **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of u32 row x columns
+  * and free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of u32 which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_u32(char *label, u32 **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Print in the kernel log a label followed by a matrix of int row x columns
+  * and free its memory
+  * @param label pointer to the string to print before the actual matrix
+  * @param matrix reference to the matrix of int which contain the actual data
+  * @param row number of rows on which the matrix should be print
+  * @param column number of columns for each row
+  */
+void print_frame_int(char *label, int **matrix, int row, int column)
+{
+    int i, j;
+
+    TPD_DEBUG("%s\n", label);
+    for (i = 0; i < row; i++) {
+        TPD_DEBUG("");
+        for (j = 0; j < column; j++)
+            printk("%d ", matrix[i][j]);
+        TPD_DEBUG( "\n");
+        kfree(matrix[i]);
+    }
+    kfree(matrix);
+}
+
+/**
+  * Convert an array of bytes to an u64, src has MSB first (big endian).
+  * @param src array of bytes
+  * @param dest pointer to the destination u64.
+  * @param size size of src (can be <= 8)
+  * @return OK if success or ERROR_OP_NOT_ALLOW if size exceed 8
+  */
+int u8ToU64_be(u8 *src, u64 *dest, int size)
+{
+    int i = 0;
+
+    /* u64 temp =0; */
+    if (size > sizeof(u64))
+        return ERROR_OP_NOT_ALLOW;
+    else {
+        *dest = 0;
+
+        for (i = 0; i < size; i++)
+            *dest |= (u64)(src[i]) << ((size - 1 - i) * 8);
+
+        return OK;
+    }
+}
+
+/**
+  * Convert an u64 to an array of bytes, dest has MSB first (big endian).
+  * @param src value of u64
+  * @param dest pointer to the destination array of bytes.
+  * @param size size of src (can be <= 8)
+  * @return OK if success or ERROR_OP_NOT_ALLOW if size exceed 8
+  */
+int u64ToU8_be(u64 src, u8 *dest, int size)
+{
+    int i = 0;
+
+    if (size > sizeof(u64))
+        return ERROR_OP_NOT_ALLOW;
+    else
+        for (i = 0; i < size; i++)
+            dest[i] = (u8)((src >> ((size - 1 - i) * 8)) & 0xFF);
+
+    return OK;
+}
+
+/**
+  * Convert a value of an id in a bitmask with a 1 in the position of the value
+  * of the id
+  * @param id Value of the ID to convert
+  * @param mask pointer to the bitmask that will be updated with the value of id
+  * @param size dimension in bytes of mask
+  * @return OK if success or ERROR_OP_NOT_ALLOW if size of mask is not enough to
+  * contain ID
+  */
+int fromIDtoMask(u8 id, u8 *mask, int size)
+{
+    if (((int)((id) / 8)) < size) {
+        TPD_DEBUG("%s: ID = %d Index = %d Position = %d !\n", __func__, id, ((int)((id) / 8)), (id % 8));
+        mask[((int)((id) / 8))] |= 0x01 << (id % 8);
+        return OK;
+    } else {
+        TPD_INFO("%s: Bitmask too small! Impossible contain ID = %d %d>=%d! ERROR %08X\n",
+             __func__, id, ((int)((id) / 8)), size, ERROR_OP_NOT_ALLOW);
+        return ERROR_OP_NOT_ALLOW;
+    }
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.h b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.h
new file mode 100644
index 0000000000000000000000000000000000000000..21f38df8bc41e78b2a028a018fc0cc6f1a711ff8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_lib/ftsTool.h
@@ -0,0 +1,52 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : ftsTool.h
+ * Description: Source file for ST fst1ba90a driver lib
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+/*!
+  * \file ftsTool.h
+  * \brief Contains all the definitions to support common operations inside the
+  * driver
+  */
+
+#ifndef FTS_TOOL_H
+#define FTS_TOOL_H
+
+char *printHex(char *label, u8 *buff, int count, u8 *result);
+int u8ToU16(u8 *src, u16 *dst);
+int u8ToU16_be(u8 *src, u16 *dst);
+int u8ToU16n(u8 *src, int src_length, u16 *dst);
+int u16ToU8(u16 src, u8 *dst);
+int u16ToU8_be(u16 src, u8 *dst);
+int u16ToU8n_be(u16 *src, int src_length, u8 *dst);
+int u8ToU32(u8 *src, u32 *dst);
+int u8ToU32_be(u8 *src, u32 *dst);
+int u32ToU8(u32 src, u8 *dst);
+int u32ToU8_be(u32 src, u8 *dst);
+int u8ToU64_be(u8 *src, u64 *dest, int size);
+int u64ToU8_be(u64 src, u8 *dest, int size);
+int attempt_function(int (*code)(void), unsigned long wait_before_retry, int retry_count);
+int senseOn(void);
+int senseOff(void);
+void print_frame_short(char *label, short **matrix, int row, int column);
+short **array1dTo2d_short(short *data, int size, int columns);
+void print_frame_u16(char *label, u16 **matrix, int row, int column);
+u16 **array1dTo2d_u16(u16 *data, int size, int columns);
+u8 **array1dTo2d_u8(u8 *data, int size, int columns);
+i8 **array1dTo2d_i8(i8 *data, int size, int columns);
+void print_frame_u8(char *label, u8 **matrix, int row, int column);
+void print_frame_i8(char *label, i8 **matrix, int row, int column);
+void print_frame_u32(char *label, u32 **matrix, int row, int column);
+void print_frame_int(char *label, int **matrix, int row, int column);
+int cleanUp(int enableTouch);
+int flushFIFO(void);
+int fromIDtoMask(u8 id, u8 *mask, int size);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_proc.c b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_proc.c
new file mode 100644
index 0000000000000000000000000000000000000000..a8050f33dce4690b93afa42fa7a96d17f95a2049
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/fst1ba90a/fts_proc.c
@@ -0,0 +1,2115 @@
+/*****************************************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * File       : fts_proc.c
+ * Description: Source file for ST fst1ba90a driver
+ * Version   : 1.0
+ * Date        : 2018-10-18
+ * Author    : Zengpeng.Chen@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ *******************************************************************************************/
+
+
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/proc_fs.h>
+#include <linux/fs.h>
+#include <linux/seq_file.h>
+#include <linux/delay.h>
+#include <linux/uaccess.h>
+#include "fts.h"
+#include "fts_lib/ftsCompensation.h"
+#include "fts_lib/ftsCore.h"
+#include "fts_lib/ftsIO.h"
+#include "fts_lib/ftsError.h"
+#include "fts_lib/ftsFrame.h"
+#include "fts_lib/ftsFlash.h"
+#include "fts_lib/ftsTest.h"
+#include "fts_lib/ftsTime.h"
+#include "fts_lib/ftsTool.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "ST-fst1ba90a"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+
+#define DRIVER_TEST_FILE_NODE    "driver_test"    /* name of file node published */
+#define CHUNK_PROC              1024  /* Max chunk of data printed on the sequential file in each iteration */
+#define DIAGNOSTIC_NUM_FRAME    10    /* number of frames reading iterations during the diagnostic test */
+
+/** @defgroup proc_file_code     Proc File Node
+  * @ingroup file_nodes
+  * The /proc/fts/driver_test file node provide expose the most important API
+  * implemented into the driver to execute any possible operation into the IC \n
+  * Thanks to a series of Operation Codes, each of them, with a different set of
+  * parameter, it is possible to select a function to execute\n
+  * The result of the function is usually returned into the shell as an ASCII
+  * hex string where each byte is encoded in two chars.\n
+  */
+
+/* Bus operations */
+#define CMD_READ                0x00    /* /< I2C/SPI read: need
+                                         * to pass: byteToRead1
+                                         * byteToRead0
+                                         * (optional) dummyByte */
+#define CMD_WRITE               0x01    /* /< I2C/SPI write:
+                                         * need to pass: cmd[0]
+                                         *  cmd[1]
+                                         * cmd[cmdLength-1] */
+#define CMD_WRITEREAD           0x02    /* /< I2C/SPI writeRead:
+                                         * need to pass: cmd[0]
+                                         * cmd[1]
+                                         * cmd[cmdLength-1]
+                                         * byteToRead1
+                                         * byteToRead0 dummyByte */
+#define CMD_WRITETHENWRITEREAD  0x03    /* /< I2C/SPI write then
+                                         * writeRead: need to
+                                         * pass: cmdSize1
+                                         * cmdSize2 cmd1[0]
+                                         * cmd1[1]
+                                         * cmd1[cmdSize1-1]
+                                         * cmd2[0] cmd2[1]
+                                         * cmd2[cmdSize2-1]
+                                         * byteToRead1
+                                         * byteToRead0 */
+#define CMD_WRITEU8UX           0x04    /* /< I2C/SPI writeU8UX:
+                                         * need to pass: cmd
+                                         * addrSize addr[0]
+                                         * addr[addrSize-1]
+                                         * data[0] data[1]  */
+#define CMD_WRITEREADU8UX       0x05    /* /< I2C/SPI
+                                         * writeReadU8UX: need
+                                         * to pass: cmd addrSize
+                                         * addr[0]
+                                         * addr[addrSize-1]
+                                         * byteToRead1
+                                         * byteToRead0
+                                         * hasDummyByte */
+#define CMD_WRITEU8UXTHENWRITEU8UX          0x06        /* /< I2C/SPI writeU8UX
+                                                         * then writeU8UX: need
+                                                         * to pass: cmd1
+                                                         * addrSize1 cmd2
+                                                         * addrSize2 addr[0]
+                                                         * addr[addrSize1+addrSize2-1]
+                                                         * data[0] data[1]  */
+#define CMD_WRITEU8UXTHENWRITEREADU8UX      0x07        /* /< I2C/SPI writeU8UX
+                                                         *  then writeReadU8UX:
+                                                         * need to pass: cmd1
+                                                         * addrSize1 cmd2
+                                                         * addrSize2 addr[0]
+                                                         * addr[addrSize1+addrSize2-1]
+                                                         *  byteToRead1
+                                                         * byteToRead0
+                                                         * hasDummybyte */
+#define CMD_GETLIMITSFILE                   0x08        /* /< Get the Production
+                                                         * Limits File and print
+                                                         * its content into the
+                                                         * shell: need to pass:
+                                                         * path(optional)
+                                                         * otherwise select the
+                                                         * approach chosen at
+                                                         * compile time */
+#define CMD_GETFWFILE                       0x09        /* /< Get the FW file
+                                                         * and print its content
+                                                         * into the shell: need
+                                                         * to pass: path
+                                                         * (optional) otherwise
+                                                         * select the approach
+                                                         * chosen at compile
+                                                         * time */
+#define CMD_READCONFIG                      0x0B        /* /< Read The config
+                                                         * memory, need to pass:
+                                                         * addr[0] addr[1]
+                                                         * byteToRead0
+                                                         * byteToRead1 */
+
+
+/* GUI utils byte ver */
+#define CMD_READ_BYTE                   0xF0    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * read @see CMD_READ */
+#define CMD_WRITE_BYTE                  0xF1    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * write @see CMD_WRITE */
+#define CMD_WRITEREAD_BYTE              0xF2    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * writeRead @see
+                                                 * CMD_WRITEREAD */
+#define CMD_WRITETHENWRITEREAD_BYTE     0xF3    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * write then writeRead
+                                                 * @see
+                                                 * CMD_WRITETHENWRITEREAD */
+#define CMD_WRITEU8UX_BYTE              0xF4    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * writeU8UX @see
+                                                 * CMD_WRITEU8UX */
+#define CMD_WRITEREADU8UX_BYTE          0xF5    /* /< Byte output
+                                                 * version of I2C/SPI
+                                                 * writeReadU8UX @see
+                                                 * CMD_WRITEREADU8UX */
+#define CMD_WRITEU8UXTHENWRITEU8UX_BYTE         0xF6    /* /< Byte output
+                                                         * version of I2C/SPI
+                                                         * writeU8UX then
+                                                         * writeU8UX @see
+                                                         * CMD_WRITEU8UXTHENWRITEU8UX */
+#define CMD_WRITEU8UXTHENWRITEREADU8UX_BYTE     0xF7    /* /< Byte output
+                                                         * version of I2C/SPI
+                                                         * writeU8UX  then
+                                                         * writeReadU8UX @see
+                                                         * CMD_WRITEU8UXTHENWRITEREADU8UX */
+#define CMD_GETLIMITSFILE_BYTE                  0xF8    /* /< Byte output
+                                                         * version of Production
+                                                         * Limits File @see
+                                                         * CMD_GETLIMITSFILE */
+#define CMD_GETFWFILE_BYTE                      0xF9    /* /< Byte output
+                                                         * version of FW file
+                                                         * need to pass: @see
+                                                         * CMD_GETFWFILE */
+
+#define CMD_CHANGE_OUTPUT_MODE                  0xFF    /* /< Select the output
+                                                         * mode of the
+                                                         * scriptless protocol,
+                                                         * need to pass:
+                                                         * bin_output = 1 data
+                                                         * returned as binary,
+                                                         * bin_output =0 data
+                                                         * returned as hex
+                                                         * string */
+
+/* Core/Tools */
+#define CMD_POLLFOREVENT            0x11    /* /< Poll the FIFO for
+                                             * an event: need to
+                                             * pass: eventLength
+                                             * event[0] event[1]
+                                             * event[eventLength-1]
+                                             * timeToWait1
+                                             * timeToWait0 */
+#define CMD_SYSTEMRESET             0x12    /* /< System Reset */
+#define CMD_CLEANUP                 0x13    /* /< Perform a system
+                                             * reset and optionally
+                                             * re-enable the
+                                             * scanning, need to
+                                             * pass: enableTouch */
+#define CMD_POWERCYCLE              0x14    /* /< Execute a power
+                                             * cycle toggling the
+                                             * regulators */
+#define CMD_READSYSINFO             0x15    /* /< Read the System
+                                             * Info information from
+                                             * the framebuffer, need
+                                             * to pass: doRequest */
+#define CMD_FWWRITE                 0x16    /* /< Write a FW
+                                             * command: need to
+                                             * pass: cmd[0]  cmd[1]
+                                             * cmd[cmdLength-1] */
+#define CMD_INTERRUPT               0x17    /* /< Allow to enable or
+                                             * disable the
+                                             * interrupts, need to
+                                             * pass: enable (if 1
+                                             * will enable the
+                                             * interrupt) */
+#define CMD_SETSCANMODE             0x18    /* /< set Scan Mode
+                                             * need to pass:
+                                             * scanType option */
+#define CMD_SAVEMPFLAG              0x19    /* /< save manually a
+                                             * value in the MP flag
+                                             * need to pass: mpflag */
+
+/* Frame */
+#define CMD_GETFORCELEN             0x20    /* /< Get the number of
+                                             * Force channels */
+#define CMD_GETSENSELEN             0x21    /* /< Get the number of
+                                             * Sense channels */
+#define CMD_GETMSFRAME              0x23    /* /< Get a MS frame:
+                                             * need to pass:
+                                             * MSFrameType */
+#define CMD_GETSSFRAME              0x24    /* /< Get a SS frame:
+                                             * need to pass:
+                                             * SSFrameType */
+#define CMD_GETSYNCFRAME            0x25    /* /< Get a Sync Frame:
+                                             * need to pass:
+                                             * frameType */
+
+/* Compensation */
+#define CMD_REQCOMPDATA             0x30    /* /< Request Init data:
+                                             * need to pass: type */
+#define CMD_READCOMPDATAHEAD        0x31    /* /< Read Init data
+                                             * header: need to pass:
+                                             * type */
+#define CMD_READMSCOMPDATA          0x32    /* /< Read MS Init data:
+                                             * need to pass: type */
+#define CMD_READSSCOMPDATA          0x33    /* /< Read SS Init data:
+                                             * need to pass: type */
+#define CMD_READTOTMSCOMPDATA       0x35    /* /< Read Tot MS Init
+                                             * data: need to pass:
+                                             * type */
+#define CMD_READTOTSSCOMPDATA       0x36    /* /< Read Tot SS Init
+                                             * data: need to pass:
+                                             * type */
+
+/* FW Update */
+#define CMD_GETFWVER                0x40    /* /< Get the FW version
+                                             * of the IC */
+#define CMD_FLASHUNLOCK             0x42    /* /< Unlock the flash */
+#define CMD_READFWFILE              0x43    /* /< Try to read the FW
+                                             * file, need to pass:
+                                             * keep_cx */
+#define CMD_FLASHPROCEDURE          0x44    /* /< Perform a full
+                                             * flashing procedure:
+                                             * need to pass: force
+                                             * keep_cx */
+#define CMD_FLASHERASEUNLOCK        0x45    /* /< Unlock the erase
+                                             * of the flash */
+#define CMD_FLASHERASEPAGE          0x46    /* /< Erase page by page
+                                             * the flash, need to
+                                             * pass: keep_cx, if
+                                             * keep_cx>SKIP_PANEL_INIT
+                                             * Panel Init Page will
+                                             * be skipped, if
+                                             * >SKIP_PANEL_CX_INIT
+                                             * Cx and Panel Init
+                                             * Pages will be skipped
+                                             * otherwise if
+                                             * =ERASE_ALL all the
+                                             * pages will be deleted */
+
+
+/* MP test */
+#define CMD_ITOTEST                 0x50    /* /< Perform an ITO
+                                             * test */
+#define CMD_INITTEST                0x51    /* /< Perform an
+                                             * Initialization test:
+                                             * need to pass: type */
+#define CMD_MSRAWTEST               0x52    /* /< Perform MS raw
+                                             * test: need to pass
+                                             * stop_on_fail */
+#define CMD_MSINITDATATEST          0x53    /* /< Perform MS Init
+                                             * data test: need to
+                                             * pass stop_on_fail */
+#define CMD_SSRAWTEST               0x54    /* /< Perform SS raw
+                                             * test: need to pass
+                                             * stop_on_fail */
+#define CMD_SSINITDATATEST          0x55    /* /< Perform SS Init
+                                             * data test: need to
+                                             * pass stop_on_fail */
+#define CMD_MAINTEST                0x56    /* /< Perform a full
+                                             * Mass production test:
+                                             * need to pass
+                                             * stop_on_fail saveInit
+                                             * mpflag */
+#define CMD_FREELIMIT               0x57    /* /< Free (if any)
+                                             * limit file which was
+                                             * loaded during any
+                                             * test procedure */
+
+/* Diagnostic */
+#define CMD_DIAGNOSTIC              0x60    /* /< Perform a series
+                                             * of commands and
+                                             * collect severals data
+                                             * to detect any
+                                             * malfunction */
+
+static u8 bin_output;       /* /< Select the output type of the scriptless
+                             * protocol (binary = 1  or hex string = 0) */
+
+/** @defgroup scriptless Scriptless Protocol
+  * @ingroup proc_file_code
+  * Scriptless Protocol allows ST Software (such as FingerTip Studio etc) to
+  * communicate with the IC from an user space.
+  * This mode gives access to common bus operations (write, read etc) and
+  * support additional functionalities. \n
+  * The protocol is based on exchange of binary messages included between a
+  * start and an end byte
+  */
+
+#define MESSAGE_START_BYTE      0x7B    /* start byte of each message
+                                         * transferred in Scriptless Mode */
+#define MESSAGE_END_BYTE        0x7D    /* end byte of each message
+                                         * transferred in Scriptless Mode */
+#define MESSAGE_MIN_HEADER_SIZE 8       /* minimun number of bytes of the
+                                         * structure of a messages exchanged
+                                         * with host (include start/end byte,
+                                         * counter, actions, msg_size) */
+
+/**
+  * Possible actions that can be requested by an host
+  */
+typedef enum {
+    ACTION_WRITE                = (u16) 0x0001,    /* Bus Write */
+    ACTION_READ                 = (u16) 0x0002,    /* Bus Read */
+    ACTION_WRITE_READ           = (u16) 0x0003,    /* Bus Write followed by a Read */
+    ACTION_GET_VERSION          = (u16) 0x0004,    /* Get
+                                                    * Version of
+                                                    * the protocol
+                                                    * (equal to the
+                                                    * first 2 bye
+                                                    * of driver
+                                                    * version) */
+    ACTION_WRITEU8UX            = (u16) 0x0011,    /* Bus Write
+                                                    * with support
+                                                    * to different
+                                                    * address size */
+    ACTION_WRITEREADU8UX        = (u16) 0x0012,    /* Bus writeRead
+                                                    * with support
+                                                    * to different
+                                                    * address size */
+    ACTION_WRITETHENWRITEREAD   = (u16) 0x0013,    /* Bus write
+                                                    * followed by a
+                                                    * writeRead */
+    ACTION_WRITEU8XTHENWRITEREADU8UX    = (u16) 0x0014,    /* Bus write
+                                                            * followed by a
+                                                            * writeRead
+                                                            * with support
+                                                            * to different
+                                                            * address size */
+    ACTION_WRITEU8UXTHENWRITEU8UX       = (u16) 0x0015,    /* Bus write
+                                                            * followed by a
+                                                            * write with
+                                                            * support to
+                                                            * different
+                                                            * address size */
+    ACTION_GET_FW               = (u16) 0x1000,    /* Get Fw
+                                                    * file content
+                                                    * used by the
+                                                    * driver */
+    ACTION_GET_LIMIT            = (u16) 0x1001     /* /< Get Limit
+                                                    * File content
+                                                    * used by the
+                                                    * driver */
+} Actions;
+
+/**
+  * Struct used to contain info of the message received by the host in
+  * Scriptless mode
+  */
+typedef struct {
+    u16         msg_size;   /* /< total size of the message in bytes */
+    u16         counter;    /* /< counter ID to identify a message */
+    Actions     action;     /* /< type of operation requested by the host @see Actions */
+    u8          dummy;      /* /< (optional)in case of any kind of read operations, specify if the first byte is dummy */
+} Message;
+
+extern TestToDo tests;
+extern SysInfo  systemInfo;
+
+static int limit;   /* /< store the amount of data to print into the shell */
+static int chunk;   /* /< store the chuk of data that should be printed in this iteration */
+static int printed; /* /< store the amount of data already printed in the shell */
+static struct proc_dir_entry *fts_dir;  /* /< reference to the directory fts under /proc */
+static u8 *driver_test_buff;            /* /< pointer to an array of bytes used to store the result of the function executed */
+char buf_chunk[CHUNK_PROC] = { 0 };     /* /< buffer used to store the message info received */
+static Message mess = { 0 };            /* /< store the information of the Scriptless message received */
+
+
+/************************ SEQUENTIAL FILE UTILITIES **************************/
+/**
+  * This function is called at the beginning of the stream to a sequential file
+  * or every time into the sequential were already written PAGE_SIZE bytes and
+  * the stream need to restart
+  * @param s pointer to the sequential file on which print the data
+  * @param pos pointer to the offset where write the data
+  * @return NULL if there is no data to print or the pointer to the beginning of
+  * the data that need to be printed
+  */
+static void *fts_seq_start(struct seq_file *s, loff_t *pos)
+{
+    TPD_DEBUG("%s: Entering start(), pos = %lld limit = %d printed = %d\n",
+         __func__, *pos, limit, printed);
+
+    if (driver_test_buff == NULL && *pos == 0) {
+        TPD_INFO("%s: No data to print!\n", __func__);
+        driver_test_buff = (u8 *)kzalloc(13 * sizeof(u8), GFP_KERNEL);
+
+        snprintf(driver_test_buff, 14, "{ %08X }\n", ERROR_OP_NOT_ALLOW);
+
+        limit = strlen(driver_test_buff);
+        /* TPD_DEBUG("%s: len = %d driver_test_buff = %s\n", __func__, limit, driver_test_buff); */
+    } else {
+        if (*pos != 0)
+            *pos += chunk - 1;
+
+        if (*pos >= limit)
+            /* TPD_DEBUG("%s: Apparently, we're done.\n", __func__); */
+            return NULL;
+    }
+
+    chunk = CHUNK_PROC;
+    if (limit - *pos < CHUNK_PROC)
+        chunk = limit - *pos;
+    /* TPD_DEBUG("%s: In start(), updated pos = %ld limit = %d printed = %d chunk = %d\n",__func__, *pos, limit, printed, chunk); */
+    memset(buf_chunk, 0, CHUNK_PROC);
+    memcpy(buf_chunk, &driver_test_buff[(int)*pos], chunk);
+
+    return buf_chunk;
+}
+
+/**
+  * This function actually print a chunk amount of data in the sequential file
+  * @param s pointer to the sequential file where to print the data
+  * @param v pointer to the data to print
+  * @return 0
+  */
+static int fts_seq_show(struct seq_file *s, void *v)
+{
+    /* TPD_DEBUG("%s: In show()\n", __func__); */
+    seq_write(s, (u8 *)v, chunk);
+    printed += chunk;
+    return 0;
+}
+
+/**
+  * This function update the pointer and the counters to the next data to be
+  * printed
+  * @param s pointer to the sequential file where to print the data
+  * @param v pointer to the data to print
+  * @param pos pointer to the offset where write the next data
+  * @return NULL if there is no data to print or the pointer to the beginning of
+  * the next data that need to be printed
+  */
+static void *fts_seq_next(struct seq_file *s, void *v, loff_t *pos)
+{
+    /* int* val_ptr; */
+    /* TPD_DEBUG("%s: In next(), v = %X, pos = %ld.\n", __func__, v, *pos); */
+    (*pos) += chunk;/* increase my position counter */
+    chunk = CHUNK_PROC;
+
+    /* TPD_DEBUG("%s: In next(), updated pos = %ld limit = %d printed = %d\n", __func__, *pos, limit,printed); */
+    if (*pos >= limit)    /* are we done? */
+        return NULL;
+    else if (limit - *pos < CHUNK_PROC)
+        chunk = limit - *pos;
+
+    memset(buf_chunk, 0, CHUNK_PROC);
+    memcpy(buf_chunk, &driver_test_buff[(int)*pos], chunk);
+    return buf_chunk;
+}
+
+
+/**
+  * This function is called when there are no more data to print  the stream
+  * need to be terminated or when PAGE_SIZE data were already written into the
+  * sequential file
+  * @param s pointer to the sequential file where to print the data
+  * @param v pointer returned by fts_seq_next
+  */
+static void fts_seq_stop(struct seq_file *s, void *v)
+{
+    /* TPD_DEBUG("%s: Entering stop().\n", __func__); */
+
+    if (v) {
+        /* TPD_DEBUG("%s: v is %X.\n", __func__, v); */
+    } else {
+        /* TPD_DEBUG("%s: v is null.\n", __func__); */
+        limit = 0;
+        chunk = 0;
+        printed = 0;
+        if (driver_test_buff != NULL) {
+            /* TPD_DEBUG("%s: Freeing and clearing driver_test_buff.\n", __func__); */
+            kfree(driver_test_buff);
+            driver_test_buff = NULL;
+        } else {
+            /* TPD_DEBUG("%s: driver_test_buff is already null.\n", __func__); */
+        }
+    }
+}
+
+/**
+  * Struct where define and specify the functions which implements the flow for
+  * writing on a sequential file
+  */
+static const struct seq_operations fts_seq_ops = {
+    .start   = fts_seq_start,
+    .next    = fts_seq_next,
+    .stop    = fts_seq_stop,
+    .show    = fts_seq_show
+};
+
+/**
+  * This function open a sequential file
+  * @param inode Inode in the file system that was called and triggered this
+  * function
+  * @param file file associated to the file node
+  * @return error code, 0 if success
+  */
+static int fts_open(struct inode *inode, struct file *file)
+{
+    return seq_open(file, &fts_seq_ops);
+};
+
+
+/**************************** DRIVER TEST ************************************/
+
+/**
+  * Receive the OP code and the inputs from shell when the file node is called,
+  * parse it and then execute the corresponding function
+  * echo cmd+parameters > /proc/fts/driver_test to execute the select command
+  * cat /proc/fts/driver_test            to obtain the result into the
+  * shell \n
+  * the string returned in the shell is made up as follow: \n
+  * { = start byte \n
+  * the answer content and format strictly depend on the cmd executed. In
+  * general can be: an HEX string or a byte array (e.g in case of 0xF- commands)
+  * \n
+  * } = end byte \n
+  */
+static ssize_t fts_driver_test_write(struct file *file, const char __user *buf,
+                     size_t count, loff_t *pos)
+{
+    int numberParam = 0;
+    struct fts_ts_info *info = PDE_DATA(file_inode(file));
+    char *p = NULL;
+    char pbuf[count];
+    char path[100] = { 0 };
+    int res = -1, j, index = 0;
+    int size = 6;
+    int temp, byte_call = 0;
+    u16 byteToRead = 0;
+    u32 fileSize = 0;
+    u8 *readData = NULL;
+    u8 cmd[count];    /* worst case needs count bytes */
+    u32 funcToTest[((count + 1) / 3)];
+    u64 addr = 0;
+    MutualSenseFrame frameMS;
+    SelfSenseFrame frameSS;
+
+    DataHeader dataHead;
+    MutualSenseData compData;
+    SelfSenseData comData;
+    TotMutualSenseData totCompData;
+    TotSelfSenseData totComData;
+
+    u64 address;
+
+    Firmware fw;
+    LimitFile lim;
+
+    mess.dummy = 0;
+    mess.action = 0;
+    mess.msg_size = 0;
+
+    memset(&compData, 0, sizeof(compData));
+    memset(&comData, 0, sizeof(comData));
+    memset(&totCompData, 0, sizeof(totCompData));
+    memset(&totComData, 0, sizeof(totComData));
+
+    if (access_ok(VERIFY_READ, buf, count) < OK || copy_from_user(pbuf, buf, count) != 0) {
+        res = ERROR_ALLOC;
+        goto END;
+    }
+
+    p = pbuf;
+    if (count > MESSAGE_MIN_HEADER_SIZE - 1 && p[0] == MESSAGE_START_BYTE) {
+        TPD_DEBUG("Enter in Byte Mode!\n");
+        byte_call = 1;
+        mess.msg_size = (p[1] << 8) | p[2];
+        mess.counter = (p[3] << 8) | p[4];
+        mess.action = (p[5] << 8) | p[6];
+        TPD_DEBUG("Message received: size = %d, counter_id = %d, action = %04X\n",mess.msg_size, mess.counter, mess.action);
+        size = MESSAGE_MIN_HEADER_SIZE + 2;    /* +2 error code */
+        if (count < mess.msg_size || p[count - 2] != MESSAGE_END_BYTE) {
+            TPD_INFO("number of byte received or end byte wrong! msg_size = %d != %d, last_byte = %02X != %02X ... ERROR %08X\n",
+                mess.msg_size, (int)count, p[count - 1], MESSAGE_END_BYTE, ERROR_OP_NOT_ALLOW);
+            res = ERROR_OP_NOT_ALLOW;
+            goto END;
+        } else {
+            numberParam = mess.msg_size - MESSAGE_MIN_HEADER_SIZE + 1;    /* +1 because put the internal op code */
+            size = MESSAGE_MIN_HEADER_SIZE + 2;    /* +2 send also the first 2 lsb of the error code */
+            switch (mess.action) {
+            case ACTION_READ:
+                cmd[0] = funcToTest[0] = CMD_READ_BYTE;
+                break;
+
+            case ACTION_WRITE:
+                cmd[0] = funcToTest[0] = CMD_WRITE_BYTE;
+                break;
+
+            case ACTION_WRITE_READ:
+                cmd[0] = funcToTest[0] = CMD_WRITEREAD_BYTE;
+                break;
+
+            case ACTION_WRITETHENWRITEREAD:
+                cmd[0] = funcToTest[0] = CMD_WRITETHENWRITEREAD_BYTE;
+                break;
+
+            case ACTION_WRITEU8UX:
+                cmd[0] = funcToTest[0] = CMD_WRITEU8UX_BYTE;
+                break;
+
+            case ACTION_WRITEREADU8UX:
+                cmd[0] = funcToTest[0] = CMD_WRITEREADU8UX_BYTE;
+                break;
+
+            case ACTION_WRITEU8UXTHENWRITEU8UX:
+                cmd[0] = funcToTest[0] = CMD_WRITEU8UXTHENWRITEU8UX_BYTE;
+                break;
+
+            case ACTION_WRITEU8XTHENWRITEREADU8UX:
+                cmd[0] = funcToTest[0] = CMD_WRITEU8UXTHENWRITEREADU8UX_BYTE;
+                break;
+
+            case ACTION_GET_FW:
+                cmd[0] = funcToTest[0] = CMD_GETFWFILE_BYTE;
+                break;
+
+            case ACTION_GET_LIMIT:
+                cmd[0] = funcToTest[0] = CMD_GETLIMITSFILE_BYTE;
+                break;
+
+            default:
+                TPD_INFO("Invalid Action = %d ... ERROR %08X\n", mess.action, ERROR_OP_NOT_ALLOW);
+                res = ERROR_OP_NOT_ALLOW;
+                goto END;
+            }
+
+            if (numberParam - 1 != 0)
+                memcpy(&cmd[1], &p[7], numberParam - 1);/* -1 because i need to exclude the cmd[0] */
+        }
+    } else {
+        if (((count + 1) / 3) >= 1) {
+            if (sscanf(p, "%02X ", &funcToTest[0]) == 1) {
+                p += 3;
+                cmd[0] = (u8)funcToTest[0];
+                numberParam = 1;
+            }
+        } else {
+            res = ERROR_OP_NOT_ALLOW;
+            goto END;
+        }
+
+        TPD_INFO("functionToTest[0] = %02X cmd[0]= %02X\n", funcToTest[0], cmd[0]);
+        switch (funcToTest[0]) {
+        case CMD_GETFWFILE:
+        case CMD_GETLIMITSFILE:
+            if (count - 2 - 1 > 1) {
+                if (sscanf(p, "%100s", path) == 1)
+                    numberParam = 2;
+                    /* the first byte is an hex string coded in three byte (2 chars for hex and the space) and -1 for the space at the end */
+            }
+            break;
+
+        default:
+            for (; numberParam < (count + 1) / 3; numberParam++) {
+                if (sscanf(p, "%02X ", &funcToTest[numberParam]) == 1) {
+                    p += 3;
+                    cmd[numberParam] = (u8)funcToTest[numberParam];
+                    TPD_INFO("functionToTest[%d] = %02X cmd[%d]= %02X\n", numberParam, funcToTest[numberParam], numberParam, cmd[numberParam]);
+                }
+
+            }
+        }
+    }
+
+    fw.data = NULL;
+    lim.data = NULL;
+
+    TPD_INFO("Number of Parameters = %d\n", numberParam);
+
+    /* elaborate input */
+    if (numberParam >= 1) {
+        switch (funcToTest[0]) {
+        case CMD_WRITEREAD:
+        case CMD_WRITEREAD_BYTE:
+            if (numberParam >= 5) {    /* need to pass: cmd[0]  cmd[1]  cmd[cmdLength-1] byteToRead1 byteToRead0 dummyByte */
+                temp = numberParam - 4;
+                if (cmd[numberParam - 1] == 0)
+                    mess.dummy = 0;
+                else
+                    mess.dummy = 1;
+
+                u8ToU16_be(&cmd[numberParam - 3], &byteToRead);
+                TPD_DEBUG("bytesToRead = %d\n", byteToRead + mess.dummy);
+
+                readData = (u8 *)kzalloc((byteToRead + mess.dummy) * sizeof(u8), GFP_KERNEL);
+                res = fts_writeRead(&cmd[1], temp, readData, byteToRead + mess.dummy);
+                size += (byteToRead * sizeof(u8));
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_WRITE:
+        case CMD_WRITE_BYTE:
+            if (numberParam >= 2) {    /* need to pass: cmd[0]  cmd[1] cmd[cmdLength-1] */
+                temp = numberParam - 1;
+
+                res = fts_write(&cmd[1], temp);
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_READ:
+        case CMD_READ_BYTE:
+            if (numberParam >= 3) {    /* need to pass: byteToRead1 byteToRead0 (optional) dummyByte */
+                if (numberParam == 3 || (numberParam == 4 && cmd[numberParam - 1] == 0))
+                    mess.dummy = 0;
+                else
+                    mess.dummy = 1;
+                u8ToU16_be(&cmd[1], &byteToRead);
+                readData = (u8 *)kzalloc((byteToRead + mess.dummy) * sizeof(u8), GFP_KERNEL);
+                res = fts_read(readData, byteToRead + mess.dummy);
+                size += (byteToRead * sizeof(u8));
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_WRITETHENWRITEREAD:
+        case CMD_WRITETHENWRITEREAD_BYTE:
+            /* need to pass: cmdSize1 cmdSize2 cmd1[0] cmd1[1] cmd1[cmdSize1-1] cmd2[0] cmd2[1]  cmd2[cmdSize2-1]  byteToRead1 byteToRead0 */
+            if (numberParam >= 6) {
+                u8ToU16_be(&cmd[numberParam - 2], &byteToRead);
+                readData = (u8 *)kzalloc(byteToRead * sizeof(u8), GFP_KERNEL);
+                res = fts_writeThenWriteRead(&cmd[3], cmd[1], &cmd[3 + (int)cmd[1]], cmd[2], readData, byteToRead);
+                size += (byteToRead * sizeof(u8));
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_WRITEU8UX:
+        case CMD_WRITEU8UX_BYTE:
+            /* need to pass: cmd addrSize addr[0]  addr[addrSize-1] data[0] data[1]  */
+            if (numberParam >= 4) {
+                if (cmd[2] <= sizeof(u64)) {
+                    u8ToU64_be(&cmd[3], &addr, cmd[2]);
+                    TPD_DEBUG("addr = %016llX %ld\n", addr, (long int)addr);
+                    res = fts_writeU8UX(cmd[1], cmd[2], addr, &cmd[3 +cmd[2]],(numberParam - cmd[2] - 3));
+                } else {
+                    TPD_INFO("Wrong address size!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        case CMD_WRITEREADU8UX:
+        case CMD_WRITEREADU8UX_BYTE:
+            /* need to pass: cmd addrSize addr[0]  addr[addrSize-1] byteToRead1 byteToRead0 hasDummyByte */
+            if (numberParam >= 6) {
+                if (cmd[2] <= sizeof(u64)) {
+                    u8ToU64_be(&cmd[3], &addr, cmd[2]);
+                    u8ToU16_be(&cmd[numberParam - 3], &byteToRead);
+                    readData = (u8 *)kzalloc(byteToRead * sizeof(u8), GFP_KERNEL);
+                    TPD_DEBUG("addr = %016llX byteToRead = %d\n", addr, byteToRead);
+                    res = fts_writeReadU8UX(cmd[1], cmd[2], addr, readData, byteToRead, cmd[numberParam - 1]);
+                    size += (byteToRead * sizeof(u8));
+                } else {
+                    TPD_INFO("Wrong address size!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_WRITEU8UXTHENWRITEU8UX:
+        case CMD_WRITEU8UXTHENWRITEU8UX_BYTE:
+            /* need to pass: cmd1 addrSize1 cmd2 addrSize2 addr[0]  addr[addrSize1+addrSize2-1] data[0] data[1] */
+            if (numberParam >= 6) {
+                if ((cmd[2] + cmd[4]) <= sizeof(u64)) {
+                    u8ToU64_be(&cmd[5], &addr, cmd[2] + cmd[4]);
+
+                    TPD_DEBUG("addr = %016llX %lld\n", addr, addr);
+                    res = fts_writeU8UXthenWriteU8UX(cmd[1], cmd[2], cmd[3], cmd[4], addr, &cmd[5 + cmd[2] + cmd[4]], (numberParam -cmd[2] - cmd[4] -5));
+                } else {
+                    TPD_INFO("Wrong address size!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_WRITEU8UXTHENWRITEREADU8UX:
+        case CMD_WRITEU8UXTHENWRITEREADU8UX_BYTE:
+            /* need to pass: cmd1 addrSize1 cmd2 addrSize2 addr[0]  addr[addrSize1+addrSize2-1]  byteToRead1 byteToRead0 hasDummybyte */
+            if (numberParam >= 8) {
+                if ((cmd[2] + cmd[4]) <= sizeof(u64)) {
+                    u8ToU64_be(&cmd[5], &addr, cmd[2] + cmd[4]);
+                    TPD_INFO("%s: cmd[5] = %02X, addr =  %016llX\n", __func__, cmd[5], addr);
+                    u8ToU16_be(&cmd[numberParam - 3], &byteToRead);
+                    readData = (u8 *)kzalloc(byteToRead * sizeof(u8), GFP_KERNEL);
+                    res = fts_writeU8UXthenWriteReadU8UX(cmd[1], cmd[2], cmd[3], cmd[4], addr, readData, byteToRead, cmd[numberParam - 1]);
+                    size += (byteToRead * sizeof(u8));
+                } else {
+                    TPD_INFO("Wrong total address size!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+
+            break;
+
+        case CMD_CHANGE_OUTPUT_MODE:
+            /* need to pass: bin_output */
+            if (numberParam >= 2) {
+                bin_output = cmd[1];
+                TPD_DEBUG("Setting Scriptless output mode: %d\n", bin_output);
+                res = OK;
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_FWWRITE:
+            if (numberParam >= 3) {    /* need to pass: cmd[0]  cmd[1] cmd[cmdLength-1] */
+                if (numberParam >= 2) {
+                    temp = numberParam - 1;
+                    res = fts_writeFwCmd(&cmd[1], temp);
+                } else {
+                    TPD_INFO("Wrong parameters!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_INTERRUPT:
+            /* need to pass: enable */
+            if (numberParam >= 2) {
+                if (cmd[1] == 1)
+                    res = fts_enableInterrupt();
+                else
+                    res = fts_disableInterrupt();
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_SETSCANMODE:
+            /* need to pass: scanMode option */
+            if (numberParam >= 3)
+                res = setScanMode(cmd[1], cmd[2]);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_SAVEMPFLAG:
+            /* need to pass: mpflag */
+            if (numberParam == 2)
+                res = saveMpFlag(cmd[1]);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        case CMD_READCONFIG:
+            if (numberParam == 5) {    /* need to pass: addr[0]  addr[1] byteToRead1 byteToRead0 */
+                byteToRead = ((funcToTest[3] << 8) | funcToTest[4]);
+                readData = (u8 *)kzalloc(byteToRead * sizeof(u8), GFP_KERNEL);
+                res = readConfig((u16)((((u8)funcToTest[1] & 0x00FF) << 8) + ((u8)funcToTest[2] & 0x00FF)), readData, byteToRead);
+                size += (byteToRead * sizeof(u8));
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_POLLFOREVENT:
+            if (numberParam >= 5) {    /* need to pass: eventLength event[0] event[1]  event[eventLength-1] timeTowait1 timeTowait0 */
+                temp = (int)funcToTest[1];
+                if (numberParam == 5 + (temp - 1) && temp != 0) {
+                    readData = (u8 *)kzalloc(FIFO_EVENT_SIZE * sizeof(u8), GFP_KERNEL);
+                    res = pollForEvent((int *)&funcToTest[2], temp, readData, ((funcToTest[temp + 2] & 0x00FF) << 8) + (funcToTest[temp + 3] & 0x00FF));
+                    if (res >= OK)
+                        res = OK;    /* pollForEvent return the number of error found */
+                    size += (FIFO_EVENT_SIZE * sizeof(u8));
+                    byteToRead = FIFO_EVENT_SIZE;
+                } else {
+                    TPD_INFO("Wrong parameters!\n");
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_SYSTEMRESET:
+            res = fts_system_reset();
+
+            break;
+
+        case CMD_READSYSINFO:
+            if (numberParam == 2)    /* need to pass: doRequest */
+                res = readSysInfo(funcToTest[1]);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+
+            break;
+
+        case CMD_CLEANUP:   /* TOUCH ENABLE/DISABLE */
+            if (numberParam == 2)    /* need to pass: enableTouch */
+                res = cleanUp(funcToTest[1]);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+
+            break;
+
+        case CMD_GETFORCELEN:    /* read number Tx channels */
+            temp = getForceLen();
+            if (temp < OK)
+                res = temp;
+            else {
+                size += (1 * sizeof(u8));
+                res = OK;
+            }
+            break;
+
+        case CMD_GETSENSELEN:    /* read number Rx channels */
+            temp = getSenseLen();
+            if (temp < OK)
+                res = temp;
+            else {
+                size += (1 * sizeof(u8));
+                res = OK;
+            }
+            break;
+
+
+        case CMD_GETMSFRAME:
+            if (numberParam == 2) {
+                /*TPD_DEBUG("Get 1 MS Frame\n");
+                setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+                msleep(WAIT_FOR_FRESH_FRAMES);
+                setScanMode(SCAN_MODE_ACTIVE, 0x00);
+                msleep(WAIT_AFTER_SENSEOFF);
+                flushFIFO(); */   /* delete the events related to
+                                   * some touch (allow to call this function while
+                                   * touching the screen without having a flooding
+                                   * of the FIFO) */
+                res = getMSFrame3((MSFrameType)cmd[1], &frameMS);
+                if (res < 0)
+                    TPD_DEBUG("Error while taking the MS frame... ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("The frame size is %d words\n", res);
+                    size += (res * sizeof(short) + 2); /* +2 to add force and sense channels set res to OK because if getMSFrame is successful res = number of words read */
+                    res = OK;
+                    print_frame_short("MS frame =", array1dTo2d_short(frameMS.node_data, frameMS.node_data_size, frameMS.header.sense_node),
+                        frameMS.header.force_node, frameMS.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        /*read self raw*/
+        case CMD_GETSSFRAME:
+            if (numberParam == 2) {
+                TPD_DEBUG("Get 1 SS Frame\n");
+                /* flushFIFO(); //delete the events related to
+                 * some touch (allow to call this function while
+                 * touching the screen without having a flooding
+                 * of the FIFO) */
+                /* setScanMode(SCAN_MODE_ACTIVE, 0xFF);
+                msleep(WAIT_FOR_FRESH_FRAMES);
+                setScanMode(SCAN_MODE_ACTIVE, 0x00);
+                msleep(WAIT_AFTER_SENSEOFF);  */
+                res = getSSFrame3((SSFrameType)cmd[1], &frameSS);
+
+                if (res < OK)
+                    TPD_DEBUG("Error while taking the SS frame... ERROR %08X\n", res);
+
+                else {
+                    TPD_DEBUG("The frame size is %d words\n", res);
+                    size += (res * sizeof(short) + 2);/* +2 to add force and sense channels  set res to OK because if getMSFrame is successful res = number of words read */
+                    res = OK;
+                    print_frame_short("SS force frame =",
+                              array1dTo2d_short(frameSS.force_data, frameSS.header.force_node, 1),
+                              frameSS.header.force_node, 1);
+                    print_frame_short("SS sense frame =",
+                              array1dTo2d_short(frameSS.sense_data, frameSS.header.sense_node, frameSS.header.sense_node),
+                              1, frameSS.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_GETSYNCFRAME:
+            /* need to pass: frameType (this parameter can be one of LOAD_SYNC_FRAME_X) */
+            if (numberParam == 2) {
+                TPD_INFO("Reading Sync Frame...\n");
+                res = getSyncFrame(cmd[1], &frameMS, &frameSS);
+                if (res < OK)
+                    TPD_DEBUG("Error while taking the Sync Frame frame... ERROR %08X\n", res);
+
+                else {
+                    TPD_DEBUG("The total frames size is %d words\n",res);
+                    size += (res * sizeof(short) + 4);/* +4 to add force and sense channels for MS and SS set res to OK because if getSyncFrame is successful res = number of words read */
+                    res = OK;
+
+                    print_frame_short("MS frame =",
+                              array1dTo2d_short(frameMS.node_data, frameMS.node_data_size, frameMS.header.sense_node),
+                              frameMS.header.force_node,frameMS.header.sense_node);
+                    print_frame_short("SS force frame =",
+                              array1dTo2d_short(frameSS.force_data,frameSS.header.force_node,1),
+                              frameSS.header.force_node, 1);
+                    print_frame_short("SS sense frame =",
+                              array1dTo2d_short(frameSS.sense_data,frameSS.header.sense_node,frameSS.header.sense_node),
+                              1,frameSS.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_REQCOMPDATA:    /* request comp data */
+            if (numberParam == 2) {
+                TPD_DEBUG("Requesting Compensation Data\n");
+                res = requestCompensationData(cmd[1]);
+
+                if (res < OK)
+                    TPD_DEBUG("Error requesting compensation data ERROR %08X\n", res);
+                else
+                    TPD_DEBUG("Requesting Compensation Data Finished!\n");
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_READCOMPDATAHEAD:    /* read comp data header */
+            if (numberParam == 2) {
+                TPD_DEBUG("Requesting Compensation Data\n");
+                res = requestCompensationData(cmd[1]);
+                if (res < OK)
+                    TPD_DEBUG("Error requesting compensation data ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("Requesting Compensation Data Finished!\n");
+                    res = readCompensationDataHeader((u8)funcToTest[1], &dataHead, &address);
+                    if (res < OK)
+                        TPD_DEBUG("Read Compensation Data Header ERROR %08X\n", res);
+                    else {
+                        TPD_DEBUG("Read Compensation Data Header OK!\n");
+                        size += (1 * sizeof(u8));
+                    }
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        case CMD_READMSCOMPDATA:/* read mutual comp data */
+            if (numberParam == 2) {
+                TPD_DEBUG( "Get MS Compensation Data\n");
+                res = readMutualSenseCompensationData(cmd[1], &compData);
+
+                if (res < OK)
+                    TPD_DEBUG("Error reading MS compensation data ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("MS Compensation Data Reading Finished!\n");
+                    size = ((compData.node_data_size + 10) * sizeof(i8));
+                    print_frame_i8("MS Data (Cx2) =",
+                               array1dTo2d_i8(compData.node_data,compData.node_data_size,compData.header.sense_node),
+                               compData.header.force_node,compData.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_READSSCOMPDATA:
+            if (numberParam == 2) {    /* read self comp data */
+                TPD_DEBUG( "Get SS Compensation Data...\n");
+                res = readSelfSenseCompensationData(cmd[1],&comData);
+                if (res < OK)
+                    TPD_DEBUG("Error reading SS compensation data ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("SS Compensation Data Reading Finished!\n");
+                    size = ((comData.header.force_node + comData.header.sense_node) * 2 + 13) * sizeof(i8);
+                    print_frame_i8("SS Data Ix2_fm = ",
+                               array1dTo2d_i8(comData.ix2_fm,comData.header.force_node,comData.header.force_node),
+                               1, comData.header.force_node);
+                    print_frame_i8("SS Data Cx2_fm = ",
+                               array1dTo2d_i8(comData.cx2_fm,comData.header.force_node,comData.header.force_node),
+                               1, comData.header.force_node);
+                    print_frame_i8("SS Data Ix2_sn = ",
+                               array1dTo2d_i8(comData.ix2_sn,comData.header.sense_node,comData.header.sense_node),
+                               1, comData.header.sense_node);
+                    print_frame_i8("SS Data Cx2_sn = ",
+                               array1dTo2d_i8(comData.cx2_sn,comData.header.sense_node,comData.header.sense_node),
+                               1, comData.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_READTOTMSCOMPDATA:    /* read mutual comp data */
+            if (numberParam == 2) {
+                TPD_DEBUG(
+                     "Get TOT MS Compensation Data\n");
+                res = readTotMutualSenseCompensationData(cmd[1], &totCompData);
+
+                if (res < OK)
+                    TPD_DEBUG("Error reading TOT MS compensation data ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("TOT MS Compensation Data Reading Finished!\n");
+                    size = (totCompData.node_data_size * sizeof(short) + 9);
+                    print_frame_short("MS Data (TOT Cx) =",
+                              array1dTo2d_short(totCompData.node_data,totCompData.node_data_size,totCompData.header.sense_node),
+                              totCompData.header.force_node,totCompData.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_READTOTSSCOMPDATA:
+            if (numberParam == 2) {    /* read self comp data */
+                TPD_DEBUG("Get TOT SS Compensation Data...\n");
+                res = readTotSelfSenseCompensationData(cmd[1], &totComData);
+                if (res < OK)
+                    TPD_DEBUG("Error reading TOT SS compensation data ERROR %08X\n", res);
+                else {
+                    TPD_DEBUG("TOT SS Compensation Data Reading Finished!\n");
+                    size = ((totComData.header.force_node + totComData.header.sense_node) * 2 * sizeof(short) + 9);
+                    print_frame_u16("SS Data TOT Ix_fm = ",
+                            array1dTo2d_u16(totComData.ix_fm,totComData.header.force_node,totComData.header.force_node),
+                            1,totComData.header.force_node);
+                    print_frame_short("SS Data TOT Cx_fm = ",
+                            array1dTo2d_short(totComData.cx_fm,totComData.header.force_node,totComData.header.force_node),
+                            1,totComData.header.force_node);
+                    print_frame_u16("SS Data TOT Ix_sn = ",
+                            array1dTo2d_u16(totComData.ix_sn,totComData.header.sense_node,totComData.header.sense_node),
+                            1,totComData.header.sense_node);
+                    print_frame_short("SS Data TOT Cx_sn = ",
+                            array1dTo2d_short(totComData.cx_sn,totComData.header.sense_node,totComData.header.sense_node),
+                            1,totComData.header.sense_node);
+                }
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        case CMD_GETFWVER:
+            size += (EXTERNAL_RELEASE_INFO_SIZE)*sizeof(u8);
+            break;
+
+        case CMD_FLASHUNLOCK:
+            res = flash_unlock();
+            if (res < OK)
+                TPD_INFO("Impossible Unlock Flash ERROR %08X\n", res);
+            else
+                TPD_DEBUG("Flash Unlock OK!\n");
+            break;
+
+        case CMD_READFWFILE:
+            if (numberParam == 2) {    /* read fw file */
+                TPD_DEBUG("Reading FW File...\n");
+                res = readFwFile(info->fw_name, &fw, funcToTest[1]);
+                if (res < OK)
+                    TPD_DEBUG("Error reading FW File ERROR %08X\n", res);
+                else
+                    TPD_DEBUG("Read FW File Finished!\n");
+                kfree(fw.data);
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_FLASHPROCEDURE:
+            if (numberParam == 3) {    /* flashing procedure */
+                TPD_DEBUG("Starting Flashing Procedure...\n");
+                res = flashProcedure(info->fw_name, cmd[1],
+                             cmd[2]);
+                if (res < OK)
+                    TPD_DEBUG("Error during flash procedure ERROR %08X\n", res);
+                else
+                    TPD_DEBUG("Flash Procedure Finished!\n");
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_FLASHERASEUNLOCK:
+            res = flash_erase_unlock();
+            if (res < OK)
+                TPD_DEBUG("Error during flash erase unlock... ERROR %08X\n", res);
+            else
+                TPD_DEBUG( "Flash Erase Unlock Finished!\n");
+            break;
+
+        case CMD_FLASHERASEPAGE:
+            if (numberParam == 2) {    /* need to pass: keep_cx */
+                TPD_DEBUG("Starting Flashing Page Erase...\n");
+                //res = flash_erase_page_by_page(cmd[1]);
+                res =ERROR_OP_NOT_ALLOW;
+                if (res < OK)
+                    TPD_DEBUG("Error during flash page erase... ERROR %08X\n", res);
+                else
+                    TPD_DEBUG("Flash Page Erase Finished!\n");
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        /*ITO TEST*/
+        case CMD_ITOTEST:
+            res = production_test_ito(info->test_limit_name, &tests);
+            break;
+
+        /*Initialization*/
+        case CMD_INITTEST:
+            if (numberParam == 2)
+                res = production_test_initialization(cmd[1]);
+
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+
+        case CMD_MSRAWTEST:    /* MS Raw DATA TEST */
+            if (numberParam == 2)    /* need to specify if stopOnFail
+                         * */
+                res = production_test_ms_raw(info->test_limit_name, cmd[1], &tests);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_MSINITDATATEST:/* MS CX DATA TEST */
+            if (numberParam == 2)    /* need stopOnFail */
+                res = production_test_ms_cx(info->test_limit_name, cmd[1], &tests);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_SSRAWTEST:    /* SS RAW DATA TEST */
+            if (numberParam == 2) /* need stopOnFail */
+                res = production_test_ss_raw(info->test_limit_name, cmd[1], &tests);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_SSINITDATATEST:/* SS IX CX DATA TEST */
+            if (numberParam == 2)    /* need stopOnFail */
+                res = production_test_ss_ix_cx(info->test_limit_name, cmd[1], &tests);
+            else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        /*PRODUCTION TEST*/
+        case CMD_MAINTEST:
+            if (numberParam >= 3) {    /* need to specify if stopOnFail saveInit and mpflag(optional)*/
+                if(numberParam == 3)
+                    res = production_test_main(info->test_limit_name, cmd[1], cmd[2], &tests, MP_FLAG_OTHERS);
+                else
+                    res = production_test_main(info->test_limit_name, cmd[1], cmd[2], &tests, cmd[3]);
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_FREELIMIT:
+            res = freeCurrentLimitsFile();
+            break;
+
+        case CMD_POWERCYCLE:
+            res = fts_chip_powercycle(info);
+            break;
+
+        case CMD_GETLIMITSFILE:
+            /* need to pass: path(optional) return error code + number of byte read otherwise GUI could not now how many byte read */
+            if (numberParam >= 1) {
+                lim.data = NULL;
+                lim.size = 0;
+                if (numberParam == 1)
+                    res = getLimitsFile(info->test_limit_name, &lim);
+                else
+                    res = getLimitsFile(path, &lim);
+                readData = lim.data;
+                fileSize = lim.size;
+                size += (fileSize * sizeof(u8));
+                if (byte_call == 1)
+                    size += sizeof(u32);    /* transmit as first 4 bytes the size */
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_GETLIMITSFILE_BYTE:
+            /* need to pass: byteToRead1 byteToRead0 */
+            if (numberParam >= 3) {
+                lim.data = NULL;
+                lim.size = 0;
+
+                u8ToU16_be(&cmd[1], &byteToRead);
+                addr = ((u64)byteToRead) * 4;    /* number of words */
+
+                res = getLimitsFile(info->test_limit_name, &lim);
+
+                readData = lim.data;
+                fileSize = lim.size;
+
+                if (fileSize > addr) {
+                    TPD_INFO("Limits dimension expected by Host is less than actual size: expected = %d, real = %d\n", byteToRead, fileSize);
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+
+                size += (addr * sizeof(u8));
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_GETFWFILE:
+            /* need to pass: from (optional) otherwise select the approach chosen at compile time */
+            if (numberParam >= 1) {
+                if (numberParam == 1)
+                    res = getFWdata(info->fw_name, &readData, &fileSize);
+                else
+                    res = getFWdata(path, &readData, &fileSize);
+
+                size += (fileSize * sizeof(u8));
+                if (byte_call == 1)
+                    size += sizeof(u32);    /* transmit as first 4 bytes the size */
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        case CMD_GETFWFILE_BYTE:
+            /* need to pass: byteToRead1 byteToRead0 */
+            if (numberParam == 3) {
+                u8ToU16_be(&cmd[1], &byteToRead);
+                addr = ((u64)byteToRead) * 4;    /* number of words */
+
+                res = getFWdata(info->fw_name, &readData, &fileSize);
+                if (fileSize > addr) {
+                    TPD_INFO("FW dimension expected by Host is less than actual size: expected = %d, real = %d\n", byteToRead, fileSize);
+                    res = ERROR_OP_NOT_ALLOW;
+                }
+
+                size += (addr * sizeof(u8));    /* return always the amount requested by host, if real size is smaller, the data are padded to zero */
+            } else {
+                TPD_INFO("Wrong number of parameters!\n");
+                res = ERROR_OP_NOT_ALLOW;
+            }
+            break;
+
+        /* finish all the diagnostic command with a goto ERROR in order
+         * to skip the modification on driver_test_buff */
+        /* remember to set properly the limit and printed variables in
+         * order to make the seq_file logic to work */
+        case CMD_DIAGNOSTIC:
+            index = 0;
+            size = 0;
+            fileSize = 256 * 1024 * sizeof(char);
+            driver_test_buff = (u8 *)kzalloc(fileSize, GFP_KERNEL);
+            readData = (u8 *)kzalloc((ERROR_DUMP_ROW_SIZE * ERROR_DUMP_COL_SIZE) * sizeof(u8), GFP_KERNEL);
+            if (driver_test_buff == NULL || readData == NULL) {
+                res = ERROR_ALLOC;
+                TPD_INFO("Impossible allocate memory for buffers! ERROR %08X!\n", res);
+                goto END;
+            }
+            j = snprintf(&driver_test_buff[index], fileSize - index, "DIAGNOSTIC TEST:\n1) I2C Test: ");
+            index += j;
+
+            res = fts_writeReadU8UX(FTS_CMD_HW_REG_R, ADDR_SIZE_HW_REG, ADDR_DCHIP_ID, (u8 *)&temp, 2, DUMMY_HW_REG);
+            if (res < OK) {
+                TPD_INFO("Error during I2C test: ERROR %08X!\n", res);
+                j = snprintf(&driver_test_buff[index], fileSize - index, "ERROR %08X\n", res);
+                index += j;
+                res = ERROR_OP_NOT_ALLOW;
+                goto END_DIAGNOSTIC;
+            }
+
+            temp &= 0xFFFF;
+            TPD_INFO("Chip ID = %04X!\n", temp);
+            j = snprintf(&driver_test_buff[index], fileSize - index, "DATA = %04X, expected = %02X%02X\n", temp, DCHIP_ID_1, DCHIP_ID_0);
+            index += j;
+            if (temp != ((DCHIP_ID_1 << 8) | DCHIP_ID_0)) {
+                TPD_INFO("Wrong CHIP ID, Diagnostic failed!\n");
+                res = ERROR_OP_NOT_ALLOW;
+                goto END_DIAGNOSTIC;
+            }
+
+            j = snprintf(&driver_test_buff[index], fileSize - index, "2) FW running: Sensing On...");
+            index += j;
+            TPD_INFO("Sensing On!\n");
+            readData[0] = FTS_CMD_SCAN_MODE;
+            readData[1] = SCAN_MODE_ACTIVE;
+            readData[2] = 0x1;
+            fts_write(readData, 3);
+            res = checkEcho(readData, 3);
+            if (res < OK) {
+                TPD_INFO("No Echo received.. ERROR %08X !\n",res);
+                j = snprintf(&driver_test_buff[index], fileSize - index, "No echo found... ERROR %08X!\n", res);
+                index += j;
+                goto END_DIAGNOSTIC;
+            } else {
+                TPD_INFO("Echo FOUND... OK!\n");
+                j = snprintf(&driver_test_buff[index], fileSize - index, "Echo FOUND... OK!\n");
+                index += j;
+            }
+
+            TPD_INFO("Reading Frames...!\n");
+            j = snprintf(&driver_test_buff[index], fileSize - index, "3) Read Frames:\n");
+            index += j;
+            for (temp = 0; temp < DIAGNOSTIC_NUM_FRAME; temp++) {
+                TPD_INFO("Iteration n. %d...\n", temp + 1);
+                j = snprintf(&driver_test_buff[index], fileSize - index, "Iteration n. %d...\n", temp + 1);
+                index += j;
+                for (addr = 0; addr < 3; addr++) {
+                    switch (addr) {
+                    case 0:
+                        j = snprintf( &driver_test_buff[index], fileSize - index, "MS RAW FRAME =");
+                        index += j;
+                        res |= getMSFrame3(MS_RAW, &frameMS);
+                        break;
+                    case 2:
+                        j = snprintf( &driver_test_buff[index], fileSize - index, "MS STRENGTH FRAME =");
+                        index += j;
+                        res |= getMSFrame3(MS_STRENGTH, &frameMS);
+                        break;
+                    case 1:
+                        j = snprintf(&driver_test_buff[index], fileSize - index, "MS BASELINE FRAME =");
+                        index += j;
+                        res |= getMSFrame3(MS_BASELINE, &frameMS);
+                        break;
+                    }
+                    if (res < OK) {
+                        j = snprintf(&driver_test_buff[index], fileSize - index, "No data! ERROR %08X\n", res);
+                        index += j;
+                    } else {
+                        for (address = 0; address < frameMS.node_data_size; address++) {
+                            if (address % frameMS.header.sense_node == 0) {
+                                j = snprintf(&driver_test_buff[index], fileSize - index, "\n");
+                                index += j;
+                            }
+                            j = snprintf(&driver_test_buff[index],fileSize -index,"%5d, ",frameMS.node_data[address]);
+                            index += j;
+                        }
+                        j = snprintf(&driver_test_buff[index],fileSize - index, "\n");
+                        index += j;
+                    }
+                    if (frameMS.node_data != NULL)
+                        kfree(frameMS.node_data);
+                }
+                for (addr = 0; addr < 3; addr++) {
+                    switch (addr) {
+                    case 0:
+                        j = snprintf(&driver_test_buff[index],fileSize - index,"SS RAW FRAME =\n");
+                        index += j;
+                        res |= getSSFrame3(SS_RAW,&frameSS);
+                        break;
+                    case 2:
+                        j = snprintf(&driver_test_buff[index],fileSize - index,"SS STRENGTH FRAME =\n");
+                        index += j;
+                        res |= getSSFrame3(SS_STRENGTH,&frameSS);
+                        break;
+                    case 1:
+                        j = snprintf(&driver_test_buff[index],fileSize - index,"SS BASELINE FRAME =\n");
+                        index += j;
+                        res |= getSSFrame3(SS_BASELINE,&frameSS);
+                        break;
+                    }
+                    if (res < OK) {
+                        j = snprintf(&driver_test_buff[index],fileSize - index,"No data! ERROR %08X\n",res);
+                        index += j;
+                    } else {
+                        for (address = 0; address < frameSS.header.force_node; address++) {
+                            j = snprintf(&driver_test_buff[index], fileSize -index, "%d\n", frameSS.force_data[address]);
+                            index += j;
+                        }
+                        for (address = 0; address < frameSS.header.sense_node; address++) {
+                            j = snprintf(&driver_test_buff[index], fileSize - index, "%d, ", frameSS.sense_data[address]);
+                            index += j;
+                        }
+                        j = snprintf(&driver_test_buff[index], fileSize - index, "\n");
+                        index += j;
+                    }
+                    if (frameSS.force_data != NULL)
+                        kfree(frameSS.force_data);
+                    if (frameSS.sense_data != NULL)
+                        kfree(frameSS.sense_data);
+                }
+            }
+
+
+            TPD_INFO("Reading error info...\n");
+            j = snprintf(&driver_test_buff[index], fileSize - index,
+                     "4) FW INFO DUMP: ");
+            index += j;
+            temp = dumpErrorInfo(readData, ERROR_DUMP_ROW_SIZE *
+                         ERROR_DUMP_COL_SIZE);
+            /* OR to detect if there are failures also in the
+             * previous reading of frames and write the correct
+             * result */
+            if (temp < OK) {
+                TPD_INFO("Error during dump: ERROR %08X!\n", res);
+                j = snprintf(&driver_test_buff[index],fileSize - index, "ERROR %08X\n",temp);
+                index += j;
+            } else {
+                TPD_INFO("DUMP OK!\n");
+                for (temp = 0; temp < ERROR_DUMP_ROW_SIZE *
+                     ERROR_DUMP_COL_SIZE; temp++) {
+                    if (temp % ERROR_DUMP_COL_SIZE == 0) {
+                        j = snprintf(&driver_test_buff[index],fileSize - index,"\n%2d - ", temp / ERROR_DUMP_COL_SIZE);
+                        index += j;
+                    }
+                    j = snprintf(&driver_test_buff[index],fileSize - index, "%02X ", readData[temp]);
+                    index += j;
+                }
+            }
+            res |= temp;
+
+END_DIAGNOSTIC:
+            if (res < OK) {
+                j = snprintf(&driver_test_buff[index],fileSize - index,"\nRESULT = FAIL\n");
+                index += j;
+            } else {
+                j = snprintf(&driver_test_buff[index],fileSize - index,"\nRESULT = FINISHED\n");
+                index += j;
+            }
+            /* the sting is already terminated with the null char by snprintf */
+            limit = index;
+            printed = 0;
+            goto ERROR;
+            break;
+
+        default:
+            TPD_INFO("COMMAND ID NOT VALID!!!\n");
+            res = ERROR_OP_NOT_ALLOW;
+            break;
+        }
+
+    } else {
+        TPD_INFO("NO COMMAND SPECIFIED!!! do: 'echo [cmd_code] [args] > stm_fts_cmd' before looking for result!\n");
+        res = ERROR_OP_NOT_ALLOW;
+    }
+
+END:    /* here start the reporting phase, assembling the data to send in the file node */
+    if (driver_test_buff != NULL) {
+        TPD_INFO("Consecutive echo on the file node, free the buffer with the previous result\n");
+        kfree(driver_test_buff);
+    }
+
+    if (byte_call == 0) {
+        size *= 2;
+        size += 2;    /* add \n and \0 (terminator char) */
+    } else {
+        if (bin_output != 1) {
+            size *= 2; /* need to code each byte as HEX string */
+            size -= 1;    /* start byte is just one, the extra byte of end byte taken by \n */
+        } else
+            size += 1;    /* add \n */
+    }
+
+    TPD_DEBUG("Size = %d\n", size);
+    driver_test_buff = (u8 *)kzalloc(size, GFP_KERNEL);
+    TPD_DEBUG("Finish to allocate memory!\n");
+    if (driver_test_buff == NULL) {
+        TPD_DEBUG("Unable to allocate driver_test_buff! ERROR %08X\n",
+             ERROR_ALLOC);
+        goto ERROR;
+    }
+
+    if (byte_call == 0) {
+        index = 0;
+        snprintf(&driver_test_buff[index], 3, "{ ");
+        index += 2;
+        snprintf(&driver_test_buff[index], 9, "%08X", res);
+
+        index += 8;
+        if (res >= OK) {
+            /*all the other cases are already fine printing only the res.*/
+            switch (funcToTest[0]) {
+            case CMD_READ:
+            case CMD_WRITEREAD:
+            case CMD_WRITETHENWRITEREAD:
+            case CMD_WRITEREADU8UX:
+            case CMD_WRITEU8UXTHENWRITEREADU8UX:
+            case CMD_READCONFIG:
+            case CMD_POLLFOREVENT:
+                /* TPD_DEBUG("Data = "); */
+                if (mess.dummy == 1)
+                    j = 1;
+                else
+                    j = 0;
+                for (; j < byteToRead + mess.dummy; j++) {
+                    /* TPD_DEBUG( "%02X ", readData[j]); */
+                    snprintf(&driver_test_buff[index], 3,"%02X", readData[j]);
+                    /* this approach is much more faster */
+                    index += 2;
+                }
+                /* TPD_DEBUG( "\n"); */
+                break;
+            case CMD_GETFWFILE:
+            case CMD_GETLIMITSFILE:
+                TPD_DEBUG("Start To parse!\n");
+                for (j = 0; j < fileSize; j++) {
+                    /* TPD_DEBUG( "%02X ", readData[j]); */
+                    snprintf(&driver_test_buff[index], 3,"%02X", readData[j]);
+                    index += 2;
+                }
+                TPD_DEBUG("Finish to parse!\n");
+                break;
+
+            case CMD_GETFORCELEN:
+            case CMD_GETSENSELEN:
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)temp);
+                index += 2;
+
+                break;
+
+
+            case CMD_GETMSFRAME:
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameMS.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameMS.header.sense_node);
+                index += 2;
+
+                for (j = 0; j < frameMS.node_data_size; j++) {
+                    snprintf(&driver_test_buff[index], 5,"%02X%02X",(frameMS.node_data[j] &0xFF00) >> 8,frameMS.node_data[j] &0xFF);
+                    index += 4;
+                }
+
+                kfree(frameMS.node_data);
+                break;
+
+            case CMD_GETSSFRAME:
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameSS.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameSS.header.sense_node);
+                index += 2;
+                /* Copying self raw data Force */
+                for (j = 0; j < frameSS.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 5,"%02X%02X",(frameSS.force_data[j] &0xFF00) >> 8,frameSS.force_data[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying self raw data Sense */
+                for (j = 0; j < frameSS.header.sense_node; j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X",(frameSS.sense_data[j] &0xFF00) >> 8,frameSS.sense_data[j] &0xFF);
+                    index += 4;
+                }
+
+                kfree(frameSS.force_data);
+                kfree(frameSS.sense_data);
+                break;
+
+            case CMD_GETSYNCFRAME:
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameMS.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameMS.header.sense_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameSS.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)frameSS.header.sense_node);
+                index += 2;
+
+                /* Copying mutual data */
+                for (j = 0; j < frameMS.node_data_size; j++) {
+                    snprintf(&driver_test_buff[index], 5,"%02X%02X",(frameMS.node_data[j] &0xFF00) >> 8,frameMS.node_data[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying self data Force */
+                for (j = 0; j < frameSS.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 5,"%02X%02X",(frameSS.force_data[j] &0xFF00) >> 8,frameSS.force_data[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying self  data Sense */
+                for (j = 0; j < frameSS.header.sense_node; j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X",(frameSS.sense_data[j] &0xFF00) >> 8,frameSS.sense_data[j] &0xFF);
+                    index += 4;
+                }
+
+                kfree(frameMS.node_data);
+                kfree(frameSS.force_data);
+                kfree(frameSS.sense_data);
+                break;
+
+            case CMD_READMSCOMPDATA:
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)compData.header.type);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)compData.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)compData.header.sense_node);
+                index += 2;
+
+                /* Cpying CX1 value */
+                snprintf(&driver_test_buff[index], 3, "%02X", compData.cx1 & 0xFF);
+                index += 2;
+
+                /* Copying CX2 values */
+                for (j = 0; j < compData.node_data_size; j++) {
+                    snprintf(&driver_test_buff[index], 3, "%02X", compData.node_data[j] &0xFF);
+                    index += 2;
+                }
+
+                kfree(compData.node_data);
+                break;
+
+            case CMD_READSSCOMPDATA:
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)comData.header.type);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.header.force_node);
+                index += 2;
+
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.header.sense_node);
+                index += 2;
+
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.f_ix1 & 0xFF);
+                index += 2;
+
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.s_ix1 & 0xFF);
+                index += 2;
+
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.f_cx1 & 0xFF);
+                index += 2;
+
+
+                snprintf(&driver_test_buff[index], 3, "%02X", comData.s_cx1 & 0xFF);
+                index += 2;
+
+                /* Copying IX2 Force */
+                for (j = 0; j < comData.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 3,"%02X", comData.ix2_fm[j] &0xFF);
+                    index += 2;
+                }
+
+                /* Copying IX2 Sense */
+                for (j = 0; j < comData.header.sense_node; j++) {
+                    snprintf(&driver_test_buff[index], 3, "%02X", comData.ix2_sn[j] &0xFF);
+                    index += 2;
+                }
+
+                /* Copying CX2 Force */
+                for (j = 0; j < comData.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 3, "%02X", comData.cx2_fm[j] &0xFF);
+
+                    index += 2;
+                }
+
+                /* Copying CX2 Sense */
+                for (j = 0; j < comData.header.sense_node;j++) {
+                    snprintf(&driver_test_buff[index], 3, "%02X", comData.cx2_sn[j] &0xFF);
+                    index += 2;
+                }
+
+                kfree(comData.ix2_fm);
+                kfree(comData.ix2_sn);
+                kfree(comData.cx2_fm);
+                kfree(comData.cx2_sn);
+                break;
+
+            case CMD_READTOTMSCOMPDATA:
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)totCompData.header.type);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)totCompData.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X", (u8)totCompData.header.sense_node);
+
+                index += 2;
+
+                /* Copying TOT CX values */
+                for (j = 0; j < totCompData.node_data_size; j++) {
+                    snprintf(&driver_test_buff[index], 5,"%02X%02X", (totCompData.node_data[j] &0xFF00) >> 8, totCompData.node_data[j] &0xFF);
+                    index += 4;
+                }
+
+                kfree(totCompData.node_data);
+                break;
+
+            case CMD_READTOTSSCOMPDATA:
+                snprintf(&driver_test_buff[index], 3, "%02X",(u8)totComData.header.type);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",totComData.header.force_node);
+                index += 2;
+
+                snprintf(&driver_test_buff[index], 3, "%02X",totComData.header.sense_node);
+                index += 2;
+
+                /* Copying TOT IX Force */
+                for (j = 0; j < totComData.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X", (totComData.ix_fm[j] &0xFF00) >> 8, totComData.ix_fm[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying TOT IX Sense */
+                for (j = 0; j < totComData.header.sense_node;j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X", (totComData.ix_sn[j] &0xFF00) >> 8, totComData.ix_sn[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying TOT CX Force */
+                for (j = 0; j < totComData.header.force_node; j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X", (totComData.cx_fm[j] &0xFF00) >> 8, totComData.cx_fm[j] &0xFF);
+                    index += 4;
+                }
+
+                /* Copying CX2 Sense */
+                for (j = 0; j < totComData.header.sense_node; j++) {
+                    snprintf(&driver_test_buff[index], 5, "%02X%02X", (totComData.cx_sn[j] &0xFF00) >> 8, totComData.cx_sn[j] &0xFF);
+                    index += 4;
+                }
+
+                kfree(totComData.ix_fm);
+                kfree(totComData.ix_sn);
+                kfree(totComData.cx_fm);
+                kfree(totComData.cx_sn);
+                break;
+
+            case CMD_GETFWVER:
+                for (j = 0; j < EXTERNAL_RELEASE_INFO_SIZE; j++) {
+                    snprintf(&driver_test_buff[index], 3, "%02X", systemInfo.u8_releaseInfo[j]);
+                    index += 2;
+                }
+                break;
+
+            case CMD_READCOMPDATAHEAD:
+                snprintf(&driver_test_buff[index], 3, "%02X", dataHead.type);
+                index += 2;
+                break;
+
+            default:
+                break;
+            }
+        }
+
+        snprintf(&driver_test_buff[index], 4, " }\n");
+        limit = size - 1;/* avoid to print \0 in the shell */
+        printed = 0;
+    } else {
+        /* start byte */
+        driver_test_buff[index++] = MESSAGE_START_BYTE;
+        if (bin_output == 1) {
+            /* msg_size */
+            driver_test_buff[index++] = (size & 0xFF00) >> 8;
+            driver_test_buff[index++] = (size & 0x00FF);
+            /* counter id */
+            driver_test_buff[index++] = (mess.counter & 0xFF00) >> 8;
+            driver_test_buff[index++] = (mess.counter & 0x00FF);
+            /* action */
+            driver_test_buff[index++] = (mess.action & 0xFF00) >> 8;
+            driver_test_buff[index++] = (mess.action & 0x00FF);
+            /* error */
+            driver_test_buff[index++] = (res & 0xFF00) >> 8;
+            driver_test_buff[index++] = (res & 0x00FF);
+        } else {
+            if (funcToTest[0] == CMD_GETLIMITSFILE_BYTE || funcToTest[0] == CMD_GETFWFILE_BYTE)
+                snprintf(&driver_test_buff[index], 5, "%02X%02X", (((fileSize + 3) / 4) &0xFF00) >> 8, ((fileSize + 3) / 4) & 0x00FF);
+            else
+                snprintf(&driver_test_buff[index], 5, "%02X%02X", (size & 0xFF00) >> 8, size & 0xFF);
+            index += 4;
+            index += snprintf(&driver_test_buff[index], 5, "%04X", (u16)mess.counter);
+            index += snprintf(&driver_test_buff[index], 5, "%04X", (u16)mess.action);
+            index += snprintf(&driver_test_buff[index], 5, "%02X%02X", (res & 0xFF00) >> 8, res &0xFF);
+        }
+
+        switch (funcToTest[0]) {
+        case CMD_READ_BYTE:
+        case CMD_WRITEREAD_BYTE:
+        case CMD_WRITETHENWRITEREAD_BYTE:
+        case CMD_WRITEREADU8UX_BYTE:
+        case CMD_WRITEU8UXTHENWRITEREADU8UX_BYTE:
+            if (bin_output == 1) {
+                if (mess.dummy == 1)
+                    memcpy(&driver_test_buff[index], &readData[1], byteToRead);
+                else
+                    memcpy(&driver_test_buff[index], readData, byteToRead);
+                index += byteToRead;
+            } else {
+                j = mess.dummy;
+                for (; j < byteToRead + mess.dummy; j++)
+                    index += snprintf(&driver_test_buff[index], 3, "%02X", (u8)readData[j]);
+            }
+            break;
+
+        case CMD_GETLIMITSFILE_BYTE:
+        case CMD_GETFWFILE_BYTE:
+            if (bin_output == 1) {
+                /* override the msg_size with dimension in words */
+                driver_test_buff[1] = (((fileSize + 3) / 4) &0xFF00) >> 8;
+                driver_test_buff[2] = (((fileSize + 3) / 4) &0x00FF);
+
+                if (readData != NULL)
+                    memcpy(&driver_test_buff[index], readData, fileSize);
+                else
+                    TPD_DEBUG("readData = NULL... returning junk data!");
+                index += addr;  /* in this case the byte to read
+                                 * are stored in addr because it
+                                 * is a u64 end byte need to be
+                                 * inserted at the end of the
+                                 * padded memory */
+            } else {
+                for (j = 0; j < fileSize; j++)
+                    index += snprintf(&driver_test_buff[index], 3, "%02X", (u8)readData[j]);
+                for (; j < addr; j++)
+                    index += snprintf(&driver_test_buff[index], 3,"%02X", 0);    /* pad memory with 0x00 */
+            }
+            break;
+        default:
+            break;
+        }
+
+        driver_test_buff[index++] = MESSAGE_END_BYTE;
+        driver_test_buff[index] = '\n';
+        limit = size;
+        printed = 0;
+    }
+ERROR:
+    numberParam = 0;/* need to reset the number of parameters in order to wait the next command, comment if you want to repeat
+                     * the last comand sent just doing a cat */
+    /* TPD_DEBUG("numberParameters = %d\n",numberParam); */
+    if (readData != NULL)
+        kfree(readData);
+
+    return count;
+}
+
+/**
+  * file_operations struct which define the functions for the canonical
+  * operation on a device file node (open. read, write etc.)
+  */
+static const struct file_operations fts_driver_test_ops = {
+    .open        = fts_open,
+    .read        = seq_read,
+    .write       = fts_driver_test_write,
+    .llseek      = seq_lseek,
+    .release     = seq_release
+};
+
+/*****************************************************************************/
+
+/**
+  * This function is called in the probe to initialize and create the directory
+  * proc/fts and the driver test file node DRIVER_TEST_FILE_NODE into the /proc
+  * file system
+  * @return OK if success or an error code which specify the type of error
+  */
+int fts_proc_init(struct touchpanel_data *ts)
+{
+    struct proc_dir_entry *entry;
+    struct fts_ts_info *info = ts->chip_data;
+
+    int retval = 0;
+
+
+    fts_dir = proc_mkdir_data("fts", 0777, ts->prEntry_tp, ts);
+    if (fts_dir == NULL) {    /* directory creation failed */
+        retval = -ENOMEM;
+        goto out;
+    }
+
+    entry = proc_create_data(DRIVER_TEST_FILE_NODE, 0777, fts_dir, &fts_driver_test_ops, info);
+
+    if (entry)
+        TPD_INFO("%s: proc entry CREATED!\n", __func__);
+    else {
+        TPD_INFO("%s: error creating proc entry!\n", __func__);
+        retval = -ENOMEM;
+        goto badfile;
+    }
+
+    return OK;
+badfile:
+    remove_proc_entry("fts", ts->prEntry_tp);
+out:
+    return retval;
+}
+
+/**
+  * Delete and Clean from the file system, all the references to the driver test
+  * file node
+  * @return OK
+  */
+void fts_proc_remove(struct touchpanel_data *ts)
+{
+    remove_proc_entry(DRIVER_TEST_FILE_NODE, fts_dir);
+    remove_proc_entry("fts", ts->prEntry_tp);
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.c b/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..12848cbf6c43de96a82e6cb1b9bee0d63d43a40a
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.c
@@ -0,0 +1,217 @@
+/***************************************************
+ * File:st_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             st common driver
+ * Version:1.0:
+ * Date created:2018/10/26
+ * Author: Zengpeng.Chen@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "../touchpanel_common.h"
+#include "st_common.h"
+#include <linux/crc32.h>
+
+
+/*******Part0:LOG TAG Declear********************/
+
+#define TPD_DEVICE "st_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+/* st get usb state */
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern unsigned int upmu_get_rgs_chrdet(void);
+int st_get_usb_state(void)
+{
+    return upmu_get_rgs_chrdet();
+}
+#else
+
+int st_get_usb_state(void)
+{
+    return 0;
+}
+#endif
+
+/* proc/touchpanel/st_auto_test */
+static int tp_auto_test_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct st_proc_operations *st_ops;
+    if (!ts)
+        return 0;
+    st_ops = (struct st_proc_operations *)ts->private_data;
+    if (!st_ops)
+        return 0;
+    if (!st_ops->auto_test || !st_ops->init_test_iterm) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+
+    /* if resume not completed, do not do screen on test */
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume state\n");
+        return 0;
+    }
+
+    /* step1:disable_irq && get mutex locked */
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+
+    ts->in_test_process = true;
+
+    /* step2:init st_test_data */
+    //st_ops->init_test_iterm(ts->panel_data.test_limit_name);
+
+    /* step3:execute st auto test func */
+    st_ops->auto_test(s, ts->chip_data, ts->panel_data.test_limit_name);
+
+    /* step4: return to normal mode */
+    ts->ts_ops->reset(ts->chip_data);
+    operate_mode_switch(ts);
+
+    /* step5: unlock the mutex && enable irq trigger */
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+
+    ts->in_test_process = false;
+    return 0;
+}
+
+
+
+/* common driver full panel auto test open func */
+static int st_autotest_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_auto_test_read_func, PDE_DATA(inode));
+}
+
+/* common driver full panel auto test func file ops */
+static const struct file_operations tp_auto_test_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = st_autotest_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+
+static int calibrate_fops_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct st_proc_operations *st_ops = (struct st_proc_operations *)ts->private_data;
+
+    if (!st_ops->calibrate)
+        return 0;
+
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+    if (!ts->touch_count) {
+        st_ops->calibrate(s, ts->chip_data);
+    } else {
+        seq_printf(s, "1 error, release touch on the screen\n");
+    }
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int proc_calibrate_fops_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, calibrate_fops_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations proc_calibrate_fops = {
+    .owner = THIS_MODULE,
+    .open  = proc_calibrate_fops_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int verify_fops_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct st_proc_operations *st_ops = (struct st_proc_operations *)ts->private_data;
+
+    if (!st_ops->verify_calibration)
+        return 0;
+
+    disable_irq_nosync(ts->irq);
+    mutex_lock(&ts->mutex);
+    if (!ts->touch_count) {
+        st_ops->verify_calibration(s, ts->chip_data);
+    } else {
+        seq_printf(s, "1 error, skip verify when touch on screen\n");
+    }
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->irq);
+
+    return 0;
+}
+
+static int proc_verify_fops_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, verify_fops_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations proc_verify_fops = {
+    .owner = THIS_MODULE,
+    .open  = proc_verify_fops_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+
+/* st create proc file node func */
+int st_create_proc(struct touchpanel_data *ts, struct st_proc_operations *st_ops)
+{
+    int ret = 0;
+
+    /* touchpanel_auto_test interface */
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    ts->private_data = st_ops;
+    prEntry_tmp = proc_create_data("baseline_test", 0666, ts->prEntry_tp, &tp_auto_test_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+	prEntry_tmp = proc_create_data("calibration", 0666, ts->prEntry_tp, &proc_calibrate_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("calibration_verify", 0666, ts->prEntry_tp, &proc_verify_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    return ret;
+}
+
+/* st remove proc file node func */
+void st_proc_remove(struct touchpanel_data *ts)
+{
+    remove_proc_entry("baseline_test", ts->prEntry_tp);
+}
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.h b/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..2bc9ec3cd0e540dff46136a2f97668ccd52a4fb8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/St/st_common.h
@@ -0,0 +1,41 @@
+/***************************************************
+ * File:st_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             st common driver
+ * Version:1.0:
+ * Date created:2018/10/26
+ * Author: Zengpeng.Chen@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef ST_H
+#define ST_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+
+
+//st common proc file ops
+struct st_proc_operations {
+    void (*auto_test)    (struct seq_file *s, void *chip_data, char *path_limits);
+    int (*init_test_iterm)  (char *path_limits);
+	void (*calibrate)    		(struct seq_file *s, void *chip_data);
+    void (*verify_calibration)    (struct seq_file *s, void *chip_data);
+};
+
+//funtion declaration
+int st_create_proc(struct touchpanel_data *ts, struct st_proc_operations *st_ops);
+void st_proc_remove(struct touchpanel_data *ts);
+int st_get_usb_state(void);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..2c67e735437f6d19bb240dcf73fe94d59dafd2ed
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Kconfig
@@ -0,0 +1,8 @@
+
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Kconfig"
+source "drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Kconfig"
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..acb766bd9c610e759c642b86a907f7d8acc2d5bf
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Makefile
@@ -0,0 +1,17 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3508) += S3508/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3320) += S3320/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3706) += S3706/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S4322) += S4322/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TD4310) += TD4310/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S1302) += S1302_virtal_key/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TCM) += Syna_tcm/
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS) += synaptics_touch_panel_remote.o
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS) += synaptics_common.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..bf72623468b8a11c965fa82dea1d929593ed5747
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Kconfig
@@ -0,0 +1,9 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+config TOUCHPANEL_SYNAPTICS_S1302
+#	default y
+	bool "TP Synaptics_S3508 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics s3508
+	
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..c7155628e6ba25516b8dbfcc23d89bfccd6da5b1
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/Makefile
@@ -0,0 +1,8 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS) += synaptics_touch_key.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/synaptics_touch_key.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/synaptics_touch_key.c
new file mode 100644
index 0000000000000000000000000000000000000000..d8c685231ac06185c757064196a8612d099c1cfb
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S1302_virtal_key/synaptics_touch_key.c
@@ -0,0 +1,2331 @@
+/***************************************************
+ * File:synaptics_touch_key.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics s1302 touch key driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/i2c.h>
+#include <linux/gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <linux/input.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/proc_fs.h>
+#include <linux/hrtimer.h>
+#include <linux/proc_fs.h>
+#include <linux/interrupt.h>
+
+#include <linux/regulator/consumer.h>
+#include <linux/firmware.h>
+
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include <linux/input/mt.h>
+
+/*------------------------------------------------Global Define--------------------------------------------*/
+#define PAGESIZE 512
+#define VKNUMBER 3
+#define TP_TEST_ENABLE 1
+
+#undef LCD_TRIGGER_KEY_FORCE_CAL
+#define SUPPORT_TP_SLEEP_MODE
+#define TYPE_B_PROTOCOL      //Multi-finger operation
+#define TP_FW_NAME_MAX_LEN 128
+
+/******************for Red function*****************/
+#undef CONFIG_SYNAPTIC_RED
+
+#define TPD_DEVICE "synaptics-s1302"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (tp_debug)\
+        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+/*---------------------------------------------Global Variable----------------------------------------------*/
+static int baseline_ret = 0;
+static unsigned int is_suspend = 0;
+static int16_t delta_baseline[30][30];
+
+static unsigned int tp_debug = 0;
+static int force_update = 0;
+static int key_reverse = 0;
+static struct synaptics_ts_data *ts_g = NULL;
+int test_err = 0;
+
+/*-----------------------------------------Global Registers----------------------------------------------*/
+static unsigned short SynaF34DataBase;
+static unsigned short SynaF34QueryBase;
+static unsigned short SynaF01DataBase;
+static unsigned short SynaF01CommandBase;
+
+static unsigned short SynaF34Reflash_BlockNum;
+static unsigned short SynaF34Reflash_BlockData;
+static unsigned short SynaF34ReflashQuery_BootID;
+static unsigned short SynaF34ReflashQuery_FlashPropertyQuery;
+static unsigned short SynaF34ReflashQuery_FirmwareBlockSize;
+static unsigned short SynaF34ReflashQuery_FirmwareBlockCount;
+static unsigned short SynaF34ReflashQuery_ConfigBlockSize;
+static unsigned short SynaF34ReflashQuery_ConfigBlockCount;
+
+static unsigned short SynaFirmwareBlockSize;
+static unsigned short SynaF34_FlashControl;
+
+static int F01_RMI_QUERY_BASE;
+static int F01_RMI_CMD_BASE;
+
+static int F01_RMI_DATA_BASE;
+
+static int F11_2D_QUERY_BASE;
+static int F11_2D_CMD_BASE;
+static int F11_2D_CTRL_BASE;
+static int F11_2D_DATA_BASE;
+
+static int F34_FLASH_QUERY_BASE;
+static int F34_FLASH_CMD_BASE;
+static int F34_FLASH_CTRL_BASE;
+static int F34_FLASH_DATA_BASE;
+
+static int F51_CUSTOM_QUERY_BASE;
+static int F51_CUSTOM_CMD_BASE;
+static int F51_CUSTOM_CTRL_BASE;
+static int F51_CUSTOM_DATA_BASE;
+
+static int F01_RMI_CMD00;
+static int F01_RMI_CTRL00;
+static int F01_RMI_CTRL01;
+
+#if TP_TEST_ENABLE
+static int synaptics_read_register_map_page1(struct synaptics_ts_data *ts);
+static int F54_ANALOG_QUERY_BASE;//0x73
+static int F54_ANALOG_COMMAND_BASE;//0x72
+static int F54_ANALOG_CONTROL_BASE;//0x0d
+static int F54_ANALOG_DATA_BASE;//0x00
+#endif
+
+int KEY_FW;
+static struct manufacture_info touch_key_info;
+extern void input_report_key_oppo(struct input_dev *dev, unsigned int code, int value);
+/*------------------------------------------Fuction Declare----------------------------------------------*/
+static int synaptics_ts_resume(struct device *dev);
+static int synaptics_ts_suspend(struct device *dev);
+static int synaptics_ts_remove(struct i2c_client *client);
+static int synaptics_ts_probe(struct i2c_client *client, const struct i2c_device_id *id);
+static int synapitcs_ts_update(struct i2c_client *client, const uint8_t *data, uint32_t data_len, bool force);
+
+static int synaptics_rmi4_i2c_read_block(struct i2c_client* client,
+        unsigned char addr, unsigned short length, unsigned char *data);
+
+static int synaptics_rmi4_i2c_write_block(struct i2c_client* client,
+        unsigned char addr, unsigned short length, unsigned char const *data);
+
+static int synaptics_rmi4_i2c_read_byte(struct i2c_client* client,
+        unsigned char addr);
+
+static int synaptics_rmi4_i2c_write_byte(struct i2c_client* client,
+        unsigned char addr, unsigned char data);
+
+static int synaptics_rmi4_i2c_read_word(struct i2c_client* client,
+        unsigned char addr);
+
+static int synaptics_init_panel(struct synaptics_ts_data *ts);
+static void checkCMD(void);
+
+#if defined(CONFIG_FB)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data);
+#endif
+static int synaptics_soft_reset(struct synaptics_ts_data *ts);
+static void synaptics_hard_reset(struct synaptics_ts_data *ts);
+
+/*-------------------------------Using Struct----------------------------------*/
+static const struct i2c_device_id synaptics_ts_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id synaptics_match_table[] = {
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops synaptic_pm_ops = {
+#ifdef CONFIG_PM
+    .suspend = NULL,
+    .resume = NULL,
+#else
+    .suspend = NULL,
+    .resume = NULL,
+#endif
+};
+
+static struct workqueue_struct *speedup_resume_wq = NULL;
+static void speedup_synaptics_resume(struct work_struct *work);
+
+static struct i2c_driver tc_i2c_driver = {
+    .probe        = synaptics_ts_probe,
+    .remove        = synaptics_ts_remove,
+    .id_table    = synaptics_ts_id,
+    .driver = {
+        //        .owner  = THIS_MODULE,
+        .name    = TPD_DEVICE,
+        .of_match_table = synaptics_match_table,
+        .pm = &synaptic_pm_ops,
+    },
+};
+
+struct synaptics_ts_data {
+    struct i2c_client *client;
+    struct mutex mutex;
+    int irq;
+    int irq_gpio;
+    int reset_gpio;
+    int en3v_gpio;
+    int enable_remote;
+    int boot_mode;
+    int pre_btn_state;
+    int is_suspended;
+    uint32_t irq_flags;
+    struct work_struct  work;
+    struct work_struct speed_up_work;
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+    struct work_struct judge_key_status_work ;
+#endif
+    struct input_dev *input_dev;
+#if defined(CONFIG_FB)
+    struct notifier_block fb_notif;
+#endif
+
+    /******power*******/
+    struct regulator *vdd_2v8;
+    struct regulator *vcc_i2c_1v8;
+
+    /*pinctrl******/
+    struct device                        *dev;
+    struct pinctrl                         *pinctrl;
+    struct pinctrl_state                 *pinctrl_state_active;
+    struct pinctrl_state                 *pinctrl_state_suspend;
+
+    /*******for FW update*******/
+    bool suspended;
+    bool loading_fw;
+    char fw_name[TP_FW_NAME_MAX_LEN];
+    char test_limit_name[TP_FW_NAME_MAX_LEN];
+    char fw_id[12];
+    char manu_name[12];
+};
+
+#define SYNAPTICS_RMI4_PRODUCT_ID_SIZE 10
+#define SYNAPTICS_RMI4_PRODUCT_INFO_SIZE 2
+struct image_header {
+    /* 0x00 - 0x0f */
+    unsigned char checksum[4];
+    unsigned char reserved_04;
+    unsigned char reserved_05;
+    unsigned char options_firmware_id:1;
+    unsigned char options_contain_bootloader:1;
+    unsigned char options_reserved:6;
+    unsigned char bootloader_version;
+    unsigned char firmware_size[4];
+    unsigned char config_size[4];
+    /* 0x10 - 0x1f */
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE];
+    unsigned char package_id[2];
+    unsigned char package_id_revision[2];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+    /* 0x20 - 0x2f */
+    unsigned char reserved_20_2f[16];
+    /* 0x30 - 0x3f */
+    unsigned char ds_id[16];
+    /* 0x40 - 0x4f */
+    unsigned char ds_info[10];
+    unsigned char reserved_4a_4f[6];
+    /* 0x50 - 0x53 */
+    unsigned char firmware_id[4];
+};
+
+struct image_header_data {
+    bool contains_firmware_id;
+    unsigned int firmware_id;
+    unsigned int checksum;
+    unsigned int firmware_size;
+    unsigned int config_size;
+    unsigned char bootloader_version;
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE + 1];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+};
+
+struct test_header {
+    unsigned int magic1;
+    unsigned int magic2;
+    unsigned int withCBC;
+    unsigned int array_limit_offset;
+    unsigned int array_limit_size;
+    unsigned int array_limitcbc_offset;
+    unsigned int array_limitcbc_size;
+};
+
+static unsigned int extract_uint_le(const unsigned char *ptr)
+{
+    return (unsigned int)ptr[0] +
+        (unsigned int)ptr[1] * 0x100 +
+        (unsigned int)ptr[2] * 0x10000 +
+        (unsigned int)ptr[3] * 0x1000000;
+}
+
+static int tc_hw_pwron(struct synaptics_ts_data *ts)
+{
+    int rc = 0;
+
+    //enable the 2v8 power
+    if (!IS_ERR(ts->vdd_2v8)) {
+        rc = regulator_enable(ts->vdd_2v8);
+        if (rc) {
+            dev_err(&ts->client->dev,
+                    "Regulator vdd enable failed rc = %d\n", rc);
+        }
+    }
+
+    if (ts->en3v_gpio > 0) {
+        TPD_INFO("synaptics:enable the en3v_gpio\n");
+        gpio_direction_output(ts->en3v_gpio, 1);
+    }
+
+    if (!IS_ERR(ts->vcc_i2c_1v8)) {
+        rc = regulator_enable(ts->vcc_i2c_1v8);
+        if (rc) {
+            dev_err(&ts->client->dev, "Regulator vcc_i2c enable failed rc = %d\n", rc);
+        }
+    }
+
+    if (ts->reset_gpio > 0) {
+        TPD_DEBUG("synaptics:enable the reset_gpio\n");
+        gpio_direction_output(ts->reset_gpio, 1);
+    }
+    msleep(80); //mingqiang.guo@phone.bsp, 2016/7/7 modify synaptics tp vender need delay 80ms
+    return rc;
+}
+
+static int tc_hw_pwroff(struct synaptics_ts_data *ts)
+{
+    int rc = 0;
+    if (ts->reset_gpio > 0) {
+        TPD_INFO("synaptics:disable the reset_gpio\n");
+        gpio_direction_output(ts->reset_gpio, 0);
+    }
+
+    if (!IS_ERR(ts->vcc_i2c_1v8)) {
+        rc = regulator_disable(ts->vcc_i2c_1v8);
+        if (rc) {
+            dev_err(&ts->client->dev, "Regulator vcc_i2c enable failed rc = %d\n", rc);
+            return rc;
+        }
+    }
+
+    if (!IS_ERR(ts->vdd_2v8)) {
+        rc = regulator_disable(ts->vdd_2v8);
+        if (rc) {
+            dev_err(&ts->client->dev, "Regulator vdd disable failed rc = %d\n", rc);
+            return rc;
+        }
+    }
+
+    if (ts->en3v_gpio > 0) {
+        TPD_INFO("synaptics:disable  the en3v_gpio\n");
+        gpio_direction_output(ts->en3v_gpio, 0);
+    }
+    return rc;
+}
+
+static int tc_power(struct synaptics_ts_data *ts, unsigned int on)
+{
+    int ret;
+    if (on)
+        ret = tc_hw_pwron(ts);
+    else
+        ret = tc_hw_pwroff(ts);
+
+    return ret;
+}
+
+static int synaptics_read_register_map(struct synaptics_ts_data *ts)
+{
+    uint8_t buf[4];
+    int ret;
+    memset(buf, 0, sizeof(buf));
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("synaptics_read_register_map: failed for page select\n");
+        return -1;
+    }
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    F11_2D_QUERY_BASE = buf[0];
+    F11_2D_CMD_BASE = buf[1];
+    F11_2D_CTRL_BASE = buf[2];
+    F11_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F11_2D_QUERY_BASE = %x \n \
+            F11_2D_CMD_BASE  = %x \n\
+            F11_2D_CTRL_BASE    = %x \n\
+            F11_2D_DATA_BASE    = %x \n\
+            ", F11_2D_QUERY_BASE, F11_2D_CMD_BASE, F11_2D_CTRL_BASE, F11_2D_DATA_BASE);
+
+
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE3, 4, &(buf[0x0]));
+    F01_RMI_QUERY_BASE = buf[0];
+    F01_RMI_CMD_BASE = buf[1];
+    F01_RMI_CTRL00 = buf[2];
+    F01_RMI_DATA_BASE = buf[3];
+    TPD_DEBUG("F01_RMI_QUERY_BASE = %x \n\
+            F01_RMI_CMD_BASE  = %x \n\
+            F01_RMI_CTRL00    = %x \n\
+            F01_RMI_DATA_BASE    = %x \n\
+            ", F01_RMI_QUERY_BASE, F01_RMI_CMD_BASE, F01_RMI_CTRL00, F01_RMI_DATA_BASE);
+
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+    F34_FLASH_QUERY_BASE = buf[0];
+    F34_FLASH_CMD_BASE = buf[1];
+    F34_FLASH_CTRL_BASE = buf[2];
+    F34_FLASH_DATA_BASE = buf[3];
+    TPD_DEBUG("F34_FLASH_QUERY_BASE = %x \n\
+            F34_FLASH_CMD_BASE    = %x \n\
+            F34_FLASH_CTRL_BASE    = %x \n\
+            F34_FLASH_DATA_BASE    = %x \n\
+            ", F34_FLASH_QUERY_BASE, F34_FLASH_CMD_BASE, F34_FLASH_CTRL_BASE, F34_FLASH_DATA_BASE);
+
+    F01_RMI_CMD00 = F01_RMI_CMD_BASE;
+    F01_RMI_CTRL01 = F01_RMI_CTRL00 + 1;
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_DEBUG("synaptics_read_register_map: failed for page select\n");
+        return -1;
+    }
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+    F51_CUSTOM_QUERY_BASE = buf[0];
+    F51_CUSTOM_CMD_BASE = buf[1];
+    F51_CUSTOM_CTRL_BASE = buf[2];
+    F51_CUSTOM_DATA_BASE = buf[3];
+
+    TPD_DEBUG("F51_CUSTOM_QUERY_BASE = %x \n\
+            F51_CUSTOM_CMD_BASE  = %x \n\
+            F51_CUSTOM_CTRL_BASE    = %x \n\
+            F51_CUSTOM_DATA_BASE    = %x \n\
+            ", F51_CUSTOM_QUERY_BASE, F51_CUSTOM_CMD_BASE, F51_CUSTOM_CTRL_BASE, F51_CUSTOM_DATA_BASE);
+
+#if TP_TEST_ENABLE
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x01);
+    if (ret < 0) {
+        TPD_INFO("synaptics_read_register_map: failed for page select\n");
+        return -1;
+    }
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+    F54_ANALOG_QUERY_BASE = buf[0];
+    F54_ANALOG_COMMAND_BASE = buf[1];
+    F54_ANALOG_CONTROL_BASE = buf[2];
+    F54_ANALOG_DATA_BASE = buf[3];
+    TPD_DEBUG("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE  = %x \n\
+            F54_CTRL_BASE    = %x \n\
+            F54_DATA_BASE    = %x \n\
+            ", F54_ANALOG_QUERY_BASE, F54_ANALOG_COMMAND_BASE, F54_ANALOG_CONTROL_BASE, F54_ANALOG_DATA_BASE);
+#endif
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+    return 0;
+}
+
+static int synaptics_read_product_id(struct synaptics_ts_data *ts, char *id)
+{
+    uint8_t buf[5] = {"\n"};
+    int ret ;
+
+    memset(buf, 0, sizeof(buf));
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("synaptics_read_product_id: failed for page select\n");
+        return -1;
+    }
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0x83, 5, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("synaptics_read_product_id error %s\n", &buf[0]);
+        return -1;
+    }
+    memcpy(id, &buf[0], sizeof(buf));
+    TPD_INFO("product id is %s\n", &buf[0]);
+    return 0;
+}
+
+static int synaptics_init_panel(struct synaptics_ts_data *ts)
+{
+    int ret;
+
+    TPD_DEBUG("%s is called!\n", __func__);
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+    /*device control: normal operation, configur = 1*/
+    //chenggang.li @BSP change 0x80 to 0x84, bit2:1 nosleep  bit2:0 sleep
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, F01_RMI_CTRL00, 0x80);
+    if (ret < 0) {
+        msleep(150);
+        ret = synaptics_rmi4_i2c_write_byte(ts->client, F01_RMI_CTRL00, 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_interrupt(struct synaptics_ts_data *ts, int enable)
+{
+    int ret = 0;
+    uint8_t abs_status_int;
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_DEBUG("%s: select page failed ret = %d\n", __func__,
+                ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_DEBUG("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, F01_RMI_CTRL01, abs_status_int);
+    if (ret < 0) {
+        TPD_DEBUG("%s: enable or disable abs \
+                interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+    return 0;
+}
+
+static void int_state(struct synaptics_ts_data *ts)
+{
+    int ret = -1;
+    TPD_INFO("%s %d\n", __func__, __LINE__);
+    ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD_BASE, 0x01);
+    if (ret) {
+        TPD_INFO("%s:cannot reset touch panel \n", __func__);
+        return;
+    }
+    msleep(170);
+
+    synaptics_init_panel(ts);
+    if (ret < 0) {
+        TPD_INFO("%s:to wakeup failed\n", __func__);
+    }
+    ret = synaptics_enable_interrupt(ts, 1);
+    if (ret) {
+        TPD_DEBUG("%s:cannot  enable interrupt \n", __func__);
+        return;
+    }
+}
+
+//Added for larger than 32 length read!
+static int synaptics_rmi4_i2c_read_block(struct i2c_client* client,
+        unsigned char addr, unsigned short length, unsigned char *data)
+{
+    int retval;
+    unsigned char retry;
+    unsigned char buf;
+    struct i2c_msg msg[] = {
+        {
+            .addr = client->addr,
+            .flags = 0,
+            .len = 1,
+            .buf = &buf,
+        },
+        {
+            .addr = client->addr,
+            .flags = I2C_M_RD,
+            .len = length,
+            .buf = data,
+        },
+    };
+    buf = addr & 0xFF;
+    for (retry = 0; retry < 2; retry++) {
+        if (i2c_transfer(client->adapter, msg, 2) == 2) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+    if (retry == 2) {
+        dev_err(&client->dev,
+                "%s: I2C read over retry limit\n",
+                __func__);
+        //rst_flag_counter = 1;//reset tp
+        retval = -5;
+    } else {
+        //rst_flag_counter = 0;
+    }
+    return retval;
+}
+
+static int synaptics_rmi4_i2c_write_block(struct i2c_client* client,
+        unsigned char addr, unsigned short length, unsigned char const *data)
+{
+    int retval;
+    unsigned char retry;
+    unsigned char buf[length + 1];
+    struct i2c_msg msg[] = {
+        {
+            .addr = client->addr,
+            .flags = 0,
+            .len = length + 1,
+            .buf = buf,
+        }
+    };
+
+    buf[0] = addr & 0xff;
+    memcpy(&buf[1], &data[0], length);
+
+    for (retry = 0; retry < 2; retry++) {
+        if (i2c_transfer(client->adapter, msg, 1) == 1) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+    if (retry == 2) {
+        //rst_flag_counter = 1;//rest tp
+        retval = -EIO;
+    } else {
+        //rst_flag_counter = 0;
+    }
+    return retval;
+}
+
+static int synaptics_rmi4_i2c_read_byte(struct i2c_client* client,
+        unsigned char addr)
+{
+    int retval = 0;
+    unsigned char buf[2] = {0};
+    retval = synaptics_rmi4_i2c_read_block(client, addr, 1, buf);
+    if (retval >= 0)
+        retval = buf[0]&0xff;
+    return retval;
+}
+
+static int synaptics_rmi4_i2c_write_byte(struct i2c_client* client,
+        unsigned char addr, unsigned char data)
+{
+    int retval;
+    unsigned char data_send = data;
+    retval = synaptics_rmi4_i2c_write_block(client, addr, 1, &data_send);
+    return retval;
+}
+
+static int synaptics_rmi4_i2c_read_word(struct i2c_client* client,
+        unsigned char addr)
+{
+    int retval;
+    unsigned char buf[2] = {0};
+    retval = synaptics_rmi4_i2c_read_block(client, addr, 2, buf);
+    if (retval >= 0)
+        retval = buf[1] << 8 | buf[0];
+    return retval;
+}
+
+static int synaptics_rmi4_i2c_write_word(struct i2c_client* client,
+        unsigned char addr, unsigned short data)
+{
+    int retval;
+    unsigned char buf[2] = {data & 0xff, (data >> 8) & 0xff};
+    retval = synaptics_rmi4_i2c_write_block(client, addr, 2, buf);
+    if (retval >= 0)
+        retval = buf[1] << 8 | buf[0];
+    return retval;
+}
+
+//mingqiang.guo@phone.bsp 2016-1-7 add for key press all the time, can not touch up, need force cal
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+static int key_press_all_the_time = 0;
+void judge_key_press_all_the_time(void)
+{
+    if (ts_g == NULL)
+        return;
+
+    if (key_press_all_the_time != 0)
+        key_press_all_the_time++;
+
+    if (key_press_all_the_time == 40)
+    {
+        key_press_all_the_time = 0;
+        schedule_work(&(ts_g->judge_key_status_work));
+    }
+}
+
+static void judge_key_status_work_func(struct work_struct *work)
+{
+    mutex_lock(&ts_g->mutex);
+    TPD_INFO("key_press_all_the_time = %d, detecte  key press all the time when touch lcd, force Cal touch key \n", key_press_all_the_time);
+    synaptics_rmi4_i2c_write_byte(ts_g->client, 0xff, 0x01);
+    synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+    checkCMD();
+    synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD();
+    synaptics_rmi4_i2c_write_byte(ts_g->client, 0xff, 0x00);
+
+    input_report_key(ts_g->input_dev, KEY_MENU, 0);
+    input_sync(ts_g->input_dev);
+    input_report_key(ts_g->input_dev, KEY_BACK, 0);
+    input_sync(ts_g->input_dev);
+    mutex_unlock(&ts_g->mutex);
+}
+#endif
+//end
+
+static char log_count = 0;
+static void int_key(struct synaptics_ts_data *ts)
+{
+    int ret;
+    int button_key;
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x02);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to change page 2!!\n", __func__);
+        return;
+    }
+
+    button_key = synaptics_rmi4_i2c_read_byte(ts->client, 0x00);
+    if (6 == (++log_count % 12))
+        TPD_INFO("%s button_key : %d   pre_btn_state:%d\n", __func__, button_key, ts->pre_btn_state);
+    else
+        TPD_INFO("%s button_key : %d   pre_btn_state:%d\n", __func__, button_key, ts->pre_btn_state);
+
+    //mingqiang.guo add for two key down, can not report long press, resolve for  electrostatic experiment
+    switch(button_key&0x03)
+    {
+        case 0: //up
+            if (ts->pre_btn_state == 1)
+            {
+                input_report_key_oppo(ts->input_dev, KEY_MENU, 0);
+                input_sync(ts->input_dev);
+            }
+            else if (ts->pre_btn_state == 2)
+            {
+                input_report_key_oppo(ts->input_dev, KEY_BACK, 0);
+                input_sync(ts->input_dev);
+            }
+            ts->pre_btn_state = 0;
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+            key_press_all_the_time = 0;
+#endif
+            break;
+
+        case 1: //down
+            ts->pre_btn_state = 0x01;
+            input_report_key_oppo(ts->input_dev, KEY_MENU, 1);
+            input_sync(ts->input_dev);
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+            key_press_all_the_time = 1;
+#endif
+            break;
+        case 2: //down
+            ts->pre_btn_state = 0x02;
+            input_report_key_oppo(ts->input_dev, KEY_BACK, 1);
+            input_sync(ts->input_dev);
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+            key_press_all_the_time = 1;
+#endif
+            break;
+
+        case 3: //force cal
+            TPD_INFO("key code = %d, key press all the time, force Cal touch key\n", button_key & 0x03);
+            synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x01);
+            synaptics_rmi4_i2c_write_word(ts->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+            checkCMD();
+            synaptics_rmi4_i2c_write_byte(ts->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+            checkCMD();
+            synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+
+            input_report_key(ts->input_dev, KEY_MENU, 0);
+            input_sync(ts->input_dev);
+            input_report_key(ts->input_dev, KEY_BACK, 0);
+            input_sync(ts->input_dev);
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+            key_press_all_the_time = 0;
+#endif
+            break;
+    }
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to change page 2!!\n", __func__);
+        return;
+    }
+    return;
+}
+
+static void synaptics_ts_report(struct synaptics_ts_data *ts)
+{
+    int ret;
+    uint8_t status = 0;
+    uint8_t inte = 0;
+
+    if (ts->enable_remote) {
+        goto END;
+    }
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+    ret = synaptics_rmi4_i2c_read_word(ts->client, 0x13);
+
+    if (ret < 0) {
+        TPD_DEBUG("Synaptic:ret = %d\n", ret);
+        synaptics_hard_reset(ts);
+        goto END;
+    }
+    status = ret & 0xff;
+    inte = (ret & 0x7f00) >> 8;
+    if (status) {
+        int_state(ts);
+    }
+    if (inte & 0x10) {
+        int_key(ts);
+    }
+END:
+    return;
+}
+
+static irqreturn_t synaptics_irq_thread_fn(int irq, void *dev_id)
+{
+    struct synaptics_ts_data *ts = (struct synaptics_ts_data *)dev_id;
+    //TPD_INFO("%s is call \n", __func__);
+    mutex_lock(&ts->mutex);
+    synaptics_ts_report(ts);
+    mutex_unlock(&ts->mutex);
+    return IRQ_HANDLED;
+}
+
+static int synaptics_input_init(struct synaptics_ts_data *ts)
+{
+    int ret = 0;
+
+    TPD_DEBUG("%s is called\n", __func__);
+    ts->input_dev = input_allocate_device();
+    if (ts->input_dev == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("synaptics_ts_probe: Failed to allocate input device\n");
+        return ret;
+    }
+    ts->input_dev->name = TPD_DEVICE;;
+    ts->input_dev->dev.parent = &ts->client->dev;
+    set_bit(EV_SYN, ts->input_dev->evbit);
+    set_bit(EV_KEY, ts->input_dev->evbit);
+    set_bit(KEY_BACK, ts->input_dev->keybit);
+    set_bit(KEY_MENU, ts->input_dev->keybit);
+    //set_bit(KEY_APPSELECT, ts->input_dev->keybit); //set this KEY_MENU will report KEY_APPSELECT
+    set_bit(KEY_HOMEPAGE, ts->input_dev->keybit);
+    input_set_drvdata(ts->input_dev, ts);
+
+    if (input_register_device(ts->input_dev)) {
+        TPD_INFO("%s: Failed to register input device\n", __func__);
+        input_unregister_device(ts->input_dev);
+        input_free_device(ts->input_dev);
+        return -1;
+    }
+
+    return 0;
+}
+
+/*********************FW Update Func******************************************/
+static int synatpitcs_fw_update(struct device *dev, bool force)
+{
+    struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+    const struct firmware *fw = NULL;
+    int ret;
+    char fw_id_temp[12];
+    uint8_t buf[4];
+    uint32_t CURRENT_FIRMWARE_ID = 0 ;
+
+    TPD_DEBUG("%s is called\n", __func__);
+
+    if (!ts->client) {
+        TPD_INFO("i2c client point is NULL\n");
+        return 0;
+    }
+    ret = request_firmware(&fw, ts->fw_name, dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n",
+                ts->fw_name, ret);
+        return ret;
+    }
+    ret = synapitcs_ts_update(ts->client, fw->data, fw->size, force);
+    if (ret < 0) {
+        TPD_INFO("FW update not success try again\n");
+        ret = synapitcs_ts_update(ts->client, fw->data, fw->size, force);
+        if (ret < 0) {
+            TPD_INFO("FW update failed twice, quit updating process!\n");
+            return ret;
+        }
+    }
+    release_firmware(fw);
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+    ret = synaptics_rmi4_i2c_read_block(ts->client, F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    sprintf(fw_id_temp, "0x%x", CURRENT_FIRMWARE_ID);
+    strcpy(ts->fw_id, fw_id_temp);
+    synaptics_init_panel(ts);
+    synaptics_enable_interrupt(ts, 1);
+    input_report_key(ts->input_dev, BTN_TOUCH, 0);
+    input_mt_sync(ts->input_dev);
+    input_sync(ts->input_dev);
+
+    return 0;
+}
+
+static int synaptics_s1302_fw_show(struct seq_file *seq, void *offset)
+{
+    struct synaptics_ts_data *ts = ts_g;
+    seq_printf(seq, "\
+            synaptics ic type is %s\n\
+            firmware name is %s\n\
+            firmware version is %s\n\
+            is update firmware state: %s\n", \
+            ts->manu_name, ts->fw_name, ts->fw_id, \
+            (ts->loading_fw)?("loading..."):("no update"));
+    return 0;
+}
+
+static ssize_t synaptics_s1302_fw_write(struct file *file, const char __user *page, size_t t, loff_t *lo)
+{
+    int val = 0;
+    TPD_INFO("start update ******* page :%s  ts_g == NULL? %s\n", page, (ts_g == NULL)? "yes":"no");
+    if (NULL == ts_g)
+        return -EINVAL;
+
+    TPD_INFO("start update ******* fw_name:%s\n", ts_g->fw_name);
+    if (t > 2)
+        return -EINVAL;
+
+    sscanf(page, "%d", &val);
+
+    if (!val)
+        val = force_update;
+
+    disable_irq_nosync(ts_g->irq);
+    mutex_lock(&ts_g->mutex);
+    ts_g->loading_fw = true;
+    synatpitcs_fw_update(ts_g->dev, val);
+    ts_g->loading_fw = false;
+    mutex_unlock(&ts_g->mutex);
+    enable_irq(ts_g->irq);
+    force_update = 0;
+
+    return t;
+}
+
+static int synaptics_s1302_fw_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, synaptics_s1302_fw_show, inode->i_private);
+}
+
+const struct file_operations proc_firmware_update =
+{
+    .owner        = THIS_MODULE,
+    .open        = synaptics_s1302_fw_open,
+    .read        = seq_read,
+    .write        = synaptics_s1302_fw_write,
+    .llseek     = seq_lseek,
+    .release    = single_release,
+};
+
+static ssize_t synaptics_s1302_key_reverse_write(struct file *file, const char __user *page, size_t t, loff_t *lo)
+{
+    int ret = 0;
+    char buf[10];
+
+    if (t > 2)
+        return t;
+    if (copy_from_user(buf, page, t)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return t;
+    }
+
+    sscanf(buf, "%d", &ret);
+    TPD_INFO("%s key_reverse:%d\n", __func__, ret);
+    if ((ret == 0) || (ret == 1))
+    {
+        key_reverse = ret;
+    }
+
+    return t;
+}
+
+static int synaptics_s1302_key_reverse_show(struct seq_file *seq, void *offset)
+{
+    seq_printf(seq, "s1302 menu key in %s\n", key_reverse?("right"):("left"));
+    return 0 ;
+}
+
+static int synaptics_s1302_key_reverse_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, synaptics_s1302_key_reverse_show, inode->i_private);
+}
+
+const struct file_operations proc_reverse_key =
+{
+    .owner        = THIS_MODULE,
+    .open        = synaptics_s1302_key_reverse_open,
+    .read        = seq_read,
+    .write      = synaptics_s1302_key_reverse_write,
+    .llseek     = seq_lseek,
+    .release    = single_release,
+};
+static int page, address, block;
+static int synaptics_s1302_radd_show(struct seq_file *seq, void *offset)
+{
+    int ret;
+    char buffer[256];
+    int i;
+
+    struct synaptics_ts_data *ts = ts_g;
+    TPD_INFO("%s page = 0x%x, address = 0x%x, block = 0x%x\n", __func__, page, address, block);
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, page);
+    ret = synaptics_rmi4_i2c_read_block(ts->client, address, block, buffer);
+    for (i = 0; i < block; i++)
+    {
+        TPD_INFO("buffer[%d] = 0x%x\n", i, buffer[i]);
+    }
+    seq_printf(seq, "page:0x%x; address:0x%x; buff[%d]:[0]0x%x, [1]0x%x, [2]0x%x, [3]0x%x\n", \
+            page, address, block, buffer[0], buffer[1], buffer[2], buffer[3]);
+
+    return 0;
+}
+
+static ssize_t synaptics_s1302_radd_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int buf[128];
+    int ret, i;
+    struct synaptics_ts_data *ts = ts_g;
+    int temp_block, wbyte;
+    char reg[30];
+
+    ret = sscanf(buffer, "%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x", \
+            &buf[0], &buf[1], &buf[2], &buf[3], &buf[4], &buf[5], &buf[6], &buf[7], &buf[8], &buf[9], \
+            &buf[10], &buf[11], &buf[12], &buf[13], &buf[14], &buf[15], &buf[16], &buf[17]);
+    for (i = 0;i < ret;i++)
+    {
+        TPD_INFO("buf[i] = 0x%x, ", buf[i]);
+    }
+    TPD_INFO("\n");
+    page = buf[0];
+    address = buf[1];
+    temp_block = buf[2];
+    wbyte = buf[3];
+    if (0xFF == temp_block)//the  mark is to write register else read register
+    {
+        for (i = 0; i < wbyte; i++)
+        {
+            reg[i] = (char)buf[4 + i];
+        }
+        ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, page);
+        ret = synaptics_rmi4_i2c_write_block(ts->client, (char)address, wbyte, reg);
+        TPD_INFO("%s write page = 0x%x, address = 0x%x\n", __func__, page, address);
+        for (i = 0;i < wbyte;i++)
+        {
+            TPD_INFO("reg = 0x%x\n", reg[i]);
+        }
+    }
+    else
+        block = temp_block;
+
+    return count;
+}
+
+static int synaptics_s1302_radd_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, synaptics_s1302_radd_show, inode->i_private);
+}
+const struct file_operations proc_radd =
+{
+    .owner      = THIS_MODULE,
+    .open       = synaptics_s1302_radd_open,
+    .read       = seq_read,
+    .write      = synaptics_s1302_radd_write,
+    .llseek     = seq_lseek,
+    .release    = single_release,
+};
+static ssize_t synaptics_s1302_reset_write (struct file *file, const char *buffer, size_t count, loff_t *ppos)
+{
+    int ret, write_flag;
+    struct synaptics_ts_data *ts = ts_g;
+
+    if (ts->loading_fw) {
+        TPD_INFO("%s FW is updating break!!\n", __func__);
+        return count;
+    }
+
+    ret = sscanf(buffer, "%x", &write_flag);
+    TPD_INFO("%s write %d\n", __func__, write_flag);
+    if (1 == write_flag)
+    {
+        ret = synaptics_soft_reset(ts);
+    }
+    else if (2 == write_flag)
+    {
+        synaptics_hard_reset(ts);
+    }
+    return count;
+}
+
+static int synaptics_s1302_reset_show(struct seq_file *seq, void *offset)
+{
+    seq_printf(seq, "%d\n", test_err);
+    return 0 ;
+}
+
+static int synaptics_s1302_reset_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, synaptics_s1302_reset_show, inode->i_private);
+}
+
+const struct file_operations proc_reset =
+{
+    .owner      = THIS_MODULE,
+    .open       = synaptics_s1302_reset_open,
+    .read       = seq_read,
+    .write      = synaptics_s1302_reset_write,
+    .llseek     = seq_lseek,
+    .release    = single_release,
+};
+
+static ssize_t synaptics_s1302_debug_write (struct file *file, const char *buffer, size_t count, loff_t *ppos)
+{
+    int ret, write_flag;
+
+    ret = sscanf(buffer, "%x", &write_flag);
+    TPD_INFO("%s write %d\n", __func__, write_flag);
+    tp_debug = write_flag?1:0;
+    return count;
+}
+static int synaptics_s1302_debug_show(struct seq_file *seq, void *offset)
+{
+    seq_printf(seq, "s1302 debug log is %s!\n", tp_debug?"on":"off");
+    return 0 ;
+}
+
+static int synaptics_s1302_debug_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, synaptics_s1302_debug_show, inode->i_private);
+}
+
+const struct file_operations proc_debug =
+{
+    .owner      = THIS_MODULE,
+    .open       = synaptics_s1302_debug_open,
+    .read       = seq_read,
+    .write      = synaptics_s1302_debug_write,
+    .llseek     = seq_lseek,
+    .release    = single_release,
+};
+
+//guomingqiang@phone.bsp 2015-12-17 add for touch key debug node
+static ssize_t synaptics_rmi4_baseline_show_s1302(struct device *dev, char *buf, bool savefile)
+{
+    int ret = 0;
+    int x, y;
+    int16_t baseline_data = 0;
+    uint8_t tmp_l = 0, tmp_h = 0;
+    ssize_t num_read_chars = 0;
+    uint16_t count = 0;
+    int error_count = 0;
+    int16_t *baseline_data_test;
+    int fd = -1;
+    struct timespec   now_time;
+    struct rtc_time   rtc_now_time;
+    uint8_t  data_buf[64];
+    mm_segment_t old_fs;
+    const struct firmware *fw = NULL;
+    struct test_header *ph = NULL;
+
+    if (!ts_g) {
+        num_read_chars += sprintf(&(buf[num_read_chars]), "ts_g is null\n");
+        return num_read_chars;
+    }
+
+    ret = request_firmware(&fw, ts_g->test_limit_name, dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts_g->test_limit_name, ret);
+        error_count++;
+        num_read_chars += sprintf(&(buf[num_read_chars]), "imageid = 0x%x, deviceid = 0x%x\n", KEY_FW, KEY_FW);
+        num_read_chars += sprintf(&(buf[num_read_chars]), "%d error(s). %s\n", error_count, "Request firmware failed");
+        return num_read_chars;
+    }
+    ph = (struct test_header *)(fw->data);
+
+    mutex_lock(&ts_g->mutex);
+    disable_irq(ts_g->irq);//disable_irq_nosync(ts_g->client->irq);
+
+    synaptics_read_register_map_page1(ts_g);
+    TPD_INFO("synaptics_rmi4_baseline_show_s1302  step 1:select report type 0x03\n");
+
+    if (savefile) {
+        getnstimeofday(&now_time);
+        rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+        sprintf(data_buf, "/sdcard/tp_key_testlimit_%02d%02d%02d-%02d%02d%02d.csv",
+                (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+                rtc_now_time.tm_hour + 8 > 23 ? (rtc_now_time.tm_hour + 8-24) : rtc_now_time.tm_hour + 8, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+
+        old_fs = get_fs();
+        set_fs(KERNEL_DS);
+
+        fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+        if (fd < 0) {
+            TPD_INFO("Open log file '%s' failed.\n", data_buf);
+            set_fs(old_fs);
+        }
+    }
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+    if (ret < 0) {
+        TPD_INFO("read_baseline: i2c_smbus_write_byte_data_s1302 failed \n");
+        goto END;
+    }
+
+    //baseline_data_test = (uint16_t *)(fw->data + ph->array_limit_offset);
+    //for (z = 0; z < 10; z++)
+    //{
+    //    TPD_DEBUG("baseline_data_test1 = %d \t baseline_data_test2 = %d\n", *(baseline_data_test + z * 2), *(baseline_data_test + z * 2 + 1));
+    //}
+    baseline_data_test = (uint16_t *)(fw->data + ph->array_limit_offset);
+
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+
+    checkCMD();
+    TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD();
+    TPD_DEBUG("Force Cal oK\n");
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD();
+
+    count = 0;
+    for (x = 0; x < 2; x++)
+    {
+        for (y = 0; y < 5; y++)
+        {
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_l = ret&0xff;
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_h = ret&0xff;
+            baseline_data = (tmp_h << 8)|tmp_l;
+            if (fd >= 0) {
+                sprintf(data_buf, "%d, ", baseline_data);
+                sys_write(fd, data_buf, strlen(data_buf));
+            }
+            //TPD_DEBUG("baseline_data is %d\n", baseline_data);
+            //TPD_DEBUG("x = %d  y = %d\n", x, y);
+            if ((x == 0) && ((y == 3) || (y == 4)))
+            {
+                TPD_DEBUG("count = %d\n", count);
+                if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1)))
+                {
+                    //TPD_INFO("TPD error baseline_data[%d][%d] = %d[%d, %d]\n", x, y, baseline_data, *(baseline_data_test + count*2),    *(baseline_data_test + count*2 + 1));
+                    num_read_chars += sprintf(&(buf[num_read_chars]), "conut = %d TPD error baseline_data[%d][%d] = %d[%d, %d]\n", count, x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    goto END;
+                }
+                count++;
+            }
+            else{
+                count++;
+                continue;
+            }
+        }
+        if (fd >= 0) {
+            sys_write(fd, "\n", 1);
+        }
+        TPD_INFO("\n");
+    }
+
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x04);
+    checkCMD();
+
+END:
+    if (fd >= 0) {
+        sys_close(fd);
+        set_fs(old_fs);
+    }
+    release_firmware(fw);
+    num_read_chars += sprintf(&(buf[num_read_chars]), "imageid = 0x%x, deviceid = 0x%x\n", KEY_FW, KEY_FW);
+    num_read_chars += sprintf(&(buf[num_read_chars]), "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    //TPD_DEBUG("buf = %s\n", buf);
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X02);
+    msleep(60);
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, 0xff, 0x00);
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F01_RMI_CMD00, 0x01);
+    msleep(150);
+    synaptics_init_panel(ts_g);
+    synaptics_enable_interrupt(ts_g, 1);
+    enable_irq(ts_g->irq);
+    TPD_DEBUG("\n\nstep5 reset and open irq complete\n");
+    mutex_unlock(&ts_g->mutex);
+
+    return num_read_chars;
+}
+
+static int tp_reg_address;
+static ssize_t tp_reg_operate_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[PAGESIZE];
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, 0xff, tp_reg_address >> 8);
+    if (ret < 0)
+    {
+        TPD_DEBUG("%s error %d\n", __func__, __LINE__);
+        return -1;
+    }
+
+    ret  = synaptics_rmi4_i2c_read_byte(ts_g->client, tp_reg_address & 0x00ff);
+
+    TPD_INFO("read reg = 0x%x is 0x%x\n", tp_reg_address, ret);
+    ret = sprintf(page, "read reg = 0x%x is 0x%x\n", tp_reg_address, ret);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static ssize_t tp_reg_operate_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int ret = 0 ;
+    char buf[50];
+
+    int data;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_DEBUG("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    sscanf(buf, "0x%x 0x%x ", &tp_reg_address, &data);
+    TPD_INFO("%s write  reg = 0x%x data = 0x%x \n", __func__, tp_reg_address, data);
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, 0xff, tp_reg_address >> 8);
+    if (ret < 0)
+    {
+        TPD_DEBUG("%s error %d\n", __func__, __LINE__);
+        return -1;
+    }
+
+    data = synaptics_rmi4_i2c_read_byte(ts_g->client, tp_reg_address & 0x00ff);
+
+    TPD_INFO("%s  read data %d\n", __func__, data);
+
+    return count;
+}
+static ssize_t tp_baseline_test_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    char page[PAGESIZE];
+
+    if (!ts_g)
+        return baseline_ret;
+    if (baseline_ret == 0) //proc node will auto read two time, but only need tp test one time
+    {
+        count = synaptics_rmi4_baseline_show_s1302(ts_g->dev, page, 1);
+        baseline_ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    }
+    else
+    {
+        baseline_ret = 0;
+    }
+
+    return baseline_ret;
+}
+
+static ssize_t tp_delta_show(struct file *file, char __user *buf, size_t size, loff_t *ppos)
+{
+    int ret = 0;
+    int x, y;
+    char * kernel_buf;
+    ssize_t num_read_chars = 0;
+    uint8_t tmp_l = 0, tmp_h = 0;
+    uint16_t count = 0;
+
+    if (!ts_g)
+        return 0;
+    kernel_buf = kmalloc(4096, GFP_KERNEL);
+    if (kernel_buf == NULL)
+    {
+        TPD_INFO("kmalloc error!\n");
+        return 0;
+    }
+    memset(delta_baseline, 0, sizeof(delta_baseline));
+
+    disable_irq(ts_g->irq);//disable_irq_nosync(ts_g->client->irq);
+
+    synaptics_read_register_map_page1(ts_g);
+
+    //TPD_DEBUG("\nstep 2:report type2 delta image\n");
+    memset(delta_baseline, 0, sizeof(delta_baseline));
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X01);//get report
+
+    checkCMD();
+
+    count = 0;
+    for (x = 0; x < 2; x++) {
+        //TPD_INFO("\n[%d]", x);
+        //num_read_chars += sprintf(&(kernel_buf[num_read_chars]), "\n[%3d]", x);
+        for (y = 0; y < 5; y++) {
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_l = ret & 0xff;
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_h = ret & 0xff;
+            delta_baseline[x][y] = (tmp_h << 8) | tmp_l;
+            //TPD_INFO("%3d, ", delta_baseline[x][y]);
+            if (x == 0 && y == 3)
+                num_read_chars += sprintf(&(kernel_buf[num_read_chars]), "menu_key: %d\n", delta_baseline[x][y]);
+            if (x == 0 && y == 4)
+                num_read_chars += sprintf(&(kernel_buf[num_read_chars]), "back_key: %d\n", delta_baseline[x][y]);
+        }
+    }
+    msleep(60);
+    //ret = synaptics_soft_reset(ts_g);
+    //delay_qt_ms(60);
+    synaptics_enable_interrupt(ts_g, 1);
+
+    enable_irq(ts_g->irq);
+
+    TPD_INFO("num_read_chars = %zd, count = %zd\n", num_read_chars, size);
+    num_read_chars += sprintf(&(kernel_buf[num_read_chars]), "%s", "\r\n");
+    ret = simple_read_from_buffer(buf, size, ppos, kernel_buf, strlen(kernel_buf));
+    kfree(kernel_buf);
+    return ret;
+}
+
+static ssize_t tp_baseline_show(struct file *file, char __user *buf, size_t size, loff_t *ppos)
+{
+    int ret = 0;
+    int x, y;
+    char * kernel_buf;
+    ssize_t num_read_chars = 0;
+    uint8_t tmp_old = 0;
+    uint8_t tmp_l = 0, tmp_h = 0;
+    uint16_t count = 0;
+    int16_t baseline_data[2][5];
+
+    if (is_suspend == 1)
+        return count;
+    if (!ts_g)
+        return count;
+
+    kernel_buf = kmalloc(4096, GFP_KERNEL);
+    if (kernel_buf == NULL)
+    {
+        TPD_INFO("kmalloc error!\n");
+        return 0;
+    }
+    memset(delta_baseline, 0, sizeof(delta_baseline));
+    disable_irq(ts_g->irq);
+    synaptics_read_register_map_page1(ts_g);
+    mutex_lock(&ts_g->mutex);
+
+    TPD_DEBUG("\n wanghao test start\n");
+    TPD_DEBUG("\n step 1:select report type 0x03 baseline\n");
+
+    //step 1:check raw capacitance.
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+    if (ret < 0) {
+        TPD_DEBUG("read_baseline: synaptics_rmi4_i2c_write_byte failed \n");
+        //return sprintf(buf, "i2c err!");
+    }
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_CONTROL_BASE + 81, 0x01);
+    ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_CONTROL_BASE + 86);
+    tmp_old = ret & 0xff;
+    TPD_DEBUG("ret = %x, tmp_old = %x, tmp_new = %x\n", ret, tmp_old, (tmp_old & 0xef));
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_CONTROL_BASE + 86, (tmp_old & 0xef));
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x04);
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_CONTROL_BASE + 29, 0x01);// Forbid NoiseMitigation
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+    checkCMD();
+    TPD_DEBUG("Forbid NoiseMitigation oK\n");\
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD();
+    TPD_DEBUG("Force Cal oK\n");
+    ret = synaptics_rmi4_i2c_write_word(ts_g->client, F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD();
+    count = 0;
+
+    for (x = 0;x < 2; x++)
+    {
+        TPD_DEBUG("\n[%2d]", x);
+        num_read_chars += sprintf(kernel_buf + num_read_chars, "\n[%2d]", x);
+
+        for (y = 0; y < 5; y++)
+        {
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_l = ret & 0xff;
+            ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_DATA_BASE + 3);
+            tmp_h = ret & 0xff;
+            baseline_data[x][y] = (tmp_h << 8) | tmp_l;
+
+            TPD_DEBUG("%d, ", baseline_data[x][y]);
+            num_read_chars += sprintf(kernel_buf + num_read_chars, "%5d", baseline_data[x][y]);
+        }
+    }
+
+    TPD_DEBUG("\n report type2 delta image \n");
+
+    ret = synaptics_rmi4_i2c_write_byte(ts_g->client, F54_ANALOG_COMMAND_BASE, 0X02);
+    msleep(60);
+    ret = synaptics_soft_reset(ts_g);
+    msleep(60);
+    synaptics_enable_interrupt(ts_g, 1);
+    mutex_unlock(&ts_g->mutex);
+    enable_irq(ts_g->irq);
+    TPD_DEBUG("\nreport delta image end\n");
+    TPD_INFO("num_read_chars = %zd, size = %zd\n", num_read_chars, size);
+    num_read_chars += sprintf(&(kernel_buf[num_read_chars]), "%s", "\r\n");
+    ret = simple_read_from_buffer(buf, size, ppos, kernel_buf, strlen(kernel_buf));
+    kfree(kernel_buf);
+
+    return ret;
+}
+
+static const struct file_operations tp_reg_operate_proc_fops = {
+    .write = tp_reg_operate_write_func,
+    .read = tp_reg_operate_read_func,
+    .open = simple_open,
+    .owner = THIS_MODULE,
+};
+static const struct file_operations tp_baseline_test_proc_fops =
+{
+    .read = tp_baseline_test_read_func,
+    .owner = THIS_MODULE,
+};
+
+static const struct file_operations oppo_tp_delta_data_proc_fops =
+{
+    .read = tp_delta_show,
+    .owner = THIS_MODULE,
+};
+
+static const struct file_operations oppo_tp_baseline_image_proc_fops =
+{
+    .read = tp_baseline_show,
+    .owner = THIS_MODULE,
+};
+//guomingqiang@phone.bsp 2015-12-17 add for touch key debug node  end
+
+static int synaptics_s1302_proc(void)
+{
+    struct proc_dir_entry *proc_entry = 0;
+
+    struct proc_dir_entry *procdir = proc_mkdir("touchkey", NULL);
+    //for firmware version
+    proc_entry = proc_create_data("fw_update", 0444, procdir, &proc_firmware_update, NULL);
+    proc_entry = proc_create_data("key_rep", 0666, procdir, &proc_reverse_key, NULL);
+    proc_entry = proc_create_data("radd", 0666, procdir, &proc_radd, NULL);
+    proc_entry = proc_create_data("reset", 0666, procdir, &proc_reset, NULL);
+    proc_entry = proc_create_data("oppo_tp_debug", 0666, procdir, &proc_debug, NULL);
+
+    //guomingqiang@phone.bsp 2015-12-17 add for touch key debug node
+    proc_entry = proc_create_data("baseline_test", 0666, procdir, &tp_baseline_test_proc_fops, NULL);
+    proc_entry = proc_create_data("oppo_tp_delta_data", 0644, procdir, &oppo_tp_delta_data_proc_fops, NULL);
+    proc_entry = proc_create_data("oppo_tp_baseline_image", 0644, procdir, &oppo_tp_baseline_image_proc_fops, NULL);
+    //guomingqiang@phone.bsp 2015-12-17 add for touch key debug node end
+
+    TPD_INFO("create nodes is successe!\n");
+
+    return 0;
+}
+/******************************end****************************/
+
+/****************************S3203*****update**********************************/
+#define SYNAPTICS_RMI4_PRODUCT_ID_SIZE 10
+#define SYNAPTICS_RMI4_PRODUCT_INFO_SIZE 2
+
+static void re_scan_PDT(struct i2c_client *client)
+{
+    uint8_t buf[8];
+    i2c_smbus_read_i2c_block_data(client, 0xE9, 6,  buf);
+    SynaF34DataBase = buf[3];
+    SynaF34QueryBase = buf[0];
+    i2c_smbus_read_i2c_block_data(client, 0xE3, 6,  buf);
+    SynaF01DataBase = buf[3];
+    SynaF01CommandBase = buf[1];
+    i2c_smbus_read_i2c_block_data(client, 0xDD, 6,  buf);
+
+    SynaF34Reflash_BlockNum = SynaF34DataBase;
+    SynaF34Reflash_BlockData = SynaF34DataBase + 2;
+    SynaF34ReflashQuery_BootID = SynaF34QueryBase;
+    SynaF34ReflashQuery_FlashPropertyQuery = SynaF34QueryBase + 2;
+    SynaF34ReflashQuery_FirmwareBlockSize = SynaF34QueryBase + 3;
+    SynaF34ReflashQuery_FirmwareBlockCount = SynaF34QueryBase + 5;
+    SynaF34ReflashQuery_ConfigBlockSize = SynaF34QueryBase + 7;
+    SynaF34ReflashQuery_ConfigBlockCount = SynaF34QueryBase + 9;
+    i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    SynaFirmwareBlockSize = buf[0] | (buf[1] << 8);
+    TPD_DEBUG("SynaFirmwareBlockSize s1302 is %d\n", SynaFirmwareBlockSize);
+    SynaF34_FlashControl = SynaF34DataBase + 0x12;
+}
+
+static void parse_header(struct image_header_data *header, const unsigned char *fw_image)
+{
+    struct image_header *data = (struct image_header *)fw_image;
+
+    header->checksum = extract_uint_le(data->checksum);
+    TPD_DEBUG(" debug checksume is 0x%x\n", header->checksum);
+    header->bootloader_version = data->bootloader_version;
+    TPD_DEBUG(" debug bootloader_version is %d\n", header->bootloader_version);
+
+    header->firmware_size = extract_uint_le(data->firmware_size);
+    TPD_DEBUG(" debug firmware_size is 0x%x\n", header->firmware_size);
+
+    header->config_size = extract_uint_le(data->config_size);
+    TPD_DEBUG(" debug header->config_size is 0x%x\n", header->config_size);
+
+    memcpy(header->product_id, data->product_id, sizeof(data->product_id));
+    header->product_id[sizeof(data->product_id)] = 0;
+
+    memcpy(header->product_info, data->product_info,
+            sizeof(data->product_info));
+
+    header->contains_firmware_id = data->options_firmware_id;
+    TPD_DEBUG(" debug header->contains_firmware_id is %x\n", header->contains_firmware_id);
+    if (header->contains_firmware_id)
+        header->firmware_id = extract_uint_le(data->firmware_id);
+
+    return;
+}
+
+#ifdef  TP_TEST_ENABLE
+static int synaptics_read_register_map_page1(struct synaptics_ts_data *ts)
+{
+    unsigned char buf[4];
+    int ret;
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_DEBUG("synaptics_rmi4_i2c_write_byte failed for page select\n");
+        return -1;
+    }
+    ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+    F54_ANALOG_QUERY_BASE = buf[0];
+    TPD_DEBUG("F54_ANALOG_QUERY_BASE = 0x%x\n", F54_ANALOG_QUERY_BASE);
+    F54_ANALOG_COMMAND_BASE = buf[1];
+    TPD_DEBUG("F54_ANALOG_COMMAND_BASE = 0x%x\n", F54_ANALOG_COMMAND_BASE);
+    F54_ANALOG_CONTROL_BASE = buf[2];
+    TPD_DEBUG("F54_ANALOG_CONTROL_BASE = 0x%x\n", F54_ANALOG_CONTROL_BASE);
+    F54_ANALOG_DATA_BASE = buf[3];
+    TPD_DEBUG("F54_ANALOG_DATA_BASE = 0x%x\n", F54_ANALOG_DATA_BASE);
+
+    return 0;
+}
+
+static void checkCMD(void)
+{
+    int ret;
+    int flag_err = 0;
+
+    TPD_DEBUG("<kernel> enter checkCMD!\n");
+    do {
+        msleep(30); //wait 10ms
+        ret = synaptics_rmi4_i2c_read_byte(ts_g->client, F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+        TPD_INFO("try read touch ic %d time \n", flag_err);
+    }while((ret > 0x00) && (flag_err < 30));
+
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+}
+#endif
+
+static int checkFlashState(struct i2c_client *client)
+{
+    int ret ;
+    int count = 0;
+    ret = synaptics_rmi4_i2c_read_byte(client, SynaF34_FlashControl);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = synaptics_rmi4_i2c_read_byte(client, SynaF34_FlashControl);
+        count++;
+    }
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+static int synaptics_fw_check(struct synaptics_ts_data *ts)
+{
+    int ret;
+    uint8_t buf[5];
+    uint32_t bootloader_mode;
+
+    if (!ts) {
+        TPD_INFO("%s ts is NULL\n", __func__);
+        return -1;
+    }
+
+    ret = synaptics_enable_interrupt(ts, 0);
+    if (ret < 0) {
+        TPD_DEBUG(" synaptics_ts_probe: disable interrupt failed\n");
+    }
+
+    /*read product id */
+    ret = synaptics_read_product_id(ts, &buf[0]);
+    if (ret) {
+        TPD_INFO("failed to read product info \n");
+        return -1;
+    }
+
+    bootloader_mode = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_DEBUG("afte fw update, program memory self-check bootloader_mode = 0x%x\n", bootloader_mode);
+
+    if (bootloader_mode == 0x40) {
+        TPD_INFO("Something terrible wrong \n Trying Update the Firmware again\n");
+        return -1;
+    }
+    return 0;
+}
+
+static int synapitcs_ts_update(struct i2c_client *client, const uint8_t *data, uint32_t data_len, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct synaptics_ts_data *ts = dev_get_drvdata(&client->dev);
+
+    TPD_DEBUG("%s is called\n", __func__);
+    if (!client)
+        return -1;
+
+    parse_header(&header, data);
+    if ((header.firmware_size + header.config_size + 0x100) > data_len) {
+        TPD_DEBUG("firmware_size + config_size + 0x100 > data_len data_len = %d \n", data_len);
+        return -1;
+    }
+
+    Firmware_Data = data + 0x100;
+    Config_Data = Firmware_Data + header.firmware_size;
+    ret = synaptics_rmi4_i2c_write_byte(client, 0xff, 0x0);
+
+    ret = synaptics_rmi4_i2c_read_block(client, F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8) | buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8) | Config_Data[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID is %x-----------, FIRMWARE_ID is %x-----------\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+    //TPD_INFO("synaptics force is %d\n", force);
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return 0;
+        }
+    }
+    re_scan_PDT(client);
+    block = 16;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = (header.firmware_size)/16;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = (header.config_size)/16;
+    TPD_DEBUG("configuration is %d \n", configuration);
+
+
+    ret = i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", SynaF34_FlashControl, ret);
+
+    synaptics_rmi4_i2c_write_byte(client, SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4 SynaF34_FlashControl:0x%x\n", SynaF34_FlashControl);
+    ret = checkFlashState(client);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return -1;
+    }
+    ret = i2c_smbus_read_byte_data(client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = i2c_smbus_read_byte_data(client, F01_RMI_CTRL00);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = i2c_smbus_write_byte_data(client, F01_RMI_CTRL00, ret|0x04);
+    /********************get into prog end************/
+    ret = i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(client);
+    i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_BootID, 2, buf);
+    i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, buf);
+    i2c_smbus_write_byte_data(client, SynaF34_FlashControl, 0x03);
+    msleep(1500);
+    ret = i2c_smbus_read_byte_data(client, SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+    for (j = 0; j < firmware; j++) {
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        synaptics_rmi4_i2c_write_block(client, SynaF34Reflash_BlockNum, 2, buf);
+        synaptics_rmi4_i2c_write_block(client, SynaF34Reflash_BlockData, 16, &Firmware_Data[j*16]);
+        synaptics_rmi4_i2c_write_byte(client, SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(client);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return -1;
+        }
+    }
+    //step 7 configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    for (j = 0; j < configuration; j++) {
+        //a)write SynaF34Reflash_BlockNum to access
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        synaptics_rmi4_i2c_write_block(client, SynaF34Reflash_BlockNum, 2, buf);
+        //b) write data
+        synaptics_rmi4_i2c_write_block(client, SynaF34Reflash_BlockData, 16, &Config_Data[j*16]);
+        //c) issue write
+        synaptics_rmi4_i2c_write_byte(client, SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(client);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return -1;
+        }
+    }
+
+    //step 1 issue reset
+    synaptics_rmi4_i2c_write_byte(client, SynaF01CommandBase, 0x01);
+    //step2 wait ATTN
+    //delay_qt_ms(1000);
+    mdelay(1500);
+    synaptics_read_register_map(ts);
+    //FW flash check!
+    ret = synaptics_fw_check(ts);
+    if (ret < 0) {
+        TPD_INFO("Firmware self check failed\n");
+        return -1;
+    }
+    TPD_INFO("Firmware self check Ok\n");
+
+    return 0;
+}
+
+static int synaptics_soft_reset(struct synaptics_ts_data *ts)
+{
+    int ret;
+
+    ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD_BASE, 0x01);
+    if (ret < 0) {
+        TPD_INFO("%s error ret = %d\n", __func__, ret);
+    }
+    TPD_INFO("%s !!!\n", __func__);
+    return ret;
+}
+
+static void synaptics_hard_reset(struct synaptics_ts_data *ts)
+{
+    if (ts->reset_gpio > 0)
+    {
+        gpio_set_value(ts->reset_gpio, 0);
+        msleep(5);
+        gpio_set_value(ts->reset_gpio, 1);
+        msleep(100);
+        TPD_INFO("%s !!!\n", __func__);
+    }
+
+}
+static int synaptics_parse_dts(struct device *dev, struct synaptics_ts_data *ts)
+{
+    int rc;
+    int retval;
+    struct device_node *np;
+
+    np = dev->of_node;
+    ts->irq_gpio = of_get_named_gpio_flags(np, "synaptics,irq-gpio", 0, &(ts->irq_flags));
+    if (ts->irq_gpio < 0) {
+        TPD_DEBUG("ts->irq_gpio not specified\n");
+    }
+
+    ts->reset_gpio = of_get_named_gpio(np, "synaptics,reset-gpio", 0);
+    if (ts->reset_gpio < 0) {
+        TPD_DEBUG("ts->reset-gpio  not specified\n");
+    }
+    ts->en3v_gpio = of_get_named_gpio(np, "synaptics,en3v_gpio", 0);
+    if (ts->en3v_gpio < 0) {
+        TPD_DEBUG("ts->en3v_gpio not specified\n");
+    }
+
+    /***********power regulator_get****************/
+
+    ts->vdd_2v8 = regulator_get(&ts->client->dev, "vdd_2v8");
+    if (IS_ERR(ts->vdd_2v8)) {
+        rc = PTR_ERR(ts->vdd_2v8);
+        TPD_DEBUG("Regulator get failed vdd rc = %d\n", rc);
+    }
+
+    ts->vcc_i2c_1v8 = regulator_get(&ts->client->dev, "vcc_i2c_1v8");
+    if (IS_ERR(ts->vcc_i2c_1v8)) {
+        rc = PTR_ERR(ts->vcc_i2c_1v8);
+        TPD_DEBUG("Regulator get failed vcc_i2c rc = %d\n", rc);
+    }
+
+    if (ts->reset_gpio > 0) {
+        if (gpio_is_valid(ts->reset_gpio)) {
+            rc = gpio_request(ts->reset_gpio, "tp-s1302-reset");
+            if (rc) {
+                TPD_INFO("unable to request gpio [%d]\n", ts->reset_gpio);
+            }
+        }
+    }
+
+    if (ts->reset_gpio > 0) {
+        if (gpio_is_valid(ts->reset_gpio)) {
+            rc = gpio_request(ts->reset_gpio, "s1302_reset");
+            if (rc)
+                TPD_INFO("unable to request gpio [%d]\n", ts->reset_gpio);
+            retval = gpio_direction_input(ts->reset_gpio);
+        }
+    }
+    if (ts->en3v_gpio > 0) {
+        if (gpio_is_valid(ts->en3v_gpio)) {
+            rc = gpio_request(ts->en3v_gpio, "s1302_en3v");
+            if (rc)
+                TPD_INFO("unable to request gpio [%d]\n", ts->en3v_gpio);
+            retval = gpio_direction_output(ts->en3v_gpio, 1);
+        }
+    }
+    return rc;
+}
+static int synaptics_dsx_pinctrl_init(struct synaptics_ts_data *ts)
+{
+    int retval;
+
+    /* Get pinctrl if target uses pinctrl */
+    ts->pinctrl = devm_pinctrl_get((ts->dev));
+    if (IS_ERR_OR_NULL(ts->pinctrl)) {
+        retval = PTR_ERR(ts->pinctrl);
+        TPD_INFO("%s %d error!\n", __func__, __LINE__);
+        goto err_pinctrl_get;
+    }
+
+    ts->pinctrl_state_active
+        = pinctrl_lookup_state(ts->pinctrl, "pmx_tk_active");
+    if (IS_ERR_OR_NULL(ts->pinctrl_state_active)) {
+        retval = PTR_ERR(ts->pinctrl_state_active);
+        TPD_INFO("%s %d error!\n", __func__, __LINE__);
+        goto err_pinctrl_lookup;
+    }
+
+    ts->pinctrl_state_suspend
+        = pinctrl_lookup_state(ts->pinctrl, "pmx_tk_suspend");
+    if (IS_ERR_OR_NULL(ts->pinctrl_state_suspend)) {
+        retval = PTR_ERR(ts->pinctrl_state_suspend);
+        TPD_INFO("%s %d !\n", __func__, __LINE__);
+        goto err_pinctrl_lookup;
+    }
+    return 0;
+
+err_pinctrl_lookup:
+    devm_pinctrl_put(ts->pinctrl);
+err_pinctrl_get:
+    ts->pinctrl = NULL;
+    return retval;
+}
+
+static int synaptics_ts_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+    struct synaptics_ts_data *ts = NULL;
+    int ret = -1;
+    uint8_t buf[4];
+    uint32_t CURRENT_FIRMWARE_ID = 0;
+    uint32_t bootloader_mode;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    ts = kzalloc(sizeof(struct synaptics_ts_data), GFP_KERNEL);
+    if (ts == NULL) {
+        ret = -ENOMEM;
+        goto err_alloc_data_failed;
+    }
+
+    ts->boot_mode = MSM_BOOT_MODE__NORMAL ;//get_boot_mode();
+
+    if ((ts->boot_mode == MSM_BOOT_MODE__FACTORY || ts->boot_mode == MSM_BOOT_MODE__RF || ts->boot_mode == MSM_BOOT_MODE__WLAN))
+    {
+        TPD_INFO("FTM regulator_disable is called\n");
+        kfree(ts); 
+        return 0;
+    }
+
+    ts->client = client;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->loading_fw = false;
+    ts_g = ts;
+
+    ret = synaptics_dsx_pinctrl_init(ts);
+    if (!ret && ts->pinctrl) {
+        pinctrl_select_state(ts->pinctrl, ts->pinctrl_state_active);
+    }
+
+    synaptics_parse_dts(&client->dev, ts);
+    /***power_init*****/
+    ret = tc_power(ts, 1);
+    if (ret < 0)
+        TPD_INFO("regulator_enable is called\n");
+
+    mutex_init(&ts->mutex);
+    synaptics_s1302_proc();
+    ts->is_suspended = 0;
+
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        TPD_INFO("%s: need I2C_FUNC_I2C\n", __func__);
+        ret = -ENODEV;
+        goto err_check_functionality_failed;
+    }
+    ret = synaptics_read_product_id(ts, ts->manu_name);
+    if (ret < 0) {
+        test_err = 1;
+        synaptics_hard_reset(ts);
+        ret = synaptics_read_product_id(ts, ts->manu_name);
+        if (ret < 0) {
+            TPD_INFO("synaptics is no exist!\n");
+            goto err_check_functionality_failed;
+        }
+    }
+
+    speedup_resume_wq = create_singlethread_workqueue("speedup_resume_wq");
+    if (!speedup_resume_wq) {
+        ret = -ENOMEM;
+        goto err_alloc_data_failed;
+    }
+    INIT_WORK(&ts->speed_up_work, speedup_synaptics_resume);
+#ifdef LCD_TRIGGER_KEY_FORCE_CAL
+    INIT_WORK(&ts->judge_key_status_work, judge_key_status_work_func);
+#endif
+    synaptics_read_register_map(ts);
+    synaptics_rmi4_i2c_read_block(ts->client, F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", CURRENT_FIRMWARE_ID);
+    sprintf(ts->fw_id, "0x%x", CURRENT_FIRMWARE_ID);
+
+    memset(ts->fw_name, 0, TP_FW_NAME_MAX_LEN);
+    strcpy(ts->fw_name, "tp/15103/15103_Firmware_touchkey.img");
+    memset(ts->test_limit_name, 0, TP_FW_NAME_MAX_LEN);
+    strcpy(ts->test_limit_name, "tp/15103/15103_key_Limit_Samsung.img");
+    TPD_INFO("touch_key fw : fw_name = %s  limit_name = %s \n", ts->fw_name, ts->test_limit_name);
+    touch_key_info.version = ts->fw_id;
+    touch_key_info.manufacture = "synatpitcs";
+    register_device_proc("touch_key", touch_key_info.version, touch_key_info.manufacture);
+
+    //push_component_info(TOUCH_KEY, ts->fw_id, ts->manu_name);
+
+    bootloader_mode = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode&0x40;
+    TPD_INFO("before fw update, bootloader_mode = 0x%x\n", bootloader_mode);
+    if (0x40 == bootloader_mode) {
+        force_update = 1;
+        TPD_INFO("This FW need to be updated!\n");
+    } else {
+        force_update = 0;
+    }
+
+    ret = synaptics_input_init(ts);
+    if (ret < 0) {
+        TPD_INFO("synaptics_input_init failed!\n");
+    }
+#if defined(CONFIG_FB)
+    ts->suspended = 0;
+    ts->fb_notif.notifier_call = fb_notifier_callback;
+    ret = fb_register_client(&ts->fb_notif);
+    if (ret)
+        TPD_INFO("Unable to register fb_notifier: %d\n", ret);
+#endif
+    if (gpio_is_valid(ts->irq_gpio)) {
+        /* configure touchscreen irq gpio */
+        ret = gpio_request(ts->irq_gpio, "s1302_int");
+        if (ret) {
+            TPD_INFO("unable to request gpio [%d]\n", ts->irq_gpio);
+        }
+        ret = gpio_direction_input(ts->irq_gpio);
+        msleep(50);
+        ts->irq = gpio_to_irq(ts->irq_gpio);
+    }
+    TPD_INFO("synaptic:ts->irq is %d\n", ts->irq);
+    ret = request_threaded_irq(ts->irq, NULL,
+            synaptics_irq_thread_fn,
+            ts->irq_flags | IRQF_ONESHOT,
+            TPD_DEVICE, ts);
+    if (ret < 0)
+        TPD_INFO("%s request_threaded_irq ret is %d\n", __func__, ret);
+
+    //   ret = synaptics_soft_reset(ts);
+    ret = synaptics_init_panel(ts); // switch to normal work mode, can not go to sleep when power on
+    if (ret < 0) {
+        TPD_INFO("synaptics_init_panel failed\n");
+    }
+    ts->loading_fw = false;
+    ret = synaptics_enable_interrupt(ts, 1);
+    if (ret < 0)
+        TPD_INFO("%s enable interrupt error ret = %d\n", __func__, ret);
+
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data_s1302();
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(ts->enable_remote);
+        register_remote_device_s1302(premote_data);
+    }
+#endif
+
+    TPD_DEBUG("synaptics_ts_probe s1302: normal end\n");
+    return 0;
+
+err_check_functionality_failed:
+err_alloc_data_failed:
+    kfree(ts);
+    ts = NULL;
+    ts_g = NULL;
+    TPD_INFO("touchkey, s1302 probe error: not normal end ret = %d\n", ret);
+
+    return ret;
+}
+
+static int synaptics_ts_remove(struct i2c_client *client)
+{
+    struct synaptics_ts_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("touchkey, s1302 %s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device_s1302();
+#endif
+
+#if defined(CONFIG_FB)
+    if (fb_unregister_client(&ts->fb_notif))
+        dev_err(&client->dev, "Error occurred while unregistering fb_notifier.\n");
+#endif
+    input_unregister_device(ts->input_dev);
+    input_free_device(ts->input_dev);
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_ts_suspend(struct device *dev)
+{
+    int ret;
+    struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+    TPD_INFO("%s: is called\n", __func__);
+
+    if (ts->input_dev == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("input_dev  registration is not complete\n");
+        return -1;
+    }
+
+    input_report_key(ts->input_dev, KEY_MENU, 0);
+    input_sync(ts->input_dev);
+    input_report_key(ts->input_dev, KEY_BACK, 0);
+    input_sync(ts->input_dev);
+
+    if (ts->loading_fw) {
+        TPD_INFO("FW is updating while suspending");
+        return -1;
+    }
+    ts->is_suspended = 1;
+    disable_irq_nosync(ts->irq);
+    ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CTRL00, 0x81);
+    if (ret < 0) {
+        TPD_INFO("%s to sleep failed\n", __func__);
+        return -1;
+    }
+    TPD_DEBUG("%s:normal end\n", __func__);
+
+    return 0;
+}
+
+static int synaptics_ts_resume(struct device *dev)
+{
+    struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+    TPD_INFO("%s is called\n", __func__);
+
+    if (ts->loading_fw)
+        return 0;
+    queue_work(speedup_resume_wq, &ts_g->speed_up_work);
+
+    return 0;
+}
+
+static void speedup_synaptics_resume(struct work_struct *work)
+{
+    int ret;
+    uint32_t bootloader_mode;
+    struct synaptics_ts_data *ts = container_of(work, struct synaptics_ts_data, speed_up_work);
+    TPD_INFO("%s \n", __func__);
+
+    if (ts->input_dev == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("input_dev  registration is not complete\n");
+        goto ERR_RESUME;
+    }
+
+    ts->is_suspended = 0;
+    mutex_lock(&ts->mutex);
+
+    ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select try again later\n", __func__);
+        msleep(20);
+        ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+        if (ret < 0) {
+            TPD_INFO("%s: failed for page select try again later\n", __func__);
+        }
+    }
+    ret = synaptics_soft_reset(ts);
+    msleep(50);
+
+    //guomingqiang@phone.bsp 2016-4-15 add for check touch key firmware mode
+    bootloader_mode = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+
+    if (bootloader_mode == 0x40)
+    {
+        TPD_INFO(" %s Something terrible wrong, need update the Firmware again\n", __func__);
+#if 0  //only for test
+        force_update = 1;
+        ts_g->loading_fw = true;
+        synatpitcs_fw_update(ts_g->dev, force_update);
+        ts_g->loading_fw = false;
+        force_update = 0;
+#endif
+    }
+    else
+    {
+        TPD_INFO("%s firmware self-check bootloader_mode = 0x%x is ok\n", __func__, bootloader_mode);
+    }
+
+    ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CTRL00, 0x80);
+    if (ret < 0) {
+        TPD_INFO("%s:to wakeup failed\n", __func__);
+        goto ERR_RESUME;
+    }
+    enable_irq(ts->irq);
+    TPD_INFO("%s:normal end!\n", __func__);
+ERR_RESUME:
+    mutex_unlock(&ts->mutex);
+    return ;
+}
+
+#if defined(CONFIG_FB)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data)
+{
+    struct fb_event *evdata = data;
+    int *blank;
+
+    struct synaptics_ts_data *ts = container_of(self, struct synaptics_ts_data, fb_notif);
+
+    if (FB_EVENT_BLANK != event)
+        return 0;
+    if ((evdata) && (evdata->data) && (ts) && (ts->client) && (event == FB_EVENT_BLANK)) {
+        blank = evdata->data;
+        if (*blank == FB_BLANK_UNBLANK) {
+            TPD_DEBUG("%s going TP resume\n", __func__);
+            if (ts->suspended == 1) {
+                synaptics_ts_resume(&ts->client->dev);
+                ts->suspended = 0;
+            }
+
+        } else if (*blank == FB_BLANK_POWERDOWN) {
+            TPD_DEBUG("%s : going TP suspend\n", __func__);
+            if (ts->suspended == 0) {
+                ts->suspended = 1;
+                synaptics_ts_suspend(&ts->client->dev);
+            }
+        }
+    }
+    return 0;
+}
+#endif
+
+static int __init tc_driver_init(void)
+{
+    if (i2c_add_driver(&tc_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tc_driver_exit(void)
+{
+    i2c_del_driver(&tc_i2c_driver);
+    return;
+}
+
+module_init(tc_driver_init);
+module_exit(tc_driver_exit);
+
+MODULE_DESCRIPTION("Synaptics S1302 Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..b08001e83af8d57409eb5c2c224b35852659070c
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+config TOUCHPANEL_SYNAPTICS_S3320
+#	default y
+	bool "TP Synaptics_S3508 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics S3320
+	
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..8da3440c204f9d0c0ae4476703774f5a5eb1ca9a
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/Makefile
@@ -0,0 +1,13 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+ifeq ($(OPPO_TARGET_DEVICE),MSM_17001)
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3320) += synaptics_drivers_s3320_17001.o
+else ifeq ($(OPPO_TARGET_DEVICE),MSM_17151)
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3320) += synaptics_drivers_s3320_17001.o
+else
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3320) += synaptics_drivers_s3320.o
+endif
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320.c
new file mode 100644
index 0000000000000000000000000000000000000000..1703c3e8229d4e1910d18ab370dcc514294c959c
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320.c
@@ -0,0 +1,2004 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+ * File       : synaptics_drivers_s3320.c
+ * Description: Source file for synaptics S3320 driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "synaptics_s3320.h"
+
+static struct chip_data_s3320 *g_chip_info = NULL;
+static int synaptics_get_chip_info(void *chip_data);
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag);
+
+/*******Part0:LOG TAG Declear********************/
+#define TPD_DEVICE "synaptics-s3320"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+/*******Part1: Function Declearation*******/
+static int synaptics_power_control(void *chip_data, bool enable);
+
+/*******Part2:Call Back Function implement*******/
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i, obj_attention;
+    unsigned char fingers_to_process = max_num;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    char buf[8*max_num];
+
+    memset(buf, 0, sizeof(buf));
+    obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+    for (i = 9;  ; i--) {
+        if ((obj_attention & 0x03FF) >> i  || i == 0)
+            break;
+        else
+            fingers_to_process--;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+    if (ret < 0) {
+        TPD_INFO("touch i2c read block failed\n");
+        return -1;
+    }
+    for (i = 0; i < fingers_to_process; i++) {
+        points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+        points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+        points[i].z = buf[i*8 + 5];
+        points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+        points[i].status = buf[i*8];
+    }
+
+    return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[4] = {0};
+    int ret = 0;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+    chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+    chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+    chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+    TPD_INFO("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE    = %x \n\
+            F54_CTRL_BASE   = %x \n\
+            F54_DATA_BASE   = %x \n",
+            chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+            chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+
+    return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+    uint8_t buf[4] = {0};
+    int ret;
+    struct chip_data_s3320    *chip_info = (struct chip_data_s3320 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    memset(buf, 0, sizeof(buf));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    reg_info->F12_2D_QUERY_BASE = buf[0];
+    reg_info->F12_2D_CMD_BASE = buf[1];
+    reg_info->F12_2D_CTRL_BASE = buf[2];
+    reg_info->F12_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+            F12_2D_CMD_BASE    = 0x%x \n\
+            F12_2D_CTRL_BASE   = 0x%x \n\
+            F12_2D_DATA_BASE   = 0x%x \n",
+            reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+            reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+    reg_info->F01_RMI_QUERY_BASE = buf[0];
+    reg_info->F01_RMI_CMD_BASE = buf[1];
+    reg_info->F01_RMI_CTRL_BASE = buf[2];
+    reg_info->F01_RMI_DATA_BASE = buf[3];
+    TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+            F01_RMI_CMD_BASE    = 0x%x \n\
+            F01_RMI_CTRL_BASE   = 0x%x \n\
+            F01_RMI_DATA_BASE   = 0x%x \n",
+            reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+            reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F34_FLASH_QUERY_BASE = buf[0];
+    reg_info->F34_FLASH_CMD_BASE = buf[1];
+    reg_info->F34_FLASH_CTRL_BASE = buf[2];
+    reg_info->F34_FLASH_DATA_BASE = buf[3];
+    TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+            F34_FLASH_CMD_BASE      = 0x%x \n\
+            F34_FLASH_CTRL_BASE     = 0x%x \n\
+            F34_FLASH_DATA_BASE     = 0x%x \n",
+            reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+            reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+    reg_info->F01_RMI_QUERY11 = reg_info->F01_RMI_QUERY_BASE + 0x0b;    // product id
+    reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+    reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+    reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+    reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;
+    reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+    reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;               // max XY Coordinate
+    reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 9;           //glove enable
+    reg_info->F12_2D_CTRL32 = reg_info->F12_2D_CTRL_BASE + 0x0f;        //moisture enable
+    reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 1;           //gesture type
+    reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 3;           //object attention
+    reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;
+    reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x07;        //motion suppression
+    reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x0b;        // wakeup Gesture enable
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_DEBUG("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+    reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+    reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+    reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+    TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+            F51_CUSTOM_CMD_BASE     = 0x%x \n\
+            F51_CUSTOM_CTRL_BASE    = 0x%x \n\
+            F51_CUSTOM_DATA_BASE    = 0x%x \n",
+            reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+            reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+    reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;       //no use
+    reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;       //wakeup gesture data
+    reg_info->F51_CUSTOM_CTRL31 = reg_info->F51_CUSTOM_CTRL_BASE + 11;  //no use
+    reg_info->F51_CUSTOM_CTRL42 = reg_info->F51_CUSTOM_CTRL_BASE + 0x14;//0D Open Test,0x42D
+    reg_info->F51_CUSTOM_CTRL50 = reg_info->F51_CUSTOM_CTRL_BASE + 0x0D;//edge function register 0x427,
+
+    synaptics_read_F54_base_reg(chip_info);
+    reg_info->F54_ANALOG_CTRL123= 0x50;      //no use
+
+    reg_info->F55_SENSOR_CTRL01 = 0x01;      //rx  number
+    reg_info->F55_SENSOR_CTRL02 = 0x02;      //tx  number
+    // select page 0
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+/**
+ * synaptics_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t synaptics_get_fw_id(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[4];
+    uint32_t current_firmware = 0;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint32_t bootloader_mode;
+    int max_y_ic = 0;
+    int max_x_ic = 0;
+    uint8_t buf[4];
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/**
+ * synaptics_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int synaptics_enable_interrupt(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+    uint8_t abs_status_int;
+
+    TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_DEBUG("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00 + 1, abs_status_int);
+    if (ret < 0) {
+        TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+
+    return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    uint8_t device_status = 0;
+    uint8_t interrupt_status = 0;
+    u8 result_event = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+#ifdef CONFIG_SYNAPTIC_RED
+    if (chip_info->enable_remote)
+        return IRQ_IGNORE;
+#endif
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+        return IRQ_EXCEPTION;
+    }
+    device_status = ret & 0xff;
+    interrupt_status = (ret & 0x7f00) >> 8;
+
+    if (device_status) {
+        TPD_INFO("%s, IRQ_EXCEPTION ,interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+        return IRQ_EXCEPTION;
+    }
+    if (interrupt_status & 0x04) {
+        if ((gesture_enable == 1) && is_suspended) {
+            return IRQ_GESTURE;
+        }
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+    if (interrupt_status & 0x10) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+
+    return  result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio \n");
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+
+    return 0;
+}
+
+static int synaptics_reset_for_prepare(void *chip_data)
+{
+    int ret = -1;
+    int i2c_error_number = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    while ((ret < 0) && (i2c_error_number < I2C_ERROR_MAX_TIME)) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        if (ret < 0) {
+            TPD_INFO("%s error, ret = %d i2c_error_number=%d\n", __func__, ret,i2c_error_number);
+        }
+        i2c_error_number++;
+    }
+    if (i2c_error_number == I2C_ERROR_MAX_TIME) {
+        TPD_INFO("i2c_error_number=%d , pull down tp 3V ,then pull up\n",i2c_error_number);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        msleep(30);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        msleep(80);
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        if (ret < 0) {
+            TPD_INFO("%s error, ret = %d\n", __func__, ret);
+        }
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+
+    return ret;
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int synaptics_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    clear_view_touchdown_flag(); //clear touch download flag
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+    msleep(80);
+
+    return ret;
+}
+
+static int synaptics_configuration_init(struct chip_data_s3320 *chip_info, bool config)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    //device control: normal operation
+    if (config) {//configed  && out of sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    } else {//sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x81);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+        return ret;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+    unsigned char report_gesture_ctrl_buf[3];
+    unsigned char wakeup_gesture_enable_buf;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    if (enable) {
+        report_gesture_ctrl_buf[2] |= 0x02 ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x3);         //set doze interval to 30ms
+    } else  {
+        report_gesture_ctrl_buf[2] &= 0xfd ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x1);         //set doze interval to 10ms
+    }
+
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    wakeup_gesture_enable_buf = 0xef;   // all kinds of gesture except triangle
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL27, wakeup_gesture_enable_buf);
+
+    return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+
+    TPD_DEBUG("%s, edge limit enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    if (enable) {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, 0x47);
+    } else  {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, 0x46);
+    }
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    TPD_INFO("edge function register F51_CUSTOM_CTRL50 = 0x%x, ?= 0x0427, enable=%d\n", chip_info->reg_info.F51_CUSTOM_CTRL50,enable);
+    return ret;
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = synaptics_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = synaptics_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            ret = synaptics_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            /*device control: sleep mode*/
+            ret = synaptics_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = synaptics_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+            ret = synaptics_glove_mode_enable(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable glove mode failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_EDGE:
+            ret = synaptics_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = 0, i, gesture_sign, regswipe;
+    uint8_t gesture_buffer[10];
+    uint8_t coordinate_buf[25] = {0};
+    uint16_t trspoint = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    regswipe = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 0x18);
+
+    TPD_DEBUG("gesture_buffer[0] = 0x%x, regswipe = 0x%x, gesture_buffer[1] = 0x%x, gesture_buffer[4] = 0x%x\n",
+            gesture_buffer[0], regswipe, gesture_buffer[1], gesture_buffer[4]);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    gesture_sign = gesture_buffer[0];
+
+    //detect the gesture mode
+    switch (gesture_sign)
+    {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case SWIPE_DETECT:
+            gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                (regswipe == 0x42) ? Right2LeftSwip   :
+                (regswipe == 0x44) ? Up2DownSwip      :
+                (regswipe == 0x48) ? Down2UpSwip      :
+                (regswipe == 0x80) ? DouSwip          :
+                UnkownGesture;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            break;
+        case VEE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                (gesture_buffer[2] == 0x02) ? UpVee    :
+                (gesture_buffer[2] == 0x04) ? RightVee :
+                (gesture_buffer[2] == 0x08) ? LeftVee  :
+                UnkownGesture;
+            break;
+        case UNICODE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x77 && gesture_buffer[3] == 0x00) ? Wgestrue :
+                (gesture_buffer[2] == 0x6d && gesture_buffer[3] == 0x00) ? Mgestrue :
+                UnkownGesture;
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+    TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d\n", __func__, gesture_sign, gesture->gesture_type);
+
+    if (gesture->gesture_type != UnkownGesture) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA,      8, &(coordinate_buf[0]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 8,  8, &(coordinate_buf[8]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 16, 8, &(coordinate_buf[16]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 24, 1, &(coordinate_buf[24]));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        for (i = 0; i < 23; i += 2) {
+            trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+            TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+        }
+
+        TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+        gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+        gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+        gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+        gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+        gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+        gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+        gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+        gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+        gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+        gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+        gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+        gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+        gesture->clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+            (coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+    }
+
+    return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        synaptics_resetgpio_set(chip_info->hw_res, true);
+        msleep(RESET_TO_NORMAL_TIME);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return ret;
+}
+
+static void checkCMD(struct chip_data_s3320 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < 30));
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+}
+
+static int checkCMD_for_finger(struct chip_data_s3320 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+    struct touchpanel_data *ts = i2c_get_clientdata(chip_info->client);
+    do {
+        msleep(10); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+        if (ts->spuri_fp_touch.lcd_trigger_fp_check && !ts->spuri_fp_touch.lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",ts->spuri_fp_touch.lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+    }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+    TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    if (10 == flag_err) {
+        TPD_INFO("checkCMD_for_finger error,reset  then msleep(80)\n");
+        if (ts->spuri_fp_touch.lcd_trigger_fp_check && !ts->spuri_fp_touch.lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",ts->spuri_fp_touch.lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+        synaptics_reset(chip_info);
+        msleep(80);
+        synaptics_mode_switch(ts->chip_data, MODE_NORMAL, true);
+        return -1;
+    } else {
+        TPD_INFO("checkCMD_for_finger ok\n");
+        return 0;
+    }
+}
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    uint8_t x, y;
+    uint8_t i;
+    uint8_t buffer_rx[syna_testdata->RX_NUM];
+    uint8_t buffer_tx[syna_testdata->TX_NUM];
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint8_t buffer[9];
+    uint16_t baseline_data = 0;
+    uint16_t *baseline_data_test;
+    uint16_t count = 0;
+    int ret = 0;
+    int error_count = 0;
+    int enable_cbc = 1;
+    int eint_status, eint_count = 0, read_gpio_num = 0;
+    uint8_t  data_buf[64];
+    struct test_header *ph = NULL;
+    uint16_t z = 0;
+    uint8_t *raw_data = NULL;
+
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            goto END;
+    }
+
+    //open file to save test data
+    ph = (struct test_header *)(syna_testdata->fw->data);
+
+    TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+    ret = synaptics_enable_interrupt(chip_info, false);
+
+    eint_count = 0;
+    read_gpio_num = 10;
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        error_count++;
+        seq_printf(s, "eint_status is low, TP EINT direct stort\n");
+        sprintf(data_buf, "eint_status is low, TP EINT direct stort, \n");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        eint_count = 0;
+        goto END;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    //step 1: Close CBC and test RT20
+    TPD_INFO("\n step 1:Close CBC and test RT20\n");
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 7, 0x01);    //Disable Noise Mitigation, F54_ANALOG_CTRL20
+    TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+    ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40);        //Read Original CBC settings from F54_ANALOG_CTRL88
+    tmp_arg1 = ret&0xff;
+
+    //Close CBC
+    TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88, close CBC
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+    checkCMD(chip_info);
+    TPD_DEBUG("Test disable cbc\n");
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%d, ", baseline_data);
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+            }
+
+            if ((y < (syna_testdata->RX_NUM - 1)) && (x < (syna_testdata->TX_NUM - 2))) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                    TPD_INFO("Synaptic:touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    seq_printf(s, "touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    goto END;
+                }
+            } else if((x > (syna_testdata->TX_NUM-3))&&(y == (syna_testdata->RX_NUM-1))) {
+                printk("%d, ", baseline_data);
+                TPD_DEBUG("touchkey test xy(%d,%d),baseline_data=%d,limite( %d, %d)\n ",x,y, baseline_data,*(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                    TPD_INFO("Synaptic:touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    seq_printf(s, "touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    goto END;
+                }
+            }
+            count++;
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+    if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+    }
+
+    //step 2: Open CBC and test RT3
+    TPD_INFO("\n step 2:Open CBC and test RT3\n");
+    do{
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        if (ret < 0) {
+            TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            error_count++;
+            goto END;
+        }
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 7, 0x01);//Disable Noise Mitigation, F54_ANALOG_CTRL20
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40);        //Read Original CBC settings from F54_ANALOG_CTRL88
+        tmp_arg1 = ret&0xff;
+
+        if (enable_cbc) {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x20));
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 | 0x20));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test enable cbc\n");
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limitcbc_offset);
+        } else {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test disable cbc\n");
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+        }
+
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info);
+
+        TPD_INFO("RX_NUM is %d, TX_NUM is %d\n", syna_testdata->RX_NUM, syna_testdata->TX_NUM);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+        count = 0;
+        for (x = 0; x < syna_testdata->TX_NUM; x++) {
+            TPD_DEBUG_NTAG("[%d]: ", x);
+            for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                z = syna_testdata->RX_NUM * x + y;
+                tmp_arg1 = raw_data[z*2] & 0xff;
+                tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+                baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+                if (syna_testdata->fd >= 0) {
+                    sprintf(data_buf, "%d, ", baseline_data);
+                    sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                TPD_DEBUG("baseline_data is %d\n", baseline_data);
+                if ((y < (syna_testdata->RX_NUM - 1)) && (x < (syna_testdata->TX_NUM - 2))) {
+                    TPD_DEBUG_NTAG("%d, ", baseline_data);
+                    if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                        TPD_INFO("Synaptic:touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        seq_printf(s, "touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        error_count++;
+                        goto END;
+                    }
+                } else if((x > (syna_testdata->TX_NUM-3))&&(y == (syna_testdata->RX_NUM-1))) {
+                    printk("%d, ", baseline_data);
+                    TPD_DEBUG("touchkey test xy(%d,%d),baseline_data=%d,limite( %d, %d)\n ",x,y, baseline_data,*(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                        TPD_INFO("Synaptic:touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        seq_printf(s, "touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        error_count++;
+                        goto END;
+                    }
+                }
+                count++;
+            }
+            if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+
+    //step 3 :check tx-to-tx and tx-to-vdd
+    TPD_INFO("step 3:check TRx-TRx & TRx-Vdd short\n");
+    ret = touch_i2c_write_byte(client, reg_info->F01_RMI_CMD_BASE, 0x01);//software reset TP
+    msleep(100);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x1A);//select report type 26
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x0);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    //msleep(100);
+    checkCMD(chip_info);
+    ret = touch_i2c_read_block(client, reg_info->F54_ANALOG_DATA_BASE + 3, 4, buffer);//for s3320 only need to check 32 Rx channels
+
+    //guomingqiang@phone.bsp, 2016-06-27, add for tp test step2
+    touch_i2c_write_byte(client, 0xff, 0x3);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+
+    TPD_DEBUG("RX_NUM : ");
+    for (i = 0; i< syna_testdata->RX_NUM; i++)
+        printk("%d, ", buffer_rx[i]);
+    printk("\n");
+
+    TPD_DEBUG("TX_NUM : ");
+    for (i = 0; i< syna_testdata->TX_NUM; i++)
+        printk("%d, ", buffer_tx[i]);
+    printk("\n");
+
+    for (x = 0; x < 4; x++) {
+        if (buffer[x] != 0) {
+            error_count++;
+            snprintf(data_buf, sizeof(data_buf), "step 3: check tx-to-tx and tx-to-vdd error, x = %d, data = %d\n", x, buffer[x]);
+            TPD_INFO("step 3: check tx-to-tx and tx-to-vdd error, x = %d, data = %d\n", x, buffer[x]);
+            seq_printf(s, data_buf);
+            if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+            }
+            goto END;
+        }
+    }
+
+    synaptics_reset(chip_info);
+    msleep(50);
+
+    //Step 4 : Check the broken line with RT133
+    TPD_INFO("Step 4 : Check the broken line\n" );
+    ret = touch_i2c_write_byte(client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x85);//select report type 0x85
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    for (y = 0; y < syna_testdata->RX_NUM; y++) {
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+        TPD_INFO("Step 4 data[%d] is %d\n", y, baseline_data);
+        if(baseline_data > 100)
+		{
+			error_count++;
+			TPD_INFO(" step 4 :check the broken line, error_line is y =%d\n",y);
+            seq_printf(s, "step 4 :check the broken line, error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+			goto END;
+		}
+    }
+
+    msleep(20);
+    TPD_INFO("Step 4 after read ret is %d\n", ret);
+
+END:
+    kfree(raw_data);
+    seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO("\n\nstep5 reset and open irq complete\n");
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    uint16_t baseline_data = 0;
+    uint8_t tmp_arg1 = 0;
+    uint8_t *raw_data = NULL;
+    int enable_cbc = 0;//enable cbc flag for baseline limit test
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+    synaptics_read_F54_base_reg(chip_info);
+    do {
+        if (enable_cbc) {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        } else {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+        }
+
+        if (ret < 0) {
+            TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+            seq_printf(s, "what the hell4, ");
+            goto END;
+        }
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 7, 0x01); //Disable Noise Mitigation, F54_ANALOG_CTRL20
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40); //Read Original CBC settings from F54_ANALOG_CTRL88
+        tmp_arg1 = ret & 0xff;
+
+        if (enable_cbc) {
+            seq_printf(s, "\nWith CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x20));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 | 0x20));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);// force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test enable cbc\n");
+        } else {
+            seq_printf(s, "\nWithout CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);// force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test disable cbc\n");
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            seq_printf(s, "[%2d] ", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                seq_printf(s, "%4d, ", baseline_data);
+            }
+            seq_printf(s, "\n");
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+
+END:
+    kfree(raw_data);
+    return ;
+}
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(30);
+    kfree(raw_data);
+}
+
+static void synaptics_self_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0;
+    uint8_t tmp_l = 0, tmp_h = 0;
+    int16_t temp_delta = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+     //prepare RT58 Test
+     ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+     ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE, 0x42);
+     ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE, 0xE1);
+     ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x80);
+     ret = touch_i2c_write_byte(chip_info->client, 0x00, 0x4F);
+     ret = touch_i2c_write_byte(chip_info->client, 0x00, 0x59);
+     ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+
+     /*disable irq when read data from IC*/
+     synaptics_read_F54_base_reg(chip_info);
+
+     //TPD_DEBUG("\nstep 2:report type2 delta image\n");
+     ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 58);//select report type 0x02
+     ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+     ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+     msleep(10);
+     checkCMD(chip_info);
+     for (x = 0; x < 1; x++) {
+         //TPD_INFO("\n[%d]", x);
+         seq_printf(s, "\n[%2d]", x);
+         for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+             ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+             tmp_l = ret & 0xff;
+             ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+             tmp_h = ret & 0xff;
+             temp_delta = (tmp_h << 8) | tmp_l;
+             seq_printf(s, "%4d, ", temp_delta);
+         }
+     }
+     seq_printf(s, "\n");
+     //ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x02);//force cal
+
+     ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 0
+     if (ret < 0) {
+         TPD_INFO("%s: failed for page select\n", __func__);
+     }
+
+     msleep(10);
+ }
+
+
+static void synaptics_self_raw_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0;
+    uint8_t tmp_0 = 0, tmp_1 = 0, tmp_2 = 0, tmp_3 = 0;
+    int32_t temp_raw = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+       return ;
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x50);
+    TPD_INFO("force doze is 0x%x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x50, (ret | 0x01));//set force doze 1
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x50);
+    TPD_INFO("force doze is 0x%x\n", ret);
+    msleep(30);
+    //TPD_DEBUG("\nstep 2:report type2 delta image\n");
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x26);//select report type 38
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+    for (x = 0; x < 1; x++) {
+        //TPD_INFO("\n[%d]", x);
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM; y++) {//self Abs raw data
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_0 = ret & 0xff;
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_1 = ret & 0xff;
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_2 = ret & 0xff;
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_3 = ret & 0xff;
+            temp_raw = tmp_3;
+            temp_raw = (temp_raw << 8) | tmp_2;
+            temp_raw = (temp_raw << 8) | tmp_1;
+            temp_raw = (temp_raw << 8) | tmp_0;
+            seq_printf(s, "%6d, ", temp_raw);
+        }
+    }
+    seq_printf(s, "\n");
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x50, 0x0);//set force doze 0
+    synaptics_reset(chip_info);     //reset
+    msleep(10);
+}
+
+static void synaptics_main_register_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    char buf[8];
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    seq_printf(s, "====================================================\n");
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE+0x04);
+    seq_printf(s, "Interference Metric: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE+0x08);
+    seq_printf(s, "Current Noise State: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE+0x0c);
+    seq_printf(s, "Sense Frequency Selection: 0x%x\n", ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        seq_printf(s, "%s: failed for page select\n", __func__);
+        return;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8, buf);
+    if (ret < 0) {
+        seq_printf(s, "touch_i2c_read_block error z = 0x%x\n", buf[5]);
+    }else {
+        seq_printf(s, "touch_i2c_read_block ok    z = 0x%x\n", buf[5]);
+    }
+    msleep(10);
+}
+
+//Reserved node
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    uint8_t x, y;
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint16_t baseline_data = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //1.get firmware doze mode info
+    TPD_INFO("1.get firmware doze mode info\n");
+    seq_printf(s, "1.get firmware doze mode info\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x19);
+    TPD_INFO("TP doze mode status is %d\n", ret);
+    seq_printf(s, "TP doze mode status is %d\n", ret);
+
+    msleep(10);
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    //2.get mutual capacitance key value, in order to calculate limite
+    TPD_INFO("2.get mutual capacitance key value, in order to calculate limite\n");
+    seq_printf(s, "2.get mutual capacitance key value, in order to calculate limite\n");
+    synaptics_reset(chip_info);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL42, 0x01);
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+        return ;
+    }
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);//force update
+    checkCMD(chip_info);
+    msleep(100);
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);//select report type 0x03
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+        return ;
+    }
+
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_arg1 = ret & 0xff;
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_arg2 = ret & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            TPD_DEBUG_NTAG("%d, ", baseline_data);
+            if (y == (chip_info->hw_res->RX_NUM-1)) {
+                if (x == (chip_info->hw_res->TX_NUM - 2)) {
+                    TPD_INFO("menu key %d [%d,%d]\n", baseline_data, MENU_LOW_LIMITE, MENU_HIGH_LIMITE);
+                    seq_printf(s, "menu key %d [%d,%d]\n", baseline_data, MENU_LOW_LIMITE, MENU_HIGH_LIMITE);
+                } else if (x == (chip_info->hw_res->TX_NUM - 1)) {
+                    TPD_INFO("back key %d [%d,%d]\n", baseline_data, BACK_LOW_LIMITE, BACK_HIGH_LIMITE);
+                    seq_printf(s, "back key %d [%d,%d]\n", baseline_data, BACK_LOW_LIMITE, BACK_HIGH_LIMITE);
+                }
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    msleep(10);
+}
+
+
+static int checkFlashState(struct chip_data_s3320 *chip_info)
+{
+    int ret ;
+    int count = 0;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+        count++;
+    }
+
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+/**
+ * re_scan_PDT -   rescan && init F34  base addr.
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void re_scan_PDT(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[8];
+
+    touch_i2c_read_block(chip_info->client, 0xE9, 6, buf);
+    chip_info->reg_info.F34_FLASH_DATA_BASE = buf[3];
+    chip_info->reg_info.F34_FLASH_QUERY_BASE = buf[0];
+    touch_i2c_read_block(chip_info->client, 0xE3, 6, buf);
+    chip_info->reg_info.F01_RMI_DATA_BASE = buf[3];
+    chip_info->reg_info.F01_RMI_CMD_BASE = buf[1];
+    touch_i2c_read_block(chip_info->client, 0xDD, 6, buf);
+
+    chip_info->reg_info.SynaF34Reflash_BlockNum    = chip_info->reg_info.F34_FLASH_DATA_BASE;
+    chip_info->reg_info.SynaF34Reflash_BlockData   = chip_info->reg_info.F34_FLASH_DATA_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_BootID = chip_info->reg_info.F34_FLASH_QUERY_BASE;
+    chip_info->reg_info.SynaF34ReflashQuery_FlashPropertyQuery = chip_info->reg_info.F34_FLASH_QUERY_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize  = chip_info->reg_info.F34_FLASH_QUERY_BASE + 2;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockCount = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockSize    = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockCount   = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    TPD_DEBUG("SynaFirmwareBlockSize is %d\n", (buf[0] | (buf[1] << 8)));
+    chip_info->reg_info.SynaF34_FlashControl = chip_info->reg_info.F34_FLASH_DATA_BASE + 2;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+    synaptics_parse_header(&header, fw->data);
+    if ((header.firmware_size + header.config_size + 0x100) > (uint32_t)fw->size) {
+        TPD_DEBUG("firmware_size + config_size + 0x100 > data_len data_len = %d \n", (uint32_t)fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+    Firmware_Data = fw->data + 0x100;
+    Config_Data = Firmware_Data + header.firmware_size;
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8)|buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8)|Config_Data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    //step 3:init needed params
+    re_scan_PDT(chip_info);
+    block = 16;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = header.firmware_size / 16;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = header.config_size / 16;
+    TPD_DEBUG("configuration is %d \n", configuration);
+
+    //step 3:Get into program mode
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", chip_info->reg_info.SynaF34_FlashControl, ret);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4\n");
+    ret = checkFlashState(chip_info);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return FW_UPDATE_ERROR;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE, ret&0x04);
+
+    /********************get into prog end************/
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(chip_info);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 2, buf);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, buf);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x03);
+    msleep(2000);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+    for (j = 0; j < firmware; j++) {
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Firmware_Data[j*16]);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    //step 5:flash configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    for (j = 0; j < configuration; j++) {
+        //a)write SynaF34Reflash_BlockNum to access
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Config_Data[j*16]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    return FW_UPDATE_SUCCESS;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t raw_data[1800] = {0};
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return fp_touch_state;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    ret = ret&0xF8;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (uint8_t)(ret)|0x80);//change to normal mode
+    msleep(1);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 124
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        return FINGER_PROTECT_TOUCH_DOWN;
+    }
+
+    fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data); //read baseline data
+    for (x = 1; x < TX_NUM - 3; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 0; y < (SPURIOUS_FP_RX_NUM - 2); y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if ((delta_data + SPURIOUS_FP_LIMIT) < 0) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug)
+                break;
+        }
+    }
+
+    TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,__LINE__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error,line=%d\n", __func__,__LINE__);
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+    return fp_touch_state;
+}
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x02);
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    TPD_INFO("touch key int_key code = %d\n",ret);
+
+    if (ret & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (ret & 0x02)
+        SET_BIT(bitmap_result, BIT_BACK);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    return bitmap_result;
+}
+
+/**
+ * synaptics_resume_prepare -   release inter pins before lcd resume flow(only gesture mode will hold those pins).
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void synaptics_resume_prepare(void *chip_data)
+{
+    synaptics_reset_for_prepare(chip_data);
+    msleep(10);
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        ret = -ENOMEM;
+        kfree(raw_data);
+        raw_data = NULL;
+        return;
+    }
+
+RE_TRY:
+    TPD_INFO("%s retry_time=%d line=%d\n",__func__,retry_time,__LINE__);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); //forcecal
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 0x02
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < TX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM*x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+    }
+
+    kfree(raw_data);
+}
+
+static void synaptics_register_info_read(void * chip_data, uint16_t register_addr, uint8_t * result, uint8_t length)
+{
+    int ret = 0;
+    uint8_t l_tmp = 0, h_tmp = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    l_tmp = register_addr & 0xFF;   //address
+    h_tmp = register_addr >> 8;     //page
+
+    if (h_tmp > 4) {
+        TPD_INFO("register_addr error!\n");
+        return;
+    }
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, h_tmp);    //set page
+    ret = touch_i2c_read_block(chip_info->client, l_tmp, length, result);     //read data
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+    .get_vendor       = synaptics_get_vendor,
+    .get_chip_info    = synaptics_get_chip_info,
+    .reset            = synaptics_reset,
+    .power_control    = synaptics_power_control,
+    .fw_check         = synaptics_fw_check,
+    .fw_update        = synaptics_fw_update,
+    .trigger_reason   = synaptics_trigger_reason,
+    .get_touch_points = synaptics_get_touch_points,
+    .get_gesture_info = synaptics_get_gesture_info,
+    .mode_switch      = synaptics_mode_switch,
+    .get_keycode      = synaptics_get_keycode,
+    .resume_prepare   = synaptics_resume_prepare,
+    .spurious_fp_check= synaptics_spurious_fp_check,
+    .finger_proctect_data_get = synaptics_finger_proctect_data_get,
+    .register_info_read = synaptics_register_info_read,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+    .auto_test     = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = synaptics_limit_read,
+    .delta_read    = synaptics_delta_read,
+    .self_delta_read    = synaptics_self_delta_read,
+    .baseline_read = synaptics_baseline_read,
+    .self_raw_read = synaptics_self_raw_read,
+    .main_register_read = synaptics_main_register_read,
+    .reserve_read = synaptics_reserve_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+
+    struct chip_data_s3320 *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_s3320), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->client = client;
+    chip_info->syna_ops = &synaptics_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &synaptics_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    //step6: collect data for supurious_fp_touch
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        synaptics_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    //step7:create synaptics related proc files
+    synaptics_create_proc(ts, chip_info->syna_ops);
+
+    //step8:Chip Related function
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data();
+    chip_info->premote_data = premote_data;
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->hw_res.irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(chip_info->enable_remote);
+        register_remote_device(premote_data);
+    }
+#endif
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device();
+#endif
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE,},
+    { .compatible = "synaptics-s3320",},
+    { }
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = synaptics_i2c_suspend,
+    .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = synaptics_tp_probe,
+    .remove     = synaptics_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320_17001.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320_17001.c
new file mode 100644
index 0000000000000000000000000000000000000000..e7f20a543581691f11cf17dcf77f7f33c83f7747
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_drivers_s3320_17001.c
@@ -0,0 +1,2023 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+ * File       : synaptics_drivers_s3320.c
+ * Description: Source file for synaptics S3320 driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "synaptics_s3320.h"
+
+static struct chip_data_s3320 *g_chip_info = NULL;
+
+/*******Part0:LOG TAG Declear********************/
+#define TPD_DEVICE "synaptics-s3320"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+/*******Part1: Function Declearation*******/
+static int synaptics_power_control(void *chip_data, bool enable);
+static int synaptics_get_chip_info(void *chip_data);
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag);
+static int checkCMD(struct chip_data_s3320 *chip_info);
+
+/*******Part2:Call Back Function implement*******/
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i, obj_attention;
+    unsigned char fingers_to_process = max_num;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    char buf[8*max_num];
+
+    memset(buf, 0, sizeof(buf));
+    obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+    for (i = 9;  ; i--) {
+        if ((obj_attention & 0x03FF) >> i  || i == 0)
+            break;
+        else
+            fingers_to_process--;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+    if (ret < 0) {
+        TPD_INFO("touch i2c read block failed\n");
+        return -1;
+    }
+    for (i = 0; i < fingers_to_process; i++) {
+        points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+        points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+        points[i].z = buf[i*8 + 5];
+        points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+        points[i].status = buf[i*8];
+    }
+
+    return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    chip_info->p_tp_fw = &panel_data->TP_FW;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[4] = {0};
+    int ret = 0;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+    chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+    chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+    chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+    TPD_INFO("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE    = %x \n\
+            F54_CTRL_BASE   = %x \n\
+            F54_DATA_BASE   = %x \n",
+            chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+            chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+
+    return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+    uint8_t buf[4] = {0};
+    int ret;
+    struct chip_data_s3320    *chip_info = (struct chip_data_s3320 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    memset(buf, 0, sizeof(buf));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    reg_info->F12_2D_QUERY_BASE = buf[0];
+    reg_info->F12_2D_CMD_BASE = buf[1];
+    reg_info->F12_2D_CTRL_BASE = buf[2];
+    reg_info->F12_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+            F12_2D_CMD_BASE    = 0x%x \n\
+            F12_2D_CTRL_BASE   = 0x%x \n\
+            F12_2D_DATA_BASE   = 0x%x \n",
+            reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+            reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+    reg_info->F01_RMI_QUERY_BASE = buf[0];
+    reg_info->F01_RMI_CMD_BASE = buf[1];
+    reg_info->F01_RMI_CTRL_BASE = buf[2];
+    reg_info->F01_RMI_DATA_BASE = buf[3];
+    TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+            F01_RMI_CMD_BASE    = 0x%x \n\
+            F01_RMI_CTRL_BASE   = 0x%x \n\
+            F01_RMI_DATA_BASE   = 0x%x \n",
+            reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+            reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F34_FLASH_QUERY_BASE = buf[0];
+    reg_info->F34_FLASH_CMD_BASE = buf[1];
+    reg_info->F34_FLASH_CTRL_BASE = buf[2];
+    reg_info->F34_FLASH_DATA_BASE = buf[3];
+    TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+            F34_FLASH_CMD_BASE      = 0x%x \n\
+            F34_FLASH_CTRL_BASE     = 0x%x \n\
+            F34_FLASH_DATA_BASE     = 0x%x \n",
+            reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+            reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+    reg_info->F01_RMI_QUERY11 = reg_info->F01_RMI_QUERY_BASE + 0x0b;    // product id
+    reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+    reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+    reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+    reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;
+    reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+    reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;               // max XY Coordinate
+    reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 9;           //glove enable
+    reg_info->F12_2D_CTRL32 = reg_info->F12_2D_CTRL_BASE + 0x10;        //moisture enable
+    reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 1;           //gesture type
+    reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 3;           //object attention
+    reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;
+    reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x07;        //motion suppression
+    reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x0c;        // wakeup Gesture enable
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+    reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+    reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+    reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+    TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+            F51_CUSTOM_CMD_BASE     = 0x%x \n\
+            F51_CUSTOM_CTRL_BASE    = 0x%x \n\
+            F51_CUSTOM_DATA_BASE    = 0x%x \n",
+            reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+            reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+    reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;       //no use
+    reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;       //wakeup gesture data
+    reg_info->F51_CUSTOM_CTRL50 = reg_info->F51_CUSTOM_CTRL_BASE + 0x08;//edge function register, realy use F51_CUSTOM_CTRL30 register
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    reg_info->F55_SENSOR_CTRL01 = 0x01;      //rx  number
+    reg_info->F55_SENSOR_CTRL02 = 0x02;      //tx  number
+    // select page 0
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+/**
+ * synaptics_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t synaptics_get_fw_id(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[4];
+    uint32_t current_firmware = 0;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint32_t bootloader_mode;
+    int max_y_ic = 0;
+    int max_x_ic = 0;
+    uint8_t buf[4];
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/**
+ * synaptics_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int synaptics_enable_interrupt(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+    uint8_t abs_status_int;
+
+    TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00 + 1, abs_status_int);
+    if (ret < 0) {
+        TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+
+    return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    uint8_t device_status = 0;
+    uint8_t interrupt_status = 0;
+    u8 result_event = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+#ifdef CONFIG_SYNAPTIC_RED
+    if (chip_info->enable_remote)
+        return IRQ_IGNORE;
+#endif
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+        return IRQ_EXCEPTION;
+    }
+    device_status = ret & 0xff;
+    interrupt_status = (ret & 0x7f00) >> 8;
+
+    if (device_status) {
+        TPD_INFO("%s, IRQ_EXCEPTION ,interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+        return IRQ_EXCEPTION;
+    }
+    if (interrupt_status & 0x04) {
+        if ((gesture_enable == 1) && is_suspended) {
+            return IRQ_GESTURE;
+        }
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+    if (interrupt_status & 0x10) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+
+    return  result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio \n");
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+
+    return 0;
+}
+
+static int synaptics_reset_for_prepare(void *chip_data)
+{
+    int ret = -1;
+    int i2c_error_number = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    while ((ret < 0) && (i2c_error_number < I2C_ERROR_MAX_TIME)) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        if (ret < 0) {
+            TPD_INFO("%s error, ret = %d i2c_error_number=%d\n", __func__, ret,i2c_error_number);
+        }
+        i2c_error_number++;
+    }
+    if (i2c_error_number == I2C_ERROR_MAX_TIME) {
+        TPD_INFO("i2c_error_number=%d , pull down tp 3V ,then pull up\n",i2c_error_number);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        msleep(30);
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        msleep(80);
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        if (ret < 0) {
+            TPD_INFO("%s error, ret = %d\n", __func__, ret);
+        }
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+
+    return ret;
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int synaptics_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    clear_view_touchdown_flag(); //clear touch download flag
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+    msleep(RESET_TO_NORMAL_TIME);
+
+    return ret;
+}
+
+static int synaptics_configuration_init(struct chip_data_s3320 *chip_info, bool config)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    //device control: normal operation
+    if (config) {//configed  && out of sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    } else {//sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x81);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+        return ret;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+    unsigned char report_gesture_ctrl_buf[3];
+    unsigned char wakeup_gesture_enable_buf;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    if (enable) {
+        report_gesture_ctrl_buf[2] |= 0x02 ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x3);         //set doze interval to 30ms
+    } else  {
+        report_gesture_ctrl_buf[2] &= 0xfd ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x1);         //set doze interval to 10ms
+    }
+
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    wakeup_gesture_enable_buf = 0xef;   // all kinds of gesture except triangle
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL27, wakeup_gesture_enable_buf);
+
+    return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_s3320 *chip_info, bool enable)
+{
+    int ret;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50);
+    if (enable) {
+        ret |= 0x01;
+    } else  {
+        ret &= 0xfe;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50);
+    TPD_INFO("%s %s, write back value = 0x%x\n", enable ? "enable" : "disable", __func__, ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    return ret;
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = synaptics_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = synaptics_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            ret = synaptics_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            /*device control: sleep mode*/
+            ret = synaptics_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = synaptics_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+            ret = synaptics_glove_mode_enable(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable glove mode failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_EDGE:
+            ret = synaptics_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = 0, i, gesture_sign, regswipe;
+    uint8_t gesture_buffer[10];
+    uint8_t coordinate_buf[25] = {0};
+    uint16_t trspoint = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    regswipe = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 0x18);
+
+    TPD_DEBUG("gesture_buffer[0] = 0x%x, regswipe = 0x%x, gesture_buffer[1] = 0x%x, gesture_buffer[4] = 0x%x\n",
+            gesture_buffer[0], regswipe, gesture_buffer[1], gesture_buffer[4]);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    gesture_sign = gesture_buffer[0];
+
+    //detect the gesture mode
+    switch (gesture_sign)
+    {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case SWIPE_DETECT:
+            gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                (regswipe == 0x42) ? Right2LeftSwip   :
+                (regswipe == 0x44) ? Up2DownSwip      :
+                (regswipe == 0x48) ? Down2UpSwip      :
+                (regswipe == 0x80) ? DouSwip          :
+                UnkownGesture;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            break;
+        case VEE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                (gesture_buffer[2] == 0x02) ? UpVee    :
+                (gesture_buffer[2] == 0x04) ? RightVee :
+                (gesture_buffer[2] == 0x08) ? LeftVee  :
+                UnkownGesture;
+            break;
+        case UNICODE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x77 && gesture_buffer[3] == 0x00) ? Wgestrue :
+                (gesture_buffer[2] == 0x6d && gesture_buffer[3] == 0x00) ? Mgestrue :
+                UnkownGesture;
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+    TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d\n", __func__, gesture_sign, gesture->gesture_type);
+
+    if (gesture->gesture_type != UnkownGesture) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA,      8, &(coordinate_buf[0]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 8,  8, &(coordinate_buf[8]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 16, 8, &(coordinate_buf[16]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 24, 1, &(coordinate_buf[24]));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        for (i = 0; i < 23; i += 2) {
+            trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+            TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+        }
+
+        TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+        gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+        gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+        gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+        gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+        gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+        gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+        gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+        gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+        gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+        gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+        gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+        gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+        gesture->clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+            (coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+    }
+
+    return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        synaptics_resetgpio_set(chip_info->hw_res, true);
+        msleep(RESET_TO_NORMAL_TIME);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return ret;
+}
+
+static int checkCMD(struct chip_data_s3320 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < 30));
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+    return ret;
+}
+
+static bool checkCMD_for_short_test(struct chip_data_s3320 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        if ((ret & 0x02) || (ret & 0x04)) {
+            break;
+        }
+        flag_err++;
+    } while ((flag_err < 30));
+    if ((ret & 0x02) || (ret & 0x04)) {
+        return true;
+    } else {
+        TPD_INFO("checkCMD_for_short_test ret is %x flag_err is %d\n", ret, flag_err);
+        return false;
+    }
+}
+
+static int checkCMD_for_finger(struct chip_data_s3320 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    if (chip_info->p_spuri_fp_touch == NULL) {
+        TPD_INFO("checkCMD_for_finger() chip_info->p_spuri_fp_touch == NULL\n");
+        return -1;
+    }
+
+    do {
+        msleep(10); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+    }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+    TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    if (10 == flag_err) {
+        TPD_INFO("checkCMD_for_finger error,reset  then msleep(80)\n");
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+        synaptics_reset(chip_info);
+        msleep(80);
+        synaptics_mode_switch(chip_info, MODE_NORMAL, true);
+        return -1;
+    } else {
+        TPD_INFO("checkCMD_for_finger ok\n");
+        return 0;
+    }
+}
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    uint8_t x, y;
+    uint8_t i;
+    uint8_t buffer_rx[syna_testdata->RX_NUM];
+    uint8_t buffer_tx[syna_testdata->TX_NUM];
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint8_t buffer[9];
+    uint16_t baseline_data = 0;
+    uint16_t *baseline_data_test;
+    uint16_t count = 0;
+    int ret = 0;
+    int error_count = 0;
+    int enable_cbc = 1;
+    int eint_status, eint_count = 0, read_gpio_num = 0;
+    uint8_t data_buf[256];
+    struct test_header *ph = NULL;
+    uint16_t z = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t doze_data;
+
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        error_count++;
+        snprintf(data_buf, sizeof(data_buf), "raw_data kzalloc error\n");
+        TPD_INFO("%s", data_buf);
+        goto END;
+    }
+
+    //open file to save test data
+    ph = (struct test_header *)(syna_testdata->fw->data);
+
+    TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+    ret = synaptics_enable_interrupt(chip_info, false);
+
+    eint_count = 0;
+    read_gpio_num = 10;
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        error_count++;
+        snprintf(data_buf, sizeof(data_buf), "step 0: begin to check INT-GND short item,"
+                            "eint_status is low, TP EINT direct stort\n");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        TPD_INFO("%s", data_buf);
+        goto END;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    //step 1: Close CBC and test RT20
+    TPD_INFO("\n step 1:Close CBC and test RT20\n");
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+    if (ret < 0) {
+        error_count++;
+        snprintf(data_buf, sizeof(data_buf), "step 1: Close CBC and test RT20 error,"
+                            "[line:%d]touch_i2c_write_byte failed \n", __LINE__);
+        TPD_INFO("%s", data_buf);
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 7, 0x01);    //Disable Noise Mitigation, F54_ANALOG_CTRL20
+    TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+    ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40);        //Read Original CBC settings from F54_ANALOG_CTRL88
+    tmp_arg1 = ret&0xff;
+
+    //Close CBC
+    TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88, close CBC
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+    checkCMD(chip_info);
+    TPD_DEBUG("Test disable cbc\n");
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                snprintf(data_buf, sizeof(data_buf), "%d, ", baseline_data);
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+            }
+
+            if ((x < (syna_testdata->TX_NUM - 1))
+             && (y < (syna_testdata->RX_NUM - 2))) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+
+                if ((baseline_data < *(baseline_data_test + count*2))
+                 || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                    snprintf(data_buf, sizeof(data_buf), "step 1: Close CBC and test RT20 error,"
+                                        "baseline_data[%d][%d] = %d[%d, %d]\n",
+                                        x, y, baseline_data,
+                                        *(baseline_data_test + count*2),
+                                        *(baseline_data_test + count*2 + 1));
+                    TPD_INFO("%s", data_buf);
+                    error_count++;
+                    if (tp_debug != 2) {
+                        goto END;
+                    }
+                }
+            } else if ((x == (syna_testdata->TX_NUM - 1))
+                   && (y > (syna_testdata->RX_NUM - 3))) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+
+                if (((baseline_data) < *(baseline_data_test + count*2))
+                 || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                    snprintf(data_buf, sizeof(data_buf), "step 1: Close CBC and test RT20 error,"
+                                        "touch key baseline_data[%d][%d] = %d[%d, %d]\n",
+                                        x, y, baseline_data,
+                                        *(baseline_data_test + count*2),
+                                        *(baseline_data_test + count*2 + 1));
+                    TPD_INFO("%s", data_buf);
+                    error_count++;
+                    if (tp_debug != 2) {
+                        goto END;
+                    }
+                }
+            }
+            count++;
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+    if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+    }
+
+    //step 2: Open CBC and test RT3
+    TPD_INFO("\n step 2:Open CBC and test RT3\n");
+    do{
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        if (ret < 0) {
+            snprintf(data_buf, sizeof(data_buf), "step 2:Open CBC and test RT3 error, "
+                                "[line:%d]touch_i2c_write_byte failed \n", __LINE__);
+            TPD_INFO("%s", data_buf);
+            error_count++;
+            goto END;
+        }
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 7, 0x01);//Disable Noise Mitigation, F54_ANALOG_CTRL20
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40);        //Read Original CBC settings from F54_ANALOG_CTRL88
+        tmp_arg1 = ret&0xff;
+
+        if (enable_cbc) {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x20));
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 | 0x20));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test enable cbc\n");
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limitcbc_offset);
+        } else {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test disable cbc\n");
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+        }
+
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info);
+
+        TPD_INFO("RX_NUM is %d, TX_NUM is %d\n", syna_testdata->RX_NUM, syna_testdata->TX_NUM);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+        count = 0;
+        for (x = 0; x < syna_testdata->TX_NUM; x++) {
+            TPD_DEBUG_NTAG("[%d]: ", x);
+            for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                z = syna_testdata->RX_NUM * x + y;
+                tmp_arg1 = raw_data[z*2] & 0xff;
+                tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+                baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+                if (syna_testdata->fd >= 0) {
+                    snprintf(data_buf, sizeof(data_buf), "%d, ", baseline_data);
+                    sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                TPD_DEBUG("baseline_data is %d\n", baseline_data);
+                if ((x < (syna_testdata->TX_NUM - 1)) && (y < (syna_testdata->RX_NUM - 2))) {
+                    TPD_DEBUG_NTAG("%d, ", baseline_data);
+                    if ((baseline_data < *(baseline_data_test + count*2))
+                        || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                        snprintf(data_buf, sizeof(data_buf), "step 2: Open CBC and test RT3 error,"
+                                            "baseline_data[%d][%d] = %d[%d, %d]\n",
+                                            x, y, baseline_data,
+                                            *(baseline_data_test + count*2),
+                                            *(baseline_data_test + count*2 + 1));
+                        TPD_INFO("%s", data_buf);
+                        error_count++;
+                        if (tp_debug != 2) {
+                            goto END;
+                        }
+                    }
+                } else if ((x == (syna_testdata->TX_NUM - 1)) && (y > (syna_testdata->RX_NUM - 3))) {
+                    TPD_DEBUG_NTAG("%d, ", baseline_data);
+                    if (((baseline_data) < *(baseline_data_test + count*2))
+                        || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                        snprintf(data_buf, sizeof(data_buf), "step 2: Open CBC and test RT3 error,"
+                                            "touchkey baseline_data[%d][%d] = %d[%d, %d]\n",
+                                            x, y, baseline_data,
+                                            *(baseline_data_test + count*2),
+                                            *(baseline_data_test + count*2 + 1));
+                        TPD_INFO("%s", data_buf);
+                        error_count++;
+                        if (tp_debug != 2) {
+                            goto END;
+                        }
+                    }
+                }
+                count++;
+            }
+            if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+
+    //step 3 :check tx-to-tx and tx-to-vdd
+    TPD_INFO("step 3:check TRx-TRx & TRx-Vdd short\n");
+    ret = touch_i2c_write_byte(client, reg_info->F01_RMI_CMD_BASE, 0x01);//software reset TP
+    msleep(100);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x1A);//select report type 26
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x0);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    //msleep(100);
+    checkCMD(chip_info);
+    ret = touch_i2c_read_block(client, reg_info->F54_ANALOG_DATA_BASE + 3, 4, buffer);//for s3320 only need to check 32 Rx channels
+
+    //guomingqiang@phone.bsp, 2016-06-27, add for tp test step2
+    touch_i2c_write_byte(client, 0xff, 0x3);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+
+    TPD_DEBUG("RX_NUM : ");
+    for (i = 0; i< syna_testdata->RX_NUM; i++)
+        printk("%d, ", buffer_rx[i]);
+    printk("\n");
+
+    TPD_DEBUG("TX_NUM : ");
+    for (i = 0; i< syna_testdata->TX_NUM; i++)
+        printk("%d, ", buffer_tx[i]);
+    printk("\n");
+
+    for (x = 0; x < 4; x++) {
+        if (buffer[x] != 0) {
+            error_count++;
+            snprintf(data_buf, sizeof(data_buf), "step 3: check tx-to-tx and tx-to-vdd error,"
+                                "x = %d, data = %d\n", x, buffer[x]);
+            TPD_INFO("%s", data_buf);
+            if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+            }
+            goto END;
+        }
+    }
+
+    synaptics_reset(chip_info);
+    msleep(50);
+
+    //Step 4 : Check the broken line with RT133
+    TPD_INFO("Step 4 : Check the broken line\n" );
+    ret = touch_i2c_write_byte(client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x85);//select report type 0x85
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD_for_short_test(chip_info);
+
+    for (y = 0; y < syna_testdata->RX_NUM; y++) {
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+        TPD_DEBUG("Step 4 data[%d] is %d\n", y, baseline_data);
+        if (baseline_data > 100) {
+            error_count++;
+            snprintf(data_buf, sizeof(data_buf), "step 4 :Check the broken line with RT133 error,"
+                                "error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+            TPD_INFO("%s", data_buf);
+            goto END;
+        }
+    }
+
+    msleep(20);
+    TPD_INFO("Step 4 after read ret is %d\n", ret);
+
+    //step5: check doze mode
+    TPD_INFO("step5: check doze mode\n" );
+    synaptics_reset(chip_info);
+    ret = touch_i2c_write_byte(client, 0xff, 0x1);
+    ret |= touch_i2c_write_byte(client, 0x67, 0x01); //enter doze mode
+    msleep(100);
+
+    ret |= touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x25);//select report type 37
+    ret |= touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04); // force update
+    checkCMD_for_short_test(chip_info);
+    ret |= touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD_for_short_test(chip_info);
+    ret |= touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x0);//set fifo 0
+    ret |= touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD_for_short_test(chip_info);
+
+    touch_i2c_read_block(client, reg_info->F54_ANALOG_DATA_BASE + 3, (syna_testdata->TX_NUM + syna_testdata->RX_NUM) * 2, raw_data);
+    if (syna_testdata->fd >= 0) {
+        sys_write(syna_testdata->fd, "\nstep5: check doze mode\n", 1);
+    }
+
+    for (x = 0; x < syna_testdata->RX_NUM; x++) {
+        doze_data = (raw_data[x * 2 + 1] << 8) | raw_data[x * 2];
+        TPD_DEBUG("Doze %d: %d\n", x, doze_data);
+        if (syna_testdata->fd >= 0) {
+            snprintf(data_buf, sizeof(data_buf), "%d, ", doze_data);
+            sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+
+        if ((doze_data > LIMIT_DOZE) || (doze_data < LIMIT_DOZE_LOW)) {
+            error_count++;
+            snprintf(data_buf, sizeof(data_buf), "step5: check abs doze error,"
+                                "%d: %d not in( %d %d)\n", x, doze_data, LIMIT_DOZE, LIMIT_DOZE_LOW);
+            TPD_INFO("%s", data_buf);
+            goto END;
+        }
+    }
+
+END:
+    if (raw_data)
+        kfree(raw_data);
+    seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+    if (error_count) {
+        seq_printf(s, data_buf);
+    }
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO("\n\nstep5 reset and open irq complete\n");
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    uint16_t baseline_data = 0;
+    uint8_t tmp_arg1 = 0;
+    uint8_t *raw_data = NULL;
+    int enable_cbc = 0;//enable cbc flag for baseline limit test
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        return;
+    }
+    synaptics_read_F54_base_reg(chip_info);
+    do {
+        if (enable_cbc) {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        } else {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+        }
+
+        if (ret < 0) {
+            TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+            seq_printf(s, "what the hell4, ");
+            goto END;
+        }
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 7, 0x01); //Disable Noise Mitigation, F54_ANALOG_CTRL20
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40); //Read Original CBC settings from F54_ANALOG_CTRL88
+        tmp_arg1 = ret & 0xff;
+
+        if (enable_cbc) {
+            seq_printf(s, "\nWith CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x20));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 | 0x20));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);// force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test enable cbc\n");
+        } else {
+            seq_printf(s, "\nWithout CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 40, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);// force update
+            checkCMD(chip_info);
+            TPD_DEBUG("Test disable cbc\n");
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            seq_printf(s, "[%2d] ", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                seq_printf(s, "%4d, ", baseline_data);
+            }
+            seq_printf(s, "\n");
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+END:
+    kfree(raw_data);
+    return ;
+}
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+    int i = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    for (i = 0; i < 2; i++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+        seq_printf(s, "checkCMD error, can not read delta data\n");
+        TPD_INFO("checkCMD error, can not read delta data\n");
+        goto OUT;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+OUT:
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(30);
+    kfree(raw_data);
+}
+
+static void synaptics_main_register_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    uint8_t buf[8];
+    int i = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    /*disable irq when read data from IC*/
+    seq_printf(s, "====================================================\n");
+    seq_printf(s, "tp fw = 0x%x\n", *(chip_info->p_tp_fw));
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE - 1);
+    seq_printf(s, "F34_FLASH_DATA03 Flash Status: 0x%x\n", ret);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+    }
+    seq_printf(s, "F01_RMI_DATA00 Device Status: 0x%x\n", ret & 0xff);
+    seq_printf(s, "F01_RMI_DATA01.00 Interrupt Status: 0x%x\n", (ret & 0x7f00) >> 8);
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8, buf);
+    seq_printf(s, "F12_2D_DATA01(00)/00 Object Type and Status 0: \n");
+    for (i = 0; i < 8; i++)
+        seq_printf(s, "0x%x\n", buf[i]);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    seq_printf(s, "F01_RMI_CTRL00 Device Control: 0x%x\n", ret);
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x04);
+    seq_printf(s, "Interference Metric: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x08);
+    seq_printf(s, "Current Noise State: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x0b);
+    seq_printf(s, "Sense Frequency Selection: 0x%x\n", ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        seq_printf(s, "%s: failed for page select\n", __func__);
+        return;
+    }
+
+    msleep(10);
+}
+
+//Reserved node
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //1.get firmware doze mode info
+    TPD_INFO("1.get firmware doze mode info\n");
+    seq_printf(s, "1.get firmware doze mode info\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x19);
+    TPD_INFO("TP doze mode status is %d\n", ret);
+    seq_printf(s, "TP doze mode status is %d\n", ret);
+
+    msleep(10);
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    msleep(10);
+}
+
+static void synaptics_abs_doze_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0;
+    int16_t doze_data = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc((chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    synaptics_reset(chip_info);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    ret |= touch_i2c_write_byte(chip_info->client, 0x67, 0x01); //enter doze mode
+    msleep(100);
+
+    ret |= touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x25);//select report type 37
+    ret |= touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); // force update
+    checkCMD_for_short_test(chip_info);
+    ret |= touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD_for_short_test(chip_info);
+    ret |= touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x0);//set fifo 0
+    ret |= touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD_for_short_test(chip_info);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, (chip_info->hw_res->TX_NUM + chip_info->hw_res->RX_NUM) * 2, raw_data);
+    TPD_INFO("abs doze(limite-%d): ",LIMIT_DOZE);
+    seq_printf(s, "abs doze(limite-%d): ",LIMIT_DOZE);
+    for (x = 0; x < chip_info->hw_res->RX_NUM; x++) {
+        doze_data = (raw_data[x * 2 + 1] << 8) | raw_data[x * 2];
+        printk("%4d, ", doze_data);
+        seq_printf(s, "%4d, ", doze_data);
+    }
+    TPD_INFO("\n");
+    seq_printf(s, "\n");
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(30);
+}
+
+static int checkFlashState(struct chip_data_s3320 *chip_info)
+{
+    int ret ;
+    int count = 0;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+        count++;
+    }
+
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+/**
+ * re_scan_PDT -   rescan && init F34  base addr.
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void re_scan_PDT(struct chip_data_s3320 *chip_info)
+{
+    uint8_t buf[8];
+
+    touch_i2c_read_block(chip_info->client, 0xE9, 6, buf);
+    chip_info->reg_info.F34_FLASH_DATA_BASE = buf[3];
+    chip_info->reg_info.F34_FLASH_QUERY_BASE = buf[0];
+    touch_i2c_read_block(chip_info->client, 0xE3, 6, buf);
+    chip_info->reg_info.F01_RMI_DATA_BASE = buf[3];
+    chip_info->reg_info.F01_RMI_CMD_BASE = buf[1];
+    touch_i2c_read_block(chip_info->client, 0xDD, 6, buf);
+
+    chip_info->reg_info.SynaF34Reflash_BlockNum    = chip_info->reg_info.F34_FLASH_DATA_BASE;
+    chip_info->reg_info.SynaF34Reflash_BlockData   = chip_info->reg_info.F34_FLASH_DATA_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_BootID = chip_info->reg_info.F34_FLASH_QUERY_BASE;
+    chip_info->reg_info.SynaF34ReflashQuery_FlashPropertyQuery = chip_info->reg_info.F34_FLASH_QUERY_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize  = chip_info->reg_info.F34_FLASH_QUERY_BASE + 2;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockCount = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockSize    = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockCount   = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    TPD_DEBUG("SynaFirmwareBlockSize is %d\n", (buf[0] | (buf[1] << 8)));
+    chip_info->reg_info.SynaF34_FlashControl = chip_info->reg_info.F34_FLASH_DATA_BASE + 2;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+    synaptics_parse_header(&header, fw->data);
+    if ((header.firmware_size + header.config_size + 0x100) > (uint32_t)fw->size) {
+        TPD_DEBUG("firmware_size + config_size + 0x100 > data_len data_len = %d \n", (uint32_t)fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+    Firmware_Data = fw->data + 0x100;
+    Config_Data = Firmware_Data + header.firmware_size;
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8)|buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8)|Config_Data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    //step 3:init needed params
+    re_scan_PDT(chip_info);
+    block = 16;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = header.firmware_size / 16;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = header.config_size / 16;
+    TPD_DEBUG("configuration is %d \n", configuration);
+
+    //step 3:Get into program mode
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", chip_info->reg_info.SynaF34_FlashControl, ret);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4\n");
+    ret = checkFlashState(chip_info);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return FW_UPDATE_ERROR;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE, ret&0x04);
+
+    /********************get into prog end************/
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(chip_info);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 2, buf);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, buf);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x03);
+    msleep(2000);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+    for (j = 0; j < firmware; j++) {
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Firmware_Data[j*16]);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    //step 5:flash configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    for (j = 0; j < configuration; j++) {
+        //a)write SynaF34Reflash_BlockNum to access
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Config_Data[j*16]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    return FW_UPDATE_SUCCESS;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t raw_data[1800] = {0};
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return fp_touch_state;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    ret = (ret & 0xF8) | 0x80;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, ret);   //exit sleep
+    msleep(1);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 124
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        return FINGER_PROTECT_TOUCH_DOWN;
+    }
+
+    fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, RX_NUM*SPURIOUS_FP_TX_NUM*2, raw_data); //read baseline data
+    for (x = 0; x < SPURIOUS_FP_TX_NUM - 2; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 1; y < (RX_NUM - 3); y++) {
+            z = RX_NUM * x + y;
+            temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if ((delta_data + SPURIOUS_FP_LIMIT) < 0) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug) {
+                TPD_INFO("finger protect trigger!report_finger_protect = %d\n", fp_touch_state);
+                break;
+            }
+        }
+    }
+
+    TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,__LINE__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error,line=%d\n", __func__,__LINE__);
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+    return fp_touch_state;
+}
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x02);
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    TPD_INFO("touch key int_key code = %d\n",ret);
+
+    if (ret & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (ret & 0x02)
+        SET_BIT(bitmap_result, BIT_BACK);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    return bitmap_result;
+}
+
+/**
+ * synaptics_resume_prepare -   release inter pins before lcd resume flow(only gesture mode will hold those pins).
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void synaptics_resume_prepare(void *chip_data)
+{
+    synaptics_reset_for_prepare(chip_data);
+    msleep(10);
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_s3320 *chip_info = (struct chip_data_s3320 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        ret = -ENOMEM;
+    }
+
+RE_TRY:
+    TPD_INFO("%s retry_time=%d line=%d\n",__func__,retry_time,__LINE__);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); //forcecal
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 0x02
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, RX_NUM*SPURIOUS_FP_TX_NUM*2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < SPURIOUS_FP_TX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < RX_NUM; y++) {
+            z = RX_NUM * x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+    }
+
+    kfree(raw_data);
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+    .get_vendor       = synaptics_get_vendor,
+    .get_chip_info    = synaptics_get_chip_info,
+    .reset            = synaptics_reset,
+    .power_control    = synaptics_power_control,
+    .fw_check         = synaptics_fw_check,
+    .fw_update        = synaptics_fw_update,
+    .trigger_reason   = synaptics_trigger_reason,
+    .get_touch_points = synaptics_get_touch_points,
+    .get_gesture_info = synaptics_get_gesture_info,
+    .mode_switch      = synaptics_mode_switch,
+    .get_keycode      = synaptics_get_keycode,
+    .resume_prepare   = synaptics_resume_prepare,
+    .spurious_fp_check= synaptics_spurious_fp_check,
+    .finger_proctect_data_get = synaptics_finger_proctect_data_get,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+    .auto_test     = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = synaptics_limit_read,
+    .delta_read    = synaptics_delta_read,
+    .baseline_read = synaptics_baseline_read,
+    .main_register_read = synaptics_main_register_read,
+    .reserve_read = synaptics_reserve_read,
+    .abs_doze_read = synaptics_abs_doze_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+
+    struct chip_data_s3320 *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_s3320), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->client = client;
+    chip_info->p_spuri_fp_touch = &(ts->spuri_fp_touch);
+    chip_info->syna_ops = &synaptics_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &synaptics_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    //step6: collect data for supurious_fp_touch
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        synaptics_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    //step7:create synaptics related proc files
+    synaptics_create_proc(ts, chip_info->syna_ops);
+
+    //step8:Chip Related function
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data();
+    chip_info->premote_data = premote_data;
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->hw_res.irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(chip_info->enable_remote);
+        register_remote_device(premote_data);
+    }
+#endif
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device();
+#endif
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE,},
+    { .compatible = "synaptics-s3320",},
+    { }
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = synaptics_i2c_suspend,
+    .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = synaptics_tp_probe,
+    .remove     = synaptics_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_s3320.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_s3320.h
new file mode 100644
index 0000000000000000000000000000000000000000..3f6c5c686fd71cbe1024d5296f013fc553e85b03
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3320/synaptics_s3320.h
@@ -0,0 +1,146 @@
+/***************************************************
+ * File:synaptics_drivers_s3320.h
+ * Copyright(C) 2008-2012 OPPO Mobile Comm Corp., Ltd
+ * Description:
+ *             synaptics s3320 driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+   <author >  <data>  <version>  <desc>
+****************************************************/
+
+#ifndef SYNAPTICS_H_S3320
+#define SYNAPTICS_H_S3320
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../synaptics_common.h"
+#ifdef CONFIG_SYNAPTIC_RED
+#include "../synaptics_touch_panel_remote.h"
+#endif
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE      0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE    0x02
+#define ENABLE_DTAP     0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT      0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT    0x07
+#define DTAP_DETECT     0x03
+
+#define RESET_TO_NORMAL_TIME 80    /*Sleep time after reset*/
+
+#define SPURIOUS_FP_LIMIT 60
+#define SPURIOUS_FP_RX_NUM 9
+#define SPURIOUS_FP_TX_NUM 9
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+#define I2C_ERROR_MAX_TIME 5
+
+//Self Capacitance key test limite
+#define MENU_LOW_LIMITE  1630
+#define MENU_HIGH_LIMITE 3803
+
+#define BACK_LOW_LIMITE 3016
+#define BACK_HIGH_LIMITE 7039
+
+#define LIMIT_DOZE  3900
+#define LIMIT_DOZE_LOW  200
+
+#define COMMAND_FORCE_UPDATE 4
+
+/*********PART3:Struct Area**********************/
+struct synaptics_register
+{
+    uint8_t F01_RMI_QUERY_BASE;
+    uint8_t F01_RMI_CMD_BASE;
+    uint8_t F01_RMI_CTRL_BASE;
+    uint8_t F01_RMI_DATA_BASE;
+
+    uint8_t F01_RMI_QUERY11;
+    uint8_t F01_RMI_DATA01;
+    uint8_t F01_RMI_CMD00;
+    uint8_t F01_RMI_CTRL00;
+    uint8_t F01_RMI_CTRL01;
+    uint8_t F01_RMI_CTRL02;
+
+    uint8_t F12_2D_QUERY_BASE;
+    uint8_t F12_2D_CMD_BASE;
+    uint8_t F12_2D_CTRL_BASE;
+    uint8_t F12_2D_DATA_BASE;
+
+    uint8_t F12_2D_CTRL08;
+    uint8_t F12_2D_CTRL20;
+    uint8_t F12_2D_CTRL23;
+    uint8_t F12_2D_CTRL27;
+    uint8_t F12_2D_CTRL32;
+    uint8_t F12_2D_DATA04;
+    uint8_t F12_2D_DATA15;
+    uint8_t F12_2D_DATA38;
+    uint8_t F12_2D_DATA39;
+    uint8_t F12_2D_CMD00;
+
+    uint8_t F34_FLASH_QUERY_BASE;
+    uint8_t F34_FLASH_CMD_BASE;
+    uint8_t F34_FLASH_CTRL_BASE;
+    uint8_t F34_FLASH_DATA_BASE;
+
+    uint8_t SynaF34_FlashControl;
+    uint8_t SynaF34Reflash_BlockNum;
+    uint8_t SynaF34Reflash_BlockData;
+    uint8_t SynaF34ReflashQuery_BootID;
+    uint8_t SynaF34ReflashQuery_FlashPropertyQuery;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockSize;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockCount;
+    uint8_t SynaF34ReflashQuery_ConfigBlockSize;
+    uint8_t SynaF34ReflashQuery_ConfigBlockCount;
+
+    uint8_t F51_CUSTOM_QUERY_BASE;
+    uint8_t F51_CUSTOM_CMD_BASE;
+    uint8_t F51_CUSTOM_CTRL_BASE;
+    uint8_t F51_CUSTOM_DATA_BASE;
+
+    uint8_t F51_CUSTOM_CTRL00;
+    uint8_t F51_CUSTOM_CTRL31;
+    uint8_t F51_CUSTOM_CTRL42;
+    uint8_t F51_CUSTOM_CTRL50;
+    uint8_t F51_CUSTOM_DATA;
+
+    uint8_t F54_ANALOG_QUERY_BASE;
+    uint8_t F54_ANALOG_COMMAND_BASE;
+    uint8_t F54_ANALOG_CONTROL_BASE;
+    uint8_t F54_ANALOG_DATA_BASE;
+    uint8_t F54_ANALOG_CTRL123;
+
+    uint8_t F55_SENSOR_CTRL01;
+    uint8_t F55_SENSOR_CTRL02;
+};
+
+struct chip_data_s3320 {
+    uint32_t *p_tp_fw;
+    tp_dev tp_type;
+    struct i2c_client *client;
+    struct synaptics_proc_operations *syna_ops; /*synaptics func provide to synaptics common driver*/
+#ifdef CONFIG_SYNAPTIC_RED
+    int    enable_remote;                       /*Redremote connect state*/
+    struct remotepanel_data *premote_data;
+#endif/*CONFIG_SYNAPTIC_RED*/
+    struct synaptics_register     reg_info;
+    struct hw_resource          *hw_res;
+    int16_t *spuri_fp_data;
+    struct spurious_fp_touch *p_spuri_fp_touch;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..30144f1c16565dbb79dfd322fe65e449c2ab33a5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+config TOUCHPANEL_SYNAPTICS_S3508
+#	default y
+	bool "TP Synaptics_S3508 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics s3508
+	
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..faad8224a447af69ddc0db99e7420b36284f0cf2
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3508) += synaptics_drivers_s3508.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_drivers_s3508.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_drivers_s3508.c
new file mode 100644
index 0000000000000000000000000000000000000000..619559380a7233610bdf64fb9de61d95263d791d
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_drivers_s3508.c
@@ -0,0 +1,2076 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.£¬
+ * File       : synaptics_drivers_s3508.c
+ * Description: Source file for synaptics S3508 driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "synaptics_s3508.h"
+
+static struct chip_data_s3508 *g_chip_info = NULL;
+extern int tp_register_times;
+void __attribute__((weak)) tfa_mutex_lock(bool enable) {return;}    //mutex avoid i2c transfer in tp reset process
+
+/*******Part0:LOG TAG Declear********************/
+
+#define TPD_DEVICE "synaptics-s3508"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+/*******Part1:Call Back Function implement*******/
+
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i, obj_attention;
+    unsigned char fingers_to_process = max_num;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+    char buf[8*max_num];
+
+    memset(buf, 0, sizeof(buf));
+    obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+    for (i = 9;  ; i--) {
+        if ((obj_attention & 0x03FF) >> i  || i == 0)
+            break;
+        else
+            fingers_to_process--;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+    if (ret < 0) {
+        TPD_INFO("touch i2c read block failed\n");
+        return -1;
+    }
+    for (i = 0; i< fingers_to_process; i++) {
+        points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+        points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+        points[i].z = buf[i*8 + 5];
+        points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+        points[i].status = buf[i*8];
+    }
+
+    return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    char manu_temp[MAX_DEVICE_MANU_LENGTH] = SYNAPTICS_PREFIX;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+    strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_s3508 *chip_info)
+{
+    uint8_t buf[4] = {0};
+    int ret = 0;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+    chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+    chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+    chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+    TPD_INFO("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE    = %x \n\
+            F54_CTRL_BASE   = %x \n\
+            F54_DATA_BASE   = %x \n",
+            chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+            chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+
+    return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+    uint8_t buf[4] = {0};
+    int ret;
+    struct chip_data_s3508    *chip_info = (struct chip_data_s3508 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    memset(buf, 0, sizeof(buf));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    reg_info->F12_2D_QUERY_BASE = buf[0];
+    reg_info->F12_2D_CMD_BASE = buf[1];
+    reg_info->F12_2D_CTRL_BASE = buf[2];
+    reg_info->F12_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+            F12_2D_CMD_BASE    = 0x%x \n\
+            F12_2D_CTRL_BASE   = 0x%x \n\
+            F12_2D_DATA_BASE   = 0x%x \n",
+            reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+            reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+    reg_info->F01_RMI_QUERY_BASE = buf[0];
+    reg_info->F01_RMI_CMD_BASE = buf[1];
+    reg_info->F01_RMI_CTRL_BASE = buf[2];
+    reg_info->F01_RMI_DATA_BASE = buf[3];
+    TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+            F01_RMI_CMD_BASE    = 0x%x \n\
+            F01_RMI_CTRL_BASE   = 0x%x \n\
+            F01_RMI_DATA_BASE   = 0x%x \n",
+            reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+            reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F34_FLASH_QUERY_BASE = buf[0];
+    reg_info->F34_FLASH_CMD_BASE = buf[1];
+    reg_info->F34_FLASH_CTRL_BASE = buf[2];
+    reg_info->F34_FLASH_DATA_BASE = buf[3];
+    TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+            F34_FLASH_CMD_BASE      = 0x%x \n\
+            F34_FLASH_CTRL_BASE     = 0x%x \n\
+            F34_FLASH_DATA_BASE     = 0x%x \n",
+            reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+            reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+    reg_info->F01_RMI_QUERY11 = reg_info->F12_2D_QUERY_BASE + 11;
+    reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+    reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+    reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+    reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;
+    reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+    reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;
+    reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 9;
+    reg_info->F12_2D_CTRL32 = reg_info->F12_2D_CTRL_BASE + 15;
+    reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 2;
+    reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 3;
+    reg_info->F12_2D_DATA38 = reg_info->F12_2D_DATA_BASE + 54;
+    reg_info->F12_2D_DATA39 = reg_info->F12_2D_DATA_BASE + 55;
+    reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;
+    reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x07;
+    reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x0c;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);     // page 4
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+    reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+    reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+    reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+    TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+            F51_CUSTOM_CMD_BASE     = 0x%x \n\
+            F51_CUSTOM_CTRL_BASE    = 0x%x \n\
+            F51_CUSTOM_DATA_BASE    = 0x%x \n",
+            reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+            reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+    reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;
+    reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;
+    reg_info->F51_CUSTOM_CTRL31 = reg_info->F51_CUSTOM_CTRL_BASE + 11;
+    reg_info->F51_CUSTOM_CTRL50 = reg_info->F51_CUSTOM_CTRL_BASE + 0x1B;
+
+    synaptics_read_F54_base_reg(chip_info);
+    reg_info->F55_SENSOR_CTRL01 = 0x01;
+    reg_info->F55_SENSOR_CTRL02 = 0x02;
+    // select page 0
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+/**
+ * synaptics_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t synaptics_get_fw_id(struct chip_data_s3508 *chip_info)
+{
+    uint8_t buf[4];
+    uint32_t current_firmware = 0;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint32_t bootloader_mode;
+    int max_y_ic = 0;
+    int max_x_ic = 0;
+    uint8_t buf[4];
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/**
+ * synaptics_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int synaptics_enable_interrupt(struct chip_data_s3508 *chip_info, bool enable)
+{
+    int ret;
+    uint8_t abs_status_int;
+
+    TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00 + 1, abs_status_int);
+    if (ret < 0) {
+        TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+
+    return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    uint8_t device_status = 0;
+    uint8_t interrupt_status = 0;
+    u8 result_event = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+#ifdef CONFIG_SYNAPTIC_RED
+    if (chip_info->enable_remote)
+        return IRQ_IGNORE;
+#endif
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+        return IRQ_EXCEPTION;
+    }
+    device_status = ret & 0xff;
+    interrupt_status = (ret & 0x7f00) >> 8;
+
+    if (device_status) {
+        TPD_INFO("%s, interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+        return IRQ_EXCEPTION;
+    }
+    if (interrupt_status & 0x04) {
+        if (gesture_enable && is_suspended) {
+            return IRQ_GESTURE;
+        }
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+    if (interrupt_status & 0x10) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+    if (interrupt_status & 0x40 && tp_debug != 0) {
+        SET_BIT(result_event, IRQ_DATA_LOGGER);
+    }
+
+    return  result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio \n");
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+
+    return 0;
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int synaptics_reset(void *chip_data)
+{
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    tfa_mutex_lock(true);
+    synaptics_resetgpio_set(chip_info->hw_res, false); // reset gpio
+    msleep(10);
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    msleep(RESET_TO_NORMAL_TIME);
+    tfa_mutex_lock(false);
+
+    return 0;
+}
+
+static int synaptics_configuration_init(struct chip_data_s3508 *chip_info, bool config)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    //device control: normal operation
+    if (config) {//configed  && out of sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    } else {//sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, 0x01);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_s3508 *chip_info, bool enable)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+        return ret;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_s3508 *chip_info, bool enable)
+{
+    int ret;
+    unsigned char report_gesture_ctrl_buf[3];
+    unsigned char wakeup_gesture_enable_buf;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    if (enable) {
+        report_gesture_ctrl_buf[2] |= 0x02 ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x3);         //set doze interval to 30ms
+    } else  {
+        report_gesture_ctrl_buf[2] &= 0xfd ;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x1);         //set doze interval to 10ms
+    }
+
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    wakeup_gesture_enable_buf = 0xef;   // all kinds of gesture except triangle
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL27, wakeup_gesture_enable_buf);
+
+    return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_s3508 *chip_info, bool enable)
+{
+    int ret;
+
+    TPD_INFO("%s, edge limit enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    if (enable) {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, 0x4b);
+    } else  {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, 0x4a);
+    }
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = synaptics_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = synaptics_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            ret = synaptics_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            /*device control: sleep mode*/
+            ret = synaptics_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = synaptics_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+            ret = synaptics_glove_mode_enable(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable glove mode failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_EDGE:
+            ret = synaptics_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = 0, i, gesture_sign, regswipe;
+    uint8_t gesture_buffer[10];
+    uint8_t coordinate_buf[25] = {0};
+    uint16_t trspoint = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    regswipe = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 0x18);
+
+    TPD_DEBUG("gesture_buffer[0] = 0x%x, regswipe = 0x%x, gesture_buffer[1] = 0x%x, gesture_buffer[4] = 0x%x\n",
+            gesture_buffer[0], regswipe, gesture_buffer[1], gesture_buffer[4]);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    gesture_sign = gesture_buffer[0];
+
+    //detect the gesture mode
+    switch (gesture_sign)
+    {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case SWIPE_DETECT:
+            gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                (regswipe == 0x42) ? Right2LeftSwip   :
+                (regswipe == 0x44) ? Up2DownSwip      :
+                (regswipe == 0x48) ? Down2UpSwip      :
+                (regswipe == 0x80) ? DouSwip          :
+                UnkownGesture;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            break;
+        case VEE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                (gesture_buffer[2] == 0x02) ? UpVee    :
+                (gesture_buffer[2] == 0x04) ? RightVee :
+                (gesture_buffer[2] == 0x08) ? LeftVee  :
+                UnkownGesture;
+            break;
+        case UNICODE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x77 && gesture_buffer[3] == 0x00) ? Wgestrue :
+                (gesture_buffer[2] == 0x6d && gesture_buffer[3] == 0x00) ? Mgestrue :
+                UnkownGesture;
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+    TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d\n", __func__, gesture_sign, gesture->gesture_type);
+
+    if (gesture->gesture_type != UnkownGesture) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA,      8, &(coordinate_buf[0]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 8,  8, &(coordinate_buf[8]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 16, 8, &(coordinate_buf[16]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 24, 1, &(coordinate_buf[24]));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        for (i = 0; i < 23; i += 2) {
+            trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+            TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+        }
+
+        TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+        gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+        gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+        gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+        gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+        gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+        gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+        gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+        gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+        gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+        gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+        gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+        gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+        gesture->clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+            (coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+    }
+
+    return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        msleep(POWEWRUP_TO_RESET_TIME);
+        synaptics_resetgpio_set(chip_info->hw_res, true);
+        msleep(RESET_TO_NORMAL_TIME);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        synaptics_resetgpio_set(chip_info->hw_res, false);
+    }
+
+    return ret;
+}
+
+static void checkCMD(struct chip_data_s3508 *chip_info, int retry_time)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        ret = ret & 0x01;
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < retry_time));
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+}
+
+static int checkCMD_for_finger(struct chip_data_s3508 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(10); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+    TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    if (10 == flag_err) {
+        TPD_INFO("checkCMD_for_finger error,reset  then msleep(80)\n");
+        synaptics_reset(chip_info);
+        msleep(80);
+        synaptics_mode_switch(chip_info, MODE_NORMAL, true);
+        return -1;
+    } else {
+        TPD_INFO("checkCMD_for_finger ok\n");
+        return 0;
+    }
+}
+
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    uint8_t x, y;
+    uint8_t i, j;
+    uint8_t buffer_rx[syna_testdata->RX_NUM];
+    uint8_t buffer_tx[syna_testdata->TX_NUM];
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint8_t buffer[9];
+    int16_t baseline_data = 0;
+    uint16_t unsigned_baseline_data = 0;
+    int16_t *baseline_data_test;
+    uint16_t count = 0;
+    int ret = 0;
+    int error_count = 0;
+    int enable_cbc = 1;
+    int eint_status, eint_count = 0, read_gpio_num = 0;
+    int sum_line_error = 0;
+    uint8_t  data_buf[64];
+    struct test_header *ph = NULL;
+    uint16_t z = 0;
+    uint8_t * raw_data = NULL;
+
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    //open file to save test data
+    ph = (struct test_header *)(syna_testdata->fw->data);
+
+    TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+    ret = synaptics_enable_interrupt(chip_info, false);
+    eint_count = 0;
+    read_gpio_num = 10;
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        error_count++;
+        seq_printf(s, "eint_status is low, TP EINT direct stort\n");
+        sprintf(data_buf, "eint_status is low, TP EINT direct stort, \n");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        eint_count = 0;
+        goto END;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+    //step 1: Close CBC and test RT20
+    TPD_INFO("\n step 1:Close CBC and test RT20\n");
+    if (syna_testdata->fd >= 0) {
+        sprintf(data_buf, "%s\n", "[RT20 Close CBC]");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+    }
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 0x14, 0x01);    //No SignalClarity
+    ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 0x1B);        //0129  CBC Xmtr carrier select
+    tmp_arg1 = ret&0xff;
+
+    //Close CBC
+    TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 0x1B, (tmp_arg1 & 0xdf));//Set CBC, F54_ANALOG_CTRL88, close CBC
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);//force update
+    checkCMD(chip_info, 30);
+    TPD_DEBUG("Test disable cbc\n");
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info, 30);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 30);
+    TPD_INFO("key_tx is %d, key_rx is %d\n", syna_testdata->key_TX, syna_testdata->key_RX);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%d, ", baseline_data);
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+            }
+
+            if ((y < syna_testdata->RX_NUM - syna_testdata->key_RX) && (x < syna_testdata->TX_NUM - syna_testdata->key_TX)) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                    TPD_INFO("Synaptic:touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    seq_printf(s, "touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    goto END;
+                }
+            } else if ((x == syna_testdata->TX_NUM - syna_testdata->key_TX) && (y >= syna_testdata->RX_NUM - syna_testdata->key_RX)) {
+                TPD_DEBUG("touchkey test xy(%d,%d),baseline_data=%d,limite( %d, %d)\n ",x,y, baseline_data,*(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                    TPD_INFO("Synaptic:touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    seq_printf(s, "touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", !enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    goto END;
+                }
+            }
+
+            count++;
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+    if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+    }
+
+    //step 2:check raw capacitance, Open CBC and testRT3
+    TPD_INFO("\n step 2:Open CBC and test RT3\n");
+    if (syna_testdata->fd >= 0) {
+        sprintf(data_buf, "%s\n", "[RT3 Open CBC]");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+    }
+    do{
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        if (ret < 0) {
+            TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+            goto END;
+        }
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 23);      //0125 0D CBC Settings
+        tmp_arg1 = ret&0xff;
+
+        if (enable_cbc) {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x10));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 20, 0x00);      // Disable No SignalClarity
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 23, (tmp_arg1 | 0x10));
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);
+            checkCMD(chip_info, 30);
+            ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 27);      //0129  CBC Xmtr carrier select
+            tmp_arg2 = ret | 0x20;
+            touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 27, tmp_arg2);
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);
+            TPD_DEBUG("Test open cbc\n");
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limitcbc_offset);
+        } else {
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xef));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 20, 0x01);      // Enable No SignalClarity
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 23, (tmp_arg1 & 0xef));  //0125 0D CBC Settings
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);
+            ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 27);
+            tmp_arg2 = ret & 0xdf;
+            touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 27, tmp_arg2); //0129  CBC Xmtr carrier select
+            ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04); // force update
+            ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CONTROL_BASE + 7, 0x01);// Forbid NoiseMitigation
+            baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+        }
+        /******write No Relax to 1******/
+        ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04); // force update
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info, 30);
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+        count = 0;
+        for (x = 0; x < syna_testdata->TX_NUM; x++) {
+            TPD_DEBUG_NTAG("[%d]: ", x);
+            for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                z = syna_testdata->RX_NUM * x + y;
+                tmp_arg1 = raw_data[z*2] & 0xff;
+                tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+                baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+                if (syna_testdata->fd >= 0) {
+                    sprintf(data_buf, "%d, ", baseline_data);
+                    sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                if ((y < syna_testdata->RX_NUM - syna_testdata->key_RX) && (x < syna_testdata->TX_NUM - syna_testdata->key_TX)) {
+                    TPD_DEBUG_NTAG("%d, ", baseline_data);
+                    if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                        TPD_INFO("Synaptic:touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        seq_printf(s, "touchpanel failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        error_count++;
+                        goto END;
+                    }
+                } else if ((x == syna_testdata->TX_NUM - syna_testdata->key_TX) && (y >= syna_testdata->RX_NUM - syna_testdata->key_RX)) {
+                    TPD_INFO("touchkey test xy(%d,%d),baseline_data=%d,limite( %d, %d)\n ",x,y, baseline_data,*(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                    if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                        TPD_INFO("Synaptic:touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        seq_printf(s, "touchkey failed,enable_cbc=%d,raw data erro baseline_data[%d][%d] = %d[%d, %d]\n", enable_cbc,x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                        error_count++;
+                        goto END;
+                    }
+                }
+                count++;
+            }
+            if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+            }
+            TPD_DEBUG_NTAG("\n");
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x04);
+    checkCMD(chip_info, 30);
+
+    //step 3 :check TRx-to-Ground, with rt25
+    TPD_INFO("step 3:check TRx-to-Ground, with rt25\n");
+    ret = touch_i2c_write_byte(client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x19);//select report type 25
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x0);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    //msleep(100);
+    checkCMD(chip_info, 30);
+    ret = touch_i2c_read_block(client, reg_info->F54_ANALOG_DATA_BASE + 3, 7, buffer);
+
+    //guomingqiang@phone.bsp, 2016-06-27, add for tp test step2
+    touch_i2c_write_byte(client, 0xff, 0x3);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+
+    TPD_INFO("RX_NUM : ");
+    for (i = 0; i< syna_testdata->RX_NUM; i++)
+        TPD_INFO("%d, ", buffer_rx[i]);
+    TPD_INFO("\n");
+
+    TPD_INFO("TX_NUM : ");
+    for (i = 0; i< syna_testdata->TX_NUM; i++)
+        TPD_INFO("%d, ", buffer_tx[i]);
+    TPD_INFO("\n");
+
+    for (x = 0; x < 7; x++) {
+        if (buffer[x] == 0) {
+            for (i = 0; i< 8; i++) {
+                if ((buffer[x] & (1 << i)) != 0) {
+                    sum_line_error = 8 * x + i + 1;
+                    for (j = 0; j < syna_testdata->RX_NUM; j++) {
+                        if (sum_line_error == buffer_rx[j]) {
+                            error_count++;
+                            TPD_INFO(" step 3 :check TRx-to-Ground, with rt25 error,  error_line is rx = %d\n", buffer_rx[j]);
+                            seq_printf(s, " step 3 :check TRx-to-Ground, with rt25,  error_line is rx = %d\n", buffer_rx[j]);
+                            goto END;
+                        }
+                    }
+                    for (j = 0; j < syna_testdata->TX_NUM; j++) {
+                        if (sum_line_error == buffer_tx[j]) {
+                            error_count++;
+                            TPD_INFO(" step 3 :check TRx-to-Ground, with rt25, error_line is tx = %d\n", buffer_tx[j]);
+                            seq_printf(s, " step 3 :check TRx-to-Ground, with rt25, error_line is rx = %d\n", buffer_rx[j]);
+                            goto END;
+                        }
+                    }
+                }
+            }
+        }
+    }
+
+    synaptics_reset(chip_info);
+    msleep(50);
+
+    //step 4 :check tx-to-tx and tx-to-vdd
+    TPD_INFO("step 4:check TRx-TRx & TRx-Vdd short\n");
+    ret = touch_i2c_write_byte(client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x1A);//select report type 26
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x0);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    //msleep(100);
+    checkCMD(chip_info, 30);
+    ret = touch_i2c_read_block(client, reg_info->F54_ANALOG_DATA_BASE + 3, 7, buffer);
+
+    //guomingqiang@phone.bsp, 2016-06-27, add for tp test step2
+    touch_i2c_write_byte(client, 0xff, 0x3);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+    touch_i2c_read_block(client, reg_info->F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+
+    TPD_INFO("RX_NUM : ");
+    for (i = 0; i< syna_testdata->RX_NUM; i++)
+        TPD_INFO("%d, ", buffer_rx[i]);
+    TPD_INFO("\n");
+
+    TPD_INFO("TX_NUM : ");
+    for (i = 0; i< syna_testdata->TX_NUM; i++)
+        TPD_INFO("%d, ", buffer_tx[i]);
+    TPD_INFO("\n");
+
+    for (x = 0; x < 7; x++) {
+        if (buffer[x] != 0) {
+            for (i = 0; i< 8; i++) {
+                if ((buffer[x] & (1 << i)) != 0) {
+                    sum_line_error = 8 * x + i + 1;
+                    for (j = 0; j < syna_testdata->RX_NUM; j++) {
+                        if (sum_line_error == buffer_rx[j]) {
+                            error_count++;
+                            TPD_INFO(" step 4 :check tx-to-tx and tx-to-vdd error,  error_line is rx = %d\n", buffer_rx[j]);
+                            seq_printf(s, " step 4 :check tx-to-tx and tx-to-vdd error,  error_line is rx = %d\n", buffer_rx[j]);
+                            goto END;
+                        }
+                    }
+                    for (j = 0; j < syna_testdata->TX_NUM; j++) {
+                        if (sum_line_error == buffer_tx[j]) {
+                            error_count++;
+                            TPD_INFO(" step 4 :check tx-to-tx and tx-to-vdd error, error_line is tx = %d\n", buffer_tx[j]);
+                            seq_printf(s, " step 4 :check tx-to-tx and tx-to-vdd error, error_line is rx = %d\n", buffer_rx[j]);
+                            goto END;
+                        }
+                    }
+                }
+            }
+        }
+    }
+
+    synaptics_reset(chip_info);
+    msleep(50);
+
+    //Step 5 : Check the broken line with RT133
+    TPD_INFO("Step 5 : Check the broken line\n" );
+    ret = touch_i2c_write_byte(client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 0x85);//select report type 0x85
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 30);
+
+    for (y = 0; y < syna_testdata->RX_NUM; y++) {
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+        TPD_INFO("Step 5 data[%d] is %d\n", y, baseline_data);
+        if(baseline_data > 100)
+		{
+			error_count++;
+			TPD_INFO(" step 5 :check the broken line, error_line is y =%d\n",y);
+            seq_printf(s, "step 5 :check the broken line, error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+			goto END;
+		}
+    }
+
+    seq_printf(s, "\n");
+    msleep(20);
+
+    //Step 7 : Check RT252 for random touch event
+    TPD_INFO("Step 7 : Check RT252 for random touch event\n");
+    if (syna_testdata->fd >= 0) {
+        sprintf(data_buf, "%s\n", "[RT252]");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+    }
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xFC);//select report type 0xFC
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 70);
+    for (y = 0; y < syna_testdata->RX_NUM + syna_testdata->TX_NUM - syna_testdata->key_TX - syna_testdata->key_RX; y++) {
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(client, reg_info->F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        unsigned_baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+        if (syna_testdata->fd >= 0) {
+            sprintf(data_buf, "%d, ", unsigned_baseline_data);
+            sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        if(unsigned_baseline_data < 10000) {
+            error_count++;
+            TPD_INFO("Step 7 : Check RT252 for random touch event, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+            seq_printf(s, "Step 7 : Check RT252 for random touch event, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+            goto END;
+        }
+    }
+    if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+    }
+
+    //Step 8 : Check RT254 for self raw data check
+    TPD_INFO("Step 8 : Check RT254 for self raw data check\n");
+    if (syna_testdata->fd >= 0) {
+        sprintf(data_buf, "%s\n", "[RT254]");
+        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+    }
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xFE);//select report type 0xFE
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 30);
+    for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM; y++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        unsigned_baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+        if (syna_testdata->fd >= 0) {
+            sprintf(data_buf, "%d, ", unsigned_baseline_data);
+            sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        if((syna_testdata->key_RX != 0 || syna_testdata->key_TX != 0) && ((y > chip_info->hw_res->RX_NUM - syna_testdata->key_RX - 1 && y < chip_info->hw_res->RX_NUM) 
+            || (y > chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - syna_testdata->key_TX - 1))) {
+            TPD_INFO("y = %d\n", y);
+            continue;
+        }
+        if(unsigned_baseline_data < 50 || unsigned_baseline_data > 975) {
+            error_count++;
+            TPD_INFO("Step 8 : Check RT254 for self raw data check, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+            seq_printf(s, "Step 8 : Check RT254 for self raw data check, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+            goto END;
+        }
+    }
+    if (syna_testdata->fd >= 0) {
+            sys_write(syna_testdata->fd, "\n", 1);
+    }
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+
+END:
+    kfree(raw_data);
+    seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO("\n\nstep5 reset and open irq complete\n");
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint16_t baseline_data = 0;
+    uint8_t *raw_data = NULL;
+    int enable_cbc = 0;//enable cbc flag for baseline limit test
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+    synaptics_read_F54_base_reg(chip_info);
+    do {
+        if (enable_cbc) {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+        } else {
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);//select report type 0x14
+        }
+        if (ret < 0) {
+            TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+            seq_printf(s, "what the hell4, ");
+            goto END;
+        }
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 23);
+        tmp_arg1 = ret & 0xff;
+
+        if (enable_cbc) {
+            seq_printf(s, "\nWith CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x10));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 20, 0x00);      // Disable No SignalClarity
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 23, (tmp_arg1 | 0x10));
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+            checkCMD(chip_info, 30);
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 27);
+            tmp_arg2 = ret | 0x20;
+            touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 27, tmp_arg2);
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+            TPD_DEBUG("Test open cbc\n");
+        } else {
+            seq_printf(s, "\nWithout CBC:\n");
+            TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xef));
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 20, 0x01);      // Enable No SignalClarity
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 23, (tmp_arg1 & 0xef));
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 27);
+            tmp_arg2 = ret & 0xdf;
+            touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 27, tmp_arg2);
+            ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); // force update
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 7, 0x01);// Forbid NoiseMitigation
+        }
+        /******write No Relax to 1******/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); // force update
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            seq_printf(s, "[%2d] ", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                seq_printf(s, "%4d, ", baseline_data);
+            }
+            seq_printf(s, "\n");
+        }
+        enable_cbc++;
+    }while(enable_cbc < 2);
+
+END:
+    kfree(raw_data);
+    return ;
+}
+
+//Reserved node
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //1.get firmware doze mode info
+    TPD_INFO("1.get firmware doze mode info\n");
+    seq_printf(s, "1.get firmware doze mode info\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x1A);
+    TPD_INFO("TP doze mode status is %d\n", ret);
+    seq_printf(s, "TP doze mode status is %d\n", ret);
+
+    msleep(10);
+}
+
+static void synaptics_RT76_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x4C);//select report type 0x4C
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 30);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(60);
+    kfree(raw_data);
+}
+
+static void synaptics_RT251_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, y = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+    uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+    uint16_t RT_data = 0;
+
+    if (!chip_info)
+        return ;
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    //Check RT252 for random touch event
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xFC);//select report type 0xFC
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 70);
+    seq_printf(s, "\n[RT252]");
+    for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - chip_info->hw_res->key_TX - chip_info->hw_res->key_RX; y++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        RT_data = (tmp_arg2 << 8) | tmp_arg1;
+        seq_printf(s, "%hu, ", RT_data);
+    }
+    seq_printf(s, "\n");
+
+    //Get RT254 info
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xFE);//select report type 0xFE
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 70);
+    seq_printf(s, "\n[RT254]");
+    for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - chip_info->hw_res->key_TX - chip_info->hw_res->key_RX; y++) {
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg1 = ret & 0xff;
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+        tmp_arg2 = ret & 0xff;
+        RT_data = (tmp_arg2 << 8) | tmp_arg1;
+        seq_printf(s, "%hu, ", RT_data);
+    }
+    seq_printf(s, "\n");
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    synaptics_reset(chip_info);
+    msleep(60);
+}
+
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    //TPD_DEBUG("\nstep 2:report type2 delta image\n");
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info, 30);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+    msleep(10);
+
+    if(tp_debug != 0 && chip_info->d_log.data_logger_control== true) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xFA);//select report type 0xFA
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            seq_printf(s, "\n[%2d]", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                seq_printf(s, "%4d, ", temp_delta);
+            }
+        }
+        seq_printf(s, "\n");
+    }
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(60);
+    kfree(raw_data);
+}
+
+static int checkFlashState(struct chip_data_s3508 *chip_info)
+{
+    int ret ;
+    int count = 0;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+        count++;
+    }
+
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+/**
+ * re_scan_PDT -   rescan && init F34  base addr.
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void re_scan_PDT(struct chip_data_s3508 *chip_info)
+{
+    uint8_t buf[8];
+
+    touch_i2c_read_block(chip_info->client, 0xE9, 6, buf);
+    chip_info->reg_info.F34_FLASH_DATA_BASE = buf[3];
+    chip_info->reg_info.F34_FLASH_QUERY_BASE = buf[0];
+    touch_i2c_read_block(chip_info->client, 0xE3, 6, buf);
+    chip_info->reg_info.F01_RMI_DATA_BASE = buf[3];
+    chip_info->reg_info.F01_RMI_CMD_BASE = buf[1];
+    touch_i2c_read_block(chip_info->client, 0xDD, 6, buf);
+
+    chip_info->reg_info.SynaF34Reflash_BlockNum    = chip_info->reg_info.F34_FLASH_DATA_BASE;
+    chip_info->reg_info.SynaF34Reflash_BlockData   = chip_info->reg_info.F34_FLASH_DATA_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_BootID = chip_info->reg_info.F34_FLASH_QUERY_BASE;
+    chip_info->reg_info.SynaF34ReflashQuery_FlashPropertyQuery = chip_info->reg_info.F34_FLASH_QUERY_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize  = chip_info->reg_info.F34_FLASH_QUERY_BASE + 2;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockCount = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockSize    = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockCount   = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    TPD_DEBUG("SynaFirmwareBlockSize is %d\n", (buf[0] | (buf[1] << 8)));
+    chip_info->reg_info.SynaF34_FlashControl = chip_info->reg_info.F34_FLASH_DATA_BASE + 2;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+    synaptics_parse_header(&header, fw->data);
+    if ((header.firmware_size + header.config_size + 0x100) > (uint32_t)fw->size) {
+        TPD_DEBUG("firmware_size + config_size + 0x100 > data_len data_len = %d \n", (uint32_t)fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+    Firmware_Data = fw->data + 0x100;
+    Config_Data = Firmware_Data + header.firmware_size;
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8)|buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8)|Config_Data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    //step 3:init needed params
+    re_scan_PDT(chip_info);
+    block = 16;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = header.firmware_size / 16;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = header.config_size / 16;
+    TPD_DEBUG("configuration is %d \n", configuration);
+
+    //step 3:Get into program mode
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", chip_info->reg_info.SynaF34_FlashControl, ret);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4\n");
+    ret = checkFlashState(chip_info);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return FW_UPDATE_ERROR;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE, ret&0x04);
+
+    /********************get into prog end************/
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(chip_info);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 2, buf);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, buf);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x03);
+    msleep(2000);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+    for (j = 0; j < firmware; j++) {
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Firmware_Data[j*16]);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    //step 5:flash configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    for (j = 0; j < configuration; j++) {
+        //a)write SynaF34Reflash_BlockNum to access
+        buf[0] = j & 0x00ff;
+        buf[1] = (j & 0xff00) >> 8;
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 16, &Config_Data[j*16]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    return FW_UPDATE_SUCCESS;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t *raw_data = NULL;
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return fp_touch_state;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        goto OUT;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    ret = (ret & 0xF8) | 0x80;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, ret);   //exit sleep
+    msleep(5);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 124
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+        goto OUT;
+    }
+
+    fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data); //read baseline data
+    for (x = 1; x < TX_NUM - 2; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 0; y < (SPURIOUS_FP_RX_NUM - 3); y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if ((delta_data + SPURIOUS_FP_LIMIT) < 0) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug)
+                break;
+        }
+    }
+
+    TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,__LINE__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error,line=%d\n", __func__,__LINE__);
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+OUT:
+    kfree(raw_data);
+    return fp_touch_state;
+}
+
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x02);
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    TPD_INFO("touch key int_key code = %d\n",ret);
+
+    if (ret & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (ret & 0x02)
+        SET_BIT(bitmap_result, BIT_BACK);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    return bitmap_result;
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        ret = -ENOMEM;
+        kfree(raw_data);
+        return;
+    }
+
+RE_TRY:
+    TPD_INFO("%s retry_time=%d line=%d\n",__func__,retry_time,__LINE__);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); //forcecal
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 0x02
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < TX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM*x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+    }
+
+    kfree(raw_data);
+}
+
+static void synaptics_data_logger_get(void * chip_data)
+{
+    int ret = 0, i = 0;
+    int data_length = 0;
+    uint8_t log_data[255];
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    if (true == chip_info->d_log.data_logger_control) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, (uint8_t)(chip_info->d_log.loglength_addr >> 8));    // page 4
+        data_length = touch_i2c_read_byte(chip_info->client, (uint8_t)(chip_info->d_log.loglength_addr & 0xFF));
+        if(data_length < 1 || data_length > 255) {
+            return;
+        } else {
+            ret = touch_i2c_read_block(chip_info->client, ((uint8_t)(chip_info->d_log.loglength_addr & 0xFF) + 1), data_length, log_data);     //read log 
+            TPD_INFO("data_length = %d, ", data_length);
+            for(i = 0; i< data_length; i++) {
+                printk(" [0x%x], ", log_data[i]);
+            }
+            TPD_INFO("\n");
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);    // page 0
+    }
+}
+
+static void synaptics_data_logger_open(void * chip_data)
+{
+    int ret = 0;
+    uint8_t l_tmp = 0, h_tmp = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    //Get status of IC log
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x05);
+    TPD_INFO("F51_CUSTOM_QUERY05 is %d\n", ret);
+    if (1 == ret) {
+        chip_info->d_log.data_logger_control = true;
+        l_tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x06);
+        h_tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x07);
+        chip_info->d_log.loglength_addr = (h_tmp << 8) | l_tmp;
+        chip_info->d_log.loginfo_addr = chip_info->d_log.loglength_addr + 1;
+        TPD_INFO("l_tmp = 0x%x h_tmp = 0x%x chip_info->d_log.loglength_addr = 0x%x chip_info->d_log.loginfo_addr = 0x%x\n", l_tmp, h_tmp, chip_info->d_log.loglength_addr, chip_info->d_log.loginfo_addr);
+    }
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+}
+
+static void synaptics_register_info_read(void * chip_data, uint16_t register_addr, uint8_t * result, uint8_t length)
+{
+    int ret = 0;
+    uint8_t l_tmp = 0, h_tmp = 0;
+    struct chip_data_s3508 *chip_info = (struct chip_data_s3508 *)chip_data;
+
+    l_tmp = register_addr & 0xFF;   //address
+    h_tmp = register_addr >> 8;     //page
+
+    if (h_tmp > 4) {
+        TPD_INFO("register_addr error!\n");
+        return;
+    }
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, h_tmp);    //set page
+    ret = touch_i2c_read_block(chip_info->client, l_tmp, length, result);     //read data
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+    .get_vendor       = synaptics_get_vendor,
+    .get_chip_info    = synaptics_get_chip_info,
+    .reset            = synaptics_reset,
+    .power_control    = synaptics_power_control,
+    .fw_check         = synaptics_fw_check,
+    .fw_update        = synaptics_fw_update,
+    .trigger_reason   = synaptics_trigger_reason,
+    .get_touch_points = synaptics_get_touch_points,
+    .get_gesture_info = synaptics_get_gesture_info,
+    .mode_switch      = synaptics_mode_switch,
+    .get_keycode      = synaptics_get_keycode,
+    .spurious_fp_check= synaptics_spurious_fp_check,
+    .finger_proctect_data_get = synaptics_finger_proctect_data_get,
+    .data_logger_get  = synaptics_data_logger_get,
+    .data_logger_open = synaptics_data_logger_open,
+    .register_info_read = synaptics_register_info_read,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+    .auto_test     = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = synaptics_limit_read,
+    .delta_read    = synaptics_delta_read,
+    .baseline_read = synaptics_baseline_read,
+    .reserve_read  = synaptics_reserve_read,
+    .RT251         = synaptics_RT251_read,
+    .RT76          = synaptics_RT76_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+
+    struct chip_data_s3508 *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+    if (tp_register_times > 0) {
+        TPD_INFO("TP driver have success loaded %d times, exit\n", tp_register_times);
+        return -1;
+    }
+
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_s3508), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->client = client;
+    chip_info->syna_ops = &synaptics_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &synaptics_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    //step6: collect data for supurious_fp_touch
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        synaptics_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    //step7: get data logger open status
+    mutex_lock(&ts->mutex);
+    synaptics_data_logger_open(chip_info);
+    mutex_unlock(&ts->mutex);
+
+    //step8:create synaptics related proc files
+    synaptics_create_proc(ts, chip_info->syna_ops);
+
+    //step9:Chip Related function
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data();
+    chip_info->premote_data = premote_data;
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->hw_res.irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(chip_info->enable_remote);
+        register_remote_device(premote_data);
+    }
+#endif
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device();
+#endif
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE, },
+    { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = synaptics_i2c_suspend,
+    .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = synaptics_tp_probe,
+    .remove     = synaptics_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_s3508.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_s3508.h
new file mode 100644
index 0000000000000000000000000000000000000000..6291a0104bbe97ac316d928b57ef5cdece0d7011
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3508/synaptics_s3508.h
@@ -0,0 +1,137 @@
+/***************************************************
+ * File:synaptics_drivers_s3508.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics s3508 driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SYNAPTICS_H_S3508
+#define SYNAPTICS_H_S3508
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../synaptics_common.h"
+#ifdef CONFIG_SYNAPTIC_RED
+#include "../synaptics_touch_panel_remote.h"
+#endif
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE      0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE    0x02
+#define ENABLE_DTAP     0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT      0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT    0x07
+#define DTAP_DETECT     0x03
+
+#define RESET_TO_NORMAL_TIME 80    /*Sleep time after reset*/
+#define POWEWRUP_TO_RESET_TIME 10
+
+
+#define SPURIOUS_FP_LIMIT 60
+#define SPURIOUS_FP_RX_NUM 9
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+
+/*********PART3:Struct Area**********************/
+struct synaptics_register
+{
+    uint8_t F01_RMI_QUERY_BASE;
+    uint8_t F01_RMI_CMD_BASE;
+    uint8_t F01_RMI_CTRL_BASE;
+    uint8_t F01_RMI_DATA_BASE;
+
+    uint8_t F01_RMI_QUERY11;
+    uint8_t F01_RMI_DATA01;
+    uint8_t F01_RMI_CMD00;
+    uint8_t F01_RMI_CTRL00;
+    uint8_t F01_RMI_CTRL01;
+    uint8_t F01_RMI_CTRL02;
+
+    uint8_t F12_2D_QUERY_BASE;
+    uint8_t F12_2D_CMD_BASE;
+    uint8_t F12_2D_CTRL_BASE;
+    uint8_t F12_2D_DATA_BASE;
+
+    uint8_t F12_2D_CTRL08;
+    uint8_t F12_2D_CTRL20;
+    uint8_t F12_2D_CTRL23;
+    uint8_t F12_2D_CTRL27;
+    uint8_t F12_2D_CTRL32;
+    uint8_t F12_2D_DATA04;
+    uint8_t F12_2D_DATA15;
+    uint8_t F12_2D_DATA38;
+    uint8_t F12_2D_DATA39;
+    uint8_t F12_2D_CMD00;
+
+    uint8_t F34_FLASH_QUERY_BASE;
+    uint8_t F34_FLASH_CMD_BASE;
+    uint8_t F34_FLASH_CTRL_BASE;
+    uint8_t F34_FLASH_DATA_BASE;
+
+    uint8_t SynaF34_FlashControl;
+    uint8_t SynaF34Reflash_BlockNum;
+    uint8_t SynaF34Reflash_BlockData;
+    uint8_t SynaF34ReflashQuery_BootID;
+    uint8_t SynaF34ReflashQuery_FlashPropertyQuery;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockSize;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockCount;
+    uint8_t SynaF34ReflashQuery_ConfigBlockSize;
+    uint8_t SynaF34ReflashQuery_ConfigBlockCount;
+
+    uint8_t F51_CUSTOM_QUERY_BASE;
+    uint8_t F51_CUSTOM_CMD_BASE;
+    uint8_t F51_CUSTOM_CTRL_BASE;
+    uint8_t F51_CUSTOM_DATA_BASE;
+
+    uint8_t F51_CUSTOM_CTRL00;
+    uint8_t F51_CUSTOM_CTRL31;
+    uint8_t F51_CUSTOM_CTRL50;
+    uint8_t F51_CUSTOM_DATA;
+
+    uint8_t F54_ANALOG_QUERY_BASE;
+    uint8_t F54_ANALOG_COMMAND_BASE;
+    uint8_t F54_ANALOG_CONTROL_BASE;
+    uint8_t F54_ANALOG_DATA_BASE;
+
+    uint8_t F55_SENSOR_CTRL01;
+    uint8_t F55_SENSOR_CTRL02;
+};
+
+struct data_logger
+{
+    bool data_logger_control;
+    int loglength_addr;
+    int loginfo_addr;
+};
+
+struct chip_data_s3508 {
+    tp_dev tp_type;
+    struct i2c_client *client;
+    struct synaptics_proc_operations *syna_ops; /*synaptics func provide to synaptics common driver*/
+#ifdef CONFIG_SYNAPTIC_RED
+    int    enable_remote;                       /*Redremote connect state*/
+    struct remotepanel_data *premote_data;
+#endif/*CONFIG_SYNAPTIC_RED*/
+    struct synaptics_register     reg_info;
+    struct hw_resource          *hw_res;
+    struct data_logger          d_log;
+    int16_t *spuri_fp_data;
+};
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..be5a296559d71d1f98b9387b23dd9ee783e4b3b2
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Kconfig
@@ -0,0 +1,11 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+config TOUCHPANEL_SYNAPTICS_S3706
+#	default y
+	bool "TP Synaptics_S3508 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics s3706
+	say Y to enable driver for Touchpanel useing synaptics s3706
+	
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..088541c8d4f678868693e8d9535f73f2dbc920b0
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S3706) += synaptics_drivers_s3706.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_drivers_s3706.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_drivers_s3706.c
new file mode 100644
index 0000000000000000000000000000000000000000..deb069bb2eb1945aaa2453bf0267535ed27eef67
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_drivers_s3706.c
@@ -0,0 +1,5158 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.£¬
+ * File           : synaptics_drivers_s3508.c
+ * Description: Source file for synaptics S3508 driver
+ * Version   : 1.0
+ * Date                : 2016-09-02
+ * Author        : Tong.han@Bsp.Group.Tp
+ * TAG                 : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>        <date>                  < author >                                                        <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+#include <linux/pm_qos.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+#include "synaptics_s3706_baseline.h"
+#include "synaptics_s3706.h"
+
+static struct chip_data_s3706 *g_chip_info = NULL;
+extern int tp_register_times;
+static int synaptics_get_chip_info(void *chip_data);
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag);
+static int synaptics_power_control(void *chip_data, bool enable);
+int gf_opticalfp_irq_handler(int event);
+#define PM_QOS_VALUE_TP 200
+struct pm_qos_request pm_qos_req_tp;
+
+
+/*******Part0:LOG TAG Declear********************/
+
+#define TPD_DEVICE "synaptics-s3706"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+        do {\
+                if (LEVEL_DEBUG == tp_debug) {\
+                        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+                }\
+        }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+        do {\
+                if (LEVEL_BASIC != tp_debug) {\
+                        pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+                }\
+        }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+        do {\
+                if (tp_debug) {\
+                        printk(a, ##arg);\
+                }\
+        }while(0)
+
+/*******Part1:Call Back Function implement*******/
+
+int tp_single_tap_en(struct chip_data_s3706 *ts, bool enable)
+{
+	uint8_t ret = 0;
+
+	ret = touch_i2c_write_byte(ts->client, 0xff, 0x04);
+	if (ret < 0)
+		return ret;
+	if (enable) {
+//		ret = touch_i2c_write_byte(ts->client,
+//			0x1F, 0x01);
+		ret = touch_i2c_write_byte(ts->client,
+			0x20, 0x1e);
+		ret = touch_i2c_write_byte(ts->client,
+			0x21, 0x1e);
+		ret = touch_i2c_write_byte(ts->client,
+			0x22, 0x32);
+//		ret = touch_i2c_write_word(ts->client,
+//			F54_ANALOG_COMMAND_BASE, 0x04); // force update
+	} else
+		ret = touch_i2c_write_byte(ts->client,
+			0x1F, 0x00);
+
+	ret = touch_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_INFO("%s: set page 00 fail!\n", __func__);
+
+	return ret;
+}
+
+
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+        int ret, i, obj_attention;
+        unsigned char fingers_to_process = max_num;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+        char *buf = kzalloc(8 * max_num, GFP_KERNEL);
+
+        obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+        for (i = 9; ; i--) {
+                if ((obj_attention & 0x03FF) >> i  || i == 0) {
+                        break;
+                } else {
+                        fingers_to_process--;
+                }
+        }
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+        if (ret < 0) {
+                TPD_INFO("touch i2c read block failed\n");
+                return -1;
+        }
+        for (i = 0; i< fingers_to_process; i++) {
+                points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+                points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+                points[i].z = buf[i*8 + 5];
+                points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+                points[i].status = buf[i*8];
+        }
+		kfree(buf);
+	pm_qos_remove_request(&pm_qos_req_tp);
+        return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+        char manu_temp[MAX_DEVICE_MANU_LENGTH] = SYNAPTICS_PREFIX;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        chip_info->tp_type = panel_data->tp_type;
+        chip_info->p_tp_fw = &panel_data->TP_FW;
+        strlcat(manu_temp, panel_data->manufacture_info.manufacture, MAX_DEVICE_MANU_LENGTH);
+        strncpy(panel_data->manufacture_info.manufacture, manu_temp, MAX_DEVICE_MANU_LENGTH);
+        TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n",
+                chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+        return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_s3706 *chip_info)
+{
+        //uint8_t buf[4] = {0};
+	uint8_t *buf;
+        int ret = 0;
+	buf = (uint8_t *)kzalloc(4,GFP_KERNEL);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        if (ret < 0) {
+                TPD_INFO("%s: failed for page select\n", __func__);
+		kfree(buf);
+                return -1;
+        }
+        ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+        chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+        chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+        chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+        chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+        TPD_INFO("F54_QUERY_BASE = %x \n\
+                        F54_CMD_BASE        = %x \n\
+                        F54_CTRL_BASE   = %x \n\
+                        F54_DATA_BASE   = %x \n",
+                        chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+                        chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+	kfree(buf);
+        return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+        //uint8_t buf[4] = {0};
+	uint8_t *buf;
+        int ret;
+        struct chip_data_s3706        *chip_info = (struct chip_data_s3706 *)chip_data;
+        struct synaptics_register *reg_info = &chip_info->reg_info;
+
+	buf = (uint8_t *)kzalloc(4,GFP_KERNEL);
+       // memset(buf, 0, sizeof(buf));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   /* page 0*/
+        if (ret < 0) {
+                TPD_INFO("%s: failed for page select\n", __func__);
+		kfree(buf);
+                return -1;
+        }
+        ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+        if (ret < 0) {
+                TPD_INFO("failed for page select!\n");
+		kfree(buf);
+                return -1;
+        }
+
+        reg_info->F12_2D_QUERY_BASE = buf[0];
+        reg_info->F12_2D_CMD_BASE = buf[1];
+        reg_info->F12_2D_CTRL_BASE = buf[2];
+        reg_info->F12_2D_DATA_BASE = buf[3];
+
+        TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+                        F12_2D_CMD_BASE        = 0x%x \n\
+                        F12_2D_CTRL_BASE   = 0x%x \n\
+                        F12_2D_DATA_BASE   = 0x%x \n",
+                        reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+                        reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+        ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+        reg_info->F01_RMI_QUERY_BASE = buf[0];
+        reg_info->F01_RMI_CMD_BASE = buf[1];
+        reg_info->F01_RMI_CTRL_BASE = buf[2];
+        reg_info->F01_RMI_DATA_BASE = buf[3];
+        TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+                        F01_RMI_CMD_BASE        = 0x%x \n\
+                        F01_RMI_CTRL_BASE   = 0x%x \n\
+                        F01_RMI_DATA_BASE   = 0x%x \n",
+                        reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+                        reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+        ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+        reg_info->F34_FLASH_QUERY_BASE = buf[0];
+        reg_info->F34_FLASH_CMD_BASE = buf[1];
+        reg_info->F34_FLASH_CTRL_BASE = buf[2];
+        reg_info->F34_FLASH_DATA_BASE = buf[3];
+        TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+                        F34_FLASH_CMD_BASE          = 0x%x \n\
+                        F34_FLASH_CTRL_BASE         = 0x%x \n\
+                        F34_FLASH_DATA_BASE         = 0x%x \n",
+                        reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+                        reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+        reg_info->F01_RMI_QUERY11 = reg_info->F12_2D_QUERY_BASE + 11;   /*no use*/
+        reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+        reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+        reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+        reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;  /*no use*/
+        reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+        reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;
+        reg_info->F12_2D_CTRL11 = reg_info->F12_2D_CTRL_BASE + 3;
+        reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 8;
+        reg_info->F12_2D_CTRL32 = reg_info->F12_2D_CTRL_BASE + 15;  /*no use*/
+        reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 2;   /*Roland, where is gesture type register*/
+        reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 3;
+        reg_info->F12_2D_DATA38 = reg_info->F12_2D_DATA_BASE + 54;  /*no use*/
+        reg_info->F12_2D_DATA39 = reg_info->F12_2D_DATA_BASE + 55;  /*no use*/
+        reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;        /*no use*/
+        reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x06;        /*no use*/
+        reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x09;        /*Roland, where is gesture type register*/
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);         /* page 4*/
+        if (ret < 0) {
+                TPD_INFO("%s: failed for page select\n", __func__);
+		kfree(buf);
+                return -1;
+        }
+        ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+        reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+        reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+        reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+        reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+        TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+                        F51_CUSTOM_CMD_BASE         = 0x%x \n\
+                        F51_CUSTOM_CTRL_BASE        = 0x%x \n\
+                        F51_CUSTOM_DATA_BASE        = 0x%x \n",
+                        reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+                        reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+        reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;   /*no use*/
+        reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;   /*Roland, where is gesture type register*/
+        reg_info->F51_CUSTOM_CTRL31 = reg_info->F51_CUSTOM_CTRL_BASE + 11;  /*no use*/
+        reg_info->F51_CUSTOM_CTRL50 = reg_info->F51_CUSTOM_CTRL_BASE + 0x0A;        /*Roland, where is edge register*/
+
+        synaptics_read_F54_base_reg(chip_info);
+        reg_info->F55_SENSOR_CTRL01 = 0x01;
+        reg_info->F55_SENSOR_CTRL02 = 0x02;
+        /* select page 0*/
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	kfree(buf);
+        return ret;
+}
+
+/**
+ * synaptics_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t synaptics_get_fw_id(struct chip_data_s3706 *chip_info)
+{
+        //uint8_t buf[4];
+        uint8_t *buf;
+        uint32_t current_firmware = 0;
+	buf = (uint8_t *)kzalloc(4,GFP_KERNEL);
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+        current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+        TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+	kfree(buf);
+        return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+        uint32_t bootloader_mode;
+        int max_y_ic = 0;
+        int max_x_ic = 0;
+       // uint8_t buf[4];
+	uint8_t *buf;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+	buf = (uint8_t *)kzalloc(4,GFP_KERNEL);
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+        max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+        max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+        TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+        if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+                resolution_info->max_x = max_x_ic;
+                resolution_info->max_y = max_y_ic;
+        }
+
+        bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+        bootloader_mode = bootloader_mode & 0xff;
+        bootloader_mode = bootloader_mode & 0x40;
+        TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+        if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+                TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+		kfree(buf);
+                return FW_ABNORMAL;
+        }
+
+        /*fw check normal need update TP_FW  && device info*/
+        panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+        if (panel_data->manufacture_info.version) {
+                sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+        }
+	kfree(buf);
+        return FW_NORMAL;
+}
+
+/**
+ * synaptics_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int synaptics_enable_interrupt(struct chip_data_s3706 *chip_info, bool enable)
+{
+        int ret;
+        uint8_t abs_status_int;
+
+        TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        if (ret < 0) {
+                TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+                return -1;
+        }
+        if (enable) {
+                abs_status_int = 0x7f;
+                /*clear interrupt bits for previous touch*/
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA01);
+                if (ret < 0) {
+                        TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+                        return -1;
+                }
+        } else {
+                abs_status_int = 0x0;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL01, abs_status_int);
+        if (ret < 0) {
+                TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+                return -1;
+        }
+
+        return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+	int ret = 0;
+	uint8_t device_status = 0;
+	uint8_t interrupt_status = 0;
+	u8 result_event = 0;
+	//uint8_t touchold_buffer[10];
+	uint8_t *touchold_buffer;
+	int touchhold_flag = 0;
+	struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+	touchold_buffer = (uint8_t *)kzalloc(10,GFP_KERNEL);
+	pm_qos_add_request(&pm_qos_req_tp, PM_QOS_CPU_DMA_LATENCY,
+				PM_QOS_VALUE_TP);
+#ifdef CONFIG_SYNAPTIC_RED
+	if (chip_info->enable_remote) {
+		pm_qos_remove_request(&pm_qos_req_tp);
+		kfree(touchold_buffer);
+		return IRQ_IGNORE;
+	}
+#endif
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+	ret = touch_i2c_read_word(chip_info->client,
+		chip_info->reg_info.F01_RMI_DATA_BASE);
+	if (ret < 0) {
+		TPD_INFO("%s, i2c read error, ret = %d\n",
+			__func__, ret);
+		pm_qos_remove_request(&pm_qos_req_tp);
+		kfree(touchold_buffer);
+		return IRQ_EXCEPTION;
+		}
+	device_status = ret & 0xff;
+	interrupt_status = (ret & 0x7f00) >> 8;
+
+		if (interrupt_status & 0x04) {
+			if (chip_info->en_up_down &&
+				chip_info->in_gesture_mode == 0) {
+				ret = touch_i2c_read_block(chip_info->client,
+					0x000A, 5, &(touchold_buffer[0]));
+				if (ret < 0) {
+					TPD_INFO("%s,i2c error,ret = %d\n",
+						__func__, ret);
+					pm_qos_remove_request(&pm_qos_req_tp);
+					kfree(touchold_buffer);
+					return IRQ_EXCEPTION;
+				}
+				touchhold_flag = touchold_buffer[0];
+//				TPD_INFO("touchold_buffer[0] is %d\n",
+//					touchold_buffer[0]);
+				if (touchhold_flag == 0x0f) {
+					gf_opticalfp_irq_handler(1);
+					TPD_INFO("touchhold down\n");
+				} else if (touchhold_flag == 0x1f) {
+					gf_opticalfp_irq_handler(0);
+					TPD_INFO("touchhold up\n");
+				}
+			}
+		}
+
+	if (device_status) {
+		TPD_INFO("%s, interrupt_status = 0x%x, device_status = 0x%x\n",
+			__func__, interrupt_status, device_status);
+		pm_qos_remove_request(&pm_qos_req_tp);
+		kfree(touchold_buffer);
+		return IRQ_EXCEPTION;
+	}
+	if (interrupt_status & 0x04) {
+		if (gesture_enable && is_suspended) {
+			if (chip_info->in_gesture_mode == 1) {
+				kfree(touchold_buffer);
+				return IRQ_GESTURE;
+			} else {
+				pm_qos_remove_request(&pm_qos_req_tp);
+				kfree(touchold_buffer);
+				return IRQ_IGNORE;
+			}
+		}
+		kfree(touchold_buffer);
+		 return  IRQ_TOUCH;
+	}
+	if (interrupt_status & 0x10)
+		SET_BIT(result_event, IRQ_BTN_KEY);
+
+	if (interrupt_status & 0x20 && tp_debug != 0)
+		SET_BIT(result_event, IRQ_DATA_LOGGER);
+
+	if (interrupt_status & 0x20) {
+		TPD_INFO("interrupt_status is %d\n", interrupt_status);
+		SET_BIT(result_event, IRQ_FACE_STATE);
+	}
+	pm_qos_remove_request(&pm_qos_req_tp);
+	kfree(touchold_buffer);
+	return result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+        if (gpio_is_valid(hw_res->reset_gpio)) {
+                TPD_DEBUG("Set the reset_gpio \n");
+                gpio_direction_output(hw_res->reset_gpio, on);
+        }
+
+        return 0;
+}
+
+/*
+ * return success: 0; fail : negative
+ */
+static int synaptics_reset(void *chip_data)
+{
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        TPD_INFO("%s.\n", __func__);
+        synaptics_resetgpio_set(chip_info->hw_res, false); /* reset gpio*/
+        msleep(10);
+        synaptics_resetgpio_set(chip_info->hw_res, true); /* reset gpio*/
+        msleep(RESET_TO_NORMAL_TIME);
+
+        return 0;
+}
+
+static int synaptics_configuration_init(struct chip_data_s3706 *chip_info, bool config)
+{
+        int ret = 0;
+
+        TPD_INFO("%s, configuration init = %d\n", __func__, config);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+        if (ret < 0) {
+                TPD_INFO("init_panel failed for page select\n");
+                return -1;
+        }
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+        if (ret < 0) {
+                TPD_INFO("failed for get F01_RMI_CTRL00\n");
+                return -1;
+        }
+
+        //device control: normal operation
+        if (config) {//configed  && out of sleep mode
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x80);
+                if (ret < 0) {
+                        TPD_INFO("%s failed for mode select\n", __func__);
+                        return -1;
+                }
+        } else {//sleep mode
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x81);
+                if (ret < 0) {
+                        TPD_INFO("%s failed for mode select\n", __func__);
+                        return -1;
+                }
+        }
+
+        return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_s3706 *chip_info, bool enable)
+{
+        int ret = 0;
+
+        TPD_INFO("%s, enable = %d\n", __func__, enable);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        if (ret < 0) {
+                TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+                return ret;
+        }
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+        if (enable) {
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+        } else {
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+        }
+
+        return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_s3706 *chip_info, bool enable)
+{
+	int ret;
+	unsigned char *report_gesture_ctrl_buf;
+
+	report_gesture_ctrl_buf = (unsigned char *)kzalloc(3, GFP_KERNEL);
+	TPD_INFO("%s, enable = %d\n", __func__, enable);
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+	if (ret < 0) {
+		TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+		kfree(report_gesture_ctrl_buf);
+		return -EINVAL;
+	}
+	touch_i2c_read_block(chip_info->client,
+		chip_info->reg_info.F12_2D_CTRL20,
+		3, &(report_gesture_ctrl_buf[0x0]));
+
+	if (enable) {
+		report_gesture_ctrl_buf[2] |= 0x02;
+		chip_info->in_gesture_mode = 1;
+		/*set doze interval to 30ms*/
+		ret = touch_i2c_write_byte(chip_info->client,
+			chip_info->reg_info.F01_RMI_CTRL02, 0x3);
+	} else {
+		report_gesture_ctrl_buf[2] &= 0xfd;
+		chip_info->in_gesture_mode = 0;
+		/*set doze interval to 10ms*/
+		ret = touch_i2c_write_byte(chip_info->client,
+			chip_info->reg_info.F01_RMI_CTRL02, 0x1);
+	}
+	touch_i2c_write_block(chip_info->client,
+		chip_info->reg_info.F12_2D_CTRL20,
+			3, &(report_gesture_ctrl_buf[0x0]));
+
+	tp_single_tap_en(chip_info, true);
+	kfree(report_gesture_ctrl_buf);
+	return 0;
+}
+
+static int synaptics_gesture_switch_mode
+		(struct chip_data_s3706 *chip_info, bool enable)
+{
+	int tmp_mod;
+	int ret;
+
+	touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	tmp_mod = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+	tmp_mod = tmp_mod & 0xF8;
+	if (enable) {//disable gesture,enter sleep
+		tmp_mod = tmp_mod | 0x81;
+		ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, tmp_mod);
+		tmp_mod = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+		TPD_INFO("disable gesture, tmp_mod is %x\n", tmp_mod);
+		synaptics_enable_black_gesture(chip_info, 0);
+	} else {//enable gesture,exit sleep
+		tmp_mod = tmp_mod | 0x80;
+		ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, tmp_mod);
+		tmp_mod = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+		TPD_INFO("enable gesture, tmp_mod is %x\n", tmp_mod);
+		synaptics_enable_black_gesture(chip_info, 1);
+	}
+
+	TPD_INFO("%s: gesture_switch: %s %s!\n", __func__,
+		enable == 0 ? "enable":"disable",
+			ret < 0 ? "failed" : "success");
+
+	return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_s3706 *chip_info, bool enable)
+{
+        int ret;
+
+        TPD_INFO("%s, edge limit enable = %d\n", __func__, enable);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+        if (ret < 0) {
+                TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+                return -1;
+        }
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50);
+        if (enable) {
+                ret |= 0x01;
+                TPD_INFO("enable is %d, ret = %d\n", enable, ret);
+                touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, ret);
+        } else  {
+                ret &= 0xFE;
+                TPD_INFO("enable is %d, ret = %d\n", enable, ret);
+                touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL50, ret);
+        }
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+        return ret;
+}
+
+//enable face dectect function
+static int synaptics_enable_face_detect(struct chip_data_s3706 *chip_info, bool enable)
+{
+	int ret = -1;
+	int doze_status = 0;
+
+	if (enable) {
+//close doze
+		ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+		doze_status = touch_i2c_read_byte(chip_info->client, 0x0d);
+		TPD_INFO("doze_status is 0x%x\n", doze_status);
+		doze_status = doze_status | 0x04;
+		TPD_INFO("doze_status is 0x%x\n", doze_status);
+		ret = touch_i2c_write_byte(chip_info->client, 0x0d,
+			doze_status);
+		msleep(120);
+//enable fd
+		ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+		ret |= touch_i2c_write_byte(chip_info->client,
+		chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x38, 0x01);
+		ret |= touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	} else {
+//disable fd
+		ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+		ret |= touch_i2c_write_byte(chip_info->client,
+		chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x38, 0x00);
+//open doze
+		ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+		doze_status = touch_i2c_read_byte(chip_info->client, 0x0d);
+		TPD_INFO("doze_status is 0x%x\n", doze_status);
+		doze_status = doze_status & 0xfb;
+		TPD_INFO("doze_status is 0x%x\n", doze_status);
+		ret = touch_i2c_write_byte(chip_info->client, 0x0d,
+			doze_status);
+		ret |= touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	}
+
+	TPD_INFO("%s state: %d %s\n", __func__,
+		enable, ret < 0 ? "failed":"success");
+	return ret;
+
+}
+
+static void synaptics_enable_charge_mode(struct chip_data_s3706 *chip_info, bool enable)
+{
+        int ret = 0, arg = 0;
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);      //set page 0
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+
+        if(enable) {
+                arg = ret | 0x20;
+                TPD_DEBUG("%s enable is %d, arg is 0x%x\n", __func__, enable, arg);
+                touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, arg);
+        } else {
+                arg = ret & 0xDF;
+                TPD_DEBUG("%s enable is %d, arg is 0x%x\n", __func__, enable, arg);
+                touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, arg);
+        }
+}
+
+static void synaptics_enable_game_mode(struct chip_data_s3706 *chip_info, bool enable)
+{
+        int ret = 0;
+        uint8_t game_buffer[13];
+        struct touchpanel_data *ts = i2c_get_clientdata(chip_info->client);
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);      //set page 0
+        if (ret < 0) {
+                TPD_INFO("%s:set page 0 fail\n",__func__);
+                return;
+        }
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL11, 13, &(game_buffer[0]));      /*get noise*/
+        if (ret < 0) {
+                TPD_INFO("%s:get noise fail\n",__func__);
+                return;
+        } else {
+                TPD_INFO("%s:game_buffer[12]=0x%x\n",__func__, game_buffer[12]);
+        }
+
+        if(enable) {
+                game_buffer[12] = ts->noise_level;
+                TPD_DEBUG("%s enable is %d, arg is 0x%x\n", __func__, enable, game_buffer[12]);
+        } else {
+                game_buffer[12] = 0x28;
+                TPD_DEBUG("%s disable is %d, arg is 0x%x\n", __func__, enable, game_buffer[12]);
+        }
+        ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL11, 13, &game_buffer[0]);
+        if (ret < 0) {
+                TPD_INFO("%s:F12_2D_CTRL11 fail\n",__func__);
+                return;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);      //set page 1
+        if (ret < 0) {
+                TPD_INFO("%s:set page 1 fail\n",__func__);
+                return;
+        }
+        TPD_INFO("%s:chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x\n",__func__, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);    /* force update*/
+        if (ret < 0) {
+                TPD_INFO("%s:force update fail\n",__func__);
+                return;
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);      //set page 0
+        if (ret < 0) {
+                TPD_INFO("%s:set page 0 fail\n",__func__);
+                return;
+        }
+
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL11, 13, &(game_buffer[0]));      /*get noise*/
+        if (ret < 0) {
+                TPD_INFO("%s:get noise fail\n",__func__);
+                return;
+        } else {
+                TPD_INFO("%s:game_buffer[12]=0x%x\n",__func__, game_buffer[12]);
+        }
+
+}
+
+static void synaptics_touchhold(struct chip_data_s3706 *chip_info, bool enable)
+{
+	int ret = -1;
+	int i = 0;
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+	if (ret < 0)
+		TPD_INFO("set page first fail!\n");
+
+	if (enable) {
+		for(i = 0; i < 10; i++) {
+			ret = touch_i2c_read_byte(chip_info->client, 0x29);
+			ret |= 0x01;
+			chip_info->en_up_down = 1;
+			ret = touch_i2c_write_byte(chip_info->client,
+				0x29, ret);
+			msleep(10);
+			ret = touch_i2c_read_byte(chip_info->client, 0x29);
+			if (ret == 1)
+				break;
+		}
+	} else {
+		ret = touch_i2c_read_byte(chip_info->client, 0x29);
+		ret &= 0xFE;
+		chip_info->en_up_down = 0;
+		ret = touch_i2c_write_byte(chip_info->client, 0x29, ret);
+	}
+
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_INFO("set page first fail!\n");
+
+    TPD_INFO("%s: touchhold_switch: %d %s!\n", __func__, enable, ret < 0 ? "failed" : "success");
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+	int ret = -1;
+	struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+	if (chip_info->is_power_down)
+		synaptics_power_control(chip_info, true);
+
+
+	switch (mode) {
+	case MODE_NORMAL:
+		ret = synaptics_configuration_init(chip_info, true);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics configuration init failed.\n",
+				__func__);
+			return ret;
+		}
+		ret = synaptics_enable_interrupt(chip_info, true);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics enable interrupt failed.\n",
+				__func__);
+			return ret;
+		}
+		break;
+
+	case MODE_SLEEP:
+
+//		ret = synaptics_enable_interrupt(chip_info, false);
+//		if (ret < 0) {
+//			TPD_INFO("%s: synaptics enable interrupt failed.\n",
+//			__func__);
+//			return ret;
+//		}
+
+			/*device control: sleep mode*/
+
+//		ret = synaptics_configuration_init(chip_info, false);
+//		if (ret < 0) {
+//			TPD_INFO("%s: synaptics configuration init failed.\n",
+//			__func__);
+//			return ret;
+//		}
+
+		ret = synaptics_power_control(chip_info, false);
+		if (ret < 0)
+			TPD_INFO("%s: power down failed\n", __func__);
+		break;
+
+	case MODE_GESTURE:
+		ret = synaptics_enable_black_gesture(chip_info, flag);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics enable gesture failed.\n",
+				__func__);
+			return ret;
+		}
+		break;
+
+	case MODE_GLOVE:
+		ret = synaptics_glove_mode_enable(chip_info, flag);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics enable glove mode failed.\n",
+				__func__);
+			return ret;
+		}
+		break;
+
+	case MODE_EDGE:
+		ret = synaptics_enable_edge_limit(chip_info, flag);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics enable edg limit failed.\n",
+				__func__);
+			return ret;
+		}
+		break;
+
+	case MODE_FACE_DETECT:
+		ret = synaptics_enable_face_detect(chip_info, flag);
+		if (ret < 0) {
+			TPD_INFO("%s: synaptics enable face detect failed.\n",
+			__func__);
+		return ret;
+		}
+		break;
+
+	case MODE_CHARGE:
+		synaptics_enable_charge_mode(chip_info, flag);
+		break;
+
+	case MODE_GAME:
+		synaptics_enable_game_mode(chip_info, flag);
+		break;
+	case MODE_TOUCH_HOLD:
+		synaptics_touchhold(chip_info, flag);
+		break;
+	case MODE_GESTURE_SWITCH:
+		ret = synaptics_gesture_switch_mode(chip_info, flag);
+		if (ret < 0) {
+			TPD_INFO("%s:synaptics enable gesture failed\n",
+					__func__);
+			return ret;
+		}
+		break;
+        default:
+                TPD_INFO("%s: Wrong mode.\n", __func__);
+        }
+
+        return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+	int ret = 0, i, gesture_sign, regswipe;
+	uint8_t *gesture_buffer = NULL;
+	uint8_t *coordinate_buf = NULL;
+	uint16_t trspoint = 0;
+	struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+	gesture_buffer = kzalloc(10 * sizeof(uint8_t), GFP_KERNEL);
+	coordinate_buf = kzalloc(25 * sizeof(uint8_t), GFP_KERNEL);
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+	if (ret < 0) {
+		TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+		kfree(gesture_buffer);
+		gesture_buffer = NULL;
+		kfree(coordinate_buf);
+		coordinate_buf = NULL;
+		pm_qos_remove_request(&pm_qos_req_tp);
+		return -EINVAL;
+	}
+	/*get gesture type*/
+	ret = touch_i2c_read_block(chip_info->client,
+		chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+	TPD_INFO("F12_2D_DATA04 is %d\n", chip_info->reg_info.F12_2D_DATA04);
+	gesture_sign = gesture_buffer[0];
+//	for (i = 0; i < 3; i++)
+//		TPD_INFO("gesture_buffer[%d] is %d\n", i, gesture_buffer[i]);
+	ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+	/*get gesture coordinate and swipe type*/
+	ret = touch_i2c_read_block(chip_info->client,
+		chip_info->reg_info.F51_CUSTOM_DATA_BASE,
+		25, &(coordinate_buf[0]));
+
+		regswipe = coordinate_buf[24];
+		ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+
+        /*detect the gesture mode*/
+        switch (gesture_sign) {
+        case DTAP_DETECT:
+                gesture->gesture_type = DouTap;
+                break;
+        case SWIPE_DETECT:
+                gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                        (regswipe == 0x42) ? Right2LeftSwip   :
+                        (regswipe == 0x44) ? Up2DownSwip          :
+                        (regswipe == 0x48) ? Down2UpSwip          :
+                        (regswipe == 0x80) ? DouSwip                  :
+                        UnkownGesture;
+                break;
+        case CIRCLE_DETECT:
+                gesture->gesture_type = Circle;
+                break;
+        case VEE_DETECT:
+                gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                        (gesture_buffer[2] == 0x02) ? UpVee        :
+                        (gesture_buffer[2] == 0x04) ? RightVee :
+                        (gesture_buffer[2] == 0x08) ? LeftVee  :
+                        UnkownGesture;
+                break;
+        case UNICODE_DETECT:
+			gesture->gesture_type = (gesture_buffer[2] == 0x77 &&
+				gesture_buffer[3] == 0x00) ? Wgestrue :
+			(gesture_buffer[2] == 0x6d &&
+				gesture_buffer[3] == 0x00) ? Mgestrue :
+			(gesture_buffer[2] == 0x73 &&
+				gesture_buffer[3] == 0x00) ? Sgestrue :
+			UnkownGesture;
+			break;
+		case SINGLE_TAP:
+			gesture->gesture_type = SingleTap;
+			break;
+
+		case TOUCHHOLD_DOWN:
+				gf_opticalfp_irq_handler(1);
+				TPD_INFO("touchhold down\n");
+				pm_qos_remove_request(&pm_qos_req_tp);
+				return 0;
+		case TOUCHHOLD_UP:
+				gf_opticalfp_irq_handler(0);
+				TPD_INFO("touchhold up\n");
+				pm_qos_remove_request(&pm_qos_req_tp);
+				return 0;
+
+        default:
+                gesture->gesture_type = UnkownGesture;
+        }
+        TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d regswipe is %d\n", __func__, gesture_sign, gesture->gesture_type, regswipe);
+
+        if (gesture->gesture_type != UnkownGesture) {
+                for (i = 0; i < 23; i += 2) {
+                        trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+                        TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+                }
+
+                TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+                gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+                gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+                gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+                gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+                gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+                gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+                gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+                gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+                gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+                gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+                gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+                gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+                gesture->clockwise         = (coordinate_buf[24] & 0x10) ? 1 :
+                        (coordinate_buf[24] & 0x20) ? 0 : 2; /* 1--clockwise, 0--anticlockwise, not circle, report 2*/
+        }
+		kfree(gesture_buffer);
+		gesture_buffer = NULL;
+		kfree(coordinate_buf);
+		coordinate_buf = NULL;
+		pm_qos_remove_request(&pm_qos_req_tp);
+        return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+        int ret = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (true == enable) {
+                ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+                if (ret) {
+                        return -1;
+                }
+                ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+                if (ret) {
+                        return -1;
+                }
+                msleep(POWEWRUP_TO_RESET_TIME);
+                synaptics_resetgpio_set(chip_info->hw_res, true);
+                msleep(RESET_TO_NORMAL_TIME);
+				ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   /* page 0*/
+				if (ret < 0) {
+					TPD_INFO("%s: failed for page select\n", __func__);
+					return -1;
+				}
+				chip_info->is_power_down = false;
+        } else {
+                ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+                if (ret) {
+                        return -1;
+                }
+                ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+                if (ret) {
+                        return -1;
+                }
+				msleep(20);
+                synaptics_resetgpio_set(chip_info->hw_res, false);
+				chip_info->is_power_down = true;
+        }
+
+        return ret;
+}
+
+static void checkCMD(struct chip_data_s3706 *chip_info, int retry_time)
+{
+        int ret;
+        int flag_err = 0;
+
+        do {
+                msleep(30); /*wait 10ms*/
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+                ret = ret & 0x07;
+                flag_err++;
+        }while((ret > 0x00) && (flag_err < retry_time));
+        if (ret > 0x00) {
+                TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+        }
+}
+
+static int checkCMD_for_finger(struct chip_data_s3706 *chip_info)
+{
+        int ret;
+        int flag_err = 0;
+
+        do {
+                msleep(10); /*wait 10ms*/
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+                flag_err++;
+        }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+        if (10 == flag_err) {
+                TPD_INFO("checkCMD_for_finger error, reset  then msleep(80)\n");
+                synaptics_reset(chip_info);
+                msleep(80);
+                synaptics_mode_switch(chip_info, MODE_NORMAL, true);
+                return -1;
+        } else {
+                TPD_INFO("checkCMD_for_finger ok\n");
+                return 0;
+        }
+}
+
+unsigned char GetLogicalPin(unsigned char p_pin, uint8_t RX_NUM, uint8_t * rx_physical)
+{
+	unsigned char i = 0;
+	for(i = 0; i < RX_NUM; i++)
+	{
+		if (rx_physical[i] == p_pin)
+		  return i;
+	}
+	return 0xff;
+}
+
+static int synaptics_capacity_test(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata,  uint8_t *raw_data, uint8_t *data_buf)
+//static int synaptics_capacity_test(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata, struct test_header *ph, uint8_t *raw_data, uint8_t *data_buf)
+{
+        int ret = 0;
+        int x = 0, y = 0, z = 0;
+        int error_count = 0;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        int16_t *baseline_data_test = NULL;
+        int16_t baseline_data = 0, count = 0;
+
+        /*step 1: Close CBC and test RT20*/
+        TPD_INFO("\n step 1:Close CBC and test RT20\n");
+        if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%s\n", "[RT20 Close CBC]");
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);/*select report type 0x14*/
+        if (ret < 0) {
+                TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+                seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n", __LINE__);
+                error_count++;
+                return error_count;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x14, 0x01);        /*No SignalClarity*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17);                /*0125  CBC Xmtr carrier select*/
+        tmp_arg1 = ret&0xff;
+
+        /*Close CBC*/
+        TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xdf));
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17, (tmp_arg1 & 0xdf));/*Set CBC, F54_ANALOG_CTRL88, close CBC*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);/*force update*/
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Test disable cbc\n");
+        //baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+		baseline_data_test = (uint16_t *)baseline_cap_18857_data[1];
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);/*force Cal*/
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        TPD_INFO("key_TX is %d, key_RX is %d\n", syna_testdata->key_TX, syna_testdata->key_RX);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);         /*read data*/
+        for (x = 0; x < syna_testdata->TX_NUM; x++) {
+                TPD_DEBUG_NTAG("[%d]: ", x);
+                for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                        z = syna_testdata->RX_NUM * x + y;
+                        tmp_arg1 = raw_data[z*2] & 0xff;
+                        tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+                        baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+                        if (syna_testdata->fd >= 0) {
+                                sprintf(data_buf, "%d, ", baseline_data);
+                                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                        }
+
+                        if ((y < syna_testdata->RX_NUM - syna_testdata->key_RX) && (x < syna_testdata->TX_NUM - syna_testdata->key_TX)) {
+                                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                                if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                                        TPD_INFO("Synaptic:touchpanel failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        seq_printf(s, "Step 1 :touchpanel failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        error_count++;
+                                        return error_count;
+                                }
+                        } else if ((x == syna_testdata->TX_NUM - syna_testdata->key_TX) && (y >= syna_testdata->RX_NUM - syna_testdata->key_RX)) {
+                                TPD_DEBUG("touchkey test xy(%d, %d), baseline_data=%d, limite( %d, %d)\n ", x, y, baseline_data,
+                                        *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                                        TPD_INFO("Synaptic:touchkey failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        seq_printf(s, "Step 1 :touchkey failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        error_count++;
+                                        return error_count;
+                                }
+                        }
+
+                        count++;
+                }
+                if (syna_testdata->fd >= 0) {
+                        sys_write(syna_testdata->fd, "\n", 1);
+                }
+                TPD_DEBUG_NTAG("\n");
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+        /*step 2:check raw capacitance, Open CBC and testRT3*/
+        TPD_INFO("\n step 2:Open CBC and test RT3\n");
+        if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%s\n", "[RT3 Open CBC]");
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x03);/*select report type 0x03*/
+        if (ret < 0) {
+                TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+                error_count++;
+                return error_count;
+        }
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x14, 0x01);        /*No SignalClarity*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17);          /*0125  CBC Xmtr carrier select*/
+        tmp_arg1 = ret&0xff;
+
+        TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x10));
+        ret = touch_i2c_write_byte(chip_info->client,
+                chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x14, 0x00);          /* Disable No SignalClarity*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17, (tmp_arg1 | 0x10));        /*open CBC*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Test open cbc\n");
+       // baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limitcbc_offset);
+	   baseline_data_test = (uint16_t *)baseline_cap_18857_data[0];
+        /******write No Relax to 1******/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); /* force update*/
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);/*force Cal*/
+        checkCMD(chip_info, 30);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+		TPD_INFO("F54_ANALOG_DATA_BASE %x \n",chip_info->reg_info.F54_ANALOG_DATA_BASE);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);         /*read data*/
+        count = 0;
+        for (x = 0; x < syna_testdata->TX_NUM; x++) {
+                TPD_DEBUG_NTAG("[%d]: ", x);
+                for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                        z = syna_testdata->RX_NUM * x + y;
+                        tmp_arg1 = raw_data[z*2] & 0xff;
+                        tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+                        baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+                        if (syna_testdata->fd >= 0) {
+                                sprintf(data_buf, "%d, ", baseline_data);
+                                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                        }
+                        if ((y < syna_testdata->RX_NUM - syna_testdata->key_RX) && (x < syna_testdata->TX_NUM - syna_testdata->key_TX)) {
+                                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                                if ((baseline_data < *(baseline_data_test + count*2)) || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                                        TPD_INFO("Synaptic:touchpanel failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        seq_printf(s, "Step 2 :touchpanel failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        error_count++;
+                                        return error_count;
+                                }
+                        } else if ((x == syna_testdata->TX_NUM - syna_testdata->key_TX) && (y >= syna_testdata->RX_NUM - syna_testdata->key_RX)) {
+                                TPD_INFO("touchkey test xy(%d, %d), baseline_data=%d, limite( %d, %d)\n ", x, y, baseline_data,
+                                        *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                if (((baseline_data) < *(baseline_data_test + count*2)) || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                                        TPD_INFO("Synaptic:touchkey failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        seq_printf(s, "Step 2 :touchkey failed, raw data erro baseline_data[%d][%d] = %d[%d, %d]\n",
+                                                x, y, baseline_data, *(baseline_data_test + count*2), *(baseline_data_test + count*2 + 1));
+                                        error_count++;
+                                        return error_count;
+                                }
+                        }
+                        count++;
+                }
+                if (syna_testdata->fd >= 0) {
+                        sys_write(syna_testdata->fd, "\n", 1);
+                }
+                TPD_DEBUG_NTAG("\n");
+        }
+
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+        checkCMD(chip_info, 30);
+
+        return error_count;
+}
+
+static int synaptics_auto_test_rt25(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata)
+{
+        int ret = 0;
+        int i = 0, j = 0, x = 0;
+        int error_count = 0;
+        //uint8_t buffer[9];
+        uint8_t *buffer;
+        uint8_t *buffer_rx;
+        uint8_t *buffer_tx;
+        int sum_line_error = 0;
+		buffer = (uint8_t *)kzalloc(9, GFP_KERNEL);
+		buffer_rx = kzalloc(syna_testdata->RX_NUM * (sizeof(uint8_t)), GFP_KERNEL);
+		buffer_tx = kzalloc(syna_testdata->TX_NUM * (sizeof(uint8_t)), GFP_KERNEL);
+        /*step 3 :check TRx-to-Ground, with rt25*/
+        TPD_INFO("step 3:check TRx-to-Ground, with rt25\n");
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x19);/*select report type 25*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x0);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        /*msleep(100);*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, 7, buffer);
+
+        /*guomingqiang@phone.bsp, 2016-06-27, add for tp test step2*/
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x3);
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+
+        TPD_INFO("RX_NUM : ");
+        for (i = 0; i< syna_testdata->RX_NUM; i++) {
+                TPD_INFO("%d, ", buffer_rx[i]);
+        }
+        TPD_INFO("\n");
+
+        TPD_INFO("TX_NUM : ");
+        for (i = 0; i< syna_testdata->TX_NUM; i++) {
+                TPD_INFO("%d, ", buffer_tx[i]);
+        }
+        TPD_INFO("\n");
+
+        for (x = 0; x < 7; x++) {
+                if (buffer[x] == 0) {
+                        for (i = 0; i< 8; i++) {
+                                if ((buffer[x] & (1 << i)) != 0) {
+                                        sum_line_error = 8 * x + i + 1;
+                                        for (j = 0; j < syna_testdata->RX_NUM; j++) {
+                                                if (sum_line_error == buffer_rx[j]) {
+                                                        error_count++;
+                                                        TPD_INFO(" step 3 :check TRx-to-Ground, with rt25 error,  error_line is rx = %d\n", buffer_rx[j]);
+                                                        seq_printf(s, " Step 3 :check TRx-to-Ground, with rt25,  error_line is rx = %d\n", buffer_rx[j]);
+                                                        return error_count;
+                                                }
+                                        }
+                                        for (j = 0; j < syna_testdata->TX_NUM; j++) {
+                                                if (sum_line_error == buffer_tx[j]) {
+                                                        error_count++;
+                                                        TPD_INFO(" step 3 :check TRx-to-Ground, with rt25, error_line is tx = %d\n", buffer_tx[j]);
+                                                        seq_printf(s, " Step 3 :check TRx-to-Ground, with rt25, error_line is rx = %d\n", buffer_rx[j]);
+                                                        return error_count;
+                                                }
+                                        }
+                                }
+                        }
+                }
+        }
+		kfree(buffer);
+		kfree(buffer_rx);
+		kfree(buffer_tx);
+        return error_count;
+}
+
+static int synaptics_auto_test_rt26(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata)
+{
+        int ret = 0;
+        int error_count = 0;
+        int i = 0, x = 0;
+        //uint8_t buffer[9];
+		uint8_t *buffer;
+        uint8_t *buffer_rx;
+        uint8_t *buffer_tx;
+		buffer = (uint8_t *)kzalloc(9, GFP_KERNEL);
+		buffer_rx = kzalloc(syna_testdata->RX_NUM * (sizeof(uint8_t)), GFP_KERNEL);
+		buffer_tx = kzalloc(syna_testdata->TX_NUM * (sizeof(uint8_t)), GFP_KERNEL);
+
+        /*step 4 :check tx-to-tx and tx-to-vdd*/
+        TPD_INFO("step 4:check TRx-TRx & TRx-Vdd short\n");
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x1A);/*select report type 26*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x0);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        /*msleep(100);*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, 7, buffer);
+
+        /*guomingqiang@phone.bsp, 2016-06-27, add for tp test step2*/
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x3);                /*page 3*/
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL01, syna_testdata->RX_NUM, buffer_rx);
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL02, syna_testdata->TX_NUM, buffer_tx);
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x1);                /*page 1*/
+
+        TPD_INFO("RX_NUM : ");
+        for (i = 0; i< syna_testdata->RX_NUM; i++) {
+                TPD_INFO("%d, ", buffer_rx[i]);
+        }
+        TPD_INFO("\n");
+
+        TPD_INFO("TX_NUM : ");
+        for (i = 0; i< syna_testdata->TX_NUM; i++) {
+                TPD_INFO("%d, ", buffer_tx[i]);
+        }
+        TPD_INFO("\n");
+		kfree(buffer_rx);
+		kfree(buffer_tx);
+        for (x = 0; x < 7; x++) {
+		TPD_INFO("RT26 data byte %d - data 0x%x\n", x, buffer[x]);
+		if (buffer[x] != 0) {
+			if ((x == 0) && (buffer[x] & 0x01)) {   //pin - 0, these four pins should be test in RT100
+
+			} else if ((x == 0) && (buffer[x] & 0x02)) {      //pin - 1
+
+			} else if ((x == 4) && (buffer[x] & 0x01)) {      //pin -32
+
+			} else if ((x == 4) && (buffer[x] & 0x02)) {      //pin -33
+
+			} else {
+			        error_count++;
+				TPD_INFO("RT26 test fail!!!  data byte %d - data 0x%x\n", x, buffer[x]);
+                                seq_printf(s, " Step 4 :RT26 test fail!!!  data byte %d - data 0x%x\n", x, buffer[x]);
+			}
+		}
+	}
+
+	kfree(buffer);
+        return error_count;
+}
+
+static int synaptics_auto_test_rt100(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata, uint8_t * raw_data)
+{
+	int ret = 0;
+	int error_count = 0;
+	int i = 0, j = 0, x = 0, y = 0, z = 0;
+	unsigned char *temp_data;
+	int16_t baseline_data = 0;
+	short *p_data_baseline1 = NULL;
+	short *p_data_baseline2 = NULL;
+	short *p_data_delta = NULL;
+	uint8_t *rx_assignment = NULL;
+	uint8_t rx_physical[syna_testdata->RX_NUM];
+	short minRX[syna_testdata->RX_NUM + 1];
+	short maxRX[syna_testdata->RX_NUM + 1];
+	unsigned char logical_pin = 0xff;
+	uint8_t ExtendRT26_pin[4] = {0, 1, 32, 33};
+
+	rx_assignment = kcalloc(syna_testdata->RX_NUM,
+		sizeof(uint8_t), GFP_KERNEL);
+	temp_data = kzalloc(64 * sizeof(unsigned char), GFP_KERNEL);
+	if (!temp_data) {
+		error_count++;
+		TPD_INFO("temp_data kzalloc error\n");
+		return error_count;
+	}
+
+        p_data_baseline1 = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!p_data_baseline1) {
+                error_count++;
+                TPD_INFO("p_data_baseline1 kzalloc error\n");
+				kfree(rx_assignment);
+				rx_assignment = NULL;
+                return error_count;
+        }
+
+        p_data_baseline2 = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!p_data_baseline2) {
+                error_count++;
+                TPD_INFO("p_data_baseline2 kzalloc error\n");
+				kfree(rx_assignment);
+				rx_assignment = NULL;
+                kfree(p_data_baseline1);
+                p_data_baseline1 = NULL;
+                return error_count;
+        }
+
+        p_data_delta = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if(!p_data_delta) {
+                error_count++;
+                TPD_INFO("p_data_delta kzalloc error\n");
+				kfree(rx_assignment);
+				rx_assignment = NULL;
+				kfree(temp_data);
+				temp_data = NULL;
+                kfree(p_data_baseline1);
+                p_data_baseline1 = NULL;
+                kfree(p_data_baseline2);
+                p_data_baseline2 = NULL;
+                return error_count;
+        }
+
+        //step 5:check RT100 for pin 0,1,32,33
+        TPD_INFO("step 5:check RT100 for pin 0,1,32,33\n");
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE);         //read no scan
+        ret |= 0x02;
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE, ret);           //set no scan
+
+        //set all local cbc to 0
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x1D, syna_testdata->RX_NUM, &temp_data[0]);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);    /* force update*/
+        checkCMD(chip_info, 30);
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x64);/*select report type 100*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x0);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2, raw_data);         /*read raw data1*/
+
+        /*debug log*/
+        TPD_INFO("baseline1:\n");
+        for (x = 0, z = 0; x < syna_testdata->TX_NUM; x++) {
+                TPD_DEBUG_NTAG("[%d]: ", x);
+		for (y = 0; y < syna_testdata->RX_NUM; y++) {
+			baseline_data = raw_data[z] | (raw_data[z + 1] << 8);
+			p_data_baseline1[x * syna_testdata->RX_NUM + y] = baseline_data;
+			z = z + 2;
+                        TPD_DEBUG_NTAG("%d, ", p_data_baseline1[x * syna_testdata->RX_NUM + y]);
+		}
+                TPD_DEBUG_NTAG("\n");
+	}
+        /*end*/
+        //get logical pin
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x03);        /* page 3*/
+        touch_i2c_read_block(chip_info->client, 0x01, syna_testdata->RX_NUM, &rx_assignment[0]);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        for(i = 0; i < syna_testdata->RX_NUM; i++) {
+                if(rx_assignment[i] != 0xff) {
+                        rx_physical[i] = rx_assignment[i];
+                }
+        }
+
+        for(i = 0; i < 4; i++) {
+                for(j = 0; j < 34; j++) {
+			minRX[j] = 5000;
+			maxRX[j] = 0;
+                }
+
+                logical_pin = GetLogicalPin(ExtendRT26_pin[i], syna_testdata->RX_NUM, rx_physical);
+
+                if (logical_pin == 0xFF)
+                        continue;
+
+                TPD_INFO("\ninfo: RT26 pin %d, logical pin %d \n", ExtendRT26_pin[i], logical_pin);
+
+                // 14. set local CBC to 8pf(2D) 3.5pf(0D)
+		temp_data[logical_pin] = 0x0f;          //EXTENDED_TRX_SHORT_CBC;
+
+                ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x1D, syna_testdata->RX_NUM, &temp_data[0]);
+                if (ret < 0) {
+                        error_count++;
+			TPD_INFO("error: %s fail to set all F54 control_96 register after changing the cbc\n", __func__);
+			goto END;
+		}
+                temp_data[logical_pin] = 0;
+
+                // 15. force update
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);    /* force update*/
+                checkCMD(chip_info, 30);
+
+                // 16. read report type 100
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x64);/*select report type 100*/
+                ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x0);
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+                checkCMD(chip_info, 30);
+                ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2, raw_data);         /*read raw data2*/
+
+                /*debug log*/
+                TPD_INFO("baseline2:\n");
+                for (x = 0, z = 0; x < syna_testdata->TX_NUM; x++) {
+                        TPD_DEBUG_NTAG("[%d]: ", x);
+			for (y = 0; y < syna_testdata->RX_NUM; y++) {
+				baseline_data = raw_data[z] | (raw_data[z + 1] << 8);
+				p_data_baseline2[x * syna_testdata->RX_NUM + y] = baseline_data;
+				z = z + 2;
+                                TPD_DEBUG_NTAG("%d, ", p_data_baseline2[x * syna_testdata->RX_NUM + y]);
+			}
+                        TPD_DEBUG_NTAG("\n");
+		}
+                /*end*/
+
+                // 17. get delta image between baseline image 1 and baseline image 2
+		for (x = 0; x < syna_testdata->TX_NUM; x++) {
+			for (y = 0; y < syna_testdata->RX_NUM; y++) {
+				p_data_delta[x * syna_testdata->RX_NUM + y] = 
+					ABS( p_data_baseline1[x * syna_testdata->RX_NUM + y], p_data_baseline2[x * syna_testdata->RX_NUM + y]);
+
+				if (maxRX[y] < p_data_delta[x * syna_testdata->RX_NUM + y])
+				  maxRX[y] = p_data_delta[x * syna_testdata->RX_NUM + y];
+
+				if (minRX[y] > p_data_delta[x * syna_testdata->RX_NUM + y])
+				  minRX[y] = p_data_delta[x * syna_testdata->RX_NUM + y];
+			}
+		}
+
+                /*debug log*/
+                TPD_DEBUG("\n");
+                for (y = 0; y < syna_testdata->RX_NUM; y++ ) {
+                        TPD_DEBUG_NTAG("Rx%-2d(max, min) = (%4d, %4d)\n", y, maxRX[y], minRX[y]);
+                }
+                TPD_DEBUG("\n");
+                /*end*/
+
+                // 18. Check data: TREX w/o CBC raised changes >= 200 or TREXn* (TREX with CBC raised) changes < 2000
+		// Flag TRX0* as 1 as well if any other RX changes are >=200
+		for (x = 0; x < syna_testdata->RX_NUM; x++) {
+			if (x == logical_pin) {
+				if (minRX[x] < 600) {
+                                        error_count++;
+					TPD_INFO("step 5:check RT100 for pin 0,1,32,33 test failed: minRX[%-2d] = %4d when test pin %d (RX Logical pin [%d])\n",
+								x, minRX[x], ExtendRT26_pin[i], logical_pin);
+                                        seq_printf(s, "Step 5:check RT100 for pin 0,1,32,33 test failed: minRX[%-2d] = %4d when test pin %d (RX Logical pin [%d])\n",
+                                                x, minRX[x], ExtendRT26_pin[i], logical_pin);
+                                        goto END;
+				}
+			} else {
+				if (maxRX[x] >= 550) {
+                                        error_count++;
+					TPD_INFO("step 5:check RT100 for pin 0,1,32,33 test failed: minRX[%-2d] = %4d when test pin %d (RX Logical pin [%d])\n",
+								x, minRX[x], ExtendRT26_pin[i], logical_pin);
+                                        seq_printf(s, "Step 5:check RT100 for pin 0,1,32,33 test failed: minRX[%-2d] = %4d when test pin %d (RX Logical pin [%d])\n",
+                                                x, minRX[x], ExtendRT26_pin[i], logical_pin);
+                                        goto END;
+				}
+			}
+		}
+        }
+
+END:
+		kfree(rx_assignment);
+		rx_assignment = NULL;
+        kfree(temp_data);
+		temp_data = NULL;
+        kfree(p_data_baseline1);
+        p_data_baseline1 = NULL;
+        kfree(p_data_baseline2);
+        p_data_baseline2 = NULL;
+        kfree(p_data_delta);
+        p_data_delta = NULL;
+        return error_count;
+}
+
+static int synaptics_auto_test_rt133(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata)
+{
+        int ret = 0;
+        int y = 0;
+        int error_count = 0;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        int16_t baseline_data = 0;
+
+        /*Step 6 : Check the broken line with RT133*/
+        TPD_INFO("Step 6 : Check the broken line\n");
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x85);/*select report type 0x85*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+                TPD_INFO("Step 6 data[%d] is %d\n", y, baseline_data);
+                if (baseline_data > 100) {
+                        error_count++;
+                        TPD_INFO(" step 6 :check the broken line, error_line is y =%d\n", y);
+                        seq_printf(s, "Step 6 :check the broken line, error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+                        return error_count;
+                }
+        }
+
+        seq_printf(s, "\n");
+
+        return error_count;
+}
+
+static int synaptics_auto_test_rt150(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata, uint8_t *data_buf)
+{
+        int ret = 0;
+        int y = 0;
+        int error_count = 0;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        uint16_t unsigned_baseline_data = 0;
+
+        /*Step 7 : Check RT150 for random touch event*/
+        TPD_INFO("Step 7 : Check RT150 for random touch event\n");
+        if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%s\n", "[RT150]");
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x96);/*select report type RT150*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 70);
+        for (y = 0; y < syna_testdata->RX_NUM + syna_testdata->TX_NUM - syna_testdata->key_TX - syna_testdata->key_RX; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                unsigned_baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+                if (syna_testdata->fd >= 0) {
+                        sprintf(data_buf, "%d, ", unsigned_baseline_data);
+                        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                if (unsigned_baseline_data < 10000) {
+                        error_count++;
+                        TPD_INFO("Step 7 : Check RT150 for random touch event, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+                        seq_printf(s, "Step 7 : Check RT150 for random touch event, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+                        return error_count;
+                }
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+
+        return error_count;
+}
+
+static int synaptics_auto_test_rt154(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata, uint8_t *data_buf)
+{
+        int ret = 0;
+        int error_count = 0;
+        int y = 0;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        uint16_t unsigned_baseline_data = 0;
+		goto fail;
+        /*Step 8 : Check RT154 for self raw data check*/
+        TPD_INFO("Step 8 : Check RT154 for self raw data check\n");
+        if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%s\n", "[RT154]");
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x9A);/*select report type 0xFE*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                unsigned_baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+                if (syna_testdata->fd >= 0) {
+                        sprintf(data_buf, "%d, ", unsigned_baseline_data);
+                        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                if ((syna_testdata->key_RX != 0 || syna_testdata->key_TX != 0)
+                        && (((y > chip_info->hw_res->RX_NUM - syna_testdata->key_RX - 1) && (y < chip_info->hw_res->RX_NUM))
+                        || (y > chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - syna_testdata->key_TX - 1))) {
+                        TPD_INFO("y = %d\n", y);
+                        continue;
+                }
+                if (unsigned_baseline_data < 50 || unsigned_baseline_data > 975) {
+                        error_count++;
+                        TPD_INFO("Step 8 : Check RT154 for self raw data check, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+                        seq_printf(s, "Step 8 : Check RT154 for self raw data check, error_line is y =%d, data[%d] = %hu\n", y, y, unsigned_baseline_data);
+                        return error_count;
+                }
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+fail:
+        return error_count;
+}
+
+static int synaptics_auto_test_rt155(struct seq_file *s, struct chip_data_s3706 *chip_info, struct syna_testdata *syna_testdata, uint8_t *data_buf)
+{
+        int ret = 0;
+        int error_count = 0;
+        int y = 0;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        int16_t baseline_data = 0;
+
+        /*Step 9 : Check RT155 for abs delta error*/
+        TPD_INFO("Step 9 : Check RT155 for abs delta\n");
+        if (syna_testdata->fd >= 0) {
+                sprintf(data_buf, "%s\n", "[RT155]");
+                sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);        /* page 1*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE);      /*get 0x10E status*/
+        ret |= 0x01;
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE, ret);       /*set no relax*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);    /* force update*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x9B);/*select report type 0x9B*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+                if (syna_testdata->fd >= 0) {
+                        sprintf(data_buf, "%d, ", baseline_data);
+                        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                if (baseline_data > 2000) {
+                        error_count++;
+                        TPD_INFO("Step 9 : Check RT155 for abs delta error, error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+                        seq_printf(s, "Step 9 : Check RT155 for abs delta error, error_line is y =%d, data[%d] = %d\n", y, y, baseline_data);
+                        return error_count;
+                }
+        }
+        if (syna_testdata->fd >= 0) {
+                sys_write(syna_testdata->fd, "\n", 1);
+        }
+
+        return error_count;
+}
+
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+        int ret = 0;
+        int error_count = 0;
+        int eint_status, eint_count = 0, read_gpio_num = 0;
+        uint8_t  *data_buf;
+   //     struct test_header *ph = NULL;
+        uint8_t * raw_data = NULL;
+
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+	data_buf = kzalloc(64*(sizeof(uint8_t)), GFP_KERNEL);
+	if (!data_buf) {
+		TPD_INFO("data_buf kzalloc error\n");
+		return;
+        }
+        raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+			TPD_INFO("raw_data kzalloc error\n");
+			kfree(data_buf);
+			return;
+        }
+
+        /*open file to save test data*/
+    //    ph = (struct test_header *)(syna_testdata->fw->data);
+
+        TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+        ret = synaptics_enable_interrupt(chip_info, false);
+        eint_count = 0;
+        read_gpio_num = 10;
+        while (read_gpio_num--) {
+                msleep(5);
+                eint_status = gpio_get_value(syna_testdata->irq_gpio);
+                if (eint_status == 1) {
+                        eint_count--;
+                }
+                else {
+                        eint_count++;
+                }
+                TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+        }
+        TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+        if (eint_count == 10) {
+                TPD_INFO("error :  TP EINT PIN direct short!\n");
+                error_count++;
+                seq_printf(s, "eint_status is low, TP EINT direct stort\n");
+                sprintf(data_buf, "eint_status is low, TP EINT direct stort, \n");
+                if (syna_testdata->fd >= 0) {
+                        sys_write(syna_testdata->fd, data_buf, strlen(data_buf));
+                }
+                eint_count = 0;
+                goto END;
+        }
+
+        synaptics_read_F54_base_reg(chip_info);
+ //       ret = synaptics_capacity_test(s, chip_info, syna_testdata, ph, raw_data, data_buf);
+        ret = synaptics_capacity_test(s, chip_info, syna_testdata, raw_data, data_buf);
+        if(ret > 0) {
+                TPD_INFO("synaptics_capacity_test failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+
+        ret = synaptics_auto_test_rt25(s, chip_info, syna_testdata);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt25 failed, ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+        synaptics_reset(chip_info);
+        msleep(50);
+
+        ret = synaptics_auto_test_rt26(s, chip_info, syna_testdata);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt26 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+        synaptics_reset(chip_info);
+        msleep(50);
+
+        ret = synaptics_auto_test_rt100(s, chip_info, syna_testdata, raw_data);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt100 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+        synaptics_reset(chip_info);
+        msleep(50);
+
+        ret = synaptics_auto_test_rt133(s, chip_info, syna_testdata);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt133 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+
+        msleep(20);
+
+        ret = synaptics_auto_test_rt150(s, chip_info, syna_testdata, data_buf);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt150 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+
+        ret = synaptics_auto_test_rt154(s, chip_info, syna_testdata, data_buf);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt154 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+
+        ret = synaptics_auto_test_rt155(s, chip_info, syna_testdata, data_buf);
+        if(ret > 0) {
+                TPD_INFO("synaptics_auto_test_rt155 failed! ret is %d\n", ret);
+                error_count++;
+                goto END;
+        }
+        synaptics_reset(chip_info);
+        msleep(50);
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /* page 0*/
+
+END:
+		kfree(data_buf);
+        kfree(raw_data);
+        seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+        seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+        TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+        TPD_INFO("\n\nstep5 reset and open irq complete\n");
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+        int ret = 0;
+        int x = 0, y = 0, z = 0;
+        uint8_t tmp_arg1 = 0;
+        uint16_t baseline_data = 0;
+        uint8_t *raw_data = NULL;
+        int enable_cbc = 0;/*enable cbc flag for baseline limit test*/
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (!chip_info) {
+                return;
+        }
+        raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+                        TPD_INFO("raw_data kzalloc error\n");
+                        return;
+        }
+        synaptics_read_F54_base_reg(chip_info);
+        do {
+                if (enable_cbc) {
+                        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x03);/*select report type 0x03*/
+                } else {
+                        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x14);/*select report type 0x14*/
+                }
+                if (ret < 0) {
+                        TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+                        seq_printf(s, "what the hell4, ");
+                        goto END;
+                }
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x14, 0x01);        /*No SignalClarity*/
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17);
+                tmp_arg1 = ret & 0xff;
+
+                if (enable_cbc) {
+                        seq_printf(s, "\nWith CBC:\n");
+                        TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 | 0x10));
+                        ret = touch_i2c_write_byte(chip_info->client,
+                                chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x14, 0x00);          /* Disable No SignalClarity*/
+                        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17, (tmp_arg1 | 0x10));
+                        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04);
+                        checkCMD(chip_info, 30);
+                        TPD_DEBUG("Test open cbc\n");
+                } else {
+                        seq_printf(s, "\nWithout CBC:\n");
+                        TPD_DEBUG("ret = %x, tmp_arg1 = %x, tmp_arg2 = %x\n", ret, tmp_arg1, (tmp_arg1 & 0xef));
+                        ret = touch_i2c_write_byte(chip_info->client,
+                                chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 20, 0x01);          /* Enable No SignalClarity*/
+                        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 0x17, (tmp_arg1 & 0xef));
+                        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); /* force update*/
+                        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CONTROL_BASE + 7, 0x01);/* Forbid NoiseMitigation*/
+                }
+                /******write No Relax to 1******/
+                ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x04); /* force update*/
+                checkCMD(chip_info, 30);
+                TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);/*force Cal*/
+                checkCMD(chip_info, 30);
+                TPD_DEBUG("Force Cal oK\n");
+                ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+                checkCMD(chip_info, 30);
+                ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                        chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);         /*read data*/
+
+                for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+                        seq_printf(s, "[%2d] ", x);
+                        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                                z = chip_info->hw_res->RX_NUM * x + y;
+                                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                                seq_printf(s, "%4d, ", baseline_data);
+                        }
+                        seq_printf(s, "\n");
+                }
+                enable_cbc++;
+        }while(enable_cbc < 2);
+
+END:
+        kfree(raw_data);
+        return;
+}
+
+/*Reserved node*/
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+        int ret = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (!chip_info) {
+                return;
+        }
+
+        /*1.get firmware doze mode info*/
+        TPD_INFO("1.get firmware doze mode info\n");
+        seq_printf(s, "1.get firmware doze mode info\n");
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);        /* page 4*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x1A);
+        TPD_INFO("TP doze mode status is %d\n", ret);
+        seq_printf(s, "TP doze mode status is %d\n", ret);
+
+        msleep(10);
+}
+
+static void synaptics_RT76_read(struct seq_file *s, void *chip_data)
+{
+        int ret = 0, x = 0, y = 0, z = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+        int16_t temp_delta = 0;
+        uint8_t *raw_data = NULL;
+
+        if (!chip_info) {
+                return;
+        }
+
+        raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+                        TPD_INFO("raw_data kzalloc error\n");
+                        return;
+        }
+
+        /*disable irq when read data from IC*/
+        synaptics_read_F54_base_reg(chip_info);
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x4C);/*select report type 0x4C*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);         /*read data*/
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+                seq_printf(s, "\n[%2d]", x);
+                for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                        z = chip_info->hw_res->RX_NUM * x + y;
+                        temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                        seq_printf(s, "%4d, ", temp_delta);
+                }
+        }
+        seq_printf(s, "\n");
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /* page 0*/
+        msleep(60);
+        kfree(raw_data);
+}
+
+static void synaptics_RT251_read(struct seq_file *s, void *chip_data)
+{
+        int ret = 0, y = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+        uint8_t tmp_arg1 = 0, tmp_arg2 = 0;
+        uint16_t RT_data = 0;
+
+        if (!chip_info) {
+                return;
+        }
+
+        /*disable irq when read data from IC*/
+        synaptics_read_F54_base_reg(chip_info);
+
+        /*Check RT252 for random touch event*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x96);/*select report type 0xFC*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 70);
+        seq_printf(s, "\n[RT252]");
+        for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - chip_info->hw_res->key_TX - chip_info->hw_res->key_RX; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                RT_data = (tmp_arg2 << 8) | tmp_arg1;
+                seq_printf(s, "%hu, ", RT_data);
+        }
+        seq_printf(s, "\n");
+
+        /*Get RT254 info*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x9A);/*select report type 0xFE*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 70);
+        seq_printf(s, "\n[RT254]");
+        for (y = 0; y < chip_info->hw_res->RX_NUM + chip_info->hw_res->TX_NUM - chip_info->hw_res->key_TX - chip_info->hw_res->key_RX; y++) {
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg1 = ret & 0xff;
+                ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+                tmp_arg2 = ret & 0xff;
+                RT_data = (tmp_arg2 << 8) | tmp_arg1;
+                seq_printf(s, "%hu, ", RT_data);
+        }
+        seq_printf(s, "\n");
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /* page 0*/
+        synaptics_reset(chip_info);
+        msleep(60);
+}
+
+static void synaptics_main_register_read(struct seq_file *s, void *chip_data)
+{
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (!chip_info)
+                return ;
+        TPD_INFO("%s start\n", __func__);
+        /*disable irq when read data from IC*/
+        seq_printf(s, "====================================================\n");
+        if(chip_info->p_tp_fw) {
+                seq_printf(s, "tp fw = 0x%x\n", *(chip_info->p_tp_fw));
+        }
+        seq_printf(s, "====================================================\n");
+
+        msleep(10);
+}
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+        int ret = 0, x = 0, y = 0, z = 0;
+        int16_t temp_delta = 0;
+        uint8_t *raw_data = NULL;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (!chip_info) {
+                return;
+        }
+
+        raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+                        TPD_INFO("raw_data kzalloc error\n");
+                        return;
+        }
+
+        /*disable irq when read data from IC*/
+        synaptics_read_F54_base_reg(chip_info);
+
+        /*TPD_DEBUG("\nstep 2:report type2 delta image\n");*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);/*select report type 0x02*/
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+        checkCMD(chip_info, 30);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);         /*read data*/
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+                seq_printf(s, "\n[%2d]", x);
+                for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                        z = chip_info->hw_res->RX_NUM * x + y;
+                        temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                        seq_printf(s, "%4d, ", temp_delta);
+                }
+        }
+        seq_printf(s, "\n");
+        msleep(10);
+
+        if (tp_debug != 0 && chip_info->d_log.data_logger_control== true) {
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0xC8);/*select report type 0xC8*/
+                ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+                ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+                checkCMD(chip_info, 30);
+                ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                        chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);         /*read data*/
+                for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+                        seq_printf(s, "\n[%2d]", x);
+                        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                                z = chip_info->hw_res->RX_NUM * x + y;
+                                temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                                seq_printf(s, "%4d, ", temp_delta);
+                        }
+                }
+                seq_printf(s, "\n");
+        }
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /* page 0*/
+        msleep(60);
+        kfree(raw_data);
+}
+
+static int s3706_reset_device(struct synaptics_rmi4_data *rmi4_data, bool rebuild)
+{
+        TPD_INFO("%s.\n", __func__);
+        synaptics_resetgpio_set(g_chip_info->hw_res, false); /* reset gpio*/
+        msleep(10);
+        synaptics_resetgpio_set(g_chip_info->hw_res, true); /* reset gpio*/
+        msleep(RESET_TO_NORMAL_TIME);
+
+        return 0;
+}
+
+static int fwu_recovery_check_status(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned char data_base;
+        unsigned char status;
+
+        data_base = chip_info->fwu->f35_fd.data_base_addr;
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        data_base + F35_ERROR_CODE_OFFSET,
+                        1,
+                        &status);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read status\n", __func__);
+                return retval;
+        }
+
+        status = status & MASK_5BIT;
+
+        if (status != 0x00) {
+                TPD_INFO("%s: Recovery mode status = %d\n", __func__, status);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_scan_pdt(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned char ii;
+        unsigned char intr_count = 0;
+        unsigned char intr_off;
+        unsigned char intr_src;
+        unsigned short addr;
+        bool f01found = false;
+        bool f34found = false;
+        bool f35found = false;
+        struct synaptics_rmi4_fn_desc rmi_fd;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+        chip_info->fwu->in_ub_mode = false;        /*in_ub_mode declare*/
+        for (addr = PDT_START; addr > PDT_END; addr -= PDT_ENTRY_SIZE) {
+                retval = touch_i2c_read_block(chip_info->client, addr, sizeof(rmi_fd), (unsigned char *)&rmi_fd);
+                if (retval < 0) {
+                        return retval;
+                }
+
+                if (rmi_fd.fn_number) {
+                        TPD_DEBUG("%s: Found F%02x\n", __func__, rmi_fd.fn_number);
+                        switch (rmi_fd.fn_number) {
+                        case SYNAPTICS_RMI4_F01:        /*found*/
+                                f01found = true;
+
+                                rmi4_data->f01_query_base_addr =
+                                                rmi_fd.query_base_addr;
+                                rmi4_data->f01_ctrl_base_addr =
+                                                rmi_fd.ctrl_base_addr;
+                                rmi4_data->f01_data_base_addr =
+                                                rmi_fd.data_base_addr;
+                                rmi4_data->f01_cmd_base_addr =
+                                                rmi_fd.cmd_base_addr;
+                                break;
+                        case SYNAPTICS_RMI4_F34:        /*found*/
+                                f34found = true;
+                                chip_info->fwu->f34_fd.query_base_addr =
+                                                rmi_fd.query_base_addr;
+                                chip_info->fwu->f34_fd.ctrl_base_addr =
+                                                rmi_fd.ctrl_base_addr;
+                                chip_info->fwu->f34_fd.data_base_addr =
+                                                rmi_fd.data_base_addr;
+
+                                TPD_DEBUG("fn_version is %d\n", rmi_fd.fn_version);
+                                switch (rmi_fd.fn_version) {
+                                case F34_V0:
+                                        chip_info->fwu->bl_version = BL_V5;
+                                        break;
+                                case F34_V1:
+                                        chip_info->fwu->bl_version = BL_V6;
+                                        break;
+                                case F34_V2:
+                                        chip_info->fwu->bl_version = BL_V7;         /* why not direct set BL_V8*/
+                                        break;
+                                default:
+                                        TPD_INFO("%s: Unrecognized F34 version\n", __func__);
+                                        return -EINVAL;
+                                }
+
+                                chip_info->fwu->intr_mask = 0;
+                                intr_src = rmi_fd.intr_src_count;
+                                intr_off = intr_count % 8;
+                                for (ii = intr_off; ii < (intr_src + intr_off); ii++) {
+                                        chip_info->fwu->intr_mask |= 1 << ii;
+                                }
+                                break;
+                        }
+                } else {
+                        break;
+                }
+
+                intr_count += rmi_fd.intr_src_count;
+        }
+        if (!f01found || !f34found) {
+                TPD_INFO("%s: Failed to find both F01 and F34\n", __func__);
+                if (!f35found) {
+                        TPD_INFO("%s: Failed to find F35\n", __func__);
+                        return -EINVAL;
+                } else {
+                        chip_info->fwu->in_ub_mode = true;
+                        TPD_INFO("%s: In microbootloader mode\n",
+                                        __func__);
+                        fwu_recovery_check_status(chip_info);
+                        return 0;
+                }
+        }
+
+        rmi4_data->intr_mask[0] |= chip_info->fwu->intr_mask;           //Roland interrupts mode for write flash, like checkFlashState in 3508 notice
+
+        addr = rmi4_data->f01_ctrl_base_addr + 1;
+        retval = touch_i2c_write_block(chip_info->client,
+                        addr,
+                        sizeof(rmi4_data->intr_mask[0]),
+                        &(rmi4_data->intr_mask[0]));
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to set interrupt enable bit\n", __func__);
+                return retval;
+        }
+        return 0;
+}
+
+static int fwu_write_f34_v7_partition_id(struct chip_data_s3706 *chip_info, unsigned char cmd)
+{
+        int retval;
+        unsigned char data_base;
+        unsigned char partition;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        switch (cmd) {
+        case CMD_WRITE_FW:
+                partition = CORE_CODE_PARTITION;
+                break;
+        case CMD_WRITE_CONFIG:
+        case CMD_READ_CONFIG:
+                if (chip_info->fwu->config_area == UI_CONFIG_AREA) {
+                        partition = CORE_CONFIG_PARTITION;
+                }
+                else if (chip_info->fwu->config_area == DP_CONFIG_AREA) {
+                        partition = DISPLAY_CONFIG_PARTITION;
+                }
+                else if (chip_info->fwu->config_area == PM_CONFIG_AREA) {
+                        partition = GUEST_SERIALIZATION_PARTITION;
+                }
+                else if (chip_info->fwu->config_area == BL_CONFIG_AREA) {
+                        partition = GLOBAL_PARAMETERS_PARTITION;
+                }
+                else if (chip_info->fwu->config_area == FLASH_CONFIG_AREA) {
+                        partition = FLASH_CONFIG_PARTITION;
+                }
+                else if (chip_info->fwu->config_area == UPP_AREA) {
+                        partition = UTILITY_PARAMETER_PARTITION;
+                }
+                break;
+        case CMD_WRITE_LOCKDOWN:
+                partition = DEVICE_CONFIG_PARTITION;
+                break;
+        case CMD_WRITE_GUEST_CODE:
+                partition = GUEST_CODE_PARTITION;
+                break;
+        case CMD_WRITE_BOOTLOADER:
+                partition = BOOTLOADER_PARTITION;
+                break;
+        case CMD_WRITE_UTILITY_PARAM:
+                partition = UTILITY_PARAMETER_PARTITION;
+                break;
+        case CMD_ERASE_ALL:
+                partition = CORE_CODE_PARTITION;
+                break;
+        case CMD_ERASE_BL_CONFIG:
+                partition = GLOBAL_PARAMETERS_PARTITION;
+                break;
+        case CMD_ERASE_UI_CONFIG:
+                partition = CORE_CONFIG_PARTITION;
+                break;
+        case CMD_ERASE_DISP_CONFIG:
+                partition = DISPLAY_CONFIG_PARTITION;
+                break;
+        case CMD_ERASE_FLASH_CONFIG:
+                partition = FLASH_CONFIG_PARTITION;
+                break;
+        case CMD_ERASE_GUEST_CODE:
+                partition = GUEST_CODE_PARTITION;
+                break;
+        case CMD_ERASE_BOOTLOADER:
+                partition = BOOTLOADER_PARTITION;
+                break;
+        case CMD_ENABLE_FLASH_PROG:
+                partition = BOOTLOADER_PARTITION;
+                break;
+        default:
+                TPD_INFO("%s: Invalid command 0x%02x\n", __func__, cmd);
+                return -EINVAL;
+        }
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.partition_id,
+                        sizeof(partition),
+                        &partition);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write partition ID\n", __func__);
+                return retval;
+        }
+
+        return 0;
+}
+
+static int fwu_write_f34_partition_id(struct chip_data_s3706 *chip_info, unsigned char cmd)
+{
+        int retval = -1;
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                retval = fwu_write_f34_v7_partition_id(chip_info, cmd);
+        }
+
+        return retval;
+}
+
+static int fwu_read_flash_status(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned char status;
+        unsigned char command;
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        chip_info->fwu->f34_fd.data_base_addr + chip_info->fwu->off.flash_status,
+                        sizeof(status),
+                        &status);              //Roland get ic state , idle or other
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read flash status\n", __func__);
+                return retval;
+        }
+
+        chip_info->fwu->in_bl_mode = status >> 7;
+
+        /*fwu->bl_version is 8*/
+        if (chip_info->fwu->bl_version == BL_V5) {
+                chip_info->fwu->flash_status = (status >> 4) & MASK_3BIT;
+        } else if (chip_info->fwu->bl_version == BL_V6) {
+                chip_info->fwu->flash_status = status & MASK_3BIT;
+        } else if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                chip_info->fwu->flash_status = status & MASK_5BIT;
+        }
+
+        if (chip_info->fwu->write_bootloader) {
+                chip_info->fwu->flash_status = 0x00;
+        }
+
+        if (chip_info->fwu->flash_status != 0x00) {
+                TPD_INFO("%s: Flash status = %d, command = 0x%02x\n",
+                                __func__, chip_info->fwu->flash_status, chip_info->fwu->command);
+        }
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                if (chip_info->fwu->flash_status == 0x08) {
+                        chip_info->fwu->flash_status = 0x00;
+                }
+        }
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        chip_info->fwu->f34_fd.data_base_addr + chip_info->fwu->off.flash_cmd,
+                        sizeof(command),
+                        &command);      //Roland read recent command
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read flash command\n",
+                                __func__);
+                return retval;
+        }
+
+        if (chip_info->fwu->bl_version == BL_V5) {
+                chip_info->fwu->command = command & MASK_4BIT;
+        } else if (chip_info->fwu->bl_version == BL_V6) {
+                chip_info->fwu->command = command & MASK_6BIT;
+        } else if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                chip_info->fwu->command = command;
+        }
+
+        if (chip_info->fwu->write_bootloader) {
+                chip_info->fwu->command = 0x00;
+        }
+
+        return 0;
+}
+
+static int fwu_wait_for_idle(struct chip_data_s3706 *chip_info, int timeout_ms, bool poll)
+{
+        int count = 0;
+        int timeout_count = ((timeout_ms * 1000) / MAX_SLEEP_TIME_US) + 1;
+
+        do {
+                usleep_range(MIN_SLEEP_TIME_US, MAX_SLEEP_TIME_US);
+
+                count++;
+                if (poll || (count == timeout_count)) {
+                        fwu_read_flash_status(chip_info);
+                }
+
+                if ((chip_info->fwu->command == CMD_IDLE) && (chip_info->fwu->flash_status == 0x00)) {
+                        return 0;
+                }
+        } while (count < timeout_count);
+
+        TPD_INFO("%s: Timed out waiting for idle status\n", __func__);
+
+        return -ETIMEDOUT;
+}
+
+static int fwu_write_f34_v7_command_single_transaction(struct chip_data_s3706 *chip_info, unsigned char cmd)
+{
+        int retval;
+        unsigned char data_base;
+        struct f34_v7_data_1_5 data_1_5;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        memset(data_1_5.data, 0x00, sizeof(data_1_5.data));
+
+        switch (cmd) {
+        case CMD_ERASE_ALL:
+                data_1_5.partition_id = CORE_CODE_PARTITION;
+                data_1_5.command = CMD_V7_ERASE_AP;
+                break;
+        case CMD_ERASE_UI_FIRMWARE:
+                data_1_5.partition_id = CORE_CODE_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_BL_CONFIG:
+                data_1_5.partition_id = GLOBAL_PARAMETERS_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_UI_CONFIG:
+                data_1_5.partition_id = CORE_CONFIG_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_DISP_CONFIG:
+                data_1_5.partition_id = DISPLAY_CONFIG_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_FLASH_CONFIG:
+                data_1_5.partition_id = FLASH_CONFIG_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_GUEST_CODE:
+                data_1_5.partition_id = GUEST_CODE_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_BOOTLOADER:
+                data_1_5.partition_id = BOOTLOADER_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ERASE_UTILITY_PARAMETER:
+                data_1_5.partition_id = UTILITY_PARAMETER_PARTITION;
+                data_1_5.command = CMD_V7_ERASE;
+                break;
+        case CMD_ENABLE_FLASH_PROG:
+                data_1_5.partition_id = BOOTLOADER_PARTITION;
+                data_1_5.command = CMD_V7_ENTER_BL;
+                break;
+        }
+
+        data_1_5.payload_0 = chip_info->fwu->bootloader_id[0];
+        data_1_5.payload_1 = chip_info->fwu->bootloader_id[1];
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.partition_id,
+                        sizeof(data_1_5.data),
+                        data_1_5.data);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write single transaction command\n", __func__);
+                return retval;
+        }
+
+        return 0;
+}
+
+static int fwu_write_f34_v7_command(struct chip_data_s3706 *chip_info, unsigned char cmd)
+{
+        int retval;
+        unsigned char data_base;
+        unsigned char command;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        switch (cmd) {
+        case CMD_WRITE_FW:
+        case CMD_WRITE_CONFIG:
+        case CMD_WRITE_LOCKDOWN:
+        case CMD_WRITE_GUEST_CODE:
+        case CMD_WRITE_BOOTLOADER:
+        case CMD_WRITE_UTILITY_PARAM:
+                command = CMD_V7_WRITE;
+                break;
+        case CMD_READ_CONFIG:
+                command = CMD_V7_READ;
+                break;
+        case CMD_ERASE_ALL:
+                command = CMD_V7_ERASE_AP;
+                break;
+        case CMD_ERASE_UI_FIRMWARE:
+        case CMD_ERASE_BL_CONFIG:
+        case CMD_ERASE_UI_CONFIG:
+        case CMD_ERASE_DISP_CONFIG:
+        case CMD_ERASE_FLASH_CONFIG:
+        case CMD_ERASE_GUEST_CODE:
+        case CMD_ERASE_BOOTLOADER:
+        case CMD_ERASE_UTILITY_PARAMETER:
+                command = CMD_V7_ERASE;
+                break;
+        case CMD_ENABLE_FLASH_PROG:
+                command = CMD_V7_ENTER_BL;
+                break;
+        default:
+                TPD_INFO("%s: Invalid command 0x%02x\n", __func__, cmd);
+                return -EINVAL;
+        }
+
+        chip_info->fwu->command = command;
+
+        switch (cmd) {
+        case CMD_ERASE_ALL:
+        case CMD_ERASE_UI_FIRMWARE:
+        case CMD_ERASE_BL_CONFIG:
+        case CMD_ERASE_UI_CONFIG:
+        case CMD_ERASE_DISP_CONFIG:
+        case CMD_ERASE_FLASH_CONFIG:
+        case CMD_ERASE_GUEST_CODE:
+        case CMD_ERASE_BOOTLOADER:
+        case CMD_ERASE_UTILITY_PARAMETER:
+        case CMD_ENABLE_FLASH_PROG:
+                retval = fwu_write_f34_v7_command_single_transaction(chip_info, cmd);
+                if (retval < 0) {
+                        return retval;
+                } else {
+                        return 0;
+                }
+        default:
+                break;
+        }
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.flash_cmd,
+                        sizeof(command),
+                        &command);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write flash command\n", __func__);
+                return retval;
+        }
+
+        return 0;
+}
+
+static int fwu_write_f34_command(struct chip_data_s3706 *chip_info, unsigned char cmd)
+{
+        int retval = -1;
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                retval = fwu_write_f34_v7_command(chip_info, cmd);
+        }
+
+        return retval;
+}
+
+static int fwu_read_f34_v7_partition_table(struct chip_data_s3706 *chip_info, unsigned char *partition_table)
+{
+        int retval;
+        unsigned char data_base;
+        unsigned char length[2];
+        unsigned short block_number = 0;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        chip_info->fwu->config_area = FLASH_CONFIG_AREA;
+
+        retval = fwu_write_f34_partition_id(chip_info, CMD_READ_CONFIG);
+        if (retval < 0) {
+                return retval;
+        }
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.block_number,
+                        sizeof(block_number),
+                        (unsigned char *)&block_number);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write block number\n", __func__);
+                return retval;
+        }
+
+        length[0] = (unsigned char)(chip_info->fwu->flash_config_length & MASK_8BIT);
+        length[1] = (unsigned char)(chip_info->fwu->flash_config_length >> 8);
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.transfer_length,
+                        sizeof(length),
+                        length);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write transfer length\n", __func__);
+                return retval;
+        }
+
+        retval = fwu_write_f34_command(chip_info, CMD_READ_CONFIG);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write command\n", __func__);
+                return retval;
+        }
+
+        msleep(READ_CONFIG_WAIT_MS);
+
+        retval = fwu_wait_for_idle(chip_info, WRITE_WAIT_MS, true);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to wait for idle status\n", __func__);
+                return retval;
+        }
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        data_base + chip_info->fwu->off.payload,
+                        chip_info->fwu->partition_table_bytes,
+                        partition_table);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read block data\n", __func__);
+                return retval;
+        }
+
+        return 0;
+}
+
+static void fwu_parse_partition_table(struct chip_data_s3706 *chip_info, const unsigned char *partition_table,
+                struct block_count *blkcount, struct physical_address *phyaddr)
+{
+        unsigned char ii;
+        unsigned char index;
+        unsigned char offset;
+        unsigned short partition_length;
+        unsigned short physical_address;
+        struct partition_table *ptable = NULL;
+
+        for (ii = 0; ii < chip_info->fwu->partitions; ii++) {
+                index = ii * 8 + 2;
+                ptable = (struct partition_table *)&partition_table[index];
+                partition_length = ptable->partition_length_15_8 << 8 |
+                                ptable->partition_length_7_0;
+                physical_address = ptable->start_physical_address_15_8 << 8 |
+                                ptable->start_physical_address_7_0;
+                TPD_DEBUG("%s: Partition entry %d:\n", __func__, ii);
+                for (offset = 0; offset < 8; offset++) {
+                        TPD_DEBUG("%s: 0x%02x\n", __func__, partition_table[index + offset]);
+                }
+                switch (ptable->partition_id) {
+                case CORE_CODE_PARTITION:           /*ii = 4*/
+                        blkcount->ui_firmware = partition_length;
+                        phyaddr->ui_firmware = physical_address;
+                        TPD_DEBUG("%s: Core code block count: %d\n",
+                                        __func__, blkcount->ui_firmware);
+                        blkcount->total_count += partition_length;
+                        break;
+                case CORE_CONFIG_PARTITION:         /*ii = 5*/
+                        blkcount->ui_config = partition_length;
+                        phyaddr->ui_config = physical_address;
+                        TPD_DEBUG("%s: Core config block count: %d\n",
+                                        __func__, blkcount->ui_config);
+                        blkcount->total_count += partition_length;
+                        break;
+                case BOOTLOADER_PARTITION:          /*ii = 0*/
+                        blkcount->bl_image = partition_length;
+                        phyaddr->bl_image = physical_address;
+                        TPD_DEBUG("%s: Bootloader block count: %d\n",
+                                        __func__, blkcount->bl_image);
+                        blkcount->total_count += partition_length;
+                        break;
+                case UTILITY_PARAMETER_PARTITION:
+                        blkcount->utility_param = partition_length;
+                        phyaddr->utility_param = physical_address;
+                        TPD_DEBUG("%s: Utility parameter block count: %d\n",
+                                        __func__, blkcount->utility_param);
+                        blkcount->total_count += partition_length;
+                        break;
+                case DISPLAY_CONFIG_PARTITION:
+                        blkcount->dp_config = partition_length;
+                        phyaddr->dp_config = physical_address;
+                        TPD_DEBUG("%s: Display config block count: %d\n",
+                                        __func__, blkcount->dp_config);
+                        blkcount->total_count += partition_length;
+                        break;
+                case FLASH_CONFIG_PARTITION:                /*ii = 3*/
+                        blkcount->fl_config = partition_length;
+                        phyaddr->fl_config = physical_address;
+                        TPD_DEBUG("%s: Flash config block count: %d\n",
+                                        __func__, blkcount->fl_config);
+                        blkcount->total_count += partition_length;
+                        break;
+                case GUEST_CODE_PARTITION:
+                        blkcount->guest_code = partition_length;
+                        phyaddr->guest_code = physical_address;
+                        TPD_DEBUG("%s: Guest code block count: %d\n",
+                                        __func__, blkcount->guest_code);
+                        blkcount->total_count += partition_length;
+                        break;
+                case GUEST_SERIALIZATION_PARTITION:         /*ii = 6*/
+                        blkcount->pm_config = partition_length;
+                        phyaddr->pm_config = physical_address;
+                        TPD_DEBUG("%s: Guest serialization block count: %d\n",
+                                        __func__, blkcount->pm_config);
+                        blkcount->total_count += partition_length;
+                        break;
+                case GLOBAL_PARAMETERS_PARTITION:           /*ii = 2*/
+                        blkcount->bl_config = partition_length;
+                        phyaddr->bl_config = physical_address;
+                        TPD_DEBUG("%s: Global parameters block count: %d\n",
+                                        __func__, blkcount->bl_config);
+                        blkcount->total_count += partition_length;
+                        break;
+                case DEVICE_CONFIG_PARTITION:           /*ii = 1*/
+                        blkcount->lockdown = partition_length;
+                        phyaddr->lockdown = physical_address;
+                        TPD_DEBUG("%s: Device config block count: %d\n",
+                                        __func__, blkcount->lockdown);
+                        blkcount->total_count += partition_length;
+                        break;
+                }
+        }
+
+        return;
+}
+
+static int fwu_read_f34_v7_queries(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned char ii;
+        unsigned char query_base;
+        unsigned char index;
+        unsigned char offset;
+        unsigned char *ptable;
+        struct f34_v7_query_0 query_0;
+        struct f34_v7_query_1_7 query_1_7;
+
+        query_base = chip_info->fwu->f34_fd.query_base_addr;
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        query_base,
+                        sizeof(query_0.data),
+                        query_0.data);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read query 0\n", __func__);
+                return retval;
+        }
+
+        offset = query_0.subpacket_1_size + 1;
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        query_base + offset,
+                        sizeof(query_1_7.data),
+                        query_1_7.data);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read queries 1 to 7\n", __func__);
+                return retval;
+        }
+
+        chip_info->fwu->bootloader_id[0] = query_1_7.bl_minor_revision;
+        chip_info->fwu->bootloader_id[1] = query_1_7.bl_major_revision;
+
+        if (chip_info->fwu->bootloader_id[1] == BL_V8) {
+                chip_info->fwu->bl_version = BL_V8;
+        }
+
+        chip_info->fwu->block_size = query_1_7.block_size_15_8 << 8 |
+                        query_1_7.block_size_7_0;
+
+        chip_info->fwu->flash_config_length = query_1_7.flash_config_length_15_8 << 8 |
+                        query_1_7.flash_config_length_7_0;
+
+        chip_info->fwu->payload_length = query_1_7.payload_length_15_8 << 8 |
+                        query_1_7.payload_length_7_0;
+
+        chip_info->fwu->off.flash_status = V7_FLASH_STATUS_OFFSET;
+        chip_info->fwu->off.partition_id = V7_PARTITION_ID_OFFSET;
+        chip_info->fwu->off.block_number = V7_BLOCK_NUMBER_OFFSET;
+        chip_info->fwu->off.transfer_length = V7_TRANSFER_LENGTH_OFFSET;
+        chip_info->fwu->off.flash_cmd = V7_COMMAND_OFFSET;
+        chip_info->fwu->off.payload = V7_PAYLOAD_OFFSET;
+
+        index = sizeof(query_1_7.data) - V7_PARTITION_SUPPORT_BYTES;
+
+        chip_info->fwu->partitions = 0;
+        for (offset = 0; offset < V7_PARTITION_SUPPORT_BYTES; offset++) {       //Roland count partition nums
+                for (ii = 0; ii < 8; ii++) {
+                        if (query_1_7.data[index + offset] & (1 << ii)) {
+                                chip_info->fwu->partitions++;
+                        }
+                }
+
+                TPD_DEBUG("%s: Supported partitions: 0x%02x\n",
+                                __func__, query_1_7.data[index + offset]);
+        }
+
+        chip_info->fwu->partition_table_bytes = chip_info->fwu->partitions * 8 + 2;
+
+        ptable = kzalloc(chip_info->fwu->partition_table_bytes, GFP_KERNEL);
+        if (!ptable) {
+                TPD_INFO("%s: Failed to alloc mem for partition table\n", __func__);
+                return -ENOMEM;
+        }
+
+        retval = fwu_read_f34_v7_partition_table(chip_info, ptable);            //Roland--->partition table
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read partition table\n", __func__);
+                kfree(ptable);
+                return retval;
+        }
+
+        fwu_parse_partition_table(chip_info, ptable, &chip_info->fwu->blkcount, &chip_info->fwu->phyaddr);      //Roland firmware in IC condition
+
+        if (chip_info->fwu->blkcount.dp_config) {
+                chip_info->fwu->flash_properties.has_disp_config = 1;
+        } else {
+                chip_info->fwu->flash_properties.has_disp_config = 0;
+        }
+
+        if (chip_info->fwu->blkcount.pm_config) {
+                chip_info->fwu->flash_properties.has_pm_config = 1;
+        } else {
+                chip_info->fwu->flash_properties.has_pm_config = 0;
+        }
+
+        if (chip_info->fwu->blkcount.bl_config) {
+                chip_info->fwu->flash_properties.has_bl_config = 1;
+        } else {
+                chip_info->fwu->flash_properties.has_bl_config = 0;
+        }
+
+        if (chip_info->fwu->blkcount.guest_code) {
+                chip_info->fwu->has_guest_code = 1;
+        } else {
+                chip_info->fwu->has_guest_code = 0;
+        }
+
+        if (chip_info->fwu->blkcount.utility_param) {
+                chip_info->fwu->has_utility_param = 1;
+        } else {
+                chip_info->fwu->has_utility_param = 0;
+        }
+
+        kfree(ptable);
+
+        return 0;
+}
+
+static int fwu_read_f34_queries(struct chip_data_s3706 *chip_info)
+{
+        int retval = -1;
+
+        memset(&chip_info->fwu->blkcount, 0x00, sizeof(chip_info->fwu->blkcount));
+        memset(&chip_info->fwu->phyaddr, 0x00, sizeof(chip_info->fwu->phyaddr));
+
+        if (chip_info->fwu->bl_version == BL_V7) {
+                retval = fwu_read_f34_v7_queries(chip_info); /*enter*/
+        }
+
+        return retval;
+}
+
+static int fwu_get_device_config_id(struct chip_data_s3706 *chip_info)
+{
+        int retval = 0;
+        unsigned char config_id_size = 0;
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                config_id_size = V7_CONFIG_ID_SIZE;
+        }
+
+        retval = touch_i2c_read_block(chip_info->client,
+                                chip_info->fwu->f34_fd.ctrl_base_addr,
+                                config_id_size,
+                                chip_info->fwu->config_id);
+        if (retval < 0) {
+                return retval;
+        }
+
+        return 0;
+}
+
+static int synaptics_rmi4_fwu_init(struct chip_data_s3706 *chip_info, bool force)
+{
+        int retval;
+        struct pdt_properties pdt_props;
+        //unsigned char build_id[3] = {0};
+        unsigned char *build_id;
+	unsigned char *data;
+	data = (unsigned char *)kzalloc(1, GFP_KERNEL);
+	build_id = (unsigned char *)kzalloc(3, GFP_KERNEL);
+
+        if (!chip_info) {
+                TPD_INFO("chip_info is NULL, return!\n");
+		kfree(data);
+		kfree(build_id);
+                return -1;
+        }
+
+        if (chip_info->fwu) {
+                TPD_INFO("%s: Handle already exists\n", __func__);
+		kfree(build_id);
+		kfree(data);
+                return -1;
+        }
+
+        chip_info->fwu = kzalloc(sizeof(struct synaptics_rmi4_fwu_handle), GFP_KERNEL);
+        if (!chip_info->fwu) {
+                TPD_INFO("%s: Failed to alloc mem for fwu\n", __func__);
+                retval = -ENOMEM;
+                goto exit;
+        }
+        retval = touch_i2c_read_block(chip_info->client, PDT_PROPS, sizeof(pdt_props.data), data);
+
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read PDT properties, assuming 0x00\n", __func__);
+        } else if (pdt_props.has_bsr) {
+                TPD_INFO("%s: Reflash for LTS not currently supported\n", __func__);
+                retval = -ENODEV;
+                goto exit_free_mem;
+        }
+
+        chip_info->fwu->rmi4_data = kzalloc(sizeof(struct synaptics_rmi4_data), GFP_KERNEL);
+        if (!chip_info->fwu->rmi4_data) {
+                TPD_INFO("%s: Failed to alloc mem for fwu\n", __func__);
+                retval = -ENOMEM;
+                goto exit_free_rmi;
+        }
+
+        chip_info->fwu->rmi4_data->reset_device = s3706_reset_device;                /*no need*/
+        //Roland change in resume and suspend, notice if suspend hold mutex before the fw update queue work
+        chip_info->fwu->rmi4_data->sensor_sleep = 0;   /*don't enter sensor sleep or suspend while update*/
+        retval = fwu_scan_pdt(chip_info);
+        retval = touch_i2c_read_block(chip_info->client,
+                chip_info->fwu->rmi4_data->f01_query_base_addr + 18,
+                sizeof(build_id),
+                build_id);
+        if (retval < 0) {
+                goto exit_free_rmi;
+        }
+
+        chip_info->fwu->rmi4_data->firmware_id = (unsigned int)build_id[0] +
+                        (unsigned int)build_id[1] * 0x100 +
+                        (unsigned int)build_id[2] * 0x10000;
+
+        if (retval < 0) {
+                goto exit_free_mem;
+        }
+
+        if (!chip_info->fwu->in_ub_mode) {
+                retval = fwu_read_f34_queries(chip_info);
+                if (retval < 0) {
+                        goto exit_free_mem;
+                }
+                retval = fwu_get_device_config_id(chip_info);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to read device config ID\n", __func__);
+                        goto exit_free_mem;
+                }
+        }
+
+        chip_info->fwu->force_update = force;
+        chip_info->fwu->do_lockdown = DO_LOCKDOWN;
+	kfree(build_id);
+	kfree(data);
+        return 0;
+
+exit_free_rmi:
+        kfree(chip_info->fwu->rmi4_data);
+        chip_info->fwu->rmi4_data = NULL;
+
+exit_free_mem:
+        kfree(chip_info->fwu);
+        chip_info->fwu = NULL;
+exit:
+	kfree(data);
+	kfree(build_id);
+        return retval;
+}
+
+static unsigned int le_to_uint(const unsigned char *ptr)
+{
+        return (unsigned int)ptr[0] +
+                        (unsigned int)ptr[1] * 0x100 +
+                        (unsigned int)ptr[2] * 0x10000 +
+                        (unsigned int)ptr[3] * 0x1000000;
+}
+
+static void fwu_parse_image_header_10_bootloader(struct chip_data_s3706 *chip_info, const unsigned char *image)
+{
+        unsigned char ii;
+        unsigned char num_of_containers;
+        unsigned int addr;
+        unsigned int container_id;
+        unsigned int length;
+        const unsigned char *content;
+        struct container_descriptor *descriptor;
+
+        num_of_containers = (chip_info->fwu->img.bootloader.size - 4) / 4;
+
+        for (ii = 1; ii <= num_of_containers; ii++) {
+                addr = le_to_uint(chip_info->fwu->img.bootloader.data + (ii * 4));
+                descriptor = (struct container_descriptor *)(image + addr);
+                container_id = descriptor->container_id[0] |
+                                descriptor->container_id[1] << 8;
+                content = image + le_to_uint(descriptor->content_address);
+                length = le_to_uint(descriptor->content_length);
+                switch (container_id) {
+                case BL_IMAGE_CONTAINER:
+                        chip_info->fwu->img.bl_image.data = content;
+                        chip_info->fwu->img.bl_image.size = length;
+                        break;
+                case BL_CONFIG_CONTAINER:
+                case GLOBAL_PARAMETERS_CONTAINER:
+                        chip_info->fwu->img.bl_config.data = content;
+                        chip_info->fwu->img.bl_config.size = length;
+                        break;
+                case BL_LOCKDOWN_INFO_CONTAINER:
+                case DEVICE_CONFIG_CONTAINER:
+                        chip_info->fwu->img.lockdown.data = content;
+                        chip_info->fwu->img.lockdown.size = length;
+                        break;
+                default:
+                        break;
+                }
+        }
+
+        return;
+}
+
+static void fwu_parse_image_header_10_utility(struct chip_data_s3706 *chip_info, const unsigned char *image)
+{
+        unsigned char ii;
+        unsigned char num_of_containers;
+        unsigned int addr;
+        unsigned int container_id;
+        unsigned int length;
+        const unsigned char *content;
+        struct container_descriptor *descriptor;
+
+        num_of_containers = chip_info->fwu->img.utility.size / 4;
+
+        for (ii = 0; ii < num_of_containers; ii++) {
+                if (ii >= MAX_UTILITY_PARAMS) {
+                        continue;
+                }
+                addr = le_to_uint(chip_info->fwu->img.utility.data + (ii * 4));
+                descriptor = (struct container_descriptor *)(image + addr);
+                container_id = descriptor->container_id[0] |
+                                descriptor->container_id[1] << 8;
+                content = image + le_to_uint(descriptor->content_address);
+                length = le_to_uint(descriptor->content_length);
+                switch (container_id) {
+                case UTILITY_PARAMETER_CONTAINER:
+                        chip_info->fwu->img.utility_param[ii].data = content;
+                        chip_info->fwu->img.utility_param[ii].size = length;
+                        chip_info->fwu->img.utility_param_id[ii] = content[0];
+                        break;
+                default:
+                        break;
+                }
+        }
+
+        return;
+}
+
+
+static void fwu_parse_image_header_10(struct chip_data_s3706 *chip_info)
+{
+        unsigned char ii;
+        unsigned char num_of_containers;
+        unsigned int addr;
+        unsigned int offset;
+        unsigned int container_id;
+        unsigned int length;
+        const unsigned char *image;
+        const unsigned char *content;
+        struct container_descriptor *descriptor;
+        struct image_header_10 *header;
+
+        image = chip_info->fwu->image;
+        header = (struct image_header_10 *)image;
+
+        chip_info->fwu->img.checksum = le_to_uint(header->checksum);
+
+        /* address of top level container */
+        offset = le_to_uint(header->top_level_container_start_addr);
+        descriptor = (struct container_descriptor *)(image + offset);
+
+        /* address of top level container content */
+        offset = le_to_uint(descriptor->content_address);
+        num_of_containers = le_to_uint(descriptor->content_length) / 4;
+
+        for (ii = 0; ii < num_of_containers; ii++) {
+                addr = le_to_uint(image + offset);
+                offset += 4;
+                descriptor = (struct container_descriptor *)(image + addr);
+                container_id = descriptor->container_id[0] |
+                                descriptor->container_id[1] << 8;
+                content = image + le_to_uint(descriptor->content_address);
+                length = le_to_uint(descriptor->content_length);
+                switch (container_id) {
+                case UI_CONTAINER:
+                case CORE_CODE_CONTAINER:
+                        chip_info->fwu->img.ui_firmware.data = content;
+                        chip_info->fwu->img.ui_firmware.size = length;
+                        break;
+                case UI_CONFIG_CONTAINER:
+                case CORE_CONFIG_CONTAINER:
+                        chip_info->fwu->img.ui_config.data = content;
+                        chip_info->fwu->img.ui_config.size = length;
+                        break;
+                case BL_CONTAINER:
+                        chip_info->fwu->img.bl_version = *content;
+                        chip_info->fwu->img.bootloader.data = content;
+                        chip_info->fwu->img.bootloader.size = length;
+                        fwu_parse_image_header_10_bootloader(chip_info, image);
+                        break;
+                case UTILITY_CONTAINER:
+                        chip_info->fwu->img.utility.data = content;
+                        chip_info->fwu->img.utility.size = length;
+                        fwu_parse_image_header_10_utility(chip_info, image);
+                        break;
+                case GUEST_CODE_CONTAINER:
+                        chip_info->fwu->img.contains_guest_code = true;
+                        chip_info->fwu->img.guest_code.data = content;
+                        chip_info->fwu->img.guest_code.size = length;
+                        break;
+                case DISPLAY_CONFIG_CONTAINER:
+                        chip_info->fwu->img.contains_disp_config = true;
+                        chip_info->fwu->img.dp_config.data = content;
+                        chip_info->fwu->img.dp_config.size = length;
+                        break;
+                case PERMANENT_CONFIG_CONTAINER:
+                case GUEST_SERIALIZATION_CONTAINER:
+                        chip_info->fwu->img.contains_perm_config = true;
+                        chip_info->fwu->img.pm_config.data = content;
+                        chip_info->fwu->img.pm_config.size = length;
+                        break;
+                case FLASH_CONFIG_CONTAINER:
+                        chip_info->fwu->img.contains_flash_config = true;
+                        chip_info->fwu->img.fl_config.data = content;
+                        chip_info->fwu->img.fl_config.size = length;
+                        break;
+                case GENERAL_INFORMATION_CONTAINER:
+                        chip_info->fwu->img.contains_firmware_id = true;
+                        chip_info->fwu->img.firmware_id = le_to_uint(content + 4);
+                        break;
+                default:
+                        break;
+                }
+        }
+
+        return;
+}
+
+static void fwu_compare_partition_tables(struct chip_data_s3706 *chip_info)
+{
+        chip_info->fwu->incompatible_partition_tables = false;
+
+        if (chip_info->fwu->phyaddr.bl_image != chip_info->fwu->img.phyaddr.bl_image) {
+                chip_info->fwu->incompatible_partition_tables = true;
+        } else if (chip_info->fwu->phyaddr.lockdown != chip_info->fwu->img.phyaddr.lockdown) {
+                chip_info->fwu->incompatible_partition_tables = true;
+        } else if (chip_info->fwu->phyaddr.bl_config != chip_info->fwu->img.phyaddr.bl_config) {
+                chip_info->fwu->incompatible_partition_tables = true;
+        } else if (chip_info->fwu->phyaddr.utility_param != chip_info->fwu->img.phyaddr.utility_param) {
+                chip_info->fwu->incompatible_partition_tables = true;
+        }
+
+        if (chip_info->fwu->bl_version == BL_V7) {
+                if (chip_info->fwu->phyaddr.fl_config != chip_info->fwu->img.phyaddr.fl_config) {
+                        chip_info->fwu->incompatible_partition_tables = true;
+                }
+        }
+
+        chip_info->fwu->new_partition_table = false;
+
+        if (chip_info->fwu->phyaddr.ui_firmware != chip_info->fwu->img.phyaddr.ui_firmware) {
+                chip_info->fwu->new_partition_table = true;
+        } else if (chip_info->fwu->phyaddr.ui_config != chip_info->fwu->img.phyaddr.ui_config) {
+                chip_info->fwu->new_partition_table = true;
+        }
+
+        if (chip_info->fwu->flash_properties.has_disp_config) {
+                if (chip_info->fwu->phyaddr.dp_config != chip_info->fwu->img.phyaddr.dp_config) {
+                        chip_info->fwu->new_partition_table = true;
+                }
+        }
+
+        if (chip_info->fwu->has_guest_code) {
+                if (chip_info->fwu->phyaddr.guest_code != chip_info->fwu->img.phyaddr.guest_code) {
+                        chip_info->fwu->new_partition_table = true;
+                }
+        }
+
+        return;
+}
+
+static int fwu_parse_image_info(struct chip_data_s3706 *chip_info)
+{
+        struct image_header_10 *header;
+
+        header = (struct image_header_10 *)chip_info->fwu->image;
+
+        memset(&chip_info->fwu->img, 0x00, sizeof(chip_info->fwu->img));
+
+        switch (header->major_header_version) {         /*header->major_header_version is 0x10*/
+        case IMAGE_HEADER_VERSION_10:
+                fwu_parse_image_header_10(chip_info);
+                break;
+        default:
+                TPD_INFO("%s: Unsupported image file format (0x%02x)\n",
+                                __func__, header->major_header_version);
+                return -EINVAL;
+        }
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                if (!chip_info->fwu->img.contains_flash_config) {
+                        TPD_INFO("%s: No flash config found in firmware image\n",
+                                        __func__);
+                        return -EINVAL;
+                }
+
+                fwu_parse_partition_table(chip_info, chip_info->fwu->img.fl_config.data,
+                                &chip_info->fwu->img.blkcount, &chip_info->fwu->img.phyaddr);           //Roland firmware img in emmc
+
+                if (chip_info->fwu->img.blkcount.utility_param) {
+                        chip_info->fwu->img.contains_utility_param = true;
+                }
+
+                fwu_compare_partition_tables(chip_info);        //Roland compare two firmware img between ic and emmc, compare addr , if not equal, return or reflash partition
+        } else {
+                chip_info->fwu->new_partition_table = false;
+                chip_info->fwu->incompatible_partition_tables = false;
+        }
+
+        return 0;
+}
+
+static int fwu_get_image_firmware_id(struct chip_data_s3706 *chip_info, unsigned int *fw_id)
+{
+        int retval;
+        unsigned char index = 0;
+        char *strptr;
+        char *firmware_id;
+
+        if (chip_info->fwu->img.contains_firmware_id) {
+                *fw_id = chip_info->fwu->img.firmware_id;
+        } else {
+                strptr = strnstr(chip_info->fwu->image_name, "PR", MAX_IMAGE_NAME_LEN);
+                if (!strptr) {
+                        TPD_INFO("%s: No valid PR number (PRxxxxxxx) found in image file name (%s)\n",
+                                        __func__, chip_info->fwu->image_name);
+                        return -EINVAL;
+                }
+
+                strptr += 2;
+                firmware_id = kzalloc(MAX_FIRMWARE_ID_LEN, GFP_KERNEL);
+                if (!firmware_id) {
+                        TPD_INFO("%s: Failed to alloc mem for firmware_id\n",
+                                        __func__);
+                        return -ENOMEM;
+                }
+                while (strptr[index] >= '0' && strptr[index] <= '9') {
+                        firmware_id[index] = strptr[index];
+                        index++;
+                        if (index == MAX_FIRMWARE_ID_LEN - 1) {
+                                break;
+                        }
+                }
+
+                retval = SSTRTOUL(firmware_id, 10, (unsigned long *)fw_id);
+                kfree(firmware_id);
+                if (retval) {
+                        TPD_INFO("%s: Failed to obtain image firmware ID\n", __func__);
+                        return -EINVAL;
+                }
+        }
+
+        return 0;
+}
+
+static enum flash_area fwu_go_nogo(struct chip_data_s3706 *chip_info)
+{
+        int retval = 0;
+        enum flash_area flash_area = NONE;
+        unsigned char ii = 0;
+        unsigned char config_id_size = 0;
+        unsigned int device_fw_id = 0;
+        unsigned int image_fw_id = 0;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+        unsigned char tmp[3] = {0};
+        unsigned char config_id_img[100] = {0};
+        unsigned char config_id_panel[100] = {0};
+
+        if (chip_info->fwu->force_update) {
+                flash_area = UI_FIRMWARE;
+                goto exit;
+        }
+
+        /* Update both UI and config if device is in bootloader mode */
+        if (chip_info->fwu->bl_mode_device) {
+                flash_area = UI_FIRMWARE;
+                goto exit;
+        }
+
+        /* Get device firmware ID */
+        device_fw_id = rmi4_data->firmware_id;          /*this is firmware id and control whether to update*/
+        TPD_INFO("%s: Device firmware ID = %d\n", __func__, device_fw_id);
+
+        /* Get image firmware ID */
+        retval = fwu_get_image_firmware_id(chip_info, &image_fw_id);   /*the firmware id in the img, if not equal device firmware id , update*/
+        if (retval < 0) {
+                flash_area = NONE;
+                goto exit;
+        }
+        TPD_INFO("%s: Image firmware ID = %d device_fw_id = %d\n", __func__, image_fw_id, device_fw_id);
+
+        if (image_fw_id != device_fw_id) {
+                flash_area = UI_FIRMWARE;           /*UI_FIRMWARE means to update firmware and config, no need to judge config*/
+                goto exit;
+        }
+
+        /* Get device config ID */
+        retval = fwu_get_device_config_id(chip_info);        /*get config id*/
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read device config ID\n", __func__);
+                flash_area = NONE;
+                goto exit;
+        }
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                config_id_size = V7_CONFIG_ID_SIZE;
+        }
+
+        for (ii = 0; ii < config_id_size; ii++) {
+                sprintf(tmp, "%02x", (unsigned char)chip_info->fwu->img.ui_config.data[ii]);
+                memcpy(&config_id_img[ii * 2], tmp, 2);
+                sprintf(tmp, "%02x", (unsigned char)chip_info->fwu->config_id[ii]);
+                memcpy(&config_id_panel[ii * 2], tmp, 2);
+                if (chip_info->fwu->img.ui_config.data[ii] != chip_info->fwu->config_id[ii]) {
+                        flash_area = UI_CONFIG;
+                        goto exit;
+                }
+        }
+
+        flash_area = NONE;
+
+exit:
+        TPD_INFO("config_id_img is %s\n", config_id_img);
+        TPD_INFO("config_id_panel is %s\n", config_id_panel);
+        if (flash_area == NONE) {
+                TPD_INFO("%s: No need to do reflash\n", __func__);
+        } else {
+                TPD_INFO("%s: Updating %s\n", __func__,
+                                flash_area == UI_FIRMWARE ?
+                                "UI firmware and config" :
+                                "UI config only");
+        }
+
+        return flash_area;
+}
+
+static int fwu_enter_flash_prog(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        struct f01_device_control f01_device_control;
+
+        retval = fwu_read_flash_status(chip_info);
+        if (retval < 0) {
+                return retval;
+        }
+
+        if (chip_info->fwu->in_bl_mode) {
+                return 0;
+        }
+
+        msleep(INT_DISABLE_WAIT_MS);
+
+        retval = fwu_write_f34_command(chip_info, CMD_ENABLE_FLASH_PROG);       //Roland enter flash program mode
+        if (retval < 0) {
+                return retval;
+        }
+
+        retval = fwu_wait_for_idle(chip_info, ENABLE_WAIT_MS, false);   //Roland wait for complete
+        if (retval < 0) {
+                return retval;
+        }
+
+        if (!chip_info->fwu->in_bl_mode) {
+                TPD_INFO("%s: BL mode not entered\n", __func__);
+                return -EINVAL;
+        }
+
+        retval = fwu_scan_pdt(chip_info);       //Roland rescan in bootloader mode
+        if (retval < 0) {
+                return retval;
+        }
+
+        retval = fwu_read_f34_queries(chip_info);
+        if (retval < 0) {
+                return retval;
+        }
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        chip_info->fwu->rmi4_data->f01_ctrl_base_addr,
+                        sizeof(f01_device_control.data),
+                        f01_device_control.data);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read F01 device control\n", __func__);
+                return retval;
+        }
+
+        f01_device_control.nosleep = true;
+        f01_device_control.sleep_mode = SLEEP_MODE_NORMAL;
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        chip_info->fwu->rmi4_data->f01_ctrl_base_addr,
+                        sizeof(f01_device_control.data),
+                        f01_device_control.data);               //Roland set no sleep mode
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write F01 device control\n", __func__);
+                return retval;
+        }
+
+        msleep(ENTER_FLASH_PROG_WAIT_MS);
+
+        return retval;
+}
+
+static int fwu_write_f34_v7_blocks(struct chip_data_s3706 *chip_info, unsigned char *block_ptr,
+                unsigned short block_cnt, unsigned char command)
+{
+        int retval = -1;
+        unsigned char data_base;
+        unsigned char length[2];
+        unsigned short transfer;
+        unsigned short remaining = block_cnt;
+        unsigned short block_number = 0;
+        unsigned short left_bytes;
+        unsigned short write_size;
+        unsigned short max_write_size;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        retval = fwu_write_f34_partition_id(chip_info, command);
+        if (retval < 0) {
+                return retval;
+        }
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.block_number,
+                        sizeof(block_number),
+                        (unsigned char *)&block_number);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write block number\n", __func__);
+                return retval;
+        }
+
+        do {
+                if (remaining / chip_info->fwu->payload_length) {
+                        transfer = chip_info->fwu->payload_length;
+                } else {
+                        transfer = remaining;
+                }
+
+                length[0] = (unsigned char)(transfer & MASK_8BIT);
+                length[1] = (unsigned char)(transfer >> 8);
+
+                retval = touch_i2c_write_block(chip_info->client,
+                                data_base + chip_info->fwu->off.transfer_length,
+                                sizeof(length),
+                                length);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to write transfer length (remaining = %d)\n", __func__, remaining);
+                        return retval;
+                }
+
+                retval = fwu_write_f34_command(chip_info, command);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to write command (remaining = %d)\n", __func__, remaining);
+                        return retval;
+                }
+
+#ifdef MAX_WRITE_SIZE
+                max_write_size = MAX_WRITE_SIZE;
+                if (max_write_size >= transfer * chip_info->fwu->block_size) {
+                        max_write_size = transfer * chip_info->fwu->block_size;
+                } else if (max_write_size > chip_info->fwu->block_size) {
+                        max_write_size -= max_write_size % chip_info->fwu->block_size;
+                } else {
+                        max_write_size = chip_info->fwu->block_size;
+                }
+#else
+                max_write_size = transfer * chip_info->fwu->block_size;
+#endif
+                left_bytes = transfer * chip_info->fwu->block_size;
+
+                do {
+                        if (left_bytes / max_write_size) {
+                                write_size = max_write_size;
+                        } else {
+                                write_size = left_bytes;
+                        }
+
+                        retval = touch_i2c_write_block(chip_info->client,
+                                        data_base + chip_info->fwu->off.payload,
+                                        write_size,
+                                        block_ptr);
+                        if (retval < 0) {
+                                TPD_INFO("%s: Failed to write block data (remaining = %d)\n",
+                                                __func__, remaining);
+                                return retval;
+                        }
+
+                        block_ptr += write_size;
+                        left_bytes -= write_size;
+                } while (left_bytes);
+
+                retval = fwu_wait_for_idle(chip_info, WRITE_WAIT_MS, true);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to wait for idle status (remaining = %d)\n",
+                                        __func__, remaining);
+                        return retval;
+                }
+
+                remaining -= transfer;
+        } while (remaining);
+
+        return 0;
+}
+
+static int fwu_write_f34_blocks(struct chip_data_s3706 *chip_info, unsigned char *block_ptr,
+                unsigned short block_cnt, unsigned char cmd)
+{
+        int retval = 0;
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8) {
+                retval = fwu_write_f34_v7_blocks(chip_info, block_ptr, block_cnt, cmd);
+        } else {
+                //retval = fwu_write_f34_v5v6_blocks(chip_info, block_ptr, block_cnt, cmd);     Roland
+        }
+
+        return retval;
+}
+
+static int fwu_write_lockdown(struct chip_data_s3706 *chip_info)
+{
+        unsigned short lockdown_block_count;
+
+        lockdown_block_count = chip_info->fwu->img.lockdown.size / chip_info->fwu->block_size;
+
+        return fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->img.lockdown.data,
+                        lockdown_block_count, CMD_WRITE_LOCKDOWN);
+}
+
+static int fwu_do_lockdown_v7(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        struct f34_v7_data0 status;
+
+        retval = fwu_enter_flash_prog(chip_info);
+        if (retval < 0)
+                return retval;
+
+        retval = touch_i2c_read_block(chip_info->client,
+                        chip_info->fwu->f34_fd.data_base_addr + chip_info->fwu->off.flash_status,
+                        sizeof(status.data),
+                        status.data);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to read flash status\n", __func__);
+                return retval;
+        }
+
+        if (status.device_cfg_status == 2) {
+                TPD_INFO("%s: Device already locked down\n", __func__);
+                return 0;
+        }
+
+        retval = fwu_write_lockdown(chip_info);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Lockdown programmed\n", __func__);
+
+        return retval;
+}
+
+static int fwu_check_ui_configuration_size(struct chip_data_s3706 *chip_info)
+{
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->img.ui_config.size / chip_info->fwu->block_size;
+
+        if (block_count != chip_info->fwu->blkcount.ui_config) {
+                TPD_INFO("%s: UI configuration size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_erase_configuration(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+
+        switch (chip_info->fwu->config_area) {
+        case UI_CONFIG_AREA:
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_UI_CONFIG);
+                if (retval < 0)
+                        return retval;
+                break;
+        case DP_CONFIG_AREA:
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_DISP_CONFIG);
+                if (retval < 0)
+                        return retval;
+                break;
+        case BL_CONFIG_AREA:
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_BL_CONFIG);
+                if (retval < 0)
+                        return retval;
+                break;
+        case FLASH_CONFIG_AREA:
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_FLASH_CONFIG);
+                if (retval < 0)
+                        return retval;
+                break;
+        case UPP_AREA:
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_UTILITY_PARAMETER);
+                if (retval < 0)
+                        return retval;
+        default:
+                TPD_INFO("%s: Invalid config area\n", __func__);
+                return -EINVAL;
+        }
+
+        TPD_INFO("%s: Erase command written\n", __func__);
+
+        retval = fwu_wait_for_idle(chip_info, ERASE_WAIT_MS, false);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Idle status detected\n", __func__);
+
+        return retval;
+}
+
+static int fwu_write_configuration(struct chip_data_s3706 *chip_info)
+{
+        return fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->config_data,
+                        chip_info->fwu->config_block_count, CMD_WRITE_CONFIG);
+}
+
+static int fwu_write_ui_configuration(struct chip_data_s3706 *chip_info)
+{
+        chip_info->fwu->config_area = UI_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.ui_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.ui_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+
+        return fwu_write_configuration(chip_info);
+}
+
+static int fwu_check_ui_firmware_size(struct chip_data_s3706 *chip_info)
+{
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->img.ui_firmware.size / chip_info->fwu->block_size;
+
+        if (block_count != chip_info->fwu->blkcount.ui_firmware) {
+                TPD_INFO("%s: UI firmware size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_check_dp_configuration_size(struct chip_data_s3706 *chip_info)
+{
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->img.dp_config.size / chip_info->fwu->block_size;
+
+        if (block_count != chip_info->fwu->blkcount.dp_config) {
+                TPD_INFO("%s: Display configuration size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_check_guest_code_size(struct chip_data_s3706 *chip_info)
+{
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->img.guest_code.size / chip_info->fwu->block_size;
+        if (block_count != chip_info->fwu->blkcount.guest_code) {
+                TPD_INFO("%s: Guest code size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_check_bl_configuration_size(struct chip_data_s3706 *chip_info)
+{
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->img.bl_config.size / chip_info->fwu->block_size;
+
+        if (block_count != chip_info->fwu->blkcount.bl_config) {
+                TPD_INFO("%s: Bootloader configuration size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        return 0;
+}
+
+static int fwu_erase_guest_code(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+
+        retval = fwu_write_f34_command(chip_info, CMD_ERASE_GUEST_CODE);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Erase command written\n", __func__);
+
+        retval = fwu_wait_for_idle(chip_info, ERASE_WAIT_MS, false);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Idle status detected\n", __func__);
+
+        return 0;
+}
+
+static int fwu_erase_all(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+
+        if (chip_info->fwu->bl_version == BL_V7) {
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_UI_FIRMWARE);
+                if (retval < 0)
+                        return retval;
+
+                TPD_INFO("%s: Erase command written\n", __func__);
+
+                retval = fwu_wait_for_idle(chip_info, ERASE_WAIT_MS, false);
+                if (retval < 0)
+                        return retval;
+
+                TPD_INFO("%s: Idle status detected\n", __func__);
+
+                chip_info->fwu->config_area = UI_CONFIG_AREA;
+                retval = fwu_erase_configuration(chip_info);
+                if (retval < 0)
+                        return retval;
+        } else {
+                retval = fwu_write_f34_command(chip_info, CMD_ERASE_ALL);
+                if (retval < 0)
+                        return retval;
+
+                TPD_INFO("%s: Erase all command written\n", __func__);
+
+                retval = fwu_wait_for_idle(chip_info, ERASE_WAIT_MS, false);
+                if (!(chip_info->fwu->bl_version == BL_V8 &&
+                                chip_info->fwu->flash_status == BAD_PARTITION_TABLE)) {
+                        if (retval < 0)
+                                return retval;
+                }
+
+                TPD_INFO("%s: Idle status detected\n", __func__);
+
+                if (chip_info->fwu->bl_version == BL_V8)
+                        return 0;
+        }
+
+        if (chip_info->fwu->flash_properties.has_disp_config) {
+                chip_info->fwu->config_area = DP_CONFIG_AREA;
+                retval = fwu_erase_configuration(chip_info);
+                if (retval < 0)
+                        return retval;
+        }
+
+        if (chip_info->fwu->has_guest_code) {
+                retval = fwu_erase_guest_code(chip_info);
+                if (retval < 0)
+                        return retval;
+        }
+
+        return 0;
+}
+
+static int fwu_erase_bootloader(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+
+        retval = fwu_write_f34_command(chip_info, CMD_ERASE_BOOTLOADER);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Erase command written\n", __func__);
+
+        retval = fwu_wait_for_idle(chip_info, ERASE_WAIT_MS, false);
+        if (retval < 0)
+                return retval;
+
+        TPD_INFO("%s: Idle status detected\n", __func__);
+
+        return 0;
+}
+
+static int fwu_write_bootloader(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned short bootloader_block_count;
+
+        bootloader_block_count = chip_info->fwu->img.bl_image.size / chip_info->fwu->block_size;
+
+        chip_info->fwu->write_bootloader = true;
+        retval = fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->img.bl_image.data,
+                        bootloader_block_count, CMD_WRITE_BOOTLOADER);
+        chip_info->fwu->write_bootloader = false;
+
+        return retval;
+}
+
+static int fwu_allocate_read_config_buf(struct chip_data_s3706 *chip_info, unsigned int count)
+{
+        if (count > chip_info->fwu->read_config_buf_size) {
+                kfree(chip_info->fwu->read_config_buf);
+                chip_info->fwu->read_config_buf = kzalloc(count, GFP_KERNEL);
+                if (!chip_info->fwu->read_config_buf) {
+                        TPD_INFO("%s: Failed to alloc mem for fwu->read_config_buf\n",
+                                        __func__);
+                        chip_info->fwu->read_config_buf_size = 0;
+                        return -ENOMEM;
+                }
+                chip_info->fwu->read_config_buf_size = count;
+        }
+
+        return 0;
+}
+
+static void calculate_checksum(unsigned short *data, unsigned long len,
+                unsigned long *result)
+{
+        unsigned long temp;
+        unsigned long sum1 = 0xffff;
+        unsigned long sum2 = 0xffff;
+
+        *result = 0xffffffff;
+
+        while (len--) {
+                temp = *data;
+                sum1 += temp;
+                sum2 += sum1;
+                sum1 = (sum1 & 0xffff) + (sum1 >> 16);
+                sum2 = (sum2 & 0xffff) + (sum2 >> 16);
+                data++;
+        }
+
+        *result = sum2 << 16 | sum1;
+
+        return;
+}
+
+static void convert_to_little_endian(unsigned char *dest, unsigned long src)
+{
+        dest[0] = (unsigned char)(src & 0xff);
+        dest[1] = (unsigned char)((src >> 8) & 0xff);
+        dest[2] = (unsigned char)((src >> 16) & 0xff);
+        dest[3] = (unsigned char)((src >> 24) & 0xff);
+
+        return;
+}
+
+static int fwu_write_utility_parameter(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned char ii;
+        unsigned char checksum_array[4];
+        unsigned char *pbuf;
+        unsigned short remaining_size;
+        unsigned short utility_param_size;
+        unsigned long checksum;
+
+        utility_param_size = chip_info->fwu->blkcount.utility_param * chip_info->fwu->block_size;
+        retval = fwu_allocate_read_config_buf(chip_info, utility_param_size);
+        if (retval < 0)
+                return retval;
+        memset(chip_info->fwu->read_config_buf, 0x00, utility_param_size);
+
+        pbuf = chip_info->fwu->read_config_buf;
+        remaining_size = utility_param_size - 4;
+
+        for (ii = 0; ii < MAX_UTILITY_PARAMS; ii++) {
+                if (chip_info->fwu->img.utility_param_id[ii] == UNUSED)
+                        continue;
+
+#ifdef F51_DISCRETE_FORCE   /*no need*/
+                if (fwu->img.utility_param_id[ii] == FORCE_PARAMETER) {
+                        if (fwu->bl_mode_device) {
+                                dev_info_3706(rmi4_data->pdev->dev.parent,
+                                                "%s: Device in bootloader mode, skipping calibration data restoration\n",
+                                                __func__);
+                                goto image_param;
+                        }
+                        retval = secure_memcpy(&(pbuf[4]),
+                                        remaining_size - 4,
+                                        fwu->cal_data,
+                                        fwu->cal_data_buf_size,
+                                        fwu->cal_data_size);
+                        if (retval < 0) {
+                                dev_err_3706(rmi4_data->pdev->dev.parent,
+                                                "%s: Failed to copy force calibration data\n",
+                                                __func__);
+                                return retval;
+                        }
+                        pbuf[0] = FORCE_PARAMETER;
+                        pbuf[1] = 0x00;
+                        pbuf[2] = (4 + fwu->cal_data_size) / 2;
+                        pbuf += (fwu->cal_data_size + 4);
+                        remaining_size -= (fwu->cal_data_size + 4);
+                        continue;
+                }
+image_param:
+#endif
+
+                retval = secure_memcpy(pbuf,
+                                remaining_size,
+                                chip_info->fwu->img.utility_param[ii].data,
+                                chip_info->fwu->img.utility_param[ii].size,
+                                chip_info->fwu->img.utility_param[ii].size);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to copy utility parameter data\n", __func__);
+                        return retval;
+                }
+                pbuf += chip_info->fwu->img.utility_param[ii].size;
+                remaining_size -= chip_info->fwu->img.utility_param[ii].size;
+        }
+
+        calculate_checksum((unsigned short *)chip_info->fwu->read_config_buf,
+                        ((utility_param_size - 4) / 2),
+                        &checksum);
+
+        convert_to_little_endian(checksum_array, checksum);
+
+        chip_info->fwu->read_config_buf[utility_param_size - 4] = checksum_array[0];
+        chip_info->fwu->read_config_buf[utility_param_size - 3] = checksum_array[1];
+        chip_info->fwu->read_config_buf[utility_param_size - 2] = checksum_array[2];
+        chip_info->fwu->read_config_buf[utility_param_size - 1] = checksum_array[3];
+
+        retval = fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->read_config_buf,
+                        chip_info->fwu->blkcount.utility_param, CMD_WRITE_UTILITY_PARAM);
+        if (retval < 0)
+                return retval;
+
+        return 0;
+}
+
+static int fwu_write_bl_area_v7(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        bool has_utility_param;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+
+        has_utility_param = chip_info->fwu->has_utility_param;
+
+        if (chip_info->fwu->has_utility_param) {
+                chip_info->fwu->config_area = UPP_AREA;
+                retval = fwu_erase_configuration(chip_info);
+                if (retval < 0)
+                        return retval;
+        }
+
+        chip_info->fwu->config_area = BL_CONFIG_AREA;
+        retval = fwu_erase_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        chip_info->fwu->config_area = FLASH_CONFIG_AREA;
+        retval = fwu_erase_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_erase_bootloader(chip_info);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_write_bootloader(chip_info);
+        if (retval < 0)
+                return retval;
+
+        /*msleep(rmi4_data->hw_if->board_data->reset_delay_ms);*/
+        msleep(200);
+        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+
+        chip_info->fwu->config_area = FLASH_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.fl_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.fl_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+        retval = fwu_write_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+
+        chip_info->fwu->config_area = BL_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.bl_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.bl_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+        retval = fwu_write_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        if (chip_info->fwu->img.contains_utility_param) {
+                retval = fwu_write_utility_parameter(chip_info);
+                if (retval < 0)
+                        return retval;
+        }
+
+        return 0;
+}
+
+static int fwu_read_f34_v7_blocks(struct chip_data_s3706 *chip_info, unsigned short block_cnt,
+                unsigned char command)
+{
+        int retval;
+        unsigned char data_base;
+        unsigned char length[2];
+        unsigned short transfer;
+        unsigned short remaining = block_cnt;
+        unsigned short block_number = 0;
+        unsigned short index = 0;
+
+        data_base = chip_info->fwu->f34_fd.data_base_addr;
+
+        retval = fwu_write_f34_partition_id(chip_info, command);
+        if (retval < 0)
+                return retval;
+
+        retval = touch_i2c_write_block(chip_info->client,
+                        data_base + chip_info->fwu->off.block_number,
+                        sizeof(block_number),
+                        (unsigned char *)&block_number);
+        if (retval < 0) {
+                TPD_INFO("%s: Failed to write block number\n", __func__);
+                return retval;
+        }
+
+        do {
+                if (remaining / chip_info->fwu->payload_length)
+                        transfer = chip_info->fwu->payload_length;
+                else
+                        transfer = remaining;
+
+                length[0] = (unsigned char)(transfer & MASK_8BIT);
+                length[1] = (unsigned char)(transfer >> 8);
+
+                retval = touch_i2c_write_block(chip_info->client,
+                                data_base + chip_info->fwu->off.transfer_length,
+                                sizeof(length),
+                                length);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to write transfer length (remaining = %d)\n",
+                                        __func__, remaining);
+                        return retval;
+                }
+
+                retval = fwu_write_f34_command(chip_info, command);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to write command (remaining = %d)\n",
+                                        __func__, remaining);
+                        return retval;
+                }
+
+                retval = fwu_wait_for_idle(chip_info, WRITE_WAIT_MS, true);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to wait for idle status (remaining = %d)\n",
+                                        __func__, remaining);
+                        return retval;
+                }
+
+                retval = touch_i2c_read_block(chip_info->client,
+                                data_base + chip_info->fwu->off.payload,
+                                transfer * chip_info->fwu->block_size,
+                                &chip_info->fwu->read_config_buf[index]);
+                if (retval < 0) {
+                        TPD_INFO("%s: Failed to read block data (remaining = %d)\n",
+                                        __func__, remaining);
+                        return retval;
+                }
+
+                index += (transfer * chip_info->fwu->block_size);
+                remaining -= transfer;
+        } while (remaining);
+
+        return 0;
+}
+
+static int fwu_read_f34_blocks(struct chip_data_s3706 *chip_info, unsigned short block_cnt, unsigned char cmd)
+{
+        int retval = 0;
+
+        if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8)
+                retval = fwu_read_f34_v7_blocks(chip_info, block_cnt, cmd);
+        return retval;
+}
+
+static int fwu_write_flash_configuration(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+
+        chip_info->fwu->config_area = FLASH_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.fl_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.fl_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+
+        if (chip_info->fwu->config_block_count != chip_info->fwu->blkcount.fl_config) {
+                TPD_INFO("%s: Flash configuration size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        retval = fwu_erase_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_write_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+
+        return 0;
+}
+
+static int fwu_write_partition_table_v7(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned short block_count;
+
+        block_count = chip_info->fwu->blkcount.bl_config;
+        chip_info->fwu->config_area = BL_CONFIG_AREA;
+        chip_info->fwu->config_size = chip_info->fwu->block_size * block_count;
+
+        retval = fwu_allocate_read_config_buf(chip_info, chip_info->fwu->config_size);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_read_f34_blocks(chip_info, block_count, CMD_READ_CONFIG);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_erase_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        retval = fwu_write_flash_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        chip_info->fwu->config_area = BL_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->read_config_buf;
+        chip_info->fwu->config_size = chip_info->fwu->img.bl_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+
+        retval = fwu_write_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        return 0;
+}
+
+static int fwu_write_partition_table_v8(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+
+        chip_info->fwu->config_area = FLASH_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.fl_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.fl_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+
+        if (chip_info->fwu->config_block_count != chip_info->fwu->blkcount.fl_config) {
+                TPD_INFO("%s: Flash configuration size mismatch\n", __func__);
+                return -EINVAL;
+        }
+
+        retval = fwu_write_configuration(chip_info);
+        if (retval < 0)
+                return retval;
+
+        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+        retval = fwu_enter_flash_prog(chip_info);
+        TPD_INFO("%s: call re-enter flash_prog mode\n", __func__);
+        if (retval < 0) {
+                TPD_INFO("%s: re-enter flash_prog mode error\n", __func__);
+        }
+
+        return 0;
+}
+
+static int fwu_write_dp_configuration(struct chip_data_s3706 *chip_info)
+{
+        chip_info->fwu->config_area = DP_CONFIG_AREA;
+        chip_info->fwu->config_data = chip_info->fwu->img.dp_config.data;
+        chip_info->fwu->config_size = chip_info->fwu->img.dp_config.size;
+        chip_info->fwu->config_block_count = chip_info->fwu->config_size / chip_info->fwu->block_size;
+
+        return fwu_write_configuration(chip_info);
+}
+
+static int fwu_write_guest_code(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        unsigned short guest_code_block_count;
+
+        guest_code_block_count = chip_info->fwu->img.guest_code.size / chip_info->fwu->block_size;
+
+        retval = fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->img.guest_code.data,
+                        guest_code_block_count, CMD_WRITE_GUEST_CODE);
+        if (retval < 0)
+                return retval;
+
+        return 0;
+}
+
+static int fwu_write_firmware(struct chip_data_s3706 *chip_info)
+{
+        unsigned short firmware_block_count;
+
+        firmware_block_count = chip_info->fwu->img.ui_firmware.size / chip_info->fwu->block_size;
+
+        return fwu_write_f34_blocks(chip_info, (unsigned char *)chip_info->fwu->img.ui_firmware.data,
+                        firmware_block_count, CMD_WRITE_FW);
+}
+
+static int fwu_do_reflash(struct chip_data_s3706 *chip_info)
+{
+        int retval;
+        bool do_bl_update = false;
+
+        if (!chip_info->fwu->new_partition_table) {
+                retval = fwu_check_ui_firmware_size(chip_info); //Roland check firmware block nums , a block is 16bytes
+                if (retval < 0)
+                        return retval;
+
+                retval = fwu_check_ui_configuration_size(chip_info);
+                if (retval < 0)
+                        return retval;
+
+                if (chip_info->fwu->flash_properties.has_disp_config &&
+                                chip_info->fwu->img.contains_disp_config) {
+                        retval = fwu_check_dp_configuration_size(chip_info);    //Roland display
+                        if (retval < 0)
+                                return retval;
+                }
+
+                if (chip_info->fwu->has_guest_code && chip_info->fwu->img.contains_guest_code) {
+                        retval = fwu_check_guest_code_size(chip_info);
+                        if (retval < 0)
+                                return retval;
+                }
+        } else if (chip_info->fwu->bl_version == BL_V7) {
+                retval = fwu_check_bl_configuration_size(chip_info);    //Roland bootloader size
+                if (retval < 0)
+                        return retval;
+        }
+
+        if (!chip_info->fwu->has_utility_param && chip_info->fwu->img.contains_utility_param) {
+                if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8)
+                        do_bl_update = true;
+        }
+
+        if (chip_info->fwu->has_utility_param && !chip_info->fwu->img.contains_utility_param) {
+                if (chip_info->fwu->bl_version == BL_V7 || chip_info->fwu->bl_version == BL_V8)
+                        do_bl_update = true;
+        }
+
+        if (!do_bl_update && chip_info->fwu->incompatible_partition_tables) {
+                TPD_INFO("%s: Incompatible partition tables\n", __func__);
+                return -EINVAL;
+        } else if (!do_bl_update && chip_info->fwu->new_partition_table) {
+                if (!chip_info->fwu->force_update) {
+                        TPD_INFO("%s: Partition table mismatch\n", __func__);
+                        return -EINVAL;
+                }
+        }
+
+        retval = fwu_erase_all(chip_info);
+        if (retval < 0)
+                return retval;
+
+        if (do_bl_update) {
+                retval = fwu_write_bl_area_v7(chip_info);
+                if (retval < 0)
+                        return retval;
+                TPD_INFO("%s: Bootloader area programmed\n", __func__);
+        } else if (chip_info->fwu->bl_version == BL_V7 && chip_info->fwu->new_partition_table) {
+                retval = fwu_write_partition_table_v7(chip_info);       //Roland reflash partition table
+                if (retval < 0)
+                        return retval;
+                TPD_INFO("%s: Partition table programmed\n", __func__);
+        } else if (chip_info->fwu->bl_version == BL_V8) {
+                retval = fwu_write_partition_table_v8(chip_info);       //Roland partition table is earsed in fwu_erase_all, rewrite FLASH_CONFIG_AREA partition
+                if (retval < 0)
+                        return retval;
+                TPD_INFO("%s: Partition table programmed\n", __func__);
+        }
+
+        chip_info->fwu->config_area = UI_CONFIG_AREA;
+        if (chip_info->fwu->flash_properties.has_disp_config &&
+                        chip_info->fwu->img.contains_disp_config) {
+                retval = fwu_write_dp_configuration(chip_info);
+                if (retval < 0)
+                        return retval;
+                TPD_INFO("%s: Display configuration programmed\n", __func__);
+        }
+
+        retval = fwu_write_ui_configuration(chip_info);         //core configuration
+        if (retval < 0)
+                return retval;
+        TPD_INFO("%s: Configuration programmed\n", __func__);
+
+        if (chip_info->fwu->has_guest_code && chip_info->fwu->img.contains_guest_code) {
+                retval = fwu_write_guest_code(chip_info);
+                if (retval < 0)
+                        return retval;
+                TPD_INFO("%s: Guest code programmed\n", __func__);
+        }
+
+        retval = fwu_write_firmware(chip_info);         //core code
+        if (retval < 0)
+                return retval;
+        TPD_INFO("%s: Firmware programmed\n", __func__);
+
+        return retval;
+}
+
+static int fwu_start_reflash(struct chip_data_s3706 *chip_info)
+{
+        int retval = 0;
+        enum flash_area flash_area;
+        bool do_rebuild = false;
+        struct synaptics_rmi4_data *rmi4_data = chip_info->fwu->rmi4_data;
+
+        if (rmi4_data->sensor_sleep) {
+                TPD_INFO("%s: Sensor sleeping\n", __func__);
+                return -ENODEV;
+        }
+        rmi4_data->stay_awake = true;   /*no need*/
+        TPD_INFO("%s: Start of reflash process\n", __func__);
+
+        retval = fwu_parse_image_info(chip_info);
+        if (retval < 0)
+                goto exit;
+
+        if (chip_info->fwu->blkcount.total_count != chip_info->fwu->img.blkcount.total_count) {
+                TPD_INFO("%s: Flash size mismatch\n", __func__);
+                retval = -EINVAL;
+                goto exit;
+        }
+
+        if (chip_info->fwu->bl_version != chip_info->fwu->img.bl_version) {
+                TPD_INFO("%s: Bootloader version mismatch\n", __func__);
+                retval = -EINVAL;
+                goto exit;
+        }
+
+        retval = fwu_read_flash_status(chip_info);
+        if (retval < 0)
+                goto exit;
+
+        if (chip_info->fwu->in_bl_mode) {
+                chip_info->fwu->bl_mode_device = true;
+                TPD_INFO("%s: Device in bootloader mode\n", __func__);
+        } else {
+                chip_info->fwu->bl_mode_device = false;
+        }
+
+        flash_area = fwu_go_nogo(chip_info);         /*judge whether to update*/
+
+        if (flash_area != NONE) {
+                retval = fwu_enter_flash_prog(chip_info);   /*lots of info, large function*///enter bootloader mode
+                if (retval < 0) {
+                        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+                        goto exit;
+                }
+        }
+
+        switch (flash_area) {
+        case UI_FIRMWARE:
+                do_rebuild = true;
+                retval = fwu_do_reflash(chip_info);
+                break;
+        case UI_CONFIG:
+                do_rebuild = true;
+                retval = fwu_check_ui_configuration_size(chip_info);
+                if (retval < 0)
+                        break;
+                chip_info->fwu->config_area = UI_CONFIG_AREA;   /*fwu_erase_configuration should set config_area first*/
+                retval = fwu_erase_configuration(chip_info);
+                if (retval < 0)
+                        break;
+                retval = fwu_write_ui_configuration(chip_info);
+                break;
+        case NONE:
+        default:
+                break;
+        }
+
+        if (chip_info->fwu->do_lockdown && (chip_info->fwu->img.lockdown.data != NULL)) {         //Roland lockdown mode , only can write once, use for save i2c addr, pull up, pull down info
+                TPD_INFO("Enter lockdown notice!!!!!!!!!!!!!!\n");
+                switch (chip_info->fwu->bl_version) {
+                case BL_V7:
+                case BL_V8:
+                        retval = fwu_do_lockdown_v7(chip_info);
+                        if (retval < 0) {
+                                TPD_INFO("%s: Failed to do lockdown\n", __func__);
+                        }
+                        chip_info->fwu->rmi4_data->reset_device(rmi4_data, false);
+                        break;
+                default:
+                        break;
+                }
+        }
+
+exit:
+        if (do_rebuild)
+                chip_info->fwu->rmi4_data->reset_device(rmi4_data, true);
+        TPD_INFO("%s: End of reflash process\n", __func__);
+        rmi4_data->stay_awake = false;  /*no need*/
+
+        return retval;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+        int retval = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        /*firmware update init*/
+        retval = synaptics_rmi4_fwu_init(chip_info, force);
+        if (retval < 0) {        /*less zero means the space has been released in synaptics_rmi4_fwu_init*/
+                goto no_need_release_mem;
+        }
+
+        /*start reflash*/
+        chip_info->fwu->image = fw->data;
+        retval = fwu_start_reflash(chip_info);
+        if (retval < 0) {
+                TPD_INFO("fwu_start_reflash failed!\n");
+        } else {
+                TPD_INFO("firmwre update successed!\n");
+        }
+
+        kfree(chip_info->fwu->rmi4_data);
+        chip_info->fwu->rmi4_data = NULL;
+        kfree(chip_info->fwu);
+        chip_info->fwu = NULL;
+        return (retval < 0) ? FW_NO_NEED_UPDATE : FW_UPDATE_SUCCESS;
+
+no_need_release_mem:
+        return FW_NO_NEED_UPDATE;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+        int x = 0, y = 0, z = 0, err_count = 0;
+        int ret = 0, TX_NUM = 0, RX_NUM = 0;
+        int16_t temp_data = 0, delta_data = 0;
+        uint8_t *raw_data = NULL;
+        fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+        TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+        if (TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+                TPD_INFO("%s, TX_NUM*RX_NUM*(sizeof(int16_t)>1800, There is not enough space\n", __func__);
+                return FINGER_PROTECT_NOTREADY;
+        }
+
+        if (!chip_info->spuri_fp_data) {
+                TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+                return fp_touch_state;
+        }
+        TX_NUM = chip_info->hw_res->TX_NUM;
+        RX_NUM = chip_info->hw_res->RX_NUM;
+
+        raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+                        TPD_INFO("raw_data kzalloc error\n");
+                        return fp_touch_state;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        if (ret < 0) {
+                TPD_INFO("%s, I2C transfer error\n", __func__);
+                goto OUT;
+        }
+
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+        ret = (ret & 0xF8) | 0x80;
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, ret);   /*exit sleep*/
+        msleep(5);
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);/*select report type 124*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);/*set LSB*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);/*set MSB*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+
+        ret = checkCMD_for_finger(chip_info);
+        if (ret < 0) {
+                fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+                goto OUT;
+        }
+
+        fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+        touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data); /*read baseline data*/
+        for (x = 1; x < TX_NUM - 2; x++) {
+                TPD_DEBUG_NTAG("[%2d]: ", x);
+                for (y = 0; y < (SPURIOUS_FP_RX_NUM - 3); y++) {
+                        z = SPURIOUS_FP_RX_NUM * x + y;
+                        temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                        delta_data = temp_data - chip_info->spuri_fp_data[z];
+                        TPD_DEBUG_NTAG("%4d, ", delta_data);
+                        if ((delta_data + SPURIOUS_FP_LIMIT) < 0) {
+                                if (!tp_debug)
+                                        TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                                err_count++;
+                        }
+                }
+                TPD_DEBUG_NTAG("\n");
+                if (err_count > 2) {
+                        fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+                        err_count = 0;
+                        if (!tp_debug)
+                                break;
+                }
+        }
+
+        TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n", __func__, __LINE__, chip_info->reg_info.F54_ANALOG_COMMAND_BASE); /*add for Prevent TP failure*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        if (ret < 0) {
+                TPD_INFO("%s, I2C transfer error, line=%d\n", __func__, __LINE__);
+        }
+
+        TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+OUT:
+        kfree(raw_data);
+        return fp_touch_state;
+}
+
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+        int ret = 0;
+        u8 bitmap_result = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x02);
+        ret = touch_i2c_read_byte(chip_info->client, 0x00);
+        TPD_INFO("touch key int_key code = %d\n", ret);
+
+        if (ret & 0x01)
+                SET_BIT(bitmap_result, BIT_MENU);
+        if (ret & 0x02)
+                SET_BIT(bitmap_result, BIT_BACK);
+
+        touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+        return bitmap_result;
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+        int ret = 0, x = 0, y = 0, z = 0;
+        uint8_t *raw_data = NULL;
+        static uint8_t retry_time = 3;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        int TX_NUM = chip_info->hw_res->TX_NUM;
+        int RX_NUM = chip_info->hw_res->RX_NUM;
+
+        if (TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+                TPD_INFO("%s, TX_NUM*RX_NUM*(sizeof(int16_t)>1800, There is not enough space\n", __func__);
+                return;
+        }
+
+        raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+        if (!raw_data) {
+                        TPD_INFO("raw_data kzalloc error\n");
+                        return;
+        }
+
+        chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+        if (!chip_info->spuri_fp_data) {
+                TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+                ret = -ENOMEM;
+                kfree(raw_data);
+                raw_data = NULL;
+                return;
+        }
+
+RE_TRY:
+        TPD_INFO("%s retry_time=%d line=%d\n", __func__, retry_time, __LINE__);
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+        if (ret < 0) {
+                TPD_INFO("%s, I2C transfer error\n", __func__);
+                kfree(raw_data);
+                raw_data = NULL;
+                return;
+        }
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); /*forcecal*/
+        ret = checkCMD_for_finger(chip_info);
+        if (ret < 0) {
+                if (retry_time) {
+                        TPD_INFO("checkCMD_for_finger error line=%d\n", __LINE__);
+                        retry_time--;
+                        goto RE_TRY;
+                }
+        }
+
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);/*select report type 0x02*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);/*set LSB*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);/*set MSB*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+
+        ret = checkCMD_for_finger(chip_info);
+        if (ret < 0) {
+                if (retry_time) {
+                        TPD_INFO("checkCMD_for_finger error line=%d\n", __LINE__);
+                        retry_time--;
+                        goto RE_TRY;
+                }
+        }
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, TX_NUM*SPURIOUS_FP_RX_NUM*2, raw_data);         /*read data*/
+        if (ret < 0) {
+                if (retry_time) {
+                        TPD_INFO("%s touch_i2c_read_block error\n", __func__);
+                        retry_time--;
+                        goto RE_TRY;
+                }
+        }
+
+        for (x = 0; x < TX_NUM; x++) {
+                printk("[%2d]: ", x);
+                for (y = 0; y < SPURIOUS_FP_RX_NUM; y++) {
+                        z = SPURIOUS_FP_RX_NUM*x + y;
+                        chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+                        printk("%5d, ", chip_info->spuri_fp_data[z]);
+                }
+                printk("\n");
+        }
+
+        TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n", __func__, chip_info->reg_info.F54_ANALOG_COMMAND_BASE); /*add for Prevent TP failure*/
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   /* page 0*/
+        if (ret < 0) {
+                TPD_INFO("%s, I2C transfer error\n", __func__);
+        }
+
+        kfree(raw_data);
+}
+
+static void synaptics_data_logger_get(void * chip_data)
+{
+        int ret = 0, i = 0;
+        int data_length = 0;
+        uint8_t *log_data = kzalloc(255 * (sizeof(uint8_t)), GFP_KERNEL);
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        if (true == chip_info->d_log.data_logger_control) {
+                ret = touch_i2c_write_byte(chip_info->client, 0xff, (uint8_t)(chip_info->d_log.loglength_addr >> 8));        /* page 4*/
+                data_length = touch_i2c_read_byte(chip_info->client, (uint8_t)(chip_info->d_log.loglength_addr & 0xFF));
+                if (data_length < 1 || data_length > 255) {
+			kfree(log_data);
+                        return;
+                } else {
+                        ret = touch_i2c_read_block(chip_info->client, ((uint8_t)(chip_info->d_log.loglength_addr & 0xFF) + 1), data_length, log_data);         /*read log*/
+                        TPD_INFO("data_length = %d, ", data_length);
+                        for (i = 0; i< data_length; i++) {
+                                printk(" [0x%x], ", log_data[i]);
+                        }
+                        TPD_INFO("\n");
+                }
+
+                ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);        /* page 0*/
+        }
+		kfree(log_data);
+}
+
+static void synaptics_data_logger_open(void * chip_data)
+{
+        int ret = 0;
+        uint8_t l_tmp = 0, h_tmp = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        /*Get status of IC log*/
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);        /* page 4*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x04);
+        TPD_INFO("F51_CUSTOM_QUERY05 is %d\n", ret);
+        if (1 == ret) {
+                chip_info->d_log.data_logger_control = true;
+                l_tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x05);
+                h_tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_QUERY_BASE + 0x06);
+                chip_info->d_log.loglength_addr = (h_tmp << 8) | l_tmp;
+                chip_info->d_log.loginfo_addr = chip_info->d_log.loglength_addr + 1;
+                TPD_INFO("l_tmp = 0x%x h_tmp = 0x%x chip_info->d_log.loglength_addr = 0x%x chip_info->d_log.loginfo_addr = 0x%x\n", l_tmp, h_tmp, chip_info->d_log.loglength_addr, chip_info->d_log.loginfo_addr);
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /* page 0*/
+}
+
+static void synaptics_register_info_read(void * chip_data, uint16_t register_addr, uint8_t * result, uint8_t length)
+{
+        int ret = 0;
+        uint8_t l_tmp = 0, h_tmp = 0;
+        struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+        l_tmp = register_addr & 0xFF;   /*address*/
+        h_tmp = register_addr >> 8;         /*page*/
+
+        if (h_tmp > 4) {
+                TPD_INFO("register_addr error!\n");
+                return;
+        }
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, h_tmp);        /*set page*/
+        ret = touch_i2c_read_block(chip_info->client, l_tmp, length, result);         /*read data*/
+}
+
+static int synaptics_get_usb_state(void)
+{
+        return 0;
+}
+
+static int synaptics_get_face_state(void * chip_data)
+{
+    int state = -1;
+    struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)chip_data;
+
+	TPD_INFO("%s\n", __func__);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x04);        /*set page*/
+	state = touch_i2c_read_byte(chip_info->client,
+		chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x01);
+	TPD_INFO("state is %d\n", state);
+	if (state == 128)
+		state = 0;
+	else
+		state = 1;
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);        /*set page*/
+
+    return state;
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+        .get_vendor                 = synaptics_get_vendor,
+        .get_chip_info              = synaptics_get_chip_info,
+        .reset                      = synaptics_reset,
+        .power_control              = synaptics_power_control,
+        .fw_check                   = synaptics_fw_check,
+        .fw_update                  = synaptics_fw_update,
+        .trigger_reason             = synaptics_trigger_reason,
+        .get_touch_points           = synaptics_get_touch_points,
+        .get_gesture_info           = synaptics_get_gesture_info,
+        .mode_switch                = synaptics_mode_switch,
+        .get_keycode                = synaptics_get_keycode,
+        .spurious_fp_check          = synaptics_spurious_fp_check,
+        .finger_proctect_data_get   = synaptics_finger_proctect_data_get,
+        .data_logger_get            = synaptics_data_logger_get,
+        .data_logger_open           = synaptics_data_logger_open,
+        .register_info_read         = synaptics_register_info_read,
+        .get_usb_state              = synaptics_get_usb_state,
+        .get_face_state             = synaptics_get_face_state,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+        .auto_test         = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+        .limit_read        = synaptics_limit_read,
+        .delta_read        = synaptics_delta_read,
+        .baseline_read = synaptics_baseline_read,
+        .reserve_read  = synaptics_reserve_read,
+        .RT251                 = synaptics_RT251_read,
+        .RT76                  = synaptics_RT76_read,
+        .main_register_read = synaptics_main_register_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+        struct remotepanel_data *premote_data = NULL;
+#endif
+
+        struct chip_data_s3706 *chip_info;
+        struct touchpanel_data *ts = NULL;
+        int ret = -1;
+
+        TPD_INFO("%s  is called\n", __func__);
+
+        if (tp_register_times > 0) {
+                TPD_INFO("TP driver have success loaded %d times, exit\n", tp_register_times);
+                return -1;
+        }
+
+        /*step1:Alloc chip_info*/
+        chip_info = kzalloc(sizeof(struct chip_data_s3706), GFP_KERNEL);
+        if (chip_info == NULL) {
+                TPD_INFO("chip info kzalloc error\n");
+                ret = -ENOMEM;
+                return ret;
+        }
+        memset(chip_info, 0, sizeof(*chip_info));
+        g_chip_info = chip_info;
+
+        /*step2:Alloc common ts*/
+        ts = common_touch_data_alloc();
+        if (ts == NULL) {
+                TPD_INFO("ts kzalloc error\n");
+                goto ts_malloc_failed;
+        }
+        memset(ts, 0, sizeof(*ts));
+
+        /*step3:binding client && dev for easy operate*/
+        chip_info->client = client;
+        chip_info->syna_ops = &synaptics_proc_ops;
+        ts->debug_info_ops = &debug_info_proc_ops;
+        ts->client = client;
+        ts->irq = client->irq;
+        i2c_set_clientdata(client, ts);
+        ts->dev = &client->dev;
+        ts->chip_data = chip_info;
+        chip_info->hw_res = &ts->hw_res;
+
+        /*step4:file_operations callback binding*/
+        ts->ts_ops = &synaptics_ops;
+
+        /*step5:register common touch*/
+        ret = register_common_touch_device(ts);
+        if (ret < 0) {
+                goto err_register_driver;
+        }
+
+        /*step6: collect data for supurious_fp_touch*/
+        if (ts->spurious_fp_support) {
+                mutex_lock(&ts->mutex);
+                synaptics_finger_proctect_data_get(chip_info);
+                mutex_unlock(&ts->mutex);
+        }
+
+        /*step7: get data logger open status*/
+        mutex_lock(&ts->mutex);
+        synaptics_data_logger_open(chip_info);
+        mutex_unlock(&ts->mutex);
+
+        /*step8:create synaptics related proc files*/
+        synaptics_create_proc(ts, chip_info->syna_ops);
+
+        /*step9:Chip Related function*/
+#ifdef CONFIG_SYNAPTIC_RED
+        premote_data = remote_alloc_panel_data();
+        chip_info->premote_data = premote_data;
+        if (premote_data) {
+                premote_data->client                = client;
+                premote_data->input_dev         = ts->input_dev;
+                premote_data->pmutex                = &ts->mutex;
+                premote_data->irq_gpio          = ts->hw_res.irq_gpio;
+                premote_data->irq                   = client->irq;
+                premote_data->enable_remote = &(chip_info->enable_remote);
+                register_remote_device(premote_data);
+        }
+#endif
+
+        TPD_INFO("%s, probe normal end\n", __func__);
+
+        return 0;
+
+err_register_driver:
+        common_touch_data_free(ts);
+        ts = NULL;
+
+ts_malloc_failed:
+        kfree(chip_info);
+        chip_info = NULL;
+        ret = -1;
+
+        TPD_INFO("%s, probe error\n", __func__);
+
+        return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+        struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+        TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+        unregister_remote_device();
+#endif
+        kfree(ts);
+
+        return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+        struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+        TPD_INFO("%s: is called\n", __func__);
+        tp_i2c_suspend(ts);
+
+        return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+        struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+        TPD_INFO("%s is called\n", __func__);
+        tp_i2c_resume(ts);
+
+        return 0;
+}
+
+static void synaptics_tp_shutdown(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+//	struct chip_data_s3706 *chip_info = (struct chip_data_s3706 *)ts->chip_data;
+
+	int ret = 0;
+
+    TPD_INFO("%s is called\n", __func__);
+	if (!ts->ts_ops->power_control) {
+		ret = -EINVAL;
+		TPD_INFO("tp power_control NULL!\n");
+		return;
+    }
+//     ret = synaptics_resetgpio_set(chip_info->hw_res, false); /* reset gpio*/
+    if(ret < 0)
+		TPD_INFO("reset fail\n");
+
+    ret = ts->ts_ops->power_control(ts->chip_data, false);
+}
+
+static const struct i2c_device_id tp_id[] = {
+        { TPD_DEVICE, 0 },
+        { }
+};
+
+static struct of_device_id tp_match_table[] = {
+        { .compatible = TPD_DEVICE, },
+        { },
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+        .suspend = synaptics_i2c_suspend,
+        .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+        .probe          = synaptics_tp_probe,
+        .remove         = synaptics_tp_remove,
+        .shutdown       = synaptics_tp_shutdown,
+        .id_table   = tp_id,
+        .driver         = {
+                .name   = TPD_DEVICE,
+                .of_match_table =  tp_match_table,
+                .pm = &tp_pm_ops,
+        },
+};
+
+static int __init tp_driver_init(void)
+{
+        TPD_INFO("%s is called\n", __func__);
+        if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+                TPD_INFO("unable to add i2c driver.\n");
+                return -1;
+        }
+        return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+        i2c_del_driver(&tp_i2c_driver);
+        return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706.h
new file mode 100644
index 0000000000000000000000000000000000000000..9c86091503b53c229c32651f2fe7437367ade85b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706.h
@@ -0,0 +1,925 @@
+/***************************************************
+ * File:synaptics_drivers_s3508.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *                         synaptics s3508 driver
+ * Version:1.0:
+ * Date : 2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SYNAPTICS_H_S3508
+#define SYNAPTICS_H_S3508
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+#include <linux/version.h>
+
+#include "../synaptics_common.h"
+#ifdef CONFIG_SYNAPTIC_RED
+#include "../synaptics_touch_panel_remote.h"
+#endif
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE          0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE        0x02
+#define ENABLE_DTAP         0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT          0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT        0x07
+#define DTAP_DETECT         0x03
+#define TOUCHHOLD_DOWN		0x0f
+#define TOUCHHOLD_UP		0x1f
+#define SINGLE_TAP			0x10
+
+#define RESET_TO_NORMAL_TIME 80        /*Sleep time after reset*/
+#define POWEWRUP_TO_RESET_TIME 10
+
+
+#define SPURIOUS_FP_LIMIT 60
+#define SPURIOUS_FP_RX_NUM 9
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+/*firmware update bootloader V7V8*/
+#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 38))
+#define KERNEL_ABOVE_2_6_38
+#endif
+
+#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 0))
+#define KERNEL_ABOVE_3_6
+#endif
+
+#ifdef KERNEL_ABOVE_2_6_38
+#define SSTRTOUL(...) kstrtoul(__VA_ARGS__)
+#else
+#define SSTRTOUL(...) strict_strtoul(__VA_ARGS__)
+#endif
+
+#define PDT_PROPS (0X00EF)
+#define PDT_START (0x00E9)
+#define PDT_END (0x00D0)
+#define PDT_ENTRY_SIZE (0x0006)
+#define PAGES_TO_SERVICE (10)
+#define PAGE_SELECT_LEN (2)
+#define ADDRESS_LEN (2)
+#define SYNAPTICS_RMI4_F01 (0x01)
+#define SYNAPTICS_RMI4_F34 (0x34)
+#define PRODUCT_INFO_SIZE 2
+#define PRODUCT_ID_SIZE 10
+#define BUILD_ID_SIZE 3
+
+#define F12_GESTURE_DETECTION_LEN 5
+#define MAX_INTR_REGISTERS 4
+#define MAX_WRITE_SIZE 1024
+
+#define MASK_16BIT 0xFFFF
+#define MASK_8BIT 0xFF
+#define MASK_7BIT 0x7F
+#define MASK_6BIT 0x3F
+#define MASK_5BIT 0x1F
+#define MASK_4BIT 0x0F
+#define MASK_3BIT 0x07
+#define MASK_2BIT 0x03
+#define MASK_1BIT 0x01
+
+#define DO_LOCKDOWN false
+
+#define MAX_IMAGE_NAME_LEN 256
+#define MAX_FIRMWARE_ID_LEN 10
+
+#define IMAGE_HEADER_VERSION_10 0x10
+#define MAX_UTILITY_PARAMS 20
+
+#define V7_CONFIG_ID_SIZE 32
+#define V7_FLASH_STATUS_OFFSET 0
+#define V7_PARTITION_ID_OFFSET 1
+#define V7_BLOCK_NUMBER_OFFSET 2
+#define V7_TRANSFER_LENGTH_OFFSET 3
+#define V7_COMMAND_OFFSET 4
+#define V7_PAYLOAD_OFFSET 5
+#define V7_PARTITION_SUPPORT_BYTES 4
+
+#define F35_ERROR_CODE_OFFSET 0
+#define SLEEP_MODE_NORMAL (0x00)
+
+#define ENABLE_WAIT_MS (1 * 1000)
+#define WRITE_WAIT_MS (3 * 1000)
+#define ERASE_WAIT_MS (5 * 1000)
+
+#define MIN_SLEEP_TIME_US 50
+#define MAX_SLEEP_TIME_US 100
+
+#define INT_DISABLE_WAIT_MS 20
+#define ENTER_FLASH_PROG_WAIT_MS 20
+#define READ_CONFIG_WAIT_MS 20
+
+#define ABS(a,b) ((a - b > 0) ? a - b : b - a)
+
+enum exp_fn {
+        RMI_DEV = 0,
+        RMI_FW_UPDATER,
+        RMI_TEST_REPORTING,
+        RMI_PROXIMITY,
+        RMI_ACTIVE_PEN,
+        RMI_GESTURE,
+        RMI_VIDEO,
+        RMI_DEBUG,
+        RMI_LAST,
+};
+
+enum f34_version {
+        F34_V0 = 0,
+        F34_V1,
+        F34_V2,
+};
+
+enum bl_version {
+        BL_V5 = 5,
+        BL_V6 = 6,
+        BL_V7 = 7,
+        BL_V8 = 8,
+};
+
+enum flash_area {
+        NONE = 0,
+        UI_FIRMWARE,
+        UI_CONFIG,
+};
+
+enum update_mode {
+        NORMAL = 1,
+        FORCE = 2,
+        LOCKDOWN = 8,
+};
+
+enum config_area {
+        UI_CONFIG_AREA = 0,
+        PM_CONFIG_AREA,
+        BL_CONFIG_AREA,
+        DP_CONFIG_AREA,
+        FLASH_CONFIG_AREA,
+#ifdef SYNA_TDDI
+        TDDI_FORCE_CONFIG_AREA,
+        TDDI_LCM_DATA_AREA,
+        TDDI_OEM_DATA_AREA,
+#endif
+        UPP_AREA,
+};
+
+enum v7_status {
+        SUCCESS = 0x00,
+        DEVICE_NOT_IN_BOOTLOADER_MODE,
+        INVALID_PARTITION,
+        INVALID_COMMAND,
+        INVALID_BLOCK_OFFSET,
+        INVALID_TRANSFER,
+        NOT_ERASED,
+        FLASH_PROGRAMMING_KEY_INCORRECT,
+        BAD_PARTITION_TABLE,
+        CHECKSUM_FAILED,
+        FLASH_HARDWARE_FAILURE = 0x1f,
+};
+
+enum v7_partition_id {
+        BOOTLOADER_PARTITION = 0x01,
+        DEVICE_CONFIG_PARTITION,
+        FLASH_CONFIG_PARTITION,
+        MANUFACTURING_BLOCK_PARTITION,
+        GUEST_SERIALIZATION_PARTITION,
+        GLOBAL_PARAMETERS_PARTITION,
+        CORE_CODE_PARTITION,
+        CORE_CONFIG_PARTITION,
+        GUEST_CODE_PARTITION,
+        DISPLAY_CONFIG_PARTITION,
+        EXTERNAL_TOUCH_AFE_CONFIG_PARTITION,
+        UTILITY_PARAMETER_PARTITION,
+};
+
+enum v7_flash_command {
+        CMD_V7_IDLE = 0x00,
+        CMD_V7_ENTER_BL,
+        CMD_V7_READ,
+        CMD_V7_WRITE,
+        CMD_V7_ERASE,
+        CMD_V7_ERASE_AP,
+        CMD_V7_SENSOR_ID,
+};
+
+enum flash_command {
+        CMD_IDLE = 0,
+        CMD_WRITE_FW,
+        CMD_WRITE_CONFIG,
+        CMD_WRITE_LOCKDOWN,
+        CMD_WRITE_GUEST_CODE,
+        CMD_WRITE_BOOTLOADER,
+        CMD_WRITE_UTILITY_PARAM,
+        CMD_READ_CONFIG,
+        CMD_ERASE_ALL,
+        CMD_ERASE_UI_FIRMWARE,
+        CMD_ERASE_UI_CONFIG,
+        CMD_ERASE_BL_CONFIG,
+        CMD_ERASE_DISP_CONFIG,
+        CMD_ERASE_FLASH_CONFIG,
+        CMD_ERASE_GUEST_CODE,
+        CMD_ERASE_BOOTLOADER,
+        CMD_ERASE_UTILITY_PARAMETER,
+        CMD_ENABLE_FLASH_PROG,
+};
+
+enum container_id {
+        TOP_LEVEL_CONTAINER = 0,
+        UI_CONTAINER,
+        UI_CONFIG_CONTAINER,
+        BL_CONTAINER,
+        BL_IMAGE_CONTAINER,
+        BL_CONFIG_CONTAINER,
+        BL_LOCKDOWN_INFO_CONTAINER,
+        PERMANENT_CONFIG_CONTAINER,
+        GUEST_CODE_CONTAINER,
+        BL_PROTOCOL_DESCRIPTOR_CONTAINER,
+        UI_PROTOCOL_DESCRIPTOR_CONTAINER,
+        RMI_SELF_DISCOVERY_CONTAINER,
+        RMI_PAGE_CONTENT_CONTAINER,
+        GENERAL_INFORMATION_CONTAINER,
+        DEVICE_CONFIG_CONTAINER,
+        FLASH_CONFIG_CONTAINER,
+        GUEST_SERIALIZATION_CONTAINER,
+        GLOBAL_PARAMETERS_CONTAINER,
+        CORE_CODE_CONTAINER,
+        CORE_CONFIG_CONTAINER,
+        DISPLAY_CONFIG_CONTAINER,
+        EXTERNAL_TOUCH_AFE_CONFIG_CONTAINER,
+        UTILITY_CONTAINER,
+        UTILITY_PARAMETER_CONTAINER,
+};
+
+enum utility_parameter_id {
+        UNUSED = 0,
+        FORCE_PARAMETER,
+        ANTI_BENDING_PARAMETER,
+};
+
+/*********PART3:Struct Area**********************/
+/*
+ * struct synaptics_rmi4_fn_desc - function descriptor fields in PDT entry
+ * @query_base_addr: base address for query registers
+ * @cmd_base_addr: base address for command registers
+ * @ctrl_base_addr: base address for control registers
+ * @data_base_addr: base address for data registers
+ * @intr_src_count: number of interrupt sources
+ * @fn_version: version of function
+ * @fn_number: function number
+ */
+struct synaptics_rmi4_fn_desc {
+        union {
+                struct {
+                        unsigned char query_base_addr;
+                        unsigned char cmd_base_addr;
+                        unsigned char ctrl_base_addr;
+                        unsigned char data_base_addr;
+                        unsigned char intr_src_count:3;
+                        unsigned char reserved_1:2;
+                        unsigned char fn_version:2;
+                        unsigned char reserved_2:1;
+                        unsigned char fn_number;
+                } __packed;
+                unsigned char data[6];
+        };
+};
+
+/*
+ * synaptics_rmi4_fn_full_addr - full 16-bit base addresses
+ * @query_base: 16-bit base address for query registers
+ * @cmd_base: 16-bit base address for command registers
+ * @ctrl_base: 16-bit base address for control registers
+ * @data_base: 16-bit base address for data registers
+ */
+struct synaptics_rmi4_fn_full_addr {
+        unsigned short query_base;
+        unsigned short cmd_base;
+        unsigned short ctrl_base;
+        unsigned short data_base;
+};
+
+/*
+ * struct synaptics_rmi4_input_settings - current input settings
+ * @num_of_fingers: maximum number of fingers for 2D touch
+ * @valid_button_count: number of valid 0D buttons
+ * @max_touch_width: maximum touch width
+ * @sensor_max_x: maximum x coordinate for 2D touch
+ * @sensor_max_y: maximum y coordinate for 2D touch
+ * @force_min: minimum force value
+ * @force_max: maximum force value
+ * @stylus_enable: flag to indicate reporting of stylus data
+ * @eraser_enable: flag to indicate reporting of eraser data
+ */
+struct synaptics_rmi4_input_settings {
+        unsigned char num_of_fingers;
+        unsigned char valid_button_count;
+        unsigned char max_touch_width;
+        int sensor_max_x;
+        int sensor_max_y;
+        int force_min;
+        int force_max;
+        bool stylus_enable;
+        bool eraser_enable;
+};
+
+/*
+ * struct synaptics_rmi4_device_info - device information
+ * @version_major: RMI protocol major version number
+ * @version_minor: RMI protocol minor version number
+ * @manufacturer_id: manufacturer ID
+ * @product_props: product properties
+ * @product_info: product information
+ * @product_id_string: product ID
+ * @build_id: firmware build ID
+ * @support_fn_list: linked list for function handlers
+ */
+struct synaptics_rmi4_device_info {
+        unsigned int version_major;
+        unsigned int version_minor;
+        unsigned char manufacturer_id;
+        unsigned char product_props;
+        unsigned char product_info[PRODUCT_INFO_SIZE];
+        unsigned char product_id_string[PRODUCT_ID_SIZE + 1];
+        unsigned char build_id[BUILD_ID_SIZE];
+        struct list_head support_fn_list;
+};
+
+/*
+ * struct synaptics_rmi4_data - RMI4 device instance data
+ * @pdev: pointer to platform device
+ * @input_dev: pointer to associated input device
+ * @stylus_dev: pointer to associated stylus device
+ * @hw_if: pointer to hardware interface data
+ * @rmi4_mod_info: device information
+ * @board_prop_dir: /sys/board_properties directory for virtual key map file
+ * @pwr_reg: pointer to regulator for power control
+ * @bus_reg: pointer to regulator for bus pullup control
+ * @rmi4_reset_mutex: mutex for software reset
+ * @rmi4_report_mutex: mutex for input event reporting
+ * @rmi4_io_ctrl_mutex: mutex for communication interface I/O
+ * @rmi4_exp_init_mutex: mutex for expansion function module initialization
+ * @rmi4_irq_enable_mutex: mutex for enabling/disabling interrupt
+ * @rb_work: work for rebuilding input device
+ * @rb_workqueue: workqueue for rebuilding input device
+ * @fb_notifier: framebuffer notifier client
+ * @reset_work: work for issuing reset after display framebuffer ready
+ * @reset_workqueue: workqueue for issuing reset after display framebuffer ready
+ * @early_suspend: early suspend power management
+ * @current_page: current RMI page for register access
+ * @button_0d_enabled: switch for enabling 0d button support
+ * @num_of_tx: number of Tx channels for 2D touch
+ * @num_of_rx: number of Rx channels for 2D touch
+ * @num_of_fingers: maximum number of fingers for 2D touch
+ * @max_touch_width: maximum touch width
+ * @valid_button_count: number of valid 0D buttons
+ * @report_enable: input data to report for F$12
+ * @no_sleep_setting: default setting of NoSleep in F01_RMI_CTRL00 register
+ * @gesture_detection: detected gesture type and properties
+ * @intr_mask: interrupt enable mask
+ * @button_txrx_mapping: Tx Rx mapping of 0D buttons
+ * @num_of_intr_regs: number of interrupt registers
+ * @f01_query_base_addr: query base address for f$01
+ * @f01_cmd_base_addr: command base address for f$01
+ * @f01_ctrl_base_addr: control base address for f$01
+ * @f01_data_base_addr: data base address for f$01
+ * @f51_query_base_addr: query base address for f$51
+ * @firmware_id: firmware build ID
+ * @irq: attention interrupt
+ * @sensor_max_x: maximum x coordinate for 2D touch
+ * @sensor_max_y: maximum y coordinate for 2D touch
+ * @force_min: minimum force value
+ * @force_max: maximum force value
+ * @flash_prog_mode: flag to indicate flash programming mode status
+ * @irq_enabled: flag to indicate attention interrupt enable status
+ * @fingers_on_2d: flag to indicate presence of fingers in 2D area
+ * @suspend: flag to indicate whether in suspend state
+ * @sensor_sleep: flag to indicate sleep state of sensor
+ * @stay_awake: flag to indicate whether to stay awake during suspend
+ * @fb_ready: flag to indicate whether display framebuffer in ready state
+ * @f11_wakeup_gesture: flag to indicate support for wakeup gestures in F$11
+ * @f12_wakeup_gesture: flag to indicate support for wakeup gestures in F$12
+ * @enable_wakeup_gesture: flag to indicate usage of wakeup gestures
+ * @wedge_sensor: flag to indicate use of wedge sensor
+ * @report_pressure: flag to indicate reporting of pressure data
+ * @stylus_enable: flag to indicate reporting of stylus data
+ * @eraser_enable: flag to indicate reporting of eraser data
+ * @external_afe_buttons: flag to indicate presence of external AFE buttons
+ * @reset_device: pointer to device reset function
+ * @irq_enable: pointer to interrupt enable function
+ * @sleep_enable: pointer to sleep enable function
+ * @report_touch: pointer to touch reporting function
+ */
+struct synaptics_rmi4_data {
+        struct platform_device *pdev;
+        struct input_dev *input_dev;
+        struct input_dev *stylus_dev;
+        const struct synaptics_dsx_hw_interface *hw_if;
+        struct synaptics_rmi4_device_info rmi4_mod_info;
+        struct synaptics_rmi4_input_settings input_settings;
+        struct kobject *board_prop_dir;
+        struct regulator *pwr_reg;
+        struct regulator *bus_reg;
+        struct mutex rmi4_reset_mutex;
+        struct mutex rmi4_report_mutex;
+        struct mutex rmi4_io_ctrl_mutex;
+        struct mutex rmi4_exp_init_mutex;
+        struct mutex rmi4_irq_enable_mutex;
+        struct delayed_work rb_work;
+        struct workqueue_struct *rb_workqueue;
+#ifdef CONFIG_FB
+        struct notifier_block fb_notifier;
+        struct work_struct reset_work;
+        struct workqueue_struct *reset_workqueue;
+#endif
+#ifdef CONFIG_HAS_EARLYSUSPEND
+        struct early_suspend early_suspend;
+#endif
+        unsigned char current_page;
+        unsigned char button_0d_enabled;
+        unsigned char num_of_tx;
+        unsigned char num_of_rx;
+        unsigned char num_of_fingers;
+        unsigned char max_touch_width;
+        unsigned char valid_button_count;
+        unsigned char report_enable;
+        unsigned char no_sleep_setting;
+        unsigned char gesture_detection[F12_GESTURE_DETECTION_LEN];
+        unsigned char intr_mask[MAX_INTR_REGISTERS];
+        unsigned char *button_txrx_mapping;
+        unsigned short num_of_intr_regs;
+        unsigned short f01_query_base_addr;
+        unsigned short f01_cmd_base_addr;
+        unsigned short f01_ctrl_base_addr;
+        unsigned short f01_data_base_addr;
+#ifdef F51_DISCRETE_FORCE
+        unsigned short f51_query_base_addr;
+#endif
+        unsigned int firmware_id;
+        int irq;
+        int sensor_max_x;
+        int sensor_max_y;
+        int force_min;
+        int force_max;
+        bool flash_prog_mode;
+        bool irq_enabled;
+        bool fingers_on_2d;
+        bool suspend;
+        bool sensor_sleep;
+        bool stay_awake;
+        bool fb_ready;
+        bool f11_wakeup_gesture;
+        bool f12_wakeup_gesture;
+        bool enable_wakeup_gesture;
+        bool wedge_sensor;
+        bool report_pressure;
+        bool stylus_enable;
+        bool eraser_enable;
+        bool external_afe_buttons;
+        int (*reset_device)(struct synaptics_rmi4_data *rmi4_data,
+                        bool rebuild);
+        int (*irq_enable)(struct synaptics_rmi4_data *rmi4_data, bool enable,
+                        bool attn_only);
+        void (*sleep_enable)(struct synaptics_rmi4_data *rmi4_data,
+                        bool enable);
+        //void (*report_touch)(struct synaptics_rmi4_data *rmi4_data,   //Roland
+                        //struct synaptics_rmi4_fn *fhandler);
+};
+
+struct synaptics_dsx_bus_access {
+        unsigned char type;
+        int (*read)(struct synaptics_rmi4_data *rmi4_data, unsigned short addr,
+                unsigned char *data, unsigned int length);
+        int (*write)(struct synaptics_rmi4_data *rmi4_data, unsigned short addr,
+                unsigned char *data, unsigned int length);
+};
+
+struct synaptics_dsx_hw_interface {
+        struct synaptics_dsx_board_data *board_data;
+        const struct synaptics_dsx_bus_access *bus_access;
+        int (*bl_hw_init)(struct synaptics_rmi4_data *rmi4_data);
+        int (*ui_hw_init)(struct synaptics_rmi4_data *rmi4_data);
+};
+
+struct pdt_properties {
+        union {
+                struct {
+                        unsigned char reserved_1:6;
+                        unsigned char has_bsr:1;
+                        unsigned char reserved_2:1;
+                } __packed;
+                unsigned char data[1];
+        };
+};
+
+struct partition_table {
+        unsigned char partition_id:5;
+        unsigned char byte_0_reserved:3;
+        unsigned char byte_1_reserved;
+        unsigned char partition_length_7_0;
+        unsigned char partition_length_15_8;
+        unsigned char start_physical_address_7_0;
+        unsigned char start_physical_address_15_8;
+        unsigned char partition_properties_7_0;
+        unsigned char partition_properties_15_8;
+} __packed;
+
+struct f01_device_control {
+        union {
+                struct {
+                        unsigned char sleep_mode:2;
+                        unsigned char nosleep:1;
+                        unsigned char reserved:2;
+                        unsigned char charger_connected:1;
+                        unsigned char report_rate:1;
+                        unsigned char configured:1;
+                } __packed;
+                unsigned char data[1];
+        };
+};
+
+struct f34_v7_query_0 {
+        union {
+                struct {
+                        unsigned char subpacket_1_size:3;
+                        unsigned char has_config_id:1;
+                        unsigned char f34_query0_b4:1;
+                        unsigned char has_thqa:1;
+                        unsigned char f34_query0_b6__7:2;
+                } __packed;
+                unsigned char data[1];
+        };
+};
+
+struct f34_v7_query_1_7 {
+        union {
+                struct {
+                        /* query 1 */
+                        unsigned char bl_minor_revision;
+                        unsigned char bl_major_revision;
+
+                        /* query 2 */
+                        unsigned char bl_fw_id_7_0;
+                        unsigned char bl_fw_id_15_8;
+                        unsigned char bl_fw_id_23_16;
+                        unsigned char bl_fw_id_31_24;
+
+                        /* query 3 */
+                        unsigned char minimum_write_size;
+                        unsigned char block_size_7_0;
+                        unsigned char block_size_15_8;
+                        unsigned char flash_page_size_7_0;
+                        unsigned char flash_page_size_15_8;
+
+                        /* query 4 */
+                        unsigned char adjustable_partition_area_size_7_0;
+                        unsigned char adjustable_partition_area_size_15_8;
+
+                        /* query 5 */
+                        unsigned char flash_config_length_7_0;
+                        unsigned char flash_config_length_15_8;
+
+                        /* query 6 */
+                        unsigned char payload_length_7_0;
+                        unsigned char payload_length_15_8;
+
+                        /* query 7 */
+                        unsigned char f34_query7_b0:1;
+                        unsigned char has_bootloader:1;
+                        unsigned char has_device_config:1;
+                        unsigned char has_flash_config:1;
+                        unsigned char has_manufacturing_block:1;
+                        unsigned char has_guest_serialization:1;
+                        unsigned char has_global_parameters:1;
+                        unsigned char has_core_code:1;
+                        unsigned char has_core_config:1;
+                        unsigned char has_guest_code:1;
+                        unsigned char has_display_config:1;
+                        unsigned char f34_query7_b11__15:5;
+                        unsigned char f34_query7_b16__23;
+                        unsigned char f34_query7_b24__31;
+                } __packed;
+                unsigned char data[21];
+        };
+};
+
+struct f34_v7_data0 {
+        union {
+                struct {
+                        unsigned char operation_status:5;
+                        unsigned char device_cfg_status:2;
+                        unsigned char bl_mode:1;
+                } __packed;
+                unsigned char data[1];
+        };
+};
+
+struct f34_v7_data_1_5 {
+        union {
+                struct {
+                        unsigned char partition_id:5;
+                        unsigned char f34_data1_b5__7:3;
+                        unsigned char block_offset_7_0;
+                        unsigned char block_offset_15_8;
+                        unsigned char transfer_length_7_0;
+                        unsigned char transfer_length_15_8;
+                        unsigned char command;
+                        unsigned char payload_0;
+                        unsigned char payload_1;
+                } __packed;
+                unsigned char data[8];
+        };
+};
+
+struct f34_v5v6_flash_properties {
+        union {
+                struct {
+                        unsigned char reg_map:1;
+                        unsigned char unlocked:1;
+                        unsigned char has_config_id:1;
+                        unsigned char has_pm_config:1;
+                        unsigned char has_bl_config:1;
+                        unsigned char has_disp_config:1;
+                        unsigned char has_ctrl1:1;
+                        unsigned char has_query4:1;
+                } __packed;
+                unsigned char data[1];
+        };
+};
+
+struct register_offset {
+        unsigned char properties;
+        unsigned char properties_2;
+        unsigned char block_size;
+        unsigned char block_count;
+        unsigned char gc_block_count;
+        unsigned char flash_status;
+        unsigned char partition_id;
+        unsigned char block_number;
+        unsigned char transfer_length;
+        unsigned char flash_cmd;
+        unsigned char payload;
+};
+
+struct block_count {
+        unsigned short ui_firmware;
+        unsigned short ui_config;
+        unsigned short dp_config;
+        unsigned short pm_config;
+        unsigned short fl_config;
+        unsigned short bl_image;
+        unsigned short bl_config;
+        unsigned short utility_param;
+        unsigned short lockdown;
+        unsigned short guest_code;
+        unsigned short total_count;
+};
+
+struct physical_address {
+        unsigned short ui_firmware;
+        unsigned short ui_config;
+        unsigned short dp_config;
+        unsigned short pm_config;
+        unsigned short fl_config;
+        unsigned short bl_image;
+        unsigned short bl_config;
+        unsigned short utility_param;
+        unsigned short lockdown;
+        unsigned short guest_code;
+};
+
+struct container_descriptor {
+        unsigned char content_checksum[4];
+        unsigned char container_id[2];
+        unsigned char minor_version;
+        unsigned char major_version;
+        unsigned char reserved_08;
+        unsigned char reserved_09;
+        unsigned char reserved_0a;
+        unsigned char reserved_0b;
+        unsigned char container_option_flags[4];
+        unsigned char content_options_length[4];
+        unsigned char content_options_address[4];
+        unsigned char content_length[4];
+        unsigned char content_address[4];
+};
+
+struct image_header_10 {
+        unsigned char checksum[4];
+        unsigned char reserved_04;
+        unsigned char reserved_05;
+        unsigned char minor_header_version;
+        unsigned char major_header_version;
+        unsigned char reserved_08;
+        unsigned char reserved_09;
+        unsigned char reserved_0a;
+        unsigned char reserved_0b;
+        unsigned char top_level_container_start_addr[4];
+};
+
+struct block_data {
+        unsigned int size;
+        const unsigned char *data;
+};
+
+struct image_metadata {
+        bool contains_firmware_id;
+        bool contains_bootloader;
+        bool contains_guest_code;
+        bool contains_disp_config;
+        bool contains_perm_config;
+        bool contains_flash_config;
+        bool contains_utility_param;
+        unsigned int firmware_id;
+        unsigned int checksum;
+        unsigned int bootloader_size;
+        unsigned int disp_config_offset;
+        unsigned char bl_version;
+        unsigned char product_id[PRODUCT_ID_SIZE + 1];
+        unsigned char cstmr_product_id[PRODUCT_ID_SIZE + 1];
+        unsigned char utility_param_id[MAX_UTILITY_PARAMS];
+        struct block_data bootloader;
+        struct block_data utility;
+        struct block_data ui_firmware;
+        struct block_data ui_config;
+        struct block_data dp_config;
+        struct block_data pm_config;
+        struct block_data fl_config;
+        struct block_data bl_image;
+        struct block_data bl_config;
+        struct block_data utility_param[MAX_UTILITY_PARAMS];
+        struct block_data lockdown;
+        struct block_data guest_code;
+        struct block_count blkcount;
+        struct physical_address phyaddr;
+};
+
+struct synaptics_rmi4_fwu_handle {
+        enum bl_version bl_version;
+        bool initialized;
+        bool in_bl_mode;
+        bool in_ub_mode;
+        bool bl_mode_device;
+        bool force_update;
+        bool do_lockdown;
+        bool has_guest_code;
+        bool has_utility_param;
+        bool new_partition_table;
+        bool incompatible_partition_tables;
+        bool write_bootloader;
+        unsigned int data_pos;
+        unsigned char *ext_data_source;
+        unsigned char *read_config_buf;
+        unsigned char intr_mask;
+        unsigned char command;
+        unsigned char bootloader_id[2];
+        unsigned char config_id[32];
+        unsigned char flash_status;
+        unsigned char partitions;
+        unsigned short block_size;
+        unsigned short config_size;
+        unsigned short config_area;
+        unsigned short config_block_count;
+        unsigned short flash_config_length;
+        unsigned short payload_length;
+        unsigned short partition_table_bytes;
+        unsigned short read_config_buf_size;
+        const unsigned char *config_data;
+        const unsigned char *image;
+        unsigned char *image_name;
+        unsigned int image_size;
+        struct image_metadata img;
+        struct register_offset off;
+        struct block_count blkcount;
+        struct physical_address phyaddr;
+        struct f34_v5v6_flash_properties flash_properties;
+        struct synaptics_rmi4_fn_desc f34_fd;
+        struct synaptics_rmi4_fn_desc f35_fd;
+        struct synaptics_rmi4_data *rmi4_data;
+        struct workqueue_struct *fwu_workqueue;
+        struct work_struct fwu_work;
+};
+
+struct synaptics_register
+{
+        uint8_t F01_RMI_QUERY_BASE;
+        uint8_t F01_RMI_CMD_BASE;
+        uint8_t F01_RMI_CTRL_BASE;
+        uint8_t F01_RMI_DATA_BASE;
+
+        uint8_t F01_RMI_QUERY11;
+        uint8_t F01_RMI_DATA01;
+        uint8_t F01_RMI_CMD00;
+        uint8_t F01_RMI_CTRL00;
+        uint8_t F01_RMI_CTRL01;
+        uint8_t F01_RMI_CTRL02;
+
+        uint8_t F12_2D_QUERY_BASE;
+        uint8_t F12_2D_CMD_BASE;
+        uint8_t F12_2D_CTRL_BASE;
+        uint8_t F12_2D_DATA_BASE;
+
+        uint8_t F12_2D_CTRL08;
+        uint8_t F12_2D_CTRL11;
+        uint8_t F12_2D_CTRL20;
+        uint8_t F12_2D_CTRL23;
+        uint8_t F12_2D_CTRL27;
+        uint8_t F12_2D_CTRL32;
+        uint8_t F12_2D_DATA04;
+        uint8_t F12_2D_DATA15;
+        uint8_t F12_2D_DATA38;
+        uint8_t F12_2D_DATA39;
+        uint8_t F12_2D_CMD00;
+
+        uint8_t F34_FLASH_QUERY_BASE;
+        uint8_t F34_FLASH_CMD_BASE;
+        uint8_t F34_FLASH_CTRL_BASE;
+        uint8_t F34_FLASH_DATA_BASE;
+
+        uint8_t SynaF34_FlashControl;
+        uint8_t SynaF34Reflash_BlockNum;
+        uint8_t SynaF34Reflash_BlockData;
+        uint8_t SynaF34ReflashQuery_BootID;
+        uint8_t SynaF34ReflashQuery_FlashPropertyQuery;
+        uint8_t SynaF34ReflashQuery_FirmwareBlockSize;
+        uint8_t SynaF34ReflashQuery_FirmwareBlockCount;
+        uint8_t SynaF34ReflashQuery_ConfigBlockSize;
+        uint8_t SynaF34ReflashQuery_ConfigBlockCount;
+
+        uint8_t F51_CUSTOM_QUERY_BASE;
+        uint8_t F51_CUSTOM_CMD_BASE;
+        uint8_t F51_CUSTOM_CTRL_BASE;
+        uint8_t F51_CUSTOM_DATA_BASE;
+
+        uint8_t F51_CUSTOM_CTRL00;
+        uint8_t F51_CUSTOM_CTRL31;
+        uint8_t F51_CUSTOM_CTRL50;
+        uint8_t F51_CUSTOM_DATA;
+
+        uint8_t F54_ANALOG_QUERY_BASE;
+        uint8_t F54_ANALOG_COMMAND_BASE;
+        uint8_t F54_ANALOG_CONTROL_BASE;
+        uint8_t F54_ANALOG_DATA_BASE;
+
+        uint8_t F55_SENSOR_CTRL01;
+        uint8_t F55_SENSOR_CTRL02;
+};
+
+struct data_logger
+{
+        bool data_logger_control;
+        int loglength_addr;
+        int loginfo_addr;
+};
+
+struct chip_data_s3706 {
+        uint32_t *p_tp_fw;
+        tp_dev tp_type;
+        struct i2c_client *client;
+        struct synaptics_proc_operations *syna_ops; /*synaptics func provide to synaptics common driver*/
+#ifdef CONFIG_SYNAPTIC_RED
+        int        enable_remote;                                           /*Redremote connect state*/
+        struct remotepanel_data *premote_data;
+#endif/*CONFIG_SYNAPTIC_RED*/
+        struct synaptics_register         reg_info;
+        struct hw_resource                  *hw_res;
+        struct data_logger                  d_log;
+        struct synaptics_rmi4_fwu_handle *fwu;          /*3706 firmware update use*/
+        int16_t *spuri_fp_data;
+		bool is_power_down;
+		int en_up_down;
+		int in_gesture_mode;
+};
+
+static inline int secure_memcpy(unsigned char *dest, unsigned int dest_size,
+                const unsigned char *src, unsigned int src_size,
+                unsigned int count)
+{
+        if (dest == NULL || src == NULL) {
+                return -EINVAL;
+        }
+
+        if (count > dest_size || count > src_size) {
+                return -EINVAL;
+        }
+
+        memcpy((void *)dest, (const void *)src, count);
+
+        return 0;
+}
+
+#endif /*SYNAPTICS_H_S3508*/
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706_baseline.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706_baseline.h
new file mode 100644
index 0000000000000000000000000000000000000000..374995bae394f8b0df40493db8e44dceaf539ab8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S3706/synaptics_s3706_baseline.h
@@ -0,0 +1,143 @@
+#ifndef SYNAPTICS_BASELINE_H
+#define SYNAPTICS_BASELINE_H
+
+#define TX_NUMBER  (17)
+#define TX_17801_NUMBER  (15)
+#define RX_NUMBER  (30)
+
+#define TX_18857_NUMBER  (16)
+#define RX_18857_NUMBER  (33)
+
+/*17819 s3706 TX 16 RX 33*/
+const int16_t baseline_cap_18857_data[2][TX_18857_NUMBER][RX_18857_NUMBER*2] = {
+//enable cbc  Notice it is opposite to the xls format.
+	{
+		{404,943,610,1423,634,1479,635,1481,632,1475,633,1476,633,1477,633,1477,634,1479,635,1482,636,1484,638,1489,637,1487,640,1493,639,1491,640,1493,646,1507,646,1507,646,1506,648,1511,652,1521,653,1524,667,1556,657,1534,661,1543,662,1544,666,1553,668,1559,669,1561,670,1563,672,1569,668,1560,638,1489},
+		{649,1514,646,1507,647,1509,647,1509,644,1502,644,1504,645,1504,644,1504,645,1506,646,1508,647,1511,649,1515,648,1512,651,1518,651,1518,651,1519,657,1532,657,1533,658,1535,657,1534,665,1551,663,1547,667,1556,670,1563,681,1590,674,1572,676,1577,678,1582,680,1586,680,1587,683,1593,685,1598,694,1620},
+		{637,1487,641,1496,642,1497,642,1497,639,1491,640,1493,640,1493,640,1493,641,1495,642,1497,643,1500,645,1504,643,1501,646,1507,646,1507,646,1507,652,1521,652,1521,653,1523,652,1522,659,1538,668,1558,661,1543,664,1550,666,1554,668,1559,670,1564,673,1569,674,1573,675,1576,677,1580,679,1585,687,1602},
+		{633,1477,639,1491,640,1492,639,1492,637,1486,638,1488,638,1488,638,1488,639,1490,639,1492,640,1494,642,1498,641,1496,643,1501,643,1501,644,1502,649,1515,649,1515,650,1518,660,1540,657,1533,655,1529,659,1537,662,1544,663,1548,665,1553,668,1558,670,1563,672,1567,698,1629,674,1573,676,1578,683,1593}, 
+		{633,1478,640,1494,639,1490,638,1490,635,1482,636,1483,637,1485,637,1486,648,1512,639,1490,640,1493,641,1496,641,1495,643,1500,642,1498,642,1498,649,1513,649,1514,649,1513,650,1516,655,1528,654,1527,658,1535,660,1539,662,1545,664,1549,666,1554,668,1559,669,1562,670,1564,673,1569,675,1575,680,1587},
+		{634,1479,666,1554,639,1490,639,1491,637,1486,648,1511,637,1487,637,1485,638,1489,638,1490,640,1493,641,1496,641,1496,643,1500,642,1499,644,1502,648,1513,648,1513,648,1513,649,1515,654,1527,654,1526,657,1534,659,1538,661,1543,663,1546,665,1552,667,1557,669,1560,669,1561,672,1567,674,1573,679,1584},
+		{577,1347,639,1491,639,1491,640,1492,637,1487,638,1489,638,1488,637,1487,638,1489,639,1491,640,1494,642,1497,641,1495,643,1501,643,1500,654,1526,649,1514,649,1513,649,1513,649,1515,655,1527,654,1527,657,1533,659,1537,661,1543,663,1546,665,1552,667,1556,668,1559,669,1560,671,1566,674,1572,677,1580},
+		{402,938,620,1447,640,1493,640,1494,648,1513,639,1492,639,1490,638,1489,639,1492,640,1494,641,1496,643,1500,642,1498,644,1503,644,1502,645,1505,650,1516,650,1516,650,1516,650,1517,655,1528,655,1528,658,1535,659,1538,662,1544,663,1547,665,1552,667,1556,668,1559,668,1559,671,1565,673,1571,676,1577}, 
+		{418,976,629,1467,639,1491,640,1492,637,1486,638,1488,638,1488,638,1488,639,1491,640,1493,641,1495,641,1496,641,1496,644,1502,643,1500,643,1501,649,1514,649,1513,648,1511,649,1515,655,1528,654,1526,657,1533,669,1561,661,1542,661,1542,664,1550,666,1555,667,1557,668,1558,670,1564,673,1570,673,1571},
+		{597,1394,641,1496,639,1491,639,1491,636,1485,637,1486,637,1487,637,1487,638,1489,639,1492,640,1494,653,1523,641,1496,643,1500,642,1499,643,1500,648,1513,648,1513,650,1516,649,1514,654,1526,653,1525,657,1532,658,1536,661,1542,663,1547,664,1549,666,1554,667,1556,667,1557,670,1563,673,1569,667,1557},
+		{651,1519,642,1497,639,1491,639,1491,636,1485,637,1487,637,1487,637,1487,639,1490,639,1491,641,1495,643,1500,641,1496,643,1501,643,1499,643,1500,649,1513,649,1513,650,1516,649,1515,654,1527,654,1525,657,1532,658,1536,661,1541,673,1570,664,1549,666,1554,667,1557,667,1557,670,1562,672,1569,674,1572},
+		{651,1519,642,1497,639,1492,640,1492,637,1486,638,1488,638,1489,638,1489,639,1491,640,1493,641,1495,643,1501,642,1497,644,1502,643,1500,643,1501,649,1514,649,1514,660,1541,649,1515,654,1527,654,1525,657,1533,659,1537,661,1542,663,1547,664,1550,666,1554,667,1556,668,1558,670,1563,672,1568,672,1567},
+		{653,1524,643,1499,640,1494,640,1494,638,1488,638,1489,637,1487,637,1487,640,1492,640,1494,651,1520,643,1500,642,1499,644,1504,642,1499,644,1503,650,1516,650,1516,650,1517,651,1519,656,1531,656,1530,659,1538,661,1543,664,1550,666,1553,669,1560,671,1566,673,1569,674,1572,677,1579,680,1586,681,1589},
+		{657,1534,645,1505,643,1499,643,1500,641,1495,641,1497,643,1500,653,1525,643,1501,644,1502,645,1505,646,1508,646,1507,648,1512,649,1514,648,1512,653,1525,653,1524,653,1524,654,1525,658,1536,658,1535,661,1542,663,1546,665,1551,666,1555,669,1561,671,1566,672,1569,673,1571,676,1578,679,1585,681,1588},
+		{650,1517,648,1511,645,1506,645,1505,642,1498,643,1500,654,1526,644,1503,644,1503,644,1504,646,1506,647,1509,646,1508,648,1513,649,1515,648,1512,653,1525,653,1525,653,1525,654,1526,659,1538,659,1537,662,1544,664,1548,666,1554,667,1557,670,1563,672,1568,674,1572,674,1574,678,1581,681,1588,678,1581},
+		{570,1329,654,1525,659,1537,655,1527,649,1514,647,1510,646,1508,645,1505,643,1501,643,1500,643,1500,643,1501,642,1497,644,1502,653,1525,642,1498,647,1509,646,1508,645,1506,646,1506,650,1517,649,1515,652,1522,654,1525,656,1530,657,1532,659,1538,661,1543,663,1547,664,1550,668,1559,675,1574,651,1519},
+	},
+	//disable cbc
+	{
+		{405,944,613,1431,637,1487,637,1487,637,1486,636,1484,637,1487,637,1486,637,1487,638,1488,638,1489,641,1495,640,1494,642,1499,643,1500,644,1503,647,1511,649,1513,648,1513,650,1516,654,1526,655,1528,670,1563,660,1540,662,1544,664,1548,666,1555,667,1557,669,1562,671,1566,672,1569,669,1562,638,1489},
+		{654,1526,650,1517,650,1518,650,1516,649,1514,648,1511,650,1516,649,1515,649,1515,650,1516,650,1518,653,1523,652,1521,654,1526,655,1528,656,1530,659,1537,660,1540,660,1539,662,1544,665,1552,666,1555,669,1561,671,1565,685,1599,675,1574,677,1579,679,1584,680,1587,682,1590,683,1595,686,1601,695,1621},
+		{642,1497,645,1506,646,1506,645,1504,644,1503,643,1500,645,1504,644,1503,644,1504,645,1505,645,1506,648,1511,647,1509,649,1515,650,1516,651,1518,654,1526,655,1528,655,1529,656,1531,660,1540,673,1571,664,1549,666,1554,667,1557,669,1561,671,1567,673,1570,674,1573,676,1577,678,1581,680,1588,687,1604},
+		{638,1488,643,1501,643,1501,643,1499,642,1498,641,1495,642,1498,642,1498,642,1498,643,1499,643,1500,645,1505,644,1504,646,1508,647,1510,648,1512,651,1519,652,1522,652,1522,666,1555,657,1533,658,1536,661,1542,663,1546,665,1551,666,1554,669,1560,669,1562,672,1568,673,1570,675,1574,678,1581,683,1595},
+		{637,1486,642,1498,642,1498,641,1497,641,1495,639,1492,641,1496,641,1495,653,1524,641,1496,642,1497,644,1502,643,1501,645,1506,646,1508,647,1509,650,1516,651,1519,651,1518,653,1523,656,1530,657,1532,659,1538,661,1542,663,1547,664,1550,667,1556,668,1558,670,1562,671,1566,673,1570,676,1577,680,1587},
+		{637,1487,643,1500,642,1498,641,1496,641,1495,652,1521,641,1496,641,1495,641,1495,641,1496,642,1497,643,1501,643,1500,645,1505,646,1506,647,1509,650,1516,651,1519,650,1517,652,1521,655,1529,656,1531,659,1537,661,1541,662,1545,664,1549,666,1554,667,1556,669,1560,670,1564,672,1568,675,1575,679,1584},
+		{580,1354,642,1498,642,1499,642,1497,641,1495,640,1493,641,1496,641,1496,641,1496,641,1497,642,1499,644,1502,643,1501,645,1506,646,1507,659,1539,650,1517,651,1519,651,1518,652,1522,655,1529,656,1531,659,1537,660,1541,662,1544,663,1547,666,1553,666,1555,668,1559,670,1563,671,1566,675,1574,677,1580},
+		{403,940,623,1454,643,1500,643,1499,655,1527,641,1496,642,1499,642,1498,642,1499,643,1500,643,1501,645,1505,645,1504,647,1509,647,1510,648,1511,651,1519,652,1521,652,1520,653,1524,656,1530,657,1532,659,1537,661,1541,662,1544,664,1548,666,1553,667,1556,668,1558,670,1563,671,1566,674,1574,676,1577},
+		{419,978,632,1475,642,1498,642,1497,641,1496,640,1493,641,1497,641,1497,642,1497,642,1499,643,1499,644,1503,644,1502,646,1506,646,1508,647,1509,650,1516,651,1519,650,1518,652,1521,655,1529,656,1530,658,1535,672,1569,662,1544,663,1546,665,1552,666,1554,667,1557,669,1561,671,1565,674,1572,673,1571},
+		{601,1403,644,1504,642,1499,641,1496,641,1496,640,1493,641,1496,641,1496,641,1496,642,1498,642,1498,656,1532,644,1502,645,1505,646,1507,647,1509,650,1516,651,1518,651,1518,652,1521,655,1528,656,1530,658,1535,660,1539,661,1543,663,1546,665,1551,666,1554,667,1557,669,1560,670,1564,674,1572,668,1558}, 
+		{655,1528,645,1504,642,1498,642,1497,641,1495,640,1493,641,1497,641,1496,641,1497,642,1498,642,1499,644,1504,643,1501,645,1505,646,1507,647,1509,650,1516,651,1519,650,1518,652,1521,655,1529,656,1530,658,1535,660,1539,661,1542,675,1575,664,1550,666,1553,667,1557,668,1560,670,1563,673,1570,674,1572},
+		{655,1528,645,1504,643,1499,642,1498,641,1496,641,1495,642,1498,642,1497,642,1497,642,1499,643,1499,645,1504,644,1502,646,1506,646,1508,647,1510,650,1516,651,1519,663,1548,652,1522,655,1528,656,1531,658,1535,660,1539,661,1543,663,1546,665,1551,665,1553,667,1556,668,1560,670,1562,673,1570,672,1567},
+		{657,1533,645,1506,643,1501,643,1499,642,1498,641,1495,642,1499,642,1498,642,1499,643,1499,656,1531,645 ,1505,645,1504,647,1509,647,1511,648,1513,651,1519,652,1522,652,1521,653,1524,656,1530,657,1534,660,1540,663,1546,665,1551,666,1555,669,1561,670,1564,672,1569,674,1574,677,1579,681,1588,681,1588},
+		{661,1541,648,1511,646,1507,645,1505,645,1504,644,1503,645,1506,658,1536,646,1507,646,1508,647,1509,648,1513,648,1512,650,1517,651,1518,652,1520,654,1526,656,1530,655,1529,656,1532,657,1534,659,1537,662,1544,664,1549,665,1553,667,1556,669,1562,671,1565,672,1569,674,1573,676,1578,680,1587,680,1588},
+		{654,1526,651,1519,649,1513,647,1510,647,1509,645,1506,659,1538,646,1508,647,1509,647,1509,647,1510,649,1514,649,1514,651,1518,651,1520,652,1521,655,1527,656,1530,656,1530,657,1533,658,1536,660,1540,663,1547,665,1552,667,1556,668,1559,670,1564,672,1568,674,1572,675,1576,678,1581,682,1591,678,1581},
+		{573,1337,657,1534,662,1545,657,1534,654,1525,650,1516,650,1516,647,1511,647,1509,646,1506,645,1505,646,1507,644,1504,646,1507,658,1536,646,1507,648,1512,649,1513,648,1511,648,1513,650,1517,651,1520,653,1525,655,1528,656,1531,658,1534,660,1539,661,1543,663,1547,665,1553,669,1560,675,1576,651,1518},
+	}
+};
+
+const int16_t baseline_cap_data[2][TX_NUMBER][RX_NUMBER*2] =
+{
+    //enable cbc
+    {
+		{403,748,441,819,451,837,451,837,450,836,459,852,450,836,448,832,456,846,451,837,454,844,458,850,463,861,498,926,499,927,501,930,515,956,526,978,529,982,528,980,531,987,544,1010,554,1030,557,1034,561,1041,568,1056,568,1056,587,1091,741,1375,776,1440},
+		{424,787,460,854,468,870,468,870,468,870,476,884,468,868,468,868,472,876,470,872,473,879,485,901,485,901,522,969,522,969,522,969,531,987,534,992,547,1017,545,1013,557,1034,561,1041,574,1066,592,1099,576,1070,592,1099,592,1099,601,1115,774,1437,791,1469},
+		{419,779,456,846,464,862,464,862,463,861,471,875,464,862,462,858,470,872,466,865,470,872,473,879,477,887,522,969,522,969,522,969,526,978,530,984,542,1006,540,1002,545,1013,557,1034,566,1052,568,1056,571,1060,580,1076,578,1074,592,1099,757,1405,783,1455},
+		{420,780,456,846,466,865,466,865,464,862,473,879,466,865,463,861,470,872,468,868,470,872,473,879,477,887,522,969,522,969,522,969,528,980,530,984,543,1009,541,1005,544,1010,566,1052,566,1052,566,1052,571,1060,578,1074,578,1073,592,1099,756,1404,783,1453},
+		{421,783,454,844,464,862,464,862,464,862,473,879,464,862,463,861,470,872,466,865,468,870,472,876,476,884,512,952,510,948,522,969,526,978,529,982,541,1005,540,1002,552,1024,557,1034,564,1048,565,1049,567,1053,575,1067,574,1066,592,1099,756,1404,777,1443},
+		{421,783,454,844,464,862,464,862,464,862,473,879,464,862,463,861,470,872,468,868,468,870,473,879,477,887,522,970,511,949,522,969,526,976,528,980,540,1002,539,1001,543,1009,557,1034,565,1049,565,1049,567,1053,575,1067,574,1066,582,1082,752,1396,774,1437},
+		{418,776,453,841,464,862,466,865,463,861,472,876,463,861,462,858,479,889,466,865,468,870,472,876,476,884,510,948,510,948,512,952,524,974,528,980,540,1002,539,1001,540,1002,552,1024,562,1044,563,1045,565,1049,572,1062,572,1062,578,1074,750,1394,774,1437},
+		{415,771,456,846,468,868,468,868,466,865,474,880,466,865,463,861,472,876,468,868,471,875,473,879,477,887,511,949,511,949,522,969,526,976,530,984,540,1002,547,1017,540,1002,552,1024,562,1044,562,1044,563,1045,574,1066,571,1060,578,1073,752,1396,774,1437},
+		{405,751,456,846,468,868,468,870,468,868,474,880,468,868,466,865,473,879,479,889,472,876,475,883,480,891,522,969,522,969,522,969,526,978,530,984,542,1006,539,1001,542,1006,557,1034,565,1049,561,1041,563,1045,572,1062,572,1062,575,1067,752,1396,774,1437},
+		{415,771,460,854,472,876,472,876,471,875,480,891,471,875,470,872,476,884,472,876,476,884,479,889,485,901,522,969,522,969,526,978,530,984,533,991,544,1010,541,1005,543,1009,557,1034,566,1052,565,1049,566,1052,574,1066,574,1066,576,1070,750,1394,774,1437},
+		{428,794,463,861,473,879,474,880,473,879,485,901,474,880,473,879,480,891,476,884,477,887,485,901,485,901,522,969,522,969,522,969,532,988,534,992,545,1013,542,1006,544,1010,557,1034,565,1049,565,1049,566,1052,574,1066,582,1082,574,1066,760,1412,762,1416},
+		{442,822,468,868,477,887,479,889,476,884,485,901,477,887,475,883,485,901,477,887,491,913,485,901,489,907,522,969,522,969,522,969,534,992,536,996,551,1023,543,1009,547,1017,557,1035,584,1084,565,1049,566,1052,574,1066,574,1066,570,1058,750,1394,762,1416},
+		{450,836,470,872,479,889,479,889,476,884,487,904,479,889,476,884,485,901,485,901,485,901,485,901,489,909,524,972,522,969,522,970,544,1010,536,996,547,1017,544,1010,547,1017,557,1035,565,1049,565,1049,567,1053,574,1066,574,1066,568,1056,753,1398,774,1437},
+		{454,844,472,876,485,901,485,901,480,891,487,905,485,901,479,889,487,904,485,901,485,901,487,905,491,913,524,974,522,970,522,970,536,995,536,996,549,1019,544,1010,547,1017,559,1037,567,1053,566,1052,578,1073,575,1067,575,1067,574,1066,756,1404,774,1437},
+		{463,861,476,884,485,901,487,905,485,901,489,909,485,901,485,901,489,907,485,901,487,904,494,918,494,918,528,980,526,976,526,978,539,1001,540,1002,557,1034,547,1017,551,1023,562,1044,574,1066,574,1066,574,1066,582,1082,584,1084,595,1105,762,1414,791,1469}, 
+		{498,926,498,926,498,926,498,926,494,918,498,926,494,918,498,926,494,918,489,909,489,909,494,918,498,926,534,992,534,992,530,984,543,1009,543,1009,570,1058,547,1017,552,1024,561,1041,589,1095,570,1058,574,1066,582,1082,582,1082,596,1106,769,1429,800,1486}, 
+		{498,926,498,926,498,926,498,926,494,918,498,926,494,918,498,926,494,918,489,909,489,909,494,918,498,926,534,992,534,992,530,984,543,1009,543,1009,570,1058,547,1017,552,1024,561,1041,589,1095,570,1058,574,1066,582,1082,582,1082,596,1106,500,3000,500,3000}, 
+    },
+	/*disable cbc*/
+	{
+		{608,1130,650,1208,655,1216,652,1210,652,1212,658,1222,652,1212,655,1216,650,1208,655,1216,656,1218,668,1240,677,1257,673,1249,681,1265,691,1283,685,1273,713,1325,713,1325,723,1343,725,1347,731,1357,734,1362,739,1372,734,1362,747,1387,741,1375,776,1440,741,1375,776,1440}, 
+		{633,1175,670,1244,677,1257,671,1247,673,1249,678,1258,673,1251,677,1257,668,1240,677,1257,677,1257,704,1307,704,1307,704,1307,704,1307,712,1322,706,1310,723,1343,739,1372,743,1379,747,1387,756,1404,756,1404,774,1437,756,1404,774,1437,774,1437,791,1469,774,1437,791,1469}, 
+		{633,1175,668,1240,673,1249,669,1243,670,1244,675,1253,671,1247,673,1251,668,1240,673,1249,673,1251,685,1273,704,1307,704,1307,710,1318,708,1316,704,1307,721,1339,731,1357,741,1375,743,1379,747,1387,750,1394,756,1404,749,1391,762,1416,757,1405,783,1455,757,1405,783,1455}, 
+		{633,1175,668,1240,673,1249,669,1243,671,1247,678,1258,673,1249,675,1253,668,1240,673,1251,676,1255,688,1278,704,1307,704,1307,704,1307,710,1318,704,1307,722,1340,732,1359,741,1375,743,1379,757,1405,752,1396,753,1398,748,1390,762,1414,756,1404,783,1453,756,1404,783,1453}, 
+		{633,1175,668,1240,670,1244,668,1240,670,1244,675,1253,673,1249,673,1251,668,1240,671,1247,675,1253,687,1275,704,1307,704,1307,704,1307,708,1314,704,1307,721,1339,729,1355,739,1372,752,1396,745,1383,748,1390,752,1396,745,1383,760,1411,756,1404,777,1443,756,1404,777,1443}, 
+		{633,1175,664,1232,669,1243,668,1240,668,1240,673,1251,670,1244,671,1247,668,1240,670,1244,673,1249,685,1273,704,1307,704,1307,704,1307,706,1310,704,1307,718,1333,727,1351,739,1372,739,1372,743,1379,747,1387,748,1390,743,1379,756,1404,752,1396,774,1437,752,1396,774,1437}, 
+		{621,1153,662,1229,668,1240,668,1240,668,1240,673,1251,670,1244,671,1247,675,1253,670,1244,673,1249,685,1273,704,1307,704,1307,704,1307,706,1310,704,1307,718,1333,727,1351,739,1372,739,1372,743,1379,747,1387,748,1390,743,1379,757,1405,750,1394,774,1437,750,1394,774,1437}, 
+		{620,1151,668,1240,671,1247,668,1240,670,1244,677,1257,673,1249,673,1251,668,1240,673,1251,675,1253,688,1278,704,1307,704,1307,704,1307,708,1314,704,1307,721,1339,729,1355,747,1387,739,1372,743,1379,747,1387,750,1394,744,1382,757,1405,752,1396,774,1437,752,1396,774,1437}, 
+		{621,1153,668,1240,675,1253,670,1244,673,1251,678,1258,673,1251,677,1257,669,1243,685,1273,678,1258,704,1307,704,1307,704,1307,704,1307,710,1318,704,1308,721,1339,731,1357,739,1372,739,1373,743,1379,749,1391,750,1394,744,1382,757,1405,752,1396,774,1437,752,1396,774,1437}, 
+		{633,1175,668,1240,676,1255,673,1251,676,1255,681,1265,677,1257,679,1261,673,1249,677,1257,679,1261,704,1307,704,1307,704,1307,704,1308,723,1343,706,1312,723,1343,732,1359,739,1373,741,1375,745,1383,750,1394,752,1396,744,1382,756,1404,750,1394,774,1437,750,1394,774,1437}, 
+		{639,1187,671,1247,678,1258,675,1253,677,1257,683,1268,679,1261,680,1264,673,1251,679,1261,681,1265,704,1307,704,1307,704,1307,706,1310,713,1325,708,1314,723,1343,732,1359,741,1375,741,1377,745,1383,747,1387,749,1391,743,1379,756,1404,760,1412,762,1416,760,1412,762,1416}, 
+		{647,1201,675,1253,679,1261,677,1257,679,1261,685,1273,681,1265,683,1268,677,1257,681,1265,704,1307,704,1307,704,1307,704,1307,708,1314,716,1330,710,1318,725,1347,739,1372,741,1377,743,1379,747,1387,774,1437,750,1394,744,1382,756,1404,750,1394,762,1416,750,1394,762,1416}, 
+		{655,1216,678,1258,683,1269,680,1264,681,1265,688,1278,683,1268,685,1273,679,1261,685,1273,685,1273,704,1307,706,1310,704,1307,710,1318,718,1333,722,1340,727,1351,739,1372,744,1382,744,1382,748,1390,750,1394,752,1396,746,1386,758,1408,753,1398,774,1437,753,1398,774,1437}, 
+		{660,1226,681,1265,685,1273,681,1265,683,1268,704,1307,685,1273,687,1275,680,1264,685,1273,688,1278,704,1307,706,1312,704,1307,710,1318,718,1333,712,1322,727,1351,739,1372,744,1382,744,1382,748,1390,752,1396,752,1396,756,1404,760,1411,756,1404,774,1437,756,1404,774,1437}, 
+		{668,1240,685,1273,688,1278,704,1307,687,1275,704,1307,687,1275,704,1307,681,1265,688,1278,704,1307,706,1312,711,1320,706,1312,714,1326,721,1339,714,1326,732,1359,741,1377,748,1390,747,1387,753,1398,757,1405,758,1408,753,1398,774,1437,762,1414,791,1469,762,1414,791,1469}, 
+		{716,1330,716,1330,716,1330,701,1301,701,1301,712,1322,699,1297,716,1330,699,1297,699,1297,699,1297,716,1330,725,1347,721,1339,734,1362,734,1362,725,1347,734,1362,769,1429,760,1412,760,1412,764,1420,787,1461,764,1420,764,1420,769,1429,769,1429,800,1486,769,1429,800,1486}, 
+		{716,1330,716,1330,716,1330,701,1301,701,1301,712,1322,699,1297,716,1330,699,1297,699,1297,699,1297,716,1330,725,1347,721,1339,734,1362,734,1362,725,1347,734,1362,769,1429,760,1412,760,1412,764,1420,787,1461,764,1420,764,1420,769,1429,769,1429,800,1486,500,3000,500,3000},
+	}
+};
+
+
+const int16_t baseline_cap_data_old[2][TX_NUMBER][RX_NUMBER*2] =
+{
+    /*enable cbc*/
+    {
+		{557, 1035, 604, 1122, 605, 1123, 604, 1122, 608, 1130, 601, 1117, 608, 1130, 615, 1141, 613, 1139, 614, 1140, 610, 1132, 609, 1131, 620, 1151, 625, 1161, 638, 1184, 641, 1191, 648, 1203, 669, 1243, 661, 1227, 671, 1245, 676, 1256, 685, 1273, 690, 1282, 694, 1288, 689, 1279, 696, 1292, 696, 1292, 724, 1344, 682, 1266, 724, 1344},
+		{574, 1066, 622, 1154, 622, 1156, 620, 1151, 624, 1158, 618, 1148, 625, 1161, 631, 1173, 630, 1170, 630, 1170, 627, 1164, 624, 1160, 636, 1180, 641, 1191, 653, 1213, 656, 1218, 662, 1230, 676, 1255, 676, 1255, 687, 1275, 694, 1288, 703, 1305, 707, 1313, 721, 1339, 706, 1310, 711, 1321, 711, 1321, 734, 1364, 671, 1245, 694, 1288},
+		{573, 1065, 619, 1149, 618, 1148, 617, 1147, 620, 1152, 614, 1140, 622, 1154, 628, 1166, 629, 1167, 628, 1166, 623, 1157, 622, 1154, 633, 1175, 638, 1186, 661, 1227, 653, 1213, 660, 1226, 673, 1249, 673, 1249, 684, 1270, 690, 1282, 701, 1301, 704, 1307, 707, 1313, 701, 1303, 707, 1313, 707, 1313, 729, 1355, 666, 1238, 687, 1277},
+		{573, 1063, 616, 1144, 616, 1144, 614, 1140, 618, 1148, 611, 1135, 619, 1149, 624, 1160, 625, 1161, 625, 1161, 622, 1154, 620, 1152, 630, 1170, 637, 1183, 650, 1206, 652, 1210, 659, 1223, 670, 1244, 671, 1247, 683, 1268, 688, 1278, 706, 1312, 701, 1301, 704, 1308, 699, 1297, 704, 1308, 703, 1305, 724, 1344, 659, 1223, 673, 1249},
+		{573, 1063, 615, 1141, 615, 1141, 613, 1138, 616, 1144, 610, 1132, 618, 1148, 624, 1158, 624, 1158, 624, 1160, 622, 1154, 620, 1151, 630, 1170, 636, 1182, 648, 1204, 651, 1209, 659, 1223, 670, 1244, 671, 1245, 680, 1264, 696, 1292, 694, 1290, 699, 1297, 701, 1303, 696, 1292, 701, 1301, 699, 1297, 718, 1333, 649, 1205, 663, 1231},
+		{574, 1066, 615, 1143, 615, 1143, 613, 1139, 616, 1144, 610, 1134, 617, 1147, 624, 1158, 625, 1161, 625, 1161, 622, 1156, 622, 1154, 631, 1173, 646, 1200, 650, 1206, 651, 1209, 659, 1223, 671, 1247, 671, 1245, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1297, 694, 1288, 699, 1297, 697, 1295, 713, 1325, 645, 1199, 658, 1222},
+		{578, 1073, 617, 1147, 616, 1144, 615, 1141, 618, 1148, 611, 1135, 619, 1149, 625, 1161, 636, 1180, 628, 1166, 624, 1158, 624, 1158, 634, 1177, 638, 1186, 651, 1209, 652, 1212, 660, 1226, 673, 1249, 673, 1249, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1299, 694, 1290, 699, 1297, 697, 1294, 713, 1323, 643, 1193, 654, 1214},
+		{582, 1080, 619, 1149, 619, 1149, 616, 1144, 619, 1149, 613, 1139, 620, 1152, 627, 1165, 628, 1166, 629, 1167, 625, 1161, 624, 1160, 636, 1180, 641, 1191, 652, 1212, 655, 1216, 661, 1227, 673, 1251, 673, 1251, 692, 1284, 687, 1275, 693, 1287, 697, 1294, 699, 1299, 694, 1288, 699, 1297, 698, 1296, 713, 1325, 645, 1197, 655, 1216},
+		{583, 1083, 619, 1149, 618, 1148, 615, 1143, 620, 1151, 613, 1138, 620, 1152, 627, 1164, 627, 1165, 638, 1184, 624, 1160, 624, 1158, 634, 1178, 638, 1186, 652, 1210, 653, 1213, 660, 1226, 671, 1245, 671, 1245, 679, 1261, 683, 1269, 690, 1282, 694, 1288, 696, 1292, 690, 1281, 694, 1290, 693, 1287, 707, 1313, 649, 1205, 655, 1217},
+		{589, 1095, 623, 1157, 622, 1156, 619, 1149, 623, 1157, 616, 1144, 624, 1158, 630, 1170, 631, 1173, 631, 1173, 629, 1167, 627, 1165, 638, 1186, 643, 1193, 655, 1216, 666, 1236, 662, 1230, 673, 1251, 673, 1249, 680, 1264, 684, 1270, 692, 1284, 697, 1294, 697, 1295, 692, 1286, 697, 1295, 696, 1292, 707, 1313, 650, 1206, 655, 1216},
+		{594, 1104, 628, 1166, 624, 1160, 622, 1156, 627, 1164, 618, 1148, 627, 1164, 632, 1174, 634, 1177, 634, 1178, 630, 1170, 629, 1169, 641, 1190, 644, 1196, 656, 1218, 659, 1223, 664, 1234, 675, 1253, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 694, 1290, 697, 1295, 693, 1287, 699, 1299, 708, 1316, 710, 1318, 649, 1205, 652, 1210},
+		{597, 1109, 629, 1169, 628, 1166, 624, 1160, 628, 1166, 620, 1152, 627, 1165, 633, 1175, 634, 1178, 634, 1178, 641, 1191, 631, 1173, 641, 1191, 646, 1200, 659, 1223, 661, 1227, 666, 1236, 676, 1255, 676, 1256, 681, 1265, 685, 1273, 692, 1286, 713, 1325, 699, 1297, 694, 1288, 701, 1301, 701, 1301, 708, 1316, 646, 1200, 649, 1205},
+		{601, 1115, 630, 1170, 629, 1167, 625, 1161, 628, 1166, 620, 1151, 628, 1166, 633, 1175, 634, 1178, 636, 1180, 631, 1173, 630, 1170, 641, 1191, 646, 1200, 659, 1225, 660, 1226, 674, 1252, 676, 1255, 673, 1251, 680, 1264, 685, 1271, 692, 1286, 694, 1290, 698, 1296, 693, 1287, 699, 1299, 702, 1304, 713, 1323, 645, 1199, 647, 1201},
+		{606, 1125, 632, 1174, 629, 1169, 627, 1164, 629, 1169, 622, 1154, 629, 1167, 634, 1178, 634, 1178, 637, 1183, 633, 1175, 630, 1170, 642, 1192, 647, 1201, 659, 1223, 660, 1226, 666, 1236, 676, 1255, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 697, 1294, 701, 1301, 704, 1308, 702, 1304, 706, 1310, 718, 1334, 638, 1184, 641, 1190},
+		{613, 1138, 634, 1177, 631, 1173, 630, 1170, 632, 1174, 624, 1158, 633, 1175, 637, 1183, 638, 1186, 641, 1190, 636, 1180, 637, 1183, 645, 1199, 651, 1209, 662, 1229, 664, 1232, 670, 1244, 680, 1262, 680, 1262, 688, 1278, 692, 1284, 699, 1297, 704, 1307, 707, 1313, 704, 1307, 712, 1322, 715, 1329, 743, 1379, 643, 1193, 644, 1196},
+		{629, 1169, 639, 1187, 634, 1178, 629, 1169, 629, 1169, 620, 1152, 627, 1165, 641, 1191, 630, 1170, 633, 1175, 627, 1165, 624, 1160, 634, 1178, 639, 1187, 656, 1218, 652, 1210, 657, 1221, 667, 1239, 678, 1258, 673, 1251, 678, 1258, 685, 1271, 706, 1310, 692, 1284, 689, 1279, 697, 1294, 701, 1301, 727, 1349, 643, 1193, 644, 1196},
+		{757, 1407, 748, 1388, 705, 1309, 698, 1296, 686, 1274, 678, 1260, 685, 1271, 683, 1269, 661, 1227, 671, 1245, 655, 1217, 669, 1242, 659, 1223, 665, 1235, 665, 1235, 661, 1227, 649, 1205, 646, 1200, 641, 1191, 649, 1205, 664, 1232, 629, 1167, 645, 1199, 629, 1167, 645, 1199, 622, 1154, 629, 1167, 629, 1167, 500, 3000, 500, 3000},
+    },
+	//disable cbc
+    {
+		{557, 1035, 604, 1122, 605, 1123, 604, 1122, 608, 1130, 601, 1117, 608, 1130, 615, 1141, 613, 1139, 614, 1140, 610, 1132, 609, 1131, 620, 1151, 625, 1161, 638, 1184, 641, 1191, 648, 1203, 669, 1243, 661, 1227, 671, 1245, 676, 1256, 685, 1273, 690, 1282, 694, 1288, 689, 1279, 696, 1292, 696, 1292, 724, 1344, 682, 1266, 724, 1344},
+		{574, 1066, 622, 1154, 622, 1156, 620, 1151, 624, 1158, 618, 1148, 625, 1161, 631, 1173, 630, 1170, 630, 1170, 627, 1164, 624, 1160, 636, 1180, 641, 1191, 653, 1213, 656, 1218, 662, 1230, 676, 1255, 676, 1255, 687, 1275, 694, 1288, 703, 1305, 707, 1313, 721, 1339, 706, 1310, 711, 1321, 711, 1321, 734, 1364, 671, 1245, 694, 1288},
+		{573, 1065, 619, 1149, 618, 1148, 617, 1147, 620, 1152, 614, 1140, 622, 1154, 628, 1166, 629, 1167, 628, 1166, 623, 1157, 622, 1154, 633, 1175, 638, 1186, 661, 1227, 653, 1213, 660, 1226, 673, 1249, 673, 1249, 684, 1270, 690, 1282, 701, 1301, 704, 1307, 707, 1313, 701, 1303, 707, 1313, 707, 1313, 729, 1355, 666, 1238, 687, 1277},
+		{573, 1063, 616, 1144, 616, 1144, 614, 1140, 618, 1148, 611, 1135, 619, 1149, 624, 1160, 625, 1161, 625, 1161, 622, 1154, 620, 1152, 630, 1170, 637, 1183, 650, 1206, 652, 1210, 659, 1223, 670, 1244, 671, 1247, 683, 1268, 688, 1278, 706, 1312, 701, 1301, 704, 1308, 699, 1297, 704, 1308, 703, 1305, 724, 1344, 659, 1223, 673, 1249},
+		{573, 1063, 615, 1141, 615, 1141, 613, 1138, 616, 1144, 610, 1132, 618, 1148, 624, 1158, 624, 1158, 624, 1160, 622, 1154, 620, 1151, 630, 1170, 636, 1182, 648, 1204, 651, 1209, 659, 1223, 670, 1244, 671, 1245, 680, 1264, 696, 1292, 694, 1290, 699, 1297, 701, 1303, 696, 1292, 701, 1301, 699, 1297, 718, 1333, 649, 1205, 663, 1231},
+		{574, 1066, 615, 1143, 615, 1143, 613, 1139, 616, 1144, 610, 1134, 617, 1147, 624, 1158, 625, 1161, 625, 1161, 622, 1156, 622, 1154, 631, 1173, 646, 1200, 650, 1206, 651, 1209, 659, 1223, 671, 1247, 671, 1245, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1297, 694, 1288, 699, 1297, 697, 1295, 713, 1325, 645, 1199, 658, 1222},
+		{578, 1073, 617, 1147, 616, 1144, 615, 1141, 618, 1148, 611, 1135, 619, 1149, 625, 1161, 636, 1180, 628, 1166, 624, 1158, 624, 1158, 634, 1177, 638, 1186, 651, 1209, 652, 1212, 660, 1226, 673, 1249, 673, 1249, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1299, 694, 1290, 699, 1297, 697, 1294, 713, 1323, 643, 1193, 654, 1214},
+		{582, 1080, 619, 1149, 619, 1149, 616, 1144, 619, 1149, 613, 1139, 620, 1152, 627, 1165, 628, 1166, 629, 1167, 625, 1161, 624, 1160, 636, 1180, 641, 1191, 652, 1212, 655, 1216, 661, 1227, 673, 1251, 673, 1251, 692, 1284, 687, 1275, 693, 1287, 697, 1294, 699, 1299, 694, 1288, 699, 1297, 698, 1296, 713, 1325, 645, 1197, 655, 1216},
+		{583, 1083, 619, 1149, 618, 1148, 615, 1143, 620, 1151, 613, 1138, 620, 1152, 627, 1164, 627, 1165, 638, 1184, 624, 1160, 624, 1158, 634, 1178, 638, 1186, 652, 1210, 653, 1213, 660, 1226, 671, 1245, 671, 1245, 679, 1261, 683, 1269, 690, 1282, 694, 1288, 696, 1292, 690, 1281, 694, 1290, 693, 1287, 707, 1313, 649, 1205, 655, 1217},
+		{589, 1095, 623, 1157, 622, 1156, 619, 1149, 623, 1157, 616, 1144, 624, 1158, 630, 1170, 631, 1173, 631, 1173, 629, 1167, 627, 1165, 638, 1186, 643, 1193, 655, 1216, 666, 1236, 662, 1230, 673, 1251, 673, 1249, 680, 1264, 684, 1270, 692, 1284, 697, 1294, 697, 1295, 692, 1286, 697, 1295, 696, 1292, 707, 1313, 650, 1206, 655, 1216},
+		{594, 1104, 628, 1166, 624, 1160, 622, 1156, 627, 1164, 618, 1148, 627, 1164, 632, 1174, 634, 1177, 634, 1178, 630, 1170, 629, 1169, 641, 1190, 644, 1196, 656, 1218, 659, 1223, 664, 1234, 675, 1253, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 694, 1290, 697, 1295, 693, 1287, 699, 1299, 708, 1316, 710, 1318, 649, 1205, 652, 1210},
+		{597, 1109, 629, 1169, 628, 1166, 624, 1160, 628, 1166, 620, 1152, 627, 1165, 633, 1175, 634, 1178, 634, 1178, 641, 1191, 631, 1173, 641, 1191, 646, 1200, 659, 1223, 661, 1227, 666, 1236, 676, 1255, 676, 1256, 681, 1265, 685, 1273, 692, 1286, 713, 1325, 699, 1297, 694, 1288, 701, 1301, 701, 1301, 708, 1316, 646, 1200, 649, 1205},
+		{601, 1115, 630, 1170, 629, 1167, 625, 1161, 628, 1166, 620, 1151, 628, 1166, 633, 1175, 634, 1178, 636, 1180, 631, 1173, 630, 1170, 641, 1191, 646, 1200, 659, 1225, 660, 1226, 674, 1252, 676, 1255, 673, 1251, 680, 1264, 685, 1271, 692, 1286, 694, 1290, 698, 1296, 693, 1287, 699, 1299, 702, 1304, 713, 1323, 645, 1199, 647, 1201},
+		{606, 1125, 632, 1174, 629, 1169, 627, 1164, 629, 1169, 622, 1154, 629, 1167, 634, 1178, 634, 1178, 637, 1183, 633, 1175, 630, 1170, 642, 1192, 647, 1201, 659, 1223, 660, 1226, 666, 1236, 676, 1255, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 697, 1294, 701, 1301, 704, 1308, 702, 1304, 706, 1310, 718, 1334, 638, 1184, 641, 1190},
+		{613, 1138, 634, 1177, 631, 1173, 630, 1170, 632, 1174, 624, 1158, 633, 1175, 637, 1183, 638, 1186, 641, 1190, 636, 1180, 637, 1183, 645, 1199, 651, 1209, 662, 1229, 664, 1232, 670, 1244, 680, 1262, 680, 1262, 688, 1278, 692, 1284, 699, 1297, 704, 1307, 707, 1313, 704, 1307, 712, 1322, 715, 1329, 743, 1379, 643, 1193, 644, 1196},
+		{629, 1169, 639, 1187, 634, 1178, 629, 1169, 629, 1169, 620, 1152, 627, 1165, 641, 1191, 630, 1170, 633, 1175, 627, 1165, 624, 1160, 634, 1178, 639, 1187, 656, 1218, 652, 1210, 657, 1221, 667, 1239, 678, 1258, 673, 1251, 678, 1258, 685, 1271, 706, 1310, 692, 1284, 689, 1279, 697, 1294, 701, 1301, 727, 1349, 643, 1193, 644, 1196},
+		{757, 1407, 748, 1388, 705, 1309, 698, 1296, 686, 1274, 678, 1260, 685, 1271, 683, 1269, 661, 1227, 671, 1245, 655, 1217, 669, 1242, 659, 1223, 665, 1235, 665, 1235, 661, 1227, 649, 1205, 646, 1200, 641, 1191, 649, 1205, 664, 1232, 629, 1167, 645, 1199, 629, 1167, 645, 1199, 622, 1154, 629, 1167, 629, 1167, 500, 3000, 500, 3000},
+    }
+
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..2e3cee66d1ee4c8f579942277908d7c97c112e6b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+config TOUCHPANEL_SYNAPTICS_S4322
+#	default y
+	bool "TP Synaptics_S3508 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics S3320
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..d7dc1e4f6473d2e54954d5703ef94d1f62770f2f
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_S4322) += synaptics_drivers_s4322.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_drivers_s4322.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_drivers_s4322.c
new file mode 100644
index 0000000000000000000000000000000000000000..ec0dca06845217dd8d4b84ab0917880c38a7eb50
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_drivers_s4322.c
@@ -0,0 +1,2695 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+ * File       : synaptics_drivers_s4322.c
+ * Description: Source file for synaptics S4322 driver
+ * Version   : 1.0
+ * Date        : 2017-04-17
+ * Author    : MingQiang.Guo@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2017-04-17, MingQiang.Guo@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/326176)
+ ****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "synaptics_s4322.h"
+
+static struct chip_data_s4322 *g_chip_info = NULL;
+
+#define OPPO17001TRULY_TD4322_1080P_CMD_PANEL 29
+
+/*******Part0:LOG TAG Declear********************/
+#define TPD_DEVICE "synaptics-s4322"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+/*******Part1: Function Declearation*******/
+static int synaptics_power_control(void *chip_data, bool enable);
+static int synaptics_get_chip_info(void *chip_data);
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag);
+static int checkCMD(struct chip_data_s4322 *chip_info);
+
+/*******Part2:Call Back Function implement*******/
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i, obj_attention;
+    unsigned char fingers_to_process = max_num;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    char buf[8*max_num];
+
+    memset(buf, 0, sizeof(buf));
+    obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+    for (i = 9;  ; i--) {
+        if ((obj_attention & 0x03FF) >> i  || i == 0)
+            break;
+        else
+            fingers_to_process--;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+    if (ret < 0) {
+        TPD_INFO("touch i2c read block failed\n");
+        return -1;
+    }
+    for (i = 0; i < fingers_to_process; i++) {
+        points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+        points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+        points[i].z = buf[i*8 + 5];
+        points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+        points[i].status = buf[i*8];
+    }
+
+    return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    chip_info->p_tp_fw = &panel_data->TP_FW;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_s4322 *chip_info)
+{
+    uint8_t buf[4] = {0};
+    int ret = 0;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+    chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+    chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+    chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+    TPD_INFO("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE    = %x \n\
+            F54_CTRL_BASE   = %x \n\
+            F54_DATA_BASE   = %x \n",
+            chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+            chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+
+    return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+    uint8_t buf[4] = {0};
+    int ret;
+    struct chip_data_s4322    *chip_info = (struct chip_data_s4322 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    memset(buf, 0, sizeof(buf));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    reg_info->F12_2D_QUERY_BASE = buf[0];
+    reg_info->F12_2D_CMD_BASE = buf[1];
+    reg_info->F12_2D_CTRL_BASE = buf[2];
+    reg_info->F12_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+            F12_2D_CMD_BASE    = 0x%x \n\
+            F12_2D_CTRL_BASE   = 0x%x \n\
+            F12_2D_DATA_BASE   = 0x%x \n",
+            reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+            reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+    reg_info->F01_RMI_QUERY_BASE = buf[0];
+    reg_info->F01_RMI_CMD_BASE = buf[1];
+    reg_info->F01_RMI_CTRL_BASE = buf[2];
+    reg_info->F01_RMI_DATA_BASE = buf[3];
+    TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+            F01_RMI_CMD_BASE    = 0x%x \n\
+            F01_RMI_CTRL_BASE   = 0x%x \n\
+            F01_RMI_DATA_BASE   = 0x%x \n",
+            reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+            reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F34_FLASH_QUERY_BASE = buf[0];
+    reg_info->F34_FLASH_CMD_BASE = buf[1];
+    reg_info->F34_FLASH_CTRL_BASE = buf[2];
+    reg_info->F34_FLASH_DATA_BASE = buf[3];
+    TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+            F34_FLASH_CMD_BASE      = 0x%x \n\
+            F34_FLASH_CTRL_BASE     = 0x%x \n\
+            F34_FLASH_DATA_BASE     = 0x%x \n",
+            reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+            reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+    reg_info->F01_RMI_QUERY11 = reg_info->F01_RMI_QUERY_BASE + 0x0b;    // product id
+    reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+    reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+    reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+    reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;
+    reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+    reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;               // max XY Coordinate
+    reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 8;           //glove enable
+
+    reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 1;           //gesture type
+    reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 2;           //object attention
+    reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;
+    reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x06;        //motion suppression
+    reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x0b;        // wakeup Gesture enable
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+    reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+    reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+    reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+    TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+            F51_CUSTOM_CMD_BASE     = 0x%x \n\
+            F51_CUSTOM_CTRL_BASE    = 0x%x \n\
+            F51_CUSTOM_DATA_BASE    = 0x%x \n",
+            reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+            reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+    reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;       //no use
+    reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;       //wakeup gesture data
+    reg_info->F51_CUSTOM_GRIP_CTRL = reg_info->F51_CUSTOM_CTRL_BASE + 0x1D;//edge function register,the enable bit of Grip suppression
+    reg_info->F51_CUSTOM_CTRL48 = reg_info->F51_CUSTOM_CTRL_BASE + 0x2B;
+
+    synaptics_read_F54_base_reg(chip_info);
+    reg_info->F54_ANALOG_CTRL91 = reg_info->F54_ANALOG_CONTROL_BASE + 0x28;
+    reg_info->F54_ANALOG_CTRL99 = reg_info->F54_ANALOG_CONTROL_BASE + 0x2d;
+    reg_info->F54_ANALOG_CTRL182 = reg_info->F54_ANALOG_CONTROL_BASE + 0x32;
+    reg_info->F54_ANALOG_CTRL225 = reg_info->F54_ANALOG_CONTROL_BASE + 0x37;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x3);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F55_SENSOR_QUERY_BASE = buf[0];
+    reg_info->F55_SENSOR_CMD_BASE   = buf[1];
+    reg_info->F55_SENSOR_CTRL_BASE  = buf[2];
+    reg_info->F55_SENSOR_DATA_BASE  = buf[3];
+    TPD_INFO("F55_SENSOR_QUERY_BASE  = 0x%x \n\
+            F55_SENSOR_CMD_BASE     = 0x%x \n\
+            F55_SENSOR_CTRL_BASE    = 0x%x \n\
+            F55_SENSOR_DATA_BASE    = 0x%x \n\
+            edge function register: F51_CUSTOM_GRIP_CTRL = 0x%x ",
+            reg_info->F55_SENSOR_QUERY_BASE, reg_info->F55_SENSOR_CMD_BASE,
+            reg_info->F55_SENSOR_CTRL_BASE,  reg_info->F55_SENSOR_DATA_BASE,
+            reg_info->F51_CUSTOM_GRIP_CTRL);
+
+    reg_info->F55_SENSOR_CTRL43 = reg_info->F55_SENSOR_CTRL_BASE + 5;
+    reg_info->F55_SENSOR_CTRL01 = 0x01;      //rx  number
+    reg_info->F55_SENSOR_CTRL02 = 0x02;      //tx  number
+    // select page 0
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+/**
+ * synaptics_get_fw_id -   get device fw id.
+ * @chip_info: struct include i2c resource.
+ * Return fw version result.
+ */
+static uint32_t synaptics_get_fw_id(struct chip_data_s4322 *chip_info)
+{
+    uint8_t buf[4];
+    uint32_t current_firmware = 0;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint32_t bootloader_mode;
+    int max_y_ic = 0;
+    int max_x_ic = 0;
+    uint8_t buf[4];
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    TPD_INFO("chip_info->reg_info.F01_RMI_DATA_BASE =  0x%x , bootloader_mode = 0x%x\n", chip_info->reg_info.F01_RMI_DATA_BASE, bootloader_mode);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/**
+ * synaptics_enable_interrupt -   Device interrupt ability control.
+ * @chip_info: struct include i2c resource.
+ * @enable: disable or enable control purpose.
+ * Return  0: succeed, -1: failed.
+ */
+static int synaptics_enable_interrupt(struct chip_data_s4322 *chip_info, bool enable)
+{
+    int ret;
+    uint8_t abs_status_int;
+
+    TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00 + 1, abs_status_int);
+    if (ret < 0) {
+        TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+
+    return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    uint8_t device_status = 0;
+    uint8_t interrupt_status = 0;
+    u8 result_event = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+#ifdef CONFIG_SYNAPTIC_RED
+    if (chip_info->enable_remote)
+        return IRQ_IGNORE;
+#endif
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+        return IRQ_EXCEPTION;
+    }
+    device_status = ret & 0xff;
+    interrupt_status = (ret & 0x7f00) >> 8;
+
+    if (device_status) {
+        TPD_INFO("%s, IRQ_EXCEPTION ,interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+        return IRQ_EXCEPTION;
+    } else {
+        TPD_DEBUG("%s, interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+    }
+    if (interrupt_status & 0x04) {
+        if ((gesture_enable == 1) && is_suspended) {
+            return IRQ_GESTURE;
+        }
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+    if (interrupt_status & 0x20) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+    if (interrupt_status & 0x02) {
+        SET_BIT(result_event, IRQ_FW_AUTO_RESET);
+        TPD_INFO("%s, tp fw auto reset detect, interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+    }
+    return  result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio \n");
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+
+    return 0;
+}
+
+static void synaptics_exit_esd_mode(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return ;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CMD_BASE, 0x2);
+    if (ret < 0) {
+        TPD_INFO("exit esd mode error\n");
+        return;
+    }
+    TPD_INFO("exit esd mode ok\n");
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+    }
+}
+
+/*
+ * return success: 0 ; fail : negative
+ */
+static int synaptics_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    clear_view_touchdown_flag(); //clear touch download flag
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+    msleep(RESET_TO_NORMAL_TIME);
+
+    //exit esd mode
+    synaptics_exit_esd_mode(chip_data);
+
+    return ret;
+}
+
+static int synaptics_configuration_init(struct chip_data_s4322 *chip_info, bool config)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    //device control: normal operation
+    if (config) {//configed  && out of sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    } else {//sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x81);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_s4322 *chip_info, bool enable)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+        return ret;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_s4322 *chip_info, bool enable)
+{
+    int ret;
+    unsigned char report_gesture_ctrl_buf[3];
+    unsigned char wakeup_gesture_enable_buf;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x3);         //set doze interval to 30ms
+    } else  {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x1);         //set doze interval to 10ms
+    }
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    if (report_gesture_ctrl_buf[2] & 0x02) {
+        TPD_INFO("Black gesture already open,can not write black gesture regiseter in suspend\n");
+        return 0;
+    }
+    if (enable) {
+        report_gesture_ctrl_buf[2] |= 0x02 ;
+    } else  {
+        report_gesture_ctrl_buf[2] &= 0xfd ;
+    }
+
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    wakeup_gesture_enable_buf = 0xef;   // all kinds of gesture except triangle
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL27, wakeup_gesture_enable_buf);
+
+    return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_s4322 *chip_info, bool enable)
+{
+    int ret;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL);
+    if (enable) {
+        ret |= 0x01;
+    } else  {
+        ret &= 0xfe;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL, ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL);
+    TPD_INFO("%s %s, write back value = 0x%x\n", enable ? "enable" : "disable", __func__, ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    return ret;
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = synaptics_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = synaptics_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            ret = synaptics_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            /*device control: sleep mode*/
+            ret = synaptics_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = synaptics_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+            ret = synaptics_glove_mode_enable(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable glove mode failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_EDGE:
+            ret = synaptics_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = 0, i, gesture_sign, regswipe;
+    uint8_t gesture_buffer[10];
+    uint8_t coordinate_buf[25] = {0};
+    uint16_t trspoint = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    regswipe = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 0x18);
+
+    TPD_DEBUG("gesture_buffer[0] = 0x%x, regswipe = 0x%x, gesture_buffer[1] = 0x%x, gesture_buffer[4] = 0x%x\n",
+            gesture_buffer[0], regswipe, gesture_buffer[1], gesture_buffer[4]);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    gesture_sign = gesture_buffer[0];
+
+    //detect the gesture mode
+    switch (gesture_sign)
+    {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case SWIPE_DETECT:
+            gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                (regswipe == 0x42) ? Right2LeftSwip   :
+                (regswipe == 0x44) ? Up2DownSwip      :
+                (regswipe == 0x48) ? Down2UpSwip      :
+                (regswipe == 0x80) ? DouSwip          :
+                UnkownGesture;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            break;
+        case VEE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                (gesture_buffer[2] == 0x02) ? UpVee    :
+                (gesture_buffer[2] == 0x04) ? RightVee :
+                (gesture_buffer[2] == 0x08) ? LeftVee  :
+                UnkownGesture;
+            break;
+        case UNICODE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x77 && gesture_buffer[3] == 0x00) ? Wgestrue :
+                (gesture_buffer[2] == 0x6d && gesture_buffer[3] == 0x00) ? Mgestrue :
+                UnkownGesture;
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+    TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d\n", __func__, gesture_sign, gesture->gesture_type);
+
+    if (gesture->gesture_type != UnkownGesture) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA,      8, &(coordinate_buf[0]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 8,  8, &(coordinate_buf[8]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 16, 8, &(coordinate_buf[16]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 24, 1, &(coordinate_buf[24]));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        for (i = 0; i < 23; i += 2) {
+            trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+            TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+        }
+
+        TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+        gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+        gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+        gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+        gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+        gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+        gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+        gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+        gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+        gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+        gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+        gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+        gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+        gesture->clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+            (coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+    }
+
+    return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        synaptics_resetgpio_set(chip_info->hw_res, true);
+        msleep(RESET_TO_NORMAL_TIME);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return ret;
+}
+
+static int checkCMD(struct chip_data_s4322 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < 30));
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+    return ret;
+}
+
+static int checkCMD_for_finger(struct chip_data_s4322 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    if (chip_info->p_spuri_fp_touch == NULL) {
+        TPD_INFO("checkCMD_for_finger() chip_info->p_spuri_fp_touch == NULL\n");
+        return -1;
+    }
+
+    do {
+        msleep(10); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+    }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+    TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    if (SPURIOUS_FP_BASE_DATA_RETRY == flag_err) {
+        TPD_INFO("checkCMD_for_finger error,reset  then msleep(80)\n");
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+        synaptics_reset(chip_info);
+        msleep(80);
+        synaptics_mode_switch(chip_info, MODE_NORMAL, true);
+        return -1;
+    } else {
+        TPD_INFO("checkCMD_for_finger ok\n");
+        return 0;
+    }
+}
+
+static short find_median(short* pdata, int num)
+{
+    int i,j;
+    short temp;
+    short *value;
+    short median;
+
+    value = (short *)kzalloc( num * sizeof(short), GFP_KERNEL);
+
+    for (i = 0; i < num; i++)
+        *(value+i) = *(pdata+i);
+
+    //sorting
+    for ( i = 1; i <= num-1; i++)
+    {
+        for ( j = 1; j <= num-i; j++)
+        {
+            if (*(value + j - 1) <= *(value + j))
+            {
+               temp = *(value + j - 1);
+               *(value + j - 1)= *(value + j);
+               *(value + j) = temp;
+            }
+            else
+                continue ;
+        }
+    }
+
+    //calculation of median
+    if ( num % 2 == 0)
+        median = (*(value + (num/2 - 1)) + *(value + (num / 2))) / 2;
+    else
+        median = *(value + (num/2));
+
+    if(value)
+        kfree(value);
+
+    return median;
+}
+
+static int tddi_ratio_calculation(signed short *p_image,  struct f55_control_43 *p_ctrl_43, int tx, int rx)
+{
+    int retval = 0;
+    int i, j;
+    int tx_num = tx;
+    int rx_num = rx;
+    unsigned char left_size = p_ctrl_43->afe_l_mux_size;
+    unsigned char right_size = p_ctrl_43->afe_r_mux_size;
+    signed short *p_data_16;
+    signed short *p_left_median = NULL;
+    signed short *p_right_median = NULL;
+    signed short *p_left_column_buf = NULL;
+    signed short *p_right_column_buf = NULL;
+    signed int temp;
+
+    if (!p_image) {
+        TPD_INFO("%s: Fail. p_image is null\n", __func__);
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    // allocate the buffer for the median value in left/right half
+    p_right_median = (signed short *) kzalloc(rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_right_median) {
+        TPD_INFO("%s: Failed to alloc mem for p_right_median\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_left_median = (signed short *) kzalloc(rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_left_median) {
+        TPD_INFO("%s: Failed to alloc mem for p_left_median\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_right_column_buf = (signed short *) kzalloc(right_size * rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_right_column_buf ) {
+        TPD_INFO("%s: Failed to alloc mem for p_right_column_buf\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_left_column_buf = (signed short *) kzalloc(left_size * rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_left_column_buf ) {
+        TPD_INFO("%s: Failed to alloc mem for p_left_column_buf\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    // divide the input image into left/right parts
+    if (p_ctrl_43->swap_sensor_side) {
+
+        // first row is left side data
+        p_data_16 = p_image;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < left_size; j++) {
+                p_left_column_buf[i * left_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+        // right side data
+        p_data_16 = p_image + left_size * rx_num;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < right_size; j++) {
+                p_right_column_buf[i * right_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+    }
+    else {
+
+        // first row is right side data
+        p_data_16 = p_image;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < right_size; j++) {
+                p_right_column_buf[i * right_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+        // left side data
+        p_data_16 = p_image + right_size * rx_num;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < left_size; j++) {
+                p_left_column_buf[i * left_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+    }
+
+    // find the median in every column
+    for (i = 0; i < rx_num; i++) {
+        p_left_median[i] = find_median(p_left_column_buf + i * left_size, left_size);
+        p_right_median[i] = find_median(p_right_column_buf + i * right_size, right_size);
+    }
+
+    // walk through the image of all data
+    // and calculate the ratio by using the median
+    for (i = 0; i < tx_num; i++) {
+        for (j = 0; j < rx_num; j++) {
+
+            // calcueate the ratio
+            if (p_ctrl_43->swap_sensor_side) {
+                // first row is left side
+                if (i < left_size) {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_left_median[j];
+                } else {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_right_median[j];
+                }
+            }
+            else {
+                // first row is right side
+                if (i < right_size) {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_right_median[j];
+                } else {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_left_median[j];
+                }
+            }
+
+            // replace the original data with the calculated ratio
+            p_image[i * rx_num + j] = temp;
+        }
+    }
+
+exit:
+    kfree(p_right_median);
+    kfree(p_left_median);
+    kfree(p_right_column_buf);
+    kfree(p_left_column_buf);
+    return retval;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static int synaptics_int_pin_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int eint_status, eint_count = 0, read_gpio_num = 10;
+
+    TPD_INFO("%s, step 0: begin to check INT-GND short item\n", __func__);
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        seq_printf(s, "TP EINT direct stort\n");
+        store_to_file(syna_testdata->fd, "eint_status is low, TP EINT direct stort, \n");
+        eint_count = 0;
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_RT92_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t *baseline_data_test = NULL;
+    uint16_t baseline_data;
+    uint8_t x, y;
+    uint16_t z;
+    uint8_t tmp_arg1;
+    uint8_t tmp_arg2;
+    int error_count = 0;
+    int count = 0;
+    int tx_2d_num = syna_testdata->TX_NUM - 1;
+
+    struct test_header *ph = (struct test_header *)(syna_testdata->fw->data);
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct i2c_client *client = chip_info->client;
+
+    store_to_file(syna_testdata->fd, "RT92:\n");
+
+    TPD_INFO("\n step 1:Close CBC and test RT92\n");
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        store_to_file(syna_testdata->fd, "I2C read error\n");
+        return TEST_FAIL;
+    }
+
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        seq_printf(s, "RT92: failed to alloc memory\n");
+        store_to_file(syna_testdata->fd, "failed to alloc memory\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                store_to_file(syna_testdata->fd, "%d, ", baseline_data);
+            }
+
+            if ((x < tx_2d_num) && (y < syna_testdata->RX_NUM)) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                if ((baseline_data < *(baseline_data_test + count*2))
+                 || (baseline_data > *(baseline_data_test + count*2 + 1))) {
+                    seq_printf(s, "step 1:test RT92 error,"
+                                  "baseline_data[%d][%d] = %d[%d, %d]\n",
+                                  x, y, baseline_data,
+                                  *(baseline_data_test + count*2),
+                                  *(baseline_data_test + count*2 + 1));
+                    TPD_INFO("step 1:test RT92 error,"
+                             "baseline_data[%d][%d] = %d[%d, %d]\n",
+                             x, y, baseline_data,
+                             *(baseline_data_test + count*2),
+                             *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    if (tp_debug != 2) {
+                        goto END;
+                    }
+                }
+            } else if ((x == tx_2d_num) && (y < 2)) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+
+                if (((baseline_data) < *(baseline_data_test + count*2))
+                 || ((baseline_data) > *(baseline_data_test + count*2 + 1))) {
+                    seq_printf(s, "step 1:test RT92 error,"
+                                  "touch key baseline_data[%d][%d] = %d[%d, %d]\n",
+                                  x, y, baseline_data,
+                                  *(baseline_data_test + count*2),
+                                  *(baseline_data_test + count*2 + 1));
+                    TPD_INFO("step 1:test RT92 error,"
+                             "touch key baseline_data[%d][%d] = %d[%d, %d]\n",
+                             x, y, baseline_data,
+                             *(baseline_data_test + count*2),
+                             *(baseline_data_test + count*2 + 1));
+                    error_count++;
+                    if (tp_debug != 2) {
+                        goto END;
+                    }
+                }
+            }
+            count++;
+        }
+
+        TPD_DEBUG_NTAG("\n");
+        if (syna_testdata->fd >= 0) {
+            store_to_file(syna_testdata->fd, "\n");
+        }
+    }
+    if (syna_testdata->fd >= 0) {
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+END:
+    if (raw_data) {
+        kfree(raw_data);
+    }
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+    return TEST_PASS;
+}
+static int synaptics_tddi_RT92_doze_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t *baseline_data_test = NULL;
+    uint16_t baseline_data;
+    uint8_t x, y;
+    uint16_t z;
+    uint8_t tmp_arg1;
+    uint8_t tmp_arg2;
+    int tx_2d_num = syna_testdata->TX_NUM - 1;
+    int error_count = 0;
+    struct test_header *ph = (struct test_header *)(syna_testdata->fw->data);
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct i2c_client *client = chip_info->client;
+
+    store_to_file(syna_testdata->fd, "RT92 doze:\n");
+
+    TPD_INFO("\n step 5:RT92 doze test\n");
+    TPD_INFO("Force Doze Mode:\r\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CTRL225, 0x01);//Force Doze
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        store_to_file(syna_testdata->fd, "I2C read error\n");
+        return TEST_FAIL;
+    }
+
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        seq_printf(s, "RT92: failed to alloc memory\n");
+        store_to_file(syna_testdata->fd, "failed to alloc memory\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                store_to_file(syna_testdata->fd, "%d, ", baseline_data);
+            }
+
+            if (((x < 2) && (y < syna_testdata->RX_NUM ))
+               || ((x == tx_2d_num ) && (y == 0))) {
+                TPD_DEBUG_NTAG("%d, ", baseline_data);
+                if ((baseline_data < LIMIT_DOZE_LOW) || (baseline_data > LIMIT_DOZE_HIGH)){
+                    seq_printf(s, "step 5:RT92 doze test error,"
+                                  "baseline_data[%d][%d] = %d[%d, %d]\n",
+                                  x, y, baseline_data, LIMIT_DOZE_LOW, LIMIT_DOZE_HIGH);
+                    TPD_INFO("step 5:RT92 doze test error,"
+                             "baseline_data[%d][%d] = %d[%d, %d]\n",
+                             x, y, baseline_data, LIMIT_DOZE_LOW, LIMIT_DOZE_HIGH);
+                    error_count++;
+                    if (tp_debug != 2) {
+                        goto END;
+                    }
+                }
+            }
+        }
+
+        TPD_DEBUG_NTAG("\n");
+        if (syna_testdata->fd >= 0) {
+            store_to_file(syna_testdata->fd, "\n");
+        }
+    }
+    if (syna_testdata->fd >= 0) {
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+END:
+    if (raw_data) {
+        kfree(raw_data);
+    }
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_open_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    int x, y, z;
+    uint8_t buffer[9];
+    uint8_t *raw_data = NULL;
+    uint8_t *raw_data_2 = NULL;
+    int tx_2d_num = syna_testdata->TX_NUM - 1;
+    uint16_t *baseline_data_test = NULL;
+    uint16_t baseline_data;
+    signed short *raw_data_delta_image = NULL;
+    uint8_t tmp_arg1, tmp_arg2;
+    int error_count = 0;
+
+    struct f54_control_91  original_f54_ctrl91;
+    struct f54_control_99  original_f54_ctrl99;
+    struct f54_control_182 original_f54_ctrl182;
+    struct f55_control_43  ctrl_43;
+
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct test_header *ph = (struct test_header *)(syna_testdata->fw->data);
+
+    TPD_INFO("\n step 2 open test \n");
+
+    store_to_file(syna_testdata->fd, "Open Test:\n");
+    synaptics_read_F54_base_reg(chip_info);
+
+    /* keep the original reference high/low capacitance */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl91\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl91");
+        return TEST_FAIL;
+    }
+    /* keep the original integration and reset duration */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl99\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl99");
+        return TEST_FAIL;
+    }
+    /* keep the original timing control */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl182\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl182");
+        return TEST_FAIL;
+    }
+
+    /* 1 Wide refcap hi/ lo and feedback, Write 0x0F to F54_ANALOG_CTRL91 */
+    buffer[0] = 0x0f;
+    buffer[1] = 0x0f;
+    buffer[2] = 0x0f;
+    buffer[3] = original_f54_ctrl91.reference_receiver_feedback_capacitance;
+    buffer[4] = original_f54_ctrl91.gain_ctrl;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, 5, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL91 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL91 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl191");
+        return TEST_FAIL;
+    }
+
+    /* 2 Increase RST_DUR to 1.53us, Write 0x5c to F54_ANALOG_CTRL99 */
+    buffer[0] = original_f54_ctrl99.integration_duration_lsb;
+    buffer[1] = original_f54_ctrl99.integration_duration_msb;
+    buffer[2] = 0x5c;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL99 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL99 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl199");
+        return TEST_FAIL;
+    }
+
+    /* 3 Write 0x02 to F54_ANALOG_CTRL182 (00)/00 and (00)/02 */
+    buffer[0] = ELEC_OPEN_TEST_TX_ON_COUNT;                 //cbc_timing_ctrl_tx_lsb
+    buffer[1] = (ELEC_OPEN_TEST_TX_ON_COUNT >> 8) & 0xff;   //cbc_timing_ctrl_tx_msb
+    buffer[2] = ELEC_OPEN_TEST_RX_ON_COUNT;                 //cbc_timing_ctrl_rx_lsb
+    buffer[3] = (ELEC_OPEN_TEST_RX_ON_COUNT >> 8) & 0xff;   //cbc_timing_ctrl_rx_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, 4, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL182 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL182 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl82");
+        return TEST_FAIL;
+    }
+
+    /* 4 Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    buffer[0] = ELEC_OPEN_INT_DUR_ONE;                      //integration_duration_lsb
+    buffer[1] = (ELEC_OPEN_INT_DUR_ONE >> 8) & 0xff;        //integration_duration_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE error\n");
+        seq_printf(s, "step 2 open Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE error\n");
+        store_to_file(syna_testdata->fd, "Failed to change OPEN INT\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    /* 5 Capture raw capacitance (rt92) image 1 */
+    /* Run Report Type 92 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Capture raw capacitance (rt92) image 1 error\n");
+        seq_printf(s, "step 2 open test: Capture raw capacitance (rt92) image 1 error\n");
+        store_to_file(syna_testdata->fd, "Failed to capture raw rt92\n");
+        return TEST_FAIL;
+    }
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("failed to alloc memory\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "no more memory\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+
+    /* 6 Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    buffer[0] = ELEC_OPEN_INT_DUR_TWO;                      //integration_duration_lsb
+    buffer[1] = (ELEC_OPEN_INT_DUR_TWO >> 8) & 0xff;        //integration_duration_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO  error\n");
+        seq_printf(s, "step 2 open test: Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO  error\n");
+        store_to_file(syna_testdata->fd, "failed to Change Int\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    /* 7 Capture raw capacitance (rt92) image 2 */
+    /* Run Report Type 92 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Capture raw capacitance (rt92) image 2 error\n");
+        seq_printf(s, "step 2 open test: Capture raw capacitance (rt92) image 2 error\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    raw_data_2 = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data_2) {
+        TPD_INFO("failed to alloc memory\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "No more memory\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    raw_data_delta_image = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!raw_data_delta_image) {
+        TPD_INFO("raw_data_delta_image kzalloc error\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "No more memory\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    baseline_data_test = (uint16_t *)(syna_testdata->fw->data + ph->array_limit_offset);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data_2);     //read data
+
+    /* 8 generate the delta image, which is equeal to image2 - image1 */
+    /* unit is femtofarad (fF) */
+    TPD_DEBUG_NTAG("----------- delta data ---------- \n ");
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            tmp_arg1 = raw_data_2[z*2] & 0xff;
+            tmp_arg2 = raw_data_2[z*2 + 1] & 0xff;
+            raw_data_delta_image[z] = ((tmp_arg2 << 8) | tmp_arg1) - baseline_data;
+            TPD_DEBUG_NTAG("%4d ", raw_data_delta_image[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    /* 9 restore the original configuration */
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl91\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl99\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl182\n",__func__);
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    store_to_file(syna_testdata->fd, "Open Test Limit 1:  > %d ok\n", ELEC_OPEN_TEST_LIMIT_ONE);
+
+    /* 10 phase 1, data verification */
+    /* the delta value should be lower than the test limit */
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", raw_data_delta_image[x * syna_testdata->RX_NUM + y]);
+            if (x < tx_2d_num && raw_data_delta_image[x * syna_testdata->RX_NUM + y] < ELEC_OPEN_TEST_LIMIT_ONE) {
+                TPD_INFO("step 2 open test: (%2d,%2d) = %4d < ELEC_OPEN_TEST_LIMIT_ONE(%d) fail\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], ELEC_OPEN_TEST_LIMIT_ONE);
+                if (!error_count) {
+                    seq_printf(s, "step 2 open test Open One:(%2d,%2d) = %4d Limit:%d\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], ELEC_OPEN_TEST_LIMIT_ONE);
+                }
+                error_count++;
+                if (tp_debug != 2) {
+                    goto RESTORE_CONFIG;
+                }
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    /* 11 phase 2, data calculation and verification */
+    /* the calculated ratio should be lower than the test limit */
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x03);    // page 3
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return TEST_FAIL;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL43, sizeof(ctrl_43), ctrl_43.data);     //read data
+    synaptics_read_F54_base_reg(chip_info);
+    tddi_ratio_calculation(raw_data_delta_image, &ctrl_43, syna_testdata->TX_NUM, syna_testdata->RX_NUM);
+
+    store_to_file(syna_testdata->fd, "Open Test Limit 2:  > %d ok\n", ELEC_OPEN_TEST_LIMIT_TWO);
+
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", raw_data_delta_image[x * syna_testdata->RX_NUM + y]);
+            if (x < tx_2d_num && raw_data_delta_image[x * syna_testdata->RX_NUM + y] < ELEC_OPEN_TEST_LIMIT_TWO) {
+                TPD_INFO("step 2 open test: (%2d,%2d) = %4d < ELEC_OPEN_TEST_LIMIT_TWO(%d) fail\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], ELEC_OPEN_TEST_LIMIT_TWO);
+                if (!error_count) {
+                    seq_printf(s, "step 2 open test Open Two:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], ELEC_OPEN_TEST_LIMIT_TWO);
+                }
+                error_count++;
+                if (tp_debug != 2) {
+                    goto RESTORE_CONFIG;
+                }
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    store_to_file(syna_testdata->fd, "\n");
+
+RESTORE_CONFIG:
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl91\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl99\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl182\n",__func__);
+    }
+
+
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_2)
+        kfree(raw_data_2);
+    if (raw_data_delta_image)
+        kfree(raw_data_delta_image);
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_short_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    int x, y, z;
+    uint8_t buffer[9];
+    uint8_t tmp_arg1, tmp_arg2;
+    int tx_2d_num = syna_testdata->TX_NUM - 1;
+    unsigned int buffer_size = tx_2d_num * syna_testdata->RX_NUM * 2;
+    uint8_t *tddi_rt95_raw_data = NULL;
+    signed short *tddi_rt95_part_one = NULL;
+    signed short *tddi_rt95_part_two = NULL;
+    int error_count = 0;
+
+    struct f54_control_91  original_f54_ctrl91;
+    struct f54_control_99  original_f54_ctrl99;
+    struct f54_control_182 original_f54_ctrl182;
+    struct f55_control_43  ctrl_43;
+
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    store_to_file(syna_testdata->fd, "Short Test:\n");
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    /* keep the original reference high/low capacitance */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl91\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl91");
+        return TEST_FAIL;
+    }
+    /* keep the original integration and reset duration */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl99\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl99");
+        return TEST_FAIL;
+    }
+    /* keep the original timing control */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl182\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl182");
+        return TEST_FAIL;
+    }
+
+    tddi_rt95_raw_data = kzalloc(2 * tx_2d_num * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!tddi_rt95_raw_data) {
+        TPD_INFO("tddi_rt95_raw_data kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    tddi_rt95_part_one = kzalloc(tx_2d_num * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!tddi_rt95_part_one) {
+        TPD_INFO("tddi_rt95_part_one kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    tddi_rt95_part_two = kzalloc(tx_2d_num * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!tddi_rt95_part_two) {
+        TPD_INFO("tddi_rt95_part_two kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    buffer[0] = EXTEND_EE_SHORT_INT_DUR;
+    buffer[1] = (EXTEND_EE_SHORT_INT_DUR >> 8) & 0xff;
+    buffer[2] = EXTEND_EE_SHORT_RESET_DUR;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 3 short test Modify the Reset duration, Integration duration error\n");
+        seq_printf(s, "step 3 short test Modify the Reset duration, Integration duration error\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    buffer[0] = EXTEND_EE_SHORT_TX_ON_COUNT;
+    buffer[1] = (EXTEND_EE_SHORT_TX_ON_COUNT >> 8) & 0xff;
+    buffer[2] = EXTEND_EE_SHORT_RX_ON_COUNT;
+    buffer[3] = (EXTEND_EE_SHORT_RX_ON_COUNT >> 8) & 0xff;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, 4, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 3 short test Modify CBC Timing Control error\n");
+        seq_printf(s, "step 3 short test Modify CBC Timing Control error\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    /* 2 Force update */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+    TPD_INFO("short test force update %d\n", __LINE__);
+
+    /* 3 get report type 95 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 95);//select report type 95
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    TPD_INFO("short test get report %d\n", __LINE__);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3,
+                                2 * tx_2d_num*syna_testdata->RX_NUM * 2, tddi_rt95_raw_data);     //read data
+
+    /* 4 use the upper half as part 1 image */
+    /* the data should be lower than TEST_LIMIT_PART1 ( fail, if > TEST_LIMIT_PART1 ) */
+    TPD_DEBUG_NTAG("----------- step 3 short test : rt95 part 1 value ---------- \n ");
+    for (x = 0; x < tx_2d_num; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = tddi_rt95_raw_data[z*2] & 0xff;
+            tmp_arg2 = tddi_rt95_raw_data[z*2 + 1] & 0xff;
+            tddi_rt95_part_one[z] = ((tmp_arg2 << 8) | tmp_arg1);
+            TPD_DEBUG_NTAG("%4d ", tddi_rt95_part_one[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    store_to_file(syna_testdata->fd, "Short Test Limit 1: < %d ok\n", EXTEND_EE_SHORT_TEST_LIMIT_PART1);
+    for (x = 0; x < tx_2d_num; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", tddi_rt95_part_one[x * syna_testdata->RX_NUM + y]);
+            if (tddi_rt95_part_one[x*syna_testdata->RX_NUM + y] > EXTEND_EE_SHORT_TEST_LIMIT_PART1) {
+                TPD_INFO("step 3 short test : (%2d,%2d) = %4d > EXTEND_EE_SHORT_TEST_LIMIT_PART1(%d) fail\n",
+                        x, y, tddi_rt95_part_one[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART1);
+                if (!error_count) {
+                    seq_printf(s, "step 3 short test Short One:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, tddi_rt95_part_two[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART1);
+                }
+                error_count++;
+                if (tp_debug != 2) {
+                    goto RESTORE_CONFIG;
+                }
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    /* 5 use the lower half as part 2 image */
+    /* and perform the calculation */
+    /* the calculated data should be over than TEST_LIMIT_PART2 ( fail, if < TEST_LIMIT_PART2 ) */
+    TPD_DEBUG_NTAG("----------- step 3 short test : rt95 part 2 value ---------- \n ");
+    for (x = 0; x < tx_2d_num; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = tddi_rt95_raw_data[buffer_size + z*2] & 0xff;
+            tmp_arg2 = tddi_rt95_raw_data[buffer_size + z*2 + 1] & 0xff;
+            tddi_rt95_part_two[syna_testdata->RX_NUM * x + y] = ((tmp_arg2 << 8) | tmp_arg1);
+            TPD_DEBUG_NTAG("%4d ", tddi_rt95_part_two[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x03);    // page 3
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL43, sizeof(ctrl_43), ctrl_43.data); //read data
+    synaptics_read_F54_base_reg(chip_info);
+    tddi_ratio_calculation(tddi_rt95_part_two, &ctrl_43, tx_2d_num, syna_testdata->RX_NUM);
+
+    store_to_file(syna_testdata->fd, "Short Test Limit 2: > %d ok\n", EXTEND_EE_SHORT_TEST_LIMIT_PART2);
+
+    for (x = 0; x < tx_2d_num; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", tddi_rt95_part_two[x * syna_testdata->RX_NUM + y]);
+            if (tddi_rt95_part_two[x * syna_testdata->RX_NUM + y] < EXTEND_EE_SHORT_TEST_LIMIT_PART2) {
+                TPD_INFO("step 3 short test : (%2d,%2d) = %4d < EXTEND_EE_SHORT_TEST_LIMIT_PART2(%d) fail\n",
+                        x, y, tddi_rt95_part_two[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART2);
+                if (!error_count) {
+                    seq_printf(s, "step 3 short test Short Two:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, tddi_rt95_part_two[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART2);
+                }
+                error_count++;
+                if (tp_debug != 2) {
+                    goto RESTORE_CONFIG;
+                }
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+RESTORE_CONFIG:
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl91\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl99\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl182\n",__func__);
+    }
+
+
+END:
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    if (tddi_rt95_raw_data)
+        kfree(tddi_rt95_raw_data);
+    if (tddi_rt95_part_one)
+        kfree(tddi_rt95_part_one);
+    if (tddi_rt95_part_two)
+        kfree(tddi_rt95_part_two);
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int error_count = 0;
+    int ret = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    ret = synaptics_enable_interrupt(chip_info, false);
+
+    error_count += synaptics_int_pin_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_RT92_test(s, chip_data, syna_testdata);
+    synaptics_tddi_open_test(s, chip_data, syna_testdata);
+    synaptics_tddi_short_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_RT92_doze_test(s, chip_data, syna_testdata);
+
+    seq_printf(s, "imageid = 0x%llx, deviceid = 0x%llx\n", syna_testdata->TP_FW, syna_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    int i = 0;
+    uint16_t baseline_data = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        return;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    for (i = 0; i < 2; i++) {
+        if (i == 0) {
+            seq_printf(s, "\nRT92 data:\n");
+        } else if (i == 1) {
+            seq_printf(s, "\nRT92 doze data:\n");
+            TPD_INFO("Force Doze Mode:\r\n");
+            ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL225, 0x01);//Force Doze
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+            checkCMD(chip_info);
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 92);//select report type 92
+        if (ret < 0) {
+            TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            goto END;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        checkCMD(chip_info);
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+        for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+            seq_printf(s, "[%2d] ", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                seq_printf(s, "%4d, ", baseline_data);
+            }
+            seq_printf(s, "\n");
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+END:
+    kfree(raw_data);
+    return ;
+}
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    int16_t temp_delta = 0;
+    uint8_t *raw_data = NULL;
+    int i = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    for (i = 0; i < 2; i++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        seq_printf(s, "checkCMD error, can not read delta data\n");
+        TPD_INFO("checkCMD error, can not read delta data\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        goto OUT;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3, chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            temp_delta = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+
+OUT:
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    msleep(30);
+    kfree(raw_data);
+}
+
+static void synaptics_main_register_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    uint8_t buf[8];
+    int i = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    TPD_INFO("%s start\n", __func__);
+    /*disable irq when read data from IC*/
+    seq_printf(s, "====================================================\n");
+    seq_printf(s, "tp fw = 0x%x\n", *(chip_info->p_tp_fw));
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE - 1);
+    seq_printf(s, "F34_FLASH_DATA03 Flash Status: 0x%x\n", ret);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+    }
+    seq_printf(s, "F01_RMI_DATA00 Device Status: 0x%x\n", ret & 0xff);
+    seq_printf(s, "F01_RMI_DATA01.00 Interrupt Status: 0x%x\n", (ret & 0x7f00) >> 8);
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8, buf);
+    seq_printf(s, "F12_2D_DATA01(00)/00 Object Type and Status 0: \n");
+    for (i = 0; i < 8; i++)
+        seq_printf(s, "0x%x\n", buf[i]);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    seq_printf(s, "F01_RMI_CTRL00 Device Control: 0x%x\n", ret);
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x04);
+    seq_printf(s, "Interference Metric: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x08);
+    seq_printf(s, "Current Noise State: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 0x0b);
+    seq_printf(s, "Sense Frequency Selection: 0x%x\n", ret);
+
+    seq_printf(s, "====================================================\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        seq_printf(s, "%s: failed for page select\n", __func__);
+        return;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x19);
+    seq_printf(s, "F51_CUSTOM_DATA95 Metal Detected Interrupt: 0x%x, bit1(in esd mode)\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL);
+    seq_printf(s, "edge control function register(0x%x) = 0x%x, bit0(Enable Grip Suppression)\n",
+               chip_info->reg_info.F51_CUSTOM_GRIP_CTRL, ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL48);
+    seq_printf(s, "ps status register(0x%x) = 0x%x, bit2(ps_status,1:near 0:far) bit1(Force enter ESD mode) bit0(ESD mode enable)\n\n",
+               chip_info->reg_info.F51_CUSTOM_CTRL48, ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        seq_printf(s, "%s: failed for page select\n", __func__);
+        return;
+    }
+
+    msleep(10);
+}
+
+//Reserved node
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //1.get firmware doze mode info
+    TPD_INFO("1.get firmware doze mode info\n");
+    seq_printf(s, "1.get firmware doze mode info\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA_BASE + 0x19);
+    TPD_INFO("TP doze mode status is %d\n", ret);
+    seq_printf(s, "TP doze mode status is %d\n", ret);
+
+    msleep(10);
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    msleep(10);
+}
+
+
+static int checkFlashState(struct chip_data_s4322 *chip_info)
+{
+    int ret ;
+    int count = 0;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+        count++;
+    }
+
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+/**
+ * re_scan_PDT -   rescan && init F34  base addr.
+ * @chip_info: struct include i2c resource.
+ * Return NULL.
+ */
+static void re_scan_PDT(struct chip_data_s4322 *chip_info)
+{
+    uint8_t buf[8];
+
+    touch_i2c_read_block(chip_info->client, 0xE9, 6, buf);
+    chip_info->reg_info.F34_FLASH_DATA_BASE = buf[3];
+    chip_info->reg_info.F34_FLASH_QUERY_BASE = buf[0];
+    touch_i2c_read_block(chip_info->client, 0xE3, 6, buf);
+    chip_info->reg_info.F01_RMI_DATA_BASE = buf[3];
+    chip_info->reg_info.F01_RMI_CMD_BASE = buf[1];
+    touch_i2c_read_block(chip_info->client, 0xDD, 6, buf);
+
+    chip_info->reg_info.SynaF34Reflash_BlockNum    = chip_info->reg_info.F34_FLASH_DATA_BASE;
+    chip_info->reg_info.SynaF34Reflash_BlockData   = chip_info->reg_info.F34_FLASH_DATA_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_BootID = chip_info->reg_info.F34_FLASH_QUERY_BASE;
+    chip_info->reg_info.SynaF34ReflashQuery_FlashPropertyQuery = chip_info->reg_info.F34_FLASH_QUERY_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize  = chip_info->reg_info.F34_FLASH_QUERY_BASE + 2;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockCount = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockSize    = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockCount   = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    TPD_DEBUG("SynaFirmwareBlockSize is %d\n", (buf[0] | (buf[1] << 8)));
+    chip_info->reg_info.SynaF34_FlashControl = chip_info->reg_info.F34_FLASH_DATA_BASE + 2;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration, disp_configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Disp_Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+    synaptics_parse_header(&header, fw->data);
+    if ((header.firmware_size + header.config_size + 0x100 + header.disp_config_size) > (uint32_t)fw->size) {
+        TPD_INFO("firmware_size + config_size + 0x100 > data_len data_len = %d \n", (uint32_t)fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+    Firmware_Data = fw->data + 0x100 + header.bootloader_size;
+    Config_Data = Firmware_Data + header.firmware_size;
+    Disp_Config_Data = fw->data + header.disp_config_offset;
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8)|buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8)|Config_Data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    //step 3:init needed params
+    re_scan_PDT(chip_info);
+    block = 256;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = header.firmware_size / block;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = header.config_size / block;
+    TPD_DEBUG("configuration is %d \n", configuration);
+    disp_configuration = header.disp_config_size / block;
+    TPD_DEBUG("disp_configuration is %d \n", disp_configuration);
+
+    //step 3:Get into program mode
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", chip_info->reg_info.SynaF34_FlashControl, ret);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4\n");
+    ret = checkFlashState(chip_info);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return FW_UPDATE_ERROR;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE, ret&0x04);
+
+    /********************get into prog end************/
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(chip_info);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 2, buf);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, buf);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x22); //erase flash except display config  ,0x03 erase all flash
+    msleep(2000);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0 & 0x00ff;
+    buf[1] = (0 & 0xff00) >> 8;
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    for (j = 0; j < firmware; j++) {
+
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Firmware_Data[j*block]);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    //step 5:flash configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0 & 0x00ff;
+    buf[1] = (0 & 0xff00) >> 8;
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    for (j = 0; j < configuration; j++) {
+
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Config_Data[j*block]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+#ifdef UPDATE_DISPLAY_CONFIG
+    TPD_INFO("update-----------------display_configuration ------------------update!\n");
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0;
+    buf[1] = 0x60;//high 3 bit configuration area select
+    TPD_INFO("---------------- buf[0]=0x%x  buf[1]=0x%x \n",buf[0],buf[1]);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    TPD_INFO("---------------- Disp_Config_Data ---------------------- \n");
+    for(j = 0; j < 16 ; j++)
+        printk("0x%x  ", Disp_Config_Data[j]);
+    TPD_INFO("-------------------------------------- \n");
+
+    for (j = 0; j < disp_configuration; j++) {
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Disp_Config_Data[j*block]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Disp_Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+    TPD_INFO("Disp_Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+#endif
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x00);
+    msleep(100);
+
+    synaptics_reset(chip_info);
+    msleep(200);
+
+    return FW_UPDATE_SUCCESS;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t raw_data[1800] = {0};
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return fp_touch_state;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    ret = (ret & 0xF8) | 0x80;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, ret);   //exit sleep
+    msleep(1);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 124
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        return FINGER_PROTECT_TOUCH_DOWN;
+    }
+
+    fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, TX_NUM * SPURIOUS_FP_RX_NUM * 2, raw_data); //read baseline data
+    for (x = 1; x < TX_NUM - 2; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 1; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if (delta_data > SPURIOUS_FP_LIMIT) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug) {
+                TPD_INFO("finger protect trigger!report_finger_protect = %d\n", fp_touch_state);
+                break;
+            }
+        }
+    }
+
+    TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,__LINE__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error,line=%d\n", __func__,__LINE__);
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+    return fp_touch_state;
+}
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x03);
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    TPD_INFO("touch key int_key code = %d\n",ret);
+
+    if (ret & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (ret & 0x02)
+        SET_BIT(bitmap_result, BIT_BACK);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    return bitmap_result;
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        ret = -ENOMEM;
+    }
+
+RE_TRY:
+    TPD_INFO("%s retry_time=%d line=%d\n",__func__,retry_time,__LINE__);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); //forcecal
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 0x02
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, TX_NUM * SPURIOUS_FP_RX_NUM * 2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < TX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+    }
+
+    kfree(raw_data);
+}
+
+static void synaptics_write_ps_status(void *chip_data, int ps_status)
+{
+    int ret = 0;
+    int tmp = 0;
+    struct chip_data_s4322 *chip_info = (struct chip_data_s4322 *)chip_data;
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return ;
+    }
+
+    tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL48);
+    if (ps_status == 1) {
+        tmp |= 0x04;    //bit2:1 ps near
+    } else {
+        tmp &= 0xfB;    //bit2:0 ps far
+    }
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL48, tmp);
+    if (ret < 0) {
+        TPD_INFO("write ps_status error\n");
+        return;
+    }
+    TPD_INFO("chip_info->reg_info.F51_CUSTOM_CTRL48=0x%x  write ps_status value 0x%x ok, ps %s \n",
+              chip_info->reg_info.F51_CUSTOM_CTRL48, tmp, ps_status ? "near" : "far");
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+    }
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+    .get_vendor       = synaptics_get_vendor,
+    .get_chip_info    = synaptics_get_chip_info,
+    .reset            = synaptics_reset,
+    .power_control    = synaptics_power_control,
+    .fw_check         = synaptics_fw_check,
+    .fw_update        = synaptics_fw_update,
+    .trigger_reason   = synaptics_trigger_reason,
+    .get_touch_points = synaptics_get_touch_points,
+    .get_gesture_info = synaptics_get_gesture_info,
+    .mode_switch      = synaptics_mode_switch,
+    .get_keycode      = synaptics_get_keycode,
+    .spurious_fp_check= synaptics_spurious_fp_check,
+    .finger_proctect_data_get = synaptics_finger_proctect_data_get,
+    .exit_esd_mode = synaptics_exit_esd_mode,
+    .write_ps_status = synaptics_write_ps_status,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+    .auto_test     = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = synaptics_limit_read,
+    .delta_read    = synaptics_delta_read,
+    .baseline_read = synaptics_baseline_read,
+    .main_register_read = synaptics_main_register_read,
+    .reserve_read = synaptics_reserve_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+
+    struct chip_data_s4322 *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+    TPD_INFO("i2c address = 0x%x ,modify i2c address = 0x20\n", client->addr);
+    client->addr = 0x20;
+
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_s4322), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    chip_info->client = client;
+    chip_info->p_spuri_fp_touch = &(ts->spuri_fp_touch);
+    chip_info->syna_ops = &synaptics_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &synaptics_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+    ts->tp_resume_order = LCD_TP_RESUME;
+    ts->skip_suspend_operate = true;
+
+    //step6: collect data for supurious_fp_touch
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        synaptics_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    //step7:create synaptics related proc files
+    synaptics_create_proc(ts, chip_info->syna_ops);
+
+    //step8:Chip Related function
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data();
+    chip_info->premote_data = premote_data;
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->hw_res.irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(chip_info->enable_remote);
+        register_remote_device(premote_data);
+    }
+#endif
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device();
+#endif
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE,},
+    { .compatible = "synaptics-s4322",},
+    { }
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = synaptics_i2c_suspend,
+    .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = synaptics_tp_probe,
+    .remove     = synaptics_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_s4322.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_s4322.h
new file mode 100644
index 0000000000000000000000000000000000000000..10386689bb1bdb00010569e2912d74824c5a8cfb
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/S4322/synaptics_s4322.h
@@ -0,0 +1,235 @@
+/***************************************************
+ * File:synaptics_drivers_s4322.h
+ * Copyright(C) 2008-2012 OPPO Mobile Comm Corp., Ltd
+ * Description:
+ *             synaptics s4322 driver
+ * Version:1.0:
+ * Date created:2017/04/17
+ * Author: MingQiang.Guo@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+   <author >  <data>  <version>  <desc>
+****************************************************/
+
+#ifndef SYNAPTICS_H_S4322
+#define SYNAPTICS_H_S4322
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../synaptics_common.h"
+#ifdef CONFIG_SYNAPTIC_RED
+#include "../synaptics_touch_panel_remote.h"
+#endif
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE      0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE    0x02
+#define ENABLE_DTAP     0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT      0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT    0x07
+#define DTAP_DETECT     0x03
+
+#define RESET_TO_NORMAL_TIME 80    /*Sleep time after reset*/
+
+#define SPURIOUS_FP_LIMIT 100
+#define SPURIOUS_FP_RX_NUM 8
+#define SPURIOUS_FP_TX_NUM 9
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+#define I2C_ERROR_MAX_TIME 5
+
+#define EXTEND_EE_SHORT_RESET_DUR  60
+#define EXTEND_EE_SHORT_INT_DUR  150
+#define EXTEND_EE_SHORT_TX_ON_COUNT  146
+#define EXTEND_EE_SHORT_RX_ON_COUNT  146
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART1  160
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART2  80         // ( unit = ratio )
+
+/* tddi f54 test reporting - */
+#define ELEC_OPEN_TEST_TX_ON_COUNT 2
+#define ELEC_OPEN_TEST_RX_ON_COUNT 2
+#define ELEC_OPEN_INT_DUR_ONE 15
+#define ELEC_OPEN_INT_DUR_TWO 25
+#define ELEC_OPEN_TEST_LIMIT_ONE 500
+#define ELEC_OPEN_TEST_LIMIT_TWO 50
+
+#define COMMAND_FORCE_UPDATE 4
+
+//#define UPDATE_DISPLAY_CONFIG
+
+//Self Capacitance key test limite
+#define MENU_LOW_LIMITE  1630
+#define MENU_HIGH_LIMITE 3803
+
+#define BACK_LOW_LIMITE 3016
+#define BACK_HIGH_LIMITE 7039
+
+#define TEST_FAIL	1
+#define TEST_PASS	0
+
+#define LIMIT_DOZE_LOW  50
+#define LIMIT_DOZE_HIGH 975
+
+struct f55_control_43 {
+	union {
+		struct {
+			unsigned char swap_sensor_side:1;
+			unsigned char f55_ctrl43_b1__7:7;
+			unsigned char afe_l_mux_size:4;
+			unsigned char afe_r_mux_size:4;
+		} __packed;
+		unsigned char data[2];
+	};
+};
+
+struct f54_control_91 {
+	union {
+		struct {
+			unsigned char reflo_transcap_capacitance;
+			unsigned char refhi_transcap_capacitance;
+			unsigned char receiver_feedback_capacitance;
+			unsigned char reference_receiver_feedback_capacitance;
+			unsigned char gain_ctrl;
+		} __packed;
+		struct {
+			unsigned char data[5];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+struct f54_control_99 {
+	union {
+		struct {
+			unsigned char integration_duration_lsb;
+			unsigned char integration_duration_msb;
+			unsigned char reset_duration;
+		} __packed;
+		struct {
+			unsigned char data[3];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+struct f54_control_182 {
+	union {
+		struct {
+			unsigned char cbc_timing_ctrl_tx_lsb;
+			unsigned char cbc_timing_ctrl_tx_msb;
+			unsigned char cbc_timing_ctrl_rx_lsb;
+			unsigned char cbc_timing_ctrl_rx_msb;
+		} __packed;
+		struct {
+			unsigned char data[4];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+/*********PART3:Struct Area**********************/
+struct synaptics_register
+{
+    uint8_t F01_RMI_QUERY_BASE;
+    uint8_t F01_RMI_CMD_BASE;
+    uint8_t F01_RMI_CTRL_BASE;
+    uint8_t F01_RMI_DATA_BASE;
+
+    uint8_t F01_RMI_QUERY11;
+    uint8_t F01_RMI_DATA01;
+    uint8_t F01_RMI_CMD00;
+    uint8_t F01_RMI_CTRL00;
+    uint8_t F01_RMI_CTRL01;
+    uint8_t F01_RMI_CTRL02;
+
+    uint8_t F12_2D_QUERY_BASE;
+    uint8_t F12_2D_CMD_BASE;
+    uint8_t F12_2D_CTRL_BASE;
+    uint8_t F12_2D_DATA_BASE;
+
+    uint8_t F12_2D_CTRL08;
+    uint8_t F12_2D_CTRL20;
+    uint8_t F12_2D_CTRL23;
+    uint8_t F12_2D_CTRL27;
+    uint8_t F12_2D_CTRL32;
+    uint8_t F12_2D_DATA04;
+    uint8_t F12_2D_DATA15;
+    uint8_t F12_2D_DATA38;
+    uint8_t F12_2D_DATA39;
+    uint8_t F12_2D_CMD00;
+
+    uint8_t F34_FLASH_QUERY_BASE;
+    uint8_t F34_FLASH_CMD_BASE;
+    uint8_t F34_FLASH_CTRL_BASE;
+    uint8_t F34_FLASH_DATA_BASE;
+
+    uint8_t SynaF34_FlashControl;
+    uint8_t SynaF34_FlashStatus;
+    uint8_t SynaF34Reflash_BlockNum;
+    uint8_t SynaF34Reflash_BlockData;
+    uint8_t SynaF34ReflashQuery_BootID;
+    uint8_t SynaF34ReflashQuery_FlashPropertyQuery;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockSize;
+    uint8_t SynaF34ReflashQuery_FirmwareBlockCount;
+    uint8_t SynaF34ReflashQuery_ConfigBlockSize;
+    uint8_t SynaF34ReflashQuery_ConfigBlockCount;
+
+    uint8_t F51_CUSTOM_QUERY_BASE;
+    uint8_t F51_CUSTOM_CMD_BASE;
+    uint8_t F51_CUSTOM_CTRL_BASE;
+    uint8_t F51_CUSTOM_DATA_BASE;
+
+    uint8_t F51_CUSTOM_CTRL00;
+    uint8_t F51_CUSTOM_CTRL31;
+    uint8_t F51_CUSTOM_CTRL42;
+    uint8_t F51_CUSTOM_CTRL48;   //ESD Mode Ctrl, bit2:1 ps near , bit2:0 ps far
+    uint8_t F51_CUSTOM_GRIP_CTRL;//edge function register,the enable bit of Grip suppression
+    uint8_t F51_CUSTOM_DATA;
+
+    uint8_t F54_ANALOG_QUERY_BASE;
+    uint8_t F54_ANALOG_COMMAND_BASE;
+    uint8_t F54_ANALOG_CONTROL_BASE;
+    uint8_t F54_ANALOG_DATA_BASE;
+    uint8_t F54_ANALOG_CTRL123;
+    uint8_t F54_ANALOG_CTRL91;
+    uint8_t F54_ANALOG_CTRL99;
+    uint8_t F54_ANALOG_CTRL182;
+    uint8_t F54_ANALOG_CTRL225;
+
+    uint8_t F55_SENSOR_QUERY_BASE;
+    uint8_t F55_SENSOR_CMD_BASE;
+    uint8_t F55_SENSOR_CTRL_BASE;
+    uint8_t F55_SENSOR_DATA_BASE;
+
+    uint8_t F55_SENSOR_CTRL01;
+    uint8_t F55_SENSOR_CTRL02;
+    uint8_t F55_SENSOR_CTRL43;
+};
+
+struct chip_data_s4322 {
+    uint32_t *p_tp_fw;
+    tp_dev tp_type;
+    struct i2c_client *client;
+    struct synaptics_proc_operations *syna_ops; /*synaptics func provide to synaptics common driver*/
+#ifdef CONFIG_SYNAPTIC_RED
+    int    enable_remote;                       /*Redremote connect state*/
+    struct remotepanel_data *premote_data;
+#endif/*CONFIG_SYNAPTIC_RED*/
+    struct synaptics_register     reg_info;
+    struct hw_resource          *hw_res;
+    int16_t *spuri_fp_data;
+    struct spurious_fp_touch *p_spuri_fp_touch;
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..9ec9c88b0caf2daeda4f7631aa515e8b098381b4
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Kconfig
@@ -0,0 +1,12 @@
+#
+# Synaptics TCM touchscreen driver configuration
+#
+config TOUCHPANEL_SYNAPTICS_TCM
+	bool "Synaptics TCM touchscreen"
+	default n
+	help
+	  Say Y here if you have a Synaptics TCM touchscreen connected
+	  to your system.
+
+	  If unsure, say N.
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..2c323a49f5a111745a17c97c3b2adb86fe09f96c
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/Makefile
@@ -0,0 +1,10 @@
+#
+# Makefile for the Synaptics TCM touchscreen driver.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TCM) += synaptics_tcm_core.o
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TCM) += synaptics_tcm_device.o
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TCM) += synaptics_tcm_recovery.o
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..0467801604def3c9fe101dd849425d4c97eaa4eb
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.c
@@ -0,0 +1,3965 @@
+/**************************************************************
+* Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+* File       : synaptics_tcm_core.c
+* Description: Source file for synaptics TD4330 driver
+* Version   : 1.0
+* Date        : 2018-01-18
+* Author    : Xing.Xiong@EXP.Bsp.Group.Tp
+* TAG         : BSP.TP.Init
+* ---------------- Revision History: --------------------------
+*   <version>    <date>          < author >                            <desc>
+* Revision 1.1, 2018-01-18, Xing.Xiong@EXP.Bsp.Group.Tp.
+****************************************************************/
+
+#include <linux/gpio.h>
+#include <linux/kthread.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include "synaptics_tcm_core.h"
+
+#define PREDICTIVE_READING
+#define MIN_READ_LENGTH 9
+#define RESPONSE_TIMEOUT_MS_SHORT 300
+#define RESPONSE_TIMEOUT_MS_DEFAULT 1000
+#define RESPONSE_TIMEOUT_MS_LONG 3000
+
+#define ERASE_FLASH_DELAY_MS 5000
+#define WRITE_FLASH_DELAY_MS 200
+
+#define APP_STATUS_POLL_TIMEOUT_MS 1000
+#define APP_STATUS_POLL_MS 100
+
+
+DECLARE_COMPLETION(response_complete);
+DECLARE_COMPLETION(report_complete);
+
+extern struct device_hcd * syna_remote_device_init(struct syna_tcm_hcd *tcm_hcd);
+extern int syna_remote_device_destory(struct syna_tcm_hcd *tcm_hcd);
+static void syna_main_register(struct seq_file *s, void *chip_data);
+
+static int syna_tcm_write_message(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char command, unsigned char *payload,
+        unsigned int length, unsigned char **resp_buf,
+        unsigned int *resp_buf_size, unsigned int *resp_length,
+        unsigned int polling_delay_ms);
+static void syna_tcm_test_report(struct syna_tcm_hcd *tcm_hcd);
+static int syna_tcm_helper(struct syna_tcm_hcd *tcm_hcd);
+
+inline int syna_tcm_rmi_read(struct syna_tcm_hcd *tcm_hcd,
+        unsigned short addr, unsigned char *data, unsigned int length)
+{
+    int retval = 0;
+    unsigned short tmp_addr = tcm_hcd->client->addr;
+
+    tcm_hcd->client->addr = tcm_hcd->ubl_addr;
+    retval = touch_i2c_read_block(tcm_hcd->client, addr, length, data);
+    tcm_hcd->client->addr = tmp_addr;
+
+    return retval;
+}
+
+inline int syna_tcm_rmi_write(struct syna_tcm_hcd *tcm_hcd,
+        unsigned short addr, unsigned char *data, unsigned int length)
+{
+    int    retval = 0;
+    unsigned short tmp_addr = tcm_hcd->client->addr;
+
+    tcm_hcd->client->addr = tcm_hcd->ubl_addr;
+    retval = touch_i2c_write_block(tcm_hcd->client, addr, length, data);
+    tcm_hcd->client->addr = tmp_addr;
+
+    return retval;
+}
+
+static inline int syna_tcm_read(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char *data, unsigned int length)
+{
+    return touch_i2c_continue_read(tcm_hcd->client, length, data);
+}
+
+static inline int syna_tcm_write(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char *data, unsigned int length)
+{
+    return touch_i2c_continue_write(tcm_hcd->client, length, data);
+}
+
+static int syna_get_report_data(struct syna_tcm_hcd *tcm_hcd, unsigned int offset,
+        unsigned int bits, unsigned int *data)
+{
+    unsigned char mask;
+    unsigned char byte_data;
+    unsigned int output_data;
+    unsigned int bit_offset;
+    unsigned int byte_offset;
+    unsigned int data_bits;
+    unsigned int available_bits;
+    unsigned int remaining_bits;
+    unsigned char *touch_report;
+
+    touch_report = tcm_hcd->report.buffer.buf;
+    output_data = 0;
+    remaining_bits = bits;
+    bit_offset = offset % 8;
+    byte_offset = offset / 8;
+
+    if (bits == 0 || bits > 32) {
+        TPD_DEBUG("larger than 32 bits:%d\n", bits);
+        secure_memcpy((unsigned char *)data, bits / 8, &touch_report[byte_offset], bits / 8, bits / 8);
+        return 0;
+    }
+
+    if (offset + bits > tcm_hcd->report.buffer.data_length * 8) {
+        *data = 0;
+        return 0;
+    }
+
+    while (remaining_bits) {
+        byte_data = touch_report[byte_offset];
+        byte_data >>= bit_offset;
+
+        available_bits = 8 - bit_offset;
+        data_bits = MIN(available_bits, remaining_bits);
+        mask = 0xff >> (8 - data_bits);
+
+        byte_data &= mask;
+
+        output_data |= byte_data << (bits - remaining_bits);
+
+        bit_offset = 0;
+        byte_offset += 1;
+        remaining_bits -= data_bits;
+    }
+
+    *data = output_data;
+
+    return 0;
+}
+
+/**
+ * touch_parse_report() - Parse touch report
+ *
+ * Traverse through the touch report configuration and parse the touch report
+ * generated by the device accordingly to retrieve the touch data.
+ */
+static int syna_parse_report(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    bool active_only = 0;
+    bool num_of_active_objects;
+    unsigned char code;
+    unsigned int size, idx, obj;
+    unsigned int next, data, bits, offset, objects;
+    unsigned int active_objects = 0;
+    unsigned int report_size, config_size;
+    unsigned char *config_data;
+    struct touch_hcd *touch_hcd;
+    struct touch_data *touch_data;
+    struct object_data *object_data;
+    static unsigned int end_of_foreach;
+
+    touch_hcd = tcm_hcd->touch_hcd;
+    touch_data = &touch_hcd->touch_data;
+    object_data = touch_hcd->touch_data.object_data;
+    config_data = tcm_hcd->config.buf;
+    config_size = tcm_hcd->config.data_length;
+    report_size = tcm_hcd->report.buffer.data_length;
+    size = sizeof(*object_data) * touch_hcd->max_objects;
+    memset(touch_hcd->touch_data.object_data, 0x00, size);
+
+    num_of_active_objects = false;
+
+    idx = 0;
+    offset = 0;
+    objects = 0;
+    while (idx < config_size) {
+        code = config_data[idx++];
+        switch (code) {
+        case TOUCH_END:
+            goto exit;
+        case TOUCH_FOREACH_ACTIVE_OBJECT:
+            obj = 0;
+            next = idx;
+            active_only = true;
+            break;
+        case TOUCH_FOREACH_OBJECT:
+            obj = 0;
+            next = idx;
+            active_only = false;
+            break;
+        case TOUCH_FOREACH_END:
+            end_of_foreach = idx;
+            if (active_only) {
+                if (num_of_active_objects) {
+                    objects++;
+                    if (objects < active_objects)
+                        idx = next;
+                } else if (offset < report_size * 8) {
+                    idx = next;
+                }
+            } else {
+                obj++;
+                if (obj < touch_hcd->max_objects)
+                    idx = next;
+            }
+            break;
+        case TOUCH_PAD_TO_NEXT_BYTE:
+            offset = ceil_div(offset, 8) * 8;
+            break;
+        case TOUCH_TIMESTAMP:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get timestamp\n");
+                return retval;
+            }
+            touch_data->timestamp = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_INDEX:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &obj);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object index\n");
+                return retval;
+            }
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_CLASSIFICATION:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object classification\n");
+                return retval;
+            }
+            object_data[obj].status = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_X_POSITION:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object x position\n");
+                return retval;
+            }
+            object_data[obj].x_pos = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_Y_POSITION:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object y position\n");
+                return retval;
+            }
+            object_data[obj].y_pos = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_Z:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object z\n");
+                return retval;
+            }
+            object_data[obj].z = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_X_WIDTH:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object x width\n");
+                return retval;
+            }
+            object_data[obj].x_width = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_Y_WIDTH:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object y width\n");
+                return retval;
+            }
+            object_data[obj].y_width = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_TX_POSITION_TIXELS:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object tx position\n");
+                return retval;
+            }
+            object_data[obj].tx_pos = data;
+            offset += bits;
+            break;
+        case TOUCH_OBJECT_N_RX_POSITION_TIXELS:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get object rx position\n");
+                return retval;
+            }
+            object_data[obj].rx_pos = data;
+            offset += bits;
+            break;
+        case TOUCH_0D_BUTTONS_STATE:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get 0D buttons state\n");
+                return retval;
+            }
+            touch_data->buttons_state = data;
+            offset += bits;
+            break;
+        case TOUCH_GESTURE_DOUBLE_TAP:
+        case TOUCH_REPORT_GESTURE_SWIPE:
+        case TOUCH_REPORT_GESTURE_CIRCLE:
+        case TOUCH_REPORT_GESTURE_UNICODE:
+        case TOUCH_REPORT_GESTURE_VEE:
+        case TOUCH_REPORT_GESTURE_TRIANGLE:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get gesture double tap\n");
+                return retval;
+            }
+            touch_data->lpwg_gesture = tcm_hcd->report.buffer.buf[0];
+            offset += bits;
+            break;
+        case TOUCH_REPORT_GESTURE_INFO:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get gesture double tap\n");
+                return retval;
+            }
+            touch_data->extra_gesture_info = data;
+            offset += bits;
+            break;
+        case TOUCH_REPORT_GESTURE_COORDINATE:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, (unsigned int *)(&touch_data->data_point[0]));
+            if (retval < 0) {
+                TPD_INFO("Failed to get gesture double tap\n");
+                return retval;
+            }
+            offset += bits;
+            break;
+        case TOUCH_FRAME_RATE:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get frame rate\n");
+                return retval;
+            }
+            touch_data->frame_rate = data;
+            offset += bits;
+            break;
+        case TOUCH_POWER_IM:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get power IM\n");
+                return retval;
+            }
+            touch_data->power_im = data;
+            offset += bits;
+            break;
+        case TOUCH_CID_IM:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get CID IM\n");
+                return retval;
+            }
+            touch_data->cid_im = data;
+            offset += bits;
+            break;
+        case TOUCH_RAIL_IM:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get rail IM\n");
+                return retval;
+            }
+            touch_data->rail_im = data;
+            offset += bits;
+            break;
+        case TOUCH_CID_VARIANCE_IM:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get CID variance IM\n");
+                return retval;
+            }
+            touch_data->cid_variance_im = data;
+            offset += bits;
+            break;
+        case TOUCH_NSM_FREQUENCY:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get NSM frequency\n");
+                return retval;
+            }
+            touch_data->nsm_frequency = data;
+            offset += bits;
+            break;
+        case TOUCH_NSM_STATE:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get NSM state\n");
+                return retval;
+            }
+            touch_data->nsm_state = data;
+            offset += bits;
+            break;
+        case TOUCH_NUM_OF_ACTIVE_OBJECTS:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get number of active objects\n");
+                return retval;
+            }
+            active_objects = data;
+            num_of_active_objects = true;
+            touch_data->num_of_active_objects = data;
+            offset += bits;
+            if (touch_data->num_of_active_objects == 0)
+                idx = end_of_foreach;
+            break;
+        case TOUCH_NUM_OF_CPU_CYCLES_USED_SINCE_LAST_FRAME:
+            bits = config_data[idx++];
+            retval = syna_get_report_data(tcm_hcd, offset, bits, &data);
+            if (retval < 0) {
+                TPD_INFO("Failed to get number of CPU cycles used since last frame\n");
+                return retval;
+            }
+            touch_data->num_of_cpu_cycles = data;
+            offset += bits;
+            break;
+        case TOUCH_TUNING_GAUSSIAN_WIDTHS:
+            bits = config_data[idx++];
+            offset += bits;
+            break;
+        case TOUCH_TUNING_SMALL_OBJECT_PARAMS:
+            bits = config_data[idx++];
+            offset += bits;
+            break;
+        case TOUCH_TUNING_0D_BUTTONS_VARIANCE:
+            bits = config_data[idx++];
+            offset += bits;
+            break;
+        }
+    }
+
+exit:
+    return 0;
+}
+
+static int syna_get_input_params(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+
+    LOCK_BUFFER(tcm_hcd->config);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_GET_TOUCH_REPORT_CONFIG,
+            NULL,
+            0,
+            &tcm_hcd->config.buf,
+            &tcm_hcd->config.buf_size,
+            &tcm_hcd->config.data_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_GET_TOUCH_REPORT_CONFIG));
+        UNLOCK_BUFFER(tcm_hcd->config);
+        return retval;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->config);
+
+    return 0;
+}
+
+static int syna_set_default_report_config(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval = 0;
+    int length = 0;
+
+    LOCK_BUFFER(tcm_hcd->config);
+
+    length = tcm_hcd->default_config.buf_size;
+
+    if (tcm_hcd->default_config.buf) {
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                    &tcm_hcd->config,
+                    length);
+        if (retval < 0) {
+            TPD_INFO("Failed to alloc mem\n");
+            goto exit;
+        }
+
+        memcpy(tcm_hcd->config.buf, tcm_hcd->default_config.buf, length);
+        tcm_hcd->config.buf_size = tcm_hcd->default_config.buf_size;
+        tcm_hcd->config.data_length = tcm_hcd->default_config.data_length;
+    }
+
+exit:
+    UNLOCK_BUFFER(tcm_hcd->config);
+
+    return retval;
+}
+
+static int syna_get_default_report_config(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval = 0;
+    unsigned int length;
+
+    length = le2_to_uint(tcm_hcd->app_info.max_touch_report_config_size);
+
+    LOCK_BUFFER(tcm_hcd->default_config);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_GET_TOUCH_REPORT_CONFIG,
+            NULL,
+            0,
+            &tcm_hcd->default_config.buf,
+            &tcm_hcd->default_config.buf_size,
+            &tcm_hcd->default_config.data_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_GET_TOUCH_REPORT_CONFIG));
+        goto exit;
+    }
+
+exit:
+    UNLOCK_BUFFER(tcm_hcd->default_config);
+    return retval;
+}
+
+static int syna_set_normal_report_config(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned int idx = 0;
+    unsigned int length;
+    struct touch_hcd *touch_hcd = tcm_hcd->touch_hcd;
+
+    TPD_DEBUG("%s:set normal report\n", __func__);
+    length = le2_to_uint(tcm_hcd->app_info.max_touch_report_config_size);
+
+    if (length < TOUCH_REPORT_CONFIG_SIZE) {
+        TPD_INFO("Invalid maximum touch report config size\n");
+        return -EINVAL;
+    }
+
+    LOCK_BUFFER(touch_hcd->out);
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &touch_hcd->out,
+            length);
+    if (retval < 0) {
+        TPD_INFO("Failed to allocate memory for touch_hcd->out.buf\n");
+        UNLOCK_BUFFER(touch_hcd->out);
+        return retval;
+    }
+
+    touch_hcd->out.buf[idx++] = TOUCH_GESTURE_DOUBLE_TAP;
+    touch_hcd->out.buf[idx++] = 8;
+    touch_hcd->out.buf[idx++] = TOUCH_FOREACH_ACTIVE_OBJECT;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_INDEX;
+    touch_hcd->out.buf[idx++] = 4;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_CLASSIFICATION;
+    touch_hcd->out.buf[idx++] = 4;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_X_POSITION;
+    touch_hcd->out.buf[idx++] = 12;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_Y_POSITION;
+    touch_hcd->out.buf[idx++] = 12;
+    touch_hcd->out.buf[idx++] = TOUCH_FOREACH_END;
+    touch_hcd->out.buf[idx++] = TOUCH_END;
+
+    LOCK_BUFFER(touch_hcd->resp);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_SET_TOUCH_REPORT_CONFIG,
+            touch_hcd->out.buf,
+            length,
+            &touch_hcd->resp.buf,
+            &touch_hcd->resp.buf_size,
+            &touch_hcd->resp.data_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_SET_TOUCH_REPORT_CONFIG));
+        UNLOCK_BUFFER(touch_hcd->resp);
+        UNLOCK_BUFFER(touch_hcd->out);
+        return retval;
+    }
+
+    UNLOCK_BUFFER(touch_hcd->resp);
+    UNLOCK_BUFFER(touch_hcd->out);
+
+    return retval;
+}
+
+static int syna_set_gesture_report_config(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned int idx = 0;
+    unsigned int length;
+    struct touch_hcd *touch_hcd = tcm_hcd->touch_hcd;
+
+    TPD_DEBUG("%s: set gesture report\n", __func__);
+    length = le2_to_uint(tcm_hcd->app_info.max_touch_report_config_size);
+
+    if (length < TOUCH_REPORT_CONFIG_SIZE) {
+        TPD_INFO("Invalid maximum touch report config size\n");
+        return -EINVAL;
+    }
+
+    LOCK_BUFFER(touch_hcd->out);
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &touch_hcd->out,
+            length);
+    if (retval < 0) {
+        TPD_INFO("Failed to allocate memory for touch_hcd->out.buf\n");
+        UNLOCK_BUFFER(touch_hcd->out);
+        return retval;
+    }
+
+    touch_hcd->out.buf[idx++] = TOUCH_GESTURE_DOUBLE_TAP;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_CIRCLE;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_SWIPE;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_UNICODE;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_VEE;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_TRIANGLE;
+    touch_hcd->out.buf[idx++] = 1;
+    touch_hcd->out.buf[idx++] = TOUCH_PAD_TO_NEXT_BYTE;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_INFO;
+    touch_hcd->out.buf[idx++] = 16;
+    touch_hcd->out.buf[idx++] = TOUCH_REPORT_GESTURE_COORDINATE;
+    touch_hcd->out.buf[idx++] = 192;
+    touch_hcd->out.buf[idx++] = TOUCH_FOREACH_ACTIVE_OBJECT;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_INDEX;
+    touch_hcd->out.buf[idx++] = 4;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_CLASSIFICATION;
+    touch_hcd->out.buf[idx++] = 4;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_X_POSITION;
+    touch_hcd->out.buf[idx++] = 12;
+    touch_hcd->out.buf[idx++] = TOUCH_OBJECT_N_Y_POSITION;
+    touch_hcd->out.buf[idx++] = 12;
+    touch_hcd->out.buf[idx++] = TOUCH_FOREACH_END;
+    touch_hcd->out.buf[idx++] = TOUCH_END;
+
+    LOCK_BUFFER(touch_hcd->resp);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_SET_TOUCH_REPORT_CONFIG,
+            touch_hcd->out.buf,
+            length,
+            &touch_hcd->resp.buf,
+            &touch_hcd->resp.buf_size,
+            &touch_hcd->resp.data_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_SET_TOUCH_REPORT_CONFIG));
+        UNLOCK_BUFFER(touch_hcd->resp);
+        UNLOCK_BUFFER(touch_hcd->out);
+        return retval;
+    }
+
+    UNLOCK_BUFFER(touch_hcd->resp);
+    UNLOCK_BUFFER(touch_hcd->out);
+
+    return 0;
+}
+
+int syna_set_input_reporting(struct syna_tcm_hcd *tcm_hcd, bool suspend)
+{
+    int retval = 0;
+    struct touch_hcd *touch_hcd = tcm_hcd->touch_hcd;
+
+    TPD_DEBUG("%s: mode 0x%x, state %d\n", __func__, tcm_hcd->id_info.mode, suspend);
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        TPD_INFO("Application firmware not running\n");
+        return 0;
+    }
+
+    touch_hcd->report_touch = false;
+
+    mutex_lock(&touch_hcd->report_mutex);
+
+    if (!suspend) {
+        retval = syna_set_normal_report_config(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to set report config\n");
+            goto default_config;
+        }
+    } else {
+        retval = syna_set_gesture_report_config(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to set report config\n");
+            goto default_config;
+        }
+    }
+
+    retval = syna_get_input_params(tcm_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to get input parameters\n");
+    }
+
+    goto exit;
+
+default_config:
+    /*if failed to set report config, use default report config */
+    retval = syna_set_default_report_config(tcm_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to set default report config");
+    }
+
+exit:
+    mutex_unlock(&touch_hcd->report_mutex);
+
+    touch_hcd->report_touch = retval < 0 ? false : true;
+
+    return retval;
+}
+
+static void syna_set_trigger_reason(struct syna_tcm_hcd *tcm_hcd, irq_reason trigger_reason)
+{
+    SET_BIT(tcm_hcd->trigger_reason, trigger_reason);
+    if (tcm_hcd->cb.invoke_common)
+        tcm_hcd->cb.invoke_common();
+
+    tcm_hcd->trigger_reason = 0;
+}
+
+static void syna_tcm_resize_chunk_size(struct syna_tcm_hcd *tcm_hcd)
+{
+    unsigned int max_write_size;
+
+    max_write_size = le2_to_uint(tcm_hcd->id_info.max_write_size);
+    tcm_hcd->wr_chunk_size = MIN(max_write_size, WR_CHUNK_SIZE);
+    if (tcm_hcd->wr_chunk_size == 0)
+        tcm_hcd->wr_chunk_size = max_write_size;
+
+}
+
+/**
+ * syna_tcm_dispatch_report() - dispatch report received from device
+ *
+ * @tcm_hcd: handle of core module
+ *
+ * The report generated by the device is forwarded to the synchronous inbox of
+ * each registered application module for further processing. In addition, the
+ * report notifier thread is woken up for asynchronous notification of the
+ * report occurrence.
+ */
+static void syna_tcm_dispatch_report(struct syna_tcm_hcd *tcm_hcd)
+{
+    int ret = 0;
+    LOCK_BUFFER(tcm_hcd->in);
+    LOCK_BUFFER(tcm_hcd->report.buffer);
+
+    tcm_hcd->report.buffer.buf = &tcm_hcd->in.buf[MESSAGE_HEADER_SIZE];
+    tcm_hcd->report.buffer.buf_size = tcm_hcd->in.buf_size;
+    tcm_hcd->report.buffer.buf_size -= MESSAGE_HEADER_SIZE;
+    tcm_hcd->report.buffer.data_length = tcm_hcd->payload_length;
+    tcm_hcd->report.id = tcm_hcd->status_report_code;
+
+    if (tcm_hcd->report.id == REPORT_TOUCH) {
+        ret = syna_parse_report(tcm_hcd);
+        if (ret < 0) {
+            TPD_INFO("Failed to parse report\n");
+            goto exit;
+        }
+
+        if (*tcm_hcd->in_suspend) {
+            syna_set_trigger_reason(tcm_hcd, IRQ_GESTURE);
+        } else {
+            syna_set_trigger_reason(tcm_hcd, IRQ_TOUCH);
+        }
+    } else if (tcm_hcd->report.id == REPORT_IDENTIFY) {
+        if (tcm_hcd->cb.async_work && tcm_hcd->id_info.mode == MODE_APPLICATION)
+            tcm_hcd->cb.async_work();
+    } else {
+        syna_tcm_test_report(tcm_hcd);
+    }
+
+exit:
+    UNLOCK_BUFFER(tcm_hcd->report.buffer);
+    UNLOCK_BUFFER(tcm_hcd->in);
+    return;
+}
+
+
+/**
+ * syna_tcm_dispatch_response() - dispatch response received from device
+ *
+ * @tcm_hcd: handle of core module
+ *
+ * The response to a command is forwarded to the sender of the command.
+ */
+static void syna_tcm_dispatch_response(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+
+    if (atomic_read(&tcm_hcd->command_status) != CMD_BUSY)
+        return;
+
+    LOCK_BUFFER(tcm_hcd->resp);
+
+    if (tcm_hcd->payload_length == 0) {
+        UNLOCK_BUFFER(tcm_hcd->resp);
+        atomic_set(&tcm_hcd->command_status, CMD_IDLE);
+        goto exit;
+    }
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &tcm_hcd->resp,
+            tcm_hcd->payload_length);
+    if (retval < 0) {
+        TPD_INFO("Failed to allocate memory for tcm_hcd->resp.buf\n");
+        UNLOCK_BUFFER(tcm_hcd->resp);
+        atomic_set(&tcm_hcd->command_status, CMD_ERROR);
+        goto exit;
+    }
+
+    LOCK_BUFFER(tcm_hcd->in);
+
+    retval = secure_memcpy(tcm_hcd->resp.buf,
+            tcm_hcd->resp.buf_size,
+            &tcm_hcd->in.buf[MESSAGE_HEADER_SIZE],
+            tcm_hcd->in.buf_size - MESSAGE_HEADER_SIZE,
+            tcm_hcd->payload_length);
+    if (retval < 0) {
+        TPD_INFO("Failed to copy payload\n");
+        UNLOCK_BUFFER(tcm_hcd->in);
+        UNLOCK_BUFFER(tcm_hcd->resp);
+        atomic_set(&tcm_hcd->command_status, CMD_ERROR);
+        goto exit;
+    }
+
+    tcm_hcd->resp.data_length = tcm_hcd->payload_length;
+
+    UNLOCK_BUFFER(tcm_hcd->in);
+    UNLOCK_BUFFER(tcm_hcd->resp);
+
+    atomic_set(&tcm_hcd->command_status, CMD_IDLE);
+
+exit:
+    complete(&response_complete);
+
+    return;
+}
+
+/**
+ * syna_tcm_dispatch_message() - dispatch message received from device
+ *
+ * @tcm_hcd: handle of core module
+ *
+ * The information received in the message read in from the device is dispatched
+ * to the appropriate destination based on whether the information represents a
+ * report or a response to a command.
+ */
+static void syna_tcm_dispatch_message(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned int payload_length;
+
+    if (tcm_hcd->status_report_code == REPORT_IDENTIFY) {
+        payload_length = tcm_hcd->payload_length;
+
+        LOCK_BUFFER(tcm_hcd->in);
+
+        retval = secure_memcpy((unsigned char *)&tcm_hcd->id_info,
+                sizeof(tcm_hcd->id_info),
+                &tcm_hcd->in.buf[MESSAGE_HEADER_SIZE],
+                tcm_hcd->in.buf_size - MESSAGE_HEADER_SIZE,
+                MIN(sizeof(tcm_hcd->id_info), payload_length));
+        if (retval < 0) {
+            TPD_INFO("Failed to copy identification info\n");
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return;
+        }
+
+        UNLOCK_BUFFER(tcm_hcd->in);
+
+        syna_tcm_resize_chunk_size(tcm_hcd);
+
+        TPD_INFO("Received identify report (firmware mode = 0x%02x)\n",
+                tcm_hcd->id_info.mode);
+
+        if (atomic_read(&tcm_hcd->command_status) == CMD_BUSY) {
+            switch (tcm_hcd->command) {
+            case CMD_RESET:
+            case CMD_RUN_BOOTLOADER_FIRMWARE:
+            case CMD_RUN_APPLICATION_FIRMWARE:
+                atomic_set(&tcm_hcd->command_status, CMD_IDLE);
+                complete(&response_complete);
+                break;
+            default:
+                TPD_INFO("Device has been reset\n");
+                atomic_set(&tcm_hcd->command_status, CMD_ERROR);
+                complete(&response_complete);
+                break;
+            }
+        }
+
+        if (tcm_hcd->id_info.mode == MODE_HOST_DOWNLOAD)
+            return;
+
+        syna_tcm_helper(tcm_hcd);
+
+    }
+
+    if (tcm_hcd->status_report_code >= REPORT_IDENTIFY)
+        syna_tcm_dispatch_report(tcm_hcd);
+    else
+        syna_tcm_dispatch_response(tcm_hcd);
+
+    return;
+}
+
+/**
+ * syna_tcm_continued_read() - retrieve entire payload from device
+ *
+ * @tcm_hcd: handle of core module
+ *
+ * Read transactions are carried out until the entire payload is retrieved from
+ * the device and stored in the handle of the core module.
+ */
+static int syna_tcm_continued_read(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned char marker;
+    unsigned char code;
+    unsigned int idx;
+    unsigned int offset;
+    unsigned int chunks;
+    unsigned int chunk_space;
+    unsigned int xfer_length;
+    unsigned int total_length;
+    unsigned int remaining_length;
+
+    total_length = MESSAGE_HEADER_SIZE + tcm_hcd->payload_length + 1;
+
+    remaining_length = total_length - tcm_hcd->read_length;
+
+    LOCK_BUFFER(tcm_hcd->in);
+
+    retval = syna_tcm_realloc_mem(tcm_hcd,
+            &tcm_hcd->in,
+            total_length);
+    if (retval < 0) {
+        TPD_INFO("Failed to reallocate memory for tcm_hcd->in.buf\n");
+        UNLOCK_BUFFER(tcm_hcd->in);
+        return retval;
+    }
+
+    /* available chunk space for payload = total chunk size minus header
+     * marker byte and header code byte */
+    if (tcm_hcd->rd_chunk_size == 0)
+        chunk_space = remaining_length;
+    else
+        chunk_space = tcm_hcd->rd_chunk_size - 2;
+
+    chunks = ceil_div(remaining_length, chunk_space);
+
+    chunks = chunks == 0 ? 1 : chunks;
+
+    offset = tcm_hcd->read_length;
+
+    LOCK_BUFFER(tcm_hcd->temp);
+
+    for (idx = 0; idx < chunks; idx++) {
+        if (remaining_length > chunk_space)
+            xfer_length = chunk_space;
+        else
+            xfer_length = remaining_length;
+
+        if (xfer_length == 1) {
+            tcm_hcd->in.buf[offset] = MESSAGE_PADDING;
+            offset += xfer_length;
+            remaining_length -= xfer_length;
+            continue;
+        }
+
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &tcm_hcd->temp,
+                xfer_length + 2);
+        if (retval < 0) {
+            TPD_INFO("Failed to allocate memory for tcm_hcd->temp.buf\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return retval;
+        }
+
+        retval = syna_tcm_read(tcm_hcd,
+                tcm_hcd->temp.buf,
+                xfer_length + 2);
+        if (retval < 0) {
+            TPD_INFO("Failed to read from device\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return retval;
+        }
+
+        marker = tcm_hcd->temp.buf[0];
+        code = tcm_hcd->temp.buf[1];
+
+        if (marker != MESSAGE_MARKER) {
+            TPD_INFO("Incorrect header marker (0x%02x)\n",
+                    marker);
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return -EIO;
+        }
+
+        if (code != STATUS_CONTINUED_READ) {
+            TPD_INFO("Incorrect header code (0x%02x)\n",
+                    code);
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return -EIO;
+        }
+
+        retval = secure_memcpy(&tcm_hcd->in.buf[offset],
+                total_length - offset,
+                &tcm_hcd->temp.buf[2],
+                xfer_length,
+                xfer_length);
+        if (retval < 0) {
+            TPD_INFO("Failed to copy payload\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            UNLOCK_BUFFER(tcm_hcd->in);
+            return retval;
+        }
+
+        offset += xfer_length;
+
+        remaining_length -= xfer_length;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->temp);
+    UNLOCK_BUFFER(tcm_hcd->in);
+
+    return 0;
+}
+
+/**
+ * syna_tcm_raw_read() - retrieve specific number of data bytes from device
+ *
+ * @tcm_hcd: handle of core module
+ * @in_buf: buffer for storing data retrieved from device
+ * @length: number of bytes to retrieve from device
+ *
+ * Read transactions are carried out until the specific number of data bytes are
+ * retrieved from the device and stored in in_buf.
+ */
+static int syna_tcm_raw_read(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char *in_buf, unsigned int length)
+{
+    int retval;
+    unsigned char code;
+    unsigned int idx;
+    unsigned int offset;
+    unsigned int chunks;
+    unsigned int chunk_space;
+    unsigned int xfer_length;
+    unsigned int remaining_length;
+
+    if (length < 2) {
+        TPD_INFO("Invalid length information\n");
+        return -EINVAL;
+    }
+
+    /* minus header marker byte and header code byte */
+    remaining_length = length - 2;
+
+    /* available chunk space for data = total chunk size minus header marker
+     * byte and header code byte */
+    if (tcm_hcd->rd_chunk_size == 0)
+        chunk_space = remaining_length;
+    else
+        chunk_space = tcm_hcd->rd_chunk_size - 2;
+
+    chunks = ceil_div(remaining_length, chunk_space);
+
+    chunks = chunks == 0 ? 1 : chunks;
+
+    offset = 0;
+
+    LOCK_BUFFER(tcm_hcd->temp);
+
+    for (idx = 0; idx < chunks; idx++) {
+        if (remaining_length > chunk_space)
+            xfer_length = chunk_space;
+        else
+            xfer_length = remaining_length;
+
+        if (xfer_length == 1) {
+            in_buf[offset] = MESSAGE_PADDING;
+            offset += xfer_length;
+            remaining_length -= xfer_length;
+            continue;
+        }
+
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &tcm_hcd->temp,
+                xfer_length + 2);
+        if (retval < 0) {
+            TPD_INFO("Failed to allocate memory for tcm_hcd->temp.buf\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            return retval;
+        }
+
+        retval = syna_tcm_read(tcm_hcd,
+                tcm_hcd->temp.buf,
+                xfer_length + 2);
+        if (retval < 0) {
+            TPD_INFO("Failed to read from device\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            return retval;
+        }
+
+        code = tcm_hcd->temp.buf[1];
+
+        if (idx == 0) {
+            retval = secure_memcpy(&in_buf[0],
+                    length,
+                    &tcm_hcd->temp.buf[0],
+                    xfer_length + 2,
+                    xfer_length + 2);
+        } else {
+            if (code != STATUS_CONTINUED_READ) {
+                TPD_INFO("Incorrect header code (0x%02x)\n",
+                        code);
+                UNLOCK_BUFFER(tcm_hcd->temp);
+                return -EIO;
+            }
+
+            retval = secure_memcpy(&in_buf[offset],
+                    length - offset,
+                    &tcm_hcd->temp.buf[2],
+                    xfer_length,
+                    xfer_length);
+        }
+        if (retval < 0) {
+            TPD_INFO("Failed to copy data\n");
+            UNLOCK_BUFFER(tcm_hcd->temp);
+            return retval;
+        }
+
+        if (idx == 0)
+            offset += (xfer_length + 2);
+        else
+            offset += xfer_length;
+
+        remaining_length -= xfer_length;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->temp);
+
+    return 0;
+}
+
+/**
+ * syna_tcm_raw_write() - write command/data to device without receiving
+ * response
+ *
+ * @tcm_hcd: handle of core module
+ * @command: command to send to device
+ * @data: data to send to device
+ * @length: length of data in bytes
+ *
+ * A command and its data, if any, are sent to the device.
+ */
+static int syna_tcm_raw_write(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char command, unsigned char *data, unsigned int length)
+{
+    int retval;
+    unsigned int idx;
+    unsigned int chunks;
+    unsigned int chunk_space;
+    unsigned int xfer_length;
+    unsigned int remaining_length;
+
+    remaining_length = length;
+
+    /* available chunk space for data = total chunk size minus command
+     * byte */
+    if (tcm_hcd->wr_chunk_size == 0)
+        chunk_space = remaining_length;
+    else
+        chunk_space = tcm_hcd->wr_chunk_size - 1;
+
+    chunks = ceil_div(remaining_length, chunk_space);
+
+    chunks = chunks == 0 ? 1 : chunks;
+
+    LOCK_BUFFER(tcm_hcd->out);
+
+    for (idx = 0; idx < chunks; idx++) {
+        if (remaining_length > chunk_space)
+            xfer_length = chunk_space;
+        else
+            xfer_length = remaining_length;
+
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &tcm_hcd->out,
+                xfer_length + 1);
+        if (retval < 0) {
+            TPD_INFO("Failed to allocate memory for tcm_hcd->out.buf\n");
+            UNLOCK_BUFFER(tcm_hcd->out);
+            return retval;
+        }
+
+        if (idx == 0)
+            tcm_hcd->out.buf[0] = command;
+        else
+            tcm_hcd->out.buf[0] = CMD_CONTINUE_WRITE;
+
+        if (xfer_length) {
+            retval = secure_memcpy(&tcm_hcd->out.buf[1],
+                    xfer_length,
+                    &data[idx * chunk_space],
+                    remaining_length,
+                    xfer_length);
+            if (retval < 0) {
+                TPD_INFO("Failed to copy data\n");
+                UNLOCK_BUFFER(tcm_hcd->out);
+                return retval;
+            }
+        }
+
+        retval = syna_tcm_write(tcm_hcd,
+                tcm_hcd->out.buf,
+                xfer_length + 1);
+        if (retval < 0) {
+            TPD_INFO("Failed to write to device\n");
+            UNLOCK_BUFFER(tcm_hcd->out);
+            return retval;
+        }
+
+        remaining_length -= xfer_length;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->out);
+
+    return 0;
+}
+
+/*add this for debug. remove before pvt*/
+static void syna_tcm_debug_message(char *buf, int len)
+{
+    int i = 0;
+    TPD_INFO("message hex:");
+    for (i = 0; i < len; i++) {
+        if (i > 32)
+            break;
+
+        printk("0x%x ", buf[i]);
+    }
+
+    printk("\n");
+}
+
+/**
+ * syna_tcm_read_message() - read message from device
+ *
+ * @tcm_hcd: handle of core module
+ * @in_buf: buffer for storing data in raw read mode
+ * @length: length of data in bytes in raw read mode
+ *
+ * If in_buf is not NULL, raw read mode is used and syna_tcm_raw_read() is
+ * called. Otherwise, a message including its entire payload is retrieved from
+ * the device and dispatched to the appropriate destination.
+ */
+static int syna_tcm_read_message(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char *in_buf, unsigned int length)
+{
+    int retval;
+    unsigned int total_length;
+    struct syna_tcm_message_header *header;
+
+    TPD_DEBUG("%s\n", __func__);
+    mutex_lock(&tcm_hcd->rw_ctrl_mutex);
+
+    if (in_buf != NULL) {
+        retval = syna_tcm_raw_read(tcm_hcd, in_buf, length);
+        goto exit;
+    }
+
+    LOCK_BUFFER(tcm_hcd->in);
+
+    retval = syna_tcm_read(tcm_hcd,
+            tcm_hcd->in.buf,
+            tcm_hcd->read_length);
+    if (retval < 0) {
+        TPD_INFO("Failed to read from device\n");
+        UNLOCK_BUFFER(tcm_hcd->in);
+        goto exit;
+    }
+
+    header = (struct syna_tcm_message_header *)tcm_hcd->in.buf;
+
+    if (header->marker != MESSAGE_MARKER) {
+        retval = -ENXIO;
+        goto exit;
+    }
+
+    tcm_hcd->status_report_code = header->code;
+    tcm_hcd->payload_length = le2_to_uint(header->length);
+
+    TPD_DETAIL("Header code = 0x%02x Payload len = %d\n",
+            tcm_hcd->status_report_code, tcm_hcd->payload_length);
+
+    if (tcm_hcd->status_report_code <= STATUS_ERROR ||
+            tcm_hcd->status_report_code == STATUS_INVALID) {
+        switch (tcm_hcd->status_report_code) {
+        case STATUS_OK:
+            break;
+        case STATUS_CONTINUED_READ:
+            TPD_INFO("Out-of-sync continued read\n");
+        case STATUS_IDLE:
+        case STATUS_BUSY:
+            tcm_hcd->payload_length = 0;
+            UNLOCK_BUFFER(tcm_hcd->in);
+            retval = 0;
+            goto exit;
+        default:
+            TPD_INFO("Incorrect header code (0x%02x)\n",
+                    tcm_hcd->status_report_code);
+            if (tcm_hcd->status_report_code != STATUS_ERROR) {
+                UNLOCK_BUFFER(tcm_hcd->in);
+                retval = -EIO;
+                goto exit;
+            }
+        }
+    }
+
+    total_length = MESSAGE_HEADER_SIZE + tcm_hcd->payload_length + 1;
+
+#ifdef PREDICTIVE_READING
+    if (total_length <= tcm_hcd->read_length) {
+        goto check_padding;
+    } else if (total_length - 1 == tcm_hcd->read_length) {
+        tcm_hcd->in.buf[total_length - 1] = MESSAGE_PADDING;
+        goto check_padding;
+    }
+#else
+    if (tcm_hcd->payload_length == 0) {
+        tcm_hcd->in.buf[total_length - 1] = MESSAGE_PADDING;
+        goto check_padding;
+    }
+#endif
+
+    UNLOCK_BUFFER(tcm_hcd->in);
+
+    retval = syna_tcm_continued_read(tcm_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to do continued read\n");
+        goto exit;
+    };
+
+    LOCK_BUFFER(tcm_hcd->in);
+
+    tcm_hcd->in.buf[0] = MESSAGE_MARKER;
+    tcm_hcd->in.buf[1] = tcm_hcd->status_report_code;
+    tcm_hcd->in.buf[2] = (unsigned char)tcm_hcd->payload_length;
+    tcm_hcd->in.buf[3] = (unsigned char)(tcm_hcd->payload_length >> 8);
+
+check_padding:
+    if (tcm_hcd->in.buf[total_length - 1] != MESSAGE_PADDING) {
+        TPD_INFO("Incorrect message padding byte (0x%02x)\n",
+                tcm_hcd->in.buf[total_length - 1]);
+        UNLOCK_BUFFER(tcm_hcd->in);
+        retval = -EIO;
+        goto exit;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->in);
+
+#ifdef PREDICTIVE_READING
+    total_length = MAX(total_length, MIN_READ_LENGTH);
+    tcm_hcd->read_length = MIN(total_length, tcm_hcd->rd_chunk_size);
+    if (tcm_hcd->rd_chunk_size == 0)
+        tcm_hcd->read_length = total_length;
+#endif
+
+    /*add for debug, remove before pvt*/
+    if (LEVEL_DEBUG == tp_debug) {
+        syna_tcm_debug_message(&tcm_hcd->in.buf[4], tcm_hcd->payload_length);
+    }
+
+    syna_tcm_dispatch_message(tcm_hcd);
+
+    retval = 0;
+
+exit:
+    if (retval < 0) {
+        if (atomic_read(&tcm_hcd->command_status) == CMD_BUSY) {
+            atomic_set(&tcm_hcd->command_status, CMD_ERROR);
+            complete(&response_complete);
+        }
+    }
+
+    mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+
+    return retval;
+}
+
+/**
+ * syna_tcm_write_message() - write message to device and receive response
+ *
+ * @tcm_hcd: handle of core module
+ * @command: command to send to device
+ * @payload: payload of command
+ * @length: length of payload in bytes
+ * @resp_buf: buffer for storing command response
+ * @resp_buf_size: size of response buffer in bytes
+ * @resp_length: length of command response in bytes
+ * @polling_delay_ms: delay time after sending command before resuming polling
+ *
+ * If resp_buf is NULL, raw write mode is used and syna_tcm_raw_write() is
+ * called. Otherwise, a command and its payload, if any, are sent to the device
+ * and the response to the command generated by the device is read in.
+ */
+static int syna_tcm_write_message(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char command, unsigned char *payload,
+        unsigned int length, unsigned char **resp_buf,
+        unsigned int *resp_buf_size, unsigned int *resp_length,
+        unsigned int timeout)
+{
+    int retval;
+    unsigned int idx;
+    unsigned int chunks;
+    unsigned int chunk_space;
+    unsigned int xfer_length;
+    unsigned int remaining_length;
+    unsigned int command_status = 0;
+    unsigned int timeout_ms = 0;
+
+    mutex_lock(&tcm_hcd->command_mutex);
+    mutex_lock(&tcm_hcd->rw_ctrl_mutex);
+
+    if (resp_buf == NULL) {
+        retval = syna_tcm_raw_write(tcm_hcd, command, payload, length);
+        mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+        goto exit;
+    }
+
+    atomic_set(&tcm_hcd->command_status, CMD_BUSY);
+    reinit_completion(&response_complete);
+    tcm_hcd->command = command;
+
+    LOCK_BUFFER(tcm_hcd->resp);
+
+    tcm_hcd->resp.buf = *resp_buf;
+    tcm_hcd->resp.buf_size = *resp_buf_size;
+    tcm_hcd->resp.data_length = 0;
+
+    UNLOCK_BUFFER(tcm_hcd->resp);
+
+    /* adding two length bytes as part of payload */
+    remaining_length = length + 2;
+
+    /* available chunk space for payload = total chunk size minus command
+     * byte */
+    if (tcm_hcd->wr_chunk_size == 0)
+        chunk_space = remaining_length;
+    else
+        chunk_space = tcm_hcd->wr_chunk_size - 1;
+
+    chunks = ceil_div(remaining_length, chunk_space);
+
+    chunks = chunks == 0 ? 1 : chunks;
+
+    TPD_DETAIL("%s:Command = 0x%02x\n", __func__, command);
+
+    LOCK_BUFFER(tcm_hcd->out);
+
+    for (idx = 0; idx < chunks; idx++) {
+        if (remaining_length > chunk_space)
+            xfer_length = chunk_space;
+        else
+            xfer_length = remaining_length;
+
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &tcm_hcd->out,
+                xfer_length + 1);
+        if (retval < 0) {
+            TPD_INFO("Failed to allocate memory for tcm_hcd->out.buf\n");
+            UNLOCK_BUFFER(tcm_hcd->out);
+            mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+            goto exit;
+        }
+
+        if (idx == 0) {
+            tcm_hcd->out.buf[0] = command;
+            tcm_hcd->out.buf[1] = (unsigned char)length;
+            tcm_hcd->out.buf[2] = (unsigned char)(length >> 8);
+
+            if (xfer_length > 2) {
+                retval = secure_memcpy(&tcm_hcd->out.buf[3],
+                        xfer_length - 2,
+                        payload,
+                        remaining_length - 2,
+                        xfer_length - 2);
+                if (retval < 0) {
+                    TPD_INFO("Failed to copy payload\n");
+                    UNLOCK_BUFFER(tcm_hcd->out);
+                    mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+                    goto exit;
+                }
+            }
+        } else {
+            tcm_hcd->out.buf[0] = CMD_CONTINUE_WRITE;
+
+            retval = secure_memcpy(&tcm_hcd->out.buf[1],
+                    xfer_length,
+                    &payload[idx * chunk_space - 2],
+                    remaining_length,
+                    xfer_length);
+            if (retval < 0) {
+                TPD_INFO("Failed to copy payload\n");
+                UNLOCK_BUFFER(tcm_hcd->out);
+                mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+                goto exit;
+            }
+        }
+
+        retval = syna_tcm_write(tcm_hcd,
+                tcm_hcd->out.buf,
+                xfer_length + 1);
+        if (retval < 0) {
+            TPD_INFO("Failed to write to device\n");
+            UNLOCK_BUFFER(tcm_hcd->out);
+            mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+            goto exit;
+        }
+
+        remaining_length -= xfer_length;
+    }
+
+    UNLOCK_BUFFER(tcm_hcd->out);
+
+    mutex_unlock(&tcm_hcd->rw_ctrl_mutex);
+
+    if (timeout == 0) {
+        timeout_ms = RESPONSE_TIMEOUT_MS_DEFAULT;
+    } else {
+        timeout_ms = timeout;
+    }
+
+    retval = wait_for_completion_timeout(&response_complete,
+            msecs_to_jiffies(timeout_ms));
+    if (retval == 0) {
+        TPD_INFO("Timed out waiting for response (command 0x%02x)\n",
+                tcm_hcd->command);
+        retval = -EIO;
+    } else {
+        command_status = atomic_read(&tcm_hcd->command_status);
+
+        if (command_status != CMD_IDLE ||
+                tcm_hcd->status_report_code == STATUS_ERROR) {
+            TPD_INFO("Failed to get valid response\n");
+            retval = -EIO;
+            goto exit;
+        }
+
+        retval = 0;
+    }
+
+exit:
+    if (command_status == CMD_IDLE) {
+        LOCK_BUFFER(tcm_hcd->resp);
+
+        if (tcm_hcd->status_report_code == STATUS_ERROR) {
+            if (tcm_hcd->resp.data_length) {
+                TPD_INFO("Error code = 0x%02x\n",
+                        tcm_hcd->resp.buf[0]);
+            }
+        }
+
+        if (resp_buf != NULL) {
+            *resp_buf = tcm_hcd->resp.buf;
+            *resp_buf_size = tcm_hcd->resp.buf_size;
+            *resp_length = tcm_hcd->resp.data_length;
+        }
+
+        UNLOCK_BUFFER(tcm_hcd->resp);
+    }
+
+    tcm_hcd->command = CMD_NONE;
+    atomic_set(&tcm_hcd->command_status, CMD_IDLE);
+    mutex_unlock(&tcm_hcd->command_mutex);
+
+    return retval;
+}
+
+static int syna_tcm_get_app_info(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int timeout;
+
+    timeout = APP_STATUS_POLL_TIMEOUT_MS;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+get_app_info:
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_GET_APPLICATION_INFO,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",
+                STR(CMD_GET_APPLICATION_INFO));
+        goto exit;
+    }
+
+    retval = secure_memcpy((unsigned char *)&tcm_hcd->app_info,
+            sizeof(tcm_hcd->app_info),
+            resp_buf,
+            resp_buf_size,
+            MIN(sizeof(tcm_hcd->app_info), resp_length));
+    if (retval < 0) {
+        TPD_INFO("Failed to copy application info\n");
+        goto exit;
+    }
+
+    tcm_hcd->app_status = le2_to_uint(tcm_hcd->app_info.status);
+
+    if (tcm_hcd->app_status == APP_STATUS_BOOTING ||
+            tcm_hcd->app_status == APP_STATUS_UPDATING) {
+        if (timeout > 0) {
+            msleep(APP_STATUS_POLL_MS);
+            timeout -= APP_STATUS_POLL_MS;
+            goto get_app_info;
+        }
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static int syna_tcm_get_boot_info(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_GET_BOOT_INFO,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",
+                STR(CMD_GET_BOOT_INFO));
+        goto exit;
+    }
+
+    retval = secure_memcpy((unsigned char *)&tcm_hcd->boot_info,
+            sizeof(tcm_hcd->boot_info),
+            resp_buf,
+            resp_buf_size,
+            MIN(sizeof(tcm_hcd->boot_info), resp_length));
+    if (retval < 0) {
+        TPD_INFO("Failed to copy boot info\n");
+        goto exit;
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static int syna_tcm_identify(struct syna_tcm_hcd *tcm_hcd, bool id)
+{
+    int retval;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    mutex_lock(&tcm_hcd->identify_mutex);
+
+    if (!id)
+        goto get_info;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_IDENTIFY,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",
+                STR(CMD_IDENTIFY));
+        goto exit;
+    }
+
+    retval = secure_memcpy((unsigned char *)&tcm_hcd->id_info,
+            sizeof(tcm_hcd->id_info),
+            resp_buf,
+            resp_buf_size,
+            MIN(sizeof(tcm_hcd->id_info), resp_length));
+    if (retval < 0) {
+        TPD_INFO("Failed to copy identification info\n");
+        goto exit;
+    }
+
+    syna_tcm_resize_chunk_size(tcm_hcd);
+
+get_info:
+    if (tcm_hcd->id_info.mode == MODE_APPLICATION) {
+        retval = syna_tcm_get_app_info(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to get application info\n");
+            goto exit;
+        }
+    } else {
+        retval = syna_tcm_get_boot_info(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to get boot info\n");
+            goto exit;
+        }
+    }
+
+    retval = 0;
+
+exit:
+    mutex_unlock(&tcm_hcd->identify_mutex);
+
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static int syna_tcm_run_application_firmware(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    bool retry;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    retry = true;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+retry:
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_RUN_APPLICATION_FIRMWARE,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",
+                STR(CMD_RUN_APPLICATION_FIRMWARE));
+        goto exit;
+    }
+
+    retval = syna_tcm_identify(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to do identification\n");
+        goto exit;
+    }
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION) {
+        TPD_INFO("Failed to run application firmware (boot status = 0x%02x)\n",
+                tcm_hcd->boot_info.status);
+        if (retry) {
+            retry = false;
+            goto retry;
+        }
+        retval = -EINVAL;
+        goto exit;
+    } else if (tcm_hcd->app_status != APP_STATUS_OK) {
+        TPD_INFO("Application status = 0x%02x\n", tcm_hcd->app_status);
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+
+static int syna_tcm_run_bootloader_firmware(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_RUN_BOOTLOADER_FIRMWARE,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_RUN_BOOTLOADER_FIRMWARE));
+        goto exit;
+    }
+
+    retval = syna_tcm_identify(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to do identification\n");
+        goto exit;
+    }
+
+    if (tcm_hcd->id_info.mode == MODE_APPLICATION) {
+        TPD_INFO("Failed to enter bootloader mode\n");
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+
+static int syna_tcm_switch_mode(struct syna_tcm_hcd *tcm_hcd,
+        enum firmware_mode mode)
+{
+    int retval;
+
+    mutex_lock(&tcm_hcd->reset_mutex);
+
+    switch (mode) {
+    case FW_MODE_BOOTLOADER:
+        retval = syna_tcm_run_bootloader_firmware(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to switch to bootloader mode\n");
+            goto exit;
+        }
+        break;
+    case FW_MODE_APPLICATION:
+        retval = syna_tcm_run_application_firmware(tcm_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to switch to application mode\n");
+            goto exit;
+        }
+        break;
+    default:
+        TPD_INFO("Invalid firmware mode\n");
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    retval = 0;
+
+exit:
+
+    mutex_unlock(&tcm_hcd->reset_mutex);
+
+    return retval;
+}
+
+static int syna_tcm_get_dynamic_config(struct syna_tcm_hcd *tcm_hcd,
+        enum dynamic_config_id id, unsigned short *value)
+{
+    int retval;
+    unsigned char out_buf;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+    out_buf = (unsigned char)id;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_GET_DYNAMIC_CONFIG,
+            &out_buf,
+            sizeof(out_buf),
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_SHORT);
+    if (retval < 0 || resp_length < 2) {
+        retval = -EINVAL;
+        TPD_INFO("Failed to read dynamic config\n");
+        goto exit;
+    }
+
+    *value = (unsigned short)le2_to_uint(resp_buf);
+exit:
+    kfree(resp_buf);
+    return retval;
+}
+
+static int syna_tcm_set_dynamic_config(struct syna_tcm_hcd *tcm_hcd,
+        enum dynamic_config_id id, unsigned short value)
+{
+    int retval;
+    unsigned char out_buf[3];
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    TPD_DEBUG("%s:config 0x%x, value %d\n", __func__, id, value);
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    out_buf[0] = (unsigned char)id;
+    out_buf[1] = (unsigned char)value;
+    out_buf[2] = (unsigned char)(value >> 8);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_SET_DYNAMIC_CONFIG,
+            out_buf,
+            sizeof(out_buf),
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_SHORT);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",
+                STR(CMD_SET_DYNAMIC_CONFIG));
+        goto exit;
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static void syna_tcm_write_ps_status(void *chip_data, int ps_status)
+{
+    int retval = 0;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    TPD_INFO("%s: value %d\n", __func__, ps_status);
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_PS_STATUS, ps_status);
+    if (retval < 0) {
+        TPD_INFO("Failed to write ps status\n");
+    }
+
+    return;
+}
+
+static int syna_tcm_sleep(struct syna_tcm_hcd *tcm_hcd, bool en)
+{
+    int retval;
+    unsigned char command;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    command = en ? CMD_ENTER_DEEP_SLEEP : CMD_EXIT_DEEP_SLEEP;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            command,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n",en ?STR(CMD_ENTER_DEEP_SLEEP):STR(CMD_EXIT_DEEP_SLEEP));
+        goto exit;
+    }
+
+    retval = 0;
+
+exit:
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static int syna_tcm_reset(void *chip_data)
+{
+    int retval;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    mutex_lock(&tcm_hcd->reset_mutex);
+
+    retval = syna_tcm_write_message(tcm_hcd,
+                CMD_RESET,
+                NULL,
+                0,
+                &resp_buf,
+                &resp_buf_size,
+                &resp_length,
+                0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_RESET));
+        goto exit;
+    }
+
+    msleep(200);
+    retval = syna_tcm_identify(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to do identification\n");
+        goto exit;
+    }
+
+    if (tcm_hcd->id_info.mode == MODE_APPLICATION)
+        goto dispatch_reset;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_RUN_APPLICATION_FIRMWARE,
+            NULL,
+            0,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_RUN_APPLICATION_FIRMWARE));
+    }
+
+    retval = syna_tcm_identify(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to do identification\n");
+        goto exit;
+    }
+
+dispatch_reset:
+    TPD_INFO("Firmware mode = 0x%02x, boot status 0x%02x, app status 0x%02x\n",
+        tcm_hcd->id_info.mode,
+        tcm_hcd->boot_info.status,
+        tcm_hcd->app_status);
+
+exit:
+    mutex_unlock(&tcm_hcd->reset_mutex);
+
+    kfree(resp_buf);
+
+    return retval;
+}
+
+static int syna_get_chip_info(void *chip_data){
+    int ret = 0;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    TPD_INFO("%s: Enter\n", __func__);
+
+    ret = syna_tcm_reset(tcm_hcd);  // reset to get bootloader info or boot info
+    if (ret < 0) {
+        TPD_INFO("failed to reset device\n");
+    }
+
+    ret = syna_get_default_report_config(tcm_hcd);
+    if (ret < 0) {
+        TPD_INFO("failed to get default report config\n");
+    }
+    return 0;
+}
+
+static int syna_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    tcm_hcd->iHex_name = panel_data->extra;
+    tcm_hcd->limit_name = panel_data->test_limit_name;
+    return 0;
+}
+
+static u8 syna_trigger_reason(void *chip_data, int gesture_enable, int is_suspended){
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    return tcm_hcd->trigger_reason;
+}
+
+static int syna_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    unsigned int idx;
+    unsigned int status;
+    struct object_data *object_data;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+    struct touch_hcd *touch_hcd = tcm_hcd->touch_hcd;
+    static unsigned int obj_attention = 0x00;
+
+    if (points == NULL)
+        return obj_attention;
+    object_data = touch_hcd->touch_data.object_data;
+
+    for (idx = 0; idx < touch_hcd->max_objects; idx++) {
+        status = object_data[idx].status;
+        if (status != LIFT) {
+            obj_attention |= (0x1 << idx);
+        } else {
+            if ((~obj_attention) & ((0x1) << idx))
+                continue;
+            else
+                obj_attention &= (~(0x1 << idx));
+        }
+
+        points[idx].x = object_data[idx].x_pos;;
+        points[idx].y = object_data[idx].y_pos;
+        points[idx].width_major = 30;
+        points[idx].status = 1;
+    }
+
+    return obj_attention;
+}
+
+static int syna_tcm_set_gesture_mode(struct syna_tcm_hcd *tcm_hcd, bool enable)
+{
+    int retval;
+    unsigned short config;
+
+    /*this command may take too much time, if needed can add flag to skip this */
+    retval = syna_tcm_get_dynamic_config(tcm_hcd, DC_IN_WAKEUP_GESTURE_MODE, &config);
+    if (retval < 0) {
+        TPD_INFO("Failed to get dynamic config\n");
+        return retval;
+    }
+
+    TPD_DEBUG("config id is %d\n", config);
+
+    if (enable) {
+        if (!config) {
+            retval = syna_set_input_reporting(tcm_hcd, true);
+            if (retval < 0) {
+                TPD_INFO("Failed to set input reporting\n");
+                return retval;
+            }
+
+            retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_IN_WAKEUP_GESTURE_MODE, true);
+            if (retval < 0) {
+                TPD_INFO("Failed to set dynamic gesture config\n");
+                return retval;
+            }
+        }
+    }
+
+    /*set to sleep*/
+    retval = syna_tcm_sleep(tcm_hcd, !enable);
+    if (retval < 0) {
+        TPD_INFO("Failed to set sleep mode");
+    }
+
+    return retval;
+}
+
+static int syna_tcm_normal_mode(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+
+    retval = syna_set_input_reporting(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to set input reporting\n");
+        return retval;
+    }
+
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_IN_WAKEUP_GESTURE_MODE, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to set dynamic gesture config\n");
+        return retval;
+    }
+
+    return retval;
+}
+
+static int syna_mode_switch(void *chip_data, work_mode mode, bool flag){
+    int ret = 0;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = syna_tcm_normal_mode(tcm_hcd);
+            if (ret < 0) {
+                TPD_INFO("normal mode switch failed\n");
+            }
+            break;
+        case MODE_GESTURE:
+            ret = syna_tcm_set_gesture_mode(tcm_hcd, flag);
+            if (ret < 0) {
+                TPD_INFO("%s:Failed to set gesture mode\n", __func__);
+            }
+            break;
+        case MODE_SLEEP:
+            ret = syna_tcm_sleep(tcm_hcd, true);
+            if (ret < 0) {
+                TPD_INFO("%s: failed to switch to sleep", __func__);
+            }
+            break;
+        case MODE_CHARGE:
+            ret = syna_tcm_set_dynamic_config(tcm_hcd, DC_CHARGER_CONNECTED, flag?1:0);
+            if (ret < 0) {
+                TPD_INFO("%s:failed to set charger mode\n", __func__);
+            }
+            break;
+        case MODE_EDGE:
+            ret = syna_tcm_set_dynamic_config(tcm_hcd, DC_GRIP_SUPPRESSION_ENABLED, flag?1:0);
+            if (ret < 0) {
+                TPD_INFO("%s:failed to set grip suppression\n", __func__);
+            }
+            break;
+        default:
+            break;
+    }
+    return 0;
+}
+
+static int syna_ftm_process(void *chip_data)
+{
+    TPD_INFO("%s: go into sleep\n", __func__);
+    syna_get_chip_info(chip_data);
+    syna_mode_switch(chip_data, MODE_SLEEP, true);
+    return 0;
+}
+
+static int  syna_tcm_reinit_device (void *chip_data)
+{
+    complete_all(&response_complete);
+    complete_all(&report_complete);
+
+    return 0;
+}
+
+static int syna_hw_reset(struct syna_tcm_hcd *tcm_hcd, struct hw_resource *hw_res)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("hardware reset: %d\n", hw_res->reset_gpio);
+        gpio_set_value(hw_res->reset_gpio, false);
+        msleep(20);
+        gpio_set_value(hw_res->reset_gpio, true);
+        msleep(200);
+        return 0;
+    }
+
+    return -EINVAL;
+}
+
+static int syna_reset_gpio(void *chip_data, bool enable)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    TPD_DEBUG("%s:gpio enable %d\n", __func__, enable);
+    if (gpio_is_valid(tcm_hcd->hw_res->reset_gpio)) {
+        gpio_set_value(tcm_hcd->hw_res->reset_gpio, enable);
+    }
+
+    return 0;
+}
+
+static int syna_power_control(void *chip_data, bool enable)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    TPD_DEBUG("%s: %d\n", __func__, enable);
+
+    return syna_hw_reset(tcm_hcd, tcm_hcd->hw_res);
+}
+
+static fw_check_state syna_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    TPD_INFO("fw id %d, custom config id 0x%s\n", panel_data->TP_FW, tcm_hcd->app_info.customer_config_id);
+
+    if (strlen(tcm_hcd->app_info.customer_config_id) == 0) {
+        return FW_ABNORMAL;
+    }
+
+    panel_data->TP_FW = le4_to_uint(tcm_hcd->id_info.build_id);
+    if (panel_data->TP_FW == 0) {
+        return FW_ABNORMAL;
+    }
+
+    if (panel_data->manufacture_info.version) {
+        sprintf(panel_data->manufacture_info.version, "0x%s", tcm_hcd->app_info.customer_config_id);
+    }
+
+    return FW_NORMAL;
+}
+
+static int syna_tcm_helper(struct syna_tcm_hcd *tcm_hcd)
+{
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION &&
+        !mutex_is_locked(&tcm_hcd->reset_mutex)) {
+        TPD_INFO("%s: use helper\n", __func__);
+        queue_work(tcm_hcd->helper_workqueue, &tcm_hcd->helper_work);
+    }
+
+    return 0;
+}
+
+static void syna_tcm_helper_work(struct work_struct *work)
+{
+    int retval = 0;
+    struct syna_tcm_hcd *tcm_hcd = container_of(work, struct syna_tcm_hcd,
+        helper_work);
+
+    mutex_lock(&tcm_hcd->reset_mutex);
+    retval = syna_tcm_run_application_firmware(tcm_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to switch to app mode\n");
+    }
+
+    mutex_unlock(&tcm_hcd->reset_mutex);
+}
+
+static int syna_tcm_async_work(void *chip_data)
+{
+    int retval = 0;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION) {
+        return 0;
+    }
+
+    retval = syna_tcm_identify(tcm_hcd, false);
+    if (retval < 0) {
+        TPD_INFO("Failed to do identification\n");
+        return retval;
+    }
+
+    syna_set_trigger_reason(tcm_hcd, IRQ_FW_AUTO_RESET);
+    return 0;
+}
+
+static int syna_tcm_erase_flash(struct syna_tcm_hcd *tcm_hcd, unsigned int page_start, unsigned int page_count)
+{
+    int ret;
+    unsigned char out_buf[2];
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    TPD_INFO("start page %d, page count %d\n", page_start, page_count);
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    out_buf[0] = (unsigned char)page_start;
+    out_buf[1] = (unsigned char)page_count;
+
+    ret = syna_tcm_write_message(tcm_hcd,
+            CMD_ERASE_FLASH,
+            out_buf,
+            sizeof(out_buf),
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            ERASE_FLASH_DELAY_MS);
+    if (ret < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_ERASE_FLASH));
+    }
+
+    kfree(resp_buf);
+    return ret;
+}
+
+static int syna_tcm_write_flash(struct syna_tcm_hcd *tcm_hcd, struct reflash_hcd *reflash_hcd,
+                unsigned int address, const unsigned char *data, unsigned int datalen)
+{
+    int retval;
+    unsigned int w_len, xfer_len, remaining_len;
+    unsigned int flash_addr, block_addr;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int offset;
+    struct syna_tcm_buffer out;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+    memset(&out, 0, sizeof(out));
+    INIT_BUFFER(out, false);
+
+    w_len = tcm_hcd->wr_chunk_size - 5;
+    w_len = w_len - (w_len % reflash_hcd->write_block_size);
+    w_len = MIN(w_len, reflash_hcd->max_write_payload_size);
+    offset = 0;
+
+    remaining_len = datalen;
+
+    while(remaining_len) {
+        if (remaining_len > w_len) {
+            xfer_len = w_len;
+        } else {
+            xfer_len = remaining_len;
+        }
+
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &out,
+                xfer_len + 2);
+        if (retval < 0) {
+            TPD_INFO("Failed to alloc memory\n");
+            break;
+        }
+
+        flash_addr = address + offset;
+        block_addr = flash_addr / reflash_hcd->write_block_size;
+        out.buf[0] = (unsigned char)block_addr;
+        out.buf[1] = (unsigned char)(block_addr >> 8);
+
+        retval = secure_memcpy(&out.buf[2],
+                xfer_len,
+                &data[offset],
+                datalen - offset,
+                xfer_len);
+        if (retval < 0) {
+            TPD_INFO("Failed to copy write data\n");
+            break;
+        }
+
+        retval = syna_tcm_write_message(tcm_hcd,
+                CMD_WRITE_FLASH,
+                out.buf,
+                xfer_len + 2,
+                &resp_buf,
+                &resp_buf_size,
+                &resp_length,
+                WRITE_FLASH_DELAY_MS);
+        if (retval < 0) {
+            TPD_INFO("Failed to write message %s, Addr 0x%08x, Len 0x%d\n",
+                STR(CMD_WRITE_FLASH), flash_addr, xfer_len);
+            break;
+        }
+
+        offset += xfer_len;
+        remaining_len -= xfer_len;
+    }
+
+    RELEASE_BUFFER(out);
+    kfree(resp_buf);
+    return 0;
+}
+
+extern int try_to_recovery_ic(struct syna_tcm_hcd *tcm_hcd, char *iHex);
+
+static fw_update_state syna_tcm_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret = 0;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+    struct image_info image_info;
+    unsigned int image_fw_id, device_fw_id;
+    unsigned char *device_config_id;
+    unsigned char *image_config_id;
+    struct app_config_header *header;
+    int temp;
+    int page_start, page_count;
+    unsigned int size, flash_addr;
+    const unsigned char *data;
+    struct reflash_hcd reflash_hcd;
+    unsigned int device_addr;
+    unsigned int device_size;
+
+    /*first check whether in ubl mode, if yes, do iHex update first. may have i2c error */
+    /*if not force, do not do recovery*/
+    if (force) {
+        ret = try_to_recovery_ic(tcm_hcd, tcm_hcd->iHex_name);
+
+        if (ret > 0) {
+            ret = syna_tcm_switch_mode(tcm_hcd, FW_MODE_APPLICATION); /* switch to app mode to get app info */
+            if (ret < 0) {
+                TPD_INFO("Failed to switch to normal mode\n");
+                return FW_UPDATE_ERROR;
+            }
+        }
+    }
+
+    memset(&image_info, 0, sizeof(struct image_info));
+    ret = synaptics_parse_header_v2(&image_info, fw->data);
+    if (ret < 0) {
+        TPD_INFO("Failed to parse fw image\n");
+        return FW_UPDATE_FATAL;
+    }
+
+    header = (struct app_config_header *)image_info.app_config.data;
+
+    image_fw_id = le4_to_uint(header->build_id);
+    device_fw_id = le4_to_uint(tcm_hcd->id_info.build_id);
+    TPD_INFO("image build id %d, device build id %d\n", image_fw_id, device_fw_id);
+
+    image_config_id = header->customer_config_id;
+    device_config_id = tcm_hcd->app_info.customer_config_id;
+    TPD_INFO("image config id 0x%s, device config id 0x%s\n", image_config_id, device_config_id);
+
+    if (!force) {
+        if ((image_fw_id == device_fw_id) && (strncmp(image_config_id, device_config_id, 16) == 0)) {
+            TPD_INFO("same firmware/config id, no need to update\n");
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    ret = syna_tcm_identify(tcm_hcd, true);
+    if (ret < 0) {
+        return FW_UPDATE_ERROR;
+    }
+
+    if (tcm_hcd->id_info.mode == MODE_APPLICATION) {
+        ret = syna_tcm_switch_mode(tcm_hcd, FW_MODE_BOOTLOADER);
+        if (ret < 0) {
+            TPD_INFO("Failed to switch to bootloader mode\n");
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    temp = tcm_hcd->boot_info.write_block_size_words;
+    reflash_hcd.write_block_size = temp * 2;
+
+    temp = le2_to_uint(tcm_hcd->boot_info.erase_page_size_words);
+    reflash_hcd.page_size = temp * 2;
+
+    temp = le2_to_uint(tcm_hcd->boot_info.max_write_payload_size);
+    reflash_hcd.max_write_payload_size = temp;
+
+    TPD_INFO("Write block size %d, page size %d, payload_size %d\n",
+        reflash_hcd.write_block_size,
+        reflash_hcd.page_size,
+        reflash_hcd.max_write_payload_size);
+
+    if (reflash_hcd.write_block_size > (tcm_hcd->wr_chunk_size - 5)) {
+        TPD_INFO("write block size is exceed\n");
+        return FW_UPDATE_ERROR;
+    }
+
+    if (image_info.app_firmware.size == 0) {
+        TPD_INFO("no application firmware in image\n\n");
+        return FW_UPDATE_ERROR;
+    }
+
+    /* erase application firmware */
+    page_start = image_info.app_firmware.flash_addr / reflash_hcd.page_size;
+    page_count = ceil_div(image_info.app_firmware.size, reflash_hcd.page_size);
+    ret = syna_tcm_erase_flash(tcm_hcd, page_start, page_count);
+    if (ret < 0) {
+        TPD_INFO("Failed to erase firmware\n");
+        return FW_UPDATE_ERROR;
+    }
+
+    /* write application firmware */
+    data = image_info.app_firmware.data;
+    size = image_info.app_firmware.size;
+    flash_addr = image_info.app_firmware.flash_addr;
+
+    ret = syna_tcm_write_flash(tcm_hcd, &reflash_hcd, flash_addr, data, size);
+    if (ret < 0) {
+        TPD_INFO("Failed to write flash \n");
+        return FW_UPDATE_ERROR;
+    }
+
+#ifdef UPDATE_DISPLAY_CONFIG
+    /* update display config start */
+    data = image_info.disp_config.data;
+    size = image_info.disp_config.size;
+    flash_addr = image_info.disp_config.flash_addr;
+
+    temp = le4_to_uint(tcm_hcd->boot_info.display_config_start_block);
+    device_addr = temp * reflash_hcd.write_block_size;
+    temp = le2_to_uint(tcm_hcd->boot_info.display_config_length_blocks);
+    device_size = temp * reflash_hcd.write_block_size;
+
+    TPD_INFO("Dispaly Device addr/size 0x%x/%d, flash addr/size 0x%x/%d\n",
+                device_addr, device_size, flash_addr, size);
+    if ((flash_addr != device_addr) || (size != device_size)) {
+        TPD_INFO("Failed to display config \n");
+        return FW_UPDATE_ERROR;
+    }
+    page_start = image_info.disp_config.flash_addr / reflash_hcd.page_size;
+    page_count = ceil_div(image_info.disp_config.size, reflash_hcd.page_size);
+
+    ret = syna_tcm_erase_flash(tcm_hcd, page_start, page_count);
+    if (ret < 0) {
+        TPD_INFO("Failed to erase config\n");
+        return FW_UPDATE_ERROR;
+    }
+
+    ret = syna_tcm_write_flash(tcm_hcd, &reflash_hcd, flash_addr, data, size);
+    if (ret < 0) {
+        TPD_INFO("Failed to write config \n");
+        return FW_UPDATE_ERROR;
+    }
+    /* update display config end*/
+#endif
+
+    /* update app config start */
+    data = image_info.app_config.data;
+    size = image_info.app_config.size;
+    flash_addr = image_info.app_config.flash_addr;
+
+    temp = le2_to_uint(tcm_hcd->app_info.app_config_start_write_block);
+    device_addr = temp * reflash_hcd.write_block_size;
+    device_size = le2_to_uint(tcm_hcd->app_info.app_config_size);
+
+    TPD_INFO("Config Device addr/size 0x%x/%d, flash addr/size 0x%x/%d\n",
+                device_addr, device_size, flash_addr, size);
+
+    page_start = image_info.app_config.flash_addr / reflash_hcd.page_size;
+    page_count = ceil_div(image_info.app_config.size, reflash_hcd.page_size);
+
+    ret = syna_tcm_erase_flash(tcm_hcd, page_start, page_count);
+    if (ret < 0) {
+        TPD_INFO("Failed to erase config\n");
+        return FW_UPDATE_ERROR;
+    }
+
+    ret = syna_tcm_write_flash(tcm_hcd, &reflash_hcd, flash_addr, data, size);
+    if (ret < 0) {
+        TPD_INFO("Failed to write config \n");
+        return FW_UPDATE_ERROR;
+    }
+
+    TPD_INFO("end of config update\n");
+    /* update app config end */
+
+    return FW_UPDATE_SUCCESS;
+}
+
+
+static int syna_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+    struct touch_hcd *touch_hcd = tcm_hcd->touch_hcd;
+    struct touch_data *touch_data = &touch_hcd->touch_data;
+
+    gesture->clockwise = 2;
+    switch (touch_data->lpwg_gesture) {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            if (touch_data->extra_gesture_info == 0x10)
+                gesture->clockwise = 0;
+            else if (touch_data->extra_gesture_info == 0x20)
+                gesture->clockwise = 1;
+            break;
+        case SWIPE_DETECT:
+            if (touch_data->extra_gesture_info == 0x41) {//x+
+                gesture->gesture_type = Left2RightSwip;
+            } else if (touch_data->extra_gesture_info == 0x42) {//x-
+                gesture->gesture_type = Right2LeftSwip;
+            } else if (touch_data->extra_gesture_info == 0x44) {//y+
+                gesture->gesture_type = Up2DownSwip;
+            } else if (touch_data->extra_gesture_info == 0x48) {//y-
+                gesture->gesture_type = Down2UpSwip;
+            } else if (touch_data->extra_gesture_info == 0x81) {//2x-
+                gesture->gesture_type = DouSwip;
+            } else if (touch_data->extra_gesture_info == 0x82) {//2x+
+                gesture->gesture_type = DouSwip;
+            } else if (touch_data->extra_gesture_info == 0x84) {//2y+
+                gesture->gesture_type = DouSwip;
+            } else if (touch_data->extra_gesture_info == 0x88) {//2y-
+                gesture->gesture_type = DouSwip;
+            }
+            break;
+        case UNICODE_DETECT:
+            if (touch_data->extra_gesture_info == 0x6d) {
+                gesture->gesture_type = Mgestrue;
+
+            } else if (touch_data->extra_gesture_info == 0x77) {
+                gesture->gesture_type = Wgestrue;
+            }
+            break;
+        case VEE_DETECT:
+            if (touch_data->extra_gesture_info == 0x02) {//up
+                gesture->gesture_type = UpVee;
+            } else if (touch_data->extra_gesture_info == 0x01) {//down
+                gesture->gesture_type = DownVee;
+            } else if (touch_data->extra_gesture_info == 0x08) {//left
+                gesture->gesture_type = LeftVee;
+            } else if (touch_data->extra_gesture_info == 0x04) {//right
+                gesture->gesture_type = RightVee;
+            }
+            break;
+        case TRIANGLE_DETECT:
+        default:
+            TPD_DEBUG("not support\n");
+            break;
+    }
+    if (gesture->gesture_type != UnkownGesture) {
+        gesture->Point_start.x = (touch_data->data_point[0] | (touch_data->data_point[1] << 8));
+        gesture->Point_start.y = (touch_data->data_point[2] | (touch_data->data_point[3] << 8));
+        gesture->Point_end.x    = (touch_data->data_point[4] | (touch_data->data_point[5] << 8));
+        gesture->Point_end.y    = (touch_data->data_point[6] | (touch_data->data_point[7] << 8));
+        gesture->Point_1st.x    = (touch_data->data_point[8] | (touch_data->data_point[9] << 8));
+        gesture->Point_1st.y    = (touch_data->data_point[10] | (touch_data->data_point[11] << 8));
+        gesture->Point_2nd.x    = (touch_data->data_point[12] | (touch_data->data_point[13] << 8));
+        gesture->Point_2nd.y    = (touch_data->data_point[14] | (touch_data->data_point[15] << 8));
+        gesture->Point_3rd.x    = (touch_data->data_point[16] | (touch_data->data_point[17] << 8));
+        gesture->Point_3rd.y    = (touch_data->data_point[18] | (touch_data->data_point[19] << 8));
+        gesture->Point_4th.x    = (touch_data->data_point[20] | (touch_data->data_point[21] << 8));
+        gesture->Point_4th.y    = (touch_data->data_point[22] | (touch_data->data_point[23] << 8));
+    }
+
+    TPD_DEBUG("lpwg:0x%x, extra:%x type:%d\n", touch_data->lpwg_gesture,
+                    touch_data->extra_gesture_info, gesture->gesture_type);
+
+    return 0;
+}
+
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+#define MAX_BUFFER_SIZE 1024
+static void store_to_buf(char *buffer, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+    static int count = 0;
+
+    if (buffer == NULL) {
+        count = 0;
+        return;
+    }
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if (count + strlen(buf) + 2 > MAX_BUFFER_SIZE) {
+        pr_err("exceed the max buffer size\n");
+        count = 0;
+        return;
+    }
+
+    memcpy(buffer + count, buf, strlen(buf));
+    count += strlen(buf);
+    *(buffer + count) = '\n';
+    count++;
+}
+
+static int syna_tcm_get_frame_size_words(struct syna_tcm_hcd *tcm_hcd, bool image_only)
+{
+    unsigned int rows;
+    unsigned int cols;
+    unsigned int hybrid;
+    unsigned int buttons;
+    int size= 0;
+    struct syna_tcm_app_info *app_info = &tcm_hcd->app_info;
+
+    rows = le2_to_uint(app_info->num_of_image_rows);
+    cols = le2_to_uint(app_info->num_of_image_cols);
+    hybrid = le2_to_uint(app_info->has_hybrid_data);
+    buttons = le2_to_uint(app_info->num_of_buttons);
+
+    size = rows * cols;
+
+    if (!image_only) {
+        if (hybrid)
+            size += rows + cols;
+        size += buttons;
+    }
+
+    return size;
+}
+
+static int syna_check_notch(int row, int col)
+{
+    if (row == 35 && (col > 5 && col < 10)) {
+        return 1;
+    } else {
+        return 0;
+    }
+}
+
+static int syna_testing_limit_compare(char *s,
+    struct syna_testdata *syna_testdata, char *test_name, char *buf)
+{
+    int idx = 0;
+    int fd = syna_testdata->fd;
+    unsigned int rows, cols;
+    unsigned int row, col;
+    int error_count = 0;
+    short data;
+    unsigned int offset;
+    struct limit_block *limit_block;
+    int16_t hi_data, lo_data;
+    int16_t *limit_data;
+
+    TPD_DEBUG("start %s compare\n", test_name);
+    offset = synaptics_get_limit_data(test_name, syna_testdata->fw->data);
+
+    if (offset == 0) {
+        store_to_buf(s, "Limit param error");
+        error_count++;
+        return error_count;
+    }
+
+    limit_block = (struct limit_block *)(syna_testdata->fw->data + offset);
+
+    TPD_INFO("compare mode %d, test name %s, size %d\n", limit_block->mode, limit_block->name, limit_block->size);
+    if ((limit_block->mode && limit_block->size < rows*cols*2) ||
+        (!limit_block->mode && limit_block->size != 4)) {
+        store_to_buf(s, "limit data is not valid");
+        error_count++;
+        return error_count;
+    }
+
+    idx = 0;
+    limit_data = &limit_block->data;
+    for (row = 0; row < syna_testdata->RX_NUM; row++) {
+        printk("[%02d] ", row);
+        store_to_file(fd, "[%02d],", row);
+        for(col = 0; col < syna_testdata->TX_NUM; col++) {
+            data = (short)le2_to_uint(&buf[idx * 2]);
+            printk("[%4d] ", data);
+            store_to_file(fd, "%4d,", data);
+
+            if (syna_check_notch(row, col)) {
+                idx++;
+                continue;
+            }
+
+            if (limit_block->mode) {
+                lo_data = (int16_t)limit_data[2*idx];
+                hi_data = (int16_t)limit_data[2*idx + 1];
+            } else {
+                lo_data = (int16_t)limit_data[0];
+                hi_data = (int16_t)limit_data[1];
+            }
+            if (data > hi_data || data < lo_data) {
+                if (!error_count) {
+                    TPD_INFO("error:[row,col][%2d %2d]=%4d\n", row, col, data);
+                    TPD_INFO("range lo hi [%5d %5d]\n", lo_data, hi_data);
+                    store_to_buf(s, "error:[row,col][%2d %2d]=%4d", row, col, data);
+                }
+                error_count++;
+            }
+            idx++;
+        }
+        store_to_file(fd, "\n");
+        printk("\n");
+    }
+
+    return error_count;
+}
+
+static int syna_testing_pt11(char *s, struct syna_tcm_hcd *tcm_hcd, struct syna_testdata *syna_testdata)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int frame_size;
+    int error_count = 0;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        store_to_buf(s, "Not in application mode");
+        error_count++;
+        return error_count;
+    }
+
+    store_to_file(syna_testdata->fd, "\nPT11 Test:\n");
+    out[0] = TEST_PT11;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_LONG);
+    if (retval < 0) {
+        store_to_buf(s, "Failed to write %s", STR(CMD_PRODUCTION_TEST));
+        error_count++;
+        goto exit;
+    }
+
+    frame_size = syna_tcm_get_frame_size_words(tcm_hcd, false);
+    if (frame_size != resp_buf_size / 2) {
+        store_to_buf(s, "Frame size mismatch");
+        error_count++;
+        goto exit;
+    }
+
+    error_count = syna_testing_limit_compare(s, syna_testdata, "PT11", resp_buf);
+
+    if (error_count) {
+        store_to_buf(s, "PT11 Test End");
+    }
+exit:
+    kfree(resp_buf);
+    return error_count;
+}
+
+static int syna_testing_dynamic_range(char *s, struct syna_tcm_hcd *tcm_hcd, struct syna_testdata *syna_testdata, char *type)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int frame_size;
+    int error_count = 0;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        store_to_buf(s, "Not in application mode");
+        error_count++;
+        return error_count;
+    }
+
+    store_to_file(syna_testdata->fd, "\n%s Test:\n", type);
+    out[0] = TEST_DYNAMIC_RANGE;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_LONG);
+    if (retval < 0) {
+        store_to_buf(s, "Failed to write %s", STR(CMD_PRODUCTION_TEST));
+        error_count++;
+        goto exit;
+    }
+
+    frame_size = syna_tcm_get_frame_size_words(tcm_hcd, false);
+    if (frame_size != resp_buf_size / 2) {
+        store_to_buf(s, "Frame size mismatch %d", resp_buf_size);
+        error_count++;
+        goto exit;
+    }
+
+    error_count = syna_testing_limit_compare(s, syna_testdata, type, resp_buf);
+   if (error_count) {
+        store_to_buf(s, "DRT Test End");
+    }
+exit:
+    kfree(resp_buf);
+    return error_count;
+}
+
+static int syna_testing_noise(char *s, struct syna_tcm_hcd *tcm_hcd, struct syna_testdata *syna_testdata, char *type)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int frame_size;
+    int error_count = 0;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        store_to_buf(s, "Not in application mode");
+        error_count++;
+        return error_count;
+    }
+
+    store_to_file(syna_testdata->fd, "%s Test:\n", type);
+
+    out[0] = TEST_NOISE;
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_LONG);
+    if (retval < 0) {
+        store_to_buf(s, "Failed to write %s", STR(CMD_PRODUCTION_TEST));
+        error_count++;
+        goto exit;
+    }
+
+    frame_size = syna_tcm_get_frame_size_words(tcm_hcd, false);
+    if (frame_size != resp_buf_size / 2) {
+        store_to_buf(s, "Frame size mismatch");
+        error_count++;
+        goto exit;
+    }
+
+    error_count = syna_testing_limit_compare(s, syna_testdata, type, resp_buf);
+    if (error_count) {
+        store_to_buf(s, "Noise Test End");
+    }
+exit:
+    kfree(resp_buf);
+    return error_count;
+}
+
+#define MAX_ROWS_PER_BURST 9
+
+static int syna_testing_Doze_dynamic_range(char *s, struct syna_tcm_hcd *tcm_hcd, struct syna_testdata *syna_testdata, char *type)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int data_size;
+    int cols = 0, tmp = 0;
+    int error_count = 0;
+    int number_of_buttons = 0;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        store_to_buf(s, "Not in application mode");
+        error_count++;
+        return error_count;
+    }
+
+    store_to_file(syna_testdata->fd, "\n%s Test:\n", type);
+
+    cols = le2_to_uint(tcm_hcd->app_info.num_of_image_cols);
+    data_size =  cols* MAX_ROWS_PER_BURST;
+    number_of_buttons  = le2_to_uint(tcm_hcd->app_info.num_of_buttons);
+    if (number_of_buttons) {
+        data_size++;
+    }
+
+    out[0] = TEST_DYNAMIC_RANGE_DOZE;
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_LONG);
+    if (retval < 0) {
+        store_to_buf(s, "Failed to write %s", STR(CMD_PRODUCTION_TEST));
+        error_count++;
+        goto exit;
+    }
+
+    if (data_size != resp_buf_size / 2) {
+        store_to_buf(s, "Data size mismatch: %d", resp_buf_size);
+        error_count++;
+        goto exit;
+    }
+
+    tmp = syna_testdata->RX_NUM;
+    syna_testdata->RX_NUM = MAX_ROWS_PER_BURST;
+
+    error_count = syna_testing_limit_compare(s, syna_testdata, type, resp_buf);
+    if (error_count) {
+        store_to_buf(s, "Doze Dynamic Test End");
+    }
+    syna_testdata->RX_NUM = tmp;
+exit:
+
+    kfree(resp_buf);
+    return error_count;
+
+}
+
+static int syna_testing_Doze_noise(char *s, struct syna_tcm_hcd *tcm_hcd, struct syna_testdata *syna_testdata, char *type)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int data_size;
+    int cols = 0, tmp = 0;
+    int error_count = 0;
+    int num_of_buttons;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        store_to_buf(s, "Not in application mode");
+        error_count++;
+        return error_count;
+    }
+
+    store_to_file(syna_testdata->fd, "\n%s Test:\n", type);
+
+    cols = le2_to_uint(tcm_hcd->app_info.num_of_image_cols);
+    data_size =  cols* MAX_ROWS_PER_BURST;
+    num_of_buttons = le2_to_uint(tcm_hcd->app_info.num_of_buttons);
+    if (num_of_buttons) {
+        data_size++;
+    }
+
+    out[0] = TEST_NOISE_DOZE;
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            RESPONSE_TIMEOUT_MS_LONG);
+    if (retval < 0) {
+        store_to_buf(s, "Failed to write %s", STR(CMD_PRODUCTION_TEST));
+        error_count++;
+        goto exit;
+    }
+
+    if (data_size != resp_buf_size / 2) {
+        store_to_buf(s, "Data size mismatch: %d", resp_buf_size);
+        error_count++;
+        goto exit;
+    }
+
+    tmp = syna_testdata->RX_NUM;
+    syna_testdata->RX_NUM = MAX_ROWS_PER_BURST;
+
+    error_count = syna_testing_limit_compare(s, syna_testdata, type, resp_buf);
+    if (error_count) {
+        store_to_buf(s, "Doze Noise Test End");
+    }
+    syna_testdata->RX_NUM = tmp;
+exit:
+
+    kfree(resp_buf);
+    return error_count;
+}
+
+static int syna_int_pin_test(char *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int eint_status, eint_count = 0, read_gpio_num = 10;
+
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        store_to_buf(s, "TP EINT direct stort");
+        eint_count = 0;
+        return 1;
+    }
+
+    return 0;
+}
+
+static void syna_tcm_black_screen_test(void *chip_data, char *message)
+{
+
+    int retval = 0;
+    int fd;
+    mm_segment_t old_fs;
+    int error_count = 0;
+    uint8_t data_buf[128];
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+    const struct firmware *fw = NULL;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+    struct syna_testdata syna_testdata;
+    char *buffer;
+
+    /*start black screen test*/
+    buffer = (char *)kzalloc(MAX_BUFFER_SIZE, GFP_KERNEL);
+    if (!buffer) {
+        return;
+    }
+
+    store_to_buf(NULL, "");
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    sprintf(data_buf, "/sdcard/tp_testlimit_gesture_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        store_to_buf(buffer, "Open failed failed");
+        error_count++;
+        set_fs(old_fs);
+        goto sys_err;
+    }
+
+    retval = request_firmware(&fw, tcm_hcd->limit_name, &tcm_hcd->client->dev);
+    if (retval < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", tcm_hcd->limit_name, retval);
+        store_to_buf(buffer, "No Limit data");
+        error_count++;
+        goto firware_err;
+    }
+
+    syna_testdata.RX_NUM = tcm_hcd->hw_res->RX_NUM;
+    syna_testdata.TX_NUM = tcm_hcd->hw_res->TX_NUM;
+    syna_testdata.fd = fd;
+    syna_testdata.fw = fw;
+
+    error_count += syna_testing_noise(buffer, tcm_hcd, &syna_testdata, "GestureNoise");
+    error_count += syna_testing_dynamic_range(buffer, tcm_hcd, &syna_testdata, "GestureDynamic");
+
+    release_firmware(fw);
+
+firware_err:
+    sys_close(fd);
+    set_fs(old_fs);
+
+sys_err:
+    sprintf(message, "%d errors. %s", error_count, buffer);
+    TPD_INFO("%d errors. %s\n", error_count, buffer);
+
+    kfree(buffer);
+    return;
+
+}
+
+static void syna_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int retval = 0;
+    int error_count = 0;
+    char *buffer;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    buffer = (char *)kzalloc(MAX_BUFFER_SIZE, GFP_KERNEL);
+    if (!buffer) {
+        return;
+    }
+
+    store_to_buf(NULL, ""); /* must add this */
+
+    /* disable ESD mode first */
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_DISABLE_ESD, false);
+    if (retval < 0) {
+        error_count++;
+        store_to_buf(buffer, "Close Esd error");
+    }
+
+    /*normal test*/
+    error_count += syna_int_pin_test(buffer, tcm_hcd, syna_testdata);
+    error_count += syna_testing_noise(buffer, tcm_hcd, syna_testdata, "Noise");
+    error_count += syna_testing_dynamic_range(buffer, tcm_hcd, syna_testdata, "Dynamic");
+    error_count += syna_testing_pt11(buffer, tcm_hcd, syna_testdata);
+
+    /*start Doze test*/
+    error_count += syna_testing_Doze_dynamic_range(buffer, tcm_hcd, syna_testdata, "DozeDynamic");
+    error_count += syna_testing_Doze_noise(buffer, tcm_hcd, syna_testdata, "DozeNoise");
+
+    seq_printf(s, buffer);
+    seq_printf(s, "imageid = %lld customID 0x%s\n", syna_testdata->TP_FW, tcm_hcd->app_info.customer_config_id);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+
+    kfree(buffer);
+}
+
+static int syna_tcm_collect_reports(struct syna_tcm_hcd *tcm_hcd, enum report_type report_type, unsigned int num_of_reports)
+{
+    int retval;
+    bool completed = false;
+    unsigned int timeout;
+    struct syna_tcm_test *test_hcd = tcm_hcd->test_hcd;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    test_hcd->report_index = 0;
+    test_hcd->report_type = report_type;
+    test_hcd->num_of_reports = num_of_reports;
+
+    reinit_completion(&report_complete);
+
+    out[0] = test_hcd->report_type;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_ENABLE_REPORT,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write message %s\n", STR(CMD_ENABLE_REPORT));
+        completed = false;
+        goto exit;
+    }
+
+    timeout = REPORT_TIMEOUT_MS * num_of_reports;
+
+    retval = wait_for_completion_timeout(&report_complete,
+            msecs_to_jiffies(timeout));
+    if (retval == 0) {
+        TPD_INFO("Timed out waiting for report collection\n");
+    } else {
+        completed = true;
+    }
+
+    out[0] = test_hcd->report_type;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+        CMD_DISABLE_REPORT,
+        out,
+        1,
+        &resp_buf,
+        &resp_buf_size,
+        &resp_length,
+        0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write message %s\n", STR(CMD_DISABLE_REPORT));
+    }
+
+    if (!completed) {
+        retval = -EIO;
+    }
+exit:
+
+    return retval;
+}
+
+static void syna_tcm_test_report(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    unsigned int offset, report_size;
+    struct syna_tcm_test *test_hcd = tcm_hcd->test_hcd;
+
+    if (tcm_hcd->report.id != test_hcd->report_type) {
+        TPD_INFO("Not request report type\n");
+        return;
+    }
+
+    report_size = tcm_hcd->report.buffer.data_length;
+    LOCK_BUFFER(test_hcd->report);
+
+    if (test_hcd->report_index == 0) {
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+            &test_hcd->report,
+            report_size*test_hcd->num_of_reports);
+        if (retval < 0) {
+            TPD_INFO("Failed to allocate memory\n");
+
+            UNLOCK_BUFFER(test_hcd->report);
+            return;
+        }
+    }
+
+    if (test_hcd->report_index < test_hcd->num_of_reports) {
+        offset = report_size * test_hcd->report_index;
+        retval = secure_memcpy(test_hcd->report.buf + offset,
+                test_hcd->report.buf_size - offset,
+                tcm_hcd->report.buffer.buf,
+                tcm_hcd->report.buffer.buf_size,
+                tcm_hcd->report.buffer.data_length);
+        if (retval < 0) {
+            TPD_INFO("Failed to copy report data\n");
+
+            UNLOCK_BUFFER(test_hcd->report);
+            return;
+        }
+
+        test_hcd->report_index++;
+        test_hcd->report.data_length += report_size;
+    }
+
+    UNLOCK_BUFFER(test_hcd->report);
+
+    if (test_hcd->report_index == test_hcd->num_of_reports) {
+        complete(&report_complete);
+    }
+    return;
+}
+
+static void syna_tcm_format_print(struct seq_file *s, struct syna_tcm_hcd *tcm_hcd, char *buffer)
+{
+    unsigned int row, col;
+    unsigned int rows, cols;
+    short *pdata_16;
+    struct syna_tcm_test *test_hcd = tcm_hcd->test_hcd;
+
+    rows = le2_to_uint(tcm_hcd->app_info.num_of_image_rows);
+    cols = le2_to_uint(tcm_hcd->app_info.num_of_image_cols);
+
+    if (buffer == NULL)
+        pdata_16 = (short *)&test_hcd->report.buf[0];
+    else
+        pdata_16 = (short *)buffer;
+
+    for (row = 0; row < rows; row++) {
+        seq_printf(s, "[%02d] ", row);
+        for (col = 0; col < cols; col++) {
+            seq_printf(s, "%5d ", *pdata_16);
+            pdata_16++;
+        }
+        seq_printf(s, "\n");
+    }
+
+    seq_printf(s, "\n");
+
+    return;
+}
+
+static void syna_main_register(struct seq_file *s, void *chip_data)
+{
+    int retval = 0;
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+        CMD_GET_NSM_INFO,
+        NULL,
+        0,
+        &resp_buf,
+        &resp_buf_size,
+        &resp_length,
+        0);
+    if (retval < 0) {
+        TPD_INFO("Failed to write command %s\n", STR(CMD_GET_NSM_INFO));
+        if (s) {
+            seq_printf(s, "Failed to write command %s\n", STR(CMD_GET_NSM_INFO));
+        }
+        goto exit;
+    }
+
+    if (resp_length < 10) {
+        TPD_INFO("Error response data\n");
+        if (s) {
+           seq_printf(s, "Error response data\n");
+        }
+        goto exit;
+    }
+
+    TPD_INFO("Reset reason:0x%02x%02x\n", resp_buf[1], resp_buf[0]);
+    TPD_INFO("power im: 0x%02x%02x\n", resp_buf[3], resp_buf[2]);
+    TPD_INFO("nsm Frequency: 0x%02x%02x\n", resp_buf[5], resp_buf[4]);
+    TPD_INFO("nsm State: 0x%02x%02x\n", resp_buf[7], resp_buf[6]);
+    TPD_INFO("esd State: 0x%02x%02x\n", resp_buf[8], resp_buf[9]);
+    TPD_INFO("Buid ID:%d, Custom ID:0x%s\n",
+                le4_to_uint(tcm_hcd->id_info.build_id),
+                tcm_hcd->app_info.customer_config_id);
+
+    if (!s) {
+        goto exit;
+    }
+
+    seq_printf(s, "Reset reason:0x%02x%02x\n", resp_buf[1], resp_buf[0]);
+    seq_printf(s, "power im: 0x%02x%02x\n", resp_buf[3], resp_buf[2]);
+    seq_printf(s, "nsm Frequency: 0x%02x%02x\n", resp_buf[5], resp_buf[4]);
+    seq_printf(s, "nsm State: 0x%02x%02x\n", resp_buf[7], resp_buf[6]);
+    seq_printf(s, "esd State: 0x%02x%02x\n", resp_buf[8], resp_buf[9]);
+    seq_printf(s, "Buid ID:%d, Custom ID:0x%s\n",
+                le4_to_uint(tcm_hcd->id_info.build_id),
+                tcm_hcd->app_info.customer_config_id);
+exit:
+    kfree(resp_buf);
+
+    return;
+}
+
+static void syna_delta_read(struct seq_file *s, void *chip_data)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 1);
+    if (retval < 0){
+        TPD_INFO("Failed to exit doze\n");
+    }
+
+    msleep(20); // delay 20ms
+
+    retval = syna_tcm_collect_reports(tcm_hcd, REPORT_DELTA, 1);
+    if (retval < 0) {
+        seq_printf(s, "Failed to read delta data\n");
+        return;
+    }
+
+    syna_tcm_format_print(s, tcm_hcd, NULL);
+
+    /*set normal doze*/
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 0);
+    if (retval < 0){
+        TPD_INFO("Failed to switch to normal\n");
+    }
+
+    return;
+}
+
+static void syna_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 1);
+    if (retval < 0){
+        TPD_INFO("Failed to exit doze\n");
+    }
+
+    msleep(20); // delay 20ms
+
+    retval = syna_tcm_collect_reports(tcm_hcd, REPORT_RAW, 1);
+    if (retval < 0) {
+        seq_printf(s, "Failed to read baseline data\n");
+        return;
+    }
+
+    syna_tcm_format_print(s, tcm_hcd, NULL);
+
+    /*set normal doze*/
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 0);
+    if (retval < 0){
+        TPD_INFO("Failed to switch to normal\n");
+    }
+
+    return;
+}
+
+static void syna_tcm_drt_read(struct seq_file *s, void *chip_data)
+{
+    int retval;
+    unsigned char out[2] = {0};
+    unsigned char *resp_buf;
+    unsigned int resp_buf_size;
+    unsigned int resp_length;
+    unsigned int frame_size;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    resp_buf = NULL;
+    resp_buf_size = 0;
+
+    if (tcm_hcd->id_info.mode != MODE_APPLICATION || tcm_hcd->app_status != APP_STATUS_OK) {
+        seq_printf(s, "Not in app mode\n");
+        return;
+    }
+
+    out[0] = TEST_DYNAMIC_RANGE;
+
+    retval = syna_tcm_write_message(tcm_hcd,
+            CMD_PRODUCTION_TEST,
+            out,
+            1,
+            &resp_buf,
+            &resp_buf_size,
+            &resp_length,
+            0);
+    if (retval < 0) {
+        seq_printf(s, "Failed to write %s\n", STR(CMD_PRODUCTION_TEST));
+        goto exit;
+    }
+
+    frame_size = syna_tcm_get_frame_size_words(tcm_hcd, false);
+    if (frame_size != resp_buf_size / 2) {
+        seq_printf(s, "Size not match\n");
+        goto exit;
+    }
+
+    syna_tcm_format_print(s, tcm_hcd, resp_buf);
+
+exit:
+    kfree(resp_buf);
+    return;
+}
+
+static struct synaptics_proc_operations syna_proc_ops = {
+    .auto_test     = syna_auto_test,
+};
+
+void syna_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 1);
+    if (retval < 0){
+        TPD_INFO("Failed to exit doze\n");
+    }
+
+    msleep(20); // delay 20ms
+
+    retval = syna_tcm_collect_reports(tcm_hcd, REPORT_DEBUG, 1);
+    if (retval < 0) {
+        seq_printf(s, "Failed to read delta data\n");
+        return;
+    }
+
+    syna_tcm_format_print(s, tcm_hcd, NULL);
+
+    /*set normal doze*/
+    retval = syna_tcm_set_dynamic_config(tcm_hcd, DC_NO_DOZE, 0);
+    if (retval < 0){
+        TPD_INFO("Failed to switch to normal\n");
+    }
+
+    return;
+}
+
+static struct debug_info_proc_operations syna_debug_proc_ops = {
+    .delta_read    = syna_delta_read,
+    .baseline_read = syna_baseline_read,
+    .main_register_read = syna_main_register,
+    .DRT           = syna_tcm_drt_read,
+    .limit_read    = synaptics_limit_read,
+    .reserve_read  = syna_reserve_read,
+};
+
+static int syna_device_report_touch(struct syna_tcm_hcd *tcm_hcd)
+{
+    int ret = syna_parse_report(tcm_hcd);
+    if (ret < 0) {
+        TPD_INFO("Failed to parse report\n");
+        return -EINVAL;
+    }
+
+    syna_set_trigger_reason(tcm_hcd, IRQ_TOUCH);
+    return 0;
+}
+
+static int syna_tcm_irq_handle(void *chip_data)
+{
+    struct syna_tcm_hcd *tcm_hcd = (struct syna_tcm_hcd *)chip_data;
+
+    return syna_tcm_read_message(tcm_hcd, NULL, 0);
+}
+
+static struct oppo_touchpanel_operations syna_tcm_ops = {
+    .get_vendor        = syna_get_vendor,
+    .get_chip_info     = syna_get_chip_info,
+    .get_touch_points  = syna_get_touch_points,
+    .get_gesture_info  = syna_get_gesture_info,
+    .power_control     = syna_power_control,
+    .reset_gpio_control= syna_reset_gpio,
+    .reset             = syna_tcm_reset,
+    .trigger_reason    = syna_trigger_reason,
+    .mode_switch       = syna_mode_switch,
+    .irq_handle_unlock = syna_tcm_irq_handle,
+    .fw_check          = syna_fw_check,
+    .fw_update         = syna_tcm_fw_update,
+    .async_work        = syna_tcm_async_work,
+    .write_ps_status   = syna_tcm_write_ps_status,
+    .black_screen_test = syna_tcm_black_screen_test,
+    .reinit_device     = syna_tcm_reinit_device,
+};
+
+static int syna_tcm_init_device(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval = 0;
+
+    mutex_init(&tcm_hcd->reset_mutex);
+    mutex_init(&tcm_hcd->rw_ctrl_mutex);
+    mutex_init(&tcm_hcd->command_mutex);
+    mutex_init(&tcm_hcd->identify_mutex);
+
+    INIT_BUFFER(tcm_hcd->in, false);
+    INIT_BUFFER(tcm_hcd->out, false);
+    INIT_BUFFER(tcm_hcd->resp, true);
+    INIT_BUFFER(tcm_hcd->temp, false);
+    INIT_BUFFER(tcm_hcd->config, false);
+    INIT_BUFFER(tcm_hcd->default_config, false);
+    INIT_BUFFER(tcm_hcd->report.buffer, true);
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &tcm_hcd->in,
+            tcm_hcd->read_length + 2);
+    TPD_INFO("%s read_length:%d\n", __func__, tcm_hcd->read_length);
+    if (retval < 0) {
+        TPD_INFO("Failed to allocate memory for tcm_hcd->in.buf\n");
+        return retval;
+    }
+
+    tcm_hcd->helper_workqueue = create_singlethread_workqueue("syna_tcm_helper");
+    INIT_WORK(&tcm_hcd->helper_work, syna_tcm_helper_work);
+
+    tcm_hcd->touch_hcd = (struct touch_hcd *)kzalloc(sizeof(struct touch_hcd), GFP_KERNEL);
+    if (!tcm_hcd->touch_hcd) {
+        retval = -ENOMEM;
+        return retval;
+    }
+
+    tcm_hcd->touch_hcd->touch_data.object_data =
+                        (struct object_data *)kzalloc(sizeof(struct object_data)*tcm_hcd->max_touch_num, GFP_KERNEL);
+    if (!tcm_hcd->touch_hcd->touch_data.object_data) {
+        retval = -ENOMEM;
+        goto free_touch;
+    }
+
+    tcm_hcd->touch_hcd->max_objects = tcm_hcd->max_touch_num;
+    mutex_init(&tcm_hcd->touch_hcd->report_mutex);
+
+    INIT_BUFFER(tcm_hcd->touch_hcd->out, false);
+    INIT_BUFFER(tcm_hcd->touch_hcd->resp, false);
+
+    tcm_hcd->test_hcd = (struct syna_tcm_test *)kzalloc(sizeof(struct syna_tcm_test), GFP_KERNEL);
+    if (!tcm_hcd->test_hcd) {
+        retval = -ENOMEM;
+        goto free_object_data;
+    }
+
+    INIT_BUFFER(tcm_hcd->test_hcd->report, false);
+
+    return retval;
+
+free_object_data:
+    kfree(tcm_hcd->touch_hcd->touch_data.object_data);
+free_touch:
+    kfree(tcm_hcd->touch_hcd);
+
+    return retval;
+}
+
+static int syna_tcm_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd;
+    struct touchpanel_data *ts = NULL;
+    struct device_hcd *device_hcd;
+
+    TPD_INFO("%s: enter\n", __func__);
+
+    tcm_hcd = kzalloc(sizeof(*tcm_hcd), GFP_KERNEL);
+    if (!tcm_hcd) {
+        TPD_INFO("no more memory\n");
+        return -ENOMEM;
+    }
+
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("failed to alloc common data\n");
+        goto ts_alloc_failed;
+    }
+
+    tcm_hcd->client = client;
+    tcm_hcd->hw_res = &ts->hw_res;
+    tcm_hcd->rd_chunk_size = RD_CHUNK_SIZE;
+    tcm_hcd->wr_chunk_size = WR_CHUNK_SIZE;
+    tcm_hcd->read_length = MIN_READ_LENGTH;
+    tcm_hcd->max_touch_num = 10; // default
+    tcm_hcd->syna_ops = &syna_proc_ops;
+    tcm_hcd->ubl_addr = 0x2c;
+    ts->chip_data = tcm_hcd;
+    ts->ts_ops = &syna_tcm_ops;
+    ts->debug_info_ops = &syna_debug_proc_ops;
+    ts->dev = &client->dev;
+    ts->client = client;
+    ts->irq = client->irq;
+    ts->has_callback = true;
+    ts->use_resume_notify = true;
+    tcm_hcd->in_suspend = &ts->is_suspended;
+    i2c_set_clientdata(client, ts);
+
+    retval = syna_tcm_init_device(tcm_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to init device information\n");
+        goto err_alloc_mem;
+    }
+
+    atomic_set(&tcm_hcd->command_status, CMD_IDLE);
+
+    retval = register_common_touch_device(ts);
+    if (retval < 0 && (retval != -EFTM)) {
+        TPD_INFO("Failed to init device information\n");
+        goto err_register_driver;
+    }
+
+    ts->tp_suspend_order = LCD_TP_SUSPEND;
+    ts->tp_resume_order = LCD_TP_RESUME;
+    ts->skip_reset_in_resume = true;
+    ts->skip_suspend_operate = true;
+    ts->mode_switch_type = SINGLE;
+
+    synaptics_create_proc(ts, tcm_hcd->syna_ops);
+
+    device_hcd = syna_remote_device_init(tcm_hcd);
+    if (device_hcd) {
+        device_hcd->irq = tcm_hcd->client->irq;
+        device_hcd->read_message = syna_tcm_read_message;
+        device_hcd->write_message = syna_tcm_write_message;
+        device_hcd->reset = syna_tcm_reset;
+        device_hcd->report_touch = syna_device_report_touch;
+    }
+
+    return 0;
+
+err_alloc_mem:
+    RELEASE_BUFFER(tcm_hcd->report.buffer);
+    RELEASE_BUFFER(tcm_hcd->config);
+    RELEASE_BUFFER(tcm_hcd->temp);
+    RELEASE_BUFFER(tcm_hcd->resp);
+    RELEASE_BUFFER(tcm_hcd->out);
+    RELEASE_BUFFER(tcm_hcd->in);
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_alloc_failed:
+    kfree(tcm_hcd);
+
+    return retval;
+}
+
+static int syna_tcm_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+    struct syna_tcm_hcd *tcm_hcd =  (struct syna_tcm_hcd *)ts->chip_data;
+
+    RELEASE_BUFFER(tcm_hcd->report.buffer);
+    RELEASE_BUFFER(tcm_hcd->config);
+    RELEASE_BUFFER(tcm_hcd->temp);
+    RELEASE_BUFFER(tcm_hcd->resp);
+    RELEASE_BUFFER(tcm_hcd->out);
+    RELEASE_BUFFER(tcm_hcd->in);
+
+    kfree(tcm_hcd);
+    kfree(ts);
+
+    return 0;
+}
+
+static struct of_device_id syna_match_table[] = {
+    { .compatible = "synaptics-td4330",},
+    { }
+};
+
+static int syna_i2c_suspend(struct device *dev){
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+    return 0;
+}
+
+static int syna_i2c_resume(struct device *dev){
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+    return 0;
+}
+
+static const struct dev_pm_ops syna_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = syna_i2c_suspend,
+    .resume = syna_i2c_resume,
+#endif
+};
+
+static const struct i2c_device_id syna_tmc_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct i2c_driver syna_i2c_driver = {
+    .probe      = syna_tcm_probe,
+    .remove     = syna_tcm_remove,
+    .id_table   = syna_tmc_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  syna_match_table,
+        .pm = &syna_pm_ops,
+    },
+};
+
+
+static int __init syna_tcm_module_init(void)
+{
+
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&syna_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+
+    return 0;
+}
+
+static void __exit syna_tcm_module_exit(void)
+{
+    i2c_del_driver(&syna_i2c_driver);
+    return;
+}
+
+module_init(syna_tcm_module_init);
+module_exit(syna_tcm_module_exit);
+
+MODULE_AUTHOR("Synaptics, Inc.");
+MODULE_DESCRIPTION("Synaptics TCM Touch Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..61984fdf8f621bc4c1c9b0def82fe99ea661b436
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_core.h
@@ -0,0 +1,624 @@
+/*
+ * Synaptics TCM touchscreen driver
+ *
+ * Copyright (C) 2017 Synaptics Incorporated. All rights reserved.
+ *
+ * Copyright (C) 2017 Scott Lin <scott.lin@tw.synaptics.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * INFORMATION CONTAINED IN THIS DOCUMENT IS PROVIDED "AS-IS," AND SYNAPTICS
+ * EXPRESSLY DISCLAIMS ALL EXPRESS AND IMPLIED WARRANTIES, INCLUDING ANY
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE,
+ * AND ANY WARRANTIES OF NON-INFRINGEMENT OF ANY INTELLECTUAL PROPERTY RIGHTS.
+ * IN NO EVENT SHALL SYNAPTICS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ * SPECIAL, PUNITIVE, OR CONSEQUENTIAL DAMAGES ARISING OUT OF OR IN CONNECTION
+ * WITH THE USE OF THE INFORMATION CONTAINED IN THIS DOCUMENT, HOWEVER CAUSED
+ * AND BASED ON ANY THEORY OF LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * NEGLIGENCE OR OTHER TORTIOUS ACTION, AND EVEN IF SYNAPTICS WAS ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGE. IF A TRIBUNAL OF COMPETENT JURISDICTION DOES
+ * NOT PERMIT THE DISCLAIMER OF DIRECT DAMAGES OR ANY OTHER DAMAGES, SYNAPTICS'
+ * TOTAL CUMULATIVE LIABILITY TO ANY PARTY SHALL NOT EXCEED ONE HUNDRED U.S.
+ * DOLLARS.
+ */
+
+#ifndef _SYNAPTICS_TCM_CORE_H_
+#define _SYNAPTICS_TCM_CORE_H_
+
+#include <linux/version.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/input.h>
+#include <linux/delay.h>
+#include <linux/wakelock.h>
+#include <linux/platform_device.h>
+#include <linux/input/synaptics_tcm.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../../touchpanel_common.h"
+#include "../synaptics_common.h"
+
+
+#define TPD_DEVICE "td4330"
+#define UPDATE_DISPLAY_CONFIG
+
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+
+#define SYNAPTICS_TCM_ID_PRODUCT (1 << 0)
+#define SYNAPTICS_TCM_ID_VERSION 0x0007
+
+#define RD_CHUNK_SIZE 0 /* read length limit in bytes, 0 = unlimited */
+#define WR_CHUNK_SIZE 0 /* write length limit in bytes, 0 = unlimited */
+
+#define MESSAGE_HEADER_SIZE 4
+#define MESSAGE_MARKER 0xa5
+#define MESSAGE_PADDING 0x5a
+
+#define REPORT_TIMEOUT_MS 1000
+
+#define INIT_BUFFER(buffer, is_clone) \
+    mutex_init(&buffer.buf_mutex); \
+    buffer.clone = is_clone
+
+#define LOCK_BUFFER(buffer) \
+    mutex_lock(&buffer.buf_mutex)
+
+#define UNLOCK_BUFFER(buffer) \
+    mutex_unlock(&buffer.buf_mutex)
+
+#define RELEASE_BUFFER(buffer) \
+    do { \
+        if (buffer.clone == false) { \
+            kfree(buffer.buf); \
+            buffer.buf_size = 0; \
+            buffer.data_length = 0; \
+        } \
+    } while (0)
+
+#define MAX(a, b) \
+    ({__typeof__(a) _a = (a); \
+    __typeof__(b) _b = (b); \
+    _a > _b ? _a : _b; })
+
+#define MIN(a, b) \
+    ({__typeof__(a) _a = (a); \
+    __typeof__(b) _b = (b); \
+    _a < _b ? _a : _b; })
+
+#define STR(x) #x
+
+#define CONCAT(a, b) a##b
+
+#define TOUCH_REPORT_CONFIG_SIZE 128
+
+#define DTAP_DETECT     0x01
+#define CIRCLE_DETECT   0x02
+#define SWIPE_DETECT    0x04
+#define UNICODE_DETECT  0x08
+#define VEE_DETECT      0x10
+#define TRIANGLE_DETECT 0x20
+
+enum test_code {
+    TEST_TRX_TRX_SHORTS = 0,
+    TEST_TRX_SENSOR_OPENS = 1,
+    TEST_TRX_GROUND_SHORTS = 2,
+    TEST_DYNAMIC_RANGE = 7,
+    TEST_OPEN_SHORT_DETECTOR = 8,
+    TEST_NOISE = 10,
+    TEST_PT11 = 11,
+    TEST_PT12 = 12,
+    TEST_PT13 = 13,
+    TEST_DYNAMIC_RANGE_DOZE = 14,
+    TEST_NOISE_DOZE = 15,
+};
+
+enum touch_status {
+    LIFT = 0,
+    FINGER = 1,
+    GLOVED_FINGER = 2,
+    NOP = -1,
+};
+
+enum touch_report_code {
+    TOUCH_END = 0,
+    TOUCH_FOREACH_ACTIVE_OBJECT,
+    TOUCH_FOREACH_OBJECT,
+    TOUCH_FOREACH_END,
+    TOUCH_PAD_TO_NEXT_BYTE,
+    TOUCH_TIMESTAMP,
+    TOUCH_OBJECT_N_INDEX,
+    TOUCH_OBJECT_N_CLASSIFICATION,
+    TOUCH_OBJECT_N_X_POSITION,
+    TOUCH_OBJECT_N_Y_POSITION,
+    TOUCH_OBJECT_N_Z,
+    TOUCH_OBJECT_N_X_WIDTH,
+    TOUCH_OBJECT_N_Y_WIDTH,
+    TOUCH_OBJECT_N_TX_POSITION_TIXELS,
+    TOUCH_OBJECT_N_RX_POSITION_TIXELS,
+    TOUCH_0D_BUTTONS_STATE,
+    TOUCH_GESTURE_DOUBLE_TAP,
+    TOUCH_FRAME_RATE,
+    TOUCH_POWER_IM,
+    TOUCH_CID_IM,
+    TOUCH_RAIL_IM,
+    TOUCH_CID_VARIANCE_IM,
+    TOUCH_NSM_FREQUENCY,
+    TOUCH_NSM_STATE,
+    TOUCH_NUM_OF_ACTIVE_OBJECTS,
+    TOUCH_NUM_OF_CPU_CYCLES_USED_SINCE_LAST_FRAME,
+    TOUCH_TUNING_GAUSSIAN_WIDTHS = 0x80,
+    TOUCH_TUNING_SMALL_OBJECT_PARAMS,
+    TOUCH_TUNING_0D_BUTTONS_VARIANCE,
+    TOUCH_REPORT_GESTURE_SWIPE = 193,
+    TOUCH_REPORT_GESTURE_CIRCLE = 194,
+    TOUCH_REPORT_GESTURE_UNICODE = 195,
+    TOUCH_REPORT_GESTURE_VEE = 196,
+    TOUCH_REPORT_GESTURE_TRIANGLE = 197,
+    TOUCH_REPORT_GESTURE_INFO = 198,
+    TOUCH_REPORT_GESTURE_COORDINATE = 199,
+};
+
+enum module_type {
+    TCM_TOUCH = 0,
+    TCM_DEVICE = 1,
+    TCM_TESTING = 2,
+    TCM_REFLASH = 3,
+    TCM_RECOVERY = 4,
+    TCM_ZEROFLASH = 5,
+    TCM_DIAGNOSTICS = 6,
+    TCM_LAST,
+};
+
+enum boot_mode {
+    MODE_APPLICATION = 0x01,
+    MODE_HOST_DOWNLOAD = 0x02,
+    MODE_BOOTLOADER = 0x0b,
+    MODE_TDDI_BOOTLOADER = 0x0c,
+};
+
+enum boot_status {
+    BOOT_STATUS_OK = 0x00,
+    BOOT_STATUS_BOOTING = 0x01,
+    BOOT_STATUS_APP_BAD_DISPLAY_CRC = 0xfc,
+    BOOT_STATUS_BAD_DISPLAY_CONFIG = 0xfd,
+    BOOT_STATUS_BAD_APP_FIRMWARE = 0xfe,
+    BOOT_STATUS_WARM_BOOT = 0xff,
+};
+
+enum app_status {
+    APP_STATUS_OK = 0x00,
+    APP_STATUS_BOOTING = 0x01,
+    APP_STATUS_UPDATING = 0x02,
+    APP_STATUS_BAD_APP_CONFIG = 0xff,
+};
+
+enum firmware_mode {
+    FW_MODE_BOOTLOADER = 0,
+    FW_MODE_APPLICATION = 1,
+};
+
+enum dynamic_config_id {
+    DC_UNKNOWN = 0x00,
+    DC_NO_DOZE,
+    DC_DISABLE_NOISE_MITIGATION,
+    DC_INHIBIT_FREQUENCY_SHIFT,
+    DC_REQUESTED_FREQUENCY,
+    DC_DISABLE_HSYNC,
+    DC_REZERO_ON_EXIT_DEEP_SLEEP,
+    DC_CHARGER_CONNECTED,
+    DC_NO_BASELINE_RELAXATION,
+    DC_IN_WAKEUP_GESTURE_MODE,
+    DC_STIMULUS_FINGERS,
+    DC_GRIP_SUPPRESSION_ENABLED,
+    DC_ENABLE_THICK_GLOVE,
+    DC_ENABLE_GLOVE,
+    DC_PS_STATUS = 0xC1,
+    DC_DISABLE_ESD = 0xC2,
+};
+
+enum command {
+    CMD_NONE = 0x00,
+    CMD_CONTINUE_WRITE = 0x01,
+    CMD_IDENTIFY = 0x02,
+    CMD_RESET = 0x04,
+    CMD_ENABLE_REPORT = 0x05,
+    CMD_DISABLE_REPORT = 0x06,
+    CMD_GET_BOOT_INFO = 0x10,
+    CMD_ERASE_FLASH = 0x11,
+    CMD_WRITE_FLASH = 0x12,
+    CMD_READ_FLASH = 0x13,
+    CMD_RUN_APPLICATION_FIRMWARE = 0x14,
+    CMD_SPI_MASTER_WRITE_THEN_READ = 0x15,
+    CMD_REBOOT_TO_ROM_BOOTLOADER = 0x16,
+    CMD_RUN_BOOTLOADER_FIRMWARE = 0x1f,
+    CMD_GET_APPLICATION_INFO = 0x20,
+    CMD_GET_STATIC_CONFIG = 0x21,
+    CMD_SET_STATIC_CONFIG = 0x22,
+    CMD_GET_DYNAMIC_CONFIG = 0x23,
+    CMD_SET_DYNAMIC_CONFIG = 0x24,
+    CMD_GET_TOUCH_REPORT_CONFIG = 0x25,
+    CMD_SET_TOUCH_REPORT_CONFIG = 0x26,
+    CMD_REZERO = 0x27,
+    CMD_COMMIT_CONFIG = 0x28,
+    CMD_DESCRIBE_DYNAMIC_CONFIG = 0x29,
+    CMD_PRODUCTION_TEST = 0x2a,
+    CMD_SET_CONFIG_ID = 0x2b,
+    CMD_ENTER_DEEP_SLEEP = 0x2c,
+    CMD_EXIT_DEEP_SLEEP = 0x2d,
+    CMD_GET_TOUCH_INFO = 0x2e,
+    CMD_GET_DATA_LOCATION = 0x2f,
+    CMD_DOWNLOAD_CONFIG = 0xc0,
+    CMD_GET_NSM_INFO = 0xc3,
+    CMD_EXIT_ESD = 0xc4,
+};
+
+enum status_code {
+    STATUS_IDLE = 0x00,
+    STATUS_OK = 0x01,
+    STATUS_BUSY = 0x02,
+    STATUS_CONTINUED_READ = 0x03,
+    STATUS_RECEIVE_BUFFER_OVERFLOW = 0x0c,
+    STATUS_PREVIOUS_COMMAND_PENDING = 0x0d,
+    STATUS_NOT_IMPLEMENTED = 0x0e,
+    STATUS_ERROR = 0x0f,
+    STATUS_INVALID = 0xff,
+};
+
+enum report_type {
+    REPORT_IDENTIFY = 0x10,
+    REPORT_TOUCH = 0x11,
+    REPORT_DELTA = 0x12,
+    REPORT_RAW = 0x13,
+    REPORT_PRINTF = 0x82,
+    REPORT_STATUS = 0xc0,
+    REPORT_DEBUG = 0x14,
+    REPORT_HDL = 0xfe,
+};
+
+enum command_status {
+    CMD_IDLE = 0,
+    CMD_BUSY = 1,
+    CMD_ERROR = -1,
+};
+
+enum flash_area {
+    BOOTLOADER = 0,
+    BOOT_CONFIG,
+    APP_FIRMWARE,
+    APP_CONFIG,
+    DISP_CONFIG,
+    CUSTOM_OTP,
+    CUSTOM_LCM,
+    CUSTOM_OEM,
+    PPDT,
+};
+
+enum flash_data {
+    LCM_DATA = 1,
+    OEM_DATA,
+    PPDT_DATA,
+};
+
+struct syna_tcm_buffer {
+    bool clone;
+    unsigned char *buf;
+    unsigned int buf_size;
+    unsigned int data_length;
+    struct mutex buf_mutex;
+};
+
+struct syna_tcm_report {
+    unsigned char id;
+    struct syna_tcm_buffer buffer;
+};
+
+struct syna_tcm_identification {
+    unsigned char version;
+    unsigned char mode;
+    unsigned char part_number[16];
+    unsigned char build_id[4];
+    unsigned char max_write_size[2];
+};
+
+struct syna_tcm_boot_info {
+    unsigned char version;
+    unsigned char status;
+    unsigned char asic_id[2];
+    unsigned char write_block_size_words;
+    unsigned char erase_page_size_words[2];
+    unsigned char max_write_payload_size[2];
+    unsigned char last_reset_reason;
+    unsigned char pc_at_time_of_last_reset[2];
+    unsigned char boot_config_start_block[2];
+    unsigned char boot_config_size_blocks[2];
+    unsigned char display_config_start_block[4];
+    unsigned char display_config_length_blocks[2];
+    unsigned char backup_display_config_start_block[4];
+    unsigned char backup_display_config_length_blocks[2];
+    unsigned char custom_otp_start_block[2];
+    unsigned char custom_otp_length_blocks[2];
+};
+
+struct syna_tcm_app_info {
+    unsigned char version[2];
+    unsigned char status[2];
+    unsigned char static_config_size[2];
+    unsigned char dynamic_config_size[2];
+    unsigned char app_config_start_write_block[2];
+    unsigned char app_config_size[2];
+    unsigned char max_touch_report_config_size[2];
+    unsigned char max_touch_report_payload_size[2];
+    unsigned char customer_config_id[16];
+    unsigned char max_x[2];
+    unsigned char max_y[2];
+    unsigned char max_objects[2];
+    unsigned char num_of_buttons[2];
+    unsigned char num_of_image_rows[2];
+    unsigned char num_of_image_cols[2];
+    unsigned char has_hybrid_data[2];
+};
+
+struct syna_tcm_touch_info {
+    unsigned char image_2d_scale_factor[4];
+    unsigned char image_0d_scale_factor[4];
+    unsigned char hybrid_x_scale_factor[4];
+    unsigned char hybrid_y_scale_factor[4];
+};
+
+struct syna_tcm_message_header {
+    unsigned char marker;
+    unsigned char code;
+    unsigned char length[2];
+};
+
+struct input_params {
+    unsigned int max_x;
+    unsigned int max_y;
+    unsigned int max_objects;
+};
+
+struct object_data {
+    unsigned char status;
+    unsigned int x_pos;
+    unsigned int y_pos;
+    unsigned int x_width;
+    unsigned int y_width;
+    unsigned int z;
+    unsigned int tx_pos;
+    unsigned int rx_pos;
+};
+
+struct touch_data {
+    struct object_data *object_data;
+    unsigned char data_point[24]; //6 points
+    unsigned int extra_gesture_info;
+    unsigned int timestamp;
+    unsigned int buttons_state;
+    unsigned int gesture_double_tap;
+    unsigned int lpwg_gesture;
+    unsigned int frame_rate;
+    unsigned int power_im;
+    unsigned int cid_im;
+    unsigned int rail_im;
+    unsigned int cid_variance_im;
+    unsigned int nsm_frequency;
+    unsigned int nsm_state;
+    unsigned int num_of_active_objects;
+    unsigned int num_of_cpu_cycles;
+};
+
+struct touch_hcd {
+    bool report_touch;
+    unsigned int max_objects;
+    struct mutex report_mutex;
+    struct touch_data touch_data;
+    struct syna_tcm_buffer out;
+    struct syna_tcm_buffer resp;
+};
+
+struct reflash_hcd {
+    bool disp_cfg_update;
+    unsigned int image_size;
+    unsigned int page_size;
+    unsigned int write_block_size;
+    unsigned int max_write_payload_size;
+};
+
+struct syna_tcm_test {
+    unsigned int num_of_reports;
+    unsigned char report_type;
+    unsigned int report_index;
+    struct syna_tcm_buffer report;
+};
+
+struct syna_tcm_hcd {
+    /*must be first*/
+    struct invoke_method cb;
+    struct i2c_client *client;
+    struct hw_resource *hw_res;
+    struct touch_hcd *touch_hcd;
+    struct syna_tcm_test *test_hcd;
+    struct synaptics_proc_operations *syna_ops;
+
+    struct workqueue_struct *helper_workqueue;
+    struct work_struct helper_work;
+
+    atomic_t command_status;
+    char *iHex_name;
+    char *limit_name;
+    int *in_suspend;
+
+    unsigned short ubl_addr;
+    unsigned char trigger_reason;
+    unsigned char command;
+    unsigned char async_report_id;
+    unsigned char status_report_code;
+    unsigned int read_length;
+    unsigned int payload_length;
+    unsigned int rd_chunk_size;
+    unsigned int wr_chunk_size;
+    unsigned int app_status;
+    unsigned int max_touch_num;
+
+    struct mutex reset_mutex;
+    struct mutex rw_ctrl_mutex;
+    struct mutex command_mutex;
+    struct mutex identify_mutex;
+
+    struct syna_tcm_buffer in;
+    struct syna_tcm_buffer out;
+    struct syna_tcm_buffer resp;
+    struct syna_tcm_buffer temp;
+    struct syna_tcm_buffer config;
+    struct syna_tcm_buffer default_config;
+    struct syna_tcm_report report;
+    struct syna_tcm_app_info app_info;
+    struct syna_tcm_boot_info boot_info;
+    struct syna_tcm_touch_info touch_info;
+    struct syna_tcm_identification id_info;
+};
+
+struct device_hcd {
+    dev_t dev_num;
+    bool raw_mode;
+    bool concurrent;
+    unsigned int ref_count;
+    int irq;
+    int flag;
+    struct cdev char_dev;
+    struct class *class;
+    struct device *device;
+    struct mutex extif_mutex;
+    struct syna_tcm_buffer out;
+    struct syna_tcm_buffer resp;
+    struct syna_tcm_buffer report;
+    struct syna_tcm_hcd *tcm_hcd;
+    int (*reset)(void *chip_data);
+    int (*write_message)(struct syna_tcm_hcd *tcm_hcd,
+        unsigned char command, unsigned char *payload,
+        unsigned int length, unsigned char **resp_buf,
+        unsigned int *resp_buf_size, unsigned int *resp_length,
+        unsigned int polling_delay_ms);
+    int (*read_message)(struct syna_tcm_hcd *tcm_hcd, unsigned char *in_buf, unsigned int length);
+    int (*report_touch) (struct syna_tcm_hcd *tcm_hcd);
+};
+
+static inline int secure_memcpy(unsigned char *dest, unsigned int dest_size,
+        const unsigned char *src, unsigned int src_size,
+        unsigned int count)
+{
+    if (dest == NULL || src == NULL)
+        return -EINVAL;
+
+    if (count > dest_size || count > src_size) {
+        pr_err("%s: src_size = %d, dest_size = %d, count = %d\n",
+                __func__, src_size, dest_size, count);
+        return -EINVAL;
+    }
+
+    memcpy((void *)dest, (const void *)src, count);
+
+    return 0;
+}
+
+static inline int syna_tcm_realloc_mem(struct syna_tcm_hcd *tcm_hcd,
+        struct syna_tcm_buffer *buffer, unsigned int size)
+{
+    int retval;
+    unsigned char *temp;
+
+    if (size > buffer->buf_size) {
+        temp = buffer->buf;
+
+        buffer->buf = kmalloc(size, GFP_KERNEL);
+        if (!(buffer->buf)) {
+            TPD_INFO("%s: Failed to allocate memory\n",
+                    __func__);
+            kfree(temp);
+            buffer->buf_size = 0;
+            return -ENOMEM;
+        }
+
+        retval = secure_memcpy(buffer->buf,
+                size,
+                temp,
+                buffer->buf_size,
+                buffer->buf_size);
+        if (retval < 0) {
+            TPD_INFO("%s: Failed to copy data\n", __func__);
+            kfree(temp);
+            kfree(buffer->buf);
+            buffer->buf_size = 0;
+            return retval;
+        }
+
+        kfree(temp);
+        buffer->buf_size = size;
+    }
+
+    return 0;
+}
+
+static inline int syna_tcm_alloc_mem(struct syna_tcm_hcd *tcm_hcd,
+        struct syna_tcm_buffer *buffer, unsigned int size)
+{
+    if (size > buffer->buf_size) {
+        kfree(buffer->buf);
+        buffer->buf = kmalloc(size, GFP_KERNEL);
+        if (!(buffer->buf)) {
+            TPD_INFO("%s: Failed to allocate memory, size %d\n",__func__, size);
+            buffer->buf_size = 0;
+            buffer->data_length = 0;
+            return -ENOMEM;
+        }
+        buffer->buf_size = size;
+    }
+
+    memset(buffer->buf, 0, buffer->buf_size);
+    buffer->data_length = 0;
+
+    return 0;
+}
+
+
+static inline unsigned int ceil_div(unsigned int dividend, unsigned divisor)
+{
+    return (dividend + divisor - 1) / divisor;
+}
+
+int syna_tcm_rmi_read(struct syna_tcm_hcd *tcm_hcd,
+        unsigned short addr, unsigned char *data, unsigned int length);
+
+int syna_tcm_rmi_write(struct syna_tcm_hcd *tcm_hcd,
+        unsigned short addr, unsigned char *data, unsigned int length);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_device.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_device.c
new file mode 100644
index 0000000000000000000000000000000000000000..912939b0c89dcbbddf33cbaefa69efe016f1d071
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_device.c
@@ -0,0 +1,602 @@
+/**************************************************************
+* Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+* File       : synaptics_tcm_device.c
+* Description: Source file for synaptics TD4330 driver
+* Version   : 1.0
+* Date        : 2018-01-18
+* Author    : Xing.Xiong@EXP.Bsp.Group.Tp
+* TAG         : BSP.TP.Init
+* ---------------- Revision History: --------------------------
+*   <version>    <date>          < author >                            <desc>
+* Revision 1.1, 2018-01-18, Xing.Xiong@EXP.Bsp.Group.Tp.
+****************************************************************/
+
+#include <linux/cdev.h>
+#include <linux/gpio.h>
+#include <linux/kthread.h>
+#include <linux/uaccess.h>
+#include "synaptics_tcm_core.h"
+
+#define CHAR_DEVICE_NAME "tcm"
+#define PLATFORM_DRIVER_NAME "synaptics_tcm"
+#define CONCURRENT true
+
+#define DEVICE_IOC_MAGIC 's'
+#define DEVICE_IOC_RESET _IO(DEVICE_IOC_MAGIC, 0) /* 0x00007300 */
+#define DEVICE_IOC_IRQ _IOW(DEVICE_IOC_MAGIC, 1, int) /* 0x40047301 */
+#define DEVICE_IOC_RAW _IOW(DEVICE_IOC_MAGIC, 2, int) /* 0x40047302 */
+#define DEVICE_IOC_CONCURRENT _IOW(DEVICE_IOC_MAGIC, 3, int) /* 0x40047303 */
+
+static struct device_hcd *g_device_hcd = NULL;
+
+static int rmidev_major_num;
+
+static void device_capture_touch_report(unsigned int count)
+{
+    int retval;
+    unsigned char id;
+    unsigned int idx;
+    unsigned int size;
+    unsigned char *data;
+    struct syna_tcm_hcd *tcm_hcd = g_device_hcd->tcm_hcd;
+    static bool report;
+    static unsigned int offset;
+    static unsigned int remaining_size;
+
+    if (count < 2)
+        return;
+
+    data = &g_device_hcd->resp.buf[0];
+
+    if (data[0] != MESSAGE_MARKER)
+        return;
+
+    id = data[1];
+    size = 0;
+
+    LOCK_BUFFER(g_device_hcd->report);
+
+    switch (id) {
+    case REPORT_TOUCH:
+        if (count >= 4) {
+            remaining_size = le2_to_uint(&data[2]);
+        } else {
+            report = false;
+            goto exit;
+        }
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &g_device_hcd->report,
+                remaining_size);
+        if (retval < 0) {
+            pr_err("Failed to allocate memory for device_hcd->report.buf\n");
+            report = false;
+            goto exit;
+        }
+        idx = 4;
+        size = count - idx;
+        offset = 0;
+        report = true;
+        break;
+    case STATUS_CONTINUED_READ:
+        if (report == false)
+            goto exit;
+        if (count >= 2) {
+            idx = 2;
+            size = count - idx;
+        }
+        break;
+    default:
+        goto exit;
+    }
+
+    if (size) {
+        size = MIN(size, remaining_size);
+        retval = secure_memcpy(&g_device_hcd->report.buf[offset],
+                g_device_hcd->report.buf_size - offset,
+                &data[idx],
+                count - idx,
+                size);
+        if (retval < 0) {
+            pr_err("Failed to copy touch report data\n");
+            report = false;
+            goto exit;
+        } else {
+            offset += size;
+            remaining_size -= size;
+            g_device_hcd->report.data_length += size;
+        }
+    }
+
+    if (remaining_size)
+        goto exit;
+
+    LOCK_BUFFER(tcm_hcd->report.buffer);
+
+    tcm_hcd->report.buffer.buf = g_device_hcd->report.buf;
+    tcm_hcd->report.buffer.buf_size = g_device_hcd->report.buf_size;
+    tcm_hcd->report.buffer.data_length = g_device_hcd->report.data_length;
+
+    g_device_hcd->report_touch(tcm_hcd);
+
+    UNLOCK_BUFFER(tcm_hcd->report.buffer);
+
+    report = false;
+
+exit:
+    UNLOCK_BUFFER(g_device_hcd->report);
+
+    return;
+}
+
+static int device_capture_touch_report_config(unsigned int count)
+{
+    int retval;
+    unsigned int size;
+    unsigned char *data;
+    struct syna_tcm_hcd *tcm_hcd = g_device_hcd->tcm_hcd;
+
+    if (g_device_hcd->raw_mode) {
+        if (count < 3) {
+            pr_err("Invalid write data\n");
+            return -EINVAL;
+        }
+
+        size = le2_to_uint(&g_device_hcd->out.buf[1]);
+
+        if (count - 3 < size) {
+            pr_err("Incomplete write data\n");
+            return -EINVAL;
+        }
+
+        if (!size)
+            return 0;
+
+        data = &g_device_hcd->out.buf[3];
+    } else {
+        size = count - 1;
+
+        if (!size)
+            return 0;
+
+        data = &g_device_hcd->out.buf[1];
+    }
+
+    LOCK_BUFFER(tcm_hcd->config);
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &tcm_hcd->config,
+            size);
+    if (retval < 0) {
+        pr_err("Failed to allocate memory for tcm_hcd->config.buf\n");
+        UNLOCK_BUFFER(tcm_hcd->config);
+        return retval;
+    }
+
+    retval = secure_memcpy(tcm_hcd->config.buf,
+            tcm_hcd->config.buf_size,
+            data,
+            size,
+            size);
+    if (retval < 0) {
+        pr_err("Failed to copy touch report config data\n");
+        UNLOCK_BUFFER(tcm_hcd->config);
+        return retval;
+    }
+
+    tcm_hcd->config.data_length = size;
+
+    UNLOCK_BUFFER(tcm_hcd->config);
+
+    return 0;
+}
+
+#ifdef HAVE_UNLOCKED_IOCTL
+static long device_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+#else
+static int device_ioctl(struct inode *inp, struct file *filp, unsigned int cmd,
+        unsigned long arg)
+#endif
+{
+    int retval = 0;
+    struct syna_tcm_hcd *tcm_hcd = g_device_hcd->tcm_hcd;
+
+    pr_info("%s: 0x%x\n", __func__, cmd);
+
+    mutex_lock(&g_device_hcd->extif_mutex);
+
+    switch (cmd) {
+    case DEVICE_IOC_RESET:
+        retval = g_device_hcd->reset(tcm_hcd);
+        break;
+    case DEVICE_IOC_IRQ:
+        if (arg == 0) {
+            if (g_device_hcd->flag == 1){
+                disable_irq(g_device_hcd->irq);
+                g_device_hcd->flag = 0;
+            }
+        }
+        else if (arg == 1) {
+            if (g_device_hcd->flag == 0) {
+                enable_irq(g_device_hcd->irq);
+                g_device_hcd->flag = 1;
+            }
+        }
+        break;
+    case DEVICE_IOC_RAW:
+        if (arg == 0)
+            g_device_hcd->raw_mode = false;
+        else if (arg == 1)
+            g_device_hcd->raw_mode = true;
+        break;
+    case DEVICE_IOC_CONCURRENT:
+        if (arg == 0)
+            g_device_hcd->concurrent = false;
+        else if (arg == 1)
+            g_device_hcd->concurrent = true;
+        break;
+    default:
+        retval = -ENOTTY;
+        break;
+    }
+
+    mutex_unlock(&g_device_hcd->extif_mutex);
+
+    return retval;
+}
+
+static loff_t device_llseek(struct file *filp, loff_t off, int whence)
+{
+    return -EINVAL;
+}
+
+static ssize_t device_read(struct file *filp, char __user *buf,
+        size_t count, loff_t *f_pos)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd = g_device_hcd->tcm_hcd;
+
+    if (count == 0)
+        return 0;
+
+    mutex_lock(&g_device_hcd->extif_mutex);
+
+    LOCK_BUFFER(g_device_hcd->resp);
+
+    if (g_device_hcd->raw_mode) {
+        retval = syna_tcm_alloc_mem(tcm_hcd,
+                &g_device_hcd->resp,
+                count);
+        if (retval < 0) {
+            pr_err("Failed to allocate memory for device_hcd->resp.buf\n");
+            UNLOCK_BUFFER(g_device_hcd->resp);
+            goto exit;
+        }
+
+        retval = g_device_hcd->read_message(tcm_hcd,
+                g_device_hcd->resp.buf,
+                count);
+        if (retval < 0) {
+            pr_err("Failed to read message\n");
+            UNLOCK_BUFFER(g_device_hcd->resp);
+            goto exit;
+        }
+    } else {
+        if (count != g_device_hcd->resp.data_length) {
+            pr_err("Invalid length information\n");
+            UNLOCK_BUFFER(g_device_hcd->resp);
+            retval = -EINVAL;
+            goto exit;
+        }
+    }
+
+    if (copy_to_user(buf, g_device_hcd->resp.buf, count)) {
+        pr_err("Failed to copy data to user space\n");
+        UNLOCK_BUFFER(g_device_hcd->resp);
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    if (!g_device_hcd->concurrent)
+        goto skip_concurrent;
+
+    if (g_device_hcd->report_touch == NULL) {
+        pr_err("Unable to report touch\n");
+        g_device_hcd->concurrent = false;
+    }
+
+    if (g_device_hcd->raw_mode)
+        device_capture_touch_report(count);
+
+skip_concurrent:
+    UNLOCK_BUFFER(g_device_hcd->resp);
+
+    retval = count;
+
+exit:
+    mutex_unlock(&g_device_hcd->extif_mutex);
+
+    return retval;
+}
+
+static ssize_t device_write(struct file *filp, const char __user *buf,
+        size_t count, loff_t *f_pos)
+{
+    int retval;
+    struct syna_tcm_hcd *tcm_hcd = g_device_hcd->tcm_hcd;
+
+    if (count == 0)
+        return 0;
+
+    mutex_lock(&g_device_hcd->extif_mutex);
+
+    LOCK_BUFFER(g_device_hcd->out);
+
+    retval = syna_tcm_alloc_mem(tcm_hcd,
+            &g_device_hcd->out,
+            count == 1 ? count + 1 : count);
+    if (retval < 0) {
+        pr_err("Failed to allocate memory for device_hcd->out.buf\n");
+        UNLOCK_BUFFER(g_device_hcd->out);
+        goto exit;
+    }
+
+    if (copy_from_user(g_device_hcd->out.buf, buf, count)) {
+        pr_err("Failed to copy data from user space\n");
+        UNLOCK_BUFFER(g_device_hcd->out);
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    LOCK_BUFFER(g_device_hcd->resp);
+
+    pr_info("%s: cmd 0x%x\n", __func__, g_device_hcd->out.buf[0]);
+    if (g_device_hcd->raw_mode) {
+        retval = g_device_hcd->write_message(tcm_hcd,
+                g_device_hcd->out.buf[0],
+                &g_device_hcd->out.buf[1],
+                count - 1,
+                NULL,
+                NULL,
+                NULL,
+                0);
+    } else {
+        mutex_lock(&tcm_hcd->reset_mutex);
+        retval = g_device_hcd->write_message(tcm_hcd,
+                g_device_hcd->out.buf[0],
+                &g_device_hcd->out.buf[1],
+                count - 1,
+                &g_device_hcd->resp.buf,
+                &g_device_hcd->resp.buf_size,
+                &g_device_hcd->resp.data_length,
+                0);
+        mutex_unlock(&tcm_hcd->reset_mutex);
+    }
+
+    if (g_device_hcd->out.buf[0] == CMD_ERASE_FLASH) {
+        msleep(500);
+    }
+
+    if (retval < 0) {
+        pr_err("Failed to write command 0x%02x\n",
+                g_device_hcd->out.buf[0]);
+        UNLOCK_BUFFER(g_device_hcd->resp);
+        UNLOCK_BUFFER(g_device_hcd->out);
+        goto exit;
+    }
+
+    if (count && g_device_hcd->out.buf[0] == CMD_SET_TOUCH_REPORT_CONFIG) {
+        retval = device_capture_touch_report_config(count);
+        if (retval < 0) {
+            pr_err("Failed to capture touch report config\n");
+        }
+    }
+
+    UNLOCK_BUFFER(g_device_hcd->out);
+
+    if (g_device_hcd->raw_mode)
+        retval = count;
+    else
+        retval = g_device_hcd->resp.data_length;
+
+    UNLOCK_BUFFER(g_device_hcd->resp);
+
+exit:
+    mutex_unlock(&g_device_hcd->extif_mutex);
+
+    return retval;
+}
+
+static int device_open(struct inode *inp, struct file *filp)
+{
+    int retval;
+
+    mutex_lock(&g_device_hcd->extif_mutex);
+
+    if (g_device_hcd->ref_count < 1) {
+        g_device_hcd->ref_count++;
+        retval = 0;
+    } else {
+        retval = -EACCES;
+    }
+
+    g_device_hcd->flag = 1;
+
+    mutex_unlock(&g_device_hcd->extif_mutex);
+
+    return retval;
+}
+
+static int device_release(struct inode *inp, struct file *filp)
+{
+
+    mutex_lock(&g_device_hcd->extif_mutex);
+
+    if (g_device_hcd->ref_count)
+        g_device_hcd->ref_count--;
+
+    mutex_unlock(&g_device_hcd->extif_mutex);
+
+    return 0;
+}
+
+static char *device_devnode(struct device *dev, umode_t *mode)
+{
+    if (!mode)
+        return NULL;
+
+    *mode = (S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH);
+
+    return kasprintf(GFP_KERNEL, "%s/%s", PLATFORM_DRIVER_NAME,
+            dev_name(dev));
+}
+
+static int device_create_class(void)
+{
+    if (g_device_hcd->class != NULL)
+        return 0;
+
+    g_device_hcd->class = class_create(THIS_MODULE, PLATFORM_DRIVER_NAME);
+
+    if (IS_ERR(g_device_hcd->class)) {
+        pr_err("Failed to create class\n");
+        return -ENODEV;
+    }
+
+    g_device_hcd->class->devnode = device_devnode;
+
+    return 0;
+}
+
+static const struct file_operations device_fops = {
+    .owner = THIS_MODULE,
+#ifdef HAVE_UNLOCKED_IOCTL
+    .unlocked_ioctl = device_ioctl,
+#ifdef HAVE_COMPAT_IOCTL
+    .compat_ioctl = device_ioctl,
+#endif
+#else
+    .ioctl = device_ioctl,
+#endif
+    .llseek = device_llseek,
+    .read = device_read,
+    .write = device_write,
+    .open = device_open,
+    .release = device_release,
+};
+
+static int device_init(struct syna_tcm_hcd *tcm_hcd)
+{
+    int retval;
+    dev_t dev_num;
+
+    g_device_hcd = kzalloc(sizeof(*g_device_hcd), GFP_KERNEL);
+    if (!g_device_hcd) {
+        pr_err("Failed to allocate memory for device_hcd\n");
+        return -ENOMEM;
+    }
+
+    mutex_init(&g_device_hcd->extif_mutex);
+
+    g_device_hcd->tcm_hcd = tcm_hcd;
+    g_device_hcd->concurrent = CONCURRENT;
+
+    INIT_BUFFER(g_device_hcd->out, false);
+    INIT_BUFFER(g_device_hcd->resp, false);
+    INIT_BUFFER(g_device_hcd->report, false);
+
+    if (rmidev_major_num) {
+        dev_num = MKDEV(rmidev_major_num, 0);
+        retval = register_chrdev_region(dev_num, 1,
+                PLATFORM_DRIVER_NAME);
+        if (retval < 0) {
+            pr_err("Failed to register char device\n");
+            goto err_register_chrdev_region;
+        }
+    } else {
+        retval = alloc_chrdev_region(&dev_num, 0, 1,
+                PLATFORM_DRIVER_NAME);
+        if (retval < 0) {
+            pr_err("Failed to allocate char device\n");
+            goto err_alloc_chrdev_region;
+        }
+
+        rmidev_major_num = MAJOR(dev_num);
+    }
+
+    g_device_hcd->dev_num = dev_num;
+
+    cdev_init(&g_device_hcd->char_dev, &device_fops);
+
+    retval = cdev_add(&g_device_hcd->char_dev, dev_num, 1);
+    if (retval < 0) {
+        pr_err("Failed to add char device\n");
+        goto err_add_chardev;
+    }
+
+    retval = device_create_class();
+    if (retval < 0) {
+        pr_err("Failed to create class\n");
+        goto err_create_class;
+    }
+
+    g_device_hcd->device = device_create(g_device_hcd->class, NULL,
+            g_device_hcd->dev_num, NULL, CHAR_DEVICE_NAME"%d",
+            MINOR(g_device_hcd->dev_num));
+    if (IS_ERR(g_device_hcd->device)) {
+        pr_err("Failed to create device\n");
+        retval = -ENODEV;
+        goto err_create_device;
+    }
+    return 0;
+
+err_create_device:
+    class_destroy(g_device_hcd->class);
+
+err_create_class:
+    cdev_del(&g_device_hcd->char_dev);
+
+err_add_chardev:
+    unregister_chrdev_region(dev_num, 1);
+
+err_alloc_chrdev_region:
+err_register_chrdev_region:
+    RELEASE_BUFFER(g_device_hcd->report);
+    RELEASE_BUFFER(g_device_hcd->resp);
+    RELEASE_BUFFER(g_device_hcd->out);
+
+    kfree(g_device_hcd);
+    g_device_hcd = NULL;
+
+    return retval;
+}
+
+struct device_hcd * syna_remote_device_init(struct syna_tcm_hcd *tcm_hcd)
+{
+    device_init(tcm_hcd);
+
+    return g_device_hcd;
+}
+
+int syna_remote_device_destory(struct syna_tcm_hcd *tcm_hcd)
+{
+    if (!g_device_hcd)
+        return 0;
+
+    device_destroy(g_device_hcd->class, g_device_hcd->dev_num);
+
+    class_destroy(g_device_hcd->class);
+
+    cdev_del(&g_device_hcd->char_dev);
+
+    unregister_chrdev_region(g_device_hcd->dev_num, 1);
+
+    RELEASE_BUFFER(g_device_hcd->report);
+    RELEASE_BUFFER(g_device_hcd->resp);
+    RELEASE_BUFFER(g_device_hcd->out);
+
+    kfree(g_device_hcd);
+    g_device_hcd = NULL;
+
+    return 0;
+}
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_recovery.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_recovery.c
new file mode 100644
index 0000000000000000000000000000000000000000..d941dcf2286abfa7b2c41877c1b36d272da7897e
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/Syna_tcm/synaptics_tcm_recovery.c
@@ -0,0 +1,562 @@
+/**************************************************************
+* Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+* File       : synaptics_tcm_recovery.c
+* Description: Source file for synaptics TD4330 driver
+* Version   : 1.0
+* Date        : 2018-01-18
+* Author    : Xing.Xiong@EXP.Bsp.Group.Tp
+* TAG         : BSP.TP.Init
+* ---------------- Revision History: --------------------------
+*   <version>    <date>          < author >                            <desc>
+* Revision 1.1, 2018-01-18, Xing.Xiong@EXP.Bsp.Group.Tp.
+****************************************************************/
+
+#include "synaptics_tcm_core.h"
+
+#define SET_UP_RECOVERY_MODE true
+#define ENABLE_SYSFS_INTERFACE true
+
+#define IHEX_BUF_SIZE (1024 * 1024)
+#define DATA_BUF_SIZE (512 * 1024)
+#define IHEX_RECORD_SIZE 14
+#define PDT_START_ADDR 0x00e9
+#define UBL_FN_NUMBER 0x35
+#define F35_CHUNK_SIZE 16
+#define F35_CHUNK_SIZE_WORDS 8
+#define F35_ERASE_ALL_WAIT_MS 5000
+#define F35_ERASE_ALL_POLL_MS 100
+#define F35_DATA5_OFFSET 5
+#define F35_CTRL3_OFFSET 18
+#define F35_RESET_COMMAND 16
+#define F35_ERASE_ALL_COMMAND 3
+#define F35_WRITE_CHUNK_COMMAND 2
+#define F35_READ_FLASH_STATUS_COMMAND 1
+
+struct rmi_pdt_entry {
+    unsigned char query_base_addr;
+    unsigned char command_base_addr;
+    unsigned char control_base_addr;
+    unsigned char data_base_addr;
+    unsigned char intr_src_count:3;
+    unsigned char reserved_1:2;
+    unsigned char fn_version:2;
+    unsigned char reserved_2:1;
+    unsigned char fn_number;
+} __packed;
+
+struct rmi_addr {
+    unsigned short query_base;
+    unsigned short command_base;
+    unsigned short control_base;
+    unsigned short data_base;
+};
+
+struct recovery_hcd {
+    unsigned char chunk_buf[F35_CHUNK_SIZE + 3];
+    unsigned char out_buf[3];
+    unsigned char *ihex_buf;
+    unsigned char *data_buf;
+    unsigned int ihex_size;
+    unsigned int ihex_records;
+    unsigned int data_entries;
+    struct rmi_addr f35_addr;
+    struct syna_tcm_hcd *tcm_hcd;
+    const struct firmware *fw_entry;
+};
+
+static int recovery_device_reset(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char command = F35_RESET_COMMAND;
+
+    retval = syna_tcm_rmi_write(recovery_hcd->tcm_hcd,
+            recovery_hcd->f35_addr.control_base + F35_CTRL3_OFFSET,
+            &command,
+            sizeof(command));
+    if (retval < 0) {
+        TPD_INFO("Failed to write F$35 command\n");
+        return retval;
+    }
+
+    msleep(200);
+
+    return 0;
+}
+
+static int recovery_add_data_entry(struct recovery_hcd *recovery_hcd, unsigned char data)
+{
+    if (recovery_hcd->data_entries >= DATA_BUF_SIZE) {
+        TPD_INFO("Reached data buffer size limit\n");
+        return -EINVAL;
+    }
+
+    recovery_hcd->data_buf[recovery_hcd->data_entries++] = data;
+
+    return 0;
+}
+
+static int recovery_add_padding(struct recovery_hcd *recovery_hcd, unsigned int *words)
+{
+    int retval;
+    unsigned int padding;
+
+    padding = (F35_CHUNK_SIZE_WORDS - *words % F35_CHUNK_SIZE_WORDS);
+    padding %= F35_CHUNK_SIZE_WORDS;
+
+    while (padding) {
+        retval = recovery_add_data_entry(recovery_hcd, 0xff);
+        if (retval < 0) {
+            TPD_INFO("Failed to add data entry\n");
+            return retval;
+        }
+
+        retval = recovery_add_data_entry(recovery_hcd, 0xff);
+        if (retval < 0) {
+            TPD_INFO("Failed to add data entry\n");
+            return retval;
+        }
+
+        (*words)++;
+        padding--;
+    }
+
+    return 0;
+}
+
+static int recovery_parse_ihex(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char colon;
+    unsigned char *buf;
+    unsigned int addr;
+    unsigned int type;
+    unsigned int addrl;
+    unsigned int addrh;
+    unsigned int data0;
+    unsigned int data1;
+    unsigned int count;
+    unsigned int words;
+    unsigned int offset;
+    unsigned int record;
+
+    words = 0;
+    offset = 0;
+    buf = recovery_hcd->ihex_buf;
+    recovery_hcd->data_entries = 0;
+
+    for (record = 0; record < recovery_hcd->ihex_records; record++) {
+        buf[(record + 1) * IHEX_RECORD_SIZE - 1] = 0x00;
+        retval = sscanf(&buf[record * IHEX_RECORD_SIZE],
+                "%c%02x%02x%02x%02x%02x%02x",
+                &colon,
+                &count,
+                &addrh,
+                &addrl,
+                &type,
+                &data0,
+                &data1);
+        if (retval != 7) {
+            TPD_INFO("Failed to read ihex record\n");
+            return -EINVAL;
+        }
+
+        if (type == 0x00) {
+            if ((words % F35_CHUNK_SIZE_WORDS) == 0) {
+                addr = (addrh << 8) + addrl;
+                addr += offset;
+                addr >>= 4;
+
+                retval = recovery_add_data_entry(recovery_hcd, addr);
+                if (retval < 0) {
+                    TPD_INFO("Failed to add data entry\n");
+                    return retval;
+                }
+
+                retval = recovery_add_data_entry(recovery_hcd, addr >> 8);
+                if (retval < 0) {
+                    TPD_INFO("Failed to add data entry\n");
+                    return retval;
+                }
+            }
+
+            retval = recovery_add_data_entry(recovery_hcd, data0);
+            if (retval < 0) {
+                TPD_INFO("Failed to add data entry\n");
+                return retval;
+            }
+
+            retval = recovery_add_data_entry(recovery_hcd, data1);
+            if (retval < 0) {
+                TPD_INFO("Failed to add data entry\n");
+                return retval;
+            }
+
+            words++;
+        } else if (type == 0x02) {
+            retval = recovery_add_padding(recovery_hcd, &words);
+            if (retval < 0) {
+                TPD_INFO("Failed to add padding\n");
+                return retval;
+            }
+
+            offset = (data0 << 8) + data1;
+            offset <<= 4;
+        }
+    }
+
+    retval = recovery_add_padding(recovery_hcd, &words);
+    if (retval < 0) {
+        TPD_INFO("Failed to add padding\n");
+        return retval;
+    }
+
+    return 0;
+}
+
+static int recovery_check_status(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char status;
+
+    retval = syna_tcm_rmi_read(recovery_hcd->tcm_hcd,
+            recovery_hcd->f35_addr.data_base,
+            &status,
+            sizeof(status));
+    if (retval < 0) {
+        TPD_INFO("Failed to read status\n");
+        return retval;
+    }
+
+    status = status & 0x1f;
+
+    if (status != 0x00) {
+        TPD_INFO("Recovery mode status = 0x%02x\n", status);
+        return -EINVAL;
+    }
+
+    return 0;
+}
+
+static int recovery_write_flash(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char *data_ptr;
+    unsigned int chunk_buf_size;
+    unsigned int chunk_data_size;
+    unsigned int entries_written;
+    unsigned int entries_to_write;
+
+    entries_written = 0;
+
+    data_ptr = recovery_hcd->data_buf;
+
+    chunk_buf_size = sizeof(recovery_hcd->chunk_buf);
+
+    chunk_data_size = chunk_buf_size - 1;
+
+    recovery_hcd->chunk_buf[chunk_buf_size - 1] = F35_WRITE_CHUNK_COMMAND;
+
+    while (entries_written < recovery_hcd->data_entries) {
+        entries_to_write = F35_CHUNK_SIZE + 2;
+
+        retval = secure_memcpy(recovery_hcd->chunk_buf,
+                chunk_buf_size - 1,
+                data_ptr,
+                recovery_hcd->data_entries - entries_written,
+                entries_to_write);
+        if (retval < 0) {
+            TPD_INFO("Failed to copy chunk data\n");
+            return retval;
+        }
+
+        retval = syna_tcm_rmi_write(recovery_hcd->tcm_hcd,
+                recovery_hcd->f35_addr.control_base,
+                recovery_hcd->chunk_buf,
+                chunk_buf_size);
+        if (retval < 0) {
+            TPD_INFO("Failed to write chunk data\n");
+            return retval;
+        }
+
+        data_ptr += entries_to_write;
+        entries_written += entries_to_write;
+    }
+
+    retval = recovery_check_status(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to get no error recovery mode status\n");
+        return retval;
+    }
+
+    return 0;
+}
+
+static int recovery_poll_erase_completion(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char status;
+    unsigned char command;
+    unsigned char data_base;
+    unsigned int timeout;
+
+    timeout = F35_ERASE_ALL_WAIT_MS;
+
+    data_base = recovery_hcd->f35_addr.data_base;
+
+    do {
+        command = F35_READ_FLASH_STATUS_COMMAND;
+
+        retval = syna_tcm_rmi_write(recovery_hcd->tcm_hcd,
+                recovery_hcd->f35_addr.command_base,
+                &command,
+                sizeof(command));
+        if (retval < 0) {
+            TPD_INFO("Failed to write F$35 command\n");
+            return retval;
+        }
+
+        do {
+            retval = syna_tcm_rmi_read(recovery_hcd->tcm_hcd,
+                    recovery_hcd->f35_addr.command_base,
+                    &command,
+                    sizeof(command));
+            if (retval < 0) {
+                TPD_INFO("Failed to read command status\n");
+                return retval;
+            }
+
+            if (command == 0x00)
+                break;
+
+            if (timeout == 0)
+                break;
+
+            msleep(F35_ERASE_ALL_POLL_MS);
+            timeout -= F35_ERASE_ALL_POLL_MS;
+        } while (true);
+
+        if (command != 0 && timeout == 0) {
+            retval = -EINVAL;
+            goto exit;
+        }
+
+        retval = syna_tcm_rmi_read(recovery_hcd->tcm_hcd,
+                data_base + F35_DATA5_OFFSET,
+                &status,
+                sizeof(status));
+        if (retval < 0) {
+            TPD_INFO("Failed to read flash status\n");
+            return retval;
+        }
+
+        if ((status & 0x01) == 0x00)
+            break;
+
+        if (timeout == 0) {
+            retval = -EINVAL;
+            goto exit;
+        }
+
+        msleep(F35_ERASE_ALL_POLL_MS);
+        timeout -= F35_ERASE_ALL_POLL_MS;
+    } while (true);
+
+    retval = 0;
+
+exit:
+    if (retval < 0) {
+        TPD_INFO("Failed to get erase completion\n");
+    }
+
+    return retval;
+}
+
+static int recovery_erase_flash(struct recovery_hcd *recovery_hcd)
+{
+    int retval;
+    unsigned char command;
+
+    command = F35_ERASE_ALL_COMMAND;
+
+    retval = syna_tcm_rmi_write(recovery_hcd->tcm_hcd,
+            recovery_hcd->f35_addr.control_base + F35_CTRL3_OFFSET,
+            &command,
+            sizeof(command));
+    if (retval < 0) {
+        TPD_INFO("Failed to write F$35 command\n");
+        return retval;
+    }
+
+    if (recovery_hcd->f35_addr.command_base) {
+        retval = recovery_poll_erase_completion(recovery_hcd);
+        if (retval < 0) {
+            TPD_INFO("Failed to wait for erase completion\n");
+            return retval;
+        }
+    } else {
+        msleep(F35_ERASE_ALL_WAIT_MS);
+    }
+
+    retval = recovery_check_status(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to get no error recovery mode status\n");
+        return retval;
+    }
+
+    return 0;
+}
+
+static int recovery_in_ubl_mode(struct recovery_hcd *recovery_hcd)
+{
+    int retval = 0;
+    struct rmi_pdt_entry p_entry;
+    retval = syna_tcm_rmi_read(recovery_hcd->tcm_hcd,
+            PDT_START_ADDR,
+            (unsigned char *)&p_entry,
+            sizeof(p_entry));
+    if (retval < 0) {
+        TPD_INFO("Failed to read PDT entry\n");
+        return false;
+    }
+
+    if (p_entry.fn_number != UBL_FN_NUMBER) {
+        TPD_INFO("Failed to find F$35\n");
+        return false;
+    }
+    return true;
+}
+static int recovery_get_fw_ihex(struct recovery_hcd *recovery_hcd, char *iHex)
+{
+    int retval;
+
+    retval = request_firmware(&recovery_hcd->fw_entry, iHex, &recovery_hcd->tcm_hcd->client->dev);
+    if (retval < 0) {
+        TPD_INFO("Failed to request %s\n", iHex);
+        return retval;
+    }
+
+    TPD_INFO("ihex file size = %d\n", (unsigned int)recovery_hcd->fw_entry->size);
+    secure_memcpy(recovery_hcd->ihex_buf,
+                recovery_hcd->fw_entry->size,
+                recovery_hcd->fw_entry->data,
+                recovery_hcd->fw_entry->size,
+                recovery_hcd->fw_entry->size);
+    recovery_hcd->ihex_size = recovery_hcd->fw_entry->size;
+    recovery_hcd->ihex_records = recovery_hcd->ihex_size / IHEX_RECORD_SIZE;
+    return 0;
+}
+
+int recovery_do_recovery(struct recovery_hcd *recovery_hcd, char *iHex)
+{
+    int retval;
+    struct rmi_pdt_entry p_entry;
+
+    retval = recovery_get_fw_ihex(recovery_hcd, iHex);
+    if (retval < 0) {
+        TPD_INFO("Failed to get ihex data\n");
+        return retval;
+    }
+
+    retval = recovery_parse_ihex(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to parse ihex data\n");
+        return retval;
+    }
+
+    retval = syna_tcm_rmi_read(recovery_hcd->tcm_hcd,
+            PDT_START_ADDR,
+            (unsigned char *)&p_entry,
+            sizeof(p_entry));
+    if (retval < 0) {
+        TPD_INFO("Failed to read PDT entry\n");
+        return retval;
+    }
+
+    if (p_entry.fn_number != UBL_FN_NUMBER) {
+        TPD_INFO("Failed to find F$35\n");
+        return -ENODEV;
+    }
+
+    recovery_hcd->f35_addr.query_base = p_entry.query_base_addr;
+    recovery_hcd->f35_addr.command_base = p_entry.command_base_addr;
+    recovery_hcd->f35_addr.control_base = p_entry.control_base_addr;
+    recovery_hcd->f35_addr.data_base = p_entry.data_base_addr;
+
+    TPD_INFO("Start of recovery\n");
+
+    retval = recovery_erase_flash(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to erase flash\n");
+        return retval;
+    }
+
+    TPD_INFO("Flash erased\n");
+
+    retval = recovery_write_flash(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to write to flash\n");
+        return retval;
+    }
+
+    TPD_INFO("Flash written\n");
+
+    retval = recovery_device_reset(recovery_hcd);
+    if (retval < 0) {
+        TPD_INFO("Failed to do reset\n");
+        return retval;
+    }
+
+    TPD_INFO("End of recovery\n");
+
+    return 0;
+}
+
+int try_to_recovery_ic(struct syna_tcm_hcd *tcm_hcd, char *iHex)
+{
+    int retval = 0;
+    struct recovery_hcd *recovery_hcd;
+
+    recovery_hcd = kzalloc(sizeof(*recovery_hcd), GFP_KERNEL);
+    if (!recovery_hcd) {
+        TPD_INFO("Failed to allocate memory for recovery_hcd\n");
+        return -ENOMEM;
+    }
+
+    recovery_hcd->ihex_buf = kzalloc(IHEX_BUF_SIZE, GFP_KERNEL);
+    if (!recovery_hcd->ihex_buf) {
+        TPD_INFO("Failed to allocate memory for recovery_hcd->ihex_buf\n");
+        retval = -ENOMEM;
+        goto err_allocate_ihex_buf;
+    }
+
+    recovery_hcd->data_buf = kzalloc(DATA_BUF_SIZE, GFP_KERNEL);
+    if (!recovery_hcd->data_buf) {
+        TPD_INFO("Failed to allocate memory for recovery_hcd->data_buf\n");
+        retval = -ENOMEM;
+        goto err_allocate_data_buf;
+    }
+
+    recovery_hcd->out_buf[0] = CMD_REBOOT_TO_ROM_BOOTLOADER;
+    recovery_hcd->out_buf[1] = 0;
+    recovery_hcd->out_buf[2] = 0;
+    recovery_hcd->tcm_hcd = tcm_hcd;
+
+    if (!recovery_in_ubl_mode(recovery_hcd)) {
+        TPD_INFO("not in ubl mode, goto normal fw update process\n");
+        retval = 0;
+        goto exit;
+    }
+
+    recovery_do_recovery(recovery_hcd, iHex);
+
+    retval = 1;
+exit:
+    kfree(recovery_hcd->data_buf);
+err_allocate_data_buf:
+    kfree(recovery_hcd->ihex_buf);
+err_allocate_ihex_buf:
+    kfree(recovery_hcd);
+    recovery_hcd = NULL;
+
+    return retval;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..6b4cdaefc2633ee5a2126fcb571246babf5e9800
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Kconfig
@@ -0,0 +1,6 @@
+config TOUCHPANEL_SYNAPTICS_TD4310
+	default n
+	bool "TP Synaptics_TD4310 IC enable or not for OPPO"
+	---help---
+	say Y to enable driver for Touchpanel useing synaptics TD4310
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..1a8aa31974c02648db313e0cf0355b481cbb39ec
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/Makefile
@@ -0,0 +1,7 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+obj-$(CONFIG_TOUCHPANEL_SYNAPTICS_TD4310) += synaptics_drivers_td4310.o
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_drivers_td4310.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_drivers_td4310.c
new file mode 100644
index 0000000000000000000000000000000000000000..25a48769c3224814285e68ef124fd33ab4ab822b
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_drivers_td4310.c
@@ -0,0 +1,2822 @@
+/**************************************************************
+* Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd
+* File       : synaptics_drivers_td4310.c
+* Description: Source file for synaptics TD4310 driver
+* Version   : 1.0
+* Date        : 2017-05-15
+* Author    : Xing.Xiong@EXP.Bsp.Group.Tp
+* TAG         : BSP.TP.Init
+* ---------------- Revision History: --------------------------
+*   <version>    <date>          < author >                            <desc>
+* Revision 1.1, 2017-05-15, Xing.Xiong@EXP.Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/326176)
+****************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/hrtimer.h>
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/regulator/consumer.h>
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "synaptics_td4310.h"
+
+static struct chip_data_td4310 *g_chip_info = NULL;
+
+
+/*******Part0:LOG TAG Declear********************/
+#define TPD_DEVICE "synaptics-td4310"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DEBUG_NTAG(a, arg...)\
+    do{\
+        if (tp_debug)\
+            printk(a, ##arg);\
+    }while(0)
+
+/*******Part1: Function Declearation*******/
+static int synaptics_power_control(void *chip_data, bool enable);
+static int synaptics_get_chip_info(void *chip_data);
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag);
+void __attribute__((weak)) tfa_mutex_lock(bool enable) {return;}    //mutex avoid i2c transfer in tp reset process
+
+/*******Part2:Call Back Function implement*******/
+static int synaptics_get_touch_points(void *chip_data, struct point_info *points, int max_num)
+{
+    int ret, i, obj_attention;
+    unsigned char fingers_to_process = max_num;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    char buf[8*max_num];
+
+    memset(buf, 0, sizeof(buf));
+    obj_attention = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F12_2D_DATA15);
+    for (i = 9;  ; i--) {
+        if ((obj_attention & 0x03FF) >> i  || i == 0)
+            break;
+        else
+            fingers_to_process--;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8*fingers_to_process, buf);
+    if (ret < 0) {
+        TPD_INFO("touch i2c read block failed\n");
+        return -1;
+    }
+    for (i = 0; i < fingers_to_process; i++) {
+        points[i].x = ((buf[i*8 + 2] & 0x0f) << 8) | (buf[i*8 + 1] & 0xff);
+        points[i].y = ((buf[i*8 + 4] & 0x0f) << 8) | (buf[i*8 + 3] & 0xff);
+        points[i].z = buf[i*8 + 5];
+        points[i].width_major = ((buf[i*8 + 6] & 0x0f) + (buf[i*8 + 7] & 0x0f)) / 2;
+        points[i].status = buf[i*8];
+    }
+
+    return obj_attention;
+}
+
+static int synaptics_get_vendor(void *chip_data, struct panel_info *panel_data)
+{
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    chip_info->tp_type = panel_data->tp_type;
+    TPD_INFO("chip_info->tp_type = %d, panel_data->test_limit_name = %s, panel_data->fw_name = %s\n", chip_info->tp_type, panel_data->test_limit_name, panel_data->fw_name);
+    return 0;
+}
+
+static int synaptics_read_F54_base_reg(struct chip_data_td4310 *chip_info)
+{
+    uint8_t buf[4] = {0};
+    int ret = 0;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);    // page 1
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    chip_info->reg_info.F54_ANALOG_QUERY_BASE = buf[0];
+    chip_info->reg_info.F54_ANALOG_COMMAND_BASE = buf[1];
+    chip_info->reg_info.F54_ANALOG_CONTROL_BASE = buf[2];
+    chip_info->reg_info.F54_ANALOG_DATA_BASE = buf[3];
+    TPD_INFO("F54_QUERY_BASE = %x \n\
+            F54_CMD_BASE    = %x \n\
+            F54_CTRL_BASE   = %x \n\
+            F54_DATA_BASE   = %x \n",
+            chip_info->reg_info.F54_ANALOG_QUERY_BASE, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,
+            chip_info->reg_info.F54_ANALOG_CONTROL_BASE, chip_info->reg_info.F54_ANALOG_DATA_BASE);
+
+    return ret;
+}
+
+static int synaptics_get_chip_info(void *chip_data)
+{
+    uint8_t buf[4] = {0};
+    int ret;
+    struct chip_data_td4310    *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    memset(buf, 0, sizeof(buf));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, 0xDD, 4, &(buf[0x0]));
+    if (ret < 0) {
+        TPD_INFO("failed for page select!\n");
+        return -1;
+    }
+
+    reg_info->F12_2D_QUERY_BASE = buf[0];
+    reg_info->F12_2D_CMD_BASE = buf[1];
+    reg_info->F12_2D_CTRL_BASE = buf[2];
+    reg_info->F12_2D_DATA_BASE = buf[3];
+
+    TPD_INFO("F12_2D_QUERY_BASE = 0x%x \n\
+            F12_2D_CMD_BASE    = 0x%x \n\
+            F12_2D_CTRL_BASE   = 0x%x \n\
+            F12_2D_DATA_BASE   = 0x%x \n",
+            reg_info->F12_2D_QUERY_BASE, reg_info->F12_2D_CMD_BASE,
+            reg_info->F12_2D_CTRL_BASE,  reg_info->F12_2D_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE3, 4, &(buf[0x0]));
+    reg_info->F01_RMI_QUERY_BASE = buf[0];
+    reg_info->F01_RMI_CMD_BASE = buf[1];
+    reg_info->F01_RMI_CTRL_BASE = buf[2];
+    reg_info->F01_RMI_DATA_BASE = buf[3];
+    TPD_INFO("F01_RMI_QUERY_BASE = 0x%x \n\
+            F01_RMI_CMD_BASE    = 0x%x \n\
+            F01_RMI_CTRL_BASE   = 0x%x \n\
+            F01_RMI_DATA_BASE   = 0x%x \n",
+            reg_info->F01_RMI_QUERY_BASE, reg_info->F01_RMI_CMD_BASE,
+            reg_info->F01_RMI_CTRL_BASE,  reg_info->F01_RMI_DATA_BASE);
+
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F34_FLASH_QUERY_BASE = buf[0];
+    reg_info->F34_FLASH_CMD_BASE = buf[1];
+    reg_info->F34_FLASH_CTRL_BASE = buf[2];
+    reg_info->F34_FLASH_DATA_BASE = buf[3];
+    TPD_INFO("F34_FLASH_QUERY_BASE   = 0x%x \n\
+            F34_FLASH_CMD_BASE      = 0x%x \n\
+            F34_FLASH_CTRL_BASE     = 0x%x \n\
+            F34_FLASH_DATA_BASE     = 0x%x \n",
+            reg_info->F34_FLASH_QUERY_BASE, reg_info->F34_FLASH_CMD_BASE,
+            reg_info->F34_FLASH_CTRL_BASE,  reg_info->F34_FLASH_DATA_BASE);
+
+    reg_info->F01_RMI_QUERY11 = reg_info->F01_RMI_QUERY_BASE + 0x0b;    // product id
+    reg_info->F01_RMI_CTRL00 = reg_info->F01_RMI_CTRL_BASE;
+    reg_info->F01_RMI_CTRL01 = reg_info->F01_RMI_CTRL_BASE + 1;
+    reg_info->F01_RMI_CTRL02 = reg_info->F01_RMI_CTRL_BASE + 2;
+    reg_info->F01_RMI_CMD00  = reg_info->F01_RMI_CMD_BASE;
+    reg_info->F01_RMI_DATA01 = reg_info->F01_RMI_DATA_BASE + 1;
+
+    reg_info->F12_2D_CTRL08 = reg_info->F12_2D_CTRL_BASE;               // max XY Coordinate
+    reg_info->F12_2D_CTRL23 = reg_info->F12_2D_CTRL_BASE + 8;           //glove enable
+
+    reg_info->F12_2D_DATA04 = reg_info->F12_2D_DATA_BASE + 1;           //gesture type
+    reg_info->F12_2D_DATA15 = reg_info->F12_2D_DATA_BASE + 2;           //object attention
+    reg_info->F12_2D_CMD00  = reg_info->F12_2D_CMD_BASE;
+    reg_info->F12_2D_CTRL20 = reg_info->F12_2D_CTRL_BASE + 0x06;        // wakeup Gesture enable
+    reg_info->F12_2D_CTRL27 = reg_info->F12_2D_CTRL_BASE + 0x0B;        //motion suppression
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F51_CUSTOM_QUERY_BASE = buf[0];
+    reg_info->F51_CUSTOM_CMD_BASE   = buf[1];
+    reg_info->F51_CUSTOM_CTRL_BASE  = buf[2];
+    reg_info->F51_CUSTOM_DATA_BASE  = buf[3];
+    TPD_INFO("F51_CUSTOM_QUERY_BASE  = 0x%x \n\
+            F51_CUSTOM_CMD_BASE     = 0x%x \n\
+            F51_CUSTOM_CTRL_BASE    = 0x%x \n\
+            F51_CUSTOM_DATA_BASE    = 0x%x \n",
+            reg_info->F51_CUSTOM_QUERY_BASE, reg_info->F51_CUSTOM_CMD_BASE,
+            reg_info->F51_CUSTOM_CTRL_BASE,  reg_info->F51_CUSTOM_DATA_BASE);
+
+    reg_info->F51_CUSTOM_CTRL00 = reg_info->F51_CUSTOM_CTRL_BASE;       //no use
+    reg_info->F51_CUSTOM_CTRL36 = reg_info->F51_CUSTOM_CTRL_BASE + 0x14;       //042e for esd test
+    reg_info->F51_CUSTOM_DATA   = reg_info->F51_CUSTOM_DATA_BASE;       //wakeup gesture data
+    reg_info->F51_CUSTOM_DATA57 = reg_info->F51_CUSTOM_DATA_BASE + 0x19; // esd status
+
+    reg_info->F51_CUSTOM_GRIP_CTRL = reg_info->F51_CUSTOM_CTRL_BASE + 0x05; //041F edge function register,the enable bit of Grip suppression
+
+    synaptics_read_F54_base_reg(chip_info);
+    reg_info->F54_ANALOG_DATA06 = reg_info->F54_ANALOG_DATA_BASE + 0x04;
+    reg_info->F54_ANALOG_DATA10 = reg_info->F54_ANALOG_DATA_BASE + 0x08;
+    reg_info->F54_ANALOG_DATA17 = reg_info->F54_ANALOG_DATA_BASE + 0x0B;
+
+    reg_info->F54_ANALOG_CTRL91 = reg_info->F54_ANALOG_CONTROL_BASE + 0x25;  // 0132
+    reg_info->F54_ANALOG_CTRL99 = reg_info->F54_ANALOG_CONTROL_BASE + 0x2A;  //0137
+    reg_info->F54_ANALOG_CTRL182 = reg_info->F54_ANALOG_CONTROL_BASE + 0x2F; //013C
+    reg_info->F54_ANALOG_CTRL225 = reg_info->F54_ANALOG_CONTROL_BASE + 0x32; //013F
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x3);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return -1;
+    }
+    ret = touch_i2c_read_block(chip_info->client, 0xE9, 4, &(buf[0x0]));
+    reg_info->F55_SENSOR_QUERY_BASE = buf[0];
+    reg_info->F55_SENSOR_CMD_BASE   = buf[1];
+    reg_info->F55_SENSOR_CTRL_BASE  = buf[2];
+    reg_info->F55_SENSOR_DATA_BASE  = buf[3];
+    TPD_INFO("F55_SENSOR_QUERY_BASE  = 0x%x \n\
+            F55_SENSOR_CMD_BASE     = 0x%x \n\
+            F55_SENSOR_CTRL_BASE    = 0x%x \n\
+            F55_SENSOR_DATA_BASE    = 0x%x \n",
+            reg_info->F55_SENSOR_QUERY_BASE, reg_info->F55_SENSOR_CMD_BASE,
+            reg_info->F55_SENSOR_CTRL_BASE,  reg_info->F55_SENSOR_DATA_BASE);
+
+    reg_info->F55_SENSOR_CTRL43 = reg_info->F55_SENSOR_CTRL_BASE + 5;
+    reg_info->F55_SENSOR_CTRL01 = 0x01;      //rx  number
+    reg_info->F55_SENSOR_CTRL02 = 0x02;      //tx  number
+    // select page 0
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+/**
+* synaptics_get_fw_id -   get device fw id.
+* @chip_info: struct include i2c resource.
+* Return fw version result.
+*/
+static uint32_t synaptics_get_fw_id(struct chip_data_td4310 *chip_info)
+{
+    uint8_t buf[4];
+    uint32_t current_firmware = 0;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    current_firmware = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+    TPD_INFO("CURRENT_FIRMWARE_ID = 0x%x\n", current_firmware);
+
+    return current_firmware;
+}
+
+static fw_check_state synaptics_fw_check(void *chip_data, struct resolution_info *resolution_info, struct panel_info *panel_data)
+{
+    uint32_t bootloader_mode;
+    int max_y_ic = 0;
+    int max_x_ic = 0;
+    uint8_t buf[4];
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL08, 4, buf);
+    max_x_ic = ((buf[1] << 8) & 0xffff) | (buf[0] & 0xffff);
+    max_y_ic = ((buf[3] << 8) & 0xffff) | (buf[2] & 0xffff);
+    TPD_INFO("max_x = %d, max_y = %d, max_x_ic = %d, max_y_ic = %d\n", resolution_info->max_x, resolution_info->max_y, max_x_ic, max_y_ic);
+    if ((resolution_info->max_x == 0) ||(resolution_info->max_y == 0)) {
+        resolution_info->max_x = max_x_ic;
+        resolution_info->max_y = max_y_ic;
+    }
+
+    bootloader_mode = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    TPD_INFO("chip_info->reg_info.F01_RMI_DATA_BASE =  0x%x , bootloader_mode = 0x%x\n", chip_info->reg_info.F01_RMI_DATA_BASE, bootloader_mode);
+    bootloader_mode = bootloader_mode & 0xff;
+    bootloader_mode = bootloader_mode & 0x40;
+    TPD_INFO("%s, bootloader_mode = 0x%x\n", __func__, bootloader_mode);
+
+    if ((max_x_ic == 0) || (max_y_ic == 0) || (bootloader_mode == 0x40)) {
+        TPD_INFO("Something terrible wrong, Trying Update the Firmware again\n");
+        return FW_ABNORMAL;
+    }
+
+    //fw check normal need update TP_FW  && device info
+    panel_data->TP_FW = synaptics_get_fw_id(chip_info);
+    if (panel_data->manufacture_info.version)
+        sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+
+    return FW_NORMAL;
+}
+
+/**
+* synaptics_enable_interrupt -   Device interrupt ability control.
+* @chip_info: struct include i2c resource.
+* @enable: disable or enable control purpose.
+* Return  0: succeed, -1: failed.
+*/
+static int synaptics_enable_interrupt(struct chip_data_td4310 *chip_info, bool enable)
+{
+    int ret;
+    uint8_t abs_status_int;
+
+    TPD_INFO("%s enter, enable = %d.\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+    if (enable) {
+        abs_status_int = 0x7f;
+        /*clear interrupt bits for previous touch*/
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE + 1);
+        if (ret < 0) {
+            TPD_INFO("%s :clear interrupt bits failed\n", __func__);
+            return -1;
+        }
+    } else {
+        abs_status_int = 0x0;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00 + 1, abs_status_int);
+    if (ret < 0) {
+        TPD_INFO("%s: enable or disable abs interrupt failed, abs_int = %d\n", __func__, abs_status_int);
+        return -1;
+    }
+
+    return 0;
+}
+
+static u8 synaptics_trigger_reason(void *chip_data, int gesture_enable, int is_suspended)
+{
+    int ret = 0;
+    uint8_t device_status = 0;
+    uint8_t interrupt_status = 0;
+    u8 result_event = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+#ifdef CONFIG_SYNAPTIC_RED
+    if (chip_info->enable_remote)
+        return IRQ_IGNORE;
+#endif
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F01_RMI_DATA_BASE);
+    if (ret < 0) {
+        TPD_INFO("%s, i2c read error, ret = %d\n", __func__, ret);
+        return IRQ_EXCEPTION;
+    }
+    device_status = ret & 0xff;
+    interrupt_status = (ret & 0x7f00) >> 8;
+
+    if ((device_status & 0xC0) == 0x80) { /*unconfigured and not in flash mode*/
+        TPD_INFO("%s, IRQ_RESET ,interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+        return IRQ_FW_AUTO_RESET;
+    } else {
+        TPD_DEBUG("%s, interrupt_status = 0x%x, device_status = 0x%x\n", __func__, interrupt_status, device_status);
+    }
+    if (interrupt_status & 0x04) {
+        if ((gesture_enable == 1) && is_suspended) {
+            return IRQ_GESTURE;
+        }
+        SET_BIT(result_event, IRQ_TOUCH);
+    }
+    if (interrupt_status & 0x20) {
+        SET_BIT(result_event, IRQ_BTN_KEY);
+    }
+
+    return  result_event;
+}
+
+static int synaptics_resetgpio_set(struct hw_resource *hw_res, bool on)
+{
+    if (gpio_is_valid(hw_res->reset_gpio)) {
+        TPD_INFO("Set the reset_gpio \n");
+        gpio_direction_output(hw_res->reset_gpio, on);
+    }
+
+    return 0;
+}
+
+static void synaptics_exit_esd_mode(void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CMD_BASE, 0x04);
+    if (ret < 0) {
+        TPD_INFO("exit esd mode error\n");
+        return;
+    }
+    TPD_INFO("exit esd mode ok\n");
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+    }
+}
+
+
+/*
+* return success: 0 ; fail : negative
+*/
+static int synaptics_reset(void *chip_data)
+{
+    int ret = -1;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    TPD_INFO("%s.\n", __func__);
+    clear_view_touchdown_flag(); //clear touch download flag
+
+    tfa_mutex_lock(true);   //mutex avoid i2c transfer in tp reset process
+    synaptics_resetgpio_set(chip_info->hw_res, true); // reset gpio
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CMD_BASE, 0x01);   // reset register
+    if (ret < 0) {
+        TPD_INFO("%s error, ret = %d\n", __func__, ret);
+    }
+    msleep(RESET_TO_NORMAL_TIME);
+    tfa_mutex_lock(false);  //mutex avoid i2c transfer in tp reset process
+
+    //exit esd mode
+    synaptics_exit_esd_mode(chip_data);
+
+    return ret;
+}
+
+static int synaptics_configuration_init(struct chip_data_td4310 *chip_info, bool config)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, configuration init = %d\n", __func__, config);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0); // page 0
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    if (ret < 0) {
+        TPD_INFO("init_panel failed for page select\n");
+        return -1;
+    }
+
+    //device control: normal operation
+    if (config) {//configed  && out of sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x80);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    } else {//sleep mode
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, (ret & 0xf8) | 0x81);
+        if (ret < 0) {
+            TPD_INFO("%s failed for mode select\n", __func__);
+            return -1;
+        }
+    }
+
+    return ret;
+}
+
+static int synaptics_glove_mode_enable(struct chip_data_td4310 *chip_info, bool enable)
+{
+    int ret = 0;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_DEBUG("touch_i2c_write_byte failed for mode select\n");
+        return ret;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23);
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret | 0x20);
+    } else {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL23, ret & 0xdf);
+    }
+
+    return ret;
+}
+
+static int synaptics_enable_black_gesture(struct chip_data_td4310 *chip_info, bool enable)
+{
+    int ret;
+    unsigned char report_gesture_ctrl_buf[3];
+    unsigned char wakeup_gesture_enable_buf;
+
+    TPD_INFO("%s, enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    if (enable) {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x3);         //set doze interval to 30ms
+    } else  {
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL02, 0x1);         //set doze interval to 10ms
+    }
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    if (report_gesture_ctrl_buf[2] & 0x02) {
+        TPD_INFO("Gesture is open, can not set twice\n");
+        return 0;
+    }
+    if (enable) {
+        report_gesture_ctrl_buf[2] |= 0x02 ;
+    } else  {
+        report_gesture_ctrl_buf[2] &= 0xfd ;
+    }
+
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.F12_2D_CTRL20, 3, &(report_gesture_ctrl_buf[0x0]));
+    wakeup_gesture_enable_buf = 0xef;   // all kinds of gesture except triangle
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F12_2D_CTRL27, wakeup_gesture_enable_buf);
+
+    return 0;
+}
+
+static int synaptics_enable_edge_limit(struct chip_data_td4310 *chip_info, bool enable)
+{
+    int ret;
+
+    TPD_INFO("%s, edge limit enable = %d\n", __func__, enable);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);
+    if (ret < 0) {
+        TPD_INFO("%s: select page failed ret = %d\n", __func__, ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL);
+    TPD_INFO("%s, read value = 0x%x\n", __func__, ret);
+
+    if (enable) {
+        ret |= 0x01;
+    } else {
+        ret &= 0xfe;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL, ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_GRIP_CTRL);
+    TPD_INFO("%s %s, write back value = 0x%x\n", enable ? "enable" : "disable", __func__, ret);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    return ret;
+}
+
+static int synaptics_mode_switch(void *chip_data, work_mode mode, bool flag)
+{
+    int ret = -1;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    switch(mode) {
+        case MODE_NORMAL:
+            ret = synaptics_configuration_init(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+            ret = synaptics_enable_interrupt(chip_info, true);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_SLEEP:
+            msleep(100);
+            ret = synaptics_enable_interrupt(chip_info, false);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable interrupt failed.\n", __func__);
+                return ret;
+            }
+
+            /*device control: sleep mode*/
+            ret = synaptics_configuration_init(chip_info, false) ;
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics configuration init failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GESTURE:
+            ret = synaptics_enable_black_gesture(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable gesture failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_GLOVE:
+            ret = synaptics_glove_mode_enable(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable glove mode failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        case MODE_EDGE:
+            ret = synaptics_enable_edge_limit(chip_info, flag);
+            if (ret < 0) {
+                TPD_INFO("%s: synaptics enable edg limit failed.\n", __func__);
+                return ret;
+            }
+
+            break;
+
+        default:
+            TPD_INFO("%s: Wrong mode.\n", __func__);
+    }
+
+    return ret;
+}
+
+static int synaptics_get_gesture_info(void *chip_data, struct gesture_info * gesture)
+{
+    int ret = 0, i, gesture_sign, regswipe;
+    uint8_t gesture_buffer[10];
+    uint8_t coordinate_buf[25] = {0};
+    uint16_t trspoint = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    if (ret < 0) {
+        TPD_INFO("failed to transfer the data, ret = %d\n", ret);
+        return -1;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA04, 5, &(gesture_buffer[0]));
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    regswipe = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 0x18);
+
+    TPD_DEBUG("gesture_buffer[0] = 0x%x, regswipe = 0x%x, gesture_buffer[1] = 0x%x, gesture_buffer[4] = 0x%x\n",
+            gesture_buffer[0], regswipe, gesture_buffer[1], gesture_buffer[4]);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    gesture_sign = gesture_buffer[0];
+
+    //detect the gesture mode
+    switch (gesture_sign)
+    {
+        case DTAP_DETECT:
+            gesture->gesture_type = DouTap;
+            break;
+        case SWIPE_DETECT:
+            gesture->gesture_type = (regswipe == 0x41) ? Left2RightSwip   :
+                (regswipe == 0x42) ? Right2LeftSwip   :
+                (regswipe == 0x44) ? Up2DownSwip      :
+                (regswipe == 0x48) ? Down2UpSwip      :
+                (regswipe == 0x80) ? DouSwip          :
+                UnkownGesture;
+            break;
+        case CIRCLE_DETECT:
+            gesture->gesture_type = Circle;
+            break;
+        case VEE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x01) ? DownVee  :
+                (gesture_buffer[2] == 0x02) ? UpVee    :
+                (gesture_buffer[2] == 0x04) ? RightVee :
+                (gesture_buffer[2] == 0x08) ? LeftVee  :
+                UnkownGesture;
+            break;
+        case UNICODE_DETECT:
+            gesture->gesture_type = (gesture_buffer[2] == 0x77 && gesture_buffer[3] == 0x00) ? Wgestrue :
+                (gesture_buffer[2] == 0x6d && gesture_buffer[3] == 0x00) ? Mgestrue :
+                UnkownGesture;
+            break;
+        default:
+            gesture->gesture_type = UnkownGesture;
+    }
+    TPD_DETAIL("%s, gesture_sign = 0x%x, gesture_type = %d\n", __func__, gesture_sign, gesture->gesture_type);
+
+    if (gesture->gesture_type != UnkownGesture) {
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA,      8, &(coordinate_buf[0]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 8,  8, &(coordinate_buf[8]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 16, 8, &(coordinate_buf[16]));
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA + 24, 1, &(coordinate_buf[24]));
+        ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+        for (i = 0; i < 23; i += 2) {
+            trspoint = coordinate_buf[i]|coordinate_buf[i + 1] << 8;
+            TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n", i, trspoint);
+        }
+
+        TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n", coordinate_buf[24]);
+        gesture->Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8));
+        gesture->Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8));
+        gesture->Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8));
+        gesture->Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8));
+        gesture->Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8));
+        gesture->Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8));
+        gesture->Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8));
+        gesture->Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8));
+        gesture->Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8));
+        gesture->Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8));
+        gesture->Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8));
+        gesture->Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8));
+        gesture->clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+            (coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+    }
+
+    return 0;
+}
+
+static int synaptics_power_control(void *chip_data, bool enable)
+{
+    int ret = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (true == enable) {
+        ret = tp_powercontrol_2v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_1v8(chip_info->hw_res, true);
+        if (ret)
+            return -1;
+        synaptics_resetgpio_set(chip_info->hw_res, true);
+        msleep(RESET_TO_NORMAL_TIME);
+    } else {
+        ret = tp_powercontrol_1v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+        ret = tp_powercontrol_2v8(chip_info->hw_res, false);
+        if (ret)
+            return -1;
+    }
+
+    return ret;
+}
+
+static int checkCMD(struct chip_data_td4310 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    do {
+        msleep(30); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+    }while((ret > 0x00) && (flag_err < 60));
+    if (ret > 0x00)
+        TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    return ret;
+}
+
+static int checkCMD_for_finger(struct chip_data_td4310 *chip_info)
+{
+    int ret;
+    int flag_err = 0;
+
+    if (chip_info->p_spuri_fp_touch == NULL) {
+        TPD_INFO("checkCMD_for_finger() chip_info->p_spuri_fp_touch == NULL\n");
+        return -1;
+    }
+
+    do {
+        msleep(10); //wait 10ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE);
+        flag_err++;
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+    }while((ret > 0x00) && (flag_err < SPURIOUS_FP_BASE_DATA_RETRY));
+    TPD_INFO("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+
+    if (10 == flag_err) {
+        TPD_INFO("checkCMD_for_finger error,reset  then msleep(80)\n");
+        if (chip_info->p_spuri_fp_touch->lcd_trigger_fp_check && !chip_info->p_spuri_fp_touch->lcd_resume_ok) {
+            TPD_INFO("checkCMD_for_finger() lcd_resume_ok=%d ret=%d flag_err=%d line=%d\n",chip_info->p_spuri_fp_touch->lcd_resume_ok,ret,flag_err,__LINE__);
+            return -1;
+        }
+        synaptics_reset(chip_info);
+        msleep(80);
+        synaptics_mode_switch(chip_info, MODE_NORMAL, true);
+        return -1;
+    } else {
+        TPD_INFO("checkCMD_for_finger ok\n");
+        return 0;
+    }
+}
+
+static short find_median(short* pdata, int num)
+{
+    int i = 0, j = 0;
+    short temp = 0;
+    short *value = NULL;
+    short median = 0;
+
+    value = (short *)kzalloc( num * sizeof(short), GFP_KERNEL);
+    if (!value) {
+        TPD_INFO("%s: kzalloc space failed\n", __func__);
+        return median;
+    }
+
+    for (i = 0; i < num; i++)
+        *(value+i) = *(pdata+i);
+
+    //sorting
+    for ( i = 1; i <= num-1; i++)
+    {
+        for ( j = 1; j <= num-i; j++)
+        {
+            if (*(value + j - 1) <= *(value + j))
+            {
+            temp = *(value + j - 1);
+            *(value + j - 1)= *(value + j);
+            *(value + j) = temp;
+            }
+            else
+                continue ;
+        }
+    }
+
+    //calculation of median
+    if ( num % 2 == 0)
+        median = (*(value + (num/2 - 1)) + *(value + (num / 2))) / 2;
+    else
+        median = *(value + (num/2));
+
+    kfree(value);
+    return median;
+}
+
+static int tddi_ratio_calculation(signed short *p_image,  struct f55_control_43 *p_ctrl_43, int tx, int rx)
+{
+    int retval = 0;
+    int i, j;
+    uint32_t tx_num = (uint32_t)tx;
+    uint32_t rx_num = (uint32_t)rx;
+    unsigned char left_size = p_ctrl_43->afe_l_mux_size;
+    unsigned char right_size = p_ctrl_43->afe_r_mux_size;
+    signed short *p_data_16;
+    signed short *p_left_median = NULL;
+    signed short *p_right_median = NULL;
+    signed short *p_left_column_buf = NULL;
+    signed short *p_right_column_buf = NULL;
+    signed int temp;
+
+    if (!p_image) {
+        TPD_INFO("%s: Fail. p_image is null\n", __func__);
+        retval = -EINVAL;
+        goto exit;
+    }
+
+    // allocate the buffer for the median value in left/right half
+    p_right_median = (signed short *) kzalloc(rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_right_median) {
+        TPD_INFO("%s: Failed to alloc mem for p_right_median\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_left_median = (signed short *) kzalloc(rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_left_median) {
+        TPD_INFO("%s: Failed to alloc mem for p_left_median\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_right_column_buf = (signed short *) kzalloc(right_size * rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_right_column_buf ) {
+        TPD_INFO("%s: Failed to alloc mem for p_right_column_buf\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    p_left_column_buf = (signed short *) kzalloc(left_size * rx_num * sizeof(short), GFP_KERNEL);
+    if (!p_left_column_buf ) {
+        TPD_INFO("%s: Failed to alloc mem for p_left_column_buf\n", __func__);
+        retval = -ENOMEM;
+        goto exit;
+    }
+
+    // divide the input image into left/right parts
+    if (p_ctrl_43->swap_sensor_side) {
+
+        // first row is left side data
+        p_data_16 = p_image;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < left_size; j++) {
+                p_left_column_buf[i * left_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+        // right side data
+        p_data_16 = p_image + left_size * rx_num;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < right_size; j++) {
+                p_right_column_buf[i * right_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+    }
+    else {
+
+        // first row is right side data
+        p_data_16 = p_image;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < right_size; j++) {
+                p_right_column_buf[i * right_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+        // left side data
+        p_data_16 = p_image + right_size * rx_num;
+        for (i = 0; i < rx_num; i++) {
+            for (j = 0; j < left_size; j++) {
+                p_left_column_buf[i * left_size + j] = p_data_16[j * rx_num + i];
+            }
+        }
+    }
+
+    // find the median in every column
+    for (i = 0; i < rx_num; i++) {
+        p_left_median[i] = find_median(p_left_column_buf + i * left_size, left_size);
+        p_right_median[i] = find_median(p_right_column_buf + i * right_size, right_size);
+    }
+
+    // walk through the image of all data
+    // and calculate the ratio by using the median
+    for (i = 0; i < tx_num; i++) {
+        for (j = 0; j < rx_num; j++) {
+
+            // calcueate the ratio
+            if (p_ctrl_43->swap_sensor_side) {
+                // first row is left side
+                if (i < left_size) {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_left_median[j];
+                } else {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_right_median[j];
+                }
+            }
+            else {
+                // first row is right side
+                if (i < right_size) {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_right_median[j];
+                } else {
+                    temp = (signed int) p_image[i * rx_num + j];
+                    temp = temp * 100 / p_left_median[j];
+                }
+            }
+
+            // replace the original data with the calculated ratio
+            p_image[i * rx_num + j] = temp;
+        }
+    }
+
+exit:
+    kfree(p_right_median);
+    kfree(p_left_median);
+    kfree(p_right_column_buf);
+    kfree(p_left_column_buf);
+    return retval;
+}
+
+static void store_to_file(int fd, char* format, ...)
+{
+    va_list args;
+    char buf[64] = {0};
+
+    va_start(args, format);
+    vsnprintf(buf, 64, format, args);
+    va_end(args);
+
+    if(fd >= 0) {
+        sys_write(fd, buf, strlen(buf));
+    }
+}
+
+static void synaptics_black_screen_RT136_test(void *chip_data, char *message)
+{
+    int ret = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t baseline_data;
+    uint8_t x, y;
+    uint16_t z;
+    uint8_t tmp_arg1, tmp_arg2;
+    int error_count = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct i2c_client *client = chip_info->client;
+    int tx_num = chip_info->hw_res->TX_NUM;
+    int rx_num = chip_info->hw_res->RX_NUM;
+    char buf[128] = {0};
+
+    TPD_INFO("%s\n", __func__);
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    msleep(200);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 136);//select report type 136
+    if (ret < 0) {
+        error_count++;
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        sprintf(buf, "i2c write error\n");
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    raw_data = kzalloc(tx_num * rx_num * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        error_count++;
+        TPD_INFO("raw_data kzalloc error\n");
+        sprintf(buf, "Alloc memory failed\n");
+        goto END;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            tx_num * rx_num *2, raw_data);     //read data
+    for (x = 0; x < 2 ; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < rx_num; y++) {
+            z = rx_num * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            TPD_DEBUG_NTAG("%d, ", baseline_data);
+
+            if (baseline_data < RT136_GESTURE_DOZE_LOW || baseline_data > RT136_GESTURE_DOZE_HIGH) {
+                TPD_INFO("Synaptic:Gesture doze test failed, [%d][%d] = %d[%d %d]\n",
+                    x, y, baseline_data, RT136_GESTURE_DOZE_LOW, RT136_GESTURE_DOZE_HIGH);
+                if (!error_count) {
+                    sprintf(buf, "Gesture Doze:[%d][%d] = %d[%d %d]\n",
+                        x, y, baseline_data, RT136_GESTURE_DOZE_LOW, RT136_GESTURE_DOZE_HIGH);
+                }
+                error_count++;
+            }
+        }
+
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    kfree(raw_data);
+
+END:
+
+    sprintf(message, "%d errors. %s", error_count, buf);
+    TPD_INFO("%d errors. %s\n", error_count, buf);
+}
+
+static int synaptics_int_pin_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int eint_status, eint_count = 0, read_gpio_num = 10;
+
+    while(read_gpio_num--) {
+        msleep(5);
+        eint_status = gpio_get_value(syna_testdata->irq_gpio);
+        if (eint_status == 1)
+            eint_count--;
+        else
+            eint_count++;
+        TPD_INFO("%s eint_count = %d  eint_status = %d\n", __func__, eint_count, eint_status);
+    }
+    TPD_INFO("TP EINT PIN direct short! eint_count = %d\n", eint_count);
+    if (eint_count == 10) {
+        TPD_INFO("error :  TP EINT PIN direct short!\n");
+        seq_printf(s, "TP EINT direct stort\n");
+        store_to_file(syna_testdata->fd, "eint_status is low, TP EINT direct stort, \n");
+        eint_count = 0;
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_RT136_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t baseline_data;
+    uint8_t tmp_arg1, tmp_arg2;
+    uint8_t x, y;
+    uint16_t z;
+    int error_count = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct i2c_client *client = chip_info->client;
+
+    store_to_file(syna_testdata->fd, "RT136:\n");
+    TPD_INFO("\n step 2:test RT136\n");
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 136);//select report type 136
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        store_to_file(syna_testdata->fd, "I2C read error\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    for (x = 0; x < 2; x++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        TPD_INFO("checkCMD error, do not read RT136 test data\n");
+        seq_printf(s, "checkCMD error, do not read RT136 test data\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        return TEST_FAIL;
+    }
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        seq_printf(s, "RT136: failed to alloc memory\n");
+        store_to_file(syna_testdata->fd, "failed to alloc memory\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                store_to_file(syna_testdata->fd, "%d, ", baseline_data);
+            }
+
+            TPD_DEBUG_NTAG("%d, ", baseline_data);
+
+            if ((baseline_data < RT136_2D_LIMIT_LOW) || (baseline_data > RT136_2D_LIMIT_HIGH)) {
+                TPD_INFO("Synaptic:touchpanel failed, rt136[%d][%d] = %d\n", x, y, baseline_data);
+                if (!error_count) {
+                    seq_printf(s, "touchpanel failed, rt136[%d][%d] = %d\n", x, y, baseline_data);
+                }
+                error_count++;
+            }
+        }
+
+        TPD_DEBUG_NTAG("\n");
+
+        if (syna_testdata->fd >= 0) {
+            store_to_file(syna_testdata->fd, "\n");
+        }
+    }
+
+    if (syna_testdata->fd >= 0) {
+        store_to_file(syna_testdata->fd, "\n");
+    }
+    if (raw_data) {
+        kfree(raw_data);
+    }
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_RT3_doze_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    uint8_t *raw_data = NULL;
+    uint16_t baseline_data;
+    uint8_t x, y;
+    uint16_t z;
+    uint8_t tmp_arg1;
+    uint8_t tmp_arg2;
+    int error_count = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+    struct i2c_client *client = chip_info->client;
+
+    store_to_file(syna_testdata->fd, "\nRT3 Doze(2 lines):\n");
+
+    TPD_INFO("RT3: Force Doze Mode Test:\r\n");
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_CTRL225, 0x01); //Force Doze
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE); //force update
+    checkCMD(chip_info);
+
+    mdelay(1000); // Doze data update every 1s, make sure data updated
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 3); //select report type 3
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        store_to_file(syna_testdata->fd, "I2C read error\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    for (x = 0; x < 2; x++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        TPD_INFO("checkCMD error, do not read RT92_doze test data\n");
+        seq_printf(s, "checkCMD error, do not read RT92_doze test data\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        return TEST_FAIL;
+    }
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        seq_printf(s, "RT3: failed to alloc memory\n");
+        store_to_file(syna_testdata->fd, "failed to alloc memory\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);      //read data
+    for (x = 0; x < 2; x++) {
+        TPD_DEBUG_NTAG("[%d]: ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            if (syna_testdata->fd >= 0) {
+                store_to_file(syna_testdata->fd, "%d, ", baseline_data);
+            }
+
+            TPD_DEBUG_NTAG("%d, ", baseline_data);
+            if ((baseline_data < RT3_DOZE_LOW) || (baseline_data > RT3_DOZE_HIGH)){
+                TPD_INFO("RT3 doze test error, TxRx[%d][%d] = %d[%d, %d]\n",
+                            x, y, baseline_data, RT3_DOZE_LOW, RT3_DOZE_HIGH);
+                if (!error_count) {
+                    seq_printf(s, "RT3 doze test error, TxRx[%d][%d] = %d[%d, %d]\n",
+                            x, y, baseline_data, RT3_DOZE_LOW, RT3_DOZE_HIGH);
+                }
+                error_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+
+        if (syna_testdata->fd >= 0) {
+            store_to_file(syna_testdata->fd, "\n");
+        }
+    }
+
+    if (syna_testdata->fd >= 0) {
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    if (raw_data) {
+        kfree(raw_data);
+    }
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_open_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    int x, y, z;
+    uint8_t buffer[9];
+    uint8_t *raw_data = NULL, *raw_data_2 = NULL;
+    uint16_t baseline_data;
+    signed short *raw_data_delta_image = NULL;
+    uint8_t tmp_arg1, tmp_arg2;
+    int error_count = 0;
+    tp_dev tp_type = TP_UNKNOWN;
+    int open_limit_one, open_limit_two;
+    uint8_t open_dur_one, open_dur_two;
+
+    struct f54_control_91  original_f54_ctrl91;
+    struct f54_control_99  original_f54_ctrl99;
+    struct f54_control_182 original_f54_ctrl182;
+    struct f55_control_43  ctrl_43;
+
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    tp_type = chip_info->tp_type;
+
+    TPD_INFO("\n step 2 open test \n");
+    store_to_file(syna_testdata->fd, "Open Test:\n");
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL36, 0); // force to turn off esd mode
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    if (tp_type == TP_TIANMA) {
+        open_dur_one = ELEC_OPEN_INT_DUR_ONE_TIANMA;
+        open_dur_two = ELEC_OPEN_INT_DUR_TWO_TIANMA;
+        open_limit_one = ELEC_OPEN_TEST_LIMIT_ONE_TIANMA;
+        open_limit_two = ELEC_OPEN_TEST_LIMIT_TWO_TIANMA;
+    } else if (tp_type == TP_BOE) {
+        open_dur_one = ELEC_OPEN_INT_DUR_ONE_BOE;
+        open_dur_two = ELEC_OPEN_INT_DUR_TWO_BOE;
+        open_limit_one = ELEC_OPEN_TEST_LIMIT_ONE_BOE;
+        open_limit_two = ELEC_OPEN_TEST_LIMIT_TWO_BOE;
+    } else if (tp_type == TP_DSJM) {
+        open_dur_one = ELEC_OPEN_INT_DUR_ONE_DSJM;
+        open_dur_two = ELEC_OPEN_INT_DUR_TWO_DSJM;
+        open_limit_one = ELEC_OPEN_TEST_LIMIT_ONE_DSJM;
+        open_limit_two = ELEC_OPEN_TEST_LIMIT_TWO_DSJM;
+    } else if (tp_type == TP_JDI) {
+        open_dur_one = ELEC_OPEN_INT_DUR_ONE_JDI;
+        open_dur_two = ELEC_OPEN_INT_DUR_TWO_JDI;
+        open_limit_one = ELEC_OPEN_TEST_LIMIT_ONE_JDI;
+        open_limit_two = ELEC_OPEN_TEST_LIMIT_TWO_JDI;
+    }else if (tp_type == TP_TRULY) {
+        open_dur_one = ELEC_OPEN_INT_DUR_ONE_TRULY;
+        open_dur_two = ELEC_OPEN_INT_DUR_TWO_TRULY;
+        open_limit_one = ELEC_OPEN_TEST_LIMIT_ONE_TRULY;
+        open_limit_two = ELEC_OPEN_TEST_LIMIT_TWO_TRULY;
+    } else {
+        error_count++;
+        seq_printf(s, "Open Test:Invalid type\n");
+        store_to_file(syna_testdata->fd, "Invalid Type\n");
+        return error_count;
+    }
+
+    TPD_INFO("TP Type %u, Duration [One:%d, Two:%d], Limit [One:%d, Two:%d]\n",
+              (uint8_t)tp_type, open_dur_one, open_dur_two, open_limit_one, open_limit_two);
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    /* keep the original reference high/low capacitance */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl91\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl91");
+        return TEST_FAIL;
+    }
+    /* keep the original integration and reset duration */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl99\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl99");
+        return TEST_FAIL;
+    }
+    /* keep the original timing control */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Failed to read original data from f54_ctrl182\n");
+        store_to_file(syna_testdata->fd, "Failed to read Ctrl182");
+        return TEST_FAIL;
+    }
+
+    /* 1¡¢Wide refcap hi/ lo and feedback, Write 0x0F to F54_ANALOG_CTRL91 */
+    buffer[0] = 0x0f;
+    buffer[1] = 0x0f;
+    buffer[2] = 0x0f;
+    buffer[3] = original_f54_ctrl91.reference_receiver_feedback_capacitance;
+    buffer[4] = original_f54_ctrl91.gain_ctrl;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, 5, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL91 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL91 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl191");
+        return TEST_FAIL;
+    }
+
+    /* 2¡¢Increase RST_DUR to 1.53us, Write 0x5c to F54_ANALOG_CTRL99 */
+    buffer[0] = original_f54_ctrl99.integration_duration_lsb;
+    buffer[1] = original_f54_ctrl99.integration_duration_msb;
+    buffer[2] = 0x5c;
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL99 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL99 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl199");
+        return TEST_FAIL;
+    }
+
+    /* 3¡¢Write 0x02 to F54_ANALOG_CTRL182 (00)/00 and (00)/02 */
+    buffer[0] = ELEC_OPEN_TEST_TX_ON_COUNT;                 //cbc_timing_ctrl_tx_lsb
+    buffer[1] = (ELEC_OPEN_TEST_TX_ON_COUNT >> 8) & 0xff;   //cbc_timing_ctrl_tx_msb
+    buffer[2] = ELEC_OPEN_TEST_RX_ON_COUNT;                 //cbc_timing_ctrl_rx_lsb
+    buffer[3] = (ELEC_OPEN_TEST_RX_ON_COUNT >> 8) & 0xff;   //cbc_timing_ctrl_rx_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, 4, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test write F54_ANALOG_CTRL182 error\n");
+        seq_printf(s, "step 2 open test write F54_ANALOG_CTRL182 error\n");
+        store_to_file(syna_testdata->fd, "Failed to write Ctrl82");
+        return TEST_FAIL;
+    }
+
+    /* 4¡¢Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    buffer[0] = open_dur_one;                      //integration_duration_lsb
+    buffer[1] = (open_dur_one >> 8) & 0xff;        //integration_duration_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE error\n");
+        seq_printf(s, "step 2 open Change the INT_DUR as ELEC_OPEN_INT_DUR_ONE error\n");
+        store_to_file(syna_testdata->fd, "Failed to change OPEN INT\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    /* 5¡¢Capture raw capacitance (rt92) image 1 */
+    /* Run Report Type 92 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Capture raw capacitance (rt92) image 1 error\n");
+        seq_printf(s, "step 2 open test: Capture raw capacitance (rt92) image 1 error\n");
+        store_to_file(syna_testdata->fd, "Failed to capture raw rt92\n");
+        return TEST_FAIL;
+    }
+
+    raw_data = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("failed to alloc memory\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "no more memory\n");
+        return TEST_FAIL;
+    }
+
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    for (x = 0; x < 2; x++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        error_count++;
+        TPD_INFO("checkCMD error, do not read open test data\n");
+        seq_printf(s, "checkCMD error, do not open short test data\n");
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        goto RESTORE_CONFIG;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data);     //read data
+
+    /* 6¡¢Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO */
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    buffer[0] = open_dur_two;                      //integration_duration_lsb
+    buffer[1] = (open_dur_two >> 8) & 0xff;        //integration_duration_msb
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, 3, buffer);
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO  error\n");
+        seq_printf(s, "step 2 open test: Change the INT_DUR into ELEC_OPEN_INT_DUR_TWO  error\n");
+        store_to_file(syna_testdata->fd, "failed to Change Int\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    /* 7¡¢Capture raw capacitance (rt92) image 2 */
+    /* Run Report Type 92 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 92);//select report type 92
+    if (ret < 0) {
+        TPD_INFO("step 2 open test: Capture raw capacitance (rt92) image 2 error\n");
+        seq_printf(s, "step 2 open test: Capture raw capacitance (rt92) image 2 error\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    raw_data_2 = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data_2) {
+        TPD_INFO("failed to alloc memory\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "No more memory\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    raw_data_delta_image = kzalloc(syna_testdata->TX_NUM * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!raw_data_delta_image) {
+        TPD_INFO("raw_data_delta_image kzalloc error\n");
+        seq_printf(s, "failed to alloc memory");
+        store_to_file(syna_testdata->fd, "No more memory\n");
+        error_count++;
+        goto RESTORE_CONFIG;
+    }
+
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    for (x = 0; x < 2; x++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        error_count++;
+        TPD_INFO("checkCMD error, do not read open test data\n");
+        seq_printf(s, "checkCMD error, do not read open test data\n");
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        goto RESTORE_CONFIG;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3,
+                            syna_testdata->TX_NUM*syna_testdata->RX_NUM*2, raw_data_2);     //read data
+
+    /* 8¡¢generate the delta image, which is equeal to image2 - image1 */
+    /* unit is femtofarad (fF) */
+    TPD_DEBUG_NTAG("----------- delta data ---------- \n ");
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = raw_data[z*2] & 0xff;
+            tmp_arg2 = raw_data[z*2 + 1] & 0xff;
+            baseline_data = (tmp_arg2 << 8) | tmp_arg1;
+
+            TPD_DEBUG_NTAG("%4d ", baseline_data);
+
+            tmp_arg1 = raw_data_2[z*2] & 0xff;
+            tmp_arg2 = raw_data_2[z*2 + 1] & 0xff;
+            raw_data_delta_image[z] = ((tmp_arg2 << 8) | tmp_arg1) - baseline_data;
+            TPD_DEBUG_NTAG("%4d ", raw_data_delta_image[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    /* 9¡¢restore the original configuration */
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl91\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl99\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl182\n",__func__);
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    store_to_file(syna_testdata->fd, "Open Test Limit 1:\n");
+
+    /* 10¡¢phase 1, data verification */
+    /* the delta value should be lower than the test limit */
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", raw_data_delta_image[x * syna_testdata->RX_NUM + y]);
+            if (raw_data_delta_image[x * syna_testdata->RX_NUM + y] < open_limit_one) {
+                TPD_INFO("step 2 open test: (%2d,%2d) = %4d < ELEC_OPEN_TEST_LIMIT_ONE(%d) fail\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], open_limit_one);
+                if (!error_count) {
+                    seq_printf(s, "Open One:(%2d,%2d) = %4d Limit:%d\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], open_limit_one);
+                }
+                error_count++;
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    /* 11¡¢phase 2, data calculation and verification */
+    /* the calculated ratio should be lower than the test limit */
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x03);    // page 3
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        if (raw_data)
+            kfree(raw_data);
+        if (raw_data_2)
+            kfree(raw_data_2);
+        if (raw_data_delta_image)
+            kfree(raw_data_delta_image);
+        return TEST_FAIL;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL43, sizeof(ctrl_43), ctrl_43.data);     //read data
+    synaptics_read_F54_base_reg(chip_info);
+    tddi_ratio_calculation(raw_data_delta_image, &ctrl_43, syna_testdata->TX_NUM, syna_testdata->RX_NUM);
+
+    store_to_file(syna_testdata->fd, "Open Test Limit 2:\n");
+
+    for (x = 0; x < syna_testdata->TX_NUM; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", raw_data_delta_image[x * syna_testdata->RX_NUM + y]);
+            if (raw_data_delta_image[x * syna_testdata->RX_NUM + y] < open_limit_two) {
+                TPD_INFO("step 2 open test: (%2d,%2d) = %4d < ELEC_OPEN_TEST_LIMIT_TWO(%d) fail\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], open_limit_two);
+                if (!error_count) {
+                    seq_printf(s, "Open Two:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, raw_data_delta_image[x * syna_testdata->RX_NUM + y], open_limit_two);
+                }
+                error_count++;
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    store_to_file(syna_testdata->fd, "\n");
+
+RESTORE_CONFIG:
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL91, sizeof(original_f54_ctrl91.data), original_f54_ctrl91.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl91\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL99, sizeof(original_f54_ctrl99.data), original_f54_ctrl99.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl99\n",__func__);
+    }
+
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL182, sizeof(original_f54_ctrl182.data), original_f54_ctrl182.data);
+    if (ret < 0) {
+        TPD_INFO("%s: Failed to read original data from f54_ctrl182\n",__func__);
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+    checkCMD(chip_info);
+
+    if (raw_data)
+        kfree(raw_data);
+    if (raw_data_2)
+        kfree(raw_data_2);
+    if (raw_data_delta_image)
+        kfree(raw_data_delta_image);
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+    return TEST_PASS;
+}
+
+static int synaptics_tddi_short_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int ret = 0;
+    int x, y, z;
+    //uint8_t buffer[9];
+    uint8_t tmp_arg1, tmp_arg2;
+    int tx_2d_num = syna_testdata->TX_NUM;
+    unsigned int buffer_size = tx_2d_num * syna_testdata->RX_NUM * 2;
+    uint8_t *tddi_rt95_raw_data = NULL;
+    signed short *tddi_rt95_part_one = NULL;
+    signed short *tddi_rt95_part_two = NULL;
+    int error_count = 0;
+
+    struct f55_control_43  ctrl_43;
+
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    struct i2c_client *client = chip_info->client;
+    struct synaptics_register *reg_info = &chip_info->reg_info;
+
+    store_to_file(syna_testdata->fd, "Short Test:\n");
+
+    TPD_INFO("Short Test:\n");
+    synaptics_read_F54_base_reg(chip_info);
+
+    tddi_rt95_raw_data = kzalloc(2 * tx_2d_num * syna_testdata->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!tddi_rt95_raw_data) {
+        TPD_INFO("tddi_rt95_raw_data kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    tddi_rt95_part_one = kzalloc(tx_2d_num * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!tddi_rt95_part_one) {
+        TPD_INFO("tddi_rt95_part_one kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    tddi_rt95_part_two = kzalloc(tx_2d_num * syna_testdata->RX_NUM * sizeof(signed short), GFP_KERNEL);
+    if (!tddi_rt95_part_two) {
+        TPD_INFO("tddi_rt95_part_two kzalloc error\n");
+        error_count++;
+        goto END;
+    }
+
+    ret = touch_i2c_write_word(client, reg_info->F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+
+    /* 3¡¢get report type 95 */
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_DATA_BASE, 95);//select report type 95
+    if (ret < 0) {
+        TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+        error_count++;
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    ret = touch_i2c_write_byte(client, reg_info->F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    for (x = 0; x < 2; x++) {
+        ret = checkCMD(chip_info);
+        if (ret == 0) {
+            break;
+        }
+    }
+    if (ret > 0) {
+        error_count++;
+        TPD_INFO("checkCMD error, do not read short test data\n");
+        seq_printf(s, "checkCMD error, do not read short test data\n");
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x00);//select report type 0x00
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report 1
+        seq_printf(s, "write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1,recovery tp touch\n");
+        TPD_INFO("write F54_ANALOG_DATA_BASE=0, F54_ANALOG_COMMAND_BASE=1, recovery tp touch\n");
+        goto END;
+    }
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3,
+                                2 * tx_2d_num*syna_testdata->RX_NUM * 2, tddi_rt95_raw_data);     //read data
+
+    /* 4¡¢use the upper half as part 1 image */
+    /* the data should be lower than TEST_LIMIT_PART1 ( fail, if > TEST_LIMIT_PART1 ) */
+    TPD_DEBUG_NTAG("----------- step 3 short test : rt95 part 1 value ---------- \n ");
+    for (x = 0; x < tx_2d_num; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = tddi_rt95_raw_data[z*2] & 0xff;
+            tmp_arg2 = tddi_rt95_raw_data[z*2 + 1] & 0xff;
+            tddi_rt95_part_one[z] = ((tmp_arg2 << 8) | tmp_arg1);
+            TPD_DEBUG_NTAG("%4d ", tddi_rt95_part_one[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    store_to_file(syna_testdata->fd, "Short Test Limit 1:\n");
+    for (x = 0; x < tx_2d_num; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", tddi_rt95_part_one[x * syna_testdata->RX_NUM + y]);
+            if (tddi_rt95_part_one[x*syna_testdata->RX_NUM + y] > EXTEND_EE_SHORT_TEST_LIMIT_PART1) {
+                TPD_INFO("step 3 short test : (%2d,%2d) = %4d > EXTEND_EE_SHORT_TEST_LIMIT_PART1(%d) fail\n",
+                        x, y, tddi_rt95_part_one[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART1);
+                if (!error_count) {
+                    seq_printf(s, "Short One:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, tddi_rt95_part_one[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART1);
+                }
+                error_count++;
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+    /* 5¡¢use the lower half as part 2 image */
+    /* and perform the calculation */
+    /* the calculated data should be over than TEST_LIMIT_PART2 ( fail, if < TEST_LIMIT_PART2 ) */
+    TPD_DEBUG_NTAG("----------- step 3 short test : rt95 part 2 value ---------- \n ");
+    for (x = 0; x < tx_2d_num; x++) {
+        TPD_DEBUG_NTAG("[%2d] ", x);
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            z = syna_testdata->RX_NUM * x + y;
+            tmp_arg1 = tddi_rt95_raw_data[buffer_size + z*2] & 0xff;
+            tmp_arg2 = tddi_rt95_raw_data[buffer_size + z*2 + 1] & 0xff;
+            tddi_rt95_part_two[syna_testdata->RX_NUM * x + y] = ((tmp_arg2 << 8) | tmp_arg1);
+            TPD_DEBUG_NTAG("%4d ", tddi_rt95_part_two[z]);
+        }
+        TPD_DEBUG_NTAG("\n");
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x03);    // page 3
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        error_count++;
+        goto END;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F55_SENSOR_CTRL43, sizeof(ctrl_43), ctrl_43.data); //read data
+    synaptics_read_F54_base_reg(chip_info);
+    tddi_ratio_calculation(tddi_rt95_part_two, &ctrl_43, tx_2d_num, syna_testdata->RX_NUM);
+
+    store_to_file(syna_testdata->fd, "Short Test Limit 2:\n");
+
+    for (x = 0; x < tx_2d_num; x++) {
+        for (y = 0; y < syna_testdata->RX_NUM; y++) {
+            store_to_file(syna_testdata->fd, "%d, ", tddi_rt95_part_two[x * syna_testdata->RX_NUM + y]);
+            if (tddi_rt95_part_two[x * syna_testdata->RX_NUM + y] < EXTEND_EE_SHORT_TEST_LIMIT_PART2) {
+                TPD_INFO("step 3 short test : (%2d,%2d) = %4d < EXTEND_EE_SHORT_TEST_LIMIT_PART2(%d) fail\n",
+                        x, y, tddi_rt95_part_two[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART2);
+                if (!error_count) {
+                    seq_printf(s, "Short Two:(%2d,%2d)=%4d Limit:%d\n",
+                        x, y, tddi_rt95_part_two[x * syna_testdata->RX_NUM + y], EXTEND_EE_SHORT_TEST_LIMIT_PART2);
+                }
+                error_count++;
+            }
+        }
+        store_to_file(syna_testdata->fd, "\n");
+    }
+
+END:
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+
+    if (tddi_rt95_raw_data)
+        kfree(tddi_rt95_raw_data);
+    if (tddi_rt95_part_one)
+        kfree(tddi_rt95_part_one);
+    if (tddi_rt95_part_two)
+        kfree(tddi_rt95_part_two);
+
+    if (error_count) {
+        return TEST_FAIL;
+    }
+
+    return TEST_PASS;
+}
+
+static void synaptics_auto_test(struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata)
+{
+    int error_count = 0;
+    int ret = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    ret = synaptics_enable_interrupt(chip_info, false);
+
+    error_count += synaptics_int_pin_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_RT136_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_open_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_short_test(s, chip_data, syna_testdata);
+    error_count += synaptics_tddi_RT3_doze_test(s, chip_data, syna_testdata); // test latest
+
+    seq_printf(s, "FW:0x%llx\n", syna_testdata->TP_FW);
+    seq_printf(s, "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+    TPD_INFO(" TP auto test %d error(s). %s\n", error_count, error_count?"":"All test passed.");
+}
+
+static void synaptics_baseline_blackscreen_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    uint16_t baseline_data = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (!chip_info)
+        return;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        return;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 136);//select report type 136
+    if (ret < 0) {
+        TPD_INFO("read_baseline: touch_i2c_write_byte failed \n");
+        seq_printf(s, "read_baseline: touch_i2c_write_byte failed \n");
+        goto END;
+    }
+
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+    checkCMD(chip_info);
+    TPD_DEBUG("Force Cal oK\n");
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    checkCMD(chip_info);
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                            chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+
+    for (x = 0; x < 2; x++) {
+        seq_printf(s, "[%2d] ", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            z = chip_info->hw_res->RX_NUM * x + y;
+            baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            seq_printf(s, "%4d, ", baseline_data);
+        }
+        seq_printf(s, "\n");
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+END:
+    kfree(raw_data);
+    return;
+}
+
+static void synaptics_baseline_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    int x = 0, y = 0, z = 0;
+    int i = 0;
+    uint16_t baseline_data = 0;
+    uint8_t *raw_data = NULL;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    int tx_num;
+    int type = 0;
+
+    if (!chip_info)
+        return ;
+
+    raw_data = kzalloc(chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+        TPD_INFO("raw_data kzalloc error\n");
+        return;
+    }
+
+    synaptics_read_F54_base_reg(chip_info);
+
+    for (i = 0; i < 2; i++) {
+        if (i == 0) {
+            seq_printf(s, "\nRT92 data:\n");
+            tx_num = chip_info->hw_res->TX_NUM;
+            type = 92;
+        } else if (i == 1) {
+            seq_printf(s, "\nRT3 doze data:\n");
+            TPD_INFO("Force Doze Mode:\n");
+            tx_num = 2;
+            ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x01);
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_CTRL225, 0x01);//Force Doze
+            ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, COMMAND_FORCE_UPDATE);//force update
+            checkCMD(chip_info);
+            type = 3;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, type);//select report
+        if (ret < 0) {
+            TPD_INFO("[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            seq_printf(s, "[line:%d]read_baseline: touch_i2c_write_byte failed \n",__LINE__);
+            goto END;
+        }
+
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+        checkCMD(chip_info);
+        TPD_DEBUG("Force Cal oK\n");
+        ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+        ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+        ret = checkCMD(chip_info);
+        if (ret > 0)
+            goto END;
+
+        ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+3,
+                                chip_info->hw_res->TX_NUM * chip_info->hw_res->RX_NUM * 2, raw_data);     //read data
+
+        for (x = 0; x < tx_num; x++) {
+            seq_printf(s, "[%2d] ", x);
+            for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+                z = chip_info->hw_res->RX_NUM * x + y;
+                baseline_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+                TPD_DEBUG("%d \n", baseline_data);
+                seq_printf(s, "%4d, ", baseline_data);
+            }
+            seq_printf(s, "\n");
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+
+END:
+    kfree(raw_data);
+    return;
+}
+
+static void synaptics_delta_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0, x = 0, y = 0;
+    uint8_t tmp_l = 0, tmp_h = 0;
+    int16_t temp_delta = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    seq_printf(s, "TD4310 Type:%d FW:0x%8x\n", chip_info->tp_type, synaptics_get_fw_id(chip_info)); // add fw info and type
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    //TPD_DEBUG("\nstep 2:report type2 delta image\n");
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+    ret = touch_i2c_write_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 1, 0x00);//set fifo 00
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+    ret = checkCMD(chip_info);
+
+    if (ret > 0) {
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0);
+        seq_printf(s, "checkCMD error, can not read delta data\n");
+        TPD_INFO("checkCMD error, can not read delta data\n");
+        goto OUT;
+    }
+
+    for (x = 0; x < chip_info->hw_res->TX_NUM; x++) {
+        //TPD_INFO("\n[%d]", x);
+        seq_printf(s, "\n[%2d]", x);
+        for (y = 0; y < chip_info->hw_res->RX_NUM; y++) {
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_l = ret & 0xff;
+            ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3);
+            tmp_h = ret & 0xff;
+            temp_delta = (tmp_h << 8) | tmp_l;
+            seq_printf(s, "%4d, ", temp_delta);
+        }
+    }
+    seq_printf(s, "\n");
+    //ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x02);//force cal
+
+OUT:
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x00);    // page 0
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+    }
+
+    msleep(10);
+}
+
+static void synaptics_main_register_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    char buf[8];
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (!chip_info)
+        return ;
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    seq_printf(s, "====================================================\n");
+
+    ret = touch_i2c_read_word(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA06);
+    seq_printf(s, "Interference Metric: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA10);
+    seq_printf(s, "Current Noise State: 0x%x\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA17);
+    seq_printf(s, "Sense Frequency Selection: 0x%x\n", ret);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        seq_printf(s, "%s: failed for page select\n", __func__);
+        return;
+    }
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F12_2D_DATA_BASE, 8, buf);
+    if (ret < 0) {
+        seq_printf(s, "touch_i2c_read_block error z = 0x%x\n", buf[5]);
+    }else {
+        seq_printf(s, "touch_i2c_read_block ok    z = 0x%x\n", buf[5]);
+    }
+    msleep(10);
+}
+
+//Reserved node
+static void synaptics_reserve_read(struct seq_file *s, void *chip_data)
+{
+    int ret = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (!chip_info)
+        return ;
+
+    //1.get firmware doze mode info
+    TPD_INFO("1.get firmware doze mode info\n");
+    seq_printf(s, "1.get firmware doze mode info\n");
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x04);    // page 4
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL36);
+    TPD_INFO("TP ps status is %d\n", ret);
+    seq_printf(s, "TP ps status is %d\n", ret);
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_DATA57);
+    TPD_INFO("TP esd status is %d\n", ret & 0x01);
+    seq_printf(s, "TP esd status is %d\n", ret & 0x01);
+
+    msleep(10);
+
+    /*disable irq when read data from IC*/
+    synaptics_read_F54_base_reg(chip_info);
+
+    msleep(10);
+}
+
+
+static int checkFlashState(struct chip_data_td4310 *chip_info)
+{
+    int ret ;
+    int count = 0;
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+    while ((ret != 0x80) && (count < 8)) {
+        msleep(3); //wait 3ms
+        ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl + 1);
+        count++;
+    }
+
+    if (count == 8)
+        return 1;
+    else
+        return 0;
+}
+
+/**
+* re_scan_PDT -   rescan && init F34  base addr.
+* @chip_info: struct include i2c resource.
+* Return NULL.
+*/
+static void re_scan_PDT(struct chip_data_td4310 *chip_info)
+{
+    uint8_t buf[8];
+
+    touch_i2c_read_block(chip_info->client, 0xE9, 6, buf);
+    chip_info->reg_info.F34_FLASH_DATA_BASE = buf[3];
+    chip_info->reg_info.F34_FLASH_QUERY_BASE = buf[0];
+    touch_i2c_read_block(chip_info->client, 0xE3, 6, buf);
+    chip_info->reg_info.F01_RMI_DATA_BASE = buf[3];
+    chip_info->reg_info.F01_RMI_CMD_BASE = buf[1];
+    touch_i2c_read_block(chip_info->client, 0xDD, 6, buf);
+
+    chip_info->reg_info.SynaF34Reflash_BlockNum    = chip_info->reg_info.F34_FLASH_DATA_BASE;
+    chip_info->reg_info.SynaF34Reflash_BlockData   = chip_info->reg_info.F34_FLASH_DATA_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_BootID = chip_info->reg_info.F34_FLASH_QUERY_BASE;
+    chip_info->reg_info.SynaF34ReflashQuery_FlashPropertyQuery = chip_info->reg_info.F34_FLASH_QUERY_BASE + 1;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize  = chip_info->reg_info.F34_FLASH_QUERY_BASE + 2;
+    chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockCount = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockSize    = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+    chip_info->reg_info.SynaF34ReflashQuery_ConfigBlockCount   = chip_info->reg_info.F34_FLASH_QUERY_BASE + 3;
+
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+    TPD_DEBUG("SynaFirmwareBlockSize is %d\n", (buf[0] | (buf[1] << 8)));
+    chip_info->reg_info.SynaF34_FlashControl = chip_info->reg_info.F34_FLASH_DATA_BASE + 2;
+}
+
+static fw_update_state synaptics_fw_update(void *chip_data, const struct firmware *fw, bool force)
+{
+    int ret, j;
+    uint8_t buf[8];
+    uint8_t bootloder_id[10];
+    uint16_t block, firmware, configuration, disp_configuration;
+    uint32_t CURRENT_FIRMWARE_ID = 0, FIRMWARE_ID = 0;
+    const uint8_t *Config_Data = NULL;
+    const uint8_t *Disp_Config_Data = NULL;
+    const uint8_t *Firmware_Data = NULL;
+    struct image_header_data header;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    if (!chip_info) {
+        TPD_INFO("Chip info is NULL\n");
+        return 0;
+    }
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step 1:fill Fw related header, get all data.
+    synaptics_parse_header(&header, fw->data);
+    if ((header.firmware_size + header.config_size + 0x100 + header.disp_config_size) > (uint32_t)fw->size) {
+        TPD_INFO("firmware_size + config_size + 0x100 > data_len data_len = %d \n", (uint32_t)fw->size);
+        return FW_NO_NEED_UPDATE;
+    }
+    Firmware_Data = fw->data + 0x100 + header.bootloader_size;
+    Config_Data = Firmware_Data + header.firmware_size;
+    Disp_Config_Data = fw->data + header.disp_config_offset;
+
+    //step 2:Get FW version from IC && determine whether we need get into update flow.
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F34_FLASH_CTRL_BASE, 4, buf);
+    CURRENT_FIRMWARE_ID = (buf[0] << 24)|(buf[1] << 16)|(buf[2] << 8)|buf[3];
+    FIRMWARE_ID = (Config_Data[0] << 24)|(Config_Data[1] << 16)|(Config_Data[2] << 8)|Config_Data[3];
+    TPD_INFO("CURRENT TP FIRMWARE ID is 0x%x, FIRMWARE IMAGE ID is 0x%x\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID);
+
+    if (!force) {
+        if (CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+            return FW_NO_NEED_UPDATE;
+        }
+    }
+
+    //step 3:init needed params
+    re_scan_PDT(chip_info);
+    block = 256;
+    TPD_DEBUG("block is %d \n", block);
+    firmware = header.firmware_size / block;
+    TPD_DEBUG("firmware is %d \n", firmware);
+    configuration = header.config_size / block;
+    TPD_DEBUG("configuration is %d \n", configuration);
+    disp_configuration = header.disp_config_size / block;
+    TPD_DEBUG("disp_configuration is %d \n", disp_configuration);
+
+    //step 3:Get into program mode
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+    TPD_DEBUG("bootloader id is %x \n", (bootloder_id[1] << 8)|bootloder_id[0]);
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n", chip_info->reg_info.SynaF34_FlashControl, ret);
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x0F);
+    msleep(10);
+    TPD_DEBUG("attn step 4\n");
+    ret = checkFlashState(chip_info);
+    if (ret > 0) {
+        TPD_INFO("Get in prog:The status(Image) of flashstate is %x\n", ret);
+        return FW_UPDATE_ERROR;
+    }
+    ret = touch_i2c_read_byte(chip_info->client, 0x04);
+    TPD_DEBUG("The status(device state) is %x\n", ret);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE);
+    TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n", ret);
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL_BASE, ret&0x04);
+
+    /********************get into prog end************/
+    ret = touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+    TPD_DEBUG("ret is %d\n", ret);
+    re_scan_PDT(chip_info);
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.SynaF34ReflashQuery_BootID, 2, buf);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, 2, buf);
+
+#ifdef UPDATE_DISPLAY_CONFIG
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x03); //erase flash except display config  ,0x03 erase all flash
+#else
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x22); //erase flash except display config  ,0x03 erase all flash
+#endif
+    msleep(2000);
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl);
+    TPD_DEBUG("going to flash firmware area synaF34_FlashControl %d\n", ret);
+
+    //step 4:flash firmware zone
+    TPD_INFO("update-----------------firmware ------------------update!\n");
+    TPD_DEBUG("cnt %d\n", firmware);
+
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0 & 0x00ff;
+    buf[1] = (0 & 0xff00) >> 8;
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    for (j = 0; j < firmware; j++) {
+
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Firmware_Data[j*block]);
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x02);
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Firmware:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+    //step 5:flash configure data
+    //TPD_INFO("going to flash configuration area\n");
+    //TPD_INFO("header.firmware_size is 0x%x\n", header.firmware_size);
+    //TPD_INFO("bootloader_size is 0x%x\n", bootloader_size);
+    TPD_INFO("update-----------------configuration ------------------update!\n");
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0 & 0x00ff;
+    buf[1] = (0 & 0xff00) >> 8;
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    for (j = 0; j < configuration; j++) {
+
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Config_Data[j*block]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+
+#ifdef UPDATE_DISPLAY_CONFIG
+    TPD_INFO("update-----------------display_configuration ------------------update!\n");
+    //a)write SynaF34Reflash_BlockNum to access
+    buf[0] = 0;
+    buf[1] = 0x60;//high 3 bit configuration area select
+    TPD_INFO("---------------- buf[0]=0x%x  buf[1]=0x%x \n",buf[0],buf[1]);
+    touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockNum, 2, buf);
+
+    TPD_INFO("---------------- Disp_Config_Data ---------------------- \n");
+    for(j = 0; j < 16 ; j++)
+        printk("0x%x  ", Disp_Config_Data[j]);
+    TPD_INFO("-------------------------------------- \n");
+
+    for (j = 0; j < disp_configuration; j++) {
+        //b) write data
+        touch_i2c_write_block(chip_info->client, chip_info->reg_info.SynaF34Reflash_BlockData, block, &Disp_Config_Data[j*block]);
+        //c) issue write
+        touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x06);
+        //d) wait attn
+        ret = checkFlashState(chip_info);
+        if (ret > 0) {
+            TPD_INFO("Disp_Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+            return FW_UPDATE_ERROR;
+        }
+    }
+    TPD_INFO("Disp_Configuration:The status(Image) of flash data3 is %x, time = %d\n", ret, j);
+#endif
+
+    TPD_INFO("Firmware && configuration flash over\n");
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.SynaF34_FlashControl, 0x00);
+    msleep(100);
+
+    synaptics_reset(chip_info);
+    msleep(200);
+
+    return FW_UPDATE_SUCCESS;
+}
+
+static fp_touch_state synaptics_spurious_fp_check(void *chip_data)
+{
+    int x = 0, y = 0, z = 0, err_count = 0;
+    int ret = 0, TX_NUM = 0, RX_NUM = 0;
+    int16_t temp_data = 0, delta_data = 0;
+    uint8_t *raw_data = NULL;
+    fp_touch_state fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    TPD_INFO(" synaptics_spurious_fp_check  start\n");
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return FINGER_PROTECT_NOTREADY ;
+    }
+
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+        return fp_touch_state;
+    }
+    TX_NUM = chip_info->hw_res->TX_NUM;
+    RX_NUM = chip_info->hw_res->RX_NUM;
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        return fp_touch_state;
+    }
+
+    ret = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00);
+    ret = (ret & 0xF8) | 0x80;
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F01_RMI_CTRL00, ret);   //exit sleep
+    msleep(1);
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 124
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        return FINGER_PROTECT_TOUCH_DOWN;
+    }
+
+    fp_touch_state = FINGER_PROTECT_TOUCH_UP;
+
+    raw_data = kzalloc(1800 ,GFP_KERNEL);
+    if (raw_data == NULL) {
+        TPD_INFO("Failed: no more memory\n");
+        return fp_touch_state;
+    }
+    touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, TX_NUM * SPURIOUS_FP_RX_NUM * 2, raw_data); //read baseline data
+    for (x = 1; x < TX_NUM - 2; x++) {
+        TPD_DEBUG_NTAG("[%2d]: ", x);
+        for (y = 1; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            temp_data = (raw_data[z * 2 + 1] << 8) | raw_data[z * 2];
+            delta_data = temp_data - chip_info->spuri_fp_data[z];
+            TPD_DEBUG_NTAG("%4d, ", delta_data);
+            if (delta_data > SPURIOUS_FP_LIMIT) {
+                if (!tp_debug)
+                    TPD_INFO("delta_data too large, delta_data = %d TX[%d] RX[%d]\n", delta_data, x, y);
+                err_count++;
+            }
+        }
+        TPD_DEBUG_NTAG("\n");
+        if(err_count > 2) {
+            fp_touch_state = FINGER_PROTECT_TOUCH_DOWN;
+            err_count = 0;
+            if (!tp_debug) {
+                TPD_INFO("finger protect trigger!report_finger_protect = %d\n", fp_touch_state);
+                break;
+            }
+        }
+    }
+
+    TPD_INFO("%s:%d chip_info->reg_info.F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,__LINE__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error,line=%d\n", __func__,__LINE__);
+    }
+
+    TPD_INFO("finger protect trigger fp_touch_state= %d\n", fp_touch_state);
+
+    kfree(raw_data);
+    return fp_touch_state;
+}
+
+static u8 synaptics_get_keycode(void *chip_data)
+{
+    int ret = 0;
+    u8 bitmap_result = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x03);
+    ret = touch_i2c_read_byte(chip_info->client, 0x00);
+    TPD_INFO("touch key int_key code = %d\n",ret);
+
+    if (ret & 0x01)
+        SET_BIT(bitmap_result, BIT_MENU);
+    if (ret & 0x02)
+        SET_BIT(bitmap_result, BIT_BACK);
+
+    touch_i2c_write_byte(chip_info->client, 0xff, 0x00);
+    return bitmap_result;
+}
+
+static void synaptics_finger_proctect_data_get(void * chip_data)
+{
+    int ret = 0, x = 0, y = 0, z = 0;
+    uint8_t *raw_data = NULL;
+    static uint8_t retry_time = 3;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+
+    int TX_NUM = chip_info->hw_res->TX_NUM;
+    int RX_NUM = chip_info->hw_res->RX_NUM;
+
+    if(TX_NUM*RX_NUM*(sizeof(int16_t)) > 1800){
+        TPD_INFO("%s,TX_NUM*RX_NUM*(sizeof(int16_t)>1800,There is not enough space\n", __func__);
+        return;
+    }
+
+    raw_data = kzalloc(TX_NUM * SPURIOUS_FP_RX_NUM * 2 * (sizeof(uint8_t)), GFP_KERNEL);
+    if (!raw_data) {
+            TPD_INFO("raw_data kzalloc error\n");
+            return;
+    }
+
+    chip_info->spuri_fp_data = kzalloc(TX_NUM*RX_NUM*(sizeof(int16_t)), GFP_KERNEL);
+    if (!chip_info->spuri_fp_data) {
+        TPD_INFO("chip_info->spuri_fp_data kzalloc error\n");
+    }
+
+RE_TRY:
+    TPD_INFO("%s retry_time=%d line=%d\n",__func__,retry_time,__LINE__);
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x1);
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+        goto OUT;
+    }
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0X02); //forcecal
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE, 0x7c);//select report type 0x02
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+1, 0x00);//set LSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE+2, 0x00);//set MSB
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE, 0x01);//get report
+
+    ret = checkCMD_for_finger(chip_info);
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("checkCMD_for_finger error line=%d\n",__LINE__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    ret = touch_i2c_read_block(chip_info->client, chip_info->reg_info.F54_ANALOG_DATA_BASE + 3, TX_NUM * SPURIOUS_FP_RX_NUM * 2, raw_data);     //read data
+    if (ret < 0) {
+        if (retry_time) {
+            TPD_INFO("%s touch_i2c_read_block error\n",__func__);
+            retry_time--;
+            goto RE_TRY;
+        }
+    }
+
+    for (x = 0; x < TX_NUM; x++) {
+        printk("[%2d]: ", x);
+        for (y = 0; y < SPURIOUS_FP_RX_NUM; y++) {
+            z = SPURIOUS_FP_RX_NUM * x + y;
+            chip_info->spuri_fp_data[z] = (raw_data[z*2 + 1] << 8) | raw_data[z *2];
+            printk("%5d,",chip_info->spuri_fp_data[z]);
+        }
+        printk("\n");
+    }
+
+    TPD_INFO("%s F54_ANALOG_COMMAND_BASE=0x%x set 0, \n",__func__,chip_info->reg_info.F54_ANALOG_COMMAND_BASE); //add for Prevent TP failure
+    touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F54_ANALOG_COMMAND_BASE,0);
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);   // page 0
+    if (ret < 0) {
+        TPD_INFO("%s,I2C transfer error\n", __func__);
+    }
+
+OUT:
+    kfree(raw_data);
+}
+
+static void synaptics_write_ps_status(void *chip_data, int ps_status)
+{
+    int ret = 0;
+    int tmp = 0;
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x4);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+        return ;
+    }
+
+    tmp = touch_i2c_read_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL36);
+    if (ps_status == 1) {
+        tmp |= 0x04;    //bit2:1 ps near
+    } else {
+        tmp &= 0xfB;    //bit2:0 ps far
+    }
+    ret = touch_i2c_write_byte(chip_info->client, chip_info->reg_info.F51_CUSTOM_CTRL36, tmp);
+    if (ret < 0) {
+        TPD_INFO("write ps_status error\n");
+        return;
+    }
+    TPD_INFO("F51_CUSTOM_CTRL36=0x%x  write ps_status value 0x%x ok, ps %s \n",
+              chip_info->reg_info.F51_CUSTOM_CTRL36, tmp, ps_status ? "near" : "far");
+
+    ret = touch_i2c_write_byte(chip_info->client, 0xff, 0x0);
+    if (ret < 0) {
+        TPD_INFO("%s: failed for page select\n", __func__);
+    }
+}
+
+void synaptics_specific_resume_operate(void *chip_data)
+{
+    struct chip_data_td4310 *chip_info = (struct chip_data_td4310 *)chip_data;
+    synaptics_exit_esd_mode(chip_info);
+}
+
+static struct oppo_touchpanel_operations synaptics_ops = {
+    .get_vendor        = synaptics_get_vendor,
+    .get_chip_info     = synaptics_get_chip_info,
+    .reset             = synaptics_reset,
+    .power_control     = synaptics_power_control,
+    .fw_check          = synaptics_fw_check,
+    .fw_update         = synaptics_fw_update,
+    .trigger_reason    = synaptics_trigger_reason,
+    .get_touch_points  = synaptics_get_touch_points,
+    .get_gesture_info  = synaptics_get_gesture_info,
+    .mode_switch       = synaptics_mode_switch,
+    .get_keycode       = synaptics_get_keycode,
+    .spurious_fp_check = synaptics_spurious_fp_check,
+    .finger_proctect_data_get = synaptics_finger_proctect_data_get,
+    .black_screen_test = synaptics_black_screen_RT136_test,
+    .exit_esd_mode     = synaptics_exit_esd_mode,
+    .write_ps_status = synaptics_write_ps_status,
+    .specific_resume_operate = synaptics_specific_resume_operate,
+};
+
+static struct synaptics_proc_operations synaptics_proc_ops = {
+    .auto_test     = synaptics_auto_test,
+};
+
+static struct debug_info_proc_operations debug_info_proc_ops = {
+    .limit_read    = synaptics_limit_read,
+    .delta_read    = synaptics_delta_read,
+    .baseline_read = synaptics_baseline_read,
+    .baseline_blackscreen_read = synaptics_baseline_blackscreen_read,
+    .main_register_read = synaptics_main_register_read,
+    .reserve_read = synaptics_reserve_read,
+};
+
+static int synaptics_tp_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+    struct remotepanel_data *premote_data = NULL;
+#endif
+
+    struct chip_data_td4310 *chip_info;
+    struct touchpanel_data *ts = NULL;
+    int ret = -1;
+
+    TPD_INFO("%s is called\n", __func__);
+    //step1:Alloc chip_info
+    chip_info = kzalloc(sizeof(struct chip_data_td4310), GFP_KERNEL);
+    if (chip_info == NULL) {
+        TPD_INFO("chip info kzalloc error\n");
+        ret = -ENOMEM;
+        return ret;
+    }
+    memset(chip_info, 0, sizeof(*chip_info));
+    g_chip_info = chip_info;
+
+    //step2:Alloc common ts
+    ts = common_touch_data_alloc();
+    if (ts == NULL) {
+        TPD_INFO("ts kzalloc error\n");
+        goto ts_malloc_failed;
+    }
+    memset(ts, 0, sizeof(*ts));
+
+    //step3:binding client && dev for easy operate
+    client->addr = 0x20;
+    chip_info->client = client;
+    chip_info->p_spuri_fp_touch = &(ts->spuri_fp_touch);
+    chip_info->syna_ops = &synaptics_proc_ops;
+    ts->debug_info_ops = &debug_info_proc_ops;
+    ts->client = client;
+    ts->irq = client->irq;
+    i2c_set_clientdata(client, ts);
+    ts->dev = &client->dev;
+    ts->chip_data = chip_info;
+    chip_info->hw_res = &ts->hw_res;
+
+    //step4:file_operations callback binding
+    ts->ts_ops = &synaptics_ops;
+
+    //step5:register common touch
+    ret = register_common_touch_device(ts);
+    if (ret < 0) {
+        goto err_register_driver;
+    }
+
+    ts->tp_resume_order = LCD_TP_RESUME;
+    ts->skip_suspend_operate = true;
+    ts->skip_reset_in_resume = true;
+
+    //step6: collect data for supurious_fp_touch
+    if (ts->spurious_fp_support) {
+        mutex_lock(&ts->mutex);
+        synaptics_finger_proctect_data_get(chip_info);
+        mutex_unlock(&ts->mutex);
+    }
+
+    //step7:create synaptics related proc files
+    synaptics_create_proc(ts, chip_info->syna_ops);
+
+    //step8:Chip Related function
+#ifdef CONFIG_SYNAPTIC_RED
+    premote_data = remote_alloc_panel_data();
+    chip_info->premote_data = premote_data;
+    if (premote_data) {
+        premote_data->client        = client;
+        premote_data->input_dev     = ts->input_dev;
+        premote_data->pmutex        = &ts->mutex;
+        premote_data->irq_gpio      = ts->hw_res.irq_gpio;
+        premote_data->irq           = client->irq;
+        premote_data->enable_remote = &(chip_info->enable_remote);
+        register_remote_device(premote_data);
+    }
+#endif
+
+    TPD_INFO("%s, probe normal end\n", __func__);
+
+    return 0;
+
+err_register_driver:
+    common_touch_data_free(ts);
+    ts = NULL;
+
+ts_malloc_failed:
+    kfree(chip_info);
+    chip_info = NULL;
+    ret = -1;
+
+    TPD_INFO("%s, probe error\n", __func__);
+
+    return ret;
+}
+
+static int synaptics_tp_remove(struct i2c_client *client)
+{
+    struct touchpanel_data *ts = i2c_get_clientdata(client);
+
+    TPD_INFO("%s is called\n", __func__);
+#ifdef CONFIG_SYNAPTIC_RED
+    unregister_remote_device();
+#endif
+    kfree(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: is called\n", __func__);
+    tp_i2c_suspend(ts);
+
+    return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s is called\n", __func__);
+    tp_i2c_resume(ts);
+
+    return 0;
+}
+
+static const struct i2c_device_id tp_id[] = {
+    { TPD_DEVICE, 0 },
+    { }
+};
+
+static struct of_device_id tp_match_table[] = {
+    { .compatible = TPD_DEVICE,},
+    { }
+};
+
+static const struct dev_pm_ops tp_pm_ops = {
+#ifdef CONFIG_FB
+    .suspend = synaptics_i2c_suspend,
+    .resume = synaptics_i2c_resume,
+#endif
+};
+
+static struct i2c_driver tp_i2c_driver = {
+    .probe      = synaptics_tp_probe,
+    .remove     = synaptics_tp_remove,
+    .id_table   = tp_id,
+    .driver     = {
+        .name   = TPD_DEVICE,
+        .of_match_table =  tp_match_table,
+        .pm = &tp_pm_ops,
+    },
+};
+
+static int __init tp_driver_init(void)
+{
+    TPD_INFO("%s is called\n", __func__);
+
+    if (!tp_judge_ic_match(TPD_DEVICE))
+        return -1;
+
+    if (i2c_add_driver(&tp_i2c_driver)!= 0) {
+        TPD_INFO("unable to add i2c driver.\n");
+        return -1;
+    }
+    return 0;
+}
+
+/* should never be called */
+static void __exit tp_driver_exit(void)
+{
+    i2c_del_driver(&tp_i2c_driver);
+    return;
+}
+
+module_init(tp_driver_init);
+module_exit(tp_driver_exit);
+
+MODULE_DESCRIPTION("Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_td4310.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_td4310.h
new file mode 100644
index 0000000000000000000000000000000000000000..a3fd8fb7d179aa58869760be7a0506b5df8f68a8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/TD4310/synaptics_td4310.h
@@ -0,0 +1,259 @@
+/***************************************************
+* File:synaptics_drivers_td4310.h
+* Copyright(C) 2008-2012 OPPO Mobile Comm Corp., Ltd
+* Description:
+*             synaptics td4310 driver
+* Version:1.0:
+* Date created:2017/04/17
+* Author: MingQiang.Guo@Bsp.Driver
+* TAG: BSP.TP.Init
+* *
+* -------------- Revision History: -----------------
+<author >  <data>  <version>  <desc>
+****************************************************/
+
+#ifndef SYNAPTICS_H_TD4310
+#define SYNAPTICS_H_TD4310
+
+/*********PART1:Head files**********************/
+#include <linux/i2c.h>
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#include "../synaptics_common.h"
+#ifdef CONFIG_SYNAPTIC_RED
+#include "../synaptics_touch_panel_remote.h"
+#endif
+
+/*********PART2:Define Area**********************/
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE      0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE    0x02
+#define ENABLE_DTAP     0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT      0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT    0x07
+#define DTAP_DETECT     0x03
+
+#define RESET_TO_NORMAL_TIME 100    /*Sleep time after reset*/
+
+#define SPURIOUS_FP_LIMIT 100
+#define SPURIOUS_FP_RX_NUM 8
+#define SPURIOUS_FP_TX_NUM 9
+#define SPURIOUS_FP_BASE_DATA_RETRY 10
+
+#define I2C_ERROR_MAX_TIME 5
+
+#define EXTEND_EE_SHORT_RESET_DUR  60
+#define EXTEND_EE_SHORT_INT_DUR  150
+#define EXTEND_EE_SHORT_TX_ON_COUNT  146
+#define EXTEND_EE_SHORT_RX_ON_COUNT  146
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART1  120
+#define EXTEND_EE_SHORT_TEST_LIMIT_PART2  70         // ( unit = ratio )
+
+/* tddi f54 test reporting - */
+#define ELEC_OPEN_TEST_TX_ON_COUNT 2
+#define ELEC_OPEN_TEST_RX_ON_COUNT 2
+
+#define ELEC_OPEN_INT_DUR_ONE_TIANMA  15
+#define ELEC_OPEN_INT_DUR_TWO_TIANMA  25
+#define ELEC_OPEN_TEST_LIMIT_ONE_TIANMA 60
+#define ELEC_OPEN_TEST_LIMIT_TWO_TIANMA 60
+
+#define ELEC_OPEN_INT_DUR_ONE_BOE  13
+#define ELEC_OPEN_INT_DUR_TWO_BOE  25
+#define ELEC_OPEN_TEST_LIMIT_ONE_BOE 150
+#define ELEC_OPEN_TEST_LIMIT_TWO_BOE 60
+
+#define ELEC_OPEN_INT_DUR_ONE_DSJM  13
+#define ELEC_OPEN_INT_DUR_TWO_DSJM  30
+#define ELEC_OPEN_TEST_LIMIT_ONE_DSJM 70
+#define ELEC_OPEN_TEST_LIMIT_TWO_DSJM 60
+
+#define ELEC_OPEN_INT_DUR_ONE_JDI  12
+#define ELEC_OPEN_INT_DUR_TWO_JDI  25
+#define ELEC_OPEN_TEST_LIMIT_ONE_JDI 70
+#define ELEC_OPEN_TEST_LIMIT_TWO_JDI 60
+
+#define ELEC_OPEN_INT_DUR_ONE_TRULY  13
+#define ELEC_OPEN_INT_DUR_TWO_TRULY  30
+#define ELEC_OPEN_TEST_LIMIT_ONE_TRULY 70
+#define ELEC_OPEN_TEST_LIMIT_TWO_TRULY 60
+
+#define COMMAND_FORCE_UPDATE 4
+
+//#define UPDATE_DISPLAY_CONFIG
+
+#define RT136_2D_LIMIT_LOW 200
+#define RT136_2D_LIMIT_HIGH 800
+
+#define RT3_DOZE_LOW  200
+#define RT3_DOZE_HIGH 800
+
+#define RT136_GESTURE_DOZE_LOW  200
+#define RT136_GESTURE_DOZE_HIGH 800
+
+#define TEST_FAIL	1
+#define TEST_PASS	0
+
+struct f55_control_43 {
+	union {
+		struct {
+			unsigned char swap_sensor_side:1;
+			unsigned char f55_ctrl43_b1__7:7;
+			unsigned char afe_l_mux_size:4;
+			unsigned char afe_r_mux_size:4;
+		} __packed;
+		unsigned char data[2];
+	};
+};
+
+struct f54_control_91 {
+	union {
+		struct {
+			unsigned char reflo_transcap_capacitance;
+			unsigned char refhi_transcap_capacitance;
+			unsigned char receiver_feedback_capacitance;
+			unsigned char reference_receiver_feedback_capacitance;
+			unsigned char gain_ctrl;
+		} __packed;
+		struct {
+			unsigned char data[5];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+struct f54_control_99 {
+	union {
+		struct {
+			unsigned char integration_duration_lsb;
+			unsigned char integration_duration_msb;
+			unsigned char reset_duration;
+		} __packed;
+		struct {
+			unsigned char data[3];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+struct f54_control_182 {
+	union {
+		struct {
+			unsigned char cbc_timing_ctrl_tx_lsb;
+			unsigned char cbc_timing_ctrl_tx_msb;
+			unsigned char cbc_timing_ctrl_rx_lsb;
+			unsigned char cbc_timing_ctrl_rx_msb;
+		} __packed;
+		struct {
+			unsigned char data[4];
+			unsigned short address;
+		} __packed;
+	};
+};
+
+/*********PART3:Struct Area**********************/
+struct synaptics_register
+{
+	uint8_t F01_RMI_QUERY_BASE;
+	uint8_t F01_RMI_CMD_BASE;
+	uint8_t F01_RMI_CTRL_BASE;
+	uint8_t F01_RMI_DATA_BASE;
+
+	uint8_t F01_RMI_QUERY11;
+	uint8_t F01_RMI_DATA01;
+	uint8_t F01_RMI_CMD00;
+	uint8_t F01_RMI_CTRL00;
+	uint8_t F01_RMI_CTRL01;
+	uint8_t F01_RMI_CTRL02;
+
+	uint8_t F12_2D_QUERY_BASE;
+	uint8_t F12_2D_CMD_BASE;
+	uint8_t F12_2D_CTRL_BASE;
+	uint8_t F12_2D_DATA_BASE;
+
+	uint8_t F12_2D_CTRL08;
+	uint8_t F12_2D_CTRL20;
+	uint8_t F12_2D_CTRL23;
+	uint8_t F12_2D_CTRL27;
+	uint8_t F12_2D_CTRL32;
+	uint8_t F12_2D_DATA04;
+	uint8_t F12_2D_DATA15;
+	uint8_t F12_2D_DATA38;
+	uint8_t F12_2D_DATA39;
+	uint8_t F12_2D_CMD00;
+
+	uint8_t F34_FLASH_QUERY_BASE;
+	uint8_t F34_FLASH_CMD_BASE;
+	uint8_t F34_FLASH_CTRL_BASE;
+	uint8_t F34_FLASH_DATA_BASE;
+
+	uint8_t SynaF34_FlashControl;
+	uint8_t SynaF34_FlashStatus;
+	uint8_t SynaF34Reflash_BlockNum;
+	uint8_t SynaF34Reflash_BlockData;
+	uint8_t SynaF34ReflashQuery_BootID;
+	uint8_t SynaF34ReflashQuery_FlashPropertyQuery;
+	uint8_t SynaF34ReflashQuery_FirmwareBlockSize;
+	uint8_t SynaF34ReflashQuery_FirmwareBlockCount;
+	uint8_t SynaF34ReflashQuery_ConfigBlockSize;
+	uint8_t SynaF34ReflashQuery_ConfigBlockCount;
+
+	uint8_t F51_CUSTOM_QUERY_BASE;
+	uint8_t F51_CUSTOM_CMD_BASE;
+	uint8_t F51_CUSTOM_CTRL_BASE;
+	uint8_t F51_CUSTOM_DATA_BASE;
+
+	uint8_t F51_CUSTOM_CTRL00;
+	uint8_t F51_CUSTOM_CTRL31;
+	uint8_t F51_CUSTOM_CTRL36;
+	uint8_t F51_CUSTOM_CTRL42;
+	uint8_t F51_CUSTOM_GRIP_CTRL;//edge function register,the enable bit of Grip suppression
+	uint8_t F51_CUSTOM_DATA;
+	uint8_t F51_CUSTOM_DATA57;
+
+	uint8_t F54_ANALOG_QUERY_BASE;
+	uint8_t F54_ANALOG_COMMAND_BASE;
+	uint8_t F54_ANALOG_CONTROL_BASE;
+	uint8_t F54_ANALOG_DATA_BASE;
+	uint8_t F54_ANALOG_DATA06;
+	uint8_t F54_ANALOG_DATA10;
+	uint8_t F54_ANALOG_DATA17;
+	uint8_t F54_ANALOG_CTRL123;
+	uint8_t F54_ANALOG_CTRL91;
+	uint8_t F54_ANALOG_CTRL99;
+	uint8_t F54_ANALOG_CTRL182;
+	uint8_t F54_ANALOG_CTRL225;
+
+	uint8_t F55_SENSOR_QUERY_BASE;
+	uint8_t F55_SENSOR_CMD_BASE;
+	uint8_t F55_SENSOR_CTRL_BASE;
+	uint8_t F55_SENSOR_DATA_BASE;
+
+	uint8_t F55_SENSOR_CTRL01;
+	uint8_t F55_SENSOR_CTRL02;
+	uint8_t F55_SENSOR_CTRL43;
+};
+
+struct chip_data_td4310 {
+	tp_dev tp_type;
+	struct i2c_client *client;
+	struct synaptics_proc_operations *syna_ops; /*synaptics func provide to synaptics common driver*/
+#ifdef CONFIG_SYNAPTIC_RED
+	int    enable_remote;                       /*Redremote connect state*/
+	struct remotepanel_data *premote_data;
+#endif/*CONFIG_SYNAPTIC_RED*/
+	struct synaptics_register     reg_info;
+	struct hw_resource          *hw_res;
+	int16_t *spuri_fp_data;
+	struct spurious_fp_touch *p_spuri_fp_touch;
+
+};
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.c
new file mode 100644
index 0000000000000000000000000000000000000000..0c28958797136fa4c72ad81871dec20b49491a94
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.c
@@ -0,0 +1,588 @@
+/***************************************************
+ * File:synaptics_common.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include "../touchpanel_common.h"
+#include "synaptics_common.h"
+#include <linux/crc32.h>
+
+/*******Part0:LOG TAG Declear********************/
+
+#define TPD_DEVICE "synaptics_common"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+
+/*******Part1:Call Back Function implement*******/
+
+unsigned int extract_uint_le(const unsigned char *ptr)
+{
+    return (unsigned int)ptr[0] +
+        (unsigned int)ptr[1] * 0x100 +
+        (unsigned int)ptr[2] * 0x10000 +
+        (unsigned int)ptr[3] * 0x1000000;
+}
+
+/*******************Limit File With "limit_block" Format*************************************/
+int synaptics_get_limit_data(char *type, const unsigned char *fw_image)
+{
+    int i = 0;
+    unsigned int offset, count;
+    struct limit_info *limit_info;
+    struct limit_block *limit_block;
+
+    limit_info = (struct limit_info *)fw_image;
+    count = limit_info->count;
+
+    offset = sizeof(struct limit_info);
+    for (i = 0; i < count; i++) {
+        limit_block = (struct limit_block *)(fw_image + offset);
+        pr_info("name: %s, size: %d, offset %d\n", limit_block->name, limit_block->size, offset);
+        if (strncmp(limit_block->name, type, MAX_LIMIT_NAME_SIZE) == 0) {
+            break;
+        }
+
+        offset += (sizeof(struct limit_block) - 4 + 2*limit_block->size); /*minus 4, because byte align*/
+    }
+
+    if (i == count) {
+        return 0;
+    }
+
+    return offset;
+}
+
+/*************************************TCM Firmware Parse Funtion**************************************/
+int synaptics_parse_header_v2(struct image_info *image_info, const unsigned char *fw_image)
+{
+    struct image_header_v2 *header;
+    unsigned int magic_value;
+    unsigned int number_of_areas;
+    unsigned int i = 0;
+    unsigned int addr;
+    unsigned int length;
+    unsigned int checksum;
+    unsigned int flash_addr;
+    const unsigned char *content;
+    struct area_descriptor *descriptor;
+    int offset = sizeof(struct image_header_v2);
+
+    header = (struct image_header_v2 *)fw_image;
+    magic_value = le4_to_uint(header->magic_value);
+
+    if (magic_value != IMAGE_FILE_MAGIC_VALUE) {
+        pr_err("invalid magic number %d\n", magic_value);
+        return -EINVAL;
+    }
+
+    number_of_areas = le4_to_uint(header->num_of_areas);
+
+    for (i = 0; i < number_of_areas; i++) {
+        addr = le4_to_uint(fw_image + offset);
+        descriptor = (struct area_descriptor *)(fw_image + addr);
+        offset += 4;
+
+        magic_value =  le4_to_uint(descriptor->magic_value);
+        if (magic_value != FLASH_AREA_MAGIC_VALUE)
+            continue;
+
+        length = le4_to_uint(descriptor->length);
+        content = (unsigned char *)descriptor + sizeof(*descriptor);
+        flash_addr = le4_to_uint(descriptor->flash_addr_words) * 2;
+        checksum = le4_to_uint(descriptor->checksum);
+
+        if (0 == strncmp((char *)descriptor->id_string,
+                BOOT_CONFIG_ID,
+                strlen(BOOT_CONFIG_ID))) {
+            if (checksum != (crc32(~0, content, length) ^ ~0)) {
+                pr_err("Boot config checksum error\n");
+                return -EINVAL;
+            }
+            image_info->boot_config.size = length;
+            image_info->boot_config.data = content;
+            image_info->boot_config.flash_addr = flash_addr;
+            pr_info("Boot config size = %d, address = 0x%08x\n", length, flash_addr);
+        } else if (0 == strncmp((char *)descriptor->id_string,
+                APP_CODE_ID,
+                strlen(APP_CODE_ID))) {
+            if (checksum != (crc32(~0, content, length) ^ ~0)) {
+                pr_err("Application firmware checksum error\n");
+                return -EINVAL;
+            }
+            image_info->app_firmware.size = length;
+            image_info->app_firmware.data = content;
+            image_info->app_firmware.flash_addr = flash_addr;
+            pr_info("Application firmware size = %d address = 0x%08x\n", length, flash_addr);
+        } else if (0 == strncmp((char *)descriptor->id_string,
+                APP_CONFIG_ID,
+                strlen(APP_CONFIG_ID))) {
+            if (checksum != (crc32(~0, content, length) ^ ~0)) {
+                pr_err("Application config checksum error\n");
+                return -EINVAL;
+            }
+            image_info->app_config.size = length;
+            image_info->app_config.data = content;
+            image_info->app_config.flash_addr = flash_addr;
+            pr_info("Application config size = %d address = 0x%08x\n",length, flash_addr);
+        } else if (0 == strncmp((char *)descriptor->id_string,
+                DISP_CONFIG_ID,
+                strlen(DISP_CONFIG_ID))) {
+            if (checksum != (crc32(~0, content, length) ^ ~0)) {
+                pr_err("Display config checksum error\n");
+                return -EINVAL;
+            }
+            image_info->disp_config.size = length;
+            image_info->disp_config.data = content;
+            image_info->disp_config.flash_addr = flash_addr;
+            pr_info("Display config size = %d address = 0x%08x\n", length, flash_addr);
+        }
+    }
+    return 0;
+}
+
+/**********************************RMI Firmware Parse Funtion*****************************************/
+void synaptics_parse_header(struct image_header_data *header, const unsigned char *fw_image)
+{
+    struct image_header *data = (struct image_header *)fw_image;
+
+    header->checksum = extract_uint_le(data->checksum);
+    TPD_DEBUG(" checksume is %x", header->checksum);
+
+    header->bootloader_version = data->bootloader_version;
+    TPD_DEBUG(" bootloader_version is %d\n", header->bootloader_version);
+
+    header->firmware_size = extract_uint_le(data->firmware_size);
+    TPD_DEBUG(" firmware_size is %x\n", header->firmware_size);
+
+    header->config_size = extract_uint_le(data->config_size);
+    TPD_DEBUG(" header->config_size is %x\n", header->config_size);
+
+    /* only available in s4322 , reserved in other, begin*/
+    header->bootloader_offset = extract_uint_le(data->bootloader_addr );
+    header->bootloader_size = extract_uint_le(data->bootloader_size);
+    TPD_DEBUG(" header->bootloader_offset is %x\n", header->bootloader_offset);
+    TPD_DEBUG(" header->bootloader_size is %x\n", header->bootloader_size);
+
+    header->disp_config_offset = extract_uint_le(data->dsp_cfg_addr);
+    header->disp_config_size = extract_uint_le(data->dsp_cfg_size);
+    TPD_DEBUG(" header->disp_config_offset is %x\n", header->disp_config_offset);
+    TPD_DEBUG(" header->disp_config_size is %x\n", header->disp_config_size);
+    /* only available in s4322 , reserved in other ,  end*/
+
+    memcpy(header->product_id, data->product_id, sizeof(data->product_id));
+    header->product_id[sizeof(data->product_id)] = 0;
+
+    memcpy(header->product_info, data->product_info, sizeof(data->product_info));
+
+    header->contains_firmware_id = data->options_firmware_id;
+    TPD_DEBUG(" header->contains_firmware_id is %x\n", header->contains_firmware_id);
+    if (header->contains_firmware_id)
+        header->firmware_id = extract_uint_le(data->firmware_id);
+
+    return;
+}
+
+void synaptics_print_limit_v2(struct seq_file *s, struct touchpanel_data *ts, const struct firmware *fw)
+{
+    int i = 0, index = 0;
+    int row, col;
+    int rows, cols;
+    unsigned int offset, count;
+    int16_t *data_16;
+    struct limit_info *limit_info;
+    struct limit_block *limit_block;
+    const char *data = fw->data;
+
+    limit_info = (struct limit_info*)data;
+    count = limit_info->count;
+
+    offset = sizeof(struct limit_info);
+    for (i = 0; i < count; i++) {
+        limit_block = (struct limit_block *)(data + offset);
+        pr_info("name: %s, size: %d, offset %d\n", limit_block->name, limit_block->size, offset);
+
+        seq_printf(s, "%s\n", limit_block->name);
+
+        data_16 = &limit_block->data;
+        offset += (sizeof(struct limit_block) - 4 + 2*limit_block->size); /*minus 4, because byte align*/
+
+        if ((ts->hw_res.TX_NUM*ts->hw_res.RX_NUM) != limit_block->size/2) {
+            continue;
+        }
+
+        cols = ts->hw_res.TX_NUM;
+        rows = ts->hw_res.RX_NUM;
+
+        index = 0;
+        for (row = 0; row < rows; row++){
+            seq_printf(s, "[%02d]:", row);
+            for(col = 0; col < cols; col++) {
+                seq_printf(s, "%4d %4d,", *(data_16 + 2*index), *(data_16 + 2*index + 1));
+                index++;
+            }
+            seq_printf(s, "\n");
+        }
+
+    }
+    return;
+}
+
+void synaptics_print_limit_v1(struct seq_file *s, struct touchpanel_data *ts, const struct firmware *fw)
+{
+    uint16_t *prow = NULL;
+    uint16_t *prowcbc = NULL;
+    int i = 0;
+    struct test_header *ph = NULL;
+
+    ph = (struct test_header *)(fw->data);
+    prow = (uint16_t *)(fw->data + ph->array_limit_offset);
+    prowcbc = (uint16_t *)(fw->data + ph->array_limitcbc_offset);
+    TPD_INFO("synaptics_test_limit_show:array_limit_offset = %x array_limitcbc_offset = %x \n",
+            ph->array_limit_offset, ph->array_limitcbc_offset);
+    TPD_DEBUG("test begin:\n");
+    seq_printf(s, "Without cbc:");
+
+    for (i = 0 ; i < (ph->array_limit_size / 2); i++) {
+        if (i % (2 * ts->hw_res.RX_NUM) == 0)
+            seq_printf(s, "\n[%2d] ", (i / ts->hw_res.RX_NUM) / 2);
+        seq_printf(s, "%4d, ", prow[i]);
+        TPD_DEBUG("%d, ", prow[i]);
+    }
+    if (ph->withCBC == 1) {
+        seq_printf(s, "\nWith cbc:");
+        for (i = 0 ; i < (ph->array_limitcbc_size / 2); i++) {
+            if (i % (2 * ts->hw_res.RX_NUM) == 0)
+                seq_printf(s, "\n[%2d] ", (i / ts->hw_res.RX_NUM) / 2);
+            seq_printf(s, "%4d, ", prowcbc[i]);
+            TPD_DEBUG("%d, ", prowcbc[i]);
+        }
+    }
+
+    seq_printf(s, "\n");
+    return;
+}
+
+
+void synaptics_limit_read(struct seq_file *s, struct touchpanel_data *ts)
+{
+    int ret = 0;
+    const struct firmware *fw = NULL;
+    struct test_header *ph = NULL;
+
+    ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "Request failed, Check the path %s\n",ts->panel_data.test_limit_name);
+        return;
+    }
+
+    ph = (struct test_header *)(fw->data);
+
+    if (ph->magic1 == Limit_MagicNum1 && ph->magic2 == Limit_MagicNum2_V2) {
+        synaptics_print_limit_v2(s, ts, fw);
+    } else {
+        synaptics_print_limit_v1(s, ts, fw);
+    }
+    release_firmware(fw);
+}
+
+//proc/touchpanel/baseline_test
+static int tp_auto_test_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct synaptics_proc_operations *syna_ops;
+    struct timespec now_time;
+    struct rtc_time rtc_now_time;
+  //  const struct firmware *fw = NULL;
+    mm_segment_t old_fs;
+    uint8_t data_buf[64];
+    //int ret = 0;
+    int fd = -1;
+
+    struct syna_testdata syna_testdata =
+    {
+        .TX_NUM = 0,
+        .RX_NUM = 0,
+        .fd = -1,
+        .irq_gpio = -1,
+        .key_TX = 0,
+        .key_RX = 0,
+        .TP_FW = 0,
+       // .fw = NULL,
+    };
+
+    if (!ts)
+        return 0;
+    syna_ops = (struct synaptics_proc_operations *)ts->private_data;
+    if (!syna_ops)
+        return 0;
+    if (!syna_ops->auto_test) {
+        seq_printf(s, "Not support auto-test proc node\n");
+        return 0;
+    }
+
+    /*if resume not completed, do not do screen on test*/
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume state\n");
+        return 0;
+    }
+
+    //step1:disable_irq && get mutex locked
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+
+    //step2: create a file to store test data in /sdcard/Tp_Test
+    getnstimeofday(&now_time);
+    rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+    sprintf(data_buf, "/sdcard/tp_testlimit_%02d%02d%02d-%02d%02d%02d-utc.csv",
+            (rtc_now_time.tm_year + 1900) % 100, rtc_now_time.tm_mon + 1, rtc_now_time.tm_mday,
+            rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+    old_fs = get_fs();
+    set_fs(KERNEL_DS);
+    fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+    if (fd < 0) {
+        TPD_INFO("Open log file '%s' failed.\n", data_buf);
+        set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        if (ts->int_mode == BANNABLE) {
+            enable_irq(ts->irq);
+         }
+        return 0;
+    }
+
+    //step3:request test limit data from userspace
+ /*  ret = request_firmware(&fw, ts->panel_data.test_limit_name, ts->dev);
+    if (ret < 0) {
+        TPD_INFO("Request firmware failed - %s (%d)\n", ts->panel_data.test_limit_name, ret);
+        seq_printf(s, "No limit IMG\n");
+		sys_close(fd);
+		set_fs(old_fs);
+        mutex_unlock(&ts->mutex);
+        if (ts->int_mode == BANNABLE) {
+            enable_irq(ts->irq);
+        }
+        return 0;
+    }
+*/
+    ts->in_test_process = true;
+
+    //step4:init syna_testdata
+    syna_testdata.fd = fd;
+    syna_testdata.TX_NUM = ts->hw_res.TX_NUM;
+    syna_testdata.RX_NUM = ts->hw_res.RX_NUM;
+    syna_testdata.irq_gpio = ts->hw_res.irq_gpio;
+    syna_testdata.key_TX = ts->hw_res.key_TX;
+    syna_testdata.key_RX = ts->hw_res.key_RX;
+    syna_testdata.TP_FW = ts->panel_data.TP_FW;
+  //  syna_testdata.fw = fw;
+
+    syna_ops->auto_test(s, ts->chip_data, &syna_testdata);
+
+    //step5: close file && release test limit firmware
+    if (fd >= 0) {
+        sys_close(fd);
+        set_fs(old_fs);
+    }
+  //  release_firmware(fw);
+
+    //step6: return to normal mode
+    ts->ts_ops->reset(ts->chip_data);
+    operate_mode_switch(ts);
+
+    //step7: unlock the mutex && enable irq trigger
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+
+    ts->in_test_process = false;
+    return 0;
+}
+
+static int baseline_autotest_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_auto_test_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_auto_test_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = baseline_autotest_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int tp_RT251_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->RT251) {
+        seq_printf(s, "Not support RT251 proc node\n");
+        return 0;
+    }
+    disable_irq_nosync(ts->client->irq);
+    mutex_lock(&ts->mutex);
+    debug_info_ops->RT251(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->client->irq);
+
+    return 0;
+}
+
+static int RT251_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_RT251_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_RT251_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = RT251_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int tp_RT76_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->RT76) {
+        seq_printf(s, "Not support RT76 proc node\n");
+        return 0;
+    }
+    disable_irq_nosync(ts->client->irq);
+    mutex_lock(&ts->mutex);
+    debug_info_ops->RT76(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    enable_irq(ts->client->irq);
+
+    return 0;
+}
+
+static int RT76_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_RT76_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_RT76_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = RT76_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+static int tp_DRT_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->DRT) {
+        seq_printf(s, "Not support RT76 proc node\n");
+        return 0;
+    }
+
+    if (ts->is_suspended && (ts->gesture_enable != 1)) {
+        seq_printf(s, "In suspend state, and gesture not enable\n");
+        return 0;
+    }
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+
+    mutex_lock(&ts->mutex);
+    debug_info_ops->DRT(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->client->irq);
+    }
+    return 0;
+
+}
+
+static int DRT_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_DRT_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_DRT_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = DRT_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+int synaptics_create_proc(struct touchpanel_data *ts, struct synaptics_proc_operations *syna_ops)
+{
+    int ret = 0;
+
+    // touchpanel_auto_test interface
+    struct proc_dir_entry *prEntry_tmp = NULL;
+    ts->private_data = syna_ops;
+    prEntry_tmp = proc_create_data("baseline_test", 0666, ts->prEntry_tp, &tp_auto_test_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show RT251 interface
+    prEntry_tmp = proc_create_data("RT251", 0666, ts->prEntry_debug_tp, &tp_RT251_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show RT76 interface
+    prEntry_tmp = proc_create_data("RT76", 0666, ts->prEntry_debug_tp, &tp_RT76_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("DRT", 0666, ts->prEntry_debug_tp, &tp_DRT_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+    return ret;
+}
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..b68148ec6df9aef529cdae07c617d103ea026185
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_common.h
@@ -0,0 +1,157 @@
+/***************************************************
+ * File:synaptics_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SYNAPTICS_H
+#define SYNAPTICS_H
+#define CONFIG_SYNAPTIC_RED
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#include "../touchpanel_common.h"
+#include "synaptics_firmware_v2.h"
+
+/*********PART2:Define Area**********************/
+#define SYNAPTICS_RMI4_PRODUCT_ID_SIZE 10
+#define SYNAPTICS_RMI4_PRODUCT_INFO_SIZE 2
+
+#define DiagonalUpperLimit  1100
+#define DiagonalLowerLimit  900
+
+#define MAX_RESERVE_SIZE 4
+#define MAX_LIMIT_NAME_SIZE 16
+
+#define Limit_MagicNum1     0x494D494C
+#define Limit_MagicNum2     0x474D4954
+#define Limit_MagicNum2_V2  0x32562D54
+
+
+/*********PART3:Struct Area**********************/
+struct image_header {
+    /* 0x00 - 0x0f */
+    unsigned char checksum[4];
+    unsigned char reserved_04;
+    unsigned char reserved_05;
+    unsigned char options_firmware_id:1;
+    unsigned char options_contain_bootloader:1;
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned char options_guest_code:1;
+    unsigned char options_tddi:1;
+    unsigned char options_reserved:4;
+    /* only available in s4322 , reserved in other ,  end*/
+    unsigned char bootloader_version;
+    unsigned char firmware_size[4];
+    unsigned char config_size[4];
+    /* 0x10 - 0x1f */
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE];
+    unsigned char package_id[2];
+    unsigned char package_id_revision[2];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+    /* 0x20 - 0x2f */
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned char bootloader_addr[4];
+    unsigned char bootloader_size[4];
+    unsigned char ui_addr[4];
+    unsigned char ui_size[4];
+    /* only available in s4322 , reserved in other ,  end*/
+    /* 0x30 - 0x3f */
+    unsigned char ds_id[16];
+    /* 0x40 - 0x4f */
+    /* only available in s4322 , reserved in other, begin*/
+    union {
+        struct {
+            unsigned char dsp_cfg_addr[4];
+            unsigned char dsp_cfg_size[4];
+            unsigned char reserved_48_4f[8];
+          };
+    };
+    /* only available in s4322 , reserved in other ,  end*/
+    /* 0x50 - 0x53 */
+    unsigned char firmware_id[4];
+};
+
+struct image_header_data {
+    bool contains_firmware_id;
+    unsigned int firmware_id;
+    unsigned int checksum;
+    unsigned int firmware_size;
+    unsigned int config_size;
+    /* only available in s4322 , reserved in other, begin*/
+    unsigned int disp_config_offset;
+    unsigned int disp_config_size;
+    unsigned int bootloader_offset;
+    unsigned int bootloader_size;
+    /* only available in s4322 , reserved in other ,  end*/
+    unsigned char bootloader_version;
+    unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE + 1];
+    unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+};
+
+struct limit_block {
+    char name[MAX_LIMIT_NAME_SIZE];
+    int mode;
+    int reserve[MAX_RESERVE_SIZE]; /*16*/
+    int size;
+    int16_t data;
+};
+
+struct limit_info {
+    unsigned int magic1;
+    unsigned int magic2;
+    unsigned int count;
+};
+
+struct test_header {
+    unsigned int magic1;
+    unsigned int magic2;
+    unsigned int withCBC;
+    unsigned int array_limit_offset;
+    unsigned int array_limit_size;
+    unsigned int array_limitcbc_offset;
+    unsigned int array_limitcbc_size;
+};
+
+struct syna_testdata{
+    int TX_NUM;
+    int RX_NUM;
+    int fd;
+    int irq_gpio;
+    int key_TX;
+    int key_RX;
+    uint64_t  TP_FW;
+    const struct firmware *fw;
+};
+
+//import from "android/bootable/bootloader/lk/platform/msm_shared/include/msm_panel.h"
+enum {
+    OPPO16037JDI_R63452_1080P_CMD_PANEL = 13,
+    OPPO16037SAMSUNG_S6E3FA5_1080P_CMD_PANEL = 14,
+    UNKNOWN_PANEL
+};
+
+struct synaptics_proc_operations {
+    void (*auto_test)    (struct seq_file *s, void *chip_data, struct syna_testdata *syna_testdata);
+};
+
+void synaptics_limit_read(struct seq_file *s, struct touchpanel_data *ts);
+int  synaptics_create_proc(struct touchpanel_data *ts, struct synaptics_proc_operations *syna_ops);
+void synaptics_parse_header(struct image_header_data *header, const unsigned char *fw_image);
+int synaptics_parse_header_v2(struct image_info *image_info, const unsigned char *fw_image);
+int synaptics_get_limit_data(char *type, const unsigned char *fw_image);
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_firmware_v2.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_firmware_v2.h
new file mode 100644
index 0000000000000000000000000000000000000000..6502c58153afbf585036f40ebd1a447ce80c24e8
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_firmware_v2.h
@@ -0,0 +1,102 @@
+/***************************************************
+ * File:synaptics_common.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics common driver
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef SYNAPTICS_FIRMWARE_V2_H
+#define SYNAPTICS_FIRMWARE_V2_H
+
+/*********PART1:Head files**********************/
+#include <linux/firmware.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+#define IMAGE_FILE_MAGIC_VALUE 0x4818472b
+#define FLASH_AREA_MAGIC_VALUE 0x7c05e516
+
+#define BOOT_CONFIG_ID "BOOT_CONFIG"
+#define APP_CODE_ID "APP_CODE"
+#define APP_CONFIG_ID "APP_CONFIG"
+#define DISP_CONFIG_ID "DISPLAY"
+
+struct app_config_header {
+    unsigned short magic_value[4];
+    unsigned char checksum[4];
+    unsigned char length[2];
+    unsigned char build_id[4];
+    unsigned char customer_config_id[16];
+};
+
+struct area_descriptor {
+    unsigned char magic_value[4];
+    unsigned char id_string[16];
+    unsigned char flags[4];
+    unsigned char flash_addr_words[4];
+    unsigned char length[4];
+    unsigned char checksum[4];
+};
+
+struct block_data_v2 {
+    const unsigned char *data;
+    unsigned int size;
+    unsigned int flash_addr;
+};
+
+struct image_info {
+    struct block_data_v2 boot_config;
+    struct block_data_v2 app_firmware;
+    struct block_data_v2 app_config;
+    struct block_data_v2 disp_config;
+};
+
+struct image_header_v2 {
+    unsigned char magic_value[4];
+    unsigned char num_of_areas[4];
+};
+
+struct boot_config {
+    union {
+        unsigned char i2c_address;
+        struct {
+            unsigned char cpha:1;
+            unsigned char cpol:1;
+            unsigned char word0_b2__7:6;
+        } __packed;
+    };
+    unsigned char attn_polarity:1;
+    unsigned char attn_drive:2;
+    unsigned char attn_pullup:1;
+    unsigned char word0_b12__14:3;
+    unsigned char used:1;
+    unsigned short customer_part_id;
+    unsigned short boot_timeout;
+    unsigned short continue_on_reset:1;
+    unsigned short word3_b1__15:15;
+} __packed;
+
+static inline unsigned int le2_to_uint(const unsigned char *src)
+{
+    return (unsigned int)src[0] +
+            (unsigned int)src[1] * 0x100;
+}
+
+static inline unsigned int le4_to_uint(const unsigned char *src)
+{
+    return (unsigned int)src[0] +
+            (unsigned int)src[1] * 0x100 +
+            (unsigned int)src[2] * 0x10000 +
+            (unsigned int)src[3] * 0x1000000;
+}
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.c b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.c
new file mode 100644
index 0000000000000000000000000000000000000000..3e6120f999ceb7359a4ac33931f9f5cbc7f97c03
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.c
@@ -0,0 +1,968 @@
+/***************************************************
+ * File:synaptics_touch_panel_remote.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics debugging tool code
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/gpio.h>
+#include <linux/uaccess.h>
+#include <linux/cdev.h>
+#include "synaptics_touch_panel_remote.h"
+
+#define CHAR_DEVICE_NAME "rmi"
+#define DEVICE_CLASS_NAME "rmidev"
+#define DEV_NUMBER 1
+#define REG_ADDR_LIMIT 0xFFFF
+
+static ssize_t rmidev_sysfs_data_show(struct file *data_file,
+        struct kobject *kobj, struct bin_attribute *attributes,
+        char *buf, loff_t pos, size_t count);
+
+static ssize_t rmidev_sysfs_data_store(struct file *data_file,
+        struct kobject *kobj, struct bin_attribute *attributes,
+        char *buf, loff_t pos, size_t count);
+
+static ssize_t rmidev_sysfs_open_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_release_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_address_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_length_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_attn_state_show(struct device *dev,
+        struct device_attribute *attr, char *buf);
+
+static int remote_rmi4_i2c_read(unsigned short addr, unsigned char *data, unsigned short length);
+static int remote_rmi4_i2c_write(unsigned short addr, unsigned char *data, unsigned short length);
+static int remote_rmi4_i2c_enable(bool enable);
+static int remote_rmi4_get_irq_gpio(void);
+static int remote_rmit_set_page(unsigned int address);
+static int remote_rmit_put_page(void);
+
+static struct input_dev *remote_rmi4_get_input(void);
+static struct i2c_client *remote_rmi4_get_i2c_client(void);
+static void remote_rmi4_delay_work(struct work_struct *work);
+static struct remotepanel_data *remote_free_panel_data(struct remotepanel_data *pdata);
+
+#define MASK_8BIT 0xFF ;
+#define SYN_I2C_RETRY_TIMES 3;
+#define BUFFER_SIZE 252
+struct rmidev_handle {
+    dev_t dev_no;
+    unsigned short address;
+    unsigned int length;
+    struct device dev;
+    struct kobject *sysfs_dir;
+    void *data;
+};
+
+struct rmidev_data {
+    int ref_count;
+    struct cdev main_dev;
+    struct class *device_class;
+    struct mutex file_mutex;
+    struct rmidev_handle *rmi_dev;
+    struct remotepanel_data *pdata;
+};
+
+static struct bin_attribute attr_data = {
+    .attr = {
+        .name = "data",
+        .mode = (S_IRUSR | S_IWUSR),
+    },
+    .size = 0,
+    .read = rmidev_sysfs_data_show,
+    .write = rmidev_sysfs_data_store,
+};
+
+static struct device_attribute attrs[] = {
+    __ATTR(open, S_IRUSR | S_IWUSR,
+            NULL,
+            rmidev_sysfs_open_store),
+    __ATTR(release, S_IRUSR | S_IWUSR,
+            NULL,
+            rmidev_sysfs_release_store),
+    __ATTR(address, S_IRUSR | S_IWUSR,
+            NULL,
+            rmidev_sysfs_address_store),
+    __ATTR(length, S_IRUSR | S_IWUSR,
+            NULL,
+            rmidev_sysfs_length_store),
+    __ATTR(attn_state, S_IRUSR | S_IWUSR,
+            rmidev_sysfs_attn_state_show,
+            NULL),
+};
+
+static int rmidev_major_num;
+
+static struct class *rmidev_device_class;
+
+static struct rmidev_handle *rmidev;
+
+static struct device *device_ptr;
+static struct delayed_work delay_work;
+
+
+static ssize_t rmidev_sysfs_data_show(struct file *data_file,
+        struct kobject *kobj, struct bin_attribute *attributes,
+        char *buf, loff_t pos, size_t count)
+{
+    int retval;
+    unsigned int data_length = rmidev->length;
+
+    if (data_length > (REG_ADDR_LIMIT - rmidev->address))
+        data_length = REG_ADDR_LIMIT - rmidev->address;
+
+    if (count < data_length) {
+        dev_err(device_ptr,
+                "%s: Not enough space (%zd bytes) in buffer\n",
+                __func__, count);
+        return -EINVAL;
+    }
+
+    if (data_length) {
+        retval = remote_rmi4_i2c_read(
+                rmidev->address,
+                (unsigned char *)buf,
+                data_length);
+        if (retval < 0) {
+            dev_err(device_ptr,
+                    "%s: Failed to read data\n",
+                    __func__);
+            return retval;
+        }
+    } else {
+        return -EINVAL;
+    }
+
+    return data_length;
+}
+
+static ssize_t rmidev_sysfs_data_store(struct file *data_file,
+        struct kobject *kobj, struct bin_attribute *attributes,
+        char *buf, loff_t pos, size_t count)
+{
+    int retval;
+    unsigned int data_length = rmidev->length;
+
+    if (data_length > (REG_ADDR_LIMIT - rmidev->address))
+        data_length = REG_ADDR_LIMIT - rmidev->address;
+
+    if (data_length) {
+        retval = remote_rmi4_i2c_write(
+                rmidev->address,
+                (unsigned char *)buf,
+                data_length);
+        if (retval < 0) {
+            dev_err(device_ptr,
+                    "%s: Failed to write data\n",
+                    __func__);
+            return retval;
+        }
+    } else {
+        return -EINVAL;
+    }
+
+    return count;
+}
+
+static ssize_t rmidev_sysfs_open_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    unsigned int input;
+
+    if (sscanf(buf, "%u", &input) != 1)
+        return -EINVAL;
+
+    if (input != 1)
+        return -EINVAL;
+
+    remote_rmi4_i2c_enable(false);
+    dev_dbg(device_ptr,
+            "%s: Attention interrupt disabled\n",
+            __func__);
+
+    return count;
+}
+
+static ssize_t rmidev_sysfs_release_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    unsigned int input;
+
+    if (sscanf(buf, "%u", &input) != 1)
+        return -EINVAL;
+
+    if (input != 1)
+        return -EINVAL;
+
+    remote_rmi4_i2c_enable(true);
+    dev_dbg(device_ptr,
+            "%s: Attention interrupt enabled\n",
+            __func__);
+
+    return count;
+}
+
+static ssize_t rmidev_sysfs_address_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    unsigned int input;
+
+    if (sscanf(buf, "%u", &input) != 1)
+        return -EINVAL;
+
+    if (input > REG_ADDR_LIMIT)
+        return -EINVAL;
+
+    rmidev->address = (unsigned short)input;
+
+    return count;
+}
+
+static ssize_t rmidev_sysfs_length_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    unsigned int input;
+
+    if (sscanf(buf, "%u", &input) != 1)
+        return -EINVAL;
+
+    if (input > REG_ADDR_LIMIT)
+        return -EINVAL;
+
+    rmidev->length = input;
+
+    return count;
+}
+
+static ssize_t rmidev_sysfs_attn_state_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+    int attn_state;
+
+    attn_state = gpio_get_value(remote_rmi4_get_irq_gpio());
+
+    return snprintf(buf, PAGE_SIZE, "%d\n", attn_state);
+}
+
+static int remote_rmi4_get_irq_gpio(void)
+{
+    struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+    return dev_data->pdata->irq_gpio;
+}
+
+static struct input_dev *remote_rmi4_get_input(void)
+{
+    struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+    return dev_data->pdata->input_dev;
+}
+
+static struct i2c_client* remote_rmi4_get_i2c_client(void)
+{
+    struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+    return dev_data->pdata->client;
+}
+
+static int remote_rmit_set_page(unsigned int address) {
+    struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+    unsigned char retry;
+    //unsigned char buf[2];
+	unsigned char *buf = kzalloc(2, GFP_KERNEL | GFP_DMA);
+    struct i2c_msg msg[] = {
+        {
+            .addr = i2c_client->addr,
+            .flags = 0,
+            .len = 2,
+            .buf = buf,
+        }
+    };
+    buf[0] = 0xff;
+    buf[1] = ((address >> 8) & 0xFF);
+
+    for (retry = 0; retry < 2; retry++) {
+        if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+            break;
+        }
+        msleep(20);
+    }
+
+    if (retry == 2) {
+	kfree(buf);
+        return -EIO;
+    }
+	kfree(buf);
+    return 0;
+}
+
+static int remote_rmit_put_page(void)
+{
+    struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+    unsigned char retry;
+    //unsigned char buf[2];
+	unsigned char *buf = kzalloc(2, GFP_KERNEL | GFP_DMA);
+    struct i2c_msg msg[] = {
+        {
+            .addr = i2c_client->addr,
+            .flags = 0,
+            .len = 2,
+            .buf = buf,
+        }
+    };
+    buf[0] = 0xff;
+    buf[1] = 0x00;
+
+    for (retry = 0; retry < 2; retry++) {
+        if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+            break;
+        }
+        msleep(20);
+    }
+
+    if (retry == 2) {
+	kfree(buf);
+        return -EIO;
+    }
+	kfree(buf);
+    return 0;
+}
+
+int remote_rmi4_i2c_read(unsigned short addr, unsigned char *data, unsigned short length)
+{
+    int retval;
+    unsigned char retry;
+    unsigned char *buf = kzalloc(1 * sizeof(char *), GFP_KERNEL | GFP_DMA);
+    struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+    struct i2c_msg msg[] = {
+        {
+            .addr = i2c_client->addr,
+            .flags = 0,
+            .len = 1,
+            .buf = buf,
+        },
+        {
+            .addr = i2c_client->addr,
+            .flags = I2C_M_RD,
+            .len = length,
+            .buf = data,
+        },
+    };
+
+    //buf = addr & 0xff;
+    buf[0] = addr & 0xff;
+
+    retval = remote_rmit_set_page(addr);
+    if (retval < 0)
+        goto exit;
+
+    for (retry = 0; retry < 2; retry++) {
+        if (i2c_transfer(i2c_client->adapter, msg, 2) == 2) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+	printk("retry is %d", retry);
+    if (retry == 2) {
+        retval = -EIO;
+    }
+
+exit:
+    remote_rmit_put_page();
+	kfree(buf);
+    return retval;
+}
+
+int remote_rmi4_i2c_write(unsigned short addr, unsigned char *data, unsigned short length)
+{
+	int retval;
+	unsigned char retry;
+   // unsigned char buf[length + 1];
+	unsigned char *buf = kzalloc((length + 1) * sizeof(char), GFP_KERNEL);
+	struct i2c_client *i2c_client = remote_rmi4_get_i2c_client();
+	struct i2c_msg msg[] = {
+		{
+		.addr = i2c_client->addr,
+		.flags = 0,
+		.len = length + 1,
+		.buf = buf,
+		}
+	};
+
+	retval = remote_rmit_set_page(addr);
+	if (retval < 0)
+		goto exit;
+
+	buf[0] = addr & 0xff;
+	memcpy(&buf[1], &data[0], length);
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+			retval = length;
+			break;
+		}
+		msleep(20);
+	}
+	msleep(20);
+	if (retry == 2)
+		retval = -EIO;
+
+exit:
+	remote_rmit_put_page();
+	kfree(buf);
+	return retval;
+}
+
+int remote_rmi4_i2c_enable(bool enable)
+{
+    struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+
+    if (enable) {
+        *(dev_data->pdata->enable_remote) = 0;
+    }else{
+        *(dev_data->pdata->enable_remote) = 1;
+    }
+    return 0 ;
+}
+
+
+/*
+ * rmidev_llseek - used to set up register address
+ *
+ * @filp: file structure for seek
+ * @off: offset
+ *   if whence == SEEK_SET,
+ *     high 16 bits: page address
+ *     low 16 bits: register address
+ *   if whence == SEEK_CUR,
+ *     offset from current position
+ *   if whence == SEEK_END,
+ *     offset from end position (0xFFFF)
+ * @whence: SEEK_SET, SEEK_CUR, or SEEK_END
+ */
+static loff_t rmidev_llseek(struct file *filp, loff_t off, int whence)
+{
+    loff_t newpos;
+    struct rmidev_data *dev_data = filp->private_data;
+
+    if (IS_ERR(dev_data)) {
+        pr_err("%s: Pointer of char device data is invalid", __func__);
+        return -EBADF;
+    }
+
+
+    mutex_lock(&(dev_data->file_mutex));
+
+    switch (whence) {
+        case SEEK_SET:
+            newpos = off;
+            break;
+        case SEEK_CUR:
+            newpos = filp->f_pos + off;
+            break;
+        case SEEK_END:
+            newpos = REG_ADDR_LIMIT + off;
+            break;
+        default:
+            newpos = -EINVAL;
+            goto clean_up;
+    }
+
+    if (newpos < 0 || newpos > REG_ADDR_LIMIT) {
+        dev_err(device_ptr,
+                "%s: New position 0x%04x is invalid\n",
+                __func__, (unsigned int)newpos);
+        newpos = -EINVAL;
+        goto clean_up;
+    }
+
+    filp->f_pos = newpos;
+
+clean_up:
+    mutex_unlock(&(dev_data->file_mutex));
+
+    return newpos;
+}
+
+/*
+ * rmidev_read: - use to read data from rmi device
+ *
+ * @filp: file structure for read
+ * @buf: user space buffer pointer
+ * @count: number of bytes to read
+ * @f_pos: offset (starting register address)
+ */
+static ssize_t rmidev_read(struct file *filp, char __user *buf,
+        size_t count, loff_t *f_pos)
+{
+    ssize_t retval;
+//unsigned char tmpbuf[count + 1];
+	unsigned char *tmpbuf;
+    struct rmidev_data *dev_data = filp->private_data;
+
+	tmpbuf = kzalloc((count + 1) * sizeof(char), GFP_KERNEL);
+    if (IS_ERR(dev_data)) {
+        pr_err("%s: Pointer of char device data is invalid", __func__);
+	kfree(tmpbuf);
+        return -EBADF;
+    }
+
+    if (count == 0) {
+	kfree(tmpbuf);
+        return 0;
+	}
+
+    if (count > (REG_ADDR_LIMIT - *f_pos))
+        count = REG_ADDR_LIMIT - *f_pos;
+
+    mutex_lock(dev_data->pdata->pmutex);
+    mutex_lock(&(dev_data->file_mutex));
+
+    retval = remote_rmi4_i2c_read(
+            *f_pos,
+            tmpbuf,
+            count);
+    if (retval < 0)
+        goto clean_up;
+
+    if (copy_to_user(buf, tmpbuf, count))
+        retval = -EFAULT;
+    else
+        *f_pos += retval;
+
+clean_up:
+    mutex_unlock(&(dev_data->file_mutex));
+    mutex_unlock(dev_data->pdata->pmutex);
+
+	kfree(tmpbuf);
+    return retval;
+}
+
+/*
+ * rmidev_write: - used to write data to rmi device
+ *
+ * @filep: file structure for write
+ * @buf: user space buffer pointer
+ * @count: number of bytes to write
+ * @f_pos: offset (starting register address)
+ */
+static ssize_t rmidev_write(struct file *filp, const char __user *buf,
+        size_t count, loff_t *f_pos)
+{
+    ssize_t retval;
+//    unsigned char tmpbuf[count + 1];
+	unsigned char *tmpbuf;
+    struct rmidev_data *dev_data = filp->private_data;
+
+	tmpbuf = kzalloc((count + 1) * sizeof(char), GFP_KERNEL);
+    if (IS_ERR(dev_data)) {
+        pr_err("%s: Pointer of char device data is invalid", __func__);
+	kfree(tmpbuf);
+        return -EBADF;
+    }
+
+    if (count == 0) {
+	kfree(tmpbuf);
+        return 0;
+	}
+
+    if (count > (REG_ADDR_LIMIT - *f_pos))
+        count = REG_ADDR_LIMIT - *f_pos;
+
+    if (copy_from_user(tmpbuf, buf, count)) {
+	kfree(tmpbuf);
+        return -EFAULT;
+	}
+    mutex_lock(dev_data->pdata->pmutex);
+    mutex_lock(&(dev_data->file_mutex));
+
+    retval = remote_rmi4_i2c_write(
+            *f_pos,
+            tmpbuf,
+            count);
+    if (retval >= 0)
+        *f_pos += retval;
+
+
+    mutex_unlock(&(dev_data->file_mutex));
+    mutex_unlock(dev_data->pdata->pmutex);
+	kfree(tmpbuf);
+
+    return retval;
+}
+
+static int rmidev_create_attr(bool create) {
+    int retval = 0;
+    unsigned char attr_count;
+    struct input_dev *input_dev = remote_rmi4_get_input();
+
+    if (!create)
+        goto err_sysfs_attrs ;
+
+    if (rmidev->sysfs_dir)
+        return 0 ;
+
+    if (!input_dev)
+        return -1;
+    /*
+       retval = gpio_export(remote_rmi4_get_irq_gpio(), false);
+       if (retval < 0) {
+       dev_err(device_ptr,
+       "%s: Failed to export attention gpio\n",
+       __func__);
+       } else {
+       retval = gpio_export_link(&(input_dev->dev),
+       "attn", remote_rmi4_get_irq_gpio());
+       if (retval < 0) {
+       dev_err(device_ptr,
+       "%s Failed to create gpio symlink\n",
+       __func__);
+       }
+       }
+     */
+    rmidev->sysfs_dir = kobject_create_and_add("rmidev",
+            &input_dev->dev.kobj);
+    if (!rmidev->sysfs_dir) {
+        dev_err(device_ptr,
+                "%s: Failed to create sysfs directory\n", __func__);
+        return -1;
+    }
+
+    retval = sysfs_create_bin_file(rmidev->sysfs_dir,
+            &attr_data);
+    if (retval < 0) {
+        dev_err(device_ptr,
+                "%s: Failed to create sysfs bin file\n",
+                __func__);
+        goto err_sysfs_bin;
+    }
+
+    for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) {
+        retval = sysfs_create_file(rmidev->sysfs_dir, &attrs[attr_count].attr);
+        if (retval < 0) {
+            dev_err(device_ptr,
+                    "%s: Failed to create sysfs attributes\n", __func__);
+            retval = -ENODEV;
+            goto err_sysfs_attrs;
+        }
+    }
+
+    return 0 ;
+
+err_sysfs_attrs:
+    if (!rmidev->sysfs_dir)
+        return 0 ;
+    for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) {
+        sysfs_remove_file(rmidev->sysfs_dir, &attrs[attr_count].attr);
+    }
+
+    sysfs_remove_bin_file(rmidev->sysfs_dir, &attr_data);
+
+err_sysfs_bin:
+    kobject_put(rmidev->sysfs_dir);
+    rmidev->sysfs_dir = NULL;
+
+    return retval;
+}
+
+/*
+ * rmidev_open: enable access to rmi device
+ * @inp: inode struture
+ * @filp: file structure
+ */
+static int rmidev_open(struct inode *inp, struct file *filp)
+{
+    int retval = 0;
+    struct rmidev_data *dev_data =
+        container_of(inp->i_cdev, struct rmidev_data, main_dev);
+
+    rmidev_create_attr(true);
+
+    filp->private_data = dev_data;
+
+    mutex_lock(&(dev_data->file_mutex));
+    *(dev_data->pdata->enable_remote) = 1;
+    //remote_rmi4_i2c_enable(false);
+    dev_dbg(device_ptr,
+            "%s: Attention interrupt disabled\n", __func__);
+    disable_irq_nosync(dev_data->pdata->irq);
+
+    if (dev_data->ref_count < 1)
+        dev_data->ref_count++;
+    else
+        retval = -EACCES;
+
+    mutex_unlock(&(dev_data->file_mutex));
+
+    return retval;
+}
+
+/*
+ * rmidev_release: - release access to rmi device
+ * @inp: inode structure
+ * @filp: file structure
+ */
+static int rmidev_release(struct inode *inp, struct file *filp)
+{
+    struct rmidev_data *dev_data =
+        container_of(inp->i_cdev, struct rmidev_data, main_dev);
+
+    rmidev_create_attr(false);
+
+    mutex_lock(&(dev_data->file_mutex));
+
+    dev_data->ref_count--;
+    if (dev_data->ref_count < 0)
+        dev_data->ref_count = 0;
+
+    remote_rmi4_i2c_enable(true);
+    dev_dbg(device_ptr,
+            "%s: Attention interrupt enabled\n", __func__);
+    enable_irq(dev_data->pdata->irq);
+    mutex_unlock(&(dev_data->file_mutex));
+
+    return 0;
+}
+
+static const struct file_operations rmidev_fops = {
+    .owner = THIS_MODULE,
+    .llseek = rmidev_llseek,
+    .read = rmidev_read,
+    .write = rmidev_write,
+    .open = rmidev_open,
+    .release = rmidev_release,
+};
+
+static void rmidev_device_cleanup(struct rmidev_data *dev_data)
+{
+    dev_t devno;
+
+    if (dev_data) {
+        devno = dev_data->main_dev.dev;
+
+        if (dev_data->device_class)
+            device_destroy(dev_data->device_class, devno);
+
+        cdev_del(&dev_data->main_dev);
+        unregister_chrdev_region(devno, 1);
+        remote_free_panel_data(dev_data->pdata);
+
+        dev_dbg(device_ptr,
+                "%s: rmidev device removed\n",  __func__);
+    }
+
+    return;
+}
+
+static char *rmi_char_devnode(struct device *dev, umode_t *mode)
+{
+    if (!mode)
+        return NULL;
+
+    *mode = (S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH);
+
+    return kasprintf(GFP_KERNEL, "rmi/%s", dev_name(dev));
+}
+
+static int rmidev_create_device_class(void)
+{
+    rmidev_device_class = class_create(THIS_MODULE, DEVICE_CLASS_NAME);
+
+    if (IS_ERR(rmidev_device_class)) {
+        pr_err("%s: Failed to create /dev/%s\n",
+                __func__, CHAR_DEVICE_NAME);
+        return -ENODEV;
+    }
+
+    rmidev_device_class->devnode = rmi_char_devnode;
+
+    return 0;
+}
+
+static void remote_rmi4_delay_work(struct work_struct *work) {
+    rmidev_create_attr(true) ;
+}
+
+struct remotepanel_data *remote_alloc_panel_data(void)
+{
+    if (rmidev)
+    {
+        pr_err("%s:remote panel data has alloc already null\n", __func__);
+        return NULL;
+    }
+
+    return kzalloc(sizeof(struct remotepanel_data), GFP_KERNEL);
+}
+
+static struct remotepanel_data *remote_free_panel_data(struct remotepanel_data *pdata)
+{
+    if (pdata)
+        kfree(pdata);
+    pdata = NULL;
+    return NULL;
+}
+
+//int rmidev_init_device(void)
+int register_remote_device(struct remotepanel_data *pdata)
+{
+    int retval;
+    dev_t dev_no;
+    struct rmidev_data *dev_data = NULL;
+
+
+    if (pdata == NULL)
+    {
+        pr_err("%s:pdata is null\n", __func__);
+        return -1;
+    }
+    if (rmidev)
+    {
+        pr_err("%s:remote device has register already null\n", __func__);
+        return -1;
+    }
+    rmidev = kzalloc(sizeof(*rmidev), GFP_KERNEL);
+    if (!rmidev) {
+        retval = -ENOMEM;
+        goto err_rmidev;
+    }
+
+    retval = rmidev_create_device_class();
+    if (retval < 0) {
+        goto err_device_class;
+    }
+
+    if (rmidev_major_num) {
+        dev_no = MKDEV(rmidev_major_num, DEV_NUMBER);
+        retval = register_chrdev_region(dev_no, 1, CHAR_DEVICE_NAME);
+        if (retval < 0) {
+            goto err_device_region;
+        }
+    } else {
+        retval = alloc_chrdev_region(&dev_no, 0, 1, CHAR_DEVICE_NAME);
+        if (retval < 0) {
+            goto err_device_region;
+        }
+
+        rmidev_major_num = MAJOR(dev_no);
+    }
+
+    dev_data = kzalloc(sizeof(*dev_data), GFP_KERNEL);
+    if (!dev_data) {
+        retval = -ENOMEM;
+        goto err_dev_data;
+    }
+
+    dev_data->pdata = pdata;
+
+    mutex_init(&dev_data->file_mutex);
+    dev_data->rmi_dev = rmidev;
+    rmidev->data = dev_data;
+
+    cdev_init(&dev_data->main_dev, &rmidev_fops);
+
+    retval = cdev_add(&dev_data->main_dev, dev_no, 1);
+    if (retval < 0) {
+        goto err_char_device;
+    }
+
+    dev_set_name(&rmidev->dev, "rmidev%d", MINOR(dev_no));
+    dev_data->device_class = rmidev_device_class;
+
+    device_ptr = device_create(dev_data->device_class, NULL, dev_no,
+            NULL, CHAR_DEVICE_NAME"%d", MINOR(dev_no));
+    if (IS_ERR(device_ptr)) {
+        dev_err(device_ptr,
+                "%s: Failed to create rmi char device\n", __func__);
+        retval = -ENODEV;
+        goto err_char_device;
+    }
+
+    INIT_DELAYED_WORK(&delay_work, remote_rmi4_delay_work);
+    schedule_delayed_work(&delay_work, msecs_to_jiffies(8*1000));
+
+    return 0;
+
+err_char_device:
+    remote_free_panel_data(dev_data->pdata);
+    rmidev_device_cleanup(dev_data);
+    kfree(dev_data);
+
+err_dev_data:
+    unregister_chrdev_region(dev_no, 1);
+
+err_device_region:
+    class_destroy(rmidev_device_class);
+
+err_device_class:
+    kfree(rmidev);
+    rmidev = NULL;
+err_rmidev:
+    return retval;
+}
+
+//void rmidev_remove_device(void)
+void unregister_remote_device(void)
+{
+    struct rmidev_data *dev_data;
+
+    if (!rmidev)
+        return;
+
+    dev_data = rmidev->data;
+    if (dev_data) {
+        rmidev_device_cleanup(dev_data);
+        kfree(dev_data);
+    }
+
+    unregister_chrdev_region(rmidev->dev_no, 1);
+
+    class_destroy(rmidev_device_class);
+
+    kfree(rmidev);
+
+    return;
+}
+
+/*
+   static int __init rmidev_module_init(void)
+   {
+   rmidev_init_device();
+
+   return 0;
+   }
+
+   static void __exit rmidev_module_exit(void)
+   {
+   rmidev_remove_device();
+
+   return;
+   }
+
+   module_init(rmidev_module_init);
+   module_exit(rmidev_module_exit);
+
+   MODULE_AUTHOR("Synaptics, Inc.");
+   MODULE_DESCRIPTION("Synaptics DSX RMI Dev Module");
+   MODULE_LICENSE("GPL v2");
+ */
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.h b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.h
new file mode 100644
index 0000000000000000000000000000000000000000..80c823fa1b35d147d0447716c118cc2f33f38d8d
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/Synaptics/synaptics_touch_panel_remote.h
@@ -0,0 +1,29 @@
+/***************************************************
+ * File:synaptics_touch_panel_remote.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             synaptics debugging tool code
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#ifndef _SYNAPTICS_REDREMOTE_H_
+#define _SYNAPTICS_REDREMOTE_H_
+struct remotepanel_data{
+    struct i2c_client *client;
+    struct input_dev *input_dev;
+    //    struct input_dev *kpd;
+    struct mutex *pmutex;
+    int irq_gpio;
+    unsigned int irq;
+    int *enable_remote;
+};
+struct remotepanel_data *remote_alloc_panel_data(void);
+int register_remote_device(struct remotepanel_data *pdata);
+void unregister_remote_device(void);
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common.h b/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common.h
new file mode 100644
index 0000000000000000000000000000000000000000..f73a8a9cc7036223f3911023eed061cd150560a6
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common.h
@@ -0,0 +1,588 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.£¬
+ * File       : touchpanel_common_driver.c
+ * Description: Source file for Touch common driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#ifndef _TOUCHPANEL_COMMON_H_
+#define _TOUCHPANEL_COMMON_H_
+
+/*********PART1:Head files**********************/
+#include <linux/input/mt.h>
+#include <linux/input.h>
+#include <linux/gpio.h>
+#include <linux/seq_file.h>
+#include <linux/proc_fs.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/i2c.h>
+#include <linux/slab.h>
+#include <linux/firmware.h>
+#include <linux/kthread.h>
+#include <asm/uaccess.h>
+#include <linux/delay.h>
+#include <linux/oneplus/boot_mode.h>
+#include <linux/workqueue.h>
+
+
+#include "util_interface/touch_interfaces.h"
+#include "tp_devices.h"
+
+#define EFTM (250)
+#define FW_UPDATE_COMPLETE_TIMEOUT  msecs_to_jiffies(40*1000)
+
+/*********PART2:Define Area**********************/
+#define TPD_USE_EINT
+#define TYPE_B_PROTOCOL
+
+#define PAGESIZE 512
+#define MAX_GESTURE_COORD 6
+
+#define UnkownGesture       0
+#define DouTap              1   // double tap
+#define UpVee               2   // V
+#define DownVee             3   // ^
+#define LeftVee             4   // >
+#define RightVee            5   // <
+#define Circle              6   // O
+#define DouSwip             7   // ||
+#define Left2RightSwip      8   // -->
+#define Right2LeftSwip      9   // <--
+#define Up2DownSwip         10  // |v
+#define Down2UpSwip         11  // |^
+#define Mgestrue            12  // M
+#define Wgestrue            13  // W
+#define SingleTap           15  // single tap
+#define Sgestrue            14  // S
+
+#define BIT0 (0x1 << 0)
+#define BIT1 (0x1 << 1)
+#define BIT2 (0x1 << 2)
+#define BIT3 (0x1 << 3)
+#define BIT4 (0x1 << 4)
+#define BIT5 (0x1 << 5)
+#define BIT6 (0x1 << 6)
+#define BIT7 (0x1 << 7)
+
+/* bit operation */
+#define SET_BIT(data, flag) ((data) |= (flag))
+#define CLR_BIT(data, flag) ((data) &= ~(flag))
+#define CHK_BIT(data, flag) ((data) & (flag))
+#define VK_TAB {KEY_MENU, KEY_HOMEPAGE, KEY_BACK, KEY_SEARCH}
+
+#define TOUCH_BIT_CHECK           0x3FF  //max support 10 point report.using for detect non-valid points
+#define MAX_FW_NAME_LENGTH        60
+#define MAX_EXTRA_NAME_LENGTH     60
+#define MAX_LIMIT_DATA_LENGTH 	  60
+
+
+#define MAX_DEVICE_VERSION_LENGTH 16
+#define MAX_DEVICE_MANU_LENGTH    16
+
+#define SYNAPTICS_PREFIX    "SY_"
+#define GOODIX_PREFIX       "GT_"
+#define FOCAL_PREFIX        "FT_"
+
+#define FW_UPDATE_DELAY        msecs_to_jiffies(2*1000)
+
+/*********PART3:Struct Area**********************/
+typedef enum {
+    TYPE_DELTA_IDLE,   /*means not in reading delta*/
+    TYPE_DELTA_BUSY,   /*reading delta data*/
+}delta_state;
+
+typedef enum {
+    TYPE_PROPERTIES = 1,   /*using board_properties*/
+    TYPE_AREA_SEPRATE,     /*using same IC (button zone &&  touch zone are seprate)*/
+    TYPE_DIFF_IC,          /*using diffrent IC (button zone &&  touch zone are seprate)*/
+    TYPE_NO_NEED,          /*No need of virtual key process*/
+}vk_type;
+
+typedef enum {
+    AREA_NOTOUCH,
+    AREA_EDGE,
+    AREA_CRITICAL,
+    AREA_NORMAL,
+    AREA_CORNER,
+}touch_area;
+
+typedef enum {
+    CORNER_TOPLEFT,      /*When Phone Face you in portrait top left corner*/
+    CORNER_TOPRIGHT,     /*When Phone Face you in portrait top right corner*/
+    CORNER_BOTTOMLEFT,   /*When Phone Face you in portrait bottom left corner*/
+    CORNER_BOTTOMRIGHT,  /*When Phone Face you in portrait 7bottom right corner*/
+}corner_type;
+
+typedef enum {
+    MODE_NORMAL,
+    MODE_SLEEP,
+    MODE_EDGE,
+    MODE_GESTURE,
+    MODE_GLOVE,
+    MODE_CHARGE,
+    MODE_GAME,
+    MODE_EARSENSE,
+    MODE_PALM_REJECTION,
+    MODE_FACE_DETECT,
+    MODE_FACE_CALIBRATE,
+    MODE_REFRESH_SWITCH,
+    MODE_TOUCH_HOLD,
+    MODE_TOUCH_AREA_SWITCH,
+    MODE_LIMIT_SWITCH,
+    MODE_GESTURE_SWITCH,
+    MODE_FINGERPRINT_TEST,
+}work_mode;
+
+typedef enum {
+    FW_NORMAL,     /*fw might update, depend on the fw id*/
+    FW_ABNORMAL,   /*fw abnormal, need update*/
+}fw_check_state;
+
+typedef enum {
+    FW_UPDATE_SUCCESS,
+    FW_NO_NEED_UPDATE,
+    FW_UPDATE_ERROR,
+    FW_UPDATE_FATAL,
+}fw_update_state;
+
+typedef enum {
+    TP_SUSPEND_EARLY_EVENT,
+    TP_SUSPEND_COMPLETE,
+    TP_RESUME_EARLY_EVENT,
+    TP_RESUME_COMPLETE,
+    TP_SPEEDUP_RESUME_COMPLETE,
+}suspend_resume_state;
+
+typedef enum IRQ_TRIGGER_REASON {
+    IRQ_TOUCH       = 0x01,
+    IRQ_GESTURE     = 0x02,
+    IRQ_BTN_KEY     = 0x04,
+    IRQ_EXCEPTION   = 0x08,
+    IRQ_FW_CONFIG   = 0x10,
+    IRQ_DATA_LOGGER = 0x20,
+    IRQ_FW_AUTO_RESET = 0x40,
+    IRQ_FACE_STATE = 0x80,
+    IRQ_IGNORE      = 0x00,
+}irq_reason;
+
+typedef enum vk_bitmap{
+    BIT_reserve    = 0x08,
+    BIT_BACK       = 0x04,
+    BIT_HOME       = 0x02,
+    BIT_MENU       = 0x01,
+}vk_bitmap;
+
+typedef enum finger_protect_status {
+    FINGER_PROTECT_TOUCH_UP,
+    FINGER_PROTECT_TOUCH_DOWN,
+    FINGER_PROTECT_NOTREADY,
+}fp_touch_state;
+
+typedef enum debug_level {
+    LEVEL_BASIC,    /*printk basic tp debug info*/
+    LEVEL_DEBUG,    /*printk all tp debug info*/
+    LEVEL_DETAIL,   /*printk tp detail log for stress test*/
+}tp_debug_level;
+
+typedef enum resume_order {
+    TP_LCD_RESUME,
+    LCD_TP_RESUME,
+}tp_resume_order;
+
+typedef enum suspend_order {
+    TP_LCD_SUSPEND,
+    LCD_TP_SUSPEND,
+}tp_suspend_order;
+
+typedef enum lcd_power {
+    LCD_POWER_OFF,
+    LCD_POWER_ON,
+}lcd_power_status;
+
+struct Coordinate {
+    int x;
+    int y;
+};
+
+typedef enum interrupt_mode {
+    BANNABLE,
+    UNBANNABLE,
+    INTERRUPT_MODE_MAX,
+}tp_interrupt_mode;
+
+typedef enum switch_mode_type {
+    SEQUENCE,
+    SINGLE,
+}tp_switch_mode;
+
+struct gesture_info {
+    uint32_t gesture_type;
+    uint32_t clockwise;
+    struct Coordinate Point_start;
+    struct Coordinate Point_end;
+    struct Coordinate Point_1st;
+    struct Coordinate Point_2nd;
+    struct Coordinate Point_3rd;
+    struct Coordinate Point_4th;
+};
+
+struct point_info {
+    uint16_t x;
+    uint16_t y;
+    uint16_t z;
+    uint8_t  width_major;
+    uint8_t  touch_major;
+    uint8_t  status;
+    touch_area type;
+};
+
+/* add haptic audio tp mask */
+struct shake_point {
+    uint16_t x;
+    uint16_t y;
+    uint8_t  status;
+};
+
+struct corner_info {
+    uint8_t id;
+    bool flag;
+    struct point_info point;
+};
+
+struct manufacture_info {
+    char *version;
+	char *manufacture;
+};
+
+struct panel_info {
+    char    *fw_name;                               /*FW name*/
+    char    *test_limit_name;                       /*test limit name*/
+    char    *extra;                                 /*for some ic, may need other information*/
+   	const char  *chip_name;                         /*chip name the panel is controlled by*/
+	const char  *project_name;						/*project_name*/
+    uint32_t TP_FW;                                 /*FW Version Read from IC*/
+    tp_dev  tp_type;
+    struct manufacture_info manufacture_info;       /*touchpanel device info*/
+};
+
+struct hw_resource {
+    //gpio
+    int id1_gpio;
+    int id2_gpio;
+    int id3_gpio;
+
+    int irq_gpio;                                   /*irq GPIO num*/
+    int reset_gpio;                                 /*Reset GPIO*/
+
+    int enable2v8_gpio;                             /*vdd_2v8 enable GPIO*/
+    int enable1v8_gpio;                             /*vcc_1v8 enable GPIO*/
+
+    //TX&&RX Num
+    int TX_NUM;
+    int RX_NUM;
+    int key_TX;                                     /*the tx num occupied by touchkey*/
+    int key_RX;                                     /*the rx num occupied by touchkey*/
+    int EARSENSE_TX_NUM;                            /*for earsense function data reading*/
+    int EARSENSE_RX_NUM;                            /*for earsense function data reading*/
+
+    //power
+    struct regulator *vdd_2v8;                      /*power 2v8*/
+    struct regulator *vcc_1v8;                      /*power 1v8*/
+    uint32_t vdd_volt;                              /*avdd specific volt*/
+
+    //pinctrl
+    struct pinctrl          *pinctrl;
+    struct pinctrl_state    *pin_set_high;
+    struct pinctrl_state    *pin_set_low;
+};
+
+struct edge_limit {
+    int limit_area;
+    int left_x1;
+    int right_x1;
+    int left_x2;
+    int right_x2;
+    int left_x3;
+    int right_x3;
+    int left_y1;
+    int right_y1;
+    int left_y2;
+    int right_y2;
+    int left_y3;
+    int right_y3;
+    touch_area in_which_area;
+};
+
+struct touch_major_limit {
+    int width_range;
+    int height_range;
+};
+
+struct button_map {
+    int width_x;                                        /*width of each key area */
+    int height_y;                                       /*height of each key area*/
+    struct Coordinate coord_menu;                       /*Menu centre coordinates*/
+    struct Coordinate coord_home;                       /*Home centre coordinates*/
+    struct Coordinate coord_back;                       /*Back centre coordinates*/
+};
+
+struct resolution_info {
+    uint32_t max_x;                                     /*touchpanel width */
+    uint32_t max_y;                                     /*touchpanel height*/
+    uint32_t LCD_WIDTH;                                 /*LCD WIDTH        */
+    uint32_t LCD_HEIGHT;                                /*LCD HEIGHT       */
+};
+
+struct esd_information {
+    bool esd_running_flag;
+    int  esd_work_time;
+    struct mutex             esd_lock;
+    struct workqueue_struct *esd_workqueue;
+    struct delayed_work      esd_check_work;
+};
+
+struct spurious_fp_touch {
+    bool fp_trigger;                                    /*thread only turn into runnning state by fingerprint kick proc/touchpanel/finger_protect_trigger*/
+    bool lcd_resume_ok;
+    bool lcd_trigger_fp_check;
+    fp_touch_state fp_touch_st;                         /*provide result to fingerprint of touch status data*/
+    struct task_struct *thread;                         /*tread use for fingerprint susprious touch check*/
+};
+
+struct register_info {
+    uint8_t reg_length;
+    uint16_t reg_addr;
+    uint8_t * reg_result;
+};
+
+struct black_gesture_test {
+    bool gesture_backup;                               /*store the gesture enable flag */
+    bool flag;                                         /* indicate do black gesture test or not*/
+    char *message;                                 /* failure information if gesture test failed */
+};
+
+struct debug_info_proc_operations;
+struct earsense_proc_operations;
+struct touchpanel_data {
+    bool register_is_16bit;                             /*register is 16bit*/
+    bool glove_mode_support;                            /*glove_mode support feature*/
+    bool black_gesture_support;                         /*black_gesture support feature*/
+    bool charger_pump_support;                          /*charger_pump support feature*/
+    bool edge_limit_support;                            /*edge_limit support feature*/
+    bool esd_handle_support;                            /*esd handle support feature*/
+    bool spurious_fp_support;                           /*avoid fingerprint spurious trrigger feature*/
+    bool gesture_test_support;                          /*indicate test black gesture or not*/
+    bool game_switch_support;                           /*indicate game switch support or not*/
+    bool ear_sense_support;                             /*touch porximity function*/
+    bool smart_gesture_support;                         /*feature used to controltouch_major report*/
+    bool face_detect_support;                           /*touch porximity function*/
+    bool lcd_refresh_rate_switch;                       /*switch lcd refresh rate 60-90hz*/
+	bool touch_hold_support;							/*touchhold function for fingerprint*/
+	bool charge_detect;
+	bool charge_detect_support;
+	bool module_id_support;								/*update firmware by lcd module id*/
+    bool i2c_ready;                                     /*i2c resume status*/
+    bool is_usb_checked;                                /*state of charger or usb*/
+    bool loading_fw;                                    /*touchpanel FW updating*/
+    bool is_incell_panel;                               /*touchpanel is incell*/
+    bool is_noflash_ic;                                 /*noflash ic*/
+    bool has_callback;                                  /*whether have callback method to invoke common*/
+    bool use_resume_notify;                             /*notify speed resume process*/
+    bool fw_update_app_support;                         /*bspFwUpdate is used*/
+    bool in_test_process;                               /*flag whether in test process*/
+    u8   vk_bitmap ;                                     /*every bit declear one state of key "reserve(keycode)|home(keycode)|menu(keycode)|back(keycode)"*/
+    vk_type  vk_type;                                   /*virtual_key type*/
+    delta_state delta_state;
+
+    uint32_t irq_flags;                                 /*irq setting flag*/
+    int irq;                                            /*irq num*/
+
+    int gesture_enable;                                 /*control state of black gesture*/
+    int palm_enable;
+    int es_enable;
+    int fd_enable;
+	int fd_calibrate;
+    int lcd_refresh_rate;
+	int	touch_hold_enable;
+	int touch_area_switch;
+    int touch_count;
+    int glove_enable;                                   /*control state of glove gesture*/
+    int limit_enable;                                   /*control state of limit ebale */
+    int limit_edge;                                     /*control state of limit edge*/
+    int limit_corner;                                /*control state of limit corner*/
+    int is_suspended;                                   /*suspend/resume flow exec flag*/
+    int corner_delay_up;                                /*corner mode flag*/
+    suspend_resume_state suspend_state;                 /*detail suspend/resume state*/
+
+    int boot_mode;                                      /*boot up mode */
+    int view_area_touched;                              /*view area touched flag*/
+    int force_update;                                   /*force update flag*/
+    int max_num;                                        /*max muti-touch num supportted*/
+    int irq_slot;                                       /*debug use, for print all finger's first touch log*/
+    int firmware_update_type;                           /*firmware_update_type: 0=check firmware version 1=force update; 2=for FAE debug*/
+
+    tp_resume_order tp_resume_order;
+    tp_suspend_order tp_suspend_order;
+    tp_interrupt_mode int_mode;                         /*whether interrupt and be disabled*/
+    tp_switch_mode mode_switch_type;                    /*used for switch mode*/
+    bool skip_reset_in_resume;                          /*some incell ic is reset by lcd reset*/
+    bool skip_suspend_operate;                          /*LCD and TP is in one chip,lcd power off in suspend at first,
+                                                         can not operate i2c when tp suspend*/
+    bool ps_status;                                     /*save ps status, ps near = 1, ps far = 0*/
+    int noise_level;                                     /*save ps status, ps near = 1, ps far = 0*/
+	bool gesture_switch;								/*gesture mode close or open gesture*/
+	bool reject_point;									/*reject point for sensor*/
+	bool fingerprint_int_test;							/*fingerprint int pin test*/
+	u8 limit_switch;									/*0 is phone up 1 is crosswise*/
+	u8 touchold_event;									/*0 is touchhold down 1 is up*/
+
+#if defined(TPD_USE_EINT)
+    struct hrtimer         timer;                       /*using polling instead of IRQ*/
+#endif
+#if defined(CONFIG_FB)
+    struct notifier_block fb_notif;                     /*register to control suspend/resume*/
+#endif
+
+    struct mutex           mutex;                       /*mutex for lock i2c related flow*/
+    struct mutex           mutex_earsense;
+    struct completion      pm_complete;                 /*completion for control suspend and resume flow*/
+    struct completion      fw_complete;                 /*completion for control fw update*/
+    struct completion      resume_complete;                 /*completion for control fw update*/
+    struct panel_info      panel_data;                  /*GPIO control(id && pinctrl && tp_type)*/
+    struct hw_resource     hw_res;                      /*hw resourc information*/
+    struct edge_limit      edge_limit;                  /*edge limit*/
+    struct button_map      button_map;                  /*virtual_key button area*/
+    struct resolution_info resolution_info;             /*resolution of touchpanel && LCD*/
+    struct gesture_info    gesture;                     /*gesture related info*/
+    struct touch_major_limit touch_major_limit;         /*used for control touch major reporting area*/
+
+    struct work_struct     speed_up_work;               /*using for speedup resume*/
+    struct workqueue_struct *speedup_resume_wq;         /*using for touchpanel speedup resume wq*/
+
+    struct work_struct     read_delta_work;               /*using for read delta*/
+    struct workqueue_struct *delta_read_wq;
+
+    struct work_struct     async_work;
+    struct workqueue_struct *async_workqueue;
+    struct work_struct     fw_update_work;             /*using for fw update*/
+	struct delayed_work 	work_read_info;				/*using for print more rawdata when probe*/
+	struct wakeup_source	source;
+
+
+    struct esd_information  esd_info;
+    struct spurious_fp_touch spuri_fp_touch;           /*spurious_finger_support*/
+
+    struct device         *dev;                         /*used for i2c->dev*/
+    struct i2c_client     *client;
+    struct spi_device     *s_client;
+    struct input_dev      *input_dev;
+    struct input_dev      *kpd_input_dev;
+
+    struct oppo_touchpanel_operations *ts_ops;          /*call_back function*/
+    struct proc_dir_entry *prEntry_tp;                  /*struct proc_dir_entry of "/proc/touchpanel"*/
+    struct proc_dir_entry *prEntry_debug_tp;                  /*struct proc_dir_entry of "/proc/touchpanel/debug_info"*/
+    struct debug_info_proc_operations  *debug_info_ops;                /*debug info data*/
+    struct earsense_proc_operations *earsense_ops;
+    struct register_info reg_info;                      /*debug node for register length*/
+    struct black_gesture_test gesture_test;             /*gesture test struct*/
+
+    void                  *chip_data;                   /*Chip Related data*/
+    void                  *private_data;                /*Reserved Private data*/
+    char                  *earsense_delta;
+};
+
+struct oppo_touchpanel_operations {
+    int  (*get_chip_info)        (void *chip_data);                                           /*return 0:success;other:failed*/
+    int  (*mode_switch)          (void *chip_data, work_mode mode, bool flag);                /*return 0:success;other:failed*/
+    int  (*get_touch_points)     (void *chip_data, struct point_info *points, int max_num);   /*return point bit-map*/
+    int  (*get_gesture_info)     (void *chip_data, struct gesture_info * gesture);            /*return 0:success;other:failed*/
+    int  (*get_vendor)           (void *chip_data, struct panel_info  *panel_data);           /*distingush which panel we use, (TRULY/OFLIM/BIEL/TPK)*/
+    int  (*reset)                (void *chip_data);                                           /*Reset Touchpanel*/
+    int  (*reinit_device)        (void *chip_data);
+    fw_check_state  (*fw_check)  (void *chip_data, struct resolution_info *resolution_info,
+                                                  struct panel_info *panel_data);             /*return < 0 :failed; 0 sucess*/
+    fw_update_state (*fw_update) (void *chip_data, const struct firmware *fw, bool force);    /*return 0 normal; return -1:update failed;*/
+    int  (*power_control)        (void *chip_data, bool enable);                              /*return 0:success;other:abnormal, need to jump out*/
+    int  (*reset_gpio_control)   (void *chip_data, bool enable);                              /*used for reset gpio*/
+    u8   (*trigger_reason)       (void *chip_data, int gesture_enable, int is_suspended);     /*clear innterrupt reg && detect irq trigger reason*/
+    u8   (*get_keycode)          (void *chip_data);                                           /*get touch-key code*/
+    int  (*esd_handle)           (void *chip_data);
+    int  (*fw_handle)            (void *chip_data);                                           /*return 0 normal; return -1:update failed;*/
+    void (*resume_prepare)       (void *chip_data);                                           /*using for operation before resume flow,
+                                                                                                eg:incell 3320 need to disable gesture to release inter pins for lcd resume*/
+    fp_touch_state (*spurious_fp_check) (void *chip_data);                                    /*spurious fingerprint check*/
+    void (*finger_proctect_data_get)    (void *chip_data);                                    /*finger protect data get*/
+    void (*data_logger_open)     (void *chip_data);                                           /*get data logger open status in probe or after fwupdate*/
+    void (*data_logger_get)      (void *chip_data);                                           /*data logger get*/
+    void (*exit_esd_mode)        (void *chip_data);                                          /*add for s4322 exit esd mode*/
+    void (*register_info_read)(void * chip_data, uint16_t register_addr, uint8_t *result, uint8_t length);   /*add for read registers*/
+    void (*write_ps_status)      (void *chip_data, int ps_status);                            /*when detect iron plate, if ps is near ,enter iron plate mode;if ps is far, can not enter; exit esd mode when ps is far*/
+    void (*specific_resume_operate) (void *chip_data);                                        /*some ic need specific opearation in resuming*/
+    int  (*get_usb_state)        (void);                                                      /*get current usb state*/
+    void (*black_screen_test)    (void *chip_data, char *msg);                                /*message of black gesture test*/
+    int  (*irq_handle_unlock)     (void *chip_info);                                          /*irq handler without mutex*/
+    int  (*async_work)           (void *chip_info);                                           /*async work*/
+    int  (*get_face_state)       (void *chip_info);                                          /*get face detect state*/
+};
+
+struct debug_info_proc_operations {
+    void (*limit_read)          (struct seq_file *s, struct touchpanel_data *ts);
+    void (*delta_read)          (struct seq_file *s, void *chip_data);
+    void (*self_delta_read)     (struct seq_file *s, void *chip_data);
+    void (*self_raw_read)       (struct seq_file *s, void *chip_data);
+    void (*baseline_read)       (struct seq_file *s, void *chip_data);
+    void (*baseline_blackscreen_read) (struct seq_file *s, void *chip_data);
+    void (*main_register_read)  (struct seq_file *s, void *chip_data);
+    void (*reserve_read)        (struct seq_file *s, void *chip_data);
+    void (*abs_doze_read)       (struct seq_file *s, void *chip_data);
+    void (*RT251)               (struct seq_file *s, void *chip_data);
+    void (*RT76)                (struct seq_file *s, void *chip_data);
+    void (*RT254)               (struct seq_file *s, void *chip_data);
+    void (*DRT)                 (struct seq_file *s, void *chip_data);
+};
+
+struct invoke_method {
+    void (*invoke_common)(void);
+    void (*async_work)(void);
+};
+
+struct earsense_proc_operations {
+    void (*rawdata_read)        (void *chip_data, char *earsense_baseline, int read_length);
+    void (*delta_read)          (void *chip_data, char *earsense_delta, int read_length);
+    void (*self_data_read)      (void *chip_data, char *earsense_self_data, int read_length);
+};
+
+/*********PART3:function or variables for other files**********************/
+extern unsigned int tp_debug ;                                                            /*using for print debug log*/
+
+struct touchpanel_data *common_touch_data_alloc(void);
+
+int  common_touch_data_free(struct touchpanel_data *pdata);
+int  register_common_touch_device(struct touchpanel_data *pdata);
+
+void tp_i2c_suspend(struct touchpanel_data *ts);
+void tp_i2c_resume (struct touchpanel_data *ts);
+
+int  tp_powercontrol_1v8(struct hw_resource *hw_res, bool on);
+int  tp_powercontrol_2v8(struct hw_resource *hw_res, bool on);
+
+void operate_mode_switch  (struct touchpanel_data *ts);
+void input_report_key_oppo(struct input_dev *dev, unsigned int code, int value);
+void esd_handle_switch(struct esd_information *esd_info, bool on);
+void clear_view_touchdown_flag(void);
+void tp_touch_btnkey_release(void);
+void tp_util_get_vendor(struct touchpanel_data *ts, struct panel_info *panel_data);
+extern bool tp_judge_ic_match(char * tp_ic_name);
+
+/* add haptic audio tp mask */
+extern int msm_drm_notifier_call_chain(unsigned long val, void *v);
+extern int gf_opticalfp_irq_handler(int event);
+
+#endif
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common_driver.c b/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common_driver.c
new file mode 100644
index 0000000000000000000000000000000000000000..e8e16036c4e96752d95628c66d14fb2aa3a048d6
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/touchpanel_common_driver.c
@@ -0,0 +1,5176 @@
+/**************************************************************
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.£¬
+ * File       : touchpanel_common_driver.c
+ * Description: Source file for Touch common driver
+ * Version   : 1.0
+ * Date        : 2016-09-02
+ * Author    : Tong.han@Bsp.Group.Tp
+ * TAG         : BSP.TP.Init
+ * ---------------- Revision History: --------------------------
+ *   <version>    <date>          < author >                            <desc>
+ * Revision 1.1, 2016-09-09, Tong.han@Bsp.Group.Tp, modify based on gerrit review result(http://gerrit.scm.adc.com:8080/#/c/223721/)
+ ****************************************************************/
+#include <asm/uaccess.h>
+#include <linux/irq.h>
+#include <linux/kernel.h>
+#include <linux/slab.h>
+#include <linux/task_work.h>
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/of_gpio.h>
+#include <linux/time.h>
+#include <linux/delay.h>
+#include <linux/regulator/consumer.h>
+#include <linux/project_info.h>
+#include <linux/time.h>
+#include <linux/pm_wakeup.h>
+
+
+#ifndef TPD_USE_EINT
+#include <linux/hrtimer.h>
+#endif
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#endif
+
+#ifdef CONFIG_DRM_MSM
+#include <linux/msm_drm_notify.h>
+#endif
+
+#include "touchpanel_common.h"
+#include "util_interface/touch_interfaces.h"
+
+/*******Part0:LOG TAG Declear************************/
+#define TPD_PRINT_POINT_NUM 150
+#define TPD_DEVICE "touchpanel"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define TPD_DEBUG(a, arg...)\
+    do{\
+        if (LEVEL_DEBUG == tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_DETAIL(a, arg...)\
+    do{\
+        if (LEVEL_BASIC != tp_debug)\
+            pr_err("[TP]"TPD_DEVICE ": " a, ##arg);\
+    }while(0)
+
+#define TPD_SPECIFIC_PRINT(count, a, arg...)\
+    do{\
+        if (count++ == TPD_PRINT_POINT_NUM || LEVEL_DEBUG == tp_debug) {\
+            TPD_INFO(TPD_DEVICE ": " a, ##arg);\
+            count = 0;\
+        }\
+    }while(0)
+
+/*******Part1:Global variables Area********************/
+unsigned int tp_debug = 0;
+unsigned int tp_register_times = 0;
+//unsigned int probe_time = 0;
+struct touchpanel_data *g_tp = NULL;
+int tp_1v8_power = 0;
+static DECLARE_WAIT_QUEUE_HEAD(waiter);
+static struct input_dev *ps_input_dev = NULL;
+static int lcd_id = 0;
+
+
+/* add haptic audio tp mask */
+struct shake_point record_point[10];
+/* add haptic audio tp mask end */
+
+int sigle_num = 0;
+struct timeval tpstart, tpend;
+int pointx[2] = {0, 0};
+int pointy[2] = {0, 0};
+#define ABS(a,b) ((a - b > 0) ? a - b : b - a)
+
+uint8_t DouTap_enable = 0;				 // double tap
+uint8_t UpVee_enable  = 0;				 // V
+uint8_t LeftVee_enable = 0; 			 // >
+uint8_t RightVee_enable = 0;			 // <
+uint8_t Circle_enable = 0;				 // O
+uint8_t DouSwip_enable = 0; 			 // ||
+uint8_t Mgestrue_enable = 0;			 // M
+uint8_t Wgestrue_enable = 0;			 // W
+uint8_t Sgestrue_enable = 0;			 // S
+uint8_t SingleTap_enable = 0;			 // single tap
+uint8_t Enable_gesture = 0;
+
+/*******Part2:declear Area********************************/
+static void speedup_resume(struct work_struct *work);
+void esd_handle_switch(struct esd_information *esd_info, bool flag);
+
+#ifdef TPD_USE_EINT
+static irqreturn_t tp_irq_thread_fn(int irq, void *dev_id);
+#endif
+
+#if defined(CONFIG_FB) || defined(CONFIG_DRM_MSM)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data);
+#endif
+
+static void tp_touch_release(struct touchpanel_data *ts);
+static void tp_btnkey_release(struct touchpanel_data *ts);
+static void tp_fw_update_work(struct work_struct *work);
+static int init_debug_info_proc(struct touchpanel_data *ts);
+static void tp_work_func(struct touchpanel_data *ts);
+__attribute__((weak)) int request_firmware_select(const struct firmware **firmware_p, const char *name, struct device *device) {return 1;}
+__attribute__((weak)) int register_devinfo(char *name, struct manufacture_info *info) {return 1;}
+__attribute__((weak)) int preconfig_power_control(struct touchpanel_data *ts) {return 0;}
+__attribute__((weak)) int reconfig_power_control(struct touchpanel_data *ts) {return 0;}
+
+static int __init get_cmdlinelcd_id(char *str)
+{
+	TPD_INFO("%s enter %s\n", __func__, str);
+	if (str) {
+		if (strncmp(str, "normal", 6) == 0) {
+			lcd_id = 0;
+		} else if (strncmp(str, "x_talk", 6) == 0) {
+			lcd_id = 1;
+		}
+	}
+	return 0;
+}
+__setup("panel_type=", get_cmdlinelcd_id);
+
+
+int check_touchirq_triggerd(void)
+{
+	int value = -1;
+
+	if (!g_tp) {
+		return 0;
+	}
+	if (!g_tp->gesture_enable) {
+		return 0;
+	}
+	value = gpio_get_value(g_tp->hw_res.irq_gpio);
+	if ((value == 0) && (g_tp->irq_flags & IRQF_TRIGGER_LOW)) {
+		return 1;
+	}
+
+	return 0;
+}
+
+/*******Part3:Function  Area********************************/
+/**
+ * operate_mode_switch - switch work mode based on current params
+ * @ts: touchpanel_data struct using for common driver
+ *
+ * switch work mode based on current params(gesture_enable, limit_enable, glove_enable)
+ * Do not care the result: Return void type
+ */
+void operate_mode_switch(struct touchpanel_data *ts)
+{
+    if (!ts->ts_ops->mode_switch) {
+        TPD_INFO("not support ts_ops->mode_switch callback\n");
+        return;
+    }
+
+    if (ts->is_suspended) {
+        if (ts->game_switch_support)
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_GAME, false);
+
+        if (ts->black_gesture_support) {
+            if (ts->gesture_enable == 1) {
+                ts->ts_ops->mode_switch(ts->chip_data, MODE_GESTURE, true);
+                if (ts->mode_switch_type == SEQUENCE)
+                    ts->ts_ops->mode_switch(ts->chip_data, MODE_NORMAL, true);
+            } else {
+                ts->ts_ops->mode_switch(ts->chip_data, MODE_GESTURE, false);
+                if (ts->mode_switch_type == SEQUENCE)
+                    ts->ts_ops->mode_switch(ts->chip_data, MODE_SLEEP, true);
+            }
+        } else
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_SLEEP, true);
+    } else {
+        if (ts->ear_sense_support) {
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_EARSENSE, ts->es_enable == 1);
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_PALM_REJECTION, ts->palm_enable);
+        }
+
+        if (ts->face_detect_support) {
+            //ts->ts_ops->mode_switch(ts->chip_data, MODE_FACE_DETECT, ts->fd_enable == 1);
+        }
+
+        if (ts->mode_switch_type == SEQUENCE) {
+            if (ts->black_gesture_support)
+                ts->ts_ops->mode_switch(ts->chip_data, MODE_GESTURE, false);
+        }
+        if (ts->edge_limit_support)
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_EDGE, ts->limit_edge);
+
+        if (ts->glove_mode_support)
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_GLOVE, ts->glove_enable);
+
+        if (ts->charger_pump_support)
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_CHARGE, ts->is_usb_checked);
+
+		if (ts->touch_hold_support)
+			ts->ts_ops->mode_switch(ts->chip_data, MODE_TOUCH_HOLD, ts->touch_hold_enable);
+
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_NORMAL, true);
+
+    }
+}
+
+static void tp_touch_down(struct touchpanel_data *ts, struct point_info points, int touch_report_num, int id)
+{
+    static int last_width_major;
+    static int point_num = 0;
+
+    if (ts->input_dev == NULL)
+        return;
+
+    input_report_key(ts->input_dev, BTN_TOUCH, 1);
+    input_report_key(ts->input_dev, BTN_TOOL_FINGER, 1);
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    if (ts->boot_mode == RECOVERY_BOOT)
+#else
+    if (ts->boot_mode == MSM_BOOT_MODE__RECOVERY)
+#endif
+    {
+        input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, points.z);
+    } else {
+        if (touch_report_num == 1) {
+            input_report_abs(ts->input_dev, ABS_MT_WIDTH_MAJOR, points.width_major);
+            last_width_major = points.width_major;
+        } else if(!(touch_report_num & 0x7f) || touch_report_num == 30) {	//avoid same point info getevent cannot report
+            //if touch_report_num == 127, every 127 points, change width_major
+            //down and keep long time, auto repeat per 5 seconds, for weixing
+            //report move event after down event, for weixing voice delay problem, 30 -> 300ms in order to avoid the intercept by shortcut
+            if (last_width_major == points.width_major) {
+                last_width_major = points.width_major + 1;
+            } else {
+                last_width_major = points.width_major;
+            }
+            input_report_abs(ts->input_dev, ABS_MT_WIDTH_MAJOR, last_width_major);
+        }
+        if (ts->smart_gesture_support && (points.touch_major > 0x12) &&\
+            (points.x > ts->touch_major_limit.width_range) && (points.x < ts->resolution_info.max_x - ts->touch_major_limit.width_range) &&\
+            (points.y > ts->touch_major_limit.height_range) && (points.y < ts->resolution_info.max_y - ts->touch_major_limit.height_range)) {
+            input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, points.touch_major);
+        }
+        if(!CHK_BIT(ts->irq_slot, (1<<id))) {
+            TPD_DETAIL("first touch point id %d [%4d %4d %4d]\n", id, points.x, points.y, points.z);
+        }
+    }
+
+    input_report_abs(ts->input_dev, ABS_MT_POSITION_X, points.x);
+    input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, points.y);
+
+    TPD_SPECIFIC_PRINT(point_num, "Touchpanel id %d :Down[%4d %4d %4d]\n", id, points.x, points.y, points.z);
+
+#ifndef TYPE_B_PROTOCOL
+    input_mt_sync(ts->input_dev);
+#endif
+}
+
+static void tp_touch_up(struct touchpanel_data *ts)
+{
+    if (ts->input_dev == NULL)
+        return;
+
+    input_report_key(ts->input_dev, BTN_TOUCH, 0);
+    input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+#ifndef TYPE_B_PROTOCOL
+    input_mt_sync(ts->input_dev);
+#endif
+}
+
+static void tp_exception_handle(struct touchpanel_data *ts)
+{
+    if (!ts->ts_ops->reset) {
+        TPD_INFO("not support ts->ts_ops->reset callback\n");
+        return;
+    }
+
+    ts->ts_ops->reset(ts->chip_data);    // after reset, all registers set to default
+    operate_mode_switch(ts);
+
+    tp_btnkey_release(ts);
+    tp_touch_release(ts);
+}
+
+static void tp_fw_auto_reset_handle(struct touchpanel_data *ts)
+{
+    TPD_INFO("%s\n", __func__);
+
+    if(ts->ts_ops->write_ps_status) {
+        ts->ts_ops->write_ps_status(ts->chip_data, ts->ps_status);
+
+        if (!ts->ps_status) {
+            if (ts->ts_ops->exit_esd_mode) {
+                ts->ts_ops->exit_esd_mode(ts->chip_data);
+            }
+        }
+    }
+
+    operate_mode_switch(ts);
+
+    tp_btnkey_release(ts);
+    tp_touch_release(ts);
+}
+
+static void tp_geture_info_transform(struct gesture_info * gesture, struct resolution_info *resolution_info)
+{
+    gesture->Point_start.x = gesture->Point_start.x * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_start.y = gesture->Point_start.y * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+    gesture->Point_end.x   = gesture->Point_end.x   * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_end.y   = gesture->Point_end.y   * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+    gesture->Point_1st.x   = gesture->Point_1st.x   * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_1st.y   = gesture->Point_1st.y   * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+    gesture->Point_2nd.x   = gesture->Point_2nd.x   * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_2nd.y   = gesture->Point_2nd.y   * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+    gesture->Point_3rd.x   = gesture->Point_3rd.x   * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_3rd.y   = gesture->Point_3rd.y   * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+    gesture->Point_4th.x   = gesture->Point_4th.x   * resolution_info->LCD_WIDTH  / (resolution_info->max_x);
+    gesture->Point_4th.y   = gesture->Point_4th.y   * resolution_info->LCD_HEIGHT / (resolution_info->max_y);
+}
+
+int sec_double_tap(struct gesture_info *gesture)
+{
+	uint32_t timeuse = 0;
+
+	if (sigle_num == 0) {
+		do_gettimeofday(&tpstart);
+		pointx[0] = gesture->Point_start.x;
+		pointy[0] = gesture->Point_start.y;
+		sigle_num ++;
+		TPD_DEBUG("first enter double tap\n");
+	} else if (sigle_num == 1) {
+		do_gettimeofday(&tpend);
+		pointx[1] = gesture->Point_start.x;
+		pointy[1] = gesture->Point_start.y;
+		sigle_num = 0;
+		timeuse = 1000000 * (tpend.tv_sec-tpstart.tv_sec)
+				+ tpend.tv_usec-tpstart.tv_usec;
+		TPD_DEBUG("timeuse = %d, distance[x] = %d, distance[y] = %d\n", timeuse, ABS(pointx[0], pointx[1]), ABS(pointy[0], pointy[1]));
+		if((ABS(pointx[0], pointx[1]) < 150) && (ABS(pointy[0], pointy[1]) < 200) && (timeuse < 800000)){
+			return 1;
+		}else {
+			TPD_DEBUG("not match double tap\n");
+			do_gettimeofday(&tpstart);
+			pointx[0] = gesture->Point_start.x;
+			pointy[0] = gesture->Point_start.y;
+			sigle_num = 1;
+		}
+	}
+	return 0;
+
+}
+
+static void tp_gesture_handle(struct touchpanel_data *ts)
+{
+    struct gesture_info gesture_info_temp;
+
+    if (!ts->ts_ops->get_gesture_info) {
+        TPD_INFO("not support ts->ts_ops->get_gesture_info callback\n");
+        return;
+    }
+
+    memset(&gesture_info_temp, 0, sizeof(struct gesture_info));
+    ts->ts_ops->get_gesture_info(ts->chip_data, &gesture_info_temp);
+    tp_geture_info_transform(&gesture_info_temp, &ts->resolution_info);
+	if (DouTap_enable) {
+		if(gesture_info_temp.gesture_type == SingleTap) {
+			if (sec_double_tap(&gesture_info_temp) == 1)
+			{
+				gesture_info_temp.gesture_type  = DouTap;
+			}else {
+				return;
+			}
+		}
+	}
+
+    TPD_INFO("detect %s gesture\n", gesture_info_temp.gesture_type == DouTap ? "double tap" :
+            gesture_info_temp.gesture_type == UpVee ? "up vee" :
+            gesture_info_temp.gesture_type == DownVee ? "down vee" :
+            gesture_info_temp.gesture_type == LeftVee ? "(>)" :
+            gesture_info_temp.gesture_type == RightVee ? "(<)" :
+            gesture_info_temp.gesture_type == Circle ? "o" :
+            gesture_info_temp.gesture_type == DouSwip ? "(||)" :
+            gesture_info_temp.gesture_type == Left2RightSwip ? "(-->)" :
+            gesture_info_temp.gesture_type == Right2LeftSwip ? "(<--)" :
+            gesture_info_temp.gesture_type == Up2DownSwip ? "up to down |" :
+            gesture_info_temp.gesture_type == Down2UpSwip ? "down to up |" :
+            gesture_info_temp.gesture_type == Mgestrue ? "(M)" :
+            gesture_info_temp.gesture_type == Sgestrue ? "(S)" :
+            gesture_info_temp.gesture_type == SingleTap ? "(single tap)" :
+            gesture_info_temp.gesture_type == Wgestrue ? "(W)" : "unknown");
+
+	if ((gesture_info_temp.gesture_type == DouTap && DouTap_enable) ||
+		(gesture_info_temp.gesture_type == UpVee && UpVee_enable) ||
+		(gesture_info_temp.gesture_type ==  LeftVee&& LeftVee_enable) ||
+		(gesture_info_temp.gesture_type == RightVee && RightVee_enable) ||
+		(gesture_info_temp.gesture_type == Circle && Circle_enable) ||
+		(gesture_info_temp.gesture_type == DouSwip && DouSwip_enable) ||
+		(gesture_info_temp.gesture_type == Mgestrue && Mgestrue_enable) ||
+		(gesture_info_temp.gesture_type == Sgestrue && Sgestrue_enable) ||
+		(gesture_info_temp.gesture_type == SingleTap && SingleTap_enable) ||
+		(gesture_info_temp.gesture_type == Wgestrue && Wgestrue_enable)) {
+        memcpy(&ts->gesture, &gesture_info_temp, sizeof(struct gesture_info));
+        input_report_key(ts->input_dev, KEY_F4, 1);
+        input_sync(ts->input_dev);
+        input_report_key(ts->input_dev, KEY_F4, 0);
+        input_sync(ts->input_dev);
+    }
+}
+
+void tp_touch_btnkey_release(void)
+{
+    struct touchpanel_data *ts = g_tp;
+
+    if (!ts) {
+        TPD_INFO("ts is NULL\n");
+        return ;
+    }
+
+    tp_touch_release(ts);
+    tp_btnkey_release(ts);
+}
+
+static void tp_touch_release(struct touchpanel_data *ts)
+{
+    int i = 0;
+
+#ifdef TYPE_B_PROTOCOL
+    for (i = 0; i < ts->max_num; i++) {
+        input_mt_slot(ts->input_dev, i);
+        input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+    }
+    input_report_key(ts->input_dev, BTN_TOUCH, 0);
+    input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+    input_sync(ts->input_dev);
+#else
+    input_report_key(ts->input_dev, BTN_TOUCH, 0);
+    input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+    input_mt_sync(ts->input_dev);
+    input_sync(ts->input_dev);
+#endif
+    TPD_INFO("release all touch point and key, clear tp touch down flag\n");
+    ts->view_area_touched = 0; //realse all touch point,must clear this flag
+    ts->touch_count = 0;
+    ts->irq_slot = 0;
+    ts->corner_delay_up = -1;
+}
+
+static bool edge_point_process(struct touchpanel_data *ts, struct point_info points)
+{
+    if (ts->limit_edge) {
+        if (points.x > ts->edge_limit.left_x2 && points.x < ts->edge_limit.right_x2) {
+            if (ts->edge_limit.in_which_area == AREA_EDGE)
+                tp_touch_release(ts);
+            ts->edge_limit.in_which_area = AREA_NORMAL;
+        } else if ((points.x > ts->edge_limit.left_x1 && points.x < ts->edge_limit.left_x2) || (points.x >ts->edge_limit.right_x2 && points.x < ts->edge_limit.right_x1)) {//area2
+            if (ts->edge_limit.in_which_area == AREA_EDGE) {
+                ts->edge_limit.in_which_area = AREA_CRITICAL;
+            }
+        } else if (points.x < ts->edge_limit.left_x1 || points.x > ts->edge_limit.right_x1) {        //area 1
+            if (ts->edge_limit.in_which_area == AREA_CRITICAL) {
+                ts->edge_limit.in_which_area = AREA_EDGE;
+                return true;
+            }
+            if (ts->edge_limit.in_which_area ==  AREA_NORMAL)
+                return true;
+
+            ts->edge_limit.in_which_area = AREA_EDGE;
+        }
+    }
+
+    return false;
+}
+
+static bool corner_point_process(struct touchpanel_data *ts, struct corner_info *corner, struct point_info *points, int i)
+{
+    int j;
+    if (ts->limit_corner) {
+        if ((ts->limit_corner & (1 << CORNER_TOPLEFT)) && (points[i].x < ts->edge_limit.left_x3 && points[i].y < ts->edge_limit.left_y1)) {
+            points[i].type  = AREA_CORNER;
+            if (ts->edge_limit.in_which_area == AREA_NORMAL)
+                return true;
+
+            corner[CORNER_TOPLEFT].id = i;
+            corner[CORNER_TOPLEFT].point = points[i];
+            corner[CORNER_TOPLEFT].flag = true;
+
+            ts->edge_limit.in_which_area = points[i].type;
+        }
+        if ((ts->limit_corner & (1 << CORNER_TOPRIGHT))  && (points[i].x < ts->edge_limit.left_x3 && points[i].y > ts->edge_limit.right_y1)) {
+            points[i].type  = AREA_CORNER;
+            if (ts->edge_limit.in_which_area == AREA_NORMAL)
+                return true;
+
+            corner[CORNER_TOPRIGHT].id = i;
+            corner[CORNER_TOPRIGHT].point = points[i];
+            corner[CORNER_TOPRIGHT].flag = true;
+
+            ts->edge_limit.in_which_area = points[i].type;
+        }
+        if ((ts->limit_corner & (1 << CORNER_BOTTOMLEFT))  && (points[i].x > ts->edge_limit.right_x3 && points[i].y < ts->edge_limit.left_y1)) {
+            points[i].type  = AREA_CORNER;
+            if (ts->edge_limit.in_which_area == AREA_NORMAL)
+                return true;
+
+            corner[CORNER_BOTTOMLEFT].id = i;
+            corner[CORNER_BOTTOMLEFT].point = points[i];
+            corner[CORNER_BOTTOMLEFT].flag = true;
+
+            ts->edge_limit.in_which_area = points[i].type;
+        }
+        if ((ts->limit_corner & (1 << CORNER_BOTTOMRIGHT))  && (points[i].x > ts->edge_limit.right_x3 && points[i].y > ts->edge_limit.right_y1)) {
+            points[i].type  = AREA_CORNER;
+            if (ts->edge_limit.in_which_area == AREA_NORMAL)
+                return true;
+
+            corner[CORNER_BOTTOMRIGHT].id = i;
+            corner[CORNER_BOTTOMRIGHT].point = points[i];
+            corner[CORNER_BOTTOMRIGHT].flag = true;
+
+            ts->edge_limit.in_which_area = points[i].type;
+        }
+
+        if (points[i].type != AREA_CORNER) {
+            if (ts->edge_limit.in_which_area == AREA_CORNER) {
+                if(ts->corner_delay_up == 0) {
+                        for (j = 0; j < 4; j++) {
+                            if (corner[j].flag) {
+#ifdef TYPE_B_PROTOCOL
+                                input_mt_slot(ts->input_dev, corner[j].id);
+                                input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+#endif
+                            }
+                        }
+                        ts->corner_delay_up = -1;
+                } else {
+                        ts->corner_delay_up = 1;
+                }
+            }
+            if(ts->corner_delay_up == -1) {
+                points[i].type = AREA_NORMAL;
+                ts->edge_limit.in_which_area = points[i].type;
+            }
+        }
+
+    }
+
+    return false;
+}
+
+static void tp_touch_handle(struct touchpanel_data *ts)
+{
+    int i = 0;
+    uint8_t finger_num = 0, touch_near_edge = 0;
+    int obj_attention = 0;
+    struct point_info *points;
+    struct corner_info corner[4];
+    static struct point_info last_point = {.x = 0, .y = 0};
+    static int touch_report_num = 0;
+    struct msm_drm_notifier notifier_data;
+    /* add haptic audio tp mask */
+    int bank;
+    int record_flag[10] = {0};
+    /* add haptic audio tp mask end */
+
+    if (!ts->ts_ops->get_touch_points) {
+        TPD_INFO("not support ts->ts_ops->get_touch_points callback\n");
+        return;
+    }
+
+    points= kzalloc(sizeof(struct point_info)*ts->max_num, GFP_KERNEL);
+    if (!points) {
+        TPD_INFO("points kzalloc failed\n");
+        return;
+    }
+    memset(corner, 0, sizeof(corner));
+    if (ts->reject_point) {/*sensor will reject point when call mode*/
+       if (ts->touch_count) {
+          #ifdef TYPE_B_PROTOCOL
+          for (i = 0; i < ts->max_num; i++) {
+               input_mt_slot(ts->input_dev, i);
+               input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+          }
+          #endif
+          input_report_key(ts->input_dev, BTN_TOUCH, 0);
+          input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+          #ifndef TYPE_B_PROTOCOL
+          input_mt_sync(ts->input_dev);
+          #endif
+          input_sync(ts->input_dev);
+       }
+       kfree(points);
+       return;
+    }
+    obj_attention = ts->ts_ops->get_touch_points(ts->chip_data, points, ts->max_num);
+    if ((obj_attention & TOUCH_BIT_CHECK) != 0) {
+        for (i = 0; i < ts->max_num; i++) {
+            if (((obj_attention & TOUCH_BIT_CHECK) >> i) & 0x01 && (points[i].status == 0)) // buf[0] == 0 is wrong point, no process
+                continue;
+            if (((obj_attention & TOUCH_BIT_CHECK) >> i) & 0x01 && (points[i].status != 0)) {
+                //Edge process before report abs
+                if (ts->edge_limit_support) {
+                    if (ts->corner_delay_up < 1 && corner_point_process(ts, corner, points, i))
+                        continue;
+                    if (edge_point_process(ts, points[i]))
+                        continue;
+                }
+#ifdef TYPE_B_PROTOCOL
+                input_mt_slot(ts->input_dev, i);
+                input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 1);
+#endif
+                touch_report_num++;
+                tp_touch_down(ts, points[i], touch_report_num, i);
+                /* add haptic audio tp mask */
+                /*bank = points[i].status;*/
+                bank = i;
+                notifier_data.data = &bank;
+                record_point[i].status = 1;
+                record_point[i].x = points[i].x;
+                record_point[i].y = points[i].y;
+                record_flag[i] = 1;
+                msm_drm_notifier_call_chain(11, &notifier_data);	//down;
+                /* add haptic audio tp mask end */
+
+                SET_BIT(ts->irq_slot, (1<<i));
+                finger_num++;
+                if (points[i].x > ts->resolution_info.max_x / 100 && points[i].x < ts->resolution_info.max_x * 99 / 100) {
+                    ts->view_area_touched = finger_num;
+                } else {
+                    touch_near_edge++;
+                }
+                /*strore  the last point data*/
+                memcpy(&last_point, &points[i], sizeof(struct point_info));
+            }
+#ifdef TYPE_B_PROTOCOL
+            else {
+                input_mt_slot(ts->input_dev, i);
+                input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+                /* add haptic audio tp mask */
+                bank = i;
+                notifier_data.data = &bank;
+                record_point[i].status = 0;
+                msm_drm_notifier_call_chain(10, &notifier_data);    //up;
+                record_flag[i] = 0;
+                /* add haptic audio tp mak */
+            }
+#endif
+        }
+
+        if(ts->corner_delay_up > -1) {
+                TPD_DETAIL("corner_delay_up is %d\n", ts->corner_delay_up);
+        }
+        ts->corner_delay_up = ts->corner_delay_up > 0 ? ts->corner_delay_up - 1 : ts->corner_delay_up;
+        if (touch_near_edge == finger_num) {        //means all the touchpoint is near the edge
+            ts->view_area_touched = 0;
+        }
+        if(ts->ear_sense_support && ts->es_enable && (finger_num > ts->touch_count)) {
+            ts->delta_state = TYPE_DELTA_BUSY;
+            queue_work(ts->delta_read_wq, &ts->read_delta_work);
+        }
+    } else {
+        finger_num = 0;
+        touch_report_num = 0;
+#ifdef TYPE_B_PROTOCOL
+        for (i = 0; i < ts->max_num; i++) {
+            input_mt_slot(ts->input_dev, i);
+            input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+            /* add haptic audio tp mask */
+            bank = i;
+            notifier_data.data = &bank;
+            record_point[i].status = 0;
+            msm_drm_notifier_call_chain(0, &notifier_data);
+            /* add haptic audio tp mask end */
+        }
+#endif
+        tp_touch_up(ts);
+        ts->view_area_touched = 0;
+        ts->irq_slot = 0;
+        ts->corner_delay_up = -1;
+        TPD_DETAIL("all touch up,view_area_touched=%d finger_num=%d\n",ts->view_area_touched, finger_num);
+        TPD_DETAIL("last point x:%d y:%d\n", last_point.x, last_point.y);
+        if (ts->edge_limit_support)
+            ts->edge_limit.in_which_area = AREA_NOTOUCH;
+    }
+    input_sync(ts->input_dev);
+    ts->touch_count = finger_num;
+	kfree(points);
+}
+
+static void tp_btnkey_release(struct touchpanel_data *ts)
+{
+    if (CHK_BIT(ts->vk_bitmap, BIT_MENU))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_MENU, 0);
+    if (CHK_BIT(ts->vk_bitmap, BIT_HOME))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_HOMEPAGE, 0);
+    if (CHK_BIT(ts->vk_bitmap, BIT_BACK))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_BACK, 0);
+    input_sync(ts->kpd_input_dev);
+}
+
+static void tp_btnkey_handle(struct touchpanel_data *ts)
+{
+    u8 touch_state = 0;
+
+    if (ts->vk_type != TYPE_AREA_SEPRATE) {
+        TPD_DEBUG("TP vk_type not proper, checktouchpanel, button-type\n");
+
+        return;
+    }
+    if (!ts->ts_ops->get_keycode) {
+        TPD_INFO("not support ts->ts_ops->get_keycode callback\n");
+
+        return;
+    }
+    touch_state = ts->ts_ops->get_keycode(ts->chip_data);
+
+    if (CHK_BIT(ts->vk_bitmap, BIT_MENU))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_MENU, CHK_BIT(touch_state, BIT_MENU));
+    if (CHK_BIT(ts->vk_bitmap, BIT_HOME))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_HOMEPAGE, CHK_BIT(touch_state, BIT_HOME));
+    if (CHK_BIT(ts->vk_bitmap, BIT_BACK))
+        input_report_key_oppo(ts->kpd_input_dev, KEY_BACK, CHK_BIT(touch_state, BIT_BACK));
+    input_sync(ts->kpd_input_dev);
+}
+
+static void tp_config_handle(struct touchpanel_data *ts)
+{
+    int ret = 0;
+    if (!ts->ts_ops->fw_handle) {
+        TPD_INFO("not support ts->ts_ops->fw_handle callback\n");
+        return;
+    }
+
+    ret = ts->ts_ops->fw_handle(ts->chip_data);
+}
+
+static void tp_datalogger_handle(struct touchpanel_data *ts)
+{
+    if (!ts->ts_ops->data_logger_get) {
+        TPD_INFO("not support ts->ts_ops->data_logger_get callback\n");
+        return;
+    }
+
+    ts->ts_ops->data_logger_get(ts->chip_data);
+}
+
+static void tp_face_detect_handle(struct touchpanel_data *ts)
+{
+    int ps_state = 0;
+
+    if (!ts->ts_ops->get_face_state) {
+        TPD_INFO("not support ts->ts_ops->get_face_state callback\n");
+        return;
+    }
+	TPD_INFO("enter tp_face_detect_handle\n");
+    ps_state = ts->ts_ops->get_face_state(ts->chip_data);
+    TPD_DETAIL("ps state: %s\n", ps_state > 0 ? "near" : "far");
+
+    input_event(ps_input_dev, EV_MSC, MSC_RAW, ps_state > 0);
+	input_sync(ps_input_dev);
+}
+
+static void tp_async_work_callback(void)
+{
+    struct touchpanel_data *ts = g_tp;
+
+    if (ts == NULL)
+        return;
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    if ((ts->boot_mode == META_BOOT || ts->boot_mode == FACTORY_BOOT))
+#else
+    if ((ts->boot_mode == MSM_BOOT_MODE__FACTORY || ts->boot_mode == MSM_BOOT_MODE__RF || ts->boot_mode == MSM_BOOT_MODE__WLAN))
+#endif
+    {
+        TPD_INFO("%s: in ftm mode, no need to call back\n", __func__);
+        return;
+    }
+
+    TPD_INFO("%s: async work\n", __func__);
+    if (ts->use_resume_notify && ts->suspend_state == TP_RESUME_COMPLETE) {
+        complete(&ts->resume_complete);
+        return;
+    }
+
+    if (ts->in_test_process) {
+        TPD_INFO("%s: In test process, do not switch mode\n", __func__);
+        return;
+    }
+
+    queue_work(ts->async_workqueue, &ts->async_work);
+}
+
+static void tp_async_work_lock(struct work_struct *work)
+{
+    struct touchpanel_data *ts = container_of(work, struct touchpanel_data, async_work);
+    mutex_lock(&ts->mutex);
+    if (ts->ts_ops->async_work) {
+        ts->ts_ops->async_work(ts->chip_data);
+    }
+    mutex_unlock(&ts->mutex);
+}
+
+static void tp_work_common_callback(void)
+{
+    struct touchpanel_data *ts;
+
+    if (g_tp == NULL)
+        return;
+    ts = g_tp;
+    tp_work_func(ts);
+}
+
+static void tp_work_func(struct touchpanel_data *ts)
+{
+    u8 cur_event = 0;
+
+    if (!ts->ts_ops->trigger_reason) {
+        TPD_INFO("not support ts_ops->trigger_reason callback\n");
+        return;
+    }
+    /*
+     *  trigger_reason:this callback determine which trigger reason should be
+     *  The value returned has some policy!
+     *  1.IRQ_EXCEPTION /IRQ_GESTURE /IRQ_IGNORE /IRQ_FW_CONFIG --->should be only reported  individually
+     *  2.IRQ_TOUCH && IRQ_BTN_KEY --->should depends on real situation && set correspond bit on trigger_reason
+     */
+    cur_event = ts->ts_ops->trigger_reason(ts->chip_data, ts->gesture_enable, ts->is_suspended);
+    if (CHK_BIT(cur_event, IRQ_TOUCH) || CHK_BIT(cur_event, IRQ_BTN_KEY) || CHK_BIT(cur_event, IRQ_DATA_LOGGER) || CHK_BIT(cur_event, IRQ_FACE_STATE)) {
+        if (CHK_BIT(cur_event, IRQ_BTN_KEY)) {
+            tp_btnkey_handle(ts);
+        }
+        if (CHK_BIT(cur_event, IRQ_TOUCH)) {
+            tp_touch_handle(ts);
+        }
+        if (CHK_BIT(cur_event, IRQ_DATA_LOGGER)) {
+            tp_datalogger_handle(ts);
+        }
+        if (CHK_BIT(cur_event, IRQ_FACE_STATE) && ts->fd_enable) {
+        TPD_INFO("cur_event is %d\n", cur_event);
+            tp_face_detect_handle(ts);
+        }
+    } else if (CHK_BIT(cur_event, IRQ_GESTURE)) {
+        tp_gesture_handle(ts);
+    } else if (CHK_BIT(cur_event, IRQ_EXCEPTION)) {
+        tp_exception_handle(ts);
+    } else if (CHK_BIT(cur_event, IRQ_FW_CONFIG)) {
+        tp_config_handle(ts);
+    }  else if (CHK_BIT(cur_event, IRQ_FW_AUTO_RESET)) {
+        tp_fw_auto_reset_handle(ts);
+    } else {
+        TPD_DEBUG("unknown irq trigger reason\n");
+    }
+}
+
+static void tp_work_func_unlock(struct touchpanel_data *ts)
+{
+    if (ts->ts_ops->irq_handle_unlock) {
+        ts->ts_ops->irq_handle_unlock(ts->chip_data);
+    }
+}
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+extern void primary_display_esd_check_enable(int enable);
+#endif
+void __attribute__((weak)) display_esd_check_enable_bytouchpanel(bool enable) {return;}
+
+static void tp_fw_update_work(struct work_struct *work)
+{
+    const struct firmware *fw = NULL;
+    int ret, fw_update_result = 0;
+    int count_tmp = 0, retry = 5;
+    char *p_node = NULL;
+    char *fw_name_fae = NULL;
+    char *postfix = "_FAE";
+    uint8_t copy_len = 0;
+
+    struct touchpanel_data *ts = container_of(work, struct touchpanel_data,
+            fw_update_work);
+
+    if (!ts->ts_ops->fw_check || !ts->ts_ops->reset) {
+        TPD_INFO("not support ts_ops->fw_check callback\n");
+        complete(&ts->fw_complete);
+        return;
+    }
+
+    TPD_INFO("%s: fw_name = %s\n", __func__, ts->panel_data.fw_name);
+
+    mutex_lock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    ts->loading_fw = true;
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, false);
+    }
+
+    display_esd_check_enable_bytouchpanel(0);
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    primary_display_esd_check_enable(0); //avoid rst pulled to low while updating
+#endif
+
+    if (ts->ts_ops->fw_update) {
+        do {
+            if(ts->firmware_update_type == 0 || ts->firmware_update_type == 1) {
+                if(ts->fw_update_app_support) {
+                        fw_name_fae = kzalloc(MAX_FW_NAME_LENGTH, GFP_KERNEL);
+                        if(fw_name_fae == NULL) {
+                                TPD_INFO("fw_name_fae kzalloc error!\n");
+                                goto EXIT;
+                        }
+                        p_node  = strstr(ts->panel_data.fw_name, ".");
+                        copy_len = p_node - ts->panel_data.fw_name;
+                        memcpy(fw_name_fae, ts->panel_data.fw_name, copy_len);
+                        strlcat(fw_name_fae, postfix, MAX_FW_NAME_LENGTH);
+                        strlcat(fw_name_fae, p_node, MAX_FW_NAME_LENGTH);
+                        TPD_INFO("fw_name_fae is %s\n", fw_name_fae);
+                        ret = request_firmware(&fw, fw_name_fae, ts->dev);
+                        if (!ret)
+                                break;
+                } else {
+                        ret = request_firmware(&fw, ts->panel_data.fw_name, ts->dev);
+                        if (!ret)
+                                break;
+                }
+            } else {
+                ret = request_firmware_select(&fw, ts->panel_data.fw_name, ts->dev);
+                if (!ret)
+                        break;
+            }
+        } while((ret < 0) && (--retry > 0));
+
+        TPD_INFO("retry times %d\n", 5 - retry);
+
+        if (!ret || ts->is_noflash_ic) {
+            do {
+                count_tmp++;
+                ret = ts->ts_ops->fw_update(ts->chip_data, fw, ts->force_update);
+                fw_update_result = ret;
+                if (ret == FW_NO_NEED_UPDATE) {
+                    break;
+                }
+
+                if(!ts->is_noflash_ic) {        //noflash update fw in reset and do bootloader reset in get_chip_info
+                        ret |= ts->ts_ops->reset(ts->chip_data);
+                        ret |= ts->ts_ops->get_chip_info(ts->chip_data);
+                }
+
+                ret |= ts->ts_ops->fw_check(ts->chip_data, &ts->resolution_info, &ts->panel_data);
+            } while((count_tmp < 2) && (ret != 0));
+
+            if(fw != NULL) {
+                release_firmware(fw);
+            }
+        } else {
+            TPD_INFO("%s: fw_name request failed %s %d\n", __func__, ts->panel_data.fw_name, ret);
+            goto EXIT;
+        }
+    }
+
+    tp_touch_release(ts);
+    tp_btnkey_release(ts);
+    operate_mode_switch(ts);
+    if (fw_update_result != FW_NO_NEED_UPDATE) {
+        if (ts->spurious_fp_support && ts->ts_ops->finger_proctect_data_get) {
+            ts->ts_ops->finger_proctect_data_get(ts->chip_data);
+        }
+        if (ts->ts_ops->data_logger_open) {
+            ts->ts_ops->data_logger_open(ts->chip_data);
+        }
+    }
+
+EXIT:
+    ts->loading_fw = false;
+
+    display_esd_check_enable_bytouchpanel(1);
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    primary_display_esd_check_enable(1); //avoid rst pulled to low while updating
+#endif
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, true);
+    }
+
+    kfree(fw_name_fae);
+    fw_name_fae = NULL;
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    mutex_unlock(&ts->mutex);
+
+    ts->force_update = 0;
+
+    complete(&ts->fw_complete); //notify to init.rc that fw update finished
+    return;
+}
+
+#ifndef TPD_USE_EINT
+static enum hrtimer_restart touchpanel_timer_func(struct hrtimer *timer)
+{
+    struct touchpanel_data *ts = container_of(timer, struct touchpanel_data, timer);
+
+    mutex_lock(&ts->mutex);
+    tp_work_func(ts);
+    mutex_unlock(&ts->mutex);
+    hrtimer_start(&ts->timer, ktime_set(0, 12500000), HRTIMER_MODE_REL);
+
+    return HRTIMER_NORESTART;
+}
+#else
+static irqreturn_t tp_irq_thread_fn(int irq, void *dev_id)
+{
+    struct touchpanel_data *ts = (struct touchpanel_data *)dev_id;
+
+    if (ts->int_mode == BANNABLE) {
+		__pm_stay_awake(&ts->source);	//avoid system enter suspend lead to i2c error
+        mutex_lock(&ts->mutex);
+        tp_work_func(ts);
+        mutex_unlock(&ts->mutex);
+		__pm_relax(&ts->source);
+    } else {
+        tp_work_func_unlock(ts);
+    }
+    return IRQ_HANDLED;
+}
+#endif
+
+/**
+ * tp_gesture_enable_flag -   expose gesture control status for other module.
+ * Return gesture_enable status.
+ */
+int tp_gesture_enable_flag(void)
+{
+    if (!g_tp || !g_tp->is_incell_panel)
+        return LCD_POWER_OFF;
+
+    return (g_tp->gesture_enable > 0)?LCD_POWER_ON: LCD_POWER_OFF;
+}
+
+/*
+*Interface for lcd to control reset pin
+*/
+int tp_control_reset_gpio(bool enable)
+{
+    if (!g_tp) {
+        return 0;
+    }
+
+    if (gpio_is_valid(g_tp->hw_res.reset_gpio)) {
+        if (g_tp->ts_ops->reset_gpio_control) {
+            g_tp->ts_ops->reset_gpio_control(g_tp->chip_data, enable);
+        }
+    }
+
+    return 0;
+}
+
+/*
+ * check_usb_state----expose to be called by charger int to get usb state
+ * @usb_state : 1 if usb checked, otherwise is 0
+*/
+void switch_usb_state(int usb_state)
+{
+    if (!g_tp) {
+        return;
+    }
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    if ((g_tp->boot_mode == META_BOOT || g_tp->boot_mode == FACTORY_BOOT))
+#else
+    if ((g_tp->boot_mode == MSM_BOOT_MODE__FACTORY || g_tp->boot_mode == MSM_BOOT_MODE__RF || g_tp->boot_mode == MSM_BOOT_MODE__WLAN))
+#endif
+    {
+        TPD_INFO("Ftm mode, do not switch usb state\n");
+        return;
+    }
+
+    if (g_tp->charger_pump_support && (g_tp->is_usb_checked != usb_state)) {
+        g_tp->is_usb_checked = !!usb_state;
+        TPD_INFO("%s: check usb state : %d, is_suspended: %d\n", __func__, usb_state, g_tp->is_suspended);
+        if (!g_tp->is_suspended && (g_tp->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+            mutex_lock(&g_tp->mutex);
+            g_tp->ts_ops->mode_switch(g_tp->chip_data, MODE_CHARGE, g_tp->is_usb_checked);
+            mutex_unlock(&g_tp->mutex);
+        }
+    }
+}
+EXPORT_SYMBOL(switch_usb_state);
+
+/*
+ *    gesture_enable = 0 : disable gesture
+ *    gesture_enable = 1 : enable gesture when ps is far away
+ *    gesture_enable = 2 : disable gesture when ps is near
+ */
+static ssize_t proc_gesture_control_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+	TPD_DEBUG("%s write argc1[0x%x],argc2[0x%x]\n",__func__,buf[0],buf[1]);
+	UpVee_enable = (buf[0] & BIT0)?1:0;
+	DouSwip_enable = (buf[0] & BIT1)?1:0;
+	LeftVee_enable = (buf[0] & BIT3)?1:0;
+	RightVee_enable = (buf[0] & BIT4)?1:0;
+	Circle_enable = (buf[0] & BIT6)?1:0;
+	DouTap_enable = (buf[0] & BIT7)?1:0;
+	Sgestrue_enable = (buf[1] & BIT0)?1:0;
+	Mgestrue_enable	= (buf[1] & BIT1)?1:0;
+	Wgestrue_enable = (buf[1] & BIT2)?1:0;
+	SingleTap_enable = (buf[1] & BIT3)?1:0;
+	Enable_gesture = (buf[1] & BIT7)?1:0;
+
+	if (UpVee_enable || DouSwip_enable || LeftVee_enable || RightVee_enable
+		|| Circle_enable || DouTap_enable || Sgestrue_enable || Mgestrue_enable
+		|| Wgestrue_enable || SingleTap_enable || Enable_gesture) {
+		value = 1;
+	} else {
+		value = 0;
+	}
+
+    mutex_lock(&ts->mutex);
+    if (ts->gesture_enable != value) {
+        ts->gesture_enable = value;
+		tp_1v8_power = ts->gesture_enable;
+        TPD_INFO("%s: gesture_enable = %d, is_suspended = %d\n", __func__, ts->gesture_enable, ts->is_suspended);
+        if (ts->is_incell_panel && (ts->suspend_state == TP_RESUME_EARLY_EVENT) && (ts->tp_resume_order == LCD_TP_RESUME)) {
+            TPD_INFO("tp will resume, no need mode_switch in incell panel\n"); /*avoid i2c error or tp rst pulled down in lcd resume*/
+        } else if (ts->is_suspended)
+            operate_mode_switch(ts);
+    }else {
+        TPD_INFO("%s: do not do same operator :%d\n", __func__, value);
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+static ssize_t proc_gesture_control_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("gesture_enable is: %d\n", ts->gesture_enable);
+    ret = sprintf(page, "%d\n", ts->gesture_enable);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static ssize_t proc_coordinate_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[PAGESIZE] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s:gesture_type = %d\n", __func__, ts->gesture.gesture_type);
+    ret = sprintf(page, "%d,%d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d\n", ts->gesture.gesture_type,
+            ts->gesture.Point_start.x, ts->gesture.Point_start.y, ts->gesture.Point_end.x, ts->gesture.Point_end.y,
+            ts->gesture.Point_1st.x,   ts->gesture.Point_1st.y,   ts->gesture.Point_2nd.x, ts->gesture.Point_2nd.y,
+            ts->gesture.Point_3rd.x,   ts->gesture.Point_3rd.y,   ts->gesture.Point_4th.x, ts->gesture.Point_4th.y,
+            ts->gesture.clockwise);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static const struct file_operations proc_gesture_control_fops = {
+    .write = proc_gesture_control_write,
+    .read  = proc_gesture_control_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static const struct file_operations proc_coordinate_fops = {
+    .read  = proc_coordinate_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_ps_status_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (!ts->ts_ops->write_ps_status) {
+        TPD_INFO("not support ts_ops->write_ps_status callback\n");
+        return count;
+    }
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    if (value > 2)
+        return count;
+
+    if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+        mutex_lock(&ts->mutex);
+        ts->ps_status = value;
+        ts->ts_ops->write_ps_status(ts->chip_data, value);
+        mutex_unlock(&ts->mutex);
+    }
+
+    return count;
+}
+
+static ssize_t proc_ps_support_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts) {
+        sprintf(page, "%d\n", -1);//no support
+    } else if (!ts->ts_ops->write_ps_status) {
+        sprintf(page, "%d\n", -1);
+    } else {
+        sprintf(page, "%d\n", 0);//support
+    }
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static const struct file_operations proc_write_ps_status_fops = {
+    .write = proc_ps_status_write,
+    .read  = proc_ps_support_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+//proc/touchpanel/game_switch_enable
+static ssize_t proc_game_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0 ;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 4) {
+        TPD_INFO("%s:count > 4\n",__func__);
+        return count;
+    }
+
+    if (!ts) {
+        TPD_INFO("%s: ts is NULL\n",__func__);
+        return count;
+    }
+
+    if (!ts->ts_ops->mode_switch) {
+        TPD_INFO("%s:not support ts_ops->mode_switch callback\n",__func__);
+        return count;
+    }
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%x", &value);
+    ts->noise_level = value;
+
+    TPD_INFO("%s: game_switch value=0x%x\n", __func__, value);
+    if (!ts->is_suspended) {
+        mutex_lock(&ts->mutex);
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_GAME, value > 0);
+        mutex_unlock(&ts->mutex);
+    } else {
+        TPD_INFO("%s: game_switch_support is_suspended.\n", __func__);
+    }
+
+    return count;
+}
+
+static ssize_t proc_game_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts) {
+        sprintf(page, "%d\n", -1);//no support
+    } else {
+        sprintf(page, "%d\n", ts->noise_level);//support
+    }
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static const struct file_operations proc_game_switch_fops = {
+    .write = proc_game_switch_write,
+    .read  = proc_game_switch_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_gesture_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0 ;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 4) {
+        TPD_INFO("%s:count > 4\n",__func__);
+        return count;
+    }
+
+    if (!ts) {
+        TPD_INFO("%s: ts is NULL\n",__func__);
+        return count;
+    }
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+	value = value - 1;		//cmd 2 is disable gesture,cmd 1 is open gesture
+    ts->gesture_switch = value;
+
+    TPD_DEBUG("%s: gesture_switch value= %d\n", __func__, value);
+    if ((ts->is_suspended == 1) && (ts->gesture_enable ==1)) {
+		__pm_stay_awake(&ts->source);	//avoid system enter suspend lead to i2c error
+        mutex_lock(&ts->mutex);
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_GESTURE_SWITCH, ts->gesture_switch);
+		mutex_unlock(&ts->mutex);
+		__pm_relax(&ts->source);
+    } else {
+        TPD_INFO("%s: gesture mode switch must be suspend.\n", __func__);
+    }
+
+    return count;
+}
+
+static ssize_t proc_gesture_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts) {
+        sprintf(page, "%d\n", -1);//no support
+    } else {
+        sprintf(page, "%d\n", ts->gesture_switch);//support
+    }
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+
+static const struct file_operations proc_gesture_switch_fops = {
+    .write = proc_gesture_switch_write,
+    .read  = proc_gesture_switch_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_reject_point_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0 ;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 4) {
+        TPD_INFO("%s:count > 4\n",__func__);
+        return count;
+    }
+
+    if (!ts) {
+        TPD_INFO("%s: ts is NULL\n",__func__);
+        return count;
+    }
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    ts->reject_point = value;
+
+    TPD_INFO("%s: ts->reject_poin = %d\n", __func__, value);
+
+    return count;
+}
+
+static ssize_t proc_reject_point_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts) {
+        sprintf(page, "%d\n", -1);//no support
+    } else {
+        sprintf(page, "%d\n", ts->reject_point);//support
+    }
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static const struct file_operations proc_reject_point_fops = {
+	.write = proc_reject_point_write,
+	.read  = proc_reject_point_read,
+	.open  = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static ssize_t proc_limit_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0 ;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 4) {
+        TPD_INFO("%s:count > 4\n",__func__);
+        return count;
+    }
+
+    if (!ts) {
+        TPD_INFO("%s: ts is NULL\n",__func__);
+        return count;
+    }
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    ts->limit_switch = value;
+
+    TPD_DEBUG("%s: ts->limit_switch = %d\n", __func__, value);
+	if (ts->is_suspended == 0) {
+		mutex_lock(&ts->mutex);
+		ts->ts_ops->mode_switch(ts->chip_data, MODE_LIMIT_SWITCH, ts->limit_switch);
+		mutex_unlock(&ts->mutex);
+	}
+    return count;
+}
+
+static ssize_t proc_limit_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts) {
+        sprintf(page, "%d\n", -1);//no support
+    } else {
+        sprintf(page, "%d\n", ts->limit_switch);//support
+    }
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static const struct file_operations proc_limit_switch_fops = {
+	.write = proc_limit_switch_write,
+	.read  = proc_limit_switch_read,
+	.open  = simple_open,
+	.owner = THIS_MODULE,
+};
+
+//proc/touchpanel/black_screen_test
+static ssize_t proc_black_screen_test_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    int retry = 20;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    TPD_INFO("%s %ld %lld\n", __func__, count, *ppos);
+
+    if (!ts || !ts->gesture_test.flag)
+        return 0;
+
+    ts->gesture_test.message = kzalloc(256, GFP_KERNEL);
+    if (!ts->gesture_test.message) {
+        TPD_INFO("failed to alloc memory\n");
+        return 0;
+    }
+
+    /* wait until tp is in sleep, then sleep 500ms to make sure tp is in gesture mode*/
+    do {
+        if (ts->is_suspended) {
+            msleep(500);
+            break;
+        }
+        msleep(200);
+    } while(--retry);
+
+    TPD_INFO("%s retry times %d\n", __func__, retry);
+    if (retry == 0 && !ts->is_suspended) {
+        sprintf(ts->gesture_test.message, "1 errors: not in sleep ");
+        goto OUT;
+    }
+
+    mutex_lock(&ts->mutex);
+    if (ts->ts_ops->black_screen_test) {
+        ts->ts_ops->black_screen_test(ts->chip_data, ts->gesture_test.message);
+    } else {
+         TPD_INFO("black_screen_test not support\n");
+         sprintf(ts->gesture_test.message, "1 errors:not support gesture test");
+    }
+    mutex_unlock(&ts->mutex);
+
+OUT:
+    ts->gesture_test.flag = false;
+    ts->gesture_enable = ts->gesture_test.gesture_backup;
+
+    ret = simple_read_from_buffer(user_buf, count, ppos, ts->gesture_test.message, strlen(ts->gesture_test.message));
+    kfree(ts->gesture_test.message);
+    return ret;
+}
+
+static ssize_t proc_black_screen_test_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2 || !ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    TPD_INFO("%s %d\n", __func__, value);
+
+    ts->gesture_test.gesture_backup = ts->gesture_enable;
+    ts->gesture_enable = true;
+    ts->gesture_test.flag = !!value;
+
+    return count;
+}
+
+static const struct file_operations proc_black_screen_test_fops = {
+    .owner = THIS_MODULE,
+    .open  = simple_open,
+    .read  = proc_black_screen_test_read,
+    .write = proc_black_screen_test_write,
+};
+
+//proc/touchpanel/irq_depth
+static ssize_t proc_get_irq_depth_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    struct irq_desc *desc = NULL;
+
+    if(!ts) {
+        return count;
+    }
+
+    desc = irq_to_desc(ts->irq);
+
+    sprintf(page, "%d\n", desc->depth);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static ssize_t proc_irq_status_write(struct file *file, const char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2 || !ts)
+        return count;
+
+    if (copy_from_user(buf, user_buf, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    TPD_INFO("%s %d, %s ts->irq=%d\n", __func__, value, value ? "enable" : "disable", ts->irq);
+
+    if (value == 1) {
+        enable_irq(ts->irq);
+    } else {
+        disable_irq_nosync(ts->irq);
+    }
+
+    return count;
+}
+
+static const struct file_operations proc_get_irq_depth_fops = {
+    .owner = THIS_MODULE,
+    .open  = simple_open,
+    .read  = proc_get_irq_depth_read,
+    .write = proc_irq_status_write,
+};
+
+static ssize_t proc_vendor_id_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if(!ts) {
+        return count;
+    }
+
+    sprintf(page, "%d\n", ts->panel_data.tp_type);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+static const struct file_operations vendor_id_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = simple_open,
+    .read  = proc_vendor_id_read,
+};
+
+static ssize_t proc_glove_control_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int ret = 0 ;
+    char buf[3] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+    if (count > 2)
+        return count;
+    if (!ts->ts_ops->mode_switch) {
+        TPD_INFO("not support ts_ops->mode_switch callback\n");
+        return count;
+    }
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &ret);
+    TPD_INFO("%s:buf = %d, ret = %d\n", __func__, *buf, ret);
+    if ((ret == 0) || (ret == 1)) {
+        mutex_lock(&ts->mutex);
+        ts->glove_enable = ret;
+        ret = ts->ts_ops->mode_switch(ts->chip_data, MODE_GLOVE, ts->glove_enable);
+        if (ret < 0) {
+            TPD_INFO("%s, Touchpanel operate mode switch failed\n", __func__);
+        }
+        mutex_unlock(&ts->mutex);
+    }
+    switch(ret) {
+        case 0:
+            TPD_DEBUG("tp_glove_func will be disable\n");
+            break;
+        case 1:
+            TPD_DEBUG("tp_glove_func will be enable\n");
+            break;
+        default:
+            TPD_DEBUG("Please enter 0 or 1 to open or close the glove function\n");
+    }
+
+    return count;
+}
+
+static ssize_t proc_glove_control_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[PAGESIZE] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_INFO("glove mode enable is: %d\n", ts->glove_enable);
+    ret = sprintf(page, "%d\n", ts->glove_enable);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static const struct file_operations proc_glove_control_fops = {
+    .write = proc_glove_control_write,
+    .read =  proc_glove_control_read,
+    .open = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t cap_vk_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf)
+{
+    struct button_map *button_map;
+    if (!g_tp)
+        return sprintf(buf, "not support");
+
+    button_map = &g_tp->button_map;
+    return sprintf(buf,
+            __stringify(EV_KEY) ":" __stringify(KEY_MENU)   ":%d:%d:%d:%d"
+            ":" __stringify(EV_KEY) ":" __stringify(KEY_HOMEPAGE)   ":%d:%d:%d:%d"
+            ":" __stringify(EV_KEY) ":" __stringify(KEY_BACK)   ":%d:%d:%d:%d"
+            "\n", button_map->coord_menu.x, button_map->coord_menu.y, button_map->width_x, button_map->height_y, \
+            button_map->coord_home.x, button_map->coord_home.y, button_map->width_x, button_map->height_y, \
+            button_map->coord_back.x, button_map->coord_back.y, button_map->width_x, button_map->height_y);
+}
+
+static struct kobj_attribute virtual_keys_attr = {
+    .attr = {
+        .name = "virtualkeys."TPD_DEVICE,
+        .mode = S_IRUGO,
+    },
+    .show = &cap_vk_show,
+};
+
+static struct attribute *properties_attrs[] = {
+    &virtual_keys_attr.attr,
+    NULL
+};
+
+static struct attribute_group properties_attr_group = {
+    .attrs = properties_attrs,
+};
+
+static ssize_t proc_debug_control_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
+{
+    uint8_t ret = 0;
+    char page[PAGESIZE];
+
+    TPD_INFO("%s: tp_debug = %d.\n", __func__, tp_debug);
+    sprintf(page, "%d", tp_debug);
+    ret = simple_read_from_buffer(buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static ssize_t proc_debug_control_write(struct file *file, const char __user *buf, size_t count, loff_t *lo)
+{
+    int tmp = 0;
+        char buffer[4] = {0};
+
+        if (count > 2) {
+                return count;
+        }
+
+        if (copy_from_user(buffer, buf, count)) {
+                TPD_INFO("%s: read proc input error.\n", __func__);
+                return count;
+        }
+
+        if (1 == sscanf(buffer, "%d", &tmp)) {
+        tp_debug = tmp;
+    } else {
+        TPD_DEBUG("invalid content: '%s', length = %zd\n", buf, count);
+    }
+
+    return count;
+}
+
+static const struct file_operations proc_debug_control_ops =
+{
+    .write = proc_debug_control_write,
+    .read  = proc_debug_control_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_limit_area_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    ssize_t ret = 0;
+    char page[PAGESIZE];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+    TPD_DEBUG("limit_area is: %d\n", ts->edge_limit.limit_area);
+    ret = sprintf(page, "limit_area = %d left_x1 = %d right_x1 = %d left_x2 = %d right_x2 = %d left_x3 = %d right_x3 = %d left_y1 = %d right_y1 = %d left_y2 = %d right_y2 = %d left_y3 = %d right_y3 = %d\n",
+            ts->edge_limit.limit_area, ts->edge_limit.left_x1, ts->edge_limit.right_x1, ts->edge_limit.left_x2, ts->edge_limit.right_x2, ts->edge_limit.left_x3, ts->edge_limit.right_x3,
+            ts->edge_limit.left_y1, ts->edge_limit.right_y1, ts->edge_limit.left_y2, ts->edge_limit.right_y2, ts->edge_limit.left_y3, ts->edge_limit.right_y3);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static ssize_t proc_limit_area_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    char buf[8];
+    int temp;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_DEBUG("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    sscanf(buf, "%d", &temp);
+    if (temp < 0 || temp > 10)
+        return count;
+
+    ts->edge_limit.limit_area = temp;
+    ts->edge_limit.left_x1    = (ts->edge_limit.limit_area*1000)/100;
+    ts->edge_limit.right_x1   = ts->resolution_info.LCD_WIDTH - ts->edge_limit.left_x1;
+    ts->edge_limit.left_x2    = 2 * ts->edge_limit.left_x1;
+    ts->edge_limit.right_x2   = ts->resolution_info.LCD_WIDTH - (2 * ts->edge_limit.left_x1);
+    ts->edge_limit.left_x3    = 5 * ts->edge_limit.left_x1;
+    ts->edge_limit.right_x3   = ts->resolution_info.LCD_WIDTH - (5 * ts->edge_limit.left_x1);
+
+    TPD_INFO("limit_area = %d; left_x1 = %d; right_x1 = %d; left_x2 = %d; right_x2 = %d; left_x3 = %d; right_x3 = %d\n",
+           ts->edge_limit.limit_area, ts->edge_limit.left_x1, ts->edge_limit.right_x1, ts->edge_limit.left_x2, ts->edge_limit.right_x2, ts->edge_limit.left_x3, ts->edge_limit.right_x3);
+
+    ts->edge_limit.left_y1    = (ts->edge_limit.limit_area*1000)/100;
+    ts->edge_limit.right_y1   = ts->resolution_info.LCD_HEIGHT - ts->edge_limit.left_y1;
+    ts->edge_limit.left_y2    = 2 * ts->edge_limit.left_y1;
+    ts->edge_limit.right_y2   = ts->resolution_info.LCD_HEIGHT - (2 * ts->edge_limit.left_y1);
+    ts->edge_limit.left_y3    = 5 * ts->edge_limit.left_y1;
+    ts->edge_limit.right_y3   = ts->resolution_info.LCD_HEIGHT - (5 * ts->edge_limit.left_y1);
+
+    TPD_INFO("limit_area = %d; left_y1 = %d; right_y1 = %d; left_y2 = %d; right_y2 = %d; left_y3 = %d; right_y3 = %d\n",
+            ts->edge_limit.limit_area, ts->edge_limit.left_y1, ts->edge_limit.right_y1, ts->edge_limit.left_y2, ts->edge_limit.right_y2, ts->edge_limit.left_y3, ts->edge_limit.right_y3);
+
+    return count;
+}
+
+static const struct file_operations proc_limit_area_ops =
+{
+    .read  = proc_limit_area_read,
+    .write = proc_limit_area_write,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_limit_control_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    ssize_t ret = 0;
+    char page[PAGESIZE];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_INFO("limit_enable is: 0x%x, ts->limit_edge = 0x%x, ts->limit_corner = 0x%x\n", ts->limit_enable, ts->limit_edge, ts->limit_corner);
+    ret = sprintf(page, "%d\n", ts->limit_enable);
+
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static ssize_t proc_limit_control_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    char buf[8] = {0};
+    int ret, temp;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    if (count > 3)
+        count = 3;
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_DEBUG("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    sscanf(buf, "%x", &temp);
+    if (temp > 0x1F) {
+        TPD_INFO("%s: temp = 0x%x > 0x1F \n", __func__, temp);
+        return count;
+    }
+
+    mutex_lock(&ts->mutex);
+    ts->limit_enable = temp;
+    ts->limit_edge = ts->limit_enable & 1;
+    ts->limit_corner = ts->limit_enable >> 1;
+    TPD_INFO("%s: limit_enable = 0x%x, ts->limit_edge = 0x%x, ts->limit_corner=0x%x\n", __func__, ts->limit_enable, ts->limit_edge, ts->limit_corner);
+
+    if (ts->is_suspended == 0) {
+        ret = ts->ts_ops->mode_switch(ts->chip_data, MODE_EDGE, ts->limit_edge);
+        if (ret < 0) {
+            TPD_INFO("%s, Touchpanel operate mode switch failed\n", __func__);
+        }
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+static const struct file_operations proc_limit_control_ops =
+{
+    .read  = proc_limit_control_read,
+    .write = proc_limit_control_write,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_fw_update_write(struct file *file, const char __user *page, size_t size, loff_t *lo)
+{
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    int val = 0;
+    int ret = 0;
+    char buf[4] = {0};
+    if (!ts)
+        return size;
+    if (size > 2)
+        return size;
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+    if (ts->boot_mode == KERNEL_POWER_OFF_CHARGING_BOOT)
+#else
+    if (ts->boot_mode == MSM_BOOT_MODE__CHARGE)
+#endif
+    {
+        TPD_INFO("boot mode is MSM_BOOT_MODE__CHARGE,not need update tp firmware\n");
+        return size;
+    }
+
+    if (copy_from_user(buf, page, size)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return size;
+    }
+
+    sscanf(buf, "%d", &val);
+    ts->firmware_update_type = val;
+    if (!ts->force_update && ts->firmware_update_type != 2)
+        ts->force_update = !!val;
+
+    schedule_work(&ts->fw_update_work);
+
+    ret = wait_for_completion_killable_timeout(&ts->fw_complete, FW_UPDATE_COMPLETE_TIMEOUT);
+    if (ret < 0) {
+        TPD_INFO("kill signal interrupt\n");
+    }
+
+    TPD_INFO("fw update finished\n");
+    return size;
+}
+
+
+
+static const struct file_operations proc_fw_update_ops =
+{
+    .write = proc_fw_update_write,
+    .open = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_finger_protect_result_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    uint8_t ret = 0;
+    char page[16] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    if(!ts)
+        return 0;
+
+    if(ts->spuri_fp_touch.fp_touch_st == FINGER_PROTECT_TOUCH_UP || ts->spuri_fp_touch.fp_touch_st == FINGER_PROTECT_TOUCH_DOWN)
+        TPD_INFO("%s report_finger_protect = %d\n", __func__, ts->spuri_fp_touch.fp_touch_st);
+    ret = sprintf(page, "%d\n", ts->spuri_fp_touch.fp_touch_st);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    return ret;
+}
+
+
+static const struct file_operations proc_finger_protect_result= {
+    .read  =  proc_finger_protect_result_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_finger_protect_trigger_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int op = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+        if (count > 2) {
+                return count;
+        }
+        if (!ts) {
+                return count;
+        }
+
+        if (copy_from_user(buf, buffer, count)) {
+                TPD_INFO("%s: read proc input error.\n", __func__);
+                return count;
+        }
+
+        if (1 == sscanf(buf, "%d", &op)) {
+        if (op == 1) {
+            ts->spuri_fp_touch.fp_trigger= true;
+            ts->spuri_fp_touch.fp_touch_st = FINGER_PROTECT_NOTREADY;
+            TPD_INFO("%s : %d\n",__func__,__LINE__);
+            wake_up_interruptible(&waiter);
+        }
+    } else {
+        TPD_INFO("invalid content: '%s', length = %zd\n", buffer, count);
+        return -EINVAL;
+    }
+
+    return count;
+}
+
+static const struct file_operations proc_finger_protect_trigger= {
+    .write = proc_finger_protect_trigger_write,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+void lcd_wakeup_finger_protect(bool wakeup)
+{
+    TPD_INFO("%s wakeup=%d\n",__func__,wakeup);
+    if (g_tp != NULL) {
+        if (g_tp->spuri_fp_touch.lcd_trigger_fp_check) {
+            if(wakeup) {
+                g_tp->spuri_fp_touch.lcd_resume_ok = true;
+                wake_up_interruptible(&waiter);
+            }
+            else {
+                mutex_lock(&g_tp->mutex);
+                g_tp->spuri_fp_touch.lcd_resume_ok = false;
+                mutex_unlock(&g_tp->mutex);
+            }
+        }
+    }
+}
+
+static int finger_protect_handler(void *data)
+{
+    struct touchpanel_data *ts = (struct touchpanel_data *)data;
+    if (!ts) {
+        TPD_INFO("ts is null should nerver get here!\n");
+        return 0;
+    };
+    if (!ts->ts_ops->spurious_fp_check) {
+        TPD_INFO("not support spurious_fp_check call back\n");
+        return 0;
+    }
+
+    do {
+        if (ts->spuri_fp_touch.lcd_trigger_fp_check)
+            wait_event_interruptible(waiter, ts->spuri_fp_touch.fp_trigger && ts->i2c_ready && ts->spuri_fp_touch.lcd_resume_ok);
+        else
+            wait_event_interruptible(waiter, ts->spuri_fp_touch.fp_trigger && ts->i2c_ready);
+        ts->spuri_fp_touch.fp_trigger = false;
+        ts->spuri_fp_touch.fp_touch_st = FINGER_PROTECT_NOTREADY;
+
+        mutex_lock(&ts->mutex);
+        if (g_tp->spuri_fp_touch.lcd_trigger_fp_check && !g_tp->spuri_fp_touch.lcd_resume_ok) {
+            TPD_INFO("LCD is suspend, can not detect finger touch in incell panel\n");
+            mutex_unlock(&ts->mutex);
+            continue;
+        }
+
+        ts->spuri_fp_touch.fp_touch_st = ts->ts_ops->spurious_fp_check(ts->chip_data);
+        if (ts->view_area_touched) {
+            TPD_INFO("%s tp touch down,clear flag\n",__func__);
+            ts->view_area_touched = 0;
+        }
+        operate_mode_switch(ts);
+        mutex_unlock(&ts->mutex);
+    } while (!kthread_should_stop());
+    return 0;
+}
+
+//proc/touchpanel/oppo_register_info node use info:
+//first choose register_add and lenght, example: echo 000e,1 > oppo_register_info
+//second read: cat oppo_register_info
+static ssize_t proc_register_info_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    int i = 0;
+    ssize_t num_read_chars = 0;
+    char page[256] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    if (ts->reg_info.reg_length < 1 || ts->reg_info.reg_length > 9) {
+        TPD_INFO("ts->reg_info.reg_length error!\n");
+        return count;
+    }
+    ts->reg_info.reg_result = kzalloc(ts->reg_info.reg_length * (sizeof(uint16_t)), GFP_KERNEL);
+    if (!ts->reg_info.reg_result) {
+        TPD_INFO("ts->reg_info.reg_result kzalloc error\n");
+        return count;
+    }
+
+    if (ts->ts_ops->register_info_read) {
+        mutex_lock(&ts->mutex);
+        ts->ts_ops->register_info_read(ts->chip_data, ts->reg_info.reg_addr, ts->reg_info.reg_result, ts->reg_info.reg_length);
+        mutex_unlock(&ts->mutex);
+        for(i = 0; i < ts->reg_info.reg_length; i++) {
+            num_read_chars += sprintf(&(page[num_read_chars]), "reg_addr(0x%x) = 0x%x\n", ts->reg_info.reg_addr, ts->reg_info.reg_result[i]);
+        }
+        ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+    }
+
+    kfree(ts->reg_info.reg_result);
+    return ret;
+}
+
+//write info: echo 000e,1 > oppo_register_info
+static ssize_t proc_register_info_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int addr = 0, length = 0;
+    char buf[16] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 7) {
+        TPD_INFO("%s count = %ld\n", __func__, count);
+        return count;
+    }
+    if (!ts) {
+        TPD_INFO("ts not exist!\n");
+        return count;
+    }
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    sscanf(buf, "%x,%d", &addr, &length);
+    ts->reg_info.reg_addr = (uint16_t)addr;
+    ts->reg_info.reg_length = (uint16_t)length;
+    TPD_INFO("ts->reg_info.reg_addr = 0x%x, ts->reg_info.reg_lenght = %d\n", ts->reg_info.reg_addr, ts->reg_info.reg_length);
+
+    return count;
+}
+
+
+static const struct file_operations proc_register_info_fops = {
+    .owner = THIS_MODULE,
+    .open  = simple_open,
+    .read  = proc_register_info_read,
+    .write = proc_register_info_write,
+};
+
+static ssize_t proc_incell_panel_info_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    uint8_t ret = 0;
+    char page[32];
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    sprintf(page, "%d", ts->is_incell_panel);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static const struct file_operations proc_incell_panel_fops = {
+    .owner = THIS_MODULE,
+    .open = simple_open,
+    .read = proc_incell_panel_info_read,
+};
+
+/**
+ * init_touchpanel_proc - Using for create proc interface
+ * @ts: touchpanel_data struct using for common driver
+ *
+ * we need to set touchpanel_data struct as private_data to those file_inode
+ * Returning zero(success) or negative errno(failed)
+ */
+static ssize_t sec_update_fw_store(struct device *dev, struct device_attribute *attr, const char *buffer, size_t size)
+{
+	struct touchpanel_data *ts = dev_get_drvdata(dev);
+	int val;
+	int ret = 0;
+
+	if (!ts)
+		return size;
+	if (size > 2)
+		return size;
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+	if (ts->boot_mode == KERNEL_POWER_OFF_CHARGING_BOOT)
+#else
+	if (ts->boot_mode == MSM_BOOT_MODE__CHARGE)
+#endif
+	{
+		TPD_INFO("boot mode is MSM_BOOT_MODE__CHARGE,not need update tp firmware\n");
+		return size;
+	}
+
+	ret = kstrtoint(buffer, 10, &val);
+	if (ret != 0) {
+		TPD_INFO("invalid content: '%s', length = %zd\n", buffer, size);
+		return ret;
+	}
+	ts->firmware_update_type = val;
+	if (!ts->force_update && ts->firmware_update_type != 2)
+		ts->force_update = !!val;
+
+	schedule_work(&ts->fw_update_work);
+
+	ret = wait_for_completion_killable_timeout(&ts->fw_complete, FW_UPDATE_COMPLETE_TIMEOUT);
+	if (ret < 0) {
+		TPD_INFO("kill signal interrupt\n");
+	}
+
+	TPD_INFO("fw update finished\n");
+	return size;
+
+}
+static ssize_t sec_update_fw_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct touchpanel_data *ts = dev_get_drvdata(dev);
+	return snprintf(buf, 2, "%d\n", ts->loading_fw);
+}
+
+static DEVICE_ATTR(tp_fw_update, 0644, sec_update_fw_show, sec_update_fw_store);
+
+static int init_touchpanel_proc(struct touchpanel_data *ts)
+{
+    int ret = 0;
+    struct proc_dir_entry *prEntry_tp = NULL;
+    struct proc_dir_entry *prEntry_tmp = NULL;
+
+    TPD_INFO("%s entry\n", __func__);
+
+    //proc files-step1:/proc/devinfo/tp  (touchpanel device info)
+    if(ts->fw_update_app_support) {
+        register_devinfo("tp", &ts->panel_data.manufacture_info);
+    }	
+
+	if (device_create_file(&ts->client->dev, &dev_attr_tp_fw_update)) {
+		TPD_INFO("driver_create_file failt\n");
+		ret = -ENOMEM;
+	}
+    //proc files-step2:/proc/touchpanel
+    prEntry_tp = proc_mkdir("touchpanel", NULL);
+    if (prEntry_tp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create TP proc entry\n", __func__);
+    }
+
+    //proc files-step2-1:/proc/touchpanel/tp_debug_log_level (log control interface)
+    prEntry_tmp = proc_create("tp_debug_log", 0644, prEntry_tp, &proc_debug_control_ops);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files-step2-2:/proc/touchpanel/oppo_tp_fw_update (FW update interface)
+    prEntry_tmp = proc_create_data("tp_fw_update", 0644, prEntry_tp, &proc_fw_update_ops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files-step2-3:/proc/touchpanel/oppo_tp_fw_update (edge limit control interface)
+    if (ts->edge_limit_support) {
+        prEntry_tmp = proc_create_data("oppo_tp_limit_area", 0664, prEntry_tp, &proc_limit_area_ops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        prEntry_tmp = proc_create_data("oppo_tp_limit_enable", 0664, prEntry_tp, &proc_limit_control_ops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    //proc files-step2-4:/proc/touchpanel/double_tap_enable (black gesture related interface)
+    if (ts->black_gesture_support) {
+        prEntry_tmp = proc_create_data("gesture_enable", 0666, prEntry_tp, &proc_gesture_control_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        prEntry_tmp = proc_create_data("coordinate", 0444, prEntry_tp, &proc_coordinate_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    //proc files-step2-5:/proc/touchpanel/glove_mode_enable (Glove mode related interface)
+    if (ts->glove_mode_support) {
+        prEntry_tmp = proc_create_data("glove_mode_enable", 0666, prEntry_tp, &proc_glove_control_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    //proc files-step2-6:/proc/touchpanel/finger_protect_result
+    if (ts->spurious_fp_support) {
+        prEntry_tmp = proc_create_data("finger_protect_result", 0666, prEntry_tp, &proc_finger_protect_result, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        prEntry_tmp = proc_create_data("finger_protect_trigger", 0666, prEntry_tp, &proc_finger_protect_trigger, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    //proc files-step2-7:/proc/touchpanel/oppo_register_info
+    prEntry_tmp = proc_create_data("oppo_register_info", 0664, prEntry_tp, &proc_register_info_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    prEntry_tmp = proc_create_data("ps_status", 0666, prEntry_tp, &proc_write_ps_status_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+
+    //proc files-step2-8:/proc/touchpanel/incell_panel
+    if (ts->is_incell_panel) {
+        prEntry_tmp = proc_create_data("incell_panel", 0664, prEntry_tp, &proc_incell_panel_fops, ts);
+    }
+
+    if (ts->gesture_test_support) {
+        prEntry_tmp = proc_create_data("black_screen_test", 0666, prEntry_tp, &proc_black_screen_test_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    //proc file-step2-9:/proc/touchpanel/irq_depth
+    prEntry_tmp = proc_create_data("irq_depth", 0666, prEntry_tp, &proc_get_irq_depth_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc file-step2-10:/proc/touchpanel/vendor_id
+    prEntry_tmp = proc_create_data("vendor_id", 0444, prEntry_tp, &vendor_id_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    //proc files-step2-3:/proc/touchpanel/game_switch_enable (edge limit control interface)
+    if (ts->game_switch_support) {
+        prEntry_tmp = proc_create_data("game_switch_enable", 0666, prEntry_tp, &proc_game_switch_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+	prEntry_tmp = proc_create_data("gesture_switch", 0666, prEntry_tp, &proc_gesture_switch_fops, ts);
+	if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+	}
+
+	prEntry_tmp = proc_create_data("reject_point", 0666, prEntry_tp, &proc_reject_point_fops, ts);
+	if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+	}
+
+	prEntry_tmp = proc_create_data("tpedge_limit_enable", 0666, prEntry_tp, &proc_limit_switch_fops, ts);
+	if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+	}
+
+    ts->prEntry_tp = prEntry_tp;
+
+    //create debug_info node
+    init_debug_info_proc(ts);
+
+    return ret;
+}
+
+//proc/touchpanel/debug_info/baseline
+static int tp_baseline_debug_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)(ts->debug_info_ops);
+    if (!debug_info_ops) {
+        TPD_INFO("debug_info_ops==NULL");
+        return 0;
+    }
+    if (!debug_info_ops->baseline_read && !debug_info_ops->baseline_blackscreen_read) {
+        seq_printf(s, "Not support baseline proc node\n");
+        return 0;
+    }
+    if ((ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) && (1 != ts->gesture_enable)) {
+        seq_printf(s, "Not in resume over or gesture state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    if (ts->is_suspended && ts->gesture_enable) {
+        if (debug_info_ops->baseline_blackscreen_read) {
+            debug_info_ops->baseline_blackscreen_read(s, ts->chip_data);
+        }
+    } else {
+        if (debug_info_ops->baseline_read) {
+            debug_info_ops->baseline_read(s, ts->chip_data);
+        }
+    }
+
+    //step6: return to normal mode
+    ts->ts_ops->reset(ts->chip_data);
+    operate_mode_switch(ts);
+
+    mutex_unlock(&ts->mutex);
+
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+
+}
+
+static int data_baseline_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_baseline_debug_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_baseline_data_proc_fops = {
+    .owner = THIS_MODULE,
+    .open = data_baseline_open,
+    .read = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/delta
+static int tp_delta_debug_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->delta_read) {
+        seq_printf(s, "Not support delta proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    debug_info_ops->delta_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int data_delta_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_delta_debug_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_delta_data_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = data_delta_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/self_delta
+static int tp_self_delta_debug_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->self_delta_read) {
+        seq_printf(s, "Not support self_delta proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    debug_info_ops->self_delta_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int data_self_delta_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_self_delta_debug_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_self_delta_data_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = data_self_delta_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/self_raw
+static int tp_self_raw_debug_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->self_raw_read) {
+        seq_printf(s, "Not support self_raw proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    debug_info_ops->self_raw_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int data_self_raw_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_self_raw_debug_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_self_raw_data_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = data_self_raw_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/main_register
+static int tp_main_register_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->main_register_read) {
+        seq_printf(s, "Not support main_register proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    seq_printf(s, "es_enable:%d\n", ts->es_enable);
+    seq_printf(s, "touch_count:%d\n", ts->touch_count);
+    debug_info_ops->main_register_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int main_register_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_main_register_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_main_register_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = main_register_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/reserve
+static int tp_reserve_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->reserve_read) {
+        seq_printf(s, "Not support main_register proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    debug_info_ops->reserve_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int reserve_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_reserve_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_reserve_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = reserve_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/data_limit
+static int tp_limit_data_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->limit_read) {
+        seq_printf(s, "Not support limit_data proc node\n");
+        return 0;
+    }
+    debug_info_ops->limit_read(s, ts);
+
+    return 0;
+}
+
+static int limit_data_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_limit_data_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_limit_data_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = limit_data_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//proc/touchpanel/debug_info/abs_doze
+static int tp_abs_doze_read_func(struct seq_file *s, void *v)
+{
+    struct touchpanel_data *ts = s->private;
+    struct debug_info_proc_operations *debug_info_ops;
+
+    if (!ts)
+        return 0;
+    debug_info_ops = (struct debug_info_proc_operations *)ts->debug_info_ops;
+
+    if (!debug_info_ops)
+        return 0;
+    if (!debug_info_ops->abs_doze_read) {
+        seq_printf(s, "Not support main_register proc node\n");
+        return 0;
+    }
+    if (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE) {
+        seq_printf(s, "Not in resume over state\n");
+        return 0;
+    }
+
+    if (ts->int_mode == BANNABLE) {
+        disable_irq_nosync(ts->irq);
+    }
+    mutex_lock(&ts->mutex);
+    debug_info_ops->abs_doze_read(s, ts->chip_data);
+    mutex_unlock(&ts->mutex);
+
+    if (ts->int_mode == BANNABLE) {
+        enable_irq(ts->irq);
+    }
+    return 0;
+}
+
+static int abs_doze_open(struct inode *inode, struct file *file)
+{
+    return single_open(file, tp_abs_doze_read_func, PDE_DATA(inode));
+}
+
+static const struct file_operations tp_abs_doze_proc_fops = {
+    .owner = THIS_MODULE,
+    .open  = abs_doze_open,
+    .read  = seq_read,
+    .release = single_release,
+};
+
+//write function of /proc/touchpanel/earsense/palm_control
+static ssize_t proc_earsense_palm_control_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    if (value > 2)
+        return count;
+
+    TPD_DEBUG("%s value: %d, palm_enable :%d\n", __func__, value, ts->palm_enable);
+    if (value == ts->palm_enable)
+        return count;
+
+    mutex_lock(&ts->mutex);
+    ts->palm_enable = value;
+    if (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_PALM_REJECTION, value);
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+//read function of /proc/touchpanel/earsense/palm_control
+static ssize_t proc_earsense_palm_control_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s value: %d\n", __func__, ts->palm_enable);
+    ret = sprintf(page, "%d\n", ts->palm_enable);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+// operation of /proc/touchpanel/earsense/palm_control
+static const struct file_operations tp_earsense_palm_control_fops = {
+    .write = proc_earsense_palm_control_write,
+    .read  = proc_earsense_palm_control_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// write function of /proc/touchpanel/earsense/es_enable
+static ssize_t proc_earsense_es_enable_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    bool state_changed = true;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    if (value > 2)
+        return count;
+
+    TPD_DEBUG("%s value: %d, es_enable :%d\n", __func__, value, ts->es_enable);
+    if (value == ts->es_enable)
+        return count;
+
+    mutex_lock(&ts->mutex);
+    if ((ts->es_enable != 1) && (value != 1))
+        state_changed =false;
+    ts->es_enable = value;
+    if (!ts->es_enable) {
+        memset(ts->earsense_delta, 0, 2 * ts->hw_res.EARSENSE_TX_NUM * ts->hw_res.EARSENSE_RX_NUM);
+    }
+    if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE) && state_changed) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_EARSENSE, ts->es_enable == 1);
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+// read function of /proc/touchpanel/earsense/es_enable
+static ssize_t proc_earsense_es_enable_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s value: %d\n", __func__, ts->es_enable);
+    ret = sprintf(page, "%d\n", ts->es_enable);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+// operation of /proc/touchpanel/earsense/es_enable
+static const struct file_operations tp_earsense_es_enable_fops = {
+    .write = proc_earsense_es_enable_write,
+    .read  = proc_earsense_es_enable_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// read function of /proc/touchpanel/earsense/es_touch_count
+static ssize_t proc_earsense_touchcnt_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s value: %d\n", __func__, ts->touch_count);
+    mutex_lock(&ts->mutex);
+    ret = sprintf(page, "%d\n", ts->touch_count);
+    mutex_unlock(&ts->mutex);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+// operation of /proc/touchpanel/earsense/es_touch_count
+static const struct file_operations tp_earsense_es_touchcnt_fops = {
+    .read  = proc_earsense_touchcnt_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// read function of /proc/touchpanel/earsense/rawdata
+static ssize_t proc_earsense_rawdata_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    int read_len = 2 * ts->hw_res.EARSENSE_TX_NUM * ts->hw_res.EARSENSE_RX_NUM;
+
+    char *tmp_data = NULL;
+    if (!ts)
+        *ppos += 11;
+    if (*ppos > 10)
+        return 0;
+    if (count != read_len) {
+        TPD_INFO("%s, length:%d not match data_len:%d\n", __func__, (int)count, read_len);
+        return 0;
+    }
+
+    TPD_DEBUG("%s is called\n", __func__);
+    mutex_lock(&ts->mutex);
+    if ((!ts->es_enable) || (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE)) {
+        *ppos += 11;
+        mutex_unlock(&ts->mutex);
+        return 0;
+    }
+    if (ts->delta_state == TYPE_DELTA_IDLE) {
+        tmp_data = kzalloc(read_len ,GFP_KERNEL);
+        ts->earsense_ops->rawdata_read(ts->chip_data, tmp_data, read_len);
+        mutex_unlock(&ts->mutex);
+        ret = copy_to_user(user_buf, tmp_data, read_len);
+        if (ret)
+            TPD_INFO("touch rawdata read fail\n");
+        kfree(tmp_data);
+        *ppos += 11;
+    } else {
+        mutex_unlock(&ts->mutex);
+        msleep(3);
+        *ppos += 1;
+    }
+
+    return read_len;
+}
+
+// operation of /proc/touchpanel/earsense/rawdata
+static const struct file_operations tp_earsense_rawdata_fops = {
+    .read  = proc_earsense_rawdata_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// read function of /proc/touchpanel/earsense/delta
+static ssize_t proc_earsense_delta_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    int read_len = 2 * ts->hw_res.EARSENSE_TX_NUM * ts->hw_res.EARSENSE_RX_NUM;
+
+    if (!ts)
+        return count;
+    if (*ppos > 0)
+        return 0;
+    if (count != read_len) {
+       TPD_INFO("%s, length:%d not match data_len:%d\n", __func__, (int)count, read_len);
+        return 0;
+    }
+
+    TPD_DEBUG("%s is called\n", __func__);
+    if ((!ts->es_enable) || (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE)) {
+        return 0;
+    }
+
+    mutex_lock(&ts->mutex_earsense);
+    ret = copy_to_user(user_buf, ts->earsense_delta, read_len);
+    mutex_unlock(&ts->mutex_earsense);
+    if (ret)
+        TPD_INFO("tp rawdata read fail\n");
+    *ppos += read_len;
+    return read_len;
+}
+
+// operation of /proc/touchpanel/earsense/delta
+static const struct file_operations tp_earsense_delta_fops = {
+    .read  = proc_earsense_delta_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// read function of /proc/touchpanel/earsense/hover_selfdata
+static ssize_t proc_earsense_selfdata_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+    uint16_t data_len = 2*(ts->hw_res.TX_NUM + ts->hw_res.RX_NUM);
+
+    char *tmp_data = NULL;
+    if (!ts)
+        *ppos += 11;
+    if (*ppos > 10)
+        return 0;
+    if (count != data_len) {
+        TPD_INFO("%s, length:%d not match data_len:%d\n", __func__, (int)count, data_len);
+        return 0;
+    }
+
+    TPD_DEBUG("%s is called\n", __func__);
+    mutex_lock(&ts->mutex);
+    if ((!ts->es_enable) || (ts->suspend_state != TP_SPEEDUP_RESUME_COMPLETE)) {
+        *ppos += 11;
+        mutex_unlock(&ts->mutex);
+        return 0;
+    }
+    if (ts->delta_state == TYPE_DELTA_IDLE) {
+        tmp_data = kzalloc(data_len ,GFP_KERNEL);
+        ts->earsense_ops->self_data_read(ts->chip_data, tmp_data, data_len);
+        mutex_unlock(&ts->mutex);
+        ret = copy_to_user(user_buf, tmp_data, data_len);
+        if (ret)
+            TPD_INFO("tp self delta read fail\n");
+        kfree(tmp_data);
+        *ppos += 11;
+    } else {
+        mutex_unlock(&ts->mutex);
+        msleep(3);
+        *ppos += 1;
+    }
+
+    return data_len;
+}
+
+// operation of /proc/touchpanel/earsense/hover_selfdata
+static const struct file_operations tp_earsense_selfdata_fops = {
+    .read  = proc_earsense_selfdata_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// write function of /proc/touchpanel/earsense/es_enable
+static ssize_t proc_fd_enable_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    if (value > 2)
+        return count;
+
+    TPD_DEBUG("%s value: %d, es_enable :%d\n", __func__, value, ts->fd_enable);
+    if (!value) {
+        input_event(ps_input_dev, EV_MSC, MSC_RAW, 2);
+		input_sync(ps_input_dev);
+    }
+    if (value == ts->fd_enable)
+        return count;
+
+    mutex_lock(&ts->mutex);
+    ts->fd_enable = value;
+    if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_FACE_DETECT, ts->fd_enable == 1);
+		if (ts->fd_enable) {
+			input_event(ps_input_dev, EV_MSC, MSC_RAW, 0);	//when open fd report default key for sensor.
+			input_sync(ps_input_dev);
+		}
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+// read function of /proc/touchpanel/fd_enable
+static ssize_t proc_fd_enable_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s value: %d\n", __func__, ts->fd_enable);
+    ret = sprintf(page, "%d\n", ts->fd_enable);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+// operation of /proc/touchpanel/fd_enable
+static const struct file_operations tp_fd_enable_fops = {
+    .write = proc_fd_enable_write,
+    .read  = proc_fd_enable_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+// read function of /proc/touchpanel/event_num
+static ssize_t proc_event_num_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    const char *devname = NULL;
+    struct input_handle *handle;
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    list_for_each_entry(handle, &ps_input_dev->h_list, d_node) {
+        if (strncmp(handle->name, "event", 5) == 0) {
+            devname = handle->name;
+            break;
+        }
+    }
+
+    ret = simple_read_from_buffer(user_buf, count, ppos, devname, strlen(devname));
+    return ret;
+}
+
+// operation of /proc/touchpanel/event_num
+static const struct file_operations tp_event_num_fops = {
+    .read  = proc_event_num_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_fd_calibrate_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int value = 0;
+    char buf[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (count > 2)
+        return count;
+    if (!ts)
+        return count;
+
+    if (copy_from_user(buf, buffer, count)) {
+        TPD_INFO("%s: read proc input error.\n", __func__);
+        return count;
+    }
+    sscanf(buf, "%d", &value);
+    if (value > 2)
+        return count;
+
+    TPD_DEBUG("%s value: %d, fd_calibrate :%d\n", __func__, value, ts->fd_calibrate);
+
+    mutex_lock(&ts->mutex);
+    ts->fd_calibrate = value;
+    if (ts->fd_enable) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_FACE_CALIBRATE, ts->fd_calibrate);
+    }
+    mutex_unlock(&ts->mutex);
+
+    return count;
+}
+
+static ssize_t proc_fd_calibrate_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+    int ret = 0;
+    char page[4] = {0};
+    struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+    if (!ts)
+        return count;
+
+    TPD_DEBUG("%s value: %d\n", __func__, ts->fd_calibrate);
+    ret = sprintf(page, "%d\n", ts->fd_calibrate);
+    ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+    return ret;
+}
+
+static const struct file_operations tp_fd_calibrate_fops = {
+    .write = proc_fd_calibrate_write,
+    .read  = proc_fd_calibrate_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_refresh_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int value = 0;
+	char buf[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (count > 2)
+		return count;
+	if (!ts)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_INFO("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &value);
+	if (value > 2)
+		return count;
+
+	TPD_DEBUG("%s value: %d, lcd_refresh_rate_switch :%d\n", __func__, value, ts->lcd_refresh_rate);
+	if (value == ts->lcd_refresh_rate)
+		return count;
+
+	mutex_lock(&ts->mutex);
+	ts->lcd_refresh_rate = value;
+	if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+		ts->ts_ops->mode_switch(ts->chip_data, MODE_REFRESH_SWITCH, ts->lcd_refresh_rate == 1);
+	}
+	mutex_unlock(&ts->mutex);
+
+	return count;
+}
+
+static ssize_t proc_refresh_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (!ts)
+		return count;
+
+	TPD_DEBUG("%s value: %d\n", __func__, ts->lcd_refresh_rate);
+	ret = sprintf(page, "%d\n", ts->lcd_refresh_rate);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+	return ret;
+}
+// operation of /proc/touchpanel/lcd_refresh_rate_switch
+static const struct file_operations tp_lcd_refresh_switch_fops = {
+	.write = proc_refresh_switch_write,
+    .read  = proc_refresh_switch_read,
+    .open  = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t proc_touch_hold_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int value = 0;
+	char buf[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (count > 2)
+		return count;
+	if (!ts)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_INFO("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &value);
+
+	TPD_DEBUG("%s value: %d, touch_hold_enable :%d\n", __func__, value, ts->touch_hold_enable);
+	if (value == 2) {
+		ts->skip_reset_in_resume = true;
+		return count;
+	}
+
+	ts->touch_hold_enable = value;
+
+	if ((ts->is_suspended) && (!ts->gesture_enable)) { //suspend and close gesture cannot response touchhold
+		return count;
+	}
+
+	mutex_lock(&ts->mutex);
+	ts->ts_ops->mode_switch(ts->chip_data, MODE_TOUCH_HOLD, ts->touch_hold_enable);
+	mutex_unlock(&ts->mutex);
+
+	return count;
+}
+
+static ssize_t proc_touch_hold_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (!ts)
+		return count;
+
+	TPD_DEBUG("%s value: %d\n", __func__, ts->touch_hold_enable);
+	ret = sprintf(page, "%d\n", ts->touch_hold_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+	return ret;
+}
+
+// operation of /proc/touchpanel/touch_hold
+static const struct file_operations tp_touch_hold_switch_fops = {
+	.write = proc_touch_hold_switch_write,
+	.read  = proc_touch_hold_switch_read,
+	.open  = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static ssize_t proc_touch_area_switch_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int value = 0;
+	char buf[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (count > 2)
+		return count;
+	if (!ts)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_INFO("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &value);
+	if (value > 1)
+		return count;
+
+	TPD_DEBUG("%s value: %d, touch_hold_enable :%d\n", __func__, value, ts->touch_area_switch);
+	if (value == ts->touch_area_switch)
+		return count;
+
+	if ((ts->is_suspended) && (!ts->gesture_enable)) { //suspend and close gesture cannot response touchhold
+		return count;
+	}
+
+	mutex_lock(&ts->mutex);
+	ts->touch_area_switch = value;
+	ts->ts_ops->mode_switch(ts->chip_data, MODE_TOUCH_AREA_SWITCH, ts->touch_area_switch == 1);
+	mutex_unlock(&ts->mutex);
+	return count;
+}
+
+static ssize_t proc_touch_area_switch_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (!ts)
+		return count;
+
+	TPD_DEBUG("%s value: %d\n", __func__, ts->touch_area_switch);
+	ret = sprintf(page, "%d\n", ts->touch_area_switch);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+	return ret;
+}
+
+// operation of /proc/touchpanel/touch_hold
+static const struct file_operations tp_touch_area_switch_fops = {
+	.write = proc_touch_area_switch_write,
+	.read  = proc_touch_area_switch_read,
+	.open  = simple_open,
+	.owner = THIS_MODULE,
+};
+static ssize_t proc_fingerprint_int_test_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int value = 0;
+	char buf[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (count > 2)
+		return count;
+	if (!ts)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_INFO("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &value);
+	if (value > 1)
+		return count;
+
+	TPD_DEBUG("%s value: %d, fingerprint_int_test :%d\n", __func__, value, ts->fingerprint_int_test);
+	if (value == ts->fingerprint_int_test)
+		return count;
+
+	mutex_lock(&ts->mutex);
+	ts->fingerprint_int_test = value;
+	ts->ts_ops->mode_switch(ts->chip_data, MODE_FINGERPRINT_TEST, ts->fingerprint_int_test == 1);
+	mutex_unlock(&ts->mutex);
+
+	return count;
+}
+
+static ssize_t proc_fingerprint_int_test_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (!ts)
+		return count;
+
+	TPD_DEBUG("%s value: %d\n", __func__, ts->fingerprint_int_test);
+	ret = sprintf(page, "%d\n", ts->fingerprint_int_test);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+	return ret;
+}
+
+static const struct file_operations tp_fingerprint_int_test_fops = {
+		.write = proc_fingerprint_int_test_write,
+		.read  = proc_fingerprint_int_test_read,
+		.open  = simple_open,
+		.owner = THIS_MODULE,
+};
+static ssize_t proc_charge_detect_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int value = 0;
+	char buf[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (count > 2)
+		return count;
+	if (!ts)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_INFO("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &value);
+
+	TPD_DEBUG("%s value: %d, charge detect enable:%d\n", __func__, value, ts->charge_detect);
+	ts->charge_detect = value;
+	mutex_lock(&ts->mutex);
+	if (ts->charge_detect_support && ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE) {
+		ts->ts_ops->mode_switch(ts->chip_data, MODE_CHARGE, ts->charge_detect);
+	}
+	mutex_unlock(&ts->mutex);
+	return count;
+}
+
+static ssize_t proc_charge_detect_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4] = {0};
+	struct touchpanel_data *ts = PDE_DATA(file_inode(file));
+
+	if (!ts)
+		return count;
+
+	TPD_DEBUG("%s value: %d\n", __func__, ts->charge_detect);
+	ret = sprintf(page, "%d\n", ts->charge_detect);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+
+	return ret;
+}
+
+// operation of /proc/touchpanel/charge_detect
+static const struct file_operations tp_charge_detect_fops = {
+	.write = proc_charge_detect_write,
+	.read  = proc_charge_detect_read,
+	.open  = simple_open,
+	.owner = THIS_MODULE,
+};
+
+//proc/touchpanel/debug_info/
+static int init_debug_info_proc(struct touchpanel_data *ts)
+{
+    int ret = 0;
+    struct proc_dir_entry *prEntry_debug_info = NULL;
+    struct proc_dir_entry *prEntry_earsense = NULL;
+    struct proc_dir_entry *prEntry_tmp = NULL;
+
+    TPD_INFO("%s entry\n", __func__);
+
+    //proc files-step1:/proc/touchpanel/debug_info
+    prEntry_debug_info = proc_mkdir("debug_info", ts->prEntry_tp);
+    if (prEntry_debug_info == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create debug_info proc entry\n", __func__);
+    }
+
+    // show limit data interface
+    prEntry_tmp = proc_create_data("data_limit", 0666, prEntry_debug_info, &tp_limit_data_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show baseline data interface
+    prEntry_tmp = proc_create_data("baseline", 0666, prEntry_debug_info, &tp_baseline_data_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show delta interface
+    prEntry_tmp = proc_create_data("delta", 0666, prEntry_debug_info, &tp_delta_data_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show self delta interface
+    prEntry_tmp = proc_create_data("self_delta", 0666, prEntry_debug_info, &tp_self_delta_data_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show self_raw interface
+    prEntry_tmp = proc_create_data("self_raw", 0666, prEntry_debug_info, &tp_self_raw_data_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show main_register interface
+    prEntry_tmp = proc_create_data("main_register", 0666, prEntry_debug_info, &tp_main_register_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show reserve interface
+    prEntry_tmp = proc_create_data("reserve", 0666, prEntry_debug_info, &tp_reserve_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    // show abs_doze interface
+    prEntry_tmp = proc_create_data("abs_doze", 0666, prEntry_debug_info, &tp_abs_doze_proc_fops, ts);
+    if (prEntry_tmp == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+    }
+
+    ts->prEntry_debug_tp = prEntry_debug_info;
+
+    if (ts->ear_sense_support) {
+        //proc files-step1:/proc/touchpanel/earsense
+        prEntry_earsense = proc_mkdir("earsense", ts->prEntry_tp);
+        if (prEntry_earsense == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create debug_info proc entry\n", __func__);
+        }
+        // show baseline for earsense
+        prEntry_tmp = proc_create_data("rawdata", 0666, prEntry_earsense, &tp_earsense_rawdata_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        // show delta for earsense
+        prEntry_tmp = proc_create_data("delta", 0666, prEntry_earsense, &tp_earsense_delta_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        // show self delta for earsense
+        prEntry_tmp = proc_create_data("hover_selfdata", 0666, prEntry_earsense, &tp_earsense_selfdata_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        // palm control for earsense
+        prEntry_tmp = proc_create_data("palm_control", 0666, prEntry_earsense, &tp_earsense_palm_control_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+        // es_enable for earsense
+        prEntry_tmp = proc_create_data("es_enable", 0666, prEntry_earsense, &tp_earsense_es_enable_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+
+        // touch count for earsense
+        prEntry_tmp = proc_create_data("es_touch_count", 0666, prEntry_earsense, &tp_earsense_es_touchcnt_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+    if (ts->face_detect_support) {
+        // proc for face detect
+        prEntry_tmp = proc_create_data("fd_enable", 0666, ts->prEntry_tp, &tp_fd_enable_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+
+        prEntry_tmp = proc_create_data("event_num", 0666, ts->prEntry_tp, &tp_event_num_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+
+		prEntry_tmp = proc_create_data("fd_calibrate", 0666, ts->prEntry_tp, &tp_fd_calibrate_fops, ts);
+        if (prEntry_tmp == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+        }
+    }
+
+	if (ts->lcd_refresh_rate_switch) {
+		// proc for lcd_refresh_rate_switch
+		prEntry_tmp = proc_create_data("lcd_refresh_rate_switch", 0666, ts->prEntry_tp, &tp_lcd_refresh_switch_fops, ts);
+		if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+		}
+	}
+
+	if (ts->touch_hold_support) {
+		// proc for touchhold switch
+		prEntry_tmp = proc_create_data("touch_hold", 0666, ts->prEntry_tp, &tp_touch_hold_switch_fops, ts);
+		if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+		}
+		prEntry_tmp = proc_create_data("touch_area_switch", 0666, ts->prEntry_tp, &tp_touch_area_switch_fops, ts);
+		if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+		}
+	}
+
+	// proc for lcd_refresh_rate_switch
+	prEntry_tmp = proc_create_data("fingerprint_int_test", 0666, ts->prEntry_tp, &tp_fingerprint_int_test_fops, ts);
+	if (prEntry_tmp == NULL) {
+	ret = -ENOMEM;
+	TPD_INFO("%s: Couldn't create proc entry, %d\n", __func__, __LINE__);
+	}
+	// proc for charge detect
+	prEntry_tmp = proc_create_data("charge_detect", 0666, ts->prEntry_tp, &tp_charge_detect_fops,ts);
+	if(prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_INFO("%s: Couldn’t create proc entey, %d\n", __func__, __LINE__);
+		}
+
+    return ret;
+}
+
+/**
+ * init_input_device - Using for register input device
+ * @ts: touchpanel_data struct using for common driver
+ *
+ * we should using this function setting input report capbility && register input device
+ * Returning zero(success) or negative errno(failed)
+ */
+static int init_input_device(struct touchpanel_data *ts)
+{
+    int ret = 0;
+    struct kobject *vk_properties_kobj;
+
+    TPD_INFO("%s is called\n", __func__);
+    ts->input_dev = input_allocate_device();
+    if (ts->input_dev == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("Failed to allocate input device\n");
+        return ret;
+    }
+
+    ts->kpd_input_dev  = input_allocate_device();
+    if (ts->kpd_input_dev == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("Failed to allocate key input device\n");
+        return ret;
+    }
+
+    if (ts->face_detect_support) {
+        ps_input_dev  = input_allocate_device();
+        if (ps_input_dev == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("Failed to allocate ps input device\n");
+            return ret;
+        }
+
+        ps_input_dev->name = TPD_DEVICE"_ps";
+        set_bit(EV_MSC, ps_input_dev->evbit);
+        set_bit(MSC_RAW, ps_input_dev->mscbit);
+    }
+
+    ts->input_dev->name = TPD_DEVICE;
+    set_bit(EV_SYN, ts->input_dev->evbit);
+    set_bit(EV_ABS, ts->input_dev->evbit);
+    set_bit(EV_KEY, ts->input_dev->evbit);
+    set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
+    set_bit(ABS_MT_WIDTH_MAJOR, ts->input_dev->absbit);
+    set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
+    set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
+    set_bit(INPUT_PROP_DIRECT, ts->input_dev->propbit);
+    set_bit(BTN_TOUCH, ts->input_dev->keybit);
+    if (ts->black_gesture_support) {
+        set_bit(KEY_F4, ts->input_dev->keybit);
+    }
+
+    ts->kpd_input_dev->name = TPD_DEVICE"_kpd";
+    set_bit(EV_KEY, ts->kpd_input_dev->evbit);
+    set_bit(EV_SYN, ts->kpd_input_dev->evbit);
+
+    switch(ts->vk_type) {
+        case TYPE_PROPERTIES :
+            {
+                TPD_DEBUG("Type 1: using board_properties\n");
+                vk_properties_kobj = kobject_create_and_add("board_properties", NULL);
+                if (vk_properties_kobj)
+                    ret = sysfs_create_group(vk_properties_kobj, &properties_attr_group);
+                if (!vk_properties_kobj || ret)
+                    TPD_DEBUG("failed to create board_properties\n");
+                break;
+            }
+        case TYPE_AREA_SEPRATE:
+            {
+                TPD_DEBUG("Type 2:using same IC (button zone &&  touch zone are seprate)\n");
+                if (CHK_BIT(ts->vk_bitmap, BIT_MENU))
+                    set_bit(KEY_MENU, ts->kpd_input_dev->keybit);
+                if (CHK_BIT(ts->vk_bitmap, BIT_HOME))
+                    set_bit(KEY_HOMEPAGE, ts->kpd_input_dev->keybit);
+                if (CHK_BIT(ts->vk_bitmap, BIT_BACK))
+                    set_bit(KEY_BACK, ts->kpd_input_dev->keybit);
+                break;
+            }
+        default :
+            break;
+    }
+
+#ifdef TYPE_B_PROTOCOL
+    input_mt_init_slots(ts->input_dev, ts->max_num, 0);
+#endif
+    input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);
+    input_set_abs_params(ts->input_dev, ABS_MT_POSITION_X, 0, ts->resolution_info.max_x, 0, 0);
+    input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y, 0, ts->resolution_info.max_y, 0, 0);
+    input_set_drvdata(ts->input_dev, ts);
+    input_set_drvdata(ts->kpd_input_dev, ts);
+
+    if (input_register_device(ts->input_dev)) {
+        TPD_INFO("%s: Failed to register input device\n", __func__);
+        input_free_device(ts->input_dev);
+        return -1;
+    }
+
+    if (input_register_device(ts->kpd_input_dev)) {
+        TPD_INFO("%s: Failed to register key input device\n", __func__);
+        input_free_device(ts->kpd_input_dev);
+        return -1;
+    }
+
+    if (ts->face_detect_support) {
+        if (input_register_device(ps_input_dev)) {
+            TPD_INFO("%s: Failed to register ps input device\n", __func__);
+            input_free_device(ps_input_dev);
+            return -1;
+        }
+    }
+
+    return 0;
+}
+
+/**
+ * init_parse_dts - parse dts, get resource defined in Dts
+ * @dev: i2c_client->dev using to get device tree
+ * @ts: touchpanel_data, using for common driver
+ *
+ * If there is any Resource needed by chip_data, we can add a call-back func in this function
+ * Do not care the result : Returning void type
+ */
+static void init_parse_dts(struct device *dev, struct touchpanel_data *ts)
+{
+    int rc;
+    struct device_node *np;
+    int temp_array[8];
+    int tx_rx_num[2];
+    int val = 0;
+
+    np = dev->of_node;
+
+    ts->register_is_16bit       = of_property_read_bool(np, "register-is-16bit");
+    ts->edge_limit_support      = of_property_read_bool(np, "edge_limit_support");
+    ts->glove_mode_support      = of_property_read_bool(np, "glove_mode_support");
+    ts->esd_handle_support      = of_property_read_bool(np, "esd_handle_support");
+    ts->spurious_fp_support     = of_property_read_bool(np, "spurious_fingerprint_support");
+    ts->charger_pump_support    = of_property_read_bool(np, "charger_pump_support");
+    ts->black_gesture_support   = of_property_read_bool(np, "black_gesture_support");
+    ts->gesture_test_support    = of_property_read_bool(np, "black_gesture_test_support");
+    ts->fw_update_app_support   = of_property_read_bool(np, "fw_update_app_support");
+    ts->game_switch_support     = of_property_read_bool(np, "game_switch_support");
+    ts->ear_sense_support       = of_property_read_bool(np, "ear_sense_support");
+    ts->smart_gesture_support   = of_property_read_bool(np, "smart_gesture_support");
+    ts->is_noflash_ic           = of_property_read_bool(np, "noflash_support");
+    ts->face_detect_support     = of_property_read_bool(np, "face_detect_support");
+    ts->lcd_refresh_rate_switch = of_property_read_bool(np, "lcd_refresh_rate_switch");
+    ts->touch_hold_support 		= of_property_read_bool(np, "touch_hold_support");
+	ts->charge_detect_support	= of_property_read_bool(np, "charge_detect_support");
+	ts->module_id_support		= of_property_read_bool(np, "module_id_support");
+    ts->spuri_fp_touch.lcd_trigger_fp_check = of_property_read_bool(np, "lcd_trigger_fp_check");
+    ts->spuri_fp_touch.lcd_resume_ok = true;
+
+	rc = of_property_read_string(np, "project-name", &ts->panel_data.project_name);
+	if (rc < 0) {
+		TPD_INFO("failed to get project name, firmware/limit name will be invalid\n");
+	}
+	rc = of_property_read_string(np, "chip-name", &ts->panel_data.chip_name);
+	if (rc < 0) {
+		TPD_INFO("failed to get chip name, firmware/limit name will be invalid\n");
+	}
+	rc = of_property_read_u32(np, "module_id" , &ts->panel_data.tp_type);
+	if(rc < 0) {
+		TPD_INFO("module id is not specified\n");
+		ts->panel_data.tp_type = 0;
+	}
+
+    rc = of_property_read_u32(np, "vdd_2v8_volt", &ts->hw_res.vdd_volt);
+    if (rc < 0) {
+        ts->hw_res.vdd_volt = 0;
+        TPD_INFO("vdd_2v8_volt not defined\n");
+    }
+
+    // irq gpio
+    ts->hw_res.irq_gpio = of_get_named_gpio_flags(np, "irq-gpio", 0, &(ts->irq_flags));
+    if (gpio_is_valid(ts->hw_res.irq_gpio)) {
+        rc= gpio_request(ts->hw_res.irq_gpio, "tp_irq_gpio");
+        if (rc) {
+            TPD_INFO("unable to request gpio [%d]\n", ts->hw_res.irq_gpio);
+        }
+    } else {
+        TPD_INFO("irq-gpio not specified in dts\n");
+    }
+
+	ts->irq = gpio_to_irq(ts->hw_res.irq_gpio);
+	ts->client->irq = ts->irq;
+    // reset gpio
+    ts->hw_res.reset_gpio = of_get_named_gpio(np, "reset-gpio", 0);
+    if (gpio_is_valid(ts->hw_res.reset_gpio)) {
+        rc = gpio_request(ts->hw_res.reset_gpio, "reset-gpio");
+        if (rc)
+            TPD_INFO("unable to request gpio [%d]\n", ts->hw_res.reset_gpio);
+    } else {
+        TPD_INFO("ts->reset-gpio not specified\n");
+    }
+
+    TPD_INFO("%s : irq_gpio = %d, irq_flags = 0x%x ts_irq = %d, reset_gpio = %d\n",
+            __func__, ts->hw_res.irq_gpio, ts->irq_flags, ts->irq, ts->hw_res.reset_gpio);
+
+    // tp type gpio
+    ts->hw_res.id1_gpio = of_get_named_gpio(np, "id1-gpio", 0);
+    if (gpio_is_valid(ts->hw_res.id1_gpio)) {
+        rc = gpio_request(ts->hw_res.id1_gpio, "TP_ID1");
+        if (rc)
+            TPD_INFO("unable to request gpio [%d]\n", ts->hw_res.id1_gpio);
+    } else {
+        TPD_INFO("id1_gpio not specified\n");
+    }
+
+    ts->hw_res.id2_gpio = of_get_named_gpio(np, "id2-gpio", 0);
+    if (gpio_is_valid(ts->hw_res.id2_gpio)) {
+        rc = gpio_request(ts->hw_res.id2_gpio, "TP_ID2");
+        if (rc)
+            TPD_INFO("unable to request gpio [%d]\n", ts->hw_res.id2_gpio);
+    } else {
+        TPD_INFO("id2_gpio not specified\n");
+    }
+
+    ts->hw_res.id3_gpio = of_get_named_gpio(np, "id3-gpio", 0);
+    if (gpio_is_valid(ts->hw_res.id3_gpio)) {
+        rc = gpio_request(ts->hw_res.id3_gpio, "TP_ID3");
+        if (rc)
+            TPD_INFO("unable to request gpio [%d]\n", ts->hw_res.id3_gpio);
+    } else {
+        TPD_INFO("id3_gpio not specified\n");
+    }
+
+    ts->hw_res.pinctrl= devm_pinctrl_get(dev);
+    if (IS_ERR_OR_NULL(ts->hw_res.pinctrl)) {
+       TPD_INFO("Getting pinctrl handle failed");
+    } else {
+        ts->hw_res.pin_set_high = pinctrl_lookup_state(ts->hw_res.pinctrl, "pin_set_high");
+        if (IS_ERR_OR_NULL(ts->hw_res.pin_set_high)) {
+            TPD_INFO("Failed to get the high state pinctrl handle \n");
+        }
+        ts->hw_res.pin_set_low = pinctrl_lookup_state(ts->hw_res.pinctrl, "pin_set_low");
+        if (IS_ERR_OR_NULL(ts->hw_res.pin_set_low)) {
+            TPD_INFO(" Failed to get the low state pinctrl handle\n");
+        }
+    }
+    ts->hw_res.enable2v8_gpio = of_get_named_gpio(np, "enable2v8_gpio", 0);
+    if (ts->hw_res.enable2v8_gpio < 0) {
+        TPD_INFO("ts->hw_res.enable2v8_gpio not specified\n");
+    } else {
+        if (gpio_is_valid(ts->hw_res.enable2v8_gpio)) {
+            rc = gpio_request(ts->hw_res.enable2v8_gpio, "vdd2v8-gpio");
+            if (rc) {
+                TPD_INFO("unable to request gpio [%d] %d\n", ts->hw_res.enable2v8_gpio, rc);
+            }
+        }
+    }
+
+    ts->hw_res.enable1v8_gpio = of_get_named_gpio(np, "enable1v8_gpio", 0);
+    if (ts->hw_res.enable1v8_gpio < 0) {
+        TPD_INFO("ts->hw_res.enable1v8_gpio not specified\n");
+    } else {
+        if (gpio_is_valid(ts->hw_res.enable1v8_gpio)) {
+            rc = gpio_request(ts->hw_res.enable1v8_gpio, "vcc1v8-gpio");
+            if (rc) {
+                TPD_INFO("unable to request gpio [%d], %d\n", ts->hw_res.enable1v8_gpio, rc);
+            }
+        }
+    }
+
+    // interrupt mode
+    ts->int_mode = BANNABLE;
+    rc = of_property_read_u32(np, "touchpanel,int-mode", &val);
+    if (rc) {
+        TPD_INFO("int-mode not specified\n");
+    } else {
+        if (val < INTERRUPT_MODE_MAX) {
+            ts->int_mode = val;
+        }
+    }
+
+    // resolution info
+    rc = of_property_read_u32(np, "touchpanel,max-num-support", &ts->max_num);
+    if (rc) {
+        TPD_INFO("ts->max_num not specified\n");
+        ts->max_num = 10;
+    }
+
+    rc = of_property_read_u32_array(np, "touchpanel,tx-rx-num", tx_rx_num, 2);
+    if (rc) {
+        TPD_INFO("tx-rx-num not set\n");
+        ts->hw_res.TX_NUM = 0;
+        ts->hw_res.RX_NUM = 0;
+    } else {
+        ts->hw_res.TX_NUM = tx_rx_num[0];
+        ts->hw_res.RX_NUM = tx_rx_num[1];
+    }
+    TPD_INFO("TX_NUM = %d, RX_NUM = %d \n", ts->hw_res.TX_NUM, ts->hw_res.RX_NUM);
+
+    rc = of_property_read_u32_array(np, "earsense,tx-rx-num", tx_rx_num, 2);
+    if (rc) {
+        TPD_INFO("tx-rx-num not set\n");
+        ts->hw_res.EARSENSE_TX_NUM = ts->hw_res.TX_NUM;
+        ts->hw_res.EARSENSE_RX_NUM = ts->hw_res.RX_NUM / 2;
+    } else {
+        ts->hw_res.EARSENSE_TX_NUM = tx_rx_num[0];
+        ts->hw_res.EARSENSE_RX_NUM = tx_rx_num[1];
+    }
+    TPD_INFO("EARSENSE_TX_NUM = %d, EARSENSE_RX_NUM = %d \n", ts->hw_res.EARSENSE_TX_NUM, ts->hw_res.EARSENSE_RX_NUM);
+
+    rc = of_property_read_u32_array(np, "touchpanel,display-coords", temp_array, 2);
+    if (rc) {
+        TPD_INFO("Lcd size not set\n");
+        ts->resolution_info.LCD_WIDTH = 0;
+        ts->resolution_info.LCD_HEIGHT = 0;
+    }else{
+        ts->resolution_info.LCD_WIDTH = temp_array[0];
+        ts->resolution_info.LCD_HEIGHT = temp_array[1];
+    }
+
+    rc = of_property_read_u32_array(np, "touchpanel,panel-coords", temp_array, 2);
+    if (rc) {
+        ts->resolution_info.max_x = 0;
+        ts->resolution_info.max_y = 0;
+    }else{
+        ts->resolution_info.max_x = temp_array[0];
+        ts->resolution_info.max_y = temp_array[1];
+    }
+    rc = of_property_read_u32_array(np, "touchpanel,touchmajor-limit", temp_array, 2);
+    if (rc) {
+        ts->touch_major_limit.width_range = 0;
+        ts->touch_major_limit.height_range = 0;
+    }else{
+        ts->touch_major_limit.width_range = temp_array[0];
+        ts->touch_major_limit.height_range = temp_array[1];
+    }
+    TPD_INFO("LCD_WIDTH = %d, LCD_HEIGHT = %d, max_x = %d, max_y = %d, limit_witdh = %d, limit_height = %d\n",
+            ts->resolution_info.LCD_WIDTH, ts->resolution_info.LCD_HEIGHT, ts->resolution_info.max_x, ts->resolution_info.max_y,\
+            ts->touch_major_limit.width_range, ts->touch_major_limit.height_range);
+
+    // virturl key Related
+    rc = of_property_read_u32_array(np, "touchpanel,button-type", temp_array, 2);
+    if (rc < 0) {
+        TPD_INFO("error:button-type should be setting in dts!");
+    } else {
+        ts->vk_type = temp_array[0];
+        ts->vk_bitmap = temp_array[1] & 0xFF;
+        if (ts->vk_type == TYPE_PROPERTIES) {
+            rc = of_property_read_u32_array(np, "touchpanel,button-map", temp_array, 8);
+            if (rc) {
+                TPD_INFO("button-map not set\n");
+            }else{
+                ts->button_map.coord_menu.x = temp_array[0];
+                ts->button_map.coord_menu.y = temp_array[1];
+                ts->button_map.coord_home.x = temp_array[2];
+                ts->button_map.coord_home.y = temp_array[3];
+                ts->button_map.coord_back.x = temp_array[4];
+                ts->button_map.coord_back.y = temp_array[5];
+                ts->button_map.width_x = temp_array[6];
+                ts->button_map.height_y = temp_array[7];
+            }
+        }
+    }
+
+    //touchkey take tx num and rx num
+    rc = of_property_read_u32_array(np, "touchpanel.button-TRx", temp_array, 2);
+    if(rc < 0) {
+        TPD_INFO("error:button-TRx should be setting in dts!\n");
+        ts->hw_res.key_TX = 0;
+        ts->hw_res.key_RX = 0;
+    } else {
+        ts->hw_res.key_TX = temp_array[0];
+        ts->hw_res.key_RX = temp_array[1];
+        TPD_INFO("key_tx is %d, key_rx is %d\n", ts->hw_res.key_TX, ts->hw_res.key_RX);
+    }
+
+    //set incell panel parameter, for of_property_read_bool return 1 when success and return 0 when item is not exist
+    rc = ts->is_incell_panel = of_property_read_bool(np, "incell_screen");
+    if(rc > 0) {
+        TPD_INFO("panel is incell!\n");
+        ts->is_incell_panel = 1;
+    } else {
+        TPD_INFO("panel is oncell!\n");
+        ts->is_incell_panel = 0;
+    }
+
+    // We can Add callback fuction here if necessary seprate some dts config for chip_data
+}
+
+int init_power_control(struct touchpanel_data *ts)
+{
+    int ret = 0;
+
+    // 1.8v
+    ts->hw_res.vcc_1v8 = regulator_get(ts->dev, "vcc_1v8");
+    if (IS_ERR_OR_NULL(ts->hw_res.vcc_1v8)) {
+        TPD_INFO("Regulator get failed vcc_1v8, ret = %d\n", ret);
+    } else {
+        if (regulator_count_voltages(ts->hw_res.vcc_1v8) > 0) {
+            ret = regulator_set_voltage(ts->hw_res.vcc_1v8, 1800000, 1800000);
+            if (ret) {
+                dev_err(ts->dev, "Regulator set_vtg failed vcc_i2c rc = %d\n", ret);
+                goto regulator_vcc_1v8_put;
+            }
+
+            ret = regulator_set_load(ts->hw_res.vcc_1v8, 200000);
+            if (ret < 0) {
+                dev_err(ts->dev, "Failed to set vcc_1v8 mode(rc:%d)\n", ret);
+                goto regulator_vcc_1v8_put;
+            }
+        }
+    }
+    // vdd 2.8v
+    ts->hw_res.vdd_2v8 = regulator_get(ts->dev, "vdd_2v8");
+    if (IS_ERR_OR_NULL(ts->hw_res.vdd_2v8)) {
+        TPD_INFO("Regulator vdd2v8 get failed, ret = %d\n", ret);
+    } else {
+        if (regulator_count_voltages(ts->hw_res.vdd_2v8) > 0) {
+            TPD_INFO("set avdd voltage to %d uV\n", ts->hw_res.vdd_volt);
+            if (ts->hw_res.vdd_volt) {
+                ret = regulator_set_voltage(ts->hw_res.vdd_2v8, ts->hw_res.vdd_volt, ts->hw_res.vdd_volt);
+            } else {
+                ret = regulator_set_voltage(ts->hw_res.vdd_2v8, 3100000, 3100000);
+            }
+            if (ret) {
+                dev_err(ts->dev, "Regulator set_vtg failed vdd rc = %d\n", ret);
+                goto regulator_vdd_2v8_put;
+            }
+
+            ret = regulator_set_load(ts->hw_res.vdd_2v8, 200000);
+            if (ret < 0) {
+                dev_err(ts->dev, "Failed to set vdd_2v8 mode(rc:%d)\n", ret);
+                goto regulator_vdd_2v8_put;
+            }
+        }
+    }
+
+    return 0;
+
+regulator_vdd_2v8_put:
+    regulator_put(ts->hw_res.vdd_2v8);
+    ts->hw_res.vdd_2v8 = NULL;
+regulator_vcc_1v8_put:
+    if (!IS_ERR_OR_NULL(ts->hw_res.vcc_1v8)) {
+        regulator_put(ts->hw_res.vcc_1v8);
+        ts->hw_res.vcc_1v8 = NULL;
+    }
+
+    return ret;
+}
+
+int tp_powercontrol_1v8(struct hw_resource *hw_res, bool on)
+{
+    int ret = 0;
+
+    if (on) {// 1v8 power on
+        if (!IS_ERR_OR_NULL(hw_res->vcc_1v8)) {
+            TPD_INFO("Enable the Regulator1v8.\n");
+            ret = regulator_enable(hw_res->vcc_1v8);
+            if (ret) {
+                TPD_INFO("Regulator vcc_i2c enable failed ret = %d\n", ret);
+                return ret;
+            }
+        }
+
+        if (hw_res->enable1v8_gpio > 0) {
+            TPD_INFO("Enable the 1v8_gpio\n");
+            ret = gpio_direction_output(hw_res->enable1v8_gpio, 1);
+            if (ret) {
+                TPD_INFO("enable the enable1v8_gpio failed.\n");
+                return ret;
+            }
+        }
+    } else {// 1v8 power off
+        if (!IS_ERR_OR_NULL(hw_res->vcc_1v8)) {
+            ret = regulator_disable(hw_res->vcc_1v8);
+            if (ret) {
+                TPD_INFO("Regulator vcc_i2c enable failed rc = %d\n", ret);
+                return ret;
+            }
+        }
+
+        if (hw_res->enable1v8_gpio > 0) {
+            TPD_INFO("disable the 1v8_gpio\n");
+            ret = gpio_direction_output(hw_res->enable1v8_gpio, 0);
+            if (ret) {
+                TPD_INFO("disable the enable1v8_gpio failed.\n");
+                return ret;
+            }
+        }
+    }
+
+    return 0;
+}
+
+int tp_powercontrol_2v8(struct hw_resource *hw_res, bool on)
+{
+    int ret = 0;
+
+    if (on) {// 2v8 power on
+        if (!IS_ERR_OR_NULL(hw_res->vdd_2v8)) {
+            TPD_INFO("Enable the Regulator2v8.\n");
+            ret = regulator_enable(hw_res->vdd_2v8);
+            if (ret) {
+                TPD_INFO("Regulator vdd enable failed ret = %d\n", ret);
+                return ret;
+            }
+        }
+        if (hw_res->enable2v8_gpio > 0) {
+            TPD_INFO("Enable the 2v8_gpio, hw_res->enable2v8_gpio is %d\n", hw_res->enable2v8_gpio);
+            ret = gpio_direction_output(hw_res->enable2v8_gpio, 1);
+            if (ret) {
+                TPD_INFO("enable the enable2v8_gpio failed.\n");
+                return ret;
+            }
+        }
+    } else {// 2v8 power off
+        if (!IS_ERR_OR_NULL(hw_res->vdd_2v8)) {
+			TPD_INFO("disable the vdd_2v8\n");
+            ret = regulator_disable(hw_res->vdd_2v8);
+            if (ret) {
+                TPD_INFO("Regulator vdd disable failed rc = %d\n", ret);
+                return ret;
+            }
+        }
+        if (hw_res->enable2v8_gpio > 0) {
+            TPD_INFO("disable the 2v8_gpio\n");
+            ret = gpio_direction_output(hw_res->enable2v8_gpio, 0);
+            if (ret) {
+                TPD_INFO("disable the enable2v8_gpio failed.\n");
+                return ret;
+            }
+        }
+    }
+    return ret;
+}
+
+
+static void esd_handle_func(struct work_struct *work)
+{
+    int ret = 0;
+    struct touchpanel_data *ts = container_of(work, struct touchpanel_data,
+            esd_info.esd_check_work.work);
+
+    if (ts->loading_fw) {
+        TPD_INFO("FW is updating, stop esd handle!\n");
+        return;
+    }
+
+    mutex_lock(&ts->esd_info.esd_lock);
+    if (!ts->esd_info.esd_running_flag) {
+        TPD_INFO("Esd protector has stopped!\n");
+        goto ESD_END;
+    }
+
+    if (ts->is_suspended == 1) {
+        TPD_INFO("Touch panel has suspended!\n");
+        goto ESD_END;
+    }
+
+    if (!ts->ts_ops->esd_handle) {
+        TPD_INFO("not support ts_ops->esd_handle callback\n");
+        goto ESD_END;
+    }
+
+    ret = ts->ts_ops->esd_handle(ts->chip_data);
+    if (ret == -1) {    //-1 means esd hanppened: handled in IC part, recovery the state here
+         operate_mode_switch(ts);
+    }
+
+    if (ts->esd_info.esd_running_flag)
+        queue_delayed_work(ts->esd_info.esd_workqueue, &ts->esd_info.esd_check_work, ts->esd_info.esd_work_time);
+    else
+        TPD_INFO("Esd protector suspended!");
+
+ESD_END:
+    mutex_unlock(&ts->esd_info.esd_lock);
+    return;
+}
+
+/**
+ * esd_handle_switch - open or close esd thread
+ * @esd_info: touchpanel_data, using for common driver resource
+ * @on: bool variable using for  indicating open or close esd check function.
+ *     true:open;
+ *     false:close;
+ */
+void esd_handle_switch(struct esd_information *esd_info, bool on)
+{
+    mutex_lock(&esd_info->esd_lock);
+
+    if (on) {
+        if (!esd_info->esd_running_flag) {
+            esd_info->esd_running_flag = 1;
+
+            TPD_INFO("Esd protector started, cycle: %d s\n", esd_info->esd_work_time/HZ);
+            queue_delayed_work(esd_info->esd_workqueue, &esd_info->esd_check_work, esd_info->esd_work_time);
+        }
+    } else {
+        if (esd_info->esd_running_flag) {
+            esd_info->esd_running_flag = 0;
+
+            TPD_INFO("Esd protector stoped!\n");
+            cancel_delayed_work(&esd_info->esd_check_work);
+        }
+    }
+
+    mutex_unlock(&esd_info->esd_lock);
+}
+
+int tp_register_irq_func(struct touchpanel_data *ts)
+{
+    int ret = 0;
+	
+#ifdef TPD_USE_EINT
+    if (gpio_is_valid(ts->hw_res.irq_gpio)) {
+        TPD_DEBUG("%s, irq_gpio is %d, ts->irq is %d\n", __func__, ts->hw_res.irq_gpio, ts->irq);
+        ret = request_threaded_irq(ts->irq, NULL,
+                tp_irq_thread_fn,
+                ts->irq_flags | IRQF_ONESHOT,
+                TPD_DEVICE, ts);
+        if (ret < 0) {
+            TPD_INFO("%s request_threaded_irq ret is %d\n", __func__, ret);
+        }
+    } else {
+        TPD_INFO("%s:no valid irq\n", __func__);
+    }
+#else
+    hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+    ts->timer.function = touchpanel_timer_func;
+    hrtimer_start(&ts->timer, ktime_set(3, 0), HRTIMER_MODE_REL);
+#endif
+
+    return ret;
+}
+
+//work schdule for reading&update delta
+static void touch_read_delta(struct work_struct *work)
+{
+    struct touchpanel_data *ts = container_of(work, struct touchpanel_data, read_delta_work);
+
+    mutex_lock(&ts->mutex_earsense);
+    mutex_lock(&ts->mutex);
+    ts->earsense_ops->delta_read(ts->chip_data, ts->earsense_delta, 2 * ts->hw_res.EARSENSE_TX_NUM * ts->hw_res.EARSENSE_RX_NUM);
+    mutex_unlock(&ts->mutex);
+    mutex_unlock(&ts->mutex_earsense);
+    ts->delta_state=TYPE_DELTA_IDLE;
+}
+
+void tp_util_get_vendor(struct touchpanel_data *ts, struct panel_info *panel_data)
+{
+
+	panel_data->test_limit_name = kzalloc(MAX_LIMIT_DATA_LENGTH, GFP_KERNEL);
+	if (panel_data->test_limit_name == NULL) {
+		TPD_INFO("panel_data.test_limit_name kzalloc error\n");
+	}
+
+	if (ts->module_id_support) {
+		if (lcd_id) {
+			snprintf(panel_data->fw_name, MAX_FW_NAME_LENGTH,
+			"tp/FW_%s_%s_NEW.img", panel_data->project_name, panel_data->chip_name);
+
+			if (panel_data->test_limit_name) {
+				snprintf(panel_data->test_limit_name, MAX_LIMIT_DATA_LENGTH,
+				"tp/LIMIT_%s_%s_NEW.img", panel_data->project_name, panel_data->chip_name);
+			}
+		} else {
+			snprintf(panel_data->fw_name, MAX_FW_NAME_LENGTH,
+			"tp/FW_%s_%s.img", panel_data->project_name, panel_data->chip_name);
+
+			if (panel_data->test_limit_name) {
+				snprintf(panel_data->test_limit_name, MAX_LIMIT_DATA_LENGTH,
+				"tp/LIMIT_%s_%s.img", panel_data->project_name, panel_data->chip_name);
+			}
+		}
+	} else {
+		snprintf(panel_data->fw_name, MAX_FW_NAME_LENGTH,
+		"tp/FW_%s_%s.img", panel_data->project_name, panel_data->chip_name);
+
+		if (panel_data->test_limit_name) {
+			snprintf(panel_data->test_limit_name, MAX_LIMIT_DATA_LENGTH,
+			"tp/LIMIT_%s_%s.img", panel_data->project_name, panel_data->chip_name);
+		}
+	}
+
+	sprintf(panel_data->manufacture_info.version, "0x%x", panel_data->TP_FW);
+	sprintf(panel_data->manufacture_info.manufacture, panel_data->chip_name);
+	push_component_info(TOUCH_KEY, panel_data->manufacture_info.version, panel_data->manufacture_info.manufacture);
+	push_component_info(TP, panel_data->manufacture_info.version, panel_data->manufacture_info.manufacture);
+
+	TPD_INFO("%s fw:%s limit:%s\n", __func__, panel_data->fw_name, panel_data->test_limit_name);
+}
+
+
+void sec_ts_pinctrl_configure(struct hw_resource *hw_res, bool enable)
+{
+	int ret;
+
+	if (enable) {
+		if (hw_res->pinctrl) {
+			ret = pinctrl_select_state(hw_res->pinctrl, hw_res->pin_set_high);
+			if (ret)
+				TPD_INFO("%s could not set active pinstate", __func__);
+		}
+	} else {
+		if (hw_res->pinctrl) {
+			ret = pinctrl_select_state(hw_res->pinctrl, hw_res->pin_set_low);
+			if (ret)
+				TPD_INFO("%s could not set suspend pinstate", __func__);
+		}
+	}
+}
+
+
+/**
+ * register_common_touch_device - parse dts, get resource defined in Dts
+ * @pdata: touchpanel_data, using for common driver
+ *
+ * entrance of common touch Driver
+ * Returning zero(sucess) or negative errno(failed)
+ */
+
+int register_common_touch_device(struct touchpanel_data *pdata)
+{
+    struct touchpanel_data *ts = pdata;
+    struct invoke_method *invoke;
+
+    int ret = -1;
+
+    TPD_INFO("%s  is called\n", __func__);
+
+	//step : FTM process
+	ts->boot_mode = get_boot_mode();
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+		if ((ts->boot_mode == META_BOOT || ts->boot_mode == FACTORY_BOOT))
+#else
+		if ((ts->boot_mode == MSM_BOOT_MODE__FACTORY || ts->boot_mode == MSM_BOOT_MODE__RF || ts->boot_mode == MSM_BOOT_MODE__WLAN || ts->boot_mode == MSM_BOOT_MODE__CHARGE))
+#endif
+		{
+			TPD_INFO("%s: not int normal mode, return.\n", __func__);
+			return -1;
+		}
+    //step1 : dts parse
+    init_parse_dts(ts->dev, ts);
+
+    //step2 : IIC interfaces init
+    init_touch_interfaces(ts->dev, ts->register_is_16bit);
+
+    //step3 : mutex init
+    mutex_init(&ts->mutex);
+    init_completion(&ts->pm_complete);
+    init_completion(&ts->fw_complete);
+    init_completion(&ts->resume_complete);
+
+    ts->async_workqueue = create_singlethread_workqueue("tp_async");
+    if (!ts->async_workqueue) {
+        ret = -ENOMEM;
+        return -1;
+    }
+    INIT_WORK(&ts->async_work, tp_async_work_lock);
+
+    if (ts->has_callback) {
+        invoke = (struct invoke_method *)pdata->chip_data;
+        invoke->invoke_common = tp_work_common_callback;
+        invoke->async_work = tp_async_work_callback;
+    }
+	sec_ts_pinctrl_configure(&ts->hw_res, true);
+    //step4 : Power init && setting
+    preconfig_power_control(ts);
+    ret = init_power_control(ts);
+    if (ret) {
+        TPD_INFO("%s: tp power init failed.\n", __func__);
+        return -1;
+    }
+    ret = reconfig_power_control(ts);
+    if (ret) {
+        TPD_INFO("%s: reconfig power failed.\n", __func__);
+        return -1;
+    }
+    if (!ts->ts_ops->power_control) {
+        ret = -EINVAL;
+        TPD_INFO("tp power_control NULL!\n");
+        goto power_control_failed;
+    }
+    ret = ts->ts_ops->power_control(ts->chip_data, true);
+    if (ret) {
+        TPD_INFO("%s: tp power init failed.\n", __func__);
+        goto power_control_failed;
+    }
+    //step5 : I2C function check
+    if (!ts->is_noflash_ic) {
+        if (!i2c_check_functionality(ts->client->adapter, I2C_FUNC_I2C)) {
+            TPD_INFO("%s: need I2C_FUNC_I2C\n", __func__);
+            ret = -ENODEV;
+            goto err_check_functionality_failed;
+        }
+    }
+
+    //step6 : touch input dev init
+    ret = init_input_device(ts);
+    if (ret < 0) {
+        ret = -EINVAL;
+        TPD_INFO("tp_input_init failed!\n");
+        goto err_check_functionality_failed;
+    }
+
+    if (ts->int_mode == UNBANNABLE) {
+        ret = tp_register_irq_func(ts);
+        if (ret < 0) {
+            goto free_touch_panel_input;
+        }
+    }
+
+    //step8 : Alloc fw_name/devinfo memory space
+    ts->panel_data.fw_name = kzalloc(MAX_FW_NAME_LENGTH, GFP_KERNEL);
+    if (ts->panel_data.fw_name == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("panel_data.fw_name kzalloc error\n");
+        goto free_touch_panel_input;
+    }
+
+    ts->panel_data.manufacture_info.version = kzalloc(MAX_DEVICE_VERSION_LENGTH, GFP_KERNEL);
+    if (ts->panel_data.manufacture_info.version == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("manufacture_info.version kzalloc error\n");
+        goto manu_version_alloc_err;
+    }
+
+    ts->panel_data.manufacture_info.manufacture = kzalloc(MAX_DEVICE_MANU_LENGTH, GFP_KERNEL);
+    if (ts->panel_data.manufacture_info.manufacture == NULL) {
+        ret = -ENOMEM;
+        TPD_INFO("panel_data.fw_name kzalloc error\n");
+        goto manu_info_alloc_err;
+    }
+
+    //step8 : touchpanel vendor
+    tp_util_get_vendor(ts, &ts->panel_data);
+	if (ts->ts_ops->get_vendor) {
+		ts->ts_ops->get_vendor(ts->chip_data, &ts->panel_data);
+	}
+
+    //step10:get chip info
+    if (!ts->ts_ops->get_chip_info) {
+        ret = -EINVAL;
+        TPD_INFO("tp get_chip_info NULL!\n");
+        goto err_check_functionality_failed;
+    }
+    ret = ts->ts_ops->get_chip_info(ts->chip_data);
+    if (ret < 0) {
+        ret = -EINVAL;
+        TPD_INFO("tp get_chip_info failed!\n");
+        goto err_check_functionality_failed;
+    }
+
+    //step11 : touchpanel Fw check
+    if(!ts->is_noflash_ic) {            //noflash don't have firmware before fw update
+        if (!ts->ts_ops->fw_check) {
+                ret = -EINVAL;
+                TPD_INFO("tp fw_check NULL!\n");
+                goto manu_info_alloc_err;
+        }
+        ret = ts->ts_ops->fw_check(ts->chip_data, &ts->resolution_info, &ts->panel_data);
+        if (ret == FW_ABNORMAL) {
+                ts->force_update = 1;
+                TPD_INFO("This FW need to be updated!\n");
+        } else {
+                ts->force_update = 0;
+        }
+    }
+
+    //step12 : enable touch ic irq output ability
+    if (!ts->ts_ops->mode_switch) {
+        ret = -EINVAL;
+        TPD_INFO("tp mode_switch NULL!\n");
+        goto manu_info_alloc_err;
+    }
+    ret = ts->ts_ops->mode_switch(ts->chip_data, MODE_NORMAL, true);
+    if (ret < 0) {
+        ret = -EINVAL;
+        TPD_INFO("%s:modem switch failed!\n", __func__);
+        goto manu_info_alloc_err;
+    }
+
+	wakeup_source_init(&ts->source, "tp_syna");
+	//step13 : irq request setting
+    if (ts->int_mode == BANNABLE) {
+        ret = tp_register_irq_func(ts);
+        if (ret < 0) {
+            goto manu_info_alloc_err;
+        }
+    }
+
+    //step14 : suspend && resume fuction register
+#if defined(CONFIG_DRM_MSM)
+    ts->fb_notif.notifier_call = fb_notifier_callback;
+    ret = msm_drm_register_client(&ts->fb_notif);
+    if (ret) {
+        TPD_INFO("Unable to register fb_notifier: %d\n", ret);
+    }
+#elif defined(CONFIG_FB)
+    ts->fb_notif.notifier_call = fb_notifier_callback;
+    ret = fb_register_client(&ts->fb_notif);
+    if (ret) {
+        TPD_INFO("Unable to register fb_notifier: %d\n", ret);
+    }
+#endif/*CONFIG_FB*/
+
+    //step15 : workqueue create(speedup_resume)
+    ts->speedup_resume_wq = create_singlethread_workqueue("speedup_resume_wq");
+    if (!ts->speedup_resume_wq) {
+        ret = -ENOMEM;
+        goto threaded_irq_free;
+    }
+
+    INIT_WORK(&ts->speed_up_work, speedup_resume);
+    INIT_WORK(&ts->fw_update_work, tp_fw_update_work);
+
+    //step 16 : short edge shield
+    if (ts->edge_limit_support) {
+        ts->limit_enable = 1;
+        ts->limit_edge = ts->limit_enable & 1;
+        ts->limit_corner = 0;
+        ts->edge_limit.limit_area = 1;
+        ts->edge_limit.in_which_area = AREA_NOTOUCH;
+
+        ts->edge_limit.left_x1  = (ts->edge_limit.limit_area * 1000)/100;
+        ts->edge_limit.right_x1 = ts->resolution_info.LCD_WIDTH - ts->edge_limit.left_x1;
+        ts->edge_limit.left_x2  = 2 * ts->edge_limit.left_x1;
+        ts->edge_limit.right_x2 = ts->resolution_info.LCD_WIDTH - (2 * ts->edge_limit.left_x1);
+        ts->edge_limit.left_x3  = 5 * ts->edge_limit.left_x1;
+        ts->edge_limit.right_x3 = ts->resolution_info.LCD_WIDTH - (5 * ts->edge_limit.left_x1);
+
+        ts->edge_limit.left_y1  = (ts->edge_limit.limit_area * 1000)/100;
+        ts->edge_limit.right_y1 = ts->resolution_info.LCD_HEIGHT - ts->edge_limit.left_y1;
+        ts->edge_limit.left_y2  = 2 * ts->edge_limit.left_y1;
+        ts->edge_limit.right_y2 = ts->resolution_info.LCD_HEIGHT - (2 * ts->edge_limit.left_y1);
+        ts->edge_limit.left_y3  = 5 * ts->edge_limit.left_y1;
+        ts->edge_limit.right_y3 = ts->resolution_info.LCD_HEIGHT - (5 * ts->edge_limit.left_y1);
+    }
+
+    //step 17:esd recover support
+    if (ts->esd_handle_support) {
+        ts->esd_info.esd_workqueue = create_singlethread_workqueue("esd_workthread");
+        INIT_DELAYED_WORK(&ts->esd_info.esd_check_work, esd_handle_func);
+
+        mutex_init(&ts->esd_info.esd_lock);
+
+        ts->esd_info.esd_running_flag = 0;
+        ts->esd_info.esd_work_time = 2 * HZ; // HZ: clock ticks in 1 second generated by system
+        TPD_INFO("Clock ticks for an esd cycle: %d\n", ts->esd_info.esd_work_time);
+
+        esd_handle_switch(&ts->esd_info, true);
+    }
+
+    //step 18:spurious_fingerprint support
+    if (ts->spurious_fp_support) {
+        ts->spuri_fp_touch.thread = kthread_run(finger_protect_handler, ts, "touchpanel_fp");
+        if (IS_ERR(ts->spuri_fp_touch.thread)) {
+            TPD_INFO("spurious fingerprint thread create failed\n");
+        }
+    }
+
+    //step 19: charge pump support
+    if (ts->charger_pump_support) {
+        if (ts->ts_ops->get_usb_state) {
+            ts->is_usb_checked = !!ts->ts_ops->get_usb_state();
+        } else {
+            ts->is_usb_checked = 0;
+        }
+        TPD_INFO("curent usb state is %d\n", ts->is_usb_checked);
+        ret = ts->ts_ops->mode_switch(ts->chip_data, MODE_CHARGE, ts->is_usb_checked);
+        if (ret < 0) {
+            TPD_INFO("switch charge mode failed\n");
+        }
+    }
+
+    // step 20: ear sense support
+    if (ts->ear_sense_support) {
+        mutex_init(&ts->mutex_earsense);    // init earsense operate mutex
+
+        //malloc space for storing earsense delta
+        ts->earsense_delta = kzalloc(2 * ts->hw_res.EARSENSE_TX_NUM * ts->hw_res.EARSENSE_RX_NUM, GFP_KERNEL);
+        if (ts->earsense_delta == NULL) {
+            ret = -ENOMEM;
+            TPD_INFO("earsense_delta kzalloc error\n");
+            goto threaded_irq_free;
+        }
+
+        //create work queue for read earsense delta
+        ts->delta_read_wq = create_singlethread_workqueue("touch_delta_wq");
+        if (!ts->delta_read_wq) {
+            ret = -ENOMEM;
+            goto earsense_alloc_free;
+        }
+        INIT_WORK(&ts->read_delta_work, touch_read_delta);
+    }
+
+    //step 21 : createproc proc files interface
+    init_touchpanel_proc(ts);
+
+    //step 22 : Other****
+    ts->i2c_ready = true;
+    ts->loading_fw = false;
+    ts->is_suspended = 0;
+    ts->suspend_state = TP_SPEEDUP_RESUME_COMPLETE;
+    ts->gesture_enable = 0;
+    ts->es_enable = 0;
+    ts->fd_enable = 0;
+    ts->palm_enable = 1;
+    ts->touch_count = 0;
+    ts->glove_enable = 0;
+    ts->view_area_touched = 0;
+    ts->tp_suspend_order = LCD_TP_SUSPEND;
+    ts->tp_resume_order = TP_LCD_RESUME;
+    ts->skip_suspend_operate = false;
+    ts->skip_reset_in_resume = false;
+    ts->irq_slot = 0;
+	ts->touch_hold_enable = 0;
+	ts->lcd_refresh_rate = 0;
+	ts->reject_point = 0;
+	ts->charge_detect = 0;
+    ts->firmware_update_type = 0;
+    ts->corner_delay_up = -1;
+    if(ts->is_noflash_ic) {
+        ts->irq = ts->s_client->irq;
+    } else {
+        ts->irq = ts->client->irq;
+    }
+    tp_register_times++;
+    g_tp = ts;
+    complete(&ts->pm_complete);
+    TPD_INFO("Touch panel probe : normal end\n");
+    return 0;
+
+earsense_alloc_free:
+    kfree(ts->earsense_delta);
+
+threaded_irq_free:
+    free_irq(ts->irq, ts);
+
+manu_info_alloc_err:
+    kfree(ts->panel_data.manufacture_info.version);
+
+manu_version_alloc_err:
+    kfree(ts->panel_data.fw_name);
+
+free_touch_panel_input:
+    input_unregister_device(ts->input_dev);
+    input_unregister_device(ts->kpd_input_dev);
+
+err_check_functionality_failed:
+    ts->ts_ops->power_control(ts->chip_data, false);
+
+power_control_failed:
+
+    if (!IS_ERR_OR_NULL(ts->hw_res.vdd_2v8)) {
+		regulator_disable(ts->hw_res.vdd_2v8);
+        regulator_put(ts->hw_res.vdd_2v8);
+        ts->hw_res.vdd_2v8 = NULL;
+    }
+
+    if (!IS_ERR_OR_NULL(ts->hw_res.vcc_1v8)) {
+		regulator_disable(ts->hw_res.vcc_1v8);
+        regulator_put(ts->hw_res.vcc_1v8);
+        ts->hw_res.vcc_1v8 = NULL;
+    }
+
+    if (gpio_is_valid(ts->hw_res.enable2v8_gpio))
+        gpio_free(ts->hw_res.enable2v8_gpio);
+
+    if (gpio_is_valid(ts->hw_res.enable1v8_gpio))
+        gpio_free(ts->hw_res.enable1v8_gpio);
+
+    if (gpio_is_valid(ts->hw_res.irq_gpio)) {
+        gpio_free(ts->hw_res.irq_gpio);
+    }
+
+    if (gpio_is_valid(ts->hw_res.reset_gpio)) {
+        gpio_free(ts->hw_res.reset_gpio);
+    }
+
+    if (gpio_is_valid(ts->hw_res.id1_gpio)) {
+        gpio_free(ts->hw_res.id1_gpio);
+    }
+
+    if (gpio_is_valid(ts->hw_res.id2_gpio)) {
+        gpio_free(ts->hw_res.id2_gpio);
+    }
+
+    if (gpio_is_valid(ts->hw_res.id3_gpio)) {
+        gpio_free(ts->hw_res.id3_gpio);
+    }
+	msleep(200);
+	sec_ts_pinctrl_configure(&ts->hw_res, false);
+
+    return ret;
+}
+
+/**
+ * touchpanel_ts_suspend - touchpanel suspend function
+ * @dev: i2c_client->dev using to get touchpanel_data resource
+ *
+ * suspend function bind to LCD on/off status
+ * Returning zero(sucess) or negative errno(failed)
+ */
+static int tp_suspend(struct device *dev)
+{
+    int ret;
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s: start.\n", __func__);
+
+    TPD_INFO("tp_suspend ts->spuri_fp_touch.fp_trigger =%d  ts->i2c_ready =%d  ts->spuri_fp_touch.lcd_resume_ok=%d \n",
+              ts->spuri_fp_touch.fp_trigger , ts->i2c_ready , ts->spuri_fp_touch.lcd_resume_ok);
+    ts->spuri_fp_touch.lcd_resume_ok = false;
+    //step1:detect whether we need to do suspend
+    if (ts->input_dev == NULL) {
+        TPD_INFO("input_dev  registration is not complete\n");
+        goto NO_NEED_SUSPEND;
+    }
+    if (ts->loading_fw) {
+        TPD_INFO("FW is updating while suspending");
+        goto NO_NEED_SUSPEND;
+    }
+
+#ifndef TPD_USE_EINT
+        hrtimer_cancel(&ts->timer);
+#endif
+
+    /* release all complete first */
+    if (ts->ts_ops->reinit_device) {
+        ts->ts_ops->reinit_device(ts->chip_data);
+    }
+
+    //step2:get mutex && start process suspend flow
+    mutex_lock(&ts->mutex);
+    if (!ts->is_suspended) {
+        ts->is_suspended = 1;
+        ts->suspend_state = TP_SUSPEND_COMPLETE;
+    } else {
+        TPD_INFO("%s: do not suspend twice.\n", __func__);
+        goto EXIT;
+    }
+
+    //step3:Release key && touch event before suspend
+    tp_btnkey_release(ts);
+    tp_touch_release(ts);
+
+    //step4:cancel esd test
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, false);
+    }
+
+    //step5:ear sense support
+    if (ts->ear_sense_support) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_EARSENSE, false);
+    }
+    if (ts->face_detect_support) {
+        ts->ts_ops->mode_switch(ts->chip_data, MODE_FACE_DETECT, false);
+    }
+
+    //step6:gesture mode status process
+    if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            ts->ts_ops->mode_switch(ts->chip_data, MODE_GESTURE, true);
+            goto EXIT;
+        }
+    }
+
+    //step7:skip suspend operate only when gesture_enable is 0
+    if (ts->skip_suspend_operate && (!ts->gesture_enable)) {
+        goto EXIT;
+    }
+
+    //step8:switch mode to sleep
+    ret = ts->ts_ops->mode_switch(ts->chip_data, MODE_SLEEP, true);
+    if (ret < 0) {
+        TPD_INFO("%s, Touchpanel operate mode switch failed\n", __func__);
+    }
+
+	sec_ts_pinctrl_configure(&ts->hw_res, false);
+
+
+EXIT:
+    TPD_INFO("%s: end.\n", __func__);
+    mutex_unlock(&ts->mutex);
+
+NO_NEED_SUSPEND:
+    complete(&ts->pm_complete);
+
+    return 0;
+}
+
+/**
+ * touchpanel_ts_suspend - touchpanel resume function
+ * @dev: i2c_client->dev using to get touchpanel_data resource
+ *
+ * resume function bind to LCD on/off status, this fuction start thread to speedup screen on flow.
+ * Do not care the result: Return void type
+ */
+static void tp_resume(struct device *dev)
+{
+    struct touchpanel_data *ts = dev_get_drvdata(dev);
+
+    TPD_INFO("%s start.\n", __func__);
+
+    if (!ts->is_suspended) {
+        TPD_INFO("%s: do not resume twice.\n", __func__);
+        goto NO_NEED_RESUME;
+    }
+    ts->is_suspended = 0;
+    ts->suspend_state = TP_RESUME_COMPLETE;
+    if (ts->loading_fw)
+        goto NO_NEED_RESUME;
+
+    //free irq at first
+    free_irq(ts->irq, ts);
+
+    if (ts->ts_ops->reinit_device) {
+        ts->ts_ops->reinit_device(ts->chip_data);
+    }
+    if(ts->ts_ops->resume_prepare) {
+        mutex_lock(&ts->mutex);
+        ts->ts_ops->resume_prepare(ts->chip_data);
+        mutex_unlock(&ts->mutex);
+    }
+
+    queue_work(ts->speedup_resume_wq, &ts->speed_up_work);
+    return;
+
+NO_NEED_RESUME:
+    ts->suspend_state = TP_SPEEDUP_RESUME_COMPLETE;
+    complete(&ts->pm_complete);
+}
+
+/**
+ * speedup_resume - speedup resume thread process
+ * @work: work struct using for this thread
+ *
+ * do actully resume function
+ * Do not care the result: Return void type
+ */
+static void speedup_resume(struct work_struct *work)
+{
+    int timed_out = 0;
+    struct touchpanel_data *ts = container_of(work, struct touchpanel_data,
+            speed_up_work);
+
+    TPD_INFO("%s is called\n", __func__);
+
+    //step1: get mutex for locking i2c acess flow
+    mutex_lock(&ts->mutex);
+
+    //step2:before Resume clear All of touch/key event Reset some flag to default satus
+    if (ts->edge_limit_support)
+        ts->edge_limit.in_which_area = AREA_NOTOUCH;
+    tp_btnkey_release(ts);
+    tp_touch_release(ts);
+
+    if (ts->int_mode == UNBANNABLE) {
+        tp_register_irq_func(ts);
+    }
+
+
+    //step3:Reset IC && switch work mode, ft8006 is reset by lcd, no more reset needed
+    if ((!ts->skip_reset_in_resume) && (ts->gesture_enable)) {
+        ts->ts_ops->reset(ts->chip_data);
+		if (g_tp->touchold_event) {
+			TPD_INFO("touchhold up\n");
+			g_tp->touchold_event = 0;
+			gf_opticalfp_irq_handler(0);	//do reset will lost touchhold up event.
+		}
+    }
+	ts->skip_reset_in_resume = false;
+	if (!ts->gesture_enable) {
+		sec_ts_pinctrl_configure(&ts->hw_res, true);
+	}
+
+    //step4:If use resume notify, exit wait first
+    if (ts->use_resume_notify) {
+        reinit_completion(&ts->resume_complete);
+        timed_out = wait_for_completion_timeout(&ts->resume_complete, 1*HZ);  //wait resume over for 1s
+        if ((0 == timed_out) || (ts->resume_complete.done)) {
+             TPD_INFO("resume state, timed_out:%d, done:%d\n", timed_out, ts->resume_complete.done);
+        }
+    }
+
+    if (ts->ts_ops->specific_resume_operate) {
+        ts->ts_ops->specific_resume_operate(ts->chip_data);
+    }
+
+   //step5: set default ps status to far
+    if (ts->ts_ops->write_ps_status) {
+        ts->ts_ops->write_ps_status(ts->chip_data, 0);
+    }
+
+    operate_mode_switch(ts);
+
+    if (ts->esd_handle_support) {
+        esd_handle_switch(&ts->esd_info, true);
+    }
+
+    //step6:Request irq again
+    if (ts->int_mode == BANNABLE) {
+        tp_register_irq_func(ts);
+    }
+
+    ts->suspend_state = TP_SPEEDUP_RESUME_COMPLETE;
+
+    //step7:Unlock  && exit
+    TPD_INFO("%s: end!\n", __func__);
+    mutex_unlock(&ts->mutex);
+    complete(&ts->pm_complete);
+}
+
+#if defined(CONFIG_FB) || defined(CONFIG_DRM_MSM)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data)
+{
+    int *blank;
+    int timed_out = -1;
+    struct fb_event *evdata = data;
+    struct touchpanel_data *ts = container_of(self, struct touchpanel_data, fb_notif);
+
+    //to aviod some kernel bug (at fbmem.c some local veriable are not initialized)
+#ifdef CONFIG_DRM_MSM
+    if(event != MSM_DRM_EARLY_EVENT_BLANK && event != MSM_DRM_EVENT_BLANK)
+#else
+    if(event != FB_EARLY_EVENT_BLANK && event != FB_EVENT_BLANK)
+#endif
+        return 0;
+
+    if (evdata && evdata->data && ts && ts->chip_data) {
+        blank = evdata->data;
+        TPD_INFO("%s: event = %ld, blank = %d\n", __func__, event, *blank);
+        if (*blank == MSM_DRM_BLANK_POWERDOWN_CUST) { //suspend
+            if (event == MSM_DRM_EARLY_EVENT_BLANK) {    //early event
+
+                timed_out = wait_for_completion_timeout(&ts->pm_complete, 0.5*HZ);  //wait resume over for 0.5s
+                if ((0 == timed_out) || (ts->pm_complete.done)) {
+                    TPD_INFO("completion state, timed_out:%d, done:%d\n", timed_out, ts->pm_complete.done);
+                }
+
+                ts->suspend_state = TP_SUSPEND_EARLY_EVENT;      //set suspend_resume_state
+                if (ts->esd_handle_support && ts->is_incell_panel && (ts->tp_suspend_order == LCD_TP_SUSPEND)) {
+                    esd_handle_switch(&ts->esd_info, false);     //incell panel need cancel esd early
+                }
+
+                if (ts->tp_suspend_order == TP_LCD_SUSPEND) {
+                    tp_suspend(ts->dev);
+                } else if (ts->tp_suspend_order == LCD_TP_SUSPEND) {
+					if (!ts->gesture_enable) {
+						disable_irq_nosync(ts->irq);	//avoid iic error
+					}
+					tp_suspend(ts->dev);
+                }
+            } else if (event == MSM_DRM_EVENT_BLANK) {   //event
+
+                if (ts->tp_suspend_order == TP_LCD_SUSPEND) {
+
+                } else if (ts->tp_suspend_order == LCD_TP_SUSPEND) {
+					tp_suspend(ts->dev);
+                }
+            }
+        } else if (*blank == MSM_DRM_BLANK_UNBLANK_CUST) {//resume
+            if (event == MSM_DRM_EARLY_EVENT_BLANK) {    //early event
+
+                timed_out = wait_for_completion_timeout(&ts->pm_complete, 0.5*HZ);  //wait suspend over for 0.5s
+                if ((0 == timed_out) || (ts->pm_complete.done)) {
+                    TPD_INFO("completion state, timed_out:%d, done:%d\n", timed_out, ts->pm_complete.done);
+                }
+
+                ts->suspend_state = TP_RESUME_EARLY_EVENT;      //set suspend_resume_state
+
+                if (ts->tp_resume_order == TP_LCD_RESUME) {
+					tp_resume(ts->dev);
+                } else if (ts->tp_resume_order == LCD_TP_RESUME) {
+                    disable_irq_nosync(ts->irq);
+                }
+            } else if (event == MSM_DRM_EVENT_BLANK) {   //event
+
+                if (ts->tp_resume_order == TP_LCD_RESUME) {
+
+                } else if (ts->tp_resume_order == LCD_TP_RESUME) {
+                    tp_resume(ts->dev);
+                    enable_irq(ts->irq);
+                }
+            }
+          }else if (*blank == MSM_DRM_DYNAMICFPS_60) {  //60-90HZ LCD refresh switch
+			if (event == MSM_DRM_EARLY_EVENT_BLANK) {
+				mutex_lock(&ts->mutex);
+				if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+					ts->ts_ops->mode_switch(ts->chip_data, MODE_REFRESH_SWITCH, 0);
+				}
+				mutex_unlock(&ts->mutex);
+			}
+		} else if (*blank == MSM_DRM_DYNAMICFPS_90) {
+			if (event == MSM_DRM_EARLY_EVENT_BLANK) {
+				mutex_lock(&ts->mutex);
+				if (!ts->is_suspended && (ts->suspend_state == TP_SPEEDUP_RESUME_COMPLETE)) {
+					ts->ts_ops->mode_switch(ts->chip_data, MODE_REFRESH_SWITCH, 1);
+				}
+				mutex_unlock(&ts->mutex);
+			}	
+		}
+    }
+
+    return 0;
+}
+#endif
+
+#ifdef CONFIG_TOUCHPANEL_MTK_PLATFORM
+void tp_i2c_suspend(struct touchpanel_data *ts)
+{
+    ts->i2c_ready = false;
+    if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            /*enable gpio wake system through interrupt*/
+            enable_irq_wake(ts->irq);
+            return;
+        }
+    }
+    disable_irq_nosync(ts->irq);
+}
+
+void tp_i2c_resume(struct touchpanel_data *ts)
+{
+    if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            /*disable gpio wake system through intterrupt*/
+            disable_irq_wake(ts->irq);
+            goto OUT;
+        }
+    }
+    enable_irq(ts->irq);
+
+OUT:
+    ts->i2c_ready = true;
+    if (ts->spurious_fp_support && ts->spuri_fp_touch.fp_trigger) {
+        wake_up_interruptible(&waiter);
+    }
+}
+
+#else
+void tp_i2c_suspend(struct touchpanel_data *ts)
+{
+    ts->i2c_ready = false;
+    if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            /*enable gpio wake system through interrupt*/
+            enable_irq_wake(ts->irq);
+        }
+    }
+    disable_irq_nosync(ts->irq);
+}
+
+void tp_i2c_resume(struct touchpanel_data *ts)
+{
+    if (ts->black_gesture_support) {
+        if (ts->gesture_enable == 1) {
+            /*disable gpio wake system through intterrupt*/
+            disable_irq_wake(ts->irq);
+        }
+    }
+    enable_irq(ts->irq);	//avoid other irq wakeup system tp irq will be no response.
+    ts->i2c_ready = true;
+    if (ts->spurious_fp_support && ts->spuri_fp_touch.fp_trigger) {
+        wake_up_interruptible(&waiter);
+    }
+}
+#endif
+
+struct touchpanel_data *common_touch_data_alloc(void)
+{
+    if (g_tp) {
+        TPD_INFO("%s:common panel struct has alloc already!\n", __func__);
+        return NULL;
+    }
+    return kzalloc(sizeof(struct touchpanel_data), GFP_KERNEL);
+}
+
+int common_touch_data_free(struct touchpanel_data *pdata)
+{
+    if (pdata) {
+        kfree(pdata);
+    }
+
+    g_tp = NULL;
+    return 0;
+}
+
+/**
+ * input_report_key_oppo - Using for report virtual key
+ * @work: work struct using for this thread
+ *
+ * before report virtual key, detect whether touch_area has been touched
+ * Do not care the result: Return void type
+ */
+void input_report_key_oppo(struct input_dev *dev, unsigned int code, int value)
+{
+    if (value) {//report Key[down]
+        if (g_tp) {
+            if (g_tp->view_area_touched == 0) {
+                input_report_key(dev, code, value);
+            }
+            else
+                TPD_INFO("Sorry,tp is touch down,can not report touch key\n");
+        }
+    } else {
+        input_report_key(dev, code, value);
+    }
+}
+
+void clear_view_touchdown_flag(void)
+{
+    if (g_tp) {
+        g_tp->view_area_touched = 0;
+    }
+}
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/tp_devices.h b/drivers/input/touchscreen/oneplus_touchscreen/tp_devices.h
new file mode 100644
index 0000000000000000000000000000000000000000..84b36eab8f0d39a68c253f9273b75e582143dc76
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/tp_devices.h
@@ -0,0 +1,41 @@
+/***************************************************
+ * File:tp_devices.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             tp dev
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+#ifndef OPPO_TP_DEVICES_H
+#define OPPO_TP_DEVICES_H
+//device list define
+typedef enum tp_dev{
+    TP_OFILM,
+    TP_BIEL,
+    TP_TRULY,
+    TP_BOE,
+    TP_G2Y,
+    TP_TPK,
+    TP_JDI,
+    TP_SAMSUNG,
+    TP_DSJM,
+    TP_BOE_B8,
+    TP_INNOLUX,
+    TP_HIMAX_DPT,
+    TP_AUO,
+    TP_DEPUTE,
+    TP_UNKNOWN,
+}tp_dev;
+
+struct tp_dev_name {
+    tp_dev type;
+    char name[32];
+};
+
+#endif
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Kconfig b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..7cf85962c8468a601541925d8b8ec7c9d89721c5
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Kconfig
@@ -0,0 +1,10 @@
+
+#Added by Tong.han@Bsp.group.Tp for synaptics ic driver
+
+#config TOUCHPANEL_ONEPLUS
+#	default y
+#	bool "TP Synaptics "
+#	---help---
+#	say Y to enable driver for Touchpanel useing Synaptics_IC
+
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Makefile b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..3957eb7ff2dd6f7311885d9569e631178862c87e
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/Makefile
@@ -0,0 +1,9 @@
+#
+# Makefile for the touchscreen drivers.
+#
+
+# Each configuration option enables a list of files.
+
+obj-$(CONFIG_TOUCHPANEL_ONEPLUS) += touch_interfaces.o
+
+#endif
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.c b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.c
new file mode 100644
index 0000000000000000000000000000000000000000..6a36584acf5bb81695ebc295c1aef5e0e279d6fe
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.c
@@ -0,0 +1,590 @@
+/***************************************************
+ * File:touch_interfaces.c
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             Touch interface
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/spi/spi.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/gpio.h>
+#include <linux/uaccess.h>
+#include <linux/cdev.h>
+#include <linux/dma-mapping.h>
+
+#include "touch_interfaces.h"
+
+#define TPD_DEVICE "touch_interface"
+#define TPD_INFO(a, arg...)  pr_err("[TP]"TPD_DEVICE ": " a, ##arg)
+#define FIX_I2C_LENGTH 256
+static bool register_is_16bit = 0;
+
+/**
+ * touch_i2c_continue_read - Using for "read sequence bytes" through IIC
+ * @client: Handle to slave device
+ * @length: data size we want to read
+ * @data: data read from IIC
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer length(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_continue_read(struct i2c_client* client, unsigned short length, unsigned char *data)
+{
+    int retval;
+    unsigned char retry;
+    struct i2c_msg msg;
+
+    msg.addr = client->addr;
+    msg.flags = I2C_M_RD;
+    msg.len = length;
+    msg.buf = data;
+
+    for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+        if (i2c_transfer(client->adapter, &msg, 1) == 1) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+    if (retry == MAX_I2C_RETRY_TIME) {
+        dev_err(&client->dev, "%s: I2C read over retry limit\n", __func__);
+        retval = -EIO;
+    }
+    return retval;
+
+}
+
+/**
+ * touch_i2c_read_block - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to write
+ * @length: data size we want to send
+ * @data: data we want to send
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer length(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_read_block(struct i2c_client* client, u16 addr, unsigned short length, unsigned char *data)
+{
+	int retval;
+	unsigned char retry;
+	static unsigned char *buffer = NULL;
+	static unsigned int read_buf_size = 0;
+	static unsigned char *read_buf = NULL;
+	struct i2c_msg msg[2];
+
+	buffer = kzalloc(2, GFP_KERNEL | GFP_DMA);
+	if (length > FIX_I2C_LENGTH) {
+		if (read_buf_size < length) {
+			if (read_buf) {
+				kfree(read_buf);
+				TPD_INFO("read block_1,free onec\n");
+			}
+			read_buf =kzalloc(length, GFP_KERNEL);
+			if(!read_buf) {
+				read_buf_size = 0;
+				TPD_INFO("read block kzaloc faied\n");
+				return -ENOMEM;
+			}
+			read_buf_size = length;
+		} else {
+			memset(read_buf, 0 ,length);
+		}
+	} else {
+		if (read_buf_size > FIX_I2C_LENGTH) {
+			kfree(read_buf);
+			read_buf = kzalloc(FIX_I2C_LENGTH,
+				GFP_KERNEL | GFP_DMA);
+			if(!read_buf) {
+				read_buf_size = 0;
+				TPD_INFO("read block kzaloc faied\n");
+				return -ENOMEM;
+			}
+			read_buf_size = FIX_I2C_LENGTH;
+		} else {
+			if(!read_buf) {
+				read_buf = kzalloc(FIX_I2C_LENGTH,
+						GFP_KERNEL | GFP_DMA);
+				if (!read_buf) {
+					read_buf_size = 0;
+					TPD_INFO("read block kzaloc faied\n");
+					return -ENOMEM;
+				}
+				read_buf_size = FIX_I2C_LENGTH;
+			} else {
+				memset(read_buf, 0, length);
+			}
+		}
+	}
+	msg[0].addr = client->addr;
+	msg[0].flags = 0;
+	msg[0].buf = buffer;
+
+	if (!register_is_16bit) {  // if register is 8bit
+		msg[0].len = 1;
+		msg[0].buf[0] = addr & 0xff;
+	} else {
+		msg[0].len = 2;
+		msg[0].buf[0] = addr >> 8 & 0xff;
+		msg[0].buf[1] = addr * 0xff;
+	}
+
+	msg[1].addr = client->addr;
+	msg[1].flags = I2C_M_RD;
+	msg[1].len = length;
+	msg[1].buf = read_buf;
+
+	for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+		if (i2c_transfer(client->adapter, msg, 2) == 2) {
+			retval = length;
+			break;
+		}
+		msleep(20);
+	}
+	if (retry == MAX_I2C_RETRY_TIME) {
+		dev_err(&client->dev, "%s: I2C read over retry limit\n", __func__);
+		retval = -EIO;
+	}
+	memcpy(data, read_buf,length);
+	kfree(buffer);
+	return retval;
+}
+
+/**
+ * touch_i2c_continue_write - Using for "write sequence bytes" through IIC
+ * @client: Handle to slave device
+ * @length: data size we want to write
+ * @data: data write to IIC
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer length(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_continue_write(struct i2c_client* client, unsigned short length, unsigned char *data)
+{
+    int retval;
+    unsigned char retry;
+    struct i2c_msg msg;
+
+    msg.addr = client->addr;
+    msg.flags = 0;
+    msg.buf = data;
+    msg.len = length;
+
+    for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+        if (i2c_transfer(client->adapter, &msg, 1) == 1) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+    if (retry == MAX_I2C_RETRY_TIME) {
+        dev_err(&client->dev, "%s: I2C write over retry limit\n", __func__);
+        retval = -EIO;
+    }
+    return retval;
+}
+
+/**
+ * touch_i2c_write_block - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to write
+ * @length: data size we want to send
+ * @data: data we want to send
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer length(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_write_block(struct i2c_client* client, u16 addr, unsigned short length, unsigned char const *data)
+{
+    int retval;
+    unsigned char retry;
+    //unsigned char buffer[length + 2];
+    unsigned char *buffer;
+    struct i2c_msg msg[1];
+    buffer = (unsigned char *)kzalloc(length + 2,GFP_KERNEL);
+    msg[0].addr = client->addr;
+    msg[0].flags = 0;
+    msg[0].buf = buffer;
+
+    if (!register_is_16bit)  // if register is 8bit
+    {
+        msg[0].len = length + 1;
+        msg[0].buf[0] = addr & 0xff;
+
+        memcpy(&buffer[1], &data[0], length);
+    }
+    else
+    {
+        msg[0].len = length + 2;
+        msg[0].buf[0] = (addr >> 8) & 0xff;
+        msg[0].buf[1] = addr & 0xff;
+
+        memcpy(&buffer[2], &data[0], length);
+    }
+
+    for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+        if (i2c_transfer(client->adapter, msg, 1) == 1) {
+            retval = length;
+            break;
+        }
+        msleep(20);
+    }
+    if (retry == MAX_I2C_RETRY_TIME) {
+        dev_err(&client->dev, "%s: I2C write over retry limit\n", __func__);
+        retval = -EIO;
+    }
+    kfree(buffer);
+    return retval;
+}
+
+/**
+ * touch_i2c_read_byte - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to read
+ *
+ * Actully, This function call touch_i2c_read_block for IIC transfer,
+ * Returning zero(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_read_byte(struct i2c_client* client, unsigned short addr)
+{
+    int retval = 0;
+   // unsigned char buf[2] = {0};
+	unsigned char *buf;
+	buf = (unsigned char *)kzalloc(2,GFP_KERNEL);
+    if (!client)    {
+        dump_stack();
+	kfree(buf);
+        return -1;
+    }
+    retval = touch_i2c_read_block(client, addr, 1, buf);
+    if (retval >= 0)
+        retval = buf[0] & 0xff;
+	kfree(buf);
+    return retval;
+}
+
+
+/**
+ * touch_i2c_write_byte - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to write
+ * @data: data we want to send
+ *
+ * Actully, This function call touch_i2c_write_block for IIC transfer,
+ * Returning zero(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_write_byte(struct i2c_client* client, unsigned short addr, unsigned char data)
+{
+    int retval;
+    int length_trans = 1;
+    unsigned char data_send = data;
+
+    if (!client)    {
+        dump_stack();
+        return -EINVAL;
+    }
+    retval = touch_i2c_write_block(client, addr, length_trans, &data_send);
+    if (retval == length_trans)
+        retval = 0;
+
+    return retval;
+}
+
+/**
+ * touch_i2c_read_word - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to write
+ * @data: data we want to read
+ *
+ * Actully, This func call touch_i2c_Read_block for IIC transfer,
+ * Returning negative errno else a 16-bit unsigned "word" received from the device.
+ */
+int touch_i2c_read_word(struct i2c_client* client, unsigned short addr)
+{
+    int retval;
+   // unsigned char buf[2] = {0};
+	unsigned char *buf;
+
+	buf = (unsigned char *)kzalloc(2, GFP_KERNEL);
+    if (!client)    {
+        dump_stack();
+	kfree(buf);
+        return -EINVAL;
+    }
+    retval = touch_i2c_read_block(client, addr, 2, buf);
+    if (retval >= 0)
+        retval = buf[1] << 8 | buf[0];
+	kfree(buf);
+    return retval;
+}
+
+/**
+ * touch_i2c_write_word - Using for "read word" through IIC
+ * @client: Handle to slave device
+ * @addr: addr to write
+ * @data: data we want to send
+ *
+ * Actully, This function call touch_i2c_write_block for IIC transfer,
+ * Returning zero(transfer success) or most likely negative errno(transfer error)
+ */
+int touch_i2c_write_word(struct i2c_client* client, unsigned short addr, unsigned short data)
+{
+    int retval;
+    int length_trans = 2;
+    unsigned char buf[2] = {data & 0xff, (data >> 8) & 0xff};
+
+    if (!client)    {
+        dump_stack();
+        return -EINVAL;
+    }
+
+    retval = touch_i2c_write_block(client, addr, length_trans, buf);
+    if (retval == length_trans)
+        retval = 0;
+
+    return retval;
+}
+
+/**
+ * touch_i2c_read - Using for "read data from ic after writing or not" through IIC
+ * @client: Handle to slave device
+ * @writebuf: buf to write
+ * @writelen: data size we want to send
+ * @readbuf:  buf we want save data
+ * @readlen:  data size we want to receive
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer msg length(transfer success) or most likely negative errno(transfer EIO error)
+ */
+int touch_i2c_read(struct i2c_client *client, char *writebuf, int writelen, char *readbuf, int readlen)
+{
+	int retval = 0;
+	int retry = 0;
+
+	if (client == NULL) {
+		TPD_INFO("%s: i2c_client == NULL!\n", __func__);
+		return -EINVAL;
+	}
+
+	if (readlen > 0) {
+		if (writelen > 0) {
+			struct i2c_msg msgs[] = {
+				{
+					.addr = client->addr,
+					.flags = 0,
+					.len = writelen,
+					.buf = writebuf,
+				},
+				{
+					.addr = client->addr,
+					.flags = I2C_M_RD,
+					.len = readlen,
+					.buf = readbuf,
+				},
+			};
+
+			for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+				if (i2c_transfer(client->adapter,
+							msgs, 2) == 2) {
+					retval = 2;
+					break;
+				}
+				msleep(20);
+			}
+		} else {
+			struct i2c_msg msgs[] = {
+				{
+					.addr = client->addr,
+					.flags = I2C_M_RD,
+					.len = readlen,
+					.buf = readbuf,
+				},
+			};
+
+			for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+				if (i2c_transfer(client->adapter,
+						msgs, 1) == 1) {
+					retval = 1;
+					break;
+				}
+				msleep(20);
+			}
+		}
+
+		if (retry == MAX_I2C_RETRY_TIME) {
+			TPD_INFO("%s: i2c_transfer(read) over retry limit\n",
+				__func__);
+			retval = -EIO;
+		}
+	}
+
+	return retval;
+}
+
+/**
+ * touch_i2c_write - Using for "write data to ic" through IIC
+ * @client: Handle to slave device
+ * @writebuf: buf data wo want to send
+ * @writelen: data size we want to send
+ *
+ * Actully, This function call i2c_transfer for IIC transfer,
+ * Returning transfer msg length(transfer success) or most likely negative errno(transfer EIO error)
+ */
+int touch_i2c_write(struct i2c_client *client, char *writebuf, int writelen)
+{
+	int retval = 0;
+	int retry = 0;
+
+	if (client == NULL) {
+		TPD_INFO("%s: i2c_client == NULL!", __func__);
+		return -EINVAL;
+	}
+
+	if (writelen > 0) {
+		struct i2c_msg msgs[] = {
+			{
+				.addr = client->addr,
+				.flags = 0,
+				.len = writelen,
+				.buf = writebuf,
+			},
+		};
+
+		for (retry = 0; retry < MAX_I2C_RETRY_TIME; retry++) {
+			if (i2c_transfer(client->adapter,
+					msgs, 1) == 1) {
+				retval = 1;
+				break;
+			}
+			msleep(20);
+		}
+
+		if (retry == MAX_I2C_RETRY_TIME) {
+			TPD_INFO("%s: i2c_transfer(write) over retry limit\n",
+					__func__);
+			retval = -EIO;
+		}
+	}
+
+	return retval;
+}
+
+
+/**
+ * init_touch_interfaces - Using for Register IIC interface
+ * @dev: i2c_client->dev using to alloc memory for dma transfer
+ * @flag_register_16bit: bool param to detect whether this device using 16bit IIC address or 8bit address
+ *
+ * Actully, This function don't have many operation, we just detect device address length && alloc DMA memory for MTK platform
+ * Returning zero(sucess) or -ENOMEM(memory alloc failed)
+ */
+int init_touch_interfaces(struct device *dev, bool flag_register_16bit)
+{
+    register_is_16bit = flag_register_16bit;
+
+    return 0;
+}
+
+/*******************************************************
+Description:
+	Novatek touchscreen spi read/write core function.
+
+return:
+	Executive outcomes. 0---succeed.
+*******************************************************/
+int32_t spi_read_write(struct spi_device *client, uint8_t *buf, size_t len , uint8_t *rbuf, SPI_RW rw)
+{
+	struct spi_message m;
+	struct spi_transfer t = {
+		.len    = len,
+	};
+
+	switch (rw) {
+		case SPIREAD:
+			t.tx_buf = &buf[0];
+			t.rx_buf = rbuf;
+			t.len    = (len + DUMMY_BYTES);
+			break;
+
+		case SPIWRITE:
+			t.tx_buf = buf;
+			break;
+	}
+
+	spi_message_init(&m);
+	spi_message_add_tail(&t, &m);
+	return spi_sync(client, &m);
+}
+
+/*******************************************************
+Description:
+	Novatek touchscreen spi read function.
+
+return:
+	Executive outcomes. 2---succeed. -5---I/O error
+*******************************************************/
+int32_t CTP_SPI_READ(struct spi_device *client, uint8_t *buf, uint16_t len)
+{
+	int32_t ret = -1;
+	int32_t retries = 0;
+        uint8_t rbuf[SPI_TANSFER_LEN+1] = {0};
+
+	buf[0] = SPI_READ_MASK(buf[0]);
+
+	while (retries < 5) {
+		ret = spi_read_write(client, buf, len, rbuf, SPIREAD);
+		if (ret == 0) break;
+		retries++;
+	}
+
+	if (unlikely(retries == 5)) {
+		TPD_INFO("read error, ret=%d\n", ret);
+		ret = -EIO;
+	} else {
+		memcpy((buf+1), (rbuf+2), (len-1));
+	}
+
+	return ret;
+}
+
+/*******************************************************
+Description:
+	Novatek touchscreen spi write function.
+
+return:
+	Executive outcomes. 1---succeed. -5---I/O error
+*******************************************************/
+int32_t CTP_SPI_WRITE(struct spi_device *client, uint8_t *buf, uint16_t len)
+{
+	int32_t ret = -1;
+	int32_t retries = 0;
+
+	buf[0] = SPI_WRITE_MASK(buf[0]);
+
+	while (retries < 5) {
+		ret = spi_read_write(client, buf, len, NULL, SPIWRITE);
+		if (ret == 0)	break;
+		retries++;
+	}
+
+	if (unlikely(retries == 5)) {
+		TPD_INFO("error, ret=%d\n", ret);
+		ret = -EIO;
+	}
+
+	return ret;
+}
+
diff --git a/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.h b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.h
new file mode 100644
index 0000000000000000000000000000000000000000..8f04e2657abd00b9a8bee90db7ea49736fc90213
--- /dev/null
+++ b/drivers/input/touchscreen/oneplus_touchscreen/util_interface/touch_interfaces.h
@@ -0,0 +1,52 @@
+/***************************************************
+ * File:touch_interfaces.h
+ * Copyright (c)  2008- 2030  Oppo Mobile communication Corp.ltd.
+ * Description:
+ *             Touch interface
+ * Version:1.0:
+ * Date created:2016/09/02
+ * Author: Tong.han@Bsp.Driver
+ * TAG: BSP.TP.Init
+ * *
+ * -------------- Revision History: -----------------
+ *  <author >  <data>  <version>  <desc>
+ ***************************************************/
+#include <linux/spi/spi.h>
+#ifndef TOUCH_INTERFACES_H
+#define TOUCH_INTERFACES_H
+
+#define MAX_I2C_RETRY_TIME 2
+
+//---SPI READ/WRITE---
+#define SPI_WRITE_MASK(a)	(a | 0x80)
+#define SPI_READ_MASK(a)	(a & 0x7F)
+#define DUMMY_BYTES (1)
+#define SPI_TANSFER_LEN		512
+
+typedef enum {
+	SPIWRITE = 1,
+	SPIREAD  = 2
+} SPI_RW;
+
+int touch_i2c_read_byte(struct i2c_client* client, u16 addr);
+int touch_i2c_write_byte(struct i2c_client* client, u16 addr, unsigned char data);
+
+int touch_i2c_read_word(struct i2c_client* client, u16 addr);
+int touch_i2c_write_word(struct i2c_client* client, u16 addr, unsigned short data);
+
+int touch_i2c_read_block(struct i2c_client* client, u16 addr, unsigned short length, unsigned char *data);
+int touch_i2c_write_block(struct i2c_client* client, u16 addr, unsigned short length, unsigned char const *data);
+
+int touch_i2c_read(struct i2c_client *client, char *writebuf, int writelen, char *readbuf, int readlen);
+int touch_i2c_write(struct i2c_client *client, char *writebuf, int writelen);
+
+int init_touch_interfaces(struct device *dev, bool flag_register_16bit);
+int touch_i2c_continue_read(struct i2c_client* client, unsigned short length, unsigned char *data);
+int touch_i2c_continue_write(struct i2c_client* client, unsigned short length, unsigned char *data);
+int32_t spi_read_write(struct spi_device *client, uint8_t *buf, size_t len, uint8_t *rbuf, SPI_RW rw);
+int32_t CTP_SPI_READ(struct spi_device *client, uint8_t *buf, uint16_t len);
+int32_t CTP_SPI_WRITE(struct spi_device *client, uint8_t *buf, uint16_t len);
+
+
+#endif
+
diff --git a/drivers/input/touchscreen/synaptics_baseline.h b/drivers/input/touchscreen/synaptics_baseline.h
new file mode 100644
index 0000000000000000000000000000000000000000..c7ebecce1286a3d826953c5a7bed71450b4574a5
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_baseline.h
@@ -0,0 +1,617 @@
+#ifndef SYNAPTICS_BASELINE_H
+#define SYNAPTICS_BASELINE_H
+
+#define TX_NUMBER  (17)
+#define TX_17801_NUMBER  (15)
+#define RX_NUMBER  (30)
+
+#define TX_17819_NUMBER  (16)
+#define RX_17819_NUMBER  (33)
+
+/*17819 s3706 TX 16 RX 33*/
+const int16_t baseline_cap_17819_data[2][TX_17819_NUMBER][RX_17819_NUMBER*2] = {
+//enable cbc  Notice it is opposite to the xls format.
+{
+	{459, 1071, 526, 1228, 533, 1244, 531, 1239,
+	529, 1234, 531, 1238, 532, 1242, 532, 1241,
+	532, 1241, 534, 1246, 535, 1249, 541, 1263,
+	539, 1257, 544, 1268, 546, 1274, 547, 1276,
+	553, 1290, 558, 1302, 558, 1303, 561, 1310,
+	569, 1328, 573, 1338, 593, 1384, 585, 1366,
+	590, 1376, 593, 1384, 598, 1395, 602, 1406,
+	608, 1419, 610, 1424, 613, 1431, 619, 1444,
+	629, 1468},
+	{544, 1269, 545, 1271, 546, 1275, 544, 1270,
+	541, 1263, 543, 1266, 545, 1271, 544, 1269,
+	544, 1270, 547, 1277, 548, 1278, 553, 1291,
+	552, 1288, 557, 1300, 558, 1302, 559, 1304,
+	566, 1322, 571, 1333, 570, 1331, 573, 1338,
+	582, 1359, 584, 1362, 591, 1379, 596, 1391,
+	619, 1444, 605, 1411, 611, 1426, 615, 1436,
+	620, 1446, 623, 1454, 626, 1460, 630, 1469,
+	643, 1499},
+	{544, 1269, 542, 1264, 543, 1267, 541, 1262,
+	538, 1255, 540, 1259, 541, 1263, 541, 1262,
+	541, 1263, 544, 1269, 544, 1270, 550, 1284,
+	549, 1281, 554, 1293, 555, 1294, 555, 1296,
+	563, 1313, 568, 1325, 567, 1323, 570, 1329,
+	579, 1351, 599, 1397, 587, 1371, 592, 1381,
+	598, 1394, 600, 1401, 607, 1416, 611, 1426,
+	615, 1436, 620, 1446, 621, 1449, 625, 1458,
+	636, 1485},
+	{544, 1269, 540, 1261, 541, 1263, 539, 1258,
+	536, 1251, 538, 1255, 539, 1259, 539, 1258,
+	539, 1258, 542, 1265, 543, 1266, 548, 1279,
+	547, 1277, 552, 1288, 553, 1290, 554, 1292,
+	561, 1309, 566, 1321, 565, 1319, 587, 1370,
+	577, 1347, 579, 1350, 585, 1366, 590, 1377,
+	595, 1389, 598, 1396, 605, 1411, 609, 1421,
+	613, 1431, 643, 1500, 619, 1443, 622, 1451,
+	632, 1475},
+	{543, 1268, 541, 1262, 540, 1261, 538, 1256,
+	535, 1249, 537, 1253, 539, 1257, 539, 1257,
+	558, 1302, 542, 1264, 542, 1265, 547, 1277,
+	547, 1276, 551, 1286, 552, 1288, 553, 1290,
+	560, 1307, 565, 1318, 564, 1315, 567, 1323,
+	576, 1345, 578, 1348, 584, 1363, 589, 1374,
+	594, 1386, 597, 1392, 603, 1408, 608, 1418,
+	612, 1428, 615, 1435, 617, 1440, 620, 1447,
+	629, 1468},
+	{478, 1115, 564, 1316, 541, 1262, 539, 1257,
+	536, 1250, 557, 1299, 539, 1258, 539, 1257,
+	539, 1258, 542, 1264, 543, 1266, 548, 1278,
+	548, 1278, 552, 1287, 552, 1289, 553, 1290,
+	560, 1307, 564, 1315, 562, 1311, 566, 1320,
+	576, 1344, 578, 1348, 584, 1364, 589, 1374,
+	594, 1386, 597, 1392, 603, 1408, 607, 1417,
+	611, 1426, 614, 1433, 617, 1439, 620, 1446,
+	627, 1463},
+	{263, 614, 500, 1167, 540, 1260, 541, 1261,
+	538, 1255, 540, 1260, 542, 1264, 541, 1263,
+	542, 1264, 545, 1271, 545, 1272, 550, 1284,
+	550, 1282, 554, 1293, 555, 1295, 575, 1341,
+	561, 1309, 564, 1316, 563, 1314, 567, 1322,
+	578, 1348, 580, 1352, 586, 1367, 591, 1378,
+	596, 1390, 598, 1395, 604, 1410, 608, 1419,
+	612, 1428, 615, 1434, 617, 1439, 620, 1447,
+	626, 1460},
+	{230, 536, 498, 1163, 541, 1262, 542, 1264,
+	558, 1303, 541, 1263, 543, 1267, 543, 1266,
+	543, 1267, 546, 1274, 546, 1275, 552, 1287,
+	551, 1285, 555, 1296, 556, 1297, 556, 1297,
+	561, 1308, 564, 1316, 563, 1314, 567, 1323,
+	578, 1349, 580, 1354, 587, 1370, 591, 1379,
+	596, 1392, 599, 1397, 605, 1411, 608, 1419,
+	612, 1428, 615, 1434, 617, 1439, 620, 1447,
+	625, 1458},
+	{245, 573, 506, 1180, 543, 1266, 543, 1267,
+	540, 1261, 543, 1266, 544, 1270, 544, 1270,
+	544, 1270, 548, 1278, 548, 1278, 553, 1290,
+	552, 1289, 557, 1300, 557, 1301, 558, 1301,
+	562, 1312, 566, 1320, 565, 1318, 569, 1327,
+	579, 1352, 581, 1356, 588, 1372, 612, 1428,
+	598, 1394, 600, 1399, 605, 1412, 609, 1421,
+	613, 1429, 615, 1435, 617, 1440, 620, 1448,
+	624, 1456},
+	{287, 670, 525, 1224, 545, 1273, 545, 1272,
+	542, 1265, 545, 1271, 546, 1274, 546, 1275,
+	547, 1275, 549, 1282, 550, 1284, 575, 1342,
+	555, 1294, 559, 1305, 560, 1306, 560, 1308,
+	566, 1320, 569, 1328, 568, 1326, 572, 1334,
+	581, 1355, 583, 1361, 590, 1376, 594, 1386,
+	599, 1397, 601, 1402, 606, 1415, 610, 1423,
+	613, 1431, 616, 1437, 618, 1441, 621, 1449,
+	623, 1454},
+	{504, 1175, 550, 1284, 547, 1277, 545, 1272,
+	542, 1265, 545, 1271, 546, 1274, 546, 1274,
+	547, 1275, 550, 1282, 550, 1284, 556, 1297,
+	555, 1295, 560, 1306, 560, 1307, 561, 1309,
+	568, 1325, 572, 1334, 570, 1330, 573, 1337,
+	582, 1357, 584, 1362, 590, 1377, 594, 1387,
+	600, 1399, 621, 1449, 607, 1416, 610, 1424,
+	614, 1432, 616, 1437, 618, 1442, 621, 1449,
+	621, 1448},
+	{566, 1322, 550, 1284, 547, 1276, 544, 1270,
+	542, 1264, 544, 1269, 546, 1274, 546, 1274,
+	546, 1275, 549, 1282, 550, 1283, 555, 1296,
+	555, 1294, 559, 1305, 560, 1306, 561, 1309,
+	568, 1325, 573, 1336, 591, 1378, 574, 1339,
+	583, 1359, 584, 1362, 590, 1377, 594, 1387,
+	599, 1399, 601, 1403, 607, 1416, 610, 1424,
+	613, 1431, 616, 1437, 618, 1441, 621, 1448,
+	616, 1438},
+	{569, 1327, 550, 1283, 547, 1276, 545, 1271,
+	542, 1265, 544, 1270, 546, 1274, 546, 1273,
+	547, 1276, 550, 1283, 570, 1330, 556, 1297,
+	555, 1295, 560, 1306, 560, 1308, 561, 1310,
+	569, 1327, 573, 1338, 572, 1336, 575, 1342,
+	584, 1362, 585, 1365, 591, 1378, 595, 1388,
+	600, 1400, 602, 1405, 607, 1417, 611, 1425,
+	614, 1434, 617, 1439, 619, 1444, 622, 1451,
+	621, 1450},
+	{570, 1331, 550, 1284, 547, 1276, 545, 1271,
+	542, 1265, 545, 1271, 546, 1274, 566, 1321,
+	547, 1277, 550, 1284, 551, 1286, 557, 1299,
+	556, 1298, 561, 1310, 562, 1312, 564, 1315,
+	571, 1332, 576, 1344, 575, 1343, 579, 1350,
+	587, 1370, 589, 1373, 595, 1387, 599, 1398,
+	604, 1410, 607, 1416, 612, 1428, 616, 1437,
+	620, 1447, 623, 1453, 625, 1459, 629, 1467,
+	630, 1469},
+	{574, 1340, 554, 1292, 550, 1283, 548, 1278,
+	545, 1272, 547, 1277, 568, 1326, 549, 1282,
+	550, 1283, 553, 1290, 553, 1291, 559, 1304,
+	558, 1302, 563, 1313, 563, 1314, 565, 1317,
+	572, 1334, 577, 1345, 576, 1343, 579, 1350,
+	587, 1370, 588, 1373, 594, 1387, 599, 1397,
+	604, 1409, 606, 1414, 611, 1427, 615, 1436,
+	619, 1444, 622, 1450, 624, 1456, 628, 1465,
+	627, 1464},
+	{539, 1259, 556, 1297, 550, 1284, 545, 1272,
+	540, 1260, 540, 1261, 541, 1262, 540, 1260,
+	540, 1259, 542, 1264, 542, 1265, 547, 1276,
+	546, 1274, 551, 1285, 570, 1330, 551, 1287,
+	558, 1303, 564, 1315, 562, 1312, 565, 1319,
+	573, 1338, 575, 1341, 581, 1355, 585, 1365,
+	590, 1377, 592, 1382, 598, 1395, 602, 1404,
+	606, 1414, 609, 1422, 612, 1429, 619, 1443,
+	639, 1491},
+},
+	//disable cbc
+{
+	{464, 1082, 531, 1239, 537, 1254, 536, 1250,
+	532, 1242, 535, 1248, 537, 1252, 536, 1251,
+	536, 1252, 538, 1256, 540, 1260, 545, 1272,
+	544, 1269, 549, 1280, 551, 1285, 551, 1286,
+	558, 1302, 563, 1314, 563, 1313, 566, 1320,
+	574, 1340, 578, 1348, 594, 1386, 590, 1377,
+	594, 1387, 598, 1394, 604, 1409, 608, 1419,
+	613, 1431, 617, 1439, 620, 1446, 625, 1457,
+	635, 1481},
+	{548, 1279, 549, 1281, 550, 1284, 548, 1279,
+	545, 1271, 547, 1276, 548, 1280, 548, 1278,
+	548, 1279, 551, 1285, 552, 1288, 557, 1300,
+	556, 1298, 561, 1310, 562, 1312, 563, 1314,
+	571, 1332, 576, 1344, 574, 1340, 577, 1347,
+	587, 1369, 588, 1372, 595, 1389, 601, 1401,
+	620, 1448, 609, 1422, 616, 1437, 620, 1447,
+	625, 1457, 628, 1465, 631, 1472, 635, 1481,
+	647, 1511},
+	{548, 1279, 546, 1273, 547, 1277, 545, 1272,
+	541, 1263, 544, 1269, 545, 1272, 545, 1271,
+	545, 1272, 548, 1278, 549, 1280, 554, 1292,
+	553, 1291, 558, 1303, 559, 1304, 560, 1306,
+	568, 1325, 573, 1336, 571, 1333, 574, 1340,
+	584, 1362, 600, 1400, 592, 1381, 596, 1392,
+	602, 1405, 605, 1411, 612, 1427, 616, 1437,
+	620, 1447, 625, 1458, 626, 1461, 630, 1470,
+	642, 1497},
+	{548, 1279, 544, 1270, 545, 1272, 543, 1268,
+	540, 1259, 542, 1265, 543, 1268, 543, 1267,
+	543, 1267, 546, 1274, 547, 1276, 552, 1289,
+	552, 1287, 557, 1299, 557, 1300, 558, 1302,
+	566, 1320, 571, 1332, 570, 1330, 588, 1373,
+	582, 1358, 583, 1360, 590, 1376, 595, 1387,
+	600, 1400, 603, 1407, 610, 1422, 614, 1432,
+	618, 1442, 648, 1511, 624, 1456, 628, 1465,
+	638, 1488},
+	{548, 1278, 545, 1271, 544, 1270, 542, 1265,
+	539, 1257, 541, 1262, 543, 1266, 543, 1266,
+	559, 1304, 546, 1273, 546, 1275, 551, 1286,
+	551, 1285, 556, 1297, 556, 1298, 557, 1300,
+	565, 1318, 570, 1330, 569, 1327, 572, 1334,
+	581, 1355, 582, 1358, 589, 1374, 594, 1385,
+	599, 1398, 602, 1404, 608, 1420, 613, 1429,
+	617, 1439, 620, 1446, 622, 1452, 626, 1461,
+	635, 1481},
+	{482, 1124, 568, 1325, 545, 1271, 543, 1266,
+	539, 1259, 558, 1302, 543, 1268, 543, 1266,
+	543, 1267, 545, 1273, 546, 1275, 552, 1287,
+	552, 1288, 556, 1297, 557, 1299, 557, 1300,
+	565, 1319, 570, 1331, 569, 1327, 572, 1335,
+	581, 1355, 582, 1358, 589, 1374, 593, 1385,
+	599, 1397, 601, 1403, 608, 1419, 612, 1428,
+	616, 1437, 619, 1444, 622, 1451, 625, 1459,
+	633, 1476},
+	{267, 622, 504, 1176, 544, 1269, 545, 1271,
+	541, 1263, 544, 1270, 545, 1273, 545, 1272,
+	545, 1273, 548, 1279, 549, 1281, 554, 1293,
+	554, 1292, 559, 1303, 559, 1305, 577, 1345,
+	568, 1325, 573, 1336, 571, 1332, 574, 1340,
+	583, 1360, 584, 1363, 590, 1377, 595, 1388,
+	600, 1401, 603, 1406, 609, 1421, 613, 1429,
+	616, 1438, 619, 1445, 622, 1451, 625, 1459,
+	631, 1473},
+	{233, 544, 502, 1171, 545, 1272, 546, 1274,
+	559, 1305, 546, 1273, 547, 1276, 546, 1275,
+	547, 1276, 549, 1282, 550, 1284, 555, 1296,
+	555, 1295, 560, 1306, 560, 1307, 561, 1309,
+	569, 1328, 574, 1339, 572, 1335, 575, 1342,
+	584, 1362, 585, 1365, 591, 1379, 595, 1389,
+	601, 1402, 603, 1408, 609, 1422, 613, 1430,
+	617, 1439, 620, 1446, 622, 1451, 625, 1459,
+	630, 1469},
+	{249, 580, 510, 1189, 547, 1275, 547, 1276,
+	544, 1269, 547, 1275, 548, 1278, 548, 1278,
+	548, 1279, 551, 1286, 552, 1288, 557, 1299,
+	556, 1298, 561, 1309, 562, 1311, 563, 1313,
+	570, 1331, 575, 1342, 574, 1339, 577, 1346,
+	585, 1365, 586, 1368, 592, 1382, 614, 1432,
+	602, 1405, 604, 1409, 610, 1423, 613, 1431,
+	617, 1440, 620, 1446, 622, 1451, 625, 1459,
+	628, 1466},
+	{291, 678, 528, 1233, 550, 1282, 549, 1281,
+	546, 1274, 549, 1280, 550, 1284, 550, 1283,
+	550, 1284, 553, 1291, 554, 1294, 576, 1345,
+	559, 1304, 564, 1315, 564, 1316, 565, 1318,
+	573, 1336, 577, 1347, 576, 1344, 579, 1351,
+	587, 1370, 588, 1372, 594, 1386, 598, 1396,
+	603, 1408, 605, 1412, 611, 1426, 614, 1434,
+	618, 1442, 621, 1448, 622, 1452, 626, 1460,
+	628, 1465},
+	{508, 1185, 554, 1294, 551, 1287, 549, 1281,
+	546, 1273, 549, 1280, 550, 1283, 550, 1283,
+	551, 1285, 553, 1291, 554, 1293, 559, 1305,
+	559, 1304, 564, 1316, 564, 1317, 565, 1319,
+	573, 1337, 578, 1348, 576, 1345, 579, 1352,
+	588, 1371, 589, 1374, 595, 1388, 599, 1397,
+	604, 1409, 623, 1455, 612, 1427, 615, 1435,
+	618, 1442, 621, 1448, 623, 1453, 626, 1460,
+	625, 1459},
+	{571, 1331, 555, 1294, 551, 1285, 549, 1280,
+	545, 1272, 548, 1279, 550, 1283, 549, 1282,
+	550, 1283, 553, 1290, 554, 1292, 559, 1305,
+	559, 1304, 564, 1315, 564, 1316, 565, 1318,
+	573, 1336, 578, 1348, 594, 1385, 579, 1351,
+	587, 1370, 589, 1373, 595, 1387, 599, 1397,
+	604, 1409, 606, 1413, 611, 1426, 615, 1434,
+	618, 1442, 621, 1448, 622, 1452, 626, 1460,
+	621, 1449},
+	{573, 1336, 554, 1292, 551, 1285, 549, 1280,
+	545, 1272, 548, 1280, 550, 1283, 550, 1282,
+	551, 1285, 554, 1292, 572, 1334, 560, 1306,
+	559, 1305, 564, 1316, 565, 1317, 565, 1319,
+	573, 1337, 578, 1349, 577, 1346, 580, 1352,
+	588, 1372, 589, 1374, 595, 1388, 599, 1398,
+	604, 1410, 606, 1415, 612, 1428, 615, 1436,
+	619, 1444, 621, 1450, 623, 1455, 627, 1462,
+	626, 1460},
+	{575, 1341, 554, 1293, 551, 1286, 549, 1281,
+	546, 1273, 549, 1280, 550, 1284, 568, 1325,
+	551, 1286, 554, 1293, 555, 1296, 560, 1308,
+	560, 1308, 566, 1320, 567, 1322, 568, 1325,
+	575, 1343, 580, 1354, 579, 1352, 583, 1360,
+	591, 1380, 593, 1383, 599, 1397, 603, 1408,
+	609, 1421, 611, 1426, 617, 1439, 621, 1448,
+	624, 1457, 627, 1464, 630, 1470, 633, 1478,
+	634, 1480},
+	{578, 1350, 557, 1301, 554, 1293, 552, 1288,
+	548, 1280, 552, 1287, 570, 1331, 553, 1291,
+	554, 1292, 556, 1298, 558, 1301, 563, 1313,
+	562, 1312, 567, 1323, 568, 1324, 569, 1327,
+	576, 1345, 581, 1356, 580, 1353, 583, 1360,
+	591, 1380, 593, 1383, 599, 1397, 603, 1407,
+	608, 1419, 610, 1424, 616, 1438, 620, 1446,
+	623, 1455, 626, 1462, 629, 1467, 633, 1476,
+	632, 1475},
+	{544, 1269, 560, 1307, 554, 1294, 549, 1281,
+	543, 1268, 544, 1270, 545, 1271, 544, 1268,
+	543, 1268, 545, 1273, 546, 1275, 551, 1285,
+	550, 1283, 555, 1295, 572, 1335, 556, 1297,
+	563, 1314, 568, 1325, 566, 1322, 569, 1328,
+	578, 1348, 579, 1350, 585, 1364, 589, 1375,
+	595, 1387, 597, 1392, 603, 1406, 606, 1415,
+	610, 1424, 614, 1432, 617, 1441, 624, 1455,
+	644, 1502},
+}
+};
+
+const int16_t baseline_cap_data[2][TX_NUMBER][RX_NUMBER*2] =
+{
+    //enable cbc
+    {
+		{403,748,441,819,451,837,451,837,450,836,459,852,450,836,448,832,456,846,451,837,454,844,458,850,463,861,498,926,499,927,501,930,515,956,526,978,529,982,528,980,531,987,544,1010,554,1030,557,1034,561,1041,568,1056,568,1056,587,1091,741,1375,776,1440},
+		{424,787,460,854,468,870,468,870,468,870,476,884,468,868,468,868,472,876,470,872,473,879,485,901,485,901,522,969,522,969,522,969,531,987,534,992,547,1017,545,1013,557,1034,561,1041,574,1066,592,1099,576,1070,592,1099,592,1099,601,1115,774,1437,791,1469},
+		{419,779,456,846,464,862,464,862,463,861,471,875,464,862,462,858,470,872,466,865,470,872,473,879,477,887,522,969,522,969,522,969,526,978,530,984,542,1006,540,1002,545,1013,557,1034,566,1052,568,1056,571,1060,580,1076,578,1074,592,1099,757,1405,783,1455},
+		{420,780,456,846,466,865,466,865,464,862,473,879,466,865,463,861,470,872,468,868,470,872,473,879,477,887,522,969,522,969,522,969,528,980,530,984,543,1009,541,1005,544,1010,566,1052,566,1052,566,1052,571,1060,578,1074,578,1073,592,1099,756,1404,783,1453},
+		{421,783,454,844,464,862,464,862,464,862,473,879,464,862,463,861,470,872,466,865,468,870,472,876,476,884,512,952,510,948,522,969,526,978,529,982,541,1005,540,1002,552,1024,557,1034,564,1048,565,1049,567,1053,575,1067,574,1066,592,1099,756,1404,777,1443},
+		{421,783,454,844,464,862,464,862,464,862,473,879,464,862,463,861,470,872,468,868,468,870,473,879,477,887,522,970,511,949,522,969,526,976,528,980,540,1002,539,1001,543,1009,557,1034,565,1049,565,1049,567,1053,575,1067,574,1066,582,1082,752,1396,774,1437},
+		{418,776,453,841,464,862,466,865,463,861,472,876,463,861,462,858,479,889,466,865,468,870,472,876,476,884,510,948,510,948,512,952,524,974,528,980,540,1002,539,1001,540,1002,552,1024,562,1044,563,1045,565,1049,572,1062,572,1062,578,1074,750,1394,774,1437},
+		{415,771,456,846,468,868,468,868,466,865,474,880,466,865,463,861,472,876,468,868,471,875,473,879,477,887,511,949,511,949,522,969,526,976,530,984,540,1002,547,1017,540,1002,552,1024,562,1044,562,1044,563,1045,574,1066,571,1060,578,1073,752,1396,774,1437},
+		{405,751,456,846,468,868,468,870,468,868,474,880,468,868,466,865,473,879,479,889,472,876,475,883,480,891,522,969,522,969,522,969,526,978,530,984,542,1006,539,1001,542,1006,557,1034,565,1049,561,1041,563,1045,572,1062,572,1062,575,1067,752,1396,774,1437},
+		{415,771,460,854,472,876,472,876,471,875,480,891,471,875,470,872,476,884,472,876,476,884,479,889,485,901,522,969,522,969,526,978,530,984,533,991,544,1010,541,1005,543,1009,557,1034,566,1052,565,1049,566,1052,574,1066,574,1066,576,1070,750,1394,774,1437},
+		{428,794,463,861,473,879,474,880,473,879,485,901,474,880,473,879,480,891,476,884,477,887,485,901,485,901,522,969,522,969,522,969,532,988,534,992,545,1013,542,1006,544,1010,557,1034,565,1049,565,1049,566,1052,574,1066,582,1082,574,1066,760,1412,762,1416},
+		{442,822,468,868,477,887,479,889,476,884,485,901,477,887,475,883,485,901,477,887,491,913,485,901,489,907,522,969,522,969,522,969,534,992,536,996,551,1023,543,1009,547,1017,557,1035,584,1084,565,1049,566,1052,574,1066,574,1066,570,1058,750,1394,762,1416},
+		{450,836,470,872,479,889,479,889,476,884,487,904,479,889,476,884,485,901,485,901,485,901,485,901,489,909,524,972,522,969,522,970,544,1010,536,996,547,1017,544,1010,547,1017,557,1035,565,1049,565,1049,567,1053,574,1066,574,1066,568,1056,753,1398,774,1437},
+		{454,844,472,876,485,901,485,901,480,891,487,905,485,901,479,889,487,904,485,901,485,901,487,905,491,913,524,974,522,970,522,970,536,995,536,996,549,1019,544,1010,547,1017,559,1037,567,1053,566,1052,578,1073,575,1067,575,1067,574,1066,756,1404,774,1437},
+		{463,861,476,884,485,901,487,905,485,901,489,909,485,901,485,901,489,907,485,901,487,904,494,918,494,918,528,980,526,976,526,978,539,1001,540,1002,557,1034,547,1017,551,1023,562,1044,574,1066,574,1066,574,1066,582,1082,584,1084,595,1105,762,1414,791,1469}, 
+		{498,926,498,926,498,926,498,926,494,918,498,926,494,918,498,926,494,918,489,909,489,909,494,918,498,926,534,992,534,992,530,984,543,1009,543,1009,570,1058,547,1017,552,1024,561,1041,589,1095,570,1058,574,1066,582,1082,582,1082,596,1106,769,1429,800,1486}, 
+		{498,926,498,926,498,926,498,926,494,918,498,926,494,918,498,926,494,918,489,909,489,909,494,918,498,926,534,992,534,992,530,984,543,1009,543,1009,570,1058,547,1017,552,1024,561,1041,589,1095,570,1058,574,1066,582,1082,582,1082,596,1106,500,3000,500,3000}, 
+    },
+	/*disable cbc*/
+	{
+		{608,1130,650,1208,655,1216,652,1210,652,1212,658,1222,652,1212,655,1216,650,1208,655,1216,656,1218,668,1240,677,1257,673,1249,681,1265,691,1283,685,1273,713,1325,713,1325,723,1343,725,1347,731,1357,734,1362,739,1372,734,1362,747,1387,741,1375,776,1440,741,1375,776,1440}, 
+		{633,1175,670,1244,677,1257,671,1247,673,1249,678,1258,673,1251,677,1257,668,1240,677,1257,677,1257,704,1307,704,1307,704,1307,704,1307,712,1322,706,1310,723,1343,739,1372,743,1379,747,1387,756,1404,756,1404,774,1437,756,1404,774,1437,774,1437,791,1469,774,1437,791,1469}, 
+		{633,1175,668,1240,673,1249,669,1243,670,1244,675,1253,671,1247,673,1251,668,1240,673,1249,673,1251,685,1273,704,1307,704,1307,710,1318,708,1316,704,1307,721,1339,731,1357,741,1375,743,1379,747,1387,750,1394,756,1404,749,1391,762,1416,757,1405,783,1455,757,1405,783,1455}, 
+		{633,1175,668,1240,673,1249,669,1243,671,1247,678,1258,673,1249,675,1253,668,1240,673,1251,676,1255,688,1278,704,1307,704,1307,704,1307,710,1318,704,1307,722,1340,732,1359,741,1375,743,1379,757,1405,752,1396,753,1398,748,1390,762,1414,756,1404,783,1453,756,1404,783,1453}, 
+		{633,1175,668,1240,670,1244,668,1240,670,1244,675,1253,673,1249,673,1251,668,1240,671,1247,675,1253,687,1275,704,1307,704,1307,704,1307,708,1314,704,1307,721,1339,729,1355,739,1372,752,1396,745,1383,748,1390,752,1396,745,1383,760,1411,756,1404,777,1443,756,1404,777,1443}, 
+		{633,1175,664,1232,669,1243,668,1240,668,1240,673,1251,670,1244,671,1247,668,1240,670,1244,673,1249,685,1273,704,1307,704,1307,704,1307,706,1310,704,1307,718,1333,727,1351,739,1372,739,1372,743,1379,747,1387,748,1390,743,1379,756,1404,752,1396,774,1437,752,1396,774,1437}, 
+		{621,1153,662,1229,668,1240,668,1240,668,1240,673,1251,670,1244,671,1247,675,1253,670,1244,673,1249,685,1273,704,1307,704,1307,704,1307,706,1310,704,1307,718,1333,727,1351,739,1372,739,1372,743,1379,747,1387,748,1390,743,1379,757,1405,750,1394,774,1437,750,1394,774,1437}, 
+		{620,1151,668,1240,671,1247,668,1240,670,1244,677,1257,673,1249,673,1251,668,1240,673,1251,675,1253,688,1278,704,1307,704,1307,704,1307,708,1314,704,1307,721,1339,729,1355,747,1387,739,1372,743,1379,747,1387,750,1394,744,1382,757,1405,752,1396,774,1437,752,1396,774,1437}, 
+		{621,1153,668,1240,675,1253,670,1244,673,1251,678,1258,673,1251,677,1257,669,1243,685,1273,678,1258,704,1307,704,1307,704,1307,704,1307,710,1318,704,1308,721,1339,731,1357,739,1372,739,1373,743,1379,749,1391,750,1394,744,1382,757,1405,752,1396,774,1437,752,1396,774,1437}, 
+		{633,1175,668,1240,676,1255,673,1251,676,1255,681,1265,677,1257,679,1261,673,1249,677,1257,679,1261,704,1307,704,1307,704,1307,704,1308,723,1343,706,1312,723,1343,732,1359,739,1373,741,1375,745,1383,750,1394,752,1396,744,1382,756,1404,750,1394,774,1437,750,1394,774,1437}, 
+		{639,1187,671,1247,678,1258,675,1253,677,1257,683,1268,679,1261,680,1264,673,1251,679,1261,681,1265,704,1307,704,1307,704,1307,706,1310,713,1325,708,1314,723,1343,732,1359,741,1375,741,1377,745,1383,747,1387,749,1391,743,1379,756,1404,760,1412,762,1416,760,1412,762,1416}, 
+		{647,1201,675,1253,679,1261,677,1257,679,1261,685,1273,681,1265,683,1268,677,1257,681,1265,704,1307,704,1307,704,1307,704,1307,708,1314,716,1330,710,1318,725,1347,739,1372,741,1377,743,1379,747,1387,774,1437,750,1394,744,1382,756,1404,750,1394,762,1416,750,1394,762,1416}, 
+		{655,1216,678,1258,683,1269,680,1264,681,1265,688,1278,683,1268,685,1273,679,1261,685,1273,685,1273,704,1307,706,1310,704,1307,710,1318,718,1333,722,1340,727,1351,739,1372,744,1382,744,1382,748,1390,750,1394,752,1396,746,1386,758,1408,753,1398,774,1437,753,1398,774,1437}, 
+		{660,1226,681,1265,685,1273,681,1265,683,1268,704,1307,685,1273,687,1275,680,1264,685,1273,688,1278,704,1307,706,1312,704,1307,710,1318,718,1333,712,1322,727,1351,739,1372,744,1382,744,1382,748,1390,752,1396,752,1396,756,1404,760,1411,756,1404,774,1437,756,1404,774,1437}, 
+		{668,1240,685,1273,688,1278,704,1307,687,1275,704,1307,687,1275,704,1307,681,1265,688,1278,704,1307,706,1312,711,1320,706,1312,714,1326,721,1339,714,1326,732,1359,741,1377,748,1390,747,1387,753,1398,757,1405,758,1408,753,1398,774,1437,762,1414,791,1469,762,1414,791,1469}, 
+		{716,1330,716,1330,716,1330,701,1301,701,1301,712,1322,699,1297,716,1330,699,1297,699,1297,699,1297,716,1330,725,1347,721,1339,734,1362,734,1362,725,1347,734,1362,769,1429,760,1412,760,1412,764,1420,787,1461,764,1420,764,1420,769,1429,769,1429,800,1486,769,1429,800,1486}, 
+		{716,1330,716,1330,716,1330,701,1301,701,1301,712,1322,699,1297,716,1330,699,1297,699,1297,699,1297,716,1330,725,1347,721,1339,734,1362,734,1362,725,1347,734,1362,769,1429,760,1412,760,1412,764,1420,787,1461,764,1420,764,1420,769,1429,769,1429,800,1486,500,3000,500,3000},
+	}
+};
+
+const int16_t baseline_cap_17801_data[2][TX_17801_NUMBER][RX_NUMBER*2] = {
+/*enable cbc*/
+	{
+		{662, 1544, 509, 1188, 510, 1189, 510, 1191, 510,
+		1189, 511, 1192, 510, 1190, 511, 1192, 512, 1195,
+		512, 1194, 514, 1199, 514, 1199, 515, 1202, 518,
+		1209, 517, 1207, 521, 1215, 523, 1219, 525, 1225,
+		526, 1228, 535, 1249, 528, 1233, 532, 1240, 533,
+		1244, 533, 1244, 535, 1249, 538, 1255, 537, 1252,
+		537, 1253, 539, 1259, 740, 1727},
+		{560, 1307, 592, 1381, 593, 1384, 594, 1387, 594,
+		1385, 595, 1388, 594, 1386, 595, 1387, 596, 1391,
+		595, 1389, 598, 1395, 597, 1394, 599, 1398, 602,
+		1405, 601, 1402, 605, 1411, 614, 1433, 609, 1421,
+		610, 1424, 612, 1427, 612, 1428, 616, 1436, 617,
+		1440, 617, 1441, 620, 1446, 622, 1451, 621, 1449,
+		621, 1449, 623, 1453, 625, 1459},
+		{562, 1311, 593, 1383, 595, 1387, 596, 1390, 595,
+		1388, 596, 1391, 595, 1389, 596, 1391, 598, 1394,
+		597, 1392, 599, 1398, 599, 1397, 600, 1400, 603,
+		1407, 602, 1405, 613, 1430, 607, 1417, 610, 1422,
+		611, 1425, 612, 1429, 613, 1429, 616, 1437, 618,
+		1441, 618, 1441, 620, 1446, 622, 1451, 621, 1449,
+		621, 1449, 622, 1452, 622, 1451},
+		{563, 1313, 592, 1381, 594, 1386, 595, 1389, 594,
+		1387, 596, 1390, 595, 1388, 595, 1389, 597, 1393,
+		596, 1391, 599, 1397, 598, 1396, 600, 1399, 603,
+		1406, 601, 1403, 604, 1410, 606, 1414, 609, 1421,
+		610, 1424, 611, 1427, 612, 1427, 615, 1435, 617,
+		1439, 624, 1457, 618, 1443, 620, 1448, 619, 1445,
+		619, 1445, 621, 1448, 619, 1444},
+		{563, 1314, 591, 1379, 593, 1384, 594, 1387, 594,
+		1386, 595, 1389, 594, 1386, 595, 1388, 596, 1392,
+		596, 1390, 598, 1395, 597, 1394, 599, 1398, 602,
+		1404, 601, 1401, 604, 1408, 605, 1413, 608, 1418,
+		617, 1440, 611, 1425, 611, 1425, 614, 1432, 615,
+		1436, 615, 1436, 617, 1440, 619, 1445, 618, 1442,
+		618, 1441, 619, 1444, 616, 1437},
+		{564, 1316, 591, 1378, 593, 1383, 594, 1386, 594,
+		1385, 595, 1388, 594, 1386, 594, 1387, 596, 1391,
+		595, 1389, 597, 1394, 597, 1393, 599, 1397, 601,
+		1403, 600, 1401, 603, 1408, 605, 1412, 608, 1418,
+		609, 1420, 610, 1423, 610, 1423, 613, 1431, 615,
+		1434, 615, 1434, 624, 1456, 618, 1443, 617, 1440,
+		617, 1439, 618, 1442, 613, 1431},
+		{565, 1319, 591, 1379, 593, 1384, 594, 1387, 594,
+		1385, 595, 1388, 594, 1386, 594, 1387, 596, 1390,
+		595, 1388, 597, 1394, 597, 1393, 598, 1396, 601,
+		1403, 600, 1400, 603, 1408, 605, 1412, 607, 1417,
+		608, 1420, 610, 1422, 617, 1441, 613, 1430, 614,
+		1433, 614, 1433, 616, 1437, 618, 1442, 617, 1439,
+		616, 1438, 617, 1440, 611, 1426},
+		{568, 1324, 591, 1380, 593, 1385, 595, 1388, 594,
+		1386, 595, 1389, 594, 1386, 595, 1388, 596, 1391,
+		595, 1389, 598, 1394, 597, 1393, 599, 1397, 601,
+		1403, 600, 1401, 603, 1408, 605, 1412, 615, 1436,
+		609, 1420, 610, 1422, 610, 1422, 613, 1429, 614,
+		1432, 614, 1432, 616, 1436, 618, 1441, 616, 1438,
+		616, 1437, 617, 1439, 610, 1423},
+		{570, 1330, 592, 1382, 594, 1386, 595, 1389, 595,
+		1388, 596, 1390, 595, 1388, 595, 1389, 597, 1393,
+		596, 1391, 598, 1396, 598, 1395, 599, 1399, 602,
+		1405, 609, 1420, 604, 1409, 605, 1413, 608, 1418,
+		609, 1420, 610, 1423, 610, 1423, 613, 1429, 614,
+		1432, 614, 1432, 615, 1436, 617, 1440, 616, 1437,
+		616, 1437, 617, 1439, 610, 1424},
+		{572, 1335, 593, 1383, 595, 1388, 596, 1391, 595,
+		1389, 596, 1392, 596, 1390, 596, 1391, 598, 1395,
+		597, 1393, 599, 1398, 599, 1397, 600, 1400, 603,
+		1406, 601, 1403, 604, 1410, 606, 1414, 608, 1419,
+		609, 1421, 610, 1424, 610, 1424, 613, 1430, 614,
+		1433, 614, 1432, 616, 1436, 617, 1440, 616, 1437,
+		616, 1437, 624, 1457, 607, 1417},
+		{576, 1345, 595, 1387, 596, 1392, 598, 1395, 597,
+		1393, 598, 1396, 598, 1394, 598, 1396, 600, 1399,
+		599, 1397, 601, 1402, 601, 1401, 602, 1404, 612,
+		1428, 603, 1407, 606, 1413, 607, 1417, 609, 1422,
+		610, 1424, 611, 1427, 611, 1426, 614, 1433, 615,
+		1435, 615, 1434, 616, 1438, 618, 1442, 616, 1438,
+		616, 1438, 617, 1440, 606, 1413},
+		{578, 1349, 594, 1387, 596, 1391, 597, 1394, 597,
+		1392, 598, 1395, 597, 1393, 598, 1395, 599, 1398,
+		598, 1396, 601, 1402, 600, 1401, 602, 1404, 604,
+		1409, 603, 1406, 605, 1413, 607, 1416, 609, 1421,
+		610, 1423, 611, 1426, 611, 1425, 614, 1432, 615,
+		1434, 614, 1434, 616, 1437, 625, 1459, 616, 1438,
+		616, 1438, 617, 1440, 605, 1411},
+		{582, 1357, 594, 1387, 596, 1391, 597, 1393, 596,
+		1392, 598, 1395, 597, 1393, 598, 1394, 599, 1398,
+		598, 1396, 601, 1401, 600, 1400, 601, 1403, 604,
+		1409, 603, 1406, 606, 1413, 607, 1416, 609, 1421,
+		610, 1423, 611, 1425, 611, 1425, 622, 1450, 615,
+		1434, 615, 1434, 616, 1438, 618, 1443, 617, 1440,
+		617, 1440, 619, 1445, 612, 1429},
+		{587, 1370, 594, 1385, 595, 1388, 596, 1390, 595,
+		1388, 596, 1391, 596, 1390, 596, 1392, 598, 1396,
+		598, 1394, 600, 1400, 600, 1400, 602, 1405, 604,
+		1410, 603, 1407, 606, 1415, 608, 1418, 610, 1424,
+		611, 1427, 612, 1429, 613, 1429, 616, 1437, 625,
+		1458, 617, 1441, 620, 1446, 622, 1452, 622, 1451,
+		623, 1453, 626, 1461, 615, 1435},
+		{738, 1721, 599, 1398, 595, 1388, 592, 1381, 597,
+		1392, 588, 1373, 586, 1367, 585, 1365, 586, 1366,
+		584, 1362, 585, 1365, 584, 1363, 585, 1364, 587,
+		1369, 585, 1365, 587, 1370, 588, 1373, 590, 1376,
+		591, 1378, 591, 1380, 591, 1378, 593, 1385, 594,
+		1387, 598, 1396, 596, 1391, 598, 1396, 598, 1395,
+		599, 1399, 613, 1431, 762, 1777},
+	},
+/*disable cbc*/
+	{
+		{821, 1915, 491, 1145, 491, 1146, 492, 1148, 492,
+		1148, 492, 1149, 492, 1147, 492, 1149, 494, 1152,
+		494, 1153, 496, 1158, 496, 1157, 498, 1161, 501,
+		1168, 500, 1166, 503, 1174, 505, 1179, 508, 1185,
+		509, 1188, 518, 1209, 511, 1192, 514, 1200, 516,
+		1204, 516, 1204, 518, 1209, 521, 1216, 519, 1211,
+		519, 1212, 523, 1220, 901, 2103},
+		{598, 1395, 630, 1470, 631, 1473, 633, 1476, 632,
+		1475, 633, 1477, 632, 1475, 633, 1476, 634, 1480,
+		634, 1480, 637, 1486, 636, 1485, 638, 1488, 641,
+		1496, 640, 1494, 644, 1502, 653, 1525, 648, 1512,
+		650, 1516, 651, 1519, 651, 1520, 655, 1528, 657,
+		1532, 657, 1533, 659, 1538, 662, 1544, 660, 1539,
+		660, 1539, 662, 1546, 665, 1551},
+		{598, 1394, 629, 1467, 631, 1472, 632, 1475, 632,
+		1474, 632, 1476, 632, 1474, 632, 1475, 634, 1479,
+		634, 1479, 636, 1485, 636, 1483, 637, 1487, 640,
+		1494, 639, 1491, 650, 1518, 644, 1504, 647, 1510,
+		648, 1513, 650, 1516, 650, 1517, 654, 1525, 655,
+		1529, 655, 1529, 657, 1534, 660, 1539, 658, 1535,
+		658, 1535, 660, 1540, 660, 1540},
+		{598, 1395, 627, 1463, 629, 1469, 631, 1472, 631,
+		1472, 631, 1473, 631, 1471, 631, 1473, 633, 1476,
+		633, 1476, 635, 1482, 634, 1480, 636, 1484, 639,
+		1491, 638, 1488, 641, 1496, 643, 1500, 646, 1506,
+		647, 1510, 648, 1513, 649, 1513, 652, 1521, 654,
+		1525, 661, 1543, 655, 1529, 658, 1534, 655, 1529,
+		655, 1529, 658, 1535, 656, 1531},
+		{598, 1395, 626, 1461, 629, 1467, 630, 1470, 630,
+		1470, 631, 1471, 630, 1469, 630, 1471, 632, 1474,
+		632, 1475, 634, 1480, 634, 1479, 635, 1482, 638,
+		1489, 637, 1486, 640, 1494, 642, 1498, 645, 1504,
+		654, 1526, 647, 1510, 648, 1511, 651, 1519, 652,
+		1522, 652, 1522, 654, 1526, 656, 1531, 654, 1526,
+		654, 1526, 656, 1531, 653, 1523},
+		{599, 1398, 626, 1461, 628, 1466, 630, 1470, 630,
+		1469, 630, 1471, 629, 1469, 630, 1470, 631, 1473,
+		631, 1473, 634, 1479, 633, 1478, 635, 1481, 638,
+		1488, 637, 1485, 640, 1493, 642, 1497, 644, 1503,
+		645, 1506, 647, 1509, 647, 1509, 650, 1517, 652,
+		1520, 652, 1520, 661, 1543, 655, 1529, 653, 1524,
+		653, 1524, 655, 1529, 650, 1518},
+		{601, 1401, 626, 1461, 629, 1467, 630, 1470, 630,
+		1469, 630, 1470, 629, 1469, 630, 1470, 631, 1473,
+		631, 1473, 634, 1479, 633, 1477, 635, 1481, 638,
+		1488, 637, 1485, 640, 1493, 642, 1497, 644, 1503,
+		645, 1505, 646, 1508, 654, 1526, 650, 1516, 651,
+		1519, 651, 1519, 653, 1523, 655, 1528, 653, 1523,
+		652, 1522, 654, 1527, 648, 1513},
+		{603, 1406, 627, 1463, 629, 1468, 631, 1471, 630,
+		1471, 631, 1472, 630, 1470, 630, 1471, 632, 1474,
+		632, 1474, 634, 1479, 634, 1478, 635, 1482, 638,
+		1489, 637, 1486, 640, 1494, 642, 1497, 652, 1522,
+		645, 1506, 646, 1508, 647, 1509, 650, 1516, 651,
+		1519, 651, 1519, 653, 1523, 655, 1528, 653, 1523,
+		652, 1522, 654, 1526, 647, 1510},
+		{605, 1411, 627, 1464, 630, 1469, 631, 1473, 631,
+		1472, 631, 1473, 630, 1471, 631, 1473, 632, 1476,
+		632, 1476, 635, 1481, 634, 1480, 636, 1483, 638,
+		1490, 645, 1505, 640, 1494, 642, 1498, 644, 1504,
+		646, 1506, 647, 1509, 647, 1509, 650, 1516, 651,
+		1519, 651, 1518, 652, 1522, 654, 1527, 652, 1522,
+		652, 1521, 654, 1526, 648, 1511},
+		{607, 1417, 628, 1466, 630, 1471, 632, 1474, 632,
+		1474, 632, 1475, 631, 1473, 632, 1475, 633, 1478,
+		633, 1478, 636, 1483, 635, 1482, 636, 1485, 639,
+		1492, 638, 1489, 641, 1495, 643, 1499, 645, 1505,
+		646, 1507, 647, 1510, 647, 1510, 650, 1517, 651,
+		1519, 651, 1519, 653, 1523, 654, 1527, 652, 1522,
+		652, 1521, 662, 1544, 644, 1504},
+		{612, 1427, 630, 1470, 632, 1475, 634, 1479, 633,
+		1478, 634, 1479, 633, 1478, 634, 1479, 635, 1483,
+		635, 1482, 637, 1487, 637, 1486, 638, 1489, 649,
+		1514, 640, 1492, 642, 1499, 644, 1503, 646, 1508,
+		647, 1510, 648, 1513, 648, 1513, 651, 1519, 652,
+		1522, 652, 1521, 653, 1524, 655, 1528, 653, 1523,
+		653, 1523, 655, 1528, 643, 1500},
+		{614, 1432, 630, 1470, 632, 1475, 634, 1478, 633,
+		1478, 634, 1479, 633, 1477, 634, 1479, 635, 1482,
+		635, 1482, 638, 1488, 637, 1486, 638, 1489, 641,
+		1495, 639, 1492, 642, 1499, 644, 1502, 646, 1508,
+		647, 1510, 648, 1512, 648, 1512, 651, 1519, 652,
+		1521, 652, 1521, 653, 1524, 663, 1547, 653, 1523,
+		653, 1523, 655, 1528, 642, 1499},
+		{617, 1440, 630, 1470, 632, 1474, 633, 1477, 633,
+		1477, 634, 1478, 633, 1477, 634, 1478, 635, 1482,
+		635, 1482, 637, 1487, 637, 1486, 638, 1489, 641,
+		1495, 640, 1492, 643, 1499, 644, 1503, 646, 1508,
+		647, 1510, 648, 1512, 648, 1512, 659, 1537, 652,
+		1522, 652, 1521, 653, 1525, 656, 1530, 654, 1525,
+		654, 1525, 657, 1533, 650, 1517},
+		{622, 1452, 629, 1469, 630, 1471, 632, 1474, 631,
+		1473, 632, 1475, 631, 1473, 632, 1475, 634, 1479,
+		634, 1480, 637, 1486, 636, 1485, 639, 1491, 641,
+		1496, 640, 1493, 643, 1501, 645, 1505, 647, 1510,
+		648, 1513, 650, 1516, 650, 1516, 653, 1523, 662,
+		1546, 655, 1528, 657, 1533, 660, 1539, 658, 1536,
+		659, 1538, 664, 1549, 653, 1523},
+		{892, 2082, 636, 1484, 632, 1474, 629, 1468, 634,
+		1480, 625, 1459, 623, 1453, 622, 1452, 623, 1453,
+		622, 1451, 623, 1453, 622, 1451, 622, 1452, 624,
+		1457, 623, 1453, 625, 1459, 626, 1461, 628, 1465,
+		629, 1467, 629, 1468, 629, 1467, 631, 1473, 633,
+		1476, 636, 1485, 634, 1479, 637, 1485, 635, 1483,
+		637, 1486, 652, 1520, 918, 2143},
+	}
+};
+
+const int16_t baseline_cap_data_old[2][TX_NUMBER][RX_NUMBER*2] =
+{
+    /*enable cbc*/
+    {
+		{557, 1035, 604, 1122, 605, 1123, 604, 1122, 608, 1130, 601, 1117, 608, 1130, 615, 1141, 613, 1139, 614, 1140, 610, 1132, 609, 1131, 620, 1151, 625, 1161, 638, 1184, 641, 1191, 648, 1203, 669, 1243, 661, 1227, 671, 1245, 676, 1256, 685, 1273, 690, 1282, 694, 1288, 689, 1279, 696, 1292, 696, 1292, 724, 1344, 682, 1266, 724, 1344},
+		{574, 1066, 622, 1154, 622, 1156, 620, 1151, 624, 1158, 618, 1148, 625, 1161, 631, 1173, 630, 1170, 630, 1170, 627, 1164, 624, 1160, 636, 1180, 641, 1191, 653, 1213, 656, 1218, 662, 1230, 676, 1255, 676, 1255, 687, 1275, 694, 1288, 703, 1305, 707, 1313, 721, 1339, 706, 1310, 711, 1321, 711, 1321, 734, 1364, 671, 1245, 694, 1288},
+		{573, 1065, 619, 1149, 618, 1148, 617, 1147, 620, 1152, 614, 1140, 622, 1154, 628, 1166, 629, 1167, 628, 1166, 623, 1157, 622, 1154, 633, 1175, 638, 1186, 661, 1227, 653, 1213, 660, 1226, 673, 1249, 673, 1249, 684, 1270, 690, 1282, 701, 1301, 704, 1307, 707, 1313, 701, 1303, 707, 1313, 707, 1313, 729, 1355, 666, 1238, 687, 1277},
+		{573, 1063, 616, 1144, 616, 1144, 614, 1140, 618, 1148, 611, 1135, 619, 1149, 624, 1160, 625, 1161, 625, 1161, 622, 1154, 620, 1152, 630, 1170, 637, 1183, 650, 1206, 652, 1210, 659, 1223, 670, 1244, 671, 1247, 683, 1268, 688, 1278, 706, 1312, 701, 1301, 704, 1308, 699, 1297, 704, 1308, 703, 1305, 724, 1344, 659, 1223, 673, 1249},
+		{573, 1063, 615, 1141, 615, 1141, 613, 1138, 616, 1144, 610, 1132, 618, 1148, 624, 1158, 624, 1158, 624, 1160, 622, 1154, 620, 1151, 630, 1170, 636, 1182, 648, 1204, 651, 1209, 659, 1223, 670, 1244, 671, 1245, 680, 1264, 696, 1292, 694, 1290, 699, 1297, 701, 1303, 696, 1292, 701, 1301, 699, 1297, 718, 1333, 649, 1205, 663, 1231},
+		{574, 1066, 615, 1143, 615, 1143, 613, 1139, 616, 1144, 610, 1134, 617, 1147, 624, 1158, 625, 1161, 625, 1161, 622, 1156, 622, 1154, 631, 1173, 646, 1200, 650, 1206, 651, 1209, 659, 1223, 671, 1247, 671, 1245, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1297, 694, 1288, 699, 1297, 697, 1295, 713, 1325, 645, 1199, 658, 1222},
+		{578, 1073, 617, 1147, 616, 1144, 615, 1141, 618, 1148, 611, 1135, 619, 1149, 625, 1161, 636, 1180, 628, 1166, 624, 1158, 624, 1158, 634, 1177, 638, 1186, 651, 1209, 652, 1212, 660, 1226, 673, 1249, 673, 1249, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1299, 694, 1290, 699, 1297, 697, 1294, 713, 1323, 643, 1193, 654, 1214},
+		{582, 1080, 619, 1149, 619, 1149, 616, 1144, 619, 1149, 613, 1139, 620, 1152, 627, 1165, 628, 1166, 629, 1167, 625, 1161, 624, 1160, 636, 1180, 641, 1191, 652, 1212, 655, 1216, 661, 1227, 673, 1251, 673, 1251, 692, 1284, 687, 1275, 693, 1287, 697, 1294, 699, 1299, 694, 1288, 699, 1297, 698, 1296, 713, 1325, 645, 1197, 655, 1216},
+		{583, 1083, 619, 1149, 618, 1148, 615, 1143, 620, 1151, 613, 1138, 620, 1152, 627, 1164, 627, 1165, 638, 1184, 624, 1160, 624, 1158, 634, 1178, 638, 1186, 652, 1210, 653, 1213, 660, 1226, 671, 1245, 671, 1245, 679, 1261, 683, 1269, 690, 1282, 694, 1288, 696, 1292, 690, 1281, 694, 1290, 693, 1287, 707, 1313, 649, 1205, 655, 1217},
+		{589, 1095, 623, 1157, 622, 1156, 619, 1149, 623, 1157, 616, 1144, 624, 1158, 630, 1170, 631, 1173, 631, 1173, 629, 1167, 627, 1165, 638, 1186, 643, 1193, 655, 1216, 666, 1236, 662, 1230, 673, 1251, 673, 1249, 680, 1264, 684, 1270, 692, 1284, 697, 1294, 697, 1295, 692, 1286, 697, 1295, 696, 1292, 707, 1313, 650, 1206, 655, 1216},
+		{594, 1104, 628, 1166, 624, 1160, 622, 1156, 627, 1164, 618, 1148, 627, 1164, 632, 1174, 634, 1177, 634, 1178, 630, 1170, 629, 1169, 641, 1190, 644, 1196, 656, 1218, 659, 1223, 664, 1234, 675, 1253, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 694, 1290, 697, 1295, 693, 1287, 699, 1299, 708, 1316, 710, 1318, 649, 1205, 652, 1210},
+		{597, 1109, 629, 1169, 628, 1166, 624, 1160, 628, 1166, 620, 1152, 627, 1165, 633, 1175, 634, 1178, 634, 1178, 641, 1191, 631, 1173, 641, 1191, 646, 1200, 659, 1223, 661, 1227, 666, 1236, 676, 1255, 676, 1256, 681, 1265, 685, 1273, 692, 1286, 713, 1325, 699, 1297, 694, 1288, 701, 1301, 701, 1301, 708, 1316, 646, 1200, 649, 1205},
+		{601, 1115, 630, 1170, 629, 1167, 625, 1161, 628, 1166, 620, 1151, 628, 1166, 633, 1175, 634, 1178, 636, 1180, 631, 1173, 630, 1170, 641, 1191, 646, 1200, 659, 1225, 660, 1226, 674, 1252, 676, 1255, 673, 1251, 680, 1264, 685, 1271, 692, 1286, 694, 1290, 698, 1296, 693, 1287, 699, 1299, 702, 1304, 713, 1323, 645, 1199, 647, 1201},
+		{606, 1125, 632, 1174, 629, 1169, 627, 1164, 629, 1169, 622, 1154, 629, 1167, 634, 1178, 634, 1178, 637, 1183, 633, 1175, 630, 1170, 642, 1192, 647, 1201, 659, 1223, 660, 1226, 666, 1236, 676, 1255, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 697, 1294, 701, 1301, 704, 1308, 702, 1304, 706, 1310, 718, 1334, 638, 1184, 641, 1190},
+		{613, 1138, 634, 1177, 631, 1173, 630, 1170, 632, 1174, 624, 1158, 633, 1175, 637, 1183, 638, 1186, 641, 1190, 636, 1180, 637, 1183, 645, 1199, 651, 1209, 662, 1229, 664, 1232, 670, 1244, 680, 1262, 680, 1262, 688, 1278, 692, 1284, 699, 1297, 704, 1307, 707, 1313, 704, 1307, 712, 1322, 715, 1329, 743, 1379, 643, 1193, 644, 1196},
+		{629, 1169, 639, 1187, 634, 1178, 629, 1169, 629, 1169, 620, 1152, 627, 1165, 641, 1191, 630, 1170, 633, 1175, 627, 1165, 624, 1160, 634, 1178, 639, 1187, 656, 1218, 652, 1210, 657, 1221, 667, 1239, 678, 1258, 673, 1251, 678, 1258, 685, 1271, 706, 1310, 692, 1284, 689, 1279, 697, 1294, 701, 1301, 727, 1349, 643, 1193, 644, 1196},
+		{757, 1407, 748, 1388, 705, 1309, 698, 1296, 686, 1274, 678, 1260, 685, 1271, 683, 1269, 661, 1227, 671, 1245, 655, 1217, 669, 1242, 659, 1223, 665, 1235, 665, 1235, 661, 1227, 649, 1205, 646, 1200, 641, 1191, 649, 1205, 664, 1232, 629, 1167, 645, 1199, 629, 1167, 645, 1199, 622, 1154, 629, 1167, 629, 1167, 500, 3000, 500, 3000},
+    },
+	//disable cbc
+    {
+		{557, 1035, 604, 1122, 605, 1123, 604, 1122, 608, 1130, 601, 1117, 608, 1130, 615, 1141, 613, 1139, 614, 1140, 610, 1132, 609, 1131, 620, 1151, 625, 1161, 638, 1184, 641, 1191, 648, 1203, 669, 1243, 661, 1227, 671, 1245, 676, 1256, 685, 1273, 690, 1282, 694, 1288, 689, 1279, 696, 1292, 696, 1292, 724, 1344, 682, 1266, 724, 1344},
+		{574, 1066, 622, 1154, 622, 1156, 620, 1151, 624, 1158, 618, 1148, 625, 1161, 631, 1173, 630, 1170, 630, 1170, 627, 1164, 624, 1160, 636, 1180, 641, 1191, 653, 1213, 656, 1218, 662, 1230, 676, 1255, 676, 1255, 687, 1275, 694, 1288, 703, 1305, 707, 1313, 721, 1339, 706, 1310, 711, 1321, 711, 1321, 734, 1364, 671, 1245, 694, 1288},
+		{573, 1065, 619, 1149, 618, 1148, 617, 1147, 620, 1152, 614, 1140, 622, 1154, 628, 1166, 629, 1167, 628, 1166, 623, 1157, 622, 1154, 633, 1175, 638, 1186, 661, 1227, 653, 1213, 660, 1226, 673, 1249, 673, 1249, 684, 1270, 690, 1282, 701, 1301, 704, 1307, 707, 1313, 701, 1303, 707, 1313, 707, 1313, 729, 1355, 666, 1238, 687, 1277},
+		{573, 1063, 616, 1144, 616, 1144, 614, 1140, 618, 1148, 611, 1135, 619, 1149, 624, 1160, 625, 1161, 625, 1161, 622, 1154, 620, 1152, 630, 1170, 637, 1183, 650, 1206, 652, 1210, 659, 1223, 670, 1244, 671, 1247, 683, 1268, 688, 1278, 706, 1312, 701, 1301, 704, 1308, 699, 1297, 704, 1308, 703, 1305, 724, 1344, 659, 1223, 673, 1249},
+		{573, 1063, 615, 1141, 615, 1141, 613, 1138, 616, 1144, 610, 1132, 618, 1148, 624, 1158, 624, 1158, 624, 1160, 622, 1154, 620, 1151, 630, 1170, 636, 1182, 648, 1204, 651, 1209, 659, 1223, 670, 1244, 671, 1245, 680, 1264, 696, 1292, 694, 1290, 699, 1297, 701, 1303, 696, 1292, 701, 1301, 699, 1297, 718, 1333, 649, 1205, 663, 1231},
+		{574, 1066, 615, 1143, 615, 1143, 613, 1139, 616, 1144, 610, 1134, 617, 1147, 624, 1158, 625, 1161, 625, 1161, 622, 1156, 622, 1154, 631, 1173, 646, 1200, 650, 1206, 651, 1209, 659, 1223, 671, 1247, 671, 1245, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1297, 694, 1288, 699, 1297, 697, 1295, 713, 1325, 645, 1199, 658, 1222},
+		{578, 1073, 617, 1147, 616, 1144, 615, 1141, 618, 1148, 611, 1135, 619, 1149, 625, 1161, 636, 1180, 628, 1166, 624, 1158, 624, 1158, 634, 1177, 638, 1186, 651, 1209, 652, 1212, 660, 1226, 673, 1249, 673, 1249, 681, 1265, 687, 1275, 694, 1288, 697, 1295, 699, 1299, 694, 1290, 699, 1297, 697, 1294, 713, 1323, 643, 1193, 654, 1214},
+		{582, 1080, 619, 1149, 619, 1149, 616, 1144, 619, 1149, 613, 1139, 620, 1152, 627, 1165, 628, 1166, 629, 1167, 625, 1161, 624, 1160, 636, 1180, 641, 1191, 652, 1212, 655, 1216, 661, 1227, 673, 1251, 673, 1251, 692, 1284, 687, 1275, 693, 1287, 697, 1294, 699, 1299, 694, 1288, 699, 1297, 698, 1296, 713, 1325, 645, 1197, 655, 1216},
+		{583, 1083, 619, 1149, 618, 1148, 615, 1143, 620, 1151, 613, 1138, 620, 1152, 627, 1164, 627, 1165, 638, 1184, 624, 1160, 624, 1158, 634, 1178, 638, 1186, 652, 1210, 653, 1213, 660, 1226, 671, 1245, 671, 1245, 679, 1261, 683, 1269, 690, 1282, 694, 1288, 696, 1292, 690, 1281, 694, 1290, 693, 1287, 707, 1313, 649, 1205, 655, 1217},
+		{589, 1095, 623, 1157, 622, 1156, 619, 1149, 623, 1157, 616, 1144, 624, 1158, 630, 1170, 631, 1173, 631, 1173, 629, 1167, 627, 1165, 638, 1186, 643, 1193, 655, 1216, 666, 1236, 662, 1230, 673, 1251, 673, 1249, 680, 1264, 684, 1270, 692, 1284, 697, 1294, 697, 1295, 692, 1286, 697, 1295, 696, 1292, 707, 1313, 650, 1206, 655, 1216},
+		{594, 1104, 628, 1166, 624, 1160, 622, 1156, 627, 1164, 618, 1148, 627, 1164, 632, 1174, 634, 1177, 634, 1178, 630, 1170, 629, 1169, 641, 1190, 644, 1196, 656, 1218, 659, 1223, 664, 1234, 675, 1253, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 694, 1290, 697, 1295, 693, 1287, 699, 1299, 708, 1316, 710, 1318, 649, 1205, 652, 1210},
+		{597, 1109, 629, 1169, 628, 1166, 624, 1160, 628, 1166, 620, 1152, 627, 1165, 633, 1175, 634, 1178, 634, 1178, 641, 1191, 631, 1173, 641, 1191, 646, 1200, 659, 1223, 661, 1227, 666, 1236, 676, 1255, 676, 1256, 681, 1265, 685, 1273, 692, 1286, 713, 1325, 699, 1297, 694, 1288, 701, 1301, 701, 1301, 708, 1316, 646, 1200, 649, 1205},
+		{601, 1115, 630, 1170, 629, 1167, 625, 1161, 628, 1166, 620, 1151, 628, 1166, 633, 1175, 634, 1178, 636, 1180, 631, 1173, 630, 1170, 641, 1191, 646, 1200, 659, 1225, 660, 1226, 674, 1252, 676, 1255, 673, 1251, 680, 1264, 685, 1271, 692, 1286, 694, 1290, 698, 1296, 693, 1287, 699, 1299, 702, 1304, 713, 1323, 645, 1199, 647, 1201},
+		{606, 1125, 632, 1174, 629, 1169, 627, 1164, 629, 1169, 622, 1154, 629, 1167, 634, 1178, 634, 1178, 637, 1183, 633, 1175, 630, 1170, 642, 1192, 647, 1201, 659, 1223, 660, 1226, 666, 1236, 676, 1255, 673, 1251, 681, 1265, 685, 1271, 693, 1287, 697, 1294, 701, 1301, 704, 1308, 702, 1304, 706, 1310, 718, 1334, 638, 1184, 641, 1190},
+		{613, 1138, 634, 1177, 631, 1173, 630, 1170, 632, 1174, 624, 1158, 633, 1175, 637, 1183, 638, 1186, 641, 1190, 636, 1180, 637, 1183, 645, 1199, 651, 1209, 662, 1229, 664, 1232, 670, 1244, 680, 1262, 680, 1262, 688, 1278, 692, 1284, 699, 1297, 704, 1307, 707, 1313, 704, 1307, 712, 1322, 715, 1329, 743, 1379, 643, 1193, 644, 1196},
+		{629, 1169, 639, 1187, 634, 1178, 629, 1169, 629, 1169, 620, 1152, 627, 1165, 641, 1191, 630, 1170, 633, 1175, 627, 1165, 624, 1160, 634, 1178, 639, 1187, 656, 1218, 652, 1210, 657, 1221, 667, 1239, 678, 1258, 673, 1251, 678, 1258, 685, 1271, 706, 1310, 692, 1284, 689, 1279, 697, 1294, 701, 1301, 727, 1349, 643, 1193, 644, 1196},
+		{757, 1407, 748, 1388, 705, 1309, 698, 1296, 686, 1274, 678, 1260, 685, 1271, 683, 1269, 661, 1227, 671, 1245, 655, 1217, 669, 1242, 659, 1223, 665, 1235, 665, 1235, 661, 1227, 649, 1205, 646, 1200, 641, 1191, 649, 1205, 664, 1232, 629, 1167, 645, 1199, 629, 1167, 645, 1199, 622, 1154, 629, 1167, 629, 1167, 500, 3000, 500, 3000},
+    }
+
+};
+
+#endif
diff --git a/drivers/input/touchscreen/synaptics_driver_s3320.c b/drivers/input/touchscreen/synaptics_driver_s3320.c
new file mode 100644
index 0000000000000000000000000000000000000000..e025b49aeb3751ce912b92da63d7be2e4dcfe039
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_driver_s3320.c
@@ -0,0 +1,6427 @@
+/************************************************************************************
+ ** File: - /android/kernel/drivers/input/touchscreen/synaptic_s3320.c
+ ** Copyright (C), 2008-2012, OEM Mobile Comm Corp., Ltd
+ **
+ ** Description:
+ **      touch panel driver for synaptics
+ **      can change MAX_POINT_NUM value to support multipoint
+ ** Version: 1.0
+ ** Date created: 10:49:46,18/01/2012
+ ** Author: Yixue.Ge@BasicDrv.TP
+ **
+ ** --------------------------- Revision History: --------------------------------
+ ** 	<author>	<data>			<desc>
+ **  morgan.gu@BSP.TP modified for oem 2017-10-30 s3706 tp_driver
+ ************************************************************************************/
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/i2c.h>
+#include <linux/gpio.h>
+#include <linux/delay.h>
+#include <linux/sysfs.h>
+#include <linux/input.h>
+#include <asm/uaccess.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/proc_fs.h>
+#include <linux/hrtimer.h>
+#include <linux/proc_fs.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include <linux/firmware.h>
+
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+
+#include <linux/kthread.h>
+#include <linux/random.h>
+#include <linux/slab.h>
+#include <linux/sched.h>
+#include <linux/sched/rt.h>
+#include <linux/task_work.h>
+
+#include <linux/rtc.h>
+#include <linux/syscalls.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+
+/*modify by morgan.gu for sdm845 */
+#define CONFIG_MSM_RDM_NOTIFY
+#undef CONFIG_FB
+
+#ifdef CONFIG_FB
+#include <linux/fb.h>
+#include <linux/notifier.h>
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+#include <linux/msm_drm_notify.h>
+#include <linux/notifier.h>
+#endif
+
+#include <linux/input/mt.h>
+
+#include "synaptics_redremote.h"
+#include <linux/project_info.h>
+#include "synaptics_baseline.h"
+#include "synaptics_dsx_core.h"
+#include <linux/oneplus/boot_mode.h>
+/*------------------------------------------------Global Define--------------------------------------------*/
+
+#define TP_UNKNOWN 0
+#define TP_G2Y 1
+#define TP_TPK 2
+#define TP_TRULY 3
+#define TP_OFILM 4
+#define TP_JDI_TPK 6
+#define TP_TEST_ENABLE 1
+
+#define DiagonalUpperLimit  1100
+#define DiagonalLowerLimit  900
+
+#define PAGESIZE 512
+#define TPD_USE_EINT
+
+#define TPD_DEVICE "synaptics,s3320"
+
+//#define SUPPORT_SLEEP_POWEROFF
+#define SUPPORT_GESTURE
+#define RESET_ONESECOND
+//#define SUPPORT_GLOVES_MODE
+//#define REPORT_2D_PRESSURE
+//#define SUPPORT_VIRTUAL_KEY
+
+
+#define SUPPORT_TP_SLEEP_MODE
+#define TYPE_B_PROTOCOL      //Multi-finger operation
+#define TP_FW_NAME_MAX_LEN 128
+#define SUPPORT_TP_TOUCHKEY
+
+#define TEST_MAGIC1 0x494D494C
+#define TEST_MAGIC2 0x474D4954
+
+struct test_header {
+	unsigned int magic1;
+	unsigned int magic2;
+	unsigned int withCBC;
+	unsigned int array_limit_offset;
+	unsigned int array_limit_size;
+	unsigned int array_limitcbc_offset;
+	unsigned int array_limitcbc_size;
+};
+
+struct fp_underscreen_info {
+    uint8_t touch_state;
+    uint8_t area_rate;
+    uint16_t x;
+    uint16_t y;
+};
+
+/******************for Red function*****************/
+#define CONFIG_SYNAPTIC_RED
+
+/*********************for gesture*******************/
+#ifdef SUPPORT_GESTURE
+#define ENABLE_UNICODE  0x40
+#define ENABLE_VEE      0x20
+#define ENABLE_CIRCLE   0x08
+#define ENABLE_SWIPE    0x02
+#define ENABLE_DTAP     0x01
+
+#define UNICODE_DETECT  0x0b
+#define VEE_DETECT      0x0a
+#define CIRCLE_DETECT   0x08
+#define SWIPE_DETECT    0x07
+#define DTAP_DETECT     0x03
+
+#define FINGER_DOWN     0x0f
+#define FINGER_UP       0x1f
+#define SINGLE_TAP      0x10
+
+#define UnkownGestrue       0
+#define DouTap              1   // double tap
+#define UpVee               2   // V
+#define DownVee             3   // ^
+#define LeftVee             4   // >
+#define RightVee            5   // <
+#define Circle              6   // O
+#define DouSwip             7   // ||
+#define Left2RightSwip      8   // -->
+#define Right2LeftSwip      9   // <--
+#define Up2DownSwip         10  // |v
+#define Down2UpSwip         11  // |^
+#define Mgestrue            12  // M
+#define Wgestrue            13  // W
+#define Sgestrue            14  // S
+#define SingleTap           15  // single tap
+
+
+//ruanbanmao@BSP add for tp gesture 2015-05-06, begin
+#define BIT0 (0x1 << 0)
+#define BIT1 (0x1 << 1)
+#define BIT2 (0x1 << 2)
+#define BIT3 (0x1 << 3)
+#define BIT4 (0x1 << 4)
+#define BIT5 (0x1 << 5)
+#define BIT6 (0x1 << 6)
+#define BIT7 (0x1 << 7)
+
+int LeftVee_gesture = 0; //">"
+int RightVee_gesture = 0; //"<"
+int DouSwip_gesture = 0; // "||"
+int Circle_gesture = 0; // "O"
+int UpVee_gesture = 0; //"V"
+int DownVee_gesture = 0; //"^"
+int DouTap_gesture = 0; //"double tap"
+
+int Left2RightSwip_gesture=0;//"(-->)"
+int Right2LeftSwip_gesture=0;//"(<--)"
+int Up2DownSwip_gesture =0;//"up to down |"
+int Down2UpSwip_gesture =0;//"down to up |"
+
+int Wgestrue_gesture =0;//"(W)"
+int Mgestrue_gesture =0;//"(M)"
+int Sgestrue_gesture =0;//"(S)"
+int Single_gesture = 0; //"(SingleTap)"
+int Enable_gesture =0;
+static int gesture_switch = 0;
+//ruanbanmao@BSP add for tp gesture 2015-05-06, end
+#endif
+
+/*********************for Debug LOG switch*******************/
+#define TPD_ERR(a, arg...)  pr_err(TPD_DEVICE ": " a, ##arg)
+#define TPDTM_DMESG(a, arg...)  printk(TPD_DEVICE ": " a, ##arg)
+
+#define TPD_DEBUG(a,arg...)\
+	do{\
+		if(tp_debug)\
+		pr_err(TPD_DEVICE ": " a,##arg);\
+	}while(0)
+
+/*---------------------------------------------Global Variable----------------------------------------------*/
+static int baseline_ret = 0;
+static long int TP_FW;
+static int tp_dev = 6;
+unsigned int tp_debug;
+static int button_map[3];
+static int tx_rx_num[2];
+static int16_t Rxdata[33][33];/*s3706 tx rx 16 33 s3508 tx rx 15 30*/
+static int16_t delta_baseline[33][33];
+static int16_t baseline[33][33];
+static int16_t delta[33][33];
+static int TX_NUM;
+static int RX_NUM;
+static int report_key_point_y = 0;
+static int force_update = 0;
+static int LCD_WIDTH ;
+static int LCD_HEIGHT ;
+static int get_tp_base = 0;
+#define ENABLE_TPEDGE_LIMIT
+#ifdef ENABLE_TPEDGE_LIMIT
+static int F51_GRIP_CONFIGURATION;
+static int limit_enable=1;
+static void synaptics_tpedge_limitfunc(void);
+#endif
+//static int ch_getbase_status = 0;
+struct timeval tpstart, tpend;
+int not_getbase;
+int need_reset;
+int singer_touch_mun;
+int recored_pointx[2] = {0, 0};
+int recored_pointy[2] = {0, 0};
+
+#ifdef SUPPORT_TP_SLEEP_MODE
+static int sleep_enable;
+#endif
+#ifdef SUPPORT_TP_TOUCHKEY
+static int key_switch = 0;
+static bool key_back_disable=false,key_appselect_disable=false;
+#endif
+static struct synaptics_ts_data *ts_g = NULL;
+static struct workqueue_struct *synaptics_wq = NULL;
+static struct workqueue_struct *synaptics_report = NULL;
+static struct workqueue_struct *get_base_report = NULL;
+static struct proc_dir_entry *prEntry_tp = NULL;
+
+
+#ifdef SUPPORT_GESTURE
+static uint32_t clockwise;
+static uint32_t gesture;
+
+/****point position*****/
+struct Coordinate {
+	uint32_t x;
+	uint32_t y;
+};
+static struct Coordinate Point_start;
+static struct Coordinate Point_end;
+static struct Coordinate Point_1st;
+static struct Coordinate Point_2nd;
+static struct Coordinate Point_3rd;
+static struct Coordinate Point_4th;
+#endif
+
+/*-----------------------------------------Global Registers----------------------------------------------*/
+static unsigned short SynaF34DataBase;
+static unsigned short SynaF34QueryBase;
+static unsigned short SynaF01DataBase;
+static unsigned short SynaF01CommandBase;
+
+static unsigned short SynaF34Reflash_BlockNum;
+static unsigned short SynaF34Reflash_BlockData;
+static unsigned short SynaF34ReflashQuery_BootID;
+static unsigned short SynaF34ReflashQuery_FlashPropertyQuery;
+static unsigned short SynaF34ReflashQuery_FirmwareBlockSize;
+static unsigned short SynaF34ReflashQuery_FirmwareBlockCount;
+static unsigned short SynaF34ReflashQuery_ConfigBlockSize;
+static unsigned short SynaF34ReflashQuery_ConfigBlockCount;
+
+static unsigned short SynaFirmwareBlockSize;
+static unsigned short SynaF34_FlashControl;
+
+static int F01_RMI_QUERY_BASE;
+static int F01_RMI_CMD_BASE;
+static int F01_RMI_CTRL_BASE;
+static int F01_RMI_DATA_BASE;
+
+static int F12_2D_QUERY_BASE;
+static int F12_2D_CMD_BASE;
+static int F12_2D_CTRL_BASE;
+static int F12_2D_DATA_BASE;
+static int F12_2D_DATA15;
+
+static int F34_FLASH_QUERY_BASE;
+static int F34_FLASH_CMD_BASE;
+static int F34_FLASH_CTRL_BASE;
+static int F34_FLASH_DATA_BASE;
+
+static int F51_CUSTOM_QUERY_BASE;
+static int F51_CUSTOM_CMD_BASE;
+static int F51_CUSTOM_CTRL_BASE;
+static int F51_CUSTOM_DATA_BASE;
+
+static int F01_RMI_QUERY11;
+static int F01_RMI_DATA01;
+static int F01_RMI_CMD00;
+static int F01_RMI_CTRL00;
+static int F01_RMI_CTRL01;
+static int F01_RMI_CTRL02;
+
+static int F12_2D_CTRL08;
+static int F12_2D_CTRL32;
+static int F12_2D_DATA04;
+static int F12_2D_DATA38;
+static int F12_2D_DATA39;
+static int F12_2D_CMD00;
+static int F12_2D_CTRL20;
+static int F12_2D_CTRL27;
+
+static int F34_FLASH_CTRL00;
+
+static int F51_CUSTOM_CTRL00;
+static int F51_CUSTOM_DATA04;
+static int F51_CUSTOM_DATA11;
+static int version_is_s3508=0;
+#if TP_TEST_ENABLE
+static int F54_ANALOG_QUERY_BASE;//0x73
+static int F54_ANALOG_COMMAND_BASE;//0x72
+static int F54_ANALOG_CONTROL_BASE;//0x0d
+static int F54_ANALOG_DATA_BASE;//0x00
+#endif
+
+/*------------------------------------------Fuction Declare----------------------------------------------*/
+static int synaptics_i2c_suspend(struct device *dev);
+static int synaptics_i2c_resume(struct device *dev);
+/**************I2C resume && suspend end*********/
+static void speedup_synaptics_resume(struct work_struct *work);
+static int synaptics_ts_resume(struct device *dev);
+static int synaptics_ts_suspend(struct device *dev);
+static int synaptics_ts_remove(struct i2c_client *client);
+static int synaptics_ts_probe(struct i2c_client *client, const struct i2c_device_id *id);
+static ssize_t synaptics_rmi4_baseline_show(struct device *dev, char *buf, bool savefile)	;
+static ssize_t synaptics_rmi4_vendor_id_show(struct device *dev, struct device_attribute *attr, char *buf);
+static int synapitcs_ts_update(struct i2c_client *client, const uint8_t *data, uint32_t data_len ,bool force);
+
+static int synaptics_rmi4_i2c_read_byte(struct i2c_client* client,
+		unsigned char addr);
+
+static int synaptics_rmi4_i2c_write_byte(struct i2c_client* client,
+		unsigned char addr,unsigned char data);
+
+static int synaptics_rmi4_i2c_read_word(struct i2c_client* client,
+		unsigned char addr);
+
+static int synaptics_rmi4_i2c_write_word(struct i2c_client* client,
+		unsigned char addr,unsigned short data);
+static int synaptics_mode_change(int mode);
+int tp_single_tap_en(struct synaptics_ts_data *ts, bool enable);
+int opticalfp_irq_handler(struct fp_underscreen_info* tp_info);
+
+#ifdef TPD_USE_EINT
+static irqreturn_t synaptics_irq_thread_fn(int irq, void *dev_id);
+#endif
+
+#if defined(CONFIG_FB)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data);
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+static int msm_drm_notifier_callback(
+	struct notifier_block *self, unsigned long event, void *data);
+#endif
+static int synaptics_soft_reset(struct synaptics_ts_data *ts);
+static void synaptics_hard_reset(struct synaptics_ts_data *ts);
+static int set_changer_bit(struct synaptics_ts_data *ts);
+static int tp_baseline_get(struct synaptics_ts_data *ts,bool flag);
+static void set_doze_time(int doze_time);
+static int synaptics_soft_reset(struct synaptics_ts_data *ts);
+static int touch_hold_en(struct synaptics_ts_data *ts, bool enable);
+
+
+/*-------------------------------Using Struct----------------------------------*/
+struct point_info {
+	unsigned char status;
+	int x;
+	int raw_x;
+	int y;
+	int raw_y;
+	int z;
+#ifdef REPORT_2D_PRESSURE
+    unsigned char pressure;
+#endif
+};
+
+static const struct i2c_device_id synaptics_ts_id[] = {
+	{ TPD_DEVICE, 0 },
+	{ }
+};
+
+static struct of_device_id synaptics_match_table[] = {
+	{ .compatible = TPD_DEVICE,},
+	{ },
+};
+
+static const struct dev_pm_ops synaptic_pm_ops = {
+#ifdef CONFIG_PM
+	.suspend = synaptics_i2c_suspend,
+	.resume = synaptics_i2c_resume,
+#else
+	.suspend = NULL,
+	.resume = NULL,
+#endif
+};
+
+//add by jiachenghui for boot time optimize 2015-5-13
+static int probe_ret;
+struct synaptics_optimize_data{
+	struct delayed_work work;
+	struct workqueue_struct *workqueue;
+	struct i2c_client *client;
+	const struct i2c_device_id *dev_id;
+};
+static struct synaptics_optimize_data optimize_data;
+static void synaptics_ts_probe_func(struct work_struct *w)
+{
+	struct i2c_client *client_optimize = optimize_data.client;
+	const struct i2c_device_id *dev_id = optimize_data.dev_id;
+	TPD_ERR("after on cpu [%d]\n",smp_processor_id());
+	probe_ret = synaptics_ts_probe(client_optimize,dev_id);
+}
+
+static int oem_synaptics_ts_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+	int i;
+	optimize_data.client = client;
+	optimize_data.dev_id = id;
+	optimize_data.workqueue = create_workqueue("tpd_probe_optimize");
+	INIT_DELAYED_WORK(&(optimize_data.work), synaptics_ts_probe_func);
+	TPD_ERR("before on cpu [%d]\n",smp_processor_id());
+
+	//add by lifeng@bsp 2015-12-10 for only one cpu on line
+	for (i = 0; i < NR_CPUS; i++){
+         TPD_ERR("check CPU[%d] is [%s]\n",i,cpu_is_offline(i)?"offline":"online");
+		 if (cpu_online(i) && (i != smp_processor_id()))
+            break;
+    }
+    queue_delayed_work_on(i != NR_CPUS?i:0,optimize_data.workqueue,&(optimize_data.work),msecs_to_jiffies(300));
+    //end add by lifeng@bsp 2015-12-10 for only one cpu on line
+
+	return probe_ret;
+}
+//end add by jiachenghui for boot time optimize 2015-5-13
+
+static struct i2c_driver tpd_i2c_driver = {
+//add by jiachenghui for boot time optimize 2015-5-13
+	.probe		= oem_synaptics_ts_probe,
+	.remove		= synaptics_ts_remove,
+	.id_table	= synaptics_ts_id,
+	.driver = {
+		//		.owner  = THIS_MODULE,
+		.name	= TPD_DEVICE,
+		.of_match_table =  synaptics_match_table,
+		.pm = &synaptic_pm_ops,
+	},
+};
+
+struct synaptics_ts_data {
+	struct i2c_client *client;
+	struct mutex mutex;
+	struct mutex mutexreport;
+	int irq;
+	int irq_gpio;
+	atomic_t irq_enable;
+	int id1_gpio;
+	int id2_gpio;
+	int id3_gpio;
+	int reset_gpio;
+	int v1p8_gpio;
+	int support_hw_poweroff;
+	int support_1080x2160_tp;
+	int support_1080x2340_tp;
+	int enable2v8_gpio;
+	int max_num;
+	int enable_remote;
+	int regulator_vdd_vmin;
+	int regulator_vdd_vmax;
+	int regulator_vdd_current;
+	int regulator_avdd_vmin;
+	int regulator_avdd_vmax;
+	int regulator_avdd_current;
+
+	uint32_t irq_flags;
+	uint32_t max_x;
+	uint32_t max_y;
+	uint32_t max_y_real;
+	uint32_t btn_state;
+	uint32_t pre_finger_state;
+	uint32_t pre_btn_state;
+	struct delayed_work  base_work;
+	struct work_struct  report_work;
+	struct delayed_work speed_up_work;
+	struct input_dev *input_dev;
+	struct hrtimer timer;
+#if defined(CONFIG_FB)
+	struct notifier_block fb_notif;
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	struct notifier_block msm_drm_notif;
+#endif
+	/******gesture*******/
+	int gesture_enable;
+	int in_gesture_mode;
+	int glove_enable;
+    int changer_connet;
+	int is_suspended;
+    atomic_t is_stop;
+    spinlock_t lock;
+
+	/********test*******/
+	int i2c_device_test;
+
+	/******power*******/
+	struct regulator *vdd_2v8;
+	struct regulator *vcc_i2c_1v8;
+
+	/*pinctrl******/
+	struct device						*dev;
+	struct pinctrl 						*pinctrl;
+	struct pinctrl_state 				*pinctrl_state_active;
+	struct pinctrl_state 				*pinctrl_state_suspend;
+
+	/*******for FW update*******/
+	bool loading_fw;
+	bool support_ft;/*support force touch*/
+	char fw_name[TP_FW_NAME_MAX_LEN];
+	char test_limit_name[TP_FW_NAME_MAX_LEN];
+	char fw_id[20];
+	char manu_name[30];
+#ifdef SUPPORT_VIRTUAL_KEY
+	struct kobject *properties_kobj;
+#endif
+	uint8_t fp_up_down;
+	unsigned int en_up_down;
+	unsigned int fp_aod_cnt;
+	unsigned int unlock_succes;
+	int project_version;
+};
+
+static struct device_attribute attrs_oem[] = {
+	//	__ATTR(baseline_test, 0664, synaptics_rmi4_baseline_show, NULL),
+	__ATTR(vendor_id, 0664, synaptics_rmi4_vendor_id_show, NULL),
+};
+
+static struct synaptics_rmi4_data *rmi4_data_s3706;
+
+static ssize_t fp_irq_get(struct device *device,
+			     struct device_attribute *attribute,
+			     char *buf)
+{
+	struct synaptics_ts_data *ts = ts_g;
+
+	return scnprintf(buf, PAGE_SIZE, "%i\n", ts->fp_up_down);
+}
+static DEVICE_ATTR(fp_irq, 0400, fp_irq_get, NULL);
+
+
+static void touch_enable (struct synaptics_ts_data *ts)
+{
+    spin_lock(&ts->lock);
+    if(0 == atomic_read(&ts->irq_enable))
+    {
+        if(ts->irq)
+            enable_irq(ts->irq);
+        atomic_set(&ts->irq_enable,1);
+        //TPD_ERR("test %%%% enable irq\n");
+    }
+    spin_unlock(&ts->lock);
+}
+
+static void touch_disable(struct synaptics_ts_data *ts)
+{
+    spin_lock(&ts->lock);
+    if(1 == atomic_read(&ts->irq_enable))
+    {
+        if(ts->irq)
+            disable_irq_nosync(ts->irq);
+        atomic_set(&ts->irq_enable,0);
+        //TPD_ERR("test ****************** disable irq\n");
+    }
+    spin_unlock(&ts->lock);
+}
+
+static int tpd_hw_pwron(struct synaptics_ts_data *ts)
+{
+	int rc = 0;
+
+	/***enable the 2v8 power*****/
+	if (!IS_ERR(ts->vdd_2v8)) {
+		//regulator_set_optimum_mode(ts->vdd_2v8,100000);
+		rc = regulator_enable(ts->vdd_2v8);
+		if(rc){
+			dev_err(&ts->client->dev,
+					"Regulator vdd enable failed rc=%d\n", rc);
+			//return rc;
+		}
+	}
+	/*add for mrogan for 3V delay 10ms ,1.8v delay 10ms*/
+	usleep_range(10*1000, 10*1000);
+	if( ts->v1p8_gpio > 0 ) {
+		TPD_DEBUG("synaptics:enable the v1p8_gpio\n");
+		gpio_direction_output(ts->v1p8_gpio, 1);
+	}
+	//msleep(100);
+
+	if( ts->enable2v8_gpio > 0 ) {
+		TPD_DEBUG("synaptics:enable the enable2v8_gpio\n");
+		gpio_direction_output(ts->enable2v8_gpio, 1);
+	}
+	/*usleep_range(10*1000, 10*1000);*/
+	if (!IS_ERR(ts->vcc_i2c_1v8)) {
+		//regulator_set_optimum_mode(ts->vcc_i2c_1v8,100000);
+		rc = regulator_enable( ts->vcc_i2c_1v8 );
+		if(rc) {
+			dev_err(&ts->client->dev, "Regulator vcc_i2c enable failed rc=%d\n", rc);
+			//return rc;
+		}
+	}
+	usleep_range(10*1000, 10*1000);
+	if( ts->reset_gpio > 0 ) {
+		gpio_direction_output(ts->reset_gpio, 1);
+        usleep_range(10*1000, 10*1000);
+		gpio_direction_output(ts->reset_gpio, 0);
+        usleep_range(10*1000, 10*1000);
+		gpio_direction_output(ts->reset_gpio, 1);
+		TPD_DEBUG("synaptics:enable the reset_gpio\n");
+	}
+	return rc;
+}
+
+static int tpd_hw_pwroff(struct synaptics_ts_data *ts)
+{
+	int rc = 0;
+	if( ts->reset_gpio > 0 ) {
+		TPD_DEBUG("%s set reset gpio low\n",__func__);
+		gpio_direction_output(ts->reset_gpio, 0);
+	}
+
+	if (!IS_ERR(ts->vcc_i2c_1v8)) {
+		rc = regulator_disable( ts->vcc_i2c_1v8 );
+		if(rc) {
+			dev_err(&ts->client->dev, "Regulator vcc_i2c enable failed rc=%d\n", rc);
+			return rc;
+		}
+	}
+	if( ts->v1p8_gpio > 0 ) {
+		TPD_DEBUG("synaptics:disable the v1p8_gpio\n");
+		gpio_direction_output(ts->v1p8_gpio, 0);
+	}
+	if (!IS_ERR(ts->vdd_2v8)) {
+		rc = regulator_disable(ts->vdd_2v8);
+		if (rc) {
+			dev_err(&ts->client->dev, "Regulator vdd disable failed rc=%d\n", rc);
+			return rc;
+		}
+	}
+	if( ts->enable2v8_gpio > 0 ) {
+		TPD_DEBUG("synaptics:enable the enable2v8_gpio\n");
+		gpio_direction_output(ts->enable2v8_gpio, 0);
+	}
+	return rc;
+}
+
+static int tpd_power(struct synaptics_ts_data *ts, unsigned int on)
+{
+	int ret;
+	if(on)
+		ret = tpd_hw_pwron(ts);
+	else
+		ret = tpd_hw_pwroff(ts);
+
+	return ret;
+}
+
+static int synaptics_read_register_map(struct synaptics_ts_data *ts)
+{
+	uint8_t buf[4];
+	int ret;
+	memset(buf, 0, sizeof(buf));
+	ret = synaptics_rmi4_i2c_write_byte( ts->client, 0xff, 0x0 );
+	if( ret < 0 ){
+		TPD_ERR("synaptics_read_register_map: failed for page select\n");
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_block(ts->client, 0xDD, 4, &(buf[0x0]));
+	if( ret < 0 ){
+		TPD_ERR("failed for page select!\n");
+		return -1;
+	}
+
+	F12_2D_QUERY_BASE = buf[0];
+	F12_2D_CMD_BASE = buf[1];
+	F12_2D_CTRL_BASE = buf[2];
+	F12_2D_DATA_BASE = buf[3];
+
+	TPD_ERR("F12_2D_QUERY_BASE = %x \n \
+			F12_2D_CMD_BASE  = %x \n\
+			F12_2D_CTRL_BASE	= %x \n\
+			F12_2D_DATA_BASE	= %x \n\
+			",F12_2D_QUERY_BASE,F12_2D_CMD_BASE,F12_2D_CTRL_BASE,F12_2D_DATA_BASE);
+
+
+	ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE3, 4, &(buf[0x0]));
+	F01_RMI_QUERY_BASE = buf[0];
+	F01_RMI_CMD_BASE = buf[1];
+	F01_RMI_CTRL_BASE = buf[2];
+	F01_RMI_DATA_BASE = buf[3];
+	TPD_DEBUG("F01_RMI_QUERY_BASE = %x \n\
+			F01_RMI_CMD_BASE  = %x \n\
+			F01_RMI_CTRL_BASE	= %x \n\
+			F01_RMI_DATA_BASE	= %x \n\
+			", F01_RMI_QUERY_BASE, F01_RMI_CMD_BASE, F01_RMI_CTRL_BASE, F01_RMI_DATA_BASE);
+
+	ret = synaptics_rmi4_i2c_read_block( ts->client, 0xE9, 4, &(buf[0x0]) );
+	F34_FLASH_QUERY_BASE = buf[0];
+	F34_FLASH_CMD_BASE = buf[1];
+	F34_FLASH_CTRL_BASE = buf[2];
+	F34_FLASH_DATA_BASE = buf[3];
+	TPD_ERR("F34_FLASH_QUERY_BASE = %x \n\
+			F34_FLASH_CMD_BASE	= %x \n\
+			F34_FLASH_CTRL_BASE	= %x \n\
+			F34_FLASH_DATA_BASE	= %x \n\
+			", F34_FLASH_QUERY_BASE, F34_FLASH_CMD_BASE, F34_FLASH_CTRL_BASE, F34_FLASH_DATA_BASE);
+
+	F01_RMI_QUERY11 = F01_RMI_QUERY_BASE+11;
+	F01_RMI_CTRL00 = F01_RMI_CTRL_BASE;
+	F01_RMI_CTRL01 = F01_RMI_CTRL_BASE + 1;
+	F01_RMI_CTRL02 = F01_RMI_CTRL_BASE + 2;
+	F01_RMI_CMD00 = F01_RMI_CMD_BASE;
+	F01_RMI_DATA01 = F01_RMI_DATA_BASE + 1;
+
+	F12_2D_CTRL08 = F12_2D_CTRL_BASE;
+	F12_2D_CTRL32 = F12_2D_CTRL_BASE + 15;
+	F12_2D_DATA38 = F12_2D_DATA_BASE + 54;
+	F12_2D_DATA39 = F12_2D_DATA_BASE + 55;
+	F12_2D_CMD00 = F12_2D_CMD_BASE;
+	if (version_is_s3508 == 2)/*s3706*/
+		F12_2D_CTRL20 = F12_2D_CTRL_BASE + 0x06;
+	else
+		F12_2D_CTRL20 = F12_2D_CTRL_BASE + 0x07;
+	F12_2D_CTRL27 = F12_2D_CTRL_BASE + 0x0c;
+
+
+	F34_FLASH_CTRL00 = F34_FLASH_CTRL_BASE;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x4);
+	if( ret < 0 ){
+		TPD_DEBUG("synaptics_read_register_map: failed for page select\n");
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+	F51_CUSTOM_QUERY_BASE = buf[0];
+	F51_CUSTOM_CMD_BASE = buf[1];
+	F51_CUSTOM_CTRL_BASE = buf[2];
+	F51_CUSTOM_DATA_BASE = buf[3];
+	F51_CUSTOM_CTRL00 = F51_CUSTOM_CTRL_BASE;
+	F51_CUSTOM_DATA04 = F51_CUSTOM_DATA_BASE;
+	F51_CUSTOM_DATA11 = F51_CUSTOM_DATA_BASE;
+
+	TPD_DEBUG("F51_CUSTOM_QUERY_BASE = %x \n\
+			F51_CUSTOM_CMD_BASE  = %x \n\
+			F51_CUSTOM_CTRL_BASE    = %x \n\
+			F51_CUSTOM_DATA_BASE    = %x \n\
+			", F51_CUSTOM_QUERY_BASE, F51_CUSTOM_CMD_BASE, F51_CUSTOM_CTRL_BASE, F51_CUSTOM_DATA_BASE);
+
+#if TP_TEST_ENABLE
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x01);
+	if(ret < 0) {
+		TPD_ERR("synaptics_read_register_map: failed for page select\n");
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+	F54_ANALOG_QUERY_BASE = buf[0];
+	F54_ANALOG_COMMAND_BASE = buf[1];
+	F54_ANALOG_CONTROL_BASE = buf[2];
+	F54_ANALOG_DATA_BASE = buf[3];
+	TPD_ERR("F54_QUERY_BASE = %x \n\
+			F54_CMD_BASE  = %x \n\
+			F54_CTRL_BASE	= %x \n\
+			F54_DATA_BASE	= %x \n\
+			", F54_ANALOG_QUERY_BASE, F54_ANALOG_COMMAND_BASE , F54_ANALOG_CONTROL_BASE, F54_ANALOG_DATA_BASE);
+#endif
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	return 0;
+}
+
+#ifdef SUPPORT_GESTURE
+static int synaptics_enable_interrupt_for_gesture(struct synaptics_ts_data *ts, int enable)
+{
+	int ret;
+	unsigned char reportbuf[4];
+	//chenggang.li@BSP.TP modified for gesture
+	TPD_DEBUG("%s is called\n", __func__);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if( ret < 0 ) {
+		TPD_ERR("%s: select page failed ret = %d\n", __func__, ret);
+		return -1;
+	}
+	ret = i2c_smbus_read_i2c_block_data( ts->client, F12_2D_CTRL20, 3, &(reportbuf[0x0]) );
+	if( ret < 0 ) {
+		TPD_DEBUG("read reg F12_2D_CTRL20[0x%x] failed\n",F12_2D_CTRL20);
+		return -1;
+	}
+
+	if( enable ) {
+		ts->in_gesture_mode = 1;
+		reportbuf[2] |= 0x02 ;
+	} else {
+		ts->in_gesture_mode = 0;
+		reportbuf[2] &= 0xfd ;
+	}
+	TPD_DEBUG("F12_2D_CTRL20:0x%x=[2]:0x%x\n", F12_2D_CTRL20, reportbuf[2]);
+	ret = i2c_smbus_write_i2c_block_data( ts->client, F12_2D_CTRL20, 3, &(reportbuf[0x0]) );
+	if( ret < 0 ){
+		TPD_ERR("%s :Failed to write report buffer\n", __func__);
+		return -1;
+	}
+	gesture = UnkownGestrue;
+	return 0;
+}
+#endif
+
+#ifdef SUPPORT_GLOVES_MODE
+#define GLOVES_ADDR 0x001f //0x001D 0x001f
+static int synaptics_glove_mode_enable(struct synaptics_ts_data *ts)
+{
+	int ret;
+	TPD_DEBUG("glove mode enable\n");
+	/* page select = 0x4 */
+	if( 1 == ts->glove_enable)  {
+		ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+		if( ret < 0 ){
+			TPD_DEBUG("i2c_smbus_write_byte_data failed for mode select\n");
+			goto GLOVE_ENABLE_END;
+		}
+		ret = i2c_smbus_read_byte_data(ts->client, GLOVES_ADDR);
+		//TPDTM_DMESG("enable glove  ret is %x ret|0x20 is %x\n", ret, ret|0x20);
+		ret = i2c_smbus_write_byte_data(ts->client, GLOVES_ADDR, ret | 0x01);
+		if( ret < 0 ){
+			TPD_DEBUG("i2c_smbus_write_byte_data failed for mode select\n");
+			goto GLOVE_ENABLE_END;
+		}
+	}else{
+		ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+		if( ret < 0 ){
+			TPD_DEBUG("i2c_smbus_write_byte_data failed for mode select\n");
+			goto GLOVE_ENABLE_END;
+		}
+		ret = i2c_smbus_read_byte_data(ts->client, GLOVES_ADDR);
+		ret = i2c_smbus_write_byte_data(ts->client, GLOVES_ADDR, ret & 0xFE);
+		if( ret < 0 ){
+			TPD_DEBUG("i2c_smbus_write_byte_data failed for mode select\n");
+			goto GLOVE_ENABLE_END;
+		}
+	}
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	if( ret < 0 ){
+		TPD_DEBUG("i2c_smbus_write_byte_data failed for page select\n");
+		goto GLOVE_ENABLE_END;
+	}
+
+GLOVE_ENABLE_END:
+	return ret;
+}
+#endif
+
+#ifdef SUPPORT_TP_SLEEP_MODE
+static int synaptics_sleep_mode_enable(struct synaptics_ts_data *ts)
+{
+	int ret;
+	/* page select = 0x0 */
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	if( ret < 0 ){
+		TPD_ERR("i2c_smbus_write_byte_data failed for page select\n");
+		goto SLEEP_ENABLE_END;
+	}
+	if( 1 == sleep_enable ){
+		/*0x00:enable glove mode,0x02:disable glove mode,*/
+		TPDTM_DMESG("sleep mode enable\n");
+        ret = synaptics_mode_change(0x01);
+		if( ret < 0 ){
+			TPD_ERR("i2c_smbus_write_byte_data failed for mode select\n");
+			goto SLEEP_ENABLE_END;
+		}
+	}else{
+		TPDTM_DMESG("sleep mode disable\n");
+        ret = synaptics_mode_change(0x84);
+		if( ret < 0 ){
+			TPD_ERR("i2c_smbus_write_byte_data failed for mode select\n");
+			goto SLEEP_ENABLE_END;
+		}
+	}
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	if( ret < 0 ){
+		TPD_ERR("i2c_smbus_write_byte_data failed for page select\n");
+		goto SLEEP_ENABLE_END;
+	}
+
+SLEEP_ENABLE_END:
+	return ret;
+}
+#endif
+
+static int synaptics_read_product_id(struct synaptics_ts_data *ts)
+{
+	uint8_t buf1[11];
+	int ret ;
+
+	memset(buf1, 0 , sizeof(buf1));
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if( ret < 0 ){
+		TPDTM_DMESG("synaptics_read_product_id: failed for page select\n");
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_block(ts->client, F01_RMI_QUERY11, 8, &(buf1[0x0]));
+	ret = synaptics_rmi4_i2c_read_block(ts->client, F01_RMI_QUERY_BASE+19, 2, &(buf1[0x8]));
+	if( ret < 0 ){
+		TPD_ERR("synaptics_read_product_id: failed to read product info\n");
+		return -1;
+	}
+	return 0;
+}
+
+static int synaptics_init_panel(struct synaptics_ts_data *ts)
+{
+	int ret;
+
+	TPD_DEBUG("%s is called!\n",__func__);
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+	if( ret < 0 ){
+		TPD_ERR("init_panel failed for page select\n");
+		return -1;
+	}
+	/*device control: normal operation, configur=1*/
+
+    ret = synaptics_mode_change(0x80);//change tp to doze mode
+	if( ret < 0 ){
+		msleep(150);
+        ret = synaptics_mode_change(0x80);
+		if( ret < 0 ){
+			TPD_ERR("%s failed for mode select\n",__func__);
+		}
+	}
+
+	return ret;
+}
+
+static int synaptics_enable_interrupt(struct synaptics_ts_data *ts, int enable)
+{
+	int ret;
+	uint8_t abs_status_int;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if( ret < 0 ) {
+		TPDTM_DMESG("synaptics_enable_interrupt: select page failed ret = %d\n",
+		    ret);
+		return -1;
+	}
+	if( enable ) {
+		abs_status_int = 0x7f;
+		/*clear interrupt bits for previous touch*/
+		ret = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE+1);
+		if( ret < 0 ) {
+			TPDTM_DMESG("synaptics_enable_interrupt :clear interrupt bits failed\n");
+			return -1;
+		}
+	} else {
+		abs_status_int = 0x0;
+	}
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, F01_RMI_CTRL00+1, abs_status_int);
+	if( ret < 0 ) {
+		TPDTM_DMESG("%s: enable or disable abs \
+		    interrupt failed,abs_int =%d\n", __func__, abs_status_int);
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_CTRL00+1);
+	return 0;
+}
+
+static void delay_qt_ms(unsigned long  w_ms)
+{
+	unsigned long i;
+	unsigned long j;
+	for(i = 0; i < w_ms; i++) {
+		for (j = 0; j < 1000; j++) {
+			udelay(1);
+		}
+	}
+}
+/*
+static void int_state(struct synaptics_ts_data *ts)
+{
+	int ret = -1;
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD00, 0x01);
+	if(ret){
+		TPD_ERR("%s:error cannot reset touch panel!\n",__func__);
+		return;
+	}
+	//delay_qt_ms(170);
+	delay_qt_ms(100);
+#ifdef SUPPORT_GLOVES_MODE
+	synaptics_glove_mode_enable(ts);
+#endif
+	ret = synaptics_init_panel(ts);
+	if( ret < 0 ){
+		TPD_DEBUG("%s:error cannot change mode!\n",__func__);
+		return;
+	}
+	ret = synaptics_enable_interrupt(ts, 1);
+	if(ret){
+		TPD_DEBUG("%s:error cannot enable interrupt!\n",__func__);
+		return;
+	}
+}
+*/
+/*Added for larger than 32 length read!*/
+
+int synaptics_rmi4_i2c_read_block(
+		struct i2c_client *client,
+		unsigned char addr,
+		unsigned short length,
+		unsigned char *data)
+{
+	int retval;
+	unsigned char retry;
+	unsigned char buf;
+	struct i2c_msg msg[] = {
+		{
+			.addr = client->addr,
+			.flags = 0,
+			.len = 1,
+			.buf = &buf,
+		},
+		{
+			.addr = client->addr,
+			.flags = I2C_M_RD,
+			.len = length,
+			.buf = data,
+		},
+	};
+	buf = addr & 0xFF;
+	for( retry = 0; retry < 2; retry++ ) {
+		if( i2c_transfer(client->adapter, msg, 2) == 2) {
+			retval = length;
+			break;
+		}
+		msleep(20);
+	}
+	if( retry == 2 ) {
+		dev_err(&client->dev,
+				"%s: I2C read over retry limit\n",
+				__func__);
+		//rst_flag_counter = 1;//reset tp
+		retval = -5;
+	} else {
+		//rst_flag_counter = 0;
+	}
+	return retval;
+}
+
+int synaptics_rmi4_i2c_write_block(
+		struct i2c_client *client,
+		unsigned char addr,
+		unsigned short length,
+		unsigned char const *data)
+{
+	int retval;
+	unsigned char retry;
+	unsigned char buf[length + 1];
+	struct i2c_msg msg[] = {
+		{
+			.addr = client->addr,
+			.flags = 0,
+			.len = length + 1,
+			.buf = buf,
+		}
+	};
+
+	buf[0] = addr & 0xff;
+	memcpy(&buf[1], &data[0], length);
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(client->adapter, msg, 1) == 1) {
+			retval = length;
+			break;
+		}
+		msleep(20);
+	}
+	if (retry == 2) {
+		//rst_flag_counter = 1;//rest tp
+		retval = -EIO;
+	} else {
+		//rst_flag_counter = 0;
+	}
+	return retval;
+}
+
+static int synaptics_rmi4_i2c_read_byte(struct i2c_client* client,
+		unsigned char addr)
+{
+	int retval = 0;
+	unsigned char buf[2] = {0};
+	retval = synaptics_rmi4_i2c_read_block(client,addr,1,buf);
+	if(retval >= 0)
+		retval = buf[0]&0xff;
+	return retval;
+}
+
+static int synaptics_rmi4_i2c_write_byte(struct i2c_client* client,
+		unsigned char addr,unsigned char data)
+{
+	int retval;
+	unsigned char data_send = data;
+	retval = synaptics_rmi4_i2c_write_block(client,addr,1,&data_send);
+	return retval;
+}
+
+static int synaptics_rmi4_i2c_read_word(struct i2c_client* client,
+		unsigned char addr)
+{
+	int retval;
+	unsigned char buf[2] = {0};
+	retval = synaptics_rmi4_i2c_read_block(client,addr,2,buf);
+	if(retval >= 0)
+		retval = buf[1]<<8|buf[0];
+	return retval;
+}
+
+static int synaptics_rmi4_i2c_write_word(struct i2c_client* client,
+		unsigned char addr,unsigned short data)
+{
+	int retval;
+	unsigned char buf[2] = {data&0xff,(data>>8)&0xff};
+	retval = synaptics_rmi4_i2c_write_block(client,addr,2,buf);
+	if(retval >= 0)
+		retval = buf[1]<<8|buf[0];
+	return retval;
+}
+
+//chenggang.li@BSP.TP modified for oem 2014-08-05 gesture_judge
+/***************start****************/
+#ifdef SUPPORT_GESTURE
+static void synaptics_get_coordinate_point(struct synaptics_ts_data *ts)
+{
+	int ret,i;
+	uint8_t coordinate_buf[25] = {0};
+	uint16_t trspoint = 0;
+/* add by lifeng 2016/1/19 workarounds for the gestrue two interrupts begin*/
+	static uint8_t coordinate_buf_last[25]= {0};
+/* add by lifeng 2016/1/19 workarounds for the gestrue two interrupts end*/
+
+	TPD_DEBUG("%s is called!\n",__func__);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x4);
+	if (version_is_s3508 == 2) {
+		ret = i2c_smbus_read_i2c_block_data(ts->client,
+			F51_CUSTOM_DATA_BASE,
+			sizeof(coordinate_buf),
+			&(coordinate_buf[0]));
+	} else if (version_is_s3508 == 1 || version_is_s3508 == 0) {
+	ret = i2c_smbus_read_i2c_block_data(ts->client, F51_CUSTOM_DATA11, 8, &(coordinate_buf[0]));
+	ret = i2c_smbus_read_i2c_block_data(ts->client, F51_CUSTOM_DATA11 + 8, 8, &(coordinate_buf[8]));
+	ret = i2c_smbus_read_i2c_block_data(ts->client, F51_CUSTOM_DATA11 + 16, 8, &(coordinate_buf[16]));
+	ret = i2c_smbus_read_i2c_block_data(ts->client, F51_CUSTOM_DATA11 + 24, 1, &(coordinate_buf[24]));
+	}
+/* add by lifeng 2016/1/19 workarounds for the gestrue two interrupts begin*/
+	if (!memcmp(coordinate_buf_last, coordinate_buf,
+		sizeof(coordinate_buf))) {
+		TPD_ERR("%s reject the same gestrue[%d]\n", __func__, gesture);
+		gesture = UnkownGestrue;
+	}
+	memcpy(coordinate_buf_last,coordinate_buf,sizeof(coordinate_buf));
+/* strcpy(coordinate_buf_last, coordinate_buf, sizeof(coordinate_buf));
+ * add by lifeng 2016/1/19 workarounds for the gestrue two interrupts end
+ */
+
+	for(i = 0; i< 23; i += 2) {
+		trspoint = coordinate_buf[i]|coordinate_buf[i+1] << 8;
+		TPD_DEBUG("synaptics TP read coordinate_point[%d] = %d\n",i,trspoint);
+	}
+
+	TPD_DEBUG("synaptics TP coordinate_buf = 0x%x\n",coordinate_buf[24]);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	Point_start.x = (coordinate_buf[0] | (coordinate_buf[1] << 8)) * LCD_WIDTH/ (ts->max_x);
+	Point_start.y = (coordinate_buf[2] | (coordinate_buf[3] << 8)) * LCD_HEIGHT/ (ts->max_y);
+	Point_end.x   = (coordinate_buf[4] | (coordinate_buf[5] << 8)) * LCD_WIDTH / (ts->max_x);
+	Point_end.y   = (coordinate_buf[6] | (coordinate_buf[7] << 8)) * LCD_HEIGHT / (ts->max_y);
+	Point_1st.x   = (coordinate_buf[8] | (coordinate_buf[9] << 8)) * LCD_WIDTH / (ts->max_x);
+	Point_1st.y   = (coordinate_buf[10] | (coordinate_buf[11] << 8)) * LCD_HEIGHT / (ts->max_y);
+	Point_2nd.x   = (coordinate_buf[12] | (coordinate_buf[13] << 8)) * LCD_WIDTH / (ts->max_x);
+	Point_2nd.y   = (coordinate_buf[14] | (coordinate_buf[15] << 8)) * LCD_HEIGHT / (ts->max_y);
+	Point_3rd.x   = (coordinate_buf[16] | (coordinate_buf[17] << 8)) * LCD_WIDTH / (ts->max_x);
+	Point_3rd.y   = (coordinate_buf[18] | (coordinate_buf[19] << 8)) * LCD_HEIGHT / (ts->max_y);
+	Point_4th.x   = (coordinate_buf[20] | (coordinate_buf[21] << 8)) * LCD_WIDTH / (ts->max_x);
+	Point_4th.y   = (coordinate_buf[22] | (coordinate_buf[23] << 8)) * LCD_HEIGHT / (ts->max_y);
+	clockwise     = (coordinate_buf[24] & 0x10) ? 1 :
+		(coordinate_buf[24] & 0x20) ? 0 : 2; // 1--clockwise, 0--anticlockwise, not circle, report 2
+}
+
+static int set_tp_info(struct synaptics_ts_data *ts, uint8_t up_down)
+{
+	int ret = 0;
+	uint8_t tp_infor[8] = {0};
+	struct fp_underscreen_info tp_info;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x4);
+	ret = i2c_smbus_read_i2c_block_data(ts->client,
+			F51_CUSTOM_DATA_BASE,
+			sizeof(tp_infor),
+			&(tp_infor[0]));
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	TPD_DEBUG("%s:tp info %d %d %d %d\n", __func__,
+			tp_infor[0]|tp_infor[1]<<8,tp_infor[2]|tp_infor[3]<<8,
+			tp_infor[4]|tp_infor[5]<<8,tp_infor[6]|tp_infor[7]<<8);
+	tp_info.x = tp_infor[1]<<8|tp_infor[0];
+	tp_info.y = tp_infor[3]<<8|tp_infor[2];
+	tp_info.area_rate = tp_infor[5]<<8|tp_infor[4];
+	tp_info.touch_state = up_down;
+	opticalfp_irq_handler(&tp_info);
+
+	return ret;
+}
+
+static int recored_xy(struct synaptics_ts_data *ts, int x)
+{
+	int ret = 0;
+	uint8_t tp_info[8] = {0};
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x4);
+	ret = i2c_smbus_read_i2c_block_data(ts->client,
+			F51_CUSTOM_DATA_BASE,
+			sizeof(tp_info),
+			&(tp_info[0]));
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	TPD_DEBUG("%s:recored_xy %d %d %d %d\n", __func__,
+			tp_info[0]|tp_info[1]<<8, tp_info[2]|tp_info[3]<<8,
+			tp_info[4]|tp_info[5]<<8, tp_info[6]|tp_info[7]<<8);
+	recored_pointx[x] = tp_info[1]<<8|tp_info[0];
+	recored_pointy[x] = tp_info[3]<<8|tp_info[2];
+	TPD_DEBUG("%s:recored_xy[%d] x= %d y= %d\n", __func__,
+		x, recored_pointx[x], recored_pointy[x]);
+
+	return ret;
+}
+
+static void fp_detect(struct synaptics_ts_data *ts)
+{
+	int ret = 0, gesture_sign;
+	uint8_t gesture_buffer[10];
+
+	ret = i2c_smbus_write_byte_data(
+		ts->client, 0xff, 0x00);
+	ret = i2c_smbus_read_i2c_block_data(
+		ts->client,
+		0x000A, 5,
+		&(gesture_buffer[0]));
+
+	gesture_sign = gesture_buffer[0];
+	switch (gesture_sign) {
+	case FINGER_DOWN:
+		ts->fp_up_down = 1;
+		sysfs_notify(&ts->dev->kobj, NULL,
+			dev_attr_fp_irq.attr.name);
+		TPD_DEBUG("%s:FINGER_DOWN %d\n", __func__,
+			ts->fp_up_down);
+		/*update tp info*/
+		set_tp_info(ts, 1);
+		need_reset = 0;
+			break;
+	case FINGER_UP:
+		ts->fp_up_down = 0;
+		sysfs_notify(&ts->dev->kobj, NULL,
+			dev_attr_fp_irq.attr.name);
+		TPD_DEBUG("%s:FINGER_UP %d\n", __func__,
+			ts->fp_up_down);
+		/*update tp info*/
+		set_tp_info(ts, 0);
+		if (ts->fp_aod_cnt > 0)
+			need_reset = 1;
+		ts->fp_aod_cnt = 0;
+		break;
+	}
+	ret = i2c_smbus_write_byte_data(
+		ts->client, 0xff, 0x00);
+}
+
+static int time_recored(bool start_time)
+{
+	int timeuse = 0;
+
+	if (start_time) {
+		do_gettimeofday(&tpstart);
+	} else {
+		do_gettimeofday(&tpend);
+		timeuse = 1000000 * (tpend.tv_sec-tpstart.tv_sec)
+				+ tpend.tv_usec-tpstart.tv_usec;
+		TPD_DEBUG("Use time: %d uSeconds!!", timeuse);
+	}
+	if ((timeuse >= 800000) || (timeuse <= 0))
+		return 0;
+
+	return 1;
+}
+
+static int double_tap(struct synaptics_ts_data *ts)
+{
+	int time_use = 0;
+	int ret = 0;
+
+	if (singer_touch_mun == 0) {
+		time_recored(true);
+		recored_xy(ts, 0);
+		singer_touch_mun = 1;
+	} else {
+		time_use = time_recored(false);
+		recored_xy(ts, 1);
+		singer_touch_mun = 0;
+		if ((abs(recored_pointx[0] - recored_pointx[1]) < 100)
+			&& (abs(recored_pointy[0] - recored_pointy[1]) < 120)
+				&& (time_use)) {
+			ret = 1;
+		} else {
+			time_recored(true);
+			recored_xy(ts, 0);
+			singer_touch_mun = 1;
+			ret = -1;
+		}
+	}
+
+	return ret;
+}
+
+
+static void gesture_judge(struct synaptics_ts_data *ts)
+{
+	unsigned int keyCode = KEY_F4;
+	int ret = 0, regswipe = 0;
+	uint8_t gesture_buffer[10];
+	uint8_t gesture_sign = 0;
+	unsigned char reportbuf[3];
+	uint8_t regswipe_s3706[25];
+	int is_double_tap = 0;
+
+	if (version_is_s3508 == 1)
+		F12_2D_DATA04 = 0x0008;
+	else if (version_is_s3508 == 2) /*s3706*/
+ 		F12_2D_DATA04 = 0x000A;
+	else
+		F12_2D_DATA04 = 0x000A;
+	TPD_DEBUG("%s start!\n",__func__);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0) {
+		TPDTM_DMESG("failed to transfer the data, ret = %d\n", ret);
+	}
+	ret = i2c_smbus_write_byte_data(
+		ts->client, 0xff, 0x00);
+	ret = i2c_smbus_read_i2c_block_data(
+		ts->client,
+		F12_2D_DATA04, 5,
+		&(gesture_buffer[0]));
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x4);
+	if (version_is_s3508 == 2) {
+		ret = i2c_smbus_read_i2c_block_data(
+		ts->client,  F51_CUSTOM_DATA_BASE,
+		sizeof(regswipe_s3706), &(regswipe_s3706[0]));
+		if (ret < 0)
+		TPDTM_DMESG("failed to transfer the data, ret = %d\n", ret);
+	} else if (version_is_s3508 == 1)
+		regswipe = i2c_smbus_read_byte_data(ts->client,
+				F51_CUSTOM_DATA04+0x18);
+	else
+		regswipe = i2c_smbus_read_byte_data(ts->client,
+				F51_CUSTOM_DATA04+0x18);
+	if (version_is_s3508 == 2) {
+		TPD_DEBUG("GestureType[0x%x]=[0x%x]\n",
+		F12_2D_DATA04, gesture_buffer[0]);
+		TPD_DEBUG("lpwgSwipeID[0x4%x] = [0x%x]\n",
+		F51_CUSTOM_DATA_BASE, regswipe_s3706[24]);
+	} else if (version_is_s3508 == 1) {
+		TPD_DEBUG("GestureType[0x%x]=[0x%x]\n",
+		F12_2D_DATA04, gesture_buffer[0]);
+		TPD_DEBUG("lpwgSwipeID[0x4%x] = [0x%x]\n",
+		(F51_CUSTOM_DATA04+0x18), regswipe);
+	} else
+		TPD_DEBUG("Gesture Type[0x%x]=[0x%x],lpwg Swipe ID[0x4%x] = [0x%x]\n",\
+		F12_2D_DATA04,gesture_buffer[0],(F51_CUSTOM_DATA04+0x18),regswipe);
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	gesture_sign = gesture_buffer[0];
+
+	if (ts->project_version == 0x03) {
+		if (DouTap_gesture) {
+			if (gesture_sign == SINGLE_TAP) {
+				is_double_tap = double_tap(ts);
+				if (is_double_tap == 1) {
+					gesture_sign = DTAP_DETECT;
+				}
+			}
+		}
+	}
+	//detect the gesture mode
+	switch (gesture_sign) {
+		case DTAP_DETECT:
+			    gesture = DouTap;
+			break;
+		case SWIPE_DETECT:
+			if (version_is_s3508 == 2) {
+			gesture =
+			(regswipe_s3706[24] == 0x41) ? Left2RightSwip :
+			(regswipe_s3706[24] == 0x42) ? Right2LeftSwip :
+			(regswipe_s3706[24] == 0x44) ? Up2DownSwip :
+			(regswipe_s3706[24] == 0x48) ? Down2UpSwip :
+			(regswipe_s3706[24] == 0x80) ? DouSwip  :
+			UnkownGestrue;
+				break;
+			} else if (version_is_s3508 == 1) {
+				gesture =   (regswipe == 0x41) ? Left2RightSwip   :
+					(regswipe == 0x42) ? Right2LeftSwip   :
+					(regswipe == 0x44) ? Up2DownSwip      :
+					(regswipe == 0x48) ? Down2UpSwip      :
+					(regswipe == 0x80) ? DouSwip          :
+					UnkownGestrue;
+				break;
+			}else{
+				gesture = (regswipe == 0x41) ? Left2RightSwip   :
+					(regswipe == 0x42) ? Right2LeftSwip   :
+					(regswipe == 0x44) ? Up2DownSwip      :
+					(regswipe == 0x48) ? Down2UpSwip      :
+					(regswipe == 0x84) ? DouSwip          :
+					UnkownGestrue;
+				break;
+			}
+		case CIRCLE_DETECT:
+			    gesture = Circle;
+			break;
+		case VEE_DETECT:
+			gesture = (gesture_buffer[2] == 0x01) ? DownVee  :
+				(gesture_buffer[2] == 0x02) ? UpVee    :
+				(gesture_buffer[2] == 0x04) ? RightVee :
+				(gesture_buffer[2] == 0x08) ? LeftVee  :
+				UnkownGestrue;
+			break;
+		case FINGER_DOWN:
+			if (ts->project_version == 0x03) {
+				ts->fp_up_down = 1;
+				ts->fp_aod_cnt = 1;
+				sysfs_notify(&ts->dev->kobj, NULL,
+					dev_attr_fp_irq.attr.name);
+				TPD_DEBUG("%s:FINGER_DOWN %d\n", __func__,
+					ts->fp_up_down);
+				/*update tp info*/
+				set_tp_info(ts, 1);
+				not_getbase = 1;
+				need_reset = 0;
+			}
+			gesture = UnkownGestrue;
+			break;
+		case FINGER_UP:
+			if (ts->project_version == 0x03) {
+				ts->fp_up_down = 0;
+				ts->fp_aod_cnt = 0;
+				sysfs_notify(&ts->dev->kobj, NULL,
+					dev_attr_fp_irq.attr.name);
+				TPD_DEBUG("%s:FINGER_UP %d\n", __func__,
+					ts->fp_up_down);
+				/*update tp info*/
+				set_tp_info(ts, 0);
+			}
+			gesture = UnkownGestrue;
+			break;
+		case SINGLE_TAP:
+			if (ts->project_version == 0x03) {
+				TPD_DEBUG("%s:SINGLE TAP\n", __func__);
+				gesture = SingleTap;
+			}
+			break;
+		case UNICODE_DETECT:
+			gesture = (gesture_buffer[2] == 0x77) ? Wgestrue :
+				(gesture_buffer[2] == 0x6d) ? Mgestrue :
+				(gesture_buffer[2] == 0x73) ? Sgestrue :
+				UnkownGestrue;
+			break;
+		default:
+			gesture = UnkownGestrue;
+			break;
+		}
+
+	TPD_ERR("detect %s gesture\n", gesture == DouTap ? "(double tap)" :
+			gesture == UpVee ? "(V)" :
+			gesture == DownVee ? "(^)" :
+			gesture == LeftVee ? "(>)" :
+			gesture == RightVee ? "(<)" :
+			gesture == Circle ? "(O)" :
+			gesture == DouSwip ? "(||)" :
+			gesture == Left2RightSwip ? "(-->)" :
+			gesture == Right2LeftSwip ? "(<--)" :
+			gesture == Up2DownSwip ? "(up to down |)" :
+			gesture == Down2UpSwip ? "(down to up |)" :
+			gesture == Mgestrue ? "(M)" :
+			gesture == Sgestrue ? "(S)" :
+			gesture == Wgestrue ? "(W)" :
+			gesture == SingleTap ? "(single tap)" : "[unknown]");
+	if ((gesture != SingleTap) && (gesture != DouTap))
+		synaptics_get_coordinate_point(ts);
+
+    TPD_DEBUG("gesture suport LeftVee:%d RightVee:%d DouSwip:%d Circle:%d UpVee:%d DouTap:%d\n",\
+        LeftVee_gesture,RightVee_gesture,DouSwip_gesture,Circle_gesture,UpVee_gesture,DouTap_gesture);
+	if((gesture == DouTap && DouTap_gesture)||(gesture == RightVee && RightVee_gesture)\
+		||(gesture == LeftVee && LeftVee_gesture)||(gesture == UpVee && UpVee_gesture)\
+		||(gesture == Circle && Circle_gesture)||(gesture == DouSwip && DouSwip_gesture)\
+		||(gesture == Sgestrue && Sgestrue_gesture)||(gesture == Wgestrue && Wgestrue_gesture)\
+		||(gesture == Mgestrue && Mgestrue_gesture)||(gesture == SingleTap && Single_gesture)) {
+		input_report_key(ts->input_dev, keyCode, 1);
+		input_sync(ts->input_dev);
+		input_report_key(ts->input_dev, keyCode, 0);
+		input_sync(ts->input_dev);
+	}else{
+		mutex_lock(&ts->mutex);
+		ret = i2c_smbus_read_i2c_block_data( ts->client, F12_2D_CTRL20, 3, &(reportbuf[0x0]) );
+		ret = reportbuf[2] & 0x20;
+		if(ret == 0)
+			reportbuf[2] |= 0x02 ;
+		ret = i2c_smbus_write_i2c_block_data( ts->client, F12_2D_CTRL20, 3, &(reportbuf[0x0]) ); //enable gesture
+		if (ret < 0)
+			TPD_ERR("%s :Failed to write report buffer\n", __func__);
+		mutex_unlock(&ts->mutex);
+	}
+	TPD_DEBUG("%s end!\n", __func__);
+}
+#endif
+/***************end****************/
+static char prlog_count = 0;
+#ifdef REPORT_2D_PRESSURE
+static unsigned char pres_value = 1;
+#endif
+#ifdef SUPPORT_VIRTUAL_KEY //WayneChang, 2015/12/02, add for key to abs, simulate key in abs through virtual key system
+//extern struct completion key_cm;
+bool key_back_pressed = 0;
+bool key_appselect_pressed = 0;
+bool key_home_pressed =0;
+extern bool virtual_key_enable;
+#endif
+
+void int_touch(void)
+{
+	int ret = -1,i = 0;
+	uint8_t buf[90];
+	uint8_t count_data = 0;
+	uint8_t object_attention[2];
+	uint16_t total_status = 0;
+	uint8_t finger_num = 0;
+	uint8_t finger_status = 0;
+	struct point_info points;
+	uint32_t finger_info = 0;
+	static uint8_t current_status = 0;
+	uint8_t last_status = 0 ;
+#ifdef SUPPORT_VIRTUAL_KEY //WayneChang, 2015/12/02, add for key to abs, simulate key in abs through virtual key system
+	bool key_appselect_check = false;
+	bool key_back_check = false;
+	bool key_home_check = false;
+	bool key_pressed = key_appselect_pressed || key_back_pressed;// || key_home_pressed;
+#endif
+	struct synaptics_ts_data *ts = ts_g;
+
+	memset(buf, 0, sizeof(buf));
+	points.x = 0;
+	points.y = 0;
+	points.z = 0;
+	points.status = 0;
+
+	mutex_lock(&ts->mutexreport);
+#ifdef REPORT_2D_PRESSURE
+    if (ts->support_ft){
+        ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x4);
+        ret = synaptics_rmi4_i2c_read_block(ts->client, 0x19,\
+            sizeof(points.pressure), &points.pressure);
+        if (ret < 0) {
+            TPD_ERR("synaptics_int_touch: i2c_transfer failed\n");
+            goto INT_TOUCH_END;
+        }
+        if (0 == points.pressure)//workaround for have no pressure value input reader into hover mode
+        {
+            pres_value++;
+            if (255 == pres_value)
+                pres_value = 1;
+        }
+        else
+        {
+            pres_value = points.pressure;
+        }
+    }
+#endif
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+	if (version_is_s3508 == 1)
+		F12_2D_DATA15 = 0x0009;
+	else if (version_is_s3508 == 0)
+		F12_2D_DATA15 = 0x000C;
+	else if (version_is_s3508 == 2)
+		F12_2D_DATA15 = 0x000B;/*s3706 for 17819*/
+	ret = synaptics_rmi4_i2c_read_block(ts->client, F12_2D_DATA15, 2, object_attention);
+    if (ret < 0) {
+        TPD_ERR("synaptics_int_touch F12_2D_DATA15: i2c_transfer failed\n");
+        goto INT_TOUCH_END;
+    }
+	total_status = (object_attention[1] << 8) | object_attention[0];
+
+	if(total_status){
+		while(total_status){
+			count_data++;
+			total_status >>= 1;
+		}
+	}else{
+		count_data = 0;
+	}
+        if(count_data > 10){
+            TPD_ERR("count_data is: %d\n", count_data);
+            goto INT_TOUCH_END;
+        }
+	ret = synaptics_rmi4_i2c_read_block(ts->client, F12_2D_DATA_BASE, count_data*8+1, buf);
+	if (ret < 0) {
+		TPD_ERR("synaptics_int_touch F12_2D_DATA_BASE: i2c_transfer failed\n");
+		goto INT_TOUCH_END;
+	}
+	for( i = 0; i < count_data; i++ ) {
+		points.status = buf[i*8];
+		points.x = ((buf[i*8+2]&0x0f)<<8) | (buf[i*8+1] & 0xff);
+		points.raw_x = buf[i*8+6] & 0x0f;
+		points.y = ((buf[i*8+4]&0x0f)<<8) | (buf[i*8+3] & 0xff);
+		points.raw_y = buf[i*8+7] & 0x0f;
+		points.z = buf[i*8+5];
+		finger_info <<= 1;
+		finger_status =  points.status & 0x03;
+#ifdef SUPPORT_VIRTUAL_KEY //WayneChang, 2015/12/02, add for key to abs, simulate key in abs through virtual key system
+            if(virtual_key_enable){
+                if(points.y > 0x780 && key_pressed){
+                        TPD_DEBUG("Drop TP event due to key pressed\n");
+                        finger_status = 0;
+                }else{
+                    finger_status =  points.status & 0x03;
+                }
+            }else{
+                finger_status =  points.status & 0x03;
+            }
+            if(virtual_key_enable){
+                    if (!finger_status){
+                        if (key_appselect_pressed && !key_appselect_check){
+                            points.x = 0xb4;
+                            points.y = 0x7e2;
+                            points.z = 0x33;
+                            points.raw_x = 4;
+                            points.raw_y = 6;
+                            key_appselect_check = true;
+                            points.status = 1;
+                            finger_status =  points.status & 0x03;
+                        }else if (key_back_pressed && !key_back_check){
+                            points.x = 0x384;
+                            points.y = 0x7e2;
+                            points.z = 0x33;
+                            points.raw_x = 4;
+                            points.raw_y = 6;
+                            key_back_check = true;
+                            points.status = 1;
+                            finger_status =  points.status & 0x03;
+                        }else if(key_home_pressed && !key_home_check){
+                            points.x = 0x21c;
+                            points.y = 0x7e2;
+                            points.z = 0x33;
+                            points.raw_x = 4;
+                            points.raw_y = 6;
+                            key_home_check = true;
+                            points.status = 1;
+                            finger_status =  points.status & 0x03;
+                    }else{
+                            //TPD_DEBUG(" finger %d with !finger_statue and no key match\n",i);
+                        }
+                    }
+            }
+#endif
+		if (version_is_s3508 == 0){//for 15811 panel
+			points.x = 1079 - points.x;
+			points.y = 1919 - points.y;
+		}
+		if (finger_status) {
+			input_mt_slot(ts->input_dev, i);
+			input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, finger_status);
+			input_report_key(ts->input_dev, BTN_TOOL_FINGER, 1);
+			input_report_abs(ts->input_dev, ABS_MT_POSITION_X, points.x);
+			input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, points.y);
+			//#ifdef REPORT_2D_W
+			input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, max(points.raw_x, points.raw_y));
+			input_report_abs(ts->input_dev, ABS_MT_TOUCH_MINOR, min(points.raw_x, points.raw_y));
+			//#endif
+#ifdef REPORT_2D_PRESSURE
+            if (ts->support_ft){
+                input_report_abs(ts->input_dev,ABS_MT_PRESSURE,pres_value);
+                TPD_DEBUG("%s: pressure%d[%d]\n",__func__,i,pres_value);
+            }
+#endif
+#ifndef TYPE_B_PROTOCOL
+			input_mt_sync(ts->input_dev);
+#endif
+#ifdef SUPPORT_VIRTUAL_KEY //WayneChang, 2015/12/02, add for key to abs, simulate key in abs through virtual key system
+            if(virtual_key_enable){
+              //  complete(&key_cm);
+            }
+#endif
+			finger_num++;
+			finger_info |= 1 ;
+			//TPD_DEBUG("%s: Finger %d: status = 0x%02x "
+					//"x = %4d, y = %4d, wx = %2d, wy = %2d\n",
+					//__func__, i, points.status, points.x, points.y, points.raw_x, points.raw_y);
+
+		}
+	}
+
+	finger_info <<= (ts->max_num - count_data);
+
+	for ( i = 0; i < ts->max_num; i++ )
+	{
+		finger_status = (finger_info>>(ts->max_num-i-1)) & 1 ;
+		if(!finger_status)
+		{
+			input_mt_slot(ts->input_dev, i);
+			input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, finger_status);
+		}
+
+	}
+
+	last_status = current_status & 0x02;
+
+	if (ts->project_version == 0x03) {
+		if (ts->en_up_down && ts->in_gesture_mode == 0)
+			fp_detect(ts);
+	}
+
+	if (finger_num == 0/* && last_status && (check_key <= 1)*/) {
+		if (3 == (++prlog_count % 6))
+			TPD_ERR("all finger up\n");
+		if (ts->project_version == 0x03) {
+			if ((ts->unlock_succes == 1) && (need_reset ==1) && (ts->is_suspended == 0)) {
+				TPD_DEBUG("touch hold reset %d\n", need_reset);
+				need_reset = 0;
+				ts->unlock_succes = 0;
+				mutex_lock(&ts->mutex);
+				ret = synaptics_rmi4_i2c_write_byte
+					(ts->client, 0xff, 0x0);
+				ret = i2c_smbus_write_byte_data(ts->client,
+					F01_RMI_CMD_BASE, 0x01);//soft reset
+				mutex_unlock(&ts->mutex);
+				msleep(2);
+			#ifdef ENABLE_TPEDGE_LIMIT
+				synaptics_tpedge_limitfunc();
+			#endif
+			}
+		}
+		input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+#ifndef TYPE_B_PROTOCOL
+		input_mt_sync(ts->input_dev);
+#endif
+	}
+	input_sync(ts->input_dev);
+
+	if ((finger_num == 0) && (get_tp_base == 0)){//all finger up do get base once
+		get_tp_base = 1;
+		TPD_ERR("start get base data:%d\n",get_tp_base);
+		if (!ts->en_up_down)
+			tp_baseline_get(ts, false);
+	}
+
+#ifdef SUPPORT_GESTURE
+	if (ts->in_gesture_mode == 1 && ts->is_suspended == 1) {
+		gesture_judge(ts);
+	}
+#endif
+
+INT_TOUCH_END:
+	mutex_unlock(&ts->mutexreport);
+}
+static char log_count = 0;
+#ifdef SUPPORT_TP_TOUCHKEY
+#define OEM_KEY_BACK (key_switch?KEY_APPSELECT:KEY_BACK)
+#define OEM_KEY_APPSELECT (key_switch?KEY_BACK:KEY_APPSELECT)
+#else
+#define OEM_KEY_BACK KEY_BACK
+#define OEM_KEY_APPSELECT KEY_APPSELECT
+#endif
+static void int_key_report_s3508(struct synaptics_ts_data *ts)
+{
+    	int ret= 0;
+	int F1A_0D_DATA00=0x00;
+	int button_key;
+
+	if (ts->is_suspended == 1)
+		return;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x02 );
+	if (ret < 0) {
+		TPD_ERR("%s: line[%d]Failed to change page!!\n",__func__,__LINE__);
+		return;
+	 }
+	button_key = synaptics_rmi4_i2c_read_byte(ts->client,F1A_0D_DATA00);
+	if (1 == (++log_count % 4))
+		TPD_ERR("touch_key[0x%x],touchkey_state[0x%x]\n",button_key,ts->pre_btn_state);
+	if((button_key & 0x01) && !(ts->pre_btn_state & 0x01) && !key_back_disable)//back
+	{
+		input_report_key(ts->input_dev, OEM_KEY_BACK, 1);
+		input_sync(ts->input_dev);
+	}else if(!(button_key & 0x01) && (ts->pre_btn_state & 0x01) && !key_back_disable){
+		input_report_key(ts->input_dev, OEM_KEY_BACK, 0);
+		input_sync(ts->input_dev);
+	}
+
+	if((button_key & 0x02) && !(ts->pre_btn_state & 0x02) && !key_appselect_disable)//menu
+	{
+		input_report_key(ts->input_dev, OEM_KEY_APPSELECT, 1);
+		input_sync(ts->input_dev);
+	}else if(!(button_key & 0x02) && (ts->pre_btn_state & 0x02) && !key_appselect_disable){
+		input_report_key(ts->input_dev, OEM_KEY_APPSELECT, 0);
+		input_sync(ts->input_dev);
+	}
+
+	ts->pre_btn_state = button_key & 0x07;
+	//input_sync(ts->input_dev);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0) {
+		TPD_ERR("%s: line[%d]Failed to change page!!\n",__func__,__LINE__);
+		return;
+	}
+	return;
+}
+
+static int synaptics_rmi4_free_fingers(struct synaptics_ts_data *ts)
+{
+	unsigned char i;
+
+#ifdef TYPE_B_PROTOCOL
+	for (i = 0; i < ts->max_num; i++) {
+		input_mt_slot(ts->input_dev, i);
+		input_mt_report_slot_state(ts->input_dev,
+				MT_TOOL_FINGER, 0);
+	}
+#endif
+	input_report_key(ts->input_dev, BTN_TOUCH, 0);
+	input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+#ifndef TYPE_B_PROTOCOL
+	input_mt_sync(ts->input_dev);
+#endif
+	input_sync(ts->input_dev);
+
+	return 0;
+}
+
+static void synaptics_ts_work_func(struct work_struct *work)
+{
+	int ret,status_check;
+	uint8_t status = 0;
+	uint8_t inte = 0;
+
+    	struct synaptics_ts_data *ts = ts_g;
+
+	if (atomic_read(&ts->is_stop) == 1)
+	{
+		touch_disable(ts);
+		return;
+	}
+
+	if( ts->enable_remote) {
+		goto END;
+	}
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00 );
+	ret = synaptics_rmi4_i2c_read_word(ts->client, F01_RMI_DATA_BASE);
+
+	if( ret < 0 ) {
+		TPDTM_DMESG("Synaptic:ret = %d\n", ret);
+		synaptics_hard_reset(ts);
+		if (ts->is_suspended == 1 && ts->gesture_enable == 0) {
+			touch_disable(ts);
+			goto EXIT;
+		}
+		goto END;
+	}
+	status = ret & 0xff;
+	inte = (ret & 0x7f00)>>8;
+	//TPD_ERR("%s status[0x%x],inte[0x%x]\n",__func__,status,inte);
+        if(status & 0x80){
+		TPD_DEBUG("enter reset tp status,and ts->in_gesture_mode is:%d\n",ts->in_gesture_mode);
+		status_check = synaptics_init_panel(ts);
+		if (status_check < 0) {
+			TPD_ERR("synaptics_init_panel failed\n");
+		}
+		if ((ts->is_suspended == 1) && (ts->gesture_enable == 1)){
+			synaptics_enable_interrupt_for_gesture(ts, 1);
+			if (ts->project_version == 0x03) {
+				mutex_lock(&ts->mutex);
+				tp_single_tap_en(ts, true);
+				if (ts->en_up_down)
+					touch_hold_en(ts, true);
+				mutex_unlock(&ts->mutex);
+			}
+		}
+	}
+/*
+	if(0 != status && 1 != status) {//0:no error;1: after hard reset;the two state don't need soft reset
+        TPD_ERR("%s status[0x%x],inte[0x%x]\n",__func__,status,inte);
+		int_state(ts);
+		goto END;
+	}
+*/
+	if (inte == 1) {
+		TPD_ERR("%s: spontaneous reset detected\n", __func__);
+		ret = synaptics_rmi4_free_fingers(ts);
+		if (ret < 0)
+			TPD_ERR("%s: Failed to reinit device\n", __func__);
+	}
+
+	if( inte & 0x04 ) {
+
+		int_touch();
+	}
+	if( inte & 0x10 ){
+		int_key_report_s3508(ts);
+	}
+
+
+END:
+	//ret = set_changer_bit(ts);
+	touch_enable(ts);
+EXIT:
+	return;
+}
+
+#ifndef TPD_USE_EINT
+static enum hrtimer_restart synaptics_ts_timer_func(struct hrtimer *timer)
+{
+	struct synaptics_ts_data *ts = container_of(timer, struct synaptics_ts_data, timer);
+	mutex_lock(&ts->mutex);
+	synaptics_ts_work_func(ts);
+	mutex_unlock(&ts->mutex);
+	hrtimer_start(&ts->timer, ktime_set(0, 12500000), HRTIMER_MODE_REL);
+	return HRTIMER_NORESTART;
+}
+#else
+static irqreturn_t synaptics_irq_thread_fn(int irq, void *dev_id)
+{
+	struct synaptics_ts_data *ts = (struct synaptics_ts_data *)dev_id;
+    touch_disable(ts);
+	synaptics_ts_work_func(&ts->report_work);
+	return IRQ_HANDLED;
+}
+#endif
+
+//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  begin
+static ssize_t tp_baseline_test_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return baseline_ret;
+	if(baseline_ret == 0){
+		count = synaptics_rmi4_baseline_show(ts->dev,page,1);
+		baseline_ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	}else{
+		baseline_ret = 0;
+	}
+	return baseline_ret;
+}
+//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  end
+
+static ssize_t i2c_device_test_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts_g)
+		return ret;
+	TPD_DEBUG("gesture enable is: %d\n", ts->gesture_enable);
+	ret = sprintf(page, "%d\n", ts->i2c_device_test);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+#ifdef SUPPORT_GESTURE
+static ssize_t tp_gesture_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	TPD_DEBUG("gesture enable is: %d\n", ts->gesture_enable);
+	ret = sprintf(page, "%d\n", ts->gesture_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t tp_gesture_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	char buf[10];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return count;
+	if( count > 3 || ts->is_suspended)
+		return count;
+	if( copy_from_user(buf, buffer, count) ){
+		TPD_ERR(KERN_INFO "%s: read proc input error.\n", __func__);
+		return count;
+	}
+	//ruanbanmao@BSP add for tp gesture 2015-05-06, begin
+	TPD_ERR("%s write argc1[0x%x],argc2[0x%x]\n",__func__,buf[0],buf[1]);
+
+	UpVee_gesture = (buf[0] & BIT0)?1:0; //"V"
+	DouSwip_gesture = (buf[0] & BIT1)?1:0;//"||"
+	LeftVee_gesture = (buf[0] & BIT3)?1:0; //">"
+	RightVee_gesture = (buf[0] & BIT4)?1:0;//"<"
+	Circle_gesture = (buf[0] & BIT6)?1:0; //"O"
+	DouTap_gesture = (buf[0] & BIT7)?1:0; //double tap
+
+	Sgestrue_gesture = (buf[1] & BIT0)?1:0;//"S"
+	Mgestrue_gesture = (buf[1] & BIT1)?1:0; //"M"
+	Wgestrue_gesture = (buf[1] & BIT2)?1:0; //"W"
+	Single_gesture = (buf[1] & BIT3)?1:0;   //"Single_gesture"
+	//enable gesture
+	Enable_gesture = (buf[1] & BIT7)?1:0;
+
+	if (DouTap_gesture || Circle_gesture || UpVee_gesture
+		|| LeftVee_gesture || RightVee_gesture || DouSwip_gesture
+		|| Sgestrue_gesture || Mgestrue_gesture || Wgestrue_gesture
+		|| Enable_gesture || Single_gesture) {
+		ts->gesture_enable = 1;
+	}
+	else
+	{
+		ts->gesture_enable = 0;
+	}
+    //ruanbanmao@BSP add for tp gesture 2015-05-06, end
+	return count;
+}
+static ssize_t coordinate_proc_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	TPD_ERR("%s:gesture_upload = %d \n", __func__, gesture);
+	ret = sprintf(page, "%d,%d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d:%d,%d\n",
+		gesture, Point_start.x, Point_start.y, Point_end.x, Point_end.y,
+		Point_1st.x, Point_1st.y, Point_2nd.x, Point_2nd.y,
+		Point_3rd.x, Point_3rd.y, Point_4th.x, Point_4th.y,
+		clockwise);
+
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t gesture_switch_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	ret = sprintf(page, "gesture_switch:%d\n", gesture_switch);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t gesture_switch_write_func(struct file *file, const char __user *page, size_t count, loff_t *ppos)
+{
+	int ret,write_flag=0;
+	char buf[10]={0};
+	struct synaptics_ts_data *ts = ts_g;
+
+	if(ts->loading_fw) {
+		TPD_ERR("%s FW is updating break!!\n",__func__);
+		return count;
+	}
+	if( copy_from_user(buf, page, count) ){
+		TPD_ERR("%s: read proc input error.\n", __func__);
+		return count;
+	}
+	mutex_lock(&ts->mutex);
+	ret = sscanf(buf,"%d",&write_flag);
+	gesture_switch = write_flag;
+	TPD_ERR("gesture_switch:%d,suspend:%d,gesture:%d\n",gesture_switch,ts->is_suspended,ts->gesture_enable);
+	if (1 == gesture_switch){
+		if ((ts->is_suspended == 1) && (ts->gesture_enable == 1)){
+			i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+			synaptics_mode_change(0x80);
+			//synaptics_enable_interrupt_for_gesture(ts, 1);
+			//change active mode no need to write gesture mode.
+			touch_enable(ts);
+		}
+	}else if(2 == gesture_switch){
+		if ((ts->is_suspended == 1) && (ts->gesture_enable == 1)){
+			i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+			synaptics_mode_change(0x81);
+			touch_disable(ts);
+			//synaptics_enable_interrupt_for_gesture(ts, 0);
+			//change slepp mode no need to write gesture mode.
+		}
+	}
+	mutex_unlock(&ts->mutex);
+
+	return count;
+}
+
+// chenggang.li@BSP.TP modified for oem 2014-08-08 create node
+/******************************start****************************/
+static const struct file_operations tp_gesture_proc_fops = {
+	.write = tp_gesture_write_func,
+	.read =  tp_gesture_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static const struct file_operations gesture_switch_proc_fops = {
+	.write = gesture_switch_write_func,
+	.read =  gesture_switch_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static const struct file_operations coordinate_proc_fops = {
+	.read =  coordinate_proc_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+#endif
+static int page ,address,block;
+static ssize_t synap_read_address(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret;
+	char buffer[PAGESIZE];
+	char buf[128];
+	int i;
+	int cnt = 0;
+
+	struct synaptics_ts_data *ts = ts_g;
+	TPD_DEBUG("%s page=0x%x,address=0x%x,block=0x%x\n",__func__,page,address,block);
+	cnt += sprintf(&(buffer[cnt]), "page=0x%x,address=0x%x,block=0x%x\n",page,address,block);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,0xff,page);
+	ret = synaptics_rmi4_i2c_read_block(ts->client,address,block,buf);
+	for (i=0;i < block;i++)
+	{
+		cnt += sprintf(&(buffer[cnt]), "buf[%d]=0x%x\n",i,buf[i]);
+		TPD_DEBUG("buffer[%d]=0x%x\n",i,buffer[i]);
+	}
+	ret = simple_read_from_buffer(user_buf, count, ppos, buffer, strlen(buffer));
+	return ret;
+}
+
+static ssize_t synap_write_address(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	int buf[128];
+	char buffer_local[128];
+	int ret, i;
+	struct synaptics_ts_data *ts = ts_g;
+	int temp_block, wbyte;
+	char reg[30];
+
+	if (count > 128)
+		return count;
+	if (copy_from_user(buffer_local, buffer, count)) {
+		TPD_ERR("%s: write proc error.\n", __func__);
+		return count;
+	}
+
+	ret = sscanf(buffer_local,
+	"%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x",
+	&buf[0], &buf[1], &buf[2], &buf[3], &buf[4],
+	&buf[5], &buf[6], &buf[7], &buf[8], &buf[9],
+	&buf[10], &buf[11], &buf[12], &buf[13], &buf[14],
+	&buf[15], &buf[16], &buf[17]);
+    for (i = 0;i < ret;i++)
+    {
+        TPD_DEBUG("buf[i]=0x%x,",buf[i]);
+    }
+    TPD_DEBUG("\n");
+    page= buf[0];
+    address = buf[1];
+    temp_block = buf[2];
+    wbyte = buf[3];
+    if (0xFF == temp_block)//the  mark is to write register else read register
+    {
+        for (i=0;i < wbyte;i++)
+        {
+            reg[i] = (char)buf[4+i];
+        }
+        ret = synaptics_rmi4_i2c_write_byte(ts->client,0xff,page);
+        ret = synaptics_rmi4_i2c_write_block(ts->client,(char)address,wbyte,reg);
+        TPD_DEBUG("%s write page=0x%x,address=0x%x\n",__func__,page,address);
+        for (i=0;i < wbyte;i++)
+        {
+            TPD_DEBUG("reg=0x%x\n",reg[i]);
+        }
+    }
+    else
+        block = temp_block;
+	return count;
+}
+
+#ifdef SUPPORT_GLOVES_MODE
+static ssize_t tp_glove_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	TPD_DEBUG("glove mode enable is: %d\n", ts->glove_enable);
+	ret = sprintf(page, "%d\n", ts->glove_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t tp_glove_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	struct synaptics_ts_data *ts= ts_g;
+	int ret = 0 ;
+	char buf[10]={0};
+
+	if( count > 10 )
+		goto GLOVE_ENABLE_END;
+	if( copy_from_user( buf, buffer, count) ){
+		TPD_ERR("%s: read proc input error.\n", __func__);
+		goto GLOVE_ENABLE_END;
+	}
+	sscanf(buf, "%d", &ret);
+	if(!ts)
+		return count;
+	TPDTM_DMESG("tp_glove_write_func:buf = %d,ret = %d\n", *buf, ret);
+	if( (ret == 0 ) || (ret == 1) ){
+		ts->glove_enable = ret;
+		synaptics_glove_mode_enable(ts);
+	}
+	switch(ret){
+		case 0:
+			TPDTM_DMESG("tp_glove_func will be disable\n");
+			break;
+		case 1:
+			TPDTM_DMESG("tp_glove_func will be enable\n");
+			break;
+		default:
+			TPDTM_DMESG("Please enter 0 or 1 to open or close the glove function\n");
+	}
+GLOVE_ENABLE_END:
+	return count;
+}
+#endif
+
+
+#ifdef SUPPORT_TP_SLEEP_MODE
+static ssize_t tp_sleep_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	TPD_DEBUG("sleep mode enable is: %d\n", sleep_enable);
+	ret = sprintf(page, "%d\n", sleep_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t tp_sleep_write_func(struct file *file, const char *buffer, size_t count, loff_t *ppos)
+{
+	char buf[10]={0};
+	struct synaptics_ts_data *ts = ts_g;
+	int ret = 0 ;
+	if( count > 10 )
+		return count;
+	if(!ts)
+		return count;
+	if( copy_from_user( buf, buffer, count) ) {
+		TPD_ERR(KERN_INFO "%s: read proc input error.\n", __func__);
+		return count;
+	}
+	sscanf(buf, "%d", &ret);
+	TPDTM_DMESG("tp_sleep_write_func:buf = %d,ret = %d\n", *buf, ret);
+	if( (ret == 0 ) || (ret == 1) ) {
+		sleep_enable = ret;
+		synaptics_sleep_mode_enable(ts);
+	}
+	switch(ret) {
+		case 0:
+			TPDTM_DMESG("tp_sleep_func will be disable\n");
+			break;
+		case 1:
+			TPDTM_DMESG("tp_sleep_func will be enable\n");
+			break;
+		default:
+			TPDTM_DMESG("Please enter 0 or 1 to open or close the sleep function\n");
+	}
+	return count;
+}
+#endif
+
+static ssize_t tp_show(struct device_driver *ddri, char *buf)
+{
+	// uint8_t ret = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	int a ;
+	int b,c;
+	if(!ts)
+		return 0;
+	a = synaptics_rmi4_i2c_read_word(ts->client, F01_RMI_DATA_BASE);
+	if( a < 0 )
+		TPD_ERR("tp_show read i2c err\n");
+	b = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA01);
+	if( b < 0 )
+		TPD_ERR("tp_show read i2c err\n");
+	c = synaptics_rmi4_i2c_read_byte(ts->client, F12_2D_DATA_BASE);
+	if( c < 0 )
+		TPD_ERR("tp_show read i2c err\n");
+
+	return sprintf(buf, "F01_RMI_DATA_BASE[0x%x]=0x%x;F01_RMI_DATA01[0x%x]=0x%x;F12_2D_DATA_BASE[0x%x]=0x%x;\n", \
+			F01_RMI_DATA_BASE,a,F01_RMI_DATA01,b,F12_2D_DATA_BASE,c);
+}
+
+static ssize_t store_tp(struct device_driver *ddri, const char *buf, size_t count)
+{
+	int tmp = 0;
+	if( 1 == sscanf(buf, "%d", &tmp) ){
+		tp_debug = tmp;
+	} else {
+		TPDTM_DMESG("invalid content: '%s', length = %zd\n", buf, count);
+	}
+	return count;
+}
+static ssize_t vendor_id_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4];
+	ret = sprintf(page, "%d\n",7);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+#if TP_TEST_ENABLE
+static int synaptics_read_register_map_page1(struct synaptics_ts_data *ts)
+{
+	unsigned char buf[4];
+	int ret;
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if( ret < 0 ) {
+		TPD_ERR("synaptics_rmi4_i2c_write_byte failed for page select\n");
+		return -1;
+	}
+	ret = synaptics_rmi4_i2c_read_block(ts->client, 0xE9, 4, &(buf[0x0]));
+	F54_ANALOG_QUERY_BASE = buf[0];
+	F54_ANALOG_COMMAND_BASE = buf[1];
+	F54_ANALOG_CONTROL_BASE = buf[2];
+	F54_ANALOG_DATA_BASE = buf[3];
+
+	TPD_ERR("F54_ANALOG_QUERY_BASE   = 0x%x \n \
+			F54_ANALOG_COMMAND_BASE  = 0x%x \n\
+			F54_ANALOG_CONTROL_BASE	 = 0x%x \n\
+			F54_ANALOG_DATA_BASE	 = 0x%x \n\
+			",F54_ANALOG_QUERY_BASE,F54_ANALOG_COMMAND_BASE,F54_ANALOG_CONTROL_BASE,F54_ANALOG_DATA_BASE);
+	return 0;
+}
+
+static void checkCMD(int delay_time)
+{
+	int ret;
+	int flag_err = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	do {
+		delay_qt_ms(delay_time); /*wait delay_time ms*/
+		ret = synaptics_rmi4_i2c_read_byte(ts->client, F54_ANALOG_COMMAND_BASE);
+		flag_err++;
+	} while ((ret > 0x00) && (flag_err < 60));
+	if (ret > 0x00 || flag_err >= 60)
+		TPD_ERR("checkCMD error ret is %x flag_err is %d\n", ret, flag_err);
+}
+
+static void checkCMD_RT133(void)
+{
+	int ret = 0;
+	int err_count = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	do {
+		if (version_is_s3508 == 2)
+			delay_qt_ms(80);
+		else
+			delay_qt_ms(10);
+		ret = synaptics_rmi4_i2c_read_byte(ts->client, F54_ANALOG_COMMAND_BASE);
+		err_count++;
+	}while( (ret & 0x01) && (err_count < 30) );
+	if( ret & 0x01 || err_count >= 30)
+		TPD_ERR("%s line%d %x count %d\n", __func__, __LINE__, ret, err_count);
+}
+
+#endif
+
+static ssize_t tp_baseline_show(struct device_driver *ddri, char *buf)
+{
+	int ret = 0;
+	int x, y;
+	ssize_t num_read_chars = 0;
+	uint8_t tmp_l = 0,tmp_h = 0;
+	uint16_t tmp_old = 0;
+	uint16_t tmp_new = 0;
+	uint16_t count = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return count;
+	memset(delta_baseline,0,sizeof(delta_baseline));
+	/*disable irq when read data from IC*/
+	touch_disable(ts);
+	mutex_lock(&ts->mutex);
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+	TPD_DEBUG("\nstep 1:select report type 0x03 baseline\n");
+	//msm_cpuidle_set_sleep_disable(true);
+	/*step 1:check raw capacitance*/
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+	if( ret < 0 ){
+		TPD_ERR("step 1: select report type 0x03 failed \n");
+		//return sprintf(buf, "i2c err!");
+	}
+
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+20, 0x01);
+
+	if (version_is_s3508 != 2) {
+	ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+23);
+	tmp_old = ret & 0xff;
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+23, (tmp_old & 0xef));
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04);
+	ret = i2c_smbus_read_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+27);
+	tmp_new = ret & 0xdf;
+	i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_CONTROL_BASE+27, tmp_new);
+	} else if (version_is_s3508 == 2) {
+	/* s3706 no nedd 0D CBC Settings */
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x04);
+	ret = i2c_smbus_read_byte_data(ts->client,
+		F54_ANALOG_CONTROL_BASE+23);/* Analog Control 1 */
+	tmp_new = ret & 0xdf;
+	i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_CONTROL_BASE+23, tmp_new);
+	}
+
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+7, 0x01);// Forbid NoiseMitigation
+
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+	checkCMD(10);
+	//TPDTM_DMESG("forbid Forbid NoiseMitigation oK\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+	checkCMD(10);
+	//TPDTM_DMESG("Force Cal oK\n");
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x00);//set fifo 00
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(10);
+	count = 0;
+	for( x = 0; x < TX_NUM; x++ ){
+		//printk("\n[%d]", x);
+		num_read_chars += sprintf(&(buf[num_read_chars]), "\n[%d]", x);
+		for( y = 0; y < RX_NUM; y++ ){
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret&0xff;
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret&0xff;
+			delta_baseline[x][y] = (tmp_h << 8)|tmp_l;
+			//printk("%d,", delta_baseline[x][y]);
+			num_read_chars += sprintf(&(buf[num_read_chars]), "%5d", delta_baseline[x][y]);
+		}
+	}
+	num_read_chars += sprintf(&(buf[num_read_chars]), "\n");
+	TPD_DEBUG("\nread all is oK\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0X02);
+	delay_qt_ms(60);
+	//msm_cpuidle_set_sleep_disable(false);
+#ifdef SUPPORT_GLOVES_MODE
+	synaptics_glove_mode_enable(ts);
+#endif
+	synaptics_init_panel(ts);
+//modify by zhouwenping for solve cat tp_baseline_image node cause touch disable 20160225 start
+	synaptics_enable_interrupt(ts,1);
+	ret = synaptics_soft_reset(ts);
+	if (ret < 0){
+           TPD_ERR("%s faile to reset device\n",__func__);
+        }
+	mutex_unlock(&ts->mutex);
+//modify by zhouwenping 20160225 end
+	return num_read_chars;
+
+}
+
+static ssize_t tp_rawdata_show(struct device_driver *ddri, char *buf)
+{
+	int ret = 0;
+	int x, y;
+	ssize_t num_read_chars = 0;
+	uint8_t tmp_l = 0, tmp_h = 0;
+	uint16_t count = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return 0;
+	memset(delta_baseline, 0, sizeof(delta_baseline));
+	/*disable irq when read data from IC*/
+	touch_disable(ts);
+	mutex_lock(&ts->mutex);
+	synaptics_read_register_map_page1(ts);
+
+	//TPD_DEBUG("\nstep 2:report type2 delta image\n");
+	memset(delta_baseline, 0, sizeof(delta_baseline));
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, F54_ANALOG_DATA_BASE, 0x02);//select report type 0x02
+	ret = synaptics_rmi4_i2c_write_word(ts->client, F54_ANALOG_DATA_BASE+1, 0x00);//set fifo 00
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, F54_ANALOG_COMMAND_BASE, 0X01);//get report
+	checkCMD(10);
+	count = 0;
+	for( x = 0; x < TX_NUM; x++ ){
+		//printk("\n[%d]", x);
+		num_read_chars += sprintf(&(buf[num_read_chars]), "\n[%d]", x);
+		for( y = 0; y < RX_NUM; y++ ){
+			ret = synaptics_rmi4_i2c_read_byte(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret&0xff;
+			ret = synaptics_rmi4_i2c_read_byte(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret&0xff;
+			delta_baseline[x][y] = (tmp_h<<8)|tmp_l;
+			//printk("%3d,", delta_baseline[x][y]);
+			num_read_chars += sprintf(&(buf[num_read_chars]), "%3d ", delta_baseline[x][y]);
+		}
+	}
+	num_read_chars += sprintf(&(buf[num_read_chars]), "\n");
+	ret = i2c_smbus_write_byte_data(ts->client,F54_ANALOG_COMMAND_BASE,0X02);
+	delay_qt_ms(60);
+	synaptics_enable_interrupt(ts, 1);
+	mutex_unlock(&ts->mutex);
+	touch_enable(ts);
+	return num_read_chars;
+}
+
+static ssize_t tp_delta_store(struct device_driver *ddri,
+		const char *buf, size_t count)
+{
+	TPDTM_DMESG("tp_test_store is not support\n");
+	return count;
+}
+
+static ssize_t synaptics_rmi4_baseline_show_s3508(struct device *dev, char *buf, bool savefile)
+{
+
+	ssize_t num_read_chars = 0;
+#if TP_TEST_ENABLE
+	int ret = 0;
+	uint8_t x,y;
+	int tx_datal;
+	int16_t err_RT251 = 0, err_RT251_self = 0, err_RT253 = 0;
+	int16_t baseline_data = 0;
+	uint16_t unsigned_baseline_data = 0;
+	uint8_t tmp_old = 0;
+	uint8_t	tmp_new = 0;
+	uint8_t tmp_l = 0,tmp_h = 0;
+	uint16_t count = 0;
+	int error_count = 0;
+	uint8_t buffer[9]={0};
+	int16_t *baseline_data_test;
+	int enable_cbc = 0;
+	int readdata_fail=0,first_check=0;
+	int16_t left_ramdata=0,right_ramdata=0;
+	int fd = -1;
+	struct timespec   now_time;
+	struct rtc_time   rtc_now_time;
+	uint8_t  data_buf[64];
+	mm_segment_t old_fs;
+    uint32_t CURRENT_FIRMWARE_ID = 0 ;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	/*
+	   const struct firmware *fw = NULL;
+	   struct test_header *ph = NULL;
+	   ret = request_firmware(&fw, ts->test_limit_name, dev);
+	   if (ret < 0) {
+	   TPD_ERR("Request firmware failed - %s (%d)\n",ts->test_limit_name, ret);
+	   error_count++;
+	   num_read_chars += sprintf(&(buf[num_read_chars]), "imageid=0x%x,deviceid=0x%x\n",TP_FW,TP_FW);
+	   num_read_chars += sprintf(&(buf[num_read_chars]), "%d error(s). %s\n", error_count, error_count?"":"All test passed.");
+	   return num_read_chars;
+	   }
+
+	//ph = (struct test_header *)(fw->data);
+	 */
+
+    ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+     synaptics_rmi4_i2c_read_block(ts->client, F34_FLASH_CTRL00, 4, buf);
+     CURRENT_FIRMWARE_ID = (buf[0]<<24) | (buf[1]<<16) | (buf[2]<<8) | buf[3];
+     TPD_ERR("[sk]CURRENT_FIRMWARE_ID = 0x%x\n", CURRENT_FIRMWARE_ID);
+	sprintf(ts->fw_id,"0x%x",CURRENT_FIRMWARE_ID);
+	//push_component_info(TP, ts->fw_id, ts->manu_name);
+READDATA_AGAIN:
+	msleep(30);
+	mutex_lock(&ts->mutex);
+	touch_disable(ts);
+
+	memset(Rxdata, 0, sizeof(Rxdata));
+	synaptics_read_register_map_page1(ts);
+	//TPDTM_DMESG("step 1:select report type 0x03\n");
+
+	if(savefile) {
+		getnstimeofday(&now_time);
+		rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+		sprintf(data_buf, "/sdcard/tp_testlimit_%02d%02d%02d-%02d%02d%02d.csv",
+				(rtc_now_time.tm_year+1900)%100, rtc_now_time.tm_mon+1, rtc_now_time.tm_mday,
+				rtc_now_time.tm_hour, rtc_now_time.tm_min, rtc_now_time.tm_sec);
+
+		old_fs = get_fs();
+		set_fs(KERNEL_DS);
+
+		fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+		if (fd < 0) {
+			TPD_ERR("Open log file '%s' failed.\n", data_buf);
+			set_fs(old_fs);
+		}
+	}
+
+	//step 1:check raw capacitance.
+TEST_WITH_CBC_s3508:
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+	if( ret < 0 ){
+		TPD_ERR("read_baseline: i2c_smbus_write_byte_data failed \n");
+		goto END;
+	}
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+20, 0x01);
+	ret = i2c_smbus_read_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+23);
+	tmp_old = ret&0xff;
+
+	if(enable_cbc){
+		TPD_DEBUG("ret = %x ,tmp_old =%x ,tmp_new = %x\n",ret,tmp_old,(tmp_old | 0x10));
+		ret = i2c_smbus_write_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+23,(tmp_old | 0x10));
+		ret = i2c_smbus_write_word_data(ts->client,F54_ANALOG_COMMAND_BASE,0x04);
+		checkCMD(30);
+		ret = i2c_smbus_read_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+27);
+		tmp_new = ret | 0x20;
+		i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+27, tmp_new);
+		ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04);
+		TPD_DEBUG("Test open cbc\n");
+		if(CURRENT_FIRMWARE_ID == 0xAB056006)
+			baseline_data_test = (int16_t *)baseline_cap_data_old[0];
+		else {
+			if (ts->support_1080x2160_tp)
+				baseline_data_test = (int16_t *)baseline_cap_17801_data[0];
+			else
+				baseline_data_test = (int16_t *)baseline_cap_data[0];
+		}
+	}else{
+		TPD_DEBUG("ret = %x ,tmp_old =%x ,tmp_new = %x\n",ret,tmp_old,(tmp_old & 0xef));
+		ret = i2c_smbus_write_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+23,(tmp_old & 0xef));
+		ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04);
+		ret = i2c_smbus_read_byte_data(ts->client,F54_ANALOG_CONTROL_BASE+27);
+		tmp_new = ret & 0xdf;
+		i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+27, tmp_new);
+		ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+		ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_CONTROL_BASE+7, 0x01);// Forbid NoiseMitigation
+		if(CURRENT_FIRMWARE_ID == 0xAB056006)
+			baseline_data_test = (int16_t *)baseline_cap_data_old[1];
+		else {
+			if (ts->support_1080x2160_tp)
+				baseline_data_test = (int16_t *)baseline_cap_17801_data[1];
+			else
+				baseline_data_test = (int16_t *)baseline_cap_data[1];
+		}
+	}
+	/******write No Relax to 1******/
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x04); // force update
+	checkCMD(30);
+	TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0X02);//force Cal
+	checkCMD(30);
+	TPD_DEBUG("Force Cal oK\n");
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x00);//set fifo 00
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(30);
+
+	count = 0;
+	for( x = 0; x < TX_NUM; x++ ){
+
+		for( y = 0; y < RX_NUM; y++ ){
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret&0xff;
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret&0xff;
+			baseline_data = (tmp_h<<8)|tmp_l;
+			if (fd >= 0){
+				sprintf(data_buf, "%d,", baseline_data);
+				sys_write(fd, data_buf, strlen(data_buf));
+			}
+			if( (y < RX_NUM ) && (x < TX_NUM) ){
+				//printk("%4d ,",baseline_data);
+				if (x == (TX_NUM-1) && y == (RX_NUM-1))
+					left_ramdata = baseline_data;
+				else if (x == (TX_NUM-1) && y == (RX_NUM-2))
+					right_ramdata = baseline_data;
+				if(((baseline_data+60) < *(baseline_data_test+count*2)) || ((baseline_data-60) > *(baseline_data_test+count*2+1))){
+					if((x == (TX_NUM-1) && (y != RX_NUM-1 || y != RX_NUM-2))||\
+						(x != (TX_NUM-1) && (y == RX_NUM-1 || y == RX_NUM-2)))//the last tx and rx last two line for touchkey,others no need take care
+					{
+						count++;
+						continue;
+					}
+					TPD_ERR("touchpanel failed,RX_NUM:%d,TX_NUM:%d,baseline_data is %d,TPK_array_limit[%d*2]=%d,TPK_array_limit[%d*2+1]=%d\n ",y,x,baseline_data,count,*(baseline_data_test+count*2),count,*(baseline_data_test+count*2+1));
+					if((baseline_data <= 0) && (first_check == 0)){
+						first_check = 1;
+						readdata_fail = 1;
+					}
+					num_read_chars += sprintf(&(buf[num_read_chars]), "0 raw data erro baseline_data[%d][%d]=%d[%d,%d]\n",x,y,baseline_data,*(baseline_data_test+count*2),	*(baseline_data_test+count*2+1));
+					error_count++;
+					goto END;
+				}
+			}
+			/*
+			//test virtual key
+			if( (y==(RX_NUM-1)) && (x>= TX_NUM-3) ){
+			TPD_DEBUG("synaptics:test virtual key,y= %d ,x = %d\n",y,x);
+			TPD_DEBUG("Synaptic:test virtual key;baseline_data is %d,TPK_array_limit[%d*2]=%d,TPK_array_limit[%d*2+1]=%d\n ",baseline_data,count,*(baseline_data_test+count*2),count,*(baseline_data_test+count*2+1));
+			if((baseline_data < *(baseline_data_test+count*2)) || (baseline_data > *(baseline_data_test+count*2+1))){
+			TPD_ERR("Synaptic:test virtual key failed------------;baseline_data is %d,TPK_array_limit[%d*2]=%d,TPK_array_limit[%d*2+1]=%d\n ",baseline_data,count,*(baseline_data_test+count*2),count,*(baseline_data_test+count*2+1));
+			num_read_chars += sprintf(&(buf[num_read_chars]), "0 raw data erro baseline_data[%d][%d]=%d[%d,%d]\n",x,y,baseline_data,*(baseline_data_test+count*2),	*(baseline_data_test+count*2+1));
+			error_count++;
+			goto END;
+			}
+			}
+			 */
+			count++;
+		}
+		//printk("\n synaptics:s3320 TX_NUM:%d\n",x);
+		if (fd >= 0){
+			sys_write(fd, "\n", 1);
+		}
+	}
+
+	if(!enable_cbc){
+		enable_cbc = 1;
+		if (fd >= 0){
+			sys_write(fd, "\n", 1);
+		}
+		TPD_ERR("enable cbc baseline test again\n");
+		goto TEST_WITH_CBC_s3508;
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if( ret < 0 ) {
+		TPD_ERR("%s line%d failed\n",__func__,__LINE__);
+		error_count++;
+		goto END;
+	}
+
+	//Step2 : Check trx-to-ground
+	TPD_ERR("step 2:Check trx-to-ground\n" );
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x19);//select report type 25
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x0);
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(10);
+	tx_datal = i2c_smbus_read_i2c_block_data(ts->client, F54_ANALOG_DATA_BASE+3, 7, buffer);
+	if (ts->support_1080x2160_tp) {
+		buffer[0] |= 0x20;/*no care 5 31 32 34 36 37 40 52 53chanel*/
+		buffer[3] |= 0x80;
+		buffer[4] |= 0x35;
+		buffer[5] |= 0x01;
+		buffer[6] |= 0xc0;
+	} else {
+		buffer[0] |= 0x10;/*no care 4 31 32 40 50 51 52chanel*/
+		buffer[3] |= 0x80;
+		buffer[5] |= 0x01;
+		buffer[6] |= 0xc0;
+	}
+	for(x = 0;x < 7; x++)
+	{
+		if(0xff != buffer[x]){
+			error_count++;
+            TPD_ERR("step 2:error_count[%d] buff%d[0x%x] ERROR!\n",error_count,x,buffer[x]);
+			goto END;
+		}
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if( ret < 0 ) {
+		TPD_ERR("%s line%d failed\n",__func__,__LINE__);
+		error_count++;
+		goto END;
+	}
+
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD_BASE, 0x01);//software reset TP
+	msleep(50);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if( ret < 0 ) {
+		TPD_ERR("%s line%d failed\n",__func__,__LINE__);
+		error_count++;
+		goto END;
+	}
+
+	//step 3 :check tx-to-tx and tx-to-vdd
+	TPD_ERR("step 3:check TRx-TRx & TRx-Vdd short\n" );
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x1A);//select report type 26
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x0);
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(10);
+	tx_datal = i2c_smbus_read_i2c_block_data(ts->client, F54_ANALOG_DATA_BASE+3, 7, buffer);
+	buffer[0] &= 0xef;/*no care 4 31 32 40 50 51 52chanel*/
+	buffer[3] &= 0x7f;
+	buffer[5] &= 0xfe;
+	buffer[6] &= 0x3f;
+	for(x = 0;x < 7; x++)
+	{
+		if(buffer[x]){
+			error_count++;
+	        TPD_ERR("step 3:error_count[%d] buff%d[0x%x] ERROR!\n",error_count,x,buffer[x]);
+			goto END;
+		}
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if( ret < 0 ) {
+		TPD_ERR("%s line%d failed\n",__func__,__LINE__);
+		error_count++;
+		goto END;
+	}
+
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD_BASE, 0x01);//software reset TP
+	msleep(50);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if( ret < 0 ) {
+		TPD_ERR("%s line%d failed\n",__func__,__LINE__);
+		error_count++;
+		goto END;
+	}
+	//Step4 : Check RT133
+	TPD_ERR("step 4:Check RT133\n" );
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x85);//select report type 133
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x0);//set fifo 0
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD_RT133();
+	for (y = 0; y < RX_NUM; y++) {
+		ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+		tmp_l = ret&0xff;
+		ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+		tmp_h = ret&0xff;
+		baseline_data = (tmp_h<<8)|tmp_l;
+		if(baseline_data > 100){
+			error_count++;
+            TPD_ERR("step 4:error_count[%d] baseline_data%d[0x%x] ERROR!\n",error_count,y,baseline_data);
+			goto END;
+		}
+	}
+	/*Step 5 : Check RT251 for random touch event*/
+	TPD_ERR("Step 5 : Check RT251 for random touch event\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0xFB);/*select report type 0xFB*/
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0x00);/*set fifo 00*/
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(100);
+
+	for (x = 0; x < TX_NUM; x++) {
+
+		for (y = 0; y < RX_NUM; y++) {
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret;
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret;
+			baseline_data = (tmp_h << 8) | tmp_l;
+			if ((x < TX_NUM-1) && (y < RX_NUM-2) && (baseline_data > 20)) {        /*red zone, test capacitance,if half num large than 20, fail*/
+				if (++err_RT251 > ((TX_NUM - 1) * (RX_NUM - 2) / 2)) {
+				    error_count++;
+				    TPD_ERR("Step 5 : Check RT251 for random touch event error, capacitance, err_RT251 is %d\n", err_RT251);
+				    goto END;
+				}
+			}
+
+			if ((x != TX_NUM - 1) && (y == RX_NUM - 1) && baseline_data > 500) {      /*blue zone, test self capaccitance, if half num large than 500, fail*/
+				if (++err_RT251_self > (TX_NUM - 1) / 2) {
+				    error_count++;
+				    TPD_ERR("Step 5 : Check RT251 for random touch event error, self capacitance, err_RT251_self is %d\n", err_RT251_self);
+				    goto END;
+				}
+			}
+		}
+	}
+	TPD_ERR("ROLAND----> err_RT251 is %d err_RT251_self is %d\n", err_RT251, err_RT251_self);
+	/*Step 6 : Check RT252 for random touch event*/
+	TPD_ERR("Step 6 : Check RT252 for random touch event\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0xFC);/*select report type 0xFC*/
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(70);
+	for (y = 0; y < RX_NUM + TX_NUM - 3; y++) {
+		ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE + 3);
+		tmp_l = ret & 0xff;
+		ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE + 3);
+		tmp_h = ret & 0xff;
+		unsigned_baseline_data = (tmp_h << 8) | tmp_l;
+		if (unsigned_baseline_data < 10000) {
+			error_count++;
+			TPD_ERR("Step 6 : Check RT252 for random touch event, error_line is y =%d,data = %hu\n", y, unsigned_baseline_data);
+			goto END;
+		}
+	}
+    /*Step 7 : Check RT253 for random touch event*/
+	TPD_ERR("Step 7 : Check RT253 for random touch event\n");
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0xFD);/*select report type 0xFD*/
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(70);
+
+	for (x = 0; x < TX_NUM; x++) {
+		for (y = 0; y < RX_NUM; y++) {
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret;
+			ret = i2c_smbus_read_byte_data(ts->client, F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret;
+			baseline_data = (tmp_h << 8) | tmp_l;
+			if (baseline_data  > 20) {
+				if (++err_RT253 > (TX_NUM * RX_NUM) / 2) {
+				    error_count++;
+				    TPD_ERR("Step 7 : Check RT253 for random touch event, self capacitance, err_RT253 is %d\n", err_RT253);
+				    goto END;
+				}
+			}
+		}
+	}
+	TPD_ERR("ROLAND----> err_RT253 is %d\n", err_RT253);
+END:
+	if (fd >= 0) {
+		sys_close(fd);
+		set_fs(old_fs);
+	}
+	//release_firmware(fw);
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0X02);
+	delay_qt_ms(60);
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD00, 0x01);
+	msleep(150);
+
+#ifdef SUPPORT_GLOVES_MODE
+	synaptics_glove_mode_enable(ts);
+#endif
+	synaptics_init_panel(ts);
+	synaptics_enable_interrupt(ts, 1);
+	touch_enable(ts);
+	TPD_ERR("\n\nstep5 reset and open irq complete\n");
+	mutex_unlock(&ts->mutex);
+#endif
+	if(readdata_fail == 1){
+		TPD_ERR("readdata_fail...try again:%d\n",first_check);
+		readdata_fail =0;
+		goto READDATA_AGAIN;
+	}
+#ifdef ENABLE_TPEDGE_LIMIT
+	synaptics_tpedge_limitfunc();
+#endif
+	TPD_ERR("status...first_check:%d:readdata_fail:%d\n",
+			first_check, readdata_fail);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+		"imageid=0x%lx,deviceid=0x%lx\n", TP_FW, TP_FW);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+		"left:=%d,right:%d\n", left_ramdata, right_ramdata);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+		"%d error(s). %s\n", error_count,
+		error_count?"":"All test passed.");
+	return num_read_chars;
+}
+
+static ssize_t synaptics_rmi4_baseline_show_s3706(
+	struct device *dev, char *buf, bool savefile)
+{
+	ssize_t num_read_chars = 0;
+#if TP_TEST_ENABLE
+	int ret = 0;
+	uint8_t x, y;
+	int tx_datal;
+	int16_t baseline_data = 0;
+	uint32_t unsigned_baseline_data = 0;
+	uint8_t tmp_old = 0;
+	uint8_t tmp_new = 0;
+	uint8_t tmp_l = 0, tmp_h = 0;
+	uint16_t count = 0;
+	int error_count = 0;
+	uint8_t buffer[9] = {0};
+	int16_t *baseline_data_test;
+	int enable_cbc = 0;
+	int readdata_fail = 0, first_check = 0;
+	int16_t left_ramdata = 0, right_ramdata = 0;
+	int fd = -1;
+	struct timespec   now_time;
+	struct rtc_time   rtc_now_time;
+	uint8_t  data_buf[64];
+	mm_segment_t old_fs;
+	unsigned long int  CURRENT_FIRMWARE_ID = 0;
+
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	//msm_cpuidle_set_sleep_disable(true);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	synaptics_rmi4_i2c_read_block(ts->client,
+		F34_FLASH_CTRL00, 8, buf);
+	CURRENT_FIRMWARE_ID = (buf[0] << 24) |
+			(buf[1] << 16) | (buf[2] << 8) | buf[3];
+	CURRENT_FIRMWARE_ID = CURRENT_FIRMWARE_ID << 32 |
+		((buf[4]<<24) | (buf[5]<<16) | (buf[6]<<8) | buf[7]);
+	TPD_ERR("[sk]CURRENT_FIRMWARE_ID = 0x%lx\n",
+			CURRENT_FIRMWARE_ID);
+	snprintf(ts->fw_id, 20, "0x%lx", CURRENT_FIRMWARE_ID);
+	//push_component_info(TP, ts->fw_id, ts->manu_name);
+READDATA_AGAIN:
+	msleep(30);
+	mutex_lock(&ts->mutex);
+	touch_disable(ts);
+
+	memset(Rxdata, 0, sizeof(Rxdata));
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+	if (savefile) {
+		getnstimeofday(&now_time);
+		rtc_time_to_tm(now_time.tv_sec, &rtc_now_time);
+		snprintf(data_buf, 40,
+		"/sdcard/tp_testlimit_%02d%02d%02d-%02d%02d%02d.csv",
+				(rtc_now_time.tm_year+1900)%100,
+				rtc_now_time.tm_mon+1,
+				rtc_now_time.tm_mday,
+				rtc_now_time.tm_hour,
+				rtc_now_time.tm_min,
+				rtc_now_time.tm_sec);
+
+		old_fs = get_fs();
+		set_fs(KERNEL_DS);
+
+		fd = sys_open(data_buf, O_WRONLY | O_CREAT | O_TRUNC, 0);
+		if (fd < 0) {
+			TPD_ERR("Open log file '%s' failed.\n", data_buf);
+			set_fs(old_fs);
+		}
+	}
+
+	/*step 1:check raw capacitance.*/
+TEST_WITH_CBC_s3508:
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_DATA_BASE, 0x03);/*select report type 0x03*/
+	if (ret < 0) {
+		TPD_ERR("read_baseline: i2c_smbus_write_byte_data failed\n");
+		goto END;
+	}
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_CONTROL_BASE+20, 0x01);
+	ret = i2c_smbus_read_byte_data(ts->client,
+		F54_ANALOG_CONTROL_BASE+23);
+	tmp_old = ret & 0xff;
+
+	if (enable_cbc) {
+		synaptics_hard_reset(ts);
+		synaptics_read_register_map_page1(ts);
+
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE, 0x03);/*select report type 0x03*/
+		if (ret < 0) {
+		TPD_ERR("read_baseline: i2c_smbus_write_byte_data failed\n");
+			goto END;
+		}
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+20, 0x01);
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23);
+
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		checkCMD(30);
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23);
+		tmp_new = ret  | 0x20;/*CBC Xmtr carrier select bit 5*/
+		i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23, tmp_new);
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		checkCMD(30);
+		TPD_DEBUG("Test open cbc\n");
+		baseline_data_test = (int16_t *)baseline_cap_17819_data[0];
+	} else {
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		checkCMD(30);
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23);
+		tmp_new = ret & 0xdf;/*CBC Xmtr carrier select bit 5*/
+		i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23, tmp_new);
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		/* force update*/
+		checkCMD(30);
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+7, 0x01);
+		/* Forbid NoiseMitigation*/
+		baseline_data_test = (int16_t *)baseline_cap_17819_data[1];
+	}
+	/******write No Relax to 1******/
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x04); /* force update*/
+	checkCMD(30);
+	TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0X02);/*force Cal*/
+	checkCMD(30);
+	TPD_DEBUG("Force Cal oK\n");
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_DATA_BASE+1, 0x00);//set fifo 00
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(30);
+
+	count = 0;
+	for (x = 0; x < TX_NUM; x++) {
+	for (y = 0; y < RX_NUM; y++) {
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE+3);
+		tmp_l = ret & 0xff;
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE+3);
+		tmp_h = ret & 0xff;
+		usleep_range(1000, 1001);
+		baseline_data = (tmp_h << 8)  | tmp_l;
+		if (fd >= 0) {
+			snprintf(data_buf, 20, "%d,", baseline_data);
+			sys_write(fd, data_buf, strlen(data_buf));
+		}
+		if ((y < RX_NUM) && (x < TX_NUM)) {
+			/*printk("%4d ,",baseline_data);*/
+			if (x == (TX_NUM-1) &&
+				y == (RX_NUM-1))
+				left_ramdata = baseline_data;
+			else if (x == (TX_NUM-1) &&
+				y == (RX_NUM-2))
+				right_ramdata = baseline_data;
+			if (((baseline_data+60) <
+				*(baseline_data_test+count*2)) ||
+				((baseline_data-60) >
+				*(baseline_data_test+count*2+1))) {
+				if (ts->support_1080x2340_tp) {
+					if ((y == 0) && (x >= 7) && (x <= 8)) {
+						count++;
+					TPD_ERR("RX_NU:%dTX_NU:%dbaslin_da%d\n",
+					y, x, baseline_data);
+						continue;
+					}
+				} else {
+					if ((y == 0) && (x >= 6) && (x <= 9)) {
+						count++;
+					TPD_ERR("RX_NU:%dTX_NU:%dbaslin_da%d\n",
+					y, x, baseline_data);
+						continue;
+					}
+				}
+	TPD_ERR("failed,RX_NU:%d,TX_NU:%d,baslin_da is%d\n",
+				y, x, baseline_data);
+	TPD_ERR("failed,TPK_arrlimit[%d*2]=%d,TPK_arrlimit[%d*2+1]=%d\n",
+				count, *(baseline_data_test+count*2),
+				count, *(baseline_data_test+count*2+1));
+				if ((baseline_data <= 0) &&
+					(first_check == 0)) {
+					first_check = 1;
+					readdata_fail = 1;
+				}
+				num_read_chars +=
+				snprintf(&(buf[num_read_chars]), 60,
+				"0 raw data erro baseline_data[%d][%d]=%d[%d,%d]\n",
+				x, y, baseline_data,
+				*(baseline_data_test+count*2),
+				*(baseline_data_test+count*2+1));
+				error_count++;
+				goto END;
+			}
+			}
+			count++;
+		}
+		/*printk("\n synaptics:s3320 TX_NUM:%d\n",x);*/
+		if (fd >= 0)
+			sys_write(fd, "\n", 1);
+	}
+
+	if (!enable_cbc) {
+		enable_cbc = 1;
+		if (fd >= 0)
+			sys_write(fd, "\n", 1);
+		TPD_ERR("enable cbc baseline test again\n");
+		goto TEST_WITH_CBC_s3508;
+	}
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if (ret < 0) {
+		TPD_ERR("%s line%d failed\n", __func__, __LINE__);
+		error_count++;
+		goto END;
+	}
+
+	/*Step2 : Check trx-to-ground*/
+	TPD_ERR("step 2:Check trx-to-ground\n");
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_DATA_BASE, 0x19);/*select report type 25*/
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_DATA_BASE+1, 0x0);
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(10);
+	tx_datal = i2c_smbus_read_i2c_block_data(ts->client,
+		F54_ANALOG_DATA_BASE+3, 7, buffer);
+
+	for (x = 0; x < 7; x++) {
+		if (buffer[x] != 0xff) {
+			error_count++;
+		TPD_ERR("step 2:error_count[%d] buff%d[0x%x] ERROR!\n",
+				error_count, x, buffer[x]);
+			goto END;
+		}
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if (ret < 0) {
+		TPD_ERR("%s line%d failed\n", __func__, __LINE__);
+		error_count++;
+		goto END;
+	}
+
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if (ret < 0) {
+		TPD_ERR("%s line%d failed\n", __func__, __LINE__);
+		error_count++;
+		goto END;
+	}
+
+	/*step 3 :check tx-to-tx and tx-to-vdd*/
+	TPD_ERR("step 3:check TRx-TRx & TRx-Vdd short\n");
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_DATA_BASE, 0x1A);/*select report type 26*/
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_DATA_BASE+1, 0x0);
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(80);
+	tx_datal = i2c_smbus_read_i2c_block_data(ts->client,
+			F54_ANALOG_DATA_BASE+3, 7, buffer);
+	buffer[0] &= 0xFC;/*buf = 03*/
+	buffer[4] &= 0xFC;/*buf = 03*/
+	for (x = 0; x < 7; x++) {
+		if (buffer[x]) {
+			error_count++;
+		TPD_ERR("step 3:error_count[%d] buff%d[0x%x] ERROR!\n",
+				error_count, x, buffer[x]);
+			goto END;
+		}
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if (ret < 0) {
+		TPD_ERR("%s line%d failed\n", __func__, __LINE__);
+		error_count++;
+		goto END;
+	}
+
+	/*hard reset TP*/
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+	if (ret < 0) {
+		TPD_ERR("%s line%d failed\n", __func__, __LINE__);
+		error_count++;
+		goto END;
+	}
+	/*Step4 : Check RT133*/
+	TPD_ERR("step 4:Check RT133\n");
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_DATA_BASE, 0x85);/*select report type 133*/
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_DATA_BASE+1, 0x0);/*set fifo 0*/
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD_RT133();
+	for (y = 0; y < RX_NUM; y++) {
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE+3);
+		tmp_l = ret & 0xff;
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE+3);
+		tmp_h = ret & 0xff;
+		baseline_data = (tmp_h << 8) | tmp_l;
+		if (baseline_data > 100) {
+			error_count++;
+		TPD_ERR("step 4:error_count[%d] baseline_data%d[0x%x] ERROR!\n",
+				error_count, y, baseline_data);
+			goto END;
+		}
+	}
+	/*must add reset for RT150 */
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+	/*Step 5 : Check RT150 for random touch event*/
+	TPD_ERR("Step 5 : Check RT150 for Hybrid Absolute\n");
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_DATA_BASE, 0x96);/*select report type 0x96*/
+	ret = i2c_smbus_write_word_data(ts->client,
+		F54_ANALOG_DATA_BASE + 1, 0x00);/*set fifo 00*/
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0x01);/*get report*/
+	checkCMD(10);
+	/*all channel 16+33 */
+	for (y = 0; y < RX_NUM + TX_NUM ; y++) {
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE + 3);
+		tmp_l = ret & 0xff;
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_DATA_BASE + 3);
+		tmp_h = ret & 0xff;
+		unsigned_baseline_data = (tmp_h << 8) | tmp_l;
+
+		if (unsigned_baseline_data < 10000) {
+			error_count++;
+		TPD_ERR("Step5 RT150 ,error_line is y =%d,data = %hu\n",
+				y, unsigned_baseline_data);
+			goto END;
+		}
+	}
+END:
+	if (fd >= 0) {
+		sys_close(fd);
+		set_fs(old_fs);
+	}
+
+	ret = i2c_smbus_write_byte_data(ts->client,
+		F54_ANALOG_COMMAND_BASE, 0X02);
+	delay_qt_ms(60);
+	ret = i2c_smbus_write_byte_data(ts->client, 0xff, 0x00);
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD00, 0x01);
+	/*hard reset TP*/
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+
+#ifdef SUPPORT_GLOVES_MODE
+	synaptics_glove_mode_enable(ts);
+#endif
+	synaptics_init_panel(ts);
+	synaptics_enable_interrupt(ts, 1);
+	touch_enable(ts);
+	TPD_ERR("\n\nstep5 reset and open irq complete\n");
+	mutex_unlock(&ts->mutex);
+#endif
+	if (readdata_fail == 1) {
+		TPD_ERR("readdata_fail...try again:%d\n", first_check);
+		readdata_fail = 0;
+		goto READDATA_AGAIN;
+	}
+#ifdef ENABLE_TPEDGE_LIMIT
+	synaptics_tpedge_limitfunc();
+#endif
+	TPD_ERR("status...first_check:%d:readdata_fail:%d\n",
+					first_check, readdata_fail);
+	//msm_cpuidle_set_sleep_disable(false);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+					"imageid=0x%lx,deviceid=0x%lx\n",
+					TP_FW, TP_FW);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+					"left:=%d,right:%d\n", left_ramdata,
+					right_ramdata);
+	num_read_chars += snprintf(&(buf[num_read_chars]), 128,
+					"%d error(s). %s\n", error_count,
+					error_count?"":"All test passed.");
+	return num_read_chars;
+}
+
+
+static ssize_t tp_baseline_show_with_cbc(struct device_driver *ddri, char *buf)
+{
+	int ret = 0;
+	int x,y;
+	ssize_t num_read_chars = 0;
+	uint8_t tmp_l = 0,tmp_h = 0;
+	uint8_t tmp_old, tmp_new;
+	uint16_t count = 0;
+	struct synaptics_ts_data *ts = ts_g;
+	if (ts->is_suspended == 1)
+		return count;
+	memset(delta_baseline, 0, sizeof(delta_baseline));
+	if (!ts)
+		return 0;
+	/*disable irq when read data from IC*/
+	touch_disable(ts);
+	mutex_lock(&ts->mutex);
+	synaptics_hard_reset(ts);
+	synaptics_read_register_map_page1(ts);
+	TPD_DEBUG("\nstep 1:select report type 0x03 baseline\n");
+	//msm_cpuidle_set_sleep_disable(true);
+	//step 1:check raw capacitance.
+	//select report type 0x03/* Report Type */
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+		F54_ANALOG_DATA_BASE, 0x03);
+	if (ret < 0) {
+		TPDTM_DMESG("step 1: select report type 0x03 failed \n");
+		//return sprintf(buf, "i2c err!");
+	}
+	if (version_is_s3508 == 2) {
+		/* Multi Metric Noise Mitigation Control */
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+20, 0x01);
+		/* Analog Command 0 *//*force update*/
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		checkCMD(10);
+		TPD_DEBUG("open CBC oK\n");
+		/* Analog Control 1  s3508 is 27 s3706 is 27*/
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23);
+		tmp_new = ret | 0x20;/*CBC Xmtr carrier select*/
+		i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23, tmp_new);
+	} else {
+		/* Multi Metric Noise Mitigation Control */
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+20, 0x01);
+		/* 0D CBC Settings */
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23);
+		tmp_old = ret&0xff;
+		TPD_DEBUG("ret = %x ,tmp_old =%x ,tmp_new = %x\n",
+					ret, tmp_old, (tmp_old | 0x10));
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+23,
+			(tmp_old | 0x10));
+		/* Analog Command 0 *//*force update*/
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+		checkCMD(10);
+		TPD_DEBUG("open CBC oK\n");
+		/* Analog Control 1  s3508 is 27 s3706 is 27*/
+		ret = i2c_smbus_read_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+27);
+		tmp_new = ret | 0x20;/*CBC Xmtr carrier select*/
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F54_ANALOG_CONTROL_BASE+27, tmp_new);
+	}
+	ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04);
+
+	/*force F54_ANALOG_CMD00*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0X04);
+	checkCMD(10);
+	TPD_DEBUG("forbid Forbid NoiseMitigation oK\n");
+	/*Force Cal, F54_ANALOG_CMD00*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0X02);
+	checkCMD(10);
+	TPDTM_DMESG("Force Cal oK\n");
+	/* Report Index LSB //set fifo 00 */
+	ret = synaptics_rmi4_i2c_write_word(ts->client,
+			F54_ANALOG_DATA_BASE+1, 0x00);
+	/*get report*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x01);
+	checkCMD(10);
+	count = 0;
+	for(x = 0;x < TX_NUM; x++) {
+		TPD_DEBUG("\n[%d]",x);
+		num_read_chars += sprintf(&(buf[num_read_chars]), "\n[%d]",x);
+		for(y = 0; y < RX_NUM; y++){
+			ret = synaptics_rmi4_i2c_read_byte(ts->client,F54_ANALOG_DATA_BASE+3);
+			tmp_l = ret&0xff;
+			ret = synaptics_rmi4_i2c_read_byte(ts->client,F54_ANALOG_DATA_BASE+3);
+			tmp_h = ret&0xff;
+			delta_baseline[x][y] = (tmp_h<<8)|tmp_l;
+			TPD_DEBUG("%d,",delta_baseline[x][y]);
+			num_read_chars += sprintf(&(buf[num_read_chars]), "%d ",delta_baseline[x][y]);
+		}
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,F54_ANALOG_COMMAND_BASE,0X02);
+	delay_qt_ms(60);
+	//msm_cpuidle_set_sleep_disable(false);
+	synaptics_enable_interrupt(ts,1);
+	mutex_unlock(&ts->mutex);
+	touch_enable(ts);
+	return num_read_chars;
+}
+
+static ssize_t synaptics_rmi4_baseline_show(struct device *dev,	char *buf, bool savefile)
+{
+	if (version_is_s3508 == 2) {
+		return synaptics_rmi4_baseline_show_s3706(dev, buf, savefile);
+	} else {
+		return synaptics_rmi4_baseline_show_s3508(dev, buf, savefile);
+	}
+}
+
+static ssize_t tp_test_store(struct device_driver *ddri,
+		const char *buf, size_t count)
+{
+	TPDTM_DMESG("tp_test_store is not support\n");
+	return count;
+}
+
+static ssize_t synaptics_rmi4_vendor_id_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	if( (tp_dev == TP_G2Y) || (tp_dev == TP_TPK) )
+		return sprintf(buf, "%d\n", TP_TPK);
+	if(tp_dev == TP_TRULY)
+		return sprintf(buf, "%d\n", TP_TRULY);
+	if(tp_dev == TP_OFILM)
+		return sprintf(buf, "%d\n", TP_OFILM);
+	return sprintf(buf, "%d\n", tp_dev);
+}
+
+
+static int	synaptics_input_init(struct synaptics_ts_data *ts)
+{
+	int attr_count = 0;
+	int ret = 0;
+
+	TPD_DEBUG("%s is called\n",__func__);
+	ts->input_dev = input_allocate_device();
+	if (ts->input_dev == NULL) {
+		ret = -ENOMEM;
+		TPD_ERR("synaptics_ts_probe: Failed to allocate input device\n");
+		return ret;
+	}
+	ts->input_dev->name = TPD_DEVICE;;
+	ts->input_dev->dev.parent = &ts->client->dev;
+	set_bit(EV_SYN, ts->input_dev->evbit);
+	set_bit(EV_ABS, ts->input_dev->evbit);
+	set_bit(EV_KEY, ts->input_dev->evbit);
+	set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
+	set_bit(ABS_MT_WIDTH_MAJOR,ts->input_dev->absbit);
+	set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
+	set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
+	set_bit(INPUT_PROP_DIRECT, ts->input_dev->propbit);
+	set_bit(BTN_TOOL_FINGER, ts->input_dev->keybit);
+#ifdef SUPPORT_GESTURE
+	set_bit(KEY_F4 , ts->input_dev->keybit);//doulbe-tap resume
+	set_bit(KEY_APPSELECT, ts->input_dev->keybit);
+	set_bit(KEY_BACK, ts->input_dev->keybit);
+#endif
+	/* For multi touch */
+	input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);
+	input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MINOR, 0,255, 0, 0);
+	input_set_abs_params(ts->input_dev, ABS_MT_POSITION_X, 0, (ts->max_x-1), 0, 0);
+	input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y, 0, (ts->max_y-1), 0, 0);
+#ifdef REPORT_2D_PRESSURE
+    if (ts->support_ft){
+        input_set_abs_params(ts->input_dev,ABS_MT_PRESSURE,0,255, 0, 0);
+    }
+#endif
+#ifdef TYPE_B_PROTOCOL
+	input_mt_init_slots(ts->input_dev, ts->max_num, 0);
+#endif
+	input_set_drvdata(ts->input_dev, ts);
+
+	if(input_register_device(ts->input_dev)) {
+		TPD_ERR("%s: Failed to register input device\n",__func__);
+		input_unregister_device(ts->input_dev);
+		input_free_device(ts->input_dev);
+		return -1;
+	}
+	for (attr_count = 0; attr_count < ARRAY_SIZE(attrs_oem); attr_count++) {
+		ret = sysfs_create_file(&ts->input_dev->dev.kobj,
+				&attrs_oem[attr_count].attr);
+		if (ret < 0) {
+			dev_err(&ts->client->dev,
+					"%s: Failed to create sysfs attributes\n",
+					__func__);
+			for (attr_count--; attr_count >= 0; attr_count--) {
+				sysfs_remove_file(&ts->input_dev->dev.kobj,
+						&attrs_oem[attr_count].attr);
+			}
+			return -1;
+		}
+	}
+	return 0;
+}
+
+#include "fw_update_v7.if"
+static int check_hardware_version(struct device *dev)
+{
+        int ret;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+        const struct firmware *fw = NULL;
+	if(!ts->client) {
+		TPD_ERR("i2c client point is NULL\n");
+		return 0;
+	}
+	ret = request_firmware(&fw, ts->fw_name, dev);
+	if (ret < 0) {
+		TPD_ERR("Request firmware failed - %s (%d)\n",ts->fw_name, ret);
+		return ret;
+	}
+        ret = fwu_start_reflash_check(fw->data,ts->client);
+	release_firmware(fw);
+        if (ret < 0)
+		return -1;
+        else
+            	return ret;
+}
+static int check_version = 0;
+
+/*FW Update Func for s3706*/
+static int synaptics_rmi4_sw_reset(struct i2c_client *client)
+{
+	int retval;
+	unsigned char command = 0x01;
+
+	retval = synaptics_rmi4_i2c_write_block(client,
+		F01_RMI_CTRL_BASE,
+		sizeof(command),
+		&command);
+
+	return retval;
+}
+
+static int synaptics_rmi4_reset_device(struct i2c_client *client,
+		bool rebuild)
+{
+	int retval;
+
+	rebuild = 1;
+	/*mutex_lock(&(rmi4_data->rmi4_reset_mutex));*/
+
+	retval = synaptics_rmi4_sw_reset(client);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to issue reset command\n",
+				__func__);
+		return retval;
+	}
+	/*mutex_unlock(&(rmi4_data->rmi4_reset_mutex));*/
+	return retval;
+}
+
+/*FW Update Func**/
+static int synatpitcs_fw_update(struct device *dev, bool force)
+{
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	const struct firmware *fw = NULL;
+	int ret;
+	char fw_id_temp[20];
+	uint8_t buf[8];
+	unsigned long int CURRENT_FIRMWARE_ID = 0;
+
+        static bool check_onetime = true;
+
+        TPD_DEBUG("%s is called\n",__func__);
+	if(!ts->client) {
+		TPD_ERR("i2c client point is NULL\n");
+		return 0;
+	}
+	if (!strncmp(ts->manu_name, "S3706", 5)) {
+		TPD_ERR("enter version 17819 update mode\n");
+			ret = request_firmware(&fw, ts->fw_name, dev);
+			if (ret < 0) {
+				TPD_ERR("Request firmware failed - %s (%d)\n",
+				ts->fw_name, ret);
+				return ret;
+			}
+	} else if (!strncmp(ts->manu_name, "S3718", 5)) {
+		if(check_onetime){
+			check_onetime = false;
+			check_version = check_hardware_version(dev);
+			TPD_ERR("%s:first check hardware version %d\n",__func__,check_version);
+			if(check_version < 0){
+				TPD_ERR("checkversion fail....\n");
+				return -1;
+			}
+		}
+
+		if(1 == check_version ) {
+			TPD_DEBUG("enter version 15801 update mode\n");
+			strcpy(ts->fw_name,"tp/fw_synaptics_15801.img");
+			//push_component_info(TP, ts->fw_id, "S3718_vA");
+			ret = request_firmware(&fw, ts->fw_name, dev);
+			if (ret < 0) {
+				TPD_ERR("Request firmware failed - %s (%d)\n",ts->fw_name, ret);
+				return ret;
+		       }
+
+		 }else{
+		        TPD_DEBUG("enter version 15801 vb update mode\n");
+			//push_component_info(TP, ts->fw_id, "S3718_vB");
+			ret = request_firmware(&fw, ts->fw_name, dev);
+			if (ret < 0) {
+				TPD_ERR("Request firmware failed - %s (%d)\n",ts->fw_name, ret);
+				return ret;
+		       }
+		}
+
+	}else if(!strncmp(ts->manu_name,"s3508",5) || !strncmp(ts->manu_name,"15811",5)){
+		        TPD_ERR("enter version 16859 update mode\n");
+			//push_component_info(TP, ts->fw_id, "s3508");
+			ret = request_firmware(&fw, ts->fw_name, dev);
+			if (ret < 0) {
+				TPD_ERR("Request firmware failed - %s (%d)\n",ts->fw_name, ret);
+				return ret;
+		       }
+	}else{
+		TPD_ERR("firmware name not match\n");
+		return -1;
+	}
+
+	ret = synapitcs_ts_update(ts->client, fw->data, fw->size, force);
+	if(ret < 0){
+		TPD_ERR("FW update not success try again\n");
+		ret = synapitcs_ts_update(ts->client, fw->data, fw->size, true);
+		if(ret < 0){
+			TPD_ERR("FW update failed twice, quit updating process!\n");
+			return ret;
+		}
+	}
+	release_firmware(fw);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	ret = synaptics_rmi4_i2c_read_block(ts->client,
+		F34_FLASH_CTRL00, 8, buf);
+	CURRENT_FIRMWARE_ID = (buf[0]<<24) | (buf[1]<<16) |
+		(buf[2]<<8) | buf[3];
+	if (version_is_s3508 == 2)
+		CURRENT_FIRMWARE_ID = CURRENT_FIRMWARE_ID << 32 |
+			((buf[4]<<24) | (buf[5]<<16) | (buf[6]<<8) | buf[7]);
+	TPD_ERR("CURRENT_FIRMWARE_ID 0x%lx!\n", CURRENT_FIRMWARE_ID);
+	snprintf(fw_id_temp, 20, "0x%lx", CURRENT_FIRMWARE_ID);
+	strcpy(ts->fw_id,fw_id_temp);
+	TP_FW = CURRENT_FIRMWARE_ID;
+	report_key_point_y = ts->max_y*button_map[2]/LCD_HEIGHT;
+#ifdef SUPPORT_GLOVES_MODE
+	synaptics_glove_mode_enable(ts);
+#endif
+	synaptics_init_panel(ts);
+	synaptics_enable_interrupt(ts,1);
+	return 0;
+}
+
+static ssize_t synaptics_update_fw_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct synaptics_ts_data *data = dev_get_drvdata(dev);
+	return snprintf(buf, 2, "%d\n", data->loading_fw);
+}
+
+static ssize_t synaptics_update_fw_store(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t size)
+{
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	unsigned long val;
+	int rc;
+/*
+	int bootmode;
+
+	bootmode = get_boot_mode();
+	TPD_ERR("synaptics bootmode %d  !\n", bootmode);
+	if ((bootmode == MSM_BOOT_MODE__FACTORY)
+		|| (bootmode == MSM_BOOT_MODE__RF)
+		|| (bootmode == MSM_BOOT_MODE__WLAN)) {
+		TPD_ERR("synaptics disable tp update firmware update\n");
+		return size;
+	}
+*/
+	if (ts->is_suspended && ts->support_hw_poweroff){
+		TPD_ERR("power off firmware abort!\n");
+		return size;
+	}
+	if (version_is_s3508 == 1) {
+		if (strncmp(ts->manu_name,"s3508",5) && strncmp(ts->manu_name,"15811",5)){
+        		TPD_ERR("product name[%s] do not update!\n",ts->manu_name);
+        		return size;
+   		 }
+	} else if (version_is_s3508 == 2) {
+		if (strncmp(ts->manu_name, "S3706", 5)) {
+			TPD_ERR("product name[%s] do not update!\n",
+			ts->manu_name);
+			return size;
+		}
+	}else{
+    		if (strncmp(ts->manu_name,"S3718",5)){
+        		TPD_ERR("product name[%s] do not update!\n",ts->manu_name);
+        		return size;
+   		 }
+	}
+	TPD_ERR("start update ******* fw_name:%s,ts->manu_name:%s\n",ts->fw_name,ts->manu_name);
+
+	if (size > 2)
+		return -EINVAL;
+
+	rc = kstrtoul(buf, 10, &val);
+	if (rc != 0)
+		return rc;
+
+	if(!val)
+		val = force_update;
+
+	touch_disable(ts);
+	mutex_lock(&ts->mutex);
+	ts->loading_fw = true;
+	synatpitcs_fw_update(dev, val);
+	ts->loading_fw = false;
+	mutex_unlock(&ts->mutex);
+	touch_enable(ts);
+	force_update = 0;
+	return size;
+}
+/*********************FW Update Func End*************************************/
+
+
+static ssize_t synaptics_test_limit_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	int ret = 0;
+	uint16_t *prow = NULL;
+	uint16_t *prowcbc = NULL;
+	const struct firmware *fw = NULL;
+	struct test_header *ph = NULL;
+	int i = 0;
+	int temp = 0;
+	static int cat_cbc_change = 0;
+	ret = request_firmware(&fw, ts->test_limit_name, dev);
+	if (ret < 0) {
+		TPD_ERR("Request firmware failed - %s (%d)\n",
+				ts->test_limit_name, ret);
+		temp = temp + sprintf(&buf[temp],"Request failed,Check the path %d",temp);
+		return temp;
+	}
+
+	ph = (struct test_header *)(fw->data);
+	prow = (uint16_t *)(fw->data + ph->array_limit_offset);
+
+	prowcbc = (uint16_t *)(fw->data + ph->array_limitcbc_offset);
+
+	TPD_DEBUG("synaptics_test_limit_show:array_limit_offset = %x array_limitcbc_offset = %x\n",
+			ph->array_limit_offset,ph->array_limitcbc_offset);
+
+	TPD_DEBUG("test begin:\n");
+	if(cat_cbc_change == 0 || ph->withCBC == 0) {
+		temp += sprintf(buf, "Without cbc:");
+		for(i = 0 ;i < (ph->array_limit_size/2 ); i++){
+			if(i % (2*RX_NUM) == 0)
+				temp += sprintf(&(buf[temp]), "\n[%d] ",(i/RX_NUM)/2);
+			temp += sprintf(&buf[temp],"%d,",prow[i]);
+			printk("%d,",prow[i]);
+		}
+		cat_cbc_change = 1;
+	}else{
+		temp += sprintf(buf, "With cbc:");
+		cat_cbc_change = 0;
+		if( ph->withCBC == 0){
+			return temp;
+		}
+		for(i = 0 ;i < (ph->array_limitcbc_size/2 ); i++){
+			if(i % (2*RX_NUM) == 0)
+				temp += sprintf(&(buf[temp]), "\n[%d] ",(i/RX_NUM)/2);
+			temp += sprintf(&buf[temp],"%d,",prowcbc[i]);
+			printk("%d,",prowcbc[i]);
+		}
+	}
+	release_firmware(fw);
+	return temp;
+}
+
+static ssize_t synaptics_test_limit_store(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t size)
+{
+	return size;
+}
+
+static ssize_t tp_doze_time_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int ret = 0;
+	int doze_time = 0;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		return snprintf(buf, 16, "switch page err\n");
+
+	doze_time = i2c_smbus_read_byte_data(ts->client, F01_RMI_CTRL02);
+	return snprintf(buf, 2, "%d\n", doze_time);
+}
+
+static ssize_t tp_doze_time_store(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t size)
+{
+	return size;
+}
+
+static int touch_hold_en(struct synaptics_ts_data *ts, bool enable)
+{
+	int ret = 0;
+	int touch_hold_enable = 0;
+
+	/* SYNA_F51_CUSTOM_CTRL20_00 0x0428*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x04);
+	if (ret < 0)
+		TPD_ERR("%s: set page 0x04 fail!\n", __func__);
+	touch_hold_enable = i2c_smbus_read_byte_data(ts->client, 0x2c);
+
+	if (enable == 1)
+		touch_hold_enable = touch_hold_enable | 0x01;
+	else if (enable == 0)
+		touch_hold_enable = touch_hold_enable & 0xfe;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+		0x2c, touch_hold_enable);
+	if (ret < 0)
+		TPD_ERR("%s: set reg fail!\n", __func__);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_ERR("%s: set page 00 fail!\n", __func__);
+
+	return ret;
+
+}
+
+int tp_single_tap_en(struct synaptics_ts_data *ts, bool enable)
+{
+	uint8_t ret = 0;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x04);
+	if (ret < 0)
+		return ret;
+	if (enable) {
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			0x22, 0x01);
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			0x23, 0);
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			0x24, 0);
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			0x25, 0x64);
+		ret = i2c_smbus_write_word_data(ts->client,
+			F54_ANALOG_COMMAND_BASE, 0x04); // force update
+		TPD_DEBUG("%s: force update %x\n",
+			__func__, F54_ANALOG_COMMAND_BASE);
+	} else
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+			0x22, 0x00);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_ERR("%s: set page 00 fail!\n", __func__);
+
+	return ret;
+}
+
+static ssize_t tp_gesture_touch_hold_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int ret = 0;
+	int touch_hold_enable = 0;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	/* SYNA_F51_CUSTOM_CTRL20_00 0x0428*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x04);
+	if (ret < 0)
+		return snprintf(buf, 16, "switch page err\n");
+	touch_hold_enable = i2c_smbus_read_byte_data(ts->client, 0x2c);
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_ERR("%s: set page 00 fail!\n", __func__);
+	return snprintf(buf, 6, "0x%x\n", touch_hold_enable);
+}
+
+static ssize_t tp_gesture_touch_hold_store(struct device *dev,
+		struct device_attribute *attr,
+		const char *buf, size_t size)
+{
+	int tmp = 0;
+	int touch_hold_enable = 0;
+	int ret = 0;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	ret = kstrtoint(buf, 10, &tmp);
+	if (ret < 0) {
+		TPDTM_DMESG("invalid content: '%s', length = %zd\n", buf, size);
+		return size;
+	}
+
+	TPD_ERR("%s: set %d\n", __func__, tmp);
+	if (tmp == 2 && ts->fp_aod_cnt > 0) {
+		ts->fp_up_down = 0;
+		ts->unlock_succes = 1;
+		return size;
+	}
+
+	if (tmp == 3) {
+		ts->unlock_succes = 0;
+		return size;
+	}
+
+	mutex_lock(&ts->mutex);
+	/* SYNA_F51_CUSTOM_CTRL20_00 0x0428*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x04);
+	if (ret < 0)
+		TPD_ERR("%s: set page 0x04 fail!\n", __func__);
+	touch_hold_enable = i2c_smbus_read_byte_data(ts->client, 0x2c);
+
+	if (tmp == 1) {
+		touch_hold_enable = touch_hold_enable | 0x01;
+		ts->en_up_down = 1;
+	} else if (tmp == 0) {
+		touch_hold_enable = touch_hold_enable & 0xfe;
+		ts->en_up_down = 0;
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client,
+		0x2c, touch_hold_enable);
+	if (ret < 0)
+		TPD_ERR("%s: set reg fail!\n", __func__);
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_ERR("%s: set page 00 fail!\n", __func__);
+	mutex_unlock(&ts->mutex);
+
+	return size;
+}
+
+//static DRIVER_ATTR(tp_baseline_image_with_cbc, 0664, tp_baseline_show_with_cbc, tp_test_store);
+static DEVICE_ATTR(test_limit, 0664, synaptics_test_limit_show, synaptics_test_limit_store);
+static DRIVER_ATTR(tp_baseline_image, 0664, tp_baseline_show, tp_delta_store);
+static DRIVER_ATTR(tp_baseline_image_with_cbc, 0664, tp_baseline_show_with_cbc, tp_test_store);
+static DRIVER_ATTR(tp_delta_image, 0664, tp_rawdata_show, NULL);
+static DRIVER_ATTR(tp_debug_log, 0664, tp_show, store_tp);
+static DEVICE_ATTR(tp_fw_update, 0664, synaptics_update_fw_show, synaptics_update_fw_store);
+static DEVICE_ATTR(tp_doze_time, 0664, tp_doze_time_show, tp_doze_time_store);
+static DEVICE_ATTR(tp_gesture_touch_hold, 0664,
+	tp_gesture_touch_hold_show, tp_gesture_touch_hold_store);
+static int synaptics_dsx_pinctrl_init(struct synaptics_ts_data *ts);
+
+static ssize_t tp_debug_log_write_func(
+	struct file *file, const char *buffer,
+	size_t count, loff_t *ppos)
+{
+	int ret, tmp = 0;
+	char buf[4] = {0};
+
+	if (count > 4)
+		return count;
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_ERR(KERN_INFO "%s: read proc input error.\n", __func__);
+		return count;
+	}
+
+	ret = kstrtoint(buf, 10, &tmp);
+	if (ret >= 0) {
+		tp_debug = tmp;
+	} else {
+	TPDTM_DMESG("invalid content: '%s', length = %zd\n",
+	buf, count);
+	}
+	return count;
+}
+
+static ssize_t tp_debug_log_read_func(
+	struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[4];
+
+	ret = snprintf(page, 4, "%d\n", tp_debug);
+	ret = simple_read_from_buffer(user_buf, count,
+		ppos, page, strlen(page));
+	return ret;
+}
+
+static const struct file_operations tp_debug_log_proc_fops = {
+	.write = tp_debug_log_write_func,
+	.read =  tp_debug_log_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static ssize_t synaptics_main_reg_read_func(
+	struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	int device_contrl = 0;
+	int doze_interval = 0;
+	unsigned char reportbuf[4] = {0};
+	struct synaptics_ts_data *ts = ts_g;
+
+	if (!ts)
+		return ret;
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0)
+		TPD_ERR("%s: chage page failed:%d\n", __func__, ret);
+
+	ret = i2c_smbus_read_byte_data(ts->client, F01_RMI_CTRL00);
+	if (ret < 0)
+		TPD_ERR("%s: read failed:%d\n", __func__, ret);
+
+	TPD_ERR("%s Device Control 0x%x=0x%x\n", __func__, F01_RMI_CTRL00, ret);
+	device_contrl = ret;
+
+	ret = i2c_smbus_read_byte_data(ts->client, F01_RMI_CTRL02);
+	if (ret < 0)
+		TPD_ERR("%s: read failed:%d\n", __func__, ret);
+
+	TPD_ERR("Doze Interval 0x%x=0x%x\n", F01_RMI_CTRL02, ret);
+	doze_interval = ret;
+
+	ret = i2c_smbus_read_i2c_block_data(ts->client, F12_2D_CTRL20,
+		3, &(reportbuf[0x0]));
+	if (ret < 0)
+		TPD_ERR("read reg F12_2D_CTRL20[0x%x] failed\n", F12_2D_CTRL20);
+
+	TPD_ERR("Gesture Report Flag 0x%x=[2]:0x%x\n",
+		F12_2D_CTRL20, reportbuf[2]);
+
+	ret = snprintf(page, 128, "0x%x:0x%x:0x%x\n",
+		device_contrl, doze_interval, reportbuf[2]);
+	ret = simple_read_from_buffer(user_buf, count,
+		ppos, page, strlen(page));
+	return ret;
+}
+
+static const struct file_operations tp_main_reg = {
+	.read =  synaptics_main_reg_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+
+static ssize_t tp_reset_write_func (struct file *file, const char *buffer, size_t count, loff_t *ppos)
+{
+	int ret, write_flag, i;
+	char buf[10] = {0};
+	struct synaptics_ts_data *ts = ts_g;
+
+	if (count > 10)
+		return count;
+	if (!ts)
+		return count;
+	if (ts->loading_fw) {
+		TPD_ERR("%s FW is updating break!!\n", __func__);
+		return count;
+	}
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_ERR(KERN_INFO "%s: read proc input error.\n", __func__);
+		return count;
+	}
+	ret = sscanf(buf, "%d", &write_flag);
+
+	TPD_ERR("%s write [%d]\n",__func__,write_flag);
+	if (1 == write_flag)
+	{
+		ret = synaptics_soft_reset(ts);
+	}
+	else if(2 == write_flag)
+	{
+		synaptics_hard_reset(ts);
+	}
+	else if(3 == write_flag)
+	{
+		disable_irq_nosync(ts->irq);
+	}
+	else if(4 == write_flag)
+	{
+		enable_irq(ts->irq);
+	}
+	else if(8 == write_flag)
+	{
+		touch_enable(ts);
+	}
+	else if(9 == write_flag)
+	{
+		touch_disable(ts);
+	}
+	else if(5 == write_flag)
+	{
+		synaptics_read_register_map(ts);
+	}
+	else if(6 == write_flag)
+	{
+		for (i = 0; i < ts->max_num; i++)
+		{
+			input_mt_slot(ts->input_dev, i);
+			input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 1);
+			input_mt_slot(ts->input_dev, i);
+			input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+		}
+		#ifndef TYPE_B_PROTOCOL
+		input_mt_sync(ts->input_dev);
+		#endif
+		input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+		input_sync(ts->input_dev);
+	}
+	return count;
+}
+
+//chenggang.li@bsp add for 14045
+static const struct file_operations base_register_address= {
+	.write = synap_write_address,
+	.read =  synap_read_address,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+
+//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  begin
+static const struct file_operations i2c_device_test_fops = {
+	.read =  i2c_device_test_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  begin
+static const struct file_operations tp_baseline_test_proc_fops = {
+	.read =  tp_baseline_test_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  end
+
+#ifdef SUPPORT_GLOVES_MODE
+static const struct file_operations glove_mode_enable_proc_fops = {
+	.write = tp_glove_write_func,
+	.read =  tp_glove_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+#endif
+
+static const struct file_operations sleep_mode_enable_proc_fops = {
+	.write = tp_sleep_write_func,
+	.read =  tp_sleep_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static const struct file_operations tp_reset_proc_fops = {
+	.write = tp_reset_write_func,
+	//.read =  tp_sleep_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+static const struct file_operations vendor_id_proc_fops = {
+	.read =  vendor_id_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+static int set_changer_bit(struct synaptics_ts_data *ts)
+{
+    int mode;
+    int ret;
+    mode = i2c_smbus_read_byte_data(ts_g->client, F01_RMI_CTRL00);
+    if (ts->changer_connet)
+        mode = mode | 0x20;
+    else
+        mode = mode & 0xDF;
+    ret = i2c_smbus_write_byte_data(ts_g->client, F01_RMI_CTRL00, mode);
+    return ret;
+}
+static ssize_t changer_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	ret = sprintf(page, "the changer is %s!\n", ts->changer_connet?("conneted"):("disconneted"));
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t changer_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	struct synaptics_ts_data *ts= ts_g;
+	int ret = 0 ;
+	char buf[4] = {0};
+
+	if (count > 2)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_ERR(KERN_INFO "%s: write proc input error.\n", __func__);
+		return count;
+	}
+
+	if (-1 == sscanf(buf, "%d", &ret)) {
+		TPD_ERR("%s sscanf error\n", __func__);
+		return count;
+	}
+	if(!ts)
+		return count;
+	if( (ret == 0 ) || (ret == 1) ){
+		ts->changer_connet = ret;
+        ret = set_changer_bit(ts);
+	}
+	TPDTM_DMESG("%s:ts->changer_connet = %d\n",__func__,ts->changer_connet);
+	return count;
+}
+static const struct file_operations changer_ops = {
+	.write = changer_write_func,
+	.read =  changer_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+static void set_doze_time(int doze_time)
+{
+	static int pre_doze_time;
+	int ret = 0;
+	struct synaptics_ts_data *ts = ts_g;
+
+	/* change to page 0 */
+	if (ts == NULL) {
+		TPD_ERR("ts crash!\n");
+		return;
+	}
+	if (pre_doze_time == doze_time) {
+		TPD_ERR("set time have already been set\n");
+		return;
+	}
+
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x00);
+	if (ret < 0) {
+		TPD_ERR("%s: chage page failed:%d\n", __func__, ret);
+		return;
+	}
+
+	TPD_ERR("%s: set doze time: %d\n", __func__, doze_time);
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CTRL02, doze_time);
+	if (ret < 0) {
+		TPD_ERR("%s: set doze time err:%d\n", __func__, ret);
+		return;
+	}
+	pre_doze_time = doze_time;
+
+	/* use the read out circle to delay */
+	ret = i2c_smbus_read_byte_data(ts->client, F01_RMI_CTRL02);
+	if (ret < 0)
+		return;
+	if (ret != doze_time) {
+		TPD_ERR("reset doze time\n");
+		ret = i2c_smbus_write_byte_data(ts->client,
+				F01_RMI_CTRL02, doze_time);
+		if (ret < 0) {
+			TPD_ERR("%s: reset doze time err:%d\n", __func__, ret);
+			return;
+		}
+	}
+}
+
+#define SUBABS(x,y) ((x)-(y))
+static int tp_baseline_get(struct synaptics_ts_data *ts, bool flag)
+{
+	int ret = 0;
+	int x, y;
+	uint8_t *value;
+	int k = 0;
+	int touch_hold_enable = 0;
+	int touch_hold_retry = 0;
+
+	if(!ts)
+		return -1;
+
+	atomic_set(&ts->is_stop,1);
+	touch_disable(ts);
+	TPD_DEBUG("%s start!\n",__func__);
+	value = kzalloc(TX_NUM*RX_NUM*2, GFP_KERNEL);
+	memset(delta_baseline,0,sizeof(delta_baseline));
+
+	mutex_lock(&ts->mutex);
+	if (ts->gesture_enable) {
+		synaptics_enable_interrupt_for_gesture(ts,false);
+		synaptics_mode_change(0x00);
+		//change to active later getbase data
+	} else {
+		synaptics_mode_change(0x00);
+		//change to active later getbase data
+	}
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x1);
+
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_DATA_BASE, 0x03);//select report type 0x03
+	ret = i2c_smbus_write_word_data(ts->client, F54_ANALOG_DATA_BASE+1, 0);//set fifo 00
+	ret = i2c_smbus_write_byte_data(ts->client, F54_ANALOG_COMMAND_BASE, 0x01);//get report
+	checkCMD(10);
+
+	ret = synaptics_rmi4_i2c_read_block(ts->client,F54_ANALOG_DATA_BASE+3,2*TX_NUM*RX_NUM,value);
+	for( x = 0; x < TX_NUM; x++ ){
+		for( y = 0; y < RX_NUM; y++ ){
+			delta_baseline[x][y] =  (int16_t)(((uint16_t)( value [k])) | ((uint16_t)( value [k+1] << 8)));
+			k = k + 2;
+
+			if (flag)
+				delta[x][y] = SUBABS(delta_baseline[x][y],baseline[x][y]);
+			else
+				baseline[x][y] = delta_baseline[x][y];
+		}
+	}
+	//ret = i2c_smbus_write_byte_data(ts->client,
+	//F54_ANALOG_COMMAND_BASE, 0X02);
+
+	if (ts->project_version != 0x03) {
+		ret = synaptics_rmi4_i2c_write_byte(ts->client,
+				0xff, 0x0);
+		ret = i2c_smbus_write_byte_data(ts->client,
+			F01_RMI_CMD_BASE, 0x01);//soft reset
+	} else {
+		if (!not_getbase && ts->unlock_succes == 0) {
+			not_getbase = 0;
+			TPD_DEBUG("touch hold not getbase reset");
+			ret = synaptics_rmi4_i2c_write_byte(ts->client,
+				0xff, 0x0);
+			ret = i2c_smbus_write_byte_data(ts->client,
+				F01_RMI_CMD_BASE, 0x01);//soft reset
+		}
+	}
+	mutex_unlock(&ts->mutex);
+	atomic_set(&ts->is_stop, 0);
+	msleep(2);
+	if (ts->gesture_enable)
+		set_doze_time(1);
+	touch_enable(ts);
+#ifdef ENABLE_TPEDGE_LIMIT
+	synaptics_tpedge_limitfunc();
+#endif
+	if (ts->project_version == 0x03) {
+		ts->fp_up_down = 0;
+		TPD_DEBUG("%s:fp_down_up %d gesture %d, en_down_up %d\n",
+			__func__, ts->fp_up_down,
+			ts->in_gesture_mode, ts->en_up_down);
+		while (ts->en_up_down) {
+			touch_hold_enable = 0;
+			touch_hold_retry++;
+			ret = synaptics_rmi4_i2c_write_byte(ts->client,
+				0xff, 0x04);
+			if (ret < 0)
+				TPD_ERR("set page first fail!\n");
+			touch_hold_enable =
+				i2c_smbus_read_byte_data(ts->client, 0x2c);
+			TPDTM_DMESG("%s:read reg 0x%x\n",
+				__func__, touch_hold_enable);
+			touch_hold_enable = touch_hold_enable | 0x01;
+			ret = synaptics_rmi4_i2c_write_byte(ts->client,
+				0x2c, touch_hold_enable);
+			if (ret < 0)
+				TPD_ERR("set first fail!\n");
+			ret = i2c_smbus_read_byte_data(ts->client, 0x2c);
+			TPDTM_DMESG("%s:read reg again 0x%x,0x%x\n", __func__,
+				touch_hold_enable, ret);
+			ret = synaptics_rmi4_i2c_write_byte(ts->client,
+				0xff, 0x00);
+			if (ret < 0)
+				TPD_ERR("set page 00 fail!\n");
+			if (touch_hold_enable == ret)
+				break;
+			if (touch_hold_retry == 3)
+				break;
+		}
+	}
+	TPD_DEBUG("%s end! \n",__func__);
+	kfree(value);
+	return 0;
+}
+static void tp_baseline_get_work(struct work_struct *work)
+{
+	struct synaptics_ts_data *ts= ts_g;
+
+	tp_baseline_get(ts, true);//get the delta data
+}
+
+static ssize_t touch_press_status_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	int x,y;
+	int press_points = 0;
+	int points_misspresee =0;
+	int str_n = 0;
+
+	char *page = kzalloc(1024*2,GFP_KERNEL);
+	if (!page){
+		TPD_ERR("%s malloc memery error!",__func__);
+		return -ENOMEM;
+	}
+	TPD_ERR("%s",__func__);
+
+	for (x = 0; x < TX_NUM; x++) {
+		for (y = 0; y < RX_NUM; y++) {
+			if (ts_g->support_1080x2160_tp) {
+				if (x > (TX_NUM-1) || y > (RX_NUM-15))
+					continue;
+			} else {
+				if (x > (TX_NUM-1) || y < (RX_NUM-12))
+					continue;
+			}
+			if ((delta[x][y] < -30) && (delta[x][y] > -250))
+			{
+				//str_n += sprintf(&page[str_n],"x%d,y%d = %4d\n", x, y, delta[x][y]);
+				press_points++;
+			}
+			if((delta[x][y] > 30) && (delta[x][y] < 200))
+				points_misspresee ++;
+		}
+
+	}
+
+	if(points_misspresee > 4)
+		get_tp_base = 0;
+	TPD_ERR("points_mispressee num:%d,get_tp_base:%d\n",points_misspresee,get_tp_base);
+	str_n += sprintf(&page[str_n], "\n%s %d points delta > [25]\n",(press_points>4)?"near":"away", press_points);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	kfree(page);
+	return ret;
+}
+
+static ssize_t touch_press_status_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	struct synaptics_ts_data *ts= ts_g;
+	int ret = 0 ;
+	char buf[4] = {0};
+
+	if (count > 2)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		TPD_ERR("%s write error\n", __func__);
+		return count;
+	}
+	if (-1 == sscanf(buf, "%d", &ret)) {
+		TPD_ERR("%s sscanf error\n", __func__);
+		return count;
+	}
+	if(!ts)
+		return count;
+
+	TPD_ERR("%s write %d\n",__func__,ret);
+	if (ret == 0){
+		tp_baseline_get(ts,false);
+	}
+	else if(ret == 1) {
+		if (0 == ts->gesture_enable)
+			queue_delayed_work(get_base_report, &ts->base_work,msecs_to_jiffies(120));
+		else
+			queue_delayed_work(get_base_report, &ts->base_work,msecs_to_jiffies(1));
+	}
+	return count;
+}
+static const struct file_operations touch_press_status = {
+	.write = touch_press_status_write,
+	.read =  touch_press_status_read,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+
+#ifdef ENABLE_TPEDGE_LIMIT
+static ssize_t limit_enable_read(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	ssize_t ret =0;
+	char page[PAGESIZE];
+
+	TPD_DEBUG("the limit_enable is: %d\n", limit_enable);
+	ret = sprintf(page, "%d\n", limit_enable);
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t limit_enable_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+        int ret;
+	char buf[8]={0};
+        int limit_mode = 0;
+
+	if (version_is_s3508 == 2) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x0a;
+	} else if (version_is_s3508 == 0) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x34;
+	} else if (version_is_s3508 == 1) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x1b;
+	} else
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x0a;
+
+	if( count > 2)
+		count = 2;
+	if(ts_g == NULL)
+	{
+		TPD_ERR("ts_g is NULL!\n");
+		return -1;
+	}
+	if(copy_from_user(buf, buffer, count))
+	{
+		TPD_DEBUG("%s: read proc input error.\n", __func__);
+		return count;
+	}
+
+	if('0' == buf[0]){
+		limit_enable = 0;
+	}else if('1' == buf[0]){
+		limit_enable = 1;
+	}
+	msleep(30);
+	mutex_lock(&ts_g->mutex);
+	ret = i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x4);
+	limit_mode = i2c_smbus_read_byte_data(ts_g->client,
+						F51_GRIP_CONFIGURATION);
+	TPD_ERR("%s_proc limit_enable =%d,mode:0x%x,grip:0x%x!\n",
+					__func__, limit_enable, limit_mode,
+					F51_GRIP_CONFIGURATION);
+	if(limit_mode){
+		i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x4);
+		if(0 == limit_enable)
+		{
+			limit_mode = limit_mode & 0xFE;
+			ret = i2c_smbus_write_byte_data(ts_g->client,
+				F51_GRIP_CONFIGURATION, limit_mode);
+		}
+		else if(1 == limit_enable)
+		{
+			limit_mode = limit_mode | 0x1;
+			ret = i2c_smbus_write_byte_data(ts_g->client,
+				F51_GRIP_CONFIGURATION, limit_mode);
+		}
+	}
+	i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x0);
+	mutex_unlock(&ts_g->mutex);
+	return count;
+}
+
+static const struct file_operations proc_limit_enable =
+{
+	.read = limit_enable_read,
+	.write = limit_enable_write,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+#endif
+#ifdef SUPPORT_TP_TOUCHKEY
+static ssize_t key_switch_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	TPD_ERR("%s left:%s right:%s\n", __func__,
+		    key_switch?"key_back":"key_appselect",
+		    key_switch?"key_appselect":"key_back");
+	ret = snprintf(page, PAGE_SIZE, "key_switch left:%s right:%s\n",
+		    key_switch?"key_back":"key_appselect",
+		    key_switch?"key_appselect":"key_back");
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t key_switch_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	char buf[4] = {0};
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return count;
+	if(count > 2)
+		return count;
+	if(copy_from_user(buf, buffer, count))
+	{
+		TPD_ERR("%s copy error\n", __func__);
+		return count;
+	}
+	sscanf(&buf[0], "%d", &key_switch);
+	TPD_ERR("%s write [%d]\n", __func__, key_switch);
+	TPD_ERR("left:%s right:%s\n", key_switch?"key_back":"key_appselect",
+		key_switch?"key_appselect":"key_back");
+	return count;
+}
+
+static const struct file_operations key_switch_proc_fops = {
+	.write = key_switch_write_func,
+	.read =  key_switch_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+static ssize_t key_disable_read_func(struct file *file, char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return ret;
+	TPD_ERR("%s key_back:%s key_appselect:%s\n",__func__,key_back_disable?"disable":"enable",key_appselect_disable?"disable":"enable");
+	ret = sprintf(page, "cmd:enable,disable\nkey_back:%s key_appselect:%s\n",key_back_disable?"disable":"enable",key_appselect_disable?"disable":"enable");
+	ret = simple_read_from_buffer(user_buf, count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t key_disable_write_func(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+	char buf[PAGESIZE];
+	struct synaptics_ts_data *ts = ts_g;
+	if(!ts)
+		return count;
+	if( count > sizeof(buf)){
+		TPD_ERR("%s error\n",__func__);
+		return count;
+	}
+
+	if(copy_from_user(buf, buffer, count))
+	{
+		TPD_ERR("%s copy error\n", __func__);
+		return count;
+	}
+	if (NULL != strstr(buf,"disable"))
+	{
+		key_back_disable =true;
+		key_appselect_disable = true;
+	}
+	else if (NULL != strstr(buf,"enable"))
+	{
+		key_back_disable =false;
+		key_appselect_disable = false;
+	}
+	TPD_ERR("%s key_back:%d key_appselect:%d\n",__func__,key_back_disable,key_appselect_disable);
+	return count;
+}
+
+static const struct file_operations key_disable_proc_fops = {
+	.write = key_disable_write_func,
+	.read =  key_disable_read_func,
+	.open = simple_open,
+	.owner = THIS_MODULE,
+};
+#endif
+static int init_synaptics_proc(void)
+{
+	int ret = 0;
+	struct proc_dir_entry *prEntry_tmp  = NULL;
+	prEntry_tp = proc_mkdir("touchpanel", NULL);
+	if( prEntry_tp == NULL ){
+		ret = -ENOMEM;
+		TPD_ERR("Couldn't create touchpanel\n");
+	}
+
+#ifdef SUPPORT_GESTURE
+	prEntry_tmp = proc_create( "gesture_enable", 0666, prEntry_tp, &tp_gesture_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create gesture_enable\n");
+	}
+	prEntry_tmp = proc_create( "gesture_switch", 0666, prEntry_tp, &gesture_switch_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+		TPD_ERR("Couldn't create gesture_switch\n");
+	}
+	prEntry_tmp = proc_create("coordinate", 0444, prEntry_tp, &coordinate_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create coordinate\n");
+	}
+#endif
+
+#ifdef SUPPORT_GLOVES_MODE
+	prEntry_tmp = proc_create( "glove_mode_enable", 0666, prEntry_tp,&glove_mode_enable_proc_fops);
+	if(prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create glove_mode_enable\n");
+	}
+#endif
+
+#ifdef SUPPORT_TP_SLEEP_MODE
+	prEntry_tmp = proc_create("sleep_mode_enable", 0666, prEntry_tp, &sleep_mode_enable_proc_fops);
+	if( prEntry_tmp == NULL ){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create sleep_mode_enable\n");
+	}
+#endif
+
+#ifdef RESET_ONESECOND
+	prEntry_tmp = proc_create( "tp_reset", 0666, prEntry_tp, &tp_reset_proc_fops);
+	if( prEntry_tmp == NULL ){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create tp_reset\n");
+	}
+#endif
+#ifdef ENABLE_TPEDGE_LIMIT
+	prEntry_tmp = proc_create("tpedge_limit_enable", 0666, prEntry_tp, &proc_limit_enable);
+	if( prEntry_tmp == NULL ){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create tp_limit_enable\n");
+	}
+#endif
+
+	//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  begin
+	prEntry_tmp = proc_create( "baseline_test", 0666, prEntry_tp, &tp_baseline_test_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create baseline_test\n");
+	}
+	//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\baseline_test"  end
+	//wangwenxue@BSP add for change baseline_test to "proc\touchpanel\i2c_device_test"  begin
+	prEntry_tmp = proc_create( "i2c_device_test", 0666, prEntry_tp, &i2c_device_test_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create i2c_device_test\n");
+	}
+
+	prEntry_tmp = proc_create( "radd", 0777, prEntry_tp, &base_register_address);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create radd\n");
+	}
+	prEntry_tmp = proc_create("vendor_id", 0444, prEntry_tp, &vendor_id_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create vendor_id\n");
+	}
+	prEntry_tmp = proc_create("changer_connet", 0666, prEntry_tp, &changer_ops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create changer_connet\n");
+	}
+
+	prEntry_tmp = proc_create("touch_press", 0666, prEntry_tp, &touch_press_status);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create touch_press\n");
+	}
+#ifdef SUPPORT_TP_TOUCHKEY
+	prEntry_tmp = proc_create("key_switch", 0666, prEntry_tp, &key_switch_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create key_switch\n");
+	}
+
+	prEntry_tmp = proc_create("key_disable", 0666, prEntry_tp, &key_disable_proc_fops);
+	if(prEntry_tmp == NULL){
+		ret = -ENOMEM;
+        TPD_ERR("Couldn't create key_disable\n");
+	}
+#endif
+
+	/*morgan.gu add for logkit to dump main registor*/
+	prEntry_tmp = proc_create("tp_main_reg", 0444,
+		prEntry_tp, &tp_main_reg);
+	if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_ERR("Couldn't create tp_main_reg\n");
+	}
+
+	/*morgan.gu add for logkit to open more log*/
+	prEntry_tmp = proc_create("tp_debug_log", 0664,
+		prEntry_tp, &tp_debug_log_proc_fops);
+	if (prEntry_tmp == NULL) {
+		ret = -ENOMEM;
+		TPD_ERR("Couldn't create tp_debug_log_proc_fops\n");
+	}
+
+	return ret;
+}
+/******************************end****************************/
+
+/****************************S3203*****update**********************************/
+#define SYNAPTICS_RMI4_PRODUCT_ID_SIZE 10
+#define SYNAPTICS_RMI4_PRODUCT_INFO_SIZE 2
+
+static void re_scan_PDT(struct i2c_client *client)
+{
+	uint8_t buf[8];
+	i2c_smbus_read_i2c_block_data(client, 0xE9, 6,  buf);
+	SynaF34DataBase = buf[3];
+	SynaF34QueryBase = buf[0];
+	i2c_smbus_read_i2c_block_data(client, 0xE3, 6,  buf);
+	SynaF01DataBase = buf[3];
+	SynaF01CommandBase = buf[1];
+	i2c_smbus_read_i2c_block_data(client, 0xDD, 6,  buf);
+
+	SynaF34Reflash_BlockNum = SynaF34DataBase;
+	SynaF34Reflash_BlockData = SynaF34DataBase + 1;
+	SynaF34ReflashQuery_BootID = SynaF34QueryBase;
+	SynaF34ReflashQuery_FlashPropertyQuery = SynaF34QueryBase + 1;
+	SynaF34ReflashQuery_FirmwareBlockSize = SynaF34QueryBase + 2;
+	SynaF34ReflashQuery_FirmwareBlockCount = SynaF34QueryBase +3;
+	SynaF34ReflashQuery_ConfigBlockSize = SynaF34QueryBase + 3;
+	SynaF34ReflashQuery_ConfigBlockCount = SynaF34QueryBase + 3;
+	i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+	SynaFirmwareBlockSize = buf[0] | (buf[1] << 8);
+	TPD_DEBUG("SynaFirmwareBlockSize 3310 is %d\n", SynaFirmwareBlockSize);
+	SynaF34_FlashControl = SynaF34DataBase + 2;
+}
+struct image_header {
+	/* 0x00 - 0x0f */
+	unsigned char checksum[4];
+	unsigned char reserved_04;
+	unsigned char reserved_05;
+	unsigned char options_firmware_id:1;
+	unsigned char options_contain_bootloader:1;
+	unsigned char options_reserved:6;
+	unsigned char bootloader_version;
+	unsigned char firmware_size[4];
+	unsigned char config_size[4];
+	/* 0x10 - 0x1f */
+	unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE];
+	unsigned char package_id[2];
+	unsigned char package_id_revision[2];
+	unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+	/* 0x20 - 0x2f */
+	unsigned char reserved_20_2f[16];
+	/* 0x30 - 0x3f */
+	unsigned char ds_id[16];
+	/* 0x40 - 0x4f */
+	unsigned char ds_info[10];
+	unsigned char reserved_4a_4f[6];
+	/* 0x50 - 0x53 */
+	unsigned char firmware_id[4];
+};
+
+struct image_header_data {
+	bool contains_firmware_id;
+	unsigned int firmware_id;
+	unsigned int checksum;
+	unsigned int firmware_size;
+	unsigned int config_size;
+	unsigned char bootloader_version;
+	unsigned char product_id[SYNAPTICS_RMI4_PRODUCT_ID_SIZE + 1];
+	unsigned char product_info[SYNAPTICS_RMI4_PRODUCT_INFO_SIZE];
+};
+
+static unsigned int extract_uint_le(const unsigned char *ptr)
+{
+	return (unsigned int)ptr[0] +
+		(unsigned int)ptr[1] * 0x100 +
+		(unsigned int)ptr[2] * 0x10000 +
+		(unsigned int)ptr[3] * 0x1000000;
+}
+
+static void parse_header(struct image_header_data *header,
+		const unsigned char *fw_image)
+{
+	struct image_header *data = (struct image_header *)fw_image;
+
+	header->checksum = extract_uint_le(data->checksum);
+	TPD_DEBUG(" debug checksume is %x", header->checksum);
+	header->bootloader_version = data->bootloader_version;
+	TPD_DEBUG(" debug bootloader_version is %d\n", header->bootloader_version);
+
+	header->firmware_size = extract_uint_le(data->firmware_size);
+	TPD_DEBUG(" debug firmware_size is %x", header->firmware_size);
+
+	header->config_size = extract_uint_le(data->config_size);
+	TPD_DEBUG(" debug header->config_size is %x", header->config_size);
+
+	memcpy(header->product_id, data->product_id, sizeof(data->product_id));
+	header->product_id[sizeof(data->product_id)] = 0;
+
+	memcpy(header->product_info, data->product_info,
+			sizeof(data->product_info));
+
+	header->contains_firmware_id = data->options_firmware_id;
+	TPD_DEBUG(" debug header->contains_firmware_id is %x\n", header->contains_firmware_id);
+	if( header->contains_firmware_id )
+		header->firmware_id = extract_uint_le(data->firmware_id);
+
+	return;
+}
+
+static int checkFlashState(struct i2c_client *client)
+{
+	int ret ;
+	int count = 0;
+	ret =  synaptics_rmi4_i2c_read_byte(client,SynaF34_FlashControl+1);
+	while ( (ret != 0x80)&&(count < 8) ) {
+		msleep(3); //wait 3ms
+		ret =  synaptics_rmi4_i2c_read_byte(client,SynaF34_FlashControl+1);
+		count++;
+	}
+	if(count == 8)
+		return 1;
+	else
+		return 0;
+}
+
+static int synaptics_fw_check(struct synaptics_ts_data *ts )
+{
+	int ret;
+	uint8_t buf[4];
+	uint32_t bootloader_mode;
+	int max_y_ic = 0;
+	int max_x_ic = 0;
+	if(!ts){
+		TPD_ERR("%s ts is NULL\n",__func__);
+		return -1;
+	}
+
+	ret = synaptics_enable_interrupt(ts, 0);
+	if(ret < 0) {
+		TPDTM_DMESG(" synaptics_ts_probe: disable interrupt failed\n");
+	}
+
+	/*read product id */
+	ret = synaptics_read_product_id(ts);
+	if(ret) {
+		TPD_ERR("failed to read product info \n");
+		return -1;
+	}
+	/*read max_x ,max_y*/
+	ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+	if (ret < 0) {
+		ret = synaptics_rmi4_i2c_write_byte(ts->client, 0xff, 0x0);
+		if(ret < 0 ){
+			TPD_ERR("synaptics_rmi4_i2c_write_byte failed for page select\n");
+			return -1;
+		}
+	}
+
+	i2c_smbus_read_i2c_block_data(ts->client, F12_2D_CTRL08, 4, buf);
+	max_x_ic = ( (buf[1]<<8)&0xffff ) | (buf[0]&0xffff);
+	max_y_ic = ( (buf[3]<<8)&0xffff ) | (buf[2]&0xffff);
+
+	TPD_ERR("max_x = %d,max_y = %d; max_x_ic = %d,max_y_ic = %d\n",ts->max_x,ts->max_y,max_x_ic,max_y_ic);
+	if((ts->max_x == 0) ||(ts->max_y ==0 )) {
+		ts->max_x = max_x_ic;
+		ts->max_y = max_y_ic;
+	}
+	bootloader_mode = synaptics_rmi4_i2c_read_byte(ts->client,F01_RMI_DATA_BASE);
+	bootloader_mode = bootloader_mode&0xff;
+	bootloader_mode = bootloader_mode&0x40;
+	TPD_DEBUG("afte fw update,program memory self-check bootloader_mode = 0x%x\n",bootloader_mode);
+
+	if((max_x_ic == 0)||(max_y_ic == 0)||(bootloader_mode == 0x40)) {
+		TPD_ERR("Something terrible wrong \n Trying Update the Firmware again\n");
+		return -1;
+	}
+	return 0;
+}
+
+static void re_scan_PDT_s3508(struct i2c_client *client)
+{
+	uint8_t buf[8];
+	i2c_smbus_read_i2c_block_data(client, 0xE9, 6,  buf);
+	SynaF34DataBase = buf[3];
+	SynaF34QueryBase = buf[0];
+	i2c_smbus_read_i2c_block_data(client, 0xE3, 6,  buf);
+	SynaF01DataBase = buf[3];
+	SynaF01CommandBase = buf[1];
+	i2c_smbus_read_i2c_block_data(client, 0xDD, 6,  buf);
+
+	SynaF34Reflash_BlockNum = SynaF34DataBase;
+	SynaF34Reflash_BlockData = SynaF34DataBase + 1;
+	SynaF34ReflashQuery_BootID = SynaF34QueryBase;
+	SynaF34ReflashQuery_FlashPropertyQuery = SynaF34QueryBase + 1;
+	SynaF34ReflashQuery_FirmwareBlockSize = SynaF34QueryBase + 2;
+	SynaF34ReflashQuery_FirmwareBlockCount = SynaF34QueryBase +3;
+	SynaF34ReflashQuery_ConfigBlockSize = SynaF34QueryBase + 3;
+	SynaF34ReflashQuery_ConfigBlockCount = SynaF34QueryBase + 3;
+	i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_FirmwareBlockSize, 2, buf);
+	SynaFirmwareBlockSize = buf[0] | (buf[1] << 8);
+	TPD_DEBUG("SynaFirmwareBlockSize 3310 is %d\n", SynaFirmwareBlockSize);
+	SynaF34_FlashControl = SynaF34DataBase + 2;
+}
+
+#define F01_BUID_ID_OFFSET 18
+
+static int synaptics_rmi4_query_firmware_id_s3706(
+		struct i2c_client *client,
+		unsigned int *firmware_id_s3706,
+		unsigned char *conifg_id_s3706)
+{
+	int retval;
+	unsigned char build_id[3];
+	unsigned int firmware_id;
+	unsigned char config_id[32];
+
+	retval = synaptics_rmi4_i2c_read_block(client,
+			F01_RMI_QUERY_BASE + F01_BUID_ID_OFFSET,
+			sizeof(build_id), build_id);
+	if (retval < 0)
+		return retval;
+	firmware_id = (unsigned int)build_id[0] +
+			(unsigned int)build_id[1] * 0x100 +
+			(unsigned int)build_id[2] * 0x10000;
+	*firmware_id_s3706 = firmware_id;
+
+	retval = synaptics_rmi4_i2c_read_block(client,
+			F34_FLASH_CTRL_BASE,
+				sizeof(config_id), config_id);
+	if (retval < 0)
+		return retval;
+	conifg_id_s3706 = config_id;
+	return 0;
+}
+
+
+static int synapitcs_ts_update(struct i2c_client *client, const uint8_t *data, uint32_t data_len ,bool force)
+{
+	int ret,j;
+	uint8_t buf[8];
+	uint8_t bootloder_id[10];
+	uint16_t block,firmware,configuration;
+	uint32_t CURRENT_FIRMWARE_ID = 0 , FIRMWARE_ID = 0;
+	unsigned char  CURRENT_CONFIG_ID[32] = {0};
+	const uint8_t *Config_Data = NULL;
+	const uint8_t *Firmware_Data = NULL;
+	struct image_header_data header;
+	struct synaptics_ts_data *ts = dev_get_drvdata(&client->dev);
+	TPD_DEBUG("%s is called\n", __func__);
+	if(!client)
+		return -1;
+	if (!strncmp(ts->manu_name, "S3706", 5)) {
+		synaptics_rmi4_query_firmware_id_s3706(
+			client,
+			&CURRENT_FIRMWARE_ID,
+			CURRENT_CONFIG_ID);
+		TPD_ERR("FW_ID:%d--CONFIG_ID %s FW_NAME:%s\n",
+				CURRENT_FIRMWARE_ID,
+				CURRENT_CONFIG_ID,
+				ts->fw_name);
+		rmi4_data_s3706->firmware_id = CURRENT_FIRMWARE_ID;
+		rmi4_data_s3706->force = force;
+		ret = synaptics_rmi4_fwu_init(rmi4_data_s3706, data, client);
+		if (ret < 0) {
+			return ret;
+		}
+	} else if (!strncmp(ts->manu_name, "S3718", 5)) {
+		Config_Data = data + 0x8f0;
+		ret = synaptics_rmi4_i2c_write_byte(client, 0xff, 0x0);
+		ret = synaptics_rmi4_i2c_read_block(client, F34_FLASH_CTRL00, 4, buf);
+		CURRENT_FIRMWARE_ID = (buf[0]<<24)|(buf[1]<<16)|(buf[2]<<8)|buf[3];
+		FIRMWARE_ID = (Config_Data[0]<<24)|(Config_Data[1]<<16)|(Config_Data[2]<<8)|Config_Data[3];
+		if(1 == check_version)
+			TPD_ERR("15801CURRENT_FW_ID:%x----, FW_ID:%x----,FW_NAME:%s\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID,ts->fw_name);
+		else
+			TPD_ERR("15801CURRENT_FW_ID:%xvB----, FW_ID:%xvB----,FW_NAME:%s\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID,ts->fw_name);
+		//TPD_ERR("synaptics force is %d\n", force);
+		if(!force) {
+			if(CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+				return 0;
+			}
+		}
+		ret = fwu_start_reflash(data,client);
+		if (ret){
+			return -1;
+		}
+	}else if(!strncmp(ts->manu_name,"s3508",5) || !strncmp(ts->manu_name,"15811",5)){
+		parse_header(&header,data);
+		if((header.firmware_size + header.config_size + 0x100) > data_len) {
+			TPDTM_DMESG("firmware_size + config_size + 0x100 > data_len data_len = %d \n",data_len);
+			return -1;
+		}
+		Firmware_Data = data + 0x100;
+		Config_Data = Firmware_Data + header.firmware_size;
+		ret = i2c_smbus_write_byte_data(client, 0xff, 0x0);
+
+		ret = i2c_smbus_read_i2c_block_data(client, F34_FLASH_CTRL00, 4, buf);
+		CURRENT_FIRMWARE_ID = (buf[0]<<24)|(buf[1]<<16)|(buf[2]<<8)|buf[3];
+		FIRMWARE_ID = (Config_Data[0]<<24)|(Config_Data[1]<<16)|(Config_Data[2]<<8)|Config_Data[3];
+		TPD_ERR("15811CURRENT_FW_ID:%x----, FW_ID:%x----,FW_NAME:%s\n", CURRENT_FIRMWARE_ID, FIRMWARE_ID,ts->fw_name);
+		TPD_ERR("synaptics force is %d\n", force);
+		if(!force) {
+			if(CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+				return 0;
+			}
+		}
+		re_scan_PDT_s3508(client);
+		block = 16;
+		TPD_DEBUG("block is %d \n",block);
+		firmware = (header.firmware_size)/16;
+		TPD_DEBUG("firmware is %d \n",firmware);
+		configuration = (header.config_size)/16;
+		TPD_DEBUG("configuration is %d \n",configuration);
+
+		ret = i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+		TPD_DEBUG("bootloader id is %x \n",(bootloder_id[1] << 8)|bootloder_id[0]);
+		ret=i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+		TPD_DEBUG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n",SynaF34_FlashControl,ret);
+
+		i2c_smbus_write_byte_data(client,SynaF34_FlashControl,0x0F);
+		msleep(10);
+		TPD_DEBUG("attn step 4\n");
+		ret=checkFlashState(client);
+		if(ret > 0) {
+			TPD_ERR("Get in prog:The status(Image) of flashstate is %x\n",ret);
+				return -1;
+		}
+		ret = i2c_smbus_read_byte_data(client,0x04);
+		TPD_DEBUG("The status(device state) is %x\n",ret);
+		ret= i2c_smbus_read_byte_data(client,F01_RMI_CTRL_BASE);
+		TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n",ret);
+		ret= i2c_smbus_write_byte_data(client,F01_RMI_CTRL_BASE,ret&0x04);
+		/********************get into prog end************/
+		ret=i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+		TPD_DEBUG("ret is %d\n",ret);
+		re_scan_PDT_s3508(client);
+		i2c_smbus_read_i2c_block_data(client,SynaF34ReflashQuery_BootID,2,buf);
+		i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockData,2,buf);
+		i2c_smbus_write_byte_data(client,SynaF34_FlashControl,0x03);
+		msleep(2500);
+		ret = i2c_smbus_read_byte_data(client, SynaF34_FlashControl);
+		if(ret != 0x00)
+			msleep(2000);
+		ret = i2c_smbus_read_byte_data(client,SynaF34_FlashControl+1);
+		TPDTM_DMESG("The status(erase) is %x\n",ret);
+		TPD_ERR("15811update-----------------update------------------update!\n");
+		TPD_DEBUG("cnt %d\n",firmware);
+		for(j=0; j<firmware; j++) {
+			buf[0]=j&0x00ff;
+			buf[1]=(j&0xff00)>>8;
+			i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockNum,2,buf);
+			i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockData,16,&Firmware_Data[j*16]);
+
+			i2c_smbus_write_byte_data(client,SynaF34_FlashControl,0x02);
+			ret=checkFlashState(client);
+			if(ret > 0) {
+				TPD_ERR("Firmware:The status(Image) of flash data3 is %x,time =%d\n",ret,j);
+				return -1;
+			}
+		}
+		//step 7 configure data
+		//TPD_ERR("going to flash configuration area\n");
+		//TPD_ERR("header.firmware_size is 0x%x\n", header.firmware_size);
+		//TPD_ERR("bootloader_size is 0x%x\n", bootloader_size);
+		for(j=0;j<configuration;j++) {
+			//a)write SynaF34Reflash_BlockNum to access
+			buf[0]=j&0x00ff;
+			buf[1]=(j&0xff00)>>8;
+			i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockNum,2,buf);
+			//b) write data
+
+				i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockData,16,&Config_Data[j*16]);
+
+			//c) issue write
+			i2c_smbus_write_byte_data(client,SynaF34_FlashControl,0x06);
+			//d) wait attn
+			ret = checkFlashState(client);
+			if(ret > 0) {
+				TPD_ERR("Configuration:The status(Image) of flash data3 is %x,time =%d\n",ret,j);
+				return -1;
+			}
+		}
+		//step 1 issue reset
+		i2c_smbus_write_byte_data(client,SynaF01CommandBase,0X01);
+	}else{
+		parse_header(&header,data);
+		if((header.firmware_size + header.config_size + 0x100) > data_len) {
+			TPDTM_DMESG("firmware_size + config_size + 0x100 > data_len data_len = %d \n",data_len);
+			return -1;
+		}
+
+		Firmware_Data = data + 0x100;
+		Config_Data = Firmware_Data + header.firmware_size;
+		ret = synaptics_rmi4_i2c_write_byte(client, 0xff, 0x0);
+
+		ret = synaptics_rmi4_i2c_read_block(client, F34_FLASH_CTRL00, 4, buf);
+		CURRENT_FIRMWARE_ID = (buf[0]<<24)|(buf[1]<<16)|(buf[2]<<8)|buf[3];
+		FIRMWARE_ID = (Config_Data[0]<<24)|(Config_Data[1]<<16)|(Config_Data[2]<<8)|Config_Data[3];
+
+		//TPD_ERR("synaptics force is %d\n", force);
+		if(!force) {
+			if(CURRENT_FIRMWARE_ID == FIRMWARE_ID) {
+				return 0;
+			}
+		}
+		re_scan_PDT(client);
+		block = 16;
+		TPD_DEBUG("block is %d \n",block);
+		firmware = (header.firmware_size)/16;
+		TPD_DEBUG("firmware is %d \n",firmware);
+		configuration = (header.config_size)/16;
+		TPD_DEBUG("configuration is %d \n",configuration);
+
+
+		ret = i2c_smbus_read_i2c_block_data(client, SynaF34ReflashQuery_BootID, 8, &(bootloder_id[0]));
+		TPD_DEBUG("bootloader id is %x \n",(bootloder_id[1] << 8)|bootloder_id[0]);
+		ret=i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+		TPDTM_DMESG("Write bootloader id SynaF34_FlashControl is 0x00%x ret is %d\n",SynaF34_FlashControl,ret);
+
+		synaptics_rmi4_i2c_write_byte(client,SynaF34_FlashControl,0x0F);
+		msleep(10);
+		TPD_DEBUG("attn step 4\n");
+		ret=checkFlashState(client);
+		if(ret > 0) {
+			TPD_ERR("Get in prog:The status(Image) of flashstate is %x\n",ret);
+			return -1;
+		}
+		ret = i2c_smbus_read_byte_data(client,0x04);
+		TPD_DEBUG("The status(device state) is %x\n",ret);
+		ret= i2c_smbus_read_byte_data(client,F01_RMI_CTRL_BASE);
+		TPD_DEBUG("The status(control f01_RMI_CTRL_DATA) is %x\n",ret);
+		ret= i2c_smbus_write_byte_data(client,F01_RMI_CTRL_BASE,ret&0x04);
+		/********************get into prog end************/
+		ret=i2c_smbus_write_i2c_block_data(client, SynaF34Reflash_BlockData, 2, &(bootloder_id[0x0]));
+		TPD_DEBUG("ret is %d\n",ret);
+		re_scan_PDT(client);
+		i2c_smbus_read_i2c_block_data(client,SynaF34ReflashQuery_BootID,2,buf);
+		i2c_smbus_write_i2c_block_data(client,SynaF34Reflash_BlockData,2,buf);
+		i2c_smbus_write_byte_data(client,SynaF34_FlashControl,0x03);
+		msleep(2000);
+		ret = i2c_smbus_read_byte_data(client,SynaF34_FlashControl);
+		TPDTM_DMESG("going to flash firmware area synaF34_FlashControl %d\n",ret);
+
+		TPD_ERR("update-----------------firmware ------------------update!\n");
+		TPD_DEBUG("cnt %d\n",firmware);
+		for(j=0; j<firmware; j++) {
+			buf[0]=j&0x00ff;
+			buf[1]=(j&0xff00)>>8;
+			synaptics_rmi4_i2c_write_block(client,SynaF34Reflash_BlockNum,2,buf);
+			synaptics_rmi4_i2c_write_block(client,SynaF34Reflash_BlockData,16,&Firmware_Data[j*16]);
+			synaptics_rmi4_i2c_write_byte(client,SynaF34_FlashControl,0x02);
+			ret=checkFlashState(client);
+			if(ret > 0) {
+				TPD_ERR("Firmware:The status(Image) of flash data3 is %x,time =%d\n",ret,j);
+				return -1;
+			}
+		}
+		//step 7 configure data
+		//TPD_ERR("going to flash configuration area\n");
+		//TPD_ERR("header.firmware_size is 0x%x\n", header.firmware_size);
+		//TPD_ERR("bootloader_size is 0x%x\n", bootloader_size);
+		TPD_ERR("update-----------------configuration ------------------update!\n");
+		for(j=0;j<configuration;j++) {
+			//a)write SynaF34Reflash_BlockNum to access
+			buf[0]=j&0x00ff;
+			buf[1]=(j&0xff00)>>8;
+			synaptics_rmi4_i2c_write_block(client,SynaF34Reflash_BlockNum,2,buf);
+			//b) write data
+			synaptics_rmi4_i2c_write_block(client,SynaF34Reflash_BlockData,16,&Config_Data[j*16]);
+			//c) issue write
+			synaptics_rmi4_i2c_write_byte(client,SynaF34_FlashControl,0x06);
+			//d) wait attn
+			ret = checkFlashState(client);
+			if(ret > 0) {
+				TPD_ERR("Configuration:The status(Image) of flash data3 is %x,time =%d\n",ret,j);
+				return -1;
+			}
+		}
+
+		//step 1 issue reset
+		synaptics_rmi4_i2c_write_byte(client,SynaF01CommandBase,0x01);
+	}
+	//step2 wait ATTN
+	//delay_qt_ms(1000);
+	mdelay(1500);
+	synaptics_read_register_map(ts);
+	//FW flash check!
+	ret =synaptics_fw_check(ts);
+	if(ret < 0 ) {
+		TPD_ERR("Firmware self check failed\n");
+		return -1;
+	}
+	TPD_ERR("Firmware self check success\n");
+	return 0;
+}
+#ifdef ENABLE_TPEDGE_LIMIT
+static void synaptics_tpedge_limitfunc(void)
+{
+	int limit_mode=0;
+	int ret;
+
+	if (version_is_s3508 == 2) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x0a;
+	} else if (version_is_s3508 == 0) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x34;
+	} else if (version_is_s3508 == 1) {
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x1b;
+	} else
+		F51_GRIP_CONFIGURATION = F51_CUSTOM_CTRL_BASE+0x0a;
+
+	TPD_DEBUG("%s line %d F51_GRIP_CONFIGURATION = 0x%x\n",
+				__func__, __LINE__, F51_GRIP_CONFIGURATION);
+	//msleep(60);
+	ret = i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x4);
+	limit_mode = i2c_smbus_read_byte_data(ts_g->client,
+						F51_GRIP_CONFIGURATION);
+	TPD_ERR("%s limit_enable =%d,mode:0x%x !\n",
+				__func__, limit_enable, limit_mode);
+	if(limit_mode){
+		i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x4);
+		if(0 == limit_enable)
+		{
+			if(limit_mode & 0x1){
+				//TPD_ERR("000 limit_enable:0x%xs  !\n",limit_mode);
+				limit_mode = limit_mode & 0xFE;
+				ret = i2c_smbus_write_byte_data(ts_g->client,
+					F51_GRIP_CONFIGURATION, limit_mode);
+			}
+		}
+		else if(1 == limit_enable)
+		{
+			if(!(limit_mode & 0x1)){
+				//TPD_ERR("111 limit_enable:x%xs  !\n",limit_mode);
+				limit_mode = limit_mode | 0x1;
+				ret = i2c_smbus_write_byte_data(ts_g->client,
+					F51_GRIP_CONFIGURATION, limit_mode);
+			}
+		}
+	}
+	i2c_smbus_write_byte_data(ts_g->client, 0xff, 0x0);
+}
+
+#endif
+static int synaptics_soft_reset(struct synaptics_ts_data *ts)
+{
+	int ret;
+	if(ts->loading_fw) {
+		TPD_ERR("%s FW is updating break!\n",__func__);
+		return -1;
+	}
+	touch_disable(ts);
+	ret = i2c_smbus_write_byte_data(ts->client, F01_RMI_CMD_BASE, 0x01);
+	if (ret < 0){
+		TPD_ERR("reset error ret=%d\n",ret);
+	}
+	TPD_ERR("%s !!!\n",__func__);
+	msleep(100);
+	touch_enable(ts);
+#ifdef ENABLE_TPEDGE_LIMIT
+	synaptics_tpedge_limitfunc();
+#endif
+	return ret;
+}
+static void synaptics_hard_reset(struct synaptics_ts_data *ts)
+{
+	if(ts->reset_gpio > 0)
+	{
+		gpio_set_value(ts->reset_gpio,0);
+		msleep(5);
+		gpio_set_value(ts->reset_gpio,1);
+		msleep(100);
+		TPD_ERR("%s !!!\n",__func__);
+	}
+
+}
+static int synaptics_parse_dts(struct device *dev, struct synaptics_ts_data *ts)
+{
+	int rc;
+	struct device_node *np;
+	int temp_array[2];
+	u32 voltage_supply[2];
+	u32 current_supply;
+
+	np = dev->of_node;
+	ts->irq_gpio = of_get_named_gpio_flags(np, "synaptics,irq-gpio", 0, &(ts->irq_flags));
+	if( ts->irq_gpio < 0 ){
+		TPD_DEBUG("ts->irq_gpio not specified\n");
+	}
+
+	ts->reset_gpio = of_get_named_gpio(np, "synaptics,reset-gpio", 0);
+	if( ts->reset_gpio < 0 ){
+		TPD_DEBUG("ts->reset-gpio  not specified\n");
+	}
+	ts->v1p8_gpio = of_get_named_gpio(np, "synaptics,1v8-gpio", 0);
+	if( ts->v1p8_gpio < 0 ){
+		TPD_DEBUG("ts->1v8-gpio  not specified\n");
+	}
+
+	if (of_property_read_bool(np, "oem,support_1080x2160_tp"))
+		ts->support_1080x2160_tp = true;
+	else
+		ts->support_1080x2160_tp = false;
+
+	if (of_property_read_bool(np, "oem,support_1080x2340_tp"))
+		ts->support_1080x2340_tp = true;
+	else
+		ts->support_1080x2340_tp = false;
+
+	if(of_property_read_bool(np, "oem,support_hw_poweroff"))
+		ts->support_hw_poweroff=true;
+	else
+		ts->support_hw_poweroff=false;
+
+	TPD_ERR("%s ts->support_hw_poweroff =%d\n",__func__,ts->support_hw_poweroff);
+
+	ts->enable2v8_gpio = of_get_named_gpio(np, "synaptics,enable2v8-gpio", 0);
+	if( ts->enable2v8_gpio < 0 ){
+		TPD_DEBUG("ts->enable2v8_gpio not specified\n");
+	}
+
+	rc = of_property_read_u32(np, "synaptics,max-num-support", &ts->max_num);
+	if(rc){
+		TPD_DEBUG("ts->max_num not specified\n");
+		ts->max_num = 10;
+	}
+
+	rc = of_property_read_u32_array(np, "synaptics,button-map", button_map, 3);
+	if(rc){
+		TPD_DEBUG("button-map not specified\n");
+		//button_map[0] = 180;
+		//button_map[1] = 180;
+		//button_map[2] = 2021;
+	}
+	TPD_DEBUG("synaptics:button map readed is %d %d %d\n", button_map[0], button_map[1], button_map[2]);
+
+	rc = of_property_read_u32_array(np, "synaptics,tx-rx-num", tx_rx_num,2);
+	if(rc){
+		TPD_ERR("button-map not specified\n");
+		TX_NUM =  30;
+		RX_NUM =  17;
+	}else{
+		TX_NUM =  tx_rx_num[0];/*s3706 16 33*/
+		RX_NUM =  tx_rx_num[1];
+	}
+	TPD_ERR("synaptics,tx-rx-num is %d %d \n", TX_NUM,RX_NUM);
+
+	rc = of_property_read_u32_array(np, "synaptics,display-coords", temp_array, 2);
+	if(rc){
+		TPD_ERR("lcd size not specified\n");
+		LCD_WIDTH = 1080;
+		LCD_HEIGHT = 1920;
+	}else{
+		LCD_WIDTH = temp_array[0];
+		LCD_HEIGHT = temp_array[1];
+	}
+
+	rc = of_property_read_u32_array(np, "synaptics,panel-coords", temp_array, 2);
+	if(rc){
+		ts->max_x = 1080;
+		ts->max_y = 1920;
+	}else{
+		ts->max_x = temp_array[0];
+		ts->max_y = temp_array[1];
+	}
+
+	TPDTM_DMESG("synaptic:ts->irq_gpio:%d irq_flags:%u max_num %d\n"\
+        ,ts->irq_gpio, ts->irq_flags, ts->max_num);
+
+	/***********power regulator_get****************/
+	ts->vdd_2v8 = regulator_get(&ts->client->dev, "vdd_2v8");
+	if( IS_ERR(ts->vdd_2v8) ){
+		rc = PTR_ERR(ts->vdd_2v8);
+		TPD_DEBUG("Regulator get failed vdd rc=%d\n", rc);
+	}
+	rc = of_property_read_u32(np,"synaptics,avdd-current", &current_supply);
+	if (rc < 0) {
+		TPD_ERR("%s: Failed to get regulator avdd current\n", __func__);
+
+	} else {
+		ts->regulator_avdd_current = current_supply;
+		TPD_ERR("%s: avdd current = %d\n",
+			__func__, ts->regulator_avdd_current);
+		rc = regulator_set_load(ts->vdd_2v8,
+			ts->regulator_avdd_current);
+		if (rc < 0)
+			TPD_ERR("%s: Failed to set avdd\n", __func__);
+	}
+
+
+	rc = of_property_read_u32_array(np, "synaptics,avdd-voltage", voltage_supply, 2);
+	if (rc < 0) {
+		TPD_ERR("%s: Failed to get regulator vdd voltage\n",__func__);
+	} else {
+		ts->regulator_avdd_vmin = voltage_supply[0];
+		ts->regulator_avdd_vmax = voltage_supply[1];
+		TPD_ERR("%s:avdd_vmin=%d,avdd_vmax=%d\n", __func__,
+			ts->regulator_avdd_vmin, ts->regulator_avdd_vmax);
+
+		rc = regulator_set_voltage(ts->vdd_2v8,
+			ts->regulator_avdd_vmin, ts->regulator_avdd_vmax);
+		if (rc < 0)
+			TPD_ERR("%s:Failed to set avdd\n", __func__);
+	}
+
+
+	ts->vcc_i2c_1v8 = regulator_get(&ts->client->dev, "vcc_i2c_1v8");
+	if( IS_ERR(ts->vcc_i2c_1v8) ){
+		rc = PTR_ERR(ts->vcc_i2c_1v8);
+		TPD_DEBUG("Regulator get failed vcc_i2c rc=%d\n", rc);
+	}
+
+	rc = of_property_read_u32(np,"synaptics,vdd-current", &current_supply);
+	if (rc < 0) {
+		TPD_ERR("%s: Failed to get regulator vdd current\n", __func__);
+	} else {
+		ts->regulator_vdd_current = current_supply;
+		TPD_ERR("%s: vdd current = %d\n", __func__,
+				ts->regulator_vdd_current);
+		rc = regulator_set_load(ts->vcc_i2c_1v8,
+			ts->regulator_vdd_current);
+		if (rc < 0)
+			TPD_ERR("%s: Failed to set vdd\n", __func__);
+	}
+
+
+	rc = of_property_read_u32_array(np, "synaptics,vdd-voltage", voltage_supply, 2);
+	if (rc < 0) {
+		TPD_ERR("%s: Failed to get regulator vdd voltage\n", __func__);
+	} else {
+		ts->regulator_vdd_vmin = voltage_supply[0];
+		ts->regulator_vdd_vmax = voltage_supply[1];
+		TPD_ERR("%s:vdd_vmin=%d,vdd_vmax=%d\n", __func__,
+			ts->regulator_vdd_vmin, ts->regulator_vdd_vmax);
+
+		rc = regulator_set_voltage(ts->vcc_i2c_1v8,
+				ts->regulator_vdd_vmin, ts->regulator_vdd_vmax);
+		if (rc < 0)
+			TPD_ERR("%s:Failed to set vdd\n", __func__);
+	}
+
+
+
+	if( ts->reset_gpio > 0){
+		if( gpio_is_valid(ts->reset_gpio) ){
+			rc = gpio_request(ts->reset_gpio, "tp-s3320-reset");
+			if(rc){
+				TPD_ERR("unable to request reset_gpio [%d]\n", ts->reset_gpio);
+			}
+			gpio_direction_output(ts->reset_gpio, 0);
+		}
+	}
+	if( ts->v1p8_gpio > 0){
+		if( gpio_is_valid(ts->v1p8_gpio) ){
+			rc = gpio_request(ts->v1p8_gpio, "tp-s3320-1v8");
+			if(rc){
+				TPD_ERR("unable to request v1p8_gpio [%d]\n", ts->v1p8_gpio);
+			}
+		}
+	}
+
+	if( ts->enable2v8_gpio > 0){
+		if( gpio_is_valid(ts->enable2v8_gpio) ){
+			rc = gpio_request(ts->enable2v8_gpio, "rmi4-enable2v8-gpio");
+			if(rc)
+				TPD_ERR("unable to request enable2v8_gpio [%d]\n", ts->enable2v8_gpio);
+
+		}
+	}
+
+	return rc;
+}
+
+static int synaptics_dsx_pinctrl_init(struct synaptics_ts_data *ts)
+{
+	int retval;
+
+	/* Get pinctrl if target uses pinctrl */
+	ts->pinctrl = devm_pinctrl_get((ts->dev));
+	if (IS_ERR_OR_NULL(ts->pinctrl)) {
+		retval = PTR_ERR(ts->pinctrl);
+        TPD_ERR("%s pinctrl error!\n",__func__);
+		goto err_pinctrl_get;
+	}
+
+	ts->pinctrl_state_active
+		= pinctrl_lookup_state(ts->pinctrl, "pmx_ts_active");
+	if (IS_ERR_OR_NULL(ts->pinctrl_state_active)) {
+		retval = PTR_ERR(ts->pinctrl_state_active);
+        TPD_ERR("%s pinctrl state active error!\n",__func__);
+		goto err_pinctrl_lookup;
+	}
+
+	ts->pinctrl_state_suspend
+		= pinctrl_lookup_state(ts->pinctrl, "pmx_ts_suspend");
+	if (IS_ERR_OR_NULL(ts->pinctrl_state_suspend)) {
+		retval = PTR_ERR(ts->pinctrl_state_suspend);
+        TPD_ERR("%s pinctrl state suspend error!\n",__func__);
+		goto err_pinctrl_lookup;
+	}
+	return 0;
+
+err_pinctrl_lookup:
+	devm_pinctrl_put(ts->pinctrl);
+err_pinctrl_get:
+	ts->pinctrl = NULL;
+	return retval;
+}
+
+#ifdef SUPPORT_VIRTUAL_KEY
+#define VK_KEY_X    180
+#define VK_CENTER_Y 2020//2260
+#define VK_WIDTH    170
+#define VK_HIGHT    200
+static ssize_t vk_syna_show(struct kobject *kobj,
+        struct kobj_attribute *attr, char *buf)
+{
+	int len ;
+
+	len =  sprintf(buf,
+	    __stringify(EV_KEY) ":" __stringify(KEY_APPSELECT)  ":%d:%d:%d:%d"
+	    ":" __stringify(EV_KEY) ":" __stringify(KEY_HOMEPAGE)  ":%d:%d:%d:%d"
+	    ":" __stringify(EV_KEY) ":" __stringify(KEY_BACK)  ":%d:%d:%d:%d" "\n",
+	    VK_KEY_X,   VK_CENTER_Y, VK_WIDTH, VK_HIGHT,
+	    VK_KEY_X*3, VK_CENTER_Y, VK_WIDTH, VK_HIGHT,
+	    VK_KEY_X*5, VK_CENTER_Y, VK_WIDTH, VK_HIGHT);
+
+	return len ;
+}
+
+static struct kobj_attribute vk_syna_attr = {
+    .attr = {
+        .name = "virtualkeys."TPD_DEVICE,
+        .mode = S_IRUGO,
+    },
+    .show = &vk_syna_show,
+};
+
+static struct attribute *syna_properties_attrs[] = {
+    &vk_syna_attr.attr,
+    NULL
+};
+
+static struct attribute_group syna_properties_attr_group = {
+    .attrs = syna_properties_attrs,
+};
+static int synaptics_ts_init_virtual_key(struct synaptics_ts_data *ts )
+{
+	int ret = 0;
+
+	/* virtual keys */
+	if(ts->properties_kobj)
+		return 0 ;
+	ts->properties_kobj = kobject_create_and_add("board_properties", NULL);
+	if (ts->properties_kobj)
+		ret = sysfs_create_group(ts->properties_kobj, &syna_properties_attr_group);
+
+	if (!ts->properties_kobj || ret)
+		printk("%s: failed to create board_properties\n", __func__);
+	/* virtual keys */
+	return ret;
+}
+#endif
+
+static int synaptics_ts_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+#ifdef CONFIG_SYNAPTIC_RED
+	struct remotepanel_data *premote_data = NULL;
+#endif
+	struct synaptics_ts_data *ts = NULL;
+	int ret = -1;
+	uint8_t buf[8];
+	unsigned long int  CURRENT_FIRMWARE_ID = 0;
+	uint32_t bootloader_mode;
+	//uint32_t bootmode;
+
+	TPD_ERR("%s  is called\n",__func__);
+
+	ts = kzalloc(sizeof(struct synaptics_ts_data), GFP_KERNEL);
+	if( ts == NULL ) {
+		ret = -ENOMEM;
+		goto err_alloc_data_failed;
+	}
+
+	ts->client = client;
+	i2c_set_clientdata(client, ts);
+	ts->dev = &client->dev;
+	ts->loading_fw = false;
+	ts->support_ft = true;
+	ts_g = ts;
+	get_tp_base = 0;
+
+	synaptics_parse_dts(&client->dev, ts);
+	ts->project_version = 0x03;
+	if (of_property_read_bool(ts->dev->of_node, "oem,fajta"))
+		ts->project_version = 0x03;
+	/***power_init*****/
+	ret = tpd_power(ts, 1);
+	if( ret < 0 )
+		TPD_ERR("regulator_enable is called\n");
+	ret = synaptics_dsx_pinctrl_init(ts);
+	if (!ret && ts->pinctrl) {
+		ret = pinctrl_select_state(ts->pinctrl,
+                ts->pinctrl_state_active);
+	}
+
+	msleep(100);//after power on tp need sometime from bootloader to ui mode
+	mutex_init(&ts->mutex);
+	mutex_init(&ts->mutexreport);
+	atomic_set(&ts->irq_enable,0);
+
+	ts->is_suspended = 0;
+	atomic_set(&ts->is_stop,0);
+	spin_lock_init(&ts->lock);
+	/*****power_end*********/
+	if( !i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA) ){
+		TPD_ERR("%s [ERR]need I2C_FUNC_I2C\n", __func__);
+		ret = -ENODEV;
+		goto err_check_functionality_failed;
+	}
+
+	ret = synaptics_rmi4_i2c_read_byte(client, 0x13);
+	if( ret < 0 ) {
+		ret = synaptics_rmi4_i2c_read_byte(client, 0x13);
+		if( ret < 0 ) {
+		#ifdef SUPPORT_VIRTUAL_KEY
+                        virtual_key_enable = 0;//if touch is no valid report key
+                #endif
+                        TPD_ERR("tp is no exist!\n");
+			goto err_check_functionality_failed;
+		}
+	}
+
+	ts->i2c_device_test = ret;
+	rmi4_data_s3706 = kzalloc(sizeof(struct synaptics_rmi4_data),
+							GFP_KERNEL);
+	if (rmi4_data_s3706 == NULL) {
+		TPD_ERR("Request rmi4_data_s3706 failed\n");
+		goto err_check_functionality_failed;
+	}
+	rmi4_data_s3706->reset_device = synaptics_rmi4_reset_device;
+	mutex_init(&(rmi4_data_s3706->rmi4_reset_mutex));
+	mutex_init(&(rmi4_data_s3706->rmi4_report_mutex));
+	mutex_init(&(rmi4_data_s3706->rmi4_io_ctrl_mutex));
+	mutex_init(&(rmi4_data_s3706->rmi4_exp_init_mutex));
+	mutex_init(&(rmi4_data_s3706->rmi4_irq_enable_mutex));
+
+	synaptics_read_register_map(ts);
+	bootloader_mode = synaptics_rmi4_i2c_read_byte(ts->client, F01_RMI_DATA_BASE);
+
+	bootloader_mode = bootloader_mode&0x40;
+	TPD_ERR("before fw update bootloader_mode[0x%x]\n", bootloader_mode);
+
+	memset(ts->fw_name, 0, TP_FW_NAME_MAX_LEN);
+	memset(ts->test_limit_name, 0, TP_FW_NAME_MAX_LEN);
+
+	//sprintf(ts->manu_name, "TP_SYNAPTICS");
+	synaptics_rmi4_i2c_read_block(ts->client, F01_RMI_QUERY11,\
+        sizeof(ts->manu_name), ts->manu_name);
+	if (!strncmp(ts->manu_name,"S3718",5)){
+		strcpy(ts->fw_name,"tp/fw_synaptics_15801b.img");
+		version_is_s3508 = 0;
+	} else if (!strncmp(ts->manu_name, "S3706", 5)) {
+		strlcpy(ts->fw_name, "tp/fw_synaptics_17819.img",
+			sizeof(ts->fw_name));
+		version_is_s3508 = 2;/*for s3706*/
+		TX_NUM =  16;/*s3706 16 33*/
+		RX_NUM =  33;
+		if (ts->support_1080x2340_tp) {
+			strlcpy(ts->fw_name, "tp/fw_synaptics_18801.img",
+			    sizeof(ts->fw_name));
+			ts->max_x = 1080;
+			ts->max_y = 2340;
+		} else {
+			ts->max_x = 1080;
+			ts->max_y = 2280;
+		}
+		F12_2D_CTRL20 = F12_2D_CTRL_BASE + 0x06;/*0x07 for s3508*/
+		F12_2D_CTRL27 = F12_2D_CTRL_BASE + 0x09;
+	} else {
+		if (ts->support_1080x2160_tp)
+			strlcpy(ts->fw_name, "tp/fw_synaptics_17801.img",
+			    sizeof(ts->fw_name));
+		else
+			strlcpy(ts->fw_name, "tp/fw_synaptics_16859.img",
+			    sizeof(ts->fw_name));
+
+		version_is_s3508 = 1;
+	}
+	strcpy(ts->test_limit_name,"tp/14049/14049_Limit_jdi.img");
+
+	TPD_DEBUG("synatpitcs fw_name=%s\n",
+		ts->fw_name);
+	TPD_DEBUG("synatpitcs manu_name:%s\n",
+		ts->manu_name);
+
+	synaptics_rmi4_i2c_read_block(ts->client,
+		F34_FLASH_CTRL00, 8, buf);
+	CURRENT_FIRMWARE_ID = (buf[0]<<24) | (buf[1]<<16) |
+						(buf[2]<<8) | buf[3];
+	if (version_is_s3508 == 2)
+		CURRENT_FIRMWARE_ID = CURRENT_FIRMWARE_ID << 32 |
+				((buf[4]<<24) | (buf[5]<<16) |
+				(buf[6]<<8) | buf[7]);
+	TPD_ERR("CURRENT_FIRMWARE_ID = 0x%lx\n",
+			CURRENT_FIRMWARE_ID);
+	TP_FW = CURRENT_FIRMWARE_ID;
+	snprintf(ts->fw_id,  20, "0x%lx", TP_FW);
+
+	//push_component_info(TOUCH_KEY, ts->fw_id, ts->manu_name);
+	//push_component_info(TP, ts->fw_id, ts->manu_name);
+
+	synaptics_wq = create_singlethread_workqueue("synaptics_wq");
+	if( !synaptics_wq ){
+		ret = -ENOMEM;
+		goto exit_createworkqueue_failed;
+	}
+	INIT_DELAYED_WORK(&ts->speed_up_work,speedup_synaptics_resume);
+
+
+	memset(baseline,0,sizeof(baseline));
+	get_base_report = create_singlethread_workqueue("get_base_report");
+	if( !get_base_report ){
+		ret = -ENOMEM;
+		goto exit_createworkqueue_failed;
+	}
+	INIT_DELAYED_WORK(&ts->base_work,tp_baseline_get_work);
+
+	ret = synaptics_init_panel(ts); /* will also switch back to page 0x04 */
+	if (ret < 0) {
+		TPD_ERR("synaptics_init_panel failed\n");
+	}
+
+	//Detect whether TP FW is error, max_x,max_y may be incoorect while it has been damaged!
+	ret = synaptics_fw_check(ts);
+	if(ret < 0 ) {
+		force_update = 1;
+		TPD_ERR("This FW need to be updated!\n");
+	} else {
+		force_update = 0;
+	}
+	/*disable interrupt*/
+	ret = synaptics_enable_interrupt(ts, 0);
+	if( ret < 0 ) {
+		TPD_ERR(" synaptics_ts_probe: disable interrupt failed\n");
+	}
+	ret = synaptics_soft_reset(ts);
+	if (ret < 0){
+		TPD_ERR("%s faile to reset device\n",__func__);
+	}
+	ret = synaptics_input_init(ts);
+	if(ret < 0) {
+		TPD_ERR("synaptics_input_init failed!\n");
+	}
+#if defined(CONFIG_FB)
+	ts->fb_notif.notifier_call = fb_notifier_callback;
+	ret = fb_register_client(&ts->fb_notif);
+	if(ret)
+		TPD_ERR("Unable to register fb_notifier: %d\n", ret);
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	ts->msm_drm_notif.notifier_call = msm_drm_notifier_callback;
+	ret = msm_drm_register_client(&ts->msm_drm_notif);
+	if (ret)
+		TPD_ERR("Unable to register msm_drm_notifier: %d\n", ret);
+#endif
+
+
+
+#ifndef TPD_USE_EINT
+	hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+	ts->timer.function = synaptics_ts_timer_func;
+	hrtimer_start(&ts->timer, ktime_set(3, 0), HRTIMER_MODE_REL);
+#endif
+
+#ifdef TPD_USE_EINT
+	/****************
+	  shoud set the irq GPIO
+	 *******************/
+	if (gpio_is_valid(ts->irq_gpio)) {
+        /* configure touchscreen irq gpio */
+        ret = gpio_request(ts->irq_gpio,"tp-s3320-irq");
+        if (ret) {
+            TPD_ERR("unable to request gpio [%d]\n",ts->irq_gpio);
+        }
+        ret = gpio_direction_input(ts->irq_gpio);
+        msleep(50);
+        ts->irq = gpio_to_irq(ts->irq_gpio);
+	}
+	TPD_ERR("synaptic:ts->irq is %d\n",ts->irq);
+
+	ret = request_threaded_irq(ts->irq, NULL,
+			synaptics_irq_thread_fn,
+			ts->irq_flags | IRQF_ONESHOT,
+			TPD_DEVICE, ts);
+	if(ret < 0)
+		TPD_ERR("%s request_threaded_irq ret is %d\n",__func__,ret);
+	msleep(5);
+	ret = synaptics_enable_interrupt(ts, 1);
+	if(ret < 0)
+		TPD_ERR("%s enable interrupt error ret=%d\n",__func__,ret);
+#endif
+
+	if (device_create_file(&client->dev, &dev_attr_test_limit)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	TPD_DEBUG("synaptics_ts_probe: going to create files--tp_fw_update\n");
+	if (device_create_file(&client->dev, &dev_attr_tp_fw_update)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if (device_create_file(&client->dev, &dev_attr_tp_doze_time)) {
+		TPDTM_DMESG("device_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if( driver_create_file(&tpd_i2c_driver.driver, &driver_attr_tp_debug_log)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if (driver_create_file(&tpd_i2c_driver.driver, &driver_attr_tp_baseline_image_with_cbc)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if( driver_create_file(&tpd_i2c_driver.driver, &driver_attr_tp_baseline_image)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if( driver_create_file(&tpd_i2c_driver.driver, &driver_attr_tp_delta_image)) {
+		TPDTM_DMESG("driver_create_file failt\n");
+		goto exit_init_failed;
+	}
+	if (ts->project_version == 0x03) {
+		if (device_create_file(&client->dev,
+			&dev_attr_tp_gesture_touch_hold)) {
+			TPDTM_DMESG("tp_gesture_touch_hold failt\n");
+			goto exit_init_failed;
+		}
+		if (device_create_file(&client->dev, &dev_attr_fp_irq)) {
+			TPDTM_DMESG("driver_create_file fail fp_irq\n");
+			goto exit_init_failed;
+		}
+		ts->fp_up_down = 0;
+		ts->en_up_down = 0;
+		ts->fp_aod_cnt = 0;
+		ts->unlock_succes = 0;
+	}
+
+#ifdef SUPPORT_VIRTUAL_KEY
+	synaptics_ts_init_virtual_key(ts);
+#endif
+#ifdef CONFIG_SYNAPTIC_RED
+	premote_data = remote_alloc_panel_data();
+	if(premote_data) {
+		premote_data->client 		= client;
+		premote_data->input_dev		= ts->input_dev;
+		premote_data->pmutex		= &ts->mutex;
+		premote_data->irq_gpio 		= ts->irq_gpio;
+		premote_data->irq			= client->irq;
+		premote_data->enable_remote = &(ts->enable_remote);
+		register_remote_device(premote_data);
+
+	}
+#endif
+	init_synaptics_proc();
+	TPDTM_DMESG("synaptics_ts_probe 3203: normal end\n");
+/*
+	bootmode = get_boot_mode();
+	TPD_ERR("synaptics bootmode %d  !\n", bootmode);
+	if ((bootmode == MSM_BOOT_MODE__FACTORY)
+		|| (bootmode == MSM_BOOT_MODE__RF)
+		|| (bootmode == MSM_BOOT_MODE__WLAN)) {
+		touch_disable(ts);
+		TPD_ERR("synaptics ftm mode disable int \n");
+		return 0;
+	}
+*/
+	return 0;
+
+exit_init_failed:
+	free_irq(client->irq,ts);
+exit_createworkqueue_failed:
+	destroy_workqueue(synaptics_wq);
+	synaptics_wq = NULL;
+	destroy_workqueue(synaptics_report);
+	synaptics_report = NULL;
+	destroy_workqueue(get_base_report);
+	get_base_report = NULL;
+
+err_check_functionality_failed:
+	tpd_power(ts, 0);
+	/*add for morgan for if no tp no pull gpio*/
+	if (ts->pinctrl) {
+		ret = pinctrl_select_state(ts->pinctrl,
+				ts->pinctrl_state_suspend);
+	}
+err_alloc_data_failed:
+	tpd_i2c_driver.driver.pm=NULL;
+	kfree(ts);
+	ts = NULL;
+	kfree(rmi4_data_s3706);
+	rmi4_data_s3706 = NULL;
+	ts_g = NULL;
+	TPD_ERR("synaptics_ts_probe: not normal end\n");
+	return ret;
+}
+
+static int synaptics_ts_remove(struct i2c_client *client)
+{
+	int attr_count;
+	struct synaptics_ts_data *ts = i2c_get_clientdata(client);
+
+	TPD_ERR("%s is called\n",__func__);
+#ifdef CONFIG_SYNAPTIC_RED
+	unregister_remote_device();
+#endif
+
+#if defined(CONFIG_FB)
+	if( fb_unregister_client(&ts->fb_notif) )
+		dev_err(&client->dev, "Error occurred while unregistering fb_notifier.\n");
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	if (msm_drm_unregister_client(&ts->msm_drm_notif))
+		dev_err(&client->dev, "Error occurred while unregistering msm_drm_notifier.\n");
+#endif
+
+#ifndef TPD_USE_EINT
+	hrtimer_cancel(&ts->timer);
+#endif
+
+	for(attr_count = 0; attr_count < ARRAY_SIZE(attrs_oem); attr_count++){
+		sysfs_remove_file(&ts->input_dev->dev.kobj, &attrs_oem[attr_count].attr);
+	}
+	input_unregister_device(ts->input_dev);
+	input_free_device(ts->input_dev);
+	kfree(ts);
+	tpd_power(ts,0);
+	return 0;
+}
+
+static int synaptics_ts_suspend(struct device *dev)
+{
+	int ret,i;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	if(ts->input_dev == NULL) {
+		ret = -ENOMEM;
+		TPD_ERR("input_dev  registration is not complete\n");
+		return -1;
+	}
+	TPD_DEBUG("%s enter\n", __func__);
+
+	if (ts->pre_btn_state & 0x01){//if press key and suspend release key
+		ts->pre_btn_state &= 0x02;//clear bit0
+		input_report_key(ts->input_dev, OEM_KEY_BACK, 0);
+		input_sync(ts->input_dev);
+	}else if (ts->pre_btn_state & 0x02){
+		ts->pre_btn_state &= 0x01;//clear bit1
+		input_report_key(ts->input_dev, OEM_KEY_APPSELECT, 0);
+		input_sync(ts->input_dev);
+	}
+	for (i = 0; i < ts->max_num; i++)
+	{
+		input_mt_slot(ts->input_dev, i);
+		input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+	}
+	input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+	input_sync(ts->input_dev);
+
+#ifndef TPD_USE_EINT
+	hrtimer_cancel(&ts->timer);
+#endif
+
+#ifdef SUPPORT_GESTURE
+	if( ts->gesture_enable ){
+		atomic_set(&ts->is_stop,0);
+		if (mutex_trylock(&ts->mutex)){
+			touch_enable(ts);
+			synaptics_enable_interrupt_for_gesture(ts, 1);
+			mutex_unlock(&ts->mutex);
+			TPD_ERR("enter gesture mode\n");
+		}
+		set_doze_time(2);
+		//just for fajita
+		if (ts->project_version == 0x03)
+			mutex_lock(&ts->mutex);
+			tp_single_tap_en(ts, true);
+			mutex_unlock(&ts->mutex);
+	}
+	else{
+		if (!ts->loading_fw) {
+			//loading_fw tp cannot enter sleep mode;
+			ret = synaptics_mode_change(0x01);
+			//when gesture disable TP sleep eary
+			if (ret < 0) {
+				TPD_ERR("%s line%d ERROR %d!\n",
+					__func__, __LINE__, ret);
+			}
+		}
+	}
+#endif
+	TPD_DEBUG("%s normal end\n", __func__);
+	return 0;
+}
+
+static void speedup_synaptics_resume(struct work_struct *work)
+{
+	int ret;
+	struct synaptics_ts_data *ts = ts_g;
+
+/*#ifdef SUPPORT_SLEEP_POWEROFF*/
+	TPD_DEBUG("%s enter!\n", __func__);
+	if (ts->support_hw_poweroff) {
+		if (ts->gesture_enable == 0) {
+		ret = tpd_power(ts, 1);
+		if (ret < 0)
+		TPD_ERR("%s power on err\n", __func__);
+		if (ts->pinctrl) {
+			ret = pinctrl_select_state(ts->pinctrl,
+				ts->pinctrl_state_active);
+		}
+		}
+	}
+	TPD_DEBUG("%s end!\n", __func__);
+/*#endif*/
+}
+
+static int synaptics_ts_resume(struct device *dev)
+{
+	int ret;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+	int i;
+
+	TPD_DEBUG("%s enter!\n", __func__);
+
+	if(ts->loading_fw) {
+		TPD_ERR("%s FW is updating break!\n",__func__);
+		return -1;
+	}
+
+	if(ts->input_dev == NULL) {
+		ret = -ENOMEM;
+		TPD_ERR("input_dev  registration is not complete\n");
+		goto ERR_RESUME;
+	}
+	for (i = 0; i < ts->max_num; i++)
+	{
+		input_mt_slot(ts->input_dev, i);
+		input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 1);
+		input_mt_slot(ts->input_dev, i);
+		input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, 0);
+	}
+	input_report_key(ts->input_dev, BTN_TOOL_FINGER, 0);
+	input_sync(ts->input_dev);
+
+    //touch_enable(ts);
+
+	TPD_DEBUG("%s:normal end!\n", __func__);
+ERR_RESUME:
+	return 0;
+}
+
+static int synaptics_i2c_suspend(struct device *dev)
+{
+	int ret;
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	TPD_DEBUG("%s: is called\n", __func__);
+	if (ts->gesture_enable == 1){
+		/*enable gpio wake system through intterrupt*/
+		enable_irq_wake(ts->irq);
+	}
+//#ifdef SUPPORT_SLEEP_POWEROFF
+	if(ts->loading_fw) {
+		TPD_ERR("FW is updating while suspending");
+		return -1;
+	}
+    if(ts->support_hw_poweroff && (ts->gesture_enable == 0)){
+	    ret = tpd_power(ts,0);
+	    if (ret < 0)
+	        TPD_ERR("%s power off err\n",__func__);
+		if (ts->pinctrl){
+			ret = pinctrl_select_state(ts->pinctrl,
+					ts->pinctrl_state_suspend);
+		}
+	}
+//#endif
+	return 0;
+}
+
+static int synaptics_i2c_resume(struct device *dev)
+{
+	struct synaptics_ts_data *ts = dev_get_drvdata(dev);
+
+	TPD_DEBUG("%s is called\n", __func__);
+    queue_delayed_work(synaptics_wq,&ts->speed_up_work, msecs_to_jiffies(1));
+	if (ts->gesture_enable == 1){
+		/*disable gpio wake system through intterrupt*/
+		disable_irq_wake(ts->irq);
+	}
+	return 0;
+}
+
+static int synaptics_mode_change(int mode)
+{
+	int ret;
+	int tmp_mode;
+	tmp_mode = i2c_smbus_read_byte_data(ts_g->client, F01_RMI_CTRL00);
+	tmp_mode = tmp_mode & 0xF8;//bit0-bit2(mode)
+	tmp_mode = tmp_mode | mode;
+	if (ts_g->changer_connet)
+		tmp_mode = tmp_mode | 0x20;//set bit6(change status)
+	else
+		tmp_mode = tmp_mode & 0xDF;//clear bit6(change status)
+	TPD_DEBUG("%s: set TP to mode[0x%x]\n", __func__,tmp_mode);
+	ret = i2c_smbus_write_byte_data(ts_g->client, F01_RMI_CTRL00, tmp_mode);
+	if(ret<0)
+		TPD_ERR("%s: set dose mode[0x%x] err!!\n", __func__,tmp_mode);
+	return ret;
+}
+#if defined(CONFIG_FB)
+static int fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data)
+{
+	struct fb_event *evdata = data;
+	int *blank;
+	static int gesture_flag;
+
+	struct synaptics_ts_data *ts = container_of(self, struct synaptics_ts_data, fb_notif);
+
+	if(FB_EARLY_EVENT_BLANK != event && FB_EVENT_BLANK != event)
+	return 0;
+	if((evdata) && (evdata->data) && (ts) && (ts->client))
+	{
+		blank = evdata->data;
+		TPD_DEBUG("%s blank[%d],event[0x%lx]\n", __func__,*blank,event);
+
+		if ((*blank == FB_BLANK_UNBLANK)
+		 && (event == FB_EARLY_EVENT_BLANK)) {
+			if (gesture_flag == 1) {
+				ts->gesture_enable = 0;
+				DouTap_gesture = 0;
+				synaptics_enable_interrupt_for_gesture(ts, 0);
+				set_doze_time(1);
+				gesture_flag = 0;
+			} else if (gesture_flag == 2) {
+				DouTap_gesture = 0;
+				gesture_flag = 0;
+			}
+			if (ts->is_suspended == 1)
+			{
+				TPD_DEBUG("%s going TP resume start\n", __func__);
+				ts->is_suspended = 0;
+				queue_delayed_work(get_base_report, &ts->base_work,msecs_to_jiffies(80));
+				synaptics_ts_resume(&ts->client->dev);
+				//atomic_set(&ts->is_stop,0);
+				TPD_DEBUG("%s going TP resume end\n", __func__);
+			}
+		} else if (*blank == FB_BLANK_NORMAL) {
+			if (ts->gesture_enable == 0) {
+				DouTap_gesture = 1;
+				ts->gesture_enable = 1;
+				i2c_smbus_write_byte_data(ts->client, 0xff, 0x0);
+				synaptics_mode_change(0x80);
+				synaptics_ts_suspend(&ts->client->dev);
+				gesture_flag = 1;
+			} else if ((ts->gesture_enable == 1) && (DouTap_gesture == 0)) {
+				DouTap_gesture = 1;
+				gesture_flag = 2;
+			}
+		}else if( *blank == FB_BLANK_POWERDOWN && (event == FB_EARLY_EVENT_BLANK )){
+			if (gesture_flag == 1) {
+				ts->gesture_enable = 0;
+				DouTap_gesture = 0;
+				synaptics_enable_interrupt_for_gesture(ts, 0);
+				set_doze_time(1);
+				ts->is_suspended = 0;
+				gesture_flag = 0;
+			} else if (gesture_flag == 2) {
+				DouTap_gesture = 0;
+				ts->is_suspended = 0;
+				gesture_flag = 0;
+			}
+			if (ts->is_suspended == 0){
+				TPD_DEBUG("%s : going TP suspend start\n", __func__);
+				ts->is_suspended = 1;
+				atomic_set(&ts->is_stop,1);
+				if (!(ts->gesture_enable))
+					touch_disable(ts);
+				synaptics_ts_suspend(&ts->client->dev);
+				TPD_DEBUG("%s : going TP suspend end\n", __func__);
+			}
+		}
+	}
+	return 0;
+}
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+static int msm_drm_notifier_callback(
+	struct notifier_block *self, unsigned long event, void *data)
+{
+	struct msm_drm_notifier *evdata = data;
+	int *blank;
+
+	struct synaptics_ts_data *ts = container_of(
+		self, struct synaptics_ts_data, msm_drm_notif);
+
+	if (event != MSM_DRM_EARLY_EVENT_BLANK
+		&& MSM_DRM_EVENT_BLANK != event)
+	return 0;
+	/*add for morgan for EID447*/
+	if (evdata->id != MSM_DRM_PRIMARY_DISPLAY)
+	return 0;
+	if ((evdata) && (evdata->data) && (ts) && (ts->client)) {
+		blank = evdata->data;
+		TPD_ERR("%s blank[%d],event[0x%lx],evdata->id[%d]\n",
+			__func__, *blank, event, evdata->id);
+
+		if ((*blank == MSM_DRM_BLANK_UNBLANK_CUST)
+		&& (event == MSM_DRM_EARLY_EVENT_BLANK)) {
+			if (ts->is_suspended == 1) {
+				TPD_DEBUG("%s TP resume start\n", __func__);
+				ts->is_suspended = 0;
+				queue_delayed_work(get_base_report,
+					&ts->base_work, msecs_to_jiffies(80));
+				synaptics_ts_resume(&ts->client->dev);
+				//atomic_set(&ts->is_stop,0);
+				TPD_DEBUG("%sTP resume end\n", __func__);
+			}
+		} else if (((*blank == MSM_DRM_BLANK_POWERDOWN_CUST)
+			&& (event == MSM_DRM_EARLY_EVENT_BLANK))
+			|| (*blank == MSM_DRM_BLANK_NORMAL)) {
+			if (ts->is_suspended == 0) {
+				TPD_DEBUG("%s:TP suspend start\n", __func__);
+				ts->is_suspended = 1;
+				atomic_set(&ts->is_stop, 1);
+				cancel_delayed_work_sync(&ts->base_work);
+				flush_workqueue(get_base_report);
+				if (!(ts->gesture_enable))
+					touch_disable(ts);
+				synaptics_ts_suspend(&ts->client->dev);
+				TPD_DEBUG("%s:TP suspend end\n", __func__);
+			}
+		}
+	}
+	return 0;
+
+
+}
+#endif
+
+static int __init tpd_driver_init(void)
+{
+	TPD_ERR("%s enter\n", __func__);
+	if( i2c_add_driver(&tpd_i2c_driver)!= 0 ){
+		TPD_ERR("unable to add i2c driver.\n");
+		return -1;
+	}
+	return 0;
+}
+
+/* should never be called */
+static void __exit tpd_driver_exit(void)
+{
+	i2c_del_driver(&tpd_i2c_driver);
+	if(synaptics_wq ){
+		destroy_workqueue(synaptics_wq);
+		synaptics_wq = NULL;
+	}
+	return;
+}
+
+module_init(tpd_driver_init);
+module_exit(tpd_driver_exit);
+
+MODULE_DESCRIPTION("Synaptics S3203 Touchscreen Driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/input/touchscreen/synaptics_dsx_core.h b/drivers/input/touchscreen/synaptics_dsx_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..82b0852a1f1e349e738e4ffb60e3eba4007980ea
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_dsx_core.h
@@ -0,0 +1,554 @@
+/*
+ * Synaptics DSX touchscreen driver
+ *
+ * Copyright (C) 2012-2016 Synaptics Incorporated. All rights reserved.
+ *
+ * Copyright (C) 2012 Alexandra Chin <alexandra.chin@tw.synaptics.com>
+ * Copyright (C) 2012 Scott Lin <scott.lin@tw.synaptics.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * INFORMATION CONTAINED IN THIS DOCUMENT IS PROVIDED "AS-IS," AND SYNAPTICS
+ * EXPRESSLY DISCLAIMS ALL EXPRESS AND IMPLIED WARRANTIES, INCLUDING ANY
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE,
+ * AND ANY WARRANTIES OF NON-INFRINGEMENT OF ANY INTELLECTUAL PROPERTY RIGHTS.
+ * IN NO EVENT SHALL SYNAPTICS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ * SPECIAL, PUNITIVE, OR CONSEQUENTIAL DAMAGES ARISING OUT OF OR IN CONNECTION
+ * WITH THE USE OF THE INFORMATION CONTAINED IN THIS DOCUMENT, HOWEVER CAUSED
+ * AND BASED ON ANY THEORY OF LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * NEGLIGENCE OR OTHER TORTIOUS ACTION, AND EVEN IF SYNAPTICS WAS ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGE. IF A TRIBUNAL OF COMPETENT JURISDICTION DOES
+ * NOT PERMIT THE DISCLAIMER OF DIRECT DAMAGES OR ANY OTHER DAMAGES, SYNAPTICS'
+ * TOTAL CUMULATIVE LIABILITY TO ANY PARTY SHALL NOT EXCEED ONE HUNDRED U.S.
+ * DOLLARS.
+ */
+
+#ifndef _SYNAPTICS_DSX_RMI4_H_
+#define _SYNAPTICS_DSX_RMI4_H_
+
+#define SYNAPTICS_DS4 (1 << 0)
+#define SYNAPTICS_DS5 (1 << 1)
+#define SYNAPTICS_DSX_DRIVER_PRODUCT (SYNAPTICS_DS4 | SYNAPTICS_DS5)
+#define SYNAPTICS_DSX_DRIVER_VERSION 0x206a
+
+#include <linux/version.h>
+/*delete by morgan.gu for sdm845 */
+#undef CONFIG_FB
+
+#ifdef CONFIG_FB
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#endif
+#ifdef CONFIG_HAS_EARLYSUSPEND
+#include <linux/earlysuspend.h>
+#endif
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/types.h>
+#include <linux/of_gpio.h>
+#include <linux/platform_device.h>
+#include <linux/input/synaptics_dsx.h>
+
+#if (KERNEL_VERSION(2, 6, 38) < LINUX_VERSION_CODE)
+#define KERNEL_ABOVE_2_6_38
+#endif
+
+#if (KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE)
+#define KERNEL_ABOVE_3_6
+#endif
+
+#ifdef KERNEL_ABOVE_2_6_38
+#define sstrtoul(...) kstrtoul(__VA_ARGS__)
+#else
+#define sstrtoul(...) kstrtoul(__VA_ARGS__)
+#endif
+/*
+ *#define F51_DISCRETE_FORCE
+ *#ifdef F51_DISCRETE_FORCE
+ *#define FORCE_LEVEL_ADDR 0x0419
+ *#define FORCE_LEVEL_MAX 255
+ *#define CAL_DATA_SIZE 144
+ *#endif
+ */
+
+#define PDT_PROPS (0X00EF)
+#define PDT_START (0x00E9)
+#define PDT_END (0x00D0)
+#define PDT_ENTRY_SIZE (0x0006)
+#define PAGES_TO_SERVICE (10)
+#define PAGE_SELECT_LEN (2)
+#define ADDRESS_LEN (2)
+
+#define SYNAPTICS_RMI4_F01 (0x01)
+#define SYNAPTICS_RMI4_F11 (0x11)
+#define SYNAPTICS_RMI4_F12 (0x12)
+#define SYNAPTICS_RMI4_F1A (0x1A)
+#define SYNAPTICS_RMI4_F21 (0x21)
+#define SYNAPTICS_RMI4_F34 (0x34)
+#define SYNAPTICS_RMI4_F35 (0x35)
+#define SYNAPTICS_RMI4_F38 (0x38)
+#define SYNAPTICS_RMI4_F51 (0x51)
+#define SYNAPTICS_RMI4_F54 (0x54)
+#define SYNAPTICS_RMI4_F55 (0x55)
+#define SYNAPTICS_RMI4_FDB (0xDB)
+
+#define PRODUCT_INFO_SIZE 2
+#define PRODUCT_ID_SIZE 10
+#define BUILD_ID_SIZE 3
+
+#define F12_FINGERS_TO_SUPPORT 10
+#define F12_NO_OBJECT_STATUS 0x00
+#define F12_FINGER_STATUS 0x01
+#define F12_ACTIVE_STYLUS_STATUS 0x02
+#define F12_PALM_STATUS 0x03
+#define F12_HOVERING_FINGER_STATUS 0x05
+#define F12_GLOVED_FINGER_STATUS 0x06
+#define F12_NARROW_OBJECT_STATUS 0x07
+#define F12_HAND_EDGE_STATUS 0x08
+#define F12_COVER_STATUS 0x0A
+#define F12_STYLUS_STATUS 0x0B
+#define F12_ERASER_STATUS 0x0C
+#define F12_SMALL_OBJECT_STATUS 0x0D
+
+#define F12_GESTURE_DETECTION_LEN 5
+
+#define MAX_NUMBER_OF_BUTTONS 4
+#define MAX_INTR_REGISTERS 4
+
+#define MASK_16BIT 0xFFFF
+#define MASK_8BIT 0xFF
+#define MASK_7BIT 0x7F
+#define MASK_6BIT 0x3F
+#define MASK_5BIT 0x1F
+#define MASK_4BIT 0x0F
+#define MASK_3BIT 0x07
+#define MASK_2BIT 0x03
+#define MASK_1BIT 0x01
+
+extern void msm_cpuidle_set_sleep_disable(bool disable);
+
+enum exp_fn {
+	RMI_DEV = 0,
+	RMI_FW_UPDATER,
+	RMI_TEST_REPORTING,
+	RMI_PROXIMITY,
+	RMI_ACTIVE_PEN,
+	RMI_GESTURE,
+	RMI_VIDEO,
+	RMI_DEBUG,
+	RMI_LAST,
+};
+
+/*
+ * struct synaptics_rmi4_fn_desc2- function descriptor fields in PDT entry
+ * @query_base_addr: base address for query registers
+ * @cmd_base_addr: base address for command registers
+ * @ctrl_base_addr: base address for control registers
+ * @data_base_addr: base address for data registers
+ * @intr_src_count: number of interrupt sources
+ * @fn_version: version of function
+ * @fn_number: function number
+ */
+struct synaptics_rmi4_fn_desc2 {
+	union {
+		struct {
+			unsigned char query_base_addr;
+			unsigned char cmd_base_addr;
+			unsigned char ctrl_base_addr;
+			unsigned char data_base_addr;
+			unsigned char intr_src_count:3;
+			unsigned char reserved_1:2;
+			unsigned char fn_version:2;
+			unsigned char reserved_2:1;
+			unsigned char fn_number;
+		} __packed;
+		unsigned char data[6];
+	};
+};
+
+/*
+ * synaptics_rmi4_fn_full_addr - full 16-bit base addresses
+ * @query_base: 16-bit base address for query registers
+ * @cmd_base: 16-bit base address for command registers
+ * @ctrl_base: 16-bit base address for control registers
+ * @data_base: 16-bit base address for data registers
+ */
+struct synaptics_rmi4_fn_full_addr {
+	unsigned short query_base;
+	unsigned short cmd_base;
+	unsigned short ctrl_base;
+	unsigned short data_base;
+};
+
+/*
+ * struct synaptics_rmi4_f11_extra_data - extra data of F$11
+ * @data38_offset: offset to F11_2D_DATA38 register
+ */
+struct synaptics_rmi4_f11_extra_data {
+	unsigned char data38_offset;
+};
+
+/*
+ * struct synaptics_rmi4_f12_extra_data - extra data of F$12
+ * @data1_offset: offset to F12_2D_DATA01 register
+ * @data4_offset: offset to F12_2D_DATA04 register
+ * @data15_offset: offset to F12_2D_DATA15 register
+ * @data15_size: size of F12_2D_DATA15 register
+ * @data15_data: buffer for reading F12_2D_DATA15 register
+ * @data29_offset: offset to F12_2D_DATA29 register
+ * @data29_size: size of F12_2D_DATA29 register
+ * @data29_data: buffer for reading F12_2D_DATA29 register
+ * @ctrl20_offset: offset to F12_2D_CTRL20 register
+ */
+struct synaptics_rmi4_f12_extra_data {
+	unsigned char data1_offset;
+	unsigned char data4_offset;
+	unsigned char data15_offset;
+	unsigned char data15_size;
+	unsigned char data15_data[(F12_FINGERS_TO_SUPPORT + 7) / 8];
+	unsigned char data29_offset;
+	unsigned char data29_size;
+	unsigned char data29_data[F12_FINGERS_TO_SUPPORT];
+	unsigned char ctrl20_offset;
+};
+
+/*
+ * struct synaptics_rmi4_fn - RMI function handler
+ * @fn_number: function number
+ * @num_of_data_sources: number of data sources
+ * @num_of_data_points: maximum number of fingers supported
+ * @intr_reg_num: index to associated interrupt register
+ * @intr_mask: interrupt mask
+ * @full_addr: full 16-bit base addresses of function registers
+ * @link: linked list for function handlers
+ * @data_size: size of private data
+ * @data: pointer to private data
+ * @extra: pointer to extra data
+ */
+struct synaptics_rmi4_fn {
+	unsigned char fn_number;
+	unsigned char num_of_data_sources;
+	unsigned char num_of_data_points;
+	unsigned char intr_reg_num;
+	unsigned char intr_mask;
+	struct synaptics_rmi4_fn_full_addr full_addr;
+	struct list_head link;
+	int data_size;
+	void *data;
+	void *extra;
+};
+
+/*
+ * struct synaptics_rmi4_input_settings - current input settings
+ * @num_of_fingers: maximum number of fingers for 2D touch
+ * @valid_button_count: number of valid 0D buttons
+ * @max_touch_width: maximum touch width
+ * @sensor_max_x: maximum x coordinate for 2D touch
+ * @sensor_max_y: maximum y coordinate for 2D touch
+ * @force_min: minimum force value
+ * @force_max: maximum force value
+ * @stylus_enable: flag to indicate reporting of stylus data
+ * @eraser_enable: flag to indicate reporting of eraser data
+ */
+struct synaptics_rmi4_input_settings {
+	unsigned char num_of_fingers;
+	unsigned char valid_button_count;
+	unsigned char max_touch_width;
+	int sensor_max_x;
+	int sensor_max_y;
+	int force_min;
+	int force_max;
+	bool stylus_enable;
+	bool eraser_enable;
+};
+
+/*
+ * struct synaptics_rmi4_device_info - device information
+ * @version_major: RMI protocol major version number
+ * @version_minor: RMI protocol minor version number
+ * @manufacturer_id: manufacturer ID
+ * @product_props: product properties
+ * @product_info: product information
+ * @product_id_string: product ID
+ * @build_id: firmware build ID
+ * @support_fn_list: linked list for function handlers
+ */
+struct synaptics_rmi4_device_info {
+	unsigned int version_major;
+	unsigned int version_minor;
+	unsigned char manufacturer_id;
+	unsigned char product_props;
+	unsigned char product_info[PRODUCT_INFO_SIZE];
+	unsigned char product_id_string[PRODUCT_ID_SIZE + 1];
+	unsigned char build_id[BUILD_ID_SIZE];
+	struct list_head support_fn_list;
+};
+
+/*
+ * struct synaptics_rmi4_data - RMI4 device instance data
+ * @pdev: pointer to platform device
+ * @input_dev: pointer to associated input device
+ * @stylus_dev: pointer to associated stylus device
+ * @hw_if: pointer to hardware interface data
+ * @rmi4_mod_info: device information
+ * @board_prop_dir: /sys/board_properties directory for virtual key map file
+ * @pwr_reg: pointer to regulator for power control
+ * @bus_reg: pointer to regulator for bus pullup control
+ * @rmi4_reset_mutex: mutex for software reset
+ * @rmi4_report_mutex: mutex for input event reporting
+ * @rmi4_io_ctrl_mutex: mutex for communication interface I/O
+ * @rmi4_exp_init_mutex: mutex for expansion function module initialization
+ * @rmi4_irq_enable_mutex: mutex for enabling/disabling interrupt
+ * @rb_work: work for rebuilding input device
+ * @rb_workqueue: workqueue for rebuilding input device
+ * @fb_notifier: framebuffer notifier client
+ * @reset_work: work for issuing reset after display framebuffer ready
+ * @reset_workqueue: workqueue for issuing reset after display framebuffer ready
+ * @early_suspend: early suspend power management
+ * @current_page: current RMI page for register access
+ * @button_0d_enabled: switch for enabling 0d button support
+ * @num_of_tx: number of Tx channels for 2D touch
+ * @num_of_rx: number of Rx channels for 2D touch
+ * @num_of_fingers: maximum number of fingers for 2D touch
+ * @max_touch_width: maximum touch width
+ * @valid_button_count: number of valid 0D buttons
+ * @report_enable: input data to report for F$12
+ * @no_sleep_setting: default setting of NoSleep in F01_RMI_CTRL00 register
+ * @gesture_detection: detected gesture type and properties
+ * @intr_mask: interrupt enable mask
+ * @button_txrx_mapping: Tx Rx mapping of 0D buttons
+ * @num_of_intr_regs: number of interrupt registers
+ * @f01_query_base_addr: query base address for f$01
+ * @f01_cmd_base_addr: command base address for f$01
+ * @f01_ctrl_base_addr: control base address for f$01
+ * @f01_data_base_addr: data base address for f$01
+ * @f51_query_base_addr: query base address for f$51
+ * @firmware_id: firmware build ID
+ * @irq: attention interrupt
+ * @sensor_max_x: maximum x coordinate for 2D touch
+ * @sensor_max_y: maximum y coordinate for 2D touch
+ * @force_min: minimum force value
+ * @force_max: maximum force value
+ * @flash_prog_mode: flag to indicate flash programming mode status
+ * @irq_enabled: flag to indicate attention interrupt enable status
+ * @fingers_on_2d: flag to indicate presence of fingers in 2D area
+ * @suspend: flag to indicate whether in suspend state
+ * @sensor_sleep: flag to indicate sleep state of sensor
+ * @stay_awake: flag to indicate whether to stay awake during suspend
+ * @fb_ready: flag to indicate whether display framebuffer in ready state
+ * @f11_wakeup_gesture: flag to indicate support for wakeup gestures in F$11
+ * @f12_wakeup_gesture: flag to indicate support for wakeup gestures in F$12
+ * @enable_wakeup_gesture: flag to indicate usage of wakeup gestures
+ * @wedge_sensor: flag to indicate use of wedge sensor
+ * @report_pressure: flag to indicate reporting of pressure data
+ * @stylus_enable: flag to indicate reporting of stylus data
+ * @eraser_enable: flag to indicate reporting of eraser data
+ * @external_afe_buttons: flag to indicate presence of external AFE buttons
+ * @reset_device: pointer to device reset function
+ * @irq_enable: pointer to interrupt enable function
+ * @sleep_enable: pointer to sleep enable function
+ * @report_touch: pointer to touch reporting function
+ */
+struct synaptics_rmi4_data {
+	struct platform_device *pdev;
+	struct input_dev *input_dev;
+	struct input_dev *stylus_dev;
+	const struct synaptics_dsx_hw_interface *hw_if;
+	struct synaptics_rmi4_device_info rmi4_mod_info;
+	struct synaptics_rmi4_input_settings input_settings;
+	struct kobject *board_prop_dir;
+	struct regulator *pwr_reg;
+	struct regulator *bus_reg;
+	struct mutex rmi4_reset_mutex;
+	struct mutex rmi4_report_mutex;
+	struct mutex rmi4_io_ctrl_mutex;
+	struct mutex rmi4_exp_init_mutex;
+	struct mutex rmi4_irq_enable_mutex;
+	struct delayed_work rb_work;
+	struct workqueue_struct *rb_workqueue;
+#ifdef CONFIG_FB
+	struct notifier_block fb_notifier;
+	struct work_struct reset_work;
+	struct workqueue_struct *reset_workqueue;
+#endif
+#ifdef CONFIG_HAS_EARLYSUSPEND
+	struct early_suspend early_suspend;
+#endif
+	unsigned char current_page;
+	unsigned char button_0d_enabled;
+	unsigned char num_of_tx;
+	unsigned char num_of_rx;
+	unsigned char num_of_fingers;
+	unsigned char max_touch_width;
+	unsigned char valid_button_count;
+	unsigned char report_enable;
+	unsigned char no_sleep_setting;
+	unsigned char gesture_detection[F12_GESTURE_DETECTION_LEN];
+	unsigned char intr_mask[MAX_INTR_REGISTERS];
+	unsigned char *button_txrx_mapping;
+	unsigned short num_of_intr_regs;
+	unsigned short f01_query_base_addr;
+	unsigned short f01_cmd_base_addr;
+	unsigned short f01_ctrl_base_addr;
+	unsigned short f01_data_base_addr;
+#ifdef F51_DISCRETE_FORCE
+	unsigned short f51_query_base_addr;
+#endif
+	unsigned int firmware_id;
+	int irq;
+	int sensor_max_x;
+	int sensor_max_y;
+	int force_min;
+	int force_max;
+	bool flash_prog_mode;
+	bool irq_enabled;
+	bool fingers_on_2d;
+	bool suspend;
+	bool sensor_sleep;
+	bool stay_awake;
+	bool fb_ready;
+	bool f11_wakeup_gesture;
+	bool f12_wakeup_gesture;
+	bool enable_wakeup_gesture;
+	bool wedge_sensor;
+	bool report_pressure;
+	bool stylus_enable;
+	bool eraser_enable;
+	bool external_afe_buttons;
+	int (*reset_device)(struct i2c_client *client,
+			bool rebuild);
+	int (*irq_enable)(struct synaptics_rmi4_data *rmi4_data, bool enable,
+			bool attn_only);
+	void (*sleep_enable)(struct synaptics_rmi4_data *rmi4_data,
+			bool enable);
+	void (*report_touch)(struct synaptics_rmi4_data *rmi4_data,
+			struct synaptics_rmi4_fn *fhandler);
+	struct device *s3706_dev;
+	bool force;
+};
+
+struct synaptics_dsx_bus_access {
+	unsigned char type;
+	int (*read)(struct synaptics_rmi4_data *rmi4_data, unsigned short addr,
+		unsigned char *data, unsigned short length);
+	int (*write)(struct synaptics_rmi4_data *rmi4_data, unsigned short addr,
+		unsigned char *data, unsigned short length);
+};
+
+struct synaptics_dsx_hw_interface {
+	struct synaptics_dsx_board_data *board_data;
+	const struct synaptics_dsx_bus_access *bus_access;
+	int (*bl_hw_init)(struct synaptics_rmi4_data *rmi4_data);
+	int (*ui_hw_init)(struct synaptics_rmi4_data *rmi4_data);
+};
+
+struct synaptics_rmi4_exp_fn {
+	enum exp_fn fn_type;
+	int (*init)(struct synaptics_rmi4_data *rmi4_data);
+	void (*remove)(struct synaptics_rmi4_data *rmi4_data);
+	void (*reset)(struct synaptics_rmi4_data *rmi4_data);
+	void (*reinit)(struct synaptics_rmi4_data *rmi4_data);
+	void (*early_suspend)(struct synaptics_rmi4_data *rmi4_data);
+	void (*suspend)(struct synaptics_rmi4_data *rmi4_data);
+	void (*resume)(struct synaptics_rmi4_data *rmi4_data);
+	void (*late_resume)(struct synaptics_rmi4_data *rmi4_data);
+	void (*attn)(struct synaptics_rmi4_data *rmi4_data,
+			unsigned char intr_mask);
+};
+
+extern unsigned int tp_debug;
+int synaptics_rmi4_bus_init(void);
+void synaptics_rmi4_bus_exit(void);
+void synaptics_rmi4_new_function(
+		struct synaptics_rmi4_exp_fn *exp_fn_module,
+		bool insert);
+int synaptics_fw_updater(
+		const unsigned char *fw_data,
+		const unsigned char *fw_image);
+int synaptics_rmi4_fwu_init(
+	struct synaptics_rmi4_data *rmi4_data,
+	const unsigned char *fw_image, struct i2c_client *client);
+/*Added for larger than 32 length read!*/
+extern  int synaptics_rmi4_i2c_read_block(
+		struct i2c_client *client,
+		unsigned char addr,
+		unsigned short length,
+		unsigned char *data);
+extern int synaptics_rmi4_i2c_write_block(
+		struct i2c_client *client,
+		unsigned char addr,
+		unsigned short length,
+		unsigned char const *data);
+static inline int synaptics_rmi4_reg_read(
+		struct i2c_client *i2c,
+		unsigned short addr,
+		unsigned char *data,
+		unsigned short len)
+{
+	return synaptics_rmi4_i2c_read_block(i2c, addr, len, data);
+}
+
+static inline int synaptics_rmi4_reg_write(
+		struct i2c_client *i2c,
+		unsigned short addr,
+		unsigned char *data,
+		unsigned short len)
+{
+	return synaptics_rmi4_i2c_write_block(i2c, addr, len, data);
+}
+
+static inline ssize_t synaptics_rmi4_show_error(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	dev_warn(dev, "%s Attempted to read from write-only attribute %s\n",
+			__func__, attr->attr.name);
+	return -EPERM;
+}
+
+static inline ssize_t synaptics_rmi4_store_error(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	dev_warn(dev, "%s Attempted to write to read-only attribute %s\n",
+			__func__, attr->attr.name);
+	return -EPERM;
+}
+
+static inline int secure_memcpy(unsigned char *dest, unsigned int dest_size,
+		const unsigned char *src, unsigned int src_size,
+		unsigned int count)
+{
+	if (dest == NULL || src == NULL)
+		return -EINVAL;
+
+	if (count > dest_size || count > src_size)
+		return -EINVAL;
+
+	memcpy((void *)dest, (const void *)src, count);
+
+	return 0;
+}
+
+static inline void batohs(unsigned short *dest, unsigned char *src)
+{
+	*dest = src[1] * 0x100 + src[0];
+}
+
+static inline void hstoba(unsigned char *dest, unsigned short src)
+{
+	dest[0] = src % 0x100;
+	dest[1] = src / 0x100;
+}
+
+#endif
diff --git a/drivers/input/touchscreen/synaptics_dsx_fw_update.c b/drivers/input/touchscreen/synaptics_dsx_fw_update.c
new file mode 100644
index 0000000000000000000000000000000000000000..77ef49342621a6658c97b00379a405cc631bba0c
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_dsx_fw_update.c
@@ -0,0 +1,4093 @@
+/*
+ * Synaptics DSX touchscreen driver
+ *
+ * Copyright (C) 2012-2016 Synaptics Incorporated. All rights reserved.
+ *
+ * Copyright (C) 2012 Alexandra Chin <alexandra.chin@tw.synaptics.com>
+ * Copyright (C) 2012 Scott Lin <scott.lin@tw.synaptics.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * INFORMATION CONTAINED IN THIS DOCUMENT IS PROVIDED "AS-IS," AND SYNAPTICS
+ * EXPRESSLY DISCLAIMS ALL EXPRESS AND IMPLIED WARRANTIES, INCLUDING ANY
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE,
+ * AND ANY WARRANTIES OF NON-INFRINGEMENT OF ANY INTELLECTUAL PROPERTY RIGHTS.
+ * IN NO EVENT SHALL SYNAPTICS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ * SPECIAL, PUNITIVE, OR CONSEQUENTIAL DAMAGES ARISING OUT OF OR IN CONNECTION
+ * WITH THE USE OF THE INFORMATION CONTAINED IN THIS DOCUMENT, HOWEVER CAUSED
+ * AND BASED ON ANY THEORY OF LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * NEGLIGENCE OR OTHER TORTIOUS ACTION, AND EVEN IF SYNAPTICS WAS ADVISED OF
+ * THE POSSIBILITY OF SUCH DAMAGE. IF A TRIBUNAL OF COMPETENT JURISDICTION DOES
+ * NOT PERMIT THE DISCLAIMER OF DIRECT DAMAGES OR ANY OTHER DAMAGES, SYNAPTICS'
+ * TOTAL CUMULATIVE LIABILITY TO ANY PARTY SHALL NOT EXCEED ONE HUNDRED U.S.
+ * DOLLARS.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/firmware.h>
+#include <linux/platform_device.h>
+#include <linux/input/synaptics_dsx.h>
+#include "synaptics_dsx_core.h"
+
+#define FW_IHEX_NAME  "tp/fw_synaptics_17819.img"
+#define FW_IMAGE_NAME  "tp/fw_synaptics_17819.img"
+
+/*#define DO_STARTUP_FW_UPDATE*/
+/*delete by morgan.gu for sdm845 */
+#undef CONFIG_FB
+
+#ifdef DO_STARTUP_FW_UPDATE
+#ifdef CONFIG_FB
+#define WAIT_FOR_FB_READY
+#define FB_READY_WAIT_MS 100
+#define FB_READY_TIMEOUT_S 30
+#endif
+#endif
+
+/*********************for Debug LOG switch*******************/
+#define TPD_DEVICE "synaptics,s3320_firmware"
+#define TPD_ERR(a, arg...)  pr_err(TPD_DEVICE ": " a, ##arg)
+#define TPDTM_DMESG(a, arg...)  printk(TPD_DEVICE ": " a, ##arg)
+
+#define TPD_DEBUG(a, arg...)\
+	do {\
+		if (tp_debug) \
+		pr_err(TPD_DEVICE ": " a, ##arg);\
+	} while (0)
+
+#define MAX_WRITE_SIZE 4096
+
+#define FORCE_UPDATE false
+#define DO_LOCKDOWN false
+
+#define MAX_IMAGE_NAME_LEN 256
+#define MAX_FIRMWARE_ID_LEN 10
+
+#define IMAGE_HEADER_VERSION_05 0x05
+#define IMAGE_HEADER_VERSION_06 0x06
+#define IMAGE_HEADER_VERSION_10 0x10
+
+#define IMAGE_AREA_OFFSET 0x100
+#define LOCKDOWN_SIZE 0x50
+
+#define MAX_UTILITY_PARAMS 20
+
+#define V5V6_BOOTLOADER_ID_OFFSET 0
+#define V5V6_CONFIG_ID_SIZE 4
+
+#define V5_PROPERTIES_OFFSET 2
+#define V5_BLOCK_SIZE_OFFSET 3
+#define V5_BLOCK_COUNT_OFFSET 5
+#define V5_BLOCK_NUMBER_OFFSET 0
+#define V5_BLOCK_DATA_OFFSET 2
+
+#define V6_PROPERTIES_OFFSET 1
+#define V6_BLOCK_SIZE_OFFSET 2
+#define V6_BLOCK_COUNT_OFFSET 3
+#define V6_PROPERTIES_2_OFFSET 4
+#define V6_GUEST_CODE_BLOCK_COUNT_OFFSET 5
+#define V6_BLOCK_NUMBER_OFFSET 0
+#define V6_BLOCK_DATA_OFFSET 1
+#define V6_FLASH_COMMAND_OFFSET 2
+#define V6_FLASH_STATUS_OFFSET 3
+
+#define V7_CONFIG_ID_SIZE 32
+
+#define V7_FLASH_STATUS_OFFSET 0
+#define V7_PARTITION_ID_OFFSET 1
+#define V7_BLOCK_NUMBER_OFFSET 2
+#define V7_TRANSFER_LENGTH_OFFSET 3
+#define V7_COMMAND_OFFSET 4
+#define V7_PAYLOAD_OFFSET 5
+
+#define V7_PARTITION_SUPPORT_BYTES 4
+
+#define F35_ERROR_CODE_OFFSET 0
+#define F35_FLASH_STATUS_OFFSET 5
+#define F35_CHUNK_NUM_LSB_OFFSET 0
+#define F35_CHUNK_NUM_MSB_OFFSET 1
+#define F35_CHUNK_DATA_OFFSET 2
+#define F35_CHUNK_COMMAND_OFFSET 18
+
+#define F35_CHUNK_SIZE 16
+#define F35_ERASE_ALL_WAIT_MS 5000
+#define F35_RESET_WAIT_MS 250
+
+#define SLEEP_MODE_NORMAL (0x00)
+#define SLEEP_MODE_SENSOR_SLEEP (0x01)
+#define SLEEP_MODE_RESERVED0 (0x02)
+#define SLEEP_MODE_RESERVED1 (0x03)
+
+#define ENABLE_WAIT_MS (1 * 1000)
+#define WRITE_WAIT_MS (3 * 1000)
+#define ERASE_WAIT_MS (5 * 1000)
+
+#define MIN_SLEEP_TIME_US 50
+#define MAX_SLEEP_TIME_US 100
+
+#define INT_DISABLE_WAIT_MS 20
+#define ENTER_FLASH_PROG_WAIT_MS 20
+
+static int fwu_do_reflash(void);
+
+static int fwu_recovery_check_status(void);
+
+enum f34_version {
+	F34_V0 = 0,
+	F34_V1,
+	F34_V2,
+};
+
+enum bl_version {
+	BL_V5 = 5,
+	BL_V6 = 6,
+	BL_V7 = 7,
+	BL_V8 = 8,
+};
+
+enum flash_area {
+	NONE = 0,
+	UI_FIRMWARE,
+	UI_CONFIG,
+};
+
+enum update_mode {
+	NORMAL = 1,
+	FORCE = 2,
+	LOCKDOWN = 8,
+};
+
+enum config_area {
+	UI_CONFIG_AREA = 0,
+	PM_CONFIG_AREA,
+	BL_CONFIG_AREA,
+	DP_CONFIG_AREA,
+	FLASH_CONFIG_AREA,
+	UPP_AREA,
+};
+
+enum v7_status {
+	SUCCESS = 0x00,
+	DEVICE_NOT_IN_BOOTLOADER_MODE,
+	INVALID_PARTITION,
+	INVALID_COMMAND,
+	INVALID_BLOCK_OFFSET,
+	INVALID_TRANSFER,
+	NOT_ERASED,
+	FLASH_PROGRAMMING_KEY_INCORRECT,
+	BAD_PARTITION_TABLE,
+	CHECKSUM_FAILED,
+	FLASH_HARDWARE_FAILURE = 0x1f,
+};
+
+enum v7_partition_id {
+	BOOTLOADER_PARTITION = 0x01,
+	DEVICE_CONFIG_PARTITION,
+	FLASH_CONFIG_PARTITION,
+	MANUFACTURING_BLOCK_PARTITION,
+	GUEST_SERIALIZATION_PARTITION,
+	GLOBAL_PARAMETERS_PARTITION,
+	CORE_CODE_PARTITION,
+	CORE_CONFIG_PARTITION,
+	GUEST_CODE_PARTITION,
+	DISPLAY_CONFIG_PARTITION,
+	EXTERNAL_TOUCH_AFE_CONFIG_PARTITION,
+	UTILITY_PARAMETER_PARTITION,
+};
+
+enum v7_flash_command {
+	CMD_V7_IDLE = 0x00,
+	CMD_V7_ENTER_BL,
+	CMD_V7_READ,
+	CMD_V7_WRITE,
+	CMD_V7_ERASE,
+	CMD_V7_ERASE_AP,
+	CMD_V7_SENSOR_ID,
+};
+
+enum v5v6_flash_command {
+	CMD_V5V6_IDLE = 0x0,
+	CMD_V5V6_WRITE_FW = 0x2,
+	CMD_V5V6_ERASE_ALL = 0x3,
+	CMD_V5V6_WRITE_LOCKDOWN = 0x4,
+	CMD_V5V6_READ_CONFIG = 0x5,
+	CMD_V5V6_WRITE_CONFIG = 0x6,
+	CMD_V5V6_ERASE_UI_CONFIG = 0x7,
+	CMD_V5V6_ERASE_BL_CONFIG = 0x9,
+	CMD_V5V6_ERASE_DISP_CONFIG = 0xa,
+	CMD_V5V6_ERASE_GUEST_CODE = 0xb,
+	CMD_V5V6_WRITE_GUEST_CODE = 0xc,
+	CMD_V5V6_ENABLE_FLASH_PROG = 0xf,
+};
+
+enum flash_command {
+	CMD_IDLE = 0,
+	CMD_WRITE_FW,
+	CMD_WRITE_CONFIG,
+	CMD_WRITE_LOCKDOWN,
+	CMD_WRITE_GUEST_CODE,
+	CMD_WRITE_BOOTLOADER,
+	CMD_WRITE_UTILITY_PARAM,
+	CMD_READ_CONFIG,
+	CMD_ERASE_ALL,
+	CMD_ERASE_UI_FIRMWARE,
+	CMD_ERASE_UI_CONFIG,
+	CMD_ERASE_BL_CONFIG,
+	CMD_ERASE_DISP_CONFIG,
+	CMD_ERASE_FLASH_CONFIG,
+	CMD_ERASE_GUEST_CODE,
+	CMD_ERASE_BOOTLOADER,
+	CMD_ERASE_UTILITY_PARAMETER,
+	CMD_ENABLE_FLASH_PROG,
+};
+
+enum f35_flash_command {
+	CMD_F35_IDLE = 0x0,
+	CMD_F35_RESERVED = 0x1,
+	CMD_F35_WRITE_CHUNK = 0x2,
+	CMD_F35_ERASE_ALL = 0x3,
+	CMD_F35_RESET = 0x10,
+};
+
+enum container_id {
+	TOP_LEVEL_CONTAINER = 0,
+	UI_CONTAINER,
+	UI_CONFIG_CONTAINER,
+	BL_CONTAINER,
+	BL_IMAGE_CONTAINER,
+	BL_CONFIG_CONTAINER,
+	BL_LOCKDOWN_INFO_CONTAINER,
+	PERMANENT_CONFIG_CONTAINER,
+	GUEST_CODE_CONTAINER,
+	BL_PROTOCOL_DESCRIPTOR_CONTAINER,
+	UI_PROTOCOL_DESCRIPTOR_CONTAINER,
+	RMI_SELF_DISCOVERY_CONTAINER,
+	RMI_PAGE_CONTENT_CONTAINER,
+	GENERAL_INFORMATION_CONTAINER,
+	DEVICE_CONFIG_CONTAINER,
+	FLASH_CONFIG_CONTAINER,
+	GUEST_SERIALIZATION_CONTAINER,
+	GLOBAL_PARAMETERS_CONTAINER,
+	CORE_CODE_CONTAINER,
+	CORE_CONFIG_CONTAINER,
+	DISPLAY_CONFIG_CONTAINER,
+	EXTERNAL_TOUCH_AFE_CONFIG_CONTAINER,
+	UTILITY_CONTAINER,
+	UTILITY_PARAMETER_CONTAINER,
+};
+
+enum utility_parameter_id {
+	UNUSED = 0,
+	FORCE_PARAMETER,
+	ANTI_BENDING_PARAMETER,
+};
+
+struct pdt_properties {
+	union {
+		struct {
+			unsigned char reserved_1:6;
+			unsigned char has_bsr:1;
+			unsigned char reserved_2:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct partition_table {
+	unsigned char partition_id:5;
+	unsigned char byte_0_reserved:3;
+	unsigned char byte_1_reserved;
+	unsigned char partition_length_7_0;
+	unsigned char partition_length_15_8;
+	unsigned char start_physical_address_7_0;
+	unsigned char start_physical_address_15_8;
+	unsigned char partition_properties_7_0;
+	unsigned char partition_properties_15_8;
+} __packed;
+
+struct f01_device_control {
+	union {
+		struct {
+			unsigned char sleep_mode:2;
+			unsigned char nosleep:1;
+			unsigned char reserved:2;
+			unsigned char charger_connected:1;
+			unsigned char report_rate:1;
+			unsigned char configured:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v7_query_0 {
+	union {
+		struct {
+			unsigned char subpacket_1_size:3;
+			unsigned char has_config_id:1;
+			unsigned char f34_query0_b4:1;
+			unsigned char has_thqa:1;
+			unsigned char f34_query0_b6__7:2;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v7_query_1_7 {
+	union {
+		struct {
+			/* query 1 */
+			unsigned char bl_minor_revision;
+			unsigned char bl_major_revision;
+
+			/* query 2 */
+			unsigned char bl_fw_id_7_0;
+			unsigned char bl_fw_id_15_8;
+			unsigned char bl_fw_id_23_16;
+			unsigned char bl_fw_id_31_24;
+
+			/* query 3 */
+			unsigned char minimum_write_size;
+			unsigned char block_size_7_0;
+			unsigned char block_size_15_8;
+			unsigned char flash_page_size_7_0;
+			unsigned char flash_page_size_15_8;
+
+			/* query 4 */
+			unsigned char adjustable_partition_area_size_7_0;
+			unsigned char adjustable_partition_area_size_15_8;
+
+			/* query 5 */
+			unsigned char flash_config_length_7_0;
+			unsigned char flash_config_length_15_8;
+
+			/* query 6 */
+			unsigned char payload_length_7_0;
+			unsigned char payload_length_15_8;
+
+			/* query 7 */
+			unsigned char f34_query7_b0:1;
+			unsigned char has_bootloader:1;
+			unsigned char has_device_config:1;
+			unsigned char has_flash_config:1;
+			unsigned char has_manufacturing_block:1;
+			unsigned char has_guest_serialization:1;
+			unsigned char has_global_parameters:1;
+			unsigned char has_core_code:1;
+			unsigned char has_core_config:1;
+			unsigned char has_guest_code:1;
+			unsigned char has_display_config:1;
+			unsigned char f34_query7_b11__15:5;
+			unsigned char f34_query7_b16__23;
+			unsigned char f34_query7_b24__31;
+		} __packed;
+		unsigned char data[21];
+	};
+};
+
+struct f34_v7_data0 {
+	union {
+		struct {
+			unsigned char operation_status:5;
+			unsigned char device_cfg_status:2;
+			unsigned char bl_mode:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v7_data_1_5 {
+	union {
+		struct {
+			unsigned char partition_id:5;
+			unsigned char f34_data1_b5__7:3;
+			unsigned char block_offset_7_0;
+			unsigned char block_offset_15_8;
+			unsigned char transfer_length_7_0;
+			unsigned char transfer_length_15_8;
+			unsigned char command;
+			unsigned char payload_0;
+			unsigned char payload_1;
+		} __packed;
+		unsigned char data[8];
+	};
+};
+
+struct f34_v5v6_flash_properties {
+	union {
+		struct {
+			unsigned char reg_map:1;
+			unsigned char unlocked:1;
+			unsigned char has_config_id:1;
+			unsigned char has_pm_config:1;
+			unsigned char has_bl_config:1;
+			unsigned char has_disp_config:1;
+			unsigned char has_ctrl1:1;
+			unsigned char has_query4:1;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct f34_v5v6_flash_properties_2 {
+	union {
+		struct {
+			unsigned char has_guest_code:1;
+			unsigned char reserved:7;
+		} __packed;
+		unsigned char data[1];
+	};
+};
+
+struct register_offset {
+	unsigned char properties;
+	unsigned char properties_2;
+	unsigned char block_size;
+	unsigned char block_count;
+	unsigned char gc_block_count;
+	unsigned char flash_status;
+	unsigned char partition_id;
+	unsigned char block_number;
+	unsigned char transfer_length;
+	unsigned char flash_cmd;
+	unsigned char payload;
+};
+
+struct block_count {
+	unsigned short ui_firmware;
+	unsigned short ui_config;
+	unsigned short dp_config;
+	unsigned short pm_config;
+	unsigned short fl_config;
+	unsigned short bl_image;
+	unsigned short bl_config;
+	unsigned short utility_param;
+	unsigned short lockdown;
+	unsigned short guest_code;
+	unsigned short total_count;
+};
+
+struct physical_address {
+	unsigned short ui_firmware;
+	unsigned short ui_config;
+	unsigned short dp_config;
+	unsigned short pm_config;
+	unsigned short fl_config;
+	unsigned short bl_image;
+	unsigned short bl_config;
+	unsigned short utility_param;
+	unsigned short lockdown;
+	unsigned short guest_code;
+};
+
+struct container_descriptor {
+	unsigned char content_checksum[4];
+	unsigned char container_id[2];
+	unsigned char minor_version;
+	unsigned char major_version;
+	unsigned char reserved_08;
+	unsigned char reserved_09;
+	unsigned char reserved_0a;
+	unsigned char reserved_0b;
+	unsigned char container_option_flags[4];
+	unsigned char content_options_length[4];
+	unsigned char content_options_address[4];
+	unsigned char content_length[4];
+	unsigned char content_address[4];
+};
+
+struct image_header_10 {
+	unsigned char checksum[4];
+	unsigned char reserved_04;
+	unsigned char reserved_05;
+	unsigned char minor_header_version;
+	unsigned char major_header_version;
+	unsigned char reserved_08;
+	unsigned char reserved_09;
+	unsigned char reserved_0a;
+	unsigned char reserved_0b;
+	unsigned char top_level_container_start_addr[4];
+};
+
+struct image_header_05_06 {
+	/* 0x00 - 0x0f */
+	unsigned char checksum[4];
+	unsigned char reserved_04;
+	unsigned char reserved_05;
+	unsigned char options_firmware_id:1;
+	unsigned char options_bootloader:1;
+	unsigned char options_guest_code:1;
+	unsigned char options_tddi:1;
+	unsigned char options_reserved:4;
+	unsigned char header_version;
+	unsigned char firmware_size[4];
+	unsigned char config_size[4];
+	/* 0x10 - 0x1f */
+	unsigned char product_id[PRODUCT_ID_SIZE];
+	unsigned char package_id[2];
+	unsigned char package_id_revision[2];
+	unsigned char product_info[PRODUCT_INFO_SIZE];
+	/* 0x20 - 0x2f */
+	unsigned char bootloader_addr[4];
+	unsigned char bootloader_size[4];
+	unsigned char ui_addr[4];
+	unsigned char ui_size[4];
+	/* 0x30 - 0x3f */
+	unsigned char ds_id[16];
+	/* 0x40 - 0x4f */
+	union {
+		struct {
+			unsigned char cstmr_product_id[PRODUCT_ID_SIZE];
+			unsigned char reserved_4a_4f[6];
+		};
+		struct {
+			unsigned char dsp_cfg_addr[4];
+			unsigned char dsp_cfg_size[4];
+			unsigned char reserved_48_4f[8];
+		};
+	};
+	/* 0x50 - 0x53 */
+	unsigned char firmware_id[4];
+};
+
+struct block_data {
+	unsigned int size;
+	const unsigned char *data;
+};
+
+struct image_metadata {
+	bool contains_firmware_id;
+	bool contains_bootloader;
+	bool contains_guest_code;
+	bool contains_disp_config;
+	bool contains_perm_config;
+	bool contains_flash_config;
+	bool contains_utility_param;
+	unsigned int firmware_id;
+	unsigned int checksum;
+	unsigned int bootloader_size;
+	unsigned int disp_config_offset;
+	unsigned char bl_version;
+	unsigned char product_id[PRODUCT_ID_SIZE + 1];
+	unsigned char cstmr_product_id[PRODUCT_ID_SIZE + 1];
+	unsigned char utility_param_id[MAX_UTILITY_PARAMS];
+	struct block_data bootloader;
+	struct block_data utility;
+	struct block_data ui_firmware;
+	struct block_data ui_config;
+	struct block_data dp_config;
+	struct block_data pm_config;
+	struct block_data fl_config;
+	struct block_data bl_image;
+	struct block_data bl_config;
+	struct block_data utility_param[MAX_UTILITY_PARAMS];
+	struct block_data lockdown;
+	struct block_data guest_code;
+	struct block_count blkcount;
+	struct physical_address phyaddr;
+};
+
+struct synaptics_rmi4_fwu_handle {
+	enum bl_version bl_version;
+	bool initialized;
+	bool in_bl_mode;
+	bool in_ub_mode;
+	bool bl_mode_device;
+	bool force_update;
+	bool do_lockdown;
+	bool has_guest_code;
+	bool has_utility_param;
+	bool new_partition_table;
+	bool incompatible_partition_tables;
+	bool write_bootloader;
+	unsigned int data_pos;
+	unsigned char *ext_data_source;
+	unsigned char *read_config_buf;
+	unsigned char intr_mask;
+	unsigned char command;
+	unsigned char bootloader_id[2];
+	unsigned char config_id[32];
+	unsigned char flash_status;
+	unsigned char partitions;
+#ifdef F51_DISCRETE_FORCE
+	unsigned char *cal_data;
+	unsigned short cal_data_off;
+	unsigned short cal_data_size;
+	unsigned short cal_data_buf_size;
+	unsigned short cal_packet_data_size;
+#endif
+	unsigned short block_size;
+	unsigned short config_size;
+	unsigned short config_area;
+	unsigned short config_block_count;
+	unsigned short flash_config_length;
+	unsigned short payload_length;
+	unsigned short partition_table_bytes;
+	unsigned short read_config_buf_size;
+	const unsigned char *config_data;
+	const unsigned char *image;
+	unsigned char *image_name;
+	unsigned int image_size;
+	struct image_metadata img;
+	struct register_offset off;
+	struct block_count blkcount;
+	struct physical_address phyaddr;
+	struct f34_v5v6_flash_properties flash_properties;
+	struct synaptics_rmi4_fn_desc2 f34_fd;
+	struct synaptics_rmi4_fn_desc2 f35_fd;
+	struct synaptics_rmi4_data *rmi4_data;
+	struct workqueue_struct *fwu_workqueue;
+	struct work_struct fwu_work;
+	struct i2c_client *client;
+	unsigned char bl_reset_add;
+};
+
+static struct synaptics_rmi4_fwu_handle *fwu;
+
+DECLARE_COMPLETION(fwu_remove_complete);
+
+static void calculate_checksum(unsigned short *data, unsigned long len,
+		unsigned long *result)
+{
+	unsigned long temp;
+	unsigned long sum1 = 0xffff;
+	unsigned long sum2 = 0xffff;
+
+	*result = 0xffffffff;
+
+	while (len--) {
+		temp = *data;
+		sum1 += temp;
+		sum2 += sum1;
+		sum1 = (sum1 & 0xffff) + (sum1 >> 16);
+		sum2 = (sum2 & 0xffff) + (sum2 >> 16);
+		data++;
+	}
+
+	*result = sum2 << 16 | sum1;
+
+}
+
+static void convert_to_little_endian(unsigned char *dest, unsigned long src)
+{
+	dest[0] = (unsigned char)(src & 0xff);
+	dest[1] = (unsigned char)((src >> 8) & 0xff);
+	dest[2] = (unsigned char)((src >> 16) & 0xff);
+	dest[3] = (unsigned char)((src >> 24) & 0xff);
+
+}
+
+static unsigned int le_to_uint(const unsigned char *ptr)
+{
+	return (unsigned int)ptr[0] +
+			(unsigned int)ptr[1] * 0x100 +
+			(unsigned int)ptr[2] * 0x10000 +
+			(unsigned int)ptr[3] * 0x1000000;
+}
+
+#ifdef F51_DISCRETE_FORCE
+static int fwu_f51_force_data_init(void)
+{
+	int retval;
+	unsigned char query_count;
+	unsigned char packet_info;
+	unsigned char offset[2];
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			rmi4_data->f51_query_base_addr + 7,
+			offset,
+			sizeof(offset));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read force data offset\n",
+				__func__);
+		return retval;
+	}
+
+	fwu->cal_data_off = offset[0] | offset[1] << 8;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			rmi4_data->f51_query_base_addr,
+			&query_count,
+			sizeof(query_count));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read number of F51 query registers\n",
+				__func__);
+		return retval;
+	}
+
+	if (query_count >= 10) {
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				rmi4_data->f51_query_base_addr + 9,
+				&packet_info,
+				sizeof(packet_info));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read F51 packet register info\n",
+					__func__);
+			return retval;
+		}
+
+		if (packet_info & MASK_1BIT) {
+			fwu->cal_packet_data_size = packet_info >> 1;
+			fwu->cal_packet_data_size *= 2;
+		} else {
+			fwu->cal_packet_data_size = 0;
+		}
+	} else {
+		fwu->cal_packet_data_size = 0;
+	}
+
+	fwu->cal_data_size = CAL_DATA_SIZE + fwu->cal_packet_data_size;
+	if (fwu->cal_data_size > fwu->cal_data_buf_size) {
+		kfree(fwu->cal_data);
+		fwu->cal_data_buf_size = fwu->cal_data_size;
+		fwu->cal_data = kmalloc(fwu->cal_data_buf_size, GFP_KERNEL);
+		if (!fwu->cal_data) {
+			TPD_ERR("%s: Failed to alloc mem for fwu->cal_data\n",
+					__func__);
+			fwu->cal_data_buf_size = 0;
+			return -ENOMEM;
+		}
+	}
+
+	return 0;
+}
+#endif
+
+static int fwu_allocate_read_config_buf(unsigned int count)
+{
+
+	if (count > fwu->read_config_buf_size) {
+		kfree(fwu->read_config_buf);
+		fwu->read_config_buf = kzalloc(count, GFP_KERNEL);
+		if (!fwu->read_config_buf) {
+			TPD_ERR("%s:Failed to alloc mem read_config_buf\n",
+					__func__);
+			fwu->read_config_buf_size = 0;
+			return -ENOMEM;
+		}
+		fwu->read_config_buf_size = count;
+	}
+
+	return 0;
+}
+
+static void fwu_compare_partition_tables(void)
+{
+	fwu->incompatible_partition_tables = false;
+
+	if (fwu->phyaddr.bl_image != fwu->img.phyaddr.bl_image)
+		fwu->incompatible_partition_tables = true;
+	else if (fwu->phyaddr.lockdown != fwu->img.phyaddr.lockdown)
+		fwu->incompatible_partition_tables = true;
+	else if (fwu->phyaddr.bl_config != fwu->img.phyaddr.bl_config)
+		fwu->incompatible_partition_tables = true;
+	else if (fwu->phyaddr.utility_param != fwu->img.phyaddr.utility_param)
+		fwu->incompatible_partition_tables = true;
+
+	if (fwu->bl_version == BL_V7) {
+		if (fwu->phyaddr.fl_config != fwu->img.phyaddr.fl_config)
+			fwu->incompatible_partition_tables = true;
+	}
+
+	fwu->new_partition_table = false;
+
+	if (fwu->phyaddr.ui_firmware != fwu->img.phyaddr.ui_firmware)
+		fwu->new_partition_table = true;
+	else if (fwu->phyaddr.ui_config != fwu->img.phyaddr.ui_config)
+		fwu->new_partition_table = true;
+
+	if (fwu->flash_properties.has_disp_config) {
+		if (fwu->phyaddr.dp_config != fwu->img.phyaddr.dp_config)
+			fwu->new_partition_table = true;
+	}
+
+	if (fwu->has_guest_code) {
+		if (fwu->phyaddr.guest_code != fwu->img.phyaddr.guest_code)
+			fwu->new_partition_table = true;
+	}
+
+}
+
+static void fwu_parse_partition_table(const unsigned char *partition_table,
+		struct block_count *blkcount, struct physical_address *phyaddr)
+{
+	unsigned char ii;
+	unsigned char index;
+	unsigned char offset;
+	unsigned short partition_length;
+	unsigned short physical_address;
+	struct partition_table *ptable;
+
+	for (ii = 0; ii < fwu->partitions; ii++) {
+		index = ii * 8 + 2;
+		ptable = (struct partition_table *)&partition_table[index];
+		partition_length = ptable->partition_length_15_8 << 8 |
+				ptable->partition_length_7_0;
+		physical_address = ptable->start_physical_address_15_8 << 8 |
+				ptable->start_physical_address_7_0;
+		TPD_DEBUG("%s: Partition entry %d:\n",
+				__func__, ii);
+		for (offset = 0; offset < 8; offset++) {
+			TPD_DEBUG("%s: 0x%02x\n",
+					__func__,
+					partition_table[index + offset]);
+		}
+		switch (ptable->partition_id) {
+		case CORE_CODE_PARTITION:
+			blkcount->ui_firmware = partition_length;
+			phyaddr->ui_firmware = physical_address;
+			TPD_DEBUG("%s: Core code block count: %d\n",
+					__func__, blkcount->ui_firmware);
+			blkcount->total_count += partition_length;
+			break;
+		case CORE_CONFIG_PARTITION:
+			blkcount->ui_config = partition_length;
+			phyaddr->ui_config = physical_address;
+			TPD_DEBUG("%s: Core config block count: %d\n",
+					__func__, blkcount->ui_config);
+			blkcount->total_count += partition_length;
+			break;
+		case BOOTLOADER_PARTITION:
+			blkcount->bl_image = partition_length;
+			phyaddr->bl_image = physical_address;
+			TPD_DEBUG("%s: Bootloader block count: %d\n",
+					__func__, blkcount->bl_image);
+			blkcount->total_count += partition_length;
+			break;
+		case UTILITY_PARAMETER_PARTITION:
+			blkcount->utility_param = partition_length;
+			phyaddr->utility_param = physical_address;
+			TPD_DEBUG("%s: Utility parameter block count: %d\n",
+					__func__, blkcount->utility_param);
+			blkcount->total_count += partition_length;
+			break;
+		case DISPLAY_CONFIG_PARTITION:
+			blkcount->dp_config = partition_length;
+			phyaddr->dp_config = physical_address;
+			TPD_DEBUG("%s: Display config block count: %d\n",
+					__func__, blkcount->dp_config);
+			blkcount->total_count += partition_length;
+			break;
+		case FLASH_CONFIG_PARTITION:
+			blkcount->fl_config = partition_length;
+			phyaddr->fl_config = physical_address;
+			TPD_DEBUG("%s: Flash config block count: %d\n",
+					__func__, blkcount->fl_config);
+			blkcount->total_count += partition_length;
+			break;
+		case GUEST_CODE_PARTITION:
+			blkcount->guest_code = partition_length;
+			phyaddr->guest_code = physical_address;
+			TPD_DEBUG("%s: Guest code block count: %d\n",
+					__func__, blkcount->guest_code);
+			blkcount->total_count += partition_length;
+			break;
+		case GUEST_SERIALIZATION_PARTITION:
+			blkcount->pm_config = partition_length;
+			phyaddr->pm_config = physical_address;
+			TPD_DEBUG("%s: Guest serialization block count: %d\n",
+					__func__, blkcount->pm_config);
+			blkcount->total_count += partition_length;
+			break;
+		case GLOBAL_PARAMETERS_PARTITION:
+			blkcount->bl_config = partition_length;
+			phyaddr->bl_config = physical_address;
+			TPD_DEBUG("%s: Global parameters block count: %d\n",
+					__func__, blkcount->bl_config);
+			blkcount->total_count += partition_length;
+			break;
+		case DEVICE_CONFIG_PARTITION:
+			blkcount->lockdown = partition_length;
+			phyaddr->lockdown = physical_address;
+			TPD_DEBUG("%s: Device config block count: %d\n",
+					__func__, blkcount->lockdown);
+			blkcount->total_count += partition_length;
+			break;
+		};
+	}
+
+}
+
+static void fwu_parse_image_header_10_utility(const unsigned char *image)
+{
+	unsigned char ii;
+	unsigned char num_of_containers;
+	unsigned int addr;
+	unsigned int container_id;
+	unsigned int length;
+	const unsigned char *content;
+	struct container_descriptor *descriptor;
+
+	num_of_containers = fwu->img.utility.size / 4;
+
+	for (ii = 0; ii < num_of_containers; ii++) {
+		if (ii >= MAX_UTILITY_PARAMS)
+			continue;
+		addr = le_to_uint(fwu->img.utility.data + (ii * 4));
+		descriptor = (struct container_descriptor *)(image + addr);
+		container_id = descriptor->container_id[0] |
+				descriptor->container_id[1] << 8;
+		content = image + le_to_uint(descriptor->content_address);
+		length = le_to_uint(descriptor->content_length);
+		switch (container_id) {
+		case UTILITY_PARAMETER_CONTAINER:
+			fwu->img.utility_param[ii].data = content;
+			fwu->img.utility_param[ii].size = length;
+			fwu->img.utility_param_id[ii] = content[0];
+			break;
+		default:
+			break;
+		};
+	}
+
+}
+
+static void fwu_parse_image_header_10_bootloader(const unsigned char *image)
+{
+	unsigned char ii;
+	unsigned char num_of_containers;
+	unsigned int addr;
+	unsigned int container_id;
+	unsigned int length;
+	const unsigned char *content;
+	struct container_descriptor *descriptor;
+
+	num_of_containers = (fwu->img.bootloader.size - 4) / 4;
+
+	for (ii = 1; ii <= num_of_containers; ii++) {
+		addr = le_to_uint(fwu->img.bootloader.data + (ii * 4));
+		descriptor = (struct container_descriptor *)(image + addr);
+		container_id = descriptor->container_id[0] |
+				descriptor->container_id[1] << 8;
+		content = image + le_to_uint(descriptor->content_address);
+		length = le_to_uint(descriptor->content_length);
+		switch (container_id) {
+		case BL_IMAGE_CONTAINER:
+			fwu->img.bl_image.data = content;
+			fwu->img.bl_image.size = length;
+			break;
+		case BL_CONFIG_CONTAINER:
+		case GLOBAL_PARAMETERS_CONTAINER:
+			fwu->img.bl_config.data = content;
+			fwu->img.bl_config.size = length;
+			break;
+		case BL_LOCKDOWN_INFO_CONTAINER:
+		case DEVICE_CONFIG_CONTAINER:
+			fwu->img.lockdown.data = content;
+			fwu->img.lockdown.size = length;
+			break;
+		default:
+			break;
+		};
+	}
+
+}
+
+static void fwu_parse_image_header_10(void)
+{
+	unsigned char ii;
+	unsigned char num_of_containers;
+	unsigned int addr;
+	unsigned int offset;
+	unsigned int container_id;
+	unsigned int length;
+	const unsigned char *image;
+	const unsigned char *content;
+	struct container_descriptor *descriptor;
+	struct image_header_10 *header;
+
+	TPD_DEBUG("%s: enter\n", __func__);
+	image = fwu->image;
+	header = (struct image_header_10 *)image;
+
+	fwu->img.checksum = le_to_uint(header->checksum);
+
+	/* address of top level container */
+	offset = le_to_uint(header->top_level_container_start_addr);
+	descriptor = (struct container_descriptor *)(image + offset);
+
+	/* address of top level container content */
+	offset = le_to_uint(descriptor->content_address);
+	num_of_containers = le_to_uint(descriptor->content_length) / 4;
+
+	for (ii = 0; ii < num_of_containers; ii++) {
+		addr = le_to_uint(image + offset);
+		offset += 4;
+		descriptor = (struct container_descriptor *)(image + addr);
+		container_id = descriptor->container_id[0] |
+				descriptor->container_id[1] << 8;
+		content = image + le_to_uint(descriptor->content_address);
+		length = le_to_uint(descriptor->content_length);
+		switch (container_id) {
+		case UI_CONTAINER:
+		case CORE_CODE_CONTAINER:
+			fwu->img.ui_firmware.data = content;
+			fwu->img.ui_firmware.size = length;
+			break;
+		case UI_CONFIG_CONTAINER:
+		case CORE_CONFIG_CONTAINER:
+			fwu->img.ui_config.data = content;
+			fwu->img.ui_config.size = length;
+			break;
+		case BL_CONTAINER:
+			fwu->img.bl_version = *content;
+			fwu->img.bootloader.data = content;
+			fwu->img.bootloader.size = length;
+			fwu_parse_image_header_10_bootloader(image);
+			break;
+		case UTILITY_CONTAINER:
+			fwu->img.utility.data = content;
+			fwu->img.utility.size = length;
+			fwu_parse_image_header_10_utility(image);
+			break;
+		case GUEST_CODE_CONTAINER:
+			fwu->img.contains_guest_code = true;
+			fwu->img.guest_code.data = content;
+			fwu->img.guest_code.size = length;
+			break;
+		case DISPLAY_CONFIG_CONTAINER:
+			fwu->img.contains_disp_config = true;
+			fwu->img.dp_config.data = content;
+			fwu->img.dp_config.size = length;
+			break;
+		case PERMANENT_CONFIG_CONTAINER:
+		case GUEST_SERIALIZATION_CONTAINER:
+			fwu->img.contains_perm_config = true;
+			fwu->img.pm_config.data = content;
+			fwu->img.pm_config.size = length;
+			break;
+		case FLASH_CONFIG_CONTAINER:
+			fwu->img.contains_flash_config = true;
+			fwu->img.fl_config.data = content;
+			fwu->img.fl_config.size = length;
+			break;
+		case GENERAL_INFORMATION_CONTAINER:
+			fwu->img.contains_firmware_id = true;
+			fwu->img.firmware_id = le_to_uint(content + 4);
+			break;
+		default:
+			break;
+		}
+	}
+
+}
+
+static void fwu_parse_image_header_05_06(void)
+{
+	int retval;
+	const unsigned char *image;
+	struct image_header_05_06 *header;
+
+	TPD_ERR("%s: enter\n", __func__);
+
+	image = fwu->image;
+	header = (struct image_header_05_06 *)image;
+
+	fwu->img.checksum = le_to_uint(header->checksum);
+
+	fwu->img.bl_version = header->header_version;
+
+	fwu->img.contains_bootloader = header->options_bootloader;
+	if (fwu->img.contains_bootloader)
+		fwu->img.bootloader_size = le_to_uint(header->bootloader_size);
+
+	fwu->img.ui_firmware.size = le_to_uint(header->firmware_size);
+	if (fwu->img.ui_firmware.size) {
+		fwu->img.ui_firmware.data = image + IMAGE_AREA_OFFSET;
+		if (fwu->img.contains_bootloader)
+			fwu->img.ui_firmware.data += fwu->img.bootloader_size;
+	}
+
+	if ((fwu->img.bl_version == BL_V6) && header->options_tddi)
+		fwu->img.ui_firmware.data = image + IMAGE_AREA_OFFSET;
+
+	fwu->img.ui_config.size = le_to_uint(header->config_size);
+	if (fwu->img.ui_config.size) {
+		fwu->img.ui_config.data = fwu->img.ui_firmware.data +
+				fwu->img.ui_firmware.size;
+	}
+
+	if (fwu->img.contains_bootloader || header->options_tddi)
+		fwu->img.contains_disp_config = true;
+	else
+		fwu->img.contains_disp_config = false;
+
+	if (fwu->img.contains_disp_config) {
+		fwu->img.disp_config_offset = le_to_uint(header->dsp_cfg_addr);
+		fwu->img.dp_config.size = le_to_uint(header->dsp_cfg_size);
+		fwu->img.dp_config.data = image + fwu->img.disp_config_offset;
+	} else {
+		retval = secure_memcpy(fwu->img.cstmr_product_id,
+				sizeof(fwu->img.cstmr_product_id),
+				header->cstmr_product_id,
+				sizeof(header->cstmr_product_id),
+				PRODUCT_ID_SIZE);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to copy custom product ID string\n",
+					__func__);
+		}
+		fwu->img.cstmr_product_id[PRODUCT_ID_SIZE] = 0;
+	}
+
+	fwu->img.contains_firmware_id = header->options_firmware_id;
+	if (fwu->img.contains_firmware_id)
+		fwu->img.firmware_id = le_to_uint(header->firmware_id);
+
+	retval = secure_memcpy(fwu->img.product_id,
+			sizeof(fwu->img.product_id),
+			header->product_id,
+			sizeof(header->product_id),
+			PRODUCT_ID_SIZE);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to copy product ID string\n",
+				__func__);
+	}
+	fwu->img.product_id[PRODUCT_ID_SIZE] = 0;
+
+	fwu->img.lockdown.size = LOCKDOWN_SIZE;
+	fwu->img.lockdown.data = image + IMAGE_AREA_OFFSET - LOCKDOWN_SIZE;
+
+}
+
+static int fwu_parse_image_info(void)
+{
+	struct image_header_10 *header;
+
+	TPD_DEBUG("%s: enter\n", __func__);
+	header = (struct image_header_10 *)fwu->image;
+
+	memset(&fwu->img, 0x00, sizeof(fwu->img));
+	switch (header->major_header_version) {
+	case IMAGE_HEADER_VERSION_10:
+		fwu_parse_image_header_10();
+		break;
+	case IMAGE_HEADER_VERSION_05:
+	case IMAGE_HEADER_VERSION_06:
+		fwu_parse_image_header_05_06();
+		break;
+	default:
+		TPD_ERR("%s: Unsupported image file format (0x%02x)\n",
+				__func__, header->major_header_version);
+		return -EINVAL;
+	}
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8) {
+		if (!fwu->img.contains_flash_config) {
+			TPD_ERR("%s: No flash config found in firmware image\n",
+					__func__);
+			return -EINVAL;
+		}
+
+		fwu_parse_partition_table(fwu->img.fl_config.data,
+				&fwu->img.blkcount, &fwu->img.phyaddr);
+
+		if (fwu->img.blkcount.utility_param)
+			fwu->img.contains_utility_param = true;
+
+		fwu_compare_partition_tables();
+	} else {
+		fwu->new_partition_table = false;
+		fwu->incompatible_partition_tables = false;
+	}
+
+	return 0;
+}
+
+static int fwu_read_flash_status(void)
+{
+	int retval;
+	unsigned char status;
+	unsigned char command;
+
+	TPD_DEBUG("%s: enter\n", __func__);
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			fwu->f34_fd.data_base_addr + fwu->off.flash_status,
+			&status,
+			sizeof(status));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash status\n",
+				__func__);
+		return retval;
+	}
+
+	fwu->in_bl_mode = status >> 7;
+
+	if (fwu->bl_version == BL_V5)
+		fwu->flash_status = (status >> 4) & MASK_3BIT;
+	else if (fwu->bl_version == BL_V6)
+		fwu->flash_status = status & MASK_3BIT;
+	else if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		fwu->flash_status = status & MASK_5BIT;
+
+	if (fwu->write_bootloader)
+		fwu->flash_status = 0x00;
+
+	if (fwu->flash_status != 0x00) {
+		TPD_ERR("%s: Flash status = %d, command = 0x%02x\n",
+				__func__, fwu->flash_status, fwu->command);
+	}
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8) {
+		if (fwu->flash_status == 0x08)
+			fwu->flash_status = 0x00;
+	}
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			fwu->f34_fd.data_base_addr + fwu->off.flash_cmd,
+			&command,
+			sizeof(command));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash command\n",
+				__func__);
+		return retval;
+	}
+
+	if (fwu->bl_version == BL_V5)
+		fwu->command = command & MASK_4BIT;
+	else if (fwu->bl_version == BL_V6)
+		fwu->command = command & MASK_6BIT;
+	else if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		fwu->command = command;
+
+	if (fwu->write_bootloader)
+		fwu->command = 0x00;
+
+	return 0;
+}
+
+static int fwu_wait_for_idle(int timeout_ms, bool poll)
+{
+	int count = 0;
+	int timeout_count = ((timeout_ms * 1000) / MAX_SLEEP_TIME_US) + 1;
+
+	TPD_DEBUG("%s: enter\n", __func__);
+	do {
+		usleep_range(MIN_SLEEP_TIME_US, MAX_SLEEP_TIME_US);
+
+		count++;
+		if (poll || (count == timeout_count))
+			fwu_read_flash_status();
+
+		if ((fwu->command == CMD_IDLE) && (fwu->flash_status == 0x00))
+			return 0;
+	} while (count < timeout_count);
+
+	TPD_ERR("%s: Timed out waiting for idle status\n",
+			__func__);
+
+	return -ETIMEDOUT;
+}
+
+static int fwu_write_f34_v7_command_single_transaction(unsigned char cmd)
+{
+	int retval;
+	unsigned char data_base;
+	struct f34_v7_data_1_5 data_1_5;
+
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	memset(data_1_5.data, 0x00, sizeof(data_1_5.data));
+
+	switch (cmd) {
+	case CMD_ERASE_ALL:
+		data_1_5.partition_id = CORE_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE_AP;
+		break;
+	case CMD_ERASE_UI_FIRMWARE:
+		data_1_5.partition_id = CORE_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_BL_CONFIG:
+		data_1_5.partition_id = GLOBAL_PARAMETERS_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_UI_CONFIG:
+		data_1_5.partition_id = CORE_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_DISP_CONFIG:
+		data_1_5.partition_id = DISPLAY_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_FLASH_CONFIG:
+		data_1_5.partition_id = FLASH_CONFIG_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_GUEST_CODE:
+		data_1_5.partition_id = GUEST_CODE_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_BOOTLOADER:
+		data_1_5.partition_id = BOOTLOADER_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ERASE_UTILITY_PARAMETER:
+		data_1_5.partition_id = UTILITY_PARAMETER_PARTITION;
+		data_1_5.command = CMD_V7_ERASE;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		data_1_5.partition_id = BOOTLOADER_PARTITION;
+		data_1_5.command = CMD_V7_ENTER_BL;
+		break;
+	};
+
+	data_1_5.payload_0 = fwu->bootloader_id[0];
+	data_1_5.payload_1 = fwu->bootloader_id[1];
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.partition_id,
+			data_1_5.data,
+			sizeof(data_1_5.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write single transaction command\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_v7_command(unsigned char cmd)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char command;
+
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	switch (cmd) {
+	case CMD_WRITE_FW:
+	case CMD_WRITE_CONFIG:
+	case CMD_WRITE_LOCKDOWN:
+	case CMD_WRITE_GUEST_CODE:
+	case CMD_WRITE_BOOTLOADER:
+	case CMD_WRITE_UTILITY_PARAM:
+		command = CMD_V7_WRITE;
+		break;
+	case CMD_READ_CONFIG:
+		command = CMD_V7_READ;
+		break;
+	case CMD_ERASE_ALL:
+		command = CMD_V7_ERASE_AP;
+		break;
+	case CMD_ERASE_UI_FIRMWARE:
+	case CMD_ERASE_BL_CONFIG:
+	case CMD_ERASE_UI_CONFIG:
+	case CMD_ERASE_DISP_CONFIG:
+	case CMD_ERASE_FLASH_CONFIG:
+	case CMD_ERASE_GUEST_CODE:
+	case CMD_ERASE_BOOTLOADER:
+	case CMD_ERASE_UTILITY_PARAMETER:
+		command = CMD_V7_ERASE;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		command = CMD_V7_ENTER_BL;
+		break;
+	default:
+		TPD_ERR("%s: Invalid command 0x%02x\n",
+				__func__, cmd);
+		return -EINVAL;
+	};
+
+	fwu->command = command;
+
+	switch (cmd) {
+	case CMD_ERASE_ALL:
+	case CMD_ERASE_UI_FIRMWARE:
+	case CMD_ERASE_BL_CONFIG:
+	case CMD_ERASE_UI_CONFIG:
+	case CMD_ERASE_DISP_CONFIG:
+	case CMD_ERASE_FLASH_CONFIG:
+	case CMD_ERASE_GUEST_CODE:
+	case CMD_ERASE_BOOTLOADER:
+	case CMD_ERASE_UTILITY_PARAMETER:
+	case CMD_ENABLE_FLASH_PROG:
+		retval = fwu_write_f34_v7_command_single_transaction(cmd);
+		if (retval < 0)
+			return retval;
+		else
+			return 0;
+	default:
+		break;
+	};
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.flash_cmd,
+			&command,
+			sizeof(command));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write flash command\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_v5v6_command(unsigned char cmd)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char command;
+
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	switch (cmd) {
+	case CMD_IDLE:
+		command = CMD_V5V6_IDLE;
+		break;
+	case CMD_WRITE_FW:
+		command = CMD_V5V6_WRITE_FW;
+		break;
+	case CMD_WRITE_CONFIG:
+		command = CMD_V5V6_WRITE_CONFIG;
+		break;
+	case CMD_WRITE_LOCKDOWN:
+		command = CMD_V5V6_WRITE_LOCKDOWN;
+		break;
+	case CMD_WRITE_GUEST_CODE:
+		command = CMD_V5V6_WRITE_GUEST_CODE;
+		break;
+	case CMD_READ_CONFIG:
+		command = CMD_V5V6_READ_CONFIG;
+		break;
+	case CMD_ERASE_ALL:
+		command = CMD_V5V6_ERASE_ALL;
+		break;
+	case CMD_ERASE_UI_CONFIG:
+		command = CMD_V5V6_ERASE_UI_CONFIG;
+		break;
+	case CMD_ERASE_DISP_CONFIG:
+		command = CMD_V5V6_ERASE_DISP_CONFIG;
+		break;
+	case CMD_ERASE_GUEST_CODE:
+		command = CMD_V5V6_ERASE_GUEST_CODE;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		command = CMD_V5V6_ENABLE_FLASH_PROG;
+		break;
+	default:
+		TPD_ERR("%s: Invalid command 0x%02x\n",
+				__func__, cmd);
+		return -EINVAL;
+	}
+
+	switch (cmd) {
+	case CMD_ERASE_ALL:
+	case CMD_ERASE_UI_CONFIG:
+	case CMD_ERASE_DISP_CONFIG:
+	case CMD_ERASE_GUEST_CODE:
+	case CMD_ENABLE_FLASH_PROG:
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				data_base + fwu->off.payload,
+				fwu->bootloader_id,
+				sizeof(fwu->bootloader_id));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write bootloader ID\n",
+					__func__);
+			return retval;
+		}
+		break;
+	default:
+		break;
+	};
+
+	fwu->command = command;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.flash_cmd,
+			&command,
+			sizeof(command));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write command 0x%02x\n",
+				__func__, command);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_command(unsigned char cmd)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		retval = fwu_write_f34_v7_command(cmd);
+	else
+		retval = fwu_write_f34_v5v6_command(cmd);
+
+	return retval;
+}
+
+static int fwu_write_f34_v7_partition_id(unsigned char cmd)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char partition = 0;
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	switch (cmd) {
+	case CMD_WRITE_FW:
+		partition = CORE_CODE_PARTITION;
+		break;
+	case CMD_WRITE_CONFIG:
+	case CMD_READ_CONFIG:
+		if (fwu->config_area == UI_CONFIG_AREA)
+			partition = CORE_CONFIG_PARTITION;
+		else if (fwu->config_area == DP_CONFIG_AREA)
+			partition = DISPLAY_CONFIG_PARTITION;
+		else if (fwu->config_area == PM_CONFIG_AREA)
+			partition = GUEST_SERIALIZATION_PARTITION;
+		else if (fwu->config_area == BL_CONFIG_AREA)
+			partition = GLOBAL_PARAMETERS_PARTITION;
+		else if (fwu->config_area == FLASH_CONFIG_AREA)
+			partition = FLASH_CONFIG_PARTITION;
+		else if (fwu->config_area == UPP_AREA)
+			partition = UTILITY_PARAMETER_PARTITION;
+		break;
+	case CMD_WRITE_LOCKDOWN:
+		partition = DEVICE_CONFIG_PARTITION;
+		break;
+	case CMD_WRITE_GUEST_CODE:
+		partition = GUEST_CODE_PARTITION;
+		break;
+	case CMD_WRITE_BOOTLOADER:
+		partition = BOOTLOADER_PARTITION;
+		break;
+	case CMD_WRITE_UTILITY_PARAM:
+		partition = UTILITY_PARAMETER_PARTITION;
+		break;
+	case CMD_ERASE_ALL:
+		partition = CORE_CODE_PARTITION;
+		break;
+	case CMD_ERASE_BL_CONFIG:
+		partition = GLOBAL_PARAMETERS_PARTITION;
+		break;
+	case CMD_ERASE_UI_CONFIG:
+		partition = CORE_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_DISP_CONFIG:
+		partition = DISPLAY_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_FLASH_CONFIG:
+		partition = FLASH_CONFIG_PARTITION;
+		break;
+	case CMD_ERASE_GUEST_CODE:
+		partition = GUEST_CODE_PARTITION;
+		break;
+	case CMD_ERASE_BOOTLOADER:
+		partition = BOOTLOADER_PARTITION;
+		break;
+	case CMD_ENABLE_FLASH_PROG:
+		partition = BOOTLOADER_PARTITION;
+		break;
+	default:
+		TPD_ERR("%s: Invalid command 0x%02x\n",
+				__func__, cmd);
+		return -EINVAL;
+	};
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.partition_id,
+			&partition,
+			sizeof(partition));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write partition ID\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_partition_id(unsigned char cmd)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		retval = fwu_write_f34_v7_partition_id(cmd);
+	else
+		retval = 0;
+
+	return retval;
+}
+
+static int fwu_read_f34_v7_partition_table(unsigned char *partition_table)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char length[2];
+	unsigned short block_number = 0;
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	fwu->config_area = FLASH_CONFIG_AREA;
+
+	retval = fwu_write_f34_partition_id(CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.block_number,
+			(unsigned char *)&block_number,
+			sizeof(block_number));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	length[0] = (unsigned char)(fwu->flash_config_length & MASK_8BIT);
+	length[1] = (unsigned char)(fwu->flash_config_length >> 8);
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.transfer_length,
+			length,
+			sizeof(length));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write transfer length\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_write_f34_command(CMD_READ_CONFIG);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write command\n",
+				__func__);
+		return retval;
+	}
+
+	retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to wait for idle status\n",
+				__func__);
+		return retval;
+	}
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			data_base + fwu->off.payload,
+			partition_table,
+			fwu->partition_table_bytes);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read block data\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_read_f34_v7_queries(void)
+{
+	int retval;
+	unsigned char ii;
+	unsigned char query_base;
+	unsigned char index;
+	unsigned char offset;
+	unsigned char *ptable;
+	struct f34_v7_query_0 query_0;
+	struct f34_v7_query_1_7 query_1_7;
+
+	query_base = fwu->f34_fd.query_base_addr;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base,
+			query_0.data,
+			sizeof(query_0.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read query 0\n",
+				__func__);
+		return retval;
+	}
+
+	offset = query_0.subpacket_1_size + 1;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base + offset,
+			query_1_7.data,
+			sizeof(query_1_7.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read queries 1 to 7\n",
+				__func__);
+		return retval;
+	}
+
+	fwu->bootloader_id[0] = query_1_7.bl_minor_revision;
+	fwu->bootloader_id[1] = query_1_7.bl_major_revision;
+
+	if (fwu->bootloader_id[1] == BL_V8)
+		fwu->bl_version = BL_V8;
+
+	fwu->block_size = query_1_7.block_size_15_8 << 8 |
+			query_1_7.block_size_7_0;
+
+	fwu->flash_config_length = query_1_7.flash_config_length_15_8 << 8 |
+			query_1_7.flash_config_length_7_0;
+
+	fwu->payload_length = query_1_7.payload_length_15_8 << 8 |
+			query_1_7.payload_length_7_0;
+
+	fwu->off.flash_status = V7_FLASH_STATUS_OFFSET;
+	fwu->off.partition_id = V7_PARTITION_ID_OFFSET;
+	fwu->off.block_number = V7_BLOCK_NUMBER_OFFSET;
+	fwu->off.transfer_length = V7_TRANSFER_LENGTH_OFFSET;
+	fwu->off.flash_cmd = V7_COMMAND_OFFSET;
+	fwu->off.payload = V7_PAYLOAD_OFFSET;
+
+	index = sizeof(query_1_7.data) - V7_PARTITION_SUPPORT_BYTES;
+
+	fwu->partitions = 0;
+	for (offset = 0; offset < V7_PARTITION_SUPPORT_BYTES; offset++) {
+		for (ii = 0; ii < 8; ii++) {
+			if (query_1_7.data[index + offset] & (1 << ii))
+				fwu->partitions++;
+		}
+
+		TPD_DEBUG("%s: Supported partitions: 0x%02x\n",
+				__func__, query_1_7.data[index + offset]);
+	}
+
+	fwu->partition_table_bytes = fwu->partitions * 8 + 2;
+
+	ptable = kzalloc(fwu->partition_table_bytes, GFP_KERNEL);
+	if (!ptable) {
+		TPD_ERR("%s: Failed to alloc mem for partition table\n",
+				__func__);
+		return -ENOMEM;
+	}
+
+	retval = fwu_read_f34_v7_partition_table(ptable);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read partition table\n",
+				__func__);
+		kfree(ptable);
+		return retval;
+	}
+
+	fwu_parse_partition_table(ptable, &fwu->blkcount, &fwu->phyaddr);
+
+	if (fwu->blkcount.dp_config)
+		fwu->flash_properties.has_disp_config = 1;
+	else
+		fwu->flash_properties.has_disp_config = 0;
+
+	if (fwu->blkcount.pm_config)
+		fwu->flash_properties.has_pm_config = 1;
+	else
+		fwu->flash_properties.has_pm_config = 0;
+
+	if (fwu->blkcount.bl_config)
+		fwu->flash_properties.has_bl_config = 1;
+	else
+		fwu->flash_properties.has_bl_config = 0;
+
+	if (fwu->blkcount.guest_code)
+		fwu->has_guest_code = 1;
+	else
+		fwu->has_guest_code = 0;
+
+	if (fwu->blkcount.utility_param)
+		fwu->has_utility_param = 1;
+	else
+		fwu->has_utility_param = 0;
+
+	kfree(ptable);
+
+	return 0;
+}
+
+static int fwu_read_f34_v5v6_queries(void)
+{
+	int retval;
+	unsigned char count;
+	unsigned char query_base;
+	unsigned char buf[10];
+	struct f34_v5v6_flash_properties_2 properties_2;
+
+	query_base = fwu->f34_fd.query_base_addr;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base + V5V6_BOOTLOADER_ID_OFFSET,
+			fwu->bootloader_id,
+			sizeof(fwu->bootloader_id));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read bootloader ID\n",
+				__func__);
+		return retval;
+	}
+
+	if (fwu->bl_version == BL_V5) {
+		fwu->off.properties = V5_PROPERTIES_OFFSET;
+		fwu->off.block_size = V5_BLOCK_SIZE_OFFSET;
+		fwu->off.block_count = V5_BLOCK_COUNT_OFFSET;
+		fwu->off.block_number = V5_BLOCK_NUMBER_OFFSET;
+		fwu->off.payload = V5_BLOCK_DATA_OFFSET;
+	} else if (fwu->bl_version == BL_V6) {
+		fwu->off.properties = V6_PROPERTIES_OFFSET;
+		fwu->off.properties_2 = V6_PROPERTIES_2_OFFSET;
+		fwu->off.block_size = V6_BLOCK_SIZE_OFFSET;
+		fwu->off.block_count = V6_BLOCK_COUNT_OFFSET;
+		fwu->off.gc_block_count = V6_GUEST_CODE_BLOCK_COUNT_OFFSET;
+		fwu->off.block_number = V6_BLOCK_NUMBER_OFFSET;
+		fwu->off.payload = V6_BLOCK_DATA_OFFSET;
+	}
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base + fwu->off.block_size,
+			buf,
+			2);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read block size info\n",
+				__func__);
+		return retval;
+	}
+
+	batohs(&fwu->block_size, &(buf[0]));
+
+	if (fwu->bl_version == BL_V5) {
+		fwu->off.flash_cmd = fwu->off.payload + fwu->block_size;
+		fwu->off.flash_status = fwu->off.flash_cmd;
+	} else if (fwu->bl_version == BL_V6) {
+		fwu->off.flash_cmd = V6_FLASH_COMMAND_OFFSET;
+		fwu->off.flash_status = V6_FLASH_STATUS_OFFSET;
+	}
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base + fwu->off.properties,
+			fwu->flash_properties.data,
+			sizeof(fwu->flash_properties.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash properties\n",
+				__func__);
+		return retval;
+	}
+
+	count = 4;
+
+	if (fwu->flash_properties.has_pm_config)
+		count += 2;
+
+	if (fwu->flash_properties.has_bl_config)
+		count += 2;
+
+	if (fwu->flash_properties.has_disp_config)
+		count += 2;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			query_base + fwu->off.block_count,
+			buf,
+			count);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read block count info\n",
+				__func__);
+		return retval;
+	}
+
+	batohs(&fwu->blkcount.ui_firmware, &(buf[0]));
+	batohs(&fwu->blkcount.ui_config, &(buf[2]));
+
+	count = 4;
+
+	if (fwu->flash_properties.has_pm_config) {
+		batohs(&fwu->blkcount.pm_config, &(buf[count]));
+		count += 2;
+	}
+
+	if (fwu->flash_properties.has_bl_config) {
+		batohs(&fwu->blkcount.bl_config, &(buf[count]));
+		count += 2;
+	}
+
+	if (fwu->flash_properties.has_disp_config)
+		batohs(&fwu->blkcount.dp_config, &(buf[count]));
+
+	fwu->has_guest_code = false;
+
+	if (fwu->flash_properties.has_query4) {
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				query_base + fwu->off.properties_2,
+				properties_2.data,
+				sizeof(properties_2.data));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read flash properties 2\n",
+					__func__);
+			return retval;
+		}
+
+		if (properties_2.has_guest_code) {
+			retval = synaptics_rmi4_reg_read(fwu->client,
+					query_base + fwu->off.gc_block_count,
+					buf,
+					2);
+			if (retval < 0) {
+			TPD_ERR("%s: Failed to read guest count\n",
+						__func__);
+				return retval;
+			}
+
+			batohs(&fwu->blkcount.guest_code, &(buf[0]));
+			fwu->has_guest_code = true;
+		}
+	}
+
+	fwu->has_utility_param = false;
+
+	return 0;
+}
+
+static int fwu_read_f34_queries(void)
+{
+	int retval;
+
+	memset(&fwu->blkcount, 0x00, sizeof(fwu->blkcount));
+	memset(&fwu->phyaddr, 0x00, sizeof(fwu->phyaddr));
+
+	if (fwu->bl_version == BL_V7)
+		retval = fwu_read_f34_v7_queries();
+	else
+		retval = fwu_read_f34_v5v6_queries();
+
+	return retval;
+}
+
+static int fwu_write_f34_v7_blocks(unsigned char *block_ptr,
+		unsigned short block_cnt, unsigned char command)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char length[2];
+	unsigned short transfer;
+	unsigned short remaining = block_cnt;
+	unsigned short block_number = 0;
+	unsigned short left_bytes;
+	unsigned short write_size;
+	unsigned short max_write_size;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	data_base = fwu->f34_fd.data_base_addr;
+
+	retval = fwu_write_f34_partition_id(command);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.block_number,
+			(unsigned char *)&block_number,
+			sizeof(block_number));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	do {
+		if (remaining / fwu->payload_length)
+			transfer = fwu->payload_length;
+		else
+			transfer = remaining;
+
+		length[0] = (unsigned char)(transfer & MASK_8BIT);
+		length[1] = (unsigned char)(transfer >> 8);
+
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				data_base + fwu->off.transfer_length,
+				length,
+				sizeof(length));
+		if (retval < 0) {
+		TPD_ERR("%s:Failed write transfer length remaining %d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+			TPD_ERR("%s:Failedwrite command remaining%d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+#ifdef MAX_WRITE_SIZE
+		max_write_size = MAX_WRITE_SIZE;
+		if (max_write_size >= transfer * fwu->block_size)
+			max_write_size = transfer * fwu->block_size;
+		else if (max_write_size > fwu->block_size)
+			max_write_size -= max_write_size % fwu->block_size;
+		else
+			max_write_size = fwu->block_size;
+#else
+		max_write_size = transfer * fwu->block_size;
+#endif
+		left_bytes = transfer * fwu->block_size;
+
+		do {
+			if (left_bytes / max_write_size)
+				write_size = max_write_size;
+			else
+				write_size = left_bytes;
+
+			retval = synaptics_rmi4_reg_write(fwu->client,
+					data_base + fwu->off.payload,
+					block_ptr,
+					write_size);
+			if (retval < 0) {
+			TPD_ERR("%s: Failed to write (remaining = %d)\n",
+						__func__, remaining);
+				return retval;
+			}
+
+			block_ptr += write_size;
+			left_bytes -= write_size;
+		} while (left_bytes);
+		/*moragan the pollingwap to increase firmware time */
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, true);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to wait idle (remaining %d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		remaining -= transfer;
+	} while (remaining);
+
+	return 0;
+}
+
+static int fwu_write_f34_v5v6_blocks(unsigned char *block_ptr,
+		unsigned short block_cnt, unsigned char command)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char block_number[] = {0, 0};
+	unsigned short blk;
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	block_number[1] |= (fwu->config_area << 5);
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.block_number,
+			block_number,
+			sizeof(block_number));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	for (blk = 0; blk < block_cnt; blk++) {
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				data_base + fwu->off.payload,
+				block_ptr,
+				fwu->block_size);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write block data (block %d)\n",
+					__func__, blk);
+			return retval;
+		}
+
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write command for block %d\n",
+					__func__, blk);
+			return retval;
+		}
+
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, false);
+		if (retval < 0) {
+			TPD_ERR("%s Failed wait idle status (block %d)\n",
+					__func__, blk);
+			return retval;
+		}
+
+		block_ptr += fwu->block_size;
+	}
+
+	return 0;
+}
+
+static int fwu_write_f34_blocks(unsigned char *block_ptr,
+		unsigned short block_cnt, unsigned char cmd)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		retval = fwu_write_f34_v7_blocks(block_ptr, block_cnt, cmd);
+	else
+		retval = fwu_write_f34_v5v6_blocks(block_ptr, block_cnt, cmd);
+
+	return retval;
+}
+
+static int fwu_read_f34_v7_blocks(unsigned short block_cnt,
+		unsigned char command)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char length[2];
+	unsigned short transfer;
+	unsigned short remaining = block_cnt;
+	unsigned short block_number = 0;
+	unsigned short index = 0;
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	retval = fwu_write_f34_partition_id(command);
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.block_number,
+			(unsigned char *)&block_number,
+			sizeof(block_number));
+	if (retval < 0) {
+	TPD_ERR("%s: Failed to writeblocknumber\n",
+				__func__);
+		return retval;
+	}
+
+	do {
+		if (remaining / fwu->payload_length)
+			transfer = fwu->payload_length;
+		else
+			transfer = remaining;
+
+		length[0] = (unsigned char)(transfer & MASK_8BIT);
+		length[1] = (unsigned char)(transfer >> 8);
+
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				data_base + fwu->off.transfer_length,
+				length,
+				sizeof(length));
+		if (retval < 0) {
+			TPD_ERR("%s Failed write transferlengthremaining%d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+		TPD_ERR("%s:Failedwrite command remaining %d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, false);
+		if (retval < 0) {
+			TPD_ERR("%s:Failed to wait dle remaining %d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				data_base + fwu->off.payload,
+				&fwu->read_config_buf[index],
+				transfer * fwu->block_size);
+		if (retval < 0) {
+		TPD_ERR("%s:Failed read dataremaining%d)\n",
+					__func__, remaining);
+			return retval;
+		}
+
+		index += (transfer * fwu->block_size);
+		remaining -= transfer;
+	} while (remaining);
+
+	return 0;
+}
+
+static int fwu_read_f34_v5v6_blocks(unsigned short block_cnt,
+		unsigned char command)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char block_number[] = {0, 0};
+	unsigned short blk;
+	unsigned short index = 0;
+
+	data_base = fwu->f34_fd.data_base_addr;
+
+	block_number[1] |= (fwu->config_area << 5);
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			data_base + fwu->off.block_number,
+			block_number,
+			sizeof(block_number));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write block number\n",
+				__func__);
+		return retval;
+	}
+
+	for (blk = 0; blk < block_cnt; blk++) {
+		retval = fwu_write_f34_command(command);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write read config command\n",
+					__func__);
+			return retval;
+		}
+
+		retval = fwu_wait_for_idle(WRITE_WAIT_MS, false);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to wait for idle status\n",
+					__func__);
+			return retval;
+		}
+
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				data_base + fwu->off.payload,
+				&fwu->read_config_buf[index],
+				fwu->block_size);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read block data (block %d)\n",
+					__func__, blk);
+			return retval;
+		}
+
+		index += fwu->block_size;
+	}
+
+	return 0;
+}
+
+static int fwu_read_f34_blocks(unsigned short block_cnt, unsigned char cmd)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		retval = fwu_read_f34_v7_blocks(block_cnt, cmd);
+	else
+		retval = fwu_read_f34_v5v6_blocks(block_cnt, cmd);
+
+	return retval;
+}
+
+static int fwu_get_image_firmware_id(unsigned int *fw_id)
+{
+	int retval;
+	unsigned char index = 0;
+	char *strptr;
+	char *firmware_id;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	if (fwu->img.contains_firmware_id) {
+		*fw_id = fwu->img.firmware_id;
+	} else {
+		strptr = strnstr(fwu->image_name, "PR", MAX_IMAGE_NAME_LEN);
+		if (!strptr) {
+		TPD_ERR("%s: No valid PR number found in image name(%s)\n",
+					__func__, fwu->image_name);
+			return -EINVAL;
+		}
+		TPD_DEBUG("%s enter 2 strptr %s\n", __func__, strptr);
+		strptr += 2;
+		firmware_id = kzalloc(MAX_FIRMWARE_ID_LEN, GFP_KERNEL);
+		if (!firmware_id) {
+			TPD_ERR("%s: Failed to alloc mem for firmware_id\n",
+					__func__);
+			return -ENOMEM;
+		}
+		while (strptr[index] >= '0' && strptr[index] <= '9') {
+			firmware_id[index] = strptr[index];
+			index++;
+		}
+		TPD_DEBUG("%s enter 3 firmware_id %s\n",
+				__func__, firmware_id);
+		retval = sstrtoul(firmware_id, 10, (unsigned long *)fw_id);
+		kfree(firmware_id);
+		if (retval) {
+			TPD_ERR("%s: Failed to obtain image firmware ID\n",
+					__func__);
+			return -EINVAL;
+		}
+	}
+
+	return 0;
+}
+
+static int fwu_get_device_config_id(void)
+{
+	int retval;
+	unsigned char config_id_size;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		config_id_size = V7_CONFIG_ID_SIZE;
+	else
+		config_id_size = V5V6_CONFIG_ID_SIZE;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+				fwu->f34_fd.ctrl_base_addr,
+				fwu->config_id,
+				config_id_size);
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static enum flash_area fwu_go_nogo(void)
+{
+	int retval;
+	enum flash_area flash_area = NONE;
+	unsigned char ii;
+	unsigned char config_id_size;
+	unsigned int device_fw_id;
+	unsigned int image_fw_id;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s enter\n", __func__);
+
+	if (rmi4_data->force) {
+		flash_area = UI_FIRMWARE;
+		TPD_ERR("%s force update firmware\n", __func__);
+		goto exit;
+	}
+
+	if (fwu->force_update) {
+		flash_area = UI_FIRMWARE;
+		goto exit;
+	}
+
+	/* Update both UI and config if device is in bootloader mode */
+	if (fwu->bl_mode_device) {
+		flash_area = UI_FIRMWARE;
+		goto exit;
+	}
+
+	/* Get device firmware ID */
+	device_fw_id = rmi4_data->firmware_id;
+	TPD_ERR("%s: Device firmware ID = %d\n",
+			__func__, device_fw_id);
+
+	/* Get image firmware ID */
+	retval = fwu_get_image_firmware_id(&image_fw_id);
+	if (retval < 0) {
+		flash_area = NONE;
+		goto exit;
+	}
+	TPD_ERR("%s: Image firmware ID = %d\n",
+			__func__, image_fw_id);
+
+	if (image_fw_id > device_fw_id) {
+		flash_area = UI_FIRMWARE;
+		goto exit;
+	} else if (image_fw_id < device_fw_id) {
+		TPD_ERR("%s: Image firmware ID older than device firmware ID\n",
+				__func__);
+		flash_area = UI_FIRMWARE;
+		goto exit;
+	}
+
+	/* Get device config ID */
+	retval = fwu_get_device_config_id();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read device config ID\n",
+				__func__);
+		flash_area = NONE;
+		goto exit;
+	}
+
+	if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+		config_id_size = V7_CONFIG_ID_SIZE;
+	else
+		config_id_size = V5V6_CONFIG_ID_SIZE;
+
+	for (ii = 0; ii < config_id_size; ii++) {
+		if (fwu->img.ui_config.data[ii] > fwu->config_id[ii]) {
+			flash_area = UI_CONFIG;
+			goto exit;
+		} else if (fwu->img.ui_config.data[ii] < fwu->config_id[ii]) {
+			flash_area = UI_CONFIG;
+			goto exit;
+		}
+	}
+
+	flash_area = NONE;
+
+exit:
+	if (flash_area == NONE) {
+		TPD_ERR("%s: No need to do reflash\n",
+				__func__);
+	} else {
+		TPD_ERR("%s: Updating %s\n",
+				__func__,
+				flash_area == UI_FIRMWARE ?
+				"UI firmware and config" :
+				"UI config only");
+	}
+
+	return flash_area;
+}
+
+static int fwu_scan_pdt(void)
+{
+	int retval;
+	unsigned char ii;
+	unsigned char intr_count = 0;
+	unsigned char intr_off;
+	unsigned char intr_src;
+	unsigned short addr;
+	bool f01found = false;
+	bool f34found = false;
+	bool f35found = false;
+	struct synaptics_rmi4_fn_desc2 rmi_fd;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	char add_buf[6] = { 0 };
+
+	fwu->in_ub_mode = false;
+
+	for (addr = PDT_START; addr > PDT_END; addr -= PDT_ENTRY_SIZE) {
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				addr,
+				(unsigned char *)&rmi_fd,
+				sizeof(rmi_fd));
+		if (retval < 0)
+			return retval;
+
+		if (rmi_fd.fn_number) {
+			TPD_DEBUG("%s: Found F%02x\n",
+					__func__, rmi_fd.fn_number);
+			switch (rmi_fd.fn_number) {
+			case SYNAPTICS_RMI4_F01:
+				f01found = true;
+
+				rmi4_data->f01_query_base_addr =
+						rmi_fd.query_base_addr;
+				rmi4_data->f01_ctrl_base_addr =
+						rmi_fd.ctrl_base_addr;
+				rmi4_data->f01_data_base_addr =
+						rmi_fd.data_base_addr;
+				rmi4_data->f01_cmd_base_addr =
+						rmi_fd.cmd_base_addr;
+				break;
+			case SYNAPTICS_RMI4_F34:
+				f34found = true;
+				fwu->f34_fd.query_base_addr =
+						rmi_fd.query_base_addr;
+				fwu->f34_fd.ctrl_base_addr =
+						rmi_fd.ctrl_base_addr;
+				fwu->f34_fd.data_base_addr =
+						rmi_fd.data_base_addr;
+
+				switch (rmi_fd.fn_version) {
+				case F34_V0:
+					fwu->bl_version = BL_V5;
+					break;
+				case F34_V1:
+					fwu->bl_version = BL_V6;
+					break;
+				case F34_V2:
+					fwu->bl_version = BL_V7;
+					break;
+				default:
+					TPD_ERR("%s:Unrecog F34 V\n",
+							__func__);
+					return -EINVAL;
+				}
+
+				fwu->intr_mask = 0;
+				intr_src = rmi_fd.intr_src_count;
+				intr_off = intr_count % 8;
+				for (ii = intr_off;
+						ii < (intr_src + intr_off);
+						ii++) {
+					fwu->intr_mask |= 1 << ii;
+				}
+				break;
+			case SYNAPTICS_RMI4_F35:
+				f35found = true;
+				fwu->f35_fd.query_base_addr =
+						rmi_fd.query_base_addr;
+				fwu->f35_fd.ctrl_base_addr =
+						rmi_fd.ctrl_base_addr;
+				fwu->f35_fd.data_base_addr =
+						rmi_fd.data_base_addr;
+				fwu->f35_fd.cmd_base_addr =
+						rmi_fd.cmd_base_addr;
+				break;
+			}
+		} else {
+			break;
+		}
+
+		intr_count += rmi_fd.intr_src_count;
+	}
+
+	if (!f01found || !f34found) {
+		TPD_ERR("%s: Failed to find both F01 and F34\n",
+				__func__);
+		if (!f35found) {
+			TPD_ERR("%s: Failed to find F35\n",
+					__func__);
+			return -EINVAL;
+		} else {
+			fwu->in_ub_mode = true;
+			TPD_ERR("%s: In microbootloader mode\n",
+					__func__);
+			fwu_recovery_check_status();
+			return 0;
+		}
+	}
+
+	rmi4_data->intr_mask[0] |= fwu->intr_mask;
+
+	addr = rmi4_data->f01_ctrl_base_addr + 1;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			addr,
+			&(rmi4_data->intr_mask[0]),
+			sizeof(rmi4_data->intr_mask[0]));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to set interrupt enable bit\n",
+				__func__);
+		return retval;
+	}
+	retval = synaptics_rmi4_i2c_read_block(fwu->client,
+		0xE3, sizeof(add_buf), add_buf);
+	fwu->bl_reset_add = add_buf[1];/*0xe4*/
+	return 0;
+}
+
+static int fwu_enter_flash_prog(void)
+{
+	int retval;
+	struct f01_device_control f01_device_control;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	retval = fwu_read_flash_status();
+	if (retval < 0)
+		return retval;
+
+	if (fwu->in_bl_mode)
+		return 0;
+
+	retval = fwu_write_f34_command(CMD_ENABLE_FLASH_PROG);
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_wait_for_idle(ENABLE_WAIT_MS, false);
+	if (retval < 0)
+		return retval;
+
+	if (!fwu->in_bl_mode) {
+		TPD_ERR("%s: BL mode not entered\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	retval = fwu_scan_pdt();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_read_f34_queries();
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			rmi4_data->f01_ctrl_base_addr,
+			f01_device_control.data,
+			sizeof(f01_device_control.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read F01 device control\n",
+				__func__);
+		return retval;
+	}
+
+	f01_device_control.nosleep = true;
+	f01_device_control.sleep_mode = SLEEP_MODE_NORMAL;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			rmi4_data->f01_ctrl_base_addr,
+			f01_device_control.data,
+			sizeof(f01_device_control.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write F01 device control\n",
+				__func__);
+		return retval;
+	}
+
+	msleep(ENTER_FLASH_PROG_WAIT_MS);
+
+	return retval;
+}
+
+static int fwu_check_ui_firmware_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.ui_firmware.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.ui_firmware) {
+		TPD_ERR("%s: UI firmware size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_ui_configuration_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.ui_config.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.ui_config) {
+		TPD_ERR("%s: UI configuration size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_dp_configuration_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.dp_config.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.dp_config) {
+		TPD_ERR("%s: Display configuration size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_bl_configuration_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.bl_config.size / fwu->block_size;
+
+	if (block_count != fwu->blkcount.bl_config) {
+		TPD_ERR("%s: Bootloader configuration size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_check_guest_code_size(void)
+{
+	unsigned short block_count;
+
+	block_count = fwu->img.guest_code.size / fwu->block_size;
+	if (block_count != fwu->blkcount.guest_code) {
+		TPD_ERR("%s: Guest code size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_erase_configuration(void)
+{
+	int retval;
+
+	switch (fwu->config_area) {
+	case UI_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_UI_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case DP_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_DISP_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case BL_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_BL_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case FLASH_CONFIG_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_FLASH_CONFIG);
+		if (retval < 0)
+			return retval;
+		break;
+	case UPP_AREA:
+		retval = fwu_write_f34_command(CMD_ERASE_UTILITY_PARAMETER);
+		if (retval < 0)
+			return retval;
+	default:
+		TPD_ERR("%s: Invalid config area\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	TPD_DEBUG("%s: Erase command written\n",
+			__func__);
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+	if (retval < 0)
+		return retval;
+
+	TPD_DEBUG("%s: Idle status detected\n",
+			__func__);
+
+	return retval;
+}
+
+static int fwu_erase_bootloader(void)
+{
+	int retval;
+
+	retval = fwu_write_f34_command(CMD_ERASE_BOOTLOADER);
+	if (retval < 0)
+		return retval;
+
+	TPD_DEBUG("%s: Erase command written\n",
+			__func__);
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+	if (retval < 0)
+		return retval;
+
+	TPD_DEBUG("%s: Idle status detected\n",
+			__func__);
+
+	return 0;
+}
+
+static int fwu_erase_guest_code(void)
+{
+	int retval;
+
+	retval = fwu_write_f34_command(CMD_ERASE_GUEST_CODE);
+	if (retval < 0)
+		return retval;
+
+	TPD_DEBUG("%s: Erase command written\n",
+			__func__);
+
+	retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+	if (retval < 0)
+		return retval;
+
+	TPD_DEBUG("%s: Idle status detected\n",
+			__func__);
+
+	return 0;
+}
+
+static int fwu_erase_all(void)
+{
+	int retval;
+
+	if (fwu->bl_version == BL_V7) {
+		retval = fwu_write_f34_command(CMD_ERASE_UI_FIRMWARE);
+		if (retval < 0)
+			return retval;
+
+		TPD_DEBUG("%s: Erase command written\n",
+				__func__);
+
+		retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+		if (retval < 0)
+			return retval;
+
+		TPD_DEBUG("%s: Idle status detected\n",
+				__func__);
+
+		fwu->config_area = UI_CONFIG_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			return retval;
+	} else {
+		retval = fwu_write_f34_command(CMD_ERASE_ALL);
+		if (retval < 0)
+			return retval;
+
+		TPD_DEBUG("%s: Erase all command written\n",
+				__func__);
+
+		retval = fwu_wait_for_idle(ERASE_WAIT_MS, false);
+		if (!(fwu->bl_version == BL_V8 &&
+				fwu->flash_status == BAD_PARTITION_TABLE)) {
+			if (retval < 0)
+				return retval;
+		}
+
+		TPD_DEBUG("%s: Idle status detected\n",
+				__func__);
+
+		if (fwu->bl_version == BL_V8)
+			return 0;
+	}
+
+	if (fwu->flash_properties.has_disp_config) {
+		fwu->config_area = DP_CONFIG_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			return retval;
+	}
+
+	if (fwu->has_guest_code) {
+		retval = fwu_erase_guest_code();
+		if (retval < 0)
+			return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_write_firmware(void)
+{
+	unsigned short firmware_block_count;
+
+	firmware_block_count = fwu->img.ui_firmware.size / fwu->block_size;
+
+	return fwu_write_f34_blocks((unsigned char *)fwu->img.ui_firmware.data,
+			firmware_block_count, CMD_WRITE_FW);
+}
+
+static int fwu_write_bootloader(void)
+{
+	int retval;
+	unsigned short bootloader_block_count;
+
+	bootloader_block_count = fwu->img.bl_image.size / fwu->block_size;
+
+	fwu->write_bootloader = true;
+	retval = fwu_write_f34_blocks((unsigned char *)fwu->img.bl_image.data,
+			bootloader_block_count, CMD_WRITE_BOOTLOADER);
+	fwu->write_bootloader = false;
+
+	return retval;
+}
+
+static int fwu_write_utility_parameter(void)
+{
+	int retval;
+	unsigned char ii;
+	unsigned char checksum_array[4];
+	unsigned char *pbuf;
+	unsigned short remaining_size;
+	unsigned short utility_param_size;
+	unsigned long checksum;
+
+	utility_param_size = fwu->blkcount.utility_param * fwu->block_size;
+	retval = fwu_allocate_read_config_buf(utility_param_size);
+	if (retval < 0)
+		return retval;
+	memset(fwu->read_config_buf, 0x00, utility_param_size);
+
+	pbuf = fwu->read_config_buf;
+	remaining_size = utility_param_size - 4;
+
+	for (ii = 0; ii < MAX_UTILITY_PARAMS; ii++) {
+		if (fwu->img.utility_param_id[ii] == UNUSED)
+			continue;
+
+#ifdef F51_DISCRETE_FORCE
+		if (fwu->img.utility_param_id[ii] == FORCE_PARAMETER) {
+			if (fwu->bl_mode_device) {
+			TPD_ERR("%s:skipping calibration data restoration\n",
+						__func__);
+				goto image_param;
+			}
+			retval = secure_memcpy(&(pbuf[4]),
+					remaining_size - 4,
+					fwu->cal_data,
+					fwu->cal_data_buf_size,
+					fwu->cal_data_size);
+			if (retval < 0) {
+			TPD_ERR("%s:Failed to copy force calibration data\n",
+						__func__);
+				return retval;
+			}
+			pbuf[0] = FORCE_PARAMETER;
+			pbuf[1] = 0x00;
+			pbuf[2] = (4 + fwu->cal_data_size) / 2;
+			pbuf += (fwu->cal_data_size + 4);
+			remaining_size -= (fwu->cal_data_size + 4);
+			continue;
+		}
+image_param:
+#endif
+
+		retval = secure_memcpy(pbuf,
+				remaining_size,
+				fwu->img.utility_param[ii].data,
+				fwu->img.utility_param[ii].size,
+				fwu->img.utility_param[ii].size);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to copy utility parameter data\n",
+					__func__);
+			return retval;
+		}
+		pbuf += fwu->img.utility_param[ii].size;
+		remaining_size -= fwu->img.utility_param[ii].size;
+	}
+
+	calculate_checksum((unsigned short *)fwu->read_config_buf,
+			((utility_param_size - 4) / 2),
+			&checksum);
+
+	convert_to_little_endian(checksum_array, checksum);
+
+	fwu->read_config_buf[utility_param_size - 4] = checksum_array[0];
+	fwu->read_config_buf[utility_param_size - 3] = checksum_array[1];
+	fwu->read_config_buf[utility_param_size - 2] = checksum_array[2];
+	fwu->read_config_buf[utility_param_size - 1] = checksum_array[3];
+
+	retval = fwu_write_f34_blocks((unsigned char *)fwu->read_config_buf,
+			fwu->blkcount.utility_param, CMD_WRITE_UTILITY_PARAM);
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static int fwu_write_configuration(void)
+{
+	return fwu_write_f34_blocks((unsigned char *)fwu->config_data,
+			fwu->config_block_count, CMD_WRITE_CONFIG);
+}
+
+static int fwu_write_ui_configuration(void)
+{
+	fwu->config_area = UI_CONFIG_AREA;
+	fwu->config_data = fwu->img.ui_config.data;
+	fwu->config_size = fwu->img.ui_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	return fwu_write_configuration();
+}
+
+static int fwu_write_dp_configuration(void)
+{
+	fwu->config_area = DP_CONFIG_AREA;
+	fwu->config_data = fwu->img.dp_config.data;
+	fwu->config_size = fwu->img.dp_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	return fwu_write_configuration();
+}
+
+static int fwu_write_flash_configuration(void)
+{
+	int retval;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	fwu->config_area = FLASH_CONFIG_AREA;
+	fwu->config_data = fwu->img.fl_config.data;
+	fwu->config_size = fwu->img.fl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	if (fwu->config_block_count != fwu->blkcount.fl_config) {
+		TPD_ERR("%s: Flash configuration size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	retval = fwu_erase_configuration();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+
+	rmi4_data->reset_device(fwu->client, false);
+
+	return 0;
+}
+
+static int fwu_write_guest_code(void)
+{
+	int retval;
+	unsigned short guest_code_block_count;
+
+	guest_code_block_count = fwu->img.guest_code.size / fwu->block_size;
+
+	retval = fwu_write_f34_blocks((unsigned char *)fwu->img.guest_code.data,
+			guest_code_block_count, CMD_WRITE_GUEST_CODE);
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static int fwu_write_lockdown(void)
+{
+	unsigned short lockdown_block_count;
+
+	lockdown_block_count = fwu->img.lockdown.size / fwu->block_size;
+
+	return fwu_write_f34_blocks((unsigned char *)fwu->img.lockdown.data,
+			lockdown_block_count, CMD_WRITE_LOCKDOWN);
+}
+
+static int fwu_write_partition_table_v8(void)
+{
+	int retval;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	fwu->config_area = FLASH_CONFIG_AREA;
+	fwu->config_data = fwu->img.fl_config.data;
+	fwu->config_size = fwu->img.fl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	if (fwu->config_block_count != fwu->blkcount.fl_config) {
+		TPD_ERR("%s: Flash configuration size mismatch\n",
+				__func__);
+		return -EINVAL;
+	}
+
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+	TPD_ERR("%s enter 1\n ", __func__);
+	rmi4_data->reset_device(fwu->client, false);
+
+	return 0;
+}
+
+static int fwu_write_partition_table_v7(void)
+{
+	int retval;
+	unsigned short block_count;
+
+	TPD_DEBUG("%s enter\n", __func__);
+
+	block_count = fwu->blkcount.bl_config;
+	fwu->config_area = BL_CONFIG_AREA;
+	fwu->config_size = fwu->block_size * block_count;
+
+	retval = fwu_allocate_read_config_buf(fwu->config_size);
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_read_f34_blocks(block_count, CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_erase_configuration();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_write_flash_configuration();
+	if (retval < 0)
+		return retval;
+
+	fwu->config_area = BL_CONFIG_AREA;
+	fwu->config_data = fwu->read_config_buf;
+	fwu->config_size = fwu->img.bl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static int fwu_write_bl_area_v7(void)
+{
+	int retval;
+	bool has_utility_param;
+
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s enter\n ", __func__);
+
+	has_utility_param = fwu->has_utility_param;
+
+	if (fwu->has_utility_param) {
+		fwu->config_area = UPP_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			return retval;
+	}
+
+	fwu->config_area = BL_CONFIG_AREA;
+	retval = fwu_erase_configuration();
+	if (retval < 0)
+		return retval;
+
+	fwu->config_area = FLASH_CONFIG_AREA;
+	retval = fwu_erase_configuration();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_erase_bootloader();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_write_bootloader();
+	if (retval < 0)
+		return retval;
+	/*msleep(rmi4_data->hw_if->board_data->reset_delay_ms);*/
+	rmi4_data->reset_device(fwu->client, false);
+
+	fwu->config_area = FLASH_CONFIG_AREA;
+	fwu->config_data = fwu->img.fl_config.data;
+	fwu->config_size = fwu->img.fl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+	rmi4_data->reset_device(fwu->client, false);
+
+	fwu->config_area = BL_CONFIG_AREA;
+	fwu->config_data = fwu->img.bl_config.data;
+	fwu->config_size = fwu->img.bl_config.size;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+
+	if (fwu->img.contains_utility_param) {
+		retval = fwu_write_utility_parameter();
+		if (retval < 0)
+			return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_do_reflash(void)
+{
+	int retval;
+	bool do_bl_update = false;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	if (!fwu->new_partition_table) {
+		retval = fwu_check_ui_firmware_size();
+		if (retval < 0)
+			return retval;
+
+		retval = fwu_check_ui_configuration_size();
+		if (retval < 0)
+			return retval;
+
+		if (fwu->flash_properties.has_disp_config &&
+				fwu->img.contains_disp_config) {
+			retval = fwu_check_dp_configuration_size();
+			if (retval < 0)
+				return retval;
+		}
+
+		if (fwu->has_guest_code && fwu->img.contains_guest_code) {
+			retval = fwu_check_guest_code_size();
+			if (retval < 0)
+				return retval;
+		}
+	} else if (fwu->bl_version == BL_V7) {
+		retval = fwu_check_bl_configuration_size();
+		if (retval < 0)
+			return retval;
+	}
+
+	if (!fwu->has_utility_param && fwu->img.contains_utility_param) {
+		if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+			do_bl_update = true;
+	}
+
+	if (fwu->has_utility_param && !fwu->img.contains_utility_param) {
+		if (fwu->bl_version == BL_V7 || fwu->bl_version == BL_V8)
+			do_bl_update = true;
+	}
+
+	if (!do_bl_update && fwu->incompatible_partition_tables) {
+		TPD_ERR("%s: Incompatible partition tables\n",
+				__func__);
+		return -EINVAL;
+	} else if (!do_bl_update && fwu->new_partition_table) {
+		if (!fwu->force_update) {
+		TPD_ERR("%s: Partition table mismatch\n",
+					__func__);
+			return -EINVAL;
+		}
+	}
+
+	retval = fwu_erase_all();
+	if (retval < 0)
+		return retval;
+
+	if (do_bl_update) {
+		retval = fwu_write_bl_area_v7();
+		if (retval < 0)
+			return retval;
+		TPD_ERR("%s: Bootloader area programmed\n", __func__);
+	} else if (fwu->bl_version == BL_V7 && fwu->new_partition_table) {
+		retval = fwu_write_partition_table_v7();
+		if (retval < 0)
+			return retval;
+		TPD_ERR("%s: Partition table programmed\n", __func__);
+	} else if (fwu->bl_version == BL_V8) {
+		retval = fwu_write_partition_table_v8();
+		if (retval < 0)
+			return retval;
+		TPD_ERR("%s: Partition table programmed\n", __func__);
+	}
+
+	retval = fwu_write_firmware();
+	if (retval < 0)
+		return retval;
+	TPD_ERR("%s: Firmware programmed\n", __func__);
+
+	fwu->config_area = UI_CONFIG_AREA;
+	retval = fwu_write_ui_configuration();
+	if (retval < 0)
+		return retval;
+	TPD_ERR("%s: Configuration programmed\n", __func__);
+
+	if (fwu->flash_properties.has_disp_config &&
+			fwu->img.contains_disp_config) {
+		retval = fwu_write_dp_configuration();
+		if (retval < 0)
+			return retval;
+		TPD_ERR("%s: Display configuration programmed\n", __func__);
+	}
+
+	if (fwu->has_guest_code && fwu->img.contains_guest_code) {
+		retval = fwu_write_guest_code();
+		if (retval < 0)
+			return retval;
+		TPD_ERR("%s: Guest code programmed\n", __func__);
+	}
+
+	return retval;
+}
+
+static int fwu_do_lockdown_v7(void)
+{
+	int retval;
+	struct f34_v7_data0 status;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	retval = fwu_enter_flash_prog();
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			fwu->f34_fd.data_base_addr + fwu->off.flash_status,
+			status.data,
+			sizeof(status.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash status\n",
+				__func__);
+		return retval;
+	}
+
+	if (status.device_cfg_status == 2) {
+		TPD_ERR("%s: Device already locked down\n",
+				__func__);
+		return 0;
+	}
+
+	retval = fwu_write_lockdown();
+	if (retval < 0)
+		return retval;
+
+	pr_notice("%s: Lockdown programmed\n", __func__);
+
+	return retval;
+}
+
+static int fwu_do_lockdown_v5v6(void)
+{
+	int retval;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	retval = fwu_enter_flash_prog();
+	if (retval < 0)
+		return retval;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			fwu->f34_fd.query_base_addr + fwu->off.properties,
+			fwu->flash_properties.data,
+			sizeof(fwu->flash_properties.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read flash properties\n",
+				__func__);
+		return retval;
+	}
+
+	if (fwu->flash_properties.unlocked == 0) {
+		TPD_ERR("%s: Device already locked down\n",
+				__func__);
+		return 0;
+	}
+
+	retval = fwu_write_lockdown();
+	if (retval < 0)
+		return retval;
+
+	pr_notice("%s: Lockdown programmed\n", __func__);
+
+	return retval;
+}
+
+#ifdef F51_DISCRETE_FORCE
+static int fwu_do_restore_f51_cal_data(void)
+{
+	int retval;
+	unsigned char checksum_array[4];
+	unsigned short block_count;
+	unsigned long checksum;
+
+	block_count = fwu->blkcount.ui_config;
+	fwu->config_size = fwu->block_size * block_count;
+	fwu->config_area = UI_CONFIG_AREA;
+
+	retval = fwu_allocate_read_config_buf(fwu->config_size);
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_read_f34_blocks(block_count, CMD_READ_CONFIG);
+	if (retval < 0)
+		return retval;
+
+	retval = secure_memcpy(&fwu->read_config_buf[fwu->cal_data_off],
+			fwu->cal_data_size, fwu->cal_data,
+			fwu->cal_data_buf_size, fwu->cal_data_size);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to restore calibration data\n",
+				__func__);
+		return retval;
+	}
+
+	calculate_checksum((unsigned short *)fwu->read_config_buf,
+			((fwu->config_size - 4) / 2),
+			&checksum);
+
+	convert_to_little_endian(checksum_array, checksum);
+
+	fwu->read_config_buf[fwu->config_size - 4] = checksum_array[0];
+	fwu->read_config_buf[fwu->config_size - 3] = checksum_array[1];
+	fwu->read_config_buf[fwu->config_size - 2] = checksum_array[2];
+	fwu->read_config_buf[fwu->config_size - 1] = checksum_array[3];
+
+	retval = fwu_enter_flash_prog();
+	if (retval < 0)
+		return retval;
+
+	fwu->config_area = UI_CONFIG_AREA;
+	fwu->config_data = fwu->read_config_buf;
+	fwu->config_block_count = fwu->config_size / fwu->block_size;
+
+	retval = fwu_erase_configuration();
+	if (retval < 0)
+		return retval;
+
+	retval = fwu_write_configuration();
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+#endif
+
+static int fwu_start_reflash(const unsigned char *fw_image)
+{
+	int retval = 0;
+	enum flash_area flash_area;
+	bool do_rebuild = false;
+	/*const struct firmware *fw_entry = NULL;*/
+	unsigned char temp;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s: enter\n", __func__);
+	if (rmi4_data->sensor_sleep) {
+		TPD_ERR("%s: Sensor sleeping\n",
+				__func__);
+		return -ENODEV;
+	}
+
+	rmi4_data->stay_awake = true;
+
+	/*mutex_lock(&rmi4_data->rmi4_exp_init_mutex);*/
+
+	TPD_ERR("%s: Start of reflash process\n", __func__);
+
+	fwu->image = fw_image;
+
+	#ifdef OLD_WAY_SYNA_REQ_FIRM
+	if (fwu->image == NULL) {
+		retval = secure_memcpy(fwu->image_name, MAX_IMAGE_NAME_LEN,
+				FW_IMAGE_NAME, sizeof(FW_IMAGE_NAME),
+				sizeof(FW_IMAGE_NAME));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to copy image file name\n",
+					__func__);
+			goto exit;
+		}
+		TPD_ERR("%s: Requesting firmware image %s\n",
+				__func__, fwu->image_name);
+
+		retval = request_firmware(&fw_entry, fwu->image_name,
+				rmi4_data->s3706_dev);
+		if (retval != 0) {
+			TPD_ERR("%s: Firmware image %s not available\n",
+					__func__, fwu->image_name);
+			retval = -EINVAL;
+			goto exit;
+		}
+
+		TPD_ERR("%s: Firmware image size = %d\n",
+				__func__, (unsigned int)fw_entry->size);
+
+		fwu->image = fw_entry->data;
+	}
+	#endif
+
+	retval = fwu_parse_image_info();
+	if (retval < 0)
+		goto exit;
+
+	if (fwu->blkcount.total_count != fwu->img.blkcount.total_count) {
+		TPD_ERR("%s: Flash size mismatch\n",
+				__func__);
+		retval = -EINVAL;
+		goto exit;
+	}
+
+	if (fwu->bl_version != fwu->img.bl_version) {
+		TPD_ERR("%s: Bootloader version mismatch\n",
+				__func__);
+		retval = -EINVAL;
+		goto exit;
+	}
+
+	retval = fwu_read_flash_status();
+	if (retval < 0)
+		goto exit;
+
+	if (fwu->in_bl_mode) {
+		fwu->bl_mode_device = true;
+		TPD_ERR("%s: Device in bootloader mode\n",
+				__func__);
+	} else {
+		fwu->bl_mode_device = false;
+	}
+
+	flash_area = fwu_go_nogo();
+
+	if (flash_area != NONE) {
+		retval = fwu_enter_flash_prog();
+		if (retval < 0) {
+			rmi4_data->reset_device(fwu->client, false);
+			goto exit;
+		}
+	}
+#ifdef F51_DISCRETE_FORCE
+	if (flash_area != NONE && !fwu->bl_mode_device) {
+		fwu->config_size = fwu->block_size * fwu->blkcount.ui_config;
+		fwu->config_area = UI_CONFIG_AREA;
+
+		retval = fwu_allocate_read_config_buf(fwu->config_size);
+		if (retval < 0) {
+			rmi4_data->reset_device(fwu->client, false);
+			goto exit;
+		}
+
+		retval = fwu_read_f34_blocks(fwu->blkcount.ui_config,
+				CMD_READ_CONFIG);
+		if (retval < 0) {
+			rmi4_data->reset_device(fwu->client, false);
+			goto exit;
+		}
+
+		retval = secure_memcpy(fwu->cal_data, fwu->cal_data_buf_size,
+				&fwu->read_config_buf[fwu->cal_data_off],
+				fwu->cal_data_size, fwu->cal_data_size);
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to save calibration data\n",
+					__func__);
+			rmi4_data->reset_device(fwu->client, false);
+			goto exit;
+		}
+	}
+#endif
+
+	switch (flash_area) {
+	case UI_FIRMWARE:
+		do_rebuild = true;
+		retval = fwu_do_reflash();
+#ifdef F51_DISCRETE_FORCE
+		if (retval < 0)
+			break;
+
+		if (fwu->has_utility_param || fwu->img.contains_utility_param)
+			break;
+
+		rmi4_data->reset_device(fwu->client, false);
+
+		if (fwu->bl_mode_device || fwu->in_bl_mode) {
+		TPD_ERR("%s:bl mode skip calibration data restoration\n",
+					__func__);
+			break;
+		}
+
+		retval = fwu_do_restore_f51_cal_data();
+#endif
+		break;
+	case UI_CONFIG:
+		do_rebuild = true;
+		retval = fwu_check_ui_configuration_size();
+		if (retval < 0)
+			break;
+		fwu->config_area = UI_CONFIG_AREA;
+		retval = fwu_erase_configuration();
+		if (retval < 0)
+			break;
+		retval = fwu_write_ui_configuration();
+#ifdef F51_DISCRETE_FORCE
+		if (retval < 0)
+			break;
+
+		if (fwu->has_utility_param)
+			break;
+
+		retval = fwu_do_restore_f51_cal_data();
+#endif
+		break;
+	case NONE:
+	default:
+		break;
+	}
+
+	if (retval < 0) {
+		do_rebuild = false;
+		rmi4_data->reset_device(fwu->client, false);
+		TPD_ERR("%s: Failed to do reflash\n",
+				__func__);
+		goto exit;
+	}
+
+	if (fwu->do_lockdown && (fwu->img.lockdown.data != NULL)) {
+		switch (fwu->bl_version) {
+		case BL_V5:
+		case BL_V6:
+			retval = fwu_do_lockdown_v5v6();
+			if (retval < 0) {
+				TPD_ERR("%s: Failed to do lockdown\n",
+						__func__);
+			}
+			rmi4_data->reset_device(fwu->client, false);
+			break;
+		case BL_V7:
+		case BL_V8:
+			retval = fwu_do_lockdown_v7();
+			if (retval < 0) {
+				TPD_ERR("%s: Failed to do lockdown\n",
+						__func__);
+			}
+			rmi4_data->reset_device(fwu->client, false);
+			break;
+		default:
+			break;
+		}
+	}
+
+exit:
+	#ifdef OLD_WAY_SYNA_REQ_FIRM
+	if (fw_entry)
+		release_firmware(fw_entry);
+	#endif
+	/*if (do_rebuild)*/
+	rmi4_data->reset_device(fwu->client, true);
+	temp = 0x01;
+	synaptics_rmi4_reg_write(fwu->client,
+		fwu->bl_reset_add, &temp, 1);/*reset tp*/
+
+	TPD_ERR("%s: End of reflash process\n", __func__);
+
+	/*mutex_unlock(&rmi4_data->rmi4_exp_init_mutex);*/
+
+	rmi4_data->stay_awake = false;
+
+	return retval;
+}
+
+static int fwu_recovery_check_status(void)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char status;
+
+	data_base = fwu->f35_fd.data_base_addr;
+
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			data_base + F35_ERROR_CODE_OFFSET,
+			&status,
+			1);
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read status\n",
+				__func__);
+		return retval;
+	}
+
+	status = status & MASK_5BIT;
+
+	if (status != 0x00) {
+		TPD_ERR("%s: Recovery mode status = %d\n",
+				__func__, status);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int fwu_recovery_erase_completion(void)
+{
+	int retval;
+	unsigned char data_base;
+	unsigned char command;
+	unsigned char status;
+	unsigned int timeout = F35_ERASE_ALL_WAIT_MS / 20;
+
+	data_base = fwu->f35_fd.data_base_addr;
+	TPD_DEBUG("%s enter\n", __func__);
+	do {
+		command = 0x01;
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				fwu->f35_fd.cmd_base_addr,
+				&command,
+				sizeof(command));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to issue command\n",
+					__func__);
+			return retval;
+		}
+
+		do {
+			retval = synaptics_rmi4_reg_read(fwu->client,
+					fwu->f35_fd.cmd_base_addr,
+					&command,
+					sizeof(command));
+			if (retval < 0) {
+				TPD_ERR("%s: Failed to read command status\n",
+						__func__);
+				return retval;
+			}
+
+			if ((command & 0x01) == 0x00)
+				break;
+
+			msleep(20);
+			timeout--;
+		} while (timeout > 0);
+
+		if (timeout == 0)
+			goto exit;
+
+		retval = synaptics_rmi4_reg_read(fwu->client,
+				data_base + F35_FLASH_STATUS_OFFSET,
+				&status,
+				sizeof(status));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read flash status\n",
+					__func__);
+			return retval;
+		}
+
+		if ((status & 0x01) == 0x00)
+			break;
+
+		msleep(20);
+		timeout--;
+	} while (timeout > 0);
+
+exit:
+	if (timeout == 0) {
+		TPD_ERR("%s: Timed out waiting for flash erase completion\n",
+				__func__);
+		return -ETIMEDOUT;
+	}
+
+	return 0;
+}
+
+static int fwu_recovery_erase_all(void)
+{
+	int retval;
+	unsigned char ctrl_base;
+	unsigned char command = CMD_F35_ERASE_ALL;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	ctrl_base = fwu->f35_fd.ctrl_base_addr;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			ctrl_base + F35_CHUNK_COMMAND_OFFSET,
+			&command,
+			sizeof(command));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to issue erase all command\n",
+				__func__);
+		return retval;
+	}
+
+	if (fwu->f35_fd.cmd_base_addr) {
+		retval = fwu_recovery_erase_completion();
+		if (retval < 0)
+			return retval;
+	} else {
+		msleep(F35_ERASE_ALL_WAIT_MS);
+	}
+
+	retval = fwu_recovery_check_status();
+	if (retval < 0)
+		return retval;
+
+	return 0;
+}
+
+static int fwu_recovery_write_chunk(void)
+{
+	int retval;
+	unsigned char ctrl_base;
+	unsigned char chunk_number[] = {0, 0};
+	unsigned char chunk_spare;
+	unsigned char chunk_size;
+	unsigned char buf[F35_CHUNK_SIZE + 1];
+	unsigned short chunk;
+	unsigned short chunk_total;
+	unsigned short bytes_written = 0;
+	unsigned char *chunk_ptr = (unsigned char *)fwu->image;
+
+	ctrl_base = fwu->f35_fd.ctrl_base_addr;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			ctrl_base + F35_CHUNK_NUM_LSB_OFFSET,
+			chunk_number,
+			sizeof(chunk_number));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write chunk number\n",
+				__func__);
+		return retval;
+	}
+
+	buf[sizeof(buf) - 1] = CMD_F35_WRITE_CHUNK;
+
+	chunk_total = fwu->image_size / F35_CHUNK_SIZE;
+	chunk_spare = fwu->image_size % F35_CHUNK_SIZE;
+	if (chunk_spare)
+		chunk_total++;
+
+	for (chunk = 0; chunk < chunk_total; chunk++) {
+		if (chunk_spare && chunk == chunk_total - 1)
+			chunk_size = chunk_spare;
+		else
+			chunk_size = F35_CHUNK_SIZE;
+
+		memset(buf, 0x00, F35_CHUNK_SIZE);
+		secure_memcpy(buf, sizeof(buf), chunk_ptr,
+					fwu->image_size - bytes_written,
+					chunk_size);
+
+		retval = synaptics_rmi4_reg_write(fwu->client,
+				ctrl_base + F35_CHUNK_DATA_OFFSET,
+				buf,
+				sizeof(buf));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to write chunk data (chunk %d)\n",
+					__func__, chunk);
+			return retval;
+		}
+		chunk_ptr += chunk_size;
+		bytes_written += chunk_size;
+	}
+
+	retval = fwu_recovery_check_status();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write chunk data\n",
+				__func__);
+		return retval;
+	}
+
+	return 0;
+}
+
+static int fwu_recovery_reset(void)
+{
+	int retval;
+	unsigned char ctrl_base;
+	unsigned char command = CMD_F35_RESET;
+
+	ctrl_base = fwu->f35_fd.ctrl_base_addr;
+
+	retval = synaptics_rmi4_reg_write(fwu->client,
+			ctrl_base + F35_CHUNK_COMMAND_OFFSET,
+			&command,
+			sizeof(command));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to issue reset command\n",
+				__func__);
+		return retval;
+	}
+
+	msleep(F35_RESET_WAIT_MS);
+
+	return 0;
+}
+
+static int fwu_start_recovery(void)
+{
+	int retval;
+	const struct firmware *fw_entry = NULL;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+
+	TPD_DEBUG("%s enter", __func__);
+	if (rmi4_data->sensor_sleep) {
+		TPD_ERR("%s: Sensor sleeping\n",
+				__func__);
+		return -ENODEV;
+	}
+
+	rmi4_data->stay_awake = true;
+
+	/*mutex_lock(&rmi4_data->rmi4_exp_init_mutex);*/
+
+	pr_notice("%s: Start of recovery process\n", __func__);
+
+	if (fwu->image == NULL) {
+		retval = secure_memcpy(fwu->image_name, MAX_IMAGE_NAME_LEN,
+				FW_IHEX_NAME, sizeof(FW_IHEX_NAME),
+				sizeof(FW_IHEX_NAME));
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to copy ihex file name\n",
+					__func__);
+			goto exit;
+		}
+		TPD_ERR("%s: Requesting firmware ihex %s\n",
+				__func__, fwu->image_name);
+
+		retval = request_firmware(&fw_entry, fwu->image_name,
+				rmi4_data->pdev->dev.parent);
+		if (retval != 0) {
+			TPD_ERR("%s: Firmware ihex %s not available\n",
+					__func__, fwu->image_name);
+			retval = -EINVAL;
+			goto exit;
+		}
+
+		TPD_ERR("%s: Firmware image size = %d\n",
+				__func__, (unsigned int)fw_entry->size);
+
+		fwu->image = fw_entry->data;
+		fwu->image_size = fw_entry->size;
+	}
+
+	/*retval = rmi4_data->irq_enable(rmi4_data, false, false);*/
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to disable interrupt\n",
+				__func__);
+		goto exit;
+	}
+
+	retval = fwu_recovery_erase_all();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to do erase all in recovery mode\n",
+				__func__);
+		goto exit;
+	}
+
+	pr_notice("%s: External flash erased\n", __func__);
+
+	retval = fwu_recovery_write_chunk();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to write chunk data in recovery mode\n",
+				__func__);
+		goto exit;
+	}
+
+	pr_notice("%s: Chunk data programmed\n", __func__);
+
+	retval = fwu_recovery_reset();
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to reset device in recovery mode\n",
+				__func__);
+		goto exit;
+	}
+
+	pr_notice("%s: Recovery mode reset issued\n", __func__);
+
+	rmi4_data->reset_device(fwu->client, true);
+
+	retval = 0;
+
+exit:
+	if (fw_entry)
+		release_firmware(fw_entry);
+
+	pr_notice("%s: End of recovery process\n", __func__);
+
+	/*mutex_unlock(&rmi4_data->rmi4_exp_init_mutex);*/
+
+	rmi4_data->stay_awake = false;
+
+	return retval;
+}
+
+int synaptics_fw_updater(const unsigned char *fw_data,
+	const unsigned char *fw_image)
+{
+	int retval;
+
+	TPD_DEBUG("%s enter\n", __func__);
+	if (!fwu)
+		return -ENODEV;
+
+	if (!fwu->initialized)
+		return -ENODEV;
+
+	if (fwu->in_ub_mode) {
+		fwu->image = NULL;
+		retval = fwu_start_recovery();
+		if (retval < 0)
+			return retval;
+	}
+
+	fwu->image = fw_data;
+
+	retval = fwu_start_reflash(fw_image);
+
+	fwu->image = NULL;
+
+	return retval;
+}
+EXPORT_SYMBOL(synaptics_fw_updater);
+
+static int fwu_startup_fw_update_work(const unsigned char *fw_image)
+{
+	int retval;
+
+#ifdef WAIT_FOR_FB_READY
+	unsigned int timeout;
+	struct synaptics_rmi4_data *rmi4_data = fwu->rmi4_data;
+#endif
+
+#ifdef WAIT_FOR_FB_READY
+	timeout = FB_READY_TIMEOUT_S * 1000 / FB_READY_WAIT_MS + 1;
+
+	while (!rmi4_data->fb_ready) {
+		msleep(FB_READY_WAIT_MS);
+		timeout--;
+		if (timeout == 0) {
+			TPD_ERR("%s: Timed out waiting for FB ready\n",
+					__func__);
+			return -EINVAL;
+		}
+	}
+#endif
+
+	retval = synaptics_fw_updater(NULL, fw_image);
+
+	return retval;
+}
+
+int synaptics_rmi4_fwu_init(struct synaptics_rmi4_data *rmi4_data,
+		const unsigned char *fw_image, struct i2c_client *client)
+{
+	int retval;
+	/*unsigned char attr_count;*/
+	struct pdt_properties pdt_props;
+
+	if (!fw_image || !rmi4_data || !client) {
+		TPD_ERR("%s: fw_image  rmi4_data  client is null\n", __func__);
+		retval = -ENOMEM;
+		goto exit;
+	}
+
+	fwu = kzalloc(sizeof(*fwu), GFP_KERNEL);
+	if (!fwu) {
+		TPD_ERR("%s: Failed to alloc mem for fwu\n", __func__);
+		retval = -ENOMEM;
+		goto exit;
+	}
+	fwu->image_name = kzalloc(MAX_IMAGE_NAME_LEN, GFP_KERNEL);
+	if (!fwu->image_name) {
+		TPD_ERR("%s: Failed to alloc mem for image name\n",
+				__func__);
+		retval = -ENOMEM;
+		goto exit_free_fwu;
+	}
+
+	fwu->rmi4_data = rmi4_data;
+	fwu->client = client;
+	retval = synaptics_rmi4_reg_read(fwu->client,
+			PDT_PROPS,
+			pdt_props.data,
+			sizeof(pdt_props.data));
+	if (retval < 0) {
+		TPD_ERR("%s: Failed to read PDT properties, assuming 0x00\n",
+				__func__);
+	} else if (pdt_props.has_bsr) {
+		TPD_ERR("%s: Reflash for LTS not currently supported\n",
+				__func__);
+		retval = -ENODEV;
+		goto exit_free_mem;
+	}
+	retval = fwu_scan_pdt();
+	if (retval < 0)
+		goto exit_free_mem;
+
+	if (!fwu->in_ub_mode) {
+		retval = fwu_read_f34_queries();
+		if (retval < 0)
+			goto exit_free_mem;
+
+		retval = fwu_get_device_config_id();
+		if (retval < 0) {
+			TPD_ERR("%s: Failed to read device config ID\n",
+					__func__);
+			goto exit_free_mem;
+		}
+	}
+
+	fwu->force_update = FORCE_UPDATE;
+	fwu->do_lockdown = DO_LOCKDOWN;
+	fwu->initialized = true;
+
+	retval = fwu_startup_fw_update_work(fw_image);
+#ifdef F51_DISCRETE_FORCE
+	fwu_read_flash_status();
+	if (!fwu->in_bl_mode) {
+		retval = fwu_f51_force_data_init();
+		if (retval < 0)
+			goto exit_free_mem;
+	}
+#endif
+
+	return retval;
+
+exit_free_mem:
+	kfree(fwu->image_name);
+
+exit_free_fwu:
+	kfree(fwu);
+	fwu = NULL;
+
+exit:
+	return retval;
+}
+
diff --git a/drivers/input/touchscreen/synaptics_redremote.h b/drivers/input/touchscreen/synaptics_redremote.h
new file mode 100644
index 0000000000000000000000000000000000000000..57428a319d47133e825b4e8099309d3cd9cefd1a
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_redremote.h
@@ -0,0 +1,15 @@
+#ifndef _SYNAPTICS_REDREMOTE_H_
+#define _SYNAPTICS_REDREMOTE_H_
+struct remotepanel_data{
+	struct i2c_client *client;
+	struct input_dev *input_dev;
+	struct input_dev *kpd;
+	struct mutex *pmutex;
+	int irq_gpio;
+	unsigned int irq;
+	int *enable_remote;
+};
+struct remotepanel_data *remote_alloc_panel_data(void);
+int register_remote_device(struct remotepanel_data *pdata);
+void unregister_remote_device(void);
+#endif
\ No newline at end of file
diff --git a/drivers/input/touchscreen/synaptics_s3320_redremote.c b/drivers/input/touchscreen/synaptics_s3320_redremote.c
new file mode 100644
index 0000000000000000000000000000000000000000..ad4df62c24637926066d31a1a96b28399856b009
--- /dev/null
+++ b/drivers/input/touchscreen/synaptics_s3320_redremote.c
@@ -0,0 +1,984 @@
+/*
+ * Synaptics DSX touchscreen driver
+ *
+ * Copyright (C) 2012 Synaptics Incorporated
+ *
+ * Copyright (C) 2012 Alexandra Chin <alexandra.chin@tw.synaptics.com>
+ * Copyright (C) 2012 Scott Lin <scott.lin@tw.synaptics.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/gpio.h>
+#include <linux/uaccess.h>
+#include <linux/cdev.h>
+#include "synaptics_redremote.h"
+
+
+#define CHAR_DEVICE_NAME "rmi"
+#define DEVICE_CLASS_NAME "rmidev"
+#define DEV_NUMBER 1
+#define REG_ADDR_LIMIT 0xFFFF
+
+
+static ssize_t rmidev_sysfs_data_show(struct file *data_file,
+		struct kobject *kobj, struct bin_attribute *attributes,
+		char *buf, loff_t pos, size_t count);
+
+static ssize_t rmidev_sysfs_data_store(struct file *data_file,
+		struct kobject *kobj, struct bin_attribute *attributes,
+		char *buf, loff_t pos, size_t count);
+
+static ssize_t rmidev_sysfs_open_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_release_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_address_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_length_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count);
+
+static ssize_t rmidev_sysfs_attn_state_show(struct device *dev,
+		struct device_attribute *attr, char *buf);
+
+static int remote_rmi4_i2c_read(unsigned short addr, unsigned char *data, unsigned short length);
+static int remote_rmi4_i2c_write(unsigned short addr, unsigned char *data, unsigned short length);
+static int remote_rmi4_i2c_enable(bool enable);
+static int remote_rmi4_get_irq_gpio(void);
+static int remote_rmit_set_page(unsigned int address);
+static int remote_rmit_put_page(void);
+
+
+static struct input_dev *remote_rmi4_get_input(void);
+static struct i2c_client *remote_rmi4_get_i2c_client(void);
+static void remote_rmi4_delay_work(struct work_struct *work);
+static struct remotepanel_data *remote_free_panel_data(struct remotepanel_data *pdata);
+
+
+#define MASK_8BIT 0xFF ;
+#define SYN_I2C_RETRY_TIMES 3;
+#define BUFFER_SIZE 252
+struct rmidev_handle {
+	dev_t dev_no;
+	unsigned short address;
+	unsigned int length;
+	struct device dev;
+	struct kobject *sysfs_dir;
+	void *data;
+};
+
+struct rmidev_data {
+	int ref_count;
+	struct cdev main_dev;
+	struct class *device_class;
+	struct mutex file_mutex;
+	struct rmidev_handle *rmi_dev;
+	struct remotepanel_data *pdata;
+};
+
+static struct bin_attribute attr_data = {
+	.attr = {
+		.name = "data",
+	    .mode = (S_IRUSR | S_IWUSR),
+	},
+	.size = 0,
+	.read = rmidev_sysfs_data_show,
+	.write = rmidev_sysfs_data_store,
+};
+
+static struct device_attribute attrs[] = {
+	__ATTR(open, S_IRUSR | S_IWUSR,
+			NULL,
+			rmidev_sysfs_open_store),
+	__ATTR(release,S_IRUSR | S_IWUSR,
+			NULL,
+			rmidev_sysfs_release_store),
+	__ATTR(address, S_IRUSR | S_IWUSR,
+			NULL,
+			rmidev_sysfs_address_store),
+	__ATTR(length, S_IRUSR | S_IWUSR,
+			NULL,
+			rmidev_sysfs_length_store),
+	__ATTR(attn_state, S_IRUSR | S_IWUSR,
+			rmidev_sysfs_attn_state_show,
+			NULL),
+};
+
+static int rmidev_major_num;
+
+static struct class *rmidev_device_class;
+
+static struct rmidev_handle *rmidev;
+
+
+static struct device *device_ptr;
+static struct delayed_work delay_work;
+
+
+static ssize_t rmidev_sysfs_data_show(struct file *data_file,
+		struct kobject *kobj, struct bin_attribute *attributes,
+		char *buf, loff_t pos, size_t count)
+{
+	int retval;
+	unsigned int data_length = rmidev->length;
+
+	if (data_length > (REG_ADDR_LIMIT - rmidev->address))
+		data_length = REG_ADDR_LIMIT - rmidev->address;
+
+	if (count < data_length) {
+		dev_err(device_ptr,
+				"%s: Not enough space (%zd bytes) in buffer\n",
+				__func__, count);
+		return -EINVAL;
+	}
+
+	if (data_length) {
+		retval = remote_rmi4_i2c_read(
+				rmidev->address,
+				(unsigned char *)buf,
+				data_length);
+		if (retval < 0) {
+			dev_err(device_ptr,
+					"%s: Failed to read data\n",
+					__func__);
+			return retval;
+		}
+	} else {
+		return -EINVAL;
+	}
+
+	return data_length;
+}
+
+static ssize_t rmidev_sysfs_data_store(struct file *data_file,
+		struct kobject *kobj, struct bin_attribute *attributes,
+		char *buf, loff_t pos, size_t count)
+{
+	int retval;
+	unsigned int data_length = rmidev->length;
+
+	if (data_length > (REG_ADDR_LIMIT - rmidev->address))
+		data_length = REG_ADDR_LIMIT - rmidev->address;
+
+	if (data_length) {
+		retval = remote_rmi4_i2c_write(
+				rmidev->address,
+				(unsigned char *)buf,
+				data_length);
+		if (retval < 0) {
+			dev_err(device_ptr,
+					"%s: Failed to write data\n",
+					__func__);
+			return retval;
+		}
+	} else {
+		return -EINVAL;
+	}
+
+	return count;
+}
+
+static ssize_t rmidev_sysfs_open_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	unsigned int input;
+
+	if (sscanf(buf, "%u", &input) != 1)
+			return -EINVAL;
+
+	if (input != 1)
+		return -EINVAL;
+
+	remote_rmi4_i2c_enable(false);
+	dev_dbg(device_ptr,
+			"%s: Attention interrupt disabled\n",
+			__func__);
+
+	return count;
+}
+
+static ssize_t rmidev_sysfs_release_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	unsigned int input;
+
+	if (sscanf(buf, "%u", &input) != 1)
+			return -EINVAL;
+
+	if (input != 1)
+		return -EINVAL;
+
+	remote_rmi4_i2c_enable(true);
+	dev_dbg(device_ptr,
+			"%s: Attention interrupt enabled\n",
+			__func__);
+
+	return count;
+}
+
+static ssize_t rmidev_sysfs_address_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	unsigned int input;
+
+	if (sscanf(buf, "%u", &input) != 1)
+			return -EINVAL;
+
+	if (input > REG_ADDR_LIMIT)
+		return -EINVAL;
+
+	rmidev->address = (unsigned short)input;
+
+	return count;
+}
+
+static ssize_t rmidev_sysfs_length_store(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	unsigned int input;
+
+	if (sscanf(buf, "%u", &input) != 1)
+			return -EINVAL;
+
+	if (input > REG_ADDR_LIMIT)
+		return -EINVAL;
+
+	rmidev->length = input;
+
+	return count;
+}
+
+static ssize_t rmidev_sysfs_attn_state_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int attn_state;
+
+	attn_state = gpio_get_value(remote_rmi4_get_irq_gpio());
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", attn_state);
+}
+
+static int remote_rmi4_get_irq_gpio(void)
+{
+	struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+	return dev_data->pdata->irq_gpio;
+}
+
+static struct input_dev *remote_rmi4_get_input(void)
+{
+	struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+	return dev_data->pdata->input_dev;
+}
+
+static struct i2c_client* remote_rmi4_get_i2c_client(void)
+{
+	struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+	return dev_data->pdata->client;
+}
+
+static int remote_rmit_set_page(unsigned int address){
+	struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+	unsigned char retry;
+	unsigned char buf[2];
+	struct i2c_msg msg[] = {
+		{
+			.addr = i2c_client->addr,
+			.flags = 0,
+			.len = 2,
+			.buf = buf,
+		}
+	};
+	buf[0] = 0xff;
+	buf[1] = ((address >> 8) & 0xFF);
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+			break;
+		}
+		msleep(5);
+	}
+
+	if (retry == 2) {
+		return -EIO;
+	}
+
+	return 0;
+}
+
+static int remote_rmit_put_page(void)
+{
+	struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+	unsigned char retry;
+	unsigned char buf[2];
+	struct i2c_msg msg[] = {
+		{
+			.addr = i2c_client->addr,
+			.flags = 0,
+			.len = 2,
+			.buf = buf,
+		}
+	};
+	buf[0] = 0xff;
+	buf[1] = 0x00;
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+			break;
+		}
+		msleep(5);
+	}
+
+	if (retry == 2) {
+		return -EIO;
+	}
+
+	return 0;
+}
+
+
+int remote_rmi4_i2c_read(unsigned short addr, unsigned char *data, unsigned short length)
+{
+	int retval;
+	unsigned char retry;
+	unsigned char buf;
+	struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+	struct i2c_msg msg[] = {
+		{
+			.addr = i2c_client->addr,
+			.flags = 0,
+			.len = 1,
+			.buf = &buf,
+		},
+		{
+			.addr = i2c_client->addr,
+			.flags = I2C_M_RD,
+			.len = length,
+			.buf = data,
+		},
+	};
+
+	buf = addr & 0xff;
+
+    retval = remote_rmit_set_page(addr);
+	if (retval < 0)
+		goto exit;
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(i2c_client->adapter, msg, 2) == 2) {
+			retval = length;
+			break;
+		}
+		msleep(5);
+	}
+
+	if (retry == 2) {
+		retval = -EIO;
+	}
+
+exit:
+	remote_rmit_put_page();
+
+	return retval;
+}
+
+int remote_rmi4_i2c_write(unsigned short addr, unsigned char *data, unsigned short length)
+{
+	int retval;
+	unsigned char retry;
+	unsigned char buf[length + 1];
+	struct i2c_client* i2c_client = remote_rmi4_get_i2c_client();
+	struct i2c_msg msg[] = {
+		{
+			.addr = i2c_client->addr,
+			.flags = 0,
+			.len = length + 1,
+			.buf = buf,
+		}
+	};
+
+
+    retval = remote_rmit_set_page(addr);
+	if (retval < 0)
+		goto exit;
+
+	buf[0] = addr & 0xff;
+	memcpy(&buf[1], &data[0], length);
+
+	for (retry = 0; retry < 2; retry++) {
+		if (i2c_transfer(i2c_client->adapter, msg, 1) == 1) {
+			retval = length;
+			break;
+		}
+		msleep(5);
+	}
+	msleep(10);
+	if (retry == 2) {
+		retval = -EIO;
+	}
+
+exit:
+	remote_rmit_put_page();
+
+	return retval;
+}
+
+int remote_rmi4_i2c_enable(bool enable)
+{
+	struct rmidev_data *dev_data = (struct rmidev_data *)rmidev->data;
+
+	if(enable){
+		*(dev_data->pdata->enable_remote) = 0;
+	}else{
+		*(dev_data->pdata->enable_remote) = 1;
+	}
+	return 0 ;
+}
+
+
+/*
+ * rmidev_llseek - used to set up register address
+ *
+ * @filp: file structure for seek
+ * @off: offset
+ *   if whence == SEEK_SET,
+ *     high 16 bits: page address
+ *     low 16 bits: register address
+ *   if whence == SEEK_CUR,
+ *     offset from current position
+ *   if whence == SEEK_END,
+ *     offset from end position (0xFFFF)
+ * @whence: SEEK_SET, SEEK_CUR, or SEEK_END
+ */
+static loff_t rmidev_llseek(struct file *filp, loff_t off, int whence)
+{
+	loff_t newpos;
+	struct rmidev_data *dev_data = filp->private_data;
+    //printk("synap %s\n",__func__);
+	if (IS_ERR(dev_data)) {
+		pr_err("%s: Pointer of char device data is invalid", __func__);
+		return -EBADF;
+	}
+
+
+	mutex_lock(&(dev_data->file_mutex));
+
+	switch (whence) {
+	case SEEK_SET:
+		newpos = off;
+		break;
+	case SEEK_CUR:
+		newpos = filp->f_pos + off;
+		break;
+	case SEEK_END:
+		newpos = REG_ADDR_LIMIT + off;
+		break;
+	default:
+		newpos = -EINVAL;
+		goto clean_up;
+	}
+
+	if (newpos < 0 || newpos > REG_ADDR_LIMIT) {
+		dev_err(device_ptr,
+				"%s: New position 0x%04x is invalid\n",
+				__func__, (unsigned int)newpos);
+		newpos = -EINVAL;
+		goto clean_up;
+	}
+
+	filp->f_pos = newpos;
+
+clean_up:
+	mutex_unlock(&(dev_data->file_mutex));
+
+	return newpos;
+}
+
+/*
+ * rmidev_read: - use to read data from rmi device
+ *
+ * @filp: file structure for read
+ * @buf: user space buffer pointer
+ * @count: number of bytes to read
+ * @f_pos: offset (starting register address)
+ */
+static ssize_t rmidev_read(struct file *filp, char __user *buf,
+		size_t count, loff_t *f_pos)
+{
+	ssize_t retval;
+	unsigned char tmpbuf[count + 1];
+	struct rmidev_data *dev_data = filp->private_data;
+    //printk("synap %s\n",__func__);
+	if (IS_ERR(dev_data)) {
+		pr_err("%s: Pointer of char device data is invalid", __func__);
+		return -EBADF;
+	}
+
+
+	if (count == 0)
+		return 0;
+
+	if (count > (REG_ADDR_LIMIT - *f_pos))
+		count = REG_ADDR_LIMIT - *f_pos;
+
+	mutex_lock(dev_data->pdata->pmutex);
+	mutex_lock(&(dev_data->file_mutex));
+
+	retval = remote_rmi4_i2c_read(
+			*f_pos,
+			tmpbuf,
+			count);
+	if (retval < 0)
+		goto clean_up;
+
+	if (copy_to_user(buf, tmpbuf, count))
+		retval = -EFAULT;
+	else
+		*f_pos += retval;
+
+clean_up:
+	mutex_unlock(&(dev_data->file_mutex));
+	mutex_unlock(dev_data->pdata->pmutex);
+
+	return retval;
+}
+
+/*
+ * rmidev_write: - used to write data to rmi device
+ *
+ * @filep: file structure for write
+ * @buf: user space buffer pointer
+ * @count: number of bytes to write
+ * @f_pos: offset (starting register address)
+ */
+static ssize_t rmidev_write(struct file *filp, const char __user *buf,
+		size_t count, loff_t *f_pos)
+{
+	ssize_t retval;
+	unsigned char tmpbuf[count + 1];
+	struct rmidev_data *dev_data = filp->private_data;
+    printk("synap %s\n",__func__);
+
+	if (IS_ERR(dev_data)) {
+		pr_err("%s: Pointer of char device data is invalid", __func__);
+		return -EBADF;
+	}
+
+
+	if (count == 0)
+		return 0;
+
+	if (count > (REG_ADDR_LIMIT - *f_pos))
+		count = REG_ADDR_LIMIT - *f_pos;
+
+	if (copy_from_user(tmpbuf, buf, count))
+		return -EFAULT;
+
+	mutex_lock(dev_data->pdata->pmutex);
+	mutex_lock(&(dev_data->file_mutex));
+
+	retval = remote_rmi4_i2c_write(
+			*f_pos,
+			tmpbuf,
+			count);
+	if (retval >= 0)
+		*f_pos += retval;
+
+
+	mutex_unlock(&(dev_data->file_mutex));
+	mutex_unlock(dev_data->pdata->pmutex);
+
+	return retval;
+}
+
+static int rmidev_create_attr(bool create) {
+	int retval = 0;
+	unsigned char attr_count;
+	struct input_dev *input_dev = remote_rmi4_get_input();
+
+    printk("synap %s\n",__func__);
+	if(!create)
+		goto err_sysfs_attrs ;
+
+	if(rmidev->sysfs_dir)
+		return 0 ;
+
+	if(!input_dev)
+		return -1;
+	/*
+	retval = gpio_export(remote_rmi4_get_irq_gpio(), false);
+	if (retval < 0) {
+		dev_err(device_ptr,
+				"%s: Failed to export attention gpio\n",
+				__func__);
+	} else {
+		retval = gpio_export_link(&(input_dev->dev),
+				"attn", remote_rmi4_get_irq_gpio());
+		if (retval < 0) {
+			dev_err(device_ptr,
+					"%s Failed to create gpio symlink\n",
+					__func__);
+		}
+	}
+	*/
+	rmidev->sysfs_dir = kobject_create_and_add("rmidev",
+			&input_dev->dev.kobj);
+	if (!rmidev->sysfs_dir) {
+		dev_err(device_ptr,
+				"%s: Failed to create sysfs directory\n",
+				__func__);
+		return -1;
+	}
+
+
+	retval = sysfs_create_bin_file(rmidev->sysfs_dir,
+			&attr_data);
+	if (retval < 0) {
+		dev_err(device_ptr,
+				"%s: Failed to create sysfs bin file\n",
+				__func__);
+		goto err_sysfs_bin;
+	}
+
+
+	for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) {
+		retval = sysfs_create_file(rmidev->sysfs_dir,
+				&attrs[attr_count].attr);
+		if (retval < 0) {
+			dev_err(device_ptr,
+					"%s: Failed to create sysfs attributes\n",
+					__func__);
+			retval = -ENODEV;
+			goto err_sysfs_attrs;
+		}
+	}
+
+	return 0 ;
+
+err_sysfs_attrs:
+	if(!rmidev->sysfs_dir)
+		return 0 ;
+	for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) {
+		sysfs_remove_file(rmidev->sysfs_dir, &attrs[attr_count].attr);
+	}
+
+	sysfs_remove_bin_file(rmidev->sysfs_dir, &attr_data);
+
+err_sysfs_bin:
+	kobject_put(rmidev->sysfs_dir);
+	rmidev->sysfs_dir = NULL;
+
+	return retval;
+}
+
+/*
+ * rmidev_open: enable access to rmi device
+ * @inp: inode struture
+ * @filp: file structure
+ */
+static int rmidev_open(struct inode *inp, struct file *filp)
+{
+	int retval = 0;
+	struct rmidev_data *dev_data =
+			container_of(inp->i_cdev, struct rmidev_data, main_dev);
+    printk("synap %s\n",__func__);
+
+	if (!dev_data)
+		return -EACCES;
+
+
+	rmidev_create_attr(true);
+
+	filp->private_data = dev_data;
+
+	mutex_lock(&(dev_data->file_mutex));
+	*(dev_data->pdata->enable_remote) = 1;
+	//remote_rmi4_i2c_enable(false);
+	dev_dbg(device_ptr,
+			"%s: Attention interrupt disabled\n",
+			__func__);
+
+	if (dev_data->ref_count < 1)
+		dev_data->ref_count++;
+	else
+		retval = -EACCES;
+
+	mutex_unlock(&(dev_data->file_mutex));
+
+	return retval;
+}
+
+/*
+ * rmidev_release: - release access to rmi device
+ * @inp: inode structure
+ * @filp: file structure
+ */
+static int rmidev_release(struct inode *inp, struct file *filp)
+{
+	struct rmidev_data *dev_data =
+			container_of(inp->i_cdev, struct rmidev_data, main_dev);
+
+	if (!dev_data)
+		return -EACCES;
+
+	rmidev_create_attr(false);
+
+	mutex_lock(&(dev_data->file_mutex));
+
+	dev_data->ref_count--;
+	if (dev_data->ref_count < 0)
+		dev_data->ref_count = 0;
+
+	remote_rmi4_i2c_enable(true);
+	dev_dbg(device_ptr,
+			"%s: Attention interrupt enabled\n",
+			__func__);
+
+	mutex_unlock(&(dev_data->file_mutex));
+
+	return 0;
+}
+
+static const struct file_operations rmidev_fops = {
+	.owner = THIS_MODULE,
+	.llseek = rmidev_llseek,
+	.read = rmidev_read,
+	.write = rmidev_write,
+	.open = rmidev_open,
+	.release = rmidev_release,
+};
+
+static void rmidev_device_cleanup(struct rmidev_data *dev_data)
+{
+	dev_t devno;
+
+	if (dev_data) {
+		devno = dev_data->main_dev.dev;
+
+		if (dev_data->device_class)
+			device_destroy(dev_data->device_class, devno);
+
+		cdev_del(&dev_data->main_dev);
+
+		unregister_chrdev_region(devno, 1);
+
+		remote_free_panel_data(dev_data->pdata);
+
+		dev_dbg(device_ptr,
+				"%s: rmidev device removed\n",
+				__func__);
+	}
+
+	return;
+}
+
+static char *rmi_char_devnode(struct device *dev, umode_t *mode)
+{
+	if (!mode)
+		return NULL;
+
+	*mode = (S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH);
+
+	return kasprintf(GFP_KERNEL, "rmi/%s", dev_name(dev));
+}
+
+static int rmidev_create_device_class(void)
+{
+	rmidev_device_class = class_create(THIS_MODULE, DEVICE_CLASS_NAME);
+
+	if (IS_ERR(rmidev_device_class)) {
+		pr_err("%s: Failed to create /dev/%s\n",
+				__func__, CHAR_DEVICE_NAME);
+		return -ENODEV;
+	}
+
+	rmidev_device_class->devnode = rmi_char_devnode;
+
+	return 0;
+}
+
+static void remote_rmi4_delay_work(struct work_struct *work) {
+	rmidev_create_attr(true) ;
+}
+
+struct remotepanel_data *remote_alloc_panel_data(void)
+{
+	if(rmidev)
+	{
+		printk("%s:remote panel data has alloc already null\n",__func__);
+		return NULL;
+	}
+
+	return kzalloc(sizeof(struct remotepanel_data), GFP_KERNEL);
+}
+
+static struct remotepanel_data *remote_free_panel_data(struct remotepanel_data *pdata)
+{
+	if(pdata)
+		kfree(pdata);
+	pdata = NULL;
+	return NULL;
+}
+
+
+
+//int rmidev_init_device(void)
+int register_remote_device(struct remotepanel_data *pdata)
+{
+	int retval;
+	dev_t dev_no;
+	struct rmidev_data *dev_data = NULL;
+
+	if(pdata == NULL)
+	{
+		printk("%s:pdata is null\n",__func__);
+		return -1;
+	}
+	if(rmidev)
+	{
+		printk("%s:remote device has register already null\n",__func__);
+		return -1;
+	}
+	rmidev = kzalloc(sizeof(*rmidev), GFP_KERNEL);
+	if (!rmidev) {
+		retval = -ENOMEM;
+		goto err_rmidev;
+	}
+
+	retval = rmidev_create_device_class();
+	if (retval < 0) {
+		goto err_device_class;
+	}
+
+
+	if (rmidev_major_num) {
+		dev_no = MKDEV(rmidev_major_num, DEV_NUMBER);
+		retval = register_chrdev_region(dev_no, 1, CHAR_DEVICE_NAME);
+	} else {
+		retval = alloc_chrdev_region(&dev_no, 1, 1, CHAR_DEVICE_NAME);
+		if (retval < 0) {
+			goto err_device_region;
+		}
+
+		rmidev_major_num = MAJOR(dev_no);
+	}
+
+
+	dev_data = kzalloc(sizeof(*dev_data), GFP_KERNEL);
+	if (!dev_data) {
+		retval = -ENOMEM;
+		goto err_dev_data;
+	}
+
+	dev_data->pdata = pdata;
+
+	mutex_init(&dev_data->file_mutex);
+	dev_data->rmi_dev = rmidev;
+	rmidev->data = dev_data;
+
+	cdev_init(&dev_data->main_dev, &rmidev_fops);
+
+	retval = cdev_add(&dev_data->main_dev, dev_no, 1);
+	if (retval < 0) {
+		goto err_char_device;
+	}
+
+
+	dev_set_name(&rmidev->dev, "rmidev%d", MINOR(dev_no));
+	dev_data->device_class = rmidev_device_class;
+
+	device_ptr = device_create(dev_data->device_class, NULL, dev_no,
+			NULL, CHAR_DEVICE_NAME"%d", MINOR(dev_no));
+	if (IS_ERR(device_ptr)) {
+		pr_err("%s: Failed to create rmi char device\n",__func__);
+		retval = -ENODEV;
+		goto err_char_device;
+	}
+
+	INIT_DELAYED_WORK(&delay_work, remote_rmi4_delay_work);
+	schedule_delayed_work(&delay_work, msecs_to_jiffies(8*1000));
+
+	return 0;
+
+err_char_device:
+	remote_free_panel_data(dev_data->pdata);
+	rmidev_device_cleanup(dev_data);
+	kfree(dev_data);
+
+err_dev_data:
+	unregister_chrdev_region(dev_no, 1);
+
+err_device_region:
+	class_destroy(rmidev_device_class);
+
+err_device_class:
+	kfree(rmidev);
+	rmidev = NULL;
+err_rmidev:
+	return retval;
+}
+
+//void rmidev_remove_device(void)
+void unregister_remote_device(void)
+{
+	struct rmidev_data *dev_data;
+
+	if (!rmidev)
+		return;
+
+	dev_data = rmidev->data;
+	if (dev_data) {
+		rmidev_device_cleanup(dev_data);
+		kfree(dev_data);
+	}
+
+	unregister_chrdev_region(rmidev->dev_no, 1);
+
+	class_destroy(rmidev_device_class);
+
+	kfree(rmidev);
+
+
+	return;
+}
+
+/*
+static int __init rmidev_module_init(void)
+{
+	rmidev_init_device();
+
+	return 0;
+}
+
+static void __exit rmidev_module_exit(void)
+{
+	rmidev_remove_device();
+
+	return;
+}
+
+module_init(rmidev_module_init);
+module_exit(rmidev_module_exit);
+
+MODULE_AUTHOR("Synaptics, Inc.");
+MODULE_DESCRIPTION("Synaptics DSX RMI Dev Module");
+MODULE_LICENSE("GPL v2");
+*/
+
diff --git a/drivers/irqchip/msm_show_resume_irq.c b/drivers/irqchip/msm_show_resume_irq.c
index 6b1d323d6215867ec5e2eaac35778e83411ac402..fe290e12a3cd922d98b53b37c398997579a16ba3 100644
--- a/drivers/irqchip/msm_show_resume_irq.c
+++ b/drivers/irqchip/msm_show_resume_irq.c
@@ -15,7 +15,7 @@
 #include <linux/kernel.h>
 #include <linux/init.h>
 
-int msm_show_resume_irq_mask;
+int msm_show_resume_irq_mask = 1;
 
 module_param_named(
 	debug_mask, msm_show_resume_irq_mask, int, 0664);
diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
index 1ab5f21c0a0cfffaeb03eb68f4a04e76d80f669e..c996ca4f89f7cfdfb373e91ee0ebca33828d572e 100644
--- a/drivers/leds/Kconfig
+++ b/drivers/leds/Kconfig
@@ -743,7 +743,16 @@ config LEDS_QPNP_VIBRATOR_LDO
 	  peripheral found on Qualcomm Technologies, Inc. QPNP PMICs.
 	  The vibrator-ldo peripheral is capable of driving ERM vibrators.
 
+config AW8697_HAPTIC
+	tristate "Haptic driver for awinic aw8697 series"
+	depends on I2C
+	help
+	This option enables support for aw8697 series Haptic Driver.
+
 comment "LED Triggers"
 source "drivers/leds/trigger/Kconfig"
 
 endif # NEW_LEDS
+
+#step_motor
+source "drivers/leds/step_motor/Kconfig"
diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile
index 9ea6d8a1cd6de6a53f2eead8f66a5417a8f55fa8..fd6a44955c65f9928f0efa8248275e6386352f0a 100644
--- a/drivers/leds/Makefile
+++ b/drivers/leds/Makefile
@@ -87,3 +87,8 @@ obj-$(CONFIG_LEDS_USER)			+= uleds.o
 
 # LED Triggers
 obj-$(CONFIG_LEDS_TRIGGERS)		+= trigger/
+#for AWINIC AW8697 Haptic
+obj-$(CONFIG_AW8697_HAPTIC) += aw8697.o
+
+#step motor
+obj-$(CONFIG_STEP_MOTOR)        += step_motor/
diff --git a/drivers/leds/aw8697.c b/drivers/leds/aw8697.c
new file mode 100644
index 0000000000000000000000000000000000000000..d22c71b598d647589cdb1c34f06444be626fe972
--- /dev/null
+++ b/drivers/leds/aw8697.c
@@ -0,0 +1,5414 @@
+/*
+ * aw8697.c   aw8697 haptic module
+ *
+ * Version: v1.3.3
+ *
+ * Copyright (c) 2018 AWINIC Technology CO., LTD
+ * This program is free software; you can redistribute  it and/or modify it
+ * under  the terms of  the GNU General  Public License as published by the
+ * Free Software Foundation;  either version 2 of the  License, or (at your
+ * option) any later version.
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/i2c.h>
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/firmware.h>
+#include <linux/slab.h>
+#include <linux/version.h>
+#include <linux/input.h>
+#include <linux/interrupt.h>
+#include <linux/debugfs.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/syscalls.h>
+#include <linux/power_supply.h>
+#include "aw8697.h"
+#include "aw8697_reg.h"
+#include "aw8697_config.h"
+#include <linux/oneplus/boot_mode.h>
+#include <linux/pm_qos.h>
+
+#include <linux/msm_drm_notify.h>
+#include <linux/fb.h>
+
+/******************************************************
+ *
+ * Marco
+ *
+ ******************************************************/
+#define AW8697_I2C_NAME "aw8697_haptic"
+#define AW8697_HAPTIC_NAME "aw8697_haptic"
+
+#define AW8697_VERSION "v1.3.3"
+
+#define AWINIC_RAM_UPDATE_DELAY
+
+#define AW_I2C_RETRIES 10
+#define AW_I2C_RETRY_DELAY 2
+#define AW_READ_CHIPID_RETRIES 5
+#define AW_READ_CHIPID_RETRY_DELAY 2
+#define AW8697_MAX_DSP_START_TRY_COUNT    10
+#define AWINIC_READ_BIN_FLEXBALLY
+
+#define AW8697_MAX_FIRMWARE_LOAD_CNT 20
+#define OP_AW_DEBUG
+#define OP_OCS_CALIBRATION_T_LENGTH 3500000
+
+#define PM_QOS_VALUE_VB 400
+struct pm_qos_request pm_qos_req_vb;
+
+/* add haptic audio tp mask */
+extern struct shake_point record_point[10];
+/* add haptic audio tp mask end */
+/******************************************************
+ *
+ * variable
+ *
+ ******************************************************/
+#define AW8697_RTP_NAME_MAX        64
+static char aw8697_ram_name[5][30] = {
+{"aw8697_haptic_166.bin"},
+{"aw8697_haptic_168.bin"},
+{"aw8697_haptic_170.bin"},
+{"aw8697_haptic_172.bin"},
+{"aw8697_haptic_174.bin"},
+};
+static char aw8697_rtp_name[][AW8697_RTP_NAME_MAX] = {
+	{"aw8697_rtp.bin"},
+	{"ring_alacrity.bin"},
+	{"ring_amenity.bin"},
+	{"ring_blues.bin"},
+	{"ring_brisk.bin"},
+	{"ring_cloud.bin"},
+	{"ring_cyclotron.bin"},
+	{"ring_distinct.bin"},
+	{"ring_dynamic.bin"},
+	{"ring_echo.bin"},
+	{"ring_expect.bin"},
+	{"ring_fanatical.bin"},
+	{"ring_funky.bin"},
+	{"ring_game.bin"},
+	{"ring_guitar.bin"},
+	{"ring_harping.bin"},
+	{"ring_highlight.bin"},
+	{"ring_idyl.bin"},
+	{"ring_innocence.bin"},
+	{"ring_journey.bin"},
+	{"ring_joyous.bin"},
+	{"ring_marimba.bin"},
+	{"ring_old_telephone.bin"},
+	{"ring_oneplus_tune.bin"},
+	{"ring_oneplus_tune_rhythm.bin"},
+	{"ring_optimistic.bin"},
+	{"ring_piano.bin"},
+	{"ring_pyxis.bin"},
+	{"ring_T-Jingle.bin"},
+	{"notif_allusion.bin"},
+	{"notif_amiable.bin"},
+	{"notif_blare.bin"},
+	{"notif_blissful.bin"},
+	{"notif_cheerful.bin"},
+	{"notif_comely.bin"},
+	{"notif_cozy.bin"},
+	{"notif_ding.bin"},
+	{"notif_effervesce.bin"},
+	{"notif_elegant.bin"},
+	{"notif_free.bin"},
+	{"notif_hallucination.bin"},
+	{"notif_inbound.bin"},
+	{"notif_incidence.bin"},
+	{"notif_light.bin"},
+	{"notif_meet.bin"},
+	{"notif_naivety.bin"},
+	{"notif_quickly.bin"},
+	{"notif_rhythm.bin"},
+	{"notif_silent.bin"},
+	{"notif_spirit.bin"},
+	{"notif_surprise.bin"},
+	{"notif_twinkle.bin"},
+	{"alarm_clock1.bin"},
+	{"alarm_clock2.bin"},
+	{"alarm_clock3.bin"},
+	{"alarm_clock4.bin"},
+	{"alarm_clock5.bin"},
+	{"alarm_breeze.bin"},
+	{"alarm_dream.bin"},
+	{"alarm_fluttering.bin"},
+	{"alarm_flyer.bin"},
+	{"alarm_interesting.bin"},
+	{"alarm_leisurely.bin"},
+	{"alarm_memory.bin"},
+	{"alarm_relieved.bin"},
+	{"alarm_ripple.bin"},
+	{"alarm_spring.bin"},
+	{"alarm_stars.bin"},
+	{"alarm_surging.bin"},
+	{"alarm_tactfully.bin"},
+	{"alarm_the_wind.bin"},
+	{"alarm_walking_in_the_rain.bin"},
+	{"shuntai24k_rtp.bin"},
+	{"wentai24k_rtp.bin"},
+};
+
+struct aw8697_container *aw8697_rtp;
+struct aw8697 *g_aw8697;
+static int aw8697_haptic_get_f0(struct aw8697 *aw8697);
+
+/******************************************************
+ *
+ * functions
+ *
+ ******************************************************/
+static void aw8697_interrupt_clear(struct aw8697 *aw8697);
+static int aw8697_haptic_trig_enable_config(struct aw8697 *aw8697);
+
+#define get_abs(a) ((a)>=0? (a) : (-(a)))
+ /******************************************************
+ *
+ * aw8697 i2c write/read
+ *
+ ******************************************************/
+static int aw8697_i2c_write(struct aw8697 *aw8697,
+         unsigned char reg_addr, unsigned char reg_data)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+
+    while(cnt < AW_I2C_RETRIES) {
+        ret = i2c_smbus_write_byte_data(aw8697->i2c, reg_addr, reg_data);
+        if(ret < 0) {
+            pr_err("%s: i2c_write cnt=%d error=%d\n", __func__, cnt, ret);
+        } else {
+            break;
+        }
+        cnt ++;
+        msleep(AW_I2C_RETRY_DELAY);
+    }
+    return ret;
+}
+
+static int aw8697_i2c_read(struct aw8697 *aw8697,
+        unsigned char reg_addr, unsigned char *reg_data)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+
+    while(cnt < AW_I2C_RETRIES) {
+        ret = i2c_smbus_read_byte_data(aw8697->i2c, reg_addr);
+        if(ret < 0) {
+            pr_err("%s: i2c_read cnt=%d error=%d\n", __func__, cnt, ret);
+        } else {
+            *reg_data = ret;
+            break;
+        }
+        cnt ++;
+        msleep(AW_I2C_RETRY_DELAY);
+    }
+
+    return ret;
+}
+
+static int aw8697_i2c_write_bits(struct aw8697 *aw8697,
+         unsigned char reg_addr, unsigned int mask, unsigned char reg_data)
+{
+    unsigned char reg_val = 0;
+
+    aw8697_i2c_read(aw8697, reg_addr, &reg_val);
+    reg_val &= mask;
+    reg_val |= reg_data;
+    aw8697_i2c_write(aw8697, reg_addr, reg_val);
+
+    return 0;
+}
+
+static int aw8697_i2c_writes(struct aw8697 *aw8697,
+        unsigned char reg_addr, unsigned char *buf, unsigned int len)
+{
+    int ret = -1;
+    unsigned char *data;
+
+    data = kmalloc(len+1, GFP_KERNEL);
+    if (data == NULL) {
+        pr_err("%s: can not allocate memory\n", __func__);
+        return  -ENOMEM;
+    }
+
+    data[0] = reg_addr;
+    memcpy(&data[1], buf, len);
+
+    ret = i2c_master_send(aw8697->i2c, data, len+1);
+    if (ret < 0) {
+        pr_err("%s: i2c master send error\n", __func__);
+    }
+
+    kfree(data);
+
+    return ret;
+}
+
+/*****************************************************
+ *
+ * ram update
+ *
+ *****************************************************/
+static void aw8697_rtp_loaded(const struct firmware *cont, void *context)
+{
+    struct aw8697 *aw8697 = context;
+    pr_info("%s enter\n", __func__);
+
+    if (!cont) {
+        pr_err("%s: failed to read %s\n", __func__, aw8697_rtp_name[aw8697->rtp_file_num]);
+        release_firmware(cont);
+        return;
+    }
+
+    pr_info("%s: loaded %s - size: %zu\n", __func__, aw8697_rtp_name[aw8697->rtp_file_num],
+                    cont ? cont->size : 0);
+
+    /* aw8697 rtp update */
+    mutex_lock(&aw8697->rtp_lock);
+    aw8697_rtp = kzalloc(cont->size+sizeof(int), GFP_KERNEL);
+    if (!aw8697_rtp) {
+        release_firmware(cont);
+        mutex_unlock(&aw8697->rtp_lock);
+        pr_err("%s: Error allocating memory\n", __func__);
+        return;
+    }
+    aw8697_rtp->len = cont->size;
+    pr_info("%s: rtp size = %d\n", __func__, aw8697_rtp->len);
+    memcpy(aw8697_rtp->data, cont->data, cont->size);
+    release_firmware(cont);
+    mutex_unlock(&aw8697->rtp_lock);
+
+    aw8697->rtp_init = 1;
+    pr_info("%s: rtp update complete\n", __func__);
+}
+
+static int aw8697_rtp_update(struct aw8697 *aw8697)
+{
+    pr_info("%s enter\n", __func__);
+
+    return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
+                aw8697_rtp_name[aw8697->rtp_file_num], aw8697->dev, GFP_KERNEL,
+                aw8697, aw8697_rtp_loaded);
+}
+
+
+ static void aw8697_container_update(struct aw8697 *aw8697,
+        struct aw8697_container *aw8697_cont)
+{
+    int i = 0;
+    unsigned int shift = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    mutex_lock(&aw8697->lock);
+
+    aw8697->ram.baseaddr_shift = 2;
+    aw8697->ram.ram_shift = 4;
+
+    /* RAMINIT Enable */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_EN);
+
+    /* base addr */
+    shift = aw8697->ram.baseaddr_shift;
+    aw8697->ram.base_addr = (unsigned int)((aw8697_cont->data[0+shift]<<8) |
+            (aw8697_cont->data[1+shift]));
+    pr_info("%s: base_addr=0x%4x\n", __func__, aw8697->ram.base_addr);
+
+    aw8697_i2c_write(aw8697, AW8697_REG_BASE_ADDRH, aw8697_cont->data[0+shift]);
+    aw8697_i2c_write(aw8697, AW8697_REG_BASE_ADDRL, aw8697_cont->data[1+shift]);
+
+    aw8697_i2c_write(aw8697, AW8697_REG_FIFO_AEH,
+                    (unsigned char)((aw8697->ram.base_addr>>1)>>8)); /*1/2 FIFO*/
+    aw8697_i2c_write(aw8697, AW8697_REG_FIFO_AEL,
+                    (unsigned char)((aw8697->ram.base_addr>>1)&0x00FF));/*1/2 FIFO*/
+    aw8697_i2c_write(aw8697, AW8697_REG_FIFO_AFH,
+                    (unsigned char)((aw8697->ram.base_addr-(aw8697->ram.base_addr>>2))>>8));
+    aw8697_i2c_write(aw8697, AW8697_REG_FIFO_AFL,
+                    (unsigned char)((aw8697->ram.base_addr-(aw8697->ram.base_addr>>2))&0x00FF));
+
+    /* ram */
+    shift = aw8697->ram.baseaddr_shift;
+    aw8697_i2c_write(aw8697, AW8697_REG_RAMADDRH, aw8697_cont->data[0+shift]);
+    aw8697_i2c_write(aw8697, AW8697_REG_RAMADDRL, aw8697_cont->data[1+shift]);
+    shift = aw8697->ram.ram_shift;
+    for(i=shift; i<aw8697_cont->len; i++) {
+        aw8697_i2c_write(aw8697, AW8697_REG_RAMDATA, aw8697_cont->data[i]);
+    }
+
+    /* RAMINIT Disable */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_OFF);
+
+    mutex_unlock(&aw8697->lock);
+
+    pr_info("%s exit\n", __func__);
+}
+
+
+static void aw8697_ram_loaded(const struct firmware *cont, void *context)
+{
+    struct aw8697 *aw8697 = context;
+    struct aw8697_container *aw8697_fw;
+    int i = 0;
+    unsigned short check_sum = 0;
+    #ifdef AWINIC_READ_BIN_FLEXBALLY
+    static unsigned char load_count =0;
+    int ram_timer_val = 1000;
+    load_count++;
+    #endif
+
+    pr_info("%s enter\n", __func__);
+
+    if (!cont) {
+        pr_err("%s: failed to read %s\n", __func__, aw8697_ram_name[aw8697->ram_bin_index]);
+        release_firmware(cont);
+    #ifdef AWINIC_READ_BIN_FLEXBALLY
+    if(load_count <=20)
+    {
+       schedule_delayed_work(&aw8697->ram_work, msecs_to_jiffies(ram_timer_val));
+       pr_info("%s:start hrtimer:load_count%d\n", __func__, load_count);
+    }
+    #endif
+        return;
+    }
+
+    pr_info("%s: loaded %s - size: %zu\n", __func__, aw8697_ram_name[aw8697->ram_bin_index],
+                    cont ? cont->size : 0);
+    /* check sum */
+    for(i=2; i<cont->size; i++) {
+        check_sum += cont->data[i];
+    }
+    if(check_sum != (unsigned short)((cont->data[0]<<8)|(cont->data[1]))) {
+        pr_err("%s: check sum err: check_sum=0x%04x\n", __func__, check_sum);
+        return;
+    } else {
+        pr_info("%s: check sum pass : 0x%04x\n", __func__, check_sum);
+        aw8697->ram.check_sum = check_sum;
+    }
+
+    /* aw8697 ram update */
+    aw8697_fw = kzalloc(cont->size+sizeof(int), GFP_KERNEL);
+    if (!aw8697_fw) {
+        release_firmware(cont);
+        pr_err("%s: Error allocating memory\n", __func__);
+        return;
+    }
+    aw8697_fw->len = cont->size;
+    memcpy(aw8697_fw->data, cont->data, cont->size);
+    release_firmware(cont);
+
+    aw8697_container_update(aw8697, aw8697_fw);
+
+    aw8697->ram.len = aw8697_fw->len;
+
+    kfree(aw8697_fw);
+
+    aw8697->ram_init = 1;
+    pr_info("%s: fw update complete\n", __func__);
+    aw8697_rtp_update(aw8697);
+}
+
+static int aw8697_ram_update(struct aw8697 *aw8697)
+{
+    aw8697->ram_init = 0;
+    aw8697->rtp_init = 0;
+
+    pr_info("%s:aw8697->haptic_real_f0:%d\n", __func__,aw8697->haptic_real_f0);
+    if (aw8697->haptic_real_f0 <167)
+        aw8697->ram_bin_index = 0;
+    else if(aw8697->haptic_real_f0 <169)
+        aw8697->ram_bin_index = 1;
+    else if(aw8697->haptic_real_f0 <171)
+        aw8697->ram_bin_index = 2;
+    else if(aw8697->haptic_real_f0 <173)
+        aw8697->ram_bin_index = 3;
+    else
+        aw8697->ram_bin_index = 4;
+    pr_info("%s:haptic bin name  %s \n", __func__,aw8697_ram_name[aw8697->ram_bin_index]);
+    return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
+                aw8697_ram_name[aw8697->ram_bin_index], aw8697->dev, GFP_KERNEL,
+                aw8697, aw8697_ram_loaded);
+}
+
+#ifdef AWINIC_RAM_UPDATE_DELAY
+static void aw8697_ram_work_routine(struct work_struct *work)
+{
+    struct aw8697 *aw8697 = container_of(work, struct aw8697, ram_work.work);
+
+    pr_info("%s enter\n", __func__);
+    aw8697_ram_update(aw8697);
+}
+#endif
+
+static int aw8697_ram_init(struct aw8697 *aw8697)
+{
+
+#ifdef AWINIC_RAM_UPDATE_DELAY
+    int ram_timer_val = 1000;
+    aw8697->haptic_real_f0 = AW8697_HAPTIC_F0_PRE/10;
+
+    INIT_DELAYED_WORK(&aw8697->ram_work, aw8697_ram_work_routine);
+    schedule_delayed_work(&aw8697->ram_work, msecs_to_jiffies(ram_timer_val));
+#else
+    aw8697_ram_update(aw8697);
+#endif
+    return 0;
+}
+
+/*****************************************************
+ *
+ * haptic control
+ *
+ *****************************************************/
+static int aw8697_haptic_softreset(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8697_i2c_write(aw8697, AW8697_REG_ID, 0xAA);
+    msleep(1);
+    return 0;
+}
+
+static int aw8697_haptic_active(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_WORK_MODE_MASK, AW8697_BIT_SYSCTRL_ACTIVE);
+    aw8697_interrupt_clear(aw8697);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_UVLO_MASK, AW8697_BIT_SYSINTM_UVLO_EN);
+    return 0;
+}
+
+static int aw8697_haptic_play_mode(struct aw8697 *aw8697, unsigned char play_mode)
+{
+    pr_debug("%s enter\n", __func__);
+
+    switch(play_mode) {
+        case AW8697_HAPTIC_STANDBY_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_STANDBY_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+                    AW8697_BIT_SYSINTM_UVLO_MASK, AW8697_BIT_SYSINTM_UVLO_OFF);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_WORK_MODE_MASK, AW8697_BIT_SYSCTRL_STANDBY);
+            break;
+        case AW8697_HAPTIC_RAM_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_RAM_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RAM);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_DISABLE);
+            }
+            aw8697_haptic_active(aw8697);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_ENABLE);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                        AW8697_BIT_SYSCTRL_BST_MODE_MASK&AW8697_BIT_SYSCTRL_WORK_MODE_MASK,
+                        AW8697_BIT_SYSCTRL_BST_MODE_BOOST|AW8697_BIT_SYSCTRL_STANDBY);
+                aw8697_haptic_active(aw8697);
+            } else {
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BOOST);
+            }
+            mdelay(2);
+            break;
+        case AW8697_HAPTIC_RAM_LOOP_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_RAM_LOOP_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RAM);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_DISABLE);
+            }
+            aw8697_haptic_active(aw8697);
+            break;
+        case AW8697_HAPTIC_RTP_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_RTP_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RTP);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RTP_DISABLE);
+            }
+            aw8697_haptic_active(aw8697);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RTP_ENABLE);
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                        AW8697_BIT_SYSCTRL_BST_MODE_MASK&AW8697_BIT_SYSCTRL_WORK_MODE_MASK,
+                        AW8697_BIT_SYSCTRL_BST_MODE_BOOST|AW8697_BIT_SYSCTRL_STANDBY);
+                aw8697_haptic_active(aw8697);
+            } else {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                        AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BOOST);
+            }
+            msleep(3);
+            break;
+        case AW8697_HAPTIC_TRIG_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_TRIG_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RAM);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_DISABLE);
+            }
+            aw8697_haptic_active(aw8697);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_ENABLE);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                        AW8697_BIT_SYSCTRL_BST_MODE_MASK&AW8697_BIT_SYSCTRL_WORK_MODE_MASK,
+                        AW8697_BIT_SYSCTRL_BST_MODE_BOOST|AW8697_BIT_SYSCTRL_STANDBY);
+                aw8697_haptic_active(aw8697);
+            } else {
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BOOST);
+            }
+            msleep(3);
+            break;
+        case AW8697_HAPTIC_CONT_MODE:
+            aw8697->play_mode = AW8697_HAPTIC_CONT_MODE;
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_CONT);
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+                    AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+            if(aw8697->auto_boost) {
+                aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                        AW8697_BIT_BST_AUTO_BST_RAM_MASK, AW8697_BIT_BST_AUTO_BST_RAM_DISABLE);
+            }
+            aw8697_haptic_active(aw8697);
+            break;
+        default:
+            dev_err(aw8697->dev, "%s: play mode %d err",
+                    __func__, play_mode);
+            break;
+    }
+    return 0;
+}
+/*OP add for juge rtp on begin*/
+static int aw8697_haptic_juge_RTP_is_going_on(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    unsigned char rtp_state = 0;
+    static unsigned char pre_reg_val;
+
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSCTRL, &reg_val);
+    if((reg_val&AW8697_BIT_SYSCTRL_PLAY_MODE_RTP)&&(!(reg_val&AW8697_BIT_SYSCTRL_STANDBY)))
+         rtp_state = 1;/*is going on*/
+    if (pre_reg_val != reg_val)
+        pr_info("%sAW8697_REG_SYSCTRL 0x04==%02x rtp_state=%d\n", __func__,reg_val,rtp_state);
+    pre_reg_val = reg_val;
+    if (aw8697->rtp_routine_on) {
+        pr_info("%s:rtp_routine_on\n", __func__);
+        rtp_state = 1;/*is going on*/
+    }
+    aw8697->rtp_on = (bool)rtp_state;
+    return rtp_state;
+}
+/*OP add for juge rtp on begin*/
+
+static int aw8697_haptic_play_go(struct aw8697 *aw8697, bool flag)
+{
+    pr_debug("%s enter\n", __func__);
+    if (!flag) {
+       do_gettimeofday(&aw8697->current_time);
+        aw8697->interval_us = (aw8697->current_time.tv_sec-aw8697->pre_enter_time.tv_sec) * 1000000
+          + (aw8697->current_time.tv_usec-aw8697->pre_enter_time.tv_usec);
+       if (aw8697->interval_us < 2000) {
+           pr_info("aw8697->interval_us t=%ld\n",aw8697->interval_us);
+           mdelay(2);
+       }
+    }
+    if (flag == true) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_GO,
+            AW8697_BIT_GO_MASK, AW8697_BIT_GO_ENABLE);
+        do_gettimeofday(&aw8697->pre_enter_time);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_GO,
+            AW8697_BIT_GO_MASK, AW8697_BIT_GO_DISABLE);
+    }
+    return 0;
+}
+
+static int aw8697_haptic_stop_delay(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    unsigned int cnt = 60;
+
+    while(cnt--) {
+        aw8697_i2c_read(aw8697, AW8697_REG_GLB_STATE, &reg_val);
+        if((reg_val&0x0f) == 0x00) {
+            return 0;
+        }
+        mdelay(2);
+        pr_info("%s wait for standby, reg glb_state=0x%02x\n",
+            __func__, reg_val);
+    }
+    pr_err("%s do not enter standby automatically\n", __func__);
+
+    return 0;
+}
+
+int aw8697_op_haptic_stop(void)
+{
+    pr_debug("%s enter\n", __func__);
+
+    mutex_lock(&g_aw8697->lock);
+    if (g_aw8697) {
+       aw8697_haptic_play_go(g_aw8697, false);
+       aw8697_haptic_stop_delay(g_aw8697);
+       aw8697_haptic_play_mode(g_aw8697, AW8697_HAPTIC_STANDBY_MODE);
+    }
+    mutex_unlock(&g_aw8697->lock);
+
+    return 0;
+}
+
+static int aw8697_haptic_stop(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+#ifdef OP_AW_DEBUG
+		do_gettimeofday(&aw8697->t_stop);
+#endif
+
+    aw8697_haptic_play_go(aw8697, false);
+    aw8697_haptic_stop_delay(aw8697);
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_STANDBY_MODE);
+    return 0;
+}
+
+static int aw8697_haptic_start(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+    aw8697_haptic_play_go(aw8697, true);
+#ifdef OP_AW_DEBUG
+    do_gettimeofday(&aw8697->t_start);
+    aw8697->game_microsecond = (aw8697->t_start.tv_sec-aw8697->t_stop.tv_sec) * 1000000 +
+        (aw8697->t_start.tv_usec-aw8697->t_stop.tv_usec);
+    pr_info("%s: haptic_audio_delay=%dus\n", __func__, aw8697->game_microsecond);
+#endif
+    return 0;
+}
+
+static int aw8697_haptic_set_wav_seq(struct aw8697 *aw8697,
+        unsigned char wav, unsigned char seq)
+{
+    aw8697_i2c_write(aw8697, AW8697_REG_WAVSEQ1+wav,
+            seq);
+    return 0;
+}
+
+static int aw8697_haptic_set_wav_loop(struct aw8697 *aw8697,
+        unsigned char wav, unsigned char loop)
+{
+    unsigned char tmp = 0;
+
+    if(wav%2) {
+        tmp = loop<<0;
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_WAVLOOP1+(wav/2),
+                AW8697_BIT_WAVLOOP_SEQNP1_MASK, tmp);
+    } else {
+        tmp = loop<<4;
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_WAVLOOP1+(wav/2),
+                AW8697_BIT_WAVLOOP_SEQN_MASK, tmp);
+    }
+
+    return 0;
+}
+
+static int aw8697_haptic_set_repeat_wav_seq(struct aw8697 *aw8697, unsigned char seq)
+{
+    aw8697_haptic_set_wav_seq(aw8697, 0x00, seq);
+    aw8697_haptic_set_wav_loop(aw8697, 0x00, AW8697_BIT_WAVLOOP_INIFINITELY);
+
+    return 0;
+}
+
+
+static int aw8697_haptic_set_bst_vol(struct aw8697 *aw8697, unsigned char bst_vol)
+{
+    if(bst_vol & 0xe0) {
+        bst_vol = 0x1f;
+    }
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_BSTDBG4,
+            AW8697_BIT_BSTDBG4_BSTVOL_MASK, (bst_vol<<1));
+    return 0;
+}
+
+static int aw8697_haptic_set_bst_peak_cur(struct aw8697 *aw8697, unsigned char peak_cur)
+{
+    peak_cur &= AW8697_BSTCFG_PEAKCUR_LIMIT;
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_BSTCFG,
+            AW8697_BIT_BSTCFG_PEAKCUR_MASK, peak_cur);
+    return 0;
+}
+
+static int aw8697_haptic_set_gain(struct aw8697 *aw8697, unsigned char gain)
+{
+    aw8697_i2c_write(aw8697, AW8697_REG_DATDBG, gain);
+    return 0;
+}
+
+static int aw8697_haptic_set_pwm(struct aw8697 *aw8697, unsigned char mode)
+{
+    switch(mode) {
+        case AW8697_PWM_48K:
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMDBG,
+                AW8697_BIT_PWMDBG_PWM_MODE_MASK, AW8697_BIT_PWMDBG_PWM_48K);
+            break;
+        case AW8697_PWM_24K:
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMDBG,
+                AW8697_BIT_PWMDBG_PWM_MODE_MASK, AW8697_BIT_PWMDBG_PWM_24K);
+            break;
+        case AW8697_PWM_12K:
+            aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMDBG,
+                AW8697_BIT_PWMDBG_PWM_MODE_MASK, AW8697_BIT_PWMDBG_PWM_12K);
+            break;
+        default:
+            break;
+    }
+    return 0;
+}
+
+static int aw8697_haptic_play_wav_seq(struct aw8697 *aw8697, unsigned char flag)
+{
+    pr_debug("%s enter\n", __func__);
+
+    if(flag) {
+        aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_RAM_MODE);
+        aw8697_haptic_start(aw8697);
+    }
+    return 0;
+}
+
+static int aw8697_haptic_play_repeat_seq(struct aw8697 *aw8697, unsigned char flag)
+{
+    pr_debug("%s enter\n", __func__);
+    if(flag) {
+        aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_RAM_LOOP_MODE);
+        aw8697_haptic_start(aw8697);
+    }
+
+    return 0;
+}
+
+static int aw8697_haptic_swicth_motorprotect_config(struct aw8697 *aw8697, unsigned char addr, unsigned char val)
+{
+    pr_debug("%s enter\n", __func__);
+    if(addr == 1) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+                AW8697_BIT_DETCTRL_PROTECT_MASK, AW8697_BIT_DETCTRL_PROTECT_SHUTDOWN);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMPRC,
+                AW8697_BIT_PWMPRC_PRC_MASK, AW8697_BIT_PWMPRC_PRC_ENABLE);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PRLVL,
+                AW8697_BIT_PRLVL_PR_MASK, AW8697_BIT_PRLVL_PR_ENABLE);
+    } else if (addr == 0) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+                AW8697_BIT_DETCTRL_PROTECT_MASK,  AW8697_BIT_DETCTRL_PROTECT_NO_ACTION);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMPRC,
+                AW8697_BIT_PWMPRC_PRC_MASK, AW8697_BIT_PWMPRC_PRC_DISABLE);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PRLVL,
+                AW8697_BIT_PRLVL_PR_MASK, AW8697_BIT_PRLVL_PR_DISABLE);
+    } else if (addr == 0x2d){
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PWMPRC,
+                AW8697_BIT_PWMPRC_PRCTIME_MASK, val);
+    }else if (addr == 0x3e){
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PRLVL,
+                AW8697_BIT_PRLVL_PRLVL_MASK, val);
+    }else if (addr == 0x3f){
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_PRTIME,
+                AW8697_BIT_PRTIME_PRTIME_MASK, val);
+    } else{
+        /*nothing to do;*/
+    }
+	 return 0;
+}
+
+/*****************************************************
+ *
+ * os calibration
+ *
+ *****************************************************/
+static int aw8697_haptic_os_calibration(struct aw8697 *aw8697)
+{
+    unsigned int cont = 2000;
+    unsigned char reg_val = 0;
+    pr_debug("%s enter\n", __func__);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+            AW8697_BIT_DETCTRL_DIAG_GO_MASK, AW8697_BIT_DETCTRL_DIAG_GO_ENABLE);
+    while(1){
+        aw8697_i2c_read(aw8697, AW8697_REG_DETCTRL, &reg_val);
+        if((reg_val & 0x01) == 0 || cont ==0)
+            break;
+         cont--;
+    }
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_OFF);
+    return 0;
+}
+/*****************************************************
+ *
+ * trig config
+ *
+ *****************************************************/
+static int aw8697_haptic_trig_param_init(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8697->trig[0].enable = AW8697_TRG1_ENABLE;
+    aw8697->trig[0].default_level = AW8697_TRG1_DEFAULT_LEVEL;
+    aw8697->trig[0].dual_edge = AW8697_TRG1_DUAL_EDGE;
+    aw8697->trig[0].frist_seq = AW8697_TRG1_FIRST_EDGE_SEQ;
+    aw8697->trig[0].second_seq = AW8697_TRG1_SECOND_EDGE_SEQ;
+
+    aw8697->trig[1].enable = AW8697_TRG2_ENABLE;
+    aw8697->trig[1].default_level = AW8697_TRG2_DEFAULT_LEVEL;
+    aw8697->trig[1].dual_edge = AW8697_TRG2_DUAL_EDGE;
+    aw8697->trig[1].frist_seq = AW8697_TRG2_FIRST_EDGE_SEQ;
+    aw8697->trig[1].second_seq = AW8697_TRG2_SECOND_EDGE_SEQ;
+
+    aw8697->trig[2].enable = AW8697_TRG3_ENABLE;
+    aw8697->trig[2].default_level = AW8697_TRG3_DEFAULT_LEVEL;
+    aw8697->trig[2].dual_edge = AW8697_TRG3_DUAL_EDGE;
+    aw8697->trig[2].frist_seq = AW8697_TRG3_FIRST_EDGE_SEQ;
+    aw8697->trig[2].second_seq = AW8697_TRG3_SECOND_EDGE_SEQ;
+
+    return 0;
+}
+static int aw8697_haptic_trig_param_config(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+
+    if(aw8697->trig[0].default_level) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG1_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG1_POLAR_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG1_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG1_POLAR_POS);
+    }
+    if(aw8697->trig[1].default_level) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG2_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG2_POLAR_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG2_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG2_POLAR_POS);
+    }
+    if(aw8697->trig[2].default_level) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG3_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG3_POLAR_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG3_POLAR_MASK, AW8697_BIT_TRGCFG1_TRG3_POLAR_POS);
+    }
+
+    if(aw8697->trig[0].dual_edge) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG1_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG1_EDGE_POS_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG1_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG1_EDGE_POS);
+    }
+    if(aw8697->trig[1].dual_edge) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG2_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG2_EDGE_POS_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG2_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG2_EDGE_POS);
+    }
+    if(aw8697->trig[2].dual_edge) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG3_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG3_EDGE_POS_NEG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG1,
+                AW8697_BIT_TRGCFG1_TRG3_EDGE_MASK, AW8697_BIT_TRGCFG1_TRG3_EDGE_POS);
+    }
+
+    if(aw8697->trig[0].frist_seq) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG1_WAV_P, aw8697->trig[0].frist_seq);
+    }
+    if(aw8697->trig[0].second_seq && aw8697->trig[0].dual_edge) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG1_WAV_N, aw8697->trig[0].second_seq);
+    }
+    if(aw8697->trig[1].frist_seq) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG2_WAV_P, aw8697->trig[1].frist_seq);
+    }
+    if(aw8697->trig[1].second_seq && aw8697->trig[1].dual_edge) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG2_WAV_N, aw8697->trig[1].second_seq);
+    }
+    if(aw8697->trig[2].frist_seq) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG3_WAV_P, aw8697->trig[1].frist_seq);
+    }
+    if(aw8697->trig[2].second_seq && aw8697->trig[2].dual_edge) {
+        aw8697_i2c_write(aw8697, AW8697_REG_TRG3_WAV_N, aw8697->trig[1].second_seq);
+    }
+
+    return 0;
+}
+
+static int aw8697_haptic_trig_enable_config(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG2,
+            AW8697_BIT_TRGCFG2_TRG1_ENABLE_MASK, aw8697->trig[0].enable);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG2,
+            AW8697_BIT_TRGCFG2_TRG2_ENABLE_MASK, aw8697->trig[1].enable);
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_TRG_CFG2,
+            AW8697_BIT_TRGCFG2_TRG3_ENABLE_MASK, aw8697->trig[2].enable);
+    return 0;
+}
+static int aw8697_haptic_auto_boost_config(struct aw8697 *aw8697, unsigned char flag)
+{
+    aw8697->auto_boost = flag;
+    if(flag) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                AW8697_BIT_BST_AUTO_BST_AUTOSW_MASK, AW8697_BIT_BST_AUTO_BST_AUTOMATIC_BOOST);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_BST_AUTO,
+                AW8697_BIT_BST_AUTO_BST_AUTOSW_MASK, AW8697_BIT_BST_AUTO_BST_MANUAL_BOOST);
+    }
+    return 0;
+}
+
+/*****************************************************
+ *
+ * vbat mode
+ *
+ *****************************************************/
+static int aw8697_haptic_cont_vbat_mode(struct aw8697 *aw8697, unsigned char flag)
+{
+    if(flag == AW8697_HAPTIC_CONT_VBAT_HW_COMP_MODE) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_ADCTEST,
+                AW8697_BIT_ADCTEST_VBAT_MODE_MASK, AW8697_BIT_ADCTEST_VBAT_HW_COMP);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_ADCTEST,
+                AW8697_BIT_ADCTEST_VBAT_MODE_MASK, AW8697_BIT_ADCTEST_VBAT_SW_COMP);
+    }
+    return 0;
+}
+
+static int aw8697_haptic_get_vbat(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    unsigned int cont = 2000;
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+            AW8697_BIT_DETCTRL_VBAT_GO_MASK, AW8697_BIT_DETCTRL_VABT_GO_ENABLE);
+
+    while(1){
+        aw8697_i2c_read(aw8697, AW8697_REG_DETCTRL, &reg_val);
+        if((reg_val & 0x02) == 0 || cont == 0)
+             break;
+        cont--;
+    }
+
+    aw8697_i2c_read(aw8697, AW8697_REG_VBATDET, &reg_val);
+    aw8697->vbat = 6100 * reg_val / 256;
+    if(aw8697->vbat > AW8697_VBAT_MAX) {
+        aw8697->vbat = AW8697_VBAT_MAX;
+        pr_debug("%s vbat max limit = %dmV\n", __func__, aw8697->vbat);
+    }
+    if(aw8697->vbat < AW8697_VBAT_MIN) {
+        aw8697->vbat = AW8697_VBAT_MIN;
+        pr_debug("%s vbat min limit = %dmV\n", __func__, aw8697->vbat);
+    }
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_OFF);
+
+    return 0;
+}
+
+static int aw8697_haptic_ram_vbat_comp(struct aw8697 *aw8697, bool flag)
+{
+    int temp_gain = 0;
+
+    if(flag) {
+        if(aw8697->ram_vbat_comp == AW8697_HAPTIC_RAM_VBAT_COMP_ENABLE) {
+            aw8697_haptic_get_vbat(aw8697);
+            temp_gain = aw8697->gain * AW8697_VBAT_REFER / aw8697->vbat;
+            if(temp_gain > (128*AW8697_VBAT_REFER/AW8697_VBAT_MIN)) {
+                temp_gain = 128*AW8697_VBAT_REFER/AW8697_VBAT_MIN;
+                pr_debug("%s gain limit=%d\n", __func__, temp_gain);
+            }
+            aw8697_haptic_set_gain(aw8697, temp_gain);
+        } else {
+            aw8697_haptic_set_gain(aw8697, aw8697->gain);
+        }
+    } else {
+        aw8697_haptic_set_gain(aw8697, aw8697->gain);
+    }
+
+    return 0;
+}
+
+/*****************************************************
+ *
+ * f0
+ *
+ *****************************************************/
+static int aw8697_haptic_set_f0_preset(struct aw8697 *aw8697)
+{
+    unsigned int f0_reg = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    f0_reg = 1000000000/(aw8697->f0_pre*AW8697_HAPTIC_F0_COEFF);
+    aw8697_i2c_write(aw8697, AW8697_REG_F_PRE_H, (unsigned char)((f0_reg>>8)&0xff));
+    aw8697_i2c_write(aw8697, AW8697_REG_F_PRE_L, (unsigned char)((f0_reg>>0)&0xff));
+
+    return 0;
+}
+
+static int aw8697_haptic_read_f0(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+    unsigned int f0_reg = 0;
+    unsigned long f0_tmp = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_F_LRA_F0_H, &reg_val);
+    f0_reg = (reg_val<<8);
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_F_LRA_F0_L, &reg_val);
+    f0_reg |= (reg_val<<0);
+    if (!f0_reg) {
+        pr_info("%s not get f0 because f0_reg vaule is 0\n", __func__);
+        return 0;
+    }
+    f0_tmp = 1000000000/(f0_reg*AW8697_HAPTIC_F0_COEFF);
+    aw8697->f0 = (unsigned int)f0_tmp;
+    pr_info("%s f0=%d\n", __func__, aw8697->f0);
+
+    return 0;
+}
+
+static int aw8697_haptic_read_cont_f0(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+    unsigned int f0_reg = 0;
+    unsigned long f0_tmp = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_F_LRA_CONT_H, &reg_val);
+    f0_reg = (reg_val<<8);
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_F_LRA_CONT_L, &reg_val);
+    f0_reg |= (reg_val<<0);
+    if (!f0_reg) {
+        pr_info("%s not get f0 because f0_reg vaule is 0\n", __func__);
+        return 0;
+    }
+    f0_tmp = 1000000000/(f0_reg*AW8697_HAPTIC_F0_COEFF);
+    aw8697->cont_f0 = (unsigned int)f0_tmp;
+    pr_info("%s f0=%d\n", __func__, aw8697->cont_f0);
+
+    return 0;
+}
+
+static int aw8697_haptic_read_beme(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_WAIT_VOL_MP, &reg_val);
+    aw8697->max_pos_beme = (reg_val<<0);
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_WAIT_VOL_MN, &reg_val);
+    aw8697->max_neg_beme = (reg_val<<0);
+
+    pr_info("%s max_pos_beme=%d\n", __func__, aw8697->max_pos_beme);
+    pr_info("%s max_neg_beme=%d\n", __func__, aw8697->max_neg_beme);
+
+    return 0;
+}
+
+
+
+/*****************************************************
+ *
+ * rtp
+ *
+ *****************************************************/
+static void aw8697_haptic_set_rtp_aei(struct aw8697 *aw8697, bool flag)
+{
+    if(flag) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+                AW8697_BIT_SYSINTM_FF_AE_MASK, AW8697_BIT_SYSINTM_FF_AE_EN);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+                AW8697_BIT_SYSINTM_FF_AE_MASK, AW8697_BIT_SYSINTM_FF_AE_OFF);
+    }
+}
+
+static unsigned char aw8697_haptic_rtp_get_fifo_afi(struct aw8697 *aw8697)
+{
+    unsigned char ret = 0;
+    unsigned char reg_val = 0;
+
+    if(aw8697->osc_cali_flag==1){
+        aw8697_i2c_read(aw8697, AW8697_REG_SYSST, &reg_val);
+        reg_val &= AW8697_BIT_SYSST_FF_AFS;
+        ret = reg_val>>3;
+    }else{
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+    reg_val &= AW8697_BIT_SYSINT_FF_AFI;
+    ret = reg_val>>3;
+    }
+
+    return ret;
+}
+
+/*****************************************************
+ *
+ * rtp
+ *
+ *****************************************************/
+static int aw8697_haptic_rtp_init(struct aw8697 *aw8697)
+{
+    unsigned int buf_len = 0;
+
+    pr_info("%s enter\n", __func__);
+    pm_qos_add_request(&pm_qos_req_vb, PM_QOS_CPU_DMA_LATENCY, PM_QOS_VALUE_VB);
+    aw8697->rtp_cnt = 0;
+
+    mutex_lock(&aw8697->rtp_lock);
+    while((!aw8697_haptic_rtp_get_fifo_afi(aw8697)) &&
+            (aw8697->play_mode == AW8697_HAPTIC_RTP_MODE)) {
+        pr_info("%s rtp cnt = %d\n", __func__, aw8697->rtp_cnt);
+        if((aw8697_rtp->len-aw8697->rtp_cnt) < (aw8697->ram.base_addr>>2)) {
+            buf_len = aw8697_rtp->len-aw8697->rtp_cnt;
+        } else {
+            buf_len = (aw8697->ram.base_addr>>2);
+        }
+        aw8697_i2c_writes(aw8697, AW8697_REG_RTP_DATA,
+                &aw8697_rtp->data[aw8697->rtp_cnt], buf_len);
+        aw8697->rtp_cnt += buf_len;
+        if(aw8697->rtp_cnt == aw8697_rtp->len || !buf_len) {
+            pr_info("%s: rtp update complete,buf_len:%d\n", __func__, buf_len);
+            aw8697->rtp_cnt = 0;
+            mutex_unlock(&aw8697->rtp_lock);
+            pm_qos_remove_request(&pm_qos_req_vb);
+            return 0;
+        }
+    }
+    mutex_unlock(&aw8697->rtp_lock);
+
+    if(aw8697->play_mode == AW8697_HAPTIC_RTP_MODE) {
+        aw8697_haptic_set_rtp_aei(aw8697, true);
+    }
+
+    pr_info("%s exit\n", __func__);
+    pm_qos_remove_request(&pm_qos_req_vb);
+    return 0;
+}
+static int aw8697_clock_OSC_trim_calibration(unsigned long int theory_time, unsigned long int real_time)
+{
+	unsigned int real_code = 0;
+	unsigned int LRA_TRIM_CODE = 0;
+	unsigned int DFT_LRA_TRIM_CODE = 0;
+	unsigned int Not_need_cali_threshold = 10;/*0.1 percent not need calibrate*/
+
+	if(theory_time == real_time ) {
+		pr_info("aw_osctheory_time == real_time:%ld  theory_time = %ld not need to cali\n",real_time,theory_time);
+		return 0;
+	} else if(theory_time < real_time ){
+		if((real_time - theory_time) > (theory_time/50 ))
+		{
+			pr_info("aw_osc(real_time - theory_time) > (theory_time/50 ) not to cali\n");
+			return DFT_LRA_TRIM_CODE;
+		}
+
+		if ((real_time - theory_time) < (Not_need_cali_threshold*theory_time/10000))
+		{
+			pr_info("aw_oscmicrosecond:%ld  theory_time = %ld not need to cali\n",real_time,theory_time);
+			return DFT_LRA_TRIM_CODE;
+		}
+
+		real_code = ((real_time - theory_time)* 4000) / theory_time;
+		real_code = ((real_code%10 < 5)? 0 : 1) + real_code/10;
+		real_code = 32 + real_code;
+	} else if(theory_time > real_time){
+		if(( theory_time - real_time) > (theory_time/50 ))
+		{
+			pr_info("aw_osc(( theory_time - real_time) > (theory_time/50 ))  not to cali \n");
+			return DFT_LRA_TRIM_CODE;
+		}
+		if ((theory_time - real_time) < (Not_need_cali_threshold*theory_time/10000))
+		{
+			pr_info("aw_oscmicrosecond:%ld  theory_time = %ld not need to cali\n",real_time,theory_time);
+			return DFT_LRA_TRIM_CODE;
+		}
+		real_code = ((theory_time - real_time)* 4000) / theory_time ;
+		real_code = ((real_code%10 < 5)? 0 : 1) + real_code/10;
+		real_code = 32 - real_code;
+	}
+	if (real_code>31)
+		LRA_TRIM_CODE = real_code -32;
+	else
+		LRA_TRIM_CODE = real_code +32;
+	pr_info("aw_oscmicrosecond:%ld  theory_time = %ld real_code =0X%02X LRA_TRIM_CODE 0X%02X\n",real_time,theory_time,real_code,LRA_TRIM_CODE);
+
+	return LRA_TRIM_CODE;
+}
+
+static int aw8697_rtp_trim_lra_calibration(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    unsigned int fre_val = 0;
+    unsigned int theory_time = 0;
+    unsigned int lra_rtim_code = 0;
+
+    aw8697_i2c_read(aw8697, AW8697_REG_PWMDBG, &reg_val);
+    fre_val = (reg_val & 0x006f )>> 5;
+
+    if(fre_val == 3)
+      theory_time = (aw8697->rtp_len / 12000) * 1000000; /*12K */
+    if(fre_val == 2)
+      theory_time = (aw8697->rtp_len / 24000) * 1000000; /*24K */
+    if(fre_val == 1 || fre_val == 0)
+      theory_time = (aw8697->rtp_len / 48000) * 1000000; /*48K */
+
+    printk("microsecond:%ld  theory_time = %d\n",aw8697->microsecond,theory_time);
+
+    lra_rtim_code = aw8697_clock_OSC_trim_calibration(theory_time,aw8697->microsecond);
+    if(lra_rtim_code > 0 ) {
+        aw8697->lra_calib_data = lra_rtim_code;
+        aw8697_i2c_write(aw8697, AW8697_REG_TRIM_LRA, (char)lra_rtim_code);
+    }
+    return 0;
+}
+static unsigned char aw8697_haptic_osc_read_int(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    aw8697_i2c_read(aw8697, AW8697_REG_DBGSTAT, &reg_val);
+    return reg_val;
+}
+static int aw8697_rtp_osc_calibration(struct aw8697 *aw8697)
+{
+    const struct firmware *rtp_file;
+    int ret = -1;
+    unsigned int buf_len = 0;
+    unsigned char osc_int_state = 0;
+    aw8697->rtp_cnt = 0;
+    aw8697->timeval_flags = 1;
+    aw8697->osc_cali_flag =1;
+
+    pr_info("%s enter\n", __func__);
+    /* fw loaded */
+    ret = request_firmware(&rtp_file,
+            aw8697_rtp_name[/*aw8697->rtp_file_num*/ 0],
+            aw8697->dev);
+    if(ret < 0)
+    {
+        pr_err("%s: failed to read %s\n", __func__,
+                aw8697_rtp_name[/*aw8697->rtp_file_num*/ 0]);
+        return ret;
+    }
+    /*op add stop,for irq interrupt during calibrate*/
+    aw8697_haptic_stop(aw8697);
+    aw8697->rtp_init = 0;
+    mutex_lock(&aw8697->rtp_lock);
+    kfree(aw8697_rtp);
+    aw8697_rtp = kzalloc(rtp_file->size+sizeof(int), GFP_KERNEL);
+    if (!aw8697_rtp) {
+        release_firmware(rtp_file);
+        mutex_unlock(&aw8697->rtp_lock);
+        pr_err("%s: error allocating memory\n", __func__);
+        return -1;
+    }
+    aw8697_rtp->len = rtp_file->size;
+    aw8697->rtp_len = rtp_file->size;
+    pr_info("%s: rtp file [%s] size = %d\n", __func__,
+            aw8697_rtp_name[/*aw8697->rtp_file_num*/ 0], aw8697_rtp->len);
+    memcpy(aw8697_rtp->data, rtp_file->data, rtp_file->size);
+    release_firmware(rtp_file);
+    mutex_unlock(&aw8697->rtp_lock);
+
+    /* gain */
+    aw8697_haptic_ram_vbat_comp(aw8697, false);
+
+    /* rtp mode config */
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_RTP_MODE);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DBGCTRL,
+            AW8697_BIT_DBGCTRL_INT_MODE_MASK, AW8697_BIT_DBGCTRL_INT_MODE_EDGE);
+    disable_irq(gpio_to_irq(aw8697->irq_gpio));
+    /* haptic start */
+    aw8697_haptic_start(aw8697);
+    pm_qos_add_request(&pm_qos_req_vb, PM_QOS_CPU_DMA_LATENCY, PM_QOS_VALUE_VB);
+    while(1) {
+        if(!aw8697_haptic_rtp_get_fifo_afi(aw8697)) {
+            pr_info("%s !aw8697_haptic_rtp_get_fifo_afi done aw8697->rtp_cnt= %d \n", __func__,aw8697->rtp_cnt);
+            mutex_lock(&aw8697->rtp_lock);
+            if((aw8697_rtp->len-aw8697->rtp_cnt) < (aw8697->ram.base_addr>>2))
+                buf_len = aw8697_rtp->len-aw8697->rtp_cnt;
+            else
+                buf_len = (aw8697->ram.base_addr>>2);
+            if (aw8697->rtp_cnt != aw8697_rtp->len) {
+                if(aw8697->timeval_flags ==1) {
+                    do_gettimeofday(&aw8697->start);
+                    aw8697->timeval_flags = 0;
+                }
+                aw8697_i2c_writes(aw8697, AW8697_REG_RTP_DATA,&aw8697_rtp->data[aw8697->rtp_cnt], buf_len);
+                aw8697->rtp_cnt += buf_len;
+              }
+             mutex_unlock(&aw8697->rtp_lock);
+        }
+        osc_int_state = aw8697_haptic_osc_read_int(aw8697);
+        if(osc_int_state&AW8697_BIT_SYSINT_DONEI) {
+            do_gettimeofday(&aw8697->end);
+            pr_info("%s vincent playback done aw8697->rtp_cnt= %d \n", __func__,aw8697->rtp_cnt);
+            break;
+        }
+
+        do_gettimeofday(&aw8697->end);
+        aw8697->microsecond = (aw8697->end.tv_sec - aw8697->start.tv_sec)*1000000 +
+        (aw8697->end.tv_usec - aw8697->start.tv_usec);
+        if (aw8697->microsecond > OP_OCS_CALIBRATION_T_LENGTH) {
+            pr_info("%s vincent time out aw8697->rtp_cnt %d osc_int_state %02x\n", __func__,aw8697->rtp_cnt, osc_int_state);
+            break;
+          }
+    }
+    pm_qos_remove_request(&pm_qos_req_vb);
+    enable_irq(gpio_to_irq(aw8697->irq_gpio));
+
+    aw8697->osc_cali_flag =0;
+    aw8697->microsecond = (aw8697->end.tv_sec - aw8697->start.tv_sec)*1000000 +
+        (aw8697->end.tv_usec - aw8697->start.tv_usec);
+    /*calibration osc*/
+    pr_info("%s 2018_microsecond:%ld \n",__func__,aw8697->microsecond);
+    pr_info("%s exit\n", __func__);
+    return 0;
+}
+
+static int aw8697_haptic_osc_set_default_trim(struct aw8697 *aw8697)
+{
+    pr_info("%s enter\n", __func__);
+    aw8697_i2c_write(aw8697, AW8697_REG_TRIM_LRA,AW8697_TRIM_DEFAULT);
+    return 0;
+}
+
+static void aw8697_op_clean_status(struct aw8697 *aw8697)
+{
+	aw8697->audio_ready = false;
+	aw8697->haptic_ready = false;
+	aw8697->pre_haptic_number = false;
+	aw8697->rtp_routine_on = 0;
+	aw8697->rtp_on = 0;
+	pr_info("%s enter\n", __FUNCTION__);
+}
+
+static void aw8697_rtp_work_routine(struct work_struct *work)
+{
+    const struct firmware *rtp_file;
+    int ret = -1;
+    struct aw8697 *aw8697 = container_of(work, struct aw8697, rtp_work);
+
+    pr_info("%s enter\n", __func__);
+    aw8697->rtp_routine_on = 1;
+    /* fw loaded */
+    ret = request_firmware(&rtp_file,
+            aw8697_rtp_name[aw8697->rtp_file_num],
+            aw8697->dev);
+    if(ret < 0)
+    {
+        pr_err("%s: failed to read %s\n", __func__,
+                aw8697_rtp_name[aw8697->rtp_file_num]);
+        aw8697->rtp_routine_on = 0;
+        return ;
+    }
+    aw8697->rtp_init = 0;
+    mutex_lock(&aw8697->rtp_lock);
+    kfree(aw8697_rtp);
+    aw8697_rtp = kzalloc(rtp_file->size+sizeof(int), GFP_KERNEL);
+    if (!aw8697_rtp) {
+        release_firmware(rtp_file);
+        pr_err("%s: error allocating memory\n", __func__);
+        aw8697_op_clean_status(aw8697);
+        aw8697->rtp_routine_on = 0;
+        mutex_unlock(&aw8697->rtp_lock);
+        return;
+    }
+    aw8697_rtp->len = rtp_file->size;
+    pr_info("%s: rtp file [%s] size = %d\n", __func__,
+            aw8697_rtp_name[aw8697->rtp_file_num], aw8697_rtp->len);
+    memcpy(aw8697_rtp->data, rtp_file->data, rtp_file->size);
+    mutex_unlock(&aw8697->rtp_lock);
+    release_firmware(rtp_file);
+
+    mutex_lock(&aw8697->lock);
+    aw8697->rtp_init = 1;
+    /* gain */
+    aw8697_haptic_ram_vbat_comp(aw8697, false);
+
+    /* rtp mode config */
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_RTP_MODE);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DBGCTRL,
+            AW8697_BIT_DBGCTRL_INT_MODE_MASK, AW8697_BIT_DBGCTRL_INT_MODE_EDGE);
+    /* haptic start */
+    aw8697_haptic_start(aw8697);
+    aw8697_haptic_rtp_init(aw8697);
+    aw8697_op_clean_status(aw8697);
+    mutex_unlock(&aw8697->lock);
+    aw8697->rtp_routine_on = 0;
+}
+
+/*****************************************************
+ *
+ * haptic - audio
+ *
+ *****************************************************/
+static int aw8697_haptic_audio_uevent_report_scan(struct aw8697 *aw8697, bool flag)
+{
+	char *envp[2];
+
+	pr_info("%s: flag=%d\n", __func__, flag);
+
+	if (flag) {
+		envp[0] = "AI_SCAN=1";
+	} else {
+		envp[0] = "AI_SCAN=0";
+	}
+
+	envp[1] = NULL;
+
+	kobject_uevent_env(&aw8697->dev->kobj, KOBJ_CHANGE, envp);
+
+	return 0;
+}
+
+static int aw8697_haptic_audio_tp_list_match(struct shake_point *pt_info, struct haptic_audio_trust_zone *p_tmp)
+{
+	if ((pt_info->x+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W > p_tmp->x) &&
+		(pt_info->x < p_tmp->x+p_tmp->w+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W) &&
+		(pt_info->y+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H> p_tmp->y) &&
+		(pt_info->y < p_tmp->y+p_tmp->h+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H)) {
+		return 1;
+	} else {
+		return 0;
+	}
+}
+
+static int aw8697_haptic_audio_tz_list_show(struct haptic_audio *haptic_audio)
+{
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+	unsigned int i = 0;
+
+	list_for_each_entry(p_tmp, &haptic_audio->list, list) {
+		pr_info("%s: tz[%02d]: [%01d, %04d, %04d, %04d, %04d]\n",
+			__func__, i, p_tmp->level, p_tmp->x, p_tmp->y,
+			p_tmp->w, p_tmp->h);
+		i++;
+
+	}
+	return 0;
+}
+
+static int aw8697_haptic_audio_tz_list_insert(
+	struct haptic_audio *haptic_audio, struct trust_zone_info *tz_info)
+{
+	struct haptic_audio_trust_zone *p_new = NULL;
+
+	pr_info("%s: enter\n", __func__);
+
+	p_new = (struct haptic_audio_trust_zone *)kzalloc(
+		sizeof(struct haptic_audio_trust_zone), GFP_KERNEL);
+	if (p_new == NULL ) {
+		pr_err("%s: kzalloc memory fail\n", __func__);
+		return -1;
+	}
+
+	/* update new list info */
+	p_new->level = tz_info->level;
+	p_new->cnt = haptic_audio->tz_cnt_thr * 2;
+	p_new->x = tz_info->x;
+	p_new->y = tz_info->y;
+	p_new->w = tz_info->w;
+	p_new->h = tz_info->h;
+
+	INIT_LIST_HEAD(&(p_new->list));
+	list_add(&(p_new->list), &(haptic_audio->list));
+
+	return 0;
+}
+
+static int aw8697_haptic_audio_tz_list_clear(struct haptic_audio *haptic_audio)
+{
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+	struct haptic_audio_trust_zone *p_tmp_bak = NULL;
+
+	list_for_each_entry_safe(p_tmp, p_tmp_bak, &(haptic_audio->list), list) {
+		list_del(&p_tmp->list);
+		kfree(p_tmp);
+	}
+
+	return 0;
+}
+
+/*
+static int aw8697_haptic_audio_ctr_list_show(struct haptic_audio *haptic_audio)
+{
+	struct haptic_ctr *p_tmp = NULL;
+	unsigned int i = 0;
+
+	list_for_each_entry(p_tmp, &haptic_audio->ctr_list, list) {
+		pr_info("%s: ctr[%02d]: [%03d, %03d, %03d, %03d, %03d]\n",
+			__func__, i, p_tmp->cmd, p_tmp->play,
+			p_tmp->wavseq, p_tmp->loop, p_tmp->gain);
+		i++;
+
+	}
+	return 0;
+}
+*/
+
+static int aw8697_haptic_audio_ctr_list_insert(
+	struct haptic_audio *haptic_audio, struct haptic_ctr *haptic_ctr)
+{
+	struct haptic_ctr *p_new = NULL;
+
+	p_new = (struct haptic_ctr *)kzalloc(
+		sizeof(struct haptic_ctr), GFP_KERNEL);
+	if (p_new == NULL ) {
+		pr_err("%s: kzalloc memory fail\n", __func__);
+		return -1;
+	}
+	/* update new list info */
+	p_new->cnt = haptic_ctr->cnt;
+	p_new->cmd = haptic_ctr->cmd;
+	p_new->play = haptic_ctr->play;
+	p_new->wavseq = haptic_ctr->wavseq;
+	p_new->loop = haptic_ctr->loop;
+	p_new->gain = haptic_ctr->gain;
+
+	INIT_LIST_HEAD(&(p_new->list));
+	list_add(&(p_new->list), &(haptic_audio->ctr_list));
+
+	return 0;
+}
+
+
+static int aw8697_haptic_audio_ctr_list_clear(struct haptic_audio *haptic_audio)
+{
+	struct haptic_ctr *p_ctr = NULL;
+	struct haptic_ctr *p_ctr_bak = NULL;
+
+	list_for_each_entry_safe_reverse(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+		list_del(&p_ctr->list);
+		kfree(p_ctr);
+	}
+
+	return 0;
+}
+
+static int aw8697_fb_notifier_callback_tp(struct notifier_block *self, unsigned long event, void *data)
+{
+	struct aw8697 *aw8697 = container_of(self, struct aw8697, fb_notif);
+	struct tp *tp = &(aw8697->haptic_audio.tp);
+	int i = 0;
+	int *blank;
+	struct fb_event *evdata = data;
+	struct haptic_audio *haptic_audio = NULL;
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+
+	haptic_audio = &(aw8697->haptic_audio);
+
+	blank = evdata->data;
+	pr_debug("%s: tp event = %ld, blank = %d\n", __func__, event, *blank);
+	i= *blank;
+#if 0
+	if (event == 11) {
+		pr_debug("%s: tp down\n", __func__);
+			pr_debug("%s: tp record_point_down[%d].status = %d\n", __func__, i, record_point[i].status);
+			if((AW8697_HAPTIC_TP_ST_PRESS == record_point[i].status) &&
+				(record_point[i].status != tp->id[i].pt_info.status)) {
+				tp->id[i].pt_info.status = record_point[i].status;
+				tp->id[i].tp_flag = AW8697_HAPTIC_TP_PRESS;
+				tp->id[i].press_flag = AW8697_HAPTIC_TP_PRESS;
+				tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+				tp->id[i].no_play_cnt = 0;
+				do_gettimeofday(&tp->id[i].t_press);
+				pr_info("%s: tp_press_release: status=%d, flag=%d", __func__, tp->id[i].pt_info.status, tp->id[i].tp_flag);
+			}
+	}
+	if (event == 10) {
+		pr_debug("%s: tp up\n", __func__);
+			pr_debug("%s: tp record_point_up[%d].status = %d\n", __func__, i, record_point[i].status);
+			if((AW8697_HAPTIC_TP_ST_RELEASE == record_point[i].status) &&
+				(record_point[i].status != tp->id[i].pt_info.status)) {
+				tp->id[i].pt_info.status = record_point[i].status;
+				tp->id[i].tp_flag = AW8697_HAPTIC_TP_RELEASE;
+				tp->id[i].release_flag = AW8697_HAPTIC_TP_RELEASE;
+				do_gettimeofday(&tp->id[i].t_release);
+				pr_info("%s: tp_press_release: status=%d, flag=%d", __func__, tp->id[i].pt_info.status, tp->id[i].tp_flag);
+			}
+	}
+#endif
+	if (event == 0) {
+		list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+			if ((tp->id[i].pt_info.x+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W > p_tmp->x) &&
+				(tp->id[i].pt_info.x < p_tmp->x+p_tmp->w+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W) &&
+				(tp->id[i].pt_info.y+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H > p_tmp->y) &&
+				(tp->id[i].pt_info.y < p_tmp->y+p_tmp->h+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H)) {
+				pr_debug("%s: tp input point[%d, %04d, %04d] up is in the ai trust zone[%d, %04d, %04d, %04d, %04d]\n",
+					__func__, tp->id[i].pt_info.id, tp->id[i].pt_info.x, tp->id[i].pt_info.y,
+					p_tmp->level, p_tmp->x, p_tmp->y, p_tmp->w, p_tmp->h);
+				if(tp->virtual_id == i) {
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.id = tp->id[i].pt_info.id;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.x = tp->id[i].pt_info.x;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.y = tp->id[i].pt_info.y;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.status = AW8697_HAPTIC_TP_ST_RELEASE;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].tp_flag = AW8697_HAPTIC_TP_RELEASE;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].release_flag = AW8697_HAPTIC_TP_RELEASE;
+					do_gettimeofday(&tp->id[AW8697_HAPTIC_TP_ID_MAX].t_release);
+				}
+				break;
+			}
+		}
+		tp->id[i].pt_info.status = AW8697_HAPTIC_TP_ST_RELEASE;
+		tp->id[i].tp_flag = AW8697_HAPTIC_TP_RELEASE;
+		tp->id[i].release_flag = AW8697_HAPTIC_TP_RELEASE;
+		do_gettimeofday(&tp->id[i].t_release);
+
+		pr_debug("%s: tp input point[%d, %04d, %04d] up to [%d, %04d, %04d] \n",
+			__func__, i, tp->id[i].pt_info.x, tp->id[i].pt_info.y,
+			i, tp->id[i].pt_info.x, tp->id[i].pt_info.y);
+	}
+
+	return 0;
+}
+
+#ifdef OP_AW_DEBUG
+static int aw8697_haptic_audio_init(struct aw8697 *aw8697)
+{
+	unsigned int i = 0;
+
+	pr_debug("%s enter\n", __func__);
+
+	aw8697_haptic_set_wav_seq(aw8697, 0x01, 0x00);
+
+	for (i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+		//aw8697->haptic_audio.tp.id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+		//aw8697->haptic_audio.tp.id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+		//aw8697->haptic_audio.tp.id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+		//aw8697->haptic_audio.tp.id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+		aw8697->haptic_audio.tp.id[i].tp_ai_match_flag = 1;
+		aw8697->haptic_audio.tp.id[i].no_play_cnt = 0;
+	}
+	//aw8697->haptic_audio.tp.play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+	//aw8697->haptic_audio.tp.press_flag = AW8697_HAPTIC_TP_NULL;
+	//aw8697->haptic_audio.tp.tp_ai_match_flag = 0;
+	//aw8697->haptic_audio.tp.tp_ai_check_flag = 0;
+	aw8697->haptic_audio.tp.hap_match_without_tz_cnt = 0;
+	aw8697->haptic_audio.uevent_report_flag = 0;
+	aw8697->haptic_audio.hap_cnt_outside_tz = 0;
+	return 0;
+}
+
+static int aw8697_haptic_audio_off(struct aw8697 *aw8697)
+{
+	pr_debug("%s enter\n", __func__);
+
+	mutex_lock(&aw8697->lock);
+	aw8697_haptic_set_gain(aw8697, 0x80);
+	aw8697_haptic_stop(aw8697);
+	aw8697_haptic_audio_ctr_list_clear(&aw8697->haptic_audio);
+	mutex_unlock(&aw8697->lock);
+
+	return 0;
+}
+
+static int aw8697_haptic_audio_stop(struct aw8697 *aw8697)
+{
+    pr_debug("%s enter\n", __func__);
+#ifdef OP_AW_DEBUG
+		do_gettimeofday(&aw8697->t_stop);
+#endif
+
+    aw8697_haptic_play_go(aw8697, false);
+    aw8697_haptic_stop_delay(aw8697);
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_STANDBY_MODE);
+
+    return 0;
+}
+
+
+
+static int aw8697_haptic_audio_play_cfg(struct aw8697 *aw8697)
+{
+	pr_debug("%s enter\n", __func__);
+
+	aw8697->play_mode = AW8697_HAPTIC_RAM_MODE;
+	aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+			AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RAM);
+
+	aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+			AW8697_BIT_SYSINTM_UVLO_MASK, AW8697_BIT_SYSINTM_UVLO_OFF);
+
+	aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+			AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_WORK_MODE_MASK, AW8697_BIT_SYSCTRL_ACTIVE);
+	aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+			AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BOOST);
+
+	return 0;
+}
+#endif
+static enum hrtimer_restart aw8697_haptic_audio_timer_func(struct hrtimer *timer)
+{
+    struct aw8697 *aw8697 = container_of(timer, struct aw8697, haptic_audio.timer);
+
+    pr_debug("%s enter\n", __func__);
+    schedule_work(&aw8697->haptic_audio.work);
+
+    hrtimer_start(&aw8697->haptic_audio.timer,
+            ktime_set(aw8697->haptic_audio.timer_val/1000000,
+                    (aw8697->haptic_audio.timer_val%1000000)*1000),
+            HRTIMER_MODE_REL);
+    return HRTIMER_NORESTART;
+}
+
+static void aw8697_haptic_audio_work_routine(struct work_struct *work)
+{
+	struct aw8697 *aw8697 = container_of(work, struct aw8697, haptic_audio.work);
+	struct tp *tp = &(aw8697->haptic_audio.tp);
+	struct haptic_audio *haptic_audio = NULL;
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+	struct haptic_ctr *p_ctr = NULL;
+	struct haptic_ctr *p_ctr_bak = NULL;
+	struct timeval tmp_time;
+	unsigned int press_delay = 0;
+	unsigned int release_delay = 0;
+	unsigned int tp_touch_play_flag = 0;
+	unsigned int i = 0;
+	unsigned int touch_vibrator_id = 0;
+	unsigned int touch_vibrator_id_flag = 0;
+	unsigned int touch_vibrator_flag = 0;
+	unsigned int tz_num = 0;
+	unsigned int tz_high_num = 0;
+	unsigned int uevent_report_flag = 0;
+	unsigned int ctr_list_flag = 0;
+	unsigned int ctr_list_input_cnt = 0;
+	unsigned int ctr_list_output_cnt = 0;
+	unsigned int ctr_list_diff_cnt = 0;
+	unsigned int ctr_list_del_cnt = 0;
+	unsigned int tp_ai_match_id = 0;
+
+	/*OP add for juge rtp on begin*/
+	int rtp_is_going_on = 0;
+
+	pr_debug("%s enter\n", __func__);
+	/*OP add for juge rtp on end*/
+
+	haptic_audio = &(aw8697->haptic_audio);
+
+	mutex_lock(&aw8697->haptic_audio.lock);
+	memset(&aw8697->haptic_audio.ctr, 0,
+		sizeof(struct haptic_ctr));
+	ctr_list_flag = 0;
+	list_for_each_entry_safe_reverse(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+		ctr_list_flag = 1;
+		break;
+	}
+	if(ctr_list_flag == 0) {
+		pr_info("%s: ctr list empty\n", __func__);
+	}
+	if(ctr_list_flag == 1) {
+		list_for_each_entry_safe(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+			ctr_list_input_cnt =  p_ctr->cnt;
+			break;
+		}
+		list_for_each_entry_safe_reverse(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+			ctr_list_output_cnt =  p_ctr->cnt;
+			break;
+		}
+		if(ctr_list_input_cnt > ctr_list_output_cnt) {
+			ctr_list_diff_cnt = ctr_list_input_cnt - ctr_list_output_cnt;
+		}
+		if(ctr_list_input_cnt < ctr_list_output_cnt) {
+			ctr_list_diff_cnt = 32 + ctr_list_input_cnt - ctr_list_output_cnt;
+		}
+		if(ctr_list_diff_cnt > 2) {
+			list_for_each_entry_safe_reverse(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+				if((p_ctr->play == 0) &&
+					(AW8697_HAPTIC_CMD_ENABLE == (AW8697_HAPTIC_CMD_HAPTIC & p_ctr->cmd))) {
+					list_del(&p_ctr->list);
+					kfree(p_ctr);
+					ctr_list_del_cnt ++;
+				}
+				if(ctr_list_del_cnt == ctr_list_diff_cnt) {
+					break;
+				}
+			}
+		}
+
+	}
+
+	/* get the last data from list */
+	list_for_each_entry_safe_reverse(p_ctr, p_ctr_bak, &(haptic_audio->ctr_list), list) {
+		aw8697->haptic_audio.ctr.cnt = p_ctr->cnt;
+		aw8697->haptic_audio.ctr.cmd = p_ctr->cmd;
+		aw8697->haptic_audio.ctr.play = p_ctr->play;
+		aw8697->haptic_audio.ctr.wavseq = p_ctr->wavseq;
+		aw8697->haptic_audio.ctr.loop = p_ctr->loop;
+		aw8697->haptic_audio.ctr.gain = p_ctr->gain;
+		list_del(&p_ctr->list);
+		kfree(p_ctr);
+		break;
+	}
+	if(aw8697->haptic_audio.ctr.play) {
+		pr_debug("%s: cnt=%d, cmd=%d, play=%d, wavseq=%d, loop=%d, gain=%d\n",
+			__func__,
+			aw8697->haptic_audio.ctr.cnt,
+			aw8697->haptic_audio.ctr.cmd,
+			aw8697->haptic_audio.ctr.play,
+			aw8697->haptic_audio.ctr.wavseq,
+			aw8697->haptic_audio.ctr.loop,
+			aw8697->haptic_audio.ctr.gain);
+	}
+
+	/* rtp mode jump */
+	rtp_is_going_on = aw8697_haptic_juge_RTP_is_going_on(aw8697);
+	if (rtp_is_going_on) {
+		mutex_unlock(&aw8697->haptic_audio.lock);
+		return;
+	}
+	/* haptic play with tp adjust info */
+	if(AW8697_HAPTIC_CMD_TP ==
+		(aw8697->haptic_audio.ctr.cmd & AW8697_HAPTIC_CMD_SYS)) {
+		do_gettimeofday(&tmp_time);
+		for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+			/* get tp press delay and tp release delay */
+			press_delay = 0;
+			release_delay = 0;
+			if(AW8697_HAPTIC_TP_PRESS == tp->id[i].press_flag) {
+				press_delay = (tmp_time.tv_sec-tp->id[i].t_press.tv_sec)*1000000 +
+					(tmp_time.tv_usec-tp->id[i].t_press.tv_usec);
+			}
+			if(AW8697_HAPTIC_TP_RELEASE == tp->id[i].release_flag) {
+				release_delay = (tmp_time.tv_sec-tp->id[i].t_release.tv_sec)*1000000 +
+					(tmp_time.tv_usec-tp->id[i].t_release.tv_usec);
+			}
+			if(tp->id[i].press_flag || tp->id[i].release_flag) {
+				pr_debug("%s: id[%d]: press_flag=%d, press_delay=%dus, release_flag=%d, release_delaly=%dus\n",
+					__func__, i, tp->id[i].press_flag, press_delay, tp->id[i].release_flag, release_delay);
+			}
+
+			/* tp touch in ai trust zone press delay over max, reduce trust zone cnt*/
+			if(AW8697_HAPTIC_TP_PRESS == tp->id[i].press_flag) {
+				if(AW8697_HAPTIC_TP_PLAY_NULL == tp->id[i].play_flag) {
+					if(press_delay > tp->press_delay_max) {
+						/* tp touch in ai trust zone */
+						/* no play time > tp-play delay max time */
+						if (tp->id[i].pt_info.touch_flag == AW8697_HAPTIC_TP_TOUCH_VAIL) {
+							list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+								if (aw8697_haptic_audio_tp_list_match(&(tp->id[i].pt_info), p_tmp)) {
+									pr_debug("%s: tp [%d %04d, %04d] touch time over max time,  in the ai trust zone[%d, %04d, %04d, %04d, %04d]\n",
+										__func__, i, tp->id[i].pt_info.x, tp->id[i].pt_info.y,
+										p_tmp->level, p_tmp->x, p_tmp->y, p_tmp->w, p_tmp->h);
+									if (p_tmp->cnt) {
+										p_tmp->cnt --;
+									}
+									if (p_tmp->cnt > aw8697->haptic_audio.tz_cnt_thr) {
+										p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_HIGH;
+									} else {
+										p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_LOW;
+									}
+									pr_debug("%s: ai trust zone[%d, %04d, %04d, %04d, %04d] cnt=%d, touch no match vibrator\n",
+										__func__, p_tmp->level, p_tmp->x, p_tmp->y,
+										p_tmp->w, p_tmp->h, p_tmp->cnt);
+									tp->id[i].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+								}
+							}
+						}
+					} else {
+						if(press_delay > tp->press_delay_min) {
+							/* tp-play delay min time < no play time < tp-play delay max time */
+						} else {
+							/* no play time < tp-play delay min time */
+						}
+					}
+				} else if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+				}
+			}
+
+			/* adjust tp play with tp press delay and tp release delay */
+			if(AW8697_HAPTIC_PLAY_ENABLE == aw8697->haptic_audio.ctr.play) {
+				if(AW8697_HAPTIC_TP_PRESS == tp->id[i].press_flag) {
+					if(AW8697_HAPTIC_TP_PLAY_NULL == tp->id[i].play_flag) {
+						if(press_delay > tp->press_delay_max) {
+							/* no play time > tp-play delay max time */
+							tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NOMORE;
+							tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+							tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+							if(i == AW8697_HAPTIC_TP_ID_MAX) {
+								tp->id[i].pt_info.status = AW8697_HAPTIC_TP_ST_RELEASE;
+								tp->id[i].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+								tp->id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].no_play_cnt = 0;
+								//tp->id[i].press_no_vibrate_flag = 0;
+							}
+							if(tp->id[i].press_no_vibrate_flag == 0)
+								tp->id[i].press_no_vibrate_flag = 2;
+						} else {
+							if(press_delay > tp->press_delay_min) {
+								/* tp-play delay min time < no play time < tp-play delay max time */
+								tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_ENABLE;
+								tp->id[i].press_no_vibrate_flag = 1;
+							} else {
+								/* no play time < tp-play delay min time */
+								tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NOMORE;
+								if(tp->id[i].press_no_vibrate_flag == 0)
+									tp->id[i].press_no_vibrate_flag = 2;
+							}
+						}
+					} else if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+					}
+					pr_debug("%s: %d: id[%d]:play_flag=%d, press_flag=%d, release_flag=%d, press_no_vibrate_flag=%d, no_play_cnt=%d\n",
+						__func__, __LINE__, i, tp->id[i].play_flag, tp->id[i].press_flag, tp->id[i].release_flag,
+						tp->id[i].press_no_vibrate_flag, tp->id[i].no_play_cnt);
+				}
+				if(AW8697_HAPTIC_TP_RELEASE == tp->id[i].release_flag) {
+					if(release_delay > tp->release_delay_max) {
+						/* tp release time > 3-continue-time play time*/
+						if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+							tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NOMORE;
+							tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+							tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+							if(i == AW8697_HAPTIC_TP_ID_MAX) {
+								tp->id[i].pt_info.status = AW8697_HAPTIC_TP_ST_RELEASE;
+								tp->id[i].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+								tp->id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].no_play_cnt = 0;
+								//tp->id[i].press_no_vibrate_flag = 0;
+							}
+							if(tp->id[i].press_no_vibrate_flag == 0)
+								tp->id[i].press_no_vibrate_flag = 2;
+						} else {
+						}
+					}
+					pr_debug("%s: %d: id[%d]:play_flag=%d, press_flag=%d, release_flag=%d, press_no_vibrate_flag=%d, no_play_cnt=%d\n",
+						__func__, __LINE__, i, tp->id[i].play_flag, tp->id[i].press_flag, tp->id[i].release_flag,
+						tp->id[i].press_no_vibrate_flag, tp->id[i].no_play_cnt);
+				}
+				tp->id[i].no_play_cnt = 0;
+			} else if(AW8697_HAPTIC_PLAY_NULL == aw8697->haptic_audio.ctr.play) {
+				if(AW8697_HAPTIC_TP_PRESS == tp->id[i].press_flag) {
+					if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+						tp->id[i].no_play_cnt ++;
+						if(tp->id[i].no_play_cnt > tp->no_play_cnt_max) {
+							/* no play cnt > play interal time */
+							tp->id[i].no_play_cnt = tp->no_play_cnt_max;
+							tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+							tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+							tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+							if(i == AW8697_HAPTIC_TP_ID_MAX) {
+								tp->id[i].pt_info.status = AW8697_HAPTIC_TP_ST_RELEASE;
+								tp->id[i].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+								tp->id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+								tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+								//tp->id[i].press_no_vibrate_flag = 0;
+							}
+							if(tp->id[i].press_no_vibrate_flag == 0)
+								tp->id[i].press_no_vibrate_flag = 2;
+						} else {
+						}
+					} else {
+						tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+					}
+					pr_debug("%s: %d: id[%d]:play_flag=%d, press_flag=%d, release_flag=%d, press_no_vibrate_flag=%d, no_play_cnt=%d\n",
+						__func__, __LINE__, i, tp->id[i].play_flag, tp->id[i].press_flag, tp->id[i].release_flag,
+						tp->id[i].press_no_vibrate_flag, tp->id[i].no_play_cnt);
+				}
+				if(AW8697_HAPTIC_TP_RELEASE == tp->id[i].release_flag) {
+					/* tp release time > 3-continue-time play time*/
+					if(release_delay > tp->release_delay_max) {
+						tp->id[i].play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+						tp->id[i].press_flag = AW8697_HAPTIC_TP_NULL;
+						tp->id[i].release_flag = AW8697_HAPTIC_TP_NULL;
+						tp->id[i].tp_ai_match_flag = 1;
+						if(tp->id[i].press_no_vibrate_flag == 0)
+							tp->id[i].press_no_vibrate_flag = 2;
+						tp->tp_ai_check_flag = 0;
+					} else {
+					}
+					pr_debug("%s: %d: id[%d]:play_flag=%d, press_flag=%d, release_flag=%d, press_no_vibrate_flag=%d, no_play_cnt=%d\n",
+						__func__, __LINE__, i, tp->id[i].play_flag, tp->id[i].press_flag, tp->id[i].release_flag,
+						tp->id[i].press_no_vibrate_flag, tp->id[i].no_play_cnt);
+				}
+			} else {
+			}
+		}
+
+		/* get tz high num */
+		tz_high_num = 0;
+		tz_num = 0;
+		list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+			tz_num ++;
+			if(p_tmp->level == AW8697_HAPTIC_TZ_LEVEL_HIGH) {
+				tz_high_num ++;
+			}
+		}
+
+		/* adjust tp play enable */
+		tp->play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+		for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+			if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+				tp_touch_play_flag = AW8697_HAPTIC_TP_PLAY_ENABLE;
+				list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+					if (aw8697_haptic_audio_tp_list_match(&(tp->id[i].pt_info), p_tmp)) {
+						tp->play_flag = AW8697_HAPTIC_TP_PLAY_ENABLE;
+						touch_vibrator_id = i;
+						pr_debug("%s: tp input point[%d, %04d, %04d] is in the ai trust zone[%d, %04d, %04d, %04d, %04d]\n",
+							__func__, i, tp->id[i].pt_info.x, tp->id[i].pt_info.y,
+							p_tmp->level, p_tmp->x, p_tmp->y, p_tmp->w, p_tmp->h);
+						break;
+					}
+				}
+			}
+			if(tp->play_flag == AW8697_HAPTIC_TP_PLAY_ENABLE) {
+				break;
+			}
+		}
+		if(tp->play_flag) {
+			pr_debug("%s: tp.play_flag with tp =%d, touch_vibrator_id=%d\n", __func__, tp->play_flag, touch_vibrator_id);
+		}
+
+		/* haptic no match with all tp and tz, find a touch vail point, or used 0 */
+		if(AW8697_HAPTIC_TP_PLAY_NULL == tp->play_flag) {
+			for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+				if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->id[i].play_flag) {
+					if (tz_high_num == 1) {
+						list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+							if(p_tmp->x < aw8697->haptic_audio.tp_size.x/2) {
+								if(tp->id[i].pt_info.x > aw8697->haptic_audio.tp_size.x/2) {
+									touch_vibrator_id = i;
+									touch_vibrator_id_flag = 1;
+									break;
+								} else {
+								}
+							} else {
+								if(tp->id[i].pt_info.x < aw8697->haptic_audio.tp_size.x/2) {
+									touch_vibrator_id = i;
+									touch_vibrator_id_flag = 1;
+									break;
+								} else {
+								}
+							}
+						}
+					} else {
+						touch_vibrator_id = i;
+						touch_vibrator_id_flag = 1;
+					}
+				}
+				if(touch_vibrator_flag == 1) {
+					break;
+				}
+			}
+			pr_debug("%s: tp.play_flag with tp =%d, touch_vibrator_id=%d\n", __func__, tp->play_flag, touch_vibrator_id);
+		}
+
+		/* ai tz match with tp touch */
+		if (AW8697_HAPTIC_TP_PLAY_ENABLE == tp->play_flag) {
+			if (tp->id[touch_vibrator_id].pt_info.touch_flag == AW8697_HAPTIC_TP_TOUCH_VAIL) {
+				list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+					if (aw8697_haptic_audio_tp_list_match(&(tp->id[touch_vibrator_id].pt_info), p_tmp)) {
+						if (p_tmp->cnt < aw8697->haptic_audio.tz_cnt_max) {
+							p_tmp->cnt ++;
+						} else {
+							p_tmp->cnt = aw8697->haptic_audio.tz_cnt_max;
+						}
+						if (p_tmp->cnt > aw8697->haptic_audio.tz_cnt_thr) {
+							p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_HIGH;
+						} else {
+							p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_LOW;
+						}
+						pr_debug("%s: ai trust zone[%d, %04d, %04d, %04d, %04d] cnt=%d, touch match vibrator\n",
+							__func__, p_tmp->level, p_tmp->x, p_tmp->y,
+							p_tmp->w, p_tmp->h, p_tmp->cnt);
+					}
+				}
+				tp->id[touch_vibrator_id].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+			}
+		}
+
+		if(AW8697_HAPTIC_TP_PLAY_NULL == tp->play_flag) {
+			if (tp->id[touch_vibrator_id].press_no_vibrate_flag == 2) {
+				if (tp->id[touch_vibrator_id].pt_info.touch_flag == AW8697_HAPTIC_TP_TOUCH_VAIL) {
+					list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+						if (aw8697_haptic_audio_tp_list_match(&(tp->id[touch_vibrator_id].pt_info), p_tmp)) {
+							if (p_tmp->cnt) {
+								p_tmp->cnt --;
+							}
+							if (p_tmp->cnt > aw8697->haptic_audio.tz_cnt_thr) {
+								p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_HIGH;
+							} else {
+								p_tmp->level = AW8697_HAPTIC_TZ_LEVEL_LOW;
+							}
+							pr_info("%s: ai trust zone[%d, %04d, %04d, %04d, %04d] cnt=%d, touch no match vibrator\n",
+								__func__, p_tmp->level, p_tmp->x, p_tmp->y,
+								p_tmp->w, p_tmp->h, p_tmp->cnt);
+						}
+					}
+					tp->id[touch_vibrator_id].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_INVAIL;
+				}
+			}
+		}
+
+		/* start/stop ai scan */
+		uevent_report_flag = haptic_audio->uevent_report_flag;
+		if (haptic_audio->tz_high_num != tz_high_num) {
+			pr_debug("%s: haptic_audio->tz_high_num =%d, tz_high_num =%d\n", __func__, haptic_audio->tz_high_num, tz_high_num);
+			if(tz_high_num == 2) {
+				uevent_report_flag = 0;
+			} else {
+				uevent_report_flag = 1;
+			}
+			haptic_audio->tz_high_num = tz_high_num;
+		}
+
+		/* haptic play cnt outside trust zone over limit, restart ai scan */
+		tp->tp_ai_match_flag = 1;
+		for(i=0; i<AW8697_HAPTIC_TP_ID_MAX; i++) {
+			pr_debug("%s: [%d] tp_ai_match_flag=%d\n", __func__, i, tp->id[i].tp_ai_match_flag);
+			if(tp->id[i].tp_ai_match_flag == 0) {
+				tp->tp_ai_match_flag = 0;
+				tp_ai_match_id = i;
+				break;
+			}
+
+		}
+		pr_debug("%s: tp_ai_match_flag=%d, tp_ai_check_flag=%d, tz_high_num=%d, tp_touch_play_flag=%d, tp->last_play_flag=%d, hap_cnt_outside_tz=%d\n",
+                       __func__, tp->tp_ai_match_flag, tp->tp_ai_check_flag,
+                       haptic_audio->tz_high_num, tp_touch_play_flag, tp->last_play_flag, haptic_audio->hap_cnt_outside_tz);
+
+		/* restart ai scan when tz_high_num=2 */
+		if ((haptic_audio->tz_high_num == 2) &&
+			(tp->tp_ai_match_flag == 0) &&
+			(tp->tp_ai_check_flag == 1)) {
+			if ((AW8697_HAPTIC_TP_PLAY_ENABLE == tp_touch_play_flag) &&
+				(AW8697_HAPTIC_TP_PLAY_NULL == tp->last_play_flag)) {
+				haptic_audio->hap_cnt_outside_tz ++;
+				if (haptic_audio->hap_cnt_outside_tz >= haptic_audio->hap_cnt_max_outside_tz) {
+					uevent_report_flag = 1;
+					if(haptic_audio->uevent_report_flag != uevent_report_flag) {
+						pr_info("%s: haptic play cnt outside trust zone over limit, restart ai scan\n", __func__);
+					}
+					haptic_audio->hap_cnt_outside_tz = haptic_audio->hap_cnt_max_outside_tz;
+				}
+				tp->tp_ai_check_flag = 0;
+				tp->id[tp_ai_match_id].tp_ai_match_flag = 1;
+			} else {
+				if (tp->id[touch_vibrator_id].press_no_vibrate_flag == 2) {
+					if (haptic_audio->hap_cnt_outside_tz) {
+						haptic_audio->hap_cnt_outside_tz --;
+					}
+					tp->tp_ai_check_flag = 0;
+				}
+			}
+		}
+
+		/* ai scan uevent report */
+		if(haptic_audio->uevent_report_flag != uevent_report_flag) {
+			if (uevent_report_flag == 1) {
+				aw8697_haptic_audio_uevent_report_scan(aw8697, true);
+			} else {
+				aw8697_haptic_audio_uevent_report_scan(aw8697, false);
+			}
+			haptic_audio->uevent_report_flag = uevent_report_flag;
+		}
+
+		/* haptic play with tz num */
+		if (AW8697_HAPTIC_TP_PLAY_ENABLE == tp_touch_play_flag) {
+			touch_vibrator_flag = 0;
+			if (tz_num == 0) {
+				touch_vibrator_flag = 1;
+			} else if (tz_num == 1) {
+				list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+					if(p_tmp->x < aw8697->haptic_audio.tp_size.x/2) {
+						if(tp->id[touch_vibrator_id].pt_info.x < aw8697->haptic_audio.tp_size.x/2) {
+							if (aw8697_haptic_audio_tp_list_match(&(tp->id[touch_vibrator_id].pt_info), p_tmp)) {
+								if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->play_flag) {
+									touch_vibrator_flag = 3;
+									break;
+								}
+							} else {
+							}
+						} else {
+							touch_vibrator_flag = 4;
+							break;
+						}
+					} else {
+						if(tp->id[touch_vibrator_id].pt_info.x > aw8697->haptic_audio.tp_size.x/2) {
+							if (aw8697_haptic_audio_tp_list_match(&(tp->id[touch_vibrator_id].pt_info), p_tmp)) {
+								if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->play_flag) {
+									touch_vibrator_flag = 5;
+									break;
+								}
+							} else {
+							}
+						} else {
+							touch_vibrator_flag = 6;
+							break;
+						}
+					}
+				}
+			} else if (tz_num == 2) {
+				list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+					if (aw8697_haptic_audio_tp_list_match(&(tp->id[touch_vibrator_id].pt_info), p_tmp)) {
+						if(AW8697_HAPTIC_TP_PLAY_ENABLE == tp->play_flag) {
+							touch_vibrator_flag = 7;
+							break;
+						}
+						break;
+					} else {
+					}
+				}
+			} else {
+				touch_vibrator_flag = 8;
+			}
+			if(touch_vibrator_flag) {
+				tp->play_flag = AW8697_HAPTIC_TP_PLAY_ENABLE;
+			} else {
+				tp->play_flag = AW8697_HAPTIC_TP_PLAY_NULL;
+			}
+			pr_debug("%s: tz_num=%d, touch_vibrator_flag=%d\n", __func__, tz_num, touch_vibrator_flag);
+		}
+
+		if(tp->play_flag) {
+			pr_debug("%s: tp.play_flag with ai tz =%d\n", __func__, tp->play_flag);
+		}
+
+		if(AW8697_HAPTIC_PLAY_ENABLE == aw8697->haptic_audio.ctr.play) {
+			tp->last_play_flag = tp->play_flag;
+		}
+		/* clear all id tp flag */
+		for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+			tp->id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+		}
+	} else {
+		for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+			tp->id[i].tp_flag = AW8697_HAPTIC_TP_NULL;
+		}
+	}
+	mutex_unlock(&aw8697->haptic_audio.lock);
+
+	/* aw8697 haptic play control */
+	if(AW8697_HAPTIC_CMD_ENABLE ==
+		(AW8697_HAPTIC_CMD_HAPTIC & aw8697->haptic_audio.ctr.cmd)) {
+		if(AW8697_HAPTIC_PLAY_ENABLE == aw8697->haptic_audio.ctr.play) {
+			pr_info("%s: haptic_audio_play_start\n", __func__);
+			if(AW8697_HAPTIC_CMD_TP == (AW8697_HAPTIC_CMD_SYS & aw8697->haptic_audio.ctr.cmd) &&
+				(AW8697_HAPTIC_TP_PLAY_ENABLE != tp->play_flag)) {
+				pr_info("%s: cancel haptic with tp event\n", __func__);
+			} else {
+				pr_info("%s: normal haptic with tp event\n", __func__);
+				mutex_lock(&aw8697->lock);
+				aw8697_haptic_audio_stop(aw8697);
+				aw8697_haptic_audio_play_cfg(aw8697);
+
+				aw8697_haptic_set_wav_seq(aw8697, 0x00,
+						aw8697->haptic_audio.ctr.wavseq);
+
+				aw8697_haptic_set_wav_loop(aw8697, 0x00,
+						aw8697->haptic_audio.ctr.loop);
+
+				aw8697_haptic_set_gain(aw8697,
+						aw8697->haptic_audio.ctr.gain);
+
+				aw8697_haptic_start(aw8697);
+				mutex_unlock(&aw8697->lock);
+			}
+		} else if(AW8697_HAPTIC_PLAY_STOP == aw8697->haptic_audio.ctr.play) {
+			mutex_lock(&aw8697->lock);
+			aw8697_haptic_audio_stop(aw8697);
+			mutex_unlock(&aw8697->lock);
+		} else if(AW8697_HAPTIC_PLAY_GAIN == aw8697->haptic_audio.ctr.play) {
+			mutex_lock(&aw8697->lock);
+			aw8697_haptic_set_gain(aw8697,
+				aw8697->haptic_audio.ctr.gain);
+			mutex_unlock(&aw8697->lock);
+		}
+	}
+}
+
+
+/*****************************************************
+ *
+ * haptic cont
+ *
+ *****************************************************/
+static int aw8697_haptic_cont(struct aw8697 *aw8697)
+{
+    pr_info("%s enter\n", __func__);
+
+    /* work mode */
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_CONT_MODE);
+    /* preset f0 */
+    aw8697->f0_pre = aw8697->f0;
+    aw8697_haptic_set_f0_preset(aw8697);
+    /* lpf */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DATCTRL,
+            AW8697_BIT_DATCTRL_FC_MASK, AW8697_BIT_DATCTRL_FC_1000HZ);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DATCTRL,
+            AW8697_BIT_DATCTRL_LPF_ENABLE_MASK, AW8697_BIT_DATCTRL_LPF_ENABLE);
+    /* cont config */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_ZC_DETEC_MASK, AW8697_BIT_CONT_CTRL_ZC_DETEC_ENABLE);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_WAIT_PERIOD_MASK, AW8697_BIT_CONT_CTRL_WAIT_1PERIOD);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_MODE_MASK, AW8697_BIT_CONT_CTRL_BY_GO_SIGNAL);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8697_CONT_PLAYBACK_MODE);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_F0_DETECT_MASK, AW8697_BIT_CONT_CTRL_F0_DETECT_DISABLE);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_O2C_MASK, AW8697_BIT_CONT_CTRL_O2C_DISABLE);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_AUTO_BRK_MASK, AW8697_BIT_CONT_CTRL_AUTO_BRK_ENABLE);
+    /* TD time */
+    aw8697_i2c_write(aw8697, AW8697_REG_TD_H, (unsigned char)(aw8697->cont_td>>8));
+    aw8697_i2c_write(aw8697, AW8697_REG_TD_L, (unsigned char)(aw8697->cont_td>>0));
+    aw8697_i2c_write(aw8697, AW8697_REG_TSET, 0x12);
+    /* zero cross */
+    aw8697_i2c_write(aw8697, AW8697_REG_ZC_THRSH_H, (unsigned char)(aw8697->cont_zc_thr>>8));
+    aw8697_i2c_write(aw8697, AW8697_REG_ZC_THRSH_L, (unsigned char)(aw8697->cont_zc_thr>>0));
+    /* bemf */
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHH_H, 0x10);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHH_L, 0x08);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHL_H, 0x03);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHL_L, 0xf8);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_BEMF_NUM,
+            AW8697_BIT_BEMF_NUM_BRK_MASK, aw8697->cont_num_brk);
+    aw8697_i2c_write(aw8697, AW8697_REG_TIME_NZC, 0x23);    /* 35*171us=5.985ms*/
+    /* f0 driver level */
+    aw8697_i2c_write(aw8697, AW8697_REG_DRV_LVL, aw8697->cont_drv_lvl);
+    aw8697_i2c_write(aw8697, AW8697_REG_DRV_LVL_OV, aw8697->cont_drv_lvl_ov);
+    /* cont play go */
+    aw8697_haptic_play_go(aw8697, true);
+
+    return 0;
+}
+
+/*****************************************************
+ *
+ * haptic f0 cali
+ *
+ *****************************************************/
+static int aw8697_haptic_get_f0(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    unsigned char f0_pre_num = 0;
+    unsigned char f0_wait_num = 0;
+    unsigned char f0_repeat_num = 0;
+    unsigned char f0_trace_num = 0;
+    unsigned int t_f0_ms = 0;
+    unsigned int t_f0_trace_ms = 0;
+    unsigned int f0_cali_cnt = 50;
+
+    pr_info("%s enter\n", __func__);
+
+    aw8697->f0 = aw8697->f0_pre;
+
+    /* f0 calibrate work mode */
+    aw8697_haptic_stop(aw8697);
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_CONT_MODE);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8697_BIT_CONT_CTRL_OPEN_PLAYBACK);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_F0_DETECT_MASK, AW8697_BIT_CONT_CTRL_F0_DETECT_ENABLE);
+
+    /* LPF */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DATCTRL,
+            AW8697_BIT_DATCTRL_FC_MASK, AW8697_BIT_DATCTRL_FC_1000HZ);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DATCTRL,
+            AW8697_BIT_DATCTRL_LPF_ENABLE_MASK, AW8697_BIT_DATCTRL_LPF_ENABLE);
+
+    /* LRA OSC Source */
+    if(aw8697->f0_cali_flag == AW8697_HAPTIC_CALI_F0) {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_ANACTRL,
+                AW8697_BIT_ANACTRL_LRA_SRC_MASK, AW8697_BIT_ANACTRL_LRA_SRC_REG);
+    } else {
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_ANACTRL,
+                AW8697_BIT_ANACTRL_LRA_SRC_MASK, AW8697_BIT_ANACTRL_LRA_SRC_EFUSE);
+    }
+
+    /* preset f0 */
+    aw8697_haptic_set_f0_preset(aw8697);
+
+    /* beme config */
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHH_H, 0x10);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHH_L, 0x08);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHL_H, 0x03);
+    aw8697_i2c_write(aw8697, AW8697_REG_BEMF_VTHL_L, 0xf8);
+
+    /* f0 driver level */
+    aw8697_i2c_write(aw8697, AW8697_REG_DRV_LVL, aw8697->cont_drv_lvl);
+
+    /* f0 trace parameter */
+    f0_pre_num = 0x05;
+    f0_wait_num = 0x03;
+    f0_repeat_num = 0x02;
+    f0_trace_num = 0x0f;
+    aw8697_i2c_write(aw8697, AW8697_REG_NUM_F0_1, (f0_pre_num<<4)|(f0_wait_num<<0));
+    aw8697_i2c_write(aw8697, AW8697_REG_NUM_F0_2, (f0_repeat_num<<0));
+    aw8697_i2c_write(aw8697, AW8697_REG_NUM_F0_3, (f0_trace_num<<0));
+
+    /* clear aw8697 interrupt */
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+
+    /* play go and start f0 calibration */
+    aw8697_haptic_play_go(aw8697, true);
+
+    /* f0 trace time */
+    t_f0_ms = 1000*10/aw8697->f0_pre;
+    t_f0_trace_ms = t_f0_ms * (f0_pre_num + f0_wait_num + (f0_trace_num+f0_wait_num)*(f0_repeat_num-1));
+    msleep(t_f0_trace_ms);
+
+    for(i=0; i<f0_cali_cnt; i++) {
+        ret = aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+        /* f0 calibrate done */
+        if(reg_val & 0x01) {
+            aw8697_haptic_read_f0(aw8697);
+            aw8697_haptic_read_beme(aw8697);
+            break;
+        }
+        msleep(10);
+        pr_info("%s f0 cali sleep 10ms\n", __func__);
+    }
+
+    if(i == f0_cali_cnt) {
+        ret = -1;
+    } else {
+        ret = 0;
+    }
+
+    /* restore default config */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8697_CONT_PLAYBACK_MODE);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_CONT_CTRL,
+            AW8697_BIT_CONT_CTRL_F0_DETECT_MASK, AW8697_BIT_CONT_CTRL_F0_DETECT_DISABLE);
+    return ret;
+}
+
+static int aw8697_haptic_f0_calibration(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+    unsigned int f0_limit = 0;
+    char f0_cali_lra = 0;
+    int f0_cali_step = 0;
+    int f0_dft_step = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    aw8697->f0_cali_flag = AW8697_HAPTIC_CALI_F0;
+
+    if(aw8697_haptic_get_f0(aw8697)) {
+        pr_err("%s get f0 error, user defafult f0\n", __func__);
+    } else {
+        /* max and min limit */
+        f0_limit = aw8697->f0;
+        if(aw8697->f0*100 < AW8697_HAPTIC_F0_PRE*(100-AW8697_HAPTIC_F0_CALI_PERCEN)) {
+            f0_limit = AW8697_HAPTIC_F0_PRE*(100-AW8697_HAPTIC_F0_CALI_PERCEN)/100;
+        }
+        if(aw8697->f0*100 > AW8697_HAPTIC_F0_PRE*(100+AW8697_HAPTIC_F0_CALI_PERCEN)) {
+            f0_limit = AW8697_HAPTIC_F0_PRE*(100+AW8697_HAPTIC_F0_CALI_PERCEN)/100;
+        }
+        /* calculate cali step */
+        f0_cali_step = 10000*((int)f0_limit-(int)aw8697->f0_pre)/((int)f0_limit*25);
+        pr_debug("%s f0_cali_step=%d\n", __func__, f0_cali_step);
+
+        /* get default cali step */
+        aw8697_i2c_read(aw8697, AW8697_REG_TRIM_LRA, &reg_val);
+        if(reg_val & 0x20) {
+            f0_dft_step = reg_val - 0x40;
+        } else {
+            f0_dft_step = reg_val;
+        }
+        pr_debug("%s f0_dft_step=%d\n", __func__, f0_dft_step);
+
+        /* get new cali step */
+        f0_cali_step += f0_dft_step;
+        pr_debug("%s f0_cali_step=%d\n", __func__, f0_cali_step);
+
+        if(f0_cali_step > 31) {
+            f0_cali_step = 31;
+        } else if(f0_cali_step < -32) {
+            f0_cali_step = -32;
+        }
+        f0_cali_lra = (char)f0_cali_step;
+        pr_debug("%s f0_cali_lra=%d\n", __func__, f0_cali_lra);
+
+        /* get cali step complement code*/
+        if(f0_cali_lra < 0) {
+            f0_cali_lra += 0x40;
+        }
+        pr_debug("%s reg f0_cali_lra=%d\n", __func__, f0_cali_lra);
+
+        /* update cali step */
+        aw8697_i2c_write(aw8697, AW8697_REG_TRIM_LRA, (char)f0_cali_lra);
+        aw8697_i2c_read(aw8697, AW8697_REG_TRIM_LRA, &reg_val);
+        pr_info("%s final trim_lra=0x%02x\n", __func__, reg_val);
+    }
+
+    if(aw8697_haptic_get_f0(aw8697)) {
+        pr_err("%s get f0 error, user defafult f0\n", __func__);
+    }
+    /* restore default work mode */
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_STANDBY_MODE);
+    aw8697->play_mode = AW8697_HAPTIC_RAM_MODE;
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_PLAY_MODE_MASK, AW8697_BIT_SYSCTRL_PLAY_MODE_RAM);
+    aw8697_haptic_stop(aw8697);
+
+    return ret;
+}
+
+/*****************************************************
+ *
+ * haptic fops
+ *
+ *****************************************************/
+static int aw8697_file_open(struct inode *inode, struct file *file)
+{
+    if (!try_module_get(THIS_MODULE))
+        return -ENODEV;
+
+    file->private_data = (void*)g_aw8697;
+
+    return 0;
+}
+
+static int aw8697_file_release(struct inode *inode, struct file *file)
+{
+    file->private_data = (void*)NULL;
+
+    module_put(THIS_MODULE);
+
+    return 0;
+}
+
+static long aw8697_file_unlocked_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
+{
+    struct aw8697 *aw8697 = (struct aw8697 *)file->private_data;
+
+    int ret = 0;
+
+    dev_info(aw8697->dev, "%s: cmd=0x%x, arg=0x%lx\n",
+              __func__, cmd, arg);
+
+    mutex_lock(&aw8697->lock);
+
+    if(_IOC_TYPE(cmd) != AW8697_HAPTIC_IOCTL_MAGIC) {
+        dev_err(aw8697->dev, "%s: cmd magic err\n",
+                __func__);
+        return -EINVAL;
+    }
+
+    switch (cmd) {
+        default:
+            dev_err(aw8697->dev, "%s, unknown cmd\n", __func__);
+            break;
+    }
+
+    mutex_unlock(&aw8697->lock);
+
+    return ret;
+}
+
+static ssize_t aw8697_file_read(struct file* filp, char* buff, size_t len, loff_t* offset)
+{
+    struct aw8697 *aw8697 = (struct aw8697 *)filp->private_data;
+    int ret = 0;
+    int i = 0;
+    unsigned char reg_val = 0;
+    unsigned char *pbuff = NULL;
+
+    mutex_lock(&aw8697->lock);
+
+    dev_info(aw8697->dev, "%s: len=%zu\n", __func__, len);
+
+    switch(aw8697->fileops.cmd)
+    {
+        case AW8697_HAPTIC_CMD_READ_REG:
+            pbuff = (unsigned char *)kzalloc(len, GFP_KERNEL);
+            if(pbuff != NULL) {
+                for(i=0; i<len; i++) {
+                    aw8697_i2c_read(aw8697, aw8697->fileops.reg+i, &reg_val);
+                    pbuff[i] = reg_val;
+                }
+                for(i=0; i<len; i++) {
+                    dev_info(aw8697->dev, "%s: pbuff[%d]=0x%02x\n",
+                            __func__, i, pbuff[i]);
+                }
+                ret = copy_to_user(buff, pbuff, len);
+                if(ret) {
+                    dev_err(aw8697->dev, "%s: copy to user fail\n", __func__);
+                }
+                kfree(pbuff);
+            } else {
+                dev_err(aw8697->dev, "%s: alloc memory fail\n", __func__);
+            }
+            break;
+        default:
+            dev_err(aw8697->dev, "%s, unknown cmd %d \n", __func__, aw8697->fileops.cmd);
+            break;
+    }
+
+    mutex_unlock(&aw8697->lock);
+
+
+    return len;
+}
+
+static ssize_t aw8697_file_write(struct file* filp, const char* buff, size_t len, loff_t* off)
+{
+    struct aw8697 *aw8697 = (struct aw8697 *)filp->private_data;
+    int i = 0;
+    int ret = 0;
+    unsigned char *pbuff = NULL;
+
+    pbuff = (unsigned char *)kzalloc(len, GFP_KERNEL);
+    if(pbuff == NULL) {
+        dev_err(aw8697->dev, "%s: alloc memory fail\n", __func__);
+        return len;
+    }
+    ret = copy_from_user(pbuff, buff, len);
+    if(ret) {
+        kfree(pbuff);
+        dev_err(aw8697->dev, "%s: copy from user fail\n", __func__);
+        return len;
+    }
+
+    for(i=0; i<len; i++) {
+        dev_info(aw8697->dev, "%s: pbuff[%d]=0x%02x\n",
+                __func__, i, pbuff[i]);
+    }
+
+    mutex_lock(&aw8697->lock);
+
+    aw8697->fileops.cmd = pbuff[0];
+
+    switch(aw8697->fileops.cmd)
+    {
+        case AW8697_HAPTIC_CMD_READ_REG:
+            if(len == 2) {
+                aw8697->fileops.reg = pbuff[1];
+            } else {
+                dev_err(aw8697->dev, "%s: read cmd len %zu err\n", __func__, len);
+            }
+            break;
+        case AW8697_HAPTIC_CMD_WRITE_REG:
+            if(len > 2) {
+                for(i=0; i<len-2; i++) {
+                    dev_info(aw8697->dev, "%s: write reg0x%02x=0x%02x\n",
+                            __func__, pbuff[1]+i, pbuff[i+2]);
+                    aw8697_i2c_write(aw8697, pbuff[1]+i, pbuff[2+i]);
+                }
+            } else {
+                dev_err(aw8697->dev, "%s: write cmd len %zu err\n", __func__, len);
+            }
+            break;
+        default:
+            dev_err(aw8697->dev, "%s, unknown cmd %d \n", __func__, aw8697->fileops.cmd);
+            break;
+    }
+
+    mutex_unlock(&aw8697->lock);
+
+    if(pbuff != NULL) {
+        kfree(pbuff);
+    }
+    return len;
+}
+
+static struct file_operations fops =
+{
+    .owner = THIS_MODULE,
+    .read = aw8697_file_read,
+    .write = aw8697_file_write,
+    .unlocked_ioctl = aw8697_file_unlocked_ioctl,
+    .open = aw8697_file_open,
+    .release = aw8697_file_release,
+};
+
+static struct miscdevice aw8697_haptic_misc =
+{
+    .minor = MISC_DYNAMIC_MINOR,
+    .name = AW8697_HAPTIC_NAME,
+    .fops = &fops,
+};
+
+static bool check_factory_mode(void)
+{
+	int boot_mode = get_boot_mode();
+
+	if (boot_mode == MSM_BOOT_MODE__RF || boot_mode == MSM_BOOT_MODE__WLAN
+			|| boot_mode == MSM_BOOT_MODE__FACTORY)
+		return true;
+	else
+		return false;
+}
+
+static int aw8697_haptic_init(struct aw8697 *aw8697)
+{
+    int ret = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    struct tp *tp = &(aw8697->haptic_audio.tp);
+
+    pr_info("%s enter\n", __func__);
+
+    ret = misc_register(&aw8697_haptic_misc);
+    if(ret) {
+        dev_err(aw8697->dev,  "%s: misc fail: %d\n", __func__, ret);
+        return ret;
+    }
+
+    /* haptic audio */
+    aw8697->haptic_audio.delay_val = 1;
+    aw8697->haptic_audio.timer_val = 21318;
+    INIT_LIST_HEAD(&(aw8697->haptic_audio.ctr_list));
+
+    hrtimer_init(&aw8697->haptic_audio.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+    aw8697->haptic_audio.timer.function = aw8697_haptic_audio_timer_func;
+    INIT_WORK(&aw8697->haptic_audio.work, aw8697_haptic_audio_work_routine);
+
+    mutex_init(&aw8697->haptic_audio.lock);
+
+    aw8697->haptic_audio.tp.press_delay_min = 1;
+    aw8697->haptic_audio.tp.press_delay_max = 500000;
+    aw8697->haptic_audio.tp.release_delay_max = 600000;
+    aw8697->haptic_audio.tp.no_play_cnt_max = 230;
+    for(i=0; i<AW8697_HAPTIC_TP_ID_MAX+1; i++) {
+        tp->id[i].pt_info.status = 0;
+    }
+
+    INIT_LIST_HEAD(&(aw8697->haptic_audio.list));
+
+    aw8697->haptic_audio.tp_size.x = 3120;
+    aw8697->haptic_audio.tp_size.y = 1440;
+    aw8697->haptic_audio.tz_cnt_thr = 3;
+    aw8697->haptic_audio.tz_cnt_max = 10;
+    aw8697->haptic_audio.hap_cnt_max_outside_tz = 5;
+
+    aw8697_op_clean_status(aw8697);
+
+    /* haptic init */
+    mutex_lock(&aw8697->lock);
+    /*For haptic test 90mA in AT begin*/
+    aw8697->activate_mode = AW8697_HAPTIC_ACTIVATE_RAM_MODE;
+    aw8697_haptic_set_wav_loop(aw8697, aw8697->loop[0x00], 0xff);
+    aw8697_haptic_set_bst_vol(aw8697, 0x11);
+    if (check_factory_mode())
+       aw8697_haptic_set_gain(aw8697, 0xcf);
+    else
+       aw8697_haptic_set_gain(aw8697, 0x80);
+    aw8697_haptic_set_repeat_wav_seq(aw8697, 10);
+    /*For haptic test 90mA in AT end*/
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_WAVSEQ1, &reg_val);
+    aw8697->index = reg_val & 0x7F;
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_DATDBG, &reg_val);
+    aw8697->gain = reg_val & 0xFF;
+    ret = aw8697_i2c_read(aw8697, AW8697_REG_BSTDBG4, &reg_val);
+    aw8697->vmax = (reg_val>>1)&0x1F;
+    for(i=0; i<AW8697_SEQUENCER_SIZE; i++) {
+        ret = aw8697_i2c_read(aw8697, AW8697_REG_WAVSEQ1+i, &reg_val);
+        aw8697->seq[i] = reg_val;
+    }
+
+    aw8697_haptic_play_mode(aw8697, AW8697_HAPTIC_STANDBY_MODE);
+
+    aw8697_haptic_set_pwm(aw8697, AW8697_PWM_24K);
+
+    aw8697_i2c_write(aw8697, AW8697_REG_BSTDBG1, 0x30);
+    aw8697_i2c_write(aw8697, AW8697_REG_BSTDBG2, 0xeb);
+    aw8697_i2c_write(aw8697, AW8697_REG_BSTDBG3, 0xd4);
+    aw8697_i2c_write(aw8697, AW8697_REG_TSET, 0x12);
+    aw8697_i2c_write(aw8697, AW8697_REG_R_SPARE, 0x68);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_ANADBG,
+            AW8697_BIT_ANADBG_IOC_MASK, AW8697_BIT_ANADBG_IOC_4P65A);
+    /*OP over current limmit set to max begin*/
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_ANADBG,
+            AW8697_BIT_ANADBG_IOC_OCDT_MASK, AW8697_BIT_ANADBG_IOC_OCDT_150NS);
+    /*OP over current limmit set to max end*/
+    aw8697_haptic_set_bst_peak_cur(aw8697, AW8697_DEFAULT_PEAKCUR);
+    aw8697_haptic_swicth_motorprotect_config(aw8697, 0x00, 0x00);
+    aw8697_haptic_auto_boost_config(aw8697, false);
+
+    aw8697_haptic_trig_param_init(aw8697);
+    aw8697_haptic_trig_param_config(aw8697);
+
+    aw8697_haptic_os_calibration(aw8697);
+    aw8697_haptic_cont_vbat_mode(aw8697,
+            AW8697_HAPTIC_CONT_VBAT_HW_COMP_MODE);
+    aw8697->ram_vbat_comp = AW8697_HAPTIC_RAM_VBAT_COMP_ENABLE;
+    mutex_unlock(&aw8697->lock);
+
+    /* f0 calibration */
+    mutex_lock(&aw8697->lock);
+    aw8697->f0_pre = AW8697_HAPTIC_F0_PRE;
+    aw8697->cont_drv_lvl = AW8697_HAPTIC_CONT_DRV_LVL;
+    aw8697->cont_drv_lvl_ov = AW8697_HAPTIC_CONT_DRV_LVL_OV;
+    aw8697->cont_td = AW8697_HAPTIC_CONT_TD;
+    aw8697->cont_zc_thr = AW8697_HAPTIC_CONT_ZC_THR;
+    aw8697->cont_num_brk = AW8697_HAPTIC_CONT_NUM_BRK;
+    mutex_unlock(&aw8697->lock);
+
+    return ret;
+}
+
+
+
+/*****************************************************
+ *
+ * vibrator
+ *
+ *****************************************************/
+#ifdef TIMED_OUTPUT
+static int aw8697_vibrator_get_time(struct timed_output_dev *dev)
+{
+    struct aw8697 *aw8697 = container_of(dev, struct aw8697, to_dev);
+
+    if (hrtimer_active(&aw8697->timer)) {
+        ktime_t r = hrtimer_get_remaining(&aw8697->timer);
+        return ktime_to_ms(r);
+    }
+
+    return 0;
+}
+
+static void aw8697_vibrator_enable( struct timed_output_dev *dev, int value)
+{
+    struct aw8697 *aw8697 = container_of(dev, struct aw8697, to_dev);
+    unsigned char reg_val = 0;
+
+    mutex_lock(&aw8697->lock);
+
+    pr_debug("%s enter\n", __func__);
+    /*RTP mode do not allow other vibrate begign*/
+    if(aw8697->play_mode == AW8697_HAPTIC_RTP_MODE)
+    {
+         aw8697_i2c_read(aw8697, AW8697_REG_GLB_STATE, &reg_val);
+         if((reg_val&0x0f) != 0x00) {
+             mutex_unlock(&aw8697->lock);
+             pr_info("%s RTP on && not stop,return\n", __func__);
+             return;
+         }
+    }
+    /*RTP mode do not allow other vibrate end*/
+
+    aw8697_haptic_stop(aw8697);
+
+    if (value > 0) {
+        aw8697_haptic_ram_vbat_comp(aw8697, false);
+        aw8697_haptic_play_wav_seq(aw8697, value);
+    }
+
+    mutex_unlock(&aw8697->lock);
+
+    pr_debug("%s exit\n", __func__);
+}
+
+#else
+static enum led_brightness aw8697_haptic_brightness_get(struct led_classdev *cdev)
+{
+    struct aw8697 *aw8697 =
+        container_of(cdev, struct aw8697, cdev);
+
+    return aw8697->amplitude;
+}
+
+static void aw8697_haptic_brightness_set(struct led_classdev *cdev,
+                enum led_brightness level)
+{
+    struct aw8697 *aw8697 =
+        container_of(cdev, struct aw8697, cdev);
+    int rtp_is_going_on = 0;
+
+    /*OP add for juge rtp on begin*/
+    rtp_is_going_on = aw8697_haptic_juge_RTP_is_going_on(aw8697);
+    if (rtp_is_going_on)
+       return;
+    if (!aw8697->ram_init)
+       return;
+    pr_info("%s enter\n", __func__);
+    /*OP add for juge rtp on end*/
+
+    aw8697->amplitude = level;
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    if (aw8697->amplitude > 0) {
+        /*aw8697_haptic_ram_vbat_comp(aw8697, false);*/
+        aw8697_haptic_play_wav_seq(aw8697, aw8697->amplitude);
+    }
+
+    mutex_unlock(&aw8697->lock);
+
+}
+#endif
+
+static ssize_t aw8697_state_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8697->state);
+}
+
+static ssize_t aw8697_state_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    return count;
+}
+
+static ssize_t aw8697_duration_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ktime_t time_rem;
+    s64 time_ms = 0;
+
+    if (hrtimer_active(&aw8697->timer)) {
+        time_rem = hrtimer_get_remaining(&aw8697->timer);
+        time_ms = ktime_to_ms(time_rem);
+    }
+
+    return snprintf(buf, PAGE_SIZE, "%lld\n", time_ms);
+}
+
+static ssize_t aw8697_duration_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+     pr_info("%s:val:%d\n", __func__, val);
+    /* setting 0 on duration is NOP for now */
+    if (val <= 0)
+        return count;
+
+    aw8697->duration = val;
+
+    return count;
+}
+
+static ssize_t aw8697_activate_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+
+    /* For now nothing to show */
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8697->state);
+}
+
+static ssize_t aw8697_activate_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+    int rtp_is_going_on = 0;
+
+    /*OP add for juge rtp on begin*/
+    rtp_is_going_on = aw8697_haptic_juge_RTP_is_going_on(aw8697);
+    if (rtp_is_going_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+    /*OP add for juge rtp on end*/
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    if (val != 0 && val != 1)
+        return count;
+
+    pr_info("%s: value=%d\n", __FUNCTION__, val);
+    mutex_lock(&aw8697->lock);
+/*for type Android OS's vibrator 20181225 begin*/
+/*set mode as RAM*/
+	aw8697->activate_mode = AW8697_HAPTIC_ACTIVATE_RAM_MODE;
+/*set ram_vbat_comp*/
+	/*aw8697->ram_vbat_comp = AW8697_HAPTIC_RAM_VBAT_COMP_ENABLE;*/
+/*set wave number,index*/
+    aw8697->index = 10;/*sine 170hz*/
+    aw8697_haptic_set_repeat_wav_seq(aw8697, aw8697->index);
+/*for type Android OS's vibrator 20181225  end*/
+    if (val == 0)
+       mdelay(10);
+    hrtimer_cancel(&aw8697->timer);
+
+    aw8697->state = val;
+    mutex_unlock(&aw8697->lock);
+    schedule_work(&aw8697->vibrator_work);
+
+    return count;
+}
+
+static ssize_t aw8697_activate_mode_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "activate_mode=%d\n", aw8697->activate_mode);
+}
+
+static ssize_t aw8697_activate_mode_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+    pr_info("%s:val:%d\n", __func__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697->activate_mode = val;
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_index_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned char reg_val = 0;
+    aw8697_i2c_read(aw8697, AW8697_REG_WAVSEQ1, &reg_val);
+    aw8697->index = reg_val;
+
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8697->index);
+}
+
+static ssize_t aw8697_index_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_info("%s: value=%d\n", __FUNCTION__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697->index = val;
+    aw8697_haptic_set_repeat_wav_seq(aw8697, aw8697->index);
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_vmax_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "0x%02x\n", aw8697->vmax);
+}
+
+static ssize_t aw8697_vmax_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_info("%s: value=%d\n", __FUNCTION__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697->vmax = val;
+    aw8697_haptic_set_bst_vol(aw8697, aw8697->vmax);
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_gain_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "0x%02x\n", aw8697->gain);
+}
+
+static ssize_t aw8697_gain_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_info("%s: value=%d\n", __FUNCTION__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697->gain = val;
+    aw8697_haptic_set_gain(aw8697, aw8697->gain);
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_seq_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    size_t count = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+
+    for(i=0; i<AW8697_SEQUENCER_SIZE; i++) {
+        aw8697_i2c_read(aw8697, AW8697_REG_WAVSEQ1+i, &reg_val);
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d: 0x%02x\n", i+1, reg_val);
+        aw8697->seq[i] |= reg_val;
+    }
+    return count;
+}
+
+static ssize_t aw8697_seq_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        pr_info("%s: seq%d=0x%x\n", __FUNCTION__, databuf[0], databuf[1]);
+        mutex_lock(&aw8697->lock);
+        aw8697->seq[databuf[0]] = (unsigned char)databuf[1];
+        aw8697_haptic_set_wav_seq(aw8697, (unsigned char)databuf[0],
+                aw8697->seq[databuf[0]]);
+        mutex_unlock(&aw8697->lock);
+    }
+    return count;
+}
+
+static ssize_t aw8697_loop_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    size_t count = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+
+    for(i=0; i<AW8697_SEQUENCER_LOOP_SIZE; i++) {
+        aw8697_i2c_read(aw8697, AW8697_REG_WAVLOOP1+i, &reg_val);
+        aw8697->loop[i*2+0] = (reg_val>>4)&0x0F;
+        aw8697->loop[i*2+1] = (reg_val>>0)&0x0F;
+
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d loop: 0x%02x\n", i*2+1, aw8697->loop[i*2+0]);
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d loop: 0x%02x\n", i*2+2, aw8697->loop[i*2+1]);
+    }
+    return count;
+}
+
+static ssize_t aw8697_loop_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        pr_info("%s: seq%d loop=0x%x\n", __FUNCTION__, databuf[0], databuf[1]);
+        mutex_lock(&aw8697->lock);
+        aw8697->loop[databuf[0]] = (unsigned char)databuf[1];
+        aw8697_haptic_set_wav_loop(aw8697, (unsigned char)databuf[0],
+                aw8697->loop[databuf[0]]);
+        mutex_unlock(&aw8697->lock);
+    }
+
+    return count;
+}
+
+static ssize_t aw8697_reg_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    for(i = 0; i < AW8697_REG_MAX; i ++) {
+        if(!(aw8697_reg_access[i]&REG_RD_ACCESS))
+           continue;
+        aw8697_i2c_read(aw8697, i, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "reg:0x%02x=0x%02x \n", i, reg_val);
+    }
+    return len;
+}
+
+static ssize_t aw8697_reg_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        aw8697_i2c_write(aw8697, (unsigned char)databuf[0], (unsigned char)databuf[1]);
+    }
+
+    return count;
+}
+
+static ssize_t aw8697_rtp_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "rtp play: %d\n", aw8697->rtp_cnt);
+
+    return len;
+}
+#define AUDIO_READY_STATUS  1024
+#define FACTORY_MODE_NORMAL_RTP_NUMBER  73
+#define FACTORY_MODE_HIGH_TEMP_RTP_NUMBER  72
+
+static ssize_t aw8697_rtp_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+    int rtp_is_going_on = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0) {
+        pr_info("%s: kstrtouint fail\n", __FUNCTION__);
+        return rc;
+    }
+    pr_info("%s: rtp[%d]\n", __FUNCTION__,val);
+
+    /*OP add for juge rtp on begin*/
+    rtp_is_going_on = aw8697_haptic_juge_RTP_is_going_on(aw8697);
+    if (rtp_is_going_on && (val == AUDIO_READY_STATUS))
+    {
+        pr_info("%s: seem audio status rtp[%d]\n", __FUNCTION__,val);
+        return count;
+    }
+    /*OP add for juge rtp on end*/
+
+    if (!aw8697->haptic_ready && (val == AUDIO_READY_STATUS)) {
+        pr_info("%s: invalid audio ready\n", __FUNCTION__);
+        return count;
+    }
+    if (val != FACTORY_MODE_NORMAL_RTP_NUMBER 
+        && val != FACTORY_MODE_HIGH_TEMP_RTP_NUMBER
+        && val != 0) {
+        if (val == AUDIO_READY_STATUS)
+           aw8697->audio_ready = true;
+        else
+           aw8697->haptic_ready = true;
+
+       pr_info("%s:audio[%d]and haptic[%d] ready\n", __FUNCTION__,
+                        aw8697->audio_ready, aw8697->haptic_ready);
+       if (aw8697->haptic_ready && !aw8697->audio_ready) {
+           aw8697->pre_haptic_number = val;
+       }
+       if (!aw8697->audio_ready || !aw8697->haptic_ready) {
+           return count;
+       }
+    }
+    if (val == AUDIO_READY_STATUS && aw8697->pre_haptic_number) {
+        pr_info("pre_haptic_number:%d\n",aw8697->pre_haptic_number);
+       val = aw8697->pre_haptic_number;
+    }
+    if (!val) {
+      aw8697_op_clean_status(aw8697);
+    }
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    aw8697_haptic_set_rtp_aei(aw8697, false);
+    aw8697_interrupt_clear(aw8697);
+    if(val < (sizeof(aw8697_rtp_name)/AW8697_RTP_NAME_MAX)) {
+        aw8697->rtp_file_num = val;
+        if(val) {
+            schedule_work(&aw8697->rtp_work);
+        }
+    } else {
+        pr_err("%s: rtp_file_num 0x%02x over max value \n", __func__, aw8697->rtp_file_num);
+    }
+    mutex_unlock(&aw8697->lock);
+
+    return count;
+}
+
+static ssize_t aw8697_ram_update_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+    ssize_t len = 0;
+
+    len += snprintf(buf+len, PAGE_SIZE-len, "sram update mode\n");
+    return len;
+}
+
+static ssize_t aw8697_ram_update_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    if(val) {
+        aw8697_ram_update(aw8697);
+    }
+    return count;
+}
+
+static ssize_t aw8697_f0_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+
+    mutex_lock(&aw8697->lock);
+    aw8697->f0_cali_flag = AW8697_HAPTIC_CALI_F0;
+    aw8697_haptic_get_f0(aw8697);
+    mutex_unlock(&aw8697->lock);
+    len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8697->f0/10);
+    return len;
+}
+
+static ssize_t aw8697_f0_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    return count;
+}
+
+static ssize_t aw8697_cali_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    mutex_lock(&aw8697->lock);
+    aw8697->f0_cali_flag = AW8697_HAPTIC_CALI_F0;
+    aw8697_haptic_get_f0(aw8697);
+    mutex_unlock(&aw8697->lock);
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cali f0 = %d\n", aw8697->f0);
+    return len;
+}
+
+static ssize_t aw8697_cali_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+    pr_info("%s:val:%d\n", __func__, val);
+    if(val) {
+        mutex_lock(&aw8697->lock);
+        aw8697_haptic_f0_calibration(aw8697);
+        mutex_unlock(&aw8697->lock);
+    }
+    return count;
+}
+
+static ssize_t aw8697_cont_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    aw8697_haptic_read_cont_f0(aw8697);
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont f0 = %d\n", aw8697->cont_f0);
+    return len;
+}
+
+static ssize_t aw8697_cont_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+    pr_info("%s:val:%d\n", __func__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    if(val) {
+        aw8697_haptic_cont(aw8697);
+    }
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+
+static ssize_t aw8697_cont_td_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont delay time = 0x%04x\n", aw8697->cont_td);
+    return len;
+}
+
+static ssize_t aw8697_cont_td_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[1] = {0};
+    if(1 == sscanf(buf, "%x", &databuf[0])) {
+        aw8697->cont_td = databuf[0];
+        aw8697_i2c_write(aw8697, AW8697_REG_TD_H, (unsigned char)(databuf[0]>>8));
+        aw8697_i2c_write(aw8697, AW8697_REG_TD_L, (unsigned char)(databuf[0]>>0));
+    }
+    return count;
+}
+
+static ssize_t aw8697_cont_drv_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont drv level = %d\n", aw8697->cont_drv_lvl);
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont drv level overdrive= %d\n", aw8697->cont_drv_lvl_ov);
+    return len;
+}
+
+static ssize_t aw8697_cont_drv_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+    if(2 == sscanf(buf, "%d %d", &databuf[0], &databuf[1])) {
+        aw8697->cont_drv_lvl = databuf[0];
+        aw8697_i2c_write(aw8697, AW8697_REG_DRV_LVL, aw8697->cont_drv_lvl);
+        aw8697->cont_drv_lvl_ov = databuf[1];
+        aw8697_i2c_write(aw8697, AW8697_REG_DRV_LVL_OV, aw8697->cont_drv_lvl_ov);
+    }
+    return count;
+}
+
+static ssize_t aw8697_cont_num_brk_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont break num = %d\n", aw8697->cont_num_brk);
+    return len;
+}
+
+static ssize_t aw8697_cont_num_brk_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[1] = {0};
+    if(1 == sscanf(buf, "%d", &databuf[0])) {
+        aw8697->cont_num_brk = databuf[0];
+        if(aw8697->cont_num_brk > 7) {
+            aw8697->cont_num_brk = 7;
+        }
+        aw8697_i2c_write_bits(aw8697, AW8697_REG_BEMF_NUM,
+                AW8697_BIT_BEMF_NUM_BRK_MASK, aw8697->cont_num_brk);
+    }
+    return count;
+}
+
+static ssize_t aw8697_cont_zc_thr_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697 cont zero cross thr = 0x%04x\n", aw8697->cont_zc_thr);
+    return len;
+}
+
+static ssize_t aw8697_cont_zc_thr_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[1] = {0};
+    if(1 == sscanf(buf, "%x", &databuf[0])) {
+        aw8697->cont_zc_thr = databuf[0];
+        aw8697_i2c_write(aw8697, AW8697_REG_ZC_THRSH_H, (unsigned char)(databuf[0]>>8));
+        aw8697_i2c_write(aw8697, AW8697_REG_ZC_THRSH_L, (unsigned char)(databuf[0]>>0));
+    }
+    return count;
+}
+
+static ssize_t aw8697_vbat_monitor_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    aw8697_haptic_get_vbat(aw8697);
+    len += snprintf(buf+len, PAGE_SIZE-len, "vbat=%dmV\n", aw8697->vbat);
+    mutex_unlock(&aw8697->lock);
+
+    return len;
+}
+
+static ssize_t aw8697_vbat_monitor_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+    return count;
+}
+
+static ssize_t aw8697_lra_resistance_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    unsigned char reg_val = 0;
+
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BYPASS);
+
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_ANACTRL,
+            AW8697_BIT_ANACTRL_HD_PD_MASK, AW8697_BIT_ANACTRL_HD_HZ_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_D2SCFG,
+            AW8697_BIT_D2SCFG_CLK_ADC_MASK, AW8697_BIT_D2SCFG_CLK_ASC_1P5MHZ);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+            AW8697_BIT_DETCTRL_RL_OS_MASK, AW8697_BIT_DETCTRL_RL_DETECT);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DETCTRL,
+            AW8697_BIT_DETCTRL_DIAG_GO_MASK, AW8697_BIT_DETCTRL_DIAG_GO_ENABLE);
+    msleep(3);
+    aw8697_i2c_read(aw8697, AW8697_REG_RLDET, &reg_val);
+    aw8697->lra = 298 * reg_val;
+    len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8697->lra/100);
+
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_ANACTRL,
+            AW8697_BIT_ANACTRL_HD_PD_MASK, AW8697_BIT_ANACTRL_HD_PD_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_D2SCFG,
+            AW8697_BIT_D2SCFG_CLK_ADC_MASK, AW8697_BIT_D2SCFG_CLK_ASC_6MHZ);
+
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_OFF);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_BST_MODE_MASK, AW8697_BIT_SYSCTRL_BST_MODE_BOOST);
+    mutex_unlock(&aw8697->lock);
+
+    return len;
+}
+
+static ssize_t aw8697_lra_resistance_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+    return count;
+}
+
+static ssize_t aw8697_auto_boost_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "auto_boost=%d\n", aw8697->auto_boost);
+    return len;
+}
+
+
+static ssize_t aw8697_auto_boost_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+    pr_info("%s:val:%d\n", __func__, val);
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    aw8697_haptic_auto_boost_config(aw8697, val);
+    mutex_unlock(&aw8697->lock);
+
+    return count;
+}
+
+static ssize_t aw8697_prctmode_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    unsigned char reg_val = 0;
+
+    aw8697_i2c_read(aw8697, AW8697_REG_RLDET, &reg_val);
+
+    len += snprintf(buf+len, PAGE_SIZE-len, "prctmode=%d\n", reg_val&0x20);
+    return len;
+}
+
+
+static ssize_t aw8697_prctmode_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+    #ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+    #else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+    #endif
+    unsigned int databuf[2] = {0, 0};
+    unsigned int addr=0;
+    unsigned int val=0;
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        addr = databuf[0];
+        val=databuf[1];
+        mutex_lock(&aw8697->lock);
+        aw8697_haptic_swicth_motorprotect_config(aw8697, addr, val);
+        mutex_unlock(&aw8697->lock);
+   }
+    return count;
+}
+static ssize_t aw8697_trig_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    unsigned char i = 0;
+    for(i=0; i<AW8697_TRIG_NUM; i++) {
+        len += snprintf(buf+len, PAGE_SIZE-len,
+            "trig%d: enable=%d, default_level=%d, dual_edge=%d, frist_seq=%d, second_seq=%d\n",
+            i+1, aw8697->trig[i].enable, aw8697->trig[i].default_level, aw8697->trig[i].dual_edge,
+            aw8697->trig[i].frist_seq, aw8697->trig[i].second_seq);
+    }
+
+    return len;
+}
+
+static ssize_t aw8697_trig_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+    #ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+    #else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+    #endif
+    unsigned int databuf[6] = {0};
+    if(sscanf(buf, "%d %d %d %d %d %d",
+            &databuf[0], &databuf[1], &databuf[2], &databuf[3], &databuf[4], &databuf[5])) {
+        pr_info("%s: %d, %d, %d, %d, %d, %d\n", __func__,
+            databuf[0], databuf[1], databuf[2], databuf[3], databuf[4], databuf[5]);
+        if(databuf[0] > 3) {
+            databuf[0] = 3;
+        }
+        if(databuf[0] > 0) {
+            databuf[0] -= 1;
+        }
+        aw8697->trig[databuf[0]].enable = databuf[1];
+        aw8697->trig[databuf[0]].default_level = databuf[2];
+        aw8697->trig[databuf[0]].dual_edge = databuf[3];
+        aw8697->trig[databuf[0]].frist_seq = databuf[4];
+        aw8697->trig[databuf[0]].second_seq = databuf[5];
+        mutex_lock(&aw8697->lock);
+        aw8697_haptic_trig_param_config(aw8697);
+        aw8697_haptic_trig_enable_config(aw8697);
+        mutex_unlock(&aw8697->lock);
+   }
+    return count;
+}
+
+static ssize_t aw8697_ram_vbat_comp_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+
+    len += snprintf(buf+len, PAGE_SIZE-len, "ram_vbat_comp=%d\n", aw8697->ram_vbat_comp);
+
+    return len;
+}
+
+
+static ssize_t aw8697_ram_vbat_comp_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    mutex_lock(&aw8697->lock);
+    if(val) {
+        aw8697->ram_vbat_comp = AW8697_HAPTIC_RAM_VBAT_COMP_ENABLE;
+    } else {
+        aw8697->ram_vbat_comp = AW8697_HAPTIC_RAM_VBAT_COMP_DISABLE;
+    }
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_haptic_osc_data_show(struct device *dev, struct device_attribute *attr,
+char *buf)
+{
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+	ssize_t len = 0;
+
+	len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8697->lra_calib_data);
+
+	return len;
+}
+
+
+static ssize_t aw8697_osc_data_store(struct device *dev, struct device_attribute *attr,
+const char *buf, size_t count)
+{
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+	unsigned int val = 0;
+	int rc = 0;
+
+	rc = kstrtouint(buf, 0, &val);
+	pr_info("%s: vqal:\n", __func__, val);
+	if (rc < 0)
+	return rc;
+	mutex_lock(&aw8697->lock);
+	pr_info("%s: val:%d\n", __func__, val);
+	if(val)
+		aw8697_i2c_write(aw8697, AW8697_REG_TRIM_LRA, (char)val);
+	mutex_unlock(&aw8697->lock);
+	return count;
+}
+
+static ssize_t aw8697_osc_cali_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+	ssize_t len = 0;
+
+	len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8697->microsecond);
+	return len;
+}
+
+static ssize_t aw8697_osc_cali_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int val = 0;
+
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    mutex_lock(&aw8697->lock);
+    if(val == 3){
+        aw8697_haptic_osc_set_default_trim(aw8697);
+        aw8697_rtp_osc_calibration(aw8697);
+        aw8697_rtp_trim_lra_calibration(aw8697);
+    }
+   if(val == 1)
+      aw8697_rtp_osc_calibration(aw8697);
+
+    mutex_unlock(&aw8697->lock);
+    return count;
+}
+
+static ssize_t aw8697_haptic_audio_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8697->haptic_audio.ctr.cnt);
+    return len;
+}
+
+static ssize_t aw8697_haptic_audio_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[6] = {0};
+    struct haptic_ctr *hap_ctr = NULL;
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+    if (!aw8697->ram_init)
+       return count;
+    if(6 == sscanf(buf, "%d %d %d %d %d %d", &databuf[0], &databuf[1], &databuf[2],
+            &databuf[3], &databuf[4], &databuf[5])) {
+	if (databuf[2]) {
+		pr_info("%s: cnt=%d, cmd=%d, play=%d, wavseq=%d, loop=%d, gain=%d\n",
+		        __func__, databuf[0], databuf[1], databuf[2], databuf[3],
+		        databuf[4], databuf[5]);
+	}
+
+	hap_ctr = (struct haptic_ctr *)kzalloc(
+		sizeof(struct haptic_ctr), GFP_KERNEL);
+	if (hap_ctr== NULL ) {
+		pr_err("%s: kzalloc memory fail\n", __func__);
+		return count;
+	}
+        mutex_lock(&aw8697->haptic_audio.lock);
+        hap_ctr->cnt = (unsigned char)databuf[0];
+        hap_ctr->cmd = (unsigned char)databuf[1];
+        hap_ctr->play = (unsigned char)databuf[2];
+        hap_ctr->wavseq = (unsigned char)databuf[3];
+        hap_ctr->loop = (unsigned char)databuf[4];
+        hap_ctr->gain = (unsigned char)databuf[5];
+        aw8697_haptic_audio_ctr_list_insert(&aw8697->haptic_audio, hap_ctr);
+
+        if(hap_ctr->cmd == 0xff) {
+            pr_info("%s: haptic_audio stop\n", __func__);
+            if(hrtimer_active(&aw8697->haptic_audio.timer)) {
+                pr_info("%s: cancel haptic_audio_timer\n", __func__);
+                hrtimer_cancel(&aw8697->haptic_audio.timer);
+                aw8697->haptic_audio.ctr.cnt = 0;
+                aw8697_haptic_audio_off(aw8697);
+            }
+        } else {
+            if(hrtimer_active(&aw8697->haptic_audio.timer)) {
+            } else {
+                pr_info("%s: start haptic_audio_timer\n", __func__);
+                aw8697_haptic_audio_init(aw8697);
+                hrtimer_start(&aw8697->haptic_audio.timer,
+                        ktime_set(aw8697->haptic_audio.delay_val/1000000,
+                                (aw8697->haptic_audio.delay_val%1000000)*1000),
+                        HRTIMER_MODE_REL);
+            }
+        }
+        mutex_unlock(&aw8697->haptic_audio.lock);
+	kfree(hap_ctr);
+    }
+    return count;
+}
+
+
+static ssize_t aw8697_haptic_audio_time_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "haptic_audio.delay_val=%dus\n", aw8697->haptic_audio.delay_val);
+    len += snprintf(buf+len, PAGE_SIZE-len, "haptic_audio.timer_val=%dus\n", aw8697->haptic_audio.timer_val);
+    return len;
+}
+
+static ssize_t aw8697_haptic_audio_time_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0};
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+    if(2 == sscanf(buf, "%d %d", &databuf[0], &databuf[1])) {
+        aw8697->haptic_audio.delay_val = databuf[0];
+        aw8697->haptic_audio.timer_val = databuf[1];
+    }
+    return count;
+}
+
+static ssize_t aw8697_haptic_audio_tp_time_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	struct tp *tp = &(aw8697->haptic_audio.tp);
+	ssize_t len = 0;
+	len += snprintf(buf+len, PAGE_SIZE-len, "tp->press_delay_min=%dus\n", tp->press_delay_min);
+	len += snprintf(buf+len, PAGE_SIZE-len, "tp->press_delay_max=%dus\n", tp->press_delay_max);
+	len += snprintf(buf+len, PAGE_SIZE-len, "tp->release_delay_max=%dus\n", tp->release_delay_max);
+	len += snprintf(buf+len, PAGE_SIZE-len, "tp->no_play_cnt_max=%d\n", tp->no_play_cnt_max);
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_tp_time_store(struct device *dev, struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	unsigned int databuf[4] = {0};
+	struct tp *tp = &(aw8697->haptic_audio.tp);
+
+	if (aw8697->rtp_on)
+		return count;
+	if (!aw8697->ram_init)
+		return count;
+
+	if(4 == sscanf(buf, "%d %d %d %d", &databuf[0], &databuf[1], &databuf[2], &databuf[3])) {
+		tp->press_delay_min = databuf[0];
+		tp->press_delay_max = databuf[1];
+		tp->release_delay_max = databuf[2];
+		tp->no_play_cnt_max= databuf[3];
+		pr_info("tp->press_delay_min=%dus\n", tp->press_delay_min);
+		pr_info("tp->press_delay_max=%dus\n", tp->press_delay_max);
+		pr_info("tp->release_delay_max=%dus\n", tp->release_delay_max);
+		pr_info("tp->no_play_cnt_max=%dus\n", tp->no_play_cnt_max);
+	}
+	return count;
+}
+
+
+static ssize_t aw8697_haptic_audio_tp_input_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	//struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	//struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	//struct led_classdev *cdev = dev_get_drvdata(dev);
+	//struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	ssize_t len = 0;
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_tp_input_store(struct device *dev, struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	struct tp_input_info tp_input;
+	struct tp *tp = &(aw8697->haptic_audio.tp);
+	struct haptic_audio *haptic_audio = NULL;
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+
+	if (aw8697->rtp_on)
+		return count;
+	if (!aw8697->ram_init)
+		return count;
+
+	haptic_audio = &(aw8697->haptic_audio);
+
+	if (count != sizeof(struct tp_input_info)) {
+		pr_err("%s: unmatch buf len, node_len=%d, struct len=%d\n",
+			__func__, count, sizeof(struct tp_input_info));
+		return count;
+	}
+
+	memcpy(&tp_input, buf, sizeof(struct tp_input_info));
+	pr_debug("%s: id[%d]: status=%d, x=%d, y=%d\n",
+		__func__, tp_input.id, tp_input.status, tp_input.x, tp_input.y);
+
+	mutex_lock(&aw8697->haptic_audio.lock);
+	if((AW8697_HAPTIC_TP_ST_PRESS == tp_input.status) &&
+		(tp_input.status != tp->id[tp_input.id].pt_info.status)) {
+		tp->tp_ai_check_flag = 1;
+		tp->id[tp_input.id].tp_ai_match_flag = 0;
+		list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+			if ((tp_input.x+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W > p_tmp->x) &&
+				(tp_input.x < p_tmp->x+p_tmp->w+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W) &&
+				(tp_input.y+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H > p_tmp->y) &&
+				(tp_input.y < p_tmp->y+p_tmp->h+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H)) {
+				pr_info("%s: tp input point[%d, %04d, %04d] is in the ai trust zone[%d, %04d, %04d, %04d, %04d]\n",
+					__func__, tp_input.id, tp_input.x, tp_input.y,
+					p_tmp->level, p_tmp->x, p_tmp->y, p_tmp->w, p_tmp->h);
+				tp->id[tp_input.id].tp_ai_match_flag = 1;
+				do_gettimeofday(&tp->id[AW8697_HAPTIC_TP_ID_MAX].t_press);
+				tp->virtual_id = tp_input.id;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.id = tp_input.id;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.x = tp_input.x;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.y = tp_input.y;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.status = tp_input.status;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_VAIL;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.touch_outside_tz_flag = AW8697_HAPTIC_TP_TOUCH_VAIL;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].tp_flag = AW8697_HAPTIC_TP_PRESS;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].press_flag = AW8697_HAPTIC_TP_PRESS;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].release_flag = AW8697_HAPTIC_TP_NULL;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].no_play_cnt = 0;
+				tp->id[AW8697_HAPTIC_TP_ID_MAX].press_no_vibrate_flag = 0;
+				break;
+			}
+		}
+		if (tp->id[tp_input.id].tp_ai_match_flag == 0) {
+			pr_info("%s: tp input point[%d, %04d, %04d] is out the trust zone\n",
+				__func__, tp_input.id, tp_input.x, tp_input.y);
+		}
+		tp->id[tp_input.id].pt_info.id = tp_input.id;
+		tp->id[tp_input.id].pt_info.x = tp_input.x;
+		tp->id[tp_input.id].pt_info.y = tp_input.y;
+		tp->id[tp_input.id].pt_info.status = tp_input.status;
+		tp->id[tp_input.id].pt_info.touch_flag = AW8697_HAPTIC_TP_TOUCH_VAIL;
+		tp->id[tp_input.id].pt_info.touch_outside_tz_flag = AW8697_HAPTIC_TP_TOUCH_VAIL;
+		tp->id[tp_input.id].tp_flag = AW8697_HAPTIC_TP_PRESS;
+		tp->id[tp_input.id].press_flag = AW8697_HAPTIC_TP_PRESS;
+		tp->id[tp_input.id].release_flag = AW8697_HAPTIC_TP_NULL;
+		tp->id[tp_input.id].no_play_cnt = 0;
+		tp->id[tp_input.id].press_no_vibrate_flag = 0;
+		do_gettimeofday(&tp->id[tp_input.id].t_press);
+		pr_debug("%s: tp_press_release: status=%d, flag=%d",
+			__func__, tp->id[tp_input.id].pt_info.status, tp->id[tp_input.id].tp_flag);
+	}
+
+	if((AW8697_HAPTIC_TP_ST_RELEASE == tp_input.status) &&
+		(tp_input.status != tp->id[tp_input.id].pt_info.status)) {
+		list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+			if ((tp->id[tp_input.id].pt_info.x+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W > p_tmp->x) &&
+				(tp->id[tp_input.id].pt_info.x < p_tmp->x+p_tmp->w+AW8697_HAPTIC_AI_X_JITTER*p_tmp->w/AW8697_HAPTIC_AI_X_DFT_W) &&
+				(tp->id[tp_input.id].pt_info.y+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H > p_tmp->y) &&
+				(tp->id[tp_input.id].pt_info.y < p_tmp->y+p_tmp->h+AW8697_HAPTIC_AI_Y_JITTER*p_tmp->h/AW8697_HAPTIC_AI_Y_DFT_H)) {
+				pr_info("%s: tp input point[%d, %04d, %04d] up is in the ai trust zone[%d, %04d, %04d, %04d, %04d]\n",
+					__func__, tp->id[tp_input.id].pt_info.id, tp->id[tp_input.id].pt_info.x, tp->id[tp_input.id].pt_info.y,
+					p_tmp->level, p_tmp->x, p_tmp->y, p_tmp->w, p_tmp->h);
+				if(tp->virtual_id == tp_input.id) {
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.id = tp->id[tp_input.id].pt_info.id;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.x = tp->id[tp_input.id].pt_info.x;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.y = tp->id[tp_input.id].pt_info.y;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].pt_info.status = tp_input.status;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].tp_flag = AW8697_HAPTIC_TP_RELEASE;
+					tp->id[AW8697_HAPTIC_TP_ID_MAX].release_flag = AW8697_HAPTIC_TP_RELEASE;
+					do_gettimeofday(&tp->id[AW8697_HAPTIC_TP_ID_MAX].t_release);
+				}
+				break;
+			}
+		}
+		tp->id[tp_input.id].pt_info.status = tp_input.status;
+		tp->id[tp_input.id].tp_flag = AW8697_HAPTIC_TP_RELEASE;
+		tp->id[tp_input.id].release_flag = AW8697_HAPTIC_TP_RELEASE;
+		do_gettimeofday(&tp->id[tp_input.id].t_release);
+		pr_info("%s: tp input point[%d, %04d, %04d] up to [%d, %04d, %04d] \n",
+			__func__, tp_input.id, tp->id[tp_input.id].pt_info.x, tp->id[tp_input.id].pt_info.y,
+			tp_input.id, tp_input.x, tp_input.y);
+		pr_debug("%s: tp_press_release: status=%d, flag=%d",
+			__func__, tp->id[tp_input.id].pt_info.status, tp->id[tp_input.id].tp_flag);
+	}
+	mutex_unlock(&aw8697->haptic_audio.lock);
+
+
+	return count;
+}
+
+static ssize_t aw8697_haptic_audio_ai_input_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	struct haptic_audio *haptic_audio = NULL;
+	struct haptic_audio_trust_zone *p_tmp = NULL;
+	char *p_ai_data = NULL;
+	ssize_t len = 0;
+	int i = 0;
+	uint8_t ai_tz_num = 0;
+
+	mutex_lock(&aw8697->haptic_audio.lock);
+	haptic_audio = &(aw8697->haptic_audio);
+	ai_tz_num = 0;
+
+	list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+		ai_tz_num ++;
+	}
+	pr_info("%s: ai_tz_num=%d\n", __func__, ai_tz_num);
+
+	p_ai_data = (char *) kzalloc(sizeof(uint8_t) + ai_tz_num * sizeof(struct ai_trust_zone), GFP_KERNEL);
+	if (!p_ai_data) {
+		pr_err("%s: p_ai_data error allocating memory\n", __func__);
+		mutex_unlock(&aw8697->haptic_audio.lock);
+		return len;
+	}
+
+	memcpy(&p_ai_data[len], &ai_tz_num, sizeof(ai_tz_num));
+	len += sizeof(ai_tz_num);
+
+	list_for_each_entry(p_tmp, &(haptic_audio->list), list) {
+		haptic_audio->output_tz_info[i].level = p_tmp->level;
+		haptic_audio->output_tz_info[i].x = p_tmp->x;
+		haptic_audio->output_tz_info[i].y = p_tmp->y;
+		haptic_audio->output_tz_info[i].w = p_tmp->w;
+		haptic_audio->output_tz_info[i].h = p_tmp->h;
+		memcpy(&p_ai_data[len], &haptic_audio->output_tz_info[i], sizeof(struct trust_zone_info));
+		len += sizeof(struct trust_zone_info);
+		pr_info("%s: trust zone [%d]: level=%d, x=%d, y=%d, w=%d, h=%d\n",
+			__func__, i, haptic_audio->output_tz_info[i].level,
+			haptic_audio->output_tz_info[i].x, haptic_audio->output_tz_info[i].y,
+			haptic_audio->output_tz_info[i].w, haptic_audio->output_tz_info[i].h);
+		i ++;
+	}
+	memcpy(buf, p_ai_data, len);
+
+	kfree(p_ai_data);
+	mutex_unlock(&aw8697->haptic_audio.lock);
+
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_ai_input_store(struct device *dev, struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	int ret = -1;
+	unsigned int i = 0;
+	struct ai_trust_zone *ai_tz = NULL;
+	struct trust_zone_info *ai_tz_info = NULL;
+	struct haptic_audio *haptic_audio = NULL;
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+	haptic_audio = &(aw8697->haptic_audio);
+
+	if (count != sizeof(struct ai_trust_zone)) {
+		pr_err("%s: unmatch buf len, node_len=%d, struct len=%d\n",
+			__func__, count, sizeof(struct ai_trust_zone));
+		return count;
+	}
+
+	mutex_lock(&aw8697->haptic_audio.lock);
+	ai_tz = kzalloc(sizeof(struct ai_trust_zone), GFP_KERNEL);
+	if (!ai_tz) {
+		pr_err("%s: ai_tz error allocating memory\n", __func__);
+		mutex_unlock(&aw8697->haptic_audio.lock);
+		return count;
+	}
+	memcpy(ai_tz, buf, sizeof(struct ai_trust_zone));
+	pr_info("%s: ai_tz num=%d\n", __func__, ai_tz->num);
+
+	ai_tz_info = kzalloc(ai_tz->num * sizeof(struct trust_zone_info), GFP_KERNEL);
+	if (!ai_tz_info) {
+		pr_err("%s: ai_tz_info error allocating memory\n", __func__);
+		mutex_unlock(&aw8697->haptic_audio.lock);
+		return count;
+	}
+	ret = copy_from_user(ai_tz_info, ai_tz->tz_info, ai_tz->num * sizeof(struct trust_zone_info));
+	if (ret) {
+		kfree(ai_tz_info);
+		kfree(ai_tz);
+		dev_err(aw8697->dev, "%s: copy from user fail\n", __func__);
+		mutex_unlock(&aw8697->haptic_audio.lock);
+		return count;
+	}
+
+	aw8697->haptic_audio.tz_high_num = 0;
+	aw8697->haptic_audio.hap_cnt_outside_tz = 0;
+	if(ai_tz->num == 2) {
+		aw8697->haptic_audio.uevent_report_flag = 1;
+	} else {
+		aw8697->haptic_audio.uevent_report_flag = 0;
+	}
+
+	/* clear unused list link */
+	aw8697_haptic_audio_tz_list_clear(&aw8697->haptic_audio);
+
+	for (i=0; i<ai_tz->num; i++) {
+		pr_debug("%s: trust zone [%d]: level=%d, x=%d, y=%d, w=%d, h=%d\n",
+			__func__, i, ai_tz_info[i].level,
+			ai_tz_info[i].x, ai_tz_info[i].y,
+			ai_tz_info[i].w, ai_tz_info[i].h);
+
+		aw8697_haptic_audio_tz_list_insert(haptic_audio, &ai_tz_info[i]);
+	}
+	aw8697_haptic_audio_tz_list_show(haptic_audio);
+
+	kfree(ai_tz_info);
+	kfree(ai_tz);
+
+	mutex_unlock(&aw8697->haptic_audio.lock);
+	return count;
+}
+
+static ssize_t aw8697_haptic_audio_tp_size_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	struct haptic_audio_tp_size *tp_size = NULL;
+	ssize_t len = 0;
+
+	tp_size = &(aw8697->haptic_audio.tp_size);
+
+	len += snprintf(buf+len, PAGE_SIZE-len, "tp_size: x=%04d, y=%04d\n", tp_size->x, tp_size->y);
+
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_tp_size_store(struct device *dev, struct device_attribute *attr,
+		const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	struct haptic_audio_tp_size *tp_size = NULL;
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+	tp_size = &(aw8697->haptic_audio.tp_size);
+
+	if (count != sizeof(struct haptic_audio_tp_size)) {
+		pr_err("%s: unmatch buf len, node_len=%d, struct len=%d\n",
+			__func__, count, sizeof(struct haptic_audio_tp_size));
+		return count;
+	}
+
+	memcpy(tp_size, buf, sizeof(struct haptic_audio_tp_size));
+	pr_info("%s: tp_size: x=%d, y=%d\n",
+		__func__, tp_size->x, tp_size->y);
+
+
+	return count;
+}
+
+static ssize_t aw8697_haptic_audio_tz_cnt_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	ssize_t len = 0;
+	len += snprintf(buf+len, PAGE_SIZE-len, "tz_cnt_thr=%d\n", aw8697->haptic_audio.tz_cnt_thr);
+	len += snprintf(buf+len, PAGE_SIZE-len, "tz_cnt_max=%d\n", aw8697->haptic_audio.tz_cnt_max);
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_tz_cnt_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[2] = {0};
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+    if(2 == sscanf(buf, "%d %d", &databuf[0], &databuf[1])) {
+        aw8697->haptic_audio.tz_cnt_thr = databuf[0];
+        aw8697->haptic_audio.tz_cnt_max = databuf[1];
+    }
+    return count;
+}
+
+
+static ssize_t aw8697_haptic_audio_hap_cnt_max_outside_tz_show(struct device *dev, struct device_attribute *attr,
+		char *buf)
+{
+#ifdef TIMED_OUTPUT
+	struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+	struct led_classdev *cdev = dev_get_drvdata(dev);
+	struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+	ssize_t len = 0;
+	len += snprintf(buf+len, PAGE_SIZE-len, "hap_cnt_max_outside_tz=%d\n", aw8697->haptic_audio.hap_cnt_max_outside_tz);
+	return len;
+}
+
+static ssize_t aw8697_haptic_audio_hap_cnt_max_outside_tz_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(to_dev, struct aw8697, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8697 *aw8697 = container_of(cdev, struct aw8697, cdev);
+#endif
+    unsigned int databuf[1] = {0};
+
+    if (aw8697->rtp_on)
+       return count;
+    if (!aw8697->ram_init)
+       return count;
+
+    if(1 == sscanf(buf, "%d", &databuf[0])) {
+        aw8697->haptic_audio.hap_cnt_max_outside_tz = databuf[0];
+    }
+    return count;
+}
+
+static DEVICE_ATTR(state, S_IWUSR | S_IRUGO, aw8697_state_show, aw8697_state_store);
+static DEVICE_ATTR(duration, S_IWUSR | S_IRUGO, aw8697_duration_show, aw8697_duration_store);
+static DEVICE_ATTR(activate, S_IWUSR | S_IRUGO, aw8697_activate_show, aw8697_activate_store);
+static DEVICE_ATTR(activate_mode, S_IWUSR | S_IRUGO, aw8697_activate_mode_show, aw8697_activate_mode_store);
+static DEVICE_ATTR(index, S_IWUSR | S_IRUGO, aw8697_index_show, aw8697_index_store);
+static DEVICE_ATTR(vmax, S_IWUSR | S_IRUGO, aw8697_vmax_show, aw8697_vmax_store);
+static DEVICE_ATTR(gain, S_IWUSR | S_IRUGO, aw8697_gain_show, aw8697_gain_store);
+static DEVICE_ATTR(seq, S_IWUSR | S_IRUGO, aw8697_seq_show, aw8697_seq_store);
+static DEVICE_ATTR(loop, S_IWUSR | S_IRUGO, aw8697_loop_show, aw8697_loop_store);
+static DEVICE_ATTR(register, S_IWUSR | S_IRUGO, aw8697_reg_show, aw8697_reg_store);
+static DEVICE_ATTR(rtp, S_IWUSR | S_IRUGO, aw8697_rtp_show, aw8697_rtp_store);
+static DEVICE_ATTR(ram_update, S_IWUSR | S_IRUGO, aw8697_ram_update_show, aw8697_ram_update_store);
+static DEVICE_ATTR(rf_hz, S_IWUSR | S_IRUGO, aw8697_f0_show, aw8697_f0_store);
+static DEVICE_ATTR(cali, S_IWUSR | S_IRUGO, aw8697_cali_show, aw8697_cali_store);
+static DEVICE_ATTR(cont, S_IWUSR | S_IRUGO, aw8697_cont_show, aw8697_cont_store);
+static DEVICE_ATTR(cont_td, S_IWUSR | S_IRUGO, aw8697_cont_td_show, aw8697_cont_td_store);
+static DEVICE_ATTR(cont_drv, S_IWUSR | S_IRUGO, aw8697_cont_drv_show, aw8697_cont_drv_store);
+static DEVICE_ATTR(cont_num_brk, S_IWUSR | S_IRUGO, aw8697_cont_num_brk_show, aw8697_cont_num_brk_store);
+static DEVICE_ATTR(cont_zc_thr, S_IWUSR | S_IRUGO, aw8697_cont_zc_thr_show, aw8697_cont_zc_thr_store);
+static DEVICE_ATTR(vbat_monitor, S_IWUSR | S_IRUGO, aw8697_vbat_monitor_show, aw8697_vbat_monitor_store);
+static DEVICE_ATTR(lra_resistance, S_IWUSR | S_IRUGO, aw8697_lra_resistance_show, aw8697_lra_resistance_store);
+static DEVICE_ATTR(auto_boost, S_IWUSR | S_IRUGO, aw8697_auto_boost_show, aw8697_auto_boost_store);
+static DEVICE_ATTR(prctmode, S_IWUSR | S_IRUGO, aw8697_prctmode_show, aw8697_prctmode_store);
+static DEVICE_ATTR(trig, S_IWUSR | S_IRUGO, aw8697_trig_show, aw8697_trig_store);
+static DEVICE_ATTR(ram_vbat_comp, S_IWUSR | S_IRUGO, aw8697_ram_vbat_comp_show, aw8697_ram_vbat_comp_store);
+static DEVICE_ATTR(osc_cali, S_IWUSR | S_IRUGO, aw8697_osc_cali_show, aw8697_osc_cali_store);
+static DEVICE_ATTR(haptic_audio, S_IWUSR | S_IRUGO, aw8697_haptic_audio_show, aw8697_haptic_audio_store);
+static DEVICE_ATTR(haptic_audio_time, S_IWUSR | S_IRUGO, aw8697_haptic_audio_time_show, aw8697_haptic_audio_time_store);
+static DEVICE_ATTR(haptic_audio_tp_time, S_IWUSR | S_IRUGO, aw8697_haptic_audio_tp_time_show, aw8697_haptic_audio_tp_time_store);
+static DEVICE_ATTR(haptic_audio_tp_input, S_IWUSR | S_IRUGO, aw8697_haptic_audio_tp_input_show, aw8697_haptic_audio_tp_input_store);
+static DEVICE_ATTR(haptic_audio_ai_input, S_IWUSR | S_IRUGO, aw8697_haptic_audio_ai_input_show, aw8697_haptic_audio_ai_input_store);
+static DEVICE_ATTR(haptic_audio_tp_size, S_IWUSR | S_IRUGO, aw8697_haptic_audio_tp_size_show, aw8697_haptic_audio_tp_size_store);
+static DEVICE_ATTR(haptic_audio_tz_cnt, S_IWUSR | S_IRUGO, aw8697_haptic_audio_tz_cnt_show, aw8697_haptic_audio_tz_cnt_store);
+static DEVICE_ATTR(haptic_audio_hap_cnt_max_outside_tz, S_IWUSR | S_IRUGO, aw8697_haptic_audio_hap_cnt_max_outside_tz_show, aw8697_haptic_audio_hap_cnt_max_outside_tz_store);
+static DEVICE_ATTR(haptic_osc_data, S_IWUSR | S_IRUGO, aw8697_haptic_osc_data_show, aw8697_osc_data_store);
+
+static struct attribute *aw8697_vibrator_attributes[] = {
+    &dev_attr_state.attr,
+    &dev_attr_duration.attr,
+    &dev_attr_activate.attr,
+    &dev_attr_activate_mode.attr,
+    &dev_attr_index.attr,
+    &dev_attr_vmax.attr,
+    &dev_attr_gain.attr,
+    &dev_attr_seq.attr,
+    &dev_attr_loop.attr,
+    &dev_attr_register.attr,
+    &dev_attr_rtp.attr,
+    &dev_attr_ram_update.attr,
+    &dev_attr_rf_hz.attr,
+    &dev_attr_cali.attr,
+    &dev_attr_cont.attr,
+    &dev_attr_cont_td.attr,
+    &dev_attr_cont_drv.attr,
+    &dev_attr_cont_num_brk.attr,
+    &dev_attr_cont_zc_thr.attr,
+    &dev_attr_vbat_monitor.attr,
+    &dev_attr_lra_resistance.attr,
+    &dev_attr_auto_boost.attr,
+    &dev_attr_prctmode.attr,
+    &dev_attr_trig.attr,
+    &dev_attr_ram_vbat_comp.attr,
+    &dev_attr_osc_cali.attr,
+    &dev_attr_haptic_audio.attr,
+    &dev_attr_haptic_audio_time.attr,
+    &dev_attr_haptic_audio_tp_time.attr,
+    &dev_attr_haptic_audio_tp_input.attr,
+    &dev_attr_haptic_audio_ai_input.attr,
+    &dev_attr_haptic_audio_tp_size.attr,
+    &dev_attr_haptic_audio_tz_cnt.attr,
+    &dev_attr_haptic_audio_hap_cnt_max_outside_tz.attr,
+    &dev_attr_haptic_osc_data.attr,
+    NULL
+};
+
+static struct attribute_group aw8697_vibrator_attribute_group = {
+    .attrs = aw8697_vibrator_attributes
+};
+
+static enum hrtimer_restart aw8697_vibrator_timer_func(struct hrtimer *timer)
+{
+    struct aw8697 *aw8697 = container_of(timer, struct aw8697, timer);
+
+    pr_debug("%s enter\n", __func__);
+    aw8697->state = 0;
+    schedule_work(&aw8697->vibrator_work);
+
+    return HRTIMER_NORESTART;
+}
+
+static void aw8697_vibrator_work_routine(struct work_struct *work)
+{
+    struct aw8697 *aw8697 = container_of(work, struct aw8697, vibrator_work);
+    unsigned val = 0;
+    pr_debug("%s enter\n", __func__);
+
+    mutex_lock(&aw8697->lock);
+
+    aw8697_haptic_stop(aw8697);
+    if(aw8697->state) {
+        if(aw8697->activate_mode == AW8697_HAPTIC_ACTIVATE_RAM_MODE) {
+            aw8697_haptic_ram_vbat_comp(aw8697, true);
+            aw8697_haptic_play_repeat_seq(aw8697, true);
+        } else if(aw8697->activate_mode == AW8697_HAPTIC_ACTIVATE_CONT_MODE) {
+            aw8697_haptic_cont(aw8697);
+        } else {
+        }
+        val = aw8697->duration;
+        /* run ms timer */
+        hrtimer_start(&aw8697->timer,
+                  ktime_set(val / 1000, (val % 1000) * 1000000),
+                  HRTIMER_MODE_REL);
+    }
+    mutex_unlock(&aw8697->lock);
+}
+
+static int aw8697_vibrator_init(struct aw8697 *aw8697)
+{
+    int ret = 0;
+
+    pr_info("%s enter\n", __func__);
+
+#ifdef TIMED_OUTPUT
+    aw8697->to_dev.name = "vibrator";
+    aw8697->to_dev.get_time = aw8697_vibrator_get_time;
+    aw8697->to_dev.enable = aw8697_vibrator_enable;
+
+    ret = timed_output_dev_register(&(aw8697->to_dev));
+    if ( ret < 0){
+        dev_err(aw8697->dev, "%s: fail to create timed output dev\n",
+                __func__);
+        return ret;
+    }
+    ret = sysfs_create_group(&aw8697->to_dev.dev->kobj, &aw8697_vibrator_attribute_group);
+    if (ret < 0) {
+        dev_err(aw8697->dev, "%s error creating sysfs attr files\n", __func__);
+        return ret;
+    }
+#else
+    aw8697->cdev.name = "vibrator";
+    aw8697->cdev.brightness_get = aw8697_haptic_brightness_get;
+    aw8697->cdev.brightness_set = aw8697_haptic_brightness_set;
+
+    ret = devm_led_classdev_register(&aw8697->i2c->dev, &aw8697->cdev);
+    if (ret < 0){
+        dev_err(aw8697->dev, "%s: fail to create led dev\n",
+                __func__);
+        return ret;
+    }
+    ret = sysfs_create_group(&aw8697->cdev.dev->kobj, &aw8697_vibrator_attribute_group);
+    if (ret < 0) {
+        dev_err(aw8697->dev, "%s error creating sysfs attr files\n", __func__);
+        return ret;
+     }
+#endif
+    hrtimer_init(&aw8697->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+    aw8697->timer.function = aw8697_vibrator_timer_func;
+    INIT_WORK(&aw8697->vibrator_work, aw8697_vibrator_work_routine);
+
+    INIT_WORK(&aw8697->rtp_work, aw8697_rtp_work_routine);
+
+    mutex_init(&aw8697->lock);
+    mutex_init(&aw8697->rtp_lock);
+
+    return 0;
+}
+
+
+
+
+/******************************************************
+ *
+ * irq
+ *
+ ******************************************************/
+static void aw8697_interrupt_clear(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+    pr_debug("%s enter\n", __func__);
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+    pr_debug("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+}
+
+static void aw8697_interrupt_setup(struct aw8697 *aw8697)
+{
+    unsigned char reg_val = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+    pr_info("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+
+    /* edge int mode */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_DBGCTRL,
+            AW8697_BIT_DBGCTRL_INT_MODE_MASK, AW8697_BIT_DBGCTRL_INT_MODE_EDGE);
+
+    /* int enable */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_BSTERR_MASK, AW8697_BIT_SYSINTM_BSTERR_OFF);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_OV_MASK, AW8697_BIT_SYSINTM_OV_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_UVLO_MASK, AW8697_BIT_SYSINTM_UVLO_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_OCD_MASK, AW8697_BIT_SYSINTM_OCD_EN);
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSINTM,
+            AW8697_BIT_SYSINTM_OT_MASK, AW8697_BIT_SYSINTM_OT_EN);
+}
+
+static irqreturn_t aw8697_irq(int irq, void *data)
+{
+    struct aw8697 *aw8697 = data;
+    unsigned char reg_val = 0;
+    unsigned char dbg_val = 0;
+    unsigned int buf_len = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+    pr_info("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+    aw8697_i2c_read(aw8697, AW8697_REG_DBGSTAT, &dbg_val);
+    pr_info("%s: reg DBGSTAT=0x%x\n", __func__, dbg_val);
+
+    if(reg_val & AW8697_BIT_SYSINT_OVI) {
+		aw8697_op_clean_status(aw8697);
+        pr_err("%s chip ov int error\n", __func__);
+    }
+    if(reg_val & AW8697_BIT_SYSINT_UVLI) {
+		aw8697_op_clean_status(aw8697);
+        pr_err("%s chip uvlo int error\n", __func__);
+    }
+    if(reg_val & AW8697_BIT_SYSINT_OCDI) {
+		aw8697_op_clean_status(aw8697);
+        pr_err("%s chip over current int error\n", __func__);
+    }
+    if(reg_val & AW8697_BIT_SYSINT_OTI) {
+		aw8697_op_clean_status(aw8697);
+        pr_err("%s chip over temperature int error\n", __func__);
+    }
+    if(reg_val & AW8697_BIT_SYSINT_DONEI) {
+		aw8697_op_clean_status(aw8697);
+        pr_info("%s chip playback done\n", __func__);
+    }
+
+    if(reg_val & AW8697_BIT_SYSINT_FF_AEI) {
+        pr_debug("%s: aw8697 rtp fifo almost empty int\n", __func__);
+        if(aw8697->rtp_init) {
+            while((!aw8697_haptic_rtp_get_fifo_afi(aw8697)) &&
+                    (aw8697->play_mode == AW8697_HAPTIC_RTP_MODE)) {
+                mutex_lock(&aw8697->rtp_lock);
+                pr_info("%s: aw8697 rtp mode fifo update, cnt=%d\n",
+                        __func__, aw8697->rtp_cnt);
+                if (!aw8697_rtp) {
+                   pr_info("%s:aw8697_rtp is null break\n",
+                        __func__);
+                   mutex_unlock(&aw8697->rtp_lock);
+                   break;
+                }
+                if((aw8697_rtp->len-aw8697->rtp_cnt) < (aw8697->ram.base_addr>>2)) {
+                    buf_len = aw8697_rtp->len-aw8697->rtp_cnt;
+                } else {
+                    buf_len = (aw8697->ram.base_addr>>2);
+                }
+                aw8697_i2c_writes(aw8697, AW8697_REG_RTP_DATA,
+                        &aw8697_rtp->data[aw8697->rtp_cnt], buf_len);
+                aw8697->rtp_cnt += buf_len;
+                if(aw8697->rtp_cnt == aw8697_rtp->len) {
+                    aw8697_op_clean_status(aw8697);
+                    pr_info("%s: rtp update complete\n", __func__);
+                    aw8697_haptic_set_rtp_aei(aw8697, false);
+                    aw8697->rtp_cnt = 0;
+                    aw8697->rtp_init = 0;
+                    mutex_unlock(&aw8697->rtp_lock);
+                    break;
+                }
+                mutex_unlock(&aw8697->rtp_lock);
+            }
+        } else {
+            pr_err("%s: aw8697 rtp init = %d, init error\n", __func__, aw8697->rtp_init);
+        }
+    }
+
+    if(reg_val & AW8697_BIT_SYSINT_FF_AFI) {
+        pr_debug("%s: aw8697 rtp mode fifo full empty\n", __func__);
+    }
+
+    if(aw8697->play_mode != AW8697_HAPTIC_RTP_MODE) {
+        aw8697_haptic_set_rtp_aei(aw8697, false);
+    }
+
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSINT, &reg_val);
+    pr_debug("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+    aw8697_i2c_read(aw8697, AW8697_REG_SYSST, &reg_val);
+    pr_debug("%s: reg SYSST=0x%x\n", __func__, reg_val);
+
+    pr_debug("%s exit\n", __func__);
+
+    return IRQ_HANDLED;
+}
+
+/*****************************************************
+ *
+ * device tree
+ *
+ *****************************************************/
+static int aw8697_parse_dt(struct device *dev, struct aw8697 *aw8697,
+        struct device_node *np) {
+    aw8697->reset_gpio = of_get_named_gpio(np, "reset-gpio", 0);
+    if (aw8697->reset_gpio < 0) {
+        dev_err(dev, "%s: no reset gpio provided, will not HW reset device\n", __func__);
+        return -1;
+    } else {
+        dev_info(dev, "%s: reset gpio provided ok\n", __func__);
+    }
+    aw8697->irq_gpio =  of_get_named_gpio(np, "irq-gpio", 0);
+    if (aw8697->irq_gpio < 0) {
+        dev_err(dev, "%s: no irq gpio provided.\n", __func__);
+    } else {
+        dev_info(dev, "%s: irq gpio provided ok.\n", __func__);
+    }
+
+    return 0;
+}
+
+static int aw8697_hw_reset(struct aw8697 *aw8697)
+{
+    pr_info("%s enter\n", __func__);
+
+    if (aw8697 && gpio_is_valid(aw8697->reset_gpio)) {
+        gpio_set_value_cansleep(aw8697->reset_gpio, 0);
+        msleep(1);
+        gpio_set_value_cansleep(aw8697->reset_gpio, 1);
+        msleep(1);
+    } else {
+        if (aw8697)
+           dev_err(aw8697->dev, "%s:  failed\n", __func__);
+    }
+    return 0;
+}
+
+
+/*****************************************************
+ *
+ * check chip id
+ *
+ *****************************************************/
+static int aw8697_read_chipid(struct aw8697 *aw8697)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+    unsigned char reg = 0;
+
+    while(cnt < AW_READ_CHIPID_RETRIES) {
+        /* hardware reset */
+        aw8697_hw_reset(aw8697);
+
+        ret = aw8697_i2c_read(aw8697, AW8697_REG_ID, &reg);
+        if (ret < 0) {
+            dev_err(aw8697->dev, "%s: failed to read register AW8697_REG_ID: %d\n", __func__, ret);
+        }
+        switch (reg) {
+        case AW8697_CHIPID:
+            pr_info("%s aw8697 detected\n", __func__);
+            aw8697->chipid = AW8697_CHIPID;
+            aw8697_haptic_softreset(aw8697);
+            return 0;
+        default:
+            pr_info("%s unsupported device revision (0x%x)\n", __func__, reg );
+            break;
+        }
+        cnt ++;
+
+        msleep(AW_READ_CHIPID_RETRY_DELAY);
+    }
+
+    return -EINVAL;
+}
+
+/******************************************************
+ *
+ * sys group attribute: reg
+ *
+ ******************************************************/
+static ssize_t aw8697_i2c_reg_store(struct device *dev, struct device_attribute *attr,
+                const char *buf, size_t count)
+{
+    struct aw8697 *aw8697 = dev_get_drvdata(dev);
+
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        aw8697_i2c_write(aw8697, (unsigned char)databuf[0], (unsigned char)databuf[1]);
+    }
+
+    return count;
+}
+
+static ssize_t aw8697_i2c_reg_show(struct device *dev, struct device_attribute *attr,
+                char *buf)
+{
+    struct aw8697 *aw8697 = dev_get_drvdata(dev);
+    ssize_t len = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    for(i = 0; i < AW8697_REG_MAX; i ++) {
+        if(!(aw8697_reg_access[i]&REG_RD_ACCESS))
+           continue;
+        aw8697_i2c_read(aw8697, i, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "reg:0x%02x=0x%02x \n", i, reg_val);
+    }
+    return len;
+}
+static ssize_t aw8697_i2c_ram_store(struct device *dev, struct device_attribute *attr,
+                const char *buf, size_t count)
+{
+    struct aw8697 *aw8697 = dev_get_drvdata(dev);
+
+    unsigned int databuf[1] = {0};
+
+    if(1 == sscanf(buf, "%x", &databuf[0])) {
+        if(1 == databuf[0]) {
+            aw8697_ram_update(aw8697);
+        }
+    }
+
+    return count;
+}
+
+static ssize_t aw8697_i2c_ram_show(struct device *dev, struct device_attribute *attr,
+                char *buf)
+{
+    struct aw8697 *aw8697 = dev_get_drvdata(dev);
+    ssize_t len = 0;
+    unsigned int i = 0;
+    unsigned char reg_val = 0;
+
+    mutex_lock(&aw8697->lock);
+    aw8697_haptic_stop(aw8697);
+    mutex_unlock(&aw8697->lock);
+    /* RAMINIT Enable */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_EN);
+
+    aw8697_i2c_write(aw8697, AW8697_REG_RAMADDRH, (unsigned char)(aw8697->ram.base_addr>>8));
+    aw8697_i2c_write(aw8697, AW8697_REG_RAMADDRL, (unsigned char)(aw8697->ram.base_addr&0x00ff));
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8697_haptic_ram:\n");
+    for(i=0; i<aw8697->ram.len; i++) {
+        aw8697_i2c_read(aw8697, AW8697_REG_RAMDATA, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "0x%02x,", reg_val);
+    }
+    len += snprintf(buf+len, PAGE_SIZE-len, "\n");
+    /* RAMINIT Disable */
+    aw8697_i2c_write_bits(aw8697, AW8697_REG_SYSCTRL,
+            AW8697_BIT_SYSCTRL_RAMINIT_MASK, AW8697_BIT_SYSCTRL_RAMINIT_OFF);
+
+    return len;
+}
+
+static DEVICE_ATTR(reg, S_IWUSR | S_IRUGO, aw8697_i2c_reg_show, aw8697_i2c_reg_store);
+static DEVICE_ATTR(ram, S_IWUSR | S_IRUGO, aw8697_i2c_ram_show, aw8697_i2c_ram_store);
+
+static struct attribute *aw8697_attributes[] = {
+    &dev_attr_reg.attr,
+    &dev_attr_ram.attr,
+    NULL
+};
+
+static struct attribute_group aw8697_attribute_group = {
+    .attrs = aw8697_attributes
+};
+
+
+/******************************************************
+ *
+ * i2c driver
+ *
+ ******************************************************/
+static int aw8697_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id)
+{
+    struct aw8697 *aw8697;
+    struct device_node *np = i2c->dev.of_node;
+    int irq_flags = 0;
+    int ret = -1;
+
+    pr_info("%s enter\n", __func__);
+
+    if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_I2C)) {
+        dev_err(&i2c->dev, "check_functionality failed\n");
+        return -EIO;
+    }
+
+    aw8697 = devm_kzalloc(&i2c->dev, sizeof(struct aw8697), GFP_KERNEL);
+    if (aw8697 == NULL)
+        return -ENOMEM;
+
+    aw8697->dev = &i2c->dev;
+    aw8697->i2c = i2c;
+
+    i2c_set_clientdata(i2c, aw8697);
+
+    /* aw8697 rst & int */
+    if (np) {
+        ret = aw8697_parse_dt(&i2c->dev, aw8697, np);
+        if (ret) {
+            dev_err(&i2c->dev, "%s: failed to parse device tree node\n", __func__);
+            goto err_parse_dt;
+        }
+    } else {
+        aw8697->reset_gpio = -1;
+        aw8697->irq_gpio = -1;
+    }
+
+    if (gpio_is_valid(aw8697->reset_gpio)) {
+        ret = devm_gpio_request_one(&i2c->dev, aw8697->reset_gpio,
+            GPIOF_OUT_INIT_LOW, "aw8697_rst");
+        if (ret){
+            dev_err(&i2c->dev, "%s: rst request failed\n", __func__);
+            goto err_reset_gpio_request;
+        }
+    }
+
+    if (gpio_is_valid(aw8697->irq_gpio)) {
+        ret = devm_gpio_request_one(&i2c->dev, aw8697->irq_gpio,
+            GPIOF_DIR_IN, "aw8697_int");
+        if (ret){
+            dev_err(&i2c->dev, "%s: int request failed\n", __func__);
+            goto err_irq_gpio_request;
+        }
+    }
+
+    /* aw8697 chip id */
+    ret = aw8697_read_chipid(aw8697);
+    if (ret < 0) {
+        dev_err(&i2c->dev, "%s: aw8697_read_chipid failed ret=%d\n", __func__, ret);
+        goto err_id;
+    }
+
+    /* aw8697 irq */
+    if (gpio_is_valid(aw8697->irq_gpio) &&
+        !(aw8697->flags & AW8697_FLAG_SKIP_INTERRUPTS)) {
+        /* register irq handler */
+        aw8697_interrupt_setup(aw8697);
+        irq_flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
+        ret = devm_request_threaded_irq(&i2c->dev,
+                    gpio_to_irq(aw8697->irq_gpio),
+                    NULL, aw8697_irq, irq_flags,
+                    "aw8697", aw8697);
+        if (ret != 0) {
+            dev_err(&i2c->dev, "%s: failed to request IRQ %d: %d\n",
+                    __func__, gpio_to_irq(aw8697->irq_gpio), ret);
+            goto err_irq;
+        }
+    } else {
+        dev_info(&i2c->dev, "%s skipping IRQ registration\n", __func__);
+        /* disable feature support if gpio was invalid */
+        aw8697->flags |= AW8697_FLAG_SKIP_INTERRUPTS;
+    }
+
+    dev_set_drvdata(&i2c->dev, aw8697);
+
+    ret = sysfs_create_group(&i2c->dev.kobj, &aw8697_attribute_group);
+    if (ret < 0) {
+        dev_info(&i2c->dev, "%s error creating sysfs attr files\n", __func__);
+        goto err_sysfs;
+    }
+
+    g_aw8697 = aw8697;
+
+    aw8697_vibrator_init(aw8697);
+
+    aw8697_haptic_init(aw8697);
+
+    aw8697_ram_init(aw8697);
+
+/* add haptic audio tp mask */
+    aw8697->fb_notif.notifier_call = aw8697_fb_notifier_callback_tp;
+    ret = msm_drm_register_client(&aw8697->fb_notif);
+    if (ret)
+       pr_info("Unable to register fb_notifier: %d\n", ret);
+/* add haptic audio tp mask end */
+    pr_info("%s probe completed successfully!\n", __func__);
+
+    return 0;
+
+err_sysfs:
+    devm_free_irq(&i2c->dev, gpio_to_irq(aw8697->irq_gpio), aw8697);
+err_irq:
+err_id:
+    if (gpio_is_valid(aw8697->irq_gpio))
+        devm_gpio_free(&i2c->dev, aw8697->irq_gpio);
+err_irq_gpio_request:
+    if (gpio_is_valid(aw8697->reset_gpio))
+        devm_gpio_free(&i2c->dev, aw8697->reset_gpio);
+err_reset_gpio_request:
+err_parse_dt:
+    devm_kfree(&i2c->dev, aw8697);
+    aw8697 = NULL;
+    return ret;
+}
+
+static int aw8697_i2c_remove(struct i2c_client *i2c)
+{
+    struct aw8697 *aw8697 = i2c_get_clientdata(i2c);
+
+    pr_info("%s enter\n", __func__);
+
+    sysfs_remove_group(&i2c->dev.kobj, &aw8697_attribute_group);
+
+    devm_free_irq(&i2c->dev, gpio_to_irq(aw8697->irq_gpio), aw8697);
+    if (gpio_is_valid(aw8697->irq_gpio))
+        devm_gpio_free(&i2c->dev, aw8697->irq_gpio);
+    if (gpio_is_valid(aw8697->reset_gpio))
+        devm_gpio_free(&i2c->dev, aw8697->reset_gpio);
+    devm_kfree(&i2c->dev, aw8697);
+    aw8697 = NULL;
+
+    return 0;
+}
+
+static int __maybe_unused aw8697_suspend(struct device *dev)
+{
+	int ret = 0;
+
+	 struct aw8697 *aw8697 = dev_get_drvdata(dev);
+	 mutex_lock(&aw8697->lock);
+	 aw8697_haptic_stop(aw8697);
+	 mutex_unlock(&aw8697->lock);
+
+	return ret;
+}
+
+static int __maybe_unused aw8697_resume(struct device *dev)
+{
+
+	int ret = 0;
+
+	return ret;
+}
+
+
+static SIMPLE_DEV_PM_OPS(aw8697_pm_ops, aw8697_suspend, aw8697_resume);
+static const struct i2c_device_id aw8697_i2c_id[] = {
+	{ AW8697_I2C_NAME, 0 },
+	{ }
+};
+MODULE_DEVICE_TABLE(i2c, aw8697_i2c_id);
+
+static struct of_device_id aw8697_dt_match[] = {
+	{ .compatible = "awinic,aw8697_haptic" },
+	{ },
+};
+
+static struct i2c_driver aw8697_i2c_driver = {
+	.driver = {
+		.name = AW8697_I2C_NAME,
+		.owner = THIS_MODULE,
+		.of_match_table = of_match_ptr(aw8697_dt_match),
+		.pm = &aw8697_pm_ops,
+	},
+	.probe = aw8697_i2c_probe,
+	.remove = aw8697_i2c_remove,
+	.id_table = aw8697_i2c_id,
+};
+
+
+static int __init aw8697_i2c_init(void)
+{
+    int ret = 0;
+
+    pr_info("aw8697 driver version %s\n", AW8697_VERSION);
+
+    ret = i2c_add_driver(&aw8697_i2c_driver);
+    if(ret){
+        pr_err("fail to add aw8697 device into i2c\n");
+        return ret;
+    }
+
+    return 0;
+}
+module_init(aw8697_i2c_init);
+
+
+static void __exit aw8697_i2c_exit(void)
+{
+    i2c_del_driver(&aw8697_i2c_driver);
+}
+module_exit(aw8697_i2c_exit);
+
+
+MODULE_DESCRIPTION("AW8697 Haptic Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/leds/aw8697.h b/drivers/leds/aw8697.h
new file mode 100644
index 0000000000000000000000000000000000000000..d9792252fc452b3f81e0ef87408f29bd83798e56
--- /dev/null
+++ b/drivers/leds/aw8697.h
@@ -0,0 +1,532 @@
+#ifndef _AW8697_H_
+#define _AW8697_H_
+
+/*********************************************************
+ *
+ * kernel version
+ *
+ ********************************************************/
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(4, 4, 1)
+#define TIMED_OUTPUT
+#endif
+
+/*********************************************************
+ *
+ * aw8697.h
+ *
+ ********************************************************/
+#include <linux/regmap.h>
+#include <linux/timer.h>
+#include <linux/workqueue.h>
+#include <linux/hrtimer.h>
+#include <linux/mutex.h>
+#include <linux/cdev.h>
+#ifdef TIMED_OUTPUT
+#include <../../../drivers/staging/android/timed_output.h>
+#else
+#include <linux/leds.h>
+#endif
+
+/*********************************************************
+ *
+ * marco
+ *
+ ********************************************************/
+#define MAX_I2C_BUFFER_SIZE                 65536
+
+#define AW8697_REG_MAX                      0xff
+
+#define AW8697_SEQUENCER_SIZE               8
+#define AW8697_SEQUENCER_LOOP_SIZE          4
+
+#define AW8697_RTP_I2C_SINGLE_MAX_NUM       512
+
+#define HAPTIC_MAX_TIMEOUT                  10000
+
+#define AW8697_VBAT_REFER                   4200
+#define AW8697_VBAT_MIN                     3000
+#define AW8697_VBAT_MAX                     4500
+/* motor config */
+#define LRA_0619
+
+#ifdef LRA_0619
+#define AW8697_HAPTIC_F0_PRE                1700    /* 170Hz*/
+#define AW8697_HAPTIC_F0_CALI_PERCEN        7       /* -7%~7%*/
+#define AW8697_HAPTIC_CONT_DRV_LVL          85  /*op modify for count mode*/   /* 105*6.1/256=2.50v*/
+#define AW8697_HAPTIC_CONT_DRV_LVL_OV       105 /*op modify for count mode*/    /* 125*6.1/256=2.98v*/
+#define AW8697_HAPTIC_CONT_TD               0x009a
+#define AW8697_HAPTIC_CONT_ZC_THR           0x0ff1
+#define AW8697_HAPTIC_CONT_NUM_BRK          3
+#endif
+
+#ifdef LRA_0832
+#define AW8697_HAPTIC_F0_PRE                2350    /* 170Hz*/
+#define AW8697_HAPTIC_F0_CALI_PERCEN        7       /* -7%~7%*/
+#define AW8697_HAPTIC_CONT_DRV_LVL          125     /* 125*6.1/256=2.98v*/
+#define AW8697_HAPTIC_CONT_DRV_LVL_OV       155     /*155*6.1/256=3.69v*/
+#define AW8697_HAPTIC_CONT_TD               0x006c
+#define AW8697_HAPTIC_CONT_ZC_THR           0x0ff1
+#define AW8697_HAPTIC_CONT_NUM_BRK          3
+#endif
+
+
+#define AW8697_HAPTIC_F0_COEFF              260     /*2.604167*/
+
+
+/* trig config */
+#define AW8697_TRIG_NUM                     3
+#define AW8697_TRG1_ENABLE                  1
+#define AW8697_TRG2_ENABLE                  1
+#define AW8697_TRG3_ENABLE                  1
+/*
+ * trig default high level
+ * ___________           _________________
+ *           |           |
+ *           |           |
+ *           |___________|
+ *        first edge
+ *                   second edge
+ *
+ *
+ * trig default low level
+ *            ___________
+ *           |           |
+ *           |           |
+ * __________|           |_________________
+ *        first edge
+ *                   second edge
+ */
+#define AW8697_TRG1_DEFAULT_LEVEL           1       // 1: high level; 0: low level
+#define AW8697_TRG2_DEFAULT_LEVEL           1       // 1: high level; 0: low level
+#define AW8697_TRG3_DEFAULT_LEVEL           1       // 1: high level; 0: low level
+
+#define AW8697_TRG1_DUAL_EDGE               1       // 1: dual edge; 0: first edge
+#define AW8697_TRG2_DUAL_EDGE               1       // 1: dual edge; 0: first edge
+#define AW8697_TRG3_DUAL_EDGE               1       // 1: dual edge; 0: first edge
+
+#define AW8697_TRG1_FIRST_EDGE_SEQ          1       // trig1: first edge waveform seq
+#define AW8697_TRG1_SECOND_EDGE_SEQ         2       // trig1: second edge waveform seq
+#define AW8697_TRG2_FIRST_EDGE_SEQ          1       // trig2: first edge waveform seq
+#define AW8697_TRG2_SECOND_EDGE_SEQ         2       // trig2: second edge waveform seq
+#define AW8697_TRG3_FIRST_EDGE_SEQ          1       // trig3: first edge waveform seq
+#define AW8697_TRG3_SECOND_EDGE_SEQ         2       // trig3: second edge waveform seq
+
+
+#if AW8697_TRG1_ENABLE
+#define AW8697_TRG1_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG1_ENABLE
+#else
+#define AW8697_TRG1_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG1_DISABLE
+#endif
+
+#if AW8697_TRG2_ENABLE
+#define AW8697_TRG2_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG2_ENABLE
+#else
+#define AW8697_TRG2_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG2_DISABLE
+#endif
+
+#if AW8697_TRG3_ENABLE
+#define AW8697_TRG3_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG3_ENABLE
+#else
+#define AW8697_TRG3_DEFAULT_ENABLE          AW8697_BIT_TRGCFG2_TRG3_DISABLE
+#endif
+
+#if AW8697_TRG1_DEFAULT_LEVEL
+#define AW8697_TRG1_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG1_POLAR_POS
+#else
+#define AW8697_TRG1_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG1_POLAR_NEG
+#endif
+
+#if AW8697_TRG2_DEFAULT_LEVEL
+#define AW8697_TRG2_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG2_POLAR_POS
+#else
+#define AW8697_TRG2_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG2_POLAR_NEG
+#endif
+
+#if AW8697_TRG3_DEFAULT_LEVEL
+#define AW8697_TRG3_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG3_POLAR_POS
+#else
+#define AW8697_TRG3_DEFAULT_POLAR           AW8697_BIT_TRGCFG1_TRG3_POLAR_NEG
+#endif
+
+#if AW8697_TRG1_DUAL_EDGE
+#define AW8697_TRG1_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG1_EDGE_POS_NEG
+#else
+#define AW8697_TRG1_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG1_EDGE_POS
+#endif
+
+#if AW8697_TRG2_DUAL_EDGE
+#define AW8697_TRG2_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG2_EDGE_POS_NEG
+#else
+#define AW8697_TRG2_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG2_EDGE_POS
+#endif
+
+#if AW8697_TRG3_DUAL_EDGE
+#define AW8697_TRG3_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG3_EDGE_POS_NEG
+#else
+#define AW8697_TRG3_DEFAULT_EDGE            AW8697_BIT_TRGCFG1_TRG3_EDGE_POS
+#endif
+enum aw8697_flags {
+    AW8697_FLAG_NONR = 0,
+    AW8697_FLAG_SKIP_INTERRUPTS = 1,
+};
+
+enum aw8697_haptic_read_write {
+    AW8697_HAPTIC_CMD_READ_REG = 0,
+    AW8697_HAPTIC_CMD_WRITE_REG = 1,
+};
+
+
+enum aw8697_haptic_work_mode {
+    AW8697_HAPTIC_STANDBY_MODE = 0,
+    AW8697_HAPTIC_RAM_MODE = 1,
+    AW8697_HAPTIC_RTP_MODE = 2,
+    AW8697_HAPTIC_TRIG_MODE = 3,
+    AW8697_HAPTIC_CONT_MODE = 4,
+    AW8697_HAPTIC_RAM_LOOP_MODE = 5,
+};
+
+enum aw8697_haptic_bst_mode {
+    AW8697_HAPTIC_BYPASS_MODE = 0,
+    AW8697_HAPTIC_BOOST_MODE = 1,
+};
+
+enum aw8697_haptic_activate_mode {
+  AW8697_HAPTIC_ACTIVATE_RAM_MODE = 0,
+  AW8697_HAPTIC_ACTIVATE_CONT_MODE = 1,
+};
+
+
+enum aw8697_haptic_cont_vbat_comp_mode {
+    AW8697_HAPTIC_CONT_VBAT_SW_COMP_MODE = 0,
+    AW8697_HAPTIC_CONT_VBAT_HW_COMP_MODE = 1,
+};
+
+enum aw8697_haptic_ram_vbat_comp_mode {
+    AW8697_HAPTIC_RAM_VBAT_COMP_DISABLE = 0,
+    AW8697_HAPTIC_RAM_VBAT_COMP_ENABLE = 1,
+};
+
+enum aw8697_haptic_f0_flag {
+    AW8697_HAPTIC_LRA_F0 = 0,
+    AW8697_HAPTIC_CALI_F0 = 1,
+};
+
+enum aw8697_haptic_pwm_mode {
+    AW8697_PWM_48K = 0,
+    AW8697_PWM_24K = 1,
+    AW8697_PWM_12K = 2,
+};
+
+
+enum aw8697_haptic_play {
+    AW8697_HAPTIC_PLAY_NULL = 0,
+    AW8697_HAPTIC_PLAY_ENABLE = 1,
+    AW8697_HAPTIC_PLAY_STOP = 2,
+    AW8697_HAPTIC_PLAY_GAIN = 8,
+};
+
+enum aw8697_haptic_cmd {
+    AW8697_HAPTIC_CMD_NULL = 0,
+    AW8697_HAPTIC_CMD_ENABLE = 1,
+    AW8697_HAPTIC_CMD_HAPTIC = 0x0f,
+    AW8697_HAPTIC_CMD_TP = 0x10,
+    AW8697_HAPTIC_CMD_SYS = 0xf0,
+    AW8697_HAPTIC_CMD_STOP = 255,
+};
+
+enum aw8697_haptic_tp_flag {
+    AW8697_HAPTIC_TP_NULL = 0,
+    AW8697_HAPTIC_TP_PRESS = 1,
+    AW8697_HAPTIC_TP_PRESS_HOLD = 2,
+    AW8697_HAPTIC_TP_RELEASE = 3,
+    AW8697_HAPTIC_TP_RELEASE_HOLD = 4,
+};
+
+enum aw8697_haptic_tp_staus {
+    AW8697_HAPTIC_TP_ST_RELEASE = 0,
+    AW8697_HAPTIC_TP_ST_PRESS = 1,
+};
+
+enum aw8697_haptic_tp_play_flag {
+    AW8697_HAPTIC_TP_PLAY_NULL = 0,
+    AW8697_HAPTIC_TP_PLAY_ENABLE = 1,
+    AW8697_HAPTIC_TP_PLAY_NOMORE= 2,
+};
+
+
+enum aw8697_haptic_tp_touch_flag {
+    AW8697_HAPTIC_TP_TOUCH_INVAIL = 0,
+    AW8697_HAPTIC_TP_TOUCH_VAIL = 1,
+};
+
+#define AW8697_HAPTIC_TP_ID_MAX     10
+
+
+#define AW8697_HAPTIC_AI_X_JITTER	20
+#define AW8697_HAPTIC_AI_Y_JITTER	20
+#define AW8697_HAPTIC_AI_X_DFT_W	200
+#define AW8697_HAPTIC_AI_Y_DFT_H	200
+
+
+enum aw8697_haptic_tz_level {
+    AW8697_HAPTIC_TZ_LEVEL_LOW = 0,
+    AW8697_HAPTIC_TZ_LEVEL_HIGH = 1,
+};
+
+/*********************************************************
+ *
+ * struct
+ *
+ ********************************************************/
+struct tp_input_info {
+    uint8_t  id;
+    uint8_t  status;
+    uint16_t x;
+    uint16_t y;
+};
+
+struct trust_zone_info {
+    uint8_t  level;
+    uint16_t x;
+    uint16_t y;
+    uint16_t w;
+    uint16_t h;
+};
+
+struct ai_trust_zone {
+    uint8_t  num;
+    struct trust_zone_info *tz_info;
+};
+
+
+struct haptic_audio_trust_zone {
+    uint8_t  level;
+    uint8_t  cnt;
+    uint16_t x;
+    uint16_t y;
+    uint16_t w;
+    uint16_t h;
+    struct list_head list;
+};
+
+struct haptic_audio_tp_size {
+    uint16_t x;
+    uint16_t y;
+};
+
+struct shake_point {
+    uint8_t  id;
+    uint16_t x;
+    uint16_t y;
+    uint8_t  status;
+    uint8_t  touch_flag;
+    uint8_t  touch_outside_tz_flag;
+};
+
+
+struct fileops {
+    unsigned char cmd;
+    unsigned char reg;
+    unsigned char ram_addrh;
+    unsigned char ram_addrl;
+};
+
+struct ram {
+    unsigned int len;
+    unsigned int check_sum;
+    unsigned int base_addr;
+    unsigned char version;
+    unsigned char ram_shift;
+    unsigned char baseaddr_shift;
+};
+
+struct haptic_ctr{
+    unsigned char cnt;
+    unsigned char cmd;
+    unsigned char play;
+    unsigned char wavseq;
+    unsigned char loop;
+    unsigned char gain;
+    struct list_head list;
+};
+
+struct tp_id{
+    struct shake_point pt_info;
+    unsigned char tp_flag;
+    unsigned char press_flag;
+    unsigned char release_flag;
+    struct timeval t_press;
+    struct timeval t_release;
+    unsigned char play_flag;
+    unsigned int no_play_cnt;
+    unsigned char tp_ai_match_flag;
+    unsigned char press_no_vibrate_flag;
+    unsigned char release_no_vibrate_flag;
+};
+
+struct tp{
+    struct tp_id id[AW8697_HAPTIC_TP_ID_MAX+1];
+    unsigned char id_index;
+    unsigned char virtual_id;
+    unsigned int press_delay_min;
+    unsigned int press_delay_max;
+    unsigned int release_delay_max;
+    unsigned char play_flag;
+    unsigned char last_play_flag;
+    unsigned char press_flag;
+    unsigned char tp_ai_match_flag;
+    unsigned char tp_ai_check_flag;
+    unsigned char hap_match_without_tz_cnt;
+    unsigned int no_play_cnt_max;
+};
+
+struct haptic_audio{
+    struct mutex lock;
+    struct hrtimer timer;
+    struct work_struct work;
+    int delay_val;
+    int timer_val;
+    struct haptic_ctr ctr;
+    struct list_head ctr_list;
+    struct tp tp;
+    struct list_head list;
+    struct haptic_audio_tp_size tp_size;
+    struct trust_zone_info output_tz_info[10];
+    int tz_num;
+    int tz_high_num;
+    int tz_cnt_thr;
+    int tz_cnt_max;
+    unsigned int uevent_report_flag;
+    unsigned int hap_cnt_outside_tz;
+    unsigned int hap_cnt_max_outside_tz;
+};
+
+struct trig{
+    unsigned char enable;
+    unsigned char default_level;
+    unsigned char dual_edge;
+    unsigned char frist_seq;
+    unsigned char second_seq;
+};
+
+struct aw8697 {
+    struct regmap *regmap;
+    struct i2c_client *i2c;
+    struct device *dev;
+    struct input_dev *input;
+    struct pinctrl *pinctrl;
+    struct pinctrl_state *pinctrl_state_active;
+    struct mutex lock;
+    struct hrtimer timer;
+    struct work_struct vibrator_work;
+    struct work_struct rtp_work;
+    struct delayed_work ram_work;
+    struct timeval current_time;
+    struct timeval pre_enter_time;
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev to_dev;
+#else
+    struct led_classdev cdev;
+#endif
+    struct fileops fileops;
+    struct ram ram;
+    bool haptic_ready;
+    bool audio_ready;
+    int pre_haptic_number;
+    bool rtp_on;
+    struct timeval start,end;
+    unsigned int timeval_flags;
+    unsigned int osc_cali_flag;
+    unsigned long int microsecond;
+    unsigned int sys_frequency;
+    unsigned int rtp_len;
+    unsigned int lra_calib_data;
+
+    int reset_gpio;
+    int irq_gpio;
+
+    unsigned char hwen_flag;
+    unsigned char flags;
+    unsigned char chipid;
+
+    unsigned char play_mode;
+
+    unsigned char activate_mode;
+    unsigned char auto_boost;
+
+    int state;
+    int duration;
+    int amplitude;
+    int index;
+    int vmax;
+    int gain;
+
+    unsigned char seq[AW8697_SEQUENCER_SIZE];
+    unsigned char loop[AW8697_SEQUENCER_SIZE];
+
+    unsigned int rtp_cnt;
+    unsigned int rtp_file_num;
+
+    unsigned char rtp_init;
+    unsigned char ram_init;
+    unsigned char rtp_routine_on;
+
+    unsigned int f0;
+    unsigned int f0_pre;
+    unsigned int cont_f0;
+    unsigned int cont_td;
+    unsigned int cont_zc_thr;
+    unsigned char cont_drv_lvl;
+    unsigned char cont_drv_lvl_ov;
+    unsigned char cont_num_brk;
+    unsigned char max_pos_beme;
+    unsigned char max_neg_beme;
+    unsigned char f0_cali_flag;
+
+    unsigned char ram_vbat_comp;
+    unsigned int vbat;
+    unsigned int lra;
+    unsigned int ram_bin_index;
+    unsigned int haptic_real_f0;
+
+    struct trig trig[AW8697_TRIG_NUM];
+    struct haptic_audio haptic_audio;
+    struct mutex rtp_lock;
+    struct timeval t_stop;
+    struct timeval t_start;
+    unsigned int game_microsecond;
+    unsigned int interval_us;
+    struct notifier_block fb_notif;/*register to control tp report*/
+};
+
+struct aw8697_container{
+    int len;
+    unsigned char data[];
+};
+
+
+/*********************************************************
+ *
+ * ioctl
+ *
+ ********************************************************/
+struct aw8697_seq_loop {
+    unsigned char loop[AW8697_SEQUENCER_SIZE];
+};
+
+struct aw8697_que_seq {
+    unsigned char index[AW8697_SEQUENCER_SIZE];
+};
+
+
+#define AW8697_HAPTIC_IOCTL_MAGIC         'h'
+
+#define AW8697_HAPTIC_SET_QUE_SEQ         _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 1, struct aw8697_que_seq*)
+#define AW8697_HAPTIC_SET_SEQ_LOOP        _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 2, struct aw8697_seq_loop*)
+#define AW8697_HAPTIC_PLAY_QUE_SEQ        _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 3, unsigned int)
+#define AW8697_HAPTIC_SET_BST_VOL         _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 4, unsigned int)
+#define AW8697_HAPTIC_SET_BST_PEAK_CUR    _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 5, unsigned int)
+#define AW8697_HAPTIC_SET_GAIN            _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 6, unsigned int)
+#define AW8697_HAPTIC_PLAY_REPEAT_SEQ     _IOWR(AW8697_HAPTIC_IOCTL_MAGIC, 7, unsigned int)
+#endif
+
diff --git a/drivers/leds/aw8697_config.h b/drivers/leds/aw8697_config.h
new file mode 100644
index 0000000000000000000000000000000000000000..8a46eb3dee027a7ec035a802bc924e3ad8ccd992
--- /dev/null
+++ b/drivers/leds/aw8697_config.h
@@ -0,0 +1,12 @@
+#ifndef __AW8697_CONFIG_H__
+#define __AW8697_CONFIG_H__
+
+#define AW8697_CHIPID                   0x97
+
+#define AW8697_BSTCFG_PEAKCUR_LIMIT     0x07
+#define AW8697_DEFAULT_PEAKCUR         AW8697_BSTCFG_PEAKCUR_LIMIT /* origin value: AW8697_BIT_BSTCFG_PEAKCUR_3P5A*/
+
+#define AW8697_CONT_PLAYBACK_MODE       AW8697_BIT_CONT_CTRL_CLOSE_PLAYBACK
+
+
+#endif
diff --git a/drivers/leds/aw8697_reg.h b/drivers/leds/aw8697_reg.h
new file mode 100644
index 0000000000000000000000000000000000000000..3f6f9db5787c056b5cea4c034f0d2920a135b321
--- /dev/null
+++ b/drivers/leds/aw8697_reg.h
@@ -0,0 +1,545 @@
+#ifndef _AW8697_REG_H_
+#define _AW8697_REG_H_
+
+/********************************************
+ * Register List
+ *******************************************/
+#define AW8697_REG_ID            0x00
+#define AW8697_REG_SYSST         0x01
+#define AW8697_REG_SYSINT        0x02
+#define AW8697_REG_SYSINTM       0x03
+#define AW8697_REG_SYSCTRL       0x04
+#define AW8697_REG_GO            0x05
+#define AW8697_REG_RTP_DATA      0x06
+#define AW8697_REG_WAVSEQ1       0x07
+#define AW8697_REG_WAVSEQ2       0x08
+#define AW8697_REG_WAVSEQ3       0x09
+#define AW8697_REG_WAVSEQ4       0x0a
+#define AW8697_REG_WAVSEQ5       0x0b
+#define AW8697_REG_WAVSEQ6       0x0c
+#define AW8697_REG_WAVSEQ7       0x0d
+#define AW8697_REG_WAVSEQ8       0x0e
+#define AW8697_REG_WAVLOOP1      0x0f
+#define AW8697_REG_WAVLOOP2      0x10
+#define AW8697_REG_WAVLOOP3      0x11
+#define AW8697_REG_WAVLOOP4      0x12
+#define AW8697_REG_MAIN_LOOP     0x13
+#define AW8697_REG_TRG1_WAV_P    0x14
+#define AW8697_REG_TRG2_WAV_P    0x15
+#define AW8697_REG_TRG3_WAV_P    0x16
+#define AW8697_REG_TRG1_WAV_N    0x17
+#define AW8697_REG_TRG2_WAV_N    0x18
+#define AW8697_REG_TRG3_WAV_N    0x19
+#define AW8697_REG_TRG_PRIO      0x1a
+#define AW8697_REG_TRG_CFG1      0x1b
+#define AW8697_REG_TRG_CFG2      0x1c
+#define AW8697_REG_DBGCTRL       0x20
+#define AW8697_REG_BASE_ADDRH    0x21
+#define AW8697_REG_BASE_ADDRL    0x22
+#define AW8697_REG_FIFO_AEH      0x23
+#define AW8697_REG_FIFO_AEL      0x24
+#define AW8697_REG_FIFO_AFH      0x25
+#define AW8697_REG_FIFO_AFL      0x26
+#define AW8697_REG_WAKE_DLY      0x27
+#define AW8697_REG_START_DLY     0x28
+#define AW8697_REG_END_DLY_H     0x29
+#define AW8697_REG_END_DLY_L     0x2a
+#define AW8697_REG_DATCTRL       0x2b
+#define AW8697_REG_PWMDEL        0x2c
+#define AW8697_REG_PWMPRC        0x2d
+#define AW8697_REG_PWMDBG        0x2e
+#define AW8697_REG_LDOCTRL       0x2f
+#define AW8697_REG_DBGSTAT       0x30
+#define AW8697_REG_BSTDBG1       0x31
+#define AW8697_REG_BSTDBG2       0x32
+#define AW8697_REG_BSTDBG3       0x33
+#define AW8697_REG_BSTCFG        0x34
+#define AW8697_REG_ANADBG        0x35
+#define AW8697_REG_ANACTRL       0x36
+#define AW8697_REG_CPDBG         0x37
+#define AW8697_REG_GLBDBG        0x38
+#define AW8697_REG_DATDBG        0x39
+#define AW8697_REG_BSTDBG4       0x3a
+#define AW8697_REG_BSTDBG5       0x3b
+#define AW8697_REG_BSTDBG6       0x3c
+#define AW8697_REG_HDRVDBG       0x3d
+#define AW8697_REG_PRLVL         0x3e
+#define AW8697_REG_PRTIME        0x3f
+#define AW8697_REG_RAMADDRH      0x40
+#define AW8697_REG_RAMADDRL      0x41
+#define AW8697_REG_RAMDATA       0x42
+#define AW8697_REG_GLB_STATE     0x46
+#define AW8697_REG_BST_AUTO      0x47
+#define AW8697_REG_CONT_CTRL     0x48
+#define AW8697_REG_F_PRE_H       0x49
+#define AW8697_REG_F_PRE_L       0x4a
+#define AW8697_REG_TD_H          0x4b
+#define AW8697_REG_TD_L          0x4c
+#define AW8697_REG_TSET          0x4d
+#define AW8697_REG_TRIM_LRA      0x5b
+#define AW8697_REG_R_SPARE       0x5d
+#define AW8697_REG_D2SCFG        0x5e
+#define AW8697_REG_DETCTRL       0x5f
+#define AW8697_REG_RLDET         0x60
+#define AW8697_REG_OSDET         0x61
+#define AW8697_REG_VBATDET       0x62
+#define AW8697_REG_TESTDET       0x63
+#define AW8697_REG_DETLO         0x64
+#define AW8697_REG_BEMFDBG       0x65
+#define AW8697_REG_ADCTEST       0x66
+#define AW8697_REG_BEMFTEST      0x67
+#define AW8697_REG_F_LRA_F0_H    0x68
+#define AW8697_REG_F_LRA_F0_L    0x69
+#define AW8697_REG_F_LRA_CONT_H  0x6a
+#define AW8697_REG_F_LRA_CONT_L  0x6b
+#define AW8697_REG_WAIT_VOL_MP   0x6d
+#define AW8697_REG_WAIT_VOL_MN   0x6f
+#define AW8697_REG_BEMF_VOL_H    0x70
+#define AW8697_REG_BEMF_VOL_L    0x71
+#define AW8697_REG_ZC_THRSH_H    0x72
+#define AW8697_REG_ZC_THRSH_L    0x73
+#define AW8697_REG_BEMF_VTHH_H   0x74
+#define AW8697_REG_BEMF_VTHH_L   0x75
+#define AW8697_REG_BEMF_VTHL_H   0x76
+#define AW8697_REG_BEMF_VTHL_L   0x77
+#define AW8697_REG_BEMF_NUM      0x78
+#define AW8697_REG_DRV_TIME      0x79
+#define AW8697_REG_TIME_NZC      0x7a
+#define AW8697_REG_DRV_LVL       0x7b
+#define AW8697_REG_DRV_LVL_OV    0x7c
+#define AW8697_REG_NUM_F0_1      0x7d
+#define AW8697_REG_NUM_F0_2      0x7e
+#define AW8697_REG_NUM_F0_3      0x7f
+
+
+
+
+/********************************************
+ * Register Access
+ *******************************************/
+#define REG_NONE_ACCESS 0
+#define REG_RD_ACCESS  1 << 0
+#define REG_WR_ACCESS  1 << 1
+
+const unsigned char aw8697_reg_access[AW8697_REG_MAX]={
+ [AW8697_REG_ID          ] = REG_RD_ACCESS,
+ [AW8697_REG_SYSST       ] = REG_RD_ACCESS,
+ [AW8697_REG_SYSINT      ] = REG_RD_ACCESS,
+ [AW8697_REG_SYSINTM     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_SYSCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_GO          ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_RTP_DATA    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ1     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ2     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ3     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ4     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ5     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ6     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ7     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVSEQ8     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVLOOP1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVLOOP2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVLOOP3    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAVLOOP4    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_MAIN_LOOP   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG1_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG2_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG3_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG1_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG2_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG3_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG_PRIO    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG_CFG1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRG_CFG2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DBGCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BASE_ADDRH  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BASE_ADDRL  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_FIFO_AEH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_FIFO_AEL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_FIFO_AFH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_FIFO_AFL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAKE_DLY    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_START_DLY   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_END_DLY_H   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_END_DLY_L   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DATCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_PWMDEL      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_PWMPRC      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_PWMDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_LDOCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DBGSTAT     ] = REG_RD_ACCESS,
+ [AW8697_REG_BSTDBG1     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTDBG2     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTDBG3     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTCFG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_ANADBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_ANACTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_CPDBG       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_GLBDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DATDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTDBG4     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTDBG5     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BSTDBG6     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_HDRVDBG     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_PRLVL       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_PRTIME      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_RAMADDRH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_RAMADDRL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_RAMDATA     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_GLB_STATE   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BST_AUTO    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_CONT_CTRL   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_PRE_H     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_PRE_L     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TD_H        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TD_L        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TSET        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TRIM_LRA    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_R_SPARE     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_D2SCFG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DETCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_RLDET       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_OSDET       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_VBATDET     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TESTDET     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DETLO       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMFDBG     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_ADCTEST     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMFTEST    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_LRA_F0_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_LRA_F0_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_LRA_CONT_H] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_F_LRA_CONT_L] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAIT_VOL_MP ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_WAIT_VOL_MN ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VOL_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VOL_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_ZC_THRSH_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_ZC_THRSH_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VTHH_H ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VTHH_L ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VTHL_H ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_VTHL_L ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_BEMF_NUM    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DRV_TIME    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_TIME_NZC    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DRV_LVL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_DRV_LVL_OV  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_NUM_F0_1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_NUM_F0_2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8697_REG_NUM_F0_3    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+};
+
+
+/******************************************************
+ * Register Detail
+ *****************************************************/
+/* SYSST*/
+#define AW8697_BIT_SYSST_BSTERRS                 (1<<7)
+#define AW8697_BIT_SYSST_OVS                     (1<<6)
+#define AW8697_BIT_SYSST_UVLS                    (1<<5)
+#define AW8697_BIT_SYSST_FF_AES                  (1<<4)
+#define AW8697_BIT_SYSST_FF_AFS                  (1<<3)
+#define AW8697_BIT_SYSST_OCDS                    (1<<2)
+#define AW8697_BIT_SYSST_OTS                     (1<<1)
+#define AW8697_BIT_SYSST_DONES                   (1<<0)
+
+/* SYSINT*/
+#define AW8697_BIT_SYSINT_BSTERRI                (1<<7)
+#define AW8697_BIT_SYSINT_OVI                    (1<<6)
+#define AW8697_BIT_SYSINT_UVLI                   (1<<5)
+#define AW8697_BIT_SYSINT_FF_AEI                 (1<<4)
+#define AW8697_BIT_SYSINT_FF_AFI                 (1<<3)
+#define AW8697_BIT_SYSINT_OCDI                   (1<<2)
+#define AW8697_BIT_SYSINT_OTI                    (1<<1)
+#define AW8697_BIT_SYSINT_DONEI                  (1<<0)
+
+/*SYSINTM*/
+#define AW8697_BIT_SYSINTM_BSTERR_MASK           (~(1<<7))
+#define AW8697_BIT_SYSINTM_BSTERR_OFF            (1<<7)
+#define AW8697_BIT_SYSINTM_BSTERR_EN             (0<<7)
+#define AW8697_BIT_SYSINTM_OV_MASK               (~(1<<6))
+#define AW8697_BIT_SYSINTM_OV_OFF                (1<<6)
+#define AW8697_BIT_SYSINTM_OV_EN                 (0<<6)
+#define AW8697_BIT_SYSINTM_UVLO_MASK             (~(1<<5))
+#define AW8697_BIT_SYSINTM_UVLO_OFF              (1<<5)
+#define AW8697_BIT_SYSINTM_UVLO_EN               (0<<5)
+#define AW8697_BIT_SYSINTM_FF_AE_MASK            (~(1<<4))
+#define AW8697_BIT_SYSINTM_FF_AE_OFF             (1<<4)
+#define AW8697_BIT_SYSINTM_FF_AE_EN              (0<<4)
+#define AW8697_BIT_SYSINTM_FF_AF_MASK            (~(1<<3))
+#define AW8697_BIT_SYSINTM_FF_AF_OFF             (1<<3)
+#define AW8697_BIT_SYSINTM_FF_AF_EN              (0<<3)
+#define AW8697_BIT_SYSINTM_OCD_MASK              (~(1<<2))
+#define AW8697_BIT_SYSINTM_OCD_OFF               (1<<2)
+#define AW8697_BIT_SYSINTM_OCD_EN                (0<<2)
+#define AW8697_BIT_SYSINTM_OT_MASK               (~(1<<1))
+#define AW8697_BIT_SYSINTM_OT_OFF                (1<<1)
+#define AW8697_BIT_SYSINTM_OT_EN                 (0<<1)
+#define AW8697_BIT_SYSINTM_DONE_MASK             (~(1<<0))
+#define AW8697_BIT_SYSINTM_DONE_OFF              (1<<0)
+#define AW8697_BIT_SYSINTM_DONE_EN               (0<<0)
+
+/*SYSCTRL*/
+#define AW8697_BIT_SYSCTRL_WAVDAT_MODE_MASK      (~(3<<6))
+#define AW8697_BIT_SYSCTRL_WAVDAT_MODE_4X        (3<<6)
+#define AW8697_BIT_SYSCTRL_WAVDAT_MODE_2X        (0<<6)
+#define AW8697_BIT_SYSCTRL_WAVDAT_MODE_1X        (1<<6)
+#define AW8697_BIT_SYSCTRL_RAMINIT_MASK          (~(1<<5))
+#define AW8697_BIT_SYSCTRL_RAMINIT_EN            (1<<5)
+#define AW8697_BIT_SYSCTRL_RAMINIT_OFF           (0<<5)
+#define AW8697_BIT_SYSCTRL_PLAY_MODE_MASK        (~(3<<2))
+#define AW8697_BIT_SYSCTRL_PLAY_MODE_CONT        (2<<2)
+#define AW8697_BIT_SYSCTRL_PLAY_MODE_RTP         (1<<2)
+#define AW8697_BIT_SYSCTRL_PLAY_MODE_RAM         (0<<2)
+#define AW8697_BIT_SYSCTRL_BST_MODE_MASK         (~(1<<1))
+#define AW8697_BIT_SYSCTRL_BST_MODE_BOOST        (1<<1)
+#define AW8697_BIT_SYSCTRL_BST_MODE_BYPASS       (0<<1)
+#define AW8697_BIT_SYSCTRL_WORK_MODE_MASK        (~(1<<0))
+#define AW8697_BIT_SYSCTRL_STANDBY               (1<<0)
+#define AW8697_BIT_SYSCTRL_ACTIVE                (0<<0)
+
+/*GO*/
+#define AW8697_BIT_GO_MASK                       (~(1<<0))
+#define AW8697_BIT_GO_ENABLE                     (1<<0)
+#define AW8697_BIT_GO_DISABLE                    (0<<0)
+
+/* WAVSEQ1*/
+#define AW8697_BIT_WAVSEQ1_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ1_WAV_FRM_SEQ1_MASK     (~(127<<0))
+
+/* WAVSEQ2*/
+#define AW8697_BIT_WAVSEQ2_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ2_WAV_FRM_SEQ2_MASK     (~(127<<0))
+
+/* WAVSEQ3*/
+#define AW8697_BIT_WAVSEQ3_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ3_WAV_FRM_SEQ3_MASK     (~(127<<0))
+
+/* WAVSEQ4*/
+#define AW8697_BIT_WAVSEQ4_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ4_WAV_FRM_SEQ4_MASK     (~(127<<0))
+
+/* WAVSEQ5*/
+#define AW8697_BIT_WAVSEQ5_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ5_WAV_FRM_SEQ5_MASK     (~(127<<0))
+
+/* WAVSEQ6*/
+#define AW8697_BIT_WAVSEQ6_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ6_WAV_FRM_SEQ6_MASK     (~(127<<0))
+
+/* WAVSEQ7*/
+#define AW8697_BIT_WAVSEQ7_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ7_WAV_FRM_SEQ7_MASK     (~(127<<0))
+
+/* WAVSEQ8*/
+#define AW8697_BIT_WAVSEQ8_WAIT                  (1<<7)
+#define AW8697_BIT_WAVSEQ8_WAV_FRM_SEQ8_MASK     (~(127<<0))
+
+/* WAVLOOP*/
+#define AW8697_BIT_WAVLOOP_SEQN_MASK            (~(15<<4))
+#define AW8697_BIT_WAVLOOP_SEQNP1_MASK          (~(15<<0))
+#define AW8697_BIT_WAVLOOP_INIFINITELY          (15<<0)
+
+/* WAVLOOP1*/
+#define AW8697_BIT_WAVLOOP1_SEQ1_MASK            (~(15<<4))
+#define AW8697_BIT_WAVLOOP1_SEQ2_MASK            (~(15<<0))
+
+/* WAVLOOP2*/
+#define AW8697_BIT_WAVLOOP2_SEQ3_MASK            (~(15<<4))
+#define AW8697_BIT_WAVLOOP2_SEQ4_MASK            (~(15<<0))
+
+/* WAVLOOP3*/
+#define AW8697_BIT_WAVLOOP3_SEQ5_MASK            (~(15<<4))
+#define AW8697_BIT_WAVLOOP3_SEQ6_MASK            (~(15<<0))
+
+/* WAVLOOP4*/
+#define AW8697_BIT_WAVLOOP4_SEQ7_MASK            (~(15<<4))
+#define AW8697_BIT_WAVLOOP4_SEQ8_MASK            (~(15<<0))
+
+
+/* PLAYPRIO*/
+#define AW8697_BIT_PLAYPRIO_GO_MASK              (~(3<<6))
+#define AW8697_BIT_PLAYPRIO_TRIG3_MASK           (~(3<<4))
+#define AW8697_BIT_PLAYPRIO_TRIG2_MASK           (~(3<<2))
+#define AW8697_BIT_PLAYPRIO_TRIG1_MASK           (~(3<<0))
+
+/* TRGCFG1*/
+#define AW8697_BIT_TRGCFG1_TRG3_POLAR_MASK       (~(1<<5))
+#define AW8697_BIT_TRGCFG1_TRG3_POLAR_NEG        (1<<5)
+#define AW8697_BIT_TRGCFG1_TRG3_POLAR_POS        (0<<5)
+#define AW8697_BIT_TRGCFG1_TRG3_EDGE_MASK        (~(1<<4))
+#define AW8697_BIT_TRGCFG1_TRG3_EDGE_POS         (1<<4)
+#define AW8697_BIT_TRGCFG1_TRG3_EDGE_POS_NEG     (0<<4)
+#define AW8697_BIT_TRGCFG1_TRG2_POLAR_MASK       (~(1<<3))
+#define AW8697_BIT_TRGCFG1_TRG2_POLAR_NEG        (1<<3)
+#define AW8697_BIT_TRGCFG1_TRG2_POLAR_POS        (0<<3)
+#define AW8697_BIT_TRGCFG1_TRG2_EDGE_MASK        (~(1<<2))
+#define AW8697_BIT_TRGCFG1_TRG2_EDGE_POS         (1<<2)
+#define AW8697_BIT_TRGCFG1_TRG2_EDGE_POS_NEG     (0<<2)
+#define AW8697_BIT_TRGCFG1_TRG1_POLAR_MASK       (~(1<<1))
+#define AW8697_BIT_TRGCFG1_TRG1_POLAR_NEG        (1<<1)
+#define AW8697_BIT_TRGCFG1_TRG1_POLAR_POS        (0<<1)
+#define AW8697_BIT_TRGCFG1_TRG1_EDGE_MASK        (~(1<<0))
+#define AW8697_BIT_TRGCFG1_TRG1_EDGE_POS         (1<<0)
+#define AW8697_BIT_TRGCFG1_TRG1_EDGE_POS_NEG     (0<<0)
+
+/* TRGCFG2*/
+#define AW8697_BIT_TRGCFG2_TRG3_ENABLE_MASK      (~(1<<2))
+#define AW8697_BIT_TRGCFG2_TRG3_ENABLE           (1<<2)
+#define AW8697_BIT_TRGCFG2_TRG3_DISABLE          (0<<2)
+#define AW8697_BIT_TRGCFG2_TRG2_ENABLE_MASK      (~(1<<1))
+#define AW8697_BIT_TRGCFG2_TRG2_ENABLE           (1<<1)
+#define AW8697_BIT_TRGCFG2_TRG2_DISABLE          (0<<1)
+#define AW8697_BIT_TRGCFG2_TRG1_ENABLE_MASK      (~(1<<0))
+#define AW8697_BIT_TRGCFG2_TRG1_ENABLE           (1<<0)
+#define AW8697_BIT_TRGCFG2_TRG1_DISABLE          (0<<0)
+
+/* DBGCTRL*/
+#define AW8697_BIT_DBGCTRL_INT_EDGE_MODE_MASK   (~(1<<3))
+#define AW8697_BIT_DBGCTRL_INT_EDGE_MODE_POS    (1<<3)
+#define AW8697_BIT_DBGCTRL_INT_EDGE_MODE_BOTH   (0<<3)
+#define AW8697_BIT_DBGCTRL_INT_MODE_MASK        (~(1<<2))
+#define AW8697_BIT_DBGCTRL_INT_MODE_EDGE        (1<<2)
+#define AW8697_BIT_DBGCTRL_INT_MODE_LEVEL       (0<<2)
+
+/* DATCTRL*/
+#define AW8697_BIT_DATCTRL_FC_MASK              (~(1<<6))
+#define AW8697_BIT_DATCTRL_FC_1000HZ            (3<<6)
+#define AW8697_BIT_DATCTRL_FC_800HZ             (3<<6)
+#define AW8697_BIT_DATCTRL_FC_600HZ             (1<<6)
+#define AW8697_BIT_DATCTRL_FC_400HZ             (0<<6)
+#define AW8697_BIT_DATCTRL_LPF_ENABLE_MASK      (~(1<<5))
+#define AW8697_BIT_DATCTRL_LPF_ENABLE           (1<<5)
+#define AW8697_BIT_DATCTRL_LPF_DISABLE          (0<<5)
+#define AW8697_BIT_DATCTRL_WAKEMODE_ENABLE_MASK (~(1<<0))
+#define AW8697_BIT_DATCTRL_WAKEMODE_ENABLE      (1<<0)
+#define AW8697_BIT_DATCTRL_WAKEMODE_DISABLE      (0<<0)
+
+/* PWMPRC*/
+#define AW8697_BIT_PWMPRC_PRC_MASK              (~(1<<7))
+#define AW8697_BIT_PWMPRC_PRC_ENABLE            (1<<7)
+#define AW8697_BIT_PWMPRC_PRC_DISABLE           (0<<7)
+#define AW8697_BIT_PWMPRC_PRCTIME_MASK          (~(0x7f<<0))
+
+/* PWMDBG*/
+#define AW8697_BIT_PWMDBG_PWM_MODE_MASK          (~(3<<5))
+#define AW8697_BIT_PWMDBG_PWM_12K                (3<<5)
+#define AW8697_BIT_PWMDBG_PWM_24K                (2<<5)
+#define AW8697_BIT_PWMDBG_PWM_48K                (0<<5)
+
+// BSTCFG: reg0x34
+#define AW8697_BIT_BSTCFG_PEAKCUR_MASK              (~(7<<0))
+#define AW8697_BIT_BSTCFG_PEAKCUR_4A                (7<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_3P75A             (6<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_3P5A              (5<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_3P25A             (4<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_3A                (3<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_2P5A              (2<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_2A                (1<<0)
+#define AW8697_BIT_BSTCFG_PEAKCUR_1P5A              (0<<0)
+/* PRLVL*/
+// ANADBG: reg0x35
+#define AW8697_BIT_ANADBG_IOC_MASK                  (~(3<<2))
+#define AW8697_BIT_ANADBG_IOC_4P65A                 (3<<2)
+#define AW8697_BIT_ANADBG_IOC_4P15A                 (2<<2)
+#define AW8697_BIT_ANADBG_IOC_3P65A                 (1<<2)
+#define AW8697_BIT_ANADBG_IOC_3P15A                 (0<<2)
+/*FOR OVER CURRENT*/
+#define AW8697_BIT_ANADBG_IOC_OCDT_MASK             (~(3<<0))
+
+#define AW8697_BIT_ANADBG_IOC_OCDT_150NS            (3<<0)
+// ANACTRL: reg0x36
+#define AW8697_BIT_ANACTRL_LRA_SRC_MASK             (~(1<<5))
+#define AW8697_BIT_ANACTRL_LRA_SRC_REG              (1<<5)
+#define AW8697_BIT_ANACTRL_LRA_SRC_EFUSE            (0<<5)
+#define AW8697_BIT_ANACTRL_HD_PD_MASK               (~(1<<3))
+#define AW8697_BIT_ANACTRL_HD_PD_EN                 (1<<3)
+#define AW8697_BIT_ANACTRL_HD_HZ_EN                 (0<<3)
+// BSTDBG4: reg0x3a
+#define AW8697_BIT_BSTDBG4_BSTVOL_MASK              (~(31<<1))
+#define AW8697_BIT_PRLVL_PR_MASK                (~(1<<7))
+#define AW8697_BIT_PRLVL_PR_ENABLE              (1<<7)
+#define AW8697_BIT_PRLVL_PR_DISABLE             (0<<7)
+#define AW8697_BIT_PRLVL_PRLVL_MASK             (~(0x7f<<0))
+
+/*PRTIME*/
+#define AW8697_BIT_PRTIME_PRTIME_MASK           (~(0xff<<0))
+
+/* BST_AUTO*/
+#define AW8697_BIT_BST_AUTO_BST_AUTOSW_MASK      (~(1<<2))
+#define AW8697_BIT_BST_AUTO_BST_AUTOMATIC_BOOST  (1<<2)
+#define AW8697_BIT_BST_AUTO_BST_MANUAL_BOOST   	 (0<<2)
+#define AW8697_BIT_BST_AUTO_BST_RTP_MASK            (~(1<<1))
+#define AW8697_BIT_BST_AUTO_BST_RTP_ENABLE          (1<<1)
+#define AW8697_BIT_BST_AUTO_BST_RTP_DISABLE         (0<<1)
+#define AW8697_BIT_BST_AUTO_BST_RAM_MASK            (~(1<<0))
+#define AW8697_BIT_BST_AUTO_BST_RAM_ENABLE          (1<<0)
+#define AW8697_BIT_BST_AUTO_BST_RAM_DISABLE         (0<<0)
+
+/* CONT_CTRL*/
+#define AW8697_BIT_CONT_CTRL_ZC_DETEC_MASK       (~(1<<7))
+#define AW8697_BIT_CONT_CTRL_ZC_DETEC_ENABLE     (1<<7)
+#define AW8697_BIT_CONT_CTRL_ZC_DETEC_DISABLE    (0<<7)
+#define AW8697_BIT_CONT_CTRL_WAIT_PERIOD_MASK    (~(3<<5))
+#define AW8697_BIT_CONT_CTRL_WAIT_8PERIOD        (3<<5)
+#define AW8697_BIT_CONT_CTRL_WAIT_4PERIOD        (2<<5)
+#define AW8697_BIT_CONT_CTRL_WAIT_2PERIOD        (1<<5)
+#define AW8697_BIT_CONT_CTRL_WAIT_1PERIOD        (0<<5)
+#define AW8697_BIT_CONT_CTRL_MODE_MASK           (~(1<<4))
+#define AW8697_BIT_CONT_CTRL_BY_DRV_TIME         (1<<4)
+#define AW8697_BIT_CONT_CTRL_BY_GO_SIGNAL        (0<<4)
+#define AW8697_BIT_CONT_CTRL_EN_CLOSE_MASK       (~(1<<3))
+#define AW8697_BIT_CONT_CTRL_CLOSE_PLAYBACK      (1<<3)
+#define AW8697_BIT_CONT_CTRL_OPEN_PLAYBACK       (0<<3)
+#define AW8697_BIT_CONT_CTRL_F0_DETECT_MASK      (~(1<<2))
+#define AW8697_BIT_CONT_CTRL_F0_DETECT_ENABLE    (1<<2)
+#define AW8697_BIT_CONT_CTRL_F0_DETECT_DISABLE   (0<<2)
+#define AW8697_BIT_CONT_CTRL_O2C_MASK            (~(1<<1))
+#define AW8697_BIT_CONT_CTRL_O2C_ENABLE          (1<<1)
+#define AW8697_BIT_CONT_CTRL_O2C_DISABLE         (0<<1)
+#define AW8697_BIT_CONT_CTRL_AUTO_BRK_MASK       (~(1<<0))
+#define AW8697_BIT_CONT_CTRL_AUTO_BRK_ENABLE     (1<<0)
+#define AW8697_BIT_CONT_CTRL_AUTO_BRK_DISABLE    (0<<0)
+
+#define AW8697_BIT_D2SCFG_CLK_ADC_MASK              (~(7<<5))
+#define AW8697_BIT_D2SCFG_CLK_ASC_0P09375MHZ        (7<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_0P1875MHZ         (6<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_0P375MHZ          (5<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_0P75MHZ           (4<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_1P5MHZ            (3<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_3MHZ              (2<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_6MHZ              (1<<5)
+#define AW8697_BIT_D2SCFG_CLK_ASC_12MHZ             (0<<5)
+
+/* DETCTRL*/
+#define AW8697_BIT_DETCTRL_RL_OS_MASK            (~(1<<6))
+#define AW8697_BIT_DETCTRL_RL_DETECT             (1<<6)
+#define AW8697_BIT_DETCTRL_OS_DETECT             (0<<6)
+#define AW8697_BIT_DETCTRL_PROTECT_MASK          (~(1<<5))
+#define AW8697_BIT_DETCTRL_PROTECT_NO_ACTION     (1<<5)
+#define AW8697_BIT_DETCTRL_PROTECT_SHUTDOWN      (0<<5)
+#define AW8697_BIT_DETCTRL_ADO_SLOT_MODE_MASK    (~(1<<4))
+#define AW8697_BIT_DETCTRL_ADO_SLOT_MODE_ENABLE  (1<<4)
+#define AW8697_BIT_DETCTRL_ADO_SLOT_MODE_DISABLE (0<<4)
+#define AW8697_BIT_DETCTRL_VBAT_GO_MASK          (~(1<<1))
+#define AW8697_BIT_DETCTRL_VABT_GO_ENABLE        (1<<1)
+#define AW8697_BIT_DETCTRL_VBAT_GO_DISBALE       (0<<1)
+#define AW8697_BIT_DETCTRL_DIAG_GO_MASK          (~(1<<0))
+#define AW8697_BIT_DETCTRL_DIAG_GO_ENABLE        (1<<0)
+#define AW8697_BIT_DETCTRL_DIAG_GO_DISABLE       (0<<0)
+
+
+/* VBAT MODE*/
+#define AW8697_BIT_ADCTEST_VBAT_MODE_MASK           (~(1<<6))
+#define AW8697_BIT_ADCTEST_VBAT_HW_COMP             (1<<6)
+#define AW8697_BIT_ADCTEST_VBAT_SW_COMP             (0<<6)
+
+/* BSTCFG*/
+#define AW8697_BIT_BEMF_NUM_BRK_MASK                (~(15<<0))
+#define AW8697_TRIM_MASK                            (~(3<<6))
+#define AW8697_TRIM_DEFAULT                         (0x00)
+
+
+
+#endif
diff --git a/drivers/leds/leds-qti-tri-led.c b/drivers/leds/leds-qti-tri-led.c
index 8090b62aff8baba1cb155b51281e431cfc782311..721a5565034cc2847a4f8db428d4ba1796dfb8b2 100644
--- a/drivers/leds/leds-qti-tri-led.c
+++ b/drivers/leds/leds-qti-tri-led.c
@@ -40,7 +40,6 @@
 #define TRILED_SUBTYPE_LED1H2L12	0x04
 
 #define TRILED_NUM_MAX			3
-
 #define PWM_PERIOD_DEFAULT_NS		1000000
 
 struct pwm_setting {
@@ -246,7 +245,9 @@ static int qpnp_tri_led_set(struct qpnp_led_dev *led)
 	}
 	dev_dbg(led->chip->dev, "PWM settings for %s led: period = %lluns, duty = %lluns\n",
 				led->cdev.name, period_ns, duty_ns);
-
+	/*temporary solution to reduce brightness*/
+	if (duty_ns > 18000)
+		duty_ns = 18000;
 	led->pwm_setting.duty_ns = duty_ns;
 	led->pwm_setting.period_ns = period_ns;
 
diff --git a/drivers/leds/step_motor/Kconfig b/drivers/leds/step_motor/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..48587e823579fb721809f3ec41e9889cc01e3305
--- /dev/null
+++ b/drivers/leds/step_motor/Kconfig
@@ -0,0 +1,10 @@
+config STEP_MOTOR
+	tristate "Step motor driver for stspin220"
+	help
+	  This option enable support for stspin220 step motor Driver.
+
+config DIGITAL_HALL_M1120
+	tristate "digital hall m1120 Controler"
+	default n
+	help
+	  Say Y here to enable m1120.
\ No newline at end of file
diff --git a/drivers/leds/step_motor/Makefile b/drivers/leds/step_motor/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..a775ee7087a8e36a4e980ce497d705fada118d2f
--- /dev/null
+++ b/drivers/leds/step_motor/Makefile
@@ -0,0 +1,8 @@
+subdir-ccflags-y += -Werror
+subdir-ccflags-y += -Wno-unused-variable
+
+obj-y		+= camera_motor_ic/
+obj-y		+= digital_hall_ic/
+
+obj-y		+= oneplus_motor.o
+obj-y		+= oneplus_motor_notifier.o
diff --git a/drivers/leds/step_motor/camera_motor_ic/Makefile b/drivers/leds/step_motor/camera_motor_ic/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..9cbd21f5ce6e4da96889e846072633525be065ba
--- /dev/null
+++ b/drivers/leds/step_motor/camera_motor_ic/Makefile
@@ -0,0 +1,3 @@
+#obj-$(CONFIG_CAMERA_MOTOR_DRV8834)		+= oneplus_drv8834.o
+obj-y		+= oneplus_drv8834.o
+#obj-y		+= oneplus_stspin220.o
\ No newline at end of file
diff --git a/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.c b/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.c
new file mode 100644
index 0000000000000000000000000000000000000000..cfb14df3d73f9fe0810ca1ffbb32fcedda4530d0
--- /dev/null
+++ b/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.c
@@ -0,0 +1,815 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_drv8834.c
+**
+** Description:
+**      Definitions for m1120 motor driver ic drv8834.
+**
+**************************************************************************************/
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/list.h>
+#include <linux/irq.h>
+#include <linux/jiffies.h>
+#include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/miscdevice.h>
+#include <linux/spinlock.h>
+#include <linux/regulator/consumer.h>
+#include <linux/of_gpio.h>
+#include <linux/pwm.h>
+#include <linux/workqueue.h>
+#include <linux/hrtimer.h>
+//#include <linux/qpnp/pin.h>
+//#include <soc/oneplus/oneplus_project.h>
+
+#include "oneplus_drv8834.h"
+#include "../oneplus_motor.h"
+
+static struct oneplus_mdrv_chip *g_the_chip = NULL;
+static void drv8834_check_motor_type(struct oneplus_mdrv_chip *chip);
+
+static void drv8834_parse_dts(struct oneplus_mdrv_chip * chip)
+{
+	struct device_node *np = chip->dev->of_node;
+	int rc = 0;
+
+	chip->pctrl = devm_pinctrl_get(chip->dev);
+	if (IS_ERR(chip->pctrl)) {
+		MOTOR_ERR("failed to get pinctrl\n");
+	};
+
+	chip->pwm_dev = of_pwm_get(np, NULL);
+
+	if (IS_ERR(chip->pwm_dev)) {
+		MOTOR_LOG("pwm_dev not specified \n");
+	} else {
+		MOTOR_LOG("request pwm seccess\n");
+	}
+
+	chip->boost_gpio = of_get_named_gpio(np, "op,boost-en-pin", 0);//boost 5v
+	if (!gpio_is_valid(chip->boost_gpio)) {
+		MOTOR_LOG("md-boost-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->boost_gpio, "boost-en-pin");
+		if (rc)
+			MOTOR_LOG("request md-boost-gpio gpio failed, rc=%d\n", rc);
+	}
+
+	chip->step_gpio = of_get_named_gpio(np, "op,step-pin", 0);//step pwm
+	if (!gpio_is_valid(chip->step_gpio)) {
+		MOTOR_LOG("md-step-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->step_gpio, "step-pin");
+		if (rc)
+			MOTOR_LOG("request md-step-gpio failed, rc=%d\n", rc);
+		//else
+		//	gpio_set_value(chip->step_gpio, 0);
+	}
+
+	chip->m0_gpio = of_get_named_gpio(np, "op,mode0-pin", 0);//mode0
+	if (!gpio_is_valid(chip->m0_gpio)) {
+		MOTOR_LOG("md-m0-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->m0_gpio, "mode0-pin");
+		if (rc)
+			MOTOR_LOG("request md-m0-gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->m0_gpio, 0);
+	}
+
+
+	chip->m1_gpio = of_get_named_gpio(np, "op,mode1-pin", 0);//mode1
+	if (!gpio_is_valid(chip->m1_gpio)) {
+		MOTOR_LOG("md-m1-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->m1_gpio, "mode1-pin");
+		if (rc)
+			MOTOR_LOG("request md-m1-gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->m1_gpio, 0);
+	}
+
+	/*vref gpio not use by op*/
+	chip->vref_gpio = of_get_named_gpio(np, "qcom,vref-gpio", 0);
+	if (!gpio_is_valid(chip->vref_gpio)) {
+		MOTOR_LOG("md-vref-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->vref_gpio, "vref-gpio");
+		if (rc)
+			MOTOR_LOG("request md_vref-gpio gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->vref_gpio, 0);
+	}
+
+	chip->sleep_gpio = of_get_named_gpio(np, "op,nsleep-pin", 0);//sleep
+	if (!gpio_is_valid(chip->sleep_gpio)) {
+		MOTOR_LOG("md-sleep-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->sleep_gpio, "nsleep-pin");
+		if (rc)
+			MOTOR_LOG("request md-sleep-gpio gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->sleep_gpio, 0);
+	}
+
+	/*sleep1 gpio not use by op*/
+	chip->sleep1_gpio = of_get_named_gpio(np, "qcom,sleep1-gpio", 0);
+	if (!gpio_is_valid(chip->sleep1_gpio)) {
+		MOTOR_LOG("md-sleep-gpio1 gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->sleep1_gpio, "sleep-gpio1");
+		if (rc)
+			MOTOR_LOG("request md-sleep-gpio1 gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->sleep1_gpio, 0);
+	}
+
+	chip->dir_gpio = of_get_named_gpio(np, "op,dir-pin", 0);//dir
+	if (!gpio_is_valid(chip->dir_gpio)) {
+		MOTOR_LOG("md-dir-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->dir_gpio, "dir-gpio");
+		if (rc)
+			MOTOR_LOG("request md-dir-gpio gpio failed, rc=%d\n", rc);
+		else
+			gpio_set_value(chip->dir_gpio, 0);
+	}
+
+	/*dir switch gpio not use by op*/
+	chip->dir_switch_gpio = of_get_named_gpio(np, "qcom,dir_switch-gpio", 0);
+	if (!gpio_is_valid(chip->dir_switch_gpio)) {
+		MOTOR_LOG("dir_switch_gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->dir_switch_gpio, "dir_switch-gpio");
+		if (rc)
+			MOTOR_LOG("request dir-switch-gpio failed, rc=%d\n", rc);
+	}
+
+	MOTOR_LOG("%d %d %d %d %d %d\n", chip->boost_gpio, chip->sleep_gpio,
+			chip->dir_gpio, chip->m0_gpio, chip->m1_gpio, chip->step_gpio);
+}
+
+static int drv8834_init_dir_switch(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (chip->vref_dirswitch_on == false)
+		return ret;//op not use dir switch
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->dir_switch_state = pinctrl_lookup_state(chip->pctrl, "dir_switch_gpio_input_high");
+	if (IS_ERR(chip->dir_switch_state)) {
+		ret = PTR_ERR(chip->dir_switch_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->dir_switch_state);
+
+	msleep(10);
+
+	chip->dir_switch = gpio_get_value(chip->dir_switch_gpio);
+
+	chip->dir_switch_state = pinctrl_lookup_state(chip->pctrl, "dir_switch_gpio_input_low");
+	if (IS_ERR(chip->dir_switch_state)) {
+		ret = PTR_ERR(chip->dir_switch_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+	pinctrl_select_state(chip->pctrl,chip->dir_switch_state);
+
+	return 0;
+
+}
+
+static int drv8834_init_pwm_config(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->pwm_state = pinctrl_lookup_state(chip->pctrl, "pwm_config");
+	if (IS_ERR(chip->pwm_state)) {
+		ret = PTR_ERR(chip->pwm_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->pwm_state);
+
+	return 0;
+
+}
+
+static int drv8834_init_boost(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->boost_state = pinctrl_lookup_state(chip->pctrl, "boost");
+	if (IS_ERR(chip->boost_state)) {
+		ret = PTR_ERR(chip->boost_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->boost_state);
+
+	return 0;
+
+}
+
+static int drv8834_init_m1_gpio(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->m1_state = pinctrl_lookup_state(chip->pctrl, "m1_gpio");
+	if (IS_ERR(chip->m1_state)) {
+		ret = PTR_ERR(chip->m1_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->m1_state);
+
+	return 0;
+
+}
+
+static int drv8834_init_sleep_gpio(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->sleep_state = pinctrl_lookup_state(chip->pctrl, "sleep_gpio");
+	if (IS_ERR(chip->sleep_state)) {
+		ret = PTR_ERR(chip->sleep_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->sleep_state);
+
+	return 0;
+
+}
+
+static int drv8834_init_dir_gpio(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->dir_state = pinctrl_lookup_state(chip->pctrl, "dir_gpio");
+	if (IS_ERR(chip->dir_state)) {
+		ret = PTR_ERR(chip->dir_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->dir_state);
+
+	return 0;
+
+}
+
+static int drv8834_change_m0_config(struct oneplus_mdrv_chip * chip ,int config)
+{
+	int ret = 0;
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	if (config == GPIO_MODE) {
+		chip->m0_state = pinctrl_lookup_state(chip->pctrl, "m0_gpio");
+		if (IS_ERR(chip->m0_state)) {
+			ret = PTR_ERR(chip->m0_state);
+			MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+			return ret;
+		};
+
+		pinctrl_select_state(chip->pctrl,chip->m0_state);
+
+	} else {
+		chip->m0_state = pinctrl_lookup_state(chip->pctrl, "m0_high_impedance");
+		if (IS_ERR(chip->m0_state)) {
+			ret = PTR_ERR(chip->m0_state);
+			MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+			return ret;
+		};
+
+		pinctrl_select_state(chip->pctrl,chip->m0_state);
+	}
+
+	return 0;
+}
+
+static int drv8834_change_vref_config(struct oneplus_mdrv_chip * chip ,int config)
+{
+	int ret = 0;
+
+	if (chip->vref_dirswitch_on == false)
+		return ret;//op not use vref config
+
+	if (IS_ERR(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	if (config == GPIO_MODE) {
+		chip->vref_state = pinctrl_lookup_state(chip->pctrl, "vref_gpio");
+		if (IS_ERR(chip->vref_state)) {
+			ret = PTR_ERR(chip->vref_state);
+			MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+			return ret;
+		};
+
+		pinctrl_select_state(chip->pctrl,chip->vref_state);
+
+	} else {
+		chip->vref_state = pinctrl_lookup_state(chip->pctrl, "vref_high_impedance");
+		if (IS_ERR(chip->vref_state)) {
+			ret = PTR_ERR(chip->vref_state);
+			MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+			return ret;
+		};
+
+		pinctrl_select_state(chip->pctrl,chip->vref_state);
+	}
+
+	return 0;
+}
+
+static int drv8834_hardware_init(struct oneplus_mdrv_chip * chip)
+{
+	int ret = 0;
+
+	//init boost
+	ret = drv8834_init_boost(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_boost %d \n",ret);
+		return -EINVAL;;
+	}
+	if (gpio_is_valid(chip->boost_gpio))
+		gpio_set_value(chip->boost_gpio, 0);
+
+
+	//config pwm for step-gpio
+	ret = drv8834_init_pwm_config(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_pwm_config %d \n",ret);
+		return -EINVAL;
+	}
+
+	//config m1_gpio
+	ret = drv8834_init_m1_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_m1_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config sleep_gpio
+	ret = drv8834_init_sleep_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_sleep_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config m1_gpio
+	ret = drv8834_init_dir_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_dir_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config m0_gpio as GPIO_MODE
+	ret = drv8834_change_m0_config(chip,GPIO_MODE);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_change_m0_config %d \n",ret);
+		return -EINVAL;;
+	}
+
+	drv8834_check_motor_type(chip);
+
+	MOTOR_LOG("motor_type=%d, vref_dirswitch_on=%d\n",
+			chip->motor_type, chip->vref_dirswitch_on);
+
+	if (chip->vref_dirswitch_on) {
+		//config vref_gpio as GPIO_MODE
+		ret = drv8834_change_vref_config(chip, GPIO_MODE);
+		if (ret < 0) {
+			MOTOR_ERR("drv8834_change_vref_config %d\n", ret);
+			return -EINVAL;
+		}
+
+		//config dir_switch _gpio
+		ret = drv8834_init_dir_switch(chip);
+		if (ret < 0) {
+			MOTOR_ERR("drv8834_init_dir_switch %d\n", ret);
+			return -EINVAL;
+		}
+	}
+
+	return 0;
+
+}
+
+static int drv8834_set_power(int mode)
+{
+	static bool first_init = true;
+
+	if (g_the_chip == NULL || IS_ERR(g_the_chip->pwm_dev)) {
+		MOTOR_LOG("g_the_chip null or pwm_dev not exist!\n");
+		return -EINVAL;
+	}
+
+	MOTOR_ERR("drv8834_set_power call mode: %d power on:%d\n",mode,MOTOR_POWER_ON);
+
+	if (mode == MOTOR_POWER_ON) {
+		drv8834_init_pwm_config(g_the_chip);
+		if (first_init) {
+			first_init = false;
+			if (gpio_is_valid(g_the_chip->boost_gpio))
+				/* boost should be always on*/
+				gpio_set_value(g_the_chip->boost_gpio, 1);
+			msleep(10);
+		}
+		if (gpio_is_valid(g_the_chip->sleep_gpio))
+			gpio_set_value(g_the_chip->sleep_gpio, 1);
+	} else {
+		if (gpio_is_valid(g_the_chip->sleep_gpio))
+			gpio_set_value(g_the_chip->sleep_gpio, 0);
+		if (gpio_is_valid(g_the_chip->step_gpio))
+			gpio_set_value(g_the_chip->step_gpio, 0);
+		if (gpio_is_valid(g_the_chip->dir_gpio))
+			gpio_set_value(g_the_chip->dir_gpio, 0);
+	}
+	return 0;
+}
+
+static int drv8834_set_direction(int dir)
+{
+	if (g_the_chip == NULL || !gpio_is_valid(g_the_chip->dir_gpio)) {
+		MOTOR_LOG("g_the_chip null or dir_gpio invalid\n");
+		return -EINVAL;
+	}
+
+	if (g_the_chip->motor_type == MOTOR_FI5) { // fi 5 motor op select
+		if (g_the_chip->dir_switch) {
+			if (dir == MOTOR_UPWARD) {
+				gpio_set_value(g_the_chip->dir_gpio, 1);
+			} else {
+				gpio_set_value(g_the_chip->dir_gpio, 0);
+			}
+		} else {
+			if (dir == MOTOR_UPWARD) {
+				gpio_set_value(g_the_chip->dir_gpio, 0);
+			} else {
+				gpio_set_value(g_the_chip->dir_gpio, 1);
+			}
+		}
+	} else { //fi 6 motor
+		if (dir == MOTOR_UPWARD) {
+			gpio_set_value(g_the_chip->dir_gpio, 1);
+		} else {
+			gpio_set_value(g_the_chip->dir_gpio, 0);
+		}
+	}
+	return 0;
+}
+
+static int drv8834_set_working_mode (int mode)
+{
+	int ret = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n ");
+		return -EINVAL;
+	}
+
+	switch (mode) {
+	case MOTOR_MODE_FULL:
+		MOTOR_ERR("MOTOR_MODE_FULL call \n");
+		ret = drv8834_change_vref_config(g_the_chip,GPIO_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_vref_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		ret = drv8834_change_m0_config(g_the_chip,GPIO_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_m0_config %d \n",ret);
+			return -EINVAL;
+		}
+		if (gpio_is_valid(g_the_chip->m0_gpio))
+			gpio_set_value(g_the_chip->m0_gpio, 0);
+		if (gpio_is_valid(g_the_chip->m1_gpio))
+			gpio_set_value(g_the_chip->m1_gpio, 0);
+		break;
+	case MOTOR_MODE_1_16:
+		MOTOR_ERR("MOTOR_MODE_1_16 call \n");
+		ret = drv8834_change_vref_config(g_the_chip,HIGH_IMPEDANCE_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_vref_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		ret = drv8834_change_m0_config(g_the_chip,GPIO_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_m0_config %d \n",ret);
+			return -EINVAL;
+		}
+		if (gpio_is_valid(g_the_chip->m0_gpio))
+			gpio_set_value(g_the_chip->m0_gpio, 1);
+		if (gpio_is_valid(g_the_chip->m1_gpio))
+			gpio_set_value(g_the_chip->m1_gpio, 1);
+		break;
+	case MOTOR_MODE_1_32://go here
+		MOTOR_ERR("MOTOR_MODE_1_32 call \n");
+		ret = drv8834_change_vref_config(g_the_chip,HIGH_IMPEDANCE_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_vref_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		ret = drv8834_change_m0_config(g_the_chip,HIGH_IMPEDANCE_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_m0_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		if (gpio_is_valid(g_the_chip->m1_gpio))
+			gpio_set_value(g_the_chip->m1_gpio, 1);
+		break;
+	default:
+		MOTOR_ERR("MOTOR_MODE_default call \n");
+		ret = drv8834_change_vref_config(g_the_chip,HIGH_IMPEDANCE_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_vref_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		ret = drv8834_change_m0_config(g_the_chip,HIGH_IMPEDANCE_MODE);
+		if (ret < 0){
+			MOTOR_ERR("drv8834_change_m0_config %d \n",ret);
+			return -EINVAL;
+		}
+
+		if (gpio_is_valid(g_the_chip->m1_gpio))
+			gpio_set_value(g_the_chip->m1_gpio, 1);
+		break;
+	}
+	MOTOR_ERR("config change %d %d %d %d %d\n",
+		gpio_get_value(g_the_chip->sleep_gpio),
+		gpio_get_value(g_the_chip->step_gpio),
+		gpio_get_value(g_the_chip->m0_gpio),
+		gpio_get_value(g_the_chip->m1_gpio),
+		gpio_get_value(g_the_chip->dir_gpio));
+	return 0;
+}
+
+
+static int drv8834_calculate_pwm_count(int L, int mode)
+{
+	int pwm_count = 0;
+	int mdmode = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return 0;
+	}
+	switch (mode) {
+	case MOTOR_MODE_FULL:
+		mdmode = 1;
+		break;
+	case MOTOR_MODE_1_16:
+		mdmode = 16;
+		break;
+	case MOTOR_MODE_1_32:
+		mdmode = 32;
+		break;
+	default:
+		mdmode = 32;
+		break;
+	}
+	//PWM = (L*18.06*20*32 )/2.4
+	pwm_count = (L * RATIO_B * RATIO_C *RATIO_D) / (RATIO_A * 100);
+	//pwm_count = (L * RATIO_B_FI_6 * RATIO_C *RATIO_D) / (RATIO_A * 100);
+	return pwm_count;
+}
+
+static int drv8834_pwm_config(int duty_ns, int period_ns)
+{
+	int pwm_count = 0;
+	int mdmode = 0;
+
+	if (g_the_chip == NULL || IS_ERR(g_the_chip->pwm_dev)) {
+		MOTOR_LOG("g_the_chip null or pwm_dev not exist!\n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("duty_ns %d period_ns %d \n",duty_ns,period_ns);
+
+	return pwm_config(g_the_chip->pwm_dev, duty_ns, period_ns);
+}
+
+static int drv8834_pwm_enable(void)
+{
+	if (g_the_chip == NULL || IS_ERR(g_the_chip->pwm_dev)) {
+		MOTOR_LOG("g_the_chip null or pwm_dev not exist!\n");
+		return -EINVAL;
+	}
+
+	return pwm_enable(g_the_chip->pwm_dev);
+}
+
+static int drv8834_pwm_disable(void)
+{
+	if (g_the_chip == NULL || IS_ERR(g_the_chip->pwm_dev)) {
+		MOTOR_LOG("g_the_chip null or pwm_dev not exist!\n");
+		return -EINVAL;
+	}
+
+	pwm_disable(g_the_chip->pwm_dev);
+	return 0;
+}
+
+static int drv8834_get_motor_type(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return MOTOR_UNKNOWN;
+	}
+
+	return g_the_chip->motor_type;
+}
+
+static void drv8834_check_motor_type(struct oneplus_mdrv_chip *chip)
+{
+    /*if (is_project(ONEPLUS_17107) && get_PCB_Version() == HW_VERSION__12) { // fi 6 motor
+        chip->motor_type = MOTOR_FI6;
+    } else { //fi 5 motor
+        chip->motor_type = MOTOR_FI5;
+    }
+	*/
+	chip->motor_type = MOTOR_FI5;
+    MOTOR_LOG("motor_type %d \n",chip->motor_type);
+}
+
+static int  drv8834_get_all_config(int* config ,int count)
+{
+	if (g_the_chip == NULL || count > 6) {
+		MOTOR_LOG("g_the_chip null \n");
+		return -EINVAL;
+	}
+
+	config[0] = gpio_get_value(g_the_chip->sleep_gpio);
+	config[1] = gpio_get_value(g_the_chip->step_gpio);
+	config[2] = gpio_get_value(g_the_chip->m0_gpio);
+	config[3] = gpio_get_value(g_the_chip->m1_gpio);
+	config[4] = gpio_get_value(g_the_chip->dir_gpio);
+
+	MOTOR_ERR("config change %d %d %d %d %d %d\n", config[0], config[1],
+		config[2], config[3], config[4]);
+
+	return 0;
+}
+
+
+struct oneplus_motor_operations  drv8834_ops = {
+	.set_power = drv8834_set_power,
+	.set_direction = drv8834_set_direction,
+	.set_working_mode = drv8834_set_working_mode,
+	.get_all_config = drv8834_get_all_config,
+	.calculate_pwm_count = drv8834_calculate_pwm_count,
+	.pwm_config = drv8834_pwm_config,
+	.pwm_enable = drv8834_pwm_enable,
+	.pwm_disable = drv8834_pwm_disable,
+	.get_motor_type = drv8834_get_motor_type,
+};
+
+static int drv8834_platform_probe(struct platform_device *pdev)
+{
+	struct oneplus_mdrv_chip *chip = NULL;
+	int ret = 0;
+
+	MOTOR_LOG("call\n");
+
+	chip = devm_kzalloc(&pdev->dev,sizeof(struct oneplus_mdrv_chip), GFP_KERNEL);
+	if (!chip) {
+		MOTOR_ERR("kernel memory alocation was failed");
+		return -ENOMEM;
+	}
+
+	chip->dev = &pdev->dev;
+	chip->vref_dirswitch_on = false;
+
+	drv8834_parse_dts(chip);
+
+	ret = drv8834_hardware_init(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_hardware_init %d \n",ret);
+		//return -EINVAL;//not need return -22 keep go on
+	}
+
+	oneplus_register_motor("drv8834",&drv8834_ops);
+
+	g_the_chip = chip;
+
+	MOTOR_LOG("success \n");
+	return 0;
+}
+
+static int drv8834_platform_remove(struct platform_device *pdev)
+{
+	if (g_the_chip) {
+		gpio_free(g_the_chip->boost_gpio);
+		gpio_free(g_the_chip->dir_gpio);
+		gpio_free(g_the_chip->m0_gpio);
+		gpio_free(g_the_chip->m1_gpio);
+		gpio_free(g_the_chip->sleep_gpio);
+		if (gpio_is_valid(g_the_chip->vref_gpio))
+			gpio_free(g_the_chip->vref_gpio);
+		if (gpio_is_valid(g_the_chip->sleep1_gpio))
+			gpio_free(g_the_chip->sleep1_gpio);
+		kfree(g_the_chip);
+		g_the_chip = NULL;
+	}
+	return 0;
+}
+
+static const struct of_device_id of_motor_drv_match[] = {
+	{ .compatible = "motor_drv-8834"},
+	{ .compatible = "oneplus,step-motor"},
+	{},
+};
+MODULE_DEVICE_TABLE(of, of_motor_match);
+
+static struct platform_driver motor_drv_driver = {
+	.probe		= drv8834_platform_probe,
+	.remove		= drv8834_platform_remove,
+	.driver		= {
+		.name	= "drv8834",
+		.of_match_table = of_motor_drv_match,
+	},
+};
+
+static int __init drv8834_init(void)
+{
+	MOTOR_LOG("call\n");
+	platform_driver_register(&motor_drv_driver);
+	return 0;
+}
+
+static void __exit drv8834_exit(void)
+{
+	MOTOR_LOG("call\n");
+}
+
+module_init(drv8834_init);
+module_exit(drv8834_exit);
+MODULE_DESCRIPTION("camera motor driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("infi.he");
+
diff --git a/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.h b/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.h
new file mode 100644
index 0000000000000000000000000000000000000000..51301dde637317092c9d77b9881c081f2b52d105
--- /dev/null
+++ b/drivers/leds/step_motor/camera_motor_ic/oneplus_drv8834.h
@@ -0,0 +1,50 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_drv8834.h
+**
+** Description:
+**      Definitions for m1120 motor driver ic drv8834.
+**
+**************************************************************************************/
+#ifndef __ONEPLUS_DRV8834_H__
+#define __ONEPLUS_DRV8834_H__
+
+#define  RATIO_A 24 //2.4
+#define  RATIO_B 1806 //18.06
+#define  RATIO_B_FI_6 354 //3.54
+#define  RATIO_C 20
+#define  RATIO_D 32
+
+enum {
+	GPIO_MODE = 0,
+	HIGH_IMPEDANCE_MODE
+};
+
+struct oneplus_mdrv_chip {
+	struct device	*dev;
+	struct pwm_device *pwm_dev;
+	struct pinctrl *pctrl;
+	struct pinctrl_state *pwm_state;
+	struct pinctrl_state *boost_state;
+	struct pinctrl_state *m0_state;
+	struct pinctrl_state *m1_state;
+	struct pinctrl_state *vref_state;
+	struct pinctrl_state *sleep_state;
+	struct pinctrl_state *dir_state;
+	struct pinctrl_state *dir_switch_state;
+	unsigned int boost_gpio;
+	unsigned int vref_gpio;
+	unsigned int sleep_gpio;
+	unsigned int sleep1_gpio;
+	unsigned int dir_gpio;
+	unsigned int m0_gpio;
+	unsigned int m1_gpio;
+	unsigned int step_gpio;
+	unsigned int dir_switch_gpio;
+	int dir_switch;
+	int motor_type;
+	bool vref_dirswitch_on;
+};
+
+#endif // __ONEPLUS_DRV8834_H__
+
diff --git a/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.c b/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.c
new file mode 100644
index 0000000000000000000000000000000000000000..b1dacedc1e1de620999ffcece18598ec7522f4e9
--- /dev/null
+++ b/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.c
@@ -0,0 +1,668 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_stspin220.c
+**
+** Description:
+**      Definitions for m1120 motor driver ic stspin220.
+**
+**************************************************************************************/
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/list.h>
+#include <linux/irq.h>
+#include <linux/jiffies.h>
+#include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/miscdevice.h>
+#include <linux/spinlock.h>
+#include <linux/regulator/consumer.h>
+#include <linux/of_gpio.h>
+#include <linux/qpnp/pwm.h>
+#include <linux/workqueue.h>
+#include <linux/hrtimer.h>
+#include <linux/qpnp/pin.h>
+#include <soc/oneplus/oneplus_project.h>
+
+#include "oneplus_stspin220.h"
+#include "../oneplus_motor.h"
+
+static struct oneplus_sts_chip *g_the_chip = NULL;
+static void stspin220_check_motor_type(struct oneplus_sts_chip *chip);
+static int stspin220_set_working_mode (int mode);
+
+static void stspin220_parse_dts(struct oneplus_sts_chip * chip)
+{
+	struct device_node *np = chip->dev->of_node;
+	int rc = 0;
+
+	chip->pctrl = devm_pinctrl_get(chip->dev);
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		MOTOR_ERR("failed to get pinctrl\n");
+	};
+
+	chip->pwm_dev = of_pwm_get(np, NULL);
+
+	if (IS_ERR_OR_NULL(chip->pwm_dev)) {
+		MOTOR_LOG("pwm_dev not specified \n");
+	} else {
+		MOTOR_LOG("request pwm seccess\n");
+	}
+
+	chip->boost_gpio = of_get_named_gpio(np, "qcom,boost-gpio", 0);
+	if (!gpio_is_valid(chip->boost_gpio)) {
+		MOTOR_LOG("md-boost-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->boost_gpio, "boost-gpio");
+		if (rc)
+			MOTOR_LOG("request md-boost-gpio gpio failed, rc=%d\n",rc);
+	}
+
+	chip->step_gpio = of_get_named_gpio(np, "qcom,step-gpio", 0);
+	if (!gpio_is_valid(chip->step_gpio)) {
+		MOTOR_LOG("md-step-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->step_gpio, "step-gpio");
+		if (rc)
+			MOTOR_LOG("request md-step-gpio failed, rc=%d\n",rc);
+		//else
+		//	gpio_set_value(chip->step_gpio, 0);
+	}
+
+	chip->sleep_gpio = of_get_named_gpio(np, "qcom,sleep-gpio", 0);
+	if (!gpio_is_valid(chip->sleep_gpio)) {
+		MOTOR_LOG("md-sleep-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->sleep_gpio, "sleep-gpio");
+		if (rc)
+			MOTOR_LOG("request md-sleep-gpio gpio failed, rc=%d\n",rc);
+		else
+			gpio_set_value(chip->sleep_gpio, 0);
+	}
+
+    chip->enable_gpio = of_get_named_gpio(np, "qcom,enable-gpio", 0);
+	if (!gpio_is_valid(chip->enable_gpio)) {
+		MOTOR_LOG("md-enable-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->enable_gpio, "enable-gpio");
+		if (rc)
+			MOTOR_LOG("request md-enavle-gpio gpio failed, rc=%d\n",rc);
+		else
+			gpio_set_value(chip->enable_gpio, 0);
+	}
+
+
+	chip->sleep1_gpio = of_get_named_gpio(np, "qcom,sleep1-gpio", 0);
+	if (!gpio_is_valid(chip->sleep1_gpio)) {
+		MOTOR_LOG("md-sleep-gpio1 gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->sleep1_gpio, "sleep-gpio1");
+		if (rc)
+			MOTOR_LOG("request md-sleep-gpio1 gpio failed, rc=%d\n",rc);
+		else
+			gpio_set_value(chip->sleep1_gpio, 0);
+	}
+
+	chip->dir_gpio = of_get_named_gpio(np, "qcom,dir-gpio", 0);
+	if (!gpio_is_valid(chip->dir_gpio)) {
+		MOTOR_LOG("md-dir-gpio gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->dir_gpio, "dir-gpio");
+		if (rc)
+			MOTOR_LOG("request md-dir-gpio gpio failed, rc=%d\n",rc);
+		else
+			gpio_set_value(chip->dir_gpio, 0);
+	}
+
+	chip->dir_switch_gpio = of_get_named_gpio(np, "qcom,dir_switch-gpio", 0);
+	if (!gpio_is_valid(chip->dir_switch_gpio)) {
+		MOTOR_LOG("dir_switch_gpio not specified\n");
+	} else {
+		rc = gpio_request(chip->dir_switch_gpio, "dir_switch-gpio");
+		if (rc)
+			MOTOR_LOG("request md-m0-gpio failed, rc=%d\n",rc);
+	}
+
+	MOTOR_LOG("%d %d %d %d %d %d %d\n",chip->boost_gpio,chip->sleep_gpio,chip->sleep1_gpio,
+						chip->dir_gpio,chip->step_gpio,chip->dir_switch_gpio,chip->enable_gpio);
+}
+
+static int stspin220_init_dir_switch(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->dir_switch_state = pinctrl_lookup_state(chip->pctrl, "dir_switch_gpio_input_high");
+	if (IS_ERR_OR_NULL(chip->dir_switch_state)) {
+		ret = PTR_ERR(chip->dir_switch_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->dir_switch_state);
+
+	msleep(10);
+
+	chip->dir_switch = gpio_get_value(chip->dir_switch_gpio);
+
+	chip->dir_switch_state = pinctrl_lookup_state(chip->pctrl, "dir_switch_gpio_input_low");
+	if (IS_ERR_OR_NULL(chip->dir_switch_state)) {
+		ret = PTR_ERR(chip->dir_switch_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+	pinctrl_select_state(chip->pctrl,chip->dir_switch_state);
+
+	return 0;
+
+}
+
+static int stspin220_init_pwm_config(struct oneplus_sts_chip * chip , int is_pwm_mode)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	if (is_pwm_mode)
+		chip->pwm_state = pinctrl_lookup_state(chip->pctrl, "pwm_config");
+	else
+		chip->pwm_state = pinctrl_lookup_state(chip->pctrl, "pwm_config_as_gpio"); 
+	if (IS_ERR_OR_NULL(chip->pwm_state)) {
+		ret = PTR_ERR(chip->pwm_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->pwm_state);
+
+	return 0;
+
+}
+
+static int stspin220_init_boost(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->boost_state = pinctrl_lookup_state(chip->pctrl, "boost");
+	if (IS_ERR_OR_NULL(chip->boost_state)) {
+		ret = PTR_ERR(chip->boost_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->boost_state);
+
+	return 0;
+
+}
+
+static int stspin220_init_sleep_gpio(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->sleep_state = pinctrl_lookup_state(chip->pctrl, "sleep_gpio");
+	if (IS_ERR_OR_NULL(chip->sleep_state)) {
+		ret = PTR_ERR(chip->sleep_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->sleep_state);
+
+	return 0;
+
+}
+
+static int stspin220_init_dir_gpio(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->dir_state = pinctrl_lookup_state(chip->pctrl, "dir_gpio");
+	if (IS_ERR_OR_NULL(chip->dir_state)) {
+		ret = PTR_ERR(chip->dir_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->dir_state);
+
+	return 0;
+
+}
+
+static int stspin220_init_enable_gpio(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	if (IS_ERR_OR_NULL(chip->pctrl)) {
+		ret = PTR_ERR(chip->pctrl);
+		MOTOR_ERR("failed to get pinctrl\n");
+		return ret;
+	};
+
+	chip->enable_state = pinctrl_lookup_state(chip->pctrl, "enable_gpio");
+	if (IS_ERR_OR_NULL(chip->enable_state)) {
+		ret = PTR_ERR(chip->enable_state);
+		MOTOR_ERR("pinctrl_lookup_state, err:%d\n", ret);
+		return ret;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->enable_state);
+
+	return 0;
+
+}
+
+static int stspin220_hardware_init(struct oneplus_sts_chip * chip)
+{
+	int ret = 0;
+
+	//init boost
+	ret = stspin220_init_boost(chip);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_init_boost %d \n",ret);
+		return -EINVAL;;
+	}
+	gpio_set_value(chip->boost_gpio, 0);
+
+
+	//config pwm for step-gpio
+	ret = stspin220_init_pwm_config(chip,0);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_init_pwm_config %d \n",ret);
+		return -EINVAL;
+	}
+
+	//config sleep_gpio
+	ret = stspin220_init_sleep_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_init_sleep_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config dir_gpio
+	ret = stspin220_init_dir_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_init_dir_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config dir_switch _gpio
+	ret = stspin220_init_dir_switch(chip);
+	if (ret < 0){
+		MOTOR_ERR("drv8834_init_dir_switch %d \n",ret);
+		return -EINVAL;;
+	}
+
+	//config enable_gpio _gpio
+	ret = stspin220_init_enable_gpio(chip);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_init_enable_gpio %d \n",ret);
+		return -EINVAL;;
+	}
+
+	stspin220_check_motor_type(chip);
+
+	return 0;
+
+}
+
+static int stspin220_set_power(int mode)
+{
+	static bool first_init = true;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n ");
+		return -EINVAL;
+	}
+
+	MOTOR_ERR("stspin220_set_power call mode: %d power on:%d\n",mode,MOTOR_POWER_ON);
+
+	if (mode == MOTOR_POWER_ON) {
+		stspin220_set_working_mode(MOTOR_MODE_1_32);
+		stspin220_init_pwm_config(g_the_chip,1);
+		if (first_init) {
+			first_init = false;
+			gpio_set_value(g_the_chip->boost_gpio, 1);//boost should be always on
+			msleep(10);
+		}
+		gpio_set_value(g_the_chip->enable_gpio, 1);
+	} else {
+		gpio_set_value(g_the_chip->sleep_gpio, 0);
+		gpio_set_value(g_the_chip->sleep1_gpio, 0);
+		gpio_set_value(g_the_chip->enable_gpio, 0);
+	}
+	return 0;
+}
+
+static int stspin220_set_direction(int dir)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n ");
+		return -EINVAL;
+	}
+
+	if (g_the_chip->motor_type == MOTOR_FI5) { // fi 5 motor
+		if (g_the_chip->dir_switch) {
+			if (dir == MOTOR_UPWARD) {
+				gpio_set_value(g_the_chip->dir_gpio, 1);
+			} else {
+				gpio_set_value(g_the_chip->dir_gpio, 0);
+			}
+		} else {
+			if (is_project(ONEPLUS_17107)) {
+				if (get_PCB_Version() >= HW_VERSION__14) {
+					if (dir == MOTOR_UPWARD) {
+						gpio_set_value(g_the_chip->dir_gpio, 1);
+					} else {
+						gpio_set_value(g_the_chip->dir_gpio, 0);
+					}
+				} else {
+					if (dir == MOTOR_UPWARD) {
+						gpio_set_value(g_the_chip->dir_gpio, 0);
+					} else {
+						gpio_set_value(g_the_chip->dir_gpio, 1);
+					}
+				}
+			} else {
+					if (get_PCB_Version() >= HW_VERSION__11) {
+					if (dir == MOTOR_UPWARD) {
+						gpio_set_value(g_the_chip->dir_gpio, 1);
+					} else {
+						gpio_set_value(g_the_chip->dir_gpio, 0);
+					}
+				} else {
+					if (dir == MOTOR_UPWARD) {
+						gpio_set_value(g_the_chip->dir_gpio, 0);
+					} else {
+						gpio_set_value(g_the_chip->dir_gpio, 1);
+					}
+				}
+			}
+		}
+	} else { //fi 6 motor
+		if (dir == MOTOR_UPWARD) {
+			gpio_set_value(g_the_chip->dir_gpio, 1);
+		} else {
+			gpio_set_value(g_the_chip->dir_gpio, 0);
+		}
+	}
+	return 0;
+}
+
+static int stspin220_set_working_mode (int mode)
+{
+	int ret = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n ");
+		return -EINVAL;
+	}
+
+	gpio_set_value(g_the_chip->sleep_gpio, 0);
+	gpio_set_value(g_the_chip->sleep1_gpio, 0);
+
+	switch (mode) {
+	case MOTOR_MODE_FULL:
+		MOTOR_ERR("MOTOR_MODE_FULL call \n");
+		stspin220_init_pwm_config(g_the_chip,0);
+		gpio_set_value(g_the_chip->dir_gpio,0);
+		break;
+	case MOTOR_MODE_1_16:
+		MOTOR_ERR("MOTOR_MODE_1_16 call \n");
+		stspin220_init_pwm_config(g_the_chip,0);
+		gpio_set_value(g_the_chip->dir_gpio,0);
+		break;
+	case MOTOR_MODE_1_32:
+		MOTOR_ERR("MOTOR_MODE_1_32 call \n");
+		stspin220_init_pwm_config(g_the_chip,0);
+		gpio_set_value(g_the_chip->dir_gpio,0);
+		break;
+	default:
+		MOTOR_ERR("MOTOR_MODE_default call \n");
+		stspin220_init_pwm_config(g_the_chip,0);
+		gpio_set_value(g_the_chip->dir_gpio,0);
+		break;
+	}
+
+	gpio_set_value(g_the_chip->sleep_gpio, 1);
+	gpio_set_value(g_the_chip->sleep1_gpio, 1);
+
+	MOTOR_ERR("config change %d %d %d\n",
+		gpio_get_value(g_the_chip->sleep_gpio),
+		gpio_get_value(g_the_chip->sleep1_gpio),
+		gpio_get_value(g_the_chip->dir_gpio));
+	return 0;
+}
+
+
+static int stspin220_calculate_pwm_count(int L, int mode)
+{
+	int pwm_count = 0;
+	int mdmode = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return 0;
+	}
+	switch (mode) {
+	case MOTOR_MODE_FULL:
+		mdmode = 1;
+		break;
+	case MOTOR_MODE_1_16:
+		mdmode = 16;
+		break;
+	case MOTOR_MODE_1_32:
+		mdmode = 32;
+		break;
+	default:
+		mdmode = 32;
+		break;
+	}
+	//PWM = (L*18.06*20*32 )/2.4
+	pwm_count = (L * RATIO_B * RATIO_C *RATIO_D) / (RATIO_A * 100);
+	//pwm_count = (L * RATIO_B_FI_6 * RATIO_C *RATIO_D) / (RATIO_A * 100);
+	return pwm_count;
+}
+
+static int stspin220_pwm_config(int duty_ns, int period_ns)
+{
+	int pwm_count = 0;
+	int mdmode = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("duty_ns %d period_ns %d \n",duty_ns,period_ns);
+
+	return pwm_config(g_the_chip->pwm_dev, duty_ns, period_ns);
+}
+
+static int stspin220_pwm_enable(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return -EINVAL;
+	}
+
+	return pwm_enable(g_the_chip->pwm_dev);
+}
+
+static int stspin220_pwm_disable(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return -EINVAL;
+	}
+
+	pwm_disable(g_the_chip->pwm_dev);
+	return 0;
+}
+
+static int stspin220_get_motor_type(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip null \n");
+		return MOTOR_UNKNOWN;
+	}
+
+	return g_the_chip->motor_type;
+}
+
+static void stspin220_check_motor_type(struct oneplus_sts_chip *chip)
+{
+    if (get_PCB_Version() == HW_VERSION__12) { // fi 6 motor
+        chip->motor_type = MOTOR_FI6;
+    } else { //fi 5 motor
+        chip->motor_type = MOTOR_FI5;
+    }
+
+    MOTOR_LOG("motor_type %d \n",chip->motor_type);
+}
+
+static int  stspin220_get_all_config(int* config ,int count)
+{
+	if (g_the_chip == NULL || count > 6) {
+		MOTOR_LOG("g_the_chip null \n");
+		return -EINVAL;
+	}
+
+	config[0] = gpio_get_value(g_the_chip->sleep_gpio);
+	config[1] = gpio_get_value(g_the_chip->step_gpio);
+	config[2] = gpio_get_value(g_the_chip->sleep1_gpio);
+	config[3] = gpio_get_value(g_the_chip->enable_gpio);
+	config[4] = gpio_get_value(g_the_chip->dir_gpio);
+	config[5] = g_the_chip->motor_type;
+
+	MOTOR_ERR("config change %d %d %d %d %d %d\n",config[0],config[1],config[2],
+		config[3],config[4],config[5]);
+
+	return 0;
+}
+
+
+struct oneplus_motor_operations  stspin220_ops = {
+	.set_power = stspin220_set_power,
+	.set_direction = stspin220_set_direction,
+	.set_working_mode = stspin220_set_working_mode,
+	.get_all_config = stspin220_get_all_config,
+	.calculate_pwm_count = stspin220_calculate_pwm_count,
+	.pwm_config = stspin220_pwm_config,
+	.pwm_enable = stspin220_pwm_enable,
+	.pwm_disable = stspin220_pwm_disable,
+	.get_motor_type = stspin220_get_motor_type,
+};
+
+static int stspin220_platform_probe(struct platform_device *pdev)
+{
+	struct oneplus_sts_chip *chip = NULL;
+	int ret = 0;
+
+	MOTOR_LOG("call\n");
+
+	chip = devm_kzalloc(&pdev->dev,sizeof(struct oneplus_sts_chip), GFP_KERNEL);
+	if (!chip) {
+		MOTOR_ERR("kernel memory alocation was failed");
+		return -ENOMEM;
+	}
+
+	chip->dev = &pdev->dev;
+
+	stspin220_parse_dts(chip);
+
+	ret = stspin220_hardware_init(chip);
+	if (ret < 0){
+		MOTOR_ERR("stspin220_hardware_init %d \n",ret);
+		return -EINVAL;;
+	}
+
+	oneplus_register_motor("stspin220",&stspin220_ops);
+
+	g_the_chip = chip;
+
+	MOTOR_LOG("success \n");
+	return 0;
+}
+
+static int stspin220_platform_remove(struct platform_device *pdev)
+{
+	if (g_the_chip) {
+		gpio_free(g_the_chip->boost_gpio);
+		gpio_free(g_the_chip->dir_gpio);
+		gpio_free(g_the_chip->enable_gpio);
+		gpio_free(g_the_chip->sleep_gpio);
+		gpio_free(g_the_chip->sleep1_gpio);
+		kfree(g_the_chip);
+		g_the_chip = NULL;
+	}
+	return 0;
+}
+
+static const struct of_device_id of_motor_drv_match[] = {
+	{ .compatible = "motor_drv-220"},
+	{},
+};
+MODULE_DEVICE_TABLE(of, of_motor_match);
+
+static struct platform_driver motor_drv_driver = {
+	.probe		= stspin220_platform_probe,
+	.remove		= stspin220_platform_remove,
+	.driver		= {
+		.name	= "stspin220",
+		.of_match_table = of_motor_drv_match,
+	},
+};
+
+static int __init stspin220_init(void)
+{
+	MOTOR_LOG("call\n");
+	platform_driver_register(&motor_drv_driver);
+	return 0;
+}
+
+static void __exit stspin220_exit(void)
+{
+	MOTOR_LOG("call\n");
+}
+
+module_init(stspin220_init);
+module_exit(stspin220_exit);
+MODULE_DESCRIPTION("camera motor driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("infi.he");
+
diff --git a/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.h b/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.h
new file mode 100644
index 0000000000000000000000000000000000000000..1fb5a4b644d829e0e85b7576f15b722f982d3cb0
--- /dev/null
+++ b/drivers/leds/step_motor/camera_motor_ic/oneplus_stspin220.h
@@ -0,0 +1,45 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_drv8834.h
+**
+** Description:
+**      Definitions for m1120 motor driver ic drv8834.
+**
+**************************************************************************************/
+#ifndef __ONEPLUS_STSPIN220_H__
+#define __ONEPLUS_STSPIN220_H__
+
+#define  RATIO_A 24 //2.4
+#define  RATIO_B 1806 //18.06
+#define  RATIO_B_FI_6 354 //3.54
+#define  RATIO_C 20
+#define  RATIO_D 32
+
+enum {
+	GPIO_MODE = 0,
+	HIGH_IMPEDANCE_MODE
+};
+
+struct oneplus_sts_chip {
+	struct device	*dev;
+	struct pwm_device *pwm_dev;
+	struct pinctrl *pctrl;
+	struct pinctrl_state *pwm_state;
+	struct pinctrl_state *boost_state;
+	struct pinctrl_state *enable_state;
+	struct pinctrl_state *sleep_state;
+	struct pinctrl_state *dir_state;
+	struct pinctrl_state *dir_switch_state;
+	unsigned int boost_gpio;
+	unsigned int sleep_gpio;
+	unsigned int sleep1_gpio;
+	unsigned int dir_gpio;
+	unsigned int enable_gpio;
+	unsigned int step_gpio;
+	unsigned int dir_switch_gpio;
+	int dir_switch;
+	int motor_type;
+};
+
+#endif // __ONEPLUS_DRV8834_H__
+
diff --git a/drivers/leds/step_motor/digital_hall_ic/Makefile b/drivers/leds/step_motor/digital_hall_ic/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..faa96e9e252ac2a707b66b8d57b8773576a0aaa8
--- /dev/null
+++ b/drivers/leds/step_motor/digital_hall_ic/Makefile
@@ -0,0 +1,6 @@
+# SPDX-License-Identifier: GPL-2.0
+
+obj-y 	+= oneplus_m1120_up.o oneplus_m1120_down.o
+
+
+
diff --git a/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120.h b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120.h
new file mode 100644
index 0000000000000000000000000000000000000000..9b493134970ef99689244d33c0cbf5e630d7fb01
--- /dev/null
+++ b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120.h
@@ -0,0 +1,165 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS 
+** File        : oneplus_m1120.c
+**
+** Description : 
+**      Definitions for m1120 digital hall_up and hall_down sensor 
+**
+****************************************************************************************/
+#ifndef __MXM1120_H__
+#define __MXM1120_H__
+
+#include <linux/ioctl.h>
+#include <linux/mutex.h>
+
+ /*********************************************************************
+                            register map
+ **********************************************************************/
+#define M1120_REG_PERSINT                   (0x00)
+#define M1120_VAL_PERSINT_COUNT(n)          (n<<4)
+#define M1120_VAL_PERSINT_INTCLR            (0x01)
+#define M1120_REG_INTSRS                    (0x01)
+#define M1120_VAL_INTSRS_INT_ON             (0x80)
+#define M1120_DETECTION_MODE_INTERRUPT      M1120_VAL_INTSRS_INT_ON
+#define M1120_VAL_INTSRS_INT_OFF            (0x00)
+#define M1120_DETECTION_MODE_POLLING        M1120_VAL_INTSRS_INT_OFF
+#define M1120_VAL_INTSRS_INTTYPE_BESIDE     (0x00)
+#define M1120_VAL_INTSRS_INTTYPE_WITHIN     (0x10)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_068mT  (0x00)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_034mT  (0x01)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_017mT  (0x02)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_009mT  (0x03)
+#define M1120_VAL_INTSRS_SRS_10BIT_0_004mT  (0x04)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_272mT   (0x00)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_136mT   (0x01)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_068mT   (0x02)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_036mT   (0x03)
+#define M1120_VAL_INTSRS_SRS_8BIT_0_016mT   (0x04)
+
+#define M1120_REG_LTHL                      (0x02)
+/* [7:0]   LTHL        : low byte of low threshold value */
+
+#define M1120_REG_LTHH                      (0x03)
+/* [7:6]   LTHH        : high 2bits of low threshold value with sign */
+
+#define M1120_REG_HTHL                      (0x04)
+/* [7:0]   HTHL        : low byte of high threshold value */
+
+#define M1120_REG_HTHH                      (0x05)
+/* [7:6]   HTHH        : high 2bits of high threshold value with sign */
+
+#define M1120_REG_I2CDIS                    (0x06)
+#define M1120_VAL_I2CDISABLE                (0x37)
+/* [7:0]   I2CDIS      : disable i2c */
+
+#define M1120_REG_SRST                      (0x07)
+#define M1120_VAL_SRST_RESET                (0x01)
+/* [0]     SRST    = 1 : soft reset */
+
+#define M1120_REG_OPF                       (0x08)
+#define M1120_VAL_OPF_FREQ_20HZ             (0x00)
+#define M1120_VAL_OPF_FREQ_10HZ             (0x10)
+#define M1120_VAL_OPF_FREQ_6_7HZ            (0x20)
+#define M1120_VAL_OPF_FREQ_5HZ              (0x30)
+#define M1120_VAL_OPF_FREQ_80HZ             (0x40)
+#define M1120_VAL_OPF_FREQ_40HZ             (0x50)
+#define M1120_VAL_OPF_FREQ_26_7HZ           (0x60)
+#define M1120_VAL_OPF_EFRD_ON               (0x08)
+#define M1120_VAL_OPF_BIT_8                 (0x02)
+#define M1120_VAL_OPF_BIT_10                (0x00)
+#define M1120_VAL_OPF_HSSON_ON              (0x01)
+#define M1120_VAL_OPF_HSSON_OFF             (0x00)
+
+#define M1120_REG_DID                       (0x09)
+#define M1120_VAL_DID                       (0x9C)
+/* [7:0]   DID         : Device ID */
+
+#define M1120_REG_INFO                      (0x0A)
+/*  [7:0]   INFO        : Information about IC */
+
+#define M1120_REG_ASA                       (0x0B)
+/* [7:0]   ASA         : Hall Sensor sensitivity adjustment */
+
+#define M1120_REG_ST1                       (0x10)
+#define M1120_VAL_ST1_DRDY                  (0x01)
+/* [4] INTM            : status of interrupt mode
+   [1] BITM            : status of resolution
+   [0] DRDY            : status of data ready */
+
+#define M1120_REG_HSL                       (0x11)
+/* [7:0]   HSL         : low byte of hall sensor measurement data */
+
+#define M1120_REG_HSH                       (0x12)
+/* [7:6]   HSL         : high 2bits of hall sensor measurement data with sign */
+
+
+
+ /*********************************************************************
+    define specific parameters to use with step motor in front camera
+ **********************************************************************/
+#define M1120_DRIVER_NAME_UP                "m1120_up"
+#define M1120_DRIVER_NAME_DOWN              "m1120_down"
+
+#define M1120_DETECTION_MODE                M1120_DETECTION_MODE_INTERRUPT
+#define M1120_INTERRUPT_TYPE                M1120_VAL_INTSRS_INTTYPE_WITHIN
+#define M1120_SENSITIVITY_TYPE              M1120_VAL_INTSRS_SRS_10BIT_0_034mT
+#define M1120_PERSISTENCE_COUNT             (0x40)
+#define M1120_OPERATION_FREQUENCY           M1120_VAL_OPF_FREQ_80HZ
+#define M1120_OPERATION_RESOLUTION          M1120_VAL_OPF_BIT_10
+
+#define M1120_DELAY_MAX                     (200)   // ms
+#define M1120_DELAY_MIN                     (20)    // ms
+
+#define M1120_I2C_BUF_SIZE                  (17)
+#define M1120_REG_NUM                       (15)
+
+//MagnaChip Hall Sensor power supply VDD 2.7V~3.6V, VIO 1.65~VDD
+#define M1120_VDD_MIN_UV                    2700000
+#define M1120_VDD_MAX_UV                    3600000
+#define M1120_VIO_MIN_UV                    1650000
+#define M1120_VIO_MAX_UV                    3600000
+
+ /*********************************************************************
+                               define struct data type 
+ **********************************************************************/
+enum {
+    OPERATION_MODE_POWERDOWN,
+    OPERATION_MODE_MEASUREMENT,
+    OPERATION_MODE_FUSEROMACCESS
+};
+
+typedef union {
+    struct {
+        unsigned char persint;
+        unsigned char intsrs;
+        unsigned char lthl;
+        unsigned char lthh;
+        unsigned char hthl;
+        unsigned char hthh;
+        unsigned char i2cdis;
+        unsigned char srst;
+        unsigned char opf;
+        unsigned char did;
+        unsigned char info;
+        unsigned char asa;
+        unsigned char st1;
+        unsigned char hsl;
+        unsigned char hsh;
+    } map;
+    unsigned char array[M1120_REG_NUM];
+} m1120_reg_t;
+
+typedef struct {
+    struct i2c_client*  client;
+    m1120_reg_t         reg;
+    bool                irq_enabled;
+    int                 power_vdd;
+    int                 irq;
+    int                 irq_gpio;
+    struct regulator*   vdd;
+    bool                power_enabled;
+    atomic_t            device_enable;
+} dhall_data_t;
+
+#endif // __MXM1120_H__
+
diff --git a/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_down.c b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_down.c
new file mode 100644
index 0000000000000000000000000000000000000000..c53e7eccb4547fa119b58cc4a894dc4653efaaed
--- /dev/null
+++ b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_down.c
@@ -0,0 +1,1003 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS 
+** File        : oneplus_m1120_down.c
+**
+** Description : 
+**      Definitions for m1120 digital hall_down sensor, i2c address is 0x0D 
+**
+****************************************************************************************/
+
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+//#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+//#include <linux/workqueue.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include <linux/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include "oneplus_m1120.h"
+#include "../oneplus_motor.h"
+
+/************************begin of declaration************************/
+
+/************************static global variable************************/
+static DEFINE_MUTEX(m1120_down_i2c_mutex);
+static DEFINE_MUTEX(m1120_down_device_enable_mutex);
+static dhall_data_t *g_hall_data;
+
+/************************function about i2c************************/
+static int   m1120_down_i2c_read_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len);
+static int   m1120_down_i2c_write_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len);
+static void  m1120_down_short_to_2byte(dhall_data_t* dhall_data, short x, u8 *hbyte, u8 *lbyte);
+static short m1120_down_2byte_to_short(dhall_data_t* dhall_data, u8 hbyte, u8 lbyte);
+
+/************************internal interrupt function************************/
+static irqreturn_t   m1120_down_irq_handler(int irq, void *dev_id);
+static int   m1120_down_clear_interrupt(dhall_data_t* dhall_data);
+
+/************************internal power control function************************/
+static int   m1120_down_power_init(dhall_data_t *data);
+static int   m1120_down_power_ctl(dhall_data_t* dhall_data, bool on);
+static int   m1120_down_set_operation_mode(dhall_data_t* dhall_data, int mode);
+//static int   m1120_down_set_power(struct device *dev, bool on);
+static bool  m1120_down_get_enable(dhall_data_t* dhall_data);
+static void  m1120_down_set_enable(dhall_data_t* dhall_data, bool enable);
+
+/************interface implement for abstract control level************/
+static bool  m1120_down_is_power_on(void);
+static int   m1120_down_parse_dt(dhall_data_t* pdata);
+static int   m1120_down_set_enable_state(bool enable);
+static bool  m1120_down_get_enable_state(void);
+static int   m1120_down_get_real_data(short *data);
+static int   m1120_down_get_abs_data( short *data);
+static int   m1120_down_set_detection_mode(u8 mode);
+static int   m1120_down_enable_irq(bool enable);
+static int   m1120_down_clear_irq(void);
+static int   m1120_down_get_irq_state(void);
+static bool  m1120_down_update_threshold(int position, short lowthd, short highthd);
+static void  m1120_down_dump_reg(u8* buf);
+static int   m1120_down_set_reg(int reg, int val);
+
+/************************init function************************/
+static int   m1120_down_init_device(dhall_data_t* hall_data);
+static int   m1120_down_reset_device(dhall_data_t* dhall_data);
+static int   m1120_down_power_init(dhall_data_t* dhall_data);
+
+/************************end of declaration************************/
+
+
+ /*********************************************************************
+                        function about i2c
+ **********************************************************************/
+static int m1120_down_i2c_read_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len)
+{
+	u8 reg_addr = addr;
+	int err = 0;
+	struct i2c_client *client = NULL;
+	struct i2c_msg msgs[2]={{0},{0}};
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (dhall_data == NULL) {
+		MOTOR_ERR("m1120_down_i2c_read_block, dhall_data == NULL \n");
+		return -EINVAL;
+    }
+    client = dhall_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+	mutex_lock(&m1120_down_i2c_mutex); 
+
+	msgs[0].addr = client->addr;
+	msgs[0].flags = 0;
+ 	msgs[0].len =1;
+ 	msgs[0].buf = &reg_addr;
+
+ 	msgs[1].addr = client->addr;
+ 	msgs[1].flags = I2C_M_RD;
+ 	msgs[1].len =len;
+ 	msgs[1].buf = data;
+
+ 	err = i2c_transfer(client->adapter, msgs, (sizeof(msgs) / sizeof(msgs[0])));
+
+ 	if (err < 0) {
+ 		MOTOR_ERR("i2c_transfer error: (%d %p %d) %d\n",addr, data, len, err);
+ 		err = -EIO;
+ 	} else  {
+ 		err = 0;
+ 	}
+ 	mutex_unlock(&m1120_down_i2c_mutex);
+
+ 	return err;
+
+}
+
+static int m1120_down_i2c_write_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len)
+{
+	int err = 0;
+	int idx = 0;
+	int num = 0;
+	char buf[M1120_I2C_BUF_SIZE] ={0};
+	struct i2c_client *client = NULL;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_down_i2c_write_block failed, p_hall_data == NULL \n");
+		return -EINVAL;
+    }
+    client = p_hall_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null \n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d \n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+
+	mutex_lock(&m1120_down_i2c_mutex);
+
+	buf[num++] = addr;
+	for (idx = 0; idx < len; idx++) {
+		buf[num++] = data[idx];
+	}
+
+	err = i2c_master_send(client, buf, num);
+	if (err < 0) {
+		MOTOR_ERR("send command error!! %d\n",err);
+	}
+
+	//store reg written
+	if (len == 1) {
+		switch(addr){
+		case M1120_REG_PERSINT:
+			p_hall_data->reg.map.persint = data[0];
+			break;
+		case M1120_REG_INTSRS:
+			p_hall_data->reg.map.intsrs = data[0];
+			break;
+		case M1120_REG_LTHL:
+			p_hall_data->reg.map.lthl = data[0];
+			break;
+		case M1120_REG_LTHH:
+			p_hall_data->reg.map.lthh = data[0];
+			break;
+		case M1120_REG_HTHL:
+			p_hall_data->reg.map.hthl = data[0];
+			break;
+		case M1120_REG_HTHH:
+			p_hall_data->reg.map.hthh = data[0];
+			break;
+		case M1120_REG_I2CDIS:
+			p_hall_data->reg.map.i2cdis = data[0];
+			break;
+		case M1120_REG_SRST:
+			p_hall_data->reg.map.srst = data[0];
+			break;
+		case M1120_REG_OPF:
+			p_hall_data->reg.map.opf = data[0];
+			break;
+		}
+	}
+
+	mutex_unlock(&m1120_down_i2c_mutex);
+	return err;
+}
+
+static void m1120_down_short_to_2byte(dhall_data_t* dhall_data, short x, u8 *hbyte, u8 *lbyte)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_down_short_to_2byte failed, p_hall_data == NULL \n");
+		return ;
+    }
+
+	if ((p_hall_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		//8 bit
+		if (x < -128) {
+			x = -128;
+		} else if(x > 127) {
+			x = 127;
+		}
+
+		if (x >= 0) {
+			*lbyte = x & 0x7F;
+		} else {
+			*lbyte = ( (0x80 - (x*(-1))) & 0x7F ) | 0x80;
+		}
+		*hbyte = 0x00;
+	} else {
+		//10 bit 
+		if (x < -512) {
+			x = -512;
+		} else if (x > 511) {
+			x = 511;
+		}
+
+		if (x >=0 ) {
+			*lbyte = x & 0xFF;
+			*hbyte = (((x & 0x100) >> 8) & 0x01) << 6;
+		} else {
+			*lbyte = (0x0200 - (x*(-1))) & 0xFF;
+			*hbyte = ((((0x0200 - (x*(-1))) & 0x100) >> 8) << 6) | 0x80;
+		}
+	}
+}
+
+static short m1120_down_2byte_to_short(dhall_data_t* dhall_data, u8 hbyte, u8 lbyte)
+{
+	short x = 0;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_down_2byte_to_short failed, p_hall_data == NULL \n");
+		return -EINVAL;
+    }
+
+	if( (p_hall_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		//8 bit 
+		x = lbyte & 0x7F;
+		if (lbyte & 0x80) {
+			x -= 0x80;
+		}
+	} else {
+		//10 bit
+		x = (((hbyte & 0x40) >> 6) << 8 ) | lbyte;
+		if (hbyte & 0x80) {
+			x -= 0x200;
+		}
+	}
+
+	return x;
+}
+
+ /*********************************************************************
+                        internal interrupt function
+ **********************************************************************/
+static irqreturn_t m1120_down_irq_handler(int irq, void *dev_id)
+{
+	MOTOR_LOG("call \n");
+
+	if (g_hall_data == NULL) {
+		MOTOR_ERR("m1120_down_irq_handler failed, g_hall_data == NULL \n");
+		return -EINVAL;
+	}
+
+	disable_irq_nosync(g_hall_data->irq);
+	oneplus_dhall_irq_handler(HALL_DOWN);
+
+	return IRQ_HANDLED;
+}
+
+static int m1120_down_clear_interrupt(dhall_data_t* dhall_data)
+{
+    int err = -1;
+    u8 data = 0x00;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("p_hall_data == NULL \n");
+		return -EINVAL;
+	}
+
+    data = p_hall_data->reg.map.persint | 0x01;
+    err =  m1120_down_i2c_write_block(p_hall_data, M1120_REG_PERSINT, &data,1);
+
+    return err;
+}
+
+ /*********************************************************************
+                        internal power control function
+ **********************************************************************/
+static int m1120_down_power_ctl(dhall_data_t* dhall_data, bool on)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_down_set_enable failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+     //we don't need to set vio power since S4A will always-on
+    if (!on && p_hall_data->power_enabled) {
+        err = regulator_disable(p_hall_data->vdd);
+        if (err) {
+            MOTOR_ERR("regulator vdd disable failed err=%d \n", err);
+            return err;
+        }
+
+        p_hall_data->power_enabled = on;
+    } else if (on && !p_hall_data->power_enabled) {
+        err = regulator_enable(p_hall_data->vdd);
+        if (err) {
+            MOTOR_ERR("regulator vdd enable failed err=%d\n", err);
+            return err;
+        }
+        msleep(10); // wait 10ms
+        p_hall_data->power_enabled = on;
+    } else {
+        MOTOR_LOG("power on=%d. enabled=%d\n", on, p_hall_data->power_enabled);
+    }
+
+    return err;
+}
+
+// static int m1120_down_set_power(struct device *dev, bool on)
+// {
+//     m1120_down_power_ctl(g_hall_data, on);
+
+//     return 0;
+// }
+
+
+static int m1120_down_set_operation_mode(dhall_data_t* dhall_data, int mode)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    u8 opf = p_hall_data->reg.map.opf;
+    int err = -1;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_down_set_enable failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+    switch (mode) {
+    case OPERATION_MODE_POWERDOWN:
+        opf &= (0xFF - M1120_VAL_OPF_HSSON_ON);
+        err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_POWERDOWN");
+        break;
+
+    case OPERATION_MODE_MEASUREMENT:
+        opf &= (0xFF - M1120_VAL_OPF_EFRD_ON);
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_MEASUREMENT");
+        break;
+
+    case OPERATION_MODE_FUSEROMACCESS:
+        opf |= M1120_VAL_OPF_EFRD_ON;
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_FUSEROMACCESS");
+        break;
+
+    default :
+        MOTOR_ERR("unknow operation mode, mode : %d", mode);
+    }
+
+    MOTOR_LOG("opf = ox%x \n", opf);
+
+    return err;
+}
+
+static bool m1120_down_get_enable(dhall_data_t* dhall_data)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    int enable = -1;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_down_set_enable failed, p_hall_data == NULL \n");
+        return false;
+    }
+    mutex_lock(&m1120_down_device_enable_mutex);
+
+    enable = atomic_read(&p_hall_data->device_enable);
+
+    mutex_unlock(&m1120_down_device_enable_mutex);
+
+    return enable > 0 ? true : false;
+}
+
+//需�看看這個怎麼�
+static void m1120_down_set_enable(dhall_data_t* dhall_data, bool enable)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    int p_enable = enable ? 1 : 0;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_down_set_enable failed, p_hall_data == NULL || p_hall_data->client == NULL \n");
+        return;
+    }
+
+    mutex_lock(&m1120_down_device_enable_mutex);// add mutex for what ??
+    MOTOR_LOG("m1120 down enable : %d\n", p_enable);
+    if (enable) {                  
+        //enable if state will be changed
+        if (!atomic_cmpxchg(&p_hall_data->device_enable, 0, 1)) {
+            m1120_down_set_operation_mode(p_hall_data, OPERATION_MODE_MEASUREMENT);
+        }
+    } else {                        
+        //disable if state will be changed
+        if (atomic_cmpxchg(&p_hall_data->device_enable, 1, 0)) {
+            m1120_down_set_operation_mode(p_hall_data, OPERATION_MODE_POWERDOWN);
+        }
+    }
+    atomic_set(&p_hall_data->device_enable, p_enable);
+
+    mutex_unlock(&m1120_down_device_enable_mutex);
+}
+
+ /*********************************************************************
+                interface implement for onplus_motor.c
+ **********************************************************************/
+static bool m1120_down_get_enable_state(void)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("m1120_down_get_enable_state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    return m1120_down_get_enable(g_hall_data) ;
+}
+
+static int m1120_down_set_enable_state(bool enable)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("m1120_down_set_enable_state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    MOTOR_LOG("set m1120_down enable : %d", enable ? 1 : 0);
+    m1120_down_set_enable(g_hall_data, enable);
+
+    return 0;
+}
+
+static bool m1120_down_is_power_on(void)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("get m1120_down_is_power_on state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    return g_hall_data->power_enabled > 0 ? true : false;
+}
+static int m1120_down_get_real_data(short* data)
+{ 
+    int err = 0;
+	u8 buf[3] = {0};
+	short value = 0;
+
+    if(!g_hall_data) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -1;
+    }
+
+	//read data
+	err = m1120_down_i2c_read_block(g_hall_data, M1120_REG_ST1, buf, sizeof(buf));
+	if (err < 0) {
+		MOTOR_ERR("m1120_down get data fail, err : %d \n",err);
+		return err;
+	}
+
+	//collect data
+	if (buf[0] & 0x01) {
+		value = m1120_down_2byte_to_short(g_hall_data, buf[2], buf[1]);
+	} else {
+		MOTOR_ERR("m1120: st1(0x%02X) is not DRDY.\n", buf[0]);
+		return -1;
+	}
+
+	*data = value;
+
+    MOTOR_LOG("value : %d", value);
+	return 0;
+}
+
+static int m1120_down_get_abs_data(short* data)
+{ 
+    short value = 0;
+    int err = -1;
+
+    err = m1120_down_get_real_data(&value);
+    if (err < 0) {
+        MOTOR_ERR("m1120_down get abs data filed, err : %d \n", err);
+        return err;
+    }
+
+    
+    value = abs(value);
+	*data = value;
+    MOTOR_LOG("value : %d", value);
+
+	return 0;
+}
+
+static int m1120_down_set_detection_mode(u8 mode)
+{
+	u8 data = 0;
+	int err = 0;
+
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	MOTOR_LOG("m1120 detection mode : %s, irq_enabled : %d\n", (mode == 0)? "POLLING":"INTERRUPT", g_hall_data->irq_enabled);
+	if(mode & DETECTION_MODE_INTERRUPT) {
+		if (!g_hall_data->irq_enabled) {
+			data = g_hall_data->reg.map.intsrs | M1120_DETECTION_MODE_INTERRUPT;
+			err = m1120_down_i2c_write_block(g_hall_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail, err : %d \n",err);
+				return err;
+			}
+			err = m1120_down_clear_interrupt(g_hall_data);
+			if (err < 0) {
+				MOTOR_ERR("clear interupt fail, err : %d \n",err);
+				return err;
+			}
+
+			//requst irq 
+            if (request_irq(g_hall_data->irq, &m1120_down_irq_handler, IRQ_TYPE_LEVEL_LOW, "m1120_down", (void *)g_hall_data->client)) {
+				MOTOR_ERR("IRQ LINE NOT AVAILABLE!! \n");
+				return -EINVAL;
+			}
+			irq_set_irq_wake(g_hall_data->irq, 1);
+
+			g_hall_data->irq_enabled = 1;
+		}
+	} else {
+		if (g_hall_data->irq_enabled) {
+			data = g_hall_data->reg.map.intsrs & (0xFF - M1120_DETECTION_MODE_INTERRUPT);
+
+			err = m1120_down_i2c_write_block(g_hall_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail, err : %d \n",err);
+				return err;
+			}
+
+			disable_irq(g_hall_data->irq);
+			free_irq(g_hall_data->irq, NULL);
+
+			g_hall_data->irq_enabled = 0;
+		}
+	}
+
+    return 0;    
+}
+static int m1120_down_enable_irq(bool enable)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	if (enable) {
+		enable_irq(g_hall_data->irq);
+	} else {
+		disable_irq_nosync(g_hall_data->irq);
+	}
+
+    return 0;
+}
+
+static int m1120_down_clear_irq(void)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_down_clear_interrupt(g_hall_data);
+    return 0;
+}
+
+static int m1120_down_get_irq_state(void)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+    return ((g_hall_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) ? 1 : 0);   
+}
+
+static bool m1120_down_update_threshold(int position, short lowthd, short highthd)
+{
+    
+    u8 lthh, lthl, hthh, hthl;
+	int err = 0;
+
+	if (g_hall_data == NULL) {
+		MOTOR_LOG("g_hall_data == NULL \n");
+		return -EINVAL;
+	}
+	MOTOR_LOG("m1120_down ,low: %d, high :%d, intsrs : %d \n",lowthd, highthd, g_hall_data->reg.map.intsrs);
+
+	err = m1120_down_clear_interrupt(g_hall_data);
+
+	if (g_hall_data->reg.map.intsrs & M1120_VAL_INTSRS_INTTYPE_WITHIN) {
+
+		m1120_down_short_to_2byte(g_hall_data, highthd, &hthh, &hthl);
+		m1120_down_short_to_2byte(g_hall_data, lowthd, &lthh, &lthl);
+		err |= m1120_down_i2c_write_block(g_hall_data, M1120_REG_HTHH,&hthh, 1);
+		err |= m1120_down_i2c_write_block(g_hall_data, M1120_REG_HTHL,&hthl, 1);
+		err |= m1120_down_i2c_write_block(g_hall_data, M1120_REG_LTHH,&lthh, 1);
+		err |= m1120_down_i2c_write_block(g_hall_data, M1120_REG_LTHL,&lthl, 1);
+	}
+
+	if (err < 0) {
+		MOTOR_ERR("update threshold fail, err : %d\n",err);
+		return false;
+	}
+
+    return true;
+}
+
+static void m1120_down_dump_reg(u8* buf)
+{
+    int i, err;
+	u8 val;
+	u8 buffer[512] = {0};
+	u8 _buf[20] = {0};
+
+	if (g_hall_data == NULL) {
+		MOTOR_LOG("g_hall_data == NULL \n");
+		return ;
+	}
+
+	for (i = 0; i <= 0x12; i++) {
+		memset(_buf, 0, sizeof(_buf));
+
+		err = m1120_down_i2c_read_block(g_hall_data, i, &val, 1);
+		if (err < 0) {
+			sprintf(buf, "read reg error!\n");
+			return;
+		}
+
+		sprintf(_buf,  "reg 0x%x:0x%x\n", i, val);
+		strcat(buffer, _buf);
+	}
+	sprintf(buf, "%s\n", buffer);
+	MOTOR_LOG("%s \n",buf);
+
+    return ;  
+}
+
+static int m1120_down_set_reg(int reg, int val)
+{
+    u8 data = (u8)val;
+
+    MOTOR_LOG("reg : %d, val : %d", reg, val);
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_down_i2c_write_block(g_hall_data, (u8)reg, &data,1);
+
+    return 0;  
+}
+
+struct oneplus_hall_operations  m1120_down_ops = {
+    .name = "m1120_down",
+    .is_power_on = m1120_down_is_power_on,
+    .set_hall_enable_state = m1120_down_set_enable_state,
+    .get_hall_enable_state = m1120_down_get_enable_state,
+    .get_data_real = m1120_down_get_real_data,
+	.get_data_abs  = m1120_down_get_abs_data,
+    .set_detection_mode = m1120_down_set_detection_mode,
+	.enable_irq = m1120_down_enable_irq,
+	.clear_irq = m1120_down_clear_irq,
+	.get_irq_state = m1120_down_get_irq_state,
+	.update_threshold = m1120_down_update_threshold,
+	.dump_regs = m1120_down_dump_reg,
+	.set_reg = m1120_down_set_reg
+};
+
+ /*********************************************************************
+                        init function
+ **********************************************************************/
+static int m1120_down_init_device(dhall_data_t* hall_data)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = hall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_down_init_device failed, p_hall_data == NULL || p_hall_data->client == NULL");
+    }
+
+   // err = m1120_down_set_power(p_hall_data, true);
+    //mutex_lock(&m1120_down_device_enable_mutex);
+    //parameter init 
+    atomic_set(&p_hall_data->device_enable, 0);
+    p_hall_data->irq_enabled = 0;
+
+    //reset registers
+    err = m1120_down_reset_device(p_hall_data);
+    if (err < 0) {
+        MOTOR_ERR("m1120_down_init_device failed, err : %d \n", err);
+        return err;
+    }
+    //mutex_unlock(&m1120_down_device_enable_mutex);
+    MOTOR_LOG("initializing device was success! \n");
+
+    return 0;
+}
+
+static int m1120_down_reset_device(dhall_data_t* dhall_data)
+{
+    int err = 0;
+    u8  id = 0xFF, data = 0x00;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_down_reset_device failed, p_hall_data == NULL || p_hall_data->client == NULL");
+        return -EINVAL;
+    }
+
+    // sw reset
+    data = M1120_VAL_SRST_RESET;
+    err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_SRST, &data,1);
+    if (err < 0) {
+        MOTOR_ERR( "sw-reset failed, err : %d \n", err);
+        return err;
+    }
+    msleep(5);
+    MOTOR_LOG("wait 5ms after vdd power up \n");
+
+    // check device id
+    err = m1120_down_i2c_read_block(p_hall_data, M1120_REG_DID, &id, 1);
+    if (err < 0)
+        return err;
+    if (id != M1120_VAL_DID) {
+        MOTOR_ERR("current device id(0x%02X) is not M1120 device id(0x%02X) \n", id, M1120_VAL_DID);
+        return -ENXIO;
+    }
+
+    //init persint
+    data = M1120_PERSISTENCE_COUNT;
+    err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_PERSINT, &data,1);
+    if (err <0) {
+        MOTOR_ERR("cm1120_down_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+    //init intsrs
+    data = M1120_DETECTION_MODE | M1120_SENSITIVITY_TYPE;
+    if (data & M1120_DETECTION_MODE_INTERRUPT) {
+        data |= M1120_INTERRUPT_TYPE;
+    }
+    err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_INTSRS, &data, 1);
+    if (err < 0) {
+        MOTOR_ERR("cm1120_down_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+    // init  operation mode
+    data = M1120_OPERATION_FREQUENCY | M1120_OPERATION_RESOLUTION;
+    err = m1120_down_i2c_write_block(p_hall_data, M1120_REG_OPF, &data, 1);
+    if (err < 0) {
+        MOTOR_ERR("m1120_down_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+
+    //set power on mode
+    m1120_down_set_enable(p_hall_data, true);//TO DO : set disable when boot finish???
+
+    return err;
+}
+
+static int m1120_down_power_init(dhall_data_t* dhall_data)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_down_power_init failed, p_hall_data == NULL || p_hall_data->client == NULL");
+        return -EINVAL;
+    }
+
+    //we don't need to set vio power since S4A will always-on
+    p_hall_data->vdd = regulator_get(&p_hall_data->client->dev, "vdd");
+    if (IS_ERR(p_hall_data->vdd)) {
+        err = PTR_ERR(p_hall_data->vdd);
+        MOTOR_ERR("regulator get vdd failed, err : %d \n", err);
+        return err;
+    }
+
+    if (regulator_count_voltages(p_hall_data->vdd) > 0) {
+        err = regulator_set_voltage(p_hall_data->vdd, M1120_VDD_MIN_UV, M1120_VDD_MAX_UV);
+        if (err) {
+            MOTOR_ERR("regulator set vdd failed, err : %d \n", err);
+            goto reg_vdd_put;
+        }
+    }
+
+    return 0;
+
+reg_vdd_put:
+    regulator_put(p_hall_data->vdd);
+    return err;
+}
+
+static int m1120_down_parse_dt(dhall_data_t* dhall_data)
+{
+    struct device_node *np = NULL;
+    u32 temp_val;
+    int err;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    MOTOR_LOG("call");
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+            MOTOR_ERR("m1120_down_parse_dt failed, p_hall_data == NULL || p_hall_data->client == NULL");
+            return -EINVAL;
+    }
+
+    np = p_hall_data->client->dev.of_node;
+
+    //gpio irq request 
+    p_hall_data->irq_gpio =  of_get_named_gpio(np, "dhall,irq-gpio", 0);
+    MOTOR_LOG("irq_gpio : %d", p_hall_data->irq_gpio);
+    if (gpio_is_valid(p_hall_data->irq_gpio)) {
+        err = gpio_request(p_hall_data->irq_gpio, "m1120_down_irq");
+        if (err) {
+            MOTOR_ERR("unable to request gpio : %d", p_hall_data->irq_gpio);
+        } else {
+            err = gpio_direction_input(dhall_data->irq_gpio);
+            msleep(50);
+            p_hall_data->irq = gpio_to_irq(dhall_data->irq_gpio);
+            MOTOR_LOG("gpio_to_irq success, irq : %d", p_hall_data->irq);
+        }
+    }
+
+    return 0;
+}
+static int m1120_down_i2c_drv_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    dhall_data_t* p_hall_data;
+    int           err = 0;
+
+    MOTOR_LOG("call");
+
+    //allocation memory for g_hall_data
+    p_hall_data = kzalloc(sizeof(dhall_data_t), GFP_KERNEL);
+    if (!p_hall_data) {
+        MOTOR_ERR("kernel memory alocation was failed \n");
+        err = -ENOMEM;
+        goto error_0;
+    }
+
+    //config i2c client
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        MOTOR_ERR("i2c_check_functionality was failed \n");
+        err = -ENODEV;
+        goto error_1;
+    }
+    i2c_set_clientdata(client, p_hall_data);
+    p_hall_data->client = client;
+    g_hall_data = p_hall_data;//save in global val 
+
+    if (client->dev.of_node) {
+        MOTOR_LOG("use client->dev.of_node \n");
+        err = m1120_down_parse_dt(p_hall_data);
+        if (err) {
+            MOTOR_LOG("failed to parse device tree, go to error_1 \n");
+            err = -EINVAL;
+            goto error_1;
+        }
+    } else {
+        MOTOR_ERR("client->dev.of_node == NULL \n");
+         goto error_0;
+    }
+
+    //power init and set power on for device
+    p_hall_data->power_enabled = false;
+    err = m1120_down_power_init(p_hall_data);
+    if (err) {
+        MOTOR_ERR("failed to get sensor regulators \n");
+        err = -EINVAL;
+        goto error_1;
+    }
+    err = m1120_down_power_ctl(p_hall_data, true);
+    if (err) {
+        MOTOR_ERR("failed to enable sensor power \n");
+        err = -EINVAL;
+        goto error_1;
+    }
+
+    //reset and init device
+    err = m1120_down_init_device(p_hall_data);
+    if (err) {
+        MOTOR_ERR("m1120_down_init_device failed,  err : %d \n", err);
+        goto error_1;
+    }
+    MOTOR_LOG( "%s found", id->name);
+    MOTOR_LOG("%s initialized", M1120_DRIVER_NAME_DOWN);
+
+    //register ops to abstract level
+    oneplus_register_dhall("m1120_down",&m1120_down_ops);
+
+    MOTOR_LOG("i2c addr : %d \n", client->addr);
+    MOTOR_LOG("%s was probed \n", M1120_DRIVER_NAME_DOWN);
+
+    return 0;
+
+error_1:
+    kfree(p_hall_data);
+
+error_0:
+       g_hall_data = NULL;
+    return err;
+}
+
+static int m1120_down_i2c_drv_remove(struct i2c_client *client)
+{
+    dhall_data_t* p_hall_data = i2c_get_clientdata(client);
+
+    if (p_hall_data == NULL) {
+        MOTOR_ERR("m1120_down_i2c_drv_remove failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+    m1120_down_set_enable(p_hall_data, false);
+    kfree(p_hall_data);
+
+    return 0;
+}
+
+static const struct i2c_device_id m1120_down_i2c_drv_id_table[] = {
+    {"m1120_down", 0 },
+    { }
+};
+
+static const struct of_device_id m1120_down_of_match[] = {
+    { .compatible = "magnachip,mxm1120,down", },
+    { },
+};
+
+static struct i2c_driver m1120_down_driver = {
+    .driver = {
+        .owner  = THIS_MODULE,
+        .name   = M1120_DRIVER_NAME_DOWN,
+        .of_match_table = m1120_down_of_match,
+    },
+    .probe    = m1120_down_i2c_drv_probe,
+    .remove  = m1120_down_i2c_drv_remove,
+    .id_table   = m1120_down_i2c_drv_id_table,
+    //.suspend  = m1120_down_i2c_drv_suspend,
+    //.resume      = m1120_down_i2c_drv_resume,
+};
+
+static int __init m1120_down_driver_init_down(void)
+{
+    int err = 0;
+    
+    err = i2c_add_driver(&m1120_down_driver);
+    MOTOR_LOG("err : %d \n", err);
+    return err;
+}
+module_init(m1120_down_driver_init_down);
+
+static void __exit m1120_down_driver_exit_down(void)
+{
+    MOTOR_LOG("call \n");
+    i2c_del_driver(&m1120_down_driver);
+}
+module_exit(m1120_down_driver_exit_down);
+
+
+MODULE_DESCRIPTION("M1120 hallswitch driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("quentin.lin");
+
diff --git a/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_up.c b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_up.c
new file mode 100644
index 0000000000000000000000000000000000000000..85d3d277f0e1860c22974f5ffa6c156b0756a5e4
--- /dev/null
+++ b/drivers/leds/step_motor/digital_hall_ic/oneplus_m1120_up.c
@@ -0,0 +1,1013 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS 
+** File        : oneplus_m1120_up.c
+**
+** Description : 
+**      Definitions for m1120 digital hall_up sensor, i2c address is 0x0C  
+**
+****************************************************************************************/
+
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+//#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+//#include <linux/workqueue.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/regulator/consumer.h>
+#include <linux/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include "oneplus_m1120.h"
+#include "../oneplus_motor.h"
+
+/************************begin of declaration************************/
+
+/************************static global variable************************/
+static DEFINE_MUTEX(m1120_up_i2c_mutex);
+static DEFINE_MUTEX(m1120_up_device_enable_mutex);
+static dhall_data_t *g_hall_data;
+
+/************************function about i2c************************/
+static int   m1120_up_i2c_read_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len);
+static int   m1120_up_i2c_write_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len);
+static void  m1120_up_short_to_2byte(dhall_data_t* dhall_data, short x, u8 *hbyte, u8 *lbyte);
+static short m1120_up_2byte_to_short(dhall_data_t* dhall_data, u8 hbyte, u8 lbyte);
+
+/************************internal interrupt function************************/
+static irqreturn_t   m1120_up_irq_handler(int irq, void *dev_id);
+static int   m1120_up_clear_interrupt(dhall_data_t* dhall_data);
+
+/************************internal power control function************************/
+static int   m1120_up_power_init(dhall_data_t *data);
+static int   m1120_up_power_ctl(dhall_data_t* dhall_data, bool on);
+static int   m1120_up_set_operation_mode(dhall_data_t* dhall_data, int mode);
+//static int   m1120_up_set_power(struct device *dev, bool on);
+static bool  m1120_up_get_enable(dhall_data_t* dhall_data);
+static void  m1120_up_set_enable(dhall_data_t* dhall_data, bool enable);
+
+/************interface implement for abstract control level************/
+static bool  m1120_up_is_power_on(void);
+static int   m1120_up_parse_dt(dhall_data_t* pdata);
+static int   m1120_up_set_enable_state(bool enable);
+static bool  m1120_up_get_enable_state(void);
+static int   m1120_up_get_real_data(short *data);
+static int   m1120_up_get_abs_data( short *data);
+static int   m1120_up_set_detection_mode(u8 mode);
+static int   m1120_up_enable_irq(bool enable);
+static int   m1120_up_clear_irq(void);
+static int   m1120_up_get_irq_state(void);
+static bool  m1120_up_update_threshold(int position, short lowthd, short highthd);
+static void  m1120_up_dump_reg(u8* buf);
+static int   m1120_up_set_reg(int reg, int val);
+
+/************************init function************************/
+static int   m1120_up_init_device(dhall_data_t* hall_data);
+static int   m1120_up_reset_device(dhall_data_t* dhall_data);
+static int   m1120_up_power_init(dhall_data_t* dhall_data);
+
+/************************end of declaration************************/
+
+
+ /*********************************************************************
+                        function about i2c
+ **********************************************************************/
+static int m1120_up_i2c_read_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len)
+{
+	u8 reg_addr = addr;
+	int err = 0;
+	struct i2c_client *client = NULL;
+	struct i2c_msg msgs[2]={{0},{0}};
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (dhall_data == NULL) {
+		MOTOR_ERR("m1120_up_i2c_read_block, dhall_data == NULL \n");
+		return -EINVAL;
+    }
+    client = dhall_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null\n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d\n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+
+	mutex_lock(&m1120_up_i2c_mutex); 
+
+	msgs[0].addr = client->addr;
+	msgs[0].flags = 0;
+ 	msgs[0].len =1;
+ 	msgs[0].buf = &reg_addr;
+
+ 	msgs[1].addr = client->addr;
+ 	msgs[1].flags = I2C_M_RD;
+ 	msgs[1].len =len;
+ 	msgs[1].buf = data;
+
+ 	err = i2c_transfer(client->adapter, msgs, (sizeof(msgs) / sizeof(msgs[0])));
+
+ 	if (err < 0) {
+ 		MOTOR_ERR("i2c_transfer error: (%d %p %d) %d\n",addr, data, len, err);
+ 		err = -EIO;
+ 	} else  {
+ 		err = 0;
+ 	}
+ 	mutex_unlock(&m1120_up_i2c_mutex);
+
+ 	return err;
+
+}
+
+static int m1120_up_i2c_write_block(dhall_data_t* dhall_data, u8 addr, u8 *data, u8 len)
+{
+	int err = 0;
+	int idx = 0;
+	int num = 0;
+	char buf[M1120_I2C_BUF_SIZE] ={0};
+	struct i2c_client *client = NULL;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_up_i2c_write_block failed, p_hall_data == NULL \n");
+		return -EINVAL;
+    }
+    client = p_hall_data->client;
+
+	if (!client) {
+		MOTOR_ERR("client null \n");
+		return -EINVAL;
+	} else if (len >= M1120_I2C_BUF_SIZE) {
+		MOTOR_ERR(" length %d exceeds %d \n", len, M1120_I2C_BUF_SIZE);
+		return -EINVAL;
+	}
+
+	mutex_lock(&m1120_up_i2c_mutex);
+
+	buf[num++] = addr;
+	for (idx = 0; idx < len; idx++) {
+		buf[num++] = data[idx];
+	}
+    
+	err = i2c_master_send(client, buf, num);
+	if (err < 0) {
+		MOTOR_ERR("send command error!! %d\n",err);
+	}
+
+	//store reg written
+	if (len == 1) {
+		switch(addr){
+		case M1120_REG_PERSINT:
+			p_hall_data->reg.map.persint = data[0];
+			break;
+		case M1120_REG_INTSRS:
+			p_hall_data->reg.map.intsrs = data[0];
+			break;
+		case M1120_REG_LTHL:
+			p_hall_data->reg.map.lthl = data[0];
+			break;
+		case M1120_REG_LTHH:
+			p_hall_data->reg.map.lthh = data[0];
+			break;
+		case M1120_REG_HTHL:
+			p_hall_data->reg.map.hthl = data[0];
+			break;
+		case M1120_REG_HTHH:
+			p_hall_data->reg.map.hthh = data[0];
+			break;
+		case M1120_REG_I2CDIS:
+			p_hall_data->reg.map.i2cdis = data[0];
+			break;
+		case M1120_REG_SRST:
+			p_hall_data->reg.map.srst = data[0];
+			break;
+		case M1120_REG_OPF:
+			p_hall_data->reg.map.opf = data[0];
+			break;
+		}
+	}
+	mutex_unlock(&m1120_up_i2c_mutex);
+	return err;
+}
+
+static void m1120_up_short_to_2byte(dhall_data_t* dhall_data, short x, u8 *hbyte, u8 *lbyte)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_up_short_to_2byte failed, p_hall_data == NULL \n");
+		return ;
+    }
+
+	if ((p_hall_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		//8 bit
+		if (x < -128) {
+			x = -128;
+		} else if(x > 127) {
+			x = 127;
+		}
+
+		if (x >= 0) {
+			*lbyte = x & 0x7F;
+		} else {
+			*lbyte = ( (0x80 - (x*(-1))) & 0x7F ) | 0x80;
+		}
+		*hbyte = 0x00;
+	} else {
+		//10 bit 
+		if (x < -512) {
+			x = -512;
+		} else if (x > 511) {
+			x = 511;
+		}
+
+		if (x >=0 ) {
+			*lbyte = x & 0xFF;
+			*hbyte = (((x & 0x100) >> 8) & 0x01) << 6;
+		} else {
+			*lbyte = (0x0200 - (x*(-1))) & 0xFF;
+			*hbyte = ((((0x0200 - (x*(-1))) & 0x100) >> 8) << 6) | 0x80;
+		}
+	}
+}
+
+static short m1120_up_2byte_to_short(dhall_data_t* dhall_data, u8 hbyte, u8 lbyte)
+{
+	short x = 0;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("m1120_up_2byte_to_short failed, p_hall_data == NULL \n");
+		return -EINVAL;
+    }
+
+	if( (p_hall_data->reg.map.opf & M1120_VAL_OPF_BIT_8) == M1120_VAL_OPF_BIT_8) {
+		//8 bit 
+		x = lbyte & 0x7F;
+		if (lbyte & 0x80) {
+			x -= 0x80;
+		}
+	} else {
+		//10 bit
+		x = (((hbyte & 0x40) >> 6) << 8 ) | lbyte;
+		if (hbyte & 0x80) {
+			x -= 0x200;
+		}
+	}
+
+	return x;
+}
+
+ /*********************************************************************
+                        internal interrupt function
+ **********************************************************************/
+static irqreturn_t m1120_up_irq_handler(int irq, void *dev_id)
+{
+	MOTOR_LOG("call \n");
+
+	if (g_hall_data == NULL) {
+		MOTOR_ERR("m1120_up_irq_handler failed, g_hall_data == NULL \n");
+		return -EINVAL;
+	}
+
+	disable_irq_nosync(g_hall_data->irq);
+	oneplus_dhall_irq_handler(HALL_UP);
+
+	return IRQ_HANDLED;
+}
+
+static int m1120_up_clear_interrupt(dhall_data_t* dhall_data)
+{
+    int err = -1;
+    u8 data = 0x00;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL) {
+		MOTOR_ERR("p_hall_data == NULL \n");
+		return -EINVAL;
+	}
+
+    data = p_hall_data->reg.map.persint | 0x01;
+    err =  m1120_up_i2c_write_block(p_hall_data, M1120_REG_PERSINT, &data,1);
+
+    return err;
+}
+
+ /*********************************************************************
+                        internal power control function
+ **********************************************************************/
+static int m1120_up_power_ctl(dhall_data_t* dhall_data, bool on)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_up_set_enable failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+     //we don't need to set vio power since S4A will always-on
+    if (!on && p_hall_data->power_enabled) {
+        err = regulator_disable(p_hall_data->vdd);
+        if (err) {
+            MOTOR_ERR("regulator vdd disable failed err=%d \n", err);
+            return err;
+        }
+
+        p_hall_data->power_enabled = on;
+    } else if (on && !p_hall_data->power_enabled) {
+        err = regulator_enable(p_hall_data->vdd);
+        if (err) {
+            MOTOR_ERR("regulator vdd enable failed err=%d\n", err);
+            return err;
+        }
+        msleep(10); // wait 10ms
+        p_hall_data->power_enabled = on;
+    } else {
+        MOTOR_LOG("power on=%d. enabled=%d\n", on, p_hall_data->power_enabled);
+    }
+
+    return err;
+}
+
+// static int m1120_up_set_power(struct device *dev, bool on)
+// {
+//     m1120_up_power_ctl(g_hall_data, on);
+
+//     return 0;
+// }
+
+
+static int m1120_up_set_operation_mode(dhall_data_t* dhall_data, int mode)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    u8 opf = p_hall_data->reg.map.opf;
+    int err = -1;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_up_set_enable failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+    switch (mode) {
+    case OPERATION_MODE_POWERDOWN:
+        opf &= (0xFF - M1120_VAL_OPF_HSSON_ON);
+        err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_POWERDOWN");
+        break;
+
+    case OPERATION_MODE_MEASUREMENT:
+        opf &= (0xFF - M1120_VAL_OPF_EFRD_ON);
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_MEASUREMENT");
+        break;
+
+    case OPERATION_MODE_FUSEROMACCESS:
+        opf |= M1120_VAL_OPF_EFRD_ON;
+        opf |= M1120_VAL_OPF_HSSON_ON;
+        err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_OPF, &opf, 1);
+        MOTOR_LOG("operation mode chnage to OPERATION_MODE_FUSEROMACCESS");
+        break;
+
+    default :
+        MOTOR_ERR("unknow operation mode, mode : %d", mode);
+    }
+
+    MOTOR_LOG("opf = ox%x \n", opf);
+
+    return err;
+}
+
+static bool m1120_up_get_enable(dhall_data_t* dhall_data)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    int enable = -1;
+
+    if (p_hall_data == NULL ) {
+        MOTOR_ERR("m1120_up_set_enable failed, p_hall_data == NULL \n");
+        return false;
+    }
+    mutex_lock(&m1120_up_device_enable_mutex);
+
+    enable = atomic_read(&p_hall_data->device_enable);
+
+    mutex_unlock(&m1120_up_device_enable_mutex);
+
+    return enable > 0 ? true : false;
+}
+
+//需�看看這個怎麼�
+static void m1120_up_set_enable(dhall_data_t* dhall_data, bool enable)
+{
+    dhall_data_t* p_hall_data = dhall_data;
+    int p_enable = enable ? 1 : 0;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_up_set_enable failed, p_hall_data == NULL || p_hall_data->client == NULL \n");
+        return;
+    }
+    MOTOR_LOG("1 \n ");
+    mutex_lock(&m1120_up_device_enable_mutex);// add mutex for what ??
+    MOTOR_LOG("m1120_up enable : %d\n", p_enable);
+    if (enable) {                  
+        //enable if state will be changed
+        if (!atomic_cmpxchg(&p_hall_data->device_enable, 0, 1)) {
+            m1120_up_set_operation_mode(p_hall_data, OPERATION_MODE_MEASUREMENT);
+        }
+    } else {                        
+        //disable if state will be changed
+        if (atomic_cmpxchg(&p_hall_data->device_enable, 1, 0)) {
+            m1120_up_set_operation_mode(p_hall_data, OPERATION_MODE_POWERDOWN);
+        }
+    }
+    atomic_set(&p_hall_data->device_enable, p_enable);
+    MOTOR_LOG("end \n ");
+    mutex_unlock(&m1120_up_device_enable_mutex);
+}
+
+ /*********************************************************************
+                interface implement for onplus_motor.c
+ **********************************************************************/
+static bool m1120_up_get_enable_state(void)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("m1120_up_get_enable_state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    return m1120_up_get_enable(g_hall_data) ;
+}
+
+static int m1120_up_set_enable_state(bool enable)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("m1120_up_set_enable_state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    MOTOR_LOG("set m1120_up enable : %d", enable ? 1 : 0);
+    m1120_up_set_enable(g_hall_data, enable);
+
+    return 0;
+}
+
+static bool m1120_up_is_power_on(void)
+{
+    if (g_hall_data == NULL) {
+		MOTOR_LOG("get m1120_up_is_power_on state failed, g_hall_data == NULL \n");
+		return false;
+	}
+
+    return g_hall_data->power_enabled > 0 ? true : false;
+}
+static int m1120_up_get_real_data(short* data)
+{ 
+    int err = 0;
+	u8 buf[3] = {0};
+	short value = 0;
+
+    if(!g_hall_data) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -1;
+    }
+
+	//read data
+	err = m1120_up_i2c_read_block(g_hall_data, M1120_REG_ST1, buf, sizeof(buf));
+	if (err < 0) {
+		MOTOR_ERR("m1120_up get data fail, err : %d \n",err);
+		return err;
+	}
+
+	//collect data
+	if (buf[0] & 0x01) {
+		value = m1120_up_2byte_to_short(g_hall_data, buf[2], buf[1]);
+	} else {
+		MOTOR_ERR("m1120: st1(0x%02X) is not DRDY.\n", buf[0]);
+		return -1;
+	}
+
+	*data = value;
+
+    MOTOR_LOG("value : %d", value);
+	return 0;
+}
+
+static int m1120_up_get_abs_data(short* data)
+{ 
+    short value = 0;
+    int err = -1;
+
+    err = m1120_up_get_real_data(&value);
+    if (err < 0) {
+        MOTOR_ERR("m1120_up get abs data filed, err : %d \n", err);
+        return err;
+    }
+
+    value = abs(value);
+	*data = value;
+
+    MOTOR_LOG("value : %d", value);
+
+	return 0;
+}
+
+static int m1120_up_set_detection_mode(u8 mode)
+{
+	u8 data = 0;
+	int err = 0;
+
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	MOTOR_LOG("m1120 detection mode : %s, irq_enabled : %d\n", (mode == 0)? "POLLING":"INTERRUPT", g_hall_data->irq_enabled);
+	if(mode & DETECTION_MODE_INTERRUPT) {
+		if (!g_hall_data->irq_enabled) {
+			data = g_hall_data->reg.map.intsrs | M1120_DETECTION_MODE_INTERRUPT;
+			err = m1120_up_i2c_write_block(g_hall_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail, err : %d \n",err);
+				return err;
+			}
+			err = m1120_up_clear_interrupt(g_hall_data);
+			if (err < 0) {
+				MOTOR_ERR("clear interupt fail, err : %d \n",err);
+				return err;
+			}
+
+			//requst irq 
+            if (request_irq(g_hall_data->irq, &m1120_up_irq_handler, IRQ_TYPE_LEVEL_LOW, "m1120_up", (void *)g_hall_data->client)) {
+				MOTOR_ERR("IRQ LINE NOT AVAILABLE!! \n");
+				return -EINVAL;
+			}
+			irq_set_irq_wake(g_hall_data->irq, 1);
+
+			g_hall_data->irq_enabled = 1;
+		}
+	} else {
+		if (g_hall_data->irq_enabled) {
+			data = g_hall_data->reg.map.intsrs & (0xFF - M1120_DETECTION_MODE_INTERRUPT);
+
+			err = m1120_up_i2c_write_block(g_hall_data, M1120_REG_INTSRS, &data, 1);
+			if (err < 0) {
+				MOTOR_ERR("config interupt fail, err : %d \n",err);
+				return err;
+			}
+
+			disable_irq(g_hall_data->irq);
+			free_irq(g_hall_data->irq, NULL);
+
+			g_hall_data->irq_enabled = 0;
+		}
+	}
+
+    return 0;    
+}
+static int m1120_up_enable_irq(bool enable)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	if (enable) {
+		enable_irq(g_hall_data->irq);
+	} else {
+		disable_irq_nosync(g_hall_data->irq);
+	}
+
+    return 0;
+}
+
+static int m1120_up_clear_irq(void)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_up_clear_interrupt(g_hall_data);
+    return 0;
+}
+
+static int m1120_up_get_irq_state(void)
+{
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+    return ((g_hall_data->reg.map.intsrs & M1120_DETECTION_MODE_INTERRUPT) ? 1 : 0);   
+}
+
+static bool m1120_up_update_threshold(int position, short lowthd, short highthd)
+{
+    
+    u8 lthh, lthl, hthh, hthl;
+	int err = 0;
+
+	if (g_hall_data == NULL) {
+		MOTOR_LOG("g_hall_data == NULL \n");
+		return -EINVAL;
+	}
+	MOTOR_LOG("m1120_up ,low: %d, high :%d, intsrs : %d \n",lowthd, highthd, g_hall_data->reg.map.intsrs);
+
+	err = m1120_up_clear_interrupt(g_hall_data);
+
+	if (g_hall_data->reg.map.intsrs & M1120_VAL_INTSRS_INTTYPE_WITHIN) {
+
+		m1120_up_short_to_2byte(g_hall_data, highthd, &hthh, &hthl);
+		m1120_up_short_to_2byte(g_hall_data, lowthd, &lthh, &lthl);
+		err |= m1120_up_i2c_write_block(g_hall_data, M1120_REG_HTHH,&hthh, 1);
+		err |= m1120_up_i2c_write_block(g_hall_data, M1120_REG_HTHL,&hthl, 1);
+		err |= m1120_up_i2c_write_block(g_hall_data, M1120_REG_LTHH,&lthh, 1);
+		err |= m1120_up_i2c_write_block(g_hall_data, M1120_REG_LTHL,&lthl, 1);
+	}
+
+	if (err < 0) {
+		MOTOR_ERR("update threshold fail, err : %d\n",err);
+		return false;
+	}
+
+    return true;
+}
+
+static void m1120_up_dump_reg(u8* buf)
+{
+    int i, err;
+	u8 val;
+	u8 buffer[512] = {0};
+	u8 _buf[20] = {0};
+
+	if (g_hall_data == NULL) {
+		MOTOR_LOG("g_hall_data == NULL \n");
+		return ;
+	}
+
+	for (i = 0; i <= 0x12; i++) {
+		memset(_buf, 0, sizeof(_buf));
+
+		err = m1120_up_i2c_read_block(g_hall_data, i, &val, 1);
+		if (err < 0) {
+			sprintf(buf, "read reg error!\n");
+			return;
+		}
+
+		sprintf(_buf,  "reg 0x%x:0x%x\n", i, val);
+		strcat(buffer, _buf);
+	}
+	sprintf(buf, "%s\n", buffer);
+	MOTOR_LOG("%s \n",buf);
+
+    return ;  
+}
+
+static int m1120_up_set_reg(int reg, int val)
+{
+    u8 data = (u8)val;
+
+    MOTOR_LOG("reg : %d, val : %d", reg, val);
+    if(g_hall_data == NULL) {
+        MOTOR_ERR("g_hall_data == NULL");
+        return -EINVAL;
+    }
+
+	m1120_up_i2c_write_block(g_hall_data, (u8)reg, &data,1);
+
+    return 0;  
+}
+
+struct oneplus_hall_operations m1120_up_ops = {
+    .name = "m1120_up",
+    .is_power_on = m1120_up_is_power_on,
+    .set_hall_enable_state = m1120_up_set_enable_state,
+    .get_hall_enable_state = m1120_up_get_enable_state,
+    .get_data_real = m1120_up_get_real_data,
+	.get_data_abs  = m1120_up_get_abs_data,
+    .set_detection_mode = m1120_up_set_detection_mode,
+	.enable_irq = m1120_up_enable_irq,
+	.clear_irq = m1120_up_clear_irq,
+	.get_irq_state = m1120_up_get_irq_state,
+	.update_threshold = m1120_up_update_threshold,
+	.dump_regs = m1120_up_dump_reg,
+	.set_reg = m1120_up_set_reg
+};
+
+ /*********************************************************************
+                        init function
+ **********************************************************************/
+static int m1120_up_init_device(dhall_data_t* hall_data)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = hall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_up_init_device failed, p_hall_data == NULL || p_hall_data->client == NULL");
+    }
+
+    //err = m1120_up_set_power(p_hall_data, true);
+    //mutex_lock(&m1120_up_device_enable_mutex);
+
+    //parameter init 
+    atomic_set(&p_hall_data->device_enable, 0);
+    p_hall_data->irq_enabled = 0;
+
+    //reset registers
+    err = m1120_up_reset_device(p_hall_data);
+    if (err < 0) {
+        MOTOR_ERR("m1120_up_init_device failed, err : %d \n", err);
+        return err;
+    }
+
+    //mutex_unlock(&m1120_up_device_enable_mutex);
+
+    MOTOR_LOG("initializing device was success! \n");
+    
+    return 0;
+}
+
+static int m1120_up_reset_device(dhall_data_t* dhall_data)
+{
+    int err = 0;
+    u8  id = 0xFF, data = 0x00;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_up_reset_device failed, p_hall_data == NULL || p_hall_data->client == NULL");
+        return -EINVAL;
+    }
+
+    // sw reset
+    data = M1120_VAL_SRST_RESET;
+    err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_SRST, &data,1);
+    if (err < 0) {
+        MOTOR_ERR( "sw-reset failed, err : %d \n", err);
+        return err;
+    }
+    msleep(5);
+    MOTOR_LOG("wait 5ms after vdd power up \n");
+
+    // check device id
+    err = m1120_up_i2c_read_block(p_hall_data, M1120_REG_DID, &id, 1);
+    MOTOR_LOG("1 \n");
+    if (err < 0)
+        return err;
+    if (id != M1120_VAL_DID) {
+        MOTOR_ERR("current device id(0x%02X) is not M1120 device id(0x%02X) \n", id, M1120_VAL_DID);
+        return -ENXIO;
+    }
+
+    //init persint
+    MOTOR_LOG("2 \n ");
+    data = M1120_PERSISTENCE_COUNT;
+    err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_PERSINT, &data,1);
+    if (err <0) {
+        MOTOR_ERR("cm1120_up_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+    //init intsrs
+    MOTOR_LOG("3 \n ");
+    data = M1120_DETECTION_MODE | M1120_SENSITIVITY_TYPE;
+    if (data & M1120_DETECTION_MODE_INTERRUPT) {
+        data |= M1120_INTERRUPT_TYPE;
+    }
+    err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_INTSRS, &data, 1);
+    if (err < 0) {
+        MOTOR_ERR("cm1120_up_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+    // init  operation mode
+    MOTOR_LOG("4 \n ");
+    data = M1120_OPERATION_FREQUENCY | M1120_OPERATION_RESOLUTION;
+    err = m1120_up_i2c_write_block(p_hall_data, M1120_REG_OPF, &data, 1);
+    if (err < 0) {
+        MOTOR_ERR("cm1120_up_i2c_write_block error, data : %d \n", data);
+        return err;
+    }
+
+    //set power on mode
+    //这边若�行的�,�新�的函数
+    m1120_up_set_enable(p_hall_data, true);//TO DO : set disable when boot finish???
+    MOTOR_LOG("5 \n ");
+    return err;
+}
+
+static int m1120_up_power_init(dhall_data_t* dhall_data)
+{
+    int err = -1;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+        MOTOR_ERR("m1120_up_power_init failed, p_hall_data == NULL || p_hall_data->client == NULL");
+        return -EINVAL;
+    }
+
+    //we don't need to set vio power since S4A will always-on
+    p_hall_data->vdd = regulator_get(&p_hall_data->client->dev, "vdd");
+    if (IS_ERR(p_hall_data->vdd)) {
+        err = PTR_ERR(p_hall_data->vdd);
+        MOTOR_ERR("regulator get vdd failed, err : %d \n", err);
+        return err;
+    }
+
+    if (regulator_count_voltages(p_hall_data->vdd) > 0) {
+        err = regulator_set_voltage(p_hall_data->vdd, M1120_VDD_MIN_UV, M1120_VDD_MAX_UV);
+        if (err) {
+            MOTOR_ERR("regulator set vdd failed, err : %d \n", err);
+            goto reg_vdd_put;
+        }
+    }
+
+    return 0;
+
+reg_vdd_put:
+    regulator_put(p_hall_data->vdd);
+    return err;
+}
+
+static int m1120_up_parse_dt(dhall_data_t* dhall_data)
+{
+    struct device_node *np = NULL;
+    u32 temp_val;
+    int err;
+    dhall_data_t* p_hall_data = dhall_data;
+
+    MOTOR_LOG("call");
+
+    if (p_hall_data == NULL || p_hall_data->client == NULL) {
+             MOTOR_ERR("m1120_up_parse_dt failed, p_hall_data == NULL || p_hall_data->client == NULL");
+            // MOTOR_ERR("m1120_up_parse_dt failed, p_hall_data == NULL || p_hall_data->client == NULL || "
+            //           "p_hall_data->client->dev == NULL || p_hall_data->client->dev->of_node == NULL");
+
+            return -EINVAL;
+    }
+
+    np = p_hall_data->client->dev.of_node;
+
+    //gpio irq request 
+    p_hall_data->irq_gpio =  of_get_named_gpio(np, "dhall,irq-gpio", 0);
+    MOTOR_LOG("irq_gpio : %d", p_hall_data->irq_gpio);
+    if (gpio_is_valid(p_hall_data->irq_gpio)) {
+        err = gpio_request(p_hall_data->irq_gpio, "m1120_up_irq");
+        if (err) {
+            MOTOR_ERR("unable to request gpio : %d", p_hall_data->irq_gpio);
+        } else {
+            err = gpio_direction_input(dhall_data->irq_gpio);
+            msleep(50);
+            p_hall_data->irq = gpio_to_irq(dhall_data->irq_gpio);
+            MOTOR_LOG("gpio_to_irq success, irq : %d", p_hall_data->irq);
+        }
+    }
+
+    return 0;
+}
+static int m1120_up_i2c_drv_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+    dhall_data_t* p_hall_data;
+    int           err = 0;
+
+    MOTOR_LOG("call");
+
+    //allocation memory for g_hall_data
+    p_hall_data = kzalloc(sizeof(dhall_data_t), GFP_KERNEL);
+    if (!p_hall_data) {
+        MOTOR_ERR("kernel memory alocation was failed \n");
+        err = -ENOMEM;
+        goto error_0;
+    }
+
+    //config i2c client
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        MOTOR_ERR("i2c_check_functionality was failed \n");
+        err = -ENODEV;
+        goto error_1;
+    }
+    i2c_set_clientdata(client, p_hall_data);
+    p_hall_data->client = client;
+    g_hall_data = p_hall_data;//save in global val 
+
+    if (client->dev.of_node) {
+        MOTOR_LOG("use client->dev.of_node \n");
+        err = m1120_up_parse_dt(p_hall_data);
+        if (err) {
+            MOTOR_LOG("failed to parse device tree, go to error_1 \n");
+            err = -EINVAL;
+            goto error_1;
+        }
+    } else {
+        MOTOR_ERR("client->dev.of_node == NULL \n");
+         goto error_0;
+    }
+
+    //power init and set power on for device
+    p_hall_data->power_enabled = false;
+    err = m1120_up_power_init(p_hall_data);
+    if (err) {
+        MOTOR_ERR("failed to get sensor regulators \n");
+        err = -EINVAL;
+        goto error_1;
+    }
+    err = m1120_up_power_ctl(p_hall_data, true);
+    if (err) {
+        MOTOR_ERR("failed to enable sensor power \n");
+        err = -EINVAL;
+        goto error_1;
+    }
+
+    //reset and init device
+    err = m1120_up_init_device(p_hall_data);
+    if (err) {
+        MOTOR_ERR("m1120_up_init_device failed,  err : %d \n", err);
+        goto error_1;
+    }
+    MOTOR_LOG( "%s found", id->name);
+    MOTOR_LOG("%s initialized", M1120_DRIVER_NAME_UP);
+
+    //register ops to abstract level
+    oneplus_register_dhall("m1120_up",&m1120_up_ops);
+
+    MOTOR_LOG("i2c addr : %d \n", client->addr);
+    MOTOR_LOG("%s was probed \n", M1120_DRIVER_NAME_UP);
+
+    return 0;
+
+error_1:
+    kfree(p_hall_data);
+
+error_0:
+       g_hall_data = NULL;
+    return err;
+}
+
+static int m1120_up_i2c_drv_remove(struct i2c_client *client)
+{
+    dhall_data_t* p_hall_data = i2c_get_clientdata(client);
+
+    if (p_hall_data == NULL) {
+        MOTOR_ERR("m1120_up_i2c_drv_remove failed, p_hall_data == NULL \n");
+        return -EINVAL;
+    }
+
+    m1120_up_set_enable(p_hall_data, false);
+    kfree(p_hall_data);
+
+    return 0;
+}
+
+static const struct i2c_device_id m1120_up_i2c_drv_id_table[] = {
+    {"m1120_up", 0 },
+    { }
+};
+
+static const struct of_device_id m1120_up_of_match[] = {
+    { .compatible = "magnachip,mxm1120,up", },
+    { },
+};
+
+static struct i2c_driver m1120_up_driver = {
+    .driver = {
+        .owner  = THIS_MODULE,
+        .name   = M1120_DRIVER_NAME_UP,
+        .of_match_table = m1120_up_of_match,
+    },
+    .probe    = m1120_up_i2c_drv_probe,
+    .remove  = m1120_up_i2c_drv_remove,
+    .id_table   = m1120_up_i2c_drv_id_table,
+    //.suspend  = m1120_up_i2c_drv_suspend,
+    //.resume      = m1120_up_i2c_drv_resume,
+};
+
+static int __init m1120_up_driver_init_up(void)
+{
+    int err = 0;
+    
+    err = i2c_add_driver(&m1120_up_driver);
+    MOTOR_LOG("err : %d \n", err);
+    return err;
+}
+module_init(m1120_up_driver_init_up);
+
+static void __exit m1120_up_driver_exit_up(void)
+{
+    MOTOR_LOG("call \n");
+    i2c_del_driver(&m1120_up_driver);
+}
+module_exit(m1120_up_driver_exit_up);
+
+MODULE_DESCRIPTION("M1120 hallswitch driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("quentin.lin");
+
diff --git a/drivers/leds/step_motor/oneplus_motor.c b/drivers/leds/step_motor/oneplus_motor.c
new file mode 100644
index 0000000000000000000000000000000000000000..20a066172a5e5cb51ae3fa2fa0fba73ef27f9288
--- /dev/null
+++ b/drivers/leds/step_motor/oneplus_motor.c
@@ -0,0 +1,3195 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_motor.c
+**
+** Description:
+**      Definitions for m1120 camera motor control layer.
+**
+****************************************************************************************/
+
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/types.h>
+#include <linux/slab.h>
+#include <linux/workqueue.h>
+#include <asm/uaccess.h>
+#include <linux/gpio.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/of_gpio.h>
+#include <linux/proc_fs.h>
+#include <linux/hrtimer.h>
+#include <linux/alarmtimer.h>
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#include <linux/string.h>
+#include <linux/syscalls.h>
+//#include <linux/jiffies.h>
+#include <linux/sched.h>
+#include <linux/jiffies.h>
+#ifdef CONFIG_DRM_MSM
+#include <linux/msm_drm_notify.h>
+#endif
+#include <linux/platform_device.h>
+#include <linux/regulator/consumer.h>
+#include <linux/version.h>
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+#include <linux/wakelock.h>
+#endif
+#include "oneplus_motor.h"
+#include "oneplus_motor_notifier.h"
+
+/************************static global variable************************/
+static struct oneplus_motor_chip*  g_the_chip = NULL;
+static DEFINE_MUTEX(motor_running_mutex);
+static DEFINE_MUTEX(position_detect_mutex);
+static DEFINE_MUTEX(motor_start_mutex);
+
+/************************fb_notifier************************/
+static void oneplus_motor_notify_state(unsigned long val);
+static int  fb_notifier_callback(struct notifier_block* nb, unsigned long event, void*  data);
+
+/************************digital_hall control interface************************/
+bool        oneplus_dhall_is_power_on(void);
+static int  oneplus_hall_set_enable_state(unsigned int id, bool enable);
+static bool oneplus_hall_get_enable_state(unsigned int id);
+static int  oneplus_hall_get_abs_data(unsigned int id);
+int         oneplus_hall_get_real_data(unsigned int id);
+int         oneplus_dhall_set_detection_mode(unsigned int id, u8 mode);
+static int  oneplus_hall_enable_irq (unsigned int id, bool enable);
+static int  oneplus_hall_clear_irq (unsigned int id);
+int         oneplus_dhall_get_irq_state(unsigned int id);
+static int  oneplus_hall_update_threshold(unsigned int id, int position, short lowthd, short highthd);
+void        oneplus_dhall_dump_regs(unsigned int id, u8* buf);
+int         oneplus_dhall_set_reg(unsigned int id, int reg, int val);
+	
+/************************step_motor control interface************************/
+static int  oneplus_motor_set_power (motor_power mode);
+static int  oneplus_motor_set_direction (int dir);
+static int  oneplus_motor_set_working_mode (int mode);
+//static int  oneplus_motor_calculate_pwm_count(int L, int mode);
+static int  oneplus_motor_pwm_config(int duty_ns, int period_ns);
+static int  oneplus_motor_pwm_enable(void);
+static int  oneplus_motor_pwm_disable(void);
+int         oneplus_motor_get_all_config(int* config, int count);
+int         oneplus_get_motor_type(void);
+void        oneplus_set_md_mode_para(int motor_work_mode);
+
+/************************combine digital_hall and step_motor for logical process************************/
+static void  manual_to_auto_down_work(struct work_struct* work);
+static void  oneplus_set_motor_speed(int speed);
+static void  oneplus_change_motor_speed(int speed);
+static void  oneplus_set_motor_direction(int direction);
+static void  oneplus_set_motor_move_state(int move_state);
+ 
+static bool  oneplus_motor_run_check(struct oneplus_motor_chip* chip);
+static void  oneplus_motor_control(int on, int speed, int direction);
+static void  oneplus_motor_start(void);
+static void  oneplus_motor_stop(void);
+static void  oneplus_motor_downward(void);
+static void  motor_run_work(struct work_struct* work);
+static void  camera_position_detect_work(struct work_struct* work);
+static void  free_fall_irq_check_work_func(struct work_struct* work);
+static int   write_hall_data_to_file(short* hall_up_data, short* hall_down_data, int buf_len, int direction, bool append);
+static enum  hrtimer_restart motor_stop_timer_func(struct hrtimer* hrtimer);
+static enum  hrtimer_restart motor_speed_up_timer_func(struct hrtimer* hrtimer);
+static enum  alarmtimer_restart motor_reset_timer_func(struct alarm* alrm, ktime_t now);
+static void  oneplus_motor_set_awake(struct oneplus_motor_chip* chip, int id, bool awake);
+static void  report_position_state(struct oneplus_motor_chip* chip, camera_position_state_event state_event); 
+
+static void  oneplus_motor_irq_monitor(struct oneplus_motor_chip* chip);
+static irqreturn_t oneplus_free_fall_detect_handler(int irq, void*  dev_id);
+
+/************************node operation by MotorManagerService or user************************/
+//for normal use
+static ssize_t  motor_direction_store(struct device* pdev, struct device_attribute* attr,
+		                              const char* buf, size_t count);
+static ssize_t  motor_direction_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_enable_store(struct device* pdev, struct device_attribute* attr, 
+								   const char* buff, size_t count);
+static ssize_t  step_count_store(struct device *pdev, struct device_attribute *attr,
+			                    const char *buff, size_t count);
+static ssize_t  step_count_show(struct device *dev,struct device_attribute *attr, char *buf);
+static ssize_t  save_hall_data_store(struct device *pdev, struct device_attribute *attr,
+		                            const char *buff, size_t count);
+static ssize_t  save_hall_data_show(struct device *dev,struct device_attribute *attr, char *buf);
+static ssize_t  hall_data_show(struct device* dev,struct device_attribute* attr, char* buf);
+static ssize_t  motor_move_state_show(struct device* dev, struct device_attribute* attr, char* buf);
+
+static ssize_t  hall_calibration_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  hall_calibration_store(struct device* pdev, struct device_attribute* attr,
+					                   const char* buff, size_t count);
+static ssize_t  stall_show(struct device* dev, struct device_attribute* attr, char* buf);	
+static ssize_t  stall_steps_show(struct device* dev, struct device_attribute* attr, char* buf);	
+static ssize_t  motor_test_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_test_store(struct device* pdev, struct device_attribute* attr, 
+ 								 const char* buff, size_t count);
+static ssize_t  hall_irq_count_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_mode_store(struct device* pdev, struct device_attribute* attr,
+		                         const char* buff, size_t count);
+static ssize_t  motor_mode_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_manual2auto_switch_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_manual2auto_switch_store(struct device* pdev, struct device_attribute* attr,
+				 	                           const char* buff, size_t count);
+static ssize_t  motor_sw_switch_store(struct device* pdev, struct device_attribute* attr,
+				 					  const char* buff, size_t count);
+static ssize_t  motor_sw_switch_show(struct device* dev, struct device_attribute* attr, char* buf);
+//for special test
+static ssize_t  motor_force_move_store(struct device* pdev, struct device_attribute* attr,
+				                       const char* buff, size_t count);
+///static ssize_t  motor_stop_time_store(struct device* pdev, struct device_attribute* attr,
+//		                              const char* buff, size_t count);
+//static ssize_t  motor_stop_time_show(struct device* dev, struct device_attribute* attr, char* buf);
+//static ssize_t  motor_initial_time_store(struct device* pdev, struct device_attribute* attr,
+//		                                 const char* buff, size_t count);
+//static ssize_t  motor_initial_time_show(struct device* dev, struct device_attribute* attr, char* buf);
+//static ssize_t  motor_initial_speed_store(struct device* pdev, struct device_attribute* attr,
+//		                                       const char* buff, size_t count);
+//static ssize_t  motor_initial_speed_show(struct device* dev, struct device_attribute* attr, char* buf);
+//static ssize_t  motor_high_speed_store(struct device* pdev, struct device_attribute* attr,
+//		                               const char* buff, size_t count);
+//static ssize_t  motor_high_speed_show(struct device* dev, struct device_attribute* attr, char* buf);
+//static ssize_t  motor_high_speed_time_store(struct device* pdev, struct device_attribute* attr,
+//		                                    const char* buff, size_t count);
+//static ssize_t  motor_high_speed_time_show(struct device* dev,struct device_attribute* attr, char* buf);
+static ssize_t  motor_slow_down_speed_store(struct device* pdev, struct device_attribute* attr,
+		                                    const char* buff, size_t count);
+static ssize_t  motor_slow_down_speed_show(struct device* dev, struct device_attribute* attr, char* buf);
+//not use 
+// static ssize_t  motor_speed_change_switch_store(struct device* pdev, struct device_attribute* attr,
+// 				 							    const char* buff, size_t count);
+// static ssize_t  motor_speed_change_switch_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  hall_detect_switch_store(struct device* pdev, struct device_attribute* attr,
+				 						 const char* buff, size_t count);
+static ssize_t  hall_detect_switch_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_all_config_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  motor_position_show(struct device* dev, struct device_attribute* attr, char* buf);
+static ssize_t  hall_all_reg_show(struct device* dev, struct device_attribute* attr, char* buf);
+ //save for compatibility
+static ssize_t  motor_change_speed_store(struct device* pdev, struct device_attribute* attr,
+				 	                     const char* buff, size_t count);
+static ssize_t  motor_speed_store(struct device* pdev, struct device_attribute* attr,
+		                          const char* buff, size_t count);
+static ssize_t  motor_speed_show(struct device* dev, struct device_attribute* attr, char* buf);
+
+/************************init function************************/	
+static int   oneplus_input_dev_init(struct oneplus_motor_chip* chip);
+static int   oneplus_motor_chip_init(struct oneplus_motor_chip* chip);
+static void  oneplus_motor_awake_init(struct oneplus_motor_chip* chip);
+static void  oneplus_motor_free_fall_register(struct oneplus_motor_chip*  chip);
+static void  oneplus_motor_reset_check(struct oneplus_motor_chip* chip);
+static void  oneplus_parameter_init(struct oneplus_motor_chip* chip);
+static int   motor_platform_probe(struct platform_device* pdev);
+static int   motor_platform_remove(struct platform_device* pdev);
+static int   motor_platform_suspend(struct platform_device* pdev, pm_message_t state);
+static int   motor_platform_resume(struct platform_device* pdev);
+static void  motor_platform_shutdown(struct platform_device* pdev);
+
+
+/*********************************************************************
+						 fb_notifier
+**********************************************************************/
+static void oneplus_motor_notify_state(unsigned long val)
+{
+    if (val < MOTOR_UP_EVENT || val > MOTOR_BLOCK_EVENT)
+        return;
+
+    motor_notifier_call_chain(val);
+}
+
+#ifdef CONFIG_DRM_MSM
+static int fb_notifier_callback(struct notifier_block* nb, unsigned long event, void* data)
+{
+	int blank;
+	struct msm_drm_notifier* evdata = data;
+
+	if (g_the_chip == NULL) {
+		return 0;
+	}
+
+	if (!evdata || (evdata->id != 0))
+		return 0;
+
+	if (event == MSM_DRM_EARLY_EVENT_BLANK) {
+		blank =* (int* )(evdata->data);
+		if (blank == MSM_DRM_BLANK_UNBLANK) {
+			g_the_chip->led_on = true;
+			MOTOR_LOG("led_on %d\n", g_the_chip->led_on);
+		} else if (blank == MSM_DRM_BLANK_POWERDOWN) {
+			g_the_chip->led_on = false;
+			MOTOR_LOG("led_on %d \n", g_the_chip->led_on);
+		} else {
+			MOTOR_LOG("receives wrong data EARLY_BLANK:%d \n", blank);
+		}
+	}
+
+	return 0;
+}
+#else
+static int fb_notifier_callback(struct notifier_block* nb, unsigned long event, void* data)
+{
+	int blank;
+	struct fb_event* evdata = data;
+
+	if (g_the_chip == NULL) {
+		return 0;
+	}
+
+	if (evdata && evdata->data) {
+		if (event == FB_EVENT_BLANK) {
+			blank =* (int* )evdata->data;
+			if (blank == FB_BLANK_UNBLANK) {
+				g_the_chip->led_on = true;
+				MOTOR_LOG("led_on %d\n", g_the_chip->led_on);
+			} else if (blank == FB_BLANK_POWERDOWN) {
+				g_the_chip->led_on = false;
+				MOTOR_LOG("led_on %d\n", g_the_chip->led_on);
+			}
+		}
+	}
+	return 0;
+}
+#endif /*CONFIG_DRM_MSM*/
+
+/*********************************************************************
+						 digital_hall control interface
+**********************************************************************/
+bool oneplus_dhall_is_power_on(void)
+{
+	if (g_the_chip == NULL || g_the_chip->hall_down_ops == NULL 
+						|| g_the_chip->hall_down_ops->is_power_on == NULL
+						|| g_the_chip->hall_up_ops == NULL 
+						|| g_the_chip->hall_up_ops->is_power_on == NULL) {
+
+		MOTOR_ERR("null pointer");
+
+  		return false;
+ 	} else {
+ 	    if (g_the_chip->hall_down_ops->is_power_on() && g_the_chip->hall_up_ops->is_power_on())
+ 		    return true;
+ 		else
+ 		    return false;
+	}
+
+}
+
+static int oneplus_hall_set_enable_state(unsigned int id, bool enable)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id) {
+	case HALL_DOWN :
+		if(g_the_chip->hall_down_ops == NULL ||  g_the_chip->hall_down_ops->set_hall_enable_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL ||  g_the_chip->hall_down_ops->set_hall_enable_state == NULL");
+			return -EINVAL;
+		} else {
+			return g_the_chip->hall_down_ops->set_hall_enable_state(enable);
+		}
+	case HALL_UP :
+		if(g_the_chip->hall_up_ops == NULL ||  g_the_chip->hall_up_ops->set_hall_enable_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL ||  g_the_chip->hall_up_ops->set_hall_enable_state == NULL");
+			return -EINVAL;
+		} else {
+			return g_the_chip->hall_up_ops->set_hall_enable_state(enable);
+		}
+	default : 
+		return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+static bool oneplus_hall_get_enable_state(unsigned int id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id) {
+	case HALL_DOWN :
+		if(g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_hall_enable_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_hall_enable_state == NULL");
+			return false;
+		} else {
+			return g_the_chip->hall_down_ops->get_hall_enable_state();
+		}
+	case HALL_UP :
+		if(g_the_chip->hall_up_ops == NULL ||  g_the_chip->hall_up_ops->get_hall_enable_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL ||  g_the_chip->hall_up_ops->get_hall_enable_state == NULL");
+			return false;
+		} else {
+			return g_the_chip->hall_up_ops->get_hall_enable_state();
+		}
+	default : 
+		return false;
+	}
+
+	return false;
+}
+
+static int oneplus_hall_get_abs_data(unsigned int id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_data_abs == NULL) {
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_data_abs == NULL");
+  			return -EINVAL;
+ 		} else {
+ 				return g_the_chip->hall_down_ops->get_data_abs(&g_the_chip->hall_down_data);
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_data_abs == NULL) {
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_data_abs == NULL");
+  			return -EINVAL;
+ 		} else {
+ 				return g_the_chip->hall_up_ops->get_data_abs(&g_the_chip->hall_up_data);
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_hall_get_real_data(unsigned int id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		 
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_data_real == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_data_real == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->get_data_real(&g_the_chip->hall_down_data);
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_data_real == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_data_real == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->get_data_real(&g_the_chip->hall_up_data);
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;	
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_dhall_set_detection_mode(unsigned int id, u8 mode)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->set_detection_mode == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->set_detection_mode == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->set_detection_mode(mode);
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->set_detection_mode == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->set_detection_mode == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->set_detection_mode(mode);
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+
+//should use in irq handle
+int oneplus_hall_enable_irq (unsigned int id, bool enable)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->enable_irq == NULL){
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->enable_irq == NULL \n");
+  			return -EINVAL;
+		} else {
+			 return g_the_chip->hall_down_ops->enable_irq(enable);
+		 } 
+ 			
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->enable_irq == NULL) {
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->enable_irq == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->enable_irq(enable);
+		}
+	default:
+		MOTOR_ERR("id : %d is not correct \n", id);	
+		return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_hall_clear_irq (unsigned int id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("oneplus_hall_clear_irq \n");
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->enable_irq == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->enable_irq == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->clear_irq();
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->enable_irq == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->enable_irq == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->clear_irq();
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;		
+	}
+
+	return -EINVAL;
+}
+
+int oneplus_dhall_get_irq_state(unsigned int id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_irq_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->get_irq_state == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->get_irq_state();
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_irq_state == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->get_irq_state == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->get_irq_state();
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+static int oneplus_hall_update_threshold(unsigned int id, int position, short lowthd, short highthd)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("lowthd : %d, highthd : %d, is_mag_positive : %d", lowthd, highthd, g_the_chip->is_mag_positive);
+	//mag is negative
+	if (!g_the_chip->is_mag_positive) {
+		if (highthd != 511 ) {
+			lowthd = -highthd;
+			highthd = 511;
+		}
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->update_threshold == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->update_threshold == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->update_threshold(position,lowthd,highthd);
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->update_threshold == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->update_threshold == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->update_threshold(position,lowthd,highthd);
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+void oneplus_dhall_dump_regs(unsigned int id, u8* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->dump_regs == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->dump_regs == NULL \n");
+  			return;
+ 		} else {
+ 			g_the_chip->hall_down_ops->dump_regs(buf);
+		}
+		break;
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->dump_regs == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->dump_regs == NULL \n");
+  			return;
+ 		} else {
+ 			g_the_chip->hall_up_ops->dump_regs(buf);
+		}
+		break;
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return;
+		
+	}
+
+	return;
+}
+
+int oneplus_dhall_set_reg(unsigned int id, int reg, int val)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	switch (id){
+	case HALL_DOWN:		
+		if (g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->set_reg == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_down_ops == NULL || g_the_chip->hall_down_ops->set_reg == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_down_ops->set_reg(reg,val);
+		}
+	case HALL_UP:		
+		if (g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->set_reg == NULL) {
+
+			MOTOR_ERR("g_the_chip->hall_up_ops == NULL || g_the_chip->hall_up_ops->set_reg == NULL \n");
+  			return -EINVAL;
+ 		} else {
+ 			return g_the_chip->hall_up_ops->set_reg(reg,val);
+		}
+		default:
+			MOTOR_ERR("id : %d is not correct \n", id);
+			return -EINVAL;
+	}
+
+	return -EINVAL;
+}
+
+/*********************************************************************
+            			step_motor control interface
+**********************************************************************/
+static int oneplus_motor_set_power(motor_power mode)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL
+			   || g_the_chip->motor_ops->set_power == NULL) {
+		
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || set_power == NULL");
+  		return -EINVAL;
+ 	} else {
+		MOTOR_ERR("oneplus_motor_set_power\n");
+ 		return g_the_chip->motor_ops->set_power(mode);
+	}
+}
+
+static int oneplus_motor_set_direction (int dir)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops->set_direction == NULL) {
+
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops->set_direction == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->set_direction(dir);
+	}
+}
+
+static int oneplus_motor_set_working_mode (int mode)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL 
+			|| g_the_chip->motor_ops->set_working_mode == NULL) {
+
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || set_working_mode == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->set_working_mode(mode);
+	}
+
+}
+
+// static int oneplus_motor_calculate_pwm_count(int L, int mode)
+// {
+// 	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL 
+// 		|| g_the_chip->motor_ops->set_working_mode == NULL) {
+		
+// 		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || set_working_mode == NULL");
+//   		return 0;
+//  	} else {
+//  		return g_the_chip->motor_ops->calculate_pwm_count(L, mode);
+// 	}
+
+// }
+
+static int oneplus_motor_pwm_config(int duty_ns, int period_ns)
+{
+	MOTOR_LOG("duty_ns : %d, period_ns : %d\n", duty_ns, period_ns);
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL
+			|| g_the_chip->motor_ops->calculate_pwm_count == NULL) {
+
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || calculate_pwm_count == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->pwm_config(duty_ns, period_ns);
+	}
+
+}
+
+static int oneplus_motor_pwm_enable(void)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL
+			|| g_the_chip->motor_ops->pwm_enable == NULL) {
+		
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || pwm_enable == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->pwm_enable();
+	}
+
+}
+
+static int oneplus_motor_pwm_disable(void)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL
+		 || g_the_chip->motor_ops->pwm_disable == NULL) {
+
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || pwm_disable == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->pwm_disable();
+	}
+
+}
+
+int oneplus_motor_get_all_config(int* config ,int count)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL 
+		|| g_the_chip->motor_ops->get_all_config == NULL) {
+		
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || get_all_config == NULL");
+  		return -EINVAL;
+ 	} else {
+ 		return g_the_chip->motor_ops->get_all_config(config,count);
+	}
+
+}
+
+
+int oneplus_get_motor_type(void)
+{
+	if (g_the_chip == NULL || g_the_chip->motor_ops == NULL	
+			 || g_the_chip->motor_ops->get_motor_type == NULL) {
+
+		MOTOR_ERR("g_the_chip == NULL || g_the_chip->motor_ops == NULL || get_motor_type == NULL");
+  		return MOTOR_UNKNOWN;
+ 	} else {
+ 		return g_the_chip->motor_ops->get_motor_type();
+	}
+
+}
+
+static void oneplus_set_motor_work_mode_para(int motor_work_mode)
+{
+	int mode = 0;
+	static int mode_pre = -1;
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	if ((motor_work_mode >= MOTOR_MODE_FULL) && (motor_work_mode <= MOTOR_MODE_1_32)) {
+		if (mode_pre != motor_work_mode) {
+			mode_pre = motor_work_mode;
+			g_the_chip->motor_work_mode = motor_work_mode;
+		} else {
+			return;//working mode not change
+		}
+	}
+
+	switch (g_the_chip->motor_work_mode) {
+		case MOTOR_MODE_FULL:
+			oneplus_motor_set_working_mode(MOTOR_MODE_FULL);
+			mode = 1;
+			break;
+
+		case MOTOR_MODE_1_16:
+			oneplus_motor_set_working_mode(MOTOR_MODE_1_16);
+			mode = 16;
+			break;
+		case MOTOR_MODE_1_32:
+			oneplus_motor_set_working_mode(MOTOR_MODE_1_32);
+			mode = 32;
+			break;
+		default:
+			oneplus_motor_set_working_mode(MOTOR_MODE_1_32);
+			mode = 32;
+			break;
+	}
+	//default 32
+	//g_the_chip->pwm_count = oneplus_motor_calculate_pwm_count(g_the_chip->whole_jonery_length, mode);//8.2mm
+	//g_the_chip->pwm_count = g_the_chip->pwm_count*  32 / 20;
+	//																			0.5mm
+	//g_the_chip->speed_up_pwm_count = oneplus_motor_calculate_pwm_count(g_the_chip->speed_up_distance, mode);
+	//																			 2mm
+	//g_the_chip->speed_down_pwm_count = oneplus_motor_calculate_pwm_count(g_the_chip->speed_down_L, mode);
+	//MOTOR_LOG("pwm_count %d,whole_jonery_length %d, speed_up_pwm_count %d, mode %d\n",
+	//		   g_the_chip->pwm_count, g_the_chip->whole_jonery_length,mode);
+}
+
+/*********************************************************************
+            combine digital_hall and step_motor for logical process
+**********************************************************************/
+static void manual_to_auto_up_work(struct work_struct *work)
+{
+	struct delayed_work *dwork = to_delayed_work(work);
+  	struct oneplus_motor_chip *chip = container_of(dwork, struct oneplus_motor_chip, up_work);
+
+	oneplus_motor_set_awake(chip,HALL_DATA_LOCK,true);//dont sleep
+	oneplus_motor_irq_monitor(chip);
+
+	MOTOR_LOG("call");
+	if (atomic_read(&chip->in_suspend)) {
+		MOTOR_ERR("in_suspend delay 20 ms \n");
+		queue_delayed_work(chip->manual2auto_wq, &chip->up_work, msecs_to_jiffies(20));
+		return;
+	}
+
+	oneplus_hall_update_threshold(HALL_DOWN, MID_STATE, 511, 511);
+
+	oneplus_hall_clear_irq(HALL_DOWN);
+
+	if (!chip->is_irq_abnormal)
+		oneplus_hall_enable_irq(HALL_DOWN, true);
+
+	oneplus_motor_set_awake(chip, HALL_DATA_LOCK, false);
+}
+
+static void manual_to_auto_down_work(struct work_struct* work)
+{
+	struct delayed_work* dwork = to_delayed_work(work);
+  	struct oneplus_motor_chip* chip = container_of(dwork, struct oneplus_motor_chip, down_work);
+
+	oneplus_motor_set_awake(chip,HALL_DATA_LOCK,true);//dont sleep
+	oneplus_motor_irq_monitor(chip);
+
+	MOTOR_LOG("call \n");
+
+	if (atomic_read(&chip->in_suspend)) {
+		MOTOR_ERR("in_suspend delay 20 ms \n");
+		queue_delayed_work(chip->manual2auto_wq,&chip->down_work,msecs_to_jiffies(20));
+		return;
+	}
+
+	oneplus_hall_update_threshold(HALL_UP, MID_STATE, 511, 511);
+
+	if (chip->manual2auto_down_switch) {
+		if (!chip->motor_started) {
+			report_position_state(chip, MANUAL_TO_DOWN_EVENT);
+			oneplus_motor_downward();
+		}
+	}
+
+	oneplus_hall_clear_irq(HALL_UP);
+
+	if (!chip->is_irq_abnormal)
+		oneplus_hall_enable_irq(HALL_UP, true);
+
+	oneplus_motor_set_awake(chip, HALL_DATA_LOCK, false);
+
+	return;
+}
+
+static void oneplus_set_motor_speed(int speed)
+{
+	long long period_ns = 0;
+	unsigned long duty_ns = 0;
+
+	
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	g_the_chip->motor_speed = speed;
+
+	MOTOR_LOG("call, speed : %d , chip->motor_speed : %d \n", speed, g_the_chip->motor_speed);
+	
+	switch (g_the_chip->motor_speed) {
+	case MOTOR_SPEED0:
+		period_ns = 12000;// 80KHZ
+		break;
+
+	case MOTOR_SPEED1:
+		period_ns = 15500;// 64KHZ
+		break;
+
+	case MOTOR_SPEED2:
+		period_ns = 19531;// 51.2HZ
+		break;
+
+	case MOTOR_SPEED3:
+		period_ns = 26041;// 38.4KHZ
+		break;
+
+	case MOTOR_SPEED4:
+		period_ns = 31250;// 32KHZ
+		break;
+
+	case MOTOR_SPEED5:
+		period_ns = 39062;// 25.6KHZ
+		break;
+
+	case MOTOR_SPEED6:
+		period_ns = 44642;// 22.4KHZ
+		break;
+
+	case MOTOR_SPEED7:
+		period_ns = 52083;// 19.2KHZ
+		break;
+
+	case MOTOR_SPEED8:
+		period_ns = 60240;// 16.6KHZ
+		break;
+
+	case MOTOR_SPEED9:
+		period_ns = 78125;// 12.8KHZ
+		break;
+
+	case MOTOR_SPEED10:
+		period_ns = 104166;// 9.6KHZ
+		break;
+
+	case MOTOR_SPEED11:
+		period_ns = 156250;// 6.4KHZ
+		break;
+
+	case MOTOR_SPEED12:
+		period_ns = 312500;// 3.2KHZ
+		break;
+
+	case MOTOR_SPEED13:
+		period_ns = 625000;// 1.6KHZ
+		break;
+	case MOTOR_SPEED_SPECIAL:
+		period_ns = 11161;//2800pps, only use in free fall
+		break;
+
+	default:
+		period_ns = 12000;// 80KHZ.
+		break;
+
+	}
+	
+	duty_ns = (unsigned long)(period_ns/2);
+	g_the_chip->pwm_duty = duty_ns;
+	g_the_chip->pwm_period = period_ns;
+	MOTOR_LOG("pwm_duty : %d, pwm_period : %d", g_the_chip->pwm_duty, g_the_chip->pwm_period);
+
+	return;
+}
+
+static void oneplus_change_motor_speed(int speed)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	if (g_the_chip->motor_speed == speed) {
+		MOTOR_LOG("speed not change");
+		return;
+	}
+
+	MOTOR_LOG("call, speed : %d , chip->motor_speed : %d \n", speed, g_the_chip->motor_speed);
+
+	oneplus_set_motor_speed(speed);
+
+	mutex_lock(&motor_running_mutex);
+	if (g_the_chip->motor_started) {
+		oneplus_motor_pwm_disable();
+		oneplus_motor_pwm_config(g_the_chip->pwm_duty, g_the_chip->pwm_period);
+		oneplus_motor_pwm_enable();
+	}
+	mutex_unlock(&motor_running_mutex);
+
+	return;
+}
+
+static void oneplus_set_motor_direction(int direction)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	if (direction >= 0)
+		g_the_chip->motor_direction = !!direction;
+}
+
+static void oneplus_set_motor_move_state(int move_state)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	if ((move_state >= MOTOR_STOP) && (move_state <= MOTOR_DOWNWARD_STOP)) {
+		g_the_chip->move_state = move_state;
+	}
+}
+
+static bool oneplus_motor_run_check(struct oneplus_motor_chip* chip)
+{
+	//TO DO : remove temporary, for debug
+
+	if (chip->is_skip_pos_check) {
+		MOTOR_ERR("skip_pos_check \n");
+		return true;
+	}
+
+	if ((chip->position == PEAK_STATE) && (chip->motor_direction == MOTOR_UPWARD)) {
+		MOTOR_LOG("has been in up_state, return false\n");
+		return false;
+	} else if ((chip->position == BOTTOM_STATE) && (chip->motor_direction == MOTOR_DOWN)) {
+		MOTOR_LOG("has been in down_state, return false\n");
+		return false;
+	}
+
+	MOTOR_LOG("oneplus_motor_run_check ok\n");
+	return true;
+}
+
+static void oneplus_motor_control(int on ,int speed ,int direction)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	MOTOR_LOG("on = %d, speed = %d, direction = %d, motor_switch : %d \n",
+								on, speed, direction, g_the_chip->motor_switch);
+
+	if (on) {
+		
+		if (g_the_chip->motor_switch == 0) {
+			MOTOR_ERR("motor_switch == 0, would not set motor start \n");
+		 	return;
+		}
+		if (!g_the_chip->motor_started) {
+			MOTOR_LOG("set motor_enable = 1");
+			g_the_chip->motor_enable = 1;
+
+			//enable hall
+			if (!g_the_chip->is_free_fall) {
+				if (!oneplus_hall_get_enable_state(HALL_DOWN))
+					oneplus_hall_set_enable_state(HALL_DOWN, true);
+
+				if (!oneplus_hall_get_enable_state(HALL_UP))
+					oneplus_hall_set_enable_state(HALL_UP, true);
+			}
+
+
+			oneplus_set_motor_speed(speed);
+			oneplus_set_motor_direction(direction);
+			if (oneplus_motor_run_check(g_the_chip)) {
+				queue_work(g_the_chip->motor_run_work_wq, &g_the_chip->motor_work);
+			}
+		}
+	} else {
+		if (g_the_chip->motor_started) {
+			MOTOR_LOG("set motor_enable = 0");
+			g_the_chip->motor_enable = 0;
+			queue_work(g_the_chip->motor_run_work_wq, &g_the_chip->motor_work);
+		}
+	}
+
+	return;
+}
+
+static void oneplus_motor_start(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip ==NULL \n");
+		return;
+	}
+
+	oneplus_motor_control(1, g_the_chip->motor_speed, g_the_chip->motor_direction);
+
+	return;
+}
+
+static void oneplus_motor_stop(void)
+{
+	int on = 0;
+	int speed = 0;
+	int direction = 0;
+
+	MOTOR_LOG("call \n");
+	oneplus_motor_control(on, speed, direction);
+
+	return;
+}
+
+static void oneplus_motor_downward(void)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return;
+	}
+
+	oneplus_motor_control(1, g_the_chip->motor_speed, MOTOR_DOWN);
+}
+
+static void motor_run_work(struct work_struct* work)
+{
+	struct oneplus_motor_chip* chip = container_of(work, struct oneplus_motor_chip, motor_work);
+	unsigned long intsecond = 0;
+	unsigned long nsecond = 0;
+	long long value = 0;
+	int err = 0;
+
+	mutex_lock(&motor_running_mutex);
+	MOTOR_LOG("%s, motor_enable : %d, motor_started : %d",
+						 __func__, chip->motor_enable, chip->motor_started);
+
+	MOTOR_LOG("is_factory_mode : %d \n", chip->is_factory_mode);
+
+	if (chip->motor_enable && (chip->motor_started == 0)) {
+		mutex_lock(&motor_start_mutex);
+
+		MOTOR_LOG("start motor\n");
+
+	    oneplus_motor_set_awake(chip,MOTOR_RUN_LOCK, true);
+		oneplus_motor_set_power(MOTOR_POWER_ON);
+		oneplus_motor_set_direction(chip->motor_direction);
+
+		if (!g_the_chip->is_motor_test) {
+			if (chip->motor_direction == MOTOR_UPWARD)
+				oneplus_hall_update_threshold(HALL_DOWN, BOTTOM_STATE, 511, 511);
+			else if (chip->motor_direction == MOTOR_DOWN)
+				oneplus_hall_update_threshold(HALL_UP, BOTTOM_STATE, 511, 511);
+		} else if (chip->motor_direction == MOTOR_UPWARD) {
+			MOTOR_LOG("motor test, update hall down irq threshold");
+			oneplus_hall_update_threshold(HALL_DOWN,BOTTOM_STATE,-512,chip->hall_down_irq_position);
+		}
+
+		if (chip->is_free_fall) {
+			MOTOR_ERR("phone is falling, use special speed");
+			oneplus_set_motor_speed(MOTOR_SPEED_SPECIAL);
+		} else if (chip->is_factory_mode == 1){
+			oneplus_set_motor_speed(MOTOR_SPEED0);//calibrate mode
+		} else {
+			oneplus_set_motor_speed(MOTOR_SPEED10);//normal mode and step test mode
+		}
+	
+		err = oneplus_motor_pwm_config(chip->pwm_duty, chip->pwm_period);
+		if (err < 0) {
+			MOTOR_ERR("pwm_config failed, err : %d \n",err);
+			chip->motor_started = 0;
+			mutex_unlock(&motor_running_mutex);
+			mutex_unlock(&motor_start_mutex);
+			return;
+		}
+
+		err = oneplus_motor_pwm_enable();
+		if (err < 0) {
+			MOTOR_ERR("pwm_enable failed, err : %d \n",err);
+			chip->motor_started = 0;
+			mutex_unlock(&motor_running_mutex);
+			mutex_unlock(&motor_start_mutex);
+			return;
+		} 
+
+		if (chip->motor_direction == MOTOR_UPWARD) {
+			if (chip->is_factory_mode == 0)
+				report_position_state(chip, UPING_EVENT);
+
+			oneplus_set_motor_move_state(MOTOR_UPWARD_ING);
+		} else if (chip->motor_direction == MOTOR_DOWN) {
+			if (chip->is_factory_mode == 0)
+				report_position_state(chip, DOWNING_EVENT);
+
+			oneplus_set_motor_move_state(MOTOR_DOWNWARD_ING);
+		}
+		chip->motor_started = 1;
+
+
+		chip->camera_position_detect = true;
+
+		do_gettimeofday(&chip->motor_start_time);
+		MOTOR_LOG("motor_start_time tv_sec : %lu, tv_usec : %lu \n", chip->motor_start_time.tv_sec, chip->motor_start_time.tv_usec);
+		
+		//calculate when the motor should stop
+		if (chip->is_factory_mode == 1) {
+			if (chip->motor_direction == 1) {//camera up
+				value = chip->camera_up_step_count * MOTOR_STOP_TIMEOUT;
+
+				MOTOR_LOG("motor up, use step count, value : %d", value);
+
+				nsecond = do_div(value, 1000000000);//value = value/1000000000 ,nsecond = value % 1000000000
+				intsecond = (unsigned long) value;
+
+				chip->whole_jonery_time = nsecond / 1000;//ns to ms
+			} else {
+				MOTOR_LOG("motor up, set timeout as 1s");
+			    value = 1000000000;
+			
+			    nsecond = do_div(value, 1000000000);
+			    intsecond = (unsigned long) value;
+			}
+		} else {
+			if (chip->motor_direction == 1) {//camera up
+				value = (chip->speed_up_pwm_count * chip->pwm_period)+
+						 ((chip->camera_up_step_count - chip->speed_up_pwm_count) * MOTOR_STOP_TIMEOUT);
+
+				MOTOR_LOG("motor up, use step count, value : %d", value);
+
+				nsecond = do_div(value, 1000000000);//value = value/1000000000 ,nsecond = value % 1000000000
+				intsecond = (unsigned long) value;
+
+				chip->whole_jonery_time = nsecond / 1000;//ns to ms
+			} else { //camera down
+				value = (chip->speed_up_pwm_count * chip->pwm_period)+
+						 ((chip->camera_up_step_count - chip->speed_up_pwm_count + 20 * 32) * MOTOR_STOP_TIMEOUT);
+
+				MOTOR_LOG("motor up, use step count, value : %d", value);
+
+				nsecond = do_div(value, 1000000000);//value = value/1000000000 ,nsecond = value % 1000000000
+				intsecond = (unsigned long) value;
+
+				chip->whole_jonery_time = nsecond / 1000;//ns to ms
+			} 
+		}
+
+		//else {
+			//MOTOR_LOG("motor up, set timeout as 1s");
+			//value = 1000000000;
+			
+			//nsecond = do_div(value, 1000000000);
+			//intsecond = (unsigned long) value;
+		//}
+
+		MOTOR_LOG("time value = %llu nsecond = %lu intsecond = %lu , whole_jonery_time : %lu \n", 
+		                value, nsecond, intsecond, chip->whole_jonery_time);
+		hrtimer_start(&chip->stop_timer, ktime_set(intsecond, nsecond), HRTIMER_MODE_REL);
+
+		//calculate when the motor should speed up
+		value = chip->speed_up_pwm_count * chip->pwm_period;
+		nsecond = do_div(value, 1000000000);//value = value/1000000000 ,nsecond = value % 1000000000
+		intsecond = (unsigned long) value;
+		MOTOR_LOG("time value = %llu nsecond = %lu intsecond = %lu, chip->speed_up_pwm_count = %d,chip->pwm_period = %d \n", 
+		                value, nsecond, intsecond, chip->speed_up_pwm_count, chip->pwm_period);
+		hrtimer_start(&chip->speed_up_timer, ktime_set(intsecond, nsecond), HRTIMER_MODE_REL);
+		mutex_unlock(&motor_start_mutex);
+	} else if (!chip->motor_enable && (chip->motor_started == 1)) {
+		MOTOR_LOG("stop motor \n");
+
+		oneplus_motor_pwm_disable();
+		oneplus_motor_set_power(MOTOR_POWER_OFF);
+
+		if (!chip->stop_timer_trigger)
+			hrtimer_cancel(&chip->stop_timer);
+		else
+			chip->stop_timer_trigger = 0;
+
+		chip->motor_started = 0;
+
+		if (chip->move_state == MOTOR_UPWARD_ING) {
+			oneplus_set_motor_move_state(MOTOR_UPWARD_STOP);
+			oneplus_hall_get_abs_data(HALL_UP);
+			MOTOR_LOG("move_state == MOTOR_UPWARD_ING, hall_up_data : %d, hall_up_irq_position : %d"
+							        ,chip->hall_up_data, chip->hall_up_irq_position);
+
+			if (chip->hall_up_data > chip->hall_up_irq_position) {
+				MOTOR_ERR("%s, position = PEAK_STATE", __func__);
+				chip->position = PEAK_STATE;
+				if (chip->is_factory_mode == 0)
+					report_position_state(chip, UP_NORMAL_EVENT);
+
+				MOTOR_ERR("POS_NORMAL, hall_up_irq_count %d\n",chip->hall_up_irq_count);
+				chip->hall_up_irq_count = 0;
+				oneplus_motor_notify_state(MOTOR_UP_EVENT);
+				oneplus_hall_update_threshold(HALL_UP,PEAK_STATE,-512,chip->hall_up_irq_position);
+			} else if (!chip->force_move) {
+				chip->position = MID_STATE;
+				if (chip->is_factory_mode == 0)
+					report_position_state(chip, UP_ABNORMA_EVENT);
+
+				MOTOR_ERR("POS_ABNORMAL %d %d\n",chip->hall_up_data ,chip->hall_up_irq_position);
+				oneplus_motor_notify_state(MOTOR_BLOCK_EVENT);
+			} else {
+				MOTOR_ERR("POS_ABNORMAL %d %d, but it is force_move mode, would not report \n",
+									    chip->hall_up_data ,chip->hall_up_irq_position);
+			}
+
+		} else if (chip->move_state == MOTOR_DOWNWARD_ING) {
+			oneplus_set_motor_move_state(MOTOR_DOWNWARD_STOP);
+			oneplus_hall_get_abs_data(HALL_DOWN);
+			MOTOR_LOG("move_state == MOTOR_DOWNWARD_ING, hall_down_data : %d, hall_down_irq_position : %d"
+								    ,chip->hall_down_data, chip->hall_down_irq_position);
+
+			if (chip->hall_down_data > chip->hall_down_irq_position) {
+				MOTOR_ERR("%s, position = BOTTOM_STATE", __func__);
+				chip->position = BOTTOM_STATE;
+				if (chip->is_factory_mode == 0)
+					report_position_state(chip, DOWN_NORMAL_EVENT);
+
+				MOTOR_ERR("POS_NORMAL, hall_down_irq_count %d\n",chip->hall_down_irq_count);
+				chip->hall_down_irq_count = 0;
+				oneplus_motor_notify_state(MOTOR_DOWN_EVENT);
+				//oneplus_hall_update_threshold(HALL_DOWN,BOTTOM_STATE,-512,chip->hall_down_irq_position);
+			} else if (!chip->force_move){
+				chip->position = MID_STATE;
+				if (chip->is_factory_mode == 0)
+					report_position_state(chip, DOWN_ABNORMAL_EVENT);
+
+				MOTOR_ERR("POS_ABNORMAL %d %d \n",chip->hall_down_data ,chip->hall_down_irq_position);
+				oneplus_motor_notify_state(MOTOR_BLOCK_EVENT);
+			} else {
+				MOTOR_ERR("POS_ABNORMAL %d %d, but it is force_move mode, would not report \n",
+										chip->hall_down_data ,chip->hall_down_irq_position);
+			}
+		}
+
+		//set motor starting speed after motor stop
+		oneplus_set_motor_speed(MOTOR_SPEED10);
+
+		if (chip->save_hall_data_to_file)
+			chip->save_hall_data_to_file = false;
+
+		if (chip->force_move)
+			chip->force_move = false;//reset to normal mode
+		
+		if (chip->is_free_fall)
+			chip->is_free_fall = false;
+		
+		//chip->slow_down_speed = MOTOR_SPEED11;
+
+		//disable hall when down finish for save power
+		//remove temporary
+		// if (g_the_chip->motor_direction == MOTOR_DOWN && chip->position == BOTTOM_STATE) {
+		// 	if (oneplus_hall_get_enable_state(HALL_DOWN))
+		// 		oneplus_hall_set_enable_state(HALL_DOWN, false);
+	
+		// 	if (oneplus_hall_get_enable_state(HALL_UP))
+		// 		oneplus_hall_set_enable_state(HALL_UP, false);		 
+		// }
+
+		oneplus_motor_set_awake(chip,MOTOR_RUN_LOCK,false);
+
+		chip->camera_position_detect = false;//stop camera position detect
+	}
+
+	mutex_unlock(&motor_running_mutex);
+}
+
+static void  free_fall_irq_check_work_func(struct work_struct* work)
+{
+	struct delayed_work* dwork = to_delayed_work(work);
+	struct oneplus_motor_chip* chip = container_of(dwork, struct oneplus_motor_chip, free_fall_irq_check_work);
+
+	if (chip == NULL) {
+		MOTOR_ERR("free_fall_irq_check_work_func error, chip == NULL");
+		return;
+	}
+
+	MOTOR_LOG("free_fall_irq_times : %d, infrared_shut_down_state : %d \n", chip->free_fall_irq_times, chip->infrared_shut_down_state);
+
+	if (chip->free_fall_irq_times == 1) {
+		g_the_chip->is_free_fall = true;
+		disable_irq_nosync(g_the_chip->free_fall_irq);
+		oneplus_motor_downward();
+		enable_irq(g_the_chip->free_fall_irq);
+
+	} else if (chip->free_fall_irq_times >= 2) {
+		MOTOR_LOG("infrared notify event, free_fall_irq_times : %d \n", chip->free_fall_irq_times);
+		chip->infrared_shut_down_state = 1;
+
+	} else {
+		MOTOR_LOG("unknow event, free_fall_irq_times : %d \n", chip->free_fall_irq_times);
+	}
+
+	chip->free_fall_irq_times = 0;
+
+	return;
+}
+static void  camera_position_detect_work(struct work_struct* work)
+{
+  	int            hall_delta_pre = 0;
+  	int            hall_delta = 0;
+  	int            delta_d = 0;
+	int            hall_down_data_pre = 0;
+	int            hall_up_data_pre = 0;
+  	int            speed_down = 0;
+  	int            should_stop_count = 0;
+	int            up_stop_times = 0;
+	int            down_stop_times = 0;
+	int            abnormal_judge_time = 400000;//400ms default
+	int            data_count = 0;
+	int            deltad_range_low = -10;
+	int            deltad_range_high = 10;
+	unsigned long  enter_deltad_first_time = 0;
+	bool           mag_noise = false;
+	bool           append_to_line = false;
+	short          hall_up_data[64] = {0};
+	short          hall_down_data[64] = {0};
+	struct         delayed_work* dwork = to_delayed_work(work);
+  	struct         oneplus_motor_chip* chip = container_of(dwork, struct oneplus_motor_chip, detect_work);
+	unsigned long  distance_time = 0;
+	struct timeval current_time;
+	
+
+	if (chip == NULL) {
+		MOTOR_ERR("camera_position_detect_work error, chip == NULL");
+		return;
+	}
+
+	mutex_lock(&position_detect_mutex);
+	mutex_lock(&motor_start_mutex);
+	oneplus_motor_set_awake(chip,POSITION_DETECT_LOCK,true);//should not be sleep during detecting
+	
+	if (chip->move_state == MOTOR_UPWARD_ING)
+		chip->stall_steps = chip->camera_up_step_count / 32;
+	else
+		chip->stall_steps = 0;
+
+	deltad_range_low = 0 - chip->deltad_range;
+	deltad_range_high = chip->deltad_range;
+	chip->is_stall = 0;
+	chip->stall_mode = UNKNOW_MODE;
+	up_stop_times = 2;
+	down_stop_times = 1;
+	abnormal_judge_time = chip->whole_jonery_time * chip->begin_stop_detect_percent / 100;
+	MOTOR_LOG("motor_diretion : %d , move_state : %d motor_started : %d, abnormal_judge_time : %d\n",
+	            chip->motor_direction, chip->move_state, chip->motor_started, abnormal_judge_time);
+	MOTOR_LOG("camera_down_slow_down_position_hall_down_data : %d, camera_down_slow_down_position_hall_up_data : %d\n", 
+		       chip->camera_down_slow_down_position_hall_down_data, chip->camera_down_slow_down_position_hall_up_data);
+	MOTOR_LOG("deltad_range_low : %d, deltad_range_high : %d \n", deltad_range_low, deltad_range_high);
+	MOTOR_LOG("stall_steps : %d, begin_stop_detect_percent : %d \n", chip->stall_steps, chip->begin_stop_detect_percent);
+
+	oneplus_change_motor_speed(MOTOR_SPEED0);
+
+    while (chip->camera_position_detect) {
+		hall_down_data_pre = chip->hall_down_data;
+		hall_up_data_pre = chip->hall_up_data;
+    	oneplus_hall_get_abs_data(HALL_DOWN);
+    	oneplus_hall_get_abs_data(HALL_UP);
+		hall_up_data[data_count] = chip->hall_down_data;
+		hall_down_data[data_count] = chip->hall_up_data;
+		data_count++;
+
+		//may be mag noise or speed is very slow
+		if (chip->save_hall_data_to_file && data_count >= 60) {
+			MOTOR_LOG("may be mag noise!!!, data_count : %d", data_count);
+			mag_noise = true;
+
+			write_hall_data_to_file(hall_up_data, hall_down_data, data_count, chip->motor_direction, false);
+
+			data_count = 0;
+			memset(hall_up_data, 0, sizeof(hall_up_data));
+			memset(hall_down_data, 0, sizeof(hall_down_data));
+		} else if (data_count >= 60) {
+			MOTOR_LOG("may be mag noise!!!, data_count : %d", data_count);
+			data_count = 0;
+		}
+	
+    	hall_delta = chip->hall_down_data - chip->hall_up_data;
+    	delta_d = hall_delta - hall_delta_pre;
+    	hall_delta_pre = hall_delta;
+
+    	MOTOR_LOG("dhall_down data : %d, dhall_up data : %d , hall_delta : %d, delta_d : %d \n",
+    			   chip->hall_down_data, chip->hall_up_data, hall_delta, delta_d);
+
+		//if force_move mode, then we don't use brake mechanism mode, use time out mode
+		if (chip->force_move) {
+			mdelay(chip->position_detect_delay);	
+			continue;
+		}
+
+		//if free fall, then we don't use brake mechanism mode, use time out mode
+		if (chip->is_free_fall) {
+			MOTOR_ERR("phone is falling");
+			mdelay(chip->position_detect_delay);	
+			continue;
+		}
+
+		//camera down
+    	if ((chip->hall_down_data - chip->hall_up_data) > (chip->camera_down_slow_down_position_hall_down_data - chip->camera_down_slow_down_position_hall_up_data)) {
+    		if ((chip->move_state == MOTOR_DOWNWARD_ING) && (speed_down == 0)) {
+    		   	speed_down = 1;
+				oneplus_change_motor_speed(chip->slow_down_speed);
+    		}
+    	 } 
+
+	    do_gettimeofday(&current_time);
+		distance_time = (current_time.tv_sec - chip->motor_start_time.tv_sec) * 1000000 + 
+		                (current_time.tv_usec - chip->motor_start_time.tv_usec);
+		MOTOR_LOG("distance_time : %d, current_time.tv_sec : %lu, current_time.tv_usec : %lu", 
+		           distance_time, (unsigned long)current_time.tv_sec, (unsigned long)current_time.tv_usec);
+
+    	//stop motor algo
+		MOTOR_LOG("should_stop_count : %d, is_stall : %d, up_stop_times : %d, down_stop_times : %d", 
+		           should_stop_count, chip->is_stall, up_stop_times, down_stop_times);
+				
+    	if ((distance_time >= abnormal_judge_time) && (delta_d >= deltad_range_low) && (delta_d <= deltad_range_high)) {
+				should_stop_count ++;
+			
+			if (enter_deltad_first_time == 0) {
+				enter_deltad_first_time = distance_time;
+			}
+			MOTOR_LOG("enter deltad_range, enter_deltad_first_time :%lu", enter_deltad_first_time);
+			
+    	}
+
+		//when calibrate mode, motor down stop by hall, else stop by steps
+		if ((should_stop_count >= down_stop_times) && (chip->move_state == MOTOR_DOWNWARD_ING) 
+												   && (chip->is_factory_mode == 1)) {
+			oneplus_motor_stop();
+
+    		break; 
+    	} else if ((should_stop_count >= up_stop_times) && (chip->move_state == MOTOR_UPWARD_ING)) {
+			chip->stall_mode = ENTER_DELTAD_RANGE_TWO_TIEMS;
+			chip->is_stall = 1;
+			chip->stall_steps = enter_deltad_first_time / 384;//(enter_deltad_first_time / 12) / 32;
+			MOTOR_LOG("should_stop_count >= up_stop_times, stall_steps : %d \n", chip->stall_steps);
+		}
+
+		//anti-shake when motor down
+		MOTOR_LOG("hall_down_data_pre : %d, hall_down_data : %d \n", hall_down_data_pre, chip->hall_down_data);
+		if ( (distance_time >= abnormal_judge_time) && (chip->move_state == MOTOR_DOWNWARD_ING) &&
+			 (hall_down_data_pre > chip->hall_down_data) && (chip->is_factory_mode == 1)) {
+			
+			MOTOR_LOG("hall_down_data_pre > chip->hall_down_data, may be structure shake, stop motor");
+			oneplus_motor_stop();
+    		break; 
+		}
+
+		//anti-shake when motor up
+		if ( (distance_time >= abnormal_judge_time) && (chip->move_state == MOTOR_UPWARD_ING) &&
+			                                           (hall_up_data_pre > chip->hall_up_data)) {
+			
+			MOTOR_LOG("hall_up_data_pre > chip->hall_up_data");
+		
+
+			if (enter_deltad_first_time != 0) {
+				chip->stall_steps = enter_deltad_first_time / 384;//(enter_deltad_first_time / 12) / 32;
+				chip->stall_mode = ENTER_DELTAD_AND_SHAKE;
+			} else {
+				chip->stall_steps = distance_time / 384;//(distance_time / 12) / 32;
+				chip->stall_mode = ONLY_SHAKE;
+			}
+			chip->is_stall = 1;
+			MOTOR_LOG("chip->stall_steps : %d, distance_time : %lu, enter_deltad_first_time : %lu \n", 
+			           chip->stall_steps, distance_time, enter_deltad_first_time);
+    		break; 
+		}
+
+		mdelay(chip->position_detect_delay);//15ms
+    }
+
+	oneplus_motor_set_awake(chip,POSITION_DETECT_LOCK,false);
+
+	MOTOR_LOG("chip->stall_mode : %d \n", chip->stall_mode);
+	if (chip->save_hall_data_to_file && data_count > 0) {
+		append_to_line = mag_noise ? true : false;
+		write_hall_data_to_file(hall_up_data, hall_down_data, data_count, chip->motor_direction, append_to_line);
+	}
+
+	mutex_unlock(&position_detect_mutex);
+	mutex_unlock(&motor_start_mutex);
+
+	return;
+}
+
+static int write_hall_data_to_file(short* hall_up_data, short* hall_down_data, int buf_len, int direction, bool append)
+{
+	int  fd = -1;
+	int  i = 0;
+	int  data_num = 0;
+	char hall_data_bufs[1024] = {0};// 16 * 64
+	char hall_data_buf[16] = {0};
+
+	if (hall_up_data == NULL || hall_down_data == NULL || buf_len < 1) {
+		MOTOR_ERR("write_hall_data_to_file failed, hall_up_data == NULL || hall_down_data == NULL || buf_len < 1");
+		return -EINVAL;
+	}
+
+	fd = sys_open("/sdcard/hall_data.csv",  O_WRONLY | O_CREAT | O_APPEND, 0);
+	if (fd < 0) {
+		MOTOR_ERR("open log file /sdcard/hall_data.csv failed, fd : %d \n", fd);
+		return -1;
+	}
+	
+	data_num = buf_len > 60 ? 60 : buf_len;
+	if (!append) {
+		if (direction) 
+			sys_write(fd, "1\n", 2);//up
+		else 
+			sys_write(fd, "0\n", 2);//down
+	}
+
+	for (i = 0; i < data_num; i++) {
+		memset(hall_data_buf, 0, sizeof(hall_data_buf));
+		sprintf(hall_data_buf, "%d,", hall_up_data[i]);
+		strcat(hall_data_bufs, hall_data_buf);
+	}
+	strcat(hall_data_bufs, "\n");
+	sys_write(fd, hall_data_bufs, strlen(hall_data_bufs));
+	memset(hall_data_bufs, 0 , sizeof(hall_data_bufs));
+
+	for (i = 0; i < data_num; i++) {
+		memset(hall_data_buf, 0, sizeof(hall_data_buf));
+		sprintf(hall_data_buf, "%d,", hall_down_data[i]);
+		strcat(hall_data_bufs, hall_data_buf);
+	}
+	strcat(hall_data_bufs, "\n");
+	sys_write(fd, hall_data_bufs, strlen(hall_data_bufs));
+	sys_write(fd, "\n", 1);
+
+	sys_close(fd);
+	return 0;
+}
+
+static enum hrtimer_restart motor_stop_timer_func(struct hrtimer* hrtimer)
+{
+	MOTOR_LOG("force_move : %d \n", g_the_chip->force_move);
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return HRTIMER_NORESTART;
+	}
+
+	if (g_the_chip->force_move){
+		MOTOR_LOG("force_move is enable, would not stop motor");
+		return HRTIMER_NORESTART;
+	}
+	g_the_chip->stop_timer_trigger = 1;
+
+	oneplus_motor_stop();
+	return HRTIMER_NORESTART;
+}
+
+static enum hrtimer_restart motor_speed_up_timer_func(struct hrtimer* hrtimer)
+{
+	MOTOR_LOG("call \n");
+
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return HRTIMER_NORESTART;
+	}
+
+	mod_delayed_work(system_highpri_wq, &g_the_chip->detect_work, 0);
+
+	return HRTIMER_NORESTART;
+}
+
+static enum alarmtimer_restart motor_reset_timer_func(struct alarm* alrm, ktime_t now)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return ALARMTIMER_NORESTART;
+	}
+
+	MOTOR_LOG("hall_down_irq_count %d hall_up_irq_count %d \n",g_the_chip->hall_down_irq_count,g_the_chip->hall_up_irq_count);
+
+	if ((g_the_chip->hall_down_irq_count >= MOTOR_IRQ_MONITOR_COUNT) ||
+		(g_the_chip->hall_up_irq_count >= MOTOR_IRQ_MONITOR_COUNT)) {
+		MOTOR_ERR("irq abnormal,reset \n");
+		g_the_chip->is_irq_abnormal = true;
+		g_the_chip->motor_switch = 0;
+		g_the_chip->hall_down_irq_count = 0;
+		g_the_chip->hall_up_irq_count = 0;
+	}
+	g_the_chip->irq_monitor_started = false;
+
+	return ALARMTIMER_NORESTART;
+}
+
+static void oneplus_motor_set_awake(struct oneplus_motor_chip* chip, int id ,bool awake)
+{
+	static int awake_count = 0;
+	static int wakelock_holder = 0;
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+	if (id >= MAX_LOCK)
+		return;
+
+	if (awake && !awake_count) {
+		if (!(wakelock_holder & (1 << id))) {//this holder have not this lock now
+			wakelock_holder |= (1 << id);
+			awake_count ++;
+			wake_lock(&chip->suspend_lock);
+			MOTOR_LOG("awake \n");
+		}
+	} else if (!awake && (awake_count == 1)) {//only one lock hold
+		if (wakelock_holder & (1 << id)) {
+			wakelock_holder &= ~(1 << id);
+			awake_count = 0;
+			wake_unlock(&chip->suspend_lock);
+			MOTOR_LOG("relax \n");
+		}
+	} else if (!awake) {
+		if (awake_count != 0) {
+			if (wakelock_holder & (1 << id)) {
+				awake_count --;
+				wakelock_holder &= ~(1 << id);
+			}
+		}
+	} else {
+		if (!(wakelock_holder & (1 << id))) {//this holder have not this lock now
+			awake_count ++;
+			wakelock_holder |= (1 << id);
+		}
+	}
+	//MOTOR_LOG("awake_count %d wakelock_holder %d\n",awake_count,wakelock_holder);
+#else
+	if (!chip->suspend_ws)
+		return;
+
+	if (id >= MAX_LOCK)
+		return;
+
+	if (awake && !awake_count) {
+		if (!(wakelock_holder & (1 << id))) {//this holder have not this lock now
+			wakelock_holder |= (1 << id);
+			awake_count ++;
+			__pm_stay_awake(chip->suspend_ws);//not alow system suspend
+			
+			MOTOR_LOG("awake \n");
+		}
+	} else if (!awake && (awake_count == 1)) {//only one lock hold
+		if (wakelock_holder & (1 << id)) {
+			wakelock_holder &= ~(1 << id);
+			awake_count = 0;
+			__pm_relax(chip->suspend_ws);
+			MOTOR_LOG("relax \n");
+		}
+	} else if (!awake) {
+		if (awake_count != 0) {
+			if (wakelock_holder & (1 << id)) {
+				awake_count --;
+				wakelock_holder &= ~(1 << id);
+			}
+		}
+	} else {
+		if (!(wakelock_holder & (1 << id))) {//this holder have not this lock now
+			awake_count ++;
+			wakelock_holder |= (1 << id);
+		}
+	}
+	MOTOR_LOG("awake_count %d wakelock_holder %d \n", awake_count, wakelock_holder);
+#endif
+}
+
+static void report_position_state(struct oneplus_motor_chip* chip, camera_position_state_event state_event)
+{
+	if (chip == NULL) {
+		MOTOR_ERR("chip == NULL \n");
+		return;
+	}
+
+	MOTOR_LOG("call, state_event : %d", state_event);
+	
+	switch (state_event) {
+	case MANUAL_TO_DOWN_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_MANUAL_TO_DOWN, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_MANUAL_TO_DOWN, 0);
+		input_sync(chip->input_dev);
+		break;
+	case UPING_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP, 0);
+		input_sync(chip->input_dev);
+		break;
+	case UP_ABNORMA_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP_ABNORMAL, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP_ABNORMAL, 0);
+		input_sync(chip->input_dev);
+		break;
+	case UP_NORMAL_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP_NORMAL, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_UP_NORMAL, 0);
+		input_sync(chip->input_dev);
+		break;
+	case DOWNING_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN, 0);
+		input_sync(chip->input_dev);
+		break;
+	case DOWN_ABNORMAL_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN_ABNORMAL, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN_ABNORMAL, 0);
+		input_sync(chip->input_dev);
+		break;
+	case DOWN_NORMAL_EVENT:
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN_NORMAL, 1);
+		input_sync(chip->input_dev);
+		input_report_key(chip->input_dev, MOTOR_EVENT_DOWN_NORMAL, 0);
+		input_sync(chip->input_dev);
+		break;
+	default:
+		MOTOR_ERR("state_event (%d) is invalid, would not report \n", state_event);
+		break;
+	}
+
+	return;
+}
+
+
+//note:work in irq context
+int oneplus_dhall_irq_handler(unsigned int id)
+{
+	MOTOR_LOG("call, id : %d \n", id);
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip == NULL \n");
+		return -EINVAL;
+	}
+
+	if (id == HALL_UP) {//push camera
+		g_the_chip->hall_up_irq_count ++;
+		queue_delayed_work(g_the_chip->manual2auto_wq, &g_the_chip->down_work, 0);
+	} else if (id == HALL_DOWN){
+		g_the_chip->hall_down_irq_count ++;
+		queue_delayed_work(g_the_chip->manual2auto_wq, &g_the_chip->up_work, 0);
+	}
+
+	return 0;
+}
+
+static void oneplus_motor_irq_monitor(struct oneplus_motor_chip* chip)
+{
+	if (!chip->irq_monitor_started) {
+		MOTOR_LOG("start \n");
+		chip->irq_monitor_started = true;
+		alarm_start_relative(&chip->reset_timer,
+					ktime_set(MOTOR_IRQ_MONITOR_TIME / 1000, (MOTOR_IRQ_MONITOR_TIME % 1000)*  1000000));
+	}
+}
+
+static irqreturn_t oneplus_free_fall_detect_handler(int irq, void* dev_id)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_LOG("g_the_chip ==NULL \n");
+		return -EINVAL;
+	}
+
+	g_the_chip->free_fall_irq_times++;
+
+
+	if (g_the_chip->free_fall_irq_times == 1)
+		mod_delayed_work(system_highpri_wq, &g_the_chip->free_fall_irq_check_work, msecs_to_jiffies(1));
+
+	// g_the_chip->is_free_fall = true;
+	// disable_irq_nosync(g_the_chip->free_fall_irq);
+	// oneplus_motor_downward();
+	// enable_irq(g_the_chip->free_fall_irq);
+
+	return IRQ_HANDLED;
+}
+
+/*********************************************************************
+            node operation by MotorManagerService and user
+**********************************************************************/
+static ssize_t motor_direction_store(struct device* pdev, struct device_attribute* attr,
+			   const char* buf, size_t count)
+{
+	unsigned long direction = 0;
+	int err = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	err = sscanf(buf, "%lu", &direction);
+	MOTOR_LOG("direction : %d, motor_started : %d", direction,g_the_chip->motor_started);
+	if (g_the_chip->motor_started) {
+		MOTOR_ERR("g_the_chip->motor_started != 0\n");
+		return count;
+	}
+
+	if (err == 1) {
+		oneplus_set_motor_direction(direction);
+	}
+
+	return count;;
+}
+
+static ssize_t motor_direction_show(struct device* dev,
+				  struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->motor_direction);
+}
+
+static ssize_t motor_enable_store(struct device* pdev, struct device_attribute* attr,
+					const char* buff, size_t count)
+{
+	unsigned long enable = 0;
+
+	if (sscanf(buff, "%lu", &enable) == 1) {
+		MOTOR_ERR("motor_enable_store enable : %d\n", enable);
+		if (enable) {
+			MOTOR_ERR("oneplus_motor_start \n");
+			oneplus_motor_start();
+		} else {
+			MOTOR_ERR("oneplus_motor_stop \n");
+			oneplus_motor_stop();
+		}
+	}
+
+	return count;
+}
+
+static ssize_t step_count_store(struct device *pdev, struct device_attribute *attr,
+		                        const char *buff, size_t count)
+{
+	unsigned long step_count = 0;
+
+	MOTOR_LOG("call");
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+
+	if (sscanf(buff, "%lu", &step_count) == 1) {
+		g_the_chip->camera_up_step_count = step_count * 32;
+
+		MOTOR_LOG("would set step_count, step_count : %d, g_the_chip->step_count : %d \n", 
+							             step_count, g_the_chip->camera_up_step_count);
+	} else {
+		MOTOR_LOG("would not set step_count, step_count : %d", step_count);
+	}
+
+	return count;
+}
+
+static ssize_t step_count_show(struct device *dev,struct device_attribute *attr, char *buf)
+{
+	int  step_count = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+	
+	step_count = g_the_chip->camera_up_step_count / 32;
+	MOTOR_LOG("step_count : %d, camera_up_step_count / 32 : %d \n", step_count , g_the_chip->camera_up_step_count / 32 );
+	return sprintf(buf, "%d\n",step_count);
+}
+
+static ssize_t save_hall_data_store(struct device *pdev, struct device_attribute *attr,
+		                            const char *buff, size_t count)
+{
+	unsigned long save_hall_data_to_file = 0;
+
+	MOTOR_LOG("call");
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+
+	if (sscanf(buff, "%lu", &save_hall_data_to_file) == 1) {
+		g_the_chip->save_hall_data_to_file = save_hall_data_to_file > 0 ? true : false;
+
+		MOTOR_LOG("would set save_hall_data_to_file, save_hall_data_to_file : %d, g_the_chip->save_hall_data_to_file : %d \n", 
+							 save_hall_data_to_file, g_the_chip->save_hall_data_to_file);
+	} else {
+		MOTOR_LOG("would not set step_count, save_hall_data_to_file : %d", save_hall_data_to_file);
+	}
+
+	return count;
+}
+
+static ssize_t save_hall_data_show(struct device *dev,struct device_attribute *attr, char *buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->save_hall_data_to_file);
+}
+
+static ssize_t hall_data_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+
+	oneplus_hall_get_abs_data(HALL_DOWN);
+	oneplus_hall_get_abs_data(HALL_UP);
+
+	MOTOR_LOG("hall_down_data  %d hall_up_data %d \n", g_the_chip->hall_down_data, g_the_chip->hall_up_data);
+
+	return sprintf(buf, "%d,%d\n", g_the_chip->hall_down_data, g_the_chip->hall_up_data);
+}
+
+static ssize_t motor_move_state_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", -1);
+	}
+
+	return sprintf(buf, "%d\n", g_the_chip->move_state);
+}
+
+static ssize_t hall_calibration_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	int step_count = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n%d\n",-1,-1);
+	}
+
+	step_count = g_the_chip->camera_up_step_count / 32;
+	return sprintf(buf, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
+	                    g_the_chip->hall_down_irq_position, 
+						g_the_chip->hall_up_irq_position,
+	                    g_the_chip->camera_down_slow_down_position_hall_down_data, 
+						g_the_chip->camera_down_slow_down_position_hall_up_data,
+	                    g_the_chip->camera_up_slow_down_position_hall_down_data, 
+						g_the_chip->camera_up_slow_down_position_hall_up_data,
+						g_the_chip->bottom_position_hall_down_data,
+						g_the_chip->bottom_position_hall_up_data,
+						g_the_chip->peak_position_hall_down_data,
+						g_the_chip->peak_position_hall_up_data,
+						step_count);
+}
+
+static ssize_t hall_calibration_store(struct device* pdev, struct device_attribute* attr,
+						              const char* buff, size_t count)
+{
+	int data[11] = {0};
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d", 
+	                 &data[0], &data[1], &data[2], &data[3], &data[4], &data[5],
+					 &data[6], &data[7], &data[8], &data[9], &data[10]) == 11) {
+
+		if (data[0] >= 0)
+			g_the_chip->hall_down_irq_position = data[0];
+		if (data[1] >= 0)
+			g_the_chip->hall_up_irq_position = data[1];
+		if (data[2] >= 0)
+		    g_the_chip->camera_down_slow_down_position_hall_down_data = data[2];
+		if (data[3] >= 0)
+		    g_the_chip->camera_down_slow_down_position_hall_up_data = data[3];
+		if (data[4] >= 0)
+		    g_the_chip->camera_up_slow_down_position_hall_down_data = data[4];
+		if (data[5] >= 0)
+		    g_the_chip->camera_up_slow_down_position_hall_up_data = data[5];
+		if (data[6] >= 0)
+			g_the_chip->bottom_position_hall_down_data = data[6];
+		if (data[7] >= 0)
+			g_the_chip->bottom_position_hall_up_data = data[7];
+		if (data[8] >= 0)
+			g_the_chip->peak_position_hall_down_data = data[8];
+		if (data[9] >= 0)
+			g_the_chip->peak_position_hall_up_data = data[9];
+		if (data[10] >= 0)
+			g_the_chip->camera_up_step_count = data[10] * 32;
+
+		MOTOR_LOG("hall calibrate date : %d %d %d %d %d %d %d %d %d %d %d\n",
+		                data[0], data[1], data[2], data[3], data[4], data[5],
+						data[6], data[7], data[8], data[9], data[10]);
+
+		if (g_the_chip->bottom_position_hall_down_data < 330)
+			g_the_chip->deltad_range = 5;
+		else 
+			g_the_chip->deltad_range = 10;
+
+		MOTOR_LOG("deltad_range : %d \n", g_the_chip->deltad_range);
+
+		//oneplus_hall_update_threshold(HALL_DOWN, BOTTOM_STATE, HALL_DETECT_RANGE_LOW, g_the_chip->hall_down_irq_position);
+	} else {
+		MOTOR_ERR("fail\n");
+	}
+	return count;
+
+}
+
+static ssize_t stall_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);;
+	}
+
+	MOTOR_LOG("is_stall %d\n",g_the_chip->is_stall);
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->is_stall);
+}
+
+static ssize_t stall_steps_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);;
+	}
+
+	MOTOR_LOG("stall_steps %d\n",g_the_chip->stall_steps);
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->stall_steps);
+}
+
+static ssize_t stall_mode_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);;
+	}
+
+	MOTOR_LOG("stall_mode %d\n",g_the_chip->stall_mode);
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->stall_mode);
+}
+
+static ssize_t  motor_test_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);;
+	}
+
+	MOTOR_LOG("is_motor_test %d\n",g_the_chip->is_motor_test);
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->is_motor_test);
+}
+
+static ssize_t motor_test_store(struct device* pdev, struct device_attribute* attr, const char* buff, size_t count)
+{
+	int test = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%d", &test) == 1) {
+		g_the_chip->is_motor_test = test;
+	}
+	MOTOR_LOG("test %d ,is_motor_test %d\n", test, g_the_chip->is_motor_test);
+
+	return count;
+}
+
+static ssize_t hall_irq_count_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n%d\n",-1,-1);
+	}
+
+	return sprintf(buf, "%d,%d\n",g_the_chip->hall_down_irq_count, g_the_chip->hall_up_irq_count);
+}
+
+static ssize_t motor_mode_store(struct device* pdev, struct device_attribute* attr,
+			   const char* buff, size_t count)
+{
+	int mdmode = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (g_the_chip->motor_started)
+		return count;
+
+	if (sscanf(buff, "%d", &mdmode) == 1) {
+		MOTOR_LOG("mdmode = %d \n", mdmode);
+		oneplus_set_motor_work_mode_para(mdmode);
+	}
+
+	return count;
+}
+
+static ssize_t  motor_mode_show(struct device* dev,
+				  struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->motor_work_mode);
+}
+
+static ssize_t motor_manual2auto_switch_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	int manual2auto_switch = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);
+	}
+
+	if (g_the_chip->manual2auto_down_switch == 1)
+		manual2auto_switch = 1;
+
+	return sprintf(buf, "%d\n",manual2auto_switch);
+}
+
+static ssize_t motor_manual2auto_switch_store(struct device* pdev, struct device_attribute* attr,
+						const char* buff, size_t count)
+{
+	int data[1] = {0};
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL\n");
+		return count;
+	}
+
+	if (sscanf(buff, "%d", &data[0]) == 1) {
+		g_the_chip->manual2auto_down_switch = data[0];
+		MOTOR_LOG("data : %d \n", data[0]);
+		if (data[0] == 1) {
+		    if (g_the_chip->position == PEAK_STATE) {
+		        oneplus_hall_update_threshold(HALL_UP,MID_STATE, HALL_DETECT_RANGE_LOW, g_the_chip->hall_up_irq_position);
+		    } else if (g_the_chip->position == BOTTOM_STATE) {
+		        oneplus_hall_update_threshold(HALL_DOWN,MID_STATE, HALL_DETECT_RANGE_LOW, g_the_chip->hall_down_irq_position);
+		    }
+			g_the_chip->is_skip_pos_check = 0;
+		} else {
+			g_the_chip->is_skip_pos_check = 1;
+		}
+	} else {
+		MOTOR_ERR("failed \n");
+	}
+
+	return count;
+}
+
+static ssize_t motor_sw_switch_store(struct device* pdev, struct device_attribute* attr,
+						             const char* buff, size_t count)
+{
+	unsigned long sw_switch = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &sw_switch) == 1) {
+		g_the_chip->motor_switch = sw_switch;
+	}
+
+	return count;
+}
+
+static ssize_t  motor_sw_switch_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->motor_switch);
+}
+
+static ssize_t motor_force_move_store(struct device* pdev, struct device_attribute* attr,
+					                  const char* buff, size_t count)
+{
+	unsigned long enable = 0;
+
+	MOTOR_LOG("call, enable : %d");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &enable) == 1) {
+		if (enable) {
+			g_the_chip->force_move = true;
+			oneplus_motor_start();
+		} else {
+			oneplus_motor_stop();
+		}
+	}
+
+	return count;
+}
+
+static ssize_t hall_detect_switch_store(struct device* pdev, struct device_attribute* attr,
+						                const char* buff, size_t count)
+{
+	unsigned long sw_switch = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &sw_switch) == 1) {
+		if (sw_switch)
+			g_the_chip->hall_detect_switch = true;
+		else
+			g_the_chip->hall_detect_switch = false;
+	}
+
+	return count;
+}
+
+static ssize_t  hall_detect_switch_show(struct device* dev,
+				  struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->hall_detect_switch);
+}
+
+static ssize_t  motor_all_config_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	int config[6] = {0};
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);
+	}
+
+	oneplus_motor_get_all_config(config, 6);
+
+	return snprintf(buf, PAGE_SIZE, "config {sleep : %d step : %d m0 : %d m1 : %d vref : %d dir : %d}\n",
+			                         config[0], config[1], config[2],config[3], config[4], config[5]);
+}
+
+static ssize_t  motor_position_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	int config[6] = {0};
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n",0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->position);
+}
+
+static ssize_t hall_all_reg_show(struct device* dev, struct device_attribute* attr, char* buf)
+{
+	u8 _buf[1024] = {0};
+
+	oneplus_dhall_dump_regs(HALL_DOWN, _buf);
+
+	return sprintf(buf, "%s\n", _buf);
+}
+
+static ssize_t motor_change_speed_store(struct device* pdev, struct device_attribute* attr,
+										const char* buff, size_t count)
+{
+	unsigned long speed = 0;
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &speed) == 1) {
+		oneplus_change_motor_speed(speed);
+	}
+
+	return count;
+}
+
+static ssize_t motor_speed_store(struct device* pdev, struct device_attribute* attr,
+			                     const char* buff, size_t count)
+{
+
+	unsigned long speed = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (g_the_chip->motor_started)
+		return count;
+
+	if (sscanf(buff, "%lu", &speed) == 1) {
+		if (speed >=0 && speed <=14) {
+			g_the_chip->is_speed_set = true;
+			g_the_chip->test_speed = speed;
+			MOTOR_LOG("would set speed, test_speed : %d", g_the_chip->test_speed);
+		} else {
+			MOTOR_LOG("speed (%d) parameter is invalid, would not set speed", speed);
+		}
+	}
+
+	return count;
+}
+
+static ssize_t motor_speed_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->motor_speed);
+}
+
+//slow down speed
+static ssize_t motor_slow_down_speed_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long slow_down_speed = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &slow_down_speed) == 1) {
+		if (slow_down_speed >=0 && slow_down_speed <=14) {
+			g_the_chip->slow_down_speed = slow_down_speed;
+			MOTOR_LOG("would set slow_down_speed, slow_down_speed : %d", g_the_chip->slow_down_speed);
+		} else {
+			MOTOR_LOG("slow_down_speed (%d) parameter is invalid, would not set slow_down_speed", slow_down_speed);
+		}
+	}
+
+	return count;
+}
+
+static ssize_t motor_slow_down_speed_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->slow_down_speed);
+}
+
+//deltad range
+static ssize_t deltad_range_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long deltad_range = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &deltad_range) == 1) {
+		g_the_chip->deltad_range = deltad_range;
+		MOTOR_LOG("would set deltad_range, deltad_range : %d", g_the_chip->deltad_range);
+	} 
+
+	return count;
+}
+
+static ssize_t deltad_range_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->deltad_range);
+}
+
+static ssize_t begin_stop_detect_percent_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long begin_stop_detect_percent = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &begin_stop_detect_percent) == 1) {
+		g_the_chip->begin_stop_detect_percent = begin_stop_detect_percent;
+		MOTOR_LOG("would set begin_stop_detect_percent, begin_stop_detect_percent : %d",
+				 g_the_chip->begin_stop_detect_percent);
+	} 
+	MOTOR_LOG("begin_stop_detect_percent : %d", begin_stop_detect_percent);
+
+	return count;
+}
+
+static ssize_t begin_stop_detect_percent_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->begin_stop_detect_percent);
+}
+
+static ssize_t factory_mode_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long is_factory_mode = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &is_factory_mode) == 1) {
+		g_the_chip->is_factory_mode = is_factory_mode;
+		MOTOR_LOG("would set is_factory_mode, is_factory_mode : %d", g_the_chip->is_factory_mode);
+	} 
+	MOTOR_LOG("is_factory_mode : %d", is_factory_mode);
+
+	return count;
+}
+
+static ssize_t factory_mode_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->is_factory_mode);
+}
+
+static ssize_t free_fall_irq_times_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long free_fall_irq_times = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &free_fall_irq_times) == 1) {
+		g_the_chip->free_fall_irq_times = free_fall_irq_times;
+		MOTOR_LOG("would set free_fall_irq_times, free_fall_irq_times : %d", g_the_chip->free_fall_irq_times);
+	} 
+	MOTOR_LOG("free_fall_irq_times : %d", free_fall_irq_times);
+
+	return count;
+}
+
+static ssize_t free_fall_irq_times_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->free_fall_irq_times);
+}
+
+static ssize_t infrared_shut_down_state_store(struct device* pdev, struct device_attribute* attr,
+			                               const char* buff, size_t count)
+{
+
+	unsigned long infrared_shut_down_state = 0;
+
+	MOTOR_LOG("call");
+
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return count;
+	}
+
+	if (sscanf(buff, "%lu", &infrared_shut_down_state) == 1) {
+		g_the_chip->infrared_shut_down_state = infrared_shut_down_state;
+		MOTOR_LOG("would set infrared_shut_down_state, free_fall_irq_times : %d", g_the_chip->infrared_shut_down_state);
+	} 
+	MOTOR_LOG("infrared_shut_down_state : %d", infrared_shut_down_state);
+
+	return count;
+}
+
+static ssize_t infrared_shut_down_state_show(struct device* dev,struct device_attribute* attr, char* buf)
+{
+	if (g_the_chip == NULL) {
+		MOTOR_ERR("g_the_chip == NULL \n");
+		return snprintf(buf, PAGE_SIZE, "%d\n", 0);;
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%d\n", g_the_chip->infrared_shut_down_state);
+}
+static DEVICE_ATTR(direction, S_IRUGO | S_IWUSR, motor_direction_show, motor_direction_store);
+static DEVICE_ATTR(speed, S_IRUGO | S_IWUSR, motor_speed_show, motor_speed_store);
+static DEVICE_ATTR(mode, S_IRUGO | S_IWUSR, motor_mode_show, motor_mode_store);
+static DEVICE_ATTR(enable, S_IRUGO | S_IWUSR, NULL, motor_enable_store);
+static DEVICE_ATTR(step_count,   S_IRUGO | S_IWUSR, step_count_show, step_count_store);
+static DEVICE_ATTR(save_hall_data, S_IRUGO | S_IWUSR, save_hall_data_show, save_hall_data_store);
+static DEVICE_ATTR(change_speed,   S_IRUGO | S_IWUSR,NULL, motor_change_speed_store);
+static DEVICE_ATTR(move_state,    S_IRUGO | S_IWUSR, motor_move_state_show,NULL);
+static DEVICE_ATTR(config,   S_IRUGO | S_IWUSR, motor_all_config_show,NULL);
+static DEVICE_ATTR(sw_switch,    S_IRUGO | S_IWUSR, motor_sw_switch_show,motor_sw_switch_store);
+//static DEVICE_ATTR(speed_change_switch,    S_IRUGO | S_IWUSR, motor_speed_change_switch_show,motor_speed_change_switch_store);
+static DEVICE_ATTR(position,   S_IRUGO | S_IWUSR, motor_position_show,NULL);
+static DEVICE_ATTR(manual2auto_switch,   S_IRUGO | S_IWUSR, motor_manual2auto_switch_show,motor_manual2auto_switch_store);
+static DEVICE_ATTR(motor_test,   S_IRUGO | S_IWUSR, motor_test_show,motor_test_store);
+static DEVICE_ATTR(hall_data,   S_IRUGO | S_IWUSR,hall_data_show,NULL);
+static DEVICE_ATTR(hall_reg,   S_IRUGO | S_IWUSR,hall_all_reg_show,NULL);
+static DEVICE_ATTR(hall_irq_count,   S_IRUGO | S_IWUSR,hall_irq_count_show,NULL);
+static DEVICE_ATTR(hall_calibration,   S_IRUGO | S_IWUSR,hall_calibration_show,hall_calibration_store);
+static DEVICE_ATTR(stall,   S_IRUGO | S_IWUSR, stall_show, NULL);
+static DEVICE_ATTR(stall_steps,   S_IRUGO | S_IWUSR, stall_steps_show, NULL);
+static DEVICE_ATTR(stall_mode, S_IRUGO | S_IWUSR, stall_mode_show, NULL);
+static DEVICE_ATTR(hall_detect_switch,   S_IRUGO | S_IWUSR,hall_detect_switch_show,hall_detect_switch_store);
+static DEVICE_ATTR(force_move, 	S_IRUGO | S_IWUSR, NULL, motor_force_move_store);
+//static DEVICE_ATTR(stop_time, S_IRUGO | S_IWUSR, motor_stop_time_show, motor_stop_time_store);
+//static DEVICE_ATTR(initial_time, S_IRUGO | S_IWUSR, motor_initial_time_show, motor_initial_time_store);
+//static DEVICE_ATTR(initial_speed, S_IRUGO | S_IWUSR, motor_initial_speed_show, motor_initial_speed_time_store);
+//static DEVICE_ATTR(high_speed, S_IRUGO | S_IWUSR, motor_high_speed_show, motor_high_speed_store);
+//static DEVICE_ATTR(high_speed_time, S_IRUGO | S_IWUSR, motor_high_speed_time_show, motor_high_speed_time_store);
+static DEVICE_ATTR(slow_down_speed, S_IRUGO | S_IWUSR, motor_slow_down_speed_show, motor_slow_down_speed_store);
+static DEVICE_ATTR(deltad_range, S_IRUGO | S_IWUSR, deltad_range_show, deltad_range_store);
+static DEVICE_ATTR(begin_stop_detect_percent, S_IRUGO | S_IWUSR, begin_stop_detect_percent_show, begin_stop_detect_percent_store);
+static DEVICE_ATTR(factory_mode, S_IRUGO | S_IWUSR, factory_mode_show, factory_mode_store);
+static DEVICE_ATTR(free_fall_irq_times, S_IRUGO | S_IWUSR, free_fall_irq_times_show, free_fall_irq_times_store);
+static DEVICE_ATTR(infrared_shut_down_state, S_IRUGO | S_IWUSR, infrared_shut_down_state_show, infrared_shut_down_state_store);
+
+
+static struct attribute*  __attributes[] = {
+	&dev_attr_direction.attr,
+	&dev_attr_speed.attr,
+	&dev_attr_mode.attr,
+	&dev_attr_enable.attr,
+	&dev_attr_step_count.attr,
+	&dev_attr_save_hall_data.attr,
+	&dev_attr_change_speed.attr,
+	&dev_attr_move_state.attr,
+	&dev_attr_config.attr,
+	&dev_attr_sw_switch.attr,
+	&dev_attr_position.attr,
+	&dev_attr_manual2auto_switch.attr,
+	&dev_attr_motor_test.attr,
+	&dev_attr_hall_data.attr,
+	&dev_attr_hall_reg.attr,
+	&dev_attr_hall_irq_count.attr,
+	&dev_attr_hall_calibration.attr,
+	&dev_attr_stall.attr,
+	&dev_attr_stall_steps.attr,
+	&dev_attr_stall_mode.attr,
+	&dev_attr_hall_detect_switch.attr,
+	&dev_attr_force_move.attr,
+
+	// &dev_attr_stop_time.attr,
+	// &dev_attr_initial_time.attr,
+	// &dev_attr_initial_speed.attr,
+	// &dev_attr_high_speed.attr,
+	// &dev_attr_high_speed_time.attr,
+	&dev_attr_slow_down_speed.attr,
+	&dev_attr_deltad_range.attr,
+	&dev_attr_begin_stop_detect_percent.attr,
+	&dev_attr_factory_mode.attr,
+	&dev_attr_free_fall_irq_times.attr,
+	&dev_attr_infrared_shut_down_state.attr,
+	NULL
+};
+
+static struct attribute_group __attribute_group = {
+	.attrs = __attributes
+};
+
+/*********************************************************************
+            digital_hall and step_motor register ops function
+**********************************************************************/
+int oneplus_register_dhall(const char* name, struct oneplus_hall_operations* ops)
+{
+	if(name == NULL || ops == NULL) {
+		MOTOR_ERR("name == NULL || ops == NULL, would not register digital hall \n");
+		return -EINVAL;
+	}
+
+	if (g_the_chip == NULL) {
+		struct oneplus_motor_chip* chip = kzalloc(sizeof(struct oneplus_motor_chip), GFP_KERNEL);
+		if (!chip) {
+			MOTOR_ERR("kzalloc err \n");
+			return -ENOMEM;
+		}
+		oneplus_motor_chip_init(chip);
+		g_the_chip = chip;
+		
+	}
+
+	MOTOR_LOG("name : %s\n", name);
+
+	if (strcmp(name, "m1120_down") == 0) {
+		if (g_the_chip->hall_down_ops == NULL) {
+			g_the_chip->hall_down_ops = ops;
+		} else {
+			MOTOR_ERR("hall_down_ops has been registered \n");
+			return -EINVAL;
+		}
+	}
+
+	if (strcmp(name, "m1120_up") == 0) {
+		if (g_the_chip->hall_up_ops == NULL) {
+			g_the_chip->hall_up_ops = ops;
+		} else {
+			MOTOR_ERR("hall_up_ops has been registered \n");
+			return -EINVAL;
+		}
+	}
+
+	return 0;
+}
+
+int oneplus_register_motor(const char*  name, struct oneplus_motor_operations* ops)
+{
+	if(name == NULL || ops == NULL) {
+		MOTOR_ERR("name == NULL || ops == NULL, would not register step motor \n");
+		return -EINVAL;
+	}
+
+	MOTOR_LOG("motor name : %s \n", name);
+	if (g_the_chip == NULL) {
+		struct oneplus_motor_chip* chip = kzalloc(sizeof(struct oneplus_motor_chip), GFP_KERNEL);
+		if (!chip) {
+			MOTOR_ERR("kzalloc err \n");
+			return -ENOMEM;
+		}
+		oneplus_motor_chip_init(chip);
+		g_the_chip = chip;
+	}
+
+	if (g_the_chip->motor_ops == NULL) {
+		g_the_chip->motor_ops = ops;
+	} else {
+		MOTOR_ERR("motor_ops has been registered \n");
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+/*********************************************************************
+						 init function
+**********************************************************************/
+static int oneplus_input_dev_init(struct oneplus_motor_chip* chip)
+{
+	struct input_dev* dev;
+	int err;
+
+	dev = input_allocate_device();
+	if (dev == NULL) {
+		MOTOR_ERR("input_allocate_device failed, dev == NULL \n");
+		return -ENOMEM;
+	}
+
+	dev->name = "motor";
+	dev->id.bustype = BUS_I2C;
+
+	set_bit(MOTOR_EVENT_TYPE, dev->evbit);
+	set_bit(MOTOR_EVENT_MANUAL_TO_DOWN, dev->keybit);
+	set_bit(MOTOR_EVENT_UP, dev->keybit);
+	set_bit(MOTOR_EVENT_UP_ABNORMAL, dev->keybit);
+	set_bit(MOTOR_EVENT_UP_NORMAL, dev->keybit);
+	set_bit(MOTOR_EVENT_DOWN, dev->keybit);
+	set_bit(MOTOR_EVENT_DOWN_ABNORMAL, dev->keybit);
+	set_bit(MOTOR_EVENT_DOWN_NORMAL, dev->keybit);
+
+	err = input_register_device(dev);
+	if (err < 0) {
+		input_free_device(dev);
+ 
+		MOTOR_ERR("input_register_device failed, err : %d \n", err);
+		return err;
+	}
+
+	chip->input_dev = dev;
+
+	return 0;
+}
+
+static int oneplus_motor_chip_init(struct oneplus_motor_chip* chip)
+{
+	MOTOR_LOG("call \n");
+
+	if (chip == NULL) {
+		MOTOR_ERR("chip == NULL \n");
+		return -EINVAL;
+	}
+
+	//step motor  property 
+	chip->pwm_duty = 0;
+	chip->pwm_period = 0;
+	chip->motor_work_mode = MOTOR_MODE_1_32;
+	chip->motor_speed = MOTOR_SPEED0;
+	chip->motor_direction = MOTOR_UPWARD;
+	chip->motor_enable = false;
+	chip->pwm_count = 0;
+	chip->motor_started = false;
+	chip->motor_switch = true;
+
+	//digital hall property
+	chip->hall_down_data = 0;
+	chip->hall_up_data = 0;
+	chip->hall_down_irq_count = 0;
+	chip->hall_up_irq_count = 0;
+
+	//calibrate property
+	chip->hall_down_irq_position = HALL_DETECT_RANGE_HIGH;
+	chip->hall_up_irq_position = HALL_DETECT_RANGE_HIGH;
+	chip->camera_up_slow_down_position_hall_down_data = 0;
+	chip->camera_up_slow_down_position_hall_up_data =  MOTOR_STOP_RETARD_VALUE;
+	chip->camera_down_slow_down_position_hall_down_data =  MOTOR_STOP_RETARD_VALUE;
+	chip->camera_down_slow_down_position_hall_up_data = 0;
+	chip->is_stall = 0;
+	chip->stall_steps = 0;
+	chip->stall_mode = UNKNOW_MODE;
+
+	//special test property
+	chip->is_motor_test = false;
+	chip->force_move = false;
+	chip->is_speed_set = false;
+	chip->is_factory_mode = 0;
+	chip->test_speed = MOTOR_SPEED0;
+
+	//logical control property
+	atomic_set(&chip->in_suspend, 0);
+	chip->whole_jonery_time = 500000;//500ms default
+
+	chip->whole_jonery_length = 82;//8.2mm, unuse
+	chip->begin_stop_detect_percent = 95;//95% default
+	chip->speed_up_distance = 5;//0.5mm
+	chip->speed_down_distance = 3;//0.3mm
+	chip->speed_up_pwm_count = 30 * 32;//75 step default
+	chip->camera_up_step_count = 1380 * 32;//1380 step default
+	chip->slow_down_speed = MOTOR_SPEED0;
+	chip->deltad_range = 5;//5 default
+	//chip->speed_down_pwm_count = 0;
+	chip->position_detect_delay = 15;//15ms
+	chip->camera_position_detect = false;
+	//chip->motor_start_time = 0;
+	chip->save_hall_data_to_file = false;
+	chip->hall_detect_switch = true;
+	chip->position = BOTTOM_STATE;
+	chip->move_state = MOTOR_STOP;
+	chip->is_skip_pos_check = false;
+	chip->manual2auto_down_switch = true;
+	chip->is_free_fall = false;
+	chip->free_fall_irq_times = 0;
+	chip->infrared_shut_down_state = 0;
+	chip->free_fall_gpio = 0;
+	chip->free_fall_irq = 0;
+	chip->irq_monitor_started = false;
+	chip->is_irq_abnormal  = false;
+	chip->is_t0_structure = false;
+	chip->is_mag_positive = true;
+	chip->led_on = false;
+	
+	chip->dev = NULL;
+	chip->pctrl = NULL;
+	chip->free_fall_state = NULL;
+	chip->input_dev = NULL;
+	chip->manual2auto_wq = NULL;
+	chip->motor_run_work_wq = NULL;
+	chip->hall_up_ops = NULL;
+	chip->hall_down_ops = NULL;
+	chip->motor_ops = NULL;
+
+	return 0;
+}
+
+static void oneplus_motor_awake_init(struct oneplus_motor_chip* chip)
+{
+	if (chip == NULL) {
+		MOTOR_ERR("chip == NULL \n");
+		return;
+	}
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+	wake_lock_init(&chip->suspend_lock, WAKE_LOCK_SUSPEND, "motor_wakelock");
+#else
+	chip->suspend_ws = wakeup_source_register("motor_wakelock");
+#endif
+}
+
+
+static void oneplus_motor_free_fall_register(struct oneplus_motor_chip*  chip)
+{
+	struct device_node* np = NULL;
+	int err = 0;
+
+	np = chip->dev->of_node;
+
+	chip->pctrl = devm_pinctrl_get(chip->dev);
+	if (IS_ERR(chip->pctrl)) {
+		MOTOR_ERR("failed to get pinctrl \n");
+		return;
+	};
+
+	chip->free_fall_state = pinctrl_lookup_state(chip->pctrl, "free_fall_input");
+	if (IS_ERR(chip->free_fall_state)) {
+		err = PTR_ERR(chip->free_fall_state);
+		MOTOR_ERR("pinctrl_lookup_state failed, err : %d \n", err);
+		return;
+	};
+
+	pinctrl_select_state(chip->pctrl,chip->free_fall_state);
+	chip->free_fall_gpio = of_get_named_gpio(np, "motor,irq-gpio", 0);
+
+	if (!gpio_is_valid(chip->free_fall_gpio)) {
+		MOTOR_LOG("qcom,hall-power-gpio gpio not specified \n");
+	} else {
+		err = gpio_request(chip->free_fall_gpio, "motor-irq-gpio");
+		if (err)
+			MOTOR_LOG("request free_fall_gpio gpio failed, err : %d \n",err);
+
+		err = gpio_direction_input(chip->free_fall_gpio);
+		msleep(50);
+		chip->free_fall_irq = gpio_to_irq(chip->free_fall_gpio);
+
+		if (request_irq(chip->free_fall_irq, &oneplus_free_fall_detect_handler, IRQ_TYPE_EDGE_RISING, "free_fall", NULL)) {
+			MOTOR_ERR("IRQ LINE NOT AVAILABLE!!\n");
+			return;
+		}
+		irq_set_irq_wake(chip->free_fall_irq, 1);
+	}
+
+	MOTOR_LOG("gpio %d irq:%d \n",chip->free_fall_gpio, chip->free_fall_irq);
+}
+
+static void oneplus_motor_reset_check(struct oneplus_motor_chip* chip)
+{
+    oneplus_hall_get_abs_data(HALL_DOWN);
+	
+    MOTOR_LOG("hall0 data %d  hall_down_irq_position %d \n", chip->hall_down_data, chip->hall_down_irq_position);
+	
+	if (chip->hall_down_data < 0)
+		chip->hall_down_data = 0 - chip->hall_down_data;
+
+    if (chip->hall_down_data < chip->hall_down_irq_position) {
+        MOTOR_LOG("reset motor \n");
+	    chip->position = PEAK_STATE;
+        oneplus_motor_downward();
+    }
+
+}
+
+static void oneplus_parameter_init(struct oneplus_motor_chip* chip)
+{
+	u32 id = 0;
+	struct device_node* np = NULL;
+	int err = -1;
+
+	if (chip == NULL || chip->dev == NULL) {
+		MOTOR_ERR("oneplus_parameter_init failed, chip == NULL || chip->dev == NULL");
+		return;
+	}
+
+	np = chip->dev->of_node;
+	err = of_property_read_u32(np, "structure,id", &id);
+	if (err && (err != -EINVAL)) {
+		MOTOR_ERR("get structure,id err : %d", err);
+	} else {
+		MOTOR_LOG("read structure,id success, id : %d", id);
+		if (id == 1) {
+			MOTOR_LOG("is T0 structure");
+			chip->is_t0_structure = true;
+		}
+	}
+
+	oneplus_hall_update_threshold(HALL_DOWN, BOTTOM_STATE, 511, 511);
+	oneplus_hall_update_threshold(HALL_UP, BOTTOM_STATE, 511, 511);
+	oneplus_dhall_set_detection_mode(HALL_DOWN, DETECTION_MODE_INTERRUPT);
+	oneplus_dhall_set_detection_mode(HALL_UP, DETECTION_MODE_INTERRUPT);
+
+	oneplus_set_motor_work_mode_para(MOTOR_MODE_1_32);
+
+	oneplus_set_motor_direction(MOTOR_UPWARD);
+
+	oneplus_motor_awake_init(chip);
+
+
+	oneplus_hall_get_real_data(HALL_DOWN);
+	oneplus_hall_get_real_data(HALL_UP);
+	//save hall data
+	MOTOR_LOG("hall_down_data : %d, HALL_UP : %d", chip->hall_down_data, chip->hall_up_data);
+	if (chip->hall_down_data < 0) {
+		MOTOR_LOG("mag is negative");
+		chip->is_mag_positive = false;
+	}
+
+}
+
+static int motor_platform_probe(struct platform_device* pdev)
+{
+	struct oneplus_motor_chip* chip = NULL;
+	struct proc_dir_entry* dir = NULL;
+	int err = 0;
+
+
+	MOTOR_LOG("call \n");
+
+	if (g_the_chip == NULL) {
+		chip = kzalloc(sizeof(struct oneplus_motor_chip), GFP_KERNEL);
+		if (!chip) {
+			MOTOR_ERR("kzalloc err \n");
+			return -ENOMEM;
+		}
+		g_the_chip = chip;
+	} else {
+		chip = g_the_chip;
+	}
+
+	chip->dev = &pdev->dev;
+
+	if (chip->hall_up_ops == NULL || chip->hall_down_ops == NULL) {
+		MOTOR_ERR("no digital hall available \n");
+		//goto fail;
+	}
+
+	if (chip->motor_ops == NULL) {
+		MOTOR_ERR("no motor driver available \n");
+		//goto fail;
+	}
+	//create
+	err = sysfs_create_group(&pdev->dev.kobj, &__attribute_group);
+	if(err) {
+		MOTOR_ERR("sysfs_create_group failed, err : %d \n", err);
+		goto sysfs_create_fail;
+	}
+
+	err = oneplus_input_dev_init(chip);
+	if (err < 0) {
+		MOTOR_ERR("oneplus_input_dev_init failed, err : %d \n", err);
+		//goto input_fail;
+	}
+
+  	chip->motor_run_work_wq = create_singlethread_workqueue("motor_run_work_wq");
+  	if (chip->motor_run_work_wq == NULL) {
+  		MOTOR_ERR("create_singlethread_workqueue failed, motor_run_work_wq == NULL \n");
+		//goto input_fail;
+  	}
+
+	chip->manual2auto_wq = create_singlethread_workqueue("manual2auto_wq");
+	if (!chip->manual2auto_wq) {
+	    MOTOR_ERR("create_singlethread_workqueue failed, manual2auto_wq == NULL \n");
+		//goto input_fail;
+	}
+
+    oneplus_motor_free_fall_register(chip);
+
+	oneplus_parameter_init(chip);
+
+	hrtimer_init(&chip->stop_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+	chip->stop_timer.function = motor_stop_timer_func;
+
+	hrtimer_init(&chip->speed_up_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+	chip->speed_up_timer.function = motor_speed_up_timer_func;
+
+	//INIT_WORK(&chip->motor_work, motor_run_work);
+	//INIT_WORK(&chip->manual_position_work,manual_position_detect_work);//zhe
+
+
+	alarm_init(&chip->reset_timer, ALARM_BOOTTIME, motor_reset_timer_func); 
+
+	INIT_DELAYED_WORK(&chip->detect_work, camera_position_detect_work);
+	INIT_DELAYED_WORK(&chip->up_work, manual_to_auto_up_work);
+	INIT_DELAYED_WORK(&chip->down_work, manual_to_auto_down_work);
+	INIT_DELAYED_WORK(&chip->free_fall_irq_check_work, free_fall_irq_check_work_func);
+	INIT_WORK(&chip->motor_work, motor_run_work);
+
+	chip->fb_notify.notifier_call = fb_notifier_callback;
+	#ifdef CONFIG_DRM_MSM
+	msm_drm_register_client(&chip->fb_notify);
+	#else
+	fb_register_client(&chip->fb_notify);
+	#endif
+
+	oneplus_motor_reset_check(g_the_chip);
+
+	MOTOR_LOG("success. \n");
+	return 0;
+
+//input_fail:
+sysfs_create_fail:
+//fail:
+	kfree(chip);
+	g_the_chip = NULL;
+	MOTOR_LOG("fail \n");
+	return -EINVAL;
+}
+
+static int motor_platform_remove(struct platform_device* pdev)
+{
+	if (g_the_chip) {
+		sysfs_remove_group(&pdev->dev.kobj, &__attribute_group);
+		input_unregister_device(g_the_chip->input_dev);
+        input_free_device(g_the_chip->input_dev);
+		kfree(g_the_chip);
+		g_the_chip = NULL;
+	}
+	return 0;
+}
+
+static int motor_platform_suspend(struct platform_device* pdev, pm_message_t state)
+{
+	if (g_the_chip) {
+		atomic_set(&g_the_chip->in_suspend, 1);
+	}
+	return 0;
+}
+
+static int motor_platform_resume(struct platform_device* pdev)
+{
+	if (g_the_chip) {
+		atomic_set(&g_the_chip->in_suspend, 0);
+	}
+	return 0;
+}
+static void motor_platform_shutdown(struct platform_device* pdev)
+{
+	MOTOR_LOG("call \n");
+	if (g_the_chip) {
+		//when phone is power off, check if camera is outside 
+		oneplus_motor_reset_check(g_the_chip);
+	}
+	return;
+}
+
+
+static const struct of_device_id of_motor_match[] = {
+	{ .compatible = "oneplus-motor"},
+	{},
+};
+MODULE_DEVICE_TABLE(of, of_motor_match);
+
+static struct platform_driver motor_platform_driver = {
+	.probe		= motor_platform_probe,
+	.remove		= motor_platform_remove,
+	.suspend	= motor_platform_suspend,
+	.resume		= motor_platform_resume,
+	.shutdown   = motor_platform_shutdown,
+	.driver		= {
+		.name	= "oneplus_motor",
+		.of_match_table = of_motor_match,
+	},
+};
+
+static int __init motor_platform_init(void)
+{
+	MOTOR_LOG("call \n");
+
+	platform_driver_register(&motor_platform_driver);
+	return 0;
+}
+
+late_initcall(motor_platform_init);
+MODULE_DESCRIPTION("camera motor platform driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("quentin.lin");
diff --git a/drivers/leds/step_motor/oneplus_motor.h b/drivers/leds/step_motor/oneplus_motor.h
new file mode 100644
index 0000000000000000000000000000000000000000..ac6c0c417f9ed9a433680c511a0420e9d6f768d2
--- /dev/null
+++ b/drivers/leds/step_motor/oneplus_motor.h
@@ -0,0 +1,273 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_motor.h
+**
+** Description:
+**      Definitions for m1120 camera motor control layer.
+**
+****************************************************************************************/
+#ifndef __ONEPLUS_MOTOR__H
+#define __ONEPLUS_MOTOR__H
+
+#include <linux/alarmtimer.h>
+#include <linux/version.h>
+
+#define MOTOR_TAG                  "[oneplus_motor] "
+#define MOTOR_ERR(fmt, args...)    printk(KERN_ERR MOTOR_TAG" %s : "fmt,__FUNCTION__,##args)
+#define MOTOR_LOG(fmt, args...)    printk(KERN_INFO MOTOR_TAG" %s : "fmt,__FUNCTION__,##args)
+
+//camera state event to report
+#define MOTOR_EVENT_TYPE			EV_KEY
+#define MOTOR_EVENT_MANUAL_TO_DOWN  KEY_F14
+#define MOTOR_EVENT_UP				KEY_F15
+#define MOTOR_EVENT_UP_ABNORMAL		KEY_F16
+#define MOTOR_EVENT_UP_NORMAL		KEY_F17
+#define MOTOR_EVENT_DOWN			KEY_F18
+#define MOTOR_EVENT_DOWN_ABNORMAL	KEY_F19
+#define MOTOR_EVENT_DOWN_NORMAL		KEY_F20
+
+//position hall data
+#define HALL_DETECT_RANGE_HIGH		    (150)
+#define HALL_DETECT_RANGE_LOW		    (-512)
+#define MOTOR_RESET_TIMER		        (500)//500ms
+#define MOTOR_STOP_STAITC_POS_VALUE		(10)
+#define MOTOR_STOP_STAITC_NEG_VALUE		(-10)
+#define MOTOR_STOP_RETARD_VALUE			(500)
+//irq
+#define MOTOR_IRQ_MONITOR_TIME		    (20)//20ms
+#define MOTOR_IRQ_MONITOR_COUNT		    (8)
+
+#define MOTOR_STOP_TIMEOUT              (12000) //80k
+
+typedef enum hall_id {
+	HALL_DOWN = 0,
+	HALL_UP,
+} hall_id;
+
+enum dhall_detection_mode {
+	DETECTION_MODE_POLLING = 0,
+	DETECTION_MODE_INTERRUPT,
+	DETECTION_MODE_INVALID,
+};
+
+enum motor_type {
+	MOTOR_UNKNOWN = 0,
+	MOTOR_FI5,
+	MOTOR_FI6,
+};
+
+typedef enum motor_power {
+	MOTOR_POWER_OFF = 0,
+	MOTOR_POWER_ON,
+} motor_power;
+
+typedef enum motor_direction_t {
+	MOTOR_DOWN = 0,
+	MOTOR_UPWARD,
+} motor_direction_t;
+
+typedef enum camera_position_state_event {
+	MANUAL_TO_DOWN_EVENT = 0,
+	UPING_EVENT,
+	UP_ABNORMA_EVENT,
+	UP_NORMAL_EVENT,
+	DOWNING_EVENT,
+	DOWN_ABNORMAL_EVENT,
+	DOWN_NORMAL_EVENT
+} camera_position_state_event;
+
+enum wakelock_id {
+	MOTOR_RUN_LOCK = 0,
+	HALL_DATA_LOCK,
+	POSITION_DETECT_LOCK,
+	MAX_LOCK
+};
+
+typedef enum motor_move_state {
+	MOTOR_STOP = 0,//never move after boot
+	MOTOR_UPWARD_ING,//motor is uping 
+	MOTOR_DOWNWARD_ING,//motor down stop , may be abnormal
+	MOTOR_UPWARD_STOP,//motor up stop , may be abnormal
+	MOTOR_DOWNWARD_STOP//motor is downing
+} motor_move_state;
+
+typedef enum camera_position {
+	PEAK_STATE,
+	BOTTOM_STATE,
+	MID_STATE,
+} camera_position;
+
+typedef enum motor_stall_mode {
+	ENTER_DELTAD_RANGE_TWO_TIEMS  = 0,
+	ENTER_DELTAD_AND_SHAKE,
+	ONLY_SHAKE,
+	UNKNOW_MODE,
+} motor_stall_mode_t;
+
+typedef enum motor_work_mode {
+	MOTOR_MODE_FULL = 0,
+	MOTOR_MODE_1_2,
+	MOTOR_MODE_1_4,
+	MOTOR_MODE_1_8,
+	MOTOR_MODE_1_16,
+	MOTOR_MODE_1_32
+} motor_work_mode_t;
+
+typedef enum motor_speed_t {
+	MOTOR_SPEED0 = 0,     //high 2500pps  80khz 
+	MOTOR_SPEED1,         //     2000pps  64khz
+	MOTOR_SPEED2,         //     1600pps  51.2khz
+	MOTOR_SPEED3,         //     1200pps  38.4khz
+	MOTOR_SPEED4,         //     1000pps  32khz
+	MOTOR_SPEED5,         //     800pps   25.6khz
+	MOTOR_SPEED6,         //     700pps   22.4khz
+	MOTOR_SPEED7,         //     600pps   19.2khz
+	MOTOR_SPEED8,         //     518pps   16.6khz
+	MOTOR_SPEED9,         //     400pps   12.8khz
+	MOTOR_SPEED10,        //     300pps   9.6kkhz
+	MOTOR_SPEED11,        //     200pps   6.4kkhz
+	MOTOR_SPEED12,        //     100pps   3.2kkhz
+	MOTOR_SPEED13,        //LOW  50pps	 1.6khz
+	MOTOR_SPEED_SPECIAL   //2800pps
+} motor_speed_t;
+
+
+struct oneplus_hall_operations {
+	const char*  name;
+	bool (*is_power_on) (void);
+	int  (*set_hall_enable_state) (bool enable);
+	bool (*get_hall_enable_state) (void);
+	int  (*get_data_real) (short* data);
+	int  (*get_data_abs) (short* data);
+	int  (*set_detection_mode) (u8 mode);
+	int  (*enable_irq) (bool enable);
+	int  (*clear_irq) (void);
+	int  (*get_irq_state) (void);
+	bool (*update_threshold) (int position, short lowthd, short highthd);
+	void (*dump_regs) (u8* buf);
+	int  (*set_reg) (int reg, int val);
+};
+
+struct oneplus_motor_operations {
+	const char*  name;
+	int (*set_power) (int mode);
+	int (*set_direction) (int dir);
+	int (*set_working_mode) (int mode);
+	int (*get_all_config)(int* config , int count);
+	int (*calculate_pwm_count) (int angle, int mode);
+	int (*pwm_config) (int duty_ns, int period_ns);
+	int (*pwm_enable) (void);
+	int (*pwm_disable) (void);
+	int (*get_motor_type) (void);
+};
+
+struct oneplus_motor_chip {
+    //step motor  property 
+	unsigned long                     pwm_duty;
+	unsigned long                     pwm_period;
+	motor_work_mode_t                 motor_work_mode;
+	motor_speed_t                     motor_speed;
+	motor_direction_t                 motor_direction;
+	bool     	                      motor_enable;
+	bool		                      motor_started;
+	bool		                      motor_switch;
+
+	//digital hall property
+	short                             hall_down_data;
+	short                             hall_up_data;
+	int	                              hall_down_irq_count;
+	int	                              hall_up_irq_count;
+	short                             hall_down_irq_position;
+	short                             hall_up_irq_position;
+
+	//calibrate property
+	short	                          camera_up_slow_down_position_hall_down_data;
+	short	                          camera_up_slow_down_position_hall_up_data;
+	short	                          camera_down_slow_down_position_hall_down_data;
+	short	                          camera_down_slow_down_position_hall_up_data;
+    short                             bottom_position_hall_down_data;
+	short                             bottom_position_hall_up_data;
+    short                             peak_position_hall_down_data;
+	short                             peak_position_hall_up_data;	
+	int                               camera_up_step_count;
+	int                               is_stall;
+	int                               stall_steps;
+	motor_stall_mode_t                stall_mode;
+
+	//special test property
+	bool		                      is_motor_test;
+	bool                              force_move;
+	bool                              is_speed_set;
+	int                               is_factory_mode;//0:normal, 1:calibrate, 2:step test
+	motor_speed_t                     test_speed;
+
+	//logical control property
+	atomic_t		                  in_suspend;
+	int  		                      pwm_count;
+	unsigned long                     whole_jonery_time;
+	int				                  whole_jonery_length;
+	int                               begin_stop_detect_percent;
+	int				                  speed_up_distance;
+	int				                  speed_down_distance;
+	int				                  speed_up_pwm_count;
+	int                               slow_down_speed;
+	int                               deltad_range;
+	//int				                  speed_down_pwm_count;
+	bool                              camera_position_detect;
+	int				                  position_detect_delay;
+	struct timeval                    motor_start_time;
+	bool                              save_hall_data_to_file;
+	bool		 	                  hall_detect_switch;
+	camera_position	                  position;
+	motor_move_state                  move_state;
+	bool			                  is_skip_pos_check;
+	bool      		                  manual2auto_down_switch;
+	bool                              is_free_fall;
+	int                               free_fall_irq_times;
+	int                               infrared_shut_down_state;
+	unsigned int	                  free_fall_gpio;
+	int		                          free_fall_irq;
+	bool        	                  irq_monitor_started;
+	bool        	                  is_irq_abnormal;
+	bool        	                  is_t0_structure;
+	bool        	                  is_mag_positive;
+	bool			                  led_on;
+	
+
+	struct device*                    dev;
+	struct pinctrl*                   pctrl;
+	struct pinctrl_state*             free_fall_state;
+	struct input_dev*                 input_dev;
+	struct workqueue_struct*          manual2auto_wq;
+	struct workqueue_struct*          motor_run_work_wq;
+	struct delayed_work	              detect_work;
+	struct delayed_work	              free_fall_irq_check_work;
+	struct work_struct                motor_work;
+	struct delayed_work               up_work;
+	struct delayed_work			      down_work;
+	struct hrtimer 					  stop_timer;
+	bool		                      stop_timer_trigger;
+	struct hrtimer 					  speed_up_timer;
+	struct alarm    				  reset_timer;
+	struct notifier_block 			  fb_notify;
+	struct oneplus_hall_operations*   hall_up_ops;
+	struct oneplus_hall_operations*   hall_down_ops;
+	struct oneplus_motor_operations*  motor_ops;
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 9, 0))
+	struct wake_lock        		   suspend_lock;
+#else
+	struct wakeup_source*	           suspend_ws;
+#endif
+	
+};
+
+
+/************************digital_hall and step_motor register ops function************************/
+int oneplus_register_dhall(const char*  name, struct oneplus_hall_operations* ops);
+int oneplus_register_motor(const char*  name, struct oneplus_motor_operations* ops);
+
+int  oneplus_dhall_irq_handler(unsigned int id);
+
+
+#endif
diff --git a/drivers/leds/step_motor/oneplus_motor_notifier.c b/drivers/leds/step_motor/oneplus_motor_notifier.c
new file mode 100644
index 0000000000000000000000000000000000000000..43c9c8eb0df8a86d8a115f85cb8052c5be75ab2d
--- /dev/null
+++ b/drivers/leds/step_motor/oneplus_motor_notifier.c
@@ -0,0 +1,54 @@
+/************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_motor_notifier.c
+**
+** Description:
+**      Definitions for motor  notifier.
+**
+**************************************************************************************/
+#include <asm/uaccess.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/notifier.h>
+#include <linux/init.h>
+#include <linux/types.h>
+#include <linux/module.h>
+
+static BLOCKING_NOTIFIER_HEAD(motor_chain);
+
+/**
+ *	register_motor_notifier - register a client notifier
+ *	@nb: notifier block to callback on events
+ */
+int register_motor_notifier(struct notifier_block *nb)
+{
+        if (!nb)
+            return -EINVAL;
+
+        return blocking_notifier_chain_register(&motor_chain, nb);
+}
+EXPORT_SYMBOL(register_motor_notifier);
+
+/**
+ *	unregister_motor_notifier - unregister a client notifier
+ *	@nb: notifier block to callback on events
+ */
+int unregister_motor_notifier(struct notifier_block *nb)
+{
+        if (!nb)
+            return -EINVAL;
+
+        return blocking_notifier_chain_unregister(&motor_chain, nb);
+}
+EXPORT_SYMBOL(unregister_motor_notifier);
+
+/**
+ * motor_notifier_call_chain - notify clients of sensor_events
+ *
+ */
+int motor_notifier_call_chain(unsigned long val)
+{
+        return blocking_notifier_call_chain(&motor_chain, val, NULL);
+}
+EXPORT_SYMBOL(motor_notifier_call_chain);
diff --git a/drivers/leds/step_motor/oneplus_motor_notifier.h b/drivers/leds/step_motor/oneplus_motor_notifier.h
new file mode 100644
index 0000000000000000000000000000000000000000..c665237b26c7f82771ad5c9f03068b085802788c
--- /dev/null
+++ b/drivers/leds/step_motor/oneplus_motor_notifier.h
@@ -0,0 +1,25 @@
+/****************************************************************************************
+** Copyright (C), 2013-2018, ONEPLUS Mobile Comm Corp., Ltd
+** File: oneplus_motor_notifier.H
+**
+** Description:
+**      Definitions for motor  notifier.
+**
+****************************************************************************************/
+
+#ifndef _ONEPLUS_MOTOR_NOTIFIER
+#define _ONEPLUS_MOTOR_NOTIFIER
+
+#include <linux/notifier.h>
+
+enum motor_event {
+	MOTOR_UP_EVENT = 0,
+	MOTOR_DOWN_EVENT,
+	MOTOR_BLOCK_EVENT,
+};
+
+extern int register_motor_notifier(struct notifier_block *nb);
+extern int unregister_motor_notifier(struct notifier_block *nb);
+extern int motor_notifier_call_chain(unsigned long val);
+
+#endif //_ONEPLUS_MOTOR_NOTIFIER
\ No newline at end of file
diff --git a/drivers/media/platform/msm/camera/cam_core/cam_context.c b/drivers/media/platform/msm/camera/cam_core/cam_context.c
old mode 100644
new mode 100755
index 081a96d311e371bbdc7e5097bbc227a76e815823..4a7f926c2610b78bef3b68af8be13ab154ccc23a
--- a/drivers/media/platform/msm/camera/cam_core/cam_context.c
+++ b/drivers/media/platform/msm/camera/cam_core/cam_context.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -242,6 +242,7 @@ int cam_context_dump_pf_info(struct cam_context *ctx, unsigned long iova,
 		return -EINVAL;
 	}
 
+	mutex_lock(&ctx->ctx_mutex);
 	if (ctx->state_machine[ctx->state].pagefault_ops) {
 		rc = ctx->state_machine[ctx->state].pagefault_ops(ctx, iova,
 			buf_info);
@@ -249,6 +250,7 @@ int cam_context_dump_pf_info(struct cam_context *ctx, unsigned long iova,
 		CAM_WARN(CAM_CORE, "No dump ctx in dev %d, state %d",
 			ctx->dev_hdl, ctx->state);
 	}
+	mutex_unlock(&ctx->ctx_mutex);
 
 	return rc;
 }
diff --git a/drivers/media/platform/msm/camera/cam_core/cam_context_utils.c b/drivers/media/platform/msm/camera/cam_core/cam_context_utils.c
old mode 100644
new mode 100755
index 1c17fc7720ca1e99629f32752cef40f36b88c0d2..5cbee3866e740bd9c79ce5d5b40b3779dcaf5b35
--- a/drivers/media/platform/msm/camera/cam_core/cam_context_utils.c
+++ b/drivers/media/platform/msm/camera/cam_core/cam_context_utils.c
@@ -462,8 +462,7 @@ int32_t cam_context_prepare_dev_to_hw(struct cam_context *ctx,
 						ctx->dev_name, ctx->ctx_id,
 						req->request_id);
 
-				cam_context_putref(ctx);
-				goto put_ref;
+				goto put_ctx_ref;
 			}
 			CAM_DBG(CAM_CTXT, "register in fence cb: %d ret = %d",
 				req->in_map_entries[j].sync_id, rc);
@@ -476,6 +475,10 @@ int32_t cam_context_prepare_dev_to_hw(struct cam_context *ctx,
 
 	return rc;
 
+put_ctx_ref:
+	for (--j; j >= 0; j--)
+		cam_context_putref(ctx);
+
 put_ref:
 	for (--i; i >= 0; i--) {
 		if (cam_sync_put_obj_ref(req->out_map_entries[i].sync_id))
diff --git a/drivers/media/platform/msm/camera/cam_core/cam_node.c b/drivers/media/platform/msm/camera/cam_core/cam_node.c
old mode 100644
new mode 100755
index 67c02c5ed1546abe44c80960eaa183c8a1ef3342..d931981465b64bf6b71e686b21e2e96d36e51bc7
--- a/drivers/media/platform/msm/camera/cam_core/cam_node.c
+++ b/drivers/media/platform/msm/camera/cam_core/cam_node.c
@@ -162,8 +162,8 @@ static int __cam_node_handle_acquire_hw_v1(struct cam_node *node,
 		return rc;
 	}
 
-	CAM_DBG(CAM_CORE, "[%s] Acquire ctx_id %d",
-		node->name, ctx->ctx_id);
+	CAM_INFO(CAM_CORE, "[%s] Done Acquire ctx_id %d session_hdl: 0x%x Device Handle: 0x%x",
+		node->name, ctx->ctx_id, acquire->session_handle, acquire->dev_handle);
 
 	return 0;
 }
@@ -197,6 +197,7 @@ static int __cam_node_handle_start_dev(struct cam_node *node,
 	rc = cam_context_handle_start_dev(ctx, start);
 	if (rc)
 		CAM_ERR(CAM_CORE, "Start failure for node %s", node->name);
+	CAM_INFO(CAM_CORE, "Start node %s ctx: %d session handle: 0x%x Device Handle: 0x%x", node->name, ctx->ctx_id, start->session_handle, start->dev_handle);
 
 	return rc;
 }
@@ -231,6 +232,7 @@ static int __cam_node_handle_stop_dev(struct cam_node *node,
 	if (rc)
 		CAM_ERR(CAM_CORE, "Stop failure for node %s", node->name);
 
+	CAM_INFO(CAM_CORE, "Stopped node %s ctx: %d session handle: 0x%x Device Handle: 0x%x", node->name, ctx->ctx_id, stop->session_handle, stop->dev_handle);
 	return rc;
 }
 
@@ -385,9 +387,9 @@ static int __cam_node_handle_release_hw_v1(struct cam_node *node,
 	if (rc)
 		CAM_ERR(CAM_CORE, "context release failed node %s", node->name);
 
-	CAM_DBG(CAM_CORE, "[%s] Release ctx_id=%d, refcount=%d",
+	CAM_INFO(CAM_CORE, "[%s] Release ctx_id=%d, refcount=%d session_handle: 0x%x Device Handle : 0x%x",
 		node->name, ctx->ctx_id,
-		atomic_read(&(ctx->refcount.refcount.refs)));
+		atomic_read(&(ctx->refcount.refcount.refs)), release->session_handle, release->dev_handle);
 
 	return rc;
 }
@@ -655,7 +657,7 @@ int cam_node_handle_ioctl(struct cam_node *node, struct cam_control *cmd)
 			rc = __cam_node_handle_acquire_hw_v1(node, acquire_ptr);
 			if (rc) {
 				CAM_ERR(CAM_CORE,
-					"acquire device failed(rc = %d)", rc);
+					"acquire hw failed(rc = %d)", rc);
 				goto acquire_kfree;
 			}
 			CAM_INFO(CAM_CORE, "Acquire HW successful");
diff --git a/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cam_cpastop_hw.c b/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cam_cpastop_hw.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cam_cpastop_hw.h b/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cam_cpastop_hw.h
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cpastop_v175_120.h b/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cpastop_v175_120.h
old mode 100644
new mode 100755
index 7a667a772a9eb118275d547119582acaf1a751e6..cb35732cbc6445db660882660b7f5280140265bd
--- a/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cpastop_v175_120.h
+++ b/drivers/media/platform/msm/camera/cam_cpas/cpas_top/cpastop_v175_120.h
@@ -713,7 +713,6 @@ static struct cam_camnoc_specific
 		.ubwc_ctl = {
 			.enable = false,
 		},
-
 	},
 	{
 		/*SidebandManager_main_SidebandManager_FlagOutSet0_Low*/
diff --git a/drivers/media/platform/msm/camera/cam_cpas/include/cam_cpas_api.h b/drivers/media/platform/msm/camera/cam_cpas/include/cam_cpas_api.h
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/cam_fd_hw_mgr.c b/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/cam_fd_hw_mgr.c
old mode 100644
new mode 100755
index a28c99ae5147641bec8dd51c59c59325c7642115..645249cb58a978101b378f72f8d57e6944cd4152
--- a/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/cam_fd_hw_mgr.c
+++ b/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/cam_fd_hw_mgr.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -162,8 +162,10 @@ static int cam_fd_mgr_util_put_frame_req(
 
 	mutex_lock(&g_fd_hw_mgr.frame_req_mutex);
 	req_ptr = *frame_req;
-	if (req_ptr)
+	if (req_ptr) {
+		list_del_init(&req_ptr->list);
 		list_add_tail(&req_ptr->list, src_list);
+	}
 	*frame_req = NULL;
 	mutex_unlock(&g_fd_hw_mgr.frame_req_mutex);
 
@@ -1465,6 +1467,16 @@ static int cam_fd_mgr_hw_flush_ctx(void *hw_mgr_priv,
 	for (i = 0; i < flush_args->num_req_pending; i++) {
 		flush_req = (struct cam_fd_mgr_frame_request *)
 			flush_args->flush_req_pending[i];
+		CAM_DBG(CAM_FD, "flush pending req %llu",
+			flush_req->request_id);
+		cam_fd_mgr_util_put_frame_req(&hw_mgr->frame_free_list,
+			&flush_req);
+	}
+
+	for (i = 0; i < flush_args->num_req_active; i++) {
+		flush_req = (struct cam_fd_mgr_frame_request *)
+			flush_args->flush_req_active[i];
+		CAM_DBG(CAM_FD, "flush active req %llu", flush_req->request_id);
 		cam_fd_mgr_util_put_frame_req(&hw_mgr->frame_free_list,
 			&flush_req);
 	}
diff --git a/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/fd_hw/cam_fd_hw_core.c b/drivers/media/platform/msm/camera/cam_fd/fd_hw_mgr/fd_hw/cam_fd_hw_core.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_icp/hfi.c b/drivers/media/platform/msm/camera/cam_icp/hfi.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_icp/icp_hw/icp_hw_mgr/cam_icp_hw_mgr.c b/drivers/media/platform/msm/camera/cam_icp/icp_hw/icp_hw_mgr/cam_icp_hw_mgr.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_icp/icp_hw/icp_hw_mgr/cam_icp_hw_mgr.h b/drivers/media/platform/msm/camera/cam_icp/icp_hw/icp_hw_mgr/cam_icp_hw_mgr.h
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_icp/icp_hw/include/cam_icp_hw_mgr_intf.h b/drivers/media/platform/msm/camera/cam_icp/icp_hw/include/cam_icp_hw_mgr_intf.h
index 7bb9b9ed18a2dc0a24ff8f25b19a0c6f0c6f00af..5dbac8cb2591927e183e613ea49f17ef64f62e41 100644
--- a/drivers/media/platform/msm/camera/cam_icp/icp_hw/include/cam_icp_hw_mgr_intf.h
+++ b/drivers/media/platform/msm/camera/cam_icp/icp_hw/include/cam_icp_hw_mgr_intf.h
@@ -23,7 +23,7 @@
 
 #define CAM_ICP_A5_BW_BYTES_VOTE 40000000
 
-#define CAM_ICP_CTX_MAX          36
+#define CAM_ICP_CTX_MAX          54
 
 #define CPAS_IPE1_BIT            0x2000
 
diff --git a/drivers/media/platform/msm/camera/cam_isp/cam_isp_context.c b/drivers/media/platform/msm/camera/cam_isp/cam_isp_context.c
old mode 100644
new mode 100755
index 14af855b9327c4879c875ad0e9be31f575f640cf..36d9ed49bc7459567051cec2160db55e6de1d511
--- a/drivers/media/platform/msm/camera/cam_isp/cam_isp_context.c
+++ b/drivers/media/platform/msm/camera/cam_isp/cam_isp_context.c
@@ -807,7 +807,7 @@ static int __cam_isp_ctx_epoch_in_applied(struct cam_isp_context *ctx_isp,
 		notify.error = CRM_KMD_ERR_BUBBLE;
 		ctx->ctx_crm_intf->notify_err(&notify);
 		atomic_set(&ctx_isp->process_bubble, 1);
-		CAM_DBG(CAM_ISP, "Notify CRM about Bubble frame %lld",
+		CAM_INFO(CAM_ISP, "Notify CRM about Bubble frame %lld",
 			ctx_isp->frame_id);
 	} else {
 		req_isp->bubble_report = 0;
@@ -2112,7 +2112,7 @@ static int __cam_isp_ctx_rdi_only_sof_in_bubble_applied(
 		notify.req_id = req->request_id;
 		notify.error = CRM_KMD_ERR_BUBBLE;
 		ctx->ctx_crm_intf->notify_err(&notify);
-		CAM_DBG(CAM_ISP, "Notify CRM about Bubble frame %lld",
+		CAM_INFO(CAM_ISP, "Notify CRM about Bubble frame %lld",
 			ctx_isp->frame_id);
 	} else {
 		req_isp->bubble_report = 0;
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/cam_ife_hw_mgr.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/cam_ife_hw_mgr.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/hw_utils/cam_isp_packet_parser.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/hw_utils/cam_isp_packet_parser.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.c
index 3a3906814f5b9accd7ffa79c8fd7e8d852e892f3..a32930ad7ed329ba344ad8102116adad80e49763 100644
--- a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.c
+++ b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -1059,7 +1059,7 @@ static int cam_ife_csid_enable_hw(struct cam_ife_csid_hw  *csid_hw)
 	CAM_DBG(CAM_ISP, "CSID:%d init CSID HW",
 		csid_hw->hw_intf->hw_idx);
 
-	clk_lvl = cam_ife_csid_get_vote_level(soc_info, csid_hw->clk_rate);
+	clk_lvl = cam_soc_util_get_vote_level(soc_info, csid_hw->clk_rate);
 	CAM_DBG(CAM_ISP, "CSID clock lvl %u", clk_lvl);
 
 	rc = cam_ife_csid_enable_soc_resources(soc_info, clk_lvl);
@@ -1122,6 +1122,7 @@ static int cam_ife_csid_disable_hw(struct cam_ife_csid_hw *csid_hw)
 	int rc = -EINVAL;
 	struct cam_hw_soc_info                   *soc_info;
 	const struct cam_ife_csid_reg_offset     *csid_reg;
+	unsigned long                             flags;
 
 	/* Check for refcount */
 	if (!csid_hw->hw_info->open_count) {
@@ -1156,6 +1157,9 @@ static int cam_ife_csid_disable_hw(struct cam_ife_csid_hw *csid_hw)
 		CAM_ERR(CAM_ISP, "CSID:%d Disable CSID SOC failed",
 			csid_hw->hw_intf->hw_idx);
 
+	spin_lock_irqsave(&csid_hw->lock_state, flags);
+	csid_hw->device_enabled = 0;
+	spin_unlock_irqrestore(&csid_hw->lock_state, flags);
 	csid_hw->hw_info->hw_state = CAM_HW_STATE_POWER_DOWN;
 	csid_hw->error_irq_count = 0;
 
@@ -1809,6 +1813,7 @@ static int cam_ife_csid_disable_pxl_path(
 	enum cam_ife_csid_halt_cmd       stop_cmd)
 {
 	int rc = 0;
+	uint32_t val = 0;
 	const struct cam_ife_csid_reg_offset       *csid_reg;
 	struct cam_hw_soc_info                     *soc_info;
 	struct cam_ife_csid_path_cfg               *path_data;
@@ -1869,6 +1874,17 @@ static int cam_ife_csid_disable_pxl_path(
 	cam_io_w_mb(0, soc_info->reg_map[0].mem_base +
 		pxl_reg->csid_pxl_irq_mask_addr);
 
+	if (path_data->sync_mode == CAM_ISP_HW_SYNC_MASTER ||
+		path_data->sync_mode == CAM_ISP_HW_SYNC_NONE) {
+		/* configure Halt */
+		val = cam_io_r_mb(soc_info->reg_map[0].mem_base +
+			pxl_reg->csid_pxl_ctrl_addr);
+		val &= ~0x3;
+		val |= stop_cmd;
+		cam_io_w_mb(val, soc_info->reg_map[0].mem_base +
+			pxl_reg->csid_pxl_ctrl_addr);
+	}
+
 	return rc;
 }
 
@@ -2120,7 +2136,7 @@ static int cam_ife_csid_disable_rdi_path(
 	enum cam_ife_csid_halt_cmd                stop_cmd)
 {
 	int rc = 0;
-	uint32_t id;
+	uint32_t id, val = 0;
 	const struct cam_ife_csid_reg_offset       *csid_reg;
 	struct cam_hw_soc_info                     *soc_info;
 
@@ -2165,6 +2181,62 @@ static int cam_ife_csid_disable_rdi_path(
 	cam_io_w_mb(0, soc_info->reg_map[0].mem_base +
 		csid_reg->rdi_reg[id]->csid_rdi_irq_mask_addr);
 
+	/* Halt the RDI path */
+	val = cam_io_r_mb(soc_info->reg_map[0].mem_base +
+		csid_reg->rdi_reg[id]->csid_rdi_ctrl_addr);
+	val &= ~0x3;
+	val |= stop_cmd;
+	cam_io_w_mb(val, soc_info->reg_map[0].mem_base +
+		csid_reg->rdi_reg[id]->csid_rdi_ctrl_addr);
+
+	return rc;
+}
+
+static int cam_ife_csid_poll_stop_status(
+	struct cam_ife_csid_hw          *csid_hw,
+	uint32_t                         res_mask)
+{
+	int rc = 0;
+	uint32_t csid_status_addr = 0, val = 0, res_id = 0;
+	const struct cam_ife_csid_reg_offset       *csid_reg;
+	struct cam_hw_soc_info                     *soc_info;
+
+	csid_reg = csid_hw->csid_info->csid_reg;
+	soc_info = &csid_hw->hw_info->soc_info;
+
+	for (; res_id < CAM_IFE_PIX_PATH_RES_MAX; res_id++, res_mask >>= 1) {
+		if ((res_mask & 0x1) == 0)
+			continue;
+		val = 0;
+
+		if (res_id == CAM_IFE_PIX_PATH_RES_IPP) {
+			csid_status_addr =
+				csid_reg->ipp_reg->csid_pxl_status_addr;
+		} else if (res_id == CAM_IFE_PIX_PATH_RES_PPP) {
+			csid_status_addr =
+				csid_reg->ppp_reg->csid_pxl_status_addr;
+		} else {
+			csid_status_addr =
+				csid_reg->rdi_reg[res_id]->csid_rdi_status_addr;
+		}
+
+		CAM_DBG(CAM_ISP, "start polling CSID:%d res_id:%d",
+			csid_hw->hw_intf->hw_idx, res_id);
+
+		rc = readl_poll_timeout(soc_info->reg_map[0].mem_base +
+			csid_status_addr, val, (val & 0x1) == 0x1,
+			CAM_IFE_CSID_TIMEOUT_SLEEP_US,
+			CAM_IFE_CSID_TIMEOUT_ALL_US);
+		if (rc < 0) {
+			CAM_ERR(CAM_ISP, "CSID:%d res:%d halt failed rc %d",
+				csid_hw->hw_intf->hw_idx, res_id, rc);
+			rc = -ETIMEDOUT;
+			break;
+		}
+		CAM_DBG(CAM_ISP, "End polling CSID:%d res_id:%d",
+			csid_hw->hw_intf->hw_idx, res_id);
+	}
+
 	return rc;
 }
 
@@ -2543,6 +2615,7 @@ static int cam_ife_csid_init_hw(void *hw_priv,
 	struct cam_hw_info                     *csid_hw_info;
 	struct cam_isp_resource_node           *res;
 	const struct cam_ife_csid_reg_offset   *csid_reg;
+	unsigned long                           flags;
 
 	if (!hw_priv || !init_args ||
 		(arg_size != sizeof(struct cam_isp_resource_node))) {
@@ -2611,6 +2684,10 @@ static int cam_ife_csid_init_hw(void *hw_priv,
 
 	if (rc)
 		cam_ife_csid_disable_hw(csid_hw);
+
+	spin_lock_irqsave(&csid_hw->lock_state, flags);
+	csid_hw->device_enabled = 1;
+	spin_unlock_irqrestore(&csid_hw->lock_state, flags);
 end:
 	mutex_unlock(&csid_hw->hw_info->hw_mutex);
 	return rc;
@@ -2743,6 +2820,7 @@ static int cam_ife_csid_stop(void *hw_priv,
 	struct cam_isp_resource_node         *res;
 	struct cam_csid_hw_stop_args         *csid_stop;
 	uint32_t  i;
+	uint32_t  res_mask = 0;
 
 	if (!hw_priv || !stop_args ||
 		(arg_size != sizeof(struct cam_csid_hw_stop_args))) {
@@ -2774,6 +2852,7 @@ static int cam_ife_csid_stop(void *hw_priv,
 				rc = cam_ife_csid_tpg_stop(csid_hw, res);
 			break;
 		case CAM_ISP_RESOURCE_PIX_PATH:
+			res_mask |= (1 << res->res_id);
 			if (res->res_id == CAM_IFE_PIX_PATH_RES_IPP ||
 				res->res_id == CAM_IFE_PIX_PATH_RES_PPP)
 				rc = cam_ife_csid_disable_pxl_path(csid_hw,
@@ -2791,6 +2870,9 @@ static int cam_ife_csid_stop(void *hw_priv,
 		}
 	}
 
+	if (res_mask)
+		rc = cam_ife_csid_poll_stop_status(csid_hw, res_mask);
+
 	for (i = 0; i < csid_stop->num_res; i++) {
 		res = csid_stop->node_res[i];
 		res->res_state = CAM_ISP_RESOURCE_STATE_INIT_HW;
@@ -2958,6 +3040,7 @@ irqreturn_t cam_ife_csid_irq(int irq_num, void *data)
 	uint32_t val, irq_status_ppp = 0;
 	bool fatal_err_detected = false;
 	uint32_t sof_irq_debug_en = 0;
+	unsigned long flags;
 
 	csid_hw = (struct cam_ife_csid_hw *)data;
 
@@ -3023,67 +3106,71 @@ irqreturn_t cam_ife_csid_irq(int irq_num, void *data)
 		complete(&csid_hw->csid_csi2_complete);
 	}
 
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE0_FIFO_OVERFLOW) {
+        spin_lock_irqsave(&csid_hw->lock_state, flags);
+	if (csid_hw->device_enabled == 1) {
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE0_FIFO_OVERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d lane 0 over flow",
 			 csid_hw->hw_intf->hw_idx);
 		fatal_err_detected = true;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE1_FIFO_OVERFLOW) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE1_FIFO_OVERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d lane 1 over flow",
 			 csid_hw->hw_intf->hw_idx);
 		fatal_err_detected = true;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE2_FIFO_OVERFLOW) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE2_FIFO_OVERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d lane 2 over flow",
 			 csid_hw->hw_intf->hw_idx);
 		fatal_err_detected = true;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE3_FIFO_OVERFLOW) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_LANE3_FIFO_OVERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d lane 3 over flow",
 			 csid_hw->hw_intf->hw_idx);
 		fatal_err_detected = true;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_TG_FIFO_OVERFLOW) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_TG_FIFO_OVERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d TG OVER FLOW",
 			 csid_hw->hw_intf->hw_idx);
 		fatal_err_detected = true;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_EOT_RECEPTION) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_EOT_RECEPTION) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d CPHY_EOT_RECEPTION",
 			 csid_hw->hw_intf->hw_idx);
 		csid_hw->error_irq_count++;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_SOT_RECEPTION) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_SOT_RECEPTION) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d CPHY_SOT_RECEPTION",
 			 csid_hw->hw_intf->hw_idx);
 		csid_hw->error_irq_count++;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_PH_CRC) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_CPHY_PH_CRC) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d CPHY_PH_CRC",
 			 csid_hw->hw_intf->hw_idx);
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_CRC) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_CRC) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d ERROR_CRC",
 			 csid_hw->hw_intf->hw_idx);
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_ECC) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_ECC) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d ERROR_ECC",
 			 csid_hw->hw_intf->hw_idx);
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_MMAPPED_VC_DT) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_MMAPPED_VC_DT) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d MMAPPED_VC_DT",
 			 csid_hw->hw_intf->hw_idx);
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_STREAM_UNDERFLOW) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_STREAM_UNDERFLOW) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d ERROR_STREAM_UNDERFLOW",
 			 csid_hw->hw_intf->hw_idx);
 		csid_hw->error_irq_count++;
-	}
-	if (irq_status_rx & CSID_CSI2_RX_ERROR_UNBOUNDED_FRAME) {
+	    }
+	    if (irq_status_rx & CSID_CSI2_RX_ERROR_UNBOUNDED_FRAME) {
 		CAM_ERR_RATE_LIMIT(CAM_ISP, "CSID:%d UNBOUNDED_FRAME",
 			 csid_hw->hw_intf->hw_idx);
 		csid_hw->error_irq_count++;
+	    }
 	}
+	spin_unlock_irqrestore(&csid_hw->lock_state, flags);
 
 	if (csid_hw->error_irq_count >
 		CAM_IFE_CSID_MAX_IRQ_ERROR_COUNT) {
@@ -3334,9 +3421,11 @@ int cam_ife_csid_hw_probe_init(struct cam_hw_intf  *csid_hw_intf,
 		ife_csid_hw->hw_intf->hw_type, csid_idx);
 
 
+	ife_csid_hw->device_enabled = 0;
 	ife_csid_hw->hw_info->hw_state = CAM_HW_STATE_POWER_DOWN;
 	mutex_init(&ife_csid_hw->hw_info->hw_mutex);
 	spin_lock_init(&ife_csid_hw->hw_info->hw_lock);
+	spin_lock_init(&ife_csid_hw->lock_state);
 	init_completion(&ife_csid_hw->hw_info->hw_complete);
 
 	init_completion(&ife_csid_hw->csid_top_complete);
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.h b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.h
index 9a4a95dda5ce090b1a4f95610658b3922419ad65..5d8664180cb390a17d34d74766deec0064155008 100644
--- a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.h
+++ b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_core.h
@@ -494,6 +494,8 @@ struct cam_ife_csid_hw {
 	bool                             sof_irq_triggered;
 	uint32_t                         irq_debug_cnt;
 	uint32_t                         error_irq_count;
+	uint32_t                         device_enabled;
+	spinlock_t                       lock_state;
 };
 
 int cam_ife_csid_hw_probe_init(struct cam_hw_intf  *csid_hw_intf,
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_soc.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_soc.c
index 890dad3b66b25349276b05ccb9bec7df11f28da2..5e02609088c43529566b6b6c8357858abdabee59 100644
--- a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_soc.c
+++ b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/ife_csid_hw/cam_ife_csid_soc.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -117,7 +117,7 @@ int cam_ife_csid_deinit_soc_resources(
 }
 
 int cam_ife_csid_enable_soc_resources(
-	struct cam_hw_soc_info *soc_info, uint32_t clk_lvl)
+	struct cam_hw_soc_info *soc_info, enum cam_vote_level clk_level)
 {
 	int rc = 0;
 	struct cam_csid_soc_private       *soc_private;
@@ -142,7 +142,7 @@ int cam_ife_csid_enable_soc_resources(
 	}
 
 	rc = cam_soc_util_enable_platform_resource(soc_info, true,
-		clk_lvl, true);
+		clk_level, true);
 	if (rc) {
 		CAM_ERR(CAM_ISP, "enable platform failed");
 		goto stop_cpas;
@@ -235,24 +235,3 @@ int cam_ife_csid_disable_ife_force_clock_on(struct cam_hw_soc_info *soc_info,
 
 	return rc;
 }
-
-uint32_t cam_ife_csid_get_vote_level(struct cam_hw_soc_info *soc_info,
-	uint64_t clock_rate)
-{
-	int i = 0;
-
-	if (!clock_rate)
-		return CAM_SVS_VOTE;
-
-	for (i = 0; i < CAM_MAX_VOTE; i++) {
-		if (soc_info->clk_rate[i][soc_info->num_clk - 1] >=
-			clock_rate) {
-			CAM_DBG(CAM_ISP,
-				"Clock rate %lld, selected clock level %d",
-				clock_rate, i);
-			return i;
-		}
-	}
-
-	return CAM_TURBO_VOTE;
-}
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/cam_vfe_core.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/cam_vfe_core.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/cam_vfe_soc.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/cam_vfe_soc.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_bus/cam_vfe_bus_ver2.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_bus/cam_vfe_bus_ver2.c
old mode 100644
new mode 100755
index 7ee9f000a8c07ea49b4bd9b196af3c6e6695d712..fa1d3ab2a518876c6f9d5e4ee45619d24c64b91a
--- a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_bus/cam_vfe_bus_ver2.c
+++ b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_bus/cam_vfe_bus_ver2.c
@@ -950,6 +950,11 @@ static int cam_vfe_bus_acquire_wm(
 			rsrc_data->stride = rsrc_data->width;
 			break;
 		case CAM_FORMAT_PLAIN16_10:
+			rsrc_data->stride = ((rsrc_data->width +15)/16)*16*2;
+			rsrc_data->width = rsrc_data->width*2;
+			rsrc_data->en_cfg = 0x1;
+			rsrc_data->pack_fmt = 0x10;
+			break;
 		case CAM_FORMAT_PLAIN16_12:
 		case CAM_FORMAT_PLAIN16_14:
 		case CAM_FORMAT_PLAIN16_16:
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_top/cam_vfe_camif_ver2.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_top/cam_vfe_camif_ver2.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_top/cam_vfe_top_ver2.c b/drivers/media/platform/msm/camera/cam_isp/isp_hw_mgr/isp_hw/vfe_hw/vfe_top/cam_vfe_top_ver2.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_jpeg/jpeg_hw/cam_jpeg_hw_mgr.c b/drivers/media/platform/msm/camera/cam_jpeg/jpeg_hw/cam_jpeg_hw_mgr.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_lrme/lrme_hw_mgr/lrme_hw/cam_lrme_hw_core.c b/drivers/media/platform/msm/camera/cam_lrme/lrme_hw_mgr/lrme_hw/cam_lrme_hw_core.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_req_mgr/cam_mem_mgr.c b/drivers/media/platform/msm/camera/cam_req_mgr/cam_mem_mgr.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_req_mgr/cam_mem_mgr_api.h b/drivers/media/platform/msm/camera/cam_req_mgr/cam_mem_mgr_api.h
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.c b/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.c
index ccf593f772fc30aa873de19387069f4368a02dec..a58dbe37f9e20f4a9c1835dfaf846875478965cc 100644
--- a/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.c
+++ b/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.c
@@ -46,6 +46,7 @@ void cam_req_mgr_core_link_reset(struct cam_req_mgr_core_link *link)
 	link->sync_link_sof_skip = false;
 	link->open_req_cnt = 0;
 	link->last_flush_id = 0;
+	link->initial_sync_req = -1;
 }
 
 void cam_req_mgr_handle_core_shutdown(void)
@@ -653,8 +654,9 @@ static int __cam_req_mgr_check_sync_for_mslave(
 	req_id = slot->req_id;
 
 	CAM_DBG(CAM_CRM,
-		"link_hdl %x req %lld frame_skip_flag %d ",
-		link->link_hdl, req_id, link->sync_link_sof_skip);
+		"link_hdl %x req %lld frame_skip_flag %d open_req_cnt:%d initial_sync_req [%lld,%lld] is_master:%d",
+		link->link_hdl, req_id, link->sync_link_sof_skip, link->open_req_cnt,
+		link->initial_sync_req, sync_link->initial_sync_req, link->is_master);
 
 	if (sync_link->sync_link_sof_skip) {
 		CAM_DBG(CAM_CRM,
@@ -696,7 +698,8 @@ static int __cam_req_mgr_check_sync_for_mslave(
 
 		rd_idx = sync_link->req.in_q->rd_idx;
 		sync_req_id = link->req.in_q->slot[prev_idx].req_id;
-		if (sync_req_id != -1) {
+		if ((sync_link->initial_sync_req != -1) &&
+			(sync_link->initial_sync_req <= sync_req_id)) {
 			sync_slot_idx = __cam_req_mgr_find_slot_for_req(
 				sync_link->req.in_q, sync_req_id);
 
@@ -734,23 +737,6 @@ static int __cam_req_mgr_check_sync_for_mslave(
 		if (link->initial_skip)
 			link->initial_skip = false;
 
-		sync_slot_idx = __cam_req_mgr_find_slot_for_req(
-			sync_link->req.in_q, req_id);
-		if (sync_slot_idx == -1) {
-			CAM_DBG(CAM_CRM,
-				"Req: %lld not found on link: %x [master]",
-				req_id, sync_link->link_hdl);
-			return -EINVAL;
-		}
-
-		if (sync_link->req.in_q->slot[sync_slot_idx].status !=
-			CRM_SLOT_STATUS_REQ_APPLIED) {
-			CAM_DBG(CAM_CRM,
-				"Req: %lld [master] not applied yet: %x",
-				req_id, sync_link->link_hdl);
-			return -EAGAIN;
-		}
-
 		rc = __cam_req_mgr_inject_delay(link->req.l_tbl, slot->idx);
 		if (rc) {
 			CAM_DBG(CAM_CRM,
@@ -767,34 +753,38 @@ static int __cam_req_mgr_check_sync_for_mslave(
 			link->req.in_q->num_slots);
 
 		sync_req_id = link->req.in_q->slot[next_idx].req_id;
-		sync_slot_idx = __cam_req_mgr_find_slot_for_req(
-					sync_link->req.in_q, sync_req_id);
-		if (sync_slot_idx == -1) {
-			CAM_DBG(CAM_CRM,
-				"Next Req: %lld [slave] not found on link: %x [master]",
-				sync_req_id, sync_link->link_hdl);
-			return -EINVAL;
-		}
 
-		if ((sync_link->req.in_q->slot[sync_slot_idx].status !=
-			CRM_SLOT_STATUS_REQ_APPLIED) &&
-			((sync_slot_idx - rd_idx) >= 1) &&
-			(sync_link->req.in_q->slot[rd_idx].status !=
-			CRM_SLOT_STATUS_REQ_APPLIED)) {
-			CAM_DBG(CAM_CRM,
-				"Next Req: %lld [slave] not next on link: %x [master]",
-				sync_req_id, sync_link->link_hdl);
-			return -EINVAL;
-		}
+		if ((sync_link->initial_sync_req != -1) &&
+			(sync_link->initial_sync_req <= sync_req_id)) {
+			sync_slot_idx = __cam_req_mgr_find_slot_for_req(
+						sync_link->req.in_q, sync_req_id);
+			if (sync_slot_idx == -1) {
+				CAM_DBG(CAM_CRM,
+					"Next Req: %lld [slave] not found on link: %x [master]",
+					sync_req_id, sync_link->link_hdl);
+				return -EINVAL;
+			}
 
-		rc = __cam_req_mgr_check_link_is_ready(sync_link,
-			sync_slot_idx, true);
-		if (rc && (sync_link->req.in_q->slot[sync_slot_idx].status !=
-			CRM_SLOT_STATUS_REQ_APPLIED)) {
-			CAM_DBG(CAM_CRM,
-				"Next Req: %lld [slave] not ready on [master] link: %x, rc=%d",
-				sync_req_id, sync_link->link_hdl, rc);
-			return rc;
+			if ((sync_link->req.in_q->slot[sync_slot_idx].status !=
+				CRM_SLOT_STATUS_REQ_APPLIED) &&
+				((sync_slot_idx - rd_idx) >= 1) &&
+				(sync_link->req.in_q->slot[rd_idx].status !=
+				CRM_SLOT_STATUS_REQ_APPLIED)) {
+				CAM_DBG(CAM_CRM,
+					"Next Req: %lld [slave] not next on link: %x [master]",
+					sync_req_id, sync_link->link_hdl);
+				return -EINVAL;
+			}
+
+			rc = __cam_req_mgr_check_link_is_ready(sync_link,
+				sync_slot_idx, true);
+			if (rc && (sync_link->req.in_q->slot[sync_slot_idx].status !=
+				CRM_SLOT_STATUS_REQ_APPLIED)) {
+				CAM_DBG(CAM_CRM,
+					"Next Req: %lld [slave] not ready on [master] link: %x, rc=%d",
+					sync_req_id, sync_link->link_hdl, rc);
+				return rc;
+			}
 		}
 	}
 
@@ -979,18 +969,21 @@ static int __cam_req_mgr_process_req(struct cam_req_mgr_core_link *link,
 
 		if ((slot->sync_mode == CAM_REQ_MGR_SYNC_MODE_SYNC) &&
 			(link->sync_link)) {
-			if (link->is_master || link->sync_link->is_master)
+			if (link->is_master || link->sync_link->is_master) {
 				rc =  __cam_req_mgr_check_sync_for_mslave(
 					link, slot);
-			else
+			} else {
 				rc = __cam_req_mgr_check_sync_req_is_ready(
 					link, slot);
+				link->initial_sync_req = -1;
+			}
 		} else {
 			rc = __cam_req_mgr_inject_delay(link->req.l_tbl,
 				slot->idx);
 			if (!rc)
 				rc = __cam_req_mgr_check_link_is_ready(link,
 					slot->idx, false);
+			link->initial_sync_req = -1;
 		}
 
 		if (rc < 0) {
@@ -1710,9 +1703,10 @@ int cam_req_mgr_process_sched_req(void *priv, void *data)
 	sched_req  = (struct cam_req_mgr_sched_request *)&task_data->u;
 	in_q = link->req.in_q;
 
-	CAM_DBG(CAM_CRM, "link_hdl %x req_id %lld at slot %d sync_mode %d",
+	CAM_DBG(CAM_CRM, "link_hdl %x req_id %lld at slot %d sync_mode %d is_master:%d",
 		sched_req->link_hdl, sched_req->req_id,
-		in_q->wr_idx, sched_req->sync_mode);
+		in_q->wr_idx, sched_req->sync_mode,
+		link->is_master);
 
 	mutex_lock(&link->req.lock);
 	slot = &in_q->slot[in_q->wr_idx];
@@ -1728,6 +1722,11 @@ int cam_req_mgr_process_sched_req(void *priv, void *data)
 	slot->recover = sched_req->bubble_enable;
 	link->open_req_cnt++;
 	__cam_req_mgr_inc_idx(&in_q->wr_idx, 1, in_q->num_slots);
+	if (slot->sync_mode == CAM_REQ_MGR_SYNC_MODE_SYNC) {
+		if (link->initial_sync_req == -1)
+			link->initial_sync_req = slot->req_id;
+	} else
+		link->initial_sync_req = -1;
 	mutex_unlock(&link->req.lock);
 
 end:
@@ -1829,6 +1828,7 @@ int cam_req_mgr_process_add_req(void *priv, void *data)
 			link->link_hdl, idx, add_req->req_id, tbl->pd);
 		slot->state = CRM_REQ_STATE_READY;
 	}
+
 	mutex_unlock(&link->req.lock);
 
 end:
diff --git a/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.h b/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.h
index 4abf147764b3b9028f06e6eb0e1825ce13516b4c..291a31a2ad41855cf1f43c46699aa530b2e275fc 100644
--- a/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.h
+++ b/drivers/media/platform/msm/camera/cam_req_mgr/cam_req_mgr_core.h
@@ -314,6 +314,8 @@ struct cam_req_mgr_connected_device {
  *                         is assigned as master
  * @initial_skip         : Flag to determine if slave has started streaming in
  *                         master-slave sync
+ * @initial_sync_req     : The initial req which is required to sync
+							with the other link
  *
  */
 struct cam_req_mgr_core_link {
@@ -339,6 +341,7 @@ struct cam_req_mgr_core_link {
 	atomic_t                             is_used;
 	bool                                 is_master;
 	bool                                 initial_skip;
+	int64_t                              initial_sync_req;
 };
 
 /**
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.c
index b0e810711c5d1502fa9b4f9370f2ff38cc4d7a3b..cc3ae7e0c67bd0465cbd0514383963a170bffc98 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_core.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -13,7 +13,8 @@
 #include <linux/module.h>
 #include "cam_cci_core.h"
 #include "cam_cci_dev.h"
-
+#include "cam_cci_ctrl_interface.h"
+#define  DUMP_CCI_REGISTERS
 static int32_t cam_cci_convert_type_to_num_bytes(
 	enum camera_sensor_i2c_type type)
 {
@@ -193,102 +194,153 @@ static void cam_cci_dump_registers(struct cci_device *cci_dev,
 	void __iomem *base = cci_dev->soc_info.reg_map[0].mem_base;
 
 	/* CCI Top Registers */
-	CAM_INFO(CAM_CCI, "****CCI TOP Registers ****");
+	CAM_ERR(CAM_CCI, "****CCI TOP Registers ****");
 	for (i = 0; i < DEBUG_TOP_REG_COUNT; i++) {
 		reg_offset = DEBUG_TOP_REG_START + i * 4;
 		read_val = cam_io_r_mb(base + reg_offset);
-		CAM_INFO(CAM_CCI, "offset = 0x%X value = 0x%X",
+		CAM_ERR(CAM_CCI, "offset = 0x%X value = 0x%X",
 			reg_offset, read_val);
 	}
 
 	/* CCI Master registers */
-	CAM_INFO(CAM_CCI, "****CCI MASTER %d Registers ****",
+	CAM_ERR(CAM_CCI, "****CCI MASTER %d Registers ****",
 		master);
 	for (i = 0; i < DEBUG_MASTER_REG_COUNT; i++) {
 		reg_offset = DEBUG_MASTER_REG_START + master*0x100 + i * 4;
 		read_val = cam_io_r_mb(base + reg_offset);
-		CAM_INFO(CAM_CCI, "offset = 0x%X value = 0x%X",
+		CAM_ERR(CAM_CCI, "offset = 0x%X value = 0x%X",
 			reg_offset, read_val);
 	}
 
 	/* CCI Master Queue registers */
-	CAM_INFO(CAM_CCI, " **** CCI MASTER%d QUEUE%d Registers ****",
+	CAM_ERR(CAM_CCI, " **** CCI MASTER%d QUEUE%d Registers ****",
 		master, queue);
 	for (i = 0; i < DEBUG_MASTER_QUEUE_REG_COUNT; i++) {
 		reg_offset = DEBUG_MASTER_QUEUE_REG_START +  master*0x200 +
 			queue*0x100 + i * 4;
 		read_val = cam_io_r_mb(base + reg_offset);
-		CAM_INFO(CAM_CCI, "offset = 0x%X value = 0x%X",
+		CAM_ERR(CAM_CCI, "offset = 0x%X value = 0x%X",
 			reg_offset, read_val);
 	}
 
 	/* CCI Interrupt registers */
-	CAM_INFO(CAM_CCI, " ****CCI Interrupt Registers ****");
+	CAM_ERR(CAM_CCI, " ****CCI Interrupt Registers ****");
 	for (i = 0; i < DEBUG_INTR_REG_COUNT; i++) {
 		reg_offset = DEBUG_INTR_REG_START + i * 4;
 		read_val = cam_io_r_mb(base + reg_offset);
-		CAM_INFO(CAM_CCI, "offset = 0x%X value = 0x%X",
+		CAM_ERR(CAM_CCI, "offset = 0x%X value = 0x%X",
 			reg_offset, read_val);
 	}
 }
 #endif
 
+static void cam_cci_load_report_cmd(struct cci_device *cci_dev,
+	enum cci_i2c_master_t master,
+	enum cci_i2c_queue_t queue)
+{
+	struct cam_hw_soc_info *soc_info =
+		&cci_dev->soc_info;
+	void __iomem *base = soc_info->reg_map[0].mem_base;
+
+	uint32_t reg_offset = master * 0x200 + queue * 0x100;
+	uint32_t read_val = cam_io_r_mb(base +
+		CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR + reg_offset);
+	uint32_t report_val = CCI_I2C_REPORT_CMD | (1 << 8);
+
+	CAM_DBG(CAM_CCI, "CCI_I2C_REPORT_CMD curr_w_cnt: %d", read_val);
+	cam_io_w_mb(report_val,
+		base + CCI_I2C_M0_Q0_LOAD_DATA_ADDR +
+		reg_offset);
+	read_val++;
+
+	CAM_DBG(CAM_CCI, "CCI_I2C_M0_Q0_EXEC_WORD_CNT_ADDR %d", read_val);
+	cam_io_w_mb(read_val, base +
+		CCI_I2C_M0_Q0_EXEC_WORD_CNT_ADDR + reg_offset);
+}
+
 static uint32_t cam_cci_wait(struct cci_device *cci_dev,
 	enum cci_i2c_master_t master,
 	enum cci_i2c_queue_t queue)
 {
 	int32_t rc = 0;
+	struct cam_hw_soc_info *soc_info = NULL;
+	void __iomem *base = NULL;
+	uint32_t reg_val = 1 << ((master * 2) + queue);
+	uint32_t reg_offset = master * 0x200 + queue * 0x100;
+	uint32_t read_val = 0;
 
 	if (!cci_dev) {
 		CAM_ERR(CAM_CCI, "failed");
 		return -EINVAL;
 	}
 
+	soc_info = &cci_dev->soc_info;
+	base = soc_info->reg_map[0].mem_base;
+
 	rc = wait_for_completion_timeout(
 		&cci_dev->cci_master_info[master].report_q[queue], CCI_TIMEOUT);
-	CAM_DBG(CAM_CCI, "wait DONE_for_completion_timeout");
+	CAM_DBG(CAM_CCI,
+		"wait DONE_for_completion_timeout for master %d queue %d rc=%d",
+		master, queue, rc);
 
 	if (rc <= 0) {
 #ifdef DUMP_CCI_REGISTERS
 		cam_cci_dump_registers(cci_dev, master, queue);
 #endif
-		CAM_ERR(CAM_CCI, "wait for queue: %d", queue);
-		if (rc == 0)
-			rc = -ETIMEDOUT;
-		cam_cci_flush_queue(cci_dev, master);
-		return rc;
-	}
-	rc = cci_dev->cci_master_info[master].status;
-	if (rc < 0) {
-		CAM_ERR(CAM_CCI, "failed rc %d", rc);
-		return rc;
-	}
+		CAM_ERR(CAM_CCI, "wait for master %d queue: %d", master, queue);
+		if (rc == 0) {
+			read_val = cam_io_r_mb(base +
+				CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR +
+				reg_offset);
+
+			if (read_val == 0) {
+				CAM_DBG(CAM_CCI,
+					"Ignore this timeout for master %d queue %d",
+					master, queue);
+				goto out;
+			}
+		}
 
-	return 0;
-}
+		cam_cci_load_report_cmd(cci_dev, master, queue);
+		cam_io_w_mb(reg_val, base + CCI_QUEUE_START_ADDR);
 
-static void cam_cci_load_report_cmd(struct cci_device *cci_dev,
-	enum cci_i2c_master_t master,
-	enum cci_i2c_queue_t queue)
-{
-	struct cam_hw_soc_info *soc_info =
-		&cci_dev->soc_info;
-	void __iomem *base = soc_info->reg_map[0].mem_base;
+		rc = wait_for_completion_timeout(
+			&cci_dev->cci_master_info[master].report_q[queue],
+			CCI_TIMEOUT / 2);
+		if (rc <= 0) {
+			if (rc == 0) {
+				read_val = cam_io_r_mb(base +
+					CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR +
+					reg_offset);
+				if (read_val > 0) {
+					rc = -ETIMEDOUT;
+					CAM_ERR(CAM_CCI,
+					"wait for master %d queue %d timeout again");
+				} else {
+					CAM_DBG(CAM_CCI,
+						"Ignore this timeout for master %d queue %d after re-execute again!!",
+						master, queue);
+					goto out;
+				}
+			}
 
-	uint32_t reg_offset = master * 0x200 + queue * 0x100;
-	uint32_t read_val = cam_io_r_mb(base +
-		CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR + reg_offset);
-	uint32_t report_val = CCI_I2C_REPORT_CMD | (1 << 8);
+			cam_cci_flush_queue(cci_dev, master);
+			goto out;
+		} else {
+			CAM_DBG(CAM_CCI,
+				"wait for master %d queue %d retry success",
+				master, queue);
+		}
+	}
 
-	CAM_DBG(CAM_CCI, "CCI_I2C_REPORT_CMD curr_w_cnt: %d", read_val);
-	cam_io_w_mb(report_val,
-		base + CCI_I2C_M0_Q0_LOAD_DATA_ADDR +
-		reg_offset);
-	read_val++;
+out:
+	if (rc >= 0)
+		rc = cci_dev->cci_master_info[master].status;
 
-	CAM_DBG(CAM_CCI, "CCI_I2C_M0_Q0_EXEC_WORD_CNT_ADDR %d", read_val);
-	cam_io_w_mb(read_val, base +
-		CCI_I2C_M0_Q0_EXEC_WORD_CNT_ADDR + reg_offset);
+	if (rc < 0)
+		CAM_ERR(CAM_CCI, "failed rc %d", rc);
+
+	return rc;
 }
 
 static int32_t cam_cci_wait_report_cmd(struct cci_device *cci_dev,
@@ -892,20 +944,39 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 
 	soc_info = &cci_dev->soc_info;
 	base = soc_info->reg_map[0].mem_base;
-	mutex_lock(&cci_dev->cci_master_info[master].mutex_q[queue]);
 
-	/*
-	 * Todo: If there is a change in frequency of operation
-	 * Wait for previos transaction to complete
-	 */
+	mutex_lock(&cci_dev->cci_master_info[master].mutex);
+	if (cci_dev->cci_master_info[master].is_first_req == true) {
+		cci_dev->cci_master_info[master].is_first_req = false;
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else if (c_ctrl->cci_info->i2c_freq_mode
+		!= cci_dev->i2c_freq_mode[master]) {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+		cci_dev->cci_master_info[master].freq_ref_cnt++;
+		spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
+	}
 
 	/* Set the I2C Frequency */
 	rc = cam_cci_set_clk_param(cci_dev, c_ctrl);
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "cam_cci_set_clk_param failed rc = %d", rc);
-		goto rel_mutex;
+		mutex_unlock(&cci_dev->cci_master_info[master].mutex);
+		goto rel_master;
 	}
+	mutex_unlock(&cci_dev->cci_master_info[master].mutex);
 
+	mutex_lock(&cci_dev->cci_master_info[master].mutex_q[queue]);
 	/*
 	 * Call validate queue to make sure queue is empty before starting.
 	 * If this call fails, don't proceed with i2c_read call. This is to
@@ -916,24 +987,24 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 		master, queue);
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "Initial validataion failed rc %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (c_ctrl->cci_info->retries > CCI_I2C_READ_MAX_RETRIES) {
 		CAM_ERR(CAM_CCI, "More than max retries");
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (read_cfg->data == NULL) {
 		CAM_ERR(CAM_CCI, "Data ptr is NULL");
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (read_cfg->addr_type >= CAMERA_SENSOR_I2C_TYPE_MAX) {
 		CAM_ERR(CAM_CCI, "failed : Invalid addr type: %u",
 			read_cfg->addr_type);
 		rc = -EINVAL;
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	CAM_DBG(CAM_CCI, "set param sid 0x%x retries %d id_map %d",
@@ -945,14 +1016,14 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_LOCK_CMD;
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_WRITE_DISABLE_P_CMD | (read_cfg->addr_type << 4);
@@ -964,21 +1035,21 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_READ_CMD | (read_cfg->num_byte << 4);
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_UNLOCK_CMD;
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = cam_io_r_mb(base + CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR
@@ -1009,7 +1080,7 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 			cam_cci_dump_registers(cci_dev, master, queue);
 #endif
 			cam_cci_flush_queue(cci_dev, master);
-			goto rel_mutex;
+			goto rel_mutex_q;
 		}
 
 		read_words = cam_io_r_mb(base +
@@ -1090,7 +1161,7 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 						master, queue);
 				#endif
 					cam_cci_flush_queue(cci_dev, master);
-				goto rel_mutex;
+				goto rel_mutex_q;
 			}
 			break;
 		}
@@ -1099,8 +1170,15 @@ static int32_t cam_cci_burst_read(struct v4l2_subdev *sd,
 	CAM_DBG(CAM_CCI, "Burst read successful words_read %d",
 		total_read_words);
 
-rel_mutex:
+rel_mutex_q:
 	mutex_unlock(&cci_dev->cci_master_info[master].mutex_q[queue]);
+rel_master:
+	spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+	if (cci_dev->cci_master_info[master].freq_ref_cnt == 0)
+		up(&cci_dev->cci_master_info[master].master_sem);
+	else
+		cci_dev->cci_master_info[master].freq_ref_cnt--;
+	spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
 	return rc;
 }
 
@@ -1132,20 +1210,38 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 	soc_info = &cci_dev->soc_info;
 	base = soc_info->reg_map[0].mem_base;
 
-	mutex_lock(&cci_dev->cci_master_info[master].mutex_q[queue]);
-
-	/*
-	 * Todo: If there is a change in frequency of operation
-	 * Wait for previos transaction to complete
-	 */
+	mutex_lock(&cci_dev->cci_master_info[master].mutex);
+	if (cci_dev->cci_master_info[master].is_first_req == true) {
+		cci_dev->cci_master_info[master].is_first_req = false;
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else if (c_ctrl->cci_info->i2c_freq_mode
+		!= cci_dev->i2c_freq_mode[master]) {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+		cci_dev->cci_master_info[master].freq_ref_cnt++;
+		spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
+	}
 
 	/* Set the I2C Frequency */
 	rc = cam_cci_set_clk_param(cci_dev, c_ctrl);
 	if (rc < 0) {
+		mutex_unlock(&cci_dev->cci_master_info[master].mutex);
 		CAM_ERR(CAM_CCI, "cam_cci_set_clk_param failed rc = %d", rc);
-		goto rel_mutex;
+		goto rel_master;
 	}
+	mutex_unlock(&cci_dev->cci_master_info[master].mutex);
 
+	mutex_lock(&cci_dev->cci_master_info[master].mutex_q[queue]);
 	/*
 	 * Call validate queue to make sure queue is empty before starting.
 	 * If this call fails, don't proceed with i2c_read call. This is to
@@ -1156,17 +1252,17 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 		master, queue);
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "Initial validataion failed rc %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (c_ctrl->cci_info->retries > CCI_I2C_READ_MAX_RETRIES) {
 		CAM_ERR(CAM_CCI, "More than max retries");
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (read_cfg->data == NULL) {
 		CAM_ERR(CAM_CCI, "Data ptr is NULL");
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	CAM_DBG(CAM_CCI, "master %d, queue %d", master, queue);
@@ -1179,21 +1275,21 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_LOCK_CMD;
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	if (read_cfg->addr_type >= CAMERA_SENSOR_I2C_TYPE_MAX) {
 		CAM_ERR(CAM_CCI, "failed : Invalid addr type: %u",
 			read_cfg->addr_type);
 		rc = -EINVAL;
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_WRITE_DISABLE_P_CMD | (read_cfg->addr_type << 4);
@@ -1205,21 +1301,21 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_READ_CMD | (read_cfg->num_byte << 4);
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = CCI_I2C_UNLOCK_CMD;
 	rc = cam_cci_write_i2c_queue(cci_dev, val, master, queue);
 	if (rc < 0) {
 		CAM_DBG(CAM_CCI, "failed rc: %d", rc);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 
 	val = cam_io_r_mb(base + CCI_I2C_M0_Q0_CUR_WORD_CNT_ADDR
@@ -1247,7 +1343,7 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 			"wait_for_completion_timeout rc = %d FIFO buf_lvl: 0x%x",
 			rc, val);
 		cam_cci_flush_queue(cci_dev, master);
-		goto rel_mutex;
+		goto rel_mutex_q;
 	} else {
 		rc = 0;
 	}
@@ -1260,7 +1356,7 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 			read_words, exp_words);
 		memset(read_cfg->data, 0, read_cfg->num_byte);
 		rc = -EINVAL;
-		goto rel_mutex;
+		goto rel_mutex_q;
 	}
 	index = 0;
 	CAM_DBG(CAM_CCI, "index %d num_type %d", index, read_cfg->num_byte);
@@ -1284,8 +1380,15 @@ static int32_t cam_cci_read(struct v4l2_subdev *sd,
 		}
 		read_words--;
 	}
-rel_mutex:
+rel_mutex_q:
 	mutex_unlock(&cci_dev->cci_master_info[master].mutex_q[queue]);
+rel_master:
+	spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+	if (cci_dev->cci_master_info[master].freq_ref_cnt == 0)
+		up(&cci_dev->cci_master_info[master].master_sem);
+	else
+		cci_dev->cci_master_info[master].freq_ref_cnt--;
+	spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
 	return rc;
 }
 
@@ -1309,12 +1412,36 @@ static int32_t cam_cci_i2c_write(struct v4l2_subdev *sd,
 		c_ctrl->cci_info->sid, c_ctrl->cci_info->retries,
 		c_ctrl->cci_info->id_map);
 
+	mutex_lock(&cci_dev->cci_master_info[master].mutex);
+	if (cci_dev->cci_master_info[master].is_first_req == true) {
+		cci_dev->cci_master_info[master].is_first_req = false;
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else if (c_ctrl->cci_info->i2c_freq_mode
+		!= cci_dev->i2c_freq_mode[master]) {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		down(&cci_dev->cci_master_info[master].master_sem);
+	} else {
+		CAM_DBG(CAM_CCI, "Master: %d, curr_freq: %d, req_freq: %d",
+			master, cci_dev->i2c_freq_mode[master],
+			c_ctrl->cci_info->i2c_freq_mode);
+		spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+		cci_dev->cci_master_info[master].freq_ref_cnt++;
+		spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
+	}
+
 	/* Set the I2C Frequency */
 	rc = cam_cci_set_clk_param(cci_dev, c_ctrl);
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "cam_cci_set_clk_param failed rc = %d", rc);
-		return rc;
+		mutex_unlock(&cci_dev->cci_master_info[master].mutex);
+		goto ERROR;
 	}
+	mutex_unlock(&cci_dev->cci_master_info[master].mutex);
 	/*
 	 * Call validate queue to make sure queue is empty before starting.
 	 * If this call fails, don't proceed with i2c_write call. This is to
@@ -1326,18 +1453,25 @@ static int32_t cam_cci_i2c_write(struct v4l2_subdev *sd,
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "Initial validataion failed rc %d",
 			rc);
-		return rc;
+		goto ERROR;
 	}
 	if (c_ctrl->cci_info->retries > CCI_I2C_READ_MAX_RETRIES) {
 		CAM_ERR(CAM_CCI, "More than max retries");
-		return rc;
+		goto ERROR;
 	}
 	rc = cam_cci_data_queue(cci_dev, c_ctrl, queue, sync_en);
 	if (rc < 0) {
 		CAM_ERR(CAM_CCI, "failed rc: %d", rc);
-		return rc;
+		goto ERROR;
 	}
 
+ERROR:
+	spin_lock(&cci_dev->cci_master_info[master].freq_cnt);
+	if (cci_dev->cci_master_info[master].freq_ref_cnt == 0)
+		up(&cci_dev->cci_master_info[master].master_sem);
+	else
+		cci_dev->cci_master_info[master].freq_ref_cnt--;
+	spin_unlock(&cci_dev->cci_master_info[master].freq_cnt);
 	return rc;
 }
 
@@ -1610,14 +1744,19 @@ int32_t cam_cci_core_cfg(struct v4l2_subdev *sd,
 	struct cam_cci_ctrl *cci_ctrl)
 {
 	int32_t rc = 0;
-
+	struct cci_device *cci_dev = v4l2_get_subdevdata(sd);
 	CAM_DBG(CAM_CCI, "cmd %d", cci_ctrl->cmd);
+
 	switch (cci_ctrl->cmd) {
 	case MSM_CCI_INIT:
+		mutex_lock(&cci_dev->init_mutex);
 		rc = cam_cci_init(sd, cci_ctrl);
+		mutex_unlock(&cci_dev->init_mutex);
 		break;
 	case MSM_CCI_RELEASE:
+		mutex_lock(&cci_dev->init_mutex);
 		rc = cam_cci_release(sd);
+		mutex_unlock(&cci_dev->init_mutex);
 		break;
 	case MSM_CCI_I2C_READ:
 		rc = cam_cci_read_bytes(sd, cci_ctrl);
@@ -1644,3 +1783,139 @@ int32_t cam_cci_core_cfg(struct v4l2_subdev *sd,
 
 	return rc;
 }
+#define MAX_WRITE_ARRAY_SIZE   300
+static struct cam_cci_ctrl cci_ctrl_interface;
+static struct cam_sensor_cci_client cci_ctrl_interface_info;
+static     struct cam_sensor_i2c_reg_array write_regarray[MAX_WRITE_ARRAY_SIZE];
+
+int32_t cam_cci_read_packet(struct cam_cci_ctrl *cci_ctrl,
+	uint32_t addr, uint8_t *data,uint32_t count)
+{
+	int32_t rc = -EINVAL;
+
+	cci_ctrl->cmd = MSM_CCI_I2C_READ;
+	cci_ctrl->cfg.cci_i2c_read_cfg.addr = addr;
+	cci_ctrl->cfg.cci_i2c_read_cfg.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+	cci_ctrl->cfg.cci_i2c_read_cfg.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+	cci_ctrl->cfg.cci_i2c_read_cfg.data = data;
+	cci_ctrl->cfg.cci_i2c_read_cfg.num_byte = count;
+	//CAM_ERR(CAM_SENSOR, "cam_cci_read_packet addr = 0x%x,data=0x%x,count=%d,rc=%d",
+	//	addr,data[0],count,rc);
+	//for(int i=0;i<count;i++){
+	//	CAM_ERR(CAM_SENSOR, "data before read data= 0x%x,index=%d",data[i],i);
+	//}
+
+	rc = cci_ctrl->status;
+	return rc;
+}
+
+static int32_t cam_cci_write_packet(
+    struct cam_cci_ctrl *cci_ctrl,
+    int addr,
+    uint8_t *data,
+    uint16_t count)
+{
+    int32_t rc = 0;
+    memset(write_regarray,0,sizeof(write_regarray));
+    if (!cci_ctrl || !data)
+        return rc;
+    if(count > MAX_WRITE_ARRAY_SIZE){
+        CAM_ERR(CAM_SENSOR, "fatal error!!count exceeds 300,count=%d",
+            count);
+        count = MAX_WRITE_ARRAY_SIZE;
+    }
+    for(int i=0;i<count;i++){
+        write_regarray[i].reg_addr = addr+i;
+        write_regarray[i].reg_data = data[i];
+        //CAM_ERR(CAM_SENSOR, "cam_cci_write_packet addr = 0x%x,data= 0x%x,count=%d",
+        //    addr,data[i],count);
+    }
+    cci_ctrl->cfg.cci_i2c_write_cfg.reg_setting =
+        write_regarray;
+    cci_ctrl->cfg.cci_i2c_write_cfg.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+    cci_ctrl->cfg.cci_i2c_write_cfg.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+    cci_ctrl->cfg.cci_i2c_write_cfg.size = count;
+
+    if (rc < 0) {
+        CAM_ERR(CAM_SENSOR, "Failed rc = %d", rc);
+        return rc;
+    }
+    rc = cci_ctrl->status;
+    //if (write_setting->delay > 20)
+    //    msleep(write_setting->delay);
+    //else if (write_setting->delay)
+    //    usleep_range(write_setting->delay * 1000, (write_setting->delay
+    //        * 1000) + 1000);
+
+    return rc;
+}
+
+
+int32_t cam_cci_control_interface(void* control)
+{
+    int32_t rc = 0,exp_byte;
+    struct v4l2_subdev *sd = cam_cci_get_subdev(CCI_DEVICE_1);
+    struct cci_device *cci_dev = v4l2_get_subdevdata(sd);
+    struct camera_cci_transfer* pControl = (struct camera_cci_transfer*)control;
+
+    switch (pControl->cmd) {
+    case CAMERA_CCI_INIT:
+        memset(&cci_ctrl_interface,0,sizeof(cci_ctrl_interface));
+        memset(&cci_ctrl_interface_info,0,sizeof(cci_ctrl_interface_info));
+        cci_ctrl_interface.cci_info = &cci_ctrl_interface_info;
+        cci_ctrl_interface.cci_info->cci_i2c_master = MASTER_0;
+        cci_ctrl_interface.cci_info->i2c_freq_mode = I2C_FAST_PLUS_MODE;
+        cci_ctrl_interface.cci_info->sid = (0x52 >> 1);
+        cci_ctrl_interface.cci_info->retries = 3;
+        mutex_lock(&cci_dev->init_mutex);
+        rc = cam_cci_init(sd, &cci_ctrl_interface);
+        CAM_INFO(CAM_CCI, "cci init cmd,rc=%d",rc);
+        mutex_unlock(&cci_dev->init_mutex);
+        break;
+    case CAMERA_CCI_RELEASE:
+        mutex_lock(&cci_dev->init_mutex);
+        rc = cam_cci_release(sd);
+        CAM_INFO(CAM_CCI, "cci release cmd,rc=%d",rc);
+        mutex_unlock(&cci_dev->init_mutex);
+        break;
+    case CAMERA_CCI_READ:
+        cci_ctrl_interface.cmd = MSM_CCI_I2C_READ;
+        //pack read data
+        cam_cci_read_packet(&cci_ctrl_interface,
+                            pControl->addr,
+                            pControl->data,
+                            pControl->count);
+        rc = cam_cci_read_bytes(sd, &cci_ctrl_interface);
+        if(rc < 0){
+            CAM_ERR(CAM_CCI, "cmd %d,rc=%d", pControl->cmd,rc);
+            exp_byte = ((cci_ctrl_interface.cfg.cci_i2c_read_cfg.num_byte / 4) + 1);
+            CAM_ERR(CAM_CCI, "songyt read exp byte=%d", exp_byte);
+            for(int i=0;i<exp_byte;i++){
+                CAM_ERR(CAM_CCI, "songyt read byte=0x%x,index=%d",
+                    cci_ctrl_interface.cfg.cci_i2c_read_cfg.data[i],i);
+            }
+        }
+        break;
+    case CAMERA_CCI_WRITE:
+        //if(pControl->count>1)
+        //    cci_ctrl_interface.cmd = MSM_CCI_I2C_WRITE_SEQ;
+        //else
+        //    cci_ctrl_interface.cmd = MSM_CCI_I2C_WRITE_SYNC_BLOCK;
+        cci_ctrl_interface.cmd = MSM_CCI_I2C_WRITE;
+        //pack write data
+        cam_cci_write_packet(&cci_ctrl_interface,
+                            pControl->addr,
+                            pControl->data,
+                            pControl->count);
+        rc = cam_cci_write(sd, &cci_ctrl_interface);
+        if(rc < 0){
+            CAM_ERR(CAM_CCI, "cmd %d,rc=%d",pControl->cmd,rc);
+        }
+        break;
+    default:
+        rc = -ENOIOCTLCMD;
+    }
+
+    cci_ctrl_interface.status = rc;
+    return rc;
+}
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_ctrl_interface.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_ctrl_interface.h
new file mode 100644
index 0000000000000000000000000000000000000000..a03df823f27c0a8890eebf479b1211d68ef0044e
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_ctrl_interface.h
@@ -0,0 +1,35 @@
+/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef _CAM_CCI_CTRL_INTERFACE_H_
+#define _CAM_CCI_CTRL_INTERFACE_H_
+
+
+int32_t cam_cci_control_interface(void*);
+
+#define USE_CAMERA_CCI
+
+enum camera_cci_operations {
+    CAMERA_CCI_INIT,
+    CAMERA_CCI_RELEASE,
+    CAMERA_CCI_READ,
+    CAMERA_CCI_WRITE,
+};
+
+struct camera_cci_transfer {
+    int cmd;
+    uint16_t addr;
+    uint8_t *data;
+    uint16_t count;
+};
+
+#endif /* _CAM_CCI_CTRL_INTERFACE_H_ */
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.c
index 6ac042c83604bc5a9493b7cb318feb32318620ed..16018f6b9403ef25fd362c878c75fa0c0c52bee9 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.c
@@ -402,6 +402,7 @@ static int cam_cci_platform_probe(struct platform_device *pdev)
 	}
 
 	g_cci_subdev[soc_info->index] = &new_cci_dev->v4l2_dev_str.sd;
+	mutex_init(&(new_cci_dev->init_mutex));
 	CAM_ERR(CAM_CCI, "Device Type :%d", soc_info->index);
 
 	cam_register_subdev_fops(&cci_v4l2_subdev_fops);
@@ -424,7 +425,6 @@ static int cam_cci_platform_probe(struct platform_device *pdev)
 	CAM_DBG(CAM_CCI, "CPAS registration successful handle=%d",
 		cpas_parms.client_handle);
 	new_cci_dev->cpas_handle = cpas_parms.client_handle;
-
 	return rc;
 cci_no_resource:
 	kfree(new_cci_dev);
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.h
index 12abeabe0a380f9f954ae0548011193f3467df2a..7d5e6ce917b71450704385715f7c29ec29926b70 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.h
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_dev.h
@@ -26,6 +26,7 @@
 #include <linux/timer.h>
 #include <linux/kernel.h>
 #include <linux/platform_device.h>
+#include <linux/semaphore.h>
 #include <media/cam_sensor.h>
 #include <media/v4l2-event.h>
 #include <media/v4l2-ioctl.h>
@@ -144,6 +145,10 @@ struct cam_cci_master_info {
 	struct completion report_q[NUM_QUEUES];
 	atomic_t done_pending[NUM_QUEUES];
 	spinlock_t lock_q[NUM_QUEUES];
+	spinlock_t freq_cnt;
+	struct semaphore master_sem;
+	bool is_first_req;
+	uint16_t freq_ref_cnt;
 };
 
 struct cam_cci_clk_params_t {
@@ -229,6 +234,7 @@ struct cci_device {
 	spinlock_t lock_status;
 	bool is_burst_read;
 	uint32_t irqs_disabled;
+	struct mutex init_mutex;
 };
 
 enum cam_cci_i2c_cmd_type {
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_soc.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_soc.c
index da714af3fde279002600800a8655e1c91b4fc505..d7d48beb0e30c90be0816a5f81c90a98f125d20c 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_soc.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_cci/cam_cci_soc.c
@@ -45,6 +45,7 @@ int cam_cci_init(struct v4l2_subdev *sd,
 
 	CAM_DBG(CAM_CCI, "Base address %pK", base);
 
+#if 0
 	if (cci_dev->ref_count++) {
 		CAM_DBG(CAM_CCI, "ref_count %d", cci_dev->ref_count);
 		master = c_ctrl->cci_info->cci_i2c_master;
@@ -77,7 +78,15 @@ int cam_cci_init(struct v4l2_subdev *sd,
 		}
 		return 0;
 	}
+#endif
 
+	if ((cci_dev->ref_count) &&
+		(cci_dev->cci_state == CCI_STATE_ENABLED)) {
+		cci_dev->ref_count++;
+		return 0;
+	}
+
+	cci_dev->ref_count++;
 	ahb_vote.type = CAM_VOTE_ABSOLUTE;
 	ahb_vote.vote.level = CAM_SVS_VOTE;
 	axi_vote.compressed_bw = CAM_CPAS_DEFAULT_AXI_BW;
@@ -169,6 +178,7 @@ int cam_cci_init(struct v4l2_subdev *sd,
 		base + CCI_I2C_M1_RD_THRESHOLD_ADDR);
 
 	cci_dev->cci_state = CCI_STATE_ENABLED;
+	CAM_INFO(CAM_CCI, "End init ref_count %d dev=%s", cci_dev->ref_count,cci_dev->device_name);
 
 	return 0;
 
@@ -196,7 +206,10 @@ static void cam_cci_init_cci_params(struct cci_device *new_cci_dev)
 
 	for (i = 0; i < NUM_MASTERS; i++) {
 		new_cci_dev->cci_master_info[i].status = 0;
+		new_cci_dev->cci_master_info[i].is_first_req = true;
 		mutex_init(&new_cci_dev->cci_master_info[i].mutex);
+		sema_init(&new_cci_dev->cci_master_info[i].master_sem, 1);
+		spin_lock_init(&new_cci_dev->cci_master_info[i].freq_cnt);
 		init_completion(
 			&new_cci_dev->cci_master_info[i].reset_complete);
 		init_completion(
@@ -382,9 +395,10 @@ int cam_cci_soc_release(struct cci_device *cci_dev)
 		return -EINVAL;
 	}
 	if (--cci_dev->ref_count) {
-		CAM_DBG(CAM_CCI, "ref_count Exit %d", cci_dev->ref_count);
+		CAM_INFO(CAM_CCI, "ref_count Exit %d dev=%s", cci_dev->ref_count,cci_dev->device_name);
 		return 0;
 	}
+
 	for (i = 0; i < MASTER_MAX; i++)
 		if (cci_dev->write_wq[i])
 			flush_workqueue(cci_dev->write_wq[i]);
@@ -403,6 +417,7 @@ int cam_cci_soc_release(struct cci_device *cci_dev)
 	cci_dev->cycles_per_us = 0;
 
 	cam_cpas_stop(cci_dev->cpas_handle);
+	CAM_INFO(CAM_CCI, "End release ref_count %d dev=%s", cci_dev->ref_count,cci_dev->device_name);
 
 	return rc;
 }
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_csiphy/include/cam_csiphy_1_1_hwreg.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_csiphy/include/cam_csiphy_1_1_hwreg.h
index b1ceb0109155d540373d4834c970d238d5781c55..f711a1f9b64323cc84a66ee55e282de00210f5f1 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_csiphy/include/cam_csiphy_1_1_hwreg.h
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_csiphy/include/cam_csiphy_1_1_hwreg.h
@@ -263,7 +263,7 @@ csiphy_reg_t csiphy_3ph_v1_1_reg[MAX_LANES][MAX_SETTINGS_PER_LANE] = {
 		{0x015C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x09B0, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0980, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
-		{0x09B0, 0x24, 0x00, CSIPHY_DEFAULT_PARAMS},
+		{0x09B0, 0x23, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x015C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0984, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0988, 0x04, 0x00, CSIPHY_DEFAULT_PARAMS},
@@ -308,7 +308,7 @@ csiphy_reg_t csiphy_3ph_v1_1_reg[MAX_LANES][MAX_SETTINGS_PER_LANE] = {
 		{0x035C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0AB0, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0A80, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
-		{0x0AB0, 0x24, 0x00, CSIPHY_DEFAULT_PARAMS},
+		{0x0AB0, 0x23, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x035C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0A84, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0A88, 0x04, 0x00, CSIPHY_DEFAULT_PARAMS},
@@ -353,7 +353,7 @@ csiphy_reg_t csiphy_3ph_v1_1_reg[MAX_LANES][MAX_SETTINGS_PER_LANE] = {
 		{0x055C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0BB0, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0B80, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
-		{0x0BB0, 0x24, 0x00, CSIPHY_DEFAULT_PARAMS},
+		{0x0BB0, 0x23, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x055C, 0x40, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0B84, 0x00, 0x00, CSIPHY_DEFAULT_PARAMS},
 		{0x0B88, 0x04, 0x00, CSIPHY_DEFAULT_PARAMS},
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_eeprom/cam_eeprom_core.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_eeprom/cam_eeprom_core.c
old mode 100644
new mode 100755
index ab4ea76c23d741d278d2d23f37900616897600d7..8598f56d22928fd4f709c48e66003baf5e298fa6
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_eeprom/cam_eeprom_core.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_eeprom/cam_eeprom_core.c
@@ -17,7 +17,34 @@
 #include "cam_eeprom_core.h"
 #include "cam_eeprom_soc.h"
 #include "cam_debug_util.h"
-#include "cam_common_util.h"
+
+#include <linux/project_info.h>
+struct module_vendor_match_tbl {
+	uint32_t sensor_id;
+	uint32_t vendor_id;
+	char vendor_name[32];
+};
+static struct module_vendor_match_tbl match_tbl[] = {
+	{0x56, 0x03, "SEMCO"}, //0x56 - imx586 - rear 1st
+	{0x56, 0x06, "OFILM"}, //0x56 - imx586 - rear 2nd
+	{0x55, 0x01, "SUNNY"}, //0x55 - imx471 - front 1st
+};
+static char r_module_date[12];
+static char f_module_date[12];
+static bool r_module_dated = false;
+static bool f_module_dated = false;
+
+#define EEPROM_FRONT_SENSOR_ID 0x55 //imx471
+#define EEPROM_SEMCO_VENDOR_ID 0x03 //SEMCO
+
+#define EEPROM_VENDOR_ADDR_L 0x0000
+#define EEPROM_VENDOR_ADDR_H 0x0001
+#define EEPROM_DAY_ADDR      0x0002
+#define EEPROM_MONTH_ADDR    0x0003
+#define EEPROM_YEAR_ADDR_L   0x0004
+#define EEPROM_YEAR_ADDR_H   0x0005
+#define EEPROM_SENSOR_ADDR_L 0x0006
+#define EEPROM_SENSOR_ADDR_H 0x0007
 
 /**
  * cam_eeprom_read_memory() - read map data into buffer
@@ -38,6 +65,12 @@ static int cam_eeprom_read_memory(struct cam_eeprom_ctrl_t *e_ctrl,
 	struct cam_eeprom_soc_private     *eb_info = NULL;
 	uint8_t                           *memptr = block->mapdata;
 
+	int ret = 0, k = 0;
+	uint32_t reg_data;
+	uint32_t yearH = 0, yearL = 0, month =0, day = 0;
+	uint32_t module_sensor_id = 0;
+	uint32_t module_vendor_id = 0;
+
 	if (!e_ctrl) {
 		CAM_ERR(CAM_EEPROM, "e_ctrl is NULL");
 		return -EINVAL;
@@ -138,6 +171,77 @@ static int cam_eeprom_read_memory(struct cam_eeprom_ctrl_t *e_ctrl,
 			}
 		}
 	}
+
+	//module sensor id
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_SENSOR_ADDR_L, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	module_sensor_id = reg_data & 0xFF;
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_SENSOR_ADDR_H, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	module_sensor_id = ((reg_data & 0xFF) << 8) | module_sensor_id;
+	CAM_INFO(CAM_EEPROM, "module_sensor_id 0x%x", module_sensor_id);
+	//module vendor id
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_VENDOR_ADDR_L, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	module_vendor_id = reg_data & 0xFF;
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_VENDOR_ADDR_H, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	module_vendor_id = ((reg_data & 0xFF) << 8) | module_vendor_id;
+	CAM_INFO(CAM_EEPROM, "module_vendor_id 0x%x", module_vendor_id);
+	//module day
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_DAY_ADDR, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	day = reg_data & 0xFF;
+	//module month
+	reg_data = 0;
+	ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_MONTH_ADDR, &reg_data,
+		CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+	month = reg_data & 0xFF;
+	//module year
+	reg_data = 0;
+	if (EEPROM_SEMCO_VENDOR_ID == module_vendor_id) { //semco year H/L invert
+		ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_YEAR_ADDR_H, &reg_data,
+			CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+		yearH = reg_data & 0xFF;
+		reg_data = 0;
+		ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_YEAR_ADDR_L, &reg_data,
+			CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+		yearL = reg_data & 0xFF;
+	} else {
+		ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_YEAR_ADDR_L, &reg_data,
+			CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+		yearH = reg_data & 0xFF;
+		reg_data = 0;
+		ret = camera_io_dev_read(&(e_ctrl->io_master_info), EEPROM_YEAR_ADDR_H, &reg_data,
+			CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_BYTE);
+		yearL = reg_data & 0xFF;
+	}
+
+	for (k = 0; k < sizeof(match_tbl)/sizeof(match_tbl[0]); k++) {
+		if (module_sensor_id == match_tbl[k].sensor_id && module_vendor_id == match_tbl[k].vendor_id) {
+			if (EEPROM_FRONT_SENSOR_ID == module_sensor_id) {
+				if (f_module_dated == false) {
+					snprintf(f_module_date, sizeof(f_module_date), "%02d%02d%02d%02d", yearH, yearL, month, day);
+					push_component_info(F_MODULE, match_tbl[k].vendor_name, f_module_date);
+					CAM_INFO(CAM_EEPROM, "F_MODULE date:%s", f_module_date);
+					f_module_dated = true;
+				}
+			} else {
+				if (r_module_dated == false) {
+					snprintf(r_module_date, sizeof(r_module_date), "%02d%02d%02d%02d", yearH, yearL, month, day);
+					push_component_info(R_MODULE, match_tbl[k].vendor_name, r_module_date);
+					CAM_INFO(CAM_EEPROM, "R_MODULE date:%s", r_module_date);
+					r_module_dated = true;
+				}
+			}
+			break;
+		}
+	}
 	return rc;
 }
 
@@ -272,6 +376,7 @@ int32_t cam_eeprom_parse_read_memory_map(struct device_node *of_node,
 	int32_t                         rc = 0;
 	struct cam_eeprom_soc_private  *soc_private;
 	struct cam_sensor_power_ctrl_t *power_info;
+	int32_t                         retry = 3;
 
 	if (!e_ctrl) {
 		CAM_ERR(CAM_EEPROM, "failed: e_ctrl is NULL");
@@ -301,11 +406,29 @@ int32_t cam_eeprom_parse_read_memory_map(struct device_node *of_node,
 			goto power_down;
 		}
 	}
-	rc = cam_eeprom_read_memory(e_ctrl, &e_ctrl->cal_data);
-	if (rc) {
-		CAM_ERR(CAM_EEPROM, "read_eeprom_memory failed");
-		goto power_down;
-	}
+
+	do {
+		rc = cam_eeprom_read_memory(e_ctrl, &e_ctrl->cal_data);
+		if (rc) {
+			CAM_ERR(CAM_EEPROM, "read_eeprom_memory failed, retry:%d", retry);
+			if (retry == 1) {
+				goto power_down;
+			}
+			rc = cam_eeprom_power_down(e_ctrl);
+			if (rc) {
+				CAM_ERR(CAM_EEPROM, "failed: eeprom power down rc %d", rc);
+			}
+			msleep(20);
+			rc = cam_eeprom_power_up(e_ctrl, power_info);
+			if (rc) {
+				CAM_ERR(CAM_EEPROM, "failed: eeprom power up rc %d", rc);
+				goto data_mem_free;
+			}
+		} else {
+			break;
+		}
+		retry--;
+	} while (retry > 0);
 
 	rc = cam_eeprom_power_down(e_ctrl);
 	if (rc)
@@ -729,6 +852,7 @@ static int32_t cam_eeprom_get_cal_data(struct cam_eeprom_ctrl_t *e_ctrl,
 static int32_t cam_eeprom_pkt_parse(struct cam_eeprom_ctrl_t *e_ctrl, void *arg)
 {
 	int32_t                         rc = 0;
+	int32_t                         retry = 3;
 	struct cam_control             *ioctl_ctrl = NULL;
 	struct cam_config_dev_cmd       dev_config;
 	uintptr_t                        generic_pkt_addr;
@@ -803,12 +927,29 @@ static int32_t cam_eeprom_pkt_parse(struct cam_eeprom_ctrl_t *e_ctrl, void *arg)
 		}
 
 		e_ctrl->cam_eeprom_state = CAM_EEPROM_CONFIG;
-		rc = cam_eeprom_read_memory(e_ctrl, &e_ctrl->cal_data);
-		if (rc) {
-			CAM_ERR(CAM_EEPROM,
-				"read_eeprom_memory failed");
-			goto power_down;
-		}
+
+		do {
+			rc = cam_eeprom_read_memory(e_ctrl, &e_ctrl->cal_data);
+			if (rc) {
+				CAM_ERR(CAM_EEPROM, "read_eeprom_memory failed, retry:%d", retry);
+				if (retry == 1) {
+					goto power_down;
+				}
+				rc = cam_eeprom_power_down(e_ctrl);
+				if (rc) {
+					CAM_ERR(CAM_EEPROM, "failed: eeprom power down rc %d", rc);
+				}
+				msleep(20);
+				rc = cam_eeprom_power_up(e_ctrl, &soc_private->power_info);
+				if (rc) {
+					CAM_ERR(CAM_EEPROM, "failed: eeprom power up rc %d", rc);
+					goto memdata_free;
+				}
+			} else {
+				break;
+			}
+			retry--;
+		} while (retry > 0);
 
 		rc = cam_eeprom_get_cal_data(e_ctrl, csl_packet);
 		rc = cam_eeprom_power_down(e_ctrl);
@@ -846,7 +987,7 @@ static int32_t cam_eeprom_pkt_parse(struct cam_eeprom_ctrl_t *e_ctrl, void *arg)
 	vfree(e_ctrl->cal_data.map);
 	e_ctrl->cal_data.num_data = 0;
 	e_ctrl->cal_data.num_map = 0;
-	e_ctrl->cam_eeprom_state = CAM_EEPROM_INIT;
+	e_ctrl->cam_eeprom_state = CAM_EEPROM_ACQUIRE;
 release_buf:
 	if (cam_mem_put_cpu_buf(dev_config.packet_handle))
 		CAM_WARN(CAM_EEPROM, "Put cpu buffer failed : 0x%x",
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_flash/cam_flash_core.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_flash/cam_flash_core.c
old mode 100644
new mode 100755
index bf0e7e9bb70f5c2ca114c6717b053dcf6df13dac..842e7e841153aa5f7a7c4da23c68dc1fd9823497
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_flash/cam_flash_core.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_flash/cam_flash_core.c
@@ -1374,6 +1374,18 @@ int cam_flash_pmic_pkt_parser(struct cam_flash_ctrl *fctrl, void *arg)
 
 			flash_operation_info =
 				(struct cam_flash_set_on_off *) cmd_buf;
+			if (!flash_operation_info) {
+				CAM_ERR(CAM_FLASH,
+					"flash_operation_info Null");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
+			if (flash_operation_info->count >
+				CAM_FLASH_MAX_LED_TRIGGERS) {
+				CAM_ERR(CAM_FLASH, "led count out of limit");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
 			fctrl->nrt_info.cmn_attr.count =
 				flash_operation_info->count;
 			fctrl->nrt_info.cmn_attr.request_id = 0;
@@ -1462,6 +1474,12 @@ int cam_flash_pmic_pkt_parser(struct cam_flash_ctrl *fctrl, void *arg)
 				rc = -EINVAL;
 				goto rel_cmd_buf;
 			}
+			if (flash_operation_info->count >
+				CAM_FLASH_MAX_LED_TRIGGERS) {
+				CAM_ERR(CAM_FLASH, "led count out of limit");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
 
 			flash_data->opcode = flash_operation_info->opcode;
 			flash_data->cmn_attr.count =
@@ -1505,6 +1523,19 @@ int cam_flash_pmic_pkt_parser(struct cam_flash_ctrl *fctrl, void *arg)
 			CAM_DBG(CAM_FLASH, "Widget Flash Operation");
 			flash_operation_info =
 				(struct cam_flash_set_on_off *) cmd_buf;
+			if (!flash_operation_info) {
+				CAM_ERR(CAM_FLASH,
+					"flash_operation_info Null");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
+			if (flash_operation_info->count >
+				CAM_FLASH_MAX_LED_TRIGGERS) {
+				CAM_ERR(CAM_FLASH, "led count out of limit");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
+
 			fctrl->nrt_info.cmn_attr.count =
 				flash_operation_info->count;
 			fctrl->nrt_info.cmn_attr.request_id = 0;
@@ -1553,6 +1584,19 @@ int cam_flash_pmic_pkt_parser(struct cam_flash_ctrl *fctrl, void *arg)
 		case CAMERA_SENSOR_FLASH_CMD_TYPE_RER: {
 			rc = 0;
 			flash_rer_info = (struct cam_flash_set_rer *)cmd_buf;
+			if (!flash_rer_info) {
+				CAM_ERR(CAM_FLASH,
+					"flash_rer_info Null");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
+			if (flash_rer_info->count >
+				CAM_FLASH_MAX_LED_TRIGGERS) {
+				CAM_ERR(CAM_FLASH, "led count out of limit");
+				rc = -EINVAL;
+				goto rel_cmd_buf;
+			}
+
 			fctrl->nrt_info.cmn_attr.cmd_type =
 				CAMERA_SENSOR_FLASH_CMD_TYPE_RER;
 			fctrl->nrt_info.opcode = flash_rer_info->opcode;
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.c
new file mode 100644
index 0000000000000000000000000000000000000000..5094b299419c1844b7f110902f005baae2b30129
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.c
@@ -0,0 +1,174 @@
+/*=======================================================================
+		Accuracy Test Sample code for LC898124
+                                             	by Rex.Tang
+                                                2016.03.27
+========================================================================*/
+#include	"math.h"
+#include 	"OisLc898124EP3.h"
+#include	"Ois.h"
+#include	"Accuracy.h"
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+
+/* Raw data buffers */	
+//Dual_Axis_t xy_raw_data[360/DEGSTEP + 1];
+Dual_Axis_t xy_raw_data[360/3 + 1];
+float xMaxAcc, yMaxAcc;
+float xLimit, yLimit;
+
+static float fix2float(unsigned int fix)
+{
+    if((fix & 0x80000000) > 0)
+    {
+        return ((float)fix-(float)0x100000000)/(float)0x7FFFFFFF;
+    } else {
+        return (float)fix/(float)0x7FFFFFFF;
+    }
+}
+
+static unsigned int float2fix(float f)
+{
+    if(f < 0)
+    {
+        return (unsigned int)(f * (float)0x7FFFFFFF + 0x100000000);
+    } else {
+        return (unsigned int)(f * (float)0x7FFFFFFF);
+    }
+}
+
+/*-------------------------------------------------------------------
+	Function Name: Accuracy
+	Param:	none
+	Return:	value = 0 (no NG point)
+			value > 0 (High byte: X total NG points;
+					   Low byte: Y total NG points)	
+--------------------------------------------------------------------*/
+//unsigned short Accuracy()
+unsigned short Accuracy(float ACCURACY, unsigned short RADIUS, unsigned short DEGSTEP, unsigned short WAIT_MSEC1, unsigned short WAIT_MSEC2, unsigned short WAIT_MSEC3)
+{
+	float xpos, ypos;
+	unsigned int xhall_value, yhall_value;
+	float xMaxHall, yMaxHall;
+    unsigned short xng = 0, yng = 0;
+    unsigned short deg;
+    float xRadius, yRadius;
+	unsigned int xGyrogain, yGyrogain;
+    unsigned int xGLenz, yGLenz;
+    unsigned int xG2x4xb, yG2x4xb;
+
+	// Get Gyro gain
+	RamRead32A(GyroFilterTableX_gxzoom, &xGyrogain);
+	RamRead32A(GyroFilterTableY_gyzoom, &yGyrogain);
+
+	// Get Lenz
+	RamRead32A(GyroFilterTableX_gxlenz, &xGLenz);
+	RamRead32A(GyroFilterTableY_gylenz, &yGLenz);
+
+	// Get Lenz
+	RamRead32A(Gyro_ShiftX_RG, &xG2x4xb);
+	RamRead32A(Gyro_ShiftY_RG, &yG2x4xb);
+	
+	// Calculate Radius (100um)
+	xRadius = 0.10546843F * fabsf(fix2float(xGyrogain)) * fabsf(fix2float(xGLenz)) * (1 << (unsigned char)( xG2x4xb >> 8 ));
+	yRadius = 0.10546843F * fabsf(fix2float(yGyrogain)) * fabsf(fix2float(yGLenz)) * (1 << (unsigned char)( yG2x4xb >> 8 ));
+	TRACE("xRadius = %d, yRadius = %d", (int)(xRadius*1000), (int)(yRadius*1000));
+
+	// Calculate Limit
+	xLimit = ACCURACY / 100 * xRadius;
+    yLimit = ACCURACY / 100 * yRadius;
+
+	// Radius change (by RADIUS value)
+	xRadius = xRadius * RADIUS / 100;
+	yRadius = yRadius * RADIUS / 100;
+
+	xMaxAcc = 0;
+	yMaxAcc = 0;
+
+	// Circle check
+	xpos = xRadius * cos(0);
+	ypos = yRadius * sin(0);
+	RamWrite32A(HALL_RAM_HXOFF1, float2fix(xpos));
+	RamWrite32A(HALL_RAM_HYOFF1, float2fix(ypos));
+	WitTim(WAIT_MSEC1);
+
+	for( deg = 0; deg <= 360; deg += DEGSTEP ) // 0-360 degree
+	{
+		xpos = xRadius * cos(deg * PI/180);
+		ypos = yRadius * sin(deg * PI/180);
+    	RamWrite32A(HALL_RAM_HXOFF1, float2fix(xpos));
+		RamWrite32A(HALL_RAM_HYOFF1, float2fix(ypos));
+
+		if(deg ==0)
+			WitTim(500);
+
+		xMaxHall = 0;
+		yMaxHall = 0;
+		WitTim(WAIT_MSEC2);
+		
+		for(short i=0; i<LOOPTIME; i++)
+		{
+			WitTim(WAIT_MSEC3);
+			RamRead32A( HALL_RAM_HXOUT0, &xhall_value );
+			RamRead32A( HALL_RAM_HYOUT0, &yhall_value );
+			if(fabsf(fix2float(xhall_value) - xpos) > fabsf(xMaxHall))	
+				xMaxHall = fix2float(xhall_value) - xpos;
+			if(fabsf(fix2float(yhall_value) - ypos) > fabsf(yMaxHall))	
+				yMaxHall = fix2float(yhall_value) - ypos;
+		}
+
+		if(fabsf(xMaxHall) > xMaxAcc)	xMaxAcc = fabsf(xMaxHall);
+		if(fabsf(yMaxHall) > yMaxAcc)	yMaxAcc = fabsf(yMaxHall);
+		
+        // Save raw data
+		xy_raw_data[deg/DEGSTEP].xpos = xpos;
+		xy_raw_data[deg/DEGSTEP].xhall = xMaxHall + xpos;
+		xy_raw_data[deg/DEGSTEP].ypos = ypos;
+		xy_raw_data[deg/DEGSTEP].yhall = yMaxHall + ypos;
+		
+		if(fabsf(xMaxHall) > xLimit)	xng++; 	// Have NG point;
+		if(fabsf(yMaxHall) > yLimit)	yng++; 	// Have NG point; 
+
+	}
+	RamWrite32A(HALL_RAM_HXOFF1, 0); // x = center
+	RamWrite32A(HALL_RAM_HYOFF1, 0); // y = center
+
+	return (xng << 8) | yng;
+}
+
+//unsigned short HallCheck(void)
+unsigned short HallCheck(float ACCURACY, unsigned short RADIUS, unsigned short DEGSTEP, unsigned short WAIT_MSEC1, unsigned short WAIT_MSEC2, unsigned short WAIT_MSEC3)
+{
+	short i;
+//	unsigned short ret = Accuracy();
+	unsigned short ret = Accuracy(ACCURACY, RADIUS, DEGSTEP, WAIT_MSEC1, WAIT_MSEC2, WAIT_MSEC3);
+
+	if(ret)
+	{
+    	TRACE("\n VCM has NG points: X = %d, Y = %d", ret >> 8, ret & 0xff);
+	} else {
+    	TRACE("\n VCM is good!");
+	}
+	
+	// Max Accuracy
+	//TRACE("\n X Max Accuracy = %f, Y Max Accuracy = %f", xMaxAcc, yMaxAcc);
+	TRACE("\n X Max Accuracy = %d, Y Max Accuracy = %d", (int)(xMaxAcc*1000), (int)(yMaxAcc*1000));
+
+	// Limit vale
+	//TRACE("\n xLimit = %f, yLimit = %f", xLimit, yLimit);
+	TRACE("\n xLimit = %d, yLimit = %d", (int)(xLimit*1000), (int)(yLimit*1000));
+
+	// Circle
+	for(i=0; i<=(360/DEGSTEP); i++)
+	{
+		//TRACE("\n xPos = %f, xHall = %f, yPos = %f, yHall = %f", xy_raw_data[i].xpos, xy_raw_data[i].xhall, xy_raw_data[i].ypos, xy_raw_data[i].yhall);
+		TRACE("\n xPos = %d, xHall = %d, yPos = %d, yHall = %d", (int)(xy_raw_data[i].xpos*1000), (int)(xy_raw_data[i].xhall*1000), (int)(xy_raw_data[i].ypos*1000), (int)(xy_raw_data[i].yhall*1000));
+	}
+	
+	return( ret );
+}
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.h
new file mode 100644
index 0000000000000000000000000000000000000000..2d9451c57d82f42c17946337fd1fb8761d10dc8f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Accuracy.h
@@ -0,0 +1,27 @@
+/*=======================================================================
+		Accuracy Test Sample code for LC898124
+                                             	by Rex.Tang
+                                                2016.03.27
+========================================================================*/
+
+// Checking radius
+//#define		RADIUS 		75							// 75um
+
+// Parameter define
+//#define		DEGSTEP		3							// Degree of one step (3�‹)
+//#define		ACCURACY	3.0F						// Accuracy (�}3.0um)
+//#define		WAIT_MSEC	10							// Each step wait time(msec)
+#define		LOOPTIME	3							// Read times at each step
+
+// Constants
+#define		PI			3.14159		// ƒÎ
+
+
+typedef struct tag_Dual_Axis
+{
+	float xpos;
+	float xhall;
+	float ypos;
+	float yhall;
+}Dual_Axis_t;
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/DownloadCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/DownloadCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..67dab419cb9c01bea3f96dc3bd8124e4ca3dfc04
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/DownloadCmd.c
@@ -0,0 +1,344 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//********************************************************************************
+
+//**************************
+//	Include Header File		
+//**************************
+#include "Ois.h"
+
+#include "LC898124EP3_Code_0_1_0_2_2_0.h"		// Gyro=LSM6DSM,	SO2821
+#include "LC898124EP3_Code_0_1_0_2_2_1.h"		// Gyro=LSM6DSM,	FRA, SO2821
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A( unsigned short, int );
+extern 	void RamRead32A( unsigned short, void * );
+/* for I2C Multi Translation : Burst Mode*/
+extern 	void CntWrt( void *, unsigned short) ;
+extern void CntRd( unsigned int addr, void *	PcSetDat, unsigned short	UsDatNum )  ;
+/* for Wait timer [Need to adjust for your system] */ 
+extern void	WitTim( unsigned short	UsWitTim );
+
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+#define BURST_LENGTH_PM ( 12*5 ) 	// 60 •K‚¸5‚Ì”{�”‚Å�Ý’è‚·‚邱‚Æ�B�Å‘å64Byte‚Ü‚Å
+#define BURST_LENGTH_DM ( 10*6 ) 	// 60 •K‚¸6‚Ì”{�”‚Å�Ý’è‚·‚邱‚Æ�B�Å‘å64Byte‚Ü‚Å
+#define BURST_LENGTH BURST_LENGTH_PM 	
+
+//********************************************************************************
+// Function Name 	: DMIOWrite32
+// Retun Value		: None
+// Argment Value	: IOadrs, IOdata
+// Explanation		: Read From code version Command
+// History			: First edition 						
+//********************************************************************************
+void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata )
+{
+#if 1
+	UINT8 data[10];
+	data[0] = 0xC0;		// Pmem address set
+	data[1] = 0x00;		// Command High
+	data[2] = (UINT8)(IOadrs >>24);		// IOadres
+	data[3] = (UINT8)(IOadrs >>16);		// Command High
+	data[4] = (UINT8)(IOadrs >> 8);		// Command High
+	data[5] = (UINT8)(IOadrs >> 0);		// Command High
+	data[6] = (UINT8)(IOdata >>24);		// IOadres
+	data[7] = (UINT8)(IOdata >>16);		// Command High
+	data[8] = (UINT8)(IOdata >> 8);		// Command High
+	data[9] = (UINT8)(IOdata >> 0);		// Command High
+	CntWrt( data, 10 ); 	// I2C 1Byte address.
+#else
+	RamWrite32A( CMD_IO_ADR_ACCESS, IOadrs ) ;
+	RamWrite32A( CMD_IO_DAT_ACCESS, IOdata ) ;
+#endif
+};
+
+//********************************************************************************
+// Function Name 	: DownloadToEP3
+// Retun Value		: NON
+// Argment Value	: PMlength: 5byte unit, DMlength : 1Byte unit 
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+unsigned char DownloadToEP3( const UINT8* DataPM, UINT32 LengthPM, UINT32 Parity, const UINT8* DataDM, UINT32 LengthDMA , UINT32 LengthDMB ) 
+{
+	UINT32 i, j;
+	UINT8 data[64];		// work fifo buffer max size 64 byte
+	UINT8 Remainder;	// —]‚è
+	UINT32 UlReadVal, UlCnt;
+	UINT32 ReadVerifyPM, ReadVerifyDMA, ReadVerifyDMB;	// Checksum
+	
+//*******************************************************************************//
+//*   pre-check ROM code version 												*//
+//*******************************************************************************//
+	RamRead32A( CMD_ROMVER , &UlReadVal );
+	if( UlReadVal == OLD_VER )	return( 3 );		/* ROM code version error */
+	
+//--------------------------------------------------------------------------------
+// 0. Start up to boot exection 
+//--------------------------------------------------------------------------------
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	switch ( (UINT8)UlReadVal ){
+	case 0x0A:	/* Normal Rom program execution */
+		break;
+	
+	case 0x01:	/* Normal Ram program execution */
+		/* �ÄDonload‚Ì‚½‚ß‚É‚Í RomReboot‚µ‚È‚¯‚ê‚΂Ȃç‚È‚¢�BAutoDownload‚³‚¹‚邽‚ß‚ÉCORE_RST‚ÅŽÀ�s‚³‚¹‚é*/
+		DMIOWrite32( SYSDSP_REMAP, 0x00001000 ); 	// CORE_RST
+		WitTim( 6 ) ;								// Bootƒvƒ�ƒOƒ‰ƒ€‚ð‰ñ‚·‚Ì‚É6msec•K—v�B
+		break;
+
+//	case 0x0B:
+//	case 0x08:
+	default:	
+		return( 1 );
+	}
+//--------------------------------------------------------------------------------
+// 1. Download Program
+//--------------------------------------------------------------------------------
+	data[0] = 0x30;		// Pmem address set
+	data[1] = 0x00;		// Command High
+	data[2] = 0x10;		// Command High
+	data[3] = 0x00;		// Command High
+	data[4] = 0x00;		// Command High
+	CntWrt( data, 5 ); 	// I2C 1Byte address.
+	// program start
+	data[0] = 0x40;		// Pmem address set
+	Remainder = ( (LengthPM*5) / BURST_LENGTH_PM ); 
+	for(i=0 ; i< Remainder ; i++)
+	{
+		UlCnt = 1;
+		for(j=0 ; j < BURST_LENGTH_PM; j++)	data[UlCnt++] = *DataPM++;
+		
+		CntWrt( data, BURST_LENGTH_PM+1 );  // I2Caddresss 1Byte.
+	}
+	Remainder = ( (LengthPM*5) % BURST_LENGTH_PM); 
+	if (Remainder != 0 )
+	{
+		UlCnt = 1;
+		for(j=0 ; j < Remainder; j++)	data[UlCnt++] = *DataPM++;
+//TRACE("Remainder %d \n", (UINT8)Remainder );
+		CntWrt( data, UlCnt );  // I2C 1Byte address.
+	}
+	// Chercksum start
+	data[0] = 0xF0;											// Pmem address set
+	data[1] = 0x0A;											// Command High
+	data[2] = (unsigned char)(( LengthPM & 0xFF00) >> 8 );	// Size High
+	data[3] = (unsigned char)(( LengthPM & 0x00FF) >> 0 );	// Size Low
+	CntWrt( data, 4 ); 	// I2C 2Byte addresss.
+	
+//--------------------------------------------------------------------------------
+// 2. Download Table Data
+//--------------------------------------------------------------------------------
+//TRACE("DM Start \n" );	
+	RamWrite32A( DmCheck_CheckSumDMA, 0 );		// DMA Parity Clear
+	RamWrite32A( DmCheck_CheckSumDMB, 0 );		// DMB Parity Clear
+
+	/***** DMA Data Send *****/
+	Remainder = ( (LengthDMA*6/4) / BURST_LENGTH_DM ); 
+	for(i=0 ; i< Remainder ; i++)
+	{
+		CntWrt( (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+		DataDM += BURST_LENGTH_DM;
+	}
+	Remainder = ( (LengthDMA*6/4) % BURST_LENGTH_DM ); 
+	if (Remainder != 0 )
+	{
+		CntWrt( (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+	}
+		DataDM += Remainder;
+	
+	/***** DMB Data Send *****/
+	Remainder = ( (LengthDMB*6/4) / BURST_LENGTH_DM ); 
+	for( i=0 ; i< Remainder ; i++)	/* ‘±‚«‚©‚ç */
+	{
+		CntWrt( (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+		DataDM += BURST_LENGTH_DM;
+	}
+	Remainder = ( (LengthDMB*6/4) % BURST_LENGTH_DM ); 
+	if (Remainder != 0 )
+	{
+		CntWrt( (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+	}
+	
+//--------------------------------------------------------------------------------
+// 3. Verify
+//--------------------------------------------------------------------------------
+	RamRead32A( PmCheck_CheckSum, &ReadVerifyPM );
+	RamRead32A( DmCheck_CheckSumDMA, &ReadVerifyDMA );
+	RamRead32A( DmCheck_CheckSumDMB, &ReadVerifyDMB );
+
+	
+	if( (ReadVerifyPM + ReadVerifyDMA + ReadVerifyDMB) != Parity  ){
+TRACE("error! %08x %08x %08x \n", (unsigned int)ReadVerifyPM, (unsigned int)ReadVerifyDMA, (unsigned int)ReadVerifyDMB );	
+		return( 2 );
+	}
+	return(0);
+}
+
+
+//********************************************************************************
+// Function Name 	: ReMapMain
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+void RemapMain( void )
+{
+	RamWrite32A( 0xF000, 0x00000000 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MonitorInfo
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: 
+// History			: Second edition
+//********************************************************************************
+void MonitorInfo( DSPVER* Dspcode )
+{
+TRACE("Vendor : %02x \n", Dspcode->Vendor );
+TRACE("User : %02x \n", Dspcode->User );
+TRACE("Model : %02x \n", Dspcode->Model );
+TRACE("Version : %02x \n", Dspcode->Version );
+
+
+if(Dspcode->SpiMode == SPI_MST )
+TRACE("spi mode : Master\n");	
+if(Dspcode->SpiMode == SPI_SLV )
+TRACE("spi mode : Slave\n");	
+if(Dspcode->SpiMode == SPI_SNGL )
+TRACE("spi mode : only master\n");	
+
+//if(Dspcode->ActType == ACT_SEMCO	)
+//TRACE("actuator type : SOXXXX\n");
+if(Dspcode->ActType == ACT_SO2821) {
+	TRACE("actuator type : SO2821\n");
+} else {
+	TRACE("actuator type : SOXXXX\n");
+}
+
+if(Dspcode->GyroType == GYRO_ICM20690 )
+TRACE("gyro type : INVEN ICM20690 \n");	
+if(Dspcode->GyroType == GYRO_LSM6DSM )
+TRACE("gyro type : ST LSM6DSM \n")	;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: GetInfomationAfterDownload
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+UINT8 GetInfomationAfterDownload( DSPVER* Info )
+{
+	UINT32 Data;
+	UINT32 UlReadVal;
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( (UINT8)UlReadVal != 0x01 ) return( 1 );
+
+	RamRead32A( (SiVerNum + 0), &Data );
+	Info->Vendor 	= (UINT8)(Data >> 24 );
+	Info->User 		= (UINT8)(Data >> 16 );
+	Info->Model 		= (UINT8)(Data >> 8 );
+	Info->Version 	= (UINT8)(Data >> 0 );
+	RamRead32A( (SiVerNum + 4), &Data );
+	Info->SpiMode =  (UINT8)(Data >> 24 );
+	Info->ActType =  (UINT8)(Data >> 8 );
+	Info->GyroType = (UINT8)(Data >> 0 );
+
+//	 MonitorInfo( Info );
+	return( 0 );
+}
+
+//********************************************************************************
+// Function Name 	: GetInfomationBeforeDownlaod
+// Retun Value		: True(0) / Fail(1)
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+UINT8 GetInfomationBeforeDownlaod( DSPVER* Info, const UINT8* DataDM,  UINT32 LengthDM )
+{
+	UINT32 i;
+	Info->ActType = 0;
+	Info->GyroType = 0;
+
+	for( i=0; i < LengthDM; i+=6 )
+	{
+		if ( (DataDM[0+i] == 0xA0) && (DataDM[1+i] == 0x00) )
+		{
+			Info->Vendor = DataDM[2+i];
+			Info->User = DataDM[3+i];
+			Info->Model = DataDM[4+i];
+			Info->Version = DataDM[5+i];
+			if ( (DataDM[6+i] == 0xA0) && (DataDM[7+i] == 0x04) )
+			{
+				Info->SpiMode = DataDM[8+i];
+				Info->ActType = DataDM[10+i];
+				Info->GyroType = DataDM[11+i];
+			}
+			MonitorInfo( Info );
+			return (0);
+		}
+	}	
+	return(1);
+}
+
+
+//********************************************************************************
+// Function Name 	: SelectDownload
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: 
+// History			: Second edition
+//********************************************************************************
+extern unsigned char I2cSlvAddrWr;
+
+const DOWNLOAD_TBL DTbl[] = {
+ {0x0002, LC898124EP3_PM_0_1_0_2_2_0, LC898124EP3_PMSize_0_1_0_2_2_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_0_2_2_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_0_2_2_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_0_2_2_0), LC898124EP3_DM_0_1_0_2_2_0, LC898124EP3_DMA_ByteSize_0_1_0_2_2_0 , LC898124EP3_DMB_ByteSize_0_1_0_2_2_0 },
+ {0x0082, LC898124EP3_PM_0_1_0_2_2_1, LC898124EP3_PMSize_0_1_0_2_2_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_0_2_2_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_0_2_2_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_0_2_2_1), LC898124EP3_DM_0_1_0_2_2_1, LC898124EP3_DMA_ByteSize_0_1_0_2_2_1 , LC898124EP3_DMB_ByteSize_0_1_0_2_2_1 },
+ {0xFFFF, (void*)0, 0, 0, (void*)0 ,0 ,0 }
+};
+
+unsigned char SelectDownload( UINT8 GyroSelect, UINT8 ActSelect, UINT8 MasterSlave )
+{
+	DSPVER Dspcode;
+	DOWNLOAD_TBL *ptr;
+
+	if ( MasterSlave == 0x00 ) {
+		ptr = ( DOWNLOAD_TBL *)DTbl;
+	}
+
+	/* ‚Ç‚ÌCode‚ðDownload‚·‚é‚Ì‚©Table‚©‚猟�õ */
+	while (ptr->Cmd != 0xFFFF ){
+		if( ptr->Cmd == ( ((UINT16)ActSelect<<8) + GyroSelect) ) break;
+		ptr++ ;
+	}
+	if (ptr->Cmd == 0xFFFF)	return(0xF0);
+
+	/* Download‚·‚é‘OCode‚ÌInformation�î•ñŠm”F */
+	if( GetInfomationBeforeDownlaod( &Dspcode, ptr->DataDM, ( ptr->LengthDMA +  ptr->LengthDMB ) ) != 0 ){
+		return(0xF1);
+	}
+
+	/* Download‚·‚é‘O‚ÌCode‚Æ�A—v‹�‚µ‚Ä‚¢‚éActuator/Gyro�î•ñ‚ªˆê’v‚µ‚Ä‚¢‚é‚©Šm”F */
+	if( (ActSelect != Dspcode.ActType) || ((GyroSelect&0x7f) != Dspcode.GyroType) ) return(0xF2);
+
+	// �‚‘¬‰»‘ΉžDownload
+TRACE("DataPM( %08x ), LengthPM( %08x ) , Parity( %08x ), DataDM( %08x ) , LengthDMA( %08x ) , LengthDMB( %08x ) \n"
+	, (int)ptr->DataPM , (int)ptr->LengthPM , (int)ptr->Parity , (int)ptr->DataDM , (int)ptr->LengthDMA , (int)ptr->LengthDMB );
+	return( DownloadToEP3( ptr->DataPM, ptr->LengthPM, ptr->Parity, ptr->DataDM, ptr->LengthDMA , ptr->LengthDMB ) ); 
+}
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/E2PromCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/E2PromCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..217bb542e01ad80543d3a15b87cb547c5a262d45
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/E2PromCmd.c
@@ -0,0 +1,1538 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//********************************************************************************
+
+//**************************
+//	Include Header File		
+//**************************
+#include	"Ois.h"
+#include	"OisAPI.h"
+
+//****************************************************
+//	LC898124 calibration parameters 
+//****************************************************
+#if ((SELECT_VENDOR&0x01) == 0x01)				// SEMCO
+extern const ADJ_HALL SO2821_HallCalParameter;
+extern const ADJ_LOPGAN SO2821_LoopGainParameter;
+extern AF_PARA SO2821_OpenAfParameter;
+#endif
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A( int, int );
+extern 	void RamRead32A( unsigned short, void * );
+/* for Wait timer [Need to adjust for your system] */ 
+extern void	WitTim( unsigned short	UsWitTim );
+
+//****************************************************
+//	EXTERN LIST
+//****************************************************
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+
+  extern const AF_PARA SO_OpenAfParameter;
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+stAdjPar	StAdjPar ;				// temporary buffer for caribration data 
+UINT16		UsGzoVal ;				// Gyro A/D Offset X
+
+#ifdef	SEL_SHIFT_COR
+stPosOff	StPosOff ;				//!< Execute Command Parameter
+stAclVal	StAclVal ;				//!< Execute Command Parameter
+#endif	//SEL_SHIFT_COR
+
+#ifdef	ZERO_SERVO
+stZeroServo			StZeroServoX;
+stZeroServo			StZeroServoY;
+stZeroServo			StZeroServoZ;
+#endif	//ZERO_SERVO
+
+//****************************************************
+//	Parameter E2Prom defines
+//****************************************************
+#define HALLCROSSXX		0x7FFFFFFF
+#define HALLCROSSXY		0x00000000
+#define HALLCROSSYY		0x7FFFFFFF
+#define HALLCROSSYX		0x00000000
+#define HALLCROSSXSHIFT	0x00
+#define HALLCROSSYSHIFT	0x00
+
+
+//****************************************************
+//	DEFINE LIST
+//****************************************************
+#define E2P_ONSEMI_AREA_SIZE	(8*2)
+#define E2P_USER_AREA_SIZE		(8*13)
+
+#define LSB 0
+#define MSB 8 
+
+
+#define CHECK_SUM_ADR	0x7D
+
+//********************************************************************************
+// Function Name 	: UnlockCodeSet
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Flash Memory> Unlock Code Set
+// History			: First edition
+//********************************************************************************
+unsigned char UnlockCodeSet( void )
+{
+	unsigned long UlReadVal;
+
+	DMIOWrite32( E2P_UNLK_CODE1, 0xAAAAAAAA );	// UNLK_CODE1(E0_7554h) = AAAA_AAAAh
+	DMIOWrite32( E2P_UNLK_CODE2, 0x55555555 );	// UNLK_CODE2(E0_7AA8h) = 5555_5555h
+	DMIOWrite32( E2P_RSTB, 		 0x00000001 );	// RSTB_FLA_WR(E0_74CCh[0])=1
+	DMIOWrite32( E2P_CLKON, 	 0x00000010 );	// FLA_WR_ON(E0_7664h[4])=1
+	DMIOWrite32( E2P_UNLK_CODE3, 0x0000ACD5 );	// Additional Unllock Code Set
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , E2P_WPB	) ;
+	RamRead32A(  CMD_IO_DAT_ACCESS , &UlReadVal ) ;
+	if ( (UlReadVal & 0x00000002) != 2 ) return(1);
+
+	return(0);	
+
+}
+
+//********************************************************************************
+// Function Name 	: UnlockCodeClear
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Flash Memory> Clear Unlock Code
+// History			: First edition
+//********************************************************************************
+unsigned char UnlockCodeClear(void)
+{
+	unsigned long UlReadVal;
+
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_WPB );				// UNLOCK_CLR(E0_7014h[4])=1
+	RamWrite32A( CMD_IO_DAT_ACCESS, 0x00000010 );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( (UlReadVal & 0x00000080) != 0 )	return (3);						
+	
+	return(0);	
+}
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: WriteE2Prom
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+unsigned char WriteE2Prom( unsigned char address, unsigned char data )
+{
+	UINT32 UlReadVal, UlCnt;
+	unsigned char ans;
+		
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return (ans);							// Unlock Code Set
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 			// FLG CLR
+	
+	switch ( (address & 0x0F) ){
+		case 0 : 	DMIOWrite32( E2P_WDAT00, data );	break;
+		case 1 : 	DMIOWrite32( E2P_WDAT01, data );	break;
+		case 2 : 	DMIOWrite32( E2P_WDAT02, data );	break;
+		case 3 : 	DMIOWrite32( E2P_WDAT03, data );	break;
+		case 4 : 	DMIOWrite32( E2P_WDAT04, data );	break;
+		case 5 : 	DMIOWrite32( E2P_WDAT05, data );	break;
+		case 6 : 	DMIOWrite32( E2P_WDAT06, data );	break;
+		case 7 : 	DMIOWrite32( E2P_WDAT07, data );	break;
+		case 8 : 	DMIOWrite32( E2P_WDAT08, data );	break;
+		case 9 : 	DMIOWrite32( E2P_WDAT09, data );	break;
+		case 10 : 	DMIOWrite32( E2P_WDAT10, data );	break;
+		case 11 : 	DMIOWrite32( E2P_WDAT11, data );	break;
+		case 12 : 	DMIOWrite32( E2P_WDAT12, data );	break;
+		case 13 : 	DMIOWrite32( E2P_WDAT13, data );	break;
+		case 14 : 	DMIOWrite32( E2P_WDAT14, data );	break;
+		case 15 : 	DMIOWrite32( E2P_WDAT15, data );	break;
+	}	
+	
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){	ans = 2;	break;	} ;	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	UnlockCodeClear();							// Unlock Code Clear
+	
+	return(ans);
+
+} 
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: ReadE2Prom
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+void ReadE2Prom( unsigned char address, unsigned char * val )
+{
+	UINT32 UlReadVal;
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_ASCNT, 0 );		// Count Number
+	DMIOWrite32( E2P_CMD, 1 ); 			// Re-Program
+	// Read Exe
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_RDAT );
+	RamRead32A ( CMD_IO_DAT_ACCESS, &UlReadVal );			// Read Access
+	
+	*val = (unsigned char)UlReadVal;
+}
+
+//********************************************************************************
+// Function Name 	: BurstReadE2Prom
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+void BurstReadE2Prom( unsigned char address, unsigned char * val, unsigned char cnt )
+{
+	UINT32 UlReadVal;
+	unsigned char i;
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_ASCNT, (cnt -1) );		// Count Number
+	DMIOWrite32( E2P_CMD, 1 ); 			// Re-Program
+	// Read Exe
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_RDAT );
+	for(i=0; i<cnt; i++ ){
+		RamRead32A ( CMD_IO_DAT_ACCESS, &UlReadVal );			// Read Access
+		val[i] = (unsigned char)UlReadVal;
+	}
+}
+
+
+//********************************************************************************
+// Function Name 	: E2PromVerificationONSEMI
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8 E2PromVerificationONSEMI( void )
+{
+	UINT32 Verify;
+	UINT8 cnt;
+	UINT8 temp[16];
+
+	// Create Checksum
+	Verify = 0;
+	BurstReadE2Prom( EEPROM_ONSEMI_LDO , temp, E2P_ONSEMI_AREA_SIZE );
+	for( cnt= 0 ; cnt <(E2P_ONSEMI_AREA_SIZE -1); cnt++ ){
+		Verify += temp[cnt];
+	}
+	if ( (UINT8)Verify != temp[ (E2P_ONSEMI_AREA_SIZE -1) ])	return( FAILURE );
+
+	return( SUCCESS	 );
+}
+
+//********************************************************************************
+// Function Name 	: E2PromVerificationONSEMI
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8 E2PromVerification( void )
+{
+	UINT32 Verify;
+	UINT8 cnt;
+	UINT8 temp[ E2P_USER_AREA_SIZE ];
+
+	// Create Checksum
+	Verify = 0;
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL , temp, E2P_USER_AREA_SIZE );
+	for( cnt= 0; cnt < (E2P_USER_AREA_SIZE -1); cnt++ ){
+		Verify += temp[cnt];
+	}
+	if ( (UINT8)Verify != temp[ (E2P_USER_AREA_SIZE-1) ])	return( FAILURE );
+	return( SUCCESS	 );
+}
+
+//********************************************************************************
+// Function Name 	: WrI2cSlaveAddr
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+extern unsigned char I2cSlvAddrWr;
+
+UINT8 WrI2cSlaveAddr( unsigned char Addr )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans;
+
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if( Addr == 0x74 ) {
+		DMIOWrite32( E2P_WDAT00, 0x7F );		// IDSEL(Slave Addr = 0x74)
+	} else {
+		DMIOWrite32( E2P_WDAT00, 0xFF );		// IDSEL(Slave Addr = 0x7C)
+	}
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	return( 0 );
+}
+
+
+//********************************************************************************
+// Function Name 	: WrHallCalData
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrHallCalData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	StAdjPar.StHalAdj.UlAdjPhs |= ( (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~( HALL_CALB_FLG | HALL_CALB_BIT )) ); 
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if ( I2cSlvAddrWr == 0x7C ) {
+		DMIOWrite32( E2P_WDAT00, 0xF7 );									// IDSEL
+	} else {
+		DMIOWrite32( E2P_WDAT00, 0x77 );									// IDSEL
+	}
+
+	DMIOWrite32( E2P_WDAT08, (UINT8)((StAdjPar.StHalAdj.UlAdjPhs)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((StAdjPar.StHalAdj.UlAdjPhs)>>MSB ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)((StAdjPar.StHalAdj.UsHlxMxa)>>LSB ) ); // OIS Hall X Max After
+	DMIOWrite32( E2P_WDAT11, (UINT8)((StAdjPar.StHalAdj.UsHlxMxa)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)((StAdjPar.StHalAdj.UsHlxMna)>>LSB ) ); // OIS Hall X Min After	
+	DMIOWrite32( E2P_WDAT13, (UINT8)((StAdjPar.StHalAdj.UsHlxMna)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, (UINT8)((StAdjPar.StHalAdj.UsHlyMxa)>>LSB ) ); // OIS Hall Y Max After
+	DMIOWrite32( E2P_WDAT15, (UINT8)((StAdjPar.StHalAdj.UsHlyMxa)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x20-0x2F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x20 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)((StAdjPar.StHalAdj.UsHlyMna)>>LSB ) ); // OIS Hall Y Min After
+	DMIOWrite32( E2P_WDAT01, (UINT8)((StAdjPar.StHalAdj.UsHlyMna)>>MSB ) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)((StAdjPar.StHalAdj.UsHlxGan)>>8 ) );		// OIS Hall Bias X
+	DMIOWrite32( E2P_WDAT03, (UINT8)((StAdjPar.StHalAdj.UsHlxOff)>>8 ) );		// OIS Hall Offset X
+	DMIOWrite32( E2P_WDAT04, (UINT8)((StAdjPar.StHalAdj.UsHlyGan)>>8 ) );		// OIS Hall Bias Y
+	DMIOWrite32( E2P_WDAT05, (UINT8)((StAdjPar.StHalAdj.UsHlyOff)>>8 ) );		// OIS Hall Offset Y
+	DMIOWrite32( E2P_WDAT06, (UINT8)((StAdjPar.StLopGan.UlLxgVal)>>16  ) );	// OIS Hall Loop Gain X
+	DMIOWrite32( E2P_WDAT07, (UINT8)((StAdjPar.StLopGan.UlLxgVal)>>24  ) );	// OIS Hall Loop Gain X
+	DMIOWrite32( E2P_WDAT08, (UINT8)((StAdjPar.StLopGan.UlLygVal)>>16  ) );   // OIS Hall Loop Gain Y
+	DMIOWrite32( E2P_WDAT09, (UINT8)((StAdjPar.StLopGan.UlLygVal)>>24  ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)((StAdjPar.StHalAdj.UsAdxOff)>>LSB ) );   // OIS Mecha center X
+	DMIOWrite32( E2P_WDAT11, (UINT8)((StAdjPar.StHalAdj.UsAdxOff)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)((StAdjPar.StHalAdj.UsAdyOff)>>LSB ) ); 	// OIS Mecha center Y
+	DMIOWrite32( E2P_WDAT13, (UINT8)((StAdjPar.StHalAdj.UsAdyOff)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, 0xFF );	//GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT15, 0xFF );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x32) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, 0xFF );	// GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT01, 0x3F );
+	DMIOWrite32( E2P_WDAT02, 0xFF );	//	GyroFilterTableY_gyzoom
+	DMIOWrite32( E2P_WDAT03, 0xFF );
+	DMIOWrite32( E2P_WDAT04, 0xFF );
+	DMIOWrite32( E2P_WDAT05, 0x3F );	
+	
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 5 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+#if 0
+	DMIOWrite32( E2P_ADR, 0x50 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT06, 0 );	// OIS gyro offset X
+	DMIOWrite32( E2P_WDAT07, (UINT8)(HALLCROSSXX>>16) );	// CrossXX lower Byte
+	DMIOWrite32( E2P_WDAT08, (UINT8)(HALLCROSSXX>>24) );	// CrossXX Higher Byte
+	DMIOWrite32( E2P_WDAT09, (UINT8)(HALLCROSSXY>>16) );	// CrossXY lower Byte
+	DMIOWrite32( E2P_WDAT10, (UINT8)(HALLCROSSXY>>24) );	// CrossXY Higher Byte
+	DMIOWrite32( E2P_WDAT11, (UINT8)(HALLCROSSYY>>16) );	// CrossYY lower Byte
+	DMIOWrite32( E2P_WDAT12, (UINT8)(HALLCROSSYY>>24) );	// CrossYY Higher Byte
+	DMIOWrite32( E2P_WDAT13, (UINT8)(HALLCROSSYX>>16) );	// CrossYX lower Byte
+	DMIOWrite32( E2P_WDAT14, (UINT8)(HALLCROSSYX>>24) );	// CrossYX Higher Byte
+	DMIOWrite32( E2P_WDAT15, HALLCROSSXSHIFT );	// CrsXsft
+	DMIOWrite32( E2P_WDAT10, HALLCROSSYSHIFT );	// CrsYsft
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+#endif
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+#if 0
+	DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, CH2SEL );	// DrvY direction 
+	DMIOWrite32( E2P_WDAT01, CH3SEL );	// DrvZ direction 
+	DMIOWrite32( E2P_WDAT02, (UINT8)(AF_FST_FREQ)      );	// AfFreq
+	DMIOWrite32( E2P_WDAT03, (UINT8)(AF_FST_FREQ>>8)   );	// AfFreq
+	DMIOWrite32( E2P_WDAT04, (UINT8)(AF_FST_UCOEF>>16) );	// AfUcode
+	DMIOWrite32( E2P_WDAT05, (UINT8)(AF_FST_UCOEF>>24) );	// AfUcode
+	DMIOWrite32( E2P_WDAT06, (UINT8)(AF_FST_DCOEF>>16) );	// AfDcode
+	DMIOWrite32( E2P_WDAT07, (UINT8)(AF_FST_DCOEF>>24) );	// AfDcode
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+#endif
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+
+} 
+//********************************************************************************
+// Function Name 	: WrGyroGainData
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: NON
+// Explanation		: Flash Write Hall Calibration Data Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrGyroGainData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	UINT32	UlZoomX, UlZoomY;
+
+	// Read the Gyro Gain value
+	RamRead32A(  GyroFilterTableX_gxzoom , &UlZoomX ) ;
+	RamRead32A(  GyroFilterTableY_gyzoom , &UlZoomY ) ;
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~GYRO_GAIN_FLG) ; 
+		
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+//	DMIOWrite32( E2P_WDAT00,  );	// IDSEL	
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x20-0x2F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x20 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT14, (UINT8)(UlZoomX>>0) );//GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT15, (UINT8)(UlZoomX>>8) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x3F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)(UlZoomX>>16) );
+	DMIOWrite32( E2P_WDAT01, (UINT8)(UlZoomX>>24) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)(UlZoomY>>0) );	//	GyroFilterTableY_gyzoom
+	DMIOWrite32( E2P_WDAT03, (UINT8)(UlZoomY>>8) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)(UlZoomY>>16) );
+	DMIOWrite32( E2P_WDAT05, (UINT8)(UlZoomY>>24) );	
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+		
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return(ans);
+}
+
+#if 0
+//********************************************************************************
+// Function Name 	: WrGyroGainData_NV
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: UlReadValX: gyro gain X, UlReadValY: gyro gain Y
+// Explanation		: Flash Write Hall Calibration Data Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrGyroGainData_NV( UINT32 UlReadValX , UINT32 UlReadValY )
+{
+
+}
+#endif
+
+
+#ifdef	ZERO_SERVO
+//********************************************************************************
+// Function Name 	: WrZeroServoData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Flash Write Zero Servo data Function
+// History			: First edition 									2016.9.5
+//********************************************************************************
+UINT8	WrZeroServoData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~ZSRV_CAL_FLG) ; 
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x3F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT01, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT02, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT03, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT04, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT05, (UINT8)(  );
+	DMIOWrite32( E2P_WDAT06, (UINT8)( ((StZeroServoX.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT07, (UINT8)( ((StZeroServoX.SlOffset)>>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT08, (UINT8)( ((StZeroServoX.SlShift) >> 0)>>LSB ) );
+	DMIOWrite32( E2P_WDAT09, (UINT8)( ((StZeroServoX.SlShift) >> 0)>>MSB ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)( ((StZeroServoX.SlGcora) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT11, (UINT8)( ((StZeroServoX.SlGcora) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)( ((StZeroServoX.SlGaina) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT13, (UINT8)( ((StZeroServoX.SlGaina) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, (UINT8)( ((StZeroServoY.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT15, (UINT8)( ((StZeroServoY.SlOffset)>>16)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 4 (0x40-0x4F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x40 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)( ((StZeroServoY.SlShift) >> 0)>>LSB ) );
+	DMIOWrite32( E2P_WDAT01, (UINT8)( ((StZeroServoY.SlShift) >> 0)>>MSB ) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)( ((StZeroServoY.SlGcora) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT03, (UINT8)( ((StZeroServoY.SlGcora) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)( ((StZeroServoY.SlGaina) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT05, (UINT8)( ((StZeroServoY.SlGaina) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT06, (UINT8)( ((StZeroServoZ.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT07, (UINT8)( ((StZeroServoZ.SlOffset)>>16)>>MSB ) );
+//	DMIOWrite32( E2P_WDAT08, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT09, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT10, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT11, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT12, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT13, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT14, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT15, (UINT8)(  );
+
+	DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+
+#endif	//ZERO_SERVO
+
+//********************************************************************************
+// Function Name 	: WrAfParameter
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: SelectAct
+// Explanation		: Flash Write Af paramter Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrAfParameter( UINT8 SelectAct )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt;
+	UINT32 ReadVerify, Parity;
+	AF_PARA* AfParaPtr;
+	// Select parameter
+	
+	if( SelectAct == ACT_SO2821 ){
+		AfParaPtr = (AF_PARA*)&SO2821_OpenAfParameter;
+	}else{
+		return( 7 );	/* Error */
+	}
+
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+//	DMIOWrite32( E2P_WDAT00,  );	// IDSEL	
+	DMIOWrite32( E2P_WDAT01, (UINT8)( AfParaPtr->DrvDir )); 					// Af driver direction
+	DMIOWrite32( E2P_WDAT02, (UINT8)((AfParaPtr->Rrmd1ToMacro)>>LSB ) ); 	// Af rrmd1 para to macro
+	DMIOWrite32( E2P_WDAT03, (UINT8)((AfParaPtr->Rrmd1ToMacro)>>MSB ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)((AfParaPtr->Rrmd1ToInfini)>>LSB ) ); 	// Af rrmd1 para to inf
+	DMIOWrite32( E2P_WDAT05, (UINT8)((AfParaPtr->Rrmd1ToInfini)>>MSB ) );
+	DMIOWrite32( E2P_WDAT06, (UINT8)((AfParaPtr->Freq)>>LSB ) ); 			// Af freq
+	DMIOWrite32( E2P_WDAT07, (UINT8)((AfParaPtr->Freq)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+		
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	DMIOWrite32( DRVCH3SEL,				(UINT32)AfParaPtr->DrvDir ); 					// Af driver direction
+	RamWrite32A( OLAF_COEF_FSTVAL0,		((UINT32)AfParaPtr->Rrmd1ToMacro)<<16  ); 		// Af rrmd1 para to macro
+	RamWrite32A( OLAF_COEF_FSTVAL1,		((UINT32)AfParaPtr->Rrmd1ToInfini)<<16 ); 		// Af rrmd1 para to inf
+	RamWrite32A( OLAF_COEF_FSTVAL2, 	(UINT32)AfParaPtr->Freq ); 						// Af freq
+	RamWrite32A( OLAF_DMB_FT, 			(UINT32)AfParaPtr->Freq ); 						// Af freq
+	
+	return(ans);
+}
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: WrHallLnData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: EEPROM Write Hall Linearity data Function
+// History			: First edition 									2017.6.27
+//********************************************************************************
+UINT8	WrHallLnData(  UINT8 UcMode, mlLinearityValue *linval )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	double		*pPosX, *pPosY;
+	UINT32	PosDifX, PosDifY;
+	DSPVER Info;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	if( UcMode ){
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~HLLN_CALB_FLG) ; 
+	}else{
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) | (HLLN_CALB_FLG) ; 
+	}
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+//------------------------------------------------------------------------------------------------
+// Page 4 (0x40-0x4F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x40 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+	if( UcMode ){
+
+		if( Info.ActType == ACT_SO2821 ){
+		//(XYSWAP == 0)
+			pPosX = linval->positionX;
+			pPosY = linval->positionY;
+		}else{
+		//(XYSWAP == 1)
+			pPosX = linval->positionX;
+			pPosY = linval->positionY;
+		}
+
+	//	DMIOWrite32( E2P_WDAT00, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT01, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)(  ) );
+		DMIOWrite32( E2P_WDAT08, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS1 X
+		DMIOWrite32( E2P_WDAT09, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;	
+		DMIOWrite32( E2P_WDAT10, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS1 Y
+		DMIOWrite32( E2P_WDAT11, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+		DMIOWrite32( E2P_WDAT12, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS2 X
+		DMIOWrite32( E2P_WDAT13, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+		DMIOWrite32( E2P_WDAT14, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS2 Y
+		DMIOWrite32( E2P_WDAT15, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+	}else{
+		DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );		// POS1 X
+		DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );		
+		DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );		// POS1 Y
+		DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );	
+		DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );		// POS2 X
+		DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );	
+		DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );		// POS2 Y
+		DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );	
+	}
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 5 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+			DMIOWrite32( E2P_ADR, 0x50 );	// Start Address
+			DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+			
+		if( UcMode ){
+			DMIOWrite32( E2P_WDAT00, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS3 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT02, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS3 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT04, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS4 X
+			DMIOWrite32( E2P_WDAT05, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT06, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS4 Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT08, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS5 X
+			DMIOWrite32( E2P_WDAT09, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT10, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS5 Y
+			DMIOWrite32( E2P_WDAT11, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT12, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS6 X
+			DMIOWrite32( E2P_WDAT13, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT14, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS6 Y
+			DMIOWrite32( E2P_WDAT15, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+		}else{
+			DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );	// POS3 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT02, (UINT8)0xFF );	// POS3 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT04, (UINT8)0xFF );	// POS4 X
+			DMIOWrite32( E2P_WDAT05, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT06, (UINT8)0xFF );	// POS4 Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );	// POS5 X
+			DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );	// POS5 Y
+			DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );	// POS6 X
+			DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );	// POS6 Y
+			DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );
+		}
+			DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+			WitTim( 20 ) ;
+			UlCnt=0;
+			do{
+				if( UlCnt++ > 10 ){
+					UnlockCodeClear();							// Unlock Code Clear
+					return( 4 );	
+				}	
+				RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+				RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+			}while ( (UlReadVal & 0x00000080) != 0 );
+			
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x60-0x6F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+		if( UcMode ){
+			DMIOWrite32( E2P_WDAT00, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS7 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );
+			DMIOWrite32( E2P_WDAT02, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS7 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );
+
+			if( Info.ActType == ACT_SO2821 ){
+			//(XYSWAP == 0)
+				PosDifX = (linval->dacX[1] - linval->dacX[0]); 
+				PosDifY = (linval->dacY[1] - linval->dacY[0]); 
+			}else{
+			//(XYSWAP == 0)
+				PosDifX = (linval->dacX[1] - linval->dacX[0]); 
+				PosDifY = (linval->dacY[1] - linval->dacY[0]); 
+			}
+
+			DMIOWrite32( E2P_WDAT04, (UINT8)( (UINT16)(PosDifX>>16)>>LSB ) );				// STEP X
+			DMIOWrite32( E2P_WDAT05, (UINT8)( (UINT16)(PosDifX>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT06, (UINT8)( (UINT16)(PosDifY>>16)>>LSB ) );				// STEP Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)( (UINT16)(PosDifY>>16)>>MSB ) );
+		}else{
+			DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );				// POS7 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT02, (UINT8)0xFF );				// POS7 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT04, (UINT8)0xFF );				// STEP X
+			DMIOWrite32( E2P_WDAT05, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT06, (UINT8)0xFF );				// STEP Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)0xFF );
+		}
+	//	DMIOWrite32( E2P_WDAT08, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT09, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT10, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT11, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT12, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT13, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT14, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT15, (UINT8)( ) );
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+
+//********************************************************************************
+// Function Name 	: WrMixCalData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: EEPROM Writecross talk data Function
+// History			: First edition 									2017.6.27
+//********************************************************************************
+UINT8	WrMixCalData(  UINT8 UcMode, mlMixingValue *mixval )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	DSPVER Info;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	if( UcMode ){
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~MIXI_CALB_FLG) ; 
+	}else{
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) | (MIXI_CALB_FLG) ; 
+	}
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x60-0x6F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+	//	DMIOWrite32( E2P_WDAT00, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT01, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)( ) );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+	
+#if 0
+	if( Info.ActType == ACT_SO2821 ){
+		
+		mixval->hx45yL = (-1)*mixval->hx45yL;
+		mixval->hy45xL = (-1)*mixval->hy45xL;
+	
+		if(mixval->hy45yL<0){			/* for MeasurementLibrary 1.X */
+			mixval->hy45yL = (-1)*mixval->hy45yL;
+			mixval->hx45yL = (-1)*mixval->hx45yL;
+		}
+	}
+#endif
+//*****************************************************//
+//	if( XYSTPDIR == 0x10 || XYSTPDIR == 0x01  ){
+//		mixval->hx45yL = (-1)*mixval->hx45yL;
+//		mixval->hy45xL = (-1)*mixval->hy45xL;
+//	}
+//****************************************************//
+	
+	if( UcMode ){
+		if( Info.ActType == ACT_SO2821 ){
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT08, (UINT8)(( mixval->hx45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT09, (UINT8)(( mixval->hx45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT10, (UINT8)(( mixval->hx45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT11, (UINT8)(( mixval->hx45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT12, (UINT8)(( mixval->hy45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT13, (UINT8)(( mixval->hy45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT14, (UINT8)(( mixval->hy45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT15, (UINT8)(( mixval->hy45xL>>16)>>MSB ) );
+		}else{
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT08, (UINT8)(( mixval->hx45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT09, (UINT8)(( mixval->hx45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT10, (UINT8)(( mixval->hx45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT11, (UINT8)(( mixval->hx45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT12, (UINT8)(( mixval->hy45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT13, (UINT8)(( mixval->hy45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT14, (UINT8)(( mixval->hy45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT15, (UINT8)(( mixval->hy45xL>>16)>>MSB ) );
+		}
+	}else{
+		DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );
+	}
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if( UcMode ){
+		if( Info.ActType == ACT_SO2821 ){
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT00, (UINT8)( mixval->hxsx ) );
+			DMIOWrite32( E2P_WDAT01, (UINT8)( mixval->hysx ) );
+		}else{
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT00, (UINT8)( mixval->hxsx ) );
+			DMIOWrite32( E2P_WDAT01, (UINT8)( mixval->hysx ) );
+		}
+	}else{
+		DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+	}
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT08, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT09, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT10, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT11, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT12, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT13, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT14, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT15, (UINT8)( ) );
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//	}
+	
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+//********************************************************************************
+// Function Name 	: WrOptOffsetData
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write opt offset data to E2Prom
+// History			: First edition
+//********************************************************************************
+UINT8	WrOptOffsetData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt;
+	UINT32 ReadVerify, Parity;
+
+	UINT32	UlHxoff;
+	UINT32	UlHyoff;
+	
+	RamRead32A( ZeroServoRAM_X_OUT , &UlHxoff ) ;	// ZeroServoRAM_X_OUT // 0x03BC
+	RamRead32A( ZeroServoRAM_Y_OUT , &UlHyoff ) ;	// ZeroServoRAM_Y_OUT // 0x03D4
+//	UlHxoff = 0xFFFFFFFF;
+//	UlHyoff = 0xFFFFFFFF;
+
+TRACE("UlHxoff = %08X\n", UlHxoff);
+TRACE("UlHyoff = %08X\n", UlHyoff);
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) {
+		TRACE("Error 1 \n");
+		return ( 1 );							// Unlock Code Set
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x72-0x75) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT02, (UINT8)((UlHxoff)>>(16+LSB) ) );   // optical center X
+	DMIOWrite32( E2P_WDAT03, (UINT8)((UlHxoff)>>(16+MSB) ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)((UlHyoff)>>(16+LSB) ) ); 	// optical center Y
+	DMIOWrite32( E2P_WDAT05, (UINT8)((UlHyoff)>>(16+MSB) ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+TRACE("Error 2 \n");
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+TRACE("Error 3 \n");
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity){
+TRACE("Error 4 \n");
+			return( 6 );  
+	}
+	
+TRACE("Pass All \n");
+	return( 0 );
+
+} 
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/HighLevelCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/HighLevelCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..8769cd915ace59bdd199224b3a34d7014d6a8d20
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/HighLevelCmd.c
@@ -0,0 +1,1978 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//	    Program Name	: OisCmd.c
+//		Design			: Y.Shigoeka
+//		History			: First edition						
+//********************************************************************************
+//**************************
+//	Include Header File		
+//**************************
+#include	"Ois.h"
+#include	<stdlib.h>
+#include	<math.h>
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+extern UINT8 GetInfomationAfterDownload( DSPVER* Info );
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+extern void BurstReadE2Prom( UINT8 startaddress, UINT8* val, UINT8 cnt );
+extern void ReadE2Prom( unsigned char address, unsigned char * val );
+//**************************
+//	STRICT
+//**************************
+typedef struct {
+	INT32				SiSampleNum ;			// Measure Sample Number
+	INT32				SiSampleMax ;			// Measure Sample Number Max
+
+	struct {
+		INT32			SiMax1 ;				// Max Measure Result
+		INT32			SiMin1 ;				// Min Measure Result
+		UINT32	UiAmp1 ;				// Amplitude Measure Result
+		INT64		LLiIntegral1 ;			// Integration Measure Result
+		INT64		LLiAbsInteg1 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam1 ;			// Measure Delay RAM Address
+	} MeasureFilterA ;
+
+	struct {
+		INT32			SiMax2 ;				// Max Measure Result
+		INT32			SiMin2 ;				// Min Measure Result
+		UINT32	UiAmp2 ;				// Amplitude Measure Result
+		INT64		LLiIntegral2 ;			// Integration Measure Result
+		INT64		LLiAbsInteg2 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam2 ;			// Measure Delay RAM Address
+	} MeasureFilterB ;
+} MeasureFunction_Type ;
+
+//**************************
+//	Local Function LIST
+//**************************
+void	MesFil( UINT8 ) ;									// Measure Filter Setting
+void	ClrMesFil( void );
+void	MeasureStart( INT32 , UINT32 , UINT32 ) ;				// Measure Start Function
+void	MeasureWait( void ) ;								// Measure Wait
+void	MemoryClear( UINT16 , UINT16 ) ;					// Memory Cloear
+void	SetWaitTime( UINT16 ) ; 							// Set Wait Timer
+void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans );
+
+void	OisEnaNCL( void );
+void	OisEnaDrCl( void );
+void	OisEnaDrNcl( void );
+void	OisDis( void );
+void	SetRec( void );
+void	SetStill( void );
+
+UINT8	MesRam( INT32 , INT32 , INT32 , stMesRam* , stMesRam* );
+
+UINT8	RdStatus( UINT8 UcStBitChk );
+void	MeasureStart2( INT32 SlMeasureParameterNum , INT32 SlMeasureParameterA , INT32 SlMeasureParameterB , UINT16 UsTime );
+void	MesFil2( UINT16	UsMesFreq )	;
+void	SetLinearityParameter( void );
+void	SetGyroCoef( UINT8 );
+void	SetAccelCoef( UINT8 );
+
+extern	stAclVal	StAclVal ;				//!< Execute Command Parameter
+
+//**************************
+//	define					
+//**************************
+#define 	ONE_MSEC_COUNT	18			// 18.0288kHz * 18 �à 1ms
+
+//#define 	HALL_ADJ		0
+#define 	LOOPGAIN		1
+#define 	THROUGH			2
+#define 	NOISE			3
+#define		OSCCHK			4
+
+#define		CNT050MS		 676
+#define		CNT100MS		1352
+#define		CNT200MS		2703
+
+//********************************************************************************
+// Function Name 	: SetTregAf
+// Retun Value		: 
+// Argment Value	: Min:000h Max:7FFh (11bit) in the case of Bi-direction
+// Argment Value	: Min:000h Max:3FFh (10bit) in the case of Uni-direction
+// Explanation		: 
+// History			: First edition 						2014.06.19 T.Tokoro
+//********************************************************************************
+void	SetTregAf( UINT16 UsTregAf )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+
+	RamWrite32A( CMD_AF_POSITION,	UsTregAf| 0x00010000 ) ;		// bit 16 : FST mode
+	while( UcStRd && ( UlStCnt++ < CNT050MS) ) {
+		UcStRd = RdStatus(1);
+	}
+TRACE("SetTregAf( status , cnt ) = %02x , %08x\n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: PreparationForPowerOff
+// Retun Value		: 
+// Argment Value	: 
+// Explanation		: 
+// History			: First edition 						
+//********************************************************************************
+void PreparationForPowerOff( void )
+{
+	UINT32 UlReadVa;
+	DSPVER Dspcode;
+		
+	/* SPI communication pending */
+	RamRead32A ( (GYRO_RAM_GYRO_AF_Switch & 0xFFFC), &UlReadVa );
+	RamWrite32A( (GYRO_RAM_GYRO_AF_Switch & 0xFFFC), (UlReadVa|0x00008000) );
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVa );
+	if ( UlReadVa == 0x01 ){
+		/* Normal Ram program execution */
+		GetInfomationAfterDownload( &Dspcode );
+		switch ( Dspcode.GyroType ){
+		case GYRO_LSM6DSM:
+			/* Gyro SPI disable command set for ST by secondary SPI*/
+			RamWrite32A( CMD_GYRO_WR_ACCS, 0x70000000 );
+		 	break;
+		} 
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MesFil
+// Retun Value		: NON
+// Argment Value	: Measure Filter Mode
+// Explanation		: Measure Filter Setting Function
+// History			: First edition 		
+//********************************************************************************
+void	MesFil( UINT8	UcMesMod )		// 20.019kHz
+{
+	UINT32	UlMeasFilaA , UlMeasFilaB , UlMeasFilaC ;
+	UINT32	UlMeasFilbA , UlMeasFilbB , UlMeasFilbC ;
+
+	if( !UcMesMod ) {								// Hall Bias&Offset Adjust
+		
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF 150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+		
+	} else if( UcMesMod == LOOPGAIN ) {				// Loop Gain Adjust
+
+		UlMeasFilaA	=	0x12FEA055 ;	// LPF1000Hz
+		UlMeasFilaB	=	0x12FEA055 ;
+		UlMeasFilaC	=	0x5A02BF55 ;
+		UlMeasFilbA	=	0x7F559791 ;	// HPF30Hz
+		UlMeasFilbB	=	0x80AA686F ;
+		UlMeasFilbC	=	0x7EAB2F23 ;
+		
+	} else if( UcMesMod == THROUGH ) {				// for Through
+
+		UlMeasFilaA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilaB	=	0x00000000 ;
+		UlMeasFilaC	=	0x00000000 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+
+	} else if( UcMesMod == NOISE ) {				// SINE WAVE TEST for NOISE
+
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilbB	=	0x0342AD4D ;
+		UlMeasFilbC	=	0x797AA565 ;
+
+	} else if(UcMesMod == OSCCHK) {
+		UlMeasFilaA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilaB	=	0x065BE349 ;
+		UlMeasFilaC	=	0x7348396D ;
+		UlMeasFilbA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilbB	=	0x065BE349 ;
+		UlMeasFilbC	=	0x7348396D ;
+	}
+	
+	RamWrite32A ( MeasureFilterA_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A ( MeasureFilterA_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c2	, UlMeasFilbC ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c2	, UlMeasFilbC ) ;
+}
+
+//********************************************************************************
+// Function Name 	: ClrMesFil
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Clear Measure Filter Function
+// History			: First edition 						
+//********************************************************************************
+void	ClrMesFil( void )
+{
+	RamWrite32A ( MeasureFilterA_Delay_z11	, 0 ) ;
+	RamWrite32A ( MeasureFilterA_Delay_z12	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterA_Delay_z21	, 0 ) ;
+	RamWrite32A ( MeasureFilterA_Delay_z22	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterB_Delay_z11	, 0 ) ;
+	RamWrite32A ( MeasureFilterB_Delay_z12	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterB_Delay_z21	, 0 ) ;
+	RamWrite32A ( MeasureFilterB_Delay_z22	, 0 ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetWaitTime
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Set Timer wait Function
+// History			: First edition 						
+//********************************************************************************
+void	SetWaitTime( UINT16 UsWaitTime )
+{
+	RamWrite32A( WaitTimerData_UiWaitCounter	, 0 ) ;
+	RamWrite32A( WaitTimerData_UiTargetCount	, (UINT32)(ONE_MSEC_COUNT * UsWaitTime)) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetTransDataAdr
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Trans Address for Data Function
+// History			: First edition 						
+//********************************************************************************
+void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans )
+{
+	UnDwdVal	StTrsVal ;
+	
+	if( UlLowAdrBeforeTrans < 0x00009000 ){
+		StTrsVal.UlDwdVal = UlLowAdrBeforeTrans ;
+	}else{
+		StTrsVal.StDwdVal.UsHigVal = (UINT16)(( UlLowAdrBeforeTrans & 0x0000F000 ) >> 8 ) ;
+		StTrsVal.StDwdVal.UsLowVal = (UINT16)( UlLowAdrBeforeTrans & 0x00000FFF ) ;
+	}
+//TRACE(" TRANS  ADR = %04xh , DAT = %08xh \n",UsLowAddress , StTrsVal.UlDwdVal ) ;
+	RamWrite32A( UsLowAddress	,	StTrsVal.UlDwdVal );
+	
+}
+
+//********************************************************************************
+// Function Name 	: MemoryClear
+// Retun Value		: NON
+// Argment Value	: Top pointer , Size
+// Explanation		: Memory Clear Function
+// History			: First edition 						
+//********************************************************************************
+void	MemoryClear( UINT16 UsSourceAddress, UINT16 UsClearSize )
+{
+	UINT16	UsLoopIndex ;
+
+	for ( UsLoopIndex = 0 ; UsLoopIndex < UsClearSize ; UsLoopIndex += 4 ) {
+		RamWrite32A( UsSourceAddress + UsLoopIndex	, 	0x00000000 ) ;				// 4Byte
+//TRACE("MEM CLR ADR = %04xh \n",UsSourceAddress + UsLoopIndex) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureStart( INT32 SlMeasureParameterNum , UINT32 SlMeasureParameterA , UINT32 SlMeasureParameterB )
+{
+	MemoryClear( StMeasFunc_SiSampleNum , sizeof( MeasureFunction_Type ) ) ;
+	RamWrite32A( StMeasFunc_MFA_SiMax1	 , 0x80000000 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFB_SiMax2	 , 0x80000000 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFA_SiMin1	 , 0x7FFFFFFF ) ;					// Set Max 
+	RamWrite32A( StMeasFunc_MFB_SiMin2	 , 0x7FFFFFFF ) ;					// Set Max 
+	
+	SetTransDataAdr( StMeasFunc_MFA_PiMeasureRam1	 , SlMeasureParameterA ) ;		// Set Measure Filter A Ram Address
+	SetTransDataAdr( StMeasFunc_MFB_PiMeasureRam2	 , SlMeasureParameterB ) ;		// Set Measure Filter B Ram Address
+	RamWrite32A( StMeasFunc_SiSampleNum	 , 0 ) ;													// Clear Measure Counter 
+	ClrMesFil() ;						// Clear Delay Ram
+//	SetWaitTime(50) ;
+	SetWaitTime(1) ;
+	RamWrite32A( StMeasFunc_SiSampleMax	 , SlMeasureParameterNum ) ;						// Set Measure Max Number
+
+}
+	
+//********************************************************************************
+// Function Name 	: MeasureWait
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Wait complete of Measure Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureWait( void )
+{
+	UINT32			SlWaitTimerSt ;
+	
+	SlWaitTimerSt = 1 ;
+	while( SlWaitTimerSt ){
+		RamRead32A( StMeasFunc_SiSampleMax , &SlWaitTimerSt ) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: set the gyro offset data. before do this before Remapmain.
+// History			: First edition 						
+//********************************************************************************
+void	SetGyroOffset( UINT16 GyroOffsetX, UINT16 GyroOffsetY, UINT16 GyroOffsetZ )
+{
+	RamWrite32A( GYRO_RAM_GXOFFZ , (( GyroOffsetX << 16 ) & 0xFFFF0000 ) ) ;		// X axis Gyro offset
+	RamWrite32A( GYRO_RAM_GYOFFZ , (( GyroOffsetY << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+	RamWrite32A( GYRO_RAM_GZOFFZ , (( GyroOffsetZ << 16 ) & 0xFFFF0000 ) ) ;		// Z axis Gyro offset
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStart( void )	
+{
+	MesFil( THROUGH ) ;								// Set Measure Filter
+	MeasureStart( GYROF_NUM , GYRO_RAM_GX_ADIDAT , GYRO_RAM_GY_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStartZ
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStartZ( void )	
+{
+	MesFil( THROUGH ) ;								// Set Measure Filter
+	MeasureStart( GYROF_NUM , GYRO_RAM_GZ_ADIDAT , GYRO_RAM_GZ_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	: GetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: get the gyro offset adjustment result
+// History			: First edition 						
+//********************************************************************************
+UINT8 GetGyroOffset( UINT16* GyroOffsetX, UINT16* GyroOffsetY, INT16 GYROF_UPPER, INT16 GYROF_LOWER   )
+{
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	INT32			SlMeasureMaxValue , SlMeasureMinValue ;
+	UINT32 UlReadVal, UlCnt=0;
+	UINT8 ans=0;
+
+	// Wait complete of measurement
+	do{
+		if( UlCnt++ > 100 ){
+			/* timeout error */
+			*GyroOffsetX = 0;
+			*GyroOffsetY = 0;
+			return( 3 );
+		}
+		RamRead32A( StMeasFunc_SiSampleMax , &UlReadVal ) ;
+	}while ( UlReadVal != 0 );
+	
+	RamRead32A( StMeasFunc_MFA_SiMax1 , ( UINT32 * )&SlMeasureMaxValue ) ;	// Max value
+	RamRead32A( StMeasFunc_MFA_SiMin1 , ( UINT32 * )&SlMeasureMinValue ) ;	// Min value
+	if (SlMeasureMaxValue == SlMeasureMinValue )
+	{
+		return( 3 ); 
+	}
+	
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+	SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / GYROF_NUM ) ;
+	SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / GYROF_NUM ) ;
+	
+	SlMeasureAveValueA = ( SlMeasureAveValueA >> 16 ) & 0x0000FFFF ;
+	SlMeasureAveValueB = ( SlMeasureAveValueB >> 16 ) & 0x0000FFFF ;
+	// EP1‚Å‚Í”½“]�ˆ—�‚µ‚È‚¢�B
+//	SlMeasureAveValueA = 0x00010000 - SlMeasureAveValueA ;
+//	SlMeasureAveValueB = 0x00010000 - SlMeasureAveValueB ;
+	
+	*GyroOffsetX = ( UINT16 )( SlMeasureAveValueA & 0x0000FFFF );		//Measure Result Store
+	*GyroOffsetY = ( UINT16 )( SlMeasureAveValueB & 0x0000FFFF );		//Measure Result Store
+
+	if(( (INT16)(*GyroOffsetX) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetX) < GYROF_LOWER )){
+		ans |= 1; 
+	}
+	if(( (INT16)(*GyroOffsetY) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetY) < GYROF_LOWER )){
+		ans |= 2; 
+	}
+
+	return( ans ); 
+}
+
+#ifdef	SEL_SHIFT_COR
+//********************************************************************************
+// Function Name 	: SetAcclOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: set the accl offset data. before do this before Remapmain.
+// History			: First edition 						
+//********************************************************************************
+void	SetAcclOffset( UINT16 AcclOffsetX, UINT16 AcclOffsetY, UINT16 AcclOffsetZ )
+{
+	RamWrite32A( ZeroServoRAM_X_OFFSET , ( ( AcclOffsetX << 16 ) & 0xFFFF0000 ) ) ;		// X axis Accl offset
+	RamWrite32A( ZeroServoRAM_Y_OFFSET , ( ( AcclOffsetY << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Accl offset
+	RamWrite32A( ZeroServoRAM_Z_OFFSET , ( ( AcclOffsetZ << 16 ) & 0xFFFF0000 ) ) ;		// Z axis Accl offset
+}
+
+//********************************************************************************
+// Function Name 	: GetAcclOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: get the accl offset adjustment result
+// History			: First edition 						
+//********************************************************************************
+void	GetAcclOffset( UINT16* AcclOffsetX, UINT16* AcclOffsetY, UINT16* AcclOffsetZ )
+{
+	*AcclOffsetX = ( UINT16 )( StAclVal.StAccel.SlOffsetX & 0x0000FFFF );
+	*AcclOffsetY = ( UINT16 )( StAclVal.StAccel.SlOffsetY & 0x0000FFFF );
+	*AcclOffsetZ = ( UINT16 )( StAclVal.StAccel.SlOffsetZ & 0x0000FFFF );	
+}
+#endif	//SEL_SHIFT_COR
+
+//********************************************************************************
+// Function Name 	: RtnCen
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Return to center Command Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	RtnCen( UINT8	UcCmdPar )
+{
+	UINT8	UcSndDat = 1 ;
+	UINT32	UlStCnt = 0;
+	
+	if( !UcCmdPar ){								// X,Y centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , BOTH_SRV_ON ) ;
+	}else if( UcCmdPar == XONLY_ON ){				// only X centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , XAXS_SRV_ON ) ;
+	}else if( UcCmdPar == YONLY_ON ){				// only Y centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , YAXS_SRV_ON ) ;
+	}else{											// Both off
+		RamWrite32A( CMD_RETURN_TO_CENTER , BOTH_SRV_OFF ) ;
+	}
+	
+	while( UcSndDat && (UlStCnt++ < CNT200MS )) {
+		UcSndDat = RdStatus(1);
+	}
+TRACE("RtnCen( cmd , status , cnt ) = %02x , %02x , %08x \n", UcCmdPar , UcSndDat , (int)UlStCnt ) ;
+	return( UcSndDat );
+}
+
+
+
+//********************************************************************************
+// Function Name 	: ZsvCnt
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Zero servo control Command Function
+// History			: First edition
+//********************************************************************************
+UINT8	ZscCnt( UINT8	UcCmdPar )
+{
+	UINT8	UcSndDat = 1 ;
+	UINT32	UlStCnt = 0;
+
+TRACE("ZscCnt(%02x) = ", UcCmdPar ) ;
+	if( !UcCmdPar ){								// Zero servo off
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_DISABLE ) ;
+	}else if( UcCmdPar == 1 ){						// Zero servo on
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_ENABLE ) ;
+	}else if( UcCmdPar == 3 ){						// Zero servo hold
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_HOLD ) ;
+	}else{
+		return( 2 );
+	}
+	
+	while( UcSndDat && (UlStCnt++ < CNT050MS )) {
+		UcSndDat = RdStatus(1);
+	}
+TRACE("ZscCnt( cmd , status , cnt ) = %02x , %02x , %08x \n", UcCmdPar , UcSndDat , (int)UlStCnt ) ;
+	
+	return( UcSndDat );
+}
+
+//********************************************************************************
+// Function Name 	: OisEna
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function
+// History			: First edition 						
+//********************************************************************************
+void	OisEna( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEna( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaNCL
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaNCL( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_NCL | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaNCL( Status , cnt ) = %02x %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaDrCl
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaDrCl( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_DOF | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaDrCl( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaDrNcl
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaDrNcl( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_DOF | OIS_ENA_NCL | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaDrCl( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+//********************************************************************************
+// Function Name 	: OisDis
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Disable Control Function
+// History			: First edition 						
+//********************************************************************************
+void	OisDis( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_DISABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisDis( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SscEna
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Ssc Enable Control Function
+// History			: First edition
+//********************************************************************************
+void	SscEna( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+
+	RamWrite32A( CMD_SSC_ENABLE , SSC_ENABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SscEna( Status) = %02x\n", UcStRd ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SscDis
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Ssc Disable Control Function
+// History			: First edition
+//********************************************************************************
+void	SscDis( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+
+	RamWrite32A( CMD_SSC_ENABLE , SSC_DISABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SscDis( Status) = %02x\n", UcStRd ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetRec
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Rec Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetRec( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetRec( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetStill
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Set Still Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetStill( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetStill( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetRecPreview
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Rec Preview Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetRecPreview( UINT8 mode )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch( mode ){
+	case 0:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE ) ;
+		break;
+	case 1:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE1 ) ;
+		break;
+	case 2:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE2 ) ;
+		break;
+	case 3:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE3 ) ;
+		break;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetRec( %02x )( status , cnt ) = %02x , %08x , \n", mode , UcStRd ,(int)UlStCnt ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetStillPreview
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Set Still Preview Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetStillPreview( unsigned char mode )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch( mode ){
+	case 0:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE ) ;
+		break;
+	case 1:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE1 ) ;
+		break;
+	case 2:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE2 ) ;
+		break;
+	case 3:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE3 ) ;
+		break;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetStill( %02x )( status , cnt ) = %02x , %08x \n", mode , UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetPanTiltMode
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Pan-Tilt Enable/Disable
+// History			: First edition 						
+//********************************************************************************
+void	SetPanTiltMode( UINT8 UcPnTmod )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch ( UcPnTmod ) {
+		case OFF :
+			RamWrite32A( CMD_PAN_TILT ,	PAN_TILT_OFF ) ;
+//TRACE(" PanTilt OFF\n");
+			break ;
+		case ON :
+			RamWrite32A( CMD_PAN_TILT ,	PAN_TILT_ON ) ;
+//TRACE(" PanTilt ON\n");
+			break ;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" PanTilt( Status , mode , cnt ) = %02x , %02x , %08x \n", UcStRd , UcPnTmod , (int)UlStCnt ) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: AfStbyRls
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Af Standby release Command Function
+// History			: First edition
+//********************************************************************************
+UINT8	AfStbyRls( void )
+{
+
+TRACE("AfStbyRls \n" ) ;
+	DMIOWrite32( SYSDSP_STBOTH, 0x00000C00 );	
+	
+	return( SUCCESS );
+}
+
+//********************************************************************************
+// Function Name 	: RdStatus
+// Retun Value		: 0:success 1:FAILURE
+// Argment Value	: bit check  0:ALL  1:bit24
+// Explanation		: High level status check Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	RdStatus( UINT8 UcStBitChk )
+{
+	UINT32	UlReadVal ;
+	
+	RamRead32A( CMD_READ_STATUS , &UlReadVal );
+//TRACE(" (Rd St) = %08x\n", (unsigned INT16)UlReadVal ) ;
+	if( UcStBitChk ){
+		UlReadVal &= READ_STATUS_INI ;
+	}
+	if( !UlReadVal ){
+		return( SUCCESS );
+	}else{
+		return( FAILURE );
+	}
+}
+
+
+//********************************************************************************
+// Function Name 	: SetSinWavGenInt
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Sine wave generator initial Function
+// History			: First edition 						
+//********************************************************************************
+void	SetSinWavGenInt( void )
+{
+	
+	RamWrite32A( SinWave_Offset		,	0x00000000 ) ;		// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+	RamWrite32A( SinWave_Phase		,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+	RamWrite32A( SinWave_Gain		,	0x00000000 ) ;		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚Í0[dB])
+//	RamWrite32A( SinWave_Gain		,	0x7FFFFFFF ) ;		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚ÍCut)
+//	SetTransDataAdr( SinWave_OutAddr	,	(UINT32)SinWave_Output ) ;		// �‰Šú’l‚Ì�o—Í�æƒAƒhƒŒƒX‚Í�AŽ©•ª‚̃�ƒ“ƒo
+
+	RamWrite32A( CosWave_Offset		,	0x00000000 );		// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+	RamWrite32A( CosWave_Phase 		,	0x00000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	RamWrite32A( CosWave_Gain 		,	0x00000000 );		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚ÍCut)
+//	RamWrite32A( CosWave_Gain 		,	0x7FFFFFFF );		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚Í0[dB])
+//	SetTransDataAdr( CosWave_OutAddr	,	(UINT32)CosWave_Output );		// �‰Šú’l‚Ì�o—Í�æƒAƒhƒŒƒX‚Í�AŽ©•ª‚̃�ƒ“ƒo
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+}
+
+
+//********************************************************************************
+// Function Name 	: TstActMov
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Hall Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+// #define		ACT_CHK_LVL		0x33320000		// 0.4
+ #define		ACT_CHK_FRQ		0x00074528		// 4Hz
+ #define		ACT_CHK_NUM		4507			// 18.0288/0.004 
+ #define		ACT_THR			0x000003E8		// 20dB 10*100
+ #define		ACT_MARGIN		0.75f			// 
+ 
+UINT8	TstActMov( UINT8 UcDirSel )
+{
+	UINT8	UcRsltSts = 0;
+	INT32	SlMeasureParameterNum ;
+	INT32	SlMeasureParameterA , SlMeasureParameterB ;
+	UnllnVal	StMeasValueA  , StMeasValueB ;
+	float		SfLimit , Sfzoom , Sflenz , Sfshift ;
+	UINT32		UlLimit , Ulzoom , Ullenz , Ulshift , UlActChkLvl ;
+	UINT8		i;
+	UINT32		UlReturnVal;
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		RamRead32A( Gyro_Limiter_X 			, ( UINT32 * )&UlLimit ) ;	// 
+		RamRead32A( GyroFilterTableX_gxzoom , ( UINT32 * )&Ulzoom ) ;	// 
+		RamRead32A( GyroFilterTableX_gxlenz , ( UINT32 * )&Ullenz ) ;	// 
+		RamRead32A( Gyro_ShiftX_RG 			, ( UINT32 * )&Ulshift ) ;	// 
+	}else{
+		RamRead32A( Gyro_Limiter_Y 			, ( UINT32 * )&UlLimit ) ;	// 
+		RamRead32A( GyroFilterTableY_gyzoom , ( UINT32 * )&Ulzoom ) ;	// 
+		RamRead32A( GyroFilterTableY_gylenz , ( UINT32 * )&Ullenz ) ;	// 
+		RamRead32A( Gyro_ShiftY_RG 			, ( UINT32 * )&Ulshift ) ;	// 
+	}
+
+TRACE(" DIR = %d, lmt = %08x, zom = %08x , lnz = %08x ,sft = %08x \n", UcDirSel, (unsigned int)UlLimit , (unsigned int)Ulzoom , (unsigned int)Ullenz , (unsigned int)Ulshift  ) ;
+
+	SfLimit = (float)UlLimit / (float)0x7FFFFFFF;
+	if( Ulzoom == 0){
+		Sfzoom = 0;
+	}else{
+		Sfzoom = (float)abs(Ulzoom) / (float)0x7FFFFFFF;
+	}
+	if( Ullenz == 0){
+		Sflenz = 0;
+	}else{
+		Sflenz = (float)Ullenz / (float)0x7FFFFFFF;
+	}
+	Ulshift = ( Ulshift & 0x0000FF00) >> 8 ;	// 2X4XB
+	Sfshift = 1;
+	for( i = 0 ; i < Ulshift ; i++ ){
+		Sfshift *= 2;
+	}
+	UlActChkLvl = (UINT32)( (float)0x7FFFFFFF * SfLimit * Sfzoom * Sflenz * Sfshift * ACT_MARGIN );
+//TRACE(" lvl = %08x \n", (unsigned int)UlActChkLvl  ) ;
+
+	SlMeasureParameterNum	=	ACT_CHK_NUM ;
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXOUT0 ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HXDAZ1 ;		// Set Measure RAM Address
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYOUT0 ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HYDAZ1 ;		// Set Measure RAM Address
+	}
+	SetSinWavGenInt();
+	
+	RamWrite32A( SinWave_Offset		,	ACT_CHK_FRQ ) ;				// Freq Setting = Freq * 80000000h / Fs	: 5Hz
+	RamWrite32A( SinWave_Gain		,	UlActChkLvl ) ;				// Set Sine Wave Gain
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;				// Sine Wave Start
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;	// Set Sine Wave Input RAM
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;	// Set Sine Wave Input RAM
+	}
+	MesFil( NOISE ) ;					// ‘ª’è—pƒtƒBƒ‹ƒ^�[‚ð�Ý’è‚·‚é�B
+
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+
+	UlReturnVal = (INT32)((INT64)StMeasValueA.UllnValue * 100 / (INT64)StMeasValueB.UllnValue  ) ;
+
+
+TRACE(" Ret = %d \n", (unsigned int)UlReturnVal ) ;
+
+	
+	UcRsltSts = EXE_END ;
+	if( UlReturnVal < ACT_THR ){
+		if ( !UcDirSel ) {					// AXIS X
+			UcRsltSts = EXE_HXMVER ;
+		}else{								// AXIS Y
+			UcRsltSts = EXE_HYMVER ;
+		}
+	}
+
+	return( UcRsltSts ) ;
+
+}
+//********************************************************************************
+// Function Name 	: RunHea
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Hall Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+UINT8	RunHea( void )
+{
+	UINT8 	UcRst ;
+	UcRst = EXE_END ;
+	UcRst |= TstActMov( X_DIR) ;
+	UcRst |= TstActMov( Y_DIR) ;
+	
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	return( UcRst ) ;
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: RunGea
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+#define 	GEA_NUM		512			// 512times
+// #define		GEA_DIF_HIG		0x0062			// 2021_32.8lsb/�‹/s    max 3.0�‹/s-p-p
+ #define		GEA_DIF_HIG		0x0057			// 2030_87.5lsb/�‹/s    max 1.0�‹/s-p-p
+ #define		GEA_DIF_LOW		0x0001				// Gyro Examination of Acceptance
+ 
+UINT8	RunGea( void )
+{
+	UnllnVal	StMeasValueA , StMeasValueB ;
+	INT32		SlMeasureParameterA , SlMeasureParameterB ;
+	UINT8 		UcRst, UcCnt, UcXLowCnt, UcYLowCnt, UcXHigCnt, UcYHigCnt ;
+	UINT16		UsGxoVal[10], UsGyoVal[10], UsDif;
+	INT32		SlMeasureParameterNum , SlMeasureAveValueA , SlMeasureAveValueB ;
+
+	
+	UcRst = EXE_END ;
+	UcXLowCnt = UcYLowCnt = UcXHigCnt = UcYHigCnt = 0 ;
+	
+	MesFil( THROUGH ) ;				// ‘ª’è—pƒtƒBƒ‹ƒ^�[‚ð�Ý’è‚·‚é�B
+	
+	for( UcCnt = 0 ; UcCnt < 10 ; UcCnt++ )
+	{
+		//•½‹Ï’l‘ª’è
+	
+		MesFil( THROUGH ) ;					// Set Measure Filter
+
+		SlMeasureParameterNum	=	GEA_NUM ;					// Measurement times
+		SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+		
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+		MeasureWait() ;					// Wait complete of measurement
+	
+//TRACE("Read Adr = %04x, %04xh \n",StMeasFunc_MFA_LLiIntegral1 + 4 , StMeasFunc_MFA_LLiIntegral1) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+//TRACE("GX_OFT = %08x, %08xh \n",(unsigned int)StMeasValueA.StUllnVal.UlHigVal,(unsigned int)StMeasValueA.StUllnVal.UlLowVal) ;
+//TRACE("GY_OFT = %08x, %08xh \n",(unsigned int)StMeasValueB.StUllnVal.UlHigVal,(unsigned int)StMeasValueB.StUllnVal.UlLowVal) ;
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+//TRACE("GX_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+//TRACE("GY_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+		// X
+		UsGxoVal[UcCnt] = (UINT16)( SlMeasureAveValueA >> 16 );	// •½‹Ï’l‘ª’è
+		
+		// Y
+		UsGyoVal[UcCnt] = (UINT16)( SlMeasureAveValueB >> 16 );	// •½‹Ï’l‘ª’è
+		
+//TRACE("UcCnt = %02x, UsGxoVal[UcCnt] = %04x\n", UcCnt, UsGxoVal[UcCnt] ) ;
+//TRACE("UcCnt = %02x, UsGyoVal[UcCnt] = %04x\n", UcCnt, UsGyoVal[UcCnt] ) ;
+		
+		
+		if( UcCnt > 0 )
+		{
+			if ( (INT16)UsGxoVal[0] > (INT16)UsGxoVal[UcCnt] ) {
+				UsDif = (UINT16)((INT16)UsGxoVal[0] - (INT16)UsGxoVal[UcCnt]) ;
+			} else {
+				UsDif = (UINT16)((INT16)UsGxoVal[UcCnt] - (INT16)UsGxoVal[0]) ;
+			}
+			
+			if( UsDif > GEA_DIF_HIG ) {
+				//UcRst = UcRst | EXE_GXABOVE ;
+				UcXHigCnt ++ ;
+			}
+			if( UsDif < GEA_DIF_LOW ) {
+				//UcRst = UcRst | EXE_GXBELOW ;
+				UcXLowCnt ++ ;
+			}
+//TRACE("CNT = %02x  ,  X diff = %04x ", UcCnt , UsDif ) ;
+			
+			if ( (INT16)UsGyoVal[0] > (INT16)UsGyoVal[UcCnt] ) {
+				UsDif = (UINT16)((INT16)UsGyoVal[0] - (INT16)UsGyoVal[UcCnt]) ;
+			} else {
+				UsDif = (UINT16)((INT16)UsGyoVal[UcCnt] - (INT16)UsGyoVal[0]) ;
+			}
+			
+			if( UsDif > GEA_DIF_HIG ) {
+				//UcRst = UcRst | EXE_GYABOVE ;
+				UcYHigCnt ++ ;
+			}
+			if( UsDif < GEA_DIF_LOW ) {
+				//UcRst = UcRst | EXE_GYBELOW ;
+				UcYLowCnt ++ ;
+			}
+//TRACE("  Y diff = %04x \n", UsDif ) ;
+		}
+	}
+	
+	if( UcXHigCnt >= 1 ) {
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( UcXLowCnt > 8 ) {
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	
+	if( UcYHigCnt >= 1 ) {
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+	if( UcYLowCnt > 8 ) {
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	
+	return( UcRst ) ;
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: GetGyroWhoAmI
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Get Gyro Who Am I
+// History			: First edition 						
+//********************************************************************************
+void GetGyroWhoAmI( UINT8 * UcWho )
+{
+	UINT32	UlVal ;
+	
+	RamWrite32A( 0xF01D , 0x75000000 ) ;
+	WitTim( 5 ) ;
+	
+	RamRead32A( 0xF01D , &UlVal ) ;
+//TRACE("%08x \n", UlVal );
+	
+	*UcWho = (UINT8)( UlVal >> 24 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: GetGyroID
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Get Gyro ID
+// History			: First edition 						
+//********************************************************************************
+void GetGyroID( UINT8 * UcGid )
+{
+	UINT32	UlCnt;
+	UINT32	UlVal;
+	
+	for( UlCnt = 0; UlCnt < 8; UlCnt++ ){
+		RamWrite32A( 0xF01E, 0x6D000000 ) ;
+		WitTim( 5 ) ;
+		
+		RamWrite32A( 0xF01E, ( 0x6E000000 | ( UlCnt << 16 ) ) ) ;
+		WitTim( 5 ) ;
+		
+		RamWrite32A( 0xF01D, 0x6F000000 ) ;
+		WitTim( 5 ) ;
+		
+		RamRead32A( 0xF01D, &UlVal ) ;
+//TRACE("%08x \n", UlVal );
+		
+		WitTim( 5 ) ;
+		UcGid[UlCnt] = (UINT8)( UlVal >> 24 ) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: GyroSleep
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Sleep Control
+// History			: First edition 						
+//********************************************************************************
+void GyroSleep( UINT8 UcCtrl )
+{
+	UINT8	UcReg;
+	UINT32	UlVal;
+	
+	RamWrite32A( 0xF01D, 0x6B000000 ) ;
+	WitTim( 5 ) ;
+	
+	RamRead32A( 0xF01D, &UlVal ) ;
+	WitTim( 5 ) ;
+	
+	UcReg = (UINT8)( UlVal >> 24 ) ;
+	
+	if( UcCtrl == ON ){
+		UcReg = UcReg | 0x40;	// Bit6(SLEEP) ON
+	}
+	else if( UcCtrl == OFF ){
+		UcReg = UcReg & 0xBF;	// Bit6(SLEEP) OFF
+	}
+	
+	RamWrite32A( 0xF01E, ( 0x6B000000 | ( UcReg << 16 ) ) ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MesRam
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure 
+// History			: First edition 						2015.07.06 
+//********************************************************************************
+UINT8	 MesRam( INT32 SlMeasureParameterA, INT32 SlMeasureParameterB, INT32 SlMeasureParameterNum, stMesRam* pStMesRamA, stMesRam* pStMesRamB )
+{
+	UnllnVal	StMeasValueA , StMeasValueB ;
+	
+	MesFil( THROUGH ) ;							// Set Measure Filter
+	
+	MeasureStart( SlMeasureParameterNum,  SlMeasureParameterA, SlMeasureParameterB	) ;		// Start measure
+	
+	MeasureWait() ;								// Wait complete of measurement
+	
+	// A : X axis
+	RamRead32A( StMeasFunc_MFA_SiMax1 , &(pStMesRamA->SlMeasureMaxValue) ) ;			// Max value
+	RamRead32A( StMeasFunc_MFA_SiMin1 , &(pStMesRamA->SlMeasureMinValue) ) ;			// Min value
+	RamRead32A( StMeasFunc_MFA_UiAmp1 , &(pStMesRamA->SlMeasureAmpValue) ) ;			// Amp value
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1,	 &(StMeasValueA.StUllnVal.UlLowVal) ) ;	// Integration Low
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &(StMeasValueA.StUllnVal.UlHigVal) ) ;	// Integration Hig
+	pStMesRamA->SlMeasureAveValue = 
+				(INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;	// Ave value
+	
+	// B : Y axis
+	RamRead32A( StMeasFunc_MFB_SiMax2 , &(pStMesRamB->SlMeasureMaxValue) ) ;			// Max value
+	RamRead32A( StMeasFunc_MFB_SiMin2 , &(pStMesRamB->SlMeasureMinValue) ) ;			// Min value
+	RamRead32A( StMeasFunc_MFB_UiAmp2 , &(pStMesRamB->SlMeasureAmpValue) ) ;			// Amp value
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2,	 &(StMeasValueB.StUllnVal.UlLowVal) ) ;	// Integration Low
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &(StMeasValueB.StUllnVal.UlHigVal) ) ;	// Integration Hig
+	pStMesRamB->SlMeasureAveValue = 
+				(INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;	// Ave value
+	
+	return( 0 );
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: RunGea2
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+#define 	GEA_NUM2		2048			// 2048times
+// level of judgement
+#define		GEA_MAX_LVL		0x0A41			// 2030_87.5lsb/�‹/s    max 30�‹/s-p-p
+#define		GEA_MIN_LVL		0x1482			// 2030_87.5lsb/�‹/s    min 60�‹/s-p-p
+UINT8	RunGea2( UINT8 UcMode )
+{
+	INT32	SlMeasureParameterA , SlMeasureParameterB ;
+	UINT8 	UcRst ;
+	UINT16	UsGyrXval , UsGyrYval;
+	INT32	SlMeasureParameterNum ;
+	UINT8	UcStRd;
+	UINT32	UlSwRd , UlGyroConfig ; //, UlGyCnt;
+	
+	stMesRam 		StMesRamA ;
+	stMesRam 		StMesRamB ;
+	
+	UcRst = EXE_END ;
+	
+	OisDis() ;
+	
+	RamRead32A( GYRO_RAM_GYRO_Switch , &UlSwRd);
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlSwRd & 0xFFFFFFFC ) ;
+	
+	RamWrite32A( CMD_GYRO_RD_ACCS , 0x1B000000 );
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	RamRead32A( CMD_GYRO_RD_ACCS , &UlGyroConfig );		/* FS_SEL backup */
+//TRACE("GYCONFIG = %08x \n",(UINT32)UlGyroConfig ) ;
+
+////////// ////////// ////////// ////////// //////////
+
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1B180000 );		/* FS_SEL=3΁Տ & Disable Self Test */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+	SlMeasureParameterNum	=	GEA_NUM2 ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+	
+	MesRam( SlMeasureParameterA, SlMeasureParameterB, SlMeasureParameterNum, &StMesRamA, &StMesRamB );
+	
+	if( UcMode == GEA_MINMAX_MODE ){	// min, max mode
+		
+//TRACE("GX [max] = %08x, [min] = %08xh \n", (unsigned int)StMesRamA.SlMeasureMaxValue, (unsigned int)StMesRamA.SlMeasureMinValue) ;
+//TRACE("GY [max] = %08x, [min] = %08xh \n", (unsigned int)StMesRamB.SlMeasureMaxValue, (unsigned int)StMesRamB.SlMeasureMinValue) ;
+
+//TRACE("ABS_GX [max] = %08x, [min] = %08xh \n", (unsigned int)abs(StMesRamA.SlMeasureMaxValue), (unsigned int)abs(StMesRamA.SlMeasureMinValue)) ;
+//TRACE("ABS_GY [max] = %08x, [min] = %08xh \n", (unsigned int)abs(StMesRamB.SlMeasureMaxValue), (unsigned int)abs(StMesRamB.SlMeasureMinValue)) ;
+		
+		// X
+		if( abs(StMesRamA.SlMeasureMaxValue) >= abs(StMesRamA.SlMeasureMinValue) ) {
+			UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureMaxValue) >> 16 );		// max value
+		}
+		else{
+			UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureMinValue) >> 16 );		// max value
+		}
+		
+		// Y
+		if( abs(StMesRamB.SlMeasureMaxValue) >= abs(StMesRamB.SlMeasureMinValue) ) {
+			UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureMaxValue) >> 16 );		// max value
+		}
+		else{
+			UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureMinValue) >> 16 );		// max value
+		}
+		
+	}
+	else{								// mean mode
+		
+//TRACE("GX [ave] = %08xh \n", (UINT32)StMesRamA.SlMeasureAveValue) ;
+//TRACE("GY [ave] = %08xh \n", (UINT32)StMesRamB.SlMeasureAveValue) ;
+		
+//TRACE("ABS_GX [ave] = %08xh \n", (UINT32)abs(StMesRamA.SlMeasureAveValue)) ;
+//TRACE("ABS_GY [ave] = %08xh \n", (UINT32)abs(StMesRamB.SlMeasureAveValue)) ;
+		
+		// X
+		UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureAveValue) >> 16 );		// ave value
+		
+		// Y
+		UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureAveValue) >> 16 );		// ave value
+		
+	}
+		
+//TRACE("UsGyrXval = %04x\n", UsGyrXval ) ;
+//TRACE("UsGyrYval = %04x\n", UsGyrYval ) ;
+		
+	if( UsGyrXval > GEA_MAX_LVL ) {
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( UsGyrYval > GEA_MAX_LVL ) {
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+	
+	if( StMesRamA.SlMeasureMinValue == StMesRamA.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( StMesRamB.SlMeasureMinValue == StMesRamB.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+
+////////// ////////// ////////// ////////// //////////
+
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1BD80000 );		/* FS_SEL=3΁Տ & Enable Self Test */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+	WitTim( 50 ) ;					/* 50ms*/
+	
+	SlMeasureParameterNum	=	GEA_NUM2 ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+
+	MesRam( SlMeasureParameterA, SlMeasureParameterB, SlMeasureParameterNum, &StMesRamA, &StMesRamB );
+
+	if( UcMode == GEA_MINMAX_MODE ){	// min, max mode
+
+//TRACE("GX [max] = %08x, [min] = %08xh \n", (UINT32)StMesRamA.SlMeasureMaxValue, (UINT32)StMesRamA.SlMeasureMinValue) ;
+//TRACE("GY [max] = %08x, [min] = %08xh \n", (UINT32)StMesRamB.SlMeasureMaxValue, (UINT32)StMesRamB.SlMeasureMinValue) ;
+
+		// X
+		UsGyrXval = (UINT16)( StMesRamA.SlMeasureMinValue >> 16 );		// min value
+		
+		// Y
+		UsGyrYval = (UINT16)( StMesRamB.SlMeasureMinValue >> 16 );		// min value
+	
+	}
+	else{								// mean mode
+//TRACE("GX [ave] = %08xh \n", (UINT32)StMesRamA.SlMeasureAveValue) ;
+//TRACE("GY [ave] = %08xh \n", (UINT32)StMesRamB.SlMeasureAveValue) ;
+		
+		// X
+		UsGyrXval = (UINT16)( StMesRamA.SlMeasureAveValue >> 16 );		// ave value
+		
+		// Y
+		UsGyrYval = (UINT16)( StMesRamB.SlMeasureAveValue >> 16 );		// ave value
+		
+	}
+	
+//TRACE("UsGyrXval = %04x\n", UsGyrXval ) ;
+//TRACE("UsGyrYval = %04x\n", UsGyrYval ) ;
+	
+	if( UsGyrXval < GEA_MIN_LVL ) {
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	if( UsGyrYval < GEA_MIN_LVL ) {
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+	if( StMesRamA.SlMeasureMinValue == StMesRamA.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	if( StMesRamB.SlMeasureMinValue == StMesRamB.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1B000000 | ( UlGyroConfig >> 8));		/* Œ³‚Ì�Ý’è’l‚É–ß‚· */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+//TRACE("GYCONFIG = %08x \n",(UINT32)(0x1B000000 | ( UlGyroConfig >> 8)) ) ;
+	
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlSwRd | 0x00000001 ) ;
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	
+	return( UcRst ) ;
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: SetAngleCorrection
+// Retun Value		: True/Fail
+// Argment Value	: 
+// Explanation		: Angle Correction
+// History			: First edition
+//********************************************************************************
+/*  bit7  	HX GYR			Hall X  ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªGX?               0:GX  1:GY  */
+/*  bit6  	HX GYR pol		Hall X+ ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªX+‚ÆG+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit5  	HY GYR pol		Hall Y+ ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªY+‚ÆG+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit4  	GZ pol			Šî–{‹É�«‚ɑ΂µ‚ÄGyroZ�M�†‚ª“¯•ûŒü?            0:NEG 1:POS */
+/*  bit3  	HX ACL			Hall X  ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªAX?               0:AX  1:AY  */
+/*  bit2  	HX ACL pol		Hall X+ ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªX+‚ÆA+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit1  	HY ACL pol		Hall Y+ ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªY+‚ÆA+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit0  	AZ pol			Šî–{‹É�«‚ɑ΂µ‚ÄAcclZ�M�†‚ª“¯•ûŒü?            0:NEG 1:POS */
+                      //   top0�‹btm0�‹//
+const UINT8 PACT0Tbl[] = { 0xFF, 0xFF };	/* Dummy table */
+const UINT8 PACT1Tbl[] = { 0x20, 0xDF };	
+const UINT8 PACT2Tbl[] = { 0x26, 0xD9 };	/* ACT_45DEG */
+
+
+UINT8 SetAngleCorrection( float DegreeGap, UINT8 SelectAct, UINT8 Arrangement )
+{
+	double OffsetAngle = 0.0f;
+	INT32 Slgx45x = 0, Slgx45y = 0;
+	INT32 Slgy45y = 0, Slgy45x = 0;
+	
+//	INT32 Slgx45m = 0, Slgx45s = 0;
+//	INT32 Slgy45m = 0, Slgy45s = 0;
+	UINT8	UcCnvF = 0;
+
+	if( ( DegreeGap > 180.0f) || ( DegreeGap < -180.0f ) ) return ( 1 );
+	if( Arrangement >= 2 ) return ( 1 );
+
+/************************************************************************/
+/*      	Gyro angle correction										*/
+/************************************************************************/
+	switch(SelectAct) {
+		case ACT_45DEG :
+			OffsetAngle = (double)( 45.0f + DegreeGap ) * 3.141592653589793238 / 180.0f ;
+			UcCnvF = PACT2Tbl[ Arrangement ];
+			break;
+		case ACT_SO2821 :
+			OffsetAngle = (double)( DegreeGap ) * 3.141592653589793238 / 180.0f ;
+			UcCnvF = PACT1Tbl[ Arrangement ];
+			break;
+		default :
+			break;
+	}
+	
+	SetGyroCoef( UcCnvF );
+	SetAccelCoef( UcCnvF );
+
+	//***********************************************//
+	// Gyro & Accel rotation correction
+	// Zero Servo angle correction
+	//***********************************************//
+	Slgx45x = (INT32)( cos( OffsetAngle )*2147483647.0);
+	Slgx45y = (INT32)(-sin( OffsetAngle )*2147483647.0);
+	Slgy45y = (INT32)( cos( OffsetAngle )*2147483647.0);
+	Slgy45x = (INT32)( sin( OffsetAngle )*2147483647.0);
+	
+	RamWrite32A( GyroFilterTableX_gx45x , 			(UINT32)Slgx45x );
+	RamWrite32A( GyroFilterTableX_gx45y , 			(UINT32)Slgx45y );
+	RamWrite32A( GyroFilterTableY_gy45y , 			(UINT32)Slgy45y );
+	RamWrite32A( GyroFilterTableY_gy45x , 			(UINT32)Slgy45x );
+#ifdef ACCEL_SERVO
+	RamWrite32A( Accl45Filter_XAmain , 				(UINT32)Slgx45x );
+	RamWrite32A( Accl45Filter_XAsub  , 				(UINT32)Slgx45y );
+	RamWrite32A( Accl45Filter_YAmain , 				(UINT32)Slgy45y );
+	RamWrite32A( Accl45Filter_YAsub  , 				(UINT32)Slgy45x );
+#endif
+	
+#ifdef ZERO_SERVO
+	RamWrite32A( ZeroServoFilterTableX_g45main 	, 	(UINT32)Slgx45x );
+	RamWrite32A( ZeroServoFilterTableX_g45sub 	, 	(UINT32)Slgx45y );
+	RamWrite32A( ZeroServoFilterTableY_g45main 	, 	(UINT32)Slgy45y );
+	RamWrite32A( ZeroServoFilterTableY_g45sub 	, 	(UINT32)Slgy45x );
+#endif
+	
+	return ( 0 );
+}
+
+void	SetGyroCoef( UINT8 UcCnvF )
+{
+	INT32 Slgxx = 0, Slgxy = 0;
+	INT32 Slgyy = 0, Slgyx = 0;
+	INT32 Slgzp = 0;
+	/************************************************/
+	/*  signal convet								*/
+	/************************************************/
+	switch( UcCnvF & 0xE0 ){
+		/* HX <== GX , HY <== GY */
+	case 0x00:
+		Slgxx = 0x7FFFFFFF ;	Slgxy = 0x00000000 ;	Slgyy = 0x7FFFFFFF ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(NEG), HY<==GY(NEG)
+	case 0x20:
+		Slgxx = 0x7FFFFFFF ;	Slgxy = 0x00000000 ;	Slgyy = 0x80000001 ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(NEG), HY<==GY(POS)
+	case 0x40:
+		Slgxx = 0x80000001 ;	Slgxy = 0x00000000 ;	Slgyy = 0x7FFFFFFF ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(POS), HY<==GY(NEG)
+	case 0x60:
+		Slgxx = 0x80000001 ;	Slgxy = 0x00000000 ;	Slgyy = 0x80000001 ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(POS), HY<==GY(POS)
+		/* HX <== GY , HY <== GX */
+	case 0x80:
+		Slgxx = 0x00000000 ;	Slgxy = 0x7FFFFFFF ;	Slgyy = 0x00000000 ;	Slgyx = 0x7FFFFFFF ;	break;	//HX<==GY(NEG), HY<==GX(NEG)
+	case 0xA0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x7FFFFFFF ;	Slgyy = 0x00000000 ;	Slgyx = 0x80000001 ;	break;	//HX<==GY(NEG), HY<==GX(POS)
+	case 0xC0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x80000001 ;	Slgyy = 0x00000000 ;	Slgyx = 0x7FFFFFFF ;	break;	//HX<==GY(POS), HY<==GX(NEG)
+	case 0xE0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x80000001 ;	Slgyy = 0x00000000 ;	Slgyx = 0x80000001 ;	break;	//HX<==GY(NEG), HY<==GX(NEG)
+	}
+	switch( UcCnvF & 0x10 ){
+	case 0x00:
+		Slgzp = 0x7FFFFFFF ;	break;																			//GZ(POS)
+	case 0x10:
+		Slgzp = 0x80000001 ;	break;																			//GZ(NEG)
+	}
+	RamWrite32A( GCNV_XX , (UINT32)Slgxx );
+	RamWrite32A( GCNV_XY , (UINT32)Slgxy );
+	RamWrite32A( GCNV_YY , (UINT32)Slgyy );
+	RamWrite32A( GCNV_YX , (UINT32)Slgyx );
+	RamWrite32A( GCNV_ZP , (UINT32)Slgzp );
+}
+
+void	SetAccelCoef( UINT8 UcCnvF )
+{
+	INT32 Slaxx = 0, Slaxy = 0;
+	INT32 Slayy = 0, Slayx = 0;
+	INT32 Slazp = 0;
+	
+	switch( UcCnvF & 0x0E ){
+		/* HX <== AX , HY <== AY */
+	case 0x00:
+		Slaxx = 0x7FFFFFFF ;	Slaxy = 0x00000000 ;	Slayy = 0x7FFFFFFF ;	Slayx = 0x00000000 ;	break;	//HX<==AX(NEG), HY<==AY(NEG)
+	case 0x02:
+		Slaxx = 0x7FFFFFFF ;	Slaxy = 0x00000000 ;	Slayy = 0x80000001 ;	Slayx = 0x00000000 ;	break;	//HX<==AX(NEG), HY<==AY(POS)
+	case 0x04:
+		Slaxx = 0x80000001 ;	Slaxy = 0x00000000 ;	Slayy = 0x7FFFFFFF ;	Slayx = 0x00000000 ;	break;	//HX<==AX(POS), HY<==AY(NEG)
+	case 0x06:
+		Slaxx = 0x80000001 ;	Slaxy = 0x00000000 ;	Slayy = 0x80000001 ;	Slayx = 0x00000000 ;	break;	//HX<==AX(POS), HY<==AY(POS)
+		/* HX <== AY , HY <== AX */
+	case 0x08:
+		Slaxx = 0x00000000 ;	Slaxy = 0x7FFFFFFF ;	Slayy = 0x00000000 ;	Slayx = 0x7FFFFFFF ;	break;	//HX<==AY(NEG), HY<==AX(NEG)
+	case 0x0A:
+		Slaxx = 0x00000000 ;	Slaxy = 0x7FFFFFFF ;	Slayy = 0x00000000 ;	Slayx = 0x80000001 ;	break;	//HX<==AY(NEG), HY<==AX(POS)
+	case 0x0C:
+		Slaxx = 0x00000000 ;	Slaxy = 0x80000001 ;	Slayy = 0x00000000 ;	Slayx = 0x7FFFFFFF ;	break;	//HX<==AY(POS), HY<==AX(NEG)
+	case 0x0E:
+		Slaxx = 0x00000000 ;	Slaxy = 0x80000001 ;	Slayy = 0x00000000 ;	Slayx = 0x80000001 ;	break;	//HX<==AY(NEG), HY<==AX(NEG)
+	}
+	switch( UcCnvF & 0x01 ){
+	case 0x00:
+		Slazp = 0x7FFFFFFF ;	break;																			//AZ(POS)
+	case 0x01:
+		Slazp = 0x80000001 ;	break;																			//AZ(NEG)
+	}
+	RamWrite32A( ACNV_XX , (UINT32)Slaxx );
+	RamWrite32A( ACNV_XY , (UINT32)Slaxy );
+	RamWrite32A( ACNV_YY , (UINT32)Slayy );
+	RamWrite32A( ACNV_YX , (UINT32)Slayx );
+	RamWrite32A( ACNV_ZP , (UINT32)Slazp );
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroAccelCoef
+// Retun Value		: non
+// Argment Value	: 
+// Explanation		: Set Gyro Coef and Accel Coef
+// History			: First edition
+//********************************************************************************
+void SetGyroAccelCoef( UINT8 SelectAct ){
+
+	RamWrite32A( GCNV_XX , (UINT32)0x00000000 );
+	RamWrite32A( GCNV_XY , (UINT32)0x7FFFFFFF );
+	RamWrite32A( GCNV_YY , (UINT32)0x00000000 );
+	RamWrite32A( GCNV_YX , (UINT32)0x7FFFFFFF );
+	RamWrite32A( GCNV_ZP , (UINT32)0x7FFFFFFF );
+	
+	RamWrite32A( ACNV_XX , (UINT32)0x00000000 );
+	RamWrite32A( ACNV_XY , (UINT32)0x7FFFFFFF );
+	RamWrite32A( ACNV_YY , (UINT32)0x00000000 );
+	RamWrite32A( ACNV_YX , (UINT32)0x7FFFFFFF );
+	RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+}
+
+//********************************************************************************
+// Function Name 	: MeasGain
+// Retun Value		: Hall amp & Sine amp
+// Argment Value	: X,Y Direction, Freq
+// Explanation		: Measuring Hall Paek To Peak
+// History			: First edition 						
+//********************************************************************************
+#define	FS4TIME	(UINT32)0x000119B3		// 18028.8 * 4
+#define	FRQOFST	(UINT32)0x0001D14A		// 80000000h / 18028.8
+
+UINT32	MeasGain ( UINT16	UcDirSel, UINT16	UsMeasFreq , UINT32 UlMesAmp )
+{
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum , SlSineWaveOffset;
+	UnllnVal		StMeasValueA  , StMeasValueB ;
+	UINT32	UlReturnVal;
+
+	StMeasValueA.UllnValue = 0;
+	StMeasValueB.UllnValue = 0;
+	SlMeasureParameterNum	=	(INT32)( FS4TIME / (UINT32)UsMeasFreq) * 2;	// 
+	
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXOUT0 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HXDAZ1 ;	// Set Measure RAM Address
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYOUT0 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HYDAZ1 ;	// Set Measure RAM Address
+	}
+	SetSinWavGenInt();
+	
+	SlSineWaveOffset = (INT32)( FRQOFST * (UINT32)UsMeasFreq );
+	RamWrite32A( SinWave_Offset		,	SlSineWaveOffset ) ;		// Freq Setting = Freq * 80000000h / Fs	
+
+	RamWrite32A( SinWave_Gain		,	UlMesAmp ) ;			// Set Sine Wave Gain
+
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;				// Sine Wave Start
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;	// Set Sine Wave Input RAM
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;	// Set Sine Wave Input RAM
+	}
+	
+	MesFil2( UsMeasFreq ) ;					// Filter setting for measurement
+
+	MeasureStart2( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB , 8000/UsMeasFreq ) ;			// Start measure
+	
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}
+
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	
+	UlReturnVal = (INT32)((INT64)StMeasValueA.UllnValue * 100 / (INT64)StMeasValueB.UllnValue  ) ;
+
+
+	return( UlReturnVal ) ;
+}
+//********************************************************************************
+// Function Name 	: MesFil2
+// Retun Value		: NON
+// Argment Value	: Measure Filter Mode
+// Explanation		: Measure Filter Setting Function
+// History			: First edition 		
+//********************************************************************************
+#define	DivOffset	5741.65f		/* 18028.8/3.14 */
+
+void	MesFil2( UINT16	UsMesFreq )		
+{
+	UINT32	UlMeasFilA1 , UlMeasFilB1 , UlMeasFilC1 , UlTempval ;
+	UINT32	UlMeasFilA2 , UlMeasFilC2 ;
+		
+	UlTempval = (UINT32)(2147483647 * (float)UsMesFreq / ((float)UsMesFreq + DivOffset ));
+	UlMeasFilA1	=	0x7fffffff - UlTempval;
+	UlMeasFilB1	=	~UlMeasFilA1 + 0x00000001;	
+	UlMeasFilC1	=	0x7FFFFFFF - ( UlTempval << 1 ) ;
+
+	UlMeasFilA2	=	UlTempval ;	
+	UlMeasFilC2	=	UlMeasFilC1 ;
+
+	
+	RamWrite32A ( MeasureFilterA_Coeff_a1	, UlMeasFilA1 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b1	, UlMeasFilB1 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c1	, UlMeasFilC1 ) ;
+
+	RamWrite32A ( MeasureFilterA_Coeff_a2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c2	, UlMeasFilC2 ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a1	, UlMeasFilA1 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b1	, UlMeasFilB1 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c1	, UlMeasFilC1 ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c2	, UlMeasFilC2 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MeasureStart2
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureStart2( INT32 SlMeasureParameterNum , INT32 SlMeasureParameterA , INT32 SlMeasureParameterB , UINT16 UsTime )
+{
+	MemoryClear( StMeasFunc_SiSampleNum , sizeof( MeasureFunction_Type ) ) ;
+	RamWrite32A( StMeasFunc_MFA_SiMax1	 , 0x80000001 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFB_SiMax2	 , 0x80000001 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFA_SiMin1	 , 0x7FFFFFFF ) ;					// Set Max 
+	RamWrite32A( StMeasFunc_MFB_SiMin2	 , 0x7FFFFFFF ) ;					// Set Max 
+	
+	SetTransDataAdr( StMeasFunc_MFA_PiMeasureRam1	 , ( UINT32 )SlMeasureParameterA ) ;		// Set Measure Filter A Ram Address
+	SetTransDataAdr( StMeasFunc_MFB_PiMeasureRam2	 , ( UINT32 )SlMeasureParameterB ) ;		// Set Measure Filter B Ram Address
+	RamWrite32A( StMeasFunc_SiSampleNum	 , 0 ) ;													// Clear Measure Counter 
+	ClrMesFil() ;						// Clear Delay Ram
+	RamWrite32A( StMeasFunc_SiSampleMax	 , SlMeasureParameterNum ) ;						// Set Measure Max Number
+	SetWaitTime(UsTime) ;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: LinearityCalculation
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	LinearityCalculation( void )
+{
+	UINT8  tempL[32];
+//	UINT8  tempC[10];
+	UINT16 tblX[7],tblY[7];
+	INT16  stpx,stpy;
+//	UINT16 tblC[5];
+	UINT8	i,n,cnt;
+	UINT16  adr;
+	INT32	dacx[7],dacy[7];
+	INT16	pixx[7],pixy[7];
+	INT16	cfax[6],cfbx[6],cfzx[5];
+	INT16	cfay[6],cfby[6],cfzy[5];
+	float	cffax[6];
+	float	cffay[6];
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(HLLN_CALB_FLG>>8) );
+	if( cnt & (UINT8)(HLLN_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_POSITION_1X_LSB  , tempL, 32 );
+//	BurstReadE2Prom( EEPROM_CROSSTALK_XX_LSB , tempC, 10 );
+	
+TRACE("\n E2prom POSITION Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[0],tempL[1],tempL[2],tempL[3],tempL[4],tempL[5],tempL[6],tempL[7]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[8],tempL[9],tempL[10],tempL[11],tempL[12],tempL[13],tempL[14],tempL[15]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[16],tempL[17],tempL[18],tempL[19],tempL[20],tempL[21],tempL[22],tempL[23]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[24],tempL[25],tempL[26],tempL[27],tempL[28],tempL[29],tempL[30],tempL[31]) ;
+TRACE("\n E2prom CROSS TALK Read \n" );
+//TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3],tempC[4],tempC[5],tempC[6],tempC[7]) ;
+//TRACE(" %02xh %02xh \n",tempC[8],tempC[9]) ;
+
+	/****** Linearity ******/
+	for( i=0 , n=0 ; n<7 ; n++ ){
+		tblX[n] = tempL[i] + (tempL[i+1]<<8);
+		i += 2;
+		tblY[n] = tempL[i] + (tempL[i+1]<<8);
+		i += 2;
+	}
+	stpx = (INT16)(tempL[i] + (tempL[i+1]<<8));
+	i += 2;
+	stpy = (INT16)(tempL[i] + (tempL[i+1]<<8));
+TRACE("\n POSITION TBL \n" );
+TRACE("[x] %04xh %04xh %04xh %04xh %04xh %04xh %04xh \n",tblX[0],tblX[1],tblX[2],tblX[3],tblX[4],tblX[5],tblX[6]) ;
+TRACE("[y] %04xh %04xh %04xh %04xh %04xh %04xh %04xh \n",tblY[0],tblY[1],tblY[2],tblY[3],tblY[4],tblY[5],tblY[6]) ;
+TRACE("[s] %04xh %04xh \n",stpx,stpy) ;
+	
+	for( i=0 ; i<7 ; i++ ){
+		dacx[i] = (( i - 3 ) * stpx)<<4;	/* 2^16/4096 = 2^4 */
+		dacy[i] = (( i - 3 ) * stpy)<<4;	/* 2^16/4096 = 2^4 */
+		pixx[i] = tblX[i] - tblX[3];
+		pixy[i] = tblY[i] - tblY[3];
+	}
+	for( i=0 ; i<6 ; i++ ){
+		if(i == 3){
+//			cfax[i] = (INT16)((float)pixx[i+1] / (float)dacx[i+1] * 524287.0f);
+//			cfay[i] = (INT16)((float)pixy[i+1] / (float)dacy[i+1] * 524287.0f);
+			cffax[i] = ((float)pixx[i+1] / (float)dacx[i+1] * 524287.0f);
+			cffay[i] = ((float)pixy[i+1] / (float)dacy[i+1] * 524287.0f);
+			cfax[i] = (INT16)cffax[i];
+			cfay[i] = (INT16)cffay[i];
+			cfbx[i] = (INT16)0;
+			cfby[i] = (INT16)0;
+		}else{
+//			cfax[i] = (INT16)(( dacx[i] - dacx[i+1] ) / ( pixx[i] - pixx[i+1] ));
+//			cfay[i] = (INT16)(( dacy[i] - dacy[i+1] ) / ( pixy[i] - pixy[i+1] ));
+			cffax[i] = (float)( dacx[i] - dacx[i+1] ) / (float)( pixx[i] - pixx[i+1] );
+			cffay[i] = (float)( dacy[i] - dacy[i+1] ) / (float)( pixy[i] - pixy[i+1] );
+			cfax[i] = (INT16)cffax[i];
+			cfay[i] = (INT16)cffay[i];
+			if(i == 2){
+				cfbx[i] = (INT16)0;
+				cfby[i] = (INT16)0;
+			}else{
+//				cfbx[i] = (INT16)( dacx[i] - (INT32)cfax[i] * (INT32)pixx[i] );
+//				cfby[i] = (INT16)( dacy[i] - (INT32)cfay[i] * (INT32)pixy[i] );
+				cfbx[i] = (INT16)( (float)dacx[i] - cffax[i] * (float)pixx[i] );
+				cfby[i] = (INT16)( (float)dacy[i] - cffay[i] * (float)pixy[i] );
+			}
+		}
+		if(i<5){
+			cfzx[i] = pixx[i+1];
+			cfzy[i] = pixy[i+1];
+		}
+	}
+TRACE("\n CALCULATE \n" );
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[0],pixx[0],(int)dacy[0],pixy[0]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[1],pixx[1],(int)dacy[1],pixy[1]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[2],pixx[2],(int)dacy[2],pixy[2]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[3],pixx[3],(int)dacy[3],pixy[3]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[4],pixx[4],(int)dacy[4],pixy[4]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[5],pixx[5],(int)dacy[5],pixy[5]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n\n",(int)dacx[6],pixx[6],(int)dacy[6],pixy[6]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[0],cfax[0],cfbx[0],cfzy[0],cfay[0],cfby[0]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[1],cfax[1],cfbx[1],cfzy[1],cfay[1],cfby[1]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[2],cfax[2],cfbx[2],cfzy[2],cfay[2],cfby[2]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[3],cfax[3],cfbx[3],cfzy[3],cfay[3],cfby[3]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[4],cfax[4],cfbx[4],cfzy[4],cfay[4],cfby[4]) ;
+TRACE(" [----- , %04xh , %04xh] [----- , %04xh , %04xh]\n"        ,cfax[5],cfbx[5]        ,cfay[5],cfby[5]) ;
+	adr = HAL_LN_CORRECT;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[0] + ((UINT16)cfax[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[2] + ((UINT16)cfax[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[4] + ((UINT16)cfax[5]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[0] + ((UINT16)cfbx[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[2] + ((UINT16)cfbx[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[4] + ((UINT16)cfbx[5]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[0] + ((UINT16)cfzx[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[2] + ((UINT16)cfzx[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[4] + ((UINT16)cfay[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[1] + ((UINT16)cfay[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[3] + ((UINT16)cfay[4]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[5] + ((UINT16)cfby[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[1] + ((UINT16)cfby[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[3] + ((UINT16)cfby[4]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[5] + ((UINT16)cfzy[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzy[1] + ((UINT16)cfzy[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzy[3] + ((UINT16)cfzy[4]<<16 )));
+
+	SetLinearityParameter();
+	
+//	/****** Cross talk ******/
+//	for( i=0 , n=0 ; n<5 ; n++ ){
+//		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+//		i += 2;
+//	}
+//TRACE("[XX] %04xh [XY]%04xh [SFT]%02xh\n",tblC[0],tblC[1],(unsigned char)(tblC[4]>>0)) ;
+//TRACE("[YY] %04xh [YX]%04xh [SFT]%02xh\n",tblC[2],tblC[3],(unsigned char)(tblC[4]>>8)) ;
+//	RamWrite32A( HF_hx45x , (UINT32)(tblC[0]<<16));
+//	RamWrite32A( HF_hx45y , (UINT32)(tblC[1]<<16));
+//	RamWrite32A( HF_hy45y , (UINT32)(tblC[2]<<16));
+//	RamWrite32A( HF_hy45x , (UINT32)(tblC[3]<<16));
+//	RamWrite32A( HF_ShiftX , (UINT32)(tblC[4]));
+	
+}	
+
+void	SetLinearityParameter( void )
+{
+	UINT32 UlGyroSw;
+	
+	
+	RamRead32A( GYRO_RAM_GYRO_Switch , &UlGyroSw );
+	UlGyroSw	|=	0x00000008;
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlGyroSw );
+	
+}
+
+//********************************************************************************
+// Function Name 	: CrosstalkCalculation
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	CrosstalkCalculation( void )
+{
+	UINT16 tblC[5];
+	UINT8  tempC[10];
+	UINT8	i,n,cnt;
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(MIXI_CALB_FLG>>8) );
+	if( cnt & (UINT8)(MIXI_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_CROSSTALK_XX_LSB , tempC, 10 );
+	
+TRACE("\n E2prom CROSS TALK Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3],tempC[4],tempC[5],tempC[6],tempC[7]) ;
+TRACE(" %02xh %02xh \n",tempC[8],tempC[9]) ;
+	
+	/****** Cross talk ******/
+	for( i=0 , n=0 ; n<5 ; n++ ){
+		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+		i += 2;
+	}
+TRACE("[XX] %04xh [XY]%04xh [SFT]%02xh\n",tblC[0],tblC[1],(unsigned char)(tblC[4]>>0)) ;
+TRACE("[YY] %04xh [YX]%04xh [SFT]%02xh\n",tblC[2],tblC[3],(unsigned char)(tblC[4]>>8)) ;
+	RamWrite32A( HF_hx45x , (UINT32)(tblC[0]<<16));
+	RamWrite32A( HF_hx45y , (UINT32)(tblC[1]<<16));
+	RamWrite32A( HF_hy45y , (UINT32)(tblC[2]<<16));
+	RamWrite32A( HF_hy45x , (UINT32)(tblC[3]<<16));
+	RamWrite32A( HF_ShiftX , (UINT32)(tblC[4]));
+
+}
+
+//********************************************************************************
+// Function Name 	: SetOpticalOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	SetOpticalOffset( void )
+{
+	UINT16 tblC[2];
+	UINT8  tempC[4];
+	UINT8	i,n,cnt;
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(HALL_CALB_FLG>>8) );
+	if( cnt & (UINT8)(HALL_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_Optical_LensOffsetX_LSB , tempC, 4 );
+	
+TRACE("\n EEPROM_Optical_LensOffset Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3]) ;
+	
+	/****** Cross talk ******/
+	for( i=0 , n=0 ; n<2 ; n++ ){
+		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+		i += 2;
+	}
+	
+	if( tblC[ 0 ] == 0xFFFF ) {
+		tblC[ 0 ]	= 0 ;
+	}
+	
+	if( tblC[ 1 ] == 0xFFFF ) {
+		tblC[ 1 ]	= 0 ;
+	}
+	
+TRACE("[XX] %04xh [XY]%04xh \n", tblC[0], tblC[1]) ;
+	RamWrite32A( Optical_Offset_X , (UINT32)(tblC[0]<<16));
+	RamWrite32A( Optical_Offset_Y , (UINT32)(tblC[1]<<16));
+
+}
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisAPI.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisAPI.h
new file mode 100644
index 0000000000000000000000000000000000000000..d2e23c5cb635131b271cfd795b2583b87ec9942f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisAPI.h
@@ -0,0 +1,101 @@
+//********************************************************************************
+//		<< LC898124EP3 Evaluation Soft>>
+//		Program Name	: OisAPI
+// 		Explanation		: API List for customers
+//		History			: First edition						2016.03.15 K.abe
+//********************************************************************************
+//****************************************************
+//	MODE SELECTORS (Compile Switches)
+//****************************************************
+#define			__MIX_LIB_METHOD__	
+
+//****************************************************
+//	API FUNCTION LIST	
+//****************************************************
+/* Program Download & Start */
+extern void RemapMain( void );							// make download code start. 
+extern unsigned char SelectDownload( UINT8 GyroSelect, UINT8 ActSelect, UINT8 MasterSlave );	// download
+
+/* Code information check such as version */
+extern UINT8 GetInfomationAfterDownload( DSPVER* Info );	// get code information after download.
+
+/* Power off for SPI interface */
+extern void PreparationForPowerOff( void );				// SPI interface stop before power off
+
+/* E2Prom Access */
+extern UINT8 E2PromVerification( void );				// E2Prom verification for user area by using check sum. O:SUCCESS, 1:FAUILRE
+extern UINT8 E2PromVerificationONSEMI( void );			// E2Prom verification for ONSEMI area by using check sum. O:SUCCESS, 1:FAUILRE
+extern void BurstReadE2Prom( UINT8 address, UINT8 * val, UINT8 cnt );	// E2Prom reading continuously for every area.
+extern void ReadE2Prom( unsigned char address, unsigned char * val );	// Read data from E2Prom
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern UINT8 WriteE2Prom( UINT8 address, UINT8 data );	// E2Prom writing for user area 1byte.
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+/* Gyro Offset Adjustment */
+extern void GyroOffsetMeasureStart( void );				// start the gyro offset adjustment
+extern UINT8 GetGyroOffset( UINT16* GyroOffsetX, UINT16* GyroOffsetY, INT16 GYROF_UPPER, INT16 GYROF_LOWER   );	// get the gyro offset values.
+extern void	SetGyroOffset( UINT16 GyroOffsetX, UINT16 GyroOffsetY, UINT16 GyroOffsetZ );	// set the gyro offset data. before do this before Remapmain.
+
+/* Angle correction for 45deg*/
+extern UINT8 SetAngleCorrection( float DegreeGap, UINT8 SelectAct, unsigned char Arrangement );
+
+extern void	SetGyroAccelCoef( UINT8 );
+
+/* AF position Control [mandatory] */
+extern void		SetTregAf( UINT16 UsTregAf );			// Bi-direction :  Min:000h Max:7FFh (11bit) 
+
+/* Status Read and OIS enable [mandatory] */
+extern	UINT8	RdStatus( UINT8 UcStBitChk );			// Status Read whether initialization finish or not.
+extern	void	OisEna( void );							// OIS Enable Function
+
+/* Others [option] */
+extern	UINT8	RtnCen( UINT8	UcCmdPar ) ;			// Return to Center Function. Hall servo on/off
+extern	UINT8	ZscCnt( UINT8 ) ;						// Zero servo control 
+extern	UINT8	AfStbyRls( void );						// Af Standby release Command Function
+extern	void	SetPanTiltMode( UINT8 UcPnTmod );		// default ON.
+extern  void	SetSinWavePara( UINT8 , UINT8 ) ;		// Circle movement 
+
+extern	UINT8	RunHea( void ) ;						// Hall Examination of Acceptance
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern	UINT8	RunGea( void ) ;						// Gyro Examination of Acceptance
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+extern void GyroOffsetMeasureStartZ( void );			// start the gyro Z offset adjustment
+extern UINT32	TneZeroServo( UINT8 , float );			/* zero servo adjustment command */
+extern UINT8	ZeroServoLmt( UINT8 UCMODE );
+extern UINT32	TneAvc( UINT8 ucposture );				// Accel offset adjustment
+
+/* Accl Offset Adjustment */
+extern void	SetAcclOffset( UINT16  AcclOffsetX, UINT16  AcclOffsetY, UINT16  AcclOffsetZ );	// set the accl offset data. before do this before Remapmain.
+extern void	GetAcclOffset( UINT16* AcclOffsetX, UINT16* AcclOffsetY, UINT16* AcclOffsetZ );	// get the accl offset values.
+
+extern void	LinearityCalculation( void );				// Linearity correction
+extern void	CrosstalkCalculation( void );				// Crosstalk correction
+extern void	SetOpticalOffset( void );					// optical offset
+
+
+//****************************************************
+//	API FUNCTION LIST	for module maker
+//****************************************************
+/* Calibration Main [mandatory] */
+extern	UINT32	TneRun( void );							// calibration for bi-direction AF
+
+/* E2Prom Access */
+extern UINT8	WrHallCalData( void );					// upload the calibration data except gyro gain to eeprom
+extern UINT8	WrOptOffsetData( void );				// upload the opt offset data
+extern UINT8	WrGyroGainData( void );					// upload the gyro gain to eeprom
+extern UINT8	WrAfParameter( UINT8 );					// upload af parameter to eeprom
+extern UINT8	WrZeroServoData( void );				// upload the servo servo parameter to eepom
+
+//extern UINT8	WrLinCrsData( UINT8 writemode );		// upload linearity & cross talk parameter to eeprom
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern UINT8	WrHallLnData(  UINT8 UcMode, mlLinearityValue *linval );	// upload linearity position to eeprom
+extern UINT8	WrMixCalData(  UINT8 UcMode, mlMixingValue *mixval );		// upload cross talk to eeprom
+extern UINT8	CalcSetMizxAndLinearityData( mlLinearityValue *,  mlMixingValue * ) ;
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+/* NOTEST */
+//extern UINT8 	NotestMain( void );						// for NOTEST (E2prom erase & data set)
+//extern	void	TimPro( void );							// for NOTEST (OSC measurement function for 1msec interruption)
+
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..9306b5bb1e595c0538ed98acd5e41763578c8a12
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisCmd.c
@@ -0,0 +1,2778 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//	    Program Name	: OisCmd.c
+//		Design			: Y.Shigoeka
+//		History			: First edition						
+//********************************************************************************
+//**************************
+//	Include Header File		
+//**************************
+#include	<stdlib.h>	/* use for abs() */
+#include	<math.h>	/* use for sqrt() */
+
+#include	"Ois.h"
+#include	"OisAPI.h"
+#include	"OisLc898124EP3.h"
+
+#if USE_BOSCH
+#include 	"Ois_BOSCH.h"
+#include	"bmi2_defs.h"
+#include	"bmi260.h"
+#include	"bmi2.h"
+#endif
+
+//****************************************************
+//	MODE SELECTORS (Compile Switches)
+//****************************************************
+//#define		NEUTRAL_CENTER			// Upper Position Current 0mA Measurement
+//#define		NEUTRAL_CENTER_FINE		// Optimize natural center current
+
+#define		HALL_ADJ_SERVO_ON		// 
+
+#define	HALLADJ_FULLCURRENT
+
+#define	TNE_PTP_NO_SIN
+
+//****************************************************
+//	LC898124 calibration parameters 
+//****************************************************
+ #if ((SELECT_VENDOR&0x01) == 0x01)				// SEMCO
+	#include 	"LC898124EP3_Calibration_SO2821.h"
+ #endif
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+extern void		ClearLaser( void ) ;
+extern short	GetLaser( void ) ;
+extern void	OisDis( void );
+
+#if USE_BOSCH
+extern int8_t bmi2_i2c_read(uint8_t dev_addr, uint8_t reg_addr, uint8_t *data, uint16_t len);
+extern int8_t bmi2_i2c_write(uint8_t dev_addr, uint8_t reg_addr, const uint8_t *data, uint16_t len);
+extern void bmi2_delay_milli_sec(uint32_t period);
+#endif
+
+//****************************************************
+//	extern  Function LIST
+//****************************************************
+extern void	MesFil( UINT8 ) ;									// Measure Filter Setting
+extern void	MeasureStart( INT32 , UINT32 , UINT32 ) ;				// Measure Start Function
+extern void	MeasureStart2( INT32, INT32, INT32, UINT16 );
+extern void	MeasureWait( void ) ;								// Measure Wait
+extern void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans );
+
+extern void	SetSinWavGenInt( void );
+
+extern	stAdjPar	StAdjPar ;				// Execute Command Parameter
+extern	UINT16		UsGzoVal ;				// Gyro A/D Offset X
+
+#ifdef	SEL_SHIFT_COR
+extern	stPosOff	StPosOff ;				//!< Execute Command Parameter
+extern	stAclVal	StAclVal ;				//!< Execute Command Parameter
+#endif	//SEL_SHIFT_COR
+
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+
+#ifdef	ZERO_SERVO
+
+extern	stZeroServo		StZeroServoX;
+extern	stZeroServo		StZeroServoY;
+extern	stZeroServo		StZeroServoZ;
+
+INT32					GYROZ_OFFSET;
+
+typedef struct STZEROSERVOMES{
+	INT32				SlHallP ;					// 
+	INT32				SlAcclP ;					// 
+} stZeroServoMes ;
+
+stZeroServoMes			StZeroServoMesX;
+stZeroServoMes			StZeroServoMesY;
+
+INT32					UlPostureSt;
+
+#endif	//ZERO_SERVO
+
+//****************************************************
+//	Local Function LIST
+//****************************************************
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+UINT32	TnePtp ( UINT8	UcDirSel, UINT8	UcBfrAft, ADJ_HALL* p, UINT8 UcSrvSwitch );
+UINT32	TneCen( UINT8 UcTneAxs, ADJ_HALL* ptr, UINT8 UcSrvSwitch  );
+void	TneOff( UnDwdVal, UINT8 ) ;							// Hall Offset Tuning
+void	TneBia( UnDwdVal, UINT8, UINT16, UINT8 ) ;			// Hall Bias Tuning
+UINT32	LopGan( UINT8 UcDirSel, ADJ_LOPGAN* ptr );
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+void	TneHvc( void );
+UINT32	TneGvc( void );
+void	TneFin( ADJ_LOPGAN* ptr );
+
+//****************************************************
+//	Parameter LIST
+//****************************************************
+//#define 	HALL_ADJ		0
+//#define 	LOOPGAIN		1
+#define 	THROUGH			2
+#define 	NOISE			3
+#define		OSCCHK			4
+// Measure Mode
+
+#define		PTP_BEFORE		0
+#define		PTP_AFTER		1
+
+#define 	TNE 			80								// Waiting Time For Movement
+#define 	OFFSET_DIV		2								// Divide Difference For Offset Step
+#define 	TIME_OUT		20								// Time Out Count
+
+#define		BIAS_HLMT		(0xBF000000 )
+#define		BIAS_LLMT		(0x20000000 )
+
+//#ifdef	ZERO_SERVO
+/************** posture check ************/
+#define		SENSITIVITY		4096						// LSB/g
+#define		PSENS_MARG		(SENSITIVITY / 4)			// 1/4g
+#define		POSTURETH_P		(SENSITIVITY - PSENS_MARG)	// LSB/g
+#define		POSTURETH_M		(-POSTURETH_P)				// LSB/g
+/************** posture check ************/
+//#endif	//ZERO_SERVO
+
+
+
+
+#define		HAll_SCAILING
+
+
+
+
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+INT16		SsNvcX = 1 ;									// NVC move direction X
+INT16		SsNvcY = 1 ;									// NVC move direction Y
+
+UINT8	BeforeControl;
+
+Act_Mov_t	StActMov = {
+	0x19998000,
+	0xE6668000,
+	0xFCCD0000
+} ;
+
+//UINT32	UlHall_ActMov[ 16 ] ;
+
+//********************************************************************************
+// Function Name 	: DacControl
+// Retun Value		: Firmware version
+// Argment Value	: NON
+// Explanation		: Dac Control Function
+// History			: First edition 						
+//********************************************************************************
+void	DacControl( UINT32 UiChannel, UINT32 PuiData )
+{
+	DMIOWrite32( ADDA_DASEL, UiChannel );	
+	DMIOWrite32( ADDA_DAO, PuiData );	
+}
+
+#ifndef __OIS_UIOIS_GYRO_USE__
+//********************************************************************************
+// Function Name 	: GetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment and get result
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+#define 	GYROF_UPPER		0x06D6			// 
+#define 	GYROF_LOWER		0xF92A			// 
+UINT32	TneGvc( void )
+{
+	UINT32	UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	
+	
+	//•½‹Ï’l‘ª’è
+	
+	MesFil( THROUGH ) ;					// Set Measure Filter
+
+	SlMeasureParameterNum	=	GYROF_NUM ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+	
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+	MeasureWait() ;					// Wait complete of measurement
+	
+TRACE("Read Adr = %04x, %04xh \n",StMeasFunc_MFA_LLiIntegral1 + 4 , StMeasFunc_MFA_LLiIntegral1) ;
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+TRACE("GX_OFT = %08x, %08xh \n",(unsigned int)StMeasValueA.StUllnVal.UlHigVal,(unsigned int)StMeasValueA.StUllnVal.UlLowVal) ;
+TRACE("GY_OFT = %08x, %08xh \n",(unsigned int)StMeasValueB.StUllnVal.UlHigVal,(unsigned int)StMeasValueB.StUllnVal.UlLowVal) ;
+	SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+	SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+TRACE("GX_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+TRACE("GY_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+	
+	SlMeasureAveValueA = ( SlMeasureAveValueA >> 16 ) & 0x0000FFFF ;
+	SlMeasureAveValueB = ( SlMeasureAveValueB >> 16 ) & 0x0000FFFF ;
+	// EP1‚Å‚Í”½“]�ˆ—�‚µ‚È‚¢�B
+//	SlMeasureAveValueA = 0x00010000 - SlMeasureAveValueA ;
+//	SlMeasureAveValueB = 0x00010000 - SlMeasureAveValueB ;
+	
+	UlRsltSts = EXE_END ;
+	StAdjPar.StGvcOff.UsGxoVal = ( UINT16 )( SlMeasureAveValueA & 0x0000FFFF );		//Measure Result Store
+	if(( (INT16)StAdjPar.StGvcOff.UsGxoVal > (INT16)GYROF_UPPER ) || ( (INT16)StAdjPar.StGvcOff.UsGxoVal < (INT16)GYROF_LOWER )){
+		UlRsltSts |= EXE_GXADJ ;
+	}
+	RamWrite32A( GYRO_RAM_GXOFFZ , (( SlMeasureAveValueA << 16 ) & 0xFFFF0000 ) ) ;		// X axis Gyro offset
+	
+	StAdjPar.StGvcOff.UsGyoVal = ( UINT16 )( SlMeasureAveValueB & 0x0000FFFF );		//Measure Result Store
+	if(( (INT16)StAdjPar.StGvcOff.UsGyoVal > (INT16)GYROF_UPPER ) || ( (INT16)StAdjPar.StGvcOff.UsGyoVal < (INT16)GYROF_LOWER )){
+		UlRsltSts |= EXE_GYADJ ;
+	}
+	RamWrite32A( GYRO_RAM_GYOFFZ , (( SlMeasureAveValueB << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+	
+TRACE("GX_AVEOFT_RV = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+TRACE("GY_AVEOFT_RV = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+	
+	RamWrite32A( GYRO_RAM_GYROX_OFFSET , 0x00000000 ) ;			// X axis Drift Gyro offset
+	RamWrite32A( GYRO_RAM_GYROY_OFFSET , 0x00000000 ) ;			// Y axis Drift Gyro offset
+	RamWrite32A( GyroFilterDelayX_GXH1Z2 , 0x00000000 ) ;		// X axis H1Z2 Clear
+	RamWrite32A( GyroFilterDelayY_GYH1Z2 , 0x00000000 ) ;		// Y axis H1Z2 Clear
+	
+	return( UlRsltSts );
+	
+		
+}
+#endif
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: HallAdj
+// Retun Value		: Hall Tuning SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Hall System Auto Adjustment Function
+// History			: First edition 						
+//********************************************************************************
+UINT32 HallAdj( ADJ_HALL* Ptr, ADJ_LOPGAN *LopgainPtr )
+{
+	UINT32	UlHlxSts, UlHlySts, UlReadVal;
+	
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( TNE ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+	RamWrite32A( HALL_RAM_HXOFF,  0x00000000 ) ;		// X Offset Clr
+	RamWrite32A( HALL_RAM_HYOFF,  0x00000000 ) ;		// Y Offset Clr
+	RamWrite32A( HallFilterCoeffX_hxgain0 , LopgainPtr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , LopgainPtr->Hygain ) ;
+#endif
+	DacControl( HLXBO , Ptr->BiasInit ) ;
+	RamWrite32A( StCaliData_UiHallBias_X , Ptr->BiasInit ) ;
+	DacControl( HLYBO , Ptr->BiasInit ) ;
+	RamWrite32A( StCaliData_UiHallBias_Y , Ptr->BiasInit ) ;
+	DacControl( HLXO, Ptr->OffsetInit ) ;
+	RamWrite32A( StCaliData_UiHallOffset_X , Ptr->OffsetInit ) ;
+	DacControl( HLYO, Ptr->OffsetInit ) ;
+	RamWrite32A( StCaliData_UiHallOffset_Y , Ptr->OffsetInit ) ;
+	
+	BeforeControl=1;
+	UlHlySts = TneCen( Y_DIR, Ptr, OFF ) ;
+	StAdjPar.StHalAdj.UsHlyCna	-= Ptr->MagneticOffset_Y ;
+	StAdjPar.StHalAdj.UsHlyCna	= ( UINT16 )( ( INT16 )StAdjPar.StHalAdj.UsHlyCna - ( INT16 )Ptr->MagneticOffset_Y ) ;
+	RamWrite32A( HALL_RAM_HYOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyCna << 16 ) & 0xFFFF0000 ) ) ;
+
+	WitTim( TNE ) ;
+
+	BeforeControl=1;
+	UlHlxSts = TneCen( X_DIR, Ptr, OFF ) ;
+	StAdjPar.StHalAdj.UsHlxCna	= ( UINT16 )( ( INT16 )StAdjPar.StHalAdj.UsHlxCna - ( INT16 )Ptr->MagneticOffset_X ) ;
+	RamWrite32A( HALL_RAM_HXOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlxCna << 16 ) & 0xFFFF0000 ) ) ;
+
+	if( (UlHlxSts != EXE_HXADJ) && (UlHlySts != EXE_HYADJ) ){
+#ifdef	HALL_ADJ_SERVO_ON
+		RtnCen( BOTH_ON ) ;		// X/Y Servo ON
+#endif
+		WitTim( TNE ) ;
+
+		UlHlySts = TneCen( Y_DIR, Ptr, ON ) ;
+		StAdjPar.StHalAdj.UsHlyCna	= ( UINT16 )( ( INT16 )StAdjPar.StHalAdj.UsHlyCna - ( INT16 )Ptr->MagneticOffset_Y ) ;
+		RamWrite32A( HALL_RAM_HYOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyCna << 16 ) & 0xFFFF0000 ) ) ;
+
+		WitTim( TNE ) ;
+		UlHlxSts = TneCen( X_DIR, Ptr, ON ) ;
+		StAdjPar.StHalAdj.UsHlxCna	= ( UINT16 )( ( INT16 )StAdjPar.StHalAdj.UsHlxCna - ( INT16 )Ptr->MagneticOffset_X ) ;
+		RamWrite32A( HALL_RAM_HXOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlxCna << 16 ) & 0xFFFF0000 ) ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+		RtnCen( BOTH_OFF ) ;		// Both OFF
+#endif
+		WitTim( TNE ) ;
+	}	
+	
+	RamRead32A( StCaliData_UiHallOffset_X , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlxOff = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallBias_X , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlxGan = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallOffset_Y , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlyOff = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallBias_Y , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlyGan = (UINT16)( UlReadVal >> 16 ) ;
+
+
+#ifdef HAll_SCAILING	//  start : Calculation  Hall Min/max Cut - added 2018/11/16
+	UINT16	UsMax_hall_cut_X, UsMin_hall_cut_X ;
+	UINT16	UsMax_hall_cut_Y, UsMin_hall_cut_Y ;
+	INT16	SsTmp ;
+
+	UsMax_hall_cut_X	= Ptr->HallMax_X ;
+	UsMin_hall_cut_X	= Ptr->HallMin_X ;
+
+	UsMax_hall_cut_Y	= Ptr->HallMax_Y ;
+	UsMin_hall_cut_Y	= Ptr->HallMin_Y ;
+
+	// Xch hall Cut
+	SsTmp						= ( INT16 )StAdjPar.StHalAdj.UsHlxMxa ;
+	TRACE( "Hall X Max = %d\n", SsTmp ) ;
+	SsTmp						= ( INT16 )( ( INT32 )SsTmp * ( 100 - UsMax_hall_cut_X * 2 ) / 100 ) ;
+	TRACE( "Hall X Max Cut = %d\n", SsTmp ) ;
+	StAdjPar.StHalAdj.UsHlxMxa	= ( UINT16 )SsTmp ;
+	RamWrite32A( StCaliData_SiHallMax_After_X, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlxMxa << 16 ) & 0xFFFF0000 ) ) ;
+
+	SsTmp						= ( INT16 )StAdjPar.StHalAdj.UsHlxMna ;
+	TRACE( "Hall X Min = %d\n", SsTmp ) ;
+	SsTmp						= ( INT16 )( ( INT32 )SsTmp * ( 100 - UsMin_hall_cut_X * 2 ) / 100 ) ;
+	TRACE( "Hall X Min Cut = %d\n", SsTmp ) ;
+	StAdjPar.StHalAdj.UsHlxMna	= ( UINT16 )SsTmp ;
+	RamWrite32A( StCaliData_SiHallMin_After_X, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlxMna << 16 ) & 0xFFFF0000 ) ) ;
+
+	// Ych hall Cut
+	SsTmp						= ( INT16 )StAdjPar.StHalAdj.UsHlyMxa ;
+	TRACE( "Hall Y Max = %d\n", SsTmp ) ;
+	SsTmp						= ( INT16 )( ( INT32 )SsTmp * ( 100 - UsMax_hall_cut_Y * 2 ) / 100 ) ;
+	TRACE( "Hall Y Max Cut = %d\n", SsTmp ) ;
+	StAdjPar.StHalAdj.UsHlyMxa	= ( UINT16 )SsTmp ;
+	RamWrite32A( StCaliData_SiHallMax_After_Y, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyMxa << 16 ) & 0xFFFF0000 ) ) ;
+	
+	SsTmp						= ( INT16 )StAdjPar.StHalAdj.UsHlyMna ;
+	TRACE( "Hall Y Min = %d\n", SsTmp ) ;
+	SsTmp						= ( INT16 )( ( INT32 )SsTmp * ( 100 - UsMin_hall_cut_Y * 2 ) / 100 ) ;
+	TRACE( "Hall Y Min Cut = %d\n", SsTmp ) ;
+	StAdjPar.StHalAdj.UsHlyMna	= ( UINT16 )SsTmp ;
+	RamWrite32A( StCaliData_SiHallMin_After_Y, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyMna << 16 ) & 0xFFFF0000 ) ) ;
+#endif	//	end : Calculation  Hall Min/max Cut - added 2018/11/16
+
+
+#ifdef	HALL_ADJ_SERVO_ON
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( TNE ) ;
+#endif	
+	return ( UlHlySts | UlHlxSts );
+}
+
+
+//********************************************************************************
+// Function Name 	: TneRun
+// Retun Value		: Hall Tuning SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Hall System Auto Adjustment Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	TneRun( void )
+{
+	UINT32	UlFinSts, UlReadVal;
+	ADJ_HALL* HallPtr;
+	ADJ_LOPGAN* LopgainPtr;
+	DSPVER Info;
+
+	// Check the status
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( UlReadVal != 0x01)	return( EXE_ERROR );
+
+	// Select parameter
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+
+	else if( Info.ActType == ACT_SO2821 ) {
+		HallPtr = 		(ADJ_HALL*)&SO2821_HallCalParameter;
+		LopgainPtr = (ADJ_LOPGAN* )&SO2821_LoopGainParameter;
+	}else{
+		return( EXE_ERROR );
+	}
+
+	/* Hall Adjustment */
+	UlFinSts = HallAdj( HallPtr, LopgainPtr );
+//	if( Info.ActType == ACT_SEMCO ) {
+//		if( ((UlFinSts & EXE_HXADJ) == EXE_HXADJ) || ((UlFinSts & EXE_HYADJ) == EXE_HYADJ) ){
+//			HallPtr = (ADJ_HALL*)&SO_HallCalParameter_F;
+//			UlFinSts = HallAdj( HallPtr );
+//		}
+//	}else{
+		if( ((UlFinSts & EXE_HXADJ) == EXE_HXADJ) || ((UlFinSts & EXE_HYADJ) == EXE_HYADJ) ) return ( UlFinSts );
+//	}
+
+	/* Hall Offser (neutral center)*/
+#ifdef	NEUTRAL_CENTER
+	TneHvc();
+#endif
+
+#ifdef	NEUTRAL_CENTER_FINE
+	TneFin( LopgainPtr );
+#endif
+
+//20180906 Komori
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+TRACE("    Xadof = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    Yadof = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+//20180906 Komori
+	
+	/* Loop gain Adjustment */
+	RamWrite32A( HallFilterCoeffX_hxgain0 , LopgainPtr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , LopgainPtr->Hygain ) ;
+	RtnCen( BOTH_ON ) ;		// Y ON / X ON
+	WitTim( TNE ) ;
+	UlFinSts |= LopGan( X_DIR, LopgainPtr ) ;	// X Loop Gain Adjust
+	UlFinSts |= LopGan( Y_DIR, LopgainPtr ) ;	// Y Loop Gain Adjust
+
+	/* Gyro DC offset Adjustment */
+#ifdef __OIS_UIOIS_GYRO_USE__
+#else
+	UlFinSts |= TneGvc() ;
+#endif
+	StAdjPar.StHalAdj.UlAdjPhs = UlFinSts ;
+	return( UlFinSts ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: TnePtp
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: X,Y Direction, Adjust Before After Parameter
+// Explanation		: Measuring Hall Paek To Peak
+// History			: First edition 						
+//********************************************************************************
+UINT32	TnePtp ( UINT8	UcDirSel, UINT8	UcBfrAft, ADJ_HALL* p, UINT8 UcSrvSwitch )
+{
+	UnDwdVal		StTneVal ;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	INT32			SlMeasureMaxValue , SlMeasureMinValue ;
+	INT32			sl_act_min_drv, sl_act_max_drv ;
+	UINT16			UsSinAdr ;
+
+TRACE("TnePtp\n ") ;
+#ifdef	HALLADJ_FULLCURRENT
+	if( UcSrvSwitch != ON ) {
+		DMIOWrite32( OISDRVFC1 , 0x00000003 );
+	}
+#endif	//HALLADJ_FULLCURRENT
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HYIDAT ;		// Set Measure RAM Address
+		if( UcSrvSwitch != ON ) {
+			UsSinAdr = HALL_RAM_SINDX1;
+		} else {
+			UsSinAdr = HALL_RAM_HXOFF1;
+		}
+		sl_act_max_drv			=	p->ActMaxDrive_X ;
+		sl_act_min_drv			=	p->ActMinDrive_X ;
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HXIDAT ;		// Set Measure RAM Address
+		if( UcSrvSwitch != ON ) {
+			UsSinAdr = HALL_RAM_SINDY1;
+		} else {
+			UsSinAdr = HALL_RAM_HYOFF1;
+		}
+		sl_act_max_drv			=	p->ActMaxDrive_Y ;
+		sl_act_min_drv			=	p->ActMinDrive_Y ;
+	}
+	
+	MesFil( THROUGH ) ;					// Filter setting for measurement
+
+	SlMeasureParameterNum	=	2000 ;
+
+	MeasureStart2( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB, 50 ) ;		// Start measure
+	
+	if( UcSrvSwitch != ON ) {
+		RamWrite32A( UsSinAdr, 0x7FFFFFFF ) ;
+	} else {
+		RamWrite32A( UsSinAdr, sl_act_min_drv ) ;
+	}
+
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamRead32A( StMeasFunc_MFA_SiMin1 , ( UINT32 * )&SlMeasureMinValue ) ;	// Min value
+	
+	SlMeasureParameterNum	=	2000 ;
+	
+	MeasureStart2( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB, 50 ) ;		// Start measure
+	
+	if( UcSrvSwitch != ON ) {
+		RamWrite32A( UsSinAdr, 0x80000000 ) ;
+	} else {
+		RamWrite32A( UsSinAdr, sl_act_max_drv ) ;
+	}
+	
+	MeasureWait() ;						// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_SiMax1 , ( UINT32 * )&SlMeasureMaxValue ) ;	// Max value
+
+	StTneVal.StDwdVal.UsHigVal = (UINT16)((SlMeasureMaxValue >> 16) & 0x0000FFFF );
+	StTneVal.StDwdVal.UsLowVal = (UINT16)((SlMeasureMinValue >> 16) & 0x0000FFFF );
+
+	RamWrite32A( UsSinAdr, 0 ) ;
+	
+#ifdef	HALLADJ_FULLCURRENT
+	if( UcSrvSwitch != ON ) {
+		DMIOWrite32( OISDRVFC1 , 0x00000000 );
+	}
+#endif	//HALLADJ_FULLCURRENT
+
+TRACE("\nPTP topbtm H = %04xh , L = %04xh , AXIS = %02x \n", StTneVal.StDwdVal.UsHigVal,StTneVal.StDwdVal.UsLowVal ,UcDirSel ) ;
+	
+	if( UcBfrAft == 0 ) {
+		if( UcDirSel == X_DIR ) {
+			StAdjPar.StHalAdj.UsHlxCen	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlxMax	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlxMin	= StTneVal.StDwdVal.UsLowVal ;
+		} else if( UcDirSel == Y_DIR ){
+			StAdjPar.StHalAdj.UsHlyCen	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlyMax	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlyMin	= StTneVal.StDwdVal.UsLowVal ;
+		}
+	} else {
+		if( UcDirSel == X_DIR ){
+			StAdjPar.StHalAdj.UsHlxCna	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlxMxa	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlxMna	= StTneVal.StDwdVal.UsLowVal ;
+		} else if( UcDirSel == Y_DIR ){
+			StAdjPar.StHalAdj.UsHlyCna	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlyMxa	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlyMna	= StTneVal.StDwdVal.UsLowVal ;
+		}
+	}
+
+TRACE("		ADJ(%d) MAX = %04x, MIN = %04x, CNT = %04x, ", UcDirSel, StTneVal.StDwdVal.UsHigVal, StTneVal.StDwdVal.UsLowVal, ( ( signed int )StTneVal.StDwdVal.UsHigVal + ( signed int )StTneVal.StDwdVal.UsLowVal ) / 2 ) ;
+	StTneVal.StDwdVal.UsHigVal	= 0x7fff - StTneVal.StDwdVal.UsHigVal ;		// Maximum Gap = Maximum - Hall Peak Top
+	StTneVal.StDwdVal.UsLowVal	= StTneVal.StDwdVal.UsLowVal - 0x8000 ; 	// Minimum Gap = Hall Peak Bottom - Minimum
+
+TRACE("	GapH = %04x, GapL = %04x\n", StTneVal.StDwdVal.UsHigVal, StTneVal.StDwdVal.UsLowVal ) ;
+TRACE("		Raw MAX = %08x, MIN = %08x\n", (unsigned int)SlMeasureMaxValue , (unsigned int)SlMeasureMinValue ) ;
+	
+	return( StTneVal.UlDwdVal ) ;
+}
+
+//********************************************************************************
+// Function Name 	: TneCen
+// Retun Value		: Hall Center Tuning Result
+// Argment Value	: X,Y Direction, Hall Top & Bottom Gaps
+// Explanation		: Hall Center Tuning Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	TneCen( UINT8 UcTneAxs, ADJ_HALL* ptr, UINT8 UcSrvSwtich )
+{
+	UnDwdVal		StTneVal ;
+	UINT8 	UcTmeOut =1, UcTofRst= FAILURE ;
+	UINT16	UsBiasVal ;
+	UINT32	UlTneRst = FAILURE, UlBiasVal , UlValNow ;
+	UINT16	UsValBef,UsValNow ;
+	UINT32	UlBiaBef,UlBiaNow ;
+	
+	if( BeforeControl != 0 ) {
+		StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_BEFORE, ptr, UcSrvSwtich ) ;
+	} else {
+		StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_AFTER, ptr, UcSrvSwtich ) ;
+	}
+	BeforeControl=0;
+
+	TneOff( StTneVal, UcTneAxs ) ;
+	UcTofRst	= SUCCESS ;				/* Žb’è‚ÅOK‚É‚·‚é */
+
+	while ( UlTneRst && (UINT32)UcTmeOut )
+	{
+		if( UcTofRst == FAILURE ) {
+TRACE(" UcTofRst == FAILURE\n" ) ;
+			TneOff( StTneVal, UcTneAxs ) ;
+			StTneVal.UlDwdVal = TnePtp( UcTneAxs, PTP_AFTER, ptr, UcSrvSwtich ) ;
+		} else {
+TRACE(" else\n" ) ;
+			if( UcTneAxs == X_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_X , &UlBiaBef ) ;		
+			} else if( UcTneAxs == Y_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_Y , &UlBiaBef ) ;		
+			}
+			TneBia( StTneVal, UcTneAxs, ptr->TargetRange, UcSrvSwtich ) ;
+			if( UcTneAxs == X_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_X , &UlBiaNow ) ;		
+			} else if( UcTneAxs == Y_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_Y , &UlBiaNow ) ;		
+			}
+			if((( UlBiaBef == BIAS_HLMT ) && ( UlBiaNow == BIAS_HLMT ))
+			|| (( UlBiaBef == BIAS_LLMT ) && ( UlBiaNow == BIAS_LLMT ))){
+				UcTmeOut += 10;
+TRACE("	No = %04d (bias count up)\n", UcTmeOut ) ;
+			}
+			StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_AFTER, ptr, UcSrvSwtich ) ;
+
+			UcTofRst	= FAILURE ;
+//			if( UcTneAxs == X_DIR ) {
+//				RamRead32A( StCaliData_UiHallBias_X , &UlBiasVal ) ;
+//			}else if( UcTneAxs == Y_DIR ){
+//				RamRead32A( StCaliData_UiHallBias_Y , &UlBiasVal ) ;
+//			}
+//			if(UlBiasVal == 0x00000000){
+//				UcTmeOut = TIME_OUT;
+//			}
+		}
+
+		if( (StTneVal.StDwdVal.UsHigVal > ptr->OffsetMargin ) && (StTneVal.StDwdVal.UsLowVal > ptr->OffsetMargin ) )	/* position check */
+		{
+			UcTofRst	= SUCCESS ;
+TRACE("  TofR = SUCC\n" ) ;
+			UsValBef = UsValNow = 0x0000 ;
+		}else if( (StTneVal.StDwdVal.UsHigVal <= ptr->OffsetMargin ) && (StTneVal.StDwdVal.UsLowVal <= ptr->OffsetMargin ) ){
+			UcTofRst	= SUCCESS ;
+			UlTneRst	= (UINT32)FAILURE ;
+		}else{
+			UcTofRst	= FAILURE ;
+TRACE("  TofR = FAIL\n" ) ;
+			
+			UsValBef = UsValNow ;
+
+			if( UcTneAxs == X_DIR  ) {
+				RamRead32A( StCaliData_UiHallOffset_X , &UlValNow ) ;
+				UsValNow = (UINT16)( UlValNow >> 16 ) ;
+			}else if( UcTneAxs == Y_DIR ){
+				RamRead32A( StCaliData_UiHallOffset_Y , &UlValNow ) ;
+				UsValNow = (UINT16)( UlValNow >> 16 ) ;
+			}
+			if( ((( UsValBef & 0xFF00 ) == 0x1000 ) && ( UsValNow & 0xFF00 ) == 0x1000 )
+			 || ((( UsValBef & 0xFF00 ) == 0xEF00 ) && ( UsValNow & 0xFF00 ) == 0xEF00 ) )
+			{
+				UcTmeOut += 10;
+TRACE("	No = %04d (offset count up)\n", UcTmeOut ) ;
+				if( UcTneAxs == X_DIR ) {
+					RamRead32A( StCaliData_UiHallBias_X , &UlBiasVal ) ;
+					UsBiasVal = (UINT16)( UlBiasVal >> 16 ) ;
+				}else if( UcTneAxs == Y_DIR ){
+					RamRead32A( StCaliData_UiHallBias_Y , &UlBiasVal ) ;
+					UsBiasVal = (UINT16)( UlBiasVal >> 16 ) ;
+				}
+				
+				if( UsBiasVal > ptr->DecrementStep )
+				{
+					UsBiasVal -= ptr->DecrementStep ;
+				}
+				
+				if( UcTneAxs == X_DIR ) {
+					UlBiasVal = ( UINT32 )( UsBiasVal << 16 ) ;
+					DacControl( HLXBO , UlBiasVal ) ;
+					RamWrite32A( StCaliData_UiHallBias_X , UlBiasVal ) ;
+				}else if( UcTneAxs == Y_DIR ){
+					UlBiasVal = ( UINT32 )( UsBiasVal << 16 ) ;
+					DacControl( HLYBO , UlBiasVal ) ;
+					RamWrite32A( StCaliData_UiHallBias_Y , UlBiasVal ) ;
+				}
+			}
+
+		}
+		
+		if((( (UINT16)0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal )) < ptr->TargetMax )
+		&& (( (UINT16)0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal )) > ptr->TargetMin ) ) {
+			if(UcTofRst	== SUCCESS)
+			{
+				UlTneRst	= (UINT32)SUCCESS ;
+				break ;
+			}
+		}
+		UlTneRst	= (UINT32)FAILURE ;
+		UcTmeOut++ ;
+TRACE("  Tne = FAIL\n" ) ;
+
+TRACE("	No = %04d", UcTmeOut ) ;
+		if ( UcTmeOut >= TIME_OUT ) {
+			UcTmeOut	= 0 ;
+		}		 																							// Set Time Out Count
+	}
+
+	SetSinWavGenInt() ;		// 
+	
+	if( UlTneRst == (UINT32)FAILURE ) {
+		if( UcTneAxs == X_DIR ) {
+			UlTneRst					= EXE_HXADJ ;
+			StAdjPar.StHalAdj.UsHlxGan	= 0xFFFF ;
+			StAdjPar.StHalAdj.UsHlxOff	= 0xFFFF ;
+		}else if( UcTneAxs == Y_DIR ) {
+			UlTneRst					= EXE_HYADJ ;
+			StAdjPar.StHalAdj.UsHlyGan	= 0xFFFF ;
+			StAdjPar.StHalAdj.UsHlyOff	= 0xFFFF ;
+		}
+	} else {
+		UlTneRst	= EXE_END ;
+	}
+
+	return( UlTneRst ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: TneBia
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: Hall Top & Bottom Gaps , X,Y Direction
+// Explanation		: Hall Bias Tuning Function
+// History			: First edition 						
+//********************************************************************************
+void TneBia( UnDwdVal StTneVal, UINT8 UcTneAxs, UINT16 UsHalAdjRange, UINT8 UcSrvSwitch  )
+{
+	UINT32			UlSetBia, UlOldBias ;
+	float			SfAmp ;
+
+TRACE("TneBia\n " ) ;
+	if( UcTneAxs == X_DIR ) {
+		RamRead32A( StCaliData_UiHallBias_X , &UlSetBia ) ;
+	} else if( UcTneAxs == Y_DIR ) {
+		RamRead32A( StCaliData_UiHallBias_Y , &UlSetBia ) ;
+	}
+
+TRACE("		UlSetBia = %08x\n ", (unsigned int)UlSetBia ) ;
+	if( UlSetBia == 0x00000000 )	UlSetBia = 0x01000000 ;
+	UlSetBia = (( UlSetBia >> 16 ) & (UINT32)0x0000FF00 ) ;
+	UlOldBias	= UlSetBia ;
+	UlSetBia *= (UINT32)UsHalAdjRange ;
+	if(( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal ) == 0xFFFF ){
+		UlSetBia = BIAS_HLMT ;
+	}else{
+		UlSetBia /= (UINT32)( 0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal ) ) ;
+		if( UcSrvSwitch != OFF ) {
+			SfAmp	= ( ( float )UlSetBia / ( float )UlOldBias - 1.0f ) ;
+			SfAmp	= ( SfAmp / 2.0f ) + 1.0f ;
+			UlSetBia	= ( UINT32 )( ( float )UlOldBias * SfAmp ) ;
+		}
+		if( UlSetBia > (UINT32)0x0000FFFF )		UlSetBia = 0x0000FFFF ;
+		UlSetBia = ( UlSetBia << 16 ) ;
+		if( UlSetBia > BIAS_HLMT )		UlSetBia = BIAS_HLMT ;
+		if( UlSetBia < BIAS_LLMT )		UlSetBia = BIAS_LLMT ;
+	}
+
+	if( UcTneAxs == X_DIR ) {
+		DacControl( HLXBO , UlSetBia ) ;
+TRACE("		HLXBO = %08x\n ",  (unsigned int)UlSetBia ) ;
+		RamWrite32A( StCaliData_UiHallBias_X , UlSetBia) ;
+	} else if( UcTneAxs == Y_DIR ){
+		DacControl( HLYBO , UlSetBia ) ;
+TRACE("		HLYBO = %08x\n ",  (unsigned int)UlSetBia ) ;
+		RamWrite32A( StCaliData_UiHallBias_Y , UlSetBia) ;
+	}
+TRACE("		( AXIS = %02x , BIAS = %08xh ) , \n", UcTneAxs , (unsigned int)UlSetBia ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: TneOff
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: Hall Top & Bottom Gaps , X,Y Direction
+// Explanation		: Hall Offset Tuning Function
+// History			: First edition 						
+//********************************************************************************
+void TneOff( UnDwdVal StTneVal, UINT8 UcTneAxs )
+{
+	UINT32	UlSetOff ;
+	UINT32	UlSetVal ;
+	
+TRACE("TneOff\n ") ;
+	if( UcTneAxs == X_DIR ) {
+		RamRead32A( StCaliData_UiHallOffset_X , &UlSetOff ) ;
+	} else if( UcTneAxs == Y_DIR ){
+		RamRead32A( StCaliData_UiHallOffset_Y , &UlSetOff ) ;
+	}
+	UlSetOff 	= ( UlSetOff >> 16 ) ;
+
+	if ( StTneVal.StDwdVal.UsHigVal > StTneVal.StDwdVal.UsLowVal ) {
+		UlSetVal	= ( UINT32 )(( StTneVal.StDwdVal.UsHigVal - StTneVal.StDwdVal.UsLowVal ) / OFFSET_DIV ) ;	// Calculating Value For Increase Step
+		UlSetOff	+= UlSetVal ;	// Calculating Value For Increase Step
+		if( UlSetOff > 0x0000FFFF )		UlSetOff = 0x0000FFFF ;
+	} else {
+		UlSetVal	= ( UINT32 )(( StTneVal.StDwdVal.UsLowVal - StTneVal.StDwdVal.UsHigVal ) / OFFSET_DIV ) ;	// Calculating Value For Decrease Step
+		if( UlSetOff < UlSetVal ){
+			UlSetOff	= 0x00000000 ;
+		}else{
+			UlSetOff	-= UlSetVal ;	// Calculating Value For Decrease Step
+		}
+	}
+
+TRACE("		UlSetOff = %08x\n ",  (unsigned int)UlSetOff ) ;
+	if( UlSetOff > ( INT32 )0x0000EFFF ) {
+		UlSetOff	= 0x0000EFFF ;
+	} else if( UlSetOff < ( INT32 )0x00001000 ) {
+		UlSetOff	= 0x00001000 ;
+	}
+
+	UlSetOff = ( UlSetOff << 16 ) ;
+	
+	if( UcTneAxs == X_DIR ) {
+		DacControl( HLXO, UlSetOff ) ;
+TRACE("		HLXO = %08x\n ",  (unsigned int)UlSetOff ) ;
+		RamWrite32A( StCaliData_UiHallOffset_X , UlSetOff ) ;
+	} else if( UcTneAxs == Y_DIR ){
+		DacControl( HLYO, UlSetOff ) ;
+TRACE("		HLYO = %08x\n ",  (unsigned int)UlSetOff ) ;
+		RamWrite32A( StCaliData_UiHallOffset_Y , UlSetOff ) ;
+	}
+TRACE("		( AXIS = %02x , OFST = %08xh ) , \n", UcTneAxs , (unsigned int)UlSetOff ) ;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: LopGan
+// Retun Value		: Execute Result
+// Argment Value	: X,Y Direction
+// Explanation		: Loop Gain Adjust Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	LopGan( UINT8 UcDirSel, ADJ_LOPGAN* ptr )
+{
+#if 1
+	UINT32			UlReturnState ;
+	
+	if( UcDirSel == X_DIR ) {							// X axis
+		RamWrite32A( HallFilterCoeffX_hxgain0 , ptr->Hxgain ) ;
+		StAdjPar.StLopGan.UlLxgVal = ptr->Hxgain ;
+		UlReturnState = EXE_END ;
+	} else if( UcDirSel == Y_DIR ){						// Y axis
+		RamWrite32A( HallFilterCoeffY_hygain0 , ptr->Hygain ) ;
+		StAdjPar.StLopGan.UlLygVal = ptr->Hygain ;
+		UlReturnState = EXE_END ;
+	}
+	
+	return( UlReturnState ) ;
+#else
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	UINT64	UllCalculateVal ;
+	UINT32	UlReturnState ;
+	UINT16	UsSinAdr ;
+	
+	if( UcDirSel == X_DIR ) {		// X axis
+TRACE("LopGain X_DIR \n") ;
+		SlMeasureParameterA		=	HALL_RAM_HXOUT1 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HXLOP ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDX0;
+	} else if( UcDirSel == Y_DIR ){						// Y axis
+TRACE("LopGain Y_DIR \n") ;
+		SlMeasureParameterA		=	HALL_RAM_HYOUT1 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HYLOP ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDY0;
+	}
+	
+	SetSinWavGenInt();
+	RamWrite32A( SinWave_Offset		,	ptr->NoiseFreq ) ;								// Freq Setting
+	RamWrite32A( SinWave_Gain		,	ptr->NoiseGain ) ;								// Set Sine Wave Gain					
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;								// Sine Wave Start
+
+TRACE("LopGain NoiseFreq = %08xh \n", (unsigned int)ptr->NoiseFreq ) ;
+TRACE("LopGain NoiseGain = %08xh \n", (unsigned int)ptr->NoiseGain ) ;
+
+	SetTransDataAdr( SinWave_OutAddr	,	( UINT32 )UsSinAdr ) ;	// Set Sine Wave Input RAM
+	
+	MesFil( 1/*LOOPGAIN*/ ) ;					// Filter setting for measurement
+	MeasureStart( ptr->NoiseNum , SlMeasureParameterA , SlMeasureParameterB ) ;			// Start measure
+	MeasureWait() ;						// Wait complete of measurement
+
+	SetSinWavGenInt();		// Sine wave stop
+	
+	SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+	RamWrite32A( UsSinAdr		,	0x00000000 ) ;				// DelayRam Clear
+	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+TRACE("LopGain StMeasValueA.UllnValue = %08xh \n", (unsigned int)StMeasValueA.StUllnVal.UlHigVal ) ;
+TRACE("LopGain StMeasValueB.UllnValue = %08xh \n", (unsigned int)StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+	if( UcDirSel == X_DIR ) {		// X axis
+		UllCalculateVal = ( StMeasValueB.UllnValue * 1000 / StMeasValueA.UllnValue ) * ptr->Hxgain / ptr->Gap ;
+		if( UllCalculateVal > (UINT64)0x000000007FFFFFFF )		UllCalculateVal = (UINT64)0x000000007FFFFFFF ;
+		StAdjPar.StLopGan.UlLxgVal = (UINT32)UllCalculateVal ;
+		RamWrite32A( HallFilterCoeffX_hxgain0 , StAdjPar.StLopGan.UlLxgVal ) ;
+TRACE("LopGain UlLxgVal = %08xh \n", (unsigned int)StAdjPar.StLopGan.UlLxgVal ) ;
+		if( (UllCalculateVal > ptr->XJudgeHigh) || ( UllCalculateVal < ptr->XJudgeLow ) ){
+			UlReturnState = EXE_LXADJ ;
+		}else{
+			UlReturnState = EXE_END ;
+		}
+		
+	}else if( UcDirSel == Y_DIR ){							// Y axis
+		UllCalculateVal = ( StMeasValueB.UllnValue * 1000 / StMeasValueA.UllnValue ) * ptr->Hygain / ptr->Gap ;
+		if( UllCalculateVal > (UINT64)0x000000007FFFFFFF )		UllCalculateVal = (UINT64)0x000000007FFFFFFF ;
+		StAdjPar.StLopGan.UlLygVal = (UINT32)UllCalculateVal ;
+		RamWrite32A( HallFilterCoeffY_hygain0 , StAdjPar.StLopGan.UlLygVal ) ;
+TRACE("LopGain UlLygVal = %08xh \n", (unsigned int)StAdjPar.StLopGan.UlLygVal ) ;
+		if( (UllCalculateVal > ptr->YJudgeHigh) || ( UllCalculateVal < ptr->YJudgeLow ) ){
+			UlReturnState = EXE_LYADJ ;
+		}else{
+			UlReturnState = EXE_END ;
+		}
+	}
+
+TRACE("LopGain UlReturnState = %08xh \n", (unsigned int)UlReturnState ) ;
+	return( UlReturnState ) ;
+#endif
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+//********************************************************************************
+// Function Name 	: SetSinWavePara
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Sine wave Test Function
+// History			: First edition 						
+//********************************************************************************
+/* Servo Sampling Clock		=	18.0288kHz						*/
+/* Freq						=	SinFreq*80000000h/Fs			*/
+/* 05 00 XX MM 				XX:Freq MM:Sin or Circle */
+const UINT32	CucFreqVal[ 17 ]	= {
+		0xFFFFFFFF,				//  0:  Stop
+		0x0001D14A,				//  1: 1Hz
+		0x0003A294,				//  2: 2Hz
+		0x000573DE,				//  3: 3Hz	
+		0x00074528,				//  4: 4Hz
+		0x00091672,				//  5: 5Hz
+		0x000AE7BC,				//  6: 6Hz
+		0x000CB906,				//  7: 7Hz
+		0x000E8A50,				//  8: 8Hz
+		0x00105B9A,				//  9: 9Hz
+		0x00122CE4,				//  A: 10Hz
+		0x0013FE2E,				//  B: 11Hz
+		0x0015CF78,				//  C: 12Hz
+		0x0017A0C2,				//  D: 13Hz
+		0x0019720C,				//  E: 14Hz
+		0x001B4356,				//  F: 15Hz
+		0x001D14A0				// 10: 16Hz
+	} ;
+	
+void	SetSinWavePara( UINT8 UcTableVal ,  UINT8 UcMethodVal )
+{
+	UINT32	UlFreqDat ;
+
+	if(UcTableVal > 0x10 )	UcTableVal = 0x10 ;			/* Limit */
+	UlFreqDat = CucFreqVal[ UcTableVal ] ;	
+	
+	if( UcMethodVal == 255/*CIRCWAVE*/) {
+		RamWrite32A( SinWave_Phase	,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+		RamWrite32A( CosWave_Phase 	,	0x00000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	}else{
+		RamWrite32A( SinWave_Phase	,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+		RamWrite32A( CosWave_Phase 	,	0x60000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	}
+
+	if( UlFreqDat == 0xFFFFFFFF )			/* Sine”g’†Ž~ */
+	{
+		RamWrite32A( SinWave_Offset		,	0x00000000 ) ;									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( SinWave_Phase		,	0x60000000 ) ;									// �³Œ·”g‚̈ʑŠ—Ê
+
+		RamWrite32A( CosWave_Offset		,	0x00000000 );									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( CosWave_Phase 		,	0x60000000 );									// �³Œ·”g‚̈ʑŠ—Ê
+
+		RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;									// Sine Wave Stop
+		SetTransDataAdr( SinWave_OutAddr	,	0x00000000 ) ;		// �o—Í�æƒAƒhƒŒƒX
+		SetTransDataAdr( CosWave_OutAddr	,	0x00000000 );		// �o—Í�æƒAƒhƒŒƒX
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else{
+		RamWrite32A( SinWave_Offset		,	UlFreqDat ) ;									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( CosWave_Offset		,	UlFreqDat );									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+
+		RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;									// Sine Wave Start
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;		// �o—Í�æƒAƒhƒŒƒX
+		SetTransDataAdr( CosWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;		// �o—Í�æƒAƒhƒŒƒX
+
+	}
+}
+
+//********************************************************************************
+// Function Name 	: TneHvc
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Hall VC offset
+// History			: First edition 				
+//********************************************************************************
+#define		ADOFF_ROUGH_NUM		64
+void	TneHvc( void )
+{
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	
+	RamWrite32A( HALL_RAM_HXOFF,  0x00000000 ) ;		// X Offset Clr
+	RamWrite32A( HALL_RAM_HYOFF,  0x00000000 ) ;		// Y Offset Clr
+	
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( 500 ) ;
+	
+	MesFil( THROUGH ) ;					// Set Measure Filter
+	MeasureStart( ADOFF_ROUGH_NUM , HALL_RAM_HXIDAT , HALL_RAM_HYIDAT ) ;					// Start measure
+	MeasureWait() ;					// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_ROUGH_NUM ) / 100 ) ;
+	SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_ROUGH_NUM ) / 100 ) ;
+
+	StAdjPar.StHalAdj.UsHlxCna = ( UINT16 )(( SlMeasureAveValueA >> 16 ) & 0x0000FFFF );		//Measure Result Store
+	StAdjPar.StHalAdj.UsHlxCen = StAdjPar.StHalAdj.UsHlxCna;									//Measure Result Store
+
+	StAdjPar.StHalAdj.UsHlyCna = ( UINT16 )(( SlMeasureAveValueB >> 16 ) & 0x0000FFFF );		//Measure Result Store
+	StAdjPar.StHalAdj.UsHlyCen = StAdjPar.StHalAdj.UsHlyCna;											//Measure Result Store
+
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+TRACE("    Xadof = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    Yadof = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: TneFin
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Hall VC offset current optimize
+// History			: First edition 				
+//********************************************************************************
+#define		ADOFF_FINE_NUM		2000	
+void	TneFin( ADJ_LOPGAN* ptr )
+{
+	UINT32	UlReadVal ;
+	UINT16	UsAdxOff, UsAdyOff ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	UINT32	UlMinimumValueA, UlMinimumValueB ;
+	UINT16	UsAdxMin, UsAdyMin ;
+	UINT8	UcFin ;
+	
+	// Loop gain set for servo
+	RamWrite32A( HallFilterCoeffX_hxgain0 , ptr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , ptr->Hygain ) ;
+	
+	// Get natural center offset
+	RamRead32A( HALL_RAM_HXOFF,  &UlReadVal ) ;
+	UsAdxOff = UsAdxMin = (UINT16)( UlReadVal >> 16 ) ;
+
+	RamRead32A( HALL_RAM_HYOFF,  &UlReadVal ) ;
+	UsAdyOff = UsAdyMin = (UINT16)( UlReadVal >> 16 ) ;
+//TRACE("*****************************************************\n" );
+//TRACE("TneFin: Before Adx=%04X, Ady=%04X\n", UsAdxOff, UsAdyOff );
+
+	// Servo ON
+	RtnCen( BOTH_ON ) ;
+	WitTim( TNE ) ;
+
+	MesFil( THROUGH ) ;					// Filter setting for measurement
+	MeasureStart( ADOFF_FINE_NUM , HALL_RAM_HALL_X_OUT , HALL_RAM_HALL_Y_OUT ) ;					// Start measure
+	MeasureWait() ;						// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 	, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 , &StMeasValueA.StUllnVal.UlHigVal ) ;
+	SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 	, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+	UlMinimumValueA = abs(SlMeasureAveValueA) ;
+	UlMinimumValueB = abs(SlMeasureAveValueB) ;
+	UcFin = 0x11 ;
+
+	while( UcFin ) {
+		if( UcFin & 0x01 ) {
+			if( UlMinimumValueA >= abs(SlMeasureAveValueA) ) {
+				UlMinimumValueA = abs(SlMeasureAveValueA) ;
+				UsAdxMin = UsAdxOff ;
+				// Žû‘©‚ð‘�‚߂邽‚ß‚É�A�o—Í’l‚É”ä—Ⴓ‚¹‚é
+				if( SlMeasureAveValueA > 0 )
+					UsAdxOff = (INT16)UsAdxOff + (SlMeasureAveValueA >> 17) + 1 ;
+				else
+					UsAdxOff = (INT16)UsAdxOff + (SlMeasureAveValueA >> 17) - 1 ;
+
+				RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+			} else {
+//TRACE("X fine\n");
+				UcFin &= 0xFE ;
+			}
+		}
+
+		if( UcFin & 0x10 ) {
+			if( UlMinimumValueB >= abs(SlMeasureAveValueB) ) {
+				UlMinimumValueB = abs(SlMeasureAveValueB) ;
+				UsAdyMin = UsAdyOff ;
+				// Žû‘©‚ð‘�‚߂邽‚ß‚É�A�o—Í’l‚É”ä—Ⴓ‚¹‚é
+				if( SlMeasureAveValueB > 0 )
+					UsAdyOff = (INT16)UsAdyOff + (SlMeasureAveValueB >> 17) + 1 ;
+				else
+					UsAdyOff = (INT16)UsAdyOff + (SlMeasureAveValueB >> 17) - 1 ;
+
+				RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+			} else {
+//TRACE("Y fine\n");
+				UcFin &= 0xEF ;
+			}
+		}
+		
+		MeasureStart( ADOFF_FINE_NUM , HALL_RAM_HALL_X_OUT , HALL_RAM_HALL_Y_OUT ) ;					// Start measure
+		MeasureWait() ;						// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 	, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 , &StMeasValueA.StUllnVal.UlHigVal ) ;
+		SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 	, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+		SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+//TRACE("-->Adx %04X, Ady %04X\n", UsAdxOff, UsAdyOff );
+	}	// while
+//TRACE("TneFin: After Adx=%04X, Ady=%04X\n", UsAdxMin, UsAdyMin );
+	StAdjPar.StHalAdj.UsHlxCna = UsAdxMin;								//Measure Result Store
+	StAdjPar.StHalAdj.UsHlxCen = StAdjPar.StHalAdj.UsHlxCna;			//Measure Result Store
+
+	StAdjPar.StHalAdj.UsHlyCna = UsAdyMin;								//Measure Result Store
+	StAdjPar.StHalAdj.UsHlyCen = StAdjPar.StHalAdj.UsHlyCna;			//Measure Result Store
+
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+
+	// Servo OFF
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+
+
+TRACE("    XadofFin = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    YadofFin = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+
+}
+
+/***************************************/
+#define		SLT_OFFSET		(0x1000)
+#define		LENS_MARGIN		(0x0800)
+#define		PIXEL_SIZE		(1.12f)							// pixel size 1.12um
+#define		SPEC_RANGE		(120.0f)						// spec need movable range 130um
+#define		SPEC_PIXEL		(PIXEL_SIZE / SPEC_RANGE)		// spec need movable range pixel
+/***************************************/
+//********************************************************************************
+// Function Name 	: IniNvc
+// Retun Value		: NON
+// Argment Value	: direction
+// Explanation		: Set each direction sign function
+//********************************************************************************
+void	IniNvc( INT16 SsX, INT16 SsY )
+{
+	SsNvcX = SsX ;
+	SsNvcY = SsY ;
+}
+
+//********************************************************************************
+// Function Name 	: TneSltPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneSltPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)((SsOff * SsNvcX) << 16) ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)((SsOff * SsNvcY) << 16) ) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: TneVrtPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneVrtPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)0 ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)((SsOff * SsNvcY) << 16) ) ;
+}
+
+//********************************************************************************
+// Function Name 	: TneHrzPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneHrzPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)((SsOff * SsNvcX) << 16) ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)0 ) ;
+}
+
+
+
+
+//********************************************************************************
+// Function Name 	: TneADO
+// Retun Value		: 0x0000:PASS, 0x0001:X MAX OVER, 0x0002:Y MAX OVER, 0x0003:X MIN OVER, 0x0004:Y MIN OVER, FFFF:Verify error
+//					: 0x0100:X MAX RANGE ERROR, 0x0200:Y MAX RANGE ERROR, 0x0300:X MIN RANGE ERROR, 0x0400:Y MIN ERROR
+// Argment Value	: 
+// Explanation		: calculation margin Function
+// History			: First edition 						
+//********************************************************************************
+UINT16	TneADO( )
+{
+	UINT16	UsSts = 0 ;
+#if 0	
+	INT32	iRetVal;
+	INT32 limit ;
+	INT32 gxgain ;
+	INT32 gygain ;
+	INT16 gout_x_marginp ;
+	INT16 gout_x_marginm ;
+	INT16 gout_y_marginp ;
+	INT16 gout_y_marginm ;
+
+	INT16 x_max ;
+	INT16 x_min ;
+	INT16 x_off ;
+	INT16 y_max ;
+	INT16 y_min ;
+	INT16 y_off ;
+	INT16 x_max_after ;
+	INT16 x_min_after ;
+	INT16 y_max_after ;
+	INT16 y_min_after ;
+	INT16 gout_x ;
+	INT16 gout_y ;
+
+	//
+	// Flash update procedure
+	//
+	// Read calibration sector to buffer
+	iRetVal = Calibration_VerifyUpdate_PreRead();
+	if(iRetVal != 0) return(iRetVal);
+
+	// Read calibration data
+	RdHallCalData();
+
+	x_max = (INT16)StAdjPar.StHalAdj.UsHlxMxa ;
+	x_min = (INT16)StAdjPar.StHalAdj.UsHlxMna ;
+	x_off = (INT16)StAdjPar.StHalAdj.UsAdxOff ;
+	y_max = (INT16)StAdjPar.StHalAdj.UsHlyMxa ;
+	y_min = (INT16)StAdjPar.StHalAdj.UsHlyMna ;
+	y_off = (INT16)StAdjPar.StHalAdj.UsAdyOff ;
+
+	RamRead32A( GF_LimitX_HLIMT,	&limit ) ;
+	RamRead32A( StCaliData_SiGyroGain_X,	&gxgain ) ;
+	RamRead32A( StCaliData_SiGyroGain_Y,	&gygain ) ;
+
+	x_max_after = (x_max - x_off) ;
+	if (x_off < 0)
+	{
+	    if ((0x7FFF - abs(x_max)) < abs(x_off)) x_max_after = 0x7FFF ;
+	}
+
+	x_min_after = (x_min - x_off) ;
+	if (x_off > 0)
+	{
+	    if ((0x7FFF - abs(x_min)) < abs(x_off)) x_min_after = 0x8001 ;
+	}
+
+	y_max_after = (y_max - y_off) ;
+	if (y_off < 0)
+	{
+	    if ((0x7FFF - abs(y_max)) < abs(y_off)) y_max_after = 0x7FFF ;
+	}
+
+	y_min_after = (y_min - y_off);
+	if (y_off > 0)
+	{
+	    if ((0x7FFF - abs(y_min)) < abs(y_off)) y_min_after = 0x8001 ;
+	}
+
+	gout_x = (INT16)((INT32)(((float)gxgain / 0x7FFFFFFF) * limit * 4) >> 16);
+	gout_y = (INT16)((INT32)(((float)gygain / 0x7FFFFFFF) * limit * 4) >> 16);
+
+//TRACE( "ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+//TRACE( "ADOFF Y\t=\t0x%04X\r\n", y_off ) ;
+//TRACE( "MAX GOUT X\t=\t0x%04X\r\n", gout_x ) ;
+//TRACE( "MIN GOUT X\t=\t0x%04X\r\n", (gout_x * -1) ) ;
+//TRACE( "MAX GOUT Y\t=\t0x%04X\r\n", gout_y) ;
+//TRACE( "MIN GOUT Y\t=\t0x%04X\r\n", (gout_y * -1) ) ;
+
+	gout_x_marginp = (INT16)(gout_x + LENS_MARGIN);			// MARGIN X+
+	gout_x_marginm = (INT16)((gout_x + LENS_MARGIN) * -1);	// MARGIN X-
+	gout_y_marginp = (INT16)(gout_y + LENS_MARGIN);			// MARGIN Y+
+	gout_y_marginm = (INT16)((gout_y + LENS_MARGIN) * -1);	// MARGIN Y-
+
+//TRACE( "MAX GOUT with margin X\t=\t0x%04X\r\n", gout_x_marginp ) ;
+//TRACE( "MIN GOUT with margin X\t=\t0x%04X\r\n", gout_x_marginm ) ;
+//TRACE( "MAX GOUT with margin Y\t=\t0x%04X\r\n", gout_y_marginp ) ;
+//TRACE( "MIN GOUT with margin Y\t=\t0x%04X\r\n", gout_y_marginm ) ;
+
+//TRACE( "MAX AFTER X\t=\t0x%04X\r\n", x_max_after ) ;
+//TRACE( "MIN AFTER X\t=\t0x%04X\r\n", x_min_after ) ;
+//TRACE( "MAX AFTER Y\t=\t0x%04X\r\n", y_max_after ) ;
+//TRACE( "MIN AFTER Y\t=\t0x%04X\r\n", y_min_after ) ;
+
+	// ƒ}�[ƒWƒ“‚ª‚Ü‚Á‚½‚­‚È‚¢‚à‚Ì‚Í•s—Ç‚Æ‚·‚é
+	if (x_max_after < gout_x) {
+		UsSts = 1 ;
+	}
+	else if (y_max_after < gout_y) {
+		UsSts = 2 ;
+	}
+	else if (x_min_after > (gout_x * -1)) {
+		UsSts = 3 ;
+	}
+	else if (y_min_after > (gout_y * -1)) {
+		UsSts = 4 ;
+	}
+	else {
+		// ƒ}�[ƒWƒ“ƒI�[ƒo�[‚Å‚ ‚ê‚Î�AADOFFSET‚ð�X�V‚·‚é
+		if (x_max_after < gout_x_marginp) {
+			x_off -= (gout_x_marginp - x_max_after);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+		}
+		if (x_min_after > gout_x_marginm) {
+			x_off += abs(x_min_after - gout_x_marginm);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+		}
+		if (y_max_after < gout_y_marginp) {
+			y_off -= (gout_y_marginp - y_max_after);
+//TRACE( "UPDATE ADOFF Y\t=\t0x%04X\r\n", y_off ) ;
+		}
+		if (y_min_after > gout_y_marginm) {
+			y_off += abs(y_min_after - gout_y_marginm);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", y_off ) ;
+		}
+		
+		if ( (StAdjPar.StHalAdj.UsAdxOff != (UINT16)x_off) || (StAdjPar.StHalAdj.UsAdyOff != (UINT16)y_off) ) {
+			StAdjPar.StHalAdj.UsAdxOff = x_off ;
+			StAdjPar.StHalAdj.UsAdyOff = y_off ;
+
+			RamWrite32A( StCaliData_SiLensCen_Offset_X ,	(UINT32)(StAdjPar.StHalAdj.UsAdxOff << 16) ) ;
+			RamWrite32A( StCaliData_SiLensCen_Offset_Y ,	(UINT32)(StAdjPar.StHalAdj.UsAdyOff << 16) ) ;
+
+			_PUT_UINT32( (UINT32)(StAdjPar.StHalAdj.UsAdxOff << 16),	LENS_CENTER_VALUE_X	) ;
+			_PUT_UINT32( (UINT32)(StAdjPar.StHalAdj.UsAdyOff << 16),	LENS_CENTER_VALUE_Y	) ;
+			iRetVal = Calibration_VerifyUpdate();
+		}
+	}
+
+	// *******************************
+	// effective range check
+	// *******************************
+	if (UsSts == 0) {
+		UINT16 UsReadVal ;
+		float flDistanceX, flDistanceY ;
+		float flDistanceAD = SLT_OFFSET * 6 ;
+
+		// effective range check
+		_GET_UINT16( UsReadVal,	DISTANCE_X	) ;
+		flDistanceX = (float)UsReadVal / 10.0f ;
+//TRACE("DISTANCE (X, Y) pixel = (%04X", UsReadVal );
+
+		_GET_UINT16( UsReadVal,	DISTANCE_Y	) ;
+		flDistanceY = (float)UsReadVal / 10.0f ;
+//TRACE(", %04X)\r\n", UsReadVal );
+
+//TRACE("DISTANCE (X, Y) pixel = (%x, %x)\r\n", (int)(flDistanceX * 10.0), (int)(flDistanceY * 10.0) );
+//TRACE("X MAX um = %d\r\n", (int)((x_max_after * (flDistanceX / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("Y MAX um = %d\r\n", (int)((y_max_after * (flDistanceY / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("X MIN um = %d\r\n", (int)((abs(x_min_after) * (flDistanceX / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("Y MIN um = %d\r\n", (int)((abs(y_min_after) * (flDistanceY / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("SPEC PIXEL = %d\r\n", (int)SPEC_PIXEL ) ;
+
+		if ( (x_max_after * (flDistanceX / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("X MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0100 ;
+		}
+		else if ( (y_max_after * (flDistanceY / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("Y MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0200 ;
+		}
+		else if ( (abs(x_min_after) * (flDistanceX / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("X MIN < 85um\r\n");
+			// error
+			UsSts |= 0x0300 ;
+		}
+		else if ( (abs(y_min_after) * (flDistanceY / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("Y MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0400 ;
+		}
+	}
+#endif	
+	return( UsSts ) ;
+
+}
+
+#if 0
+//********************************************************************************
+// Function Name 	: FrqDet
+// Retun Value		: 0:PASS, 1:OIS X NG, 2:OIS Y NG, 4:CLAF NG
+// Argment Value	: NON
+// Explanation		: Module Check 
+// History			: First edition 						
+//********************************************************************************
+// Threshold of osciration amplitude
+#define ULTHDVAL	0x01000000								// Threshold of the hale value
+UINT8 FrqDet( void )
+{
+	INT32 SlMeasureParameterA , SlMeasureParameterB ;
+	INT32 SlMeasureParameterNum ;
+	UINT32 UlXasP_P , UlYasP_P ;
+	UINT8 UcRtnVal;
+
+	UcRtnVal = 0;
+
+	//Measurement Setup
+	MesFil( OSCCHK ) ;													// Set Measure Filter
+
+	SlMeasureParameterNum	=	1000 ;									// 1000times( 50ms )
+	SlMeasureParameterA		=	(UINT32)HALL_RAM_HXOUT0 ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	(UINT32)HALL_RAM_HYOUT0 ;		// Set Measure RAM Address
+
+	// impulse Set
+//	RamWrite32A( HALL_RAM_HXOFF1 , STEP1 ) ;							// X manual 
+//	RamWrite32A( HALL_RAM_HYOFF1 , STEP1 ) ;							// Y manual
+
+//	RamWrite32A( HALL_RAM_HXOFF1 , STEP2 ) ;							// X manual 
+//	RamWrite32A( HALL_RAM_HYOFF1 , STEP2 ) ;							// Y manual
+	WitTim( 300 ) ;
+
+	// Start measure
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;	
+	MeasureWait() ;														// Wait complete of measurement
+	RamRead32A( StMeasFunc_MFA_UiAmp1, &UlXasP_P ) ;					// X Axis Peak to Peak
+	RamRead32A( StMeasFunc_MFB_UiAmp2, &UlYasP_P ) ;					// Y Axis Peak to Peak
+//TRACE("UlXasP_P = %X\r\n", (unsigned int)UlXasP_P ) ;
+//TRACE("UlYasP_P = %X\r\n", (unsigned int)UlYasP_P ) ;
+
+	WitTim( 50 ) ;
+
+	// Osc Value Check X
+	if(  UlXasP_P > ULTHDVAL ){
+		UcRtnVal = 1;
+	}
+	// Osc Value Check Y
+	if(  UlYasP_P > ULTHDVAL ){
+		UcRtnVal |= 2;
+	}
+
+
+	return(UcRtnVal);													// Retun Status value
+}
+#endif
+
+#ifdef	ZERO_SERVO
+//********************************************************************************
+// Function Name 	: TneZeroServo
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes Zero Servo Parameter
+// History			: First edition
+//********************************************************************************
+#define 	ZERO_SERVO_NUM		4096				// 4096times
+UINT32	TneZeroServo( UINT8 ucposture , float DegreeGap )
+{
+	UINT32			UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	double			dTemp;
+	UINT8			i;
+	UINT32			UlRdVal;
+	double			OffsetAngle;
+	
+	UlRsltSts = EXE_END ;
+	if( ucposture < 0x80 ){
+		RamRead32A( CMD_RETURN_TO_CENTER , &UlRdVal );
+		if( UlRdVal != 0x00000000 ){
+			RtnCen( BOTH_OFF ) ;
+		}
+
+		RamRead32A( CMD_ZSRV_MODE , &UlRdVal );
+		if( ( UlRdVal & 0x00000001) == ZSRV_ENABLE ){
+			RamWrite32A( CMD_ZSRV_MODE , ZSRV_DISABLE );
+		}
+		
+		//•½‹Ï’l‘ª’è
+			MesFil( THROUGH ) ;					// Set Measure Filter
+
+			SlMeasureParameterNum	=	ZERO_SERVO_NUM ;					// Measurement times
+
+		if( ucposture != 0 && ucposture != 2 ){
+			UlRsltSts = EXE_ERROR;
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+			return( UlRsltSts );
+		}
+			
+		for( i=ucposture ; i< (ucposture+2) ; i++ )
+		{
+			switch( i ){
+			case 0:				/* +Y */
+				SlMeasureParameterA		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	GYRO_RAM_GZ_ADIDAT ;		// Set Measure RAM Address
+				break;
+			case 1:
+				SlMeasureParameterA		=	HALL_RAM_HYOUT2 ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+				break;
+			case 2:				/* +X */
+				SlMeasureParameterA		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+				break;
+			case 3:
+				SlMeasureParameterA		=	HALL_RAM_HXOUT2 ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+				break;
+			}
+
+			MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+			MeasureWait() ;					// Wait complete of measurement
+
+			RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+			RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+			RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+			RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+			SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+			SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+			
+			switch( i ){
+			case 0:
+				StZeroServoX.SlOffset = SlMeasureAveValueA ;		// i case 0 : ZeroServoRAM_X_IN
+				GYROZ_OFFSET = SlMeasureAveValueB ;
+				break;
+			case 2:
+				StZeroServoY.SlOffset = SlMeasureAveValueA ;		// i case 2 : ZeroServoRAM_Y_IN
+				StZeroServoZ.SlOffset = SlMeasureAveValueB ;
+				break;
+			default :
+				break;
+			}
+		}
+
+TRACE("VAL(H,A) pos = \t%08xh\t%08xh\t%d \n",(int)SlMeasureAveValueA, (int)SlMeasureAveValueB, ucposture ) ;
+			
+			
+			switch( ucposture ){
+			case 0:		/* +Y */
+				if( SlMeasureAveValueB < (int)(POSTURETH_P<<16) ){
+					UlRsltSts = EXE_ERROR ;
+					StZeroServoX.SlOffset = 0 ;
+				}else{
+					StZeroServoMesY.SlHallP = SlMeasureAveValueA ;	// i case 1 : HALL_RAM_HYOUT2
+					StZeroServoMesY.SlAcclP = SlMeasureAveValueB ;	// i case 1 : ZeroServoRAM_Y_IN
+					UlPostureSt |= 0x00000001;
+				}
+				break;
+			case 2:		/* +X */
+				if( SlMeasureAveValueB < (int)(POSTURETH_P<<16) ){
+					UlRsltSts = EXE_ERROR ;
+					StZeroServoY.SlOffset = 0 ;
+				}else{
+					StZeroServoMesX.SlHallP = SlMeasureAveValueA ;	// i case 3 : HALL_RAM_HXOUT2
+					StZeroServoMesX.SlAcclP = SlMeasureAveValueB ;	// i case 3 : ZeroServoRAM_X_IN
+					UlPostureSt |= 0x00000004;
+				}
+				break;
+			}
+	}else{
+		switch(ucposture){
+		case 0x80:	/* ŒvŽZ */
+			
+			if( UlPostureSt == 0x05L ){
+				// ( Xhp ) / ( Xap)
+				StZeroServoMesX.SlAcclP -= StZeroServoX.SlOffset;
+				dTemp = (double)2147483647.0  / (double)( StZeroServoMesX.SlAcclP );
+				for( StZeroServoX.SlShift = 0 ; StZeroServoX.SlShift <= 5;  StZeroServoX.SlShift++){
+					if( fabs(dTemp) <= 1 ){
+						break;
+					}
+					dTemp = dTemp / (double)2 ;
+				}
+				StZeroServoX.SlGcora = (INT32)(dTemp * (double)2147483647.0);
+				StZeroServoX.SlShift = StZeroServoX.SlShift << 8;
+
+				// ( Yhp ) / ( Yap )
+				StZeroServoMesY.SlAcclP -= StZeroServoY.SlOffset;
+				dTemp = (double)2147483647.0 / (double)( StZeroServoMesY.SlAcclP );
+				for( StZeroServoY.SlShift = 0 ; StZeroServoY.SlShift <= 5;  StZeroServoY.SlShift++){
+					if( fabs(dTemp) <= 1 ){
+						break;
+					}
+					dTemp = dTemp / 2 ;
+				}
+				StZeroServoY.SlGcora = (INT32)(dTemp * (double)2147483647.0);
+				StZeroServoY.SlShift = StZeroServoY.SlShift << 8;
+				
+				OffsetAngle = (double)( DegreeGap ) * 3.141592653589793238 / 180.0f ;
+
+
+
+				
+				StZeroServoX.SlGaina = (INT32)( (float)StZeroServoMesX.SlHallP / cos( OffsetAngle ) ) ;
+				StZeroServoY.SlGaina = (INT32)( (float)StZeroServoMesY.SlHallP / cos( OffsetAngle ) ) ;
+				
+TRACE("   X    ,   Y    ,   angle = %f \n", DegreeGap ) ;
+TRACE("%08xh,%08xh(Offset)\n",(int)StZeroServoX.SlOffset, (int)StZeroServoY.SlOffset) ;
+TRACE("%08xh,%08xh(Gcora)\n",(int)StZeroServoX.SlGcora, (int)StZeroServoY.SlGcora) ;
+TRACE("%08xh,%08xh(Gaina)\n",(int)StZeroServoX.SlGaina, (int)StZeroServoY.SlGaina) ;
+TRACE("%08xh,%08xh(Shift)\n",(int)StZeroServoX.SlShift, (int)StZeroServoY.SlShift) ;
+TRACE("%08xh,%08xh(AZ , GZ)\n",(int)StZeroServoZ.SlOffset, (int)GYROZ_OFFSET) ;
+				RamWrite32A( ZeroServoRAM_X_OFFSET 			, StZeroServoX.SlOffset );
+				RamWrite32A( ZeroServoFilterTableX_gcora	, StZeroServoX.SlGcora );
+				RamWrite32A( ZeroServoFilterTableX_gaina 	, StZeroServoX.SlGaina );
+				RamWrite32A( ZeroServoFilterTableX_shift 	, StZeroServoX.SlShift );
+
+				RamWrite32A( ZeroServoRAM_Y_OFFSET 			, StZeroServoY.SlOffset );
+				RamWrite32A( ZeroServoFilterTableY_gcora	, StZeroServoY.SlGcora );
+				RamWrite32A( ZeroServoFilterTableY_gaina 	, StZeroServoY.SlGaina );
+				RamWrite32A( ZeroServoFilterTableY_shift 	, StZeroServoY.SlShift );
+
+				RamWrite32A( ZeroServoRAM_Z_OFFSET 			, StZeroServoZ.SlOffset );
+				RamWrite32A( GYRO_RAM_GZOFFZ 				, GYROZ_OFFSET );
+				
+			}else{
+				UlRsltSts = EXE_ERROR ;
+			}
+			break;
+		case 0xFF:	/* RAM clear */
+			UlPostureSt = 0L;
+			break;
+		}
+	}
+
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+	return( UlRsltSts );
+}
+
+//********************************************************************************
+// Function Name 	: ZeroServoLmt
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Zero Servo Limit Parameter
+// History			: First edition
+//********************************************************************************
+UINT8	ZeroServoLmt( UINT8 UCMODE )
+{
+	UINT32			UlRsltSts;
+#if (EP3_ES == 2)
+	double			dTemp1;
+#else
+	double			dTemp1, dTemp2;
+	UINT32			UlFilCoef;
+	UINT16			Usshift , UsShiftx , UsShifty;
+	UINT32			Ulcoef , Ulgainx , Ulgainy;
+#endif
+	
+TRACE(" ZSRV LMT ( %d )%\n" , UCMODE ) ;
+	UlRsltSts = EXE_END ;
+	if(( UCMODE > 0x64 ) || ( UCMODE < 0x0A )){
+TRACE(" 	error \n" ) ;
+		return( EXE_ERROR ) ;
+	}
+
+#if (EP3_ES == 2)
+	dTemp1 = (double)UCMODE /(double)100.0 * (double)2147483647;
+	
+	RamWrite32A( ZS_LMT_limitx 	, (INT32)dTemp1 );
+	RamWrite32A( ZS_LMT_limity 	, (INT32)dTemp1 );
+	
+#else // ES1
+	RamRead32A( ZeroServoFilterTableX_gcora 	, &StZeroServoX.SlGcora );
+	RamRead32A( ZeroServoFilterTableX_shift 	, &StZeroServoX.SlShift );
+	RamRead32A( ZeroServoFilterTableY_gcora		, &StZeroServoY.SlGcora );
+	RamRead32A( ZeroServoFilterTableY_shift 	, &StZeroServoY.SlShift );
+	RamRead32A( ZeroServoFilterTableX_coeff1_0 	, &UlFilCoef );
+	
+TRACE("		before X (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)StZeroServoX.SlGcora ,(int)StZeroServoX.SlShift ,(int)UlFilCoef   ) ;
+TRACE("		before Y (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)StZeroServoY.SlGcora ,(int)StZeroServoY.SlShift ,(int)UlFilCoef   ) ;
+	dTemp1 = (double)100.0 / (double)UCMODE;
+	dTemp2 = (double)UCMODE / (double)100.0;
+	
+	for( Usshift = 0 ; Usshift <= 4;  Usshift++){
+		if( fabs(dTemp1) <= 1 ){
+			break;
+		}
+		dTemp1 = dTemp1 / (double)2 ;
+	}
+	
+	Ulgainx = (INT32)(dTemp1 * (double)StZeroServoX.SlGcora);
+	Ulgainy = (INT32)(dTemp1 * (double)StZeroServoY.SlGcora);
+	UsShiftx = (UINT16)StZeroServoX.SlShift + (UINT16)(Usshift<<8);
+	UsShifty = (UINT16)StZeroServoY.SlShift + (UINT16)(Usshift<<8);
+	Ulcoef = (INT32)(dTemp2 * (double)UlFilCoef);
+TRACE("		after  X (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)Ulgainx ,(int)UsShiftx ,(int)Ulcoef   ) ;
+TRACE("		after  Y (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)Ulgainy ,(int)UsShifty ,(int)Ulcoef   ) ;
+	
+	RamWrite32A( ZeroServoFilterTableX_gcora 	, Ulgainx );
+	RamWrite32A( ZeroServoFilterTableX_shift 	, (UINT32)UsShiftx );
+	RamWrite32A( ZeroServoFilterTableY_gcora	, Ulgainy );
+	RamWrite32A( ZeroServoFilterTableY_shift 	, (UINT32)UsShifty );
+	RamWrite32A( ZeroServoFilterTableX_coeff1_0 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableX_coeff1_2 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableY_coeff1_0 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableY_coeff1_2 , Ulcoef );
+#endif
+
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+	return( UlRsltSts );
+}
+#endif	//ZERO_SERVO
+
+#ifdef	SEL_SHIFT_COR
+//********************************************************************************
+// Function Name 	: MemClr
+// Retun Value		: void
+// Argment Value	: Clear Target Pointer, Clear Byte Number
+// Explanation		: Memory Clear Function
+// History			: First edition 						
+//********************************************************************************
+void	MemClr( UINT8	*NcTgtPtr, UINT16	UsClrSiz )
+{
+	UINT16	UsClrIdx ;
+
+	for ( UsClrIdx = 0 ; UsClrIdx < UsClrSiz ; UsClrIdx++ )
+	{
+		*NcTgtPtr	= 0 ;
+		NcTgtPtr++ ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: TneAvc
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Accel VC offset for All
+// History			: First edition
+//********************************************************************************
+#define 	ACCLOF_NUM		4096				// 4096times
+UINT32	TneAvc( UINT8 ucposture )
+{
+	UINT32			UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	INT32			SlMeasureRetValueX , SlMeasureRetValueY , SlMeasureRetValueZ;
+	UINT8			j , k;
+//	UINT8			i , j , k;
+//	INT32			mtrx[9] , imtrx[9];
+//	float			detA;
+	INT32			SlDiff[3] ;
+
+	UlRsltSts = EXE_END ;
+	if( ucposture < 0x7f ){
+		//•½‹Ï’l‘ª’è
+		MesFil( THROUGH ) ;					// Set Measure Filter
+
+		SlMeasureParameterNum	=	ACCLOF_NUM ;					// Measurement times
+		/******* 1st *******/
+		SlMeasureParameterA		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+		MeasureWait() ;					// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+
+		SlMeasureRetValueX = SlMeasureAveValueA ;
+		SlMeasureRetValueY = SlMeasureAveValueB ;
+
+		/******* 2nd *******/
+		SlMeasureParameterA		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+		MeasureWait() ;					// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+
+		SlMeasureRetValueZ = SlMeasureAveValueA ;
+		
+
+
+TRACE("VAL(X,Y,Z) pos = \t%08xh\t%08xh\t%08xh\t%d \n", (unsigned int)SlMeasureRetValueX, (unsigned int)SlMeasureRetValueY, (unsigned int)SlMeasureRetValueZ, ucposture ) ;
+		if(( SlMeasureRetValueZ < (INT32)(POSTURETH_P<<16)) && (ucposture == 0x10)){
+				UlRsltSts = EXE_ERROR ;
+TRACE(" POS14 [ERROR] \t%08xh < %08xh\n", (unsigned int)(SlMeasureRetValueZ), (unsigned int)(POSTURETH_P<<16) ) ;
+		}else if(( SlMeasureRetValueZ > (INT32)(POSTURETH_M<<16)) && (ucposture == 0x11)){
+				UlRsltSts = EXE_ERROR ;
+TRACE(" POS14 [ERROR] \t%08xh > %08xh\n", (unsigned int)(SlMeasureRetValueZ), (unsigned int)(POSTURETH_M<<16) ) ;
+		}else{
+TRACE("DEBUG = \t%08xh\t \n", abs( (INT32)(ACCL_SENS << 16) - abs(SlMeasureRetValueZ) ) ) ;
+			if( abs(SlMeasureRetValueX) > ZEROG_MRGN_XY )									UlRsltSts |= EXE_GXADJ ;
+			if( abs(SlMeasureRetValueY) > ZEROG_MRGN_XY )									UlRsltSts |= EXE_GYADJ ;
+			if( abs( (INT32)(ACCL_SENS << 16) - abs(SlMeasureRetValueZ)) > ZEROG_MRGN_Z )	UlRsltSts |= EXE_GZADJ ;
+			if( UlRsltSts == EXE_END ){
+//				StPosOff.StPos.Pos[4][0] = SlMeasureRetValueX;
+//				StPosOff.StPos.Pos[4][1] = SlMeasureRetValueY;
+//				StPosOff.StPos.Pos[4][2] = SlMeasureRetValueZ;
+				StPosOff.UlAclOfSt |= 0x0000003F;
+TRACE("POS14(X,Y,Z) st = \t%08xh\t%08xh\t%08xh\t%08xh \n", (unsigned int)StPosOff.StPos.Pos[4][0], (unsigned int)StPosOff.StPos.Pos[4][1], (unsigned int)StPosOff.StPos.Pos[4][2], (unsigned int)StPosOff.UlAclOfSt ) ;
+
+				SlDiff[0] = SlMeasureRetValueX - (INT32)0;
+				SlDiff[1] = SlMeasureRetValueY - (INT32)0;
+				if(ucposture == 0x10){
+					SlDiff[2] = SlMeasureRetValueZ - (INT32)(ACCL_SENS << 16);
+				}else{
+					SlDiff[2] = SlMeasureRetValueZ - (INT32)(ACCL_SENS_M << 16);
+				}
+				StPosOff.StPos.Pos[4][0] = SlDiff[0];
+				StPosOff.StPos.Pos[4][1] = SlDiff[1];
+				StPosOff.StPos.Pos[4][2] = SlDiff[2];
+			}
+		}
+	}else{
+		switch(ucposture){
+		case 0x80:	/* ŒvŽZ */
+
+			if(StPosOff.UlAclOfSt == 0x3fL ){
+				/*X offset*/
+				StAclVal.StAccel.SlOffsetX = StPosOff.StPos.Pos[4][0] ;
+				/*Y offset*/
+				StAclVal.StAccel.SlOffsetY = StPosOff.StPos.Pos[4][1] ;
+				/*Z offset*/
+				StAclVal.StAccel.SlOffsetZ = StPosOff.StPos.Pos[4][2] ;
+#ifdef DEBUG
+TRACE("ACLOFST(X,Y,Z) = \t%08xh\t%08xh\t%08xh \n", (unsigned int)StAclVal.StAccel.SlOffsetX, (unsigned int)StAclVal.StAccel.SlOffsetY, (unsigned int)StAclVal.StAccel.SlOffsetZ   ) ;
+#endif //DEBUG
+				
+				RamWrite32A( ZeroServoRAM_X_OFFSET , StAclVal.StAccel.SlOffsetX ) ;	// X axis Accel offset
+				RamWrite32A( ZeroServoRAM_Y_OFFSET , StAclVal.StAccel.SlOffsetY ) ;	// Y axis Accel offset
+				RamWrite32A( ZeroServoRAM_Z_OFFSET , StAclVal.StAccel.SlOffsetZ ) ;	// Z axis Accel offset
+				
+				StAclVal.StAccel.SlOffsetX = ( StAclVal.StAccel.SlOffsetX >> 16 ) & 0x0000FFFF;
+				StAclVal.StAccel.SlOffsetY = ( StAclVal.StAccel.SlOffsetY >> 16 ) & 0x0000FFFF;
+				StAclVal.StAccel.SlOffsetZ = ( StAclVal.StAccel.SlOffsetZ >> 16 ) & 0x0000FFFF;
+				
+				for( j=0 ; j < 6 ; j++ ){
+					k = 4 * j;
+					RamWrite32A( AcclFilDly_X + k , 0x00000000 ) ;			// X axis Accl LPF Clear
+					RamWrite32A( AcclFilDly_Y + k , 0x00000000 ) ;			// Y axis Accl LPF Clear
+					RamWrite32A( AcclFilDly_Z + k , 0x00000000 ) ;			// Z axis Accl LPF Clear
+				}
+
+			}else{
+				UlRsltSts = EXE_ERROR ;
+			}
+			break;
+		case 0xFF:	/* RAM clear */
+			MemClr( ( UINT8 * )&StPosOff, sizeof( stPosOff ) ) ;	// Adjust Parameter Clear
+			MemClr( ( UINT8 * )&StAclVal, sizeof( stAclVal ) ) ;	// Adjust Parameter Clear
+//			StPosOff.UlAclOfSt = 0L;
+			break;
+		}
+	}
+
+TRACE(" Result = %08x\n", (unsigned int)UlRsltSts ) ;
+	return( UlRsltSts );
+
+
+}
+#endif	//SEL_SHIFT_COR
+
+
+
+//********************************************************************************
+// Function Name 	: Actuator_Moving
+// Retun Value		: Status
+// Argment Value	: X or Y axis, Actuator Moving Parameter Pointer, Hall Data Pointer
+// Explanation		: Actuator Moving Test Function
+// History			: First edition 		
+//********************************************************************************
+UINT8	Actuator_Moving( UINT8 uc_axis, Act_Mov_t *pt_parameter, int *ul_readval )
+{
+	UINT8		uc_status	= SUCCESS ;
+	UnllnVal	StMeasValueA, StMeasValueB ;
+	int			targetcode ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;															// X,Y Servo On
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	MesFil( NOISE ) ;																			// Measure Filter Setting
+
+	targetcode	= pt_parameter->startcode ;														// Set Initial Position
+
+	while( targetcode > pt_parameter->endcode ) {
+		// Move to measuring porision
+		if( !uc_axis ) {																		// X Axis
+			RamWrite32A( HALL_RAM_GYROX_OUT, targetcode ) ;
+		} else {																				// Y Axis
+			RamWrite32A( HALL_RAM_GYROY_OUT, targetcode ) ;
+		}
+		
+		// Measure position
+		WitTim( 100 ) ;																			// Wait 100ms
+		
+		MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;								// Measurement Starting
+		
+		MeasureWait() ;																			// Wait for finishing measure
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;			// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;			// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		if( !uc_axis ) {																		// X Axis
+			*ul_readval	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) ;
+		} else {																				// Y Axis
+			*ul_readval	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) ;
+		}
+		
+//		if( ( *( ul_readval - 1 ) - *ul_readval ) < abs( pt_parameter->step / 2 ) ) {
+//			uc_status	= FAILURE ;
+//		}
+		
+		targetcode	+= pt_parameter->step ;
+		ul_readval++ ;
+	}
+	
+	// Move to center position
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;
+	return( uc_status ) ;
+}
+
+
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=  ‚±‚±‚©‚ç’ljÁ by K.Otake                                                                     +=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//********************************************************************************
+// Function Name 	: Laser_LinearityCorrection
+// Retun Value		: Status
+// Argment Value	: None
+// Explanation		: Linearity correction by laser displacement meter Function
+// History			: First edition 		
+//********************************************************************************
+#define	RATED_STROKE_RANGE	80L
+UINT8	Laser_LinearityCorrection( void )
+{
+	UINT16	us_peak_to_peak_x, us_rated_peak_to_peak_x, us_peak_to_peak_y, us_rated_peak_to_peak_y ;
+	INT32	sl_step_x, sl_position_x[ 7 ], sl_step_y, sl_position_y[ 7 ] ;
+	INT16	ss_laser_x[ 7 ], ss_laser_y[ 7 ] ;
+	UINT8	i, us_status	= SUCCESS ;
+	INT32	sl_gyro_switch, sl_calib_status ;
+	
+	// Initialize
+	if( ( short )StAdjPar.StHalAdj.UsHlxMxa < ( short )StAdjPar.StHalAdj.UsHlxMna ) {
+		us_status	= FAILURE ;
+		return( us_status ) ;
+	}
+	
+	if( ( short )StAdjPar.StHalAdj.UsHlyMxa < ( short )StAdjPar.StHalAdj.UsHlyMna ) {
+		us_status	= FAILURE ;
+		return( us_status ) ;
+	}
+	
+	// Linearity correction disable
+	RamRead32A( GYRO_RAM_GYRO_Switch, &sl_gyro_switch ) ;
+	sl_gyro_switch	&= 0xFFFFFFF7 ;
+	RamWrite32A( GYRO_RAM_GYRO_Switch, sl_gyro_switch ) ;
+	
+	// Servo ON
+	RamWrite32A( CMD_RETURN_TO_CENTER, BOTH_SRV_ON ) ;
+	WitTim( 100 ) ;
+
+	// Calculate the moving position
+	us_peak_to_peak_x		= ( unsigned short )( ( long )StAdjPar.StHalAdj.UsHlxMxa - ( long )StAdjPar.StHalAdj.UsHlxMna ) ;
+	us_rated_peak_to_peak_x	= ( unsigned short )( ( long )us_peak_to_peak_x * RATED_STROKE_RANGE / 100L ) ;
+	sl_step_x				= us_rated_peak_to_peak_x / 6 ;
+
+	us_peak_to_peak_y		= ( unsigned short )( ( long )StAdjPar.StHalAdj.UsHlyMxa - ( long )StAdjPar.StHalAdj.UsHlyMna ) ;
+	us_rated_peak_to_peak_y	= ( unsigned short )( ( long )us_peak_to_peak_y * RATED_STROKE_RANGE / 100L ) ;
+	sl_step_y				= us_rated_peak_to_peak_y / 6 ;
+	for( i = 0 ; i < 7 ; i++ ) {
+		sl_position_x[ i ]	= ( long )( 0 + ( sl_step_x * ( i - 3 ) ) ) << 16 ;
+		sl_position_y[ i ]	= ( long )( 0 + ( sl_step_y * ( i - 3 ) ) ) << 16 ;
+	}
+	
+	// Move the position x to initial position
+	RamWrite32A( HALL_RAM_GYROX_OUT, ( unsigned long )sl_position_x[ 0 ] ) ;
+	WitTim( 100 ) ;
+	
+	// Please set laser displacement meter to 0um
+	ClearLaser() ;
+	
+	// Please take laser displacement data while the actuator move
+	// Please take X axis laser data
+	for( i = 0 ; i < 7 ; i++ ) {
+		RamWrite32A( HALL_RAM_GYROX_OUT, ( unsigned long )sl_position_x[ i ] ) ;
+		WitTim( 100 ) ;
+		ss_laser_x[ i ]	= GetLaser() ;
+	}
+	
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;										// Return to center position
+	WitTim( 100 ) ;
+	
+	// Move the position y to initial position
+	RamWrite32A( HALL_RAM_GYROY_OUT, ( unsigned long )sl_position_y[ 0 ] ) ;
+	WitTim( 100 ) ;
+	
+	// Please set laser displacement meter to 0um
+	ClearLaser() ;
+	
+	// Please take Y axis laser data
+	for( i = 0 ; i < 7 ; i++ ) {
+		RamWrite32A( HALL_RAM_GYROY_OUT, ( unsigned long )sl_position_y[ i ] ) ;
+		WitTim( 100 ) ;
+		ss_laser_y[ i ]	= GetLaser() ;
+	}
+	
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;										// Return to center position
+	
+#if 0
+	// Test
+	ss_laser_x[ 0 ]	= 0 ;
+	ss_laser_x[ 1 ]	= 60 ;
+	ss_laser_x[ 2 ]	= 123 ;
+	ss_laser_x[ 3 ]	= 191 ;
+	ss_laser_x[ 4 ]	= 262 ;
+	ss_laser_x[ 5 ]	= 341 ;
+	ss_laser_x[ 6 ]	= 427 ;
+	sl_step_x		= 4003 ;
+	
+	ss_laser_y[ 0 ]	= 0 ;
+	ss_laser_y[ 1 ]	= 51 ;
+	ss_laser_y[ 2 ]	= 91 ;
+	ss_laser_y[ 3 ]	= 146 ;
+	ss_laser_y[ 4 ]	= 201 ;
+	ss_laser_y[ 5 ]	= 267 ;
+	ss_laser_y[ 6 ]	= 330 ;
+	sl_step_y		= 3482 ;
+#endif
+
+	// Send laser displacement data to DSP
+	RamWrite32A( StPosition_0, ( unsigned long )( ( long )( ( ss_laser_y[ 0 ] * 10 ) << 16 ) | ( ss_laser_x[ 0 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_1, ( unsigned long )( ( long )( ( ss_laser_y[ 1 ] * 10 ) << 16 ) | ( ss_laser_x[ 1 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_2, ( unsigned long )( ( long )( ( ss_laser_y[ 2 ] * 10 ) << 16 ) | ( ss_laser_x[ 2 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_3, ( unsigned long )( ( long )( ( ss_laser_y[ 3 ] * 10 ) << 16 ) | ( ss_laser_x[ 3 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_4, ( unsigned long )( ( long )( ( ss_laser_y[ 4 ] * 10 ) << 16 ) | ( ss_laser_x[ 4 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_5, ( unsigned long )( ( long )( ( ss_laser_y[ 5 ] * 10 ) << 16 ) | ( ss_laser_x[ 5 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_6, ( unsigned long )( ( long )( ( ss_laser_y[ 6 ] * 10 ) << 16 ) | ( ss_laser_x[ 6 ] * 10 ) ) ) ;
+	RamWrite32A( SiStepXY, ( unsigned long )( sl_step_y << 16 | sl_step_x ) ) ;
+	
+	// Linearity correction enable
+	RamRead32A( GYRO_RAM_GYRO_Switch, &sl_gyro_switch ) ;
+	sl_gyro_switch	|= 0x00000008 ;
+	RamWrite32A( GYRO_RAM_GYRO_Switch, sl_gyro_switch ) ;
+
+	// Linearity Data enable
+	RamRead32A( StCaliData_UsCalibrationStatus, &sl_calib_status ) ;
+	sl_calib_status	&= 0xFFFFFBFF ;
+	RamWrite32A( StCaliData_UsCalibrationStatus, sl_calib_status ) ;
+	
+	// Calculate the coefficient for linearity correction
+	RamWrite32A( CMD_LASER_LINEAR_DATA, 0 ) ;
+	
+	return( us_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: CircleTest
+// Retun Value		: Status
+// Argment Value	: Frequency, XX% Mechanical Stroke
+// Explanation		: Sine Wave Test Function
+// History			: First edition 		
+//********************************************************************************
+#define	TRACKING_THRESHOLD	0x08000000
+UINT8	CircleTest( UINT8 uc_freq, UINT8 us_amp )
+{
+	UINT16	us_amplitude_x, us_amplitude_y ;
+	UINT32	ul_gain_x, ul_gain_y ;
+	UINT8	uc_status = SUCCESS ;
+	INT32	sl_sample_num, sl_ach_max, sl_ach_min, sl_bch_max, sl_bch_min ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;
+
+	// Sine wave amplitude setting
+	SetSinWavGenInt() ;
+	
+	if( StAdjPar.StHalAdj.UsHlxMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlxMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlxMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlxMna ;
+	}
+	
+	us_amplitude_x	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+
+	if( StAdjPar.StHalAdj.UsHlyMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlyMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlyMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlyMna ;
+	}
+	
+	us_amplitude_y	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+	
+	ul_gain_x	= ( UINT32 )( ( UINT32 )us_amplitude_x * us_amp / 100 ) << 16 ;
+	ul_gain_y	= ( UINT32 )( ( UINT32 )us_amplitude_y * us_amp / 100 ) << 16 ;
+
+	// Sine wave generation
+	SetSinWavePara( uc_freq, CIRCWAVE ) ;
+	
+	RamWrite32A( SinWave_Gain, ul_gain_x ) ;									// Sine wave gain
+	RamWrite32A( CosWave_Gain, ul_gain_y ) ;									// Cosine wave gain
+	
+	// Measurement initialize
+	MesFil( NOISE ) ;
+	
+	sl_sample_num	= ( INT32 )( FS_FREQ / ( float )uc_freq ) ;
+	
+	// Start peak to peak measurement
+	MeasureStart( sl_sample_num, HALL_RAM_HXOUT0, HALL_RAM_HYOUT0 ) ;
+	
+	MeasureWait() ;
+	
+	// Check tracking
+	RamRead32A( StMeasFunc_MFA_SiMax1, &sl_ach_max ) ;
+	RamRead32A( StMeasFunc_MFA_SiMin1, &sl_ach_min ) ;
+	RamRead32A( StMeasFunc_MFB_SiMax2, &sl_bch_max ) ;
+	RamRead32A( StMeasFunc_MFB_SiMin2, &sl_bch_min ) ;
+	
+	if( ( ( sl_ach_max - sl_ach_min ) > TRACKING_THRESHOLD ) || ( ( sl_bch_max - sl_bch_min ) > TRACKING_THRESHOLD ) ) {
+		uc_status	= FAILURE ;
+	}
+	
+	// Step sine wave
+	SetSinWavePara( 0, CIRCWAVE ) ;
+	
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OscillationDetection
+// Retun Value		: Status
+// Argment Value	: XX% X axis Mechanical Stroke, XX% Y axis Mechanical Stroke
+// Explanation		: Sine Wave Test Function
+// History			: First edition 		
+//********************************************************************************
+#define	OSCILLATION_THRESHOLD	0x01000000
+UINT8	OscillationDetection( INT8 sc_offset_x, INT8 sc_offset_y, UINT16 us_wait_time )
+{
+	UINT16	us_amplitude_x, us_amplitude_y ;
+	INT32	sl_offset_x, sl_offset_y ;
+	UINT8	uc_status = SUCCESS ;
+	INT32	sl_ach_max, sl_ach_min, sl_bch_max, sl_bch_min ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;
+
+	// Add Offset
+	if( StAdjPar.StHalAdj.UsHlxMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlxMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlxMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlxMna ;
+	}
+	
+	us_amplitude_x	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+
+	if( StAdjPar.StHalAdj.UsHlyMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlyMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlyMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlyMna ;
+	}
+	
+	us_amplitude_y	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+	
+	sl_offset_x	= ( UINT32 )( ( UINT32 )us_amplitude_x * sc_offset_x / 100 ) << 16 ;
+	sl_offset_y	= ( UINT32 )( ( UINT32 )us_amplitude_y * sc_offset_y / 100 ) << 16 ;
+	TRACE( "Offset X = %x\n", sl_offset_x ) ;
+	TRACE( "Offset Y = %x\n", sl_offset_y ) ;
+
+	RamWrite32A( HALL_RAM_GYROX_OUT, ( UINT32 )sl_offset_x ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, ( UINT32 )sl_offset_y ) ;
+
+	WitTim( 100 ) ;
+
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;
+
+	WitTim( us_wait_time ) ;
+
+	// Measurement initialize
+	MesFil( NOISE ) ;
+	
+	// Start peak to peak measurement
+	MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;
+	
+	MeasureWait() ;
+	
+	// Check Oscillation
+	RamRead32A( StMeasFunc_MFA_SiMax1, &sl_ach_max ) ;
+	RamRead32A( StMeasFunc_MFA_SiMin1, &sl_ach_min ) ;
+	RamRead32A( StMeasFunc_MFB_SiMax2, &sl_bch_max ) ;
+	RamRead32A( StMeasFunc_MFB_SiMin2, &sl_bch_min ) ;
+	TRACE( "sl_ach_max = %x\n", sl_ach_max ) ;
+	TRACE( "sl_ach_min = %x\n", sl_ach_min ) ;
+	TRACE( "sl_bch_max = %x\n", sl_bch_max ) ;
+	TRACE( "sl_bch_min = %x\n", sl_bch_min ) ;
+	
+	if( ( ( sl_ach_max - sl_ach_min ) > OSCILLATION_THRESHOLD ) || ( ( sl_bch_max - sl_bch_min ) > OSCILLATION_THRESHOLD ) ) {
+		uc_status	= FAILURE ;
+	}
+	
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OIS_PosMes_by_AF
+// Retun Value		: Status
+// Argment Value	: None
+// Explanation		: OIS Position Measurement by AF Function
+// History			: First edition 		
+//********************************************************************************
+#define	OIS_POSITION_THRESHOLD	0x15000000
+UINT16	Us_Af_Position[ 9 ]	= { 0x0000, 0x0080, 0x0100, 0x0180, 0x0200, 0x0280, 0x0300, 0x0380, 0x03FF } ;
+UINT32	UlBufDat[ 64 ] ;
+INT32	Sl_Hall_X_by_AF[ 9 ] ;
+INT32	Sl_Hall_Y_by_AF[ 9 ] ;
+INT32	Sl_Hall_X_Slope_by_AF[ 8 ] ;
+INT32	Sl_Hall_Y_Slope_by_AF[ 8 ] ;
+
+UINT8	OIS_PosMes_by_AF( void )
+{
+	UINT8		uc_status, i ;
+	INT32		sl_hall_x[ 9 ], sl_hall_y[ 9 ], sl_default_x, sl_default_y ;
+	UnllnVal	StMeasValueA, StMeasValueB ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_OFF ) ;														// X,Y Servo Off
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;																				// OIS disable
+
+	MesFil( NOISE ) ;																		// Measure filter setting
+
+	// Measure default position
+	WitTim( 100 ) ;																		// Wait 100ms
+	
+	MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;							// Measurement Starting
+	
+	MeasureWait() ;																		// Wait for finishing measure
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;		// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;		// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	sl_default_x	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) ;
+	sl_default_y	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) ;
+	
+	// OIS position measurement while moving AF
+	for( i = 0 ; i < 9 ; i++ ) {
+		// Please insert AF moving code here
+
+		WitTim( 100 ) ;																		// Wait 100ms
+		
+		MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;							// Measurement Starting
+		
+		MeasureWait() ;																		// Wait for finishing measure
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;		// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;		// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		sl_hall_x[ i ]	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) - sl_default_x ;
+		sl_hall_y[ i ]	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) - sl_default_y ;
+	}
+	
+	for( i = 1 ; i < 9 ; i++ ) {
+		if( abs( sl_hall_x[ i ] - sl_hall_x[ i - 1 ] ) > OIS_POSITION_THRESHOLD ) {
+			return( FAILURE ) ;
+		}
+
+		if( abs( sl_hall_y[ i ] - sl_hall_y[ i - 1 ] ) > OIS_POSITION_THRESHOLD ) {
+			return( FAILURE ) ;
+		}
+	}
+	
+	// Please store the measurement data in external EEPROM
+	
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: Read_OIS_PosData_by_AF
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Read OIS Position Data by AF Function
+// History			: First edition 		
+//********************************************************************************
+void	Read_OIS_PosData_by_AF( void )
+{
+	UINT8		i ;
+
+	// Please insert the function what reads OIS shift cal data from external EEPROM
+
+//------------------------------------------------------------------------------------------------
+// Read Calibration data
+//------------------------------------------------------------------------------------------------
+	// Here is Inputing the dummy data
+	// But, Actually, Please input OIS shift cal data
+	Sl_Hall_X_by_AF[ 0 ]	= UlBufDat[ OIS_POS_BY_AF_X1 ] ;
+	Sl_Hall_X_by_AF[ 1 ]	= UlBufDat[ OIS_POS_BY_AF_X2 ] ;
+	Sl_Hall_X_by_AF[ 2 ]	= UlBufDat[ OIS_POS_BY_AF_X3 ] ;
+	Sl_Hall_X_by_AF[ 3 ]	= UlBufDat[ OIS_POS_BY_AF_X4 ] ;
+	Sl_Hall_X_by_AF[ 4 ]	= UlBufDat[ OIS_POS_BY_AF_X5 ] ;
+	Sl_Hall_X_by_AF[ 5 ]	= UlBufDat[ OIS_POS_BY_AF_X6 ] ;
+	Sl_Hall_X_by_AF[ 6 ]	= UlBufDat[ OIS_POS_BY_AF_X7 ] ;
+	Sl_Hall_X_by_AF[ 7 ]	= UlBufDat[ OIS_POS_BY_AF_X8 ] ;
+	Sl_Hall_X_by_AF[ 8 ]	= UlBufDat[ OIS_POS_BY_AF_X9 ] ;
+
+	Sl_Hall_Y_by_AF[ 0 ]	= UlBufDat[ OIS_POS_BY_AF_Y1 ] ;
+	Sl_Hall_Y_by_AF[ 1 ]	= UlBufDat[ OIS_POS_BY_AF_Y2 ] ;
+	Sl_Hall_Y_by_AF[ 2 ]	= UlBufDat[ OIS_POS_BY_AF_Y3 ] ;
+	Sl_Hall_Y_by_AF[ 3 ]	= UlBufDat[ OIS_POS_BY_AF_Y4 ] ;
+	Sl_Hall_Y_by_AF[ 4 ]	= UlBufDat[ OIS_POS_BY_AF_Y5 ] ;
+	Sl_Hall_Y_by_AF[ 5 ]	= UlBufDat[ OIS_POS_BY_AF_Y6 ] ;
+	Sl_Hall_Y_by_AF[ 6 ]	= UlBufDat[ OIS_POS_BY_AF_Y7 ] ;
+	Sl_Hall_Y_by_AF[ 7 ]	= UlBufDat[ OIS_POS_BY_AF_Y8 ] ;
+	Sl_Hall_Y_by_AF[ 8 ]	= UlBufDat[ OIS_POS_BY_AF_Y9 ] ;
+
+//------------------------------------------------------------------------------------------------
+// Calculate the slope
+//------------------------------------------------------------------------------------------------
+	for( i = 0 ; i < 8 ; i++ ) {
+		Sl_Hall_X_Slope_by_AF[ i ] = ( INT32 )( ( Sl_Hall_X_by_AF[ i + 1 ] - Sl_Hall_X_by_AF[ i ] ) / ( Us_Af_Position[ i + 1 ] - Us_Af_Position[ i ] ) ) ;
+		Sl_Hall_Y_Slope_by_AF[ i ] = ( INT32 )( ( Sl_Hall_Y_by_AF[ i + 1 ] - Sl_Hall_Y_by_AF[ i ] ) / ( Us_Af_Position[ i + 1 ] - Us_Af_Position[ i ] ) ) ;
+	}
+
+	return ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OIS_Pos_Correction_by_AF
+// Retun Value		: None
+// Argment Value	: AF Code
+// Explanation		: OIS Position Correction by AF Function
+// History			: First edition 		
+//********************************************************************************
+void	OIS_Pos_Correction_by_AF( UINT16	us_af_code )
+{
+	UINT8	i ;
+	INT32	sl_offset_x, sl_offset_y ;
+
+	for( i = 1 ; i < 9 ; i++ ) {
+		if( us_af_code < Us_Af_Position[ i ] + 1 ) {
+			sl_offset_x	= ( INT32 )( Sl_Hall_X_Slope_by_AF[ i - 1 ] * ( us_af_code - Us_Af_Position[ i - 1 ] ) + ( Sl_Hall_X_by_AF[ i - 1 ] - Sl_Hall_X_by_AF[ 0 ] ) ) ;
+			sl_offset_y	= ( INT32 )( Sl_Hall_Y_Slope_by_AF[ i - 1 ] * ( us_af_code - Us_Af_Position[ i - 1 ] ) + ( Sl_Hall_Y_by_AF[ i - 1 ] - Sl_Hall_Y_by_AF[ 0 ] ) ) ;
+			break ;
+		}
+	}
+	
+	RamWrite32A( HALL_RAM_HXOFF1, sl_offset_x ) ;
+	RamWrite32A( HALL_RAM_HYOFF1, sl_offset_y ) ;
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: CalcSetMizxAndLinearityData
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: UcMode	0:disable	1:enable
+//					: mlLinearityValue *linval
+// Explanation		: Flash write linearity correction data function
+// History			: First edition
+//********************************************************************************
+#define N 7  /* ƒf�[ƒ^�” */
+
+UINT8	CalcSetMizxAndLinearityData( mlLinearityValue *linval ,  mlMixingValue *mixval )
+{
+	int i;
+ 	double Xa = 0, Ya = 0;
+  	double Xsum_xy = 0, Xsum_x = 0, Xsum_y = 0, Xsum_x2 = 0;
+  	double Ysum_xy = 0, Ysum_x = 0, Ysum_y = 0, Ysum_x2 = 0;
+	UINT8		ans;
+	
+	// **************************************************
+	// �Å�¬2�æ–@
+	// **************************************************
+#ifdef __MIX_LIB_METHOD__		// TESTAPP library method
+	for (i=0; i<N; i++) {
+		Xsum_xy += i * mixval->XonXmove[i];
+		Xsum_x  += i;
+		Xsum_y  += mixval->XonXmove[i];
+		
+		Ysum_xy += i * mixval->YonXmove[i];
+		Ysum_y  += mixval->YonXmove[i];
+	}
+ 	Xa = ((N * Ysum_xy) - (Xsum_x * Ysum_y)) / ((N * Xsum_xy) - (Xsum_x * Xsum_y));
+
+  	Xsum_xy = Xsum_x = Xsum_y = Xsum_x2 = 0;
+  	Ysum_xy = Ysum_x = Ysum_y = Ysum_x2 = 0;
+
+	for (i=0; i<N; i++) {
+		Xsum_xy += i * mixval->XonYmove[i];
+		Xsum_x  += i;
+		Xsum_y  += mixval->XonYmove[i];
+
+		Ysum_xy += i * mixval->YonYmove[i];
+		Ysum_y  += mixval->YonYmove[i];
+	}
+ 	Ya = ((N * Xsum_xy) - (Xsum_x * Xsum_y)) / ((N * Ysum_xy) - (Xsum_x * Ysum_y));
+#else
+	for (i=0; i<N; i++) {
+		Xsum_xy += mixval->XonXmove[i] * mixval->YonXmove[i];
+		Xsum_x  += mixval->XonXmove[i];
+		Xsum_y  += mixval->YonXmove[i];
+		Xsum_x2 += pow(mixval->XonXmove[i], 2);
+
+		Ysum_xy += mixval->YonYmove[i] * mixval->XonYmove[i];
+		Ysum_x  += mixval->YonYmove[i];
+		Ysum_y  += mixval->XonYmove[i];
+		Ysum_x2 += pow(mixval->YonYmove[i], 2);
+	}
+ 	Xa = ((N * Xsum_xy) - (Xsum_x * Xsum_y)) / ((N * Xsum_x2) - pow(Xsum_x, 2));
+ 	Ya = ((N * Ysum_xy) - (Ysum_x * Ysum_y)) / ((N * Ysum_x2) - pow(Ysum_x, 2));
+#endif
+
+TRACE("Xa = %f\n", Xa);
+TRACE("Ya = %f\n", Ya);
+
+	// **************************************************
+	// MIXINGŒW�”ŒvŽZ
+	// **************************************************
+TRACE("degreeX  = %f\n", -atan(Xa)*180/3.14159265358979323846 );
+TRACE("degreeY  = %f\n", +atan(Ya)*180/3.14159265358979323846 );
+#if (SLT_XY_SWAP ==1)
+	mixval->radianX = +atan(Ya);
+	mixval->radianY = -atan(Xa);
+#else
+	mixval->radianX = -atan(Xa);
+	mixval->radianY = +atan(Ya);
+#endif
+//TRACE("radianX  = %f\n", mixval->radianX);
+//TRACE("radianY  = %f\n", mixval->radianY);
+
+	mixval->hx45x = +(cos(mixval->radianY) / cos(mixval->radianX - mixval->radianY));
+    mixval->hx45y = +(sin(mixval->radianY) / cos(mixval->radianX - mixval->radianY));
+//    mixval->hy45y = -(cos(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+//    mixval->hy45x = -(sin(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+    mixval->hy45y = +(cos(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+    mixval->hy45x = -(sin(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+
+	mixval->hxsx = (unsigned char)abs(mixval->hx45x);                                     // >1‚È‚ç‚΃Vƒtƒg�”‚Æ‚µ‚Ä�Ý’è
+	mixval->hysx = (unsigned char)abs(mixval->hy45y);                                     // >1‚È‚ç‚΃Vƒtƒg�”‚Æ‚µ‚Ä�Ý’è
+
+    mixval->hx45x = mixval->hx45x / pow(2, (double)mixval->hxsx);        // ƒVƒtƒg‚ð‰Á–¡‚µ‚Ä�ÄŒvŽZ
+    mixval->hy45y = mixval->hy45y / pow(2, (double)mixval->hysx);        // ƒVƒtƒg‚ð‰Á–¡‚µ‚Ä�ÄŒvŽZ
+
+TRACE("hx45x  = %f\n", mixval->hx45x);
+TRACE("hx45y  = %f\n", mixval->hx45y);
+TRACE("hy45y  = %f\n", mixval->hy45y);
+TRACE("hy45x  = %f\n", mixval->hy45x);
+TRACE("hxsx  = %02X\n", mixval->hxsx);
+TRACE("hysx  = %02X\n", mixval->hysx);
+
+	mixval->hx45xL = (long)(mixval->hx45x * 0x7FFFFFFF);
+	mixval->hx45yL = (long)(mixval->hx45y * 0x7FFFFFFF);
+	mixval->hy45yL = (long)(mixval->hy45y * 0x7FFFFFFF);
+	mixval->hy45xL = (long)(mixval->hy45x * 0x7FFFFFFF);
+
+TRACE("hx45xL  = %08X\n", mixval->hx45xL);
+TRACE("hx45yL  = %08X\n", mixval->hx45yL);
+TRACE("hy45yL  = %08X\n", mixval->hy45yL);
+TRACE("hy45xL  = %08X\n", mixval->hy45xL);
+
+	// **************************************************
+	// RAM‚ɃZƒbƒg‚·‚é
+	// **************************************************
+	RamWrite32A( HF_hx45x, mixval->hx45xL ) ; 
+	RamWrite32A( HF_hx45y, mixval->hx45yL ) ; 
+	RamWrite32A( HF_hy45y, mixval->hy45yL ) ; 
+	RamWrite32A( HF_hy45x, mixval->hy45xL ) ; 
+	RamWrite32A( HF_ShiftX, ( (UINT32) mixval->hxsx << 0) | ((UINT32)mixval->hysx << 8) ) ;
+
+	ans	= WrHallLnData( 1, linval ) ;
+	
+	if( ans ) {
+		return( ans ) ;														// CheckSum OK
+	}
+	
+	ans	= WrMixCalData( 1, mixval ) ;
+	
+	return( ans ) ;															// CheckSum OK
+}
+#endif
+
+#if USE_BOSCH
+//********************************************************************************
+// Function Name 	: Read_BMI260_CHIP_ID
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Read CHIP_ID from BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 Read_BMI260_CHIP_ID( void )
+{
+	unsigned char ReadData;
+
+	struct bmi2_dev dev = {
+	        .dev_id = BMI2_I2C_PRIM_ADDR,
+	        .intf = BMI2_I2C_INTERFACE,
+	        .read = bmi2_i2c_read,
+	        .write = bmi2_i2c_write,
+	        .delay_ms = bmi2_delay_milli_sec,
+	        .read_write_len = 2,
+	        .config_file_ptr = NULL
+	};
+
+	bmi2_get_regs( CHIP_ID_260, &ReadData, 1, &dev );
+
+	return ReadData;
+}
+
+//********************************************************************************
+// Function Name 	: Configuring_BMI260
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Initialize BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 Configuring_BMI260( void )
+{
+	unsigned char WriteData;
+	unsigned char ReadData;
+	char          Count;
+	unsigned char Status = FAILURE;									// 0x01=NG  0x00=OK
+
+	struct bmi2_dev dev = {
+	        .dev_id = BMI2_I2C_PRIM_ADDR,
+	        .intf = BMI2_I2C_INTERFACE,
+	        .read = bmi2_i2c_read,
+	        .write = bmi2_i2c_write,
+	        .delay_ms = bmi2_delay_milli_sec,
+	        .read_write_len = 2,
+	        .config_file_ptr = NULL
+	};
+
+	// PWR_CTRL(0x7D) to set bit ACC_EN and GYR_EN to neable them
+	Count = 0;
+	do {
+		WriteData = 0x0E;
+		bmi2_set_regs( PWR_CTRL_260, &WriteData, 1, &dev );			// write to BMI260
+		bmi2_get_regs( PWR_CTRL_260, &ReadData, 1, &dev );			// read from BMI260
+
+		if( WriteData == ReadData ) {
+			Status = SUCCESS;
+			break;
+		}
+	} while( Count++ < 20 );
+
+	if( Status == FAILURE ) return Status;
+
+	// Please set as necessary.
+	// Setting accelerometer interface
+	WriteData = 0xA8;										// ACC_CONF(0x40) to set accelerometer interface ODR bandwidth
+	bmi2_set_regs( ACC_CONF_260, &WriteData, 1, &dev );
+	WriteData = 0x00;										// ACC_RANGE(0x41) to set accelerometer interface range
+	bmi2_set_regs( ACC_RANGE_260, &WriteData, 1, &dev );
+	WriteData = 0x04;										// GYR_RANGE(0x43) to select OIS RANGE
+	bmi2_set_regs( GYR_RANGE_260, &WriteData, 1, &dev );
+	WriteData = 0xE9;										// GYR_CONF(0x42)
+	bmi2_set_regs( GYR_CONF_260, &WriteData, 1, &dev );
+	WriteData = 0x02;										// PWR_CONF(0x7C)
+	bmi2_set_regs( PWR_CONF_260, &WriteData, 1, &dev );
+	WriteData = 0x10;										// IF_CONF(0x6B)
+	bmi2_set_regs( IF_CONF_260, &WriteData, 1, &dev );
+
+	return Status;
+}
+
+//********************************************************************************
+// Function Name 	: PerformingInitialization_BMI260
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Performing Initialization sequence BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 PerformingInitialization_BMI260( void )
+{
+	int8_t rslt;
+
+	struct bmi2_dev dev = {
+	        .dev_id = BMI2_I2C_PRIM_ADDR,
+	        .intf = BMI2_I2C_INTERFACE,
+	        .read = bmi2_i2c_read,
+	        .write = bmi2_i2c_write,
+	        .delay_ms = bmi2_delay_milli_sec,
+//	        .read_write_len = 2,
+	        .read_write_len = 60,
+	        .config_file_ptr = NULL
+	};
+
+	rslt = bmi2_init(&dev);
+	if (rslt != BMI2_OK) {								// BMI2_OK(0x00)
+		rslt = FAILURE;									// 0x01=NG  0x00=OK
+	}
+
+	return rslt;
+}
+
+//********************************************************************************
+// Function Name 	: Read_InternalStatus_BMI260
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Checking the correct initialization status BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 Read_InternalStatus_BMI260( void )
+{
+	unsigned char ReadData;
+
+	struct bmi2_dev dev = {
+	        .dev_id = BMI2_I2C_PRIM_ADDR,
+	        .intf = BMI2_I2C_INTERFACE,
+	        .read = bmi2_i2c_read,
+	        .write = bmi2_i2c_write,
+	        .delay_ms = bmi2_delay_milli_sec,
+	        .read_write_len = 2,
+	        .config_file_ptr = NULL
+	};
+
+	bmi2_get_regs( INTERNAL_STATUS_260, &ReadData, 1, &dev );
+
+	return ReadData;
+}
+#endif
+
+
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=  ‚±‚±‚Ü‚Å by K.Otake                                                                         +=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.c
new file mode 100644
index 0000000000000000000000000000000000000000..777e40cd0481345fbc3e29b3af314bbe816ba821
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.c
@@ -0,0 +1,445 @@
+/**
+ * @brief		FRA measurement command for LC898123 F40
+ *
+ * @author		Copyright (C) 2016, ON Semiconductor, all right reserved.
+ *
+ * @file		OisFRA.c
+ * @date		svn:$Date:: 2016-06-17 16:42:32 +0900#$
+ * @version	svn:$Revision: 54 $
+ * @attention
+ **/
+
+//**************************
+//	Include Header File
+//**************************
+#define		__OISFRA__
+
+#include	<math.h>
+#include	"Ois.h"
+#include	"OisAPI.h"
+#include	"OisFRA.h"
+
+
+//#define ACT_THROUGH_CLOSE		// for ball type
+//#define CLOSED_RESPONSE			// for openloop measurement
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */
+extern	void RamWrite32A( INT32, INT32 );
+extern 	void RamRead32A( UINT16, void * );
+/* for Wait timer [Need to adjust for your system] */
+extern void	WitTim( UINT16 );
+
+//**************************
+//	External Function Prototype
+//**************************
+extern void	SetSineWave(   UINT8 , UINT8 );
+extern void	SetSinWavGenInt( void );
+extern void	SetTransDataAdr( UINT16, UINT32  ) ;
+extern void	MeasureWait( void ) ;
+extern void	ClrMesFil( void ) ;
+extern void	SetWaitTime( UINT16 ) ;
+
+#ifdef ACT_THROUGH_CLOSE
+UINT_32 BackupParameter[30];
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : SetThroughParameter 		                                         */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+void SetThroughParameter(UINT_8	UcDirSel )
+{
+	if( UcDirSel == X_DIR ) {
+		BackupParameter[29] = X_DIR;
+		RamRead32A( HallFilterCoeffX_hxdgain0, &BackupParameter[0]);
+		RamRead32A( HallFilterCoeffX_hxpgain0, &BackupParameter[1]);
+		RamRead32A( HallFilterCoeffX_hxpgain1, &BackupParameter[2]);
+		RamRead32A( HallFilterCoeffX_hxigain0, &BackupParameter[3]);
+		RamRead32A( HallFilterCoeffX_hxgain0, &BackupParameter[4]);	
+		RamRead32A( HallFilterShiftX, &BackupParameter[5]);	
+		RamRead32A( (HallFilterShiftX+4), &BackupParameter[6]);	
+		RamRead32A( HallFilterCoeffX_hxsa, &BackupParameter[7]);
+		RamRead32A( HallFilterCoeffX_hxsb, &BackupParameter[8]);
+		RamRead32A( HallFilterCoeffX_hxsc, &BackupParameter[9]);
+		RamRead32A( HallFilterCoeffX_hxoa, &BackupParameter[10]);
+		RamRead32A( HallFilterCoeffX_hxob, &BackupParameter[11]);
+		RamRead32A( HallFilterCoeffX_hxoc, &BackupParameter[12]);
+		RamRead32A( HallFilterCoeffX_hxod, &BackupParameter[13]);
+		RamRead32A( HallFilterCoeffX_hxoe, &BackupParameter[14]);
+		RamRead32A( HallFilterCoeffX_hxpa, &BackupParameter[15]);
+		RamRead32A( HallFilterCoeffX_hxpb, &BackupParameter[16]);
+		RamRead32A( HallFilterCoeffX_hxpc, &BackupParameter[17]);
+		RamRead32A( HallFilterCoeffX_hxpd, &BackupParameter[18]);
+		RamRead32A( HallFilterCoeffX_hxpe, &BackupParameter[19]);
+
+		RamWrite32A( HallFilterCoeffX_hxdgain0, 0x00000000);	//RAMW32	80EC	00000000
+		RamWrite32A( HallFilterCoeffX_hxpgain0, 0x7fffffff);	//RAMW32	80D8	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxpgain1, 0x7fffffff);	//RAMW32	80E4	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxigain0, 0x00000000);	//RAMW32	80E8	00000000
+		RamWrite32A( HallFilterCoeffX_hxgain0, 0x7fffffff);		//RAMW32	80F0	7fffffff
+		RamWrite32A( HallFilterShiftX, 0x00000000);				//RAMW32	81F8	00000000
+		RamWrite32A( (HallFilterShiftX+4), 0x00000000);			//RAMW32	81FC	00000000
+		RamWrite32A( HallFilterCoeffX_hxsa, 0x7fffffff);		//RAMW32	8100	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxsb, 0x00000000);		//RAMW32	80F8	00000000
+		RamWrite32A( HallFilterCoeffX_hxsc, 0x00000000);		//RAMW32	80FC	00000000
+		RamWrite32A( HallFilterCoeffX_hxoa, 0x7fffffff);		//RAMW32	8114	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxob, 0x00000000);		//RAMW32	8104	00000000
+		RamWrite32A( HallFilterCoeffX_hxoc, 0x00000000);		//RAMW32	8108	00000000
+		RamWrite32A( HallFilterCoeffX_hxod, 0x00000000);		//RAMW32	810C	00000000
+		RamWrite32A( HallFilterCoeffX_hxoe, 0x00000000);		//RAMW32	8110	00000000
+		RamWrite32A( HallFilterCoeffX_hxpa, 0x7fffffff);		//RAMW32	8128	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxpb, 0x00000000);		//RAMW32	8118	00000000
+		RamWrite32A( HallFilterCoeffX_hxpc, 0x00000000);		//RAMW32	811C	00000000
+		RamWrite32A( HallFilterCoeffX_hxpd, 0x00000000);		//RAMW32	8120	00000000
+		RamWrite32A( HallFilterCoeffX_hxpe, 0x00000000);		//RAMW32	8124	00000000
+	}else if( UcDirSel == Y_DIR ){
+		BackupParameter[29] = Y_DIR;
+		RamRead32A( HallFilterCoeffY_hydgain0, &BackupParameter[0]);
+		RamRead32A( HallFilterCoeffY_hypgain0, &BackupParameter[1]);
+		RamRead32A( HallFilterCoeffY_hypgain1, &BackupParameter[2]);
+		RamRead32A( HallFilterCoeffY_hyigain0, &BackupParameter[3]);
+		RamRead32A( HallFilterCoeffY_hygain0, &BackupParameter[4]);
+		RamRead32A( HallFilterShiftY, &BackupParameter[5]);	
+		RamRead32A( HallFilterCoeffY_hysa, &BackupParameter[6]);
+		RamRead32A( HallFilterCoeffY_hysb, &BackupParameter[7]);
+		RamRead32A( HallFilterCoeffY_hysc, &BackupParameter[8]);
+		RamRead32A( HallFilterCoeffY_hyoa, &BackupParameter[9]);
+		RamRead32A( HallFilterCoeffY_hyob, &BackupParameter[10]);
+		RamRead32A( HallFilterCoeffY_hyoc, &BackupParameter[11]);
+		RamRead32A( HallFilterCoeffY_hyod, &BackupParameter[12]);
+		RamRead32A( HallFilterCoeffY_hyoe, &BackupParameter[13]);
+		RamRead32A( HallFilterCoeffY_hypa, &BackupParameter[14]);
+		RamRead32A( HallFilterCoeffY_hypb, &BackupParameter[15]);
+		RamRead32A( HallFilterCoeffY_hypc, &BackupParameter[16]);
+		RamRead32A( HallFilterCoeffY_hypd, &BackupParameter[17]);
+		RamRead32A( HallFilterCoeffY_hype, &BackupParameter[18]);
+		
+		RamWrite32A( HallFilterCoeffY_hydgain0, 0x00000000);	//RAMW32	8188	00000000
+		RamWrite32A( HallFilterCoeffY_hypgain0, 0x7fffffff);	//RAMW32	8174	7fffffff
+		RamWrite32A( HallFilterCoeffY_hypgain1, 0x7fffffff);	//RAMW32	8180	7fffffff
+		RamWrite32A( HallFilterCoeffY_hyigain0, 0x00000000);	//RAMW32	8184	00000000
+		RamWrite32A( HallFilterCoeffY_hygain0, 0x7fffffff);		//RAMW32	818C	7fffffff
+		RamWrite32A( HallFilterShiftY, 0x00000000);				//RAMW32	8200	00000000
+		RamWrite32A( HallFilterCoeffY_hysa, 0x7fffffff);		//RAMW32	819C	7fffffff
+		RamWrite32A( HallFilterCoeffY_hysb, 0x00000000);		//RAMW32	8194	00000000
+		RamWrite32A( HallFilterCoeffY_hysc, 0x00000000);		//RAMW32	8198	00000000
+		RamWrite32A( HallFilterCoeffY_hyoa, 0x7fffffff);		//RAMW32	81B0	7fffffff
+		RamWrite32A( HallFilterCoeffY_hyob, 0x00000000);		//RAMW32	81A0	00000000
+		RamWrite32A( HallFilterCoeffY_hyoc, 0x00000000);		//RAMW32	81A4	00000000
+		RamWrite32A( HallFilterCoeffY_hyod, 0x00000000);		//RAMW32	81A8	00000000
+		RamWrite32A( HallFilterCoeffY_hyoe, 0x00000000);		//RAMW32	81AC	00000000
+		RamWrite32A( HallFilterCoeffY_hypa, 0x7fffffff);		//RAMW32	81C4	7fffffff
+		RamWrite32A( HallFilterCoeffY_hypb, 0x00000000);		//RAMW32	81B4	00000000
+		RamWrite32A( HallFilterCoeffY_hypc, 0x00000000);		//RAMW32	81B8	00000000
+		RamWrite32A( HallFilterCoeffY_hypd, 0x00000000);		//RAMW32	81BC	00000000
+		RamWrite32A( HallFilterCoeffY_hype, 0x00000000);		//RAMW32	81C0	00000000
+	}else if( UcDirSel == Z_DIR ){
+		}
+	}
+
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : ResetThroughParameter 		                                     */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+void ResetThroughParameter(void)
+{
+	if( BackupParameter[29] == X_DIR ) {
+		RamWrite32A( HallFilterCoeffX_hxdgain0, BackupParameter[0]);
+		RamWrite32A( HallFilterCoeffX_hxpgain0, BackupParameter[1]);
+		RamWrite32A( HallFilterCoeffX_hxpgain1, BackupParameter[2]);
+		RamWrite32A( HallFilterCoeffX_hxigain0, BackupParameter[3]);
+		RamWrite32A( HallFilterCoeffX_hxgain0, BackupParameter[4]);	
+		RamWrite32A( HallFilterShiftX, BackupParameter[5]);	
+		RamWrite32A( (HallFilterShiftX+4), BackupParameter[6]);	
+		RamWrite32A( HallFilterCoeffX_hxsa, BackupParameter[7]);
+		RamWrite32A( HallFilterCoeffX_hxsb, BackupParameter[8]);
+		RamWrite32A( HallFilterCoeffX_hxsc, BackupParameter[9]);
+		RamWrite32A( HallFilterCoeffX_hxoa, BackupParameter[10]);
+		RamWrite32A( HallFilterCoeffX_hxob, BackupParameter[11]);
+		RamWrite32A( HallFilterCoeffX_hxoc, BackupParameter[12]);
+		RamWrite32A( HallFilterCoeffX_hxod, BackupParameter[13]);
+		RamWrite32A( HallFilterCoeffX_hxoe, BackupParameter[14]);
+		RamWrite32A( HallFilterCoeffX_hxpa, BackupParameter[15]);
+		RamWrite32A( HallFilterCoeffX_hxpb, BackupParameter[16]);
+		RamWrite32A( HallFilterCoeffX_hxpc, BackupParameter[17]);
+		RamWrite32A( HallFilterCoeffX_hxpd, BackupParameter[18]);
+		RamWrite32A( HallFilterCoeffX_hxpe, BackupParameter[19]);
+	}else if( BackupParameter[29] == Y_DIR ){
+		RamWrite32A( HallFilterCoeffY_hydgain0, BackupParameter[0]);
+		RamWrite32A( HallFilterCoeffY_hypgain0, BackupParameter[1]);
+		RamWrite32A( HallFilterCoeffY_hypgain1, BackupParameter[2]);
+		RamWrite32A( HallFilterCoeffY_hyigain0, BackupParameter[3]);
+		RamWrite32A( HallFilterCoeffY_hygain0, BackupParameter[4]);
+		RamWrite32A( HallFilterShiftY, BackupParameter[5]);	
+		RamWrite32A( HallFilterCoeffY_hysa, BackupParameter[6]);
+		RamWrite32A( HallFilterCoeffY_hysb, BackupParameter[7]);
+		RamWrite32A( HallFilterCoeffY_hysc, BackupParameter[8]);
+		RamWrite32A( HallFilterCoeffY_hyoa, BackupParameter[9]);
+		RamWrite32A( HallFilterCoeffY_hyob, BackupParameter[10]);
+		RamWrite32A( HallFilterCoeffY_hyoc, BackupParameter[11]);
+		RamWrite32A( HallFilterCoeffY_hyod, BackupParameter[12]);
+		RamWrite32A( HallFilterCoeffY_hyoe, BackupParameter[13]);
+		RamWrite32A( HallFilterCoeffY_hypa, BackupParameter[14]);
+		RamWrite32A( HallFilterCoeffY_hypb, BackupParameter[15]);
+		RamWrite32A( HallFilterCoeffY_hypc, BackupParameter[16]);
+		RamWrite32A( HallFilterCoeffY_hypd, BackupParameter[17]);
+		RamWrite32A( HallFilterCoeffY_hype, BackupParameter[18]);
+	}else if( BackupParameter[29] == Z_DIR ){
+	}
+}
+#endif
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : CoeffGenerate  		                                             */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+#define	Q31 	( 0x7FFFFFFF )
+#define	Q23 	( 0x007FFFFF )
+#define	Q21 	( 0x001FFFFF )
+#define	PAI 	( 3.14159265358979323846 )
+#define N 		( 2048 )
+int     nDivision;
+
+void CoeffGenerate( double fc )
+{
+	double  df, fs; 
+	int     point, C0, S0, CN, SN;
+	double  theta;			// theta = 2*Pi*f/Fs
+
+	if 		( fc > 40 ){ nDivision = 0; fs = (FS_FREQ    ); }
+	else if ( fc > 20 ){ nDivision = 1; fs = (FS_FREQ / 2); }
+	else if ( fc > 10 ){ nDivision = 2; fs = (FS_FREQ / 4); }
+	else if ( fc >  5 ){ nDivision = 3; fs = (FS_FREQ / 8); }
+	else 			   { nDivision = 4; fs = (FS_FREQ /16); }
+
+	//***** Žæ“¾‚µ‚½Žü”g�”ƒe�[ƒuƒ‹‚©‚ç”»’èƒ|ƒCƒ“ƒg‚Æ”»’ètheta‚ÌŽZ�o *****
+	df = fs / (double)N;									// FFT‚Ì1ƒ|ƒCƒ“ƒg“–‚½‚è‚ÌŽü”g�”
+	point = (int)(fc / df + 0.5);							// ”»’èƒ|ƒCƒ“ƒg‚ÌŽZ�o
+	theta = 2.0 * PAI * (double)point * df / fs;			// ”»’èƒ|ƒCƒ“ƒg‚ł̈ʑŠ‚ÌŽZ�o
+
+	C0 = (int)((double)Q31 * cos(theta) + 0.5);
+	S0 = (int)((double)Q31 * sin(theta) + 0.5);
+	CN = (int)((double)Q31 * cos(((double)N - 1.0) * theta) + 0.5);
+	SN = (int)((double)Q31 * sin(((double)N - 1.0) * theta) + 0.5);
+
+	RamWrite32A( FRA_DMA_DeciShift, nDivision );	
+	RamWrite32A( FRA_DMB_C0, C0 ) ;
+	RamWrite32A( FRA_DMB_S0, S0 ) ;
+	RamWrite32A( FRA_DMB_CN, CN ) ;
+	RamWrite32A( FRA_DMB_SN, SN ) ;
+
+TRACE("0x%08X, 0x%08X, 0x%08X, 0x%08X,\n", C0, S0, CN, SN);
+}
+
+//********************************************************************************
+// Function Name 	: Freq_Convert
+// Retun Value		: Phase Step Value
+// Argment Value	: Frequency
+// Explanation		: Convert Frequency
+// History			: First edition
+//********************************************************************************
+UINT32	Freq_Convert( float SfFreq )
+{
+	UINT32	UlPhsStep;
+	
+	UlPhsStep	= ( UINT32 )( ( SfFreq * ( float )0x100000000 / FS_FREQ + 0.5F ) / 2.0F ) ;
+
+	return( UlPhsStep ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: MesStart_FRA_Single
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	MesStart_FRA_Single( UINT8	UcDirSel )
+{
+	float	SfTmp ;
+	INT32	GainQ23, PhaseQ21 ;
+	UINT32	UlReadVal ;	
+
+
+	SetSinWavGenInt() ;
+	// Change Frequency 
+	RamWrite32A( SinWave_Offset,	Freq_Convert( StFRAParam.StHostCom.SfFrqCom.SfFltVal ) ) ;		// Freq Setting = Freq * 80000000h / Fs	: 10Hz
+
+	SfTmp	= StFRAParam.StHostCom.SfAmpCom.SfFltVal / 1400.0F ;									// AVDD 2800mV / 2 = 1400mV
+	RamWrite32A( SinWave_Gain,		( UINT32 )( ( float )0x7FFFFFFF * SfTmp ) ) ;					// Set Sine Wave Gain
+
+	if ( StFRAParam.StHostCom.UcAvgCycl == 10) 	{  		// Actuator Through
+#ifdef ACT_THROUGH_CLOSE
+		SetThroughParameter( UcDirSel );
+
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_XSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XHOUTA ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_XHOUTB ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_YSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YHOUTA ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_YHOUTB ) ;
+		}else if( UcDirSel == Z_DIR ){
+		}
+#else
+		RtnCen( BOTH_OFF ) ;
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_SINDX1 ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_RAM_SINDX1 ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_RAM_HXIDAT ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_SINDY1 ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_RAM_SINDY1 ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_RAM_HXIDAT ) ;
+		}
+ #ifdef SEL_CLOSED_AF
+		else if( UcDirSel == Z_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)CLAF_RAMA_AFOUT ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, CLAF_RAMA_AFOUT ) ;
+			RamWrite32A( FRA_DMA_OutputData, CLAF_RAMA_AFADIN ) ;
+	}
+ #endif
+#endif
+		} else {
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_XSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XSININ ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XHOUTA ) ;
+#endif
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_XHOUTB ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_YSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YSININ  ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YHOUTA ) ;
+#endif			
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_YHOUTB ) ;
+		}
+#ifdef SEL_CLOSED_AF
+		else if( UcDirSel == Z_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)CLAF_RAMA_AFSINE ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, CLAF_RAMA_AFSINE  ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, CLAF_DELAY_AFDZ0 ) ;
+#endif			
+			RamWrite32A( FRA_DMA_OutputData, CLAF_RAMA_AFDEV ) ;
+		}
+#endif // SEL_CLOSED_AF
+	}
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;												// Sine Wave Start
+
+
+	CoeffGenerate( StFRAParam.StHostCom.SfFrqCom.SfFltVal );
+//	WitTim(10);
+	// Start to measure
+	RamWrite32A( FRA_DMA_Control,1 ) ;
+
+	if (nDivision == 0)	WitTim(100);
+	if (nDivision == 1)	WitTim(200);
+	if (nDivision == 2)	WitTim(400);
+	if (nDivision == 3)	WitTim(800);
+	if (nDivision == 4)	WitTim(1600);
+	do{
+		WitTim(10);
+		RamRead32A( FRA_DMA_Control	, &UlReadVal ) ;	
+	}while (UlReadVal == 1);
+	// Read answer
+	RamRead32A( FRA_DMA_Gain	, &GainQ23 ) ;		// Gain
+	RamRead32A( FRA_DMA_Phase	, &PhaseQ21 ) ;		// Phase
+	StFRAParam.StMesRslt.SfGainAvg = (float)GainQ23 / Q23; //0x007FFFFF;
+	StFRAParam.StMesRslt.SfPhaseAvg = (float)PhaseQ21 / Q21; //0x001FFFFF;	
+
+	TRACE("Phase %f deg : Gain %f dB\n", StFRAParam.StMesRslt.SfPhaseAvg, StFRAParam.StMesRslt.SfGainAvg );
+
+}
+
+
+
+//********************************************************************************
+// Function Name 	: MesStart_FRA_Continue
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Continue Measurement Function
+// History			: First edition
+//********************************************************************************
+void	MesStart_FRA_Continue( void )
+{
+	INT32	GainQ23, PhaseQ21 ;
+	UINT32	UlReadVal ;	
+	
+	// Change Frequency 
+	RamWrite32A( SinWave_Offset,	Freq_Convert( StFRAParam.StHostCom.SfFrqCom.SfFltVal ) ) ;
+	// Set parameter
+	CoeffGenerate( StFRAParam.StHostCom.SfFrqCom.SfFltVal );
+//	WitTim(10)
+	// Start to measure
+	RamWrite32A( FRA_DMA_Control,1 ) ;									// Integral Value Clear
+	if (nDivision == 0)	WitTim(100);
+	if (nDivision == 1)	WitTim(200);
+	if (nDivision == 2)	WitTim(400);
+	if (nDivision == 3)	WitTim(800);
+	if (nDivision == 4)	WitTim(1600);
+	do{
+		WitTim(10);	
+		RamRead32A( FRA_DMA_Control	, &UlReadVal ) ;	
+	}while (UlReadVal == 1);
+	// Read answer
+	RamRead32A( FRA_DMA_Gain	, &GainQ23 ) ;		// Gain
+	RamRead32A( FRA_DMA_Phase	, &PhaseQ21 ) ;		// Phase
+	StFRAParam.StMesRslt.SfGainAvg = (float)GainQ23 / Q23;
+	StFRAParam.StMesRslt.SfPhaseAvg = (float)PhaseQ21 / Q21;	
+
+	TRACE("Phase %f deg : Gain %f dB\n", StFRAParam.StMesRslt.SfPhaseAvg, StFRAParam.StMesRslt.SfGainAvg );
+}
+
+
+
+//********************************************************************************
+// Function Name 	: MesEnd_FRA_Sweep
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Stop Measurement Function
+// History			: First edition
+//********************************************************************************
+void	MesEnd_FRA_Sweep( void )
+{
+	// Stop Sine Wave
+	RamWrite32A( SinWaveC_Regsiter,		0x00000000 ) ;					// Sine Wave Stop
+	SetTransDataAdr( SinWave_OutAddr,	( UINT32 )0x00000000 ) ;		// Set Sine Wave Input RAM
+
+	if ( StFRAParam.StHostCom.UcAvgCycl == 10) 	{  		// Actuator Through
+#ifdef ACT_THROUGH_CLOSE
+		ResetThroughParameter( );
+#else
+		RtnCen( BOTH_ON ) ;
+#endif
+	}
+	RamWrite32A( HALL_RAM_SINDX0,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_RAM_SINDY0,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_FRA_XSININ,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_FRA_YSININ,	0x00000000 ) ;		// DelayRam Clear
+
+}
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.h
new file mode 100644
index 0000000000000000000000000000000000000000..94dab4eaa1d01535d82c0c6d767fb58338c9221f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/OisFRA.h
@@ -0,0 +1,62 @@
+/**
+ * @brief		FRA measurement header for LC898123 F40
+ * 				API List for customers
+ *
+ * @author		Copyright (C) 2016, ON Semiconductor, all right reserved.
+ *
+ * @file		OisAPI.h
+ * @date		svn:$Date:: 2016-04-28 14:30:21 +0900#$
+ * @version		svn:$Revision: 43 $
+ * @attention
+ **/
+#ifndef OISFRA_H_
+#define OISFRA_H_
+
+//****************************************************
+//	extern selector for API
+//****************************************************
+#ifdef	__OISFRA__
+	#define	__OIS_FRA_HEADER__
+#else
+	#define	__OIS_FRA_HEADER__		extern
+#endif
+
+typedef struct STFRA_PARAM {
+	struct {
+		UnFltVal		SfFrqCom ;
+		UnFltVal		SfAmpCom ;
+		unsigned char	UcAvgCycl ;
+	} StHostCom ;
+
+	float				SfGain[ 10 ] ;
+	float				SfPhase[ 10 ] ;
+
+	struct {
+		float			SfGainAvg ;
+		float			SfPhaseAvg ;
+	} StMesRslt ;
+} StFRAParam_t ;
+
+__OIS_FRA_HEADER__	StFRAParam_t	StFRAParam ;
+/*
+typedef struct STFRA_MES {
+	UINT_64	UllCumulAdd1 ;
+	UINT_64	UllCumulAdd2 ;
+	UINT_16	UsFsCount ;
+} StFRAMes_t ;
+
+__OIS_FRA_HEADER__	StFRAMes_t		StFRAMes ;
+
+typedef struct  {
+	INT_32	a1 ;
+	INT_32	b1 ;
+	INT_32	c1 ;
+	INT_32	a2 ;
+	INT_32	b2 ;
+	INT_32	c2 ;
+} StMesFCoeff_t ;
+
+*/
+
+
+#endif	// OISFRA_H_
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Ois_BOSCH.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Ois_BOSCH.h
new file mode 100644
index 0000000000000000000000000000000000000000..3042fa2ee62109ba3d103e2cd08208a635393010
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/18857ois_fw/Ois_BOSCH.h
@@ -0,0 +1,34 @@
+//********************************************************************************
+//
+//		<< BMI260 Evaluation Soft>>
+//		Program Name	: Ois_BOSCH.h
+// 		Explanation		: BMI260 Global Declaration & ProtType Declaration
+//		Design			: K.abe
+//		History			: First edition	
+//********************************************************************************
+#define BMI260_SlvAddrWr	0xD0		// I2C Slave Address
+#define BMI260_SlvAddrRd	0xD1		// I2C Slave Address
+
+/************************************************/
+/*	Command Addrss								*/
+/************************************************/
+#define CHIP_ID_260			0x00
+#define INTERNAL_STATUS_260	0x21
+#define	ACC_CONF_260		0x40
+#define ACC_RANGE_260		0x41
+#define	GYR_CONF_260		0x42
+#define GYR_RANGE_260		0x43
+#define INIT_CTRL_260		0x59
+#define INIT_DATA_260		0x5E
+#define IF_CONF_260			0x6B
+#define PWR_CONF_260		0x7C
+#define PWR_CTRL_260		0x7D
+
+/************************************************/
+/*	Data										*/
+/************************************************/
+#define AUX_EN_260			0
+#define GYR_EN_260			1
+#define ACC_EN_260			2
+#define	TEMP_EN_260			3
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_core.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_core.c
index 8e51cd95e4485e158188e14b02b5487d79d6ae88..3744d4f7134decf4387551b5cc88c9d0526bf33b 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_core.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_core.c
@@ -20,6 +20,920 @@
 #include "cam_res_mgr_api.h"
 #include "cam_common_util.h"
 
+#include <linux/string.h>
+#include <linux/time.h>
+#include "ois_fw/Ois.h"
+
+//18821 master
+#include "ois_fw/LC898124EP3_Code_0_1_2_2_0_0.h"		// Gyro=LSM6DSM,	SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Code_0_1_3_2_1_0.h"		// Gyro=LSM6DSM,	SPI Slave	SO3600_T1
+
+//18821 master ofilm
+#include "ois_fw/LC898124EP3_Code_0_2_6_2_0_0.h"		// Gyro=LSM6DSM,	SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Code_0_2_6_2_0_1.h"		// Gyro=LSM6DSM,	SPI Slave	SO3600_T1
+
+//18821 slave
+#include "ois_fw/LC898124EP3_Code_0_1_2_3_0_0.h"		// Gyro=BMI160,		SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Code_0_1_3_3_1_0.h"		// Gyro=BMI160,		SPI Slave	SO3600_T1
+
+//18821 slave ofilm
+#include "ois_fw/LC898124EP3_Code_0_2_7_2_1_0.h"		// Gyro=BMI160,		SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Code_0_2_7_2_1_1.h"		// Gyro=BMI160,		SPI Slave	SO3600_T1
+
+//18857
+#include "ois_fw/LC898124EP3_Code_0_1_0_2_2_0.h"		// Gyro=LSM6DSM,	SO2821
+#include "ois_fw/LC898124EP3_Code_0_1_0_2_2_1.h"		// Gyro=LSM6DSM,	FRA, SO2821
+
+//18821 Servo on master
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_0.h"		// Gyro=LSM6DSM,	SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_0.h"		// Gyro=LSM6DSM,	SPI Slave	SO3600_T1
+
+//18821 Servo on master ofilm
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_2_6_2_0_0.h"		// Gyro=LSM6DSM,	SPI Maste	SO2820_T1
+
+//18821 Servo on slave
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_0.h"		// Gyro=BMI160,		SPI Maste	SO2820_T1
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_0.h"		// Gyro=BMI160,		SPI Slave	SO3600_T1
+
+//18821 Servo on slave ofilm
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_2_7_2_1_0.h"		// Gyro=BMI160,		SPI Maste	SO2820_T1
+
+//18857 Servo on
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_0.h"		// Gyro=LSM6DSM,	SO2821
+#include "ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_1.h"		// Gyro=LSM6DSM,	FRA, SO2821
+
+#define MAX_DATA_NUM 64
+#define MASTER_CCI_ADDR (0x7C >> 1)
+#define SLAVE_CCI_ADDR (0x74 >> 1)
+
+#define BURST_LENGTH_PM (12*5)
+#define BURST_LENGTH_DM (10*6)
+#define BURST_LENGTH BURST_LENGTH_PM
+
+static bool imx586_ois_initialized = false;
+static bool s5k3m5_ois_initialized = false;
+static bool imx586_ois_ready = false;
+static bool s5k3m5_ois_ready = false;
+static struct cam_sensor_i2c_reg_array *i2c_write_setting_gl = NULL;
+extern struct cam_ois_ctrl_t *ctrl;
+
+typedef struct {
+	INT32				SiSampleNum ;			// Measure Sample Number
+	INT32				SiSampleMax ;			// Measure Sample Number Max
+
+	struct {
+		INT32			SiMax1 ;				// Max Measure Result
+		INT32			SiMin1 ;				// Min Measure Result
+		UINT32	UiAmp1 ;				// Amplitude Measure Result
+		INT64		LLiIntegral1 ;			// Integration Measure Result
+		INT64		LLiAbsInteg1 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam1 ;			// Measure Delay RAM Address
+	} MeasureFilterA ;
+
+	struct {
+		INT32			SiMax2 ;				// Max Measure Result
+		INT32			SiMin2 ;				// Min Measure Result
+		UINT32	UiAmp2 ;				// Amplitude Measure Result
+		INT64		LLiIntegral2 ;			// Integration Measure Result
+		INT64		LLiAbsInteg2 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam2 ;			// Measure Delay RAM Address
+	} MeasureFilterB ;
+} MeasureFunction_Type ;
+
+//**************************
+//	define
+//**************************
+#define 	ONE_MSEC_COUNT	18			// 18.0288kHz * 18 ¨P 1ms
+
+//#define 	HALL_ADJ		0
+#define 	LOOPGAIN		1
+#define 	THROUGH			2
+#define 	NOISE			3
+#define		OSCCHK			4
+
+#define		CNT050MS		 676
+#define		CNT100MS		1352
+#define		CNT200MS		2703
+
+//18857
+const DOWNLOAD_TBL DTbl[] = {
+ {0x0002, 1, LC898124EP3_PM_0_1_0_2_2_0, LC898124EP3_PMSize_0_1_0_2_2_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_0_2_2_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_0_2_2_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_0_2_2_0), LC898124EP3_DM_0_1_0_2_2_0, LC898124EP3_DMA_ByteSize_0_1_0_2_2_0 , LC898124EP3_DMB_ByteSize_0_1_0_2_2_0 },
+ {0x0082, 1, LC898124EP3_PM_0_1_0_2_2_1, LC898124EP3_PMSize_0_1_0_2_2_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_0_2_2_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_0_2_2_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_0_2_2_1), LC898124EP3_DM_0_1_0_2_2_1, LC898124EP3_DMA_ByteSize_0_1_0_2_2_1 , LC898124EP3_DMB_ByteSize_0_1_0_2_2_1 },
+ {0x0002, 2, LC898124EP3_SERVO_ON_PM_0_1_0_2_2_0, LC898124EP3_SERVO_ON_PMSize_0_1_0_2_2_0, (UINT32)((UINT32)LC898124EP3_SERVO_ON_PMCheckSum_0_1_0_2_2_0 + (UINT32)LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_0_2_2_0), LC898124EP3_SERVO_ON_DM_0_1_0_2_2_0, LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_0_2_2_0 , LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_0_2_2_0 },
+ {0xFFFF, 1, (void*)0, 0, 0, (void*)0 ,0 ,0 }
+};
+
+//18821 master
+const DOWNLOAD_TBL DTbl_M[] = {
+ {0x0202, 1, LC898124EP3_PM_0_1_2_2_0_0, LC898124EP3_PMSize_0_1_2_2_0_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_2_0_0), LC898124EP3_DM_0_1_2_2_0_0, LC898124EP3_DMA_ByteSize_0_1_2_2_0_0 , LC898124EP3_DMB_ByteSize_0_1_2_2_0_0 },
+ {0x0203, 1, LC898124EP3_PM_0_1_2_3_0_0, LC898124EP3_PMSize_0_1_2_3_0_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_3_0_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_3_0_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_3_0_0), LC898124EP3_DM_0_1_2_3_0_0, LC898124EP3_DMA_ByteSize_0_1_2_3_0_0 , LC898124EP3_DMB_ByteSize_0_1_2_3_0_0 },
+ {0x0602, 1, LC898124EP3_PM_0_2_6_2_0_0, LC898124EP3_PMSize_0_2_6_2_0_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_2_6_2_0_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_2_6_2_0_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_2_6_2_0_0), LC898124EP3_DM_0_2_6_2_0_0, LC898124EP3_DMA_ByteSize_0_2_6_2_0_0 , LC898124EP3_DMB_ByteSize_0_2_6_2_0_0 },
+ {0x0202, 2, LC898124EP3_SERVO_ON_PM_0_1_2_2_0_0, LC898124EP3_SERVO_ON_PMSize_0_1_2_2_0_0, (UINT32)((UINT32)LC898124EP3_SERVO_ON_PMCheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_2_2_0_0), LC898124EP3_SERVO_ON_DM_0_1_2_2_0_0, LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_2_2_0_0 , LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_2_2_0_0 },
+ {0x0602, 2, LC898124EP3_SERVO_ON_PM_0_2_6_2_0_0, LC898124EP3_SERVO_ON_PMSize_0_2_6_2_0_0, (UINT32)((UINT32)LC898124EP3_SERVO_ON_PMCheckSum_0_2_6_2_0_0 + (UINT32)LC898124EP3_SERVO_ON_DMA_CheckSum_0_2_6_2_0_0 + (UINT32)LC898124EP3_SERVO_ON_DMB_CheckSum_0_2_6_2_0_0), LC898124EP3_SERVO_ON_DM_0_2_6_2_0_0, LC898124EP3_SERVO_ON_DMA_ByteSize_0_2_6_2_0_0 , LC898124EP3_SERVO_ON_DMB_ByteSize_0_2_6_2_0_0 },
+ {0xFFFF, 1, (void*)0, 0, 0, (void*)0 ,0 ,0 }
+};
+
+//18821 slave
+const DOWNLOAD_TBL DTbl_S[] = {
+ {0x0302, 1, LC898124EP3_PM_0_1_3_2_1_0, LC898124EP3_PMSize_0_1_3_2_1_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_2_1_0), LC898124EP3_DM_0_1_3_2_1_0, LC898124EP3_DMA_ByteSize_0_1_3_2_1_0 , LC898124EP3_DMB_ByteSize_0_1_3_2_1_0 },
+ {0x0303, 1, LC898124EP3_PM_0_1_3_3_1_0, LC898124EP3_PMSize_0_1_3_3_1_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_3_1_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_3_1_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_3_1_0), LC898124EP3_DM_0_1_3_3_1_0, LC898124EP3_DMA_ByteSize_0_1_3_3_1_0 , LC898124EP3_DMB_ByteSize_0_1_3_3_1_0 },
+ {0x0702, 1, LC898124EP3_PM_0_2_7_2_1_0, LC898124EP3_PMSize_0_2_7_2_1_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_2_7_2_1_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_2_7_2_1_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_2_7_2_1_0), LC898124EP3_DM_0_2_7_2_1_0, LC898124EP3_DMA_ByteSize_0_2_7_2_1_0 , LC898124EP3_DMB_ByteSize_0_2_7_2_1_0 },
+ {0x0302, 2, LC898124EP3_SERVO_ON_PM_0_1_3_2_1_0, LC898124EP3_SERVO_ON_PMSize_0_1_3_2_1_0, (UINT32)((UINT32)LC898124EP3_SERVO_ON_PMCheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_3_2_1_0), LC898124EP3_SERVO_ON_DM_0_1_3_2_1_0, LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_3_2_1_0 , LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_3_2_1_0 },
+ {0x0702, 2, LC898124EP3_SERVO_ON_PM_0_2_7_2_1_0, LC898124EP3_SERVO_ON_PMSize_0_2_7_2_1_0, (UINT32)((UINT32)LC898124EP3_SERVO_ON_PMCheckSum_0_2_7_2_1_0 + (UINT32)LC898124EP3_SERVO_ON_DMA_CheckSum_0_2_7_2_1_0 + (UINT32)LC898124EP3_SERVO_ON_DMB_CheckSum_0_2_7_2_1_0), LC898124EP3_SERVO_ON_DM_0_2_7_2_1_0, LC898124EP3_SERVO_ON_DMA_ByteSize_0_2_7_2_1_0 , LC898124EP3_SERVO_ON_DMB_ByteSize_0_2_7_2_1_0 },
+ {0xFFFF, 1, (void*)0, 0, 0, (void*)0 ,0 ,0 }
+};
+
+static int RamWrite32A(struct cam_ois_ctrl_t *o_ctrl,
+    UINT32 addr, UINT32 data)
+{
+    int32_t rc = 0;
+    int retry = 3;
+    struct cam_sensor_i2c_reg_array i2c_write_setting = {
+        .reg_addr = addr,
+        .reg_data = data,
+        .delay = 0x00,
+        .data_mask = 0x00,
+    };
+    struct cam_sensor_i2c_reg_setting i2c_write = {
+        .reg_setting = &i2c_write_setting,
+        .size = 1,
+        .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+        .data_type = CAMERA_SENSOR_I2C_TYPE_DWORD,
+        .delay = 0x00,
+    };
+
+    if (o_ctrl == NULL) {
+        CAM_ERR(CAM_OIS, "Invalid Args");
+        return -EINVAL;
+    }
+
+    for(int i = 0; i < retry; i++)
+    {
+        rc = camera_io_dev_write(&(o_ctrl->io_master_info), &i2c_write);
+        if (rc < 0) {
+            CAM_ERR(CAM_OIS, "write 0x%04x failed, retry:%d", addr, i+1);
+        } else {
+            return rc;
+        }
+    }
+    return rc;
+}
+
+static int RamRead32A(struct cam_ois_ctrl_t *o_ctrl,
+    UINT32 addr, UINT32* data)
+{
+    int32_t rc = 0;
+    int retry = 3;
+    if (o_ctrl == NULL) {
+        CAM_ERR(CAM_OIS, "Invalid Args");
+        return -EINVAL;
+    }
+    for(int i = 0; i < retry; i++)
+    {
+        rc = camera_io_dev_read(&(o_ctrl->io_master_info), (uint32_t)addr, (uint32_t *)data,
+            CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_DWORD);
+        if (rc < 0) {
+            CAM_ERR(CAM_OIS, "read 0x%04x failed, retry:%d", addr, i+1);
+        } else {
+            return rc;
+        }
+    }
+    return rc;
+}
+
+static void CntWrt(struct cam_ois_ctrl_t *o_ctrl,
+    UINT8 *data, UINT16 size)
+{
+    int32_t rc = 0;
+    int i = 0;
+    int reg_data_cnt = size - 1;
+    int continue_cnt = 0;
+    int retry = 3;
+    struct cam_sensor_i2c_reg_setting i2c_write;
+
+    if (o_ctrl == NULL) {
+        CAM_ERR(CAM_OIS, "Invalid Args");
+        return;
+    }
+
+    if (i2c_write_setting_gl == NULL) {
+        i2c_write_setting_gl = (struct cam_sensor_i2c_reg_array *)kzalloc(
+            sizeof(struct cam_sensor_i2c_reg_array)*MAX_DATA_NUM, GFP_KERNEL);
+        if(!i2c_write_setting_gl) {
+            CAM_ERR(CAM_OIS, "Alloc i2c_write_setting_gl failed");
+            return;
+        }
+    }
+
+    for(i = 0; i< reg_data_cnt; i++) {
+        if (i == 0) {
+            i2c_write_setting_gl[continue_cnt].reg_addr = data[0];
+            i2c_write_setting_gl[continue_cnt].reg_data = data[1];
+            i2c_write_setting_gl[continue_cnt].delay = 0x00;
+            i2c_write_setting_gl[continue_cnt].data_mask = 0x00;
+        } else {
+            i2c_write_setting_gl[continue_cnt].reg_data = data[i+1];
+            i2c_write_setting_gl[continue_cnt].delay = 0x00;
+            i2c_write_setting_gl[continue_cnt].data_mask = 0x00;
+        }
+        continue_cnt++;
+    }
+    i2c_write.reg_setting = i2c_write_setting_gl;
+    i2c_write.size = continue_cnt;
+    i2c_write.addr_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+    i2c_write.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+    i2c_write.delay = 0x00;
+
+    for(i = 0; i < retry; i++)
+    {
+        rc = camera_io_dev_write_continuous(&(o_ctrl->io_master_info),
+            &i2c_write, 1);
+        if (rc < 0) {
+            CAM_ERR(CAM_OIS, "Continue write failed, rc:%d, retry:%d", rc, i+1);
+        } else {
+            break;
+        }
+    }
+}
+
+static void DMIOWrite32(struct cam_ois_ctrl_t *o_ctrl, UINT32 IOadrs, UINT32 IOdata )
+{
+#if 1
+    UINT8 data[10];
+    data[0] = 0xC0;		// Pmem address set
+    data[1] = 0x00;		// Command High
+    data[2] = (UINT8)(IOadrs >>24);		// IOadres
+    data[3] = (UINT8)(IOadrs >>16);		// Command High
+    data[4] = (UINT8)(IOadrs >> 8);		// Command High
+    data[5] = (UINT8)(IOadrs >> 0);		// Command High
+    data[6] = (UINT8)(IOdata >>24);		// IOadres
+    data[7] = (UINT8)(IOdata >>16);		// Command High
+    data[8] = (UINT8)(IOdata >> 8);		// Command High
+    data[9] = (UINT8)(IOdata >> 0);		// Command High
+    CntWrt(o_ctrl, data, 10 ); 	// I2C 1Byte address.
+#else
+    RamWrite32A( CMD_IO_ADR_ACCESS, IOadrs ) ;
+    RamWrite32A( CMD_IO_DAT_ACCESS, IOdata ) ;
+#endif
+};
+
+//********************************************************************************
+// Function Name 	: MonitorInfo
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		:
+// History			: Second edition
+//********************************************************************************
+void MonitorInfo( DSPVER* Dspcode )
+{
+    CAM_INFO(CAM_OIS, "Vendor : %02x \n", Dspcode->Vendor);
+    CAM_INFO(CAM_OIS, "User : %02x \n", Dspcode->User);
+    CAM_INFO(CAM_OIS, "Model : %02x \n", Dspcode->Model);
+    CAM_INFO(CAM_OIS, "Version : %02x \n", Dspcode->Version);
+
+    if(Dspcode->SpiMode == SPI_MST)
+        CAM_INFO(CAM_OIS, "spi mode : Master\n");
+    if(Dspcode->SpiMode == SPI_SLV)
+        CAM_INFO(CAM_OIS, "spi mode : Slave\n");
+    if(Dspcode->SpiMode == SPI_SNGL)
+        CAM_INFO(CAM_OIS, "spi mode : only master\n");
+
+    if(Dspcode->ActType == ACT_SO2820) {
+        CAM_INFO(CAM_OIS, "actuator type : SO2820\n");
+    } else if(Dspcode->ActType == ACT_SO3600) {
+        CAM_INFO(CAM_OIS, "actuator type : SO3600\n");
+    } else {
+        CAM_INFO(CAM_OIS, "actuator type : SOXXXX\n");
+    }
+
+    if(Dspcode->GyroType == GYRO_ICM20690)
+        CAM_INFO(CAM_OIS, "gyro type : INVEN ICM20690 \n");
+    if(Dspcode->GyroType == GYRO_LSM6DSM)
+        CAM_INFO(CAM_OIS, "gyro type : ST LSM6DSM \n");
+
+}
+
+//********************************************************************************
+// Function Name 	: GetInfomationBeforeDownlaod
+// Retun Value		: True(0) / Fail(1)
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+UINT8 GetInfomationBeforeDownload( DSPVER* Info, const UINT8* DataDM,  UINT32 LengthDM )
+{
+	UINT32 i;
+	Info->ActType = 0;
+	Info->GyroType = 0;
+
+	for( i=0; i < LengthDM; i+=6 )
+	{
+		if ( (DataDM[0+i] == 0xA0) && (DataDM[1+i] == 0x00) )
+		{
+			Info->Vendor = DataDM[2+i];
+			Info->User = DataDM[3+i];
+			Info->Model = DataDM[4+i];
+			Info->Version = DataDM[5+i];
+			if ( (DataDM[6+i] == 0xA0) && (DataDM[7+i] == 0x04) )
+			{
+				Info->SpiMode = DataDM[8+i];
+				Info->ActType = DataDM[10+i];
+				Info->GyroType = DataDM[11+i];
+			}
+			MonitorInfo( Info );
+			return (0);
+		}
+	}
+	return(1);
+}
+
+//********************************************************************************
+// Function Name 	: DownloadToEP3
+// Retun Value		: NON
+// Argment Value	: PMlength: 5byte unit, DMlength : 1Byte unit
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+unsigned char DownloadToEP3(struct cam_ois_ctrl_t *o_ctrl, const UINT8* DataPM, UINT32 LengthPM, UINT32 Parity, const UINT8* DataDM, UINT32 LengthDMA , UINT32 LengthDMB )
+{
+    UINT32 i, j;
+    UINT8 data[MAX_DATA_NUM];		// work fifo buffer max size 64 byte
+    UINT8 Remainder;
+    UINT32 UlReadVal, UlCnt;
+    UINT32 ReadVerifyPM = 0, ReadVerifyDMA = 0, ReadVerifyDMB = 0;	// Checksum
+    UINT32 VerifySUM = 0;
+
+//*******************************************************************************//
+//*   pre-check ROM code version 												*//
+//*******************************************************************************//
+    RamRead32A(o_ctrl, CMD_ROMVER , &UlReadVal );
+    if( UlReadVal == OLD_VER )	return( 3 );		/* ROM code version error */
+
+//--------------------------------------------------------------------------------
+// 0. Start up to boot exection
+//--------------------------------------------------------------------------------
+    RamWrite32A(o_ctrl, CMD_IO_ADR_ACCESS , ROMINFO );
+    RamRead32A(o_ctrl, CMD_IO_DAT_ACCESS, &UlReadVal );
+    switch ( (UINT8)UlReadVal ){
+        case 0x0A:	/* Normal Rom program execution */
+            break;
+
+        case 0x01:	/* Normal Ram program execution */
+            DMIOWrite32(o_ctrl, SYSDSP_REMAP, 0x00001000 ); 	// CORE_RST
+            msleep(6) ;							// Boot 6msec
+            break;
+
+//	case 0x0B:
+//	case 0x08:
+        default:
+            return( 1 );
+    }
+//--------------------------------------------------------------------------------
+// 1. Download Program
+//--------------------------------------------------------------------------------
+    data[0] = 0x30;		// Pmem address set
+    data[1] = 0x00;		// Command High
+    data[2] = 0x10;		// Command High
+    data[3] = 0x00;		// Command High
+    data[4] = 0x00;		// Command High
+    CntWrt(o_ctrl, data, 5 ); 	// I2C 1Byte address.
+
+    // program start
+    data[0] = 0x40;		// Pmem address set
+    Remainder = ( (LengthPM*5) / BURST_LENGTH_PM );
+    for(i=0 ; i< Remainder ; i++)
+    {
+        UlCnt = 1;
+        for(j=0 ; j < BURST_LENGTH_PM; j++)	data[UlCnt++] = *DataPM++;
+
+        CntWrt(o_ctrl, data, BURST_LENGTH_PM+1 );  // I2Caddresss 1Byte.
+    }
+    Remainder = ( (LengthPM*5) % BURST_LENGTH_PM);
+    if (Remainder != 0 )
+    {
+        UlCnt = 1;
+        for(j=0 ; j < Remainder; j++)	data[UlCnt++] = *DataPM++;
+        CntWrt(o_ctrl, data, UlCnt );  // I2C 1Byte address.
+    }
+    // Chercksum start
+    data[0] = 0xF0;											// Pmem address set
+    data[1] = 0x0A;											// Command High
+    data[2] = (unsigned char)(( LengthPM & 0xFF00) >> 8 );	// Size High
+    data[3] = (unsigned char)(( LengthPM & 0x00FF) >> 0 );	// Size Low
+    CntWrt(o_ctrl, data, 4 ); 	// I2C 2Byte addresss.
+
+//--------------------------------------------------------------------------------
+// 2. Download Table Data
+//--------------------------------------------------------------------------------
+    RamWrite32A(o_ctrl, DmCheck_CheckSumDMA, 0 );		// DMA Parity Clear
+    RamWrite32A(o_ctrl, DmCheck_CheckSumDMB, 0 );		// DMB Parity Clear
+
+    /***** DMA Data Send *****/
+    Remainder = ( (LengthDMA*6/4) / BURST_LENGTH_DM );
+    for(i=0 ; i< Remainder ; i++)
+    {
+        CntWrt(o_ctrl, (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+        DataDM += BURST_LENGTH_DM;
+    }
+    Remainder = ( (LengthDMA*6/4) % BURST_LENGTH_DM );
+    if (Remainder != 0 )
+    {
+        CntWrt(o_ctrl, (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+    }
+    DataDM += Remainder;
+
+    /***** DMB Data Send *****/
+    Remainder = ( (LengthDMB*6/4) / BURST_LENGTH_DM );
+    for( i=0 ; i< Remainder ; i++)
+    {
+        CntWrt(o_ctrl, (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+        DataDM += BURST_LENGTH_DM;
+    }
+    Remainder = ( (LengthDMB*6/4) % BURST_LENGTH_DM );
+    if (Remainder != 0 )
+    {
+        CntWrt(o_ctrl, (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+    }
+
+//--------------------------------------------------------------------------------
+// 3. Verify
+//--------------------------------------------------------------------------------
+    RamRead32A(o_ctrl, PmCheck_CheckSum, &ReadVerifyPM );
+    RamRead32A(o_ctrl, DmCheck_CheckSumDMA, &ReadVerifyDMA );
+    RamRead32A(o_ctrl, DmCheck_CheckSumDMB, &ReadVerifyDMB );
+    VerifySUM = ReadVerifyPM + ReadVerifyDMA + ReadVerifyDMB;
+    if(VerifySUM == Parity){
+        CAM_ERR(CAM_OIS, "verify success. ReadVerifyPM=0x%x, ReadVerifyDMA=0x%x, ReadVerifyDMB=0x%x, VerifySUM=0x%x, Parity=0x%x",
+            ReadVerifyPM, ReadVerifyDMA, ReadVerifyDMB, VerifySUM, Parity);
+    } else {
+        CAM_ERR(CAM_OIS, "verify fail. ReadVerifyPM=0x%x, ReadVerifyDMA=0x%x, ReadVerifyDMB=0x%x, VerifySUM=0x%x, Parity=0x%x",
+            ReadVerifyPM, ReadVerifyDMA, ReadVerifyDMB, VerifySUM, Parity);
+        return( 2 );
+    }
+    return(0);
+}
+
+unsigned char SelectDownload(struct cam_ois_ctrl_t *o_ctrl, UINT8 GyroSelect, UINT8 ActSelect, UINT8 MasterSlave, UINT8 FWType)
+{
+	DSPVER Dspcode;
+	DOWNLOAD_TBL *ptr;
+	CAM_INFO(CAM_OIS, "ois_name:%s, GyroSelect:0x%x, ActSelect:0x%x, MasterSlave:0x%x, FWType:%d\n", o_ctrl->ois_name, GyroSelect, ActSelect, MasterSlave, FWType);
+
+   if(o_ctrl->ois_gyro_id==3){
+    ptr = ( DOWNLOAD_TBL *)DTbl;
+   }else{
+      if ( MasterSlave == 0x00 ) {
+            ptr = ( DOWNLOAD_TBL *)DTbl_M;
+      } else {
+            ptr = ( DOWNLOAD_TBL *)DTbl_S;
+      }
+   }
+
+	while (ptr->Cmd != 0xFFFF ){
+		if( (ptr->Cmd == ( ((UINT16)ActSelect<<8) + GyroSelect)) && (ptr->FWType == FWType) ) break;
+		ptr++ ;
+	}
+	if (ptr->Cmd == 0xFFFF)	return(0xF0);
+
+	if( GetInfomationBeforeDownload( &Dspcode, ptr->DataDM, ( ptr->LengthDMA +  ptr->LengthDMB ) ) != 0 ){
+		return(0xF1);
+	}
+
+	if( (ActSelect != Dspcode.ActType) || ((GyroSelect&0x7f) != Dspcode.GyroType) ) return(0xF2);
+
+	return( DownloadToEP3(o_ctrl, ptr->DataPM, ptr->LengthPM, ptr->Parity, ptr->DataDM, ptr->LengthDMA , ptr->LengthDMB ) );
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroAccelCoef
+// Retun Value		: non
+// Argment Value	:
+// Explanation		: Set Gyro Coef and Accel Coef
+// History			: First edition
+//********************************************************************************
+void SetGyroAccelCoef(struct cam_ois_ctrl_t *o_ctrl, UINT8 SelectAct ){
+	switch(SelectAct) {
+		case ACT_SO2820 :
+                    if(1 == o_ctrl->ois_gyro_id)//18821 rear
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef : gyro %d 821 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x7FFFFFFF );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x7FFFFFFF );
+                    }
+                    if(2 == o_ctrl->ois_gyro_id)//18827 rear
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef : gyro %d 827 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x80000001 );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x80000001 );
+                    }
+                    break;
+        case ACT_SO3600 :
+                    if(1 == o_ctrl->ois_gyro_id)//18821 rear
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef tele: gyro %d 821 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x7FFFFFFF );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x7FFFFFFF );
+                    }
+                    if(2 == o_ctrl->ois_gyro_id)//18827 rear
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef tele: gyro %d 827 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x7FFFFFFF );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x7FFFFFFF );
+                    }
+                    break;
+       case ACT_SO2821:
+                    if(3 == o_ctrl->ois_gyro_id)//18857 rear
+                    {
+                         CAM_INFO(CAM_OIS, "SetGyroAccelCoef 857main : gyro %d 857 rear\n", o_ctrl->ois_gyro_id);
+                         RamWrite32A(o_ctrl,  GCNV_XX, (UINT32)0x00000000 );
+                         RamWrite32A(o_ctrl,  GCNV_XY, (UINT32)0x7FFFFFFF );
+                         RamWrite32A(o_ctrl,  GCNV_YY, (UINT32)0x00000000 );
+                         RamWrite32A(o_ctrl,  GCNV_YX, (UINT32)0x7FFFFFFF );
+                         RamWrite32A(o_ctrl,  GCNV_ZP, (UINT32)0x7FFFFFFF );
+
+                         RamWrite32A(o_ctrl,  ACNV_XX, (UINT32)0x00000000 );
+                         RamWrite32A(o_ctrl,  ACNV_XY, (UINT32)0x7FFFFFFF );
+                         RamWrite32A(o_ctrl,  ACNV_YY, (UINT32)0x00000000 );
+                         RamWrite32A(o_ctrl,  ACNV_YX, (UINT32)0x7FFFFFFF );
+                         RamWrite32A(o_ctrl,  ACNV_ZP, (UINT32)0x7FFFFFFF ); 
+                    }
+                    break;
+        case ACT_M12337_A1 :
+        case ACT_M10235_A1 :
+                    if(1 == o_ctrl->ois_gyro_id)//18821 rear ofilm
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef : gyro %d 821 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x80000001 );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x7FFFFFFF );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x7FFFFFFF );
+                    }
+                    if(2 == o_ctrl->ois_gyro_id)//18827 rear
+                    {
+                        CAM_INFO(CAM_OIS, "SetGyroAccelCoef : gyro %d 827 rear\n", o_ctrl->ois_gyro_id);
+                        RamWrite32A(o_ctrl, GCNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, GCNV_YX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, GCNV_ZP , (UINT32)0x80000001 );
+
+                        RamWrite32A(o_ctrl, ACNV_XX , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_XY , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_YY , (UINT32)0x00000000 );
+                        RamWrite32A(o_ctrl, ACNV_YX , (UINT32)0x7FFFFFFF );
+                        RamWrite32A(o_ctrl, ACNV_ZP , (UINT32)0x80000001 );
+                    }
+                    break;
+        }
+    
+}
+
+//********************************************************************************
+// Function Name 	: MesFil
+// Retun Value		: NON
+// Argment Value	: Measure Filter Mode
+// Explanation		: Measure Filter Setting Function
+// History			: First edition
+//********************************************************************************
+void MesFil(struct cam_ois_ctrl_t *o_ctrl, UINT8	UcMesMod )		// 20.019kHz
+{
+	UINT32	UlMeasFilaA , UlMeasFilaB , UlMeasFilaC ;
+	UINT32	UlMeasFilbA , UlMeasFilbB , UlMeasFilbC ;
+
+         UlMeasFilaA	=	0x00000000 ;
+	     UlMeasFilaB	=	0x00000000 ;
+	     UlMeasFilaC	=	0x00000000 ;
+	     UlMeasFilbA	=	0x00000000 ;
+	     UlMeasFilbB	=	0x00000000 ;
+	     UlMeasFilbC	=	0x00000000 ;
+
+
+	if( !UcMesMod ) {								// Hall Bias&Offset Adjust
+
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF 150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+
+	} else if( UcMesMod == LOOPGAIN ) {				// Loop Gain Adjust
+
+		UlMeasFilaA	=	0x12FEA055 ;	// LPF1000Hz
+		UlMeasFilaB	=	0x12FEA055 ;
+		UlMeasFilaC	=	0x5A02BF55 ;
+		UlMeasFilbA	=	0x7F559791 ;	// HPF30Hz
+		UlMeasFilbB	=	0x80AA686F ;
+		UlMeasFilbC	=	0x7EAB2F23 ;
+
+	} else if( UcMesMod == THROUGH ) {				// for Through
+
+		UlMeasFilaA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilaB	=	0x00000000 ;
+		UlMeasFilaC	=	0x00000000 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+
+	} else if( UcMesMod == NOISE ) {				// SINE WAVE TEST for NOISE
+
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilbB	=	0x0342AD4D ;
+		UlMeasFilbC	=	0x797AA565 ;
+
+	} else if(UcMesMod == OSCCHK) {
+		UlMeasFilaA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilaB	=	0x065BE349 ;
+		UlMeasFilaC	=	0x7348396D ;
+		UlMeasFilbA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilbB	=	0x065BE349 ;
+		UlMeasFilbC	=	0x7348396D ;
+	}
+
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Coeff_c2	, UlMeasFilbC ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Coeff_c2	, UlMeasFilbC ) ;
+}
+
+//********************************************************************************
+// Function Name 	: ClrMesFil
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Clear Measure Filter Function
+// History			: First edition
+//********************************************************************************
+void ClrMesFil(struct cam_ois_ctrl_t *o_ctrl)
+{
+	RamWrite32A (o_ctrl, MeasureFilterA_Delay_z11	, 0 ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Delay_z12	, 0 ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterA_Delay_z21	, 0 ) ;
+	RamWrite32A (o_ctrl, MeasureFilterA_Delay_z22	, 0 ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterB_Delay_z11	, 0 ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Delay_z12	, 0 ) ;
+
+	RamWrite32A (o_ctrl, MeasureFilterB_Delay_z21	, 0 ) ;
+	RamWrite32A (o_ctrl, MeasureFilterB_Delay_z22	, 0 ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetWaitTime
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Set Timer wait Function
+// History			: First edition
+//********************************************************************************
+void SetWaitTime(struct cam_ois_ctrl_t *o_ctrl, UINT16 UsWaitTime )
+{
+	RamWrite32A(o_ctrl, WaitTimerData_UiWaitCounter	, 0 ) ;
+	RamWrite32A(o_ctrl, WaitTimerData_UiTargetCount	, (UINT32)(ONE_MSEC_COUNT * UsWaitTime)) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetTransDataAdr
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Trans Address for Data Function
+// History			: First edition
+//********************************************************************************
+void SetTransDataAdr(struct cam_ois_ctrl_t *o_ctrl, UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans )
+{
+	UnDwdVal	StTrsVal ;
+
+	if( UlLowAdrBeforeTrans < 0x00009000 ){
+		StTrsVal.UlDwdVal = UlLowAdrBeforeTrans ;
+	}else{
+		StTrsVal.StDwdVal.UsHigVal = (UINT16)(( UlLowAdrBeforeTrans & 0x0000F000 ) >> 8 ) ;
+		StTrsVal.StDwdVal.UsLowVal = (UINT16)( UlLowAdrBeforeTrans & 0x00000FFF ) ;
+	}
+//TRACE(" TRANS  ADR = %04xh , DAT = %08xh \n",UsLowAddress , StTrsVal.UlDwdVal ) ;
+	RamWrite32A(o_ctrl, UsLowAddress,	StTrsVal.UlDwdVal );
+
+}
+
+//********************************************************************************
+// Function Name 	: MemoryClear
+// Retun Value		: NON
+// Argment Value	: Top pointer , Size
+// Explanation		: Memory Clear Function
+// History			: First edition
+//********************************************************************************
+void MemoryClear(struct cam_ois_ctrl_t *o_ctrl, UINT16 UsSourceAddress, UINT16 UsClearSize )
+{
+	UINT16	UsLoopIndex ;
+
+	for ( UsLoopIndex = 0 ; UsLoopIndex < UsClearSize ; UsLoopIndex += 4 ) {
+		RamWrite32A(o_ctrl, UsSourceAddress + UsLoopIndex, 0x00000000 ) ;				// 4Byte
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void MeasureStart(struct cam_ois_ctrl_t *o_ctrl, INT32 SlMeasureParameterNum,
+    UINT32 SlMeasureParameterA , UINT32 SlMeasureParameterB )
+{
+	MemoryClear(o_ctrl, StMeasFunc_SiSampleNum , sizeof( MeasureFunction_Type ) ) ;
+	RamWrite32A(o_ctrl, StMeasFunc_MFA_SiMax1	 , 0x80000000 ) ;					// Set Min
+	RamWrite32A(o_ctrl, StMeasFunc_MFB_SiMax2	 , 0x80000000 ) ;					// Set Min
+	RamWrite32A(o_ctrl, StMeasFunc_MFA_SiMin1	 , 0x7FFFFFFF ) ;					// Set Max
+	RamWrite32A(o_ctrl, StMeasFunc_MFB_SiMin2	 , 0x7FFFFFFF ) ;					// Set Max
+
+	SetTransDataAdr(o_ctrl, StMeasFunc_MFA_PiMeasureRam1	 , SlMeasureParameterA ) ;		// Set Measure Filter A Ram Address
+	SetTransDataAdr(o_ctrl, StMeasFunc_MFB_PiMeasureRam2	 , SlMeasureParameterB ) ;		// Set Measure Filter B Ram Address
+	RamWrite32A(o_ctrl, StMeasFunc_SiSampleNum	 , 0 ) ;													// Clear Measure Counter
+	ClrMesFil(o_ctrl) ;						// Clear Delay Ram
+//	SetWaitTime(50) ;
+	SetWaitTime(o_ctrl, 1) ;
+	RamWrite32A(o_ctrl, StMeasFunc_SiSampleMax	 , SlMeasureParameterNum ) ;						// Set Measure Max Number
+
+}
+
+//********************************************************************************
+// Function Name 	: MeasureWait
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Wait complete of Measure Function
+// History			: First edition
+//********************************************************************************
+void MeasureWait(struct cam_ois_ctrl_t *o_ctrl)
+{
+	UINT32			SlWaitTimerSt ;
+
+	SlWaitTimerSt = 1 ;
+	while( SlWaitTimerSt ){
+		RamRead32A(o_ctrl, StMeasFunc_SiSampleMax , &SlWaitTimerSt ) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: set the gyro offset data. before do this before Remapmain.
+// History			: First edition
+//********************************************************************************
+void SetGyroOffset(struct cam_ois_ctrl_t *o_ctrl, UINT16 GyroOffsetX, UINT16 GyroOffsetY, UINT16 GyroOffsetZ )
+{
+	RamWrite32A(o_ctrl, GYRO_RAM_GXOFFZ , (( GyroOffsetX << 16 ) & 0xFFFF0000 ) ) ;		// X axis Gyro offset
+	RamWrite32A(o_ctrl, GYRO_RAM_GYOFFZ , (( GyroOffsetY << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+	RamWrite32A(o_ctrl, GYRO_RAM_GZOFFZ , (( GyroOffsetZ << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStart(struct cam_ois_ctrl_t *o_ctrl)
+{
+	MesFil(o_ctrl, THROUGH ) ;								// Set Measure Filter
+	MeasureStart(o_ctrl, GYROF_NUM , GYRO_RAM_GX_ADIDAT , GYRO_RAM_GY_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStartZ
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStartZ(struct cam_ois_ctrl_t *o_ctrl)
+{
+	MesFil(o_ctrl, THROUGH ) ;								// Set Measure Filter
+	MeasureStart(o_ctrl, GYROF_NUM , GYRO_RAM_GZ_ADIDAT , GYRO_RAM_GZ_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	: GetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: get the gyro offset adjustment result
+// History			: First edition
+//********************************************************************************
+UINT8 GetGyroOffset(struct cam_ois_ctrl_t *o_ctrl, UINT16* GyroOffsetX, UINT16* GyroOffsetY, INT16 GYROF_UPPER, INT16 GYROF_LOWER   )
+{
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	INT32			SlMeasureMaxValue , SlMeasureMinValue ;
+	UINT32 UlReadVal, UlCnt=0;
+	UINT8 ans=0;
+
+	// Wait complete of measurement
+	do{
+		if( UlCnt++ > 100 ){
+			/* timeout error */
+			*GyroOffsetX = 0;
+			*GyroOffsetY = 0;
+			CAM_ERR(CAM_OIS,
+				"UlCnt up to 100+ return 3.");//byron
+			return( 3 );
+		}
+		RamRead32A(o_ctrl, StMeasFunc_SiSampleMax , &UlReadVal ) ;
+	}while ( UlReadVal != 0 );
+
+	RamRead32A(o_ctrl, StMeasFunc_MFA_SiMax1 , ( UINT32 * )&SlMeasureMaxValue ) ;	// Max value
+	RamRead32A(o_ctrl, StMeasFunc_MFA_SiMin1 , ( UINT32 * )&SlMeasureMinValue ) ;	// Min value
+	if (SlMeasureMaxValue == SlMeasureMinValue )
+	{
+		CAM_ERR(CAM_OIS,
+				"SlMeasureMaxValue == SlMeasureMinValue return 3.");//byron2
+		return( 3 );
+	}
+
+	RamRead32A(o_ctrl, StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A(o_ctrl, StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A(o_ctrl, StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A(o_ctrl, StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / GYROF_NUM ) ;
+	SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / GYROF_NUM ) ;
+
+	SlMeasureAveValueA = ( SlMeasureAveValueA >> 16 ) & 0x0000FFFF ;
+	SlMeasureAveValueB = ( SlMeasureAveValueB >> 16 ) & 0x0000FFFF ;
+
+	*GyroOffsetX = ( UINT16 )( SlMeasureAveValueA & 0x0000FFFF );		//Measure Result Store
+	*GyroOffsetY = ( UINT16 )( SlMeasureAveValueB & 0x0000FFFF );		//Measure Result Store
+
+	if(( (INT16)(*GyroOffsetX) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetX) < GYROF_LOWER )){
+		ans |= 1;
+	}
+	if(( (INT16)(*GyroOffsetY) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetY) < GYROF_LOWER )){
+		ans |= 2;
+	}
+    CAM_ERR(CAM_OIS,
+				"func finish return.");//byron3
+	return( ans );
+}
+
 int32_t cam_ois_construct_default_power_setting(
 	struct cam_sensor_power_ctrl_t *power_info)
 {
@@ -202,6 +1116,12 @@ static int cam_ois_power_down(struct cam_ois_ctrl_t *o_ctrl)
 
 	camera_io_release(&o_ctrl->io_master_info);
 
+	CAM_INFO(CAM_OIS, "cam_io_release");
+
+	imx586_ois_initialized = false;
+	s5k3m5_ois_initialized = false;
+	imx586_ois_ready = false;
+	s5k3m5_ois_ready = false;
 	return rc;
 }
 
@@ -292,125 +1212,229 @@ static int cam_ois_slaveInfo_pkt_parser(struct cam_ois_ctrl_t *o_ctrl,
 
 	return rc;
 }
-
 static int cam_ois_fw_download(struct cam_ois_ctrl_t *o_ctrl)
 {
-	uint16_t                           total_bytes = 0;
-	uint8_t                           *ptr = NULL;
-	int32_t                            rc = 0, cnt;
-	uint32_t                           fw_size;
-	const struct firmware             *fw = NULL;
-	const char                        *fw_name_prog = NULL;
-	const char                        *fw_name_coeff = NULL;
-	char                               name_prog[32] = {0};
-	char                               name_coeff[32] = {0};
-	struct device                     *dev = &(o_ctrl->pdev->dev);
-	struct cam_sensor_i2c_reg_setting  i2c_reg_setting;
-	struct page                       *page = NULL;
-
-	if (!o_ctrl) {
-		CAM_ERR(CAM_OIS, "Invalid Args");
-		return -EINVAL;
-	}
-
-	snprintf(name_coeff, 32, "%s.coeff", o_ctrl->ois_name);
-
-	snprintf(name_prog, 32, "%s.prog", o_ctrl->ois_name);
-
-	/* cast pointer as const pointer*/
-	fw_name_prog = name_prog;
-	fw_name_coeff = name_coeff;
-
-	/* Load FW */
-	rc = request_firmware(&fw, fw_name_prog, dev);
-	if (rc) {
-		CAM_ERR(CAM_OIS, "Failed to locate %s", fw_name_prog);
-		return rc;
-	}
-
-	total_bytes = fw->size;
-	i2c_reg_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
-	i2c_reg_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
-	i2c_reg_setting.size = total_bytes;
-	i2c_reg_setting.delay = 0;
-	fw_size = PAGE_ALIGN(sizeof(struct cam_sensor_i2c_reg_array) *
-		total_bytes) >> PAGE_SHIFT;
-	page = cma_alloc(dev_get_cma_area((o_ctrl->soc_info.dev)),
-		fw_size, 0, GFP_KERNEL);
-	if (!page) {
-		CAM_ERR(CAM_OIS, "Failed in allocating i2c_array");
-		release_firmware(fw);
-		return -ENOMEM;
-	}
-
-	i2c_reg_setting.reg_setting = (struct cam_sensor_i2c_reg_array *) (
-		page_address(page));
-
-	for (cnt = 0, ptr = (uint8_t *)fw->data; cnt < total_bytes;
-		cnt++, ptr++) {
-		i2c_reg_setting.reg_setting[cnt].reg_addr =
-			o_ctrl->opcode.prog;
-		i2c_reg_setting.reg_setting[cnt].reg_data = *ptr;
-		i2c_reg_setting.reg_setting[cnt].delay = 0;
-		i2c_reg_setting.reg_setting[cnt].data_mask = 0;
-	}
-
-	rc = camera_io_dev_write_continuous(&(o_ctrl->io_master_info),
-		&i2c_reg_setting, 1);
-	if (rc < 0) {
-		CAM_ERR(CAM_OIS, "OIS FW download failed %d", rc);
-		goto release_firmware;
-	}
-	cma_release(dev_get_cma_area((o_ctrl->soc_info.dev)),
-		page, fw_size);
-	page = NULL;
-	fw_size = 0;
-	release_firmware(fw);
-
-	rc = request_firmware(&fw, fw_name_coeff, dev);
-	if (rc) {
-		CAM_ERR(CAM_OIS, "Failed to locate %s", fw_name_coeff);
-		return rc;
-	}
-
-	total_bytes = fw->size;
-	i2c_reg_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
-	i2c_reg_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
-	i2c_reg_setting.size = total_bytes;
-	i2c_reg_setting.delay = 0;
-	fw_size = PAGE_ALIGN(sizeof(struct cam_sensor_i2c_reg_array) *
-		total_bytes) >> PAGE_SHIFT;
-	page = cma_alloc(dev_get_cma_area((o_ctrl->soc_info.dev)),
-		fw_size, 0, GFP_KERNEL);
-	if (!page) {
-		CAM_ERR(CAM_OIS, "Failed in allocating i2c_array");
-		release_firmware(fw);
-		return -ENOMEM;
-	}
-
-	i2c_reg_setting.reg_setting = (struct cam_sensor_i2c_reg_array *) (
-		page_address(page));
-
-	for (cnt = 0, ptr = (uint8_t *)fw->data; cnt < total_bytes;
-		cnt++, ptr++) {
-		i2c_reg_setting.reg_setting[cnt].reg_addr =
-			o_ctrl->opcode.coeff;
-		i2c_reg_setting.reg_setting[cnt].reg_data = *ptr;
-		i2c_reg_setting.reg_setting[cnt].delay = 0;
-		i2c_reg_setting.reg_setting[cnt].data_mask = 0;
-	}
-
-	rc = camera_io_dev_write_continuous(&(o_ctrl->io_master_info),
-		&i2c_reg_setting, 1);
-	if (rc < 0)
-		CAM_ERR(CAM_OIS, "OIS FW download failed %d", rc);
-
-release_firmware:
-	cma_release(dev_get_cma_area((o_ctrl->soc_info.dev)),
-		page, fw_size);
-	release_firmware(fw);
-
-	return rc;
+    UINT32 UlReadValX, UlReadValY;
+    //UINT16 OffsetX, OffsetY;
+    UINT32 spi_type;
+    UINT32 UlReadVal;
+    unsigned char rc = 0;
+    //unsigned char gyroresult = 0;
+    struct timespec mStartTime, mEndTime, diff;
+    UINT64 mSpendTime = 0;
+    if (!o_ctrl) {
+        CAM_ERR(CAM_OIS, "Invalid Args");
+        return -EINVAL;
+    }
+    getnstimeofday(&mStartTime);
+
+    //Master_1:imx586 Master_0:s5k3m5
+    CAM_INFO(CAM_OIS, "sid:0x%02x, Master:%d, ois_gyro_id:%d",
+        o_ctrl->io_master_info.cci_client->sid,
+        o_ctrl->io_master_info.cci_client->cci_i2c_master,
+        o_ctrl->ois_gyro_id);
+
+    if (MASTER_1 == o_ctrl->io_master_info.cci_client->cci_i2c_master &&
+        false == imx586_ois_initialized) {
+
+        if(o_ctrl->ois_gyro_id==3){
+            rc = SelectDownload(o_ctrl, 0x02, 0x00, 0x00, o_ctrl->ois_fw_flag);
+        }else {
+            if (strcmp(o_ctrl->ois_name, "ofilm_imx586_lc898124ep3_ois") == 0 ){
+                rc = SelectDownload(o_ctrl, 0x02, 0x06, 0x00, o_ctrl->ois_fw_flag);
+            }else {
+                rc = SelectDownload(o_ctrl, 0x02, 0x02, 0x00, o_ctrl->ois_fw_flag);
+            }
+        }
+
+        if (0 == rc) {
+            imx586_ois_initialized = true;
+            RamRead32A( o_ctrl,(SiVerNum + 4), &UlReadVal );
+            SetGyroAccelCoef( o_ctrl,(UINT8)(UlReadVal>>8) );
+            CAM_INFO(CAM_OIS, "SetGyroAccelCoef : %02x\n", (UINT8)(UlReadVal>>8));
+            //GyroOffsetMeasureStart(o_ctrl);// +
+            //msleep(120);
+            //gyroresult = GetGyroOffset(o_ctrl, &OffsetX, &OffsetY, 15, 0);
+            //CAM_INFO(CAM_OIS, "Gyro_offset_X:0x%x, Gyro_offset_Y:0x%x, Gyroresult:0x%x", OffsetX, OffsetY,gyroresult);
+            //GyroOffsetMeasureStartZ(o_ctrl);
+            //msleep(120);
+            //gyroresult = GetGyroOffset(o_ctrl, &OffsetX, &OffsetY, 15, 0);
+            //CAM_INFO(CAM_OIS, "Gyro_offset_Z:0x%x, Gyro_offset_Z:0x%x, Gyroresult:0x%x", OffsetX, OffsetY,gyroresult);// -
+
+            //remap master
+            RamWrite32A(o_ctrl, 0xF000, 0x00000000 );
+            //msleep(120);
+
+            //SPI-Master ( Act1 )  Check gyro signal
+            RamRead32A(o_ctrl, 0x061C, & UlReadValX );
+            RamRead32A(o_ctrl, 0x0620, & UlReadValY );
+            CAM_INFO(CAM_OIS, "Gyro_X:0x%x, Gyro_Y:0x%x", UlReadValX, UlReadValY);
+
+            spi_type = 0;
+            RamRead32A(o_ctrl, 0xf112, & spi_type );
+            CAM_INFO(CAM_OIS, "spi_type:0x%x", spi_type);
+
+            //GyroOffsetMeasureStart(o_ctrl);
+            //msleep(10);
+            //GetGyroOffset(o_ctrl, &OffsetX, &OffsetY, 15, 0);
+            //CAM_INFO(CAM_OIS, "Gyro_offset_X:0x%x, Gyro_offset_Y:0x%x", OffsetX, OffsetY);
+
+            //GyroOffsetMeasureStartZ(o_ctrl);
+            //msleep(10);
+            //GetGyroOffset(o_ctrl, &OffsetX, &OffsetY, 15, 0);
+            //CAM_INFO(CAM_OIS, "Gyro_offset_Z:0x%x, Gyro_offset_Z:0x%x", OffsetX, OffsetY);
+
+            //SPI-Master ( Act1 )  Check gyro gain
+            RamRead32A(o_ctrl, 0x82b8, & UlReadValX );
+            RamRead32A(o_ctrl, 0x8318, & UlReadValY );
+            CAM_INFO(CAM_OIS, "Gyro_gain_X:0x%x, Gyro_gain_Y:0x%x", UlReadValX, UlReadValY);
+
+            //SPI-Master ( Act1 )  start gyro signal transfer. ( from Master to slave. )
+            RamWrite32A(o_ctrl, 0x8970, 0x00000001 );
+            //msleep(5);
+            RamWrite32A(o_ctrl, 0xf111, 0x00000001 );
+            //msleep(5);
+        } else {
+            switch (rc) {
+                case 0x01:
+                    CAM_ERR(CAM_OIS, "H/W error");
+                    break;
+                case 0x02:
+                    CAM_ERR(CAM_OIS, "Table Data & Program download verify error");
+                    break;
+                case 0xF0:
+                    CAM_ERR(CAM_OIS, "Download code select error");
+                    break;
+                case 0xF1:
+                    CAM_ERR(CAM_OIS, "Download code information read error");
+                    break;
+                case 0xF2:
+                    CAM_ERR(CAM_OIS, "Download code information disagreement");
+                    break;
+                case 0xF3:
+                    CAM_ERR(CAM_OIS, "Download code version error");
+                    break;
+                default:
+                    CAM_ERR(CAM_OIS, "Unkown error code");
+                    break;
+            }
+        }
+    } else if (MASTER_0 == o_ctrl->io_master_info.cci_client->cci_i2c_master &&
+        false == s5k3m5_ois_initialized) {
+
+        o_ctrl->io_master_info.cci_client->cci_i2c_master = MASTER_0;
+        o_ctrl->io_master_info.cci_client->sid = SLAVE_CCI_ADDR;
+        if (strcmp(o_ctrl->ois_name, "ofilm_s5k3m5_lc898124ep3_ois") == 0 ){
+            rc = SelectDownload(o_ctrl, 0x02, 0x07, 0x01, o_ctrl->ois_fw_flag);
+        }else {
+            rc = SelectDownload(o_ctrl, 0x02, 0x03, 0x01, o_ctrl->ois_fw_flag);
+        }
+        if (0 == rc) {
+            RamRead32A( o_ctrl,(SiVerNum + 4), &UlReadVal );
+            //SetGyroAccelCoef(o_ctrl, 0x02);
+            SetGyroAccelCoef( o_ctrl,(UINT8)(UlReadVal>>8) );
+            CAM_INFO(CAM_OIS, "SetGyroAccelCoef : %02x\n", (UINT8)(UlReadVal>>8));
+            //remap slave
+            RamWrite32A(o_ctrl, 0xF000, 0x00000000 );
+            //msleep(120);
+            //SPI-Master ( Act1 )  Check gyro signal
+            RamRead32A(o_ctrl, 0x061C, & UlReadValX );
+            RamRead32A(o_ctrl, 0x0620, & UlReadValY );
+            CAM_INFO(CAM_OIS, "Gyro_X:0x%x, Gyro_Y:0x%x", UlReadValX, UlReadValY);
+
+            spi_type = 0;
+            RamRead32A(o_ctrl, 0xf112, & spi_type );
+            CAM_INFO(CAM_OIS, "spi_type:0x%x", spi_type);
+
+            //SPI-Master ( Act1 )  Check gyro gain
+            RamRead32A(o_ctrl, 0x82b8, & UlReadValX );
+            RamRead32A(o_ctrl, 0x8318, & UlReadValY );
+            CAM_INFO(CAM_OIS, "Gyro_gain_X:0x%x, Gyro_gain_Y:0x%x", UlReadValX, UlReadValY);
+            s5k3m5_ois_initialized = true;
+        } else {
+            switch (rc) {
+                case 0x01:
+                    CAM_ERR(CAM_OIS, "Slave H/W error");
+                    break;
+                case 0x02:
+                    CAM_ERR(CAM_OIS, "Slave Table Data & Program download verify error");
+                    break;
+                case 0xF0:
+                    CAM_ERR(CAM_OIS, "Slave Download code select error");
+                    break;
+                case 0xF1:
+                    CAM_ERR(CAM_OIS, "Slave Download code information read error");
+                    break;
+                case 0xF2:
+                    CAM_ERR(CAM_OIS, "Slave Download code information disagreement");
+                    break;
+                case 0xF3:
+                    CAM_ERR(CAM_OIS, "Slave Download code version error");
+                    break;
+                default:
+                    CAM_ERR(CAM_OIS, "Slave Unkown error code");
+                    break;
+            }
+
+        }
+        if (false == imx586_ois_initialized) {
+            o_ctrl->io_master_info.cci_client->cci_i2c_master= MASTER_1;
+            o_ctrl->io_master_info.cci_client->sid = MASTER_CCI_ADDR;
+            if (strcmp(o_ctrl->ois_name, "ofilm_imx586_lc898124ep3_ois") == 0 ){
+                rc = SelectDownload(o_ctrl, 0x02, 0x06, 0x00, o_ctrl->ois_fw_flag);
+            }else {
+                rc = SelectDownload(o_ctrl, 0x02, 0x02, 0x00, o_ctrl->ois_fw_flag);
+            }
+            if (0 == rc) {
+            //remap master
+            RamWrite32A(o_ctrl, 0xF000, 0x00000000 );
+            msleep(120);
+            //SPI-Master ( Act1 )  start gyro signal transfer. ( from Master to slave. )
+            RamWrite32A(o_ctrl, 0x8970, 0x00000001 );
+            msleep(5);
+            RamWrite32A(o_ctrl, 0xf111, 0x00000001 );
+            o_ctrl->io_master_info.cci_client->cci_i2c_master = MASTER_0;
+            o_ctrl->io_master_info.cci_client->sid = SLAVE_CCI_ADDR;
+            RamRead32A(o_ctrl, 0x061C, & UlReadValX );
+            RamRead32A(o_ctrl, 0x0620, & UlReadValY );
+            CAM_INFO(CAM_OIS, "Slave Gyro_X:0x%x, Gyro_Y:0x%x", UlReadValX, UlReadValY);
+            spi_type = 0;
+            RamRead32A(o_ctrl, 0xf112, & spi_type );
+            CAM_INFO(CAM_OIS, "spi_type:0x%x", spi_type);
+            imx586_ois_initialized = true;
+        } else {
+            switch (rc) {
+                case 0x01:
+                    CAM_ERR(CAM_OIS, "H/W error");
+                    break;
+                case 0x02:
+                    CAM_ERR(CAM_OIS, "Table Data & Program download verify error");
+                    break;
+                case 0xF0:
+                    CAM_ERR(CAM_OIS, "Download code select error");
+                    break;
+                case 0xF1:
+                    CAM_ERR(CAM_OIS, "Download code information read error");
+                    break;
+                case 0xF2:
+                    CAM_ERR(CAM_OIS, "Download code information disagreement");
+                    break;
+                case 0xF3:
+                    CAM_ERR(CAM_OIS, "Download code version error");
+                    break;
+                default:
+                    CAM_ERR(CAM_OIS, "Unkown error code");
+                    break;
+            }
+        }
+    }
+    }
+    getnstimeofday(&mEndTime);
+    diff = timespec_sub(mEndTime, mStartTime);
+    mSpendTime = (timespec_to_ns(&diff))/1000000;
+    CAM_INFO(CAM_OIS, "cam_ois_fw_download rc=%d, (Spend: %d ms)", rc, mSpendTime);
+
+    return 0;
 }
 
 /**
@@ -440,6 +1464,7 @@ static int cam_ois_pkt_parse(struct cam_ois_ctrl_t *o_ctrl, void *arg)
 	struct cam_ois_soc_private     *soc_private =
 		(struct cam_ois_soc_private *)o_ctrl->soc_info.soc_private;
 	struct cam_sensor_power_ctrl_t  *power_info = &soc_private->power_info;
+    uint32_t temp, retry_cnt;
 
 	ioctl_ctrl = (struct cam_control *)arg;
 	if (copy_from_user(&dev_config,
@@ -648,6 +1673,35 @@ static int cam_ois_pkt_parse(struct cam_ois_ctrl_t *o_ctrl, void *arg)
 			goto rel_pkt;
 		}
 
+        if (MASTER_1 == o_ctrl->io_master_info.cci_client->cci_i2c_master && !imx586_ois_ready) {
+            retry_cnt = 10;
+            do {
+                RamRead32A(o_ctrl, 0xF100, &temp);
+                CAM_ERR(CAM_OIS, "read imx586 0xF100 = 0x%x", temp);
+                if (temp == 0)
+                {
+                    imx586_ois_ready = true;
+                    break;
+                }
+                retry_cnt--;
+                msleep(10);
+            } while(retry_cnt);
+        }
+        if (MASTER_0 == o_ctrl->io_master_info.cci_client->cci_i2c_master && !s5k3m5_ois_ready) {
+            retry_cnt = 10;
+            do {
+                RamRead32A(o_ctrl, 0xF100, &temp);
+                CAM_ERR(CAM_OIS, "read s5k3m5 0xF100 = 0x%x", temp);
+                if (temp == 0)
+                {
+                    s5k3m5_ois_ready = true;
+                    break;
+                }
+                retry_cnt--;
+                msleep(10);
+            } while(retry_cnt);
+        }
+
 		rc = cam_ois_apply_settings(o_ctrl, i2c_reg_settings);
 		if (rc < 0) {
 			CAM_ERR(CAM_OIS, "Cannot apply mode settings");
@@ -745,6 +1799,9 @@ int cam_ois_driver_cmd(struct cam_ois_ctrl_t *o_ctrl, void *arg)
 	struct cam_ois_soc_private      *soc_private = NULL;
 	struct cam_sensor_power_ctrl_t  *power_info = NULL;
 
+	uint32_t testAddr  = 61458;
+	uint32_t testData  = 0;
+
 	if (!o_ctrl || !cmd) {
 		CAM_ERR(CAM_OIS, "Invalid arguments");
 		return -EINVAL;
@@ -756,6 +1813,7 @@ int cam_ois_driver_cmd(struct cam_ois_ctrl_t *o_ctrl, void *arg)
 		return -EINVAL;
 	}
 
+	ctrl=o_ctrl; //record device info
 	soc_private =
 		(struct cam_ois_soc_private *)o_ctrl->soc_info.soc_private;
 	power_info = &soc_private->power_info;
@@ -794,7 +1852,14 @@ int cam_ois_driver_cmd(struct cam_ois_ctrl_t *o_ctrl, void *arg)
 		o_ctrl->cam_ois_state = CAM_OIS_START;
 		break;
 	case CAM_CONFIG_DEV:
+		CAM_INFO(CAM_OIS, "CAM_CONFIG_DEV for %s", o_ctrl->ois_name);
 		rc = cam_ois_pkt_parse(o_ctrl, arg);
+
+		camera_io_dev_read((&o_ctrl->io_master_info),
+		testAddr, &testData, 2, 4);
+		CAM_INFO(CAM_OIS, "OISAddr 0x%x, value read %d for %s",
+		testAddr, testData, o_ctrl->ois_name);
+
 		if (rc) {
 			CAM_ERR(CAM_OIS, "Failed in ois pkt Parsing");
 			goto release_mutex;
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.c
index 4e23b8a501b6f1ae72088c0144e6486a041cdb90..7fede9115f65cb553455782091ac0152d437b36d 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.c
@@ -15,6 +15,37 @@
 #include "cam_ois_soc.h"
 #include "cam_ois_core.h"
 #include "cam_debug_util.h"
+#include "linux/proc_fs.h"
+#include "ois_fw/Ois.h"
+#include "ois_fw/OisAPI.h"
+struct cam_ois_ctrl_t *ctrl = NULL;
+
+
+
+static int RamRead32A(struct cam_ois_ctrl_t *o_ctrl,
+    UINT32 addr, UINT32* data)
+{
+    int32_t rc = 0;
+    int retry = 3;
+    if (o_ctrl == NULL) {
+        CAM_ERR(CAM_OIS, "Invalid Args dev");
+        return -EINVAL;
+    }
+    //CAM_INFO(CAM_OIS, "o_ctrl valid, power state = %d, iomaster = %p dev" , o_ctrl->cam_ois_state,&(o_ctrl->io_master_info));
+    for(int i = 0; i < retry; i++)
+    {
+        rc = camera_io_dev_read(&(o_ctrl->io_master_info), (uint32_t)addr, (uint32_t *)data,
+            CAMERA_SENSOR_I2C_TYPE_WORD, CAMERA_SENSOR_I2C_TYPE_DWORD);
+        if (rc < 0) {
+            CAM_ERR(CAM_OIS, "read 0x%04x failed, retry:%d", addr, i+1);
+        } else {
+            //CAM_INFO(CAM_OIS, "I2C read address = %p result = %d dev", addr, *data);
+            return rc;
+        }
+    }
+    //CAM_INFO(CAM_OIS, "I2C read address = %p result = %d dev", addr, *data);
+    return rc;
+}
 
 static long cam_ois_subdev_ioctl(struct v4l2_subdev *sd,
 	unsigned int cmd, void *arg)
@@ -388,12 +419,62 @@ static struct i2c_driver cam_ois_i2c_driver = {
 	},
 };
 
+static ssize_t OISread(struct file *p_file,
+	char __user *puser_buf, size_t count, loff_t *p_offset)
+{
+
+	char page[256] = {0};
+	int len = 0;
+	int ret = 0;
+	uint32_t hall_x=0;
+	uint32_t hall_y=0;
+	if (puser_buf == NULL ) return 0;
+	ret = RamRead32A(ctrl, HALL_RAM_HXIDAT , &hall_x );
+	if(ret < 0) CAM_ERR(CAM_OIS, "read HALL data fail for X");
+	ret = RamRead32A(ctrl, HALL_RAM_HYIDAT , &hall_y );
+	if(ret < 0) CAM_ERR(CAM_OIS, "read HALL data fail for Y");
+	hall_x >>= 16;
+	hall_y >>= 16;
+	len = sprintf(page, "%08d%08d", hall_x, hall_y);
+	//CAM_INFO(CAM_OIS, "hall_x = %d, hall_y = %d, hall_x = 0x%x, hall_y = 0x%x", hall_x, hall_y, hall_x, hall_y);
+	if (len > *p_offset) {
+		len -= *p_offset;
+	}
+	else {
+		len = 0;
+	}
+	if (copy_to_user(puser_buf, page, (len < count ? len : count))) {
+		CAM_ERR(CAM_OIS, "copy to user error");
+		return -EFAULT;
+	}
+	*p_offset += len < count ? len : count;
+
+	return (len < count ? len : count);
+}
+
+static ssize_t OISwrite(struct file *p_file,
+	const char __user *puser_buf,
+	size_t count, loff_t *p_offset)
+{
+	CAM_ERR(CAM_OIS, "OISwrite");
+	return 0;
+}
+
+
+static const struct file_operations proc_file_fops = {
+ .owner = THIS_MODULE,
+ .read  = OISread,
+ .write = OISwrite,
+};
+
 static struct cam_ois_registered_driver_t registered_driver = {
 	0, 0};
 
 static int __init cam_ois_driver_init(void)
 {
 	int rc = 0;
+	struct proc_dir_entry *face_common_dir = NULL;
+	struct proc_dir_entry *proc_file_entry = NULL;
 
 	rc = platform_driver_register(&cam_ois_platform_driver);
 	if (rc) {
@@ -411,6 +492,19 @@ static int __init cam_ois_driver_init(void)
 	}
 
 	registered_driver.i2c_driver = 1;
+
+	face_common_dir =  proc_mkdir("OIS", NULL);
+	if(!face_common_dir) {
+		CAM_ERR(CAM_OIS, "create dir fail CAM_ERROR API");
+		//return FACE_ERROR_GENERAL;
+	}
+
+	proc_file_entry = proc_create("OISGyro", 0444, face_common_dir, &proc_file_fops);
+	if(proc_file_entry == NULL)
+		CAM_ERR(CAM_OIS, "Create fail");
+	else
+		CAM_ERR(CAM_OIS, "Create successs");
+
 	return rc;
 }
 
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.h
index ea648594ccc0a2aa17f4adaa4b8ef2b7ec782e42..cbb3bfa163c8bad0fe1f496ea403e2ba9a99065b 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.h
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_dev.h
@@ -128,6 +128,7 @@ struct cam_ois_ctrl_t {
 	uint8_t ois_fw_flag;
 	uint8_t is_ois_calib;
 	struct cam_ois_opcode opcode;
+	uint8_t ois_gyro_id; //18821->1, 18827->2
 };
 
 #endif /*_CAM_OIS_DEV_H_ */
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_soc.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_soc.c
index d090ebb432b54d390e937db3d1c332bb83d838ba..150668db1cb02114a0eceed537617e3d9159c041 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_soc.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/cam_ois_soc.c
@@ -89,7 +89,7 @@ int cam_ois_driver_soc_init(struct cam_ois_ctrl_t *o_ctrl)
 	int                             rc = 0;
 	struct cam_hw_soc_info         *soc_info = &o_ctrl->soc_info;
 	struct device_node             *of_node = NULL;
-
+	int                             id;
 	if (!soc_info->dev) {
 		CAM_ERR(CAM_OIS, "soc_info is not initialized");
 		return -EINVAL;
@@ -125,5 +125,21 @@ int cam_ois_driver_soc_init(struct cam_ois_ctrl_t *o_ctrl)
 	if (rc < 0)
 		CAM_DBG(CAM_OIS, "failed: ois get dt data rc %d", rc);
 
+	rc = of_property_read_u32(of_node, "ois_gyro,id", &id);
+	if (rc && (rc != -EINVAL)) {
+	    o_ctrl->ois_gyro_id = 1;
+		CAM_ERR(CAM_OIS, "get ois_gyro,id failed rc:%d, default 1", rc);
+	} else {
+	    o_ctrl->ois_gyro_id = (uint8_t)id;
+		CAM_INFO(CAM_OIS, "read ois_gyro,id success, id:%d, rc:%d", o_ctrl->ois_gyro_id, rc);
+		if (o_ctrl->ois_gyro_id == 1) {
+			CAM_INFO(CAM_OIS, "821 gyro backside");
+		} else if (o_ctrl->ois_gyro_id == 2) {
+			CAM_INFO(CAM_OIS, "827 gyro upside");
+		}
+        else if (o_ctrl->ois_gyro_id == 3) {
+			CAM_INFO(CAM_OIS, "857 gyro upside");
+		}
+	}
 	return rc;
 }
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.c
new file mode 100644
index 0000000000000000000000000000000000000000..5094b299419c1844b7f110902f005baae2b30129
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.c
@@ -0,0 +1,174 @@
+/*=======================================================================
+		Accuracy Test Sample code for LC898124
+                                             	by Rex.Tang
+                                                2016.03.27
+========================================================================*/
+#include	"math.h"
+#include 	"OisLc898124EP3.h"
+#include	"Ois.h"
+#include	"Accuracy.h"
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+
+/* Raw data buffers */	
+//Dual_Axis_t xy_raw_data[360/DEGSTEP + 1];
+Dual_Axis_t xy_raw_data[360/3 + 1];
+float xMaxAcc, yMaxAcc;
+float xLimit, yLimit;
+
+static float fix2float(unsigned int fix)
+{
+    if((fix & 0x80000000) > 0)
+    {
+        return ((float)fix-(float)0x100000000)/(float)0x7FFFFFFF;
+    } else {
+        return (float)fix/(float)0x7FFFFFFF;
+    }
+}
+
+static unsigned int float2fix(float f)
+{
+    if(f < 0)
+    {
+        return (unsigned int)(f * (float)0x7FFFFFFF + 0x100000000);
+    } else {
+        return (unsigned int)(f * (float)0x7FFFFFFF);
+    }
+}
+
+/*-------------------------------------------------------------------
+	Function Name: Accuracy
+	Param:	none
+	Return:	value = 0 (no NG point)
+			value > 0 (High byte: X total NG points;
+					   Low byte: Y total NG points)	
+--------------------------------------------------------------------*/
+//unsigned short Accuracy()
+unsigned short Accuracy(float ACCURACY, unsigned short RADIUS, unsigned short DEGSTEP, unsigned short WAIT_MSEC1, unsigned short WAIT_MSEC2, unsigned short WAIT_MSEC3)
+{
+	float xpos, ypos;
+	unsigned int xhall_value, yhall_value;
+	float xMaxHall, yMaxHall;
+    unsigned short xng = 0, yng = 0;
+    unsigned short deg;
+    float xRadius, yRadius;
+	unsigned int xGyrogain, yGyrogain;
+    unsigned int xGLenz, yGLenz;
+    unsigned int xG2x4xb, yG2x4xb;
+
+	// Get Gyro gain
+	RamRead32A(GyroFilterTableX_gxzoom, &xGyrogain);
+	RamRead32A(GyroFilterTableY_gyzoom, &yGyrogain);
+
+	// Get Lenz
+	RamRead32A(GyroFilterTableX_gxlenz, &xGLenz);
+	RamRead32A(GyroFilterTableY_gylenz, &yGLenz);
+
+	// Get Lenz
+	RamRead32A(Gyro_ShiftX_RG, &xG2x4xb);
+	RamRead32A(Gyro_ShiftY_RG, &yG2x4xb);
+	
+	// Calculate Radius (100um)
+	xRadius = 0.10546843F * fabsf(fix2float(xGyrogain)) * fabsf(fix2float(xGLenz)) * (1 << (unsigned char)( xG2x4xb >> 8 ));
+	yRadius = 0.10546843F * fabsf(fix2float(yGyrogain)) * fabsf(fix2float(yGLenz)) * (1 << (unsigned char)( yG2x4xb >> 8 ));
+	TRACE("xRadius = %d, yRadius = %d", (int)(xRadius*1000), (int)(yRadius*1000));
+
+	// Calculate Limit
+	xLimit = ACCURACY / 100 * xRadius;
+    yLimit = ACCURACY / 100 * yRadius;
+
+	// Radius change (by RADIUS value)
+	xRadius = xRadius * RADIUS / 100;
+	yRadius = yRadius * RADIUS / 100;
+
+	xMaxAcc = 0;
+	yMaxAcc = 0;
+
+	// Circle check
+	xpos = xRadius * cos(0);
+	ypos = yRadius * sin(0);
+	RamWrite32A(HALL_RAM_HXOFF1, float2fix(xpos));
+	RamWrite32A(HALL_RAM_HYOFF1, float2fix(ypos));
+	WitTim(WAIT_MSEC1);
+
+	for( deg = 0; deg <= 360; deg += DEGSTEP ) // 0-360 degree
+	{
+		xpos = xRadius * cos(deg * PI/180);
+		ypos = yRadius * sin(deg * PI/180);
+    	RamWrite32A(HALL_RAM_HXOFF1, float2fix(xpos));
+		RamWrite32A(HALL_RAM_HYOFF1, float2fix(ypos));
+
+		if(deg ==0)
+			WitTim(500);
+
+		xMaxHall = 0;
+		yMaxHall = 0;
+		WitTim(WAIT_MSEC2);
+		
+		for(short i=0; i<LOOPTIME; i++)
+		{
+			WitTim(WAIT_MSEC3);
+			RamRead32A( HALL_RAM_HXOUT0, &xhall_value );
+			RamRead32A( HALL_RAM_HYOUT0, &yhall_value );
+			if(fabsf(fix2float(xhall_value) - xpos) > fabsf(xMaxHall))	
+				xMaxHall = fix2float(xhall_value) - xpos;
+			if(fabsf(fix2float(yhall_value) - ypos) > fabsf(yMaxHall))	
+				yMaxHall = fix2float(yhall_value) - ypos;
+		}
+
+		if(fabsf(xMaxHall) > xMaxAcc)	xMaxAcc = fabsf(xMaxHall);
+		if(fabsf(yMaxHall) > yMaxAcc)	yMaxAcc = fabsf(yMaxHall);
+		
+        // Save raw data
+		xy_raw_data[deg/DEGSTEP].xpos = xpos;
+		xy_raw_data[deg/DEGSTEP].xhall = xMaxHall + xpos;
+		xy_raw_data[deg/DEGSTEP].ypos = ypos;
+		xy_raw_data[deg/DEGSTEP].yhall = yMaxHall + ypos;
+		
+		if(fabsf(xMaxHall) > xLimit)	xng++; 	// Have NG point;
+		if(fabsf(yMaxHall) > yLimit)	yng++; 	// Have NG point; 
+
+	}
+	RamWrite32A(HALL_RAM_HXOFF1, 0); // x = center
+	RamWrite32A(HALL_RAM_HYOFF1, 0); // y = center
+
+	return (xng << 8) | yng;
+}
+
+//unsigned short HallCheck(void)
+unsigned short HallCheck(float ACCURACY, unsigned short RADIUS, unsigned short DEGSTEP, unsigned short WAIT_MSEC1, unsigned short WAIT_MSEC2, unsigned short WAIT_MSEC3)
+{
+	short i;
+//	unsigned short ret = Accuracy();
+	unsigned short ret = Accuracy(ACCURACY, RADIUS, DEGSTEP, WAIT_MSEC1, WAIT_MSEC2, WAIT_MSEC3);
+
+	if(ret)
+	{
+    	TRACE("\n VCM has NG points: X = %d, Y = %d", ret >> 8, ret & 0xff);
+	} else {
+    	TRACE("\n VCM is good!");
+	}
+	
+	// Max Accuracy
+	//TRACE("\n X Max Accuracy = %f, Y Max Accuracy = %f", xMaxAcc, yMaxAcc);
+	TRACE("\n X Max Accuracy = %d, Y Max Accuracy = %d", (int)(xMaxAcc*1000), (int)(yMaxAcc*1000));
+
+	// Limit vale
+	//TRACE("\n xLimit = %f, yLimit = %f", xLimit, yLimit);
+	TRACE("\n xLimit = %d, yLimit = %d", (int)(xLimit*1000), (int)(yLimit*1000));
+
+	// Circle
+	for(i=0; i<=(360/DEGSTEP); i++)
+	{
+		//TRACE("\n xPos = %f, xHall = %f, yPos = %f, yHall = %f", xy_raw_data[i].xpos, xy_raw_data[i].xhall, xy_raw_data[i].ypos, xy_raw_data[i].yhall);
+		TRACE("\n xPos = %d, xHall = %d, yPos = %d, yHall = %d", (int)(xy_raw_data[i].xpos*1000), (int)(xy_raw_data[i].xhall*1000), (int)(xy_raw_data[i].ypos*1000), (int)(xy_raw_data[i].yhall*1000));
+	}
+	
+	return( ret );
+}
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.h
new file mode 100644
index 0000000000000000000000000000000000000000..2d9451c57d82f42c17946337fd1fb8761d10dc8f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Accuracy.h
@@ -0,0 +1,27 @@
+/*=======================================================================
+		Accuracy Test Sample code for LC898124
+                                             	by Rex.Tang
+                                                2016.03.27
+========================================================================*/
+
+// Checking radius
+//#define		RADIUS 		75							// 75um
+
+// Parameter define
+//#define		DEGSTEP		3							// Degree of one step (3�‹)
+//#define		ACCURACY	3.0F						// Accuracy (�}3.0um)
+//#define		WAIT_MSEC	10							// Each step wait time(msec)
+#define		LOOPTIME	3							// Read times at each step
+
+// Constants
+#define		PI			3.14159		// ƒÎ
+
+
+typedef struct tag_Dual_Axis
+{
+	float xpos;
+	float xhall;
+	float ypos;
+	float yhall;
+}Dual_Axis_t;
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/DownloadCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/DownloadCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..06692929104a2dcb93bbff3478f0b21417ec66d3
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/DownloadCmd.c
@@ -0,0 +1,367 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//********************************************************************************
+
+//**************************
+//	Include Header File		
+//**************************
+#include "Ois.h"
+
+#include "LC898124EP3_Code_0_1_2_2_0_0.h"		// Gyro=LSM6DSM,	SPI Maste	SO2820
+#include "LC898124EP3_Code_0_1_3_2_1_0.h"		// Gyro=LSM6DSM,	SPI Slave	SO3600
+
+#include "LC898124EP3_Code_0_1_2_3_0_0.h"		// Gyro=BMI160,		SPI Maste	SO2820
+#include "LC898124EP3_Code_0_1_3_3_1_0.h"		// Gyro=BMI160,		SPI Slave	SO3600
+
+#include "LC898124EP3_Code_0_1_2_2_0_1.h"		// Gyro=LSM6DSM,	FRA, SPI Maste	SO2820
+#include "LC898124EP3_Code_0_1_3_2_1_1.h"		// Gyro=LSM6DSM,	FRA, SPI Slave	SO3600
+
+#include "LC898124EP3_Code_0_1_2_3_0_1.h"		// Gyro=BMI160,		FRA, SPI Maste	SO2820
+#include "LC898124EP3_Code_0_1_3_3_1_1.h"		// Gyro=BMI160,		FRA, SPI Slave	SO3600
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A( unsigned short, int );
+extern 	void RamRead32A( unsigned short, void * );
+/* for I2C Multi Translation : Burst Mode*/
+extern 	void CntWrt( void *, unsigned short) ;
+extern void CntRd( unsigned int addr, void *	PcSetDat, unsigned short	UsDatNum )  ;
+/* for Wait timer [Need to adjust for your system] */ 
+extern void	WitTim( unsigned short	UsWitTim );
+
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+#define BURST_LENGTH_PM ( 12*5 ) 	// 60 •K‚¸5‚Ì”{�”‚Å�Ý’è‚·‚邱‚Æ�B�Å‘å64Byte‚Ü‚Å
+#define BURST_LENGTH_DM ( 10*6 ) 	// 60 •K‚¸6‚Ì”{�”‚Å�Ý’è‚·‚邱‚Æ�B�Å‘å64Byte‚Ü‚Å
+#define BURST_LENGTH BURST_LENGTH_PM 	
+
+//********************************************************************************
+// Function Name 	: DMIOWrite32
+// Retun Value		: None
+// Argment Value	: IOadrs, IOdata
+// Explanation		: Read From code version Command
+// History			: First edition 						
+//********************************************************************************
+void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata )
+{
+#if 1
+	UINT8 data[10];
+	data[0] = 0xC0;		// Pmem address set
+	data[1] = 0x00;		// Command High
+	data[2] = (UINT8)(IOadrs >>24);		// IOadres
+	data[3] = (UINT8)(IOadrs >>16);		// Command High
+	data[4] = (UINT8)(IOadrs >> 8);		// Command High
+	data[5] = (UINT8)(IOadrs >> 0);		// Command High
+	data[6] = (UINT8)(IOdata >>24);		// IOadres
+	data[7] = (UINT8)(IOdata >>16);		// Command High
+	data[8] = (UINT8)(IOdata >> 8);		// Command High
+	data[9] = (UINT8)(IOdata >> 0);		// Command High
+	CntWrt( data, 10 ); 	// I2C 1Byte address.
+#else
+	RamWrite32A( CMD_IO_ADR_ACCESS, IOadrs ) ;
+	RamWrite32A( CMD_IO_DAT_ACCESS, IOdata ) ;
+#endif
+};
+
+//********************************************************************************
+// Function Name 	: DownloadToEP3
+// Retun Value		: NON
+// Argment Value	: PMlength: 5byte unit, DMlength : 1Byte unit 
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+unsigned char DownloadToEP3( const UINT8* DataPM, UINT32 LengthPM, UINT32 Parity, const UINT8* DataDM, UINT32 LengthDMA , UINT32 LengthDMB ) 
+{
+	UINT32 i, j;
+	UINT8 data[64];		// work fifo buffer max size 64 byte
+	UINT8 Remainder;	// —]‚è
+	UINT32 UlReadVal, UlCnt;
+	UINT32 ReadVerifyPM, ReadVerifyDMA, ReadVerifyDMB;	// Checksum
+	
+//*******************************************************************************//
+//*   pre-check ROM code version 												*//
+//*******************************************************************************//
+	RamRead32A( CMD_ROMVER , &UlReadVal );
+	if( UlReadVal == OLD_VER )	return( 3 );		/* ROM code version error */
+	
+//--------------------------------------------------------------------------------
+// 0. Start up to boot exection 
+//--------------------------------------------------------------------------------
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	switch ( (UINT8)UlReadVal ){
+	case 0x0A:	/* Normal Rom program execution */
+		break;
+	
+	case 0x01:	/* Normal Ram program execution */
+		/* �ÄDonload‚Ì‚½‚ß‚É‚Í RomReboot‚µ‚È‚¯‚ê‚΂Ȃç‚È‚¢�BAutoDownload‚³‚¹‚邽‚ß‚ÉCORE_RST‚ÅŽÀ�s‚³‚¹‚é*/
+		DMIOWrite32( SYSDSP_REMAP, 0x00001000 ); 	// CORE_RST
+		WitTim( 6 ) ;								// Bootƒvƒ�ƒOƒ‰ƒ€‚ð‰ñ‚·‚Ì‚É6msec•K—v�B
+		break;
+
+//	case 0x0B:
+//	case 0x08:
+	default:	
+		return( 1 );
+	}
+//--------------------------------------------------------------------------------
+// 1. Download Program
+//--------------------------------------------------------------------------------
+	data[0] = 0x30;		// Pmem address set
+	data[1] = 0x00;		// Command High
+	data[2] = 0x10;		// Command High
+	data[3] = 0x00;		// Command High
+	data[4] = 0x00;		// Command High
+	CntWrt( data, 5 ); 	// I2C 1Byte address.
+	// program start
+	data[0] = 0x40;		// Pmem address set
+	Remainder = ( (LengthPM*5) / BURST_LENGTH_PM ); 
+	for(i=0 ; i< Remainder ; i++)
+	{
+		UlCnt = 1;
+		for(j=0 ; j < BURST_LENGTH_PM; j++)	data[UlCnt++] = *DataPM++;
+		
+		CntWrt( data, BURST_LENGTH_PM+1 );  // I2Caddresss 1Byte.
+	}
+	Remainder = ( (LengthPM*5) % BURST_LENGTH_PM); 
+	if (Remainder != 0 )
+	{
+		UlCnt = 1;
+		for(j=0 ; j < Remainder; j++)	data[UlCnt++] = *DataPM++;
+//TRACE("Remainder %d \n", (UINT8)Remainder );
+		CntWrt( data, UlCnt );  // I2C 1Byte address.
+	}
+	// Chercksum start
+	data[0] = 0xF0;											// Pmem address set
+	data[1] = 0x0A;											// Command High
+	data[2] = (unsigned char)(( LengthPM & 0xFF00) >> 8 );	// Size High
+	data[3] = (unsigned char)(( LengthPM & 0x00FF) >> 0 );	// Size Low
+	CntWrt( data, 4 ); 	// I2C 2Byte addresss.
+	
+//--------------------------------------------------------------------------------
+// 2. Download Table Data
+//--------------------------------------------------------------------------------
+//TRACE("DM Start \n" );	
+	RamWrite32A( DmCheck_CheckSumDMA, 0 );		// DMA Parity Clear
+	RamWrite32A( DmCheck_CheckSumDMB, 0 );		// DMB Parity Clear
+
+	/***** DMA Data Send *****/
+	Remainder = ( (LengthDMA*6/4) / BURST_LENGTH_DM ); 
+	for(i=0 ; i< Remainder ; i++)
+	{
+		CntWrt( (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+		DataDM += BURST_LENGTH_DM;
+	}
+	Remainder = ( (LengthDMA*6/4) % BURST_LENGTH_DM ); 
+	if (Remainder != 0 )
+	{
+		CntWrt( (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+	}
+	DataDM += Remainder;
+	
+	/***** DMB Data Send *****/
+	Remainder = ( (LengthDMB*6/4) / BURST_LENGTH_DM ); 
+	for( i=0 ; i< Remainder ; i++)	/* ‘±‚«‚©‚ç */
+	{
+		CntWrt( (UINT8*)DataDM, BURST_LENGTH_DM );  // I2Caddresss 1Byte.
+		DataDM += BURST_LENGTH_DM;
+	}
+	Remainder = ( (LengthDMB*6/4) % BURST_LENGTH_DM ); 
+	if (Remainder != 0 )
+	{
+		CntWrt( (UINT8*)DataDM, (UINT8)Remainder );  // I2Caddresss 1Byte.
+	}
+	
+//--------------------------------------------------------------------------------
+// 3. Verify
+//--------------------------------------------------------------------------------
+	RamRead32A( PmCheck_CheckSum, &ReadVerifyPM );
+	RamRead32A( DmCheck_CheckSumDMA, &ReadVerifyDMA );
+	RamRead32A( DmCheck_CheckSumDMB, &ReadVerifyDMB );
+
+	
+	if( (ReadVerifyPM + ReadVerifyDMA + ReadVerifyDMB) != Parity  ){
+TRACE("error! %08x %08x %08x \n", (unsigned int)ReadVerifyPM, (unsigned int)ReadVerifyDMA, (unsigned int)ReadVerifyDMB );	
+		return( 2 );
+	}
+	return(0);
+}
+
+
+//********************************************************************************
+// Function Name 	: ReMapMain
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+void RemapMain( void )
+{
+	RamWrite32A( 0xF000, 0x00000000 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MonitorInfo
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: 
+// History			: Second edition
+//********************************************************************************
+void MonitorInfo( DSPVER* Dspcode )
+{
+TRACE("Vendor : %02x \n", Dspcode->Vendor );
+TRACE("User : %02x \n", Dspcode->User );
+TRACE("Model : %02x \n", Dspcode->Model );
+TRACE("Version : %02x \n", Dspcode->Version );
+
+
+if(Dspcode->SpiMode == SPI_MST )
+TRACE("spi mode : Master\n");	
+if(Dspcode->SpiMode == SPI_SLV )
+TRACE("spi mode : Slave\n");	
+if(Dspcode->SpiMode == SPI_SNGL )
+TRACE("spi mode : only master\n");	
+
+//if(Dspcode->ActType == ACT_SEMCO	)
+//TRACE("actuator type : SOXXXX\n");
+if(Dspcode->ActType == ACT_SO2820) {
+	TRACE("actuator type : SO2820\n");
+} else if(Dspcode->ActType == ACT_SO3600) {
+	TRACE("actuator type : SO3600\n");
+} else {
+	TRACE("actuator type : SOXXXX\n");
+}
+
+if(Dspcode->GyroType == GYRO_ICM20690 )
+TRACE("gyro type : INVEN ICM20690 \n");	
+if(Dspcode->GyroType == GYRO_LSM6DSM )
+TRACE("gyro type : ST LSM6DSM \n")	;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: GetInfomationAfterDownload
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+UINT8 GetInfomationAfterDownload( DSPVER* Info )
+{
+	UINT32 Data;
+	UINT32 UlReadVal;
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( (UINT8)UlReadVal != 0x01 ) return( 1 );
+
+	RamRead32A( (SiVerNum + 0), &Data );
+	Info->Vendor 	= (UINT8)(Data >> 24 );
+	Info->User 		= (UINT8)(Data >> 16 );
+	Info->Model 		= (UINT8)(Data >> 8 );
+	Info->Version 	= (UINT8)(Data >> 0 );
+	RamRead32A( (SiVerNum + 4), &Data );
+	Info->SpiMode =  (UINT8)(Data >> 24 );
+	Info->ActType =  (UINT8)(Data >> 8 );
+	Info->GyroType = (UINT8)(Data >> 0 );
+
+//	 MonitorInfo( Info );
+	return( 0 );
+}
+
+//********************************************************************************
+// Function Name 	: GetInfomationBeforeDownlaod
+// Retun Value		: True(0) / Fail(1)
+// Argment Value	: NON
+// Explanation		: <Pmem Memory> Write Data
+// History			: First edition
+//********************************************************************************
+UINT8 GetInfomationBeforeDownlaod( DSPVER* Info, const UINT8* DataDM,  UINT32 LengthDM )
+{
+	UINT32 i;
+	Info->ActType = 0;
+	Info->GyroType = 0;
+
+	for( i=0; i < LengthDM; i+=6 )
+	{
+		if ( (DataDM[0+i] == 0xA0) && (DataDM[1+i] == 0x00) )
+		{
+			Info->Vendor = DataDM[2+i];
+			Info->User = DataDM[3+i];
+			Info->Model = DataDM[4+i];
+			Info->Version = DataDM[5+i];
+			if ( (DataDM[6+i] == 0xA0) && (DataDM[7+i] == 0x04) )
+			{
+				Info->SpiMode = DataDM[8+i];
+				Info->ActType = DataDM[10+i];
+				Info->GyroType = DataDM[11+i];
+			}
+			MonitorInfo( Info );
+			return (0);
+		}
+	}	
+	return(1);
+}
+
+
+//********************************************************************************
+// Function Name 	: SelectDownload
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: 
+// History			: Second edition
+//********************************************************************************
+extern unsigned char I2cSlvAddrWr;
+
+const DOWNLOAD_TBL DTbl_M[] = {
+ {0x0202, LC898124EP3_PM_0_1_2_2_0_0, LC898124EP3_PMSize_0_1_2_2_0_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_2_0_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_2_0_0), LC898124EP3_DM_0_1_2_2_0_0, LC898124EP3_DMA_ByteSize_0_1_2_2_0_0 , LC898124EP3_DMB_ByteSize_0_1_2_2_0_0 },
+ {0x0282, LC898124EP3_PM_0_1_2_2_0_1, LC898124EP3_PMSize_0_1_2_2_0_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_2_0_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_2_0_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_2_0_1), LC898124EP3_DM_0_1_2_2_0_1, LC898124EP3_DMA_ByteSize_0_1_2_2_0_1 , LC898124EP3_DMB_ByteSize_0_1_2_2_0_1 },
+ {0x0203, LC898124EP3_PM_0_1_2_3_0_0, LC898124EP3_PMSize_0_1_2_3_0_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_3_0_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_3_0_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_3_0_0), LC898124EP3_DM_0_1_2_3_0_0, LC898124EP3_DMA_ByteSize_0_1_2_3_0_0 , LC898124EP3_DMB_ByteSize_0_1_2_3_0_0 },
+ {0x0283, LC898124EP3_PM_0_1_2_3_0_1, LC898124EP3_PMSize_0_1_2_3_0_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_2_3_0_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_2_3_0_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_2_3_0_1), LC898124EP3_DM_0_1_2_3_0_1, LC898124EP3_DMA_ByteSize_0_1_2_3_0_1 , LC898124EP3_DMB_ByteSize_0_1_2_3_0_1 },
+ {0xFFFF, (void*)0, 0, 0, (void*)0 ,0 ,0 }
+};
+
+const DOWNLOAD_TBL DTbl_S[] = {
+ {0x0302, LC898124EP3_PM_0_1_3_2_1_0, LC898124EP3_PMSize_0_1_3_2_1_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_2_1_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_2_1_0), LC898124EP3_DM_0_1_3_2_1_0, LC898124EP3_DMA_ByteSize_0_1_3_2_1_0 , LC898124EP3_DMB_ByteSize_0_1_3_2_1_0 },
+ {0x0382, LC898124EP3_PM_0_1_3_2_1_1, LC898124EP3_PMSize_0_1_3_2_1_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_2_1_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_2_1_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_2_1_1), LC898124EP3_DM_0_1_3_2_1_1, LC898124EP3_DMA_ByteSize_0_1_3_2_1_1 , LC898124EP3_DMB_ByteSize_0_1_3_2_1_1 },
+ {0x0303, LC898124EP3_PM_0_1_3_3_1_0, LC898124EP3_PMSize_0_1_3_3_1_0, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_3_1_0 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_3_1_0 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_3_1_0), LC898124EP3_DM_0_1_3_3_1_0, LC898124EP3_DMA_ByteSize_0_1_3_3_1_0 , LC898124EP3_DMB_ByteSize_0_1_3_3_1_0 },
+ {0x0383, LC898124EP3_PM_0_1_3_3_1_1, LC898124EP3_PMSize_0_1_3_3_1_1, (UINT32)((UINT32)LC898124EP3_PMCheckSum_0_1_3_3_1_1 + (UINT32)LC898124EP3_DMA_CheckSum_0_1_3_3_1_1 + (UINT32)LC898124EP3_DMB_CheckSum_0_1_3_3_1_1), LC898124EP3_DM_0_1_3_3_1_1, LC898124EP3_DMA_ByteSize_0_1_3_3_1_1 , LC898124EP3_DMB_ByteSize_0_1_3_3_1_1 },
+ {0xFFFF, (void*)0, 0, 0, (void*)0 ,0 ,0 }		//20180910 komori
+};
+
+unsigned char SelectDownload( UINT8 GyroSelect, UINT8 ActSelect, UINT8 MasterSlave )
+{
+	DSPVER Dspcode;
+	DOWNLOAD_TBL *ptr;
+
+	if ( MasterSlave == 0x00 ) {
+		ptr = ( DOWNLOAD_TBL *)DTbl_M;
+	} else {
+		ptr = ( DOWNLOAD_TBL *)DTbl_S;
+	}
+
+	/* ‚Ç‚ÌCode‚ðDownload‚·‚é‚Ì‚©Table‚©‚猟�õ */
+	while (ptr->Cmd != 0xFFFF ){
+		if( ptr->Cmd == ( ((UINT16)ActSelect<<8) + GyroSelect) ) break;
+		ptr++ ;
+	}
+	if (ptr->Cmd == 0xFFFF)	return(0xF0);
+
+	/* Download‚·‚é‘OCode‚ÌInformation�î•ñŠm”F */
+	if( GetInfomationBeforeDownlaod( &Dspcode, ptr->DataDM, ( ptr->LengthDMA +  ptr->LengthDMB ) ) != 0 ){
+		return(0xF1);
+	}
+
+	/* Download‚·‚é‘O‚ÌCode‚Æ�A—v‹�‚µ‚Ä‚¢‚éActuator/Gyro�î•ñ‚ªˆê’v‚µ‚Ä‚¢‚é‚©Šm”F */
+	if( (ActSelect != Dspcode.ActType) || ((GyroSelect&0x7f) != Dspcode.GyroType) ) return(0xF2);
+
+	// �‚‘¬‰»‘ΉžDownload
+TRACE("DataPM( %08x ), LengthPM( %08x ) , Parity( %08x ), DataDM( %08x ) , LengthDMA( %08x ) , LengthDMB( %08x ) \n"
+	, (int)ptr->DataPM , (int)ptr->LengthPM , (int)ptr->Parity , (int)ptr->DataDM , (int)ptr->LengthDMA , (int)ptr->LengthDMB );
+	return( DownloadToEP3( ptr->DataPM, ptr->LengthPM, ptr->Parity, ptr->DataDM, ptr->LengthDMA , ptr->LengthDMB ) ); 
+}
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/E2PromCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/E2PromCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..737d650440dc19666788e70dabb6d4cf0500b190
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/E2PromCmd.c
@@ -0,0 +1,1573 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//********************************************************************************
+
+//**************************
+//	Include Header File		
+//**************************
+#include	"Ois.h"
+#include	"OisAPI.h"
+
+//****************************************************
+//	LC898124 calibration parameters 
+//****************************************************
+#if ((SELECT_VENDOR&0x01) == 0x01)				// SEMCO
+extern const ADJ_HALL SO2820_HallCalParameter;
+extern const ADJ_LOPGAN SO2820_LoopGainParameter;
+extern AF_PARA SO2820_OpenAfParameter;
+
+extern const ADJ_HALL SO3600_HallCalParameter;
+extern const ADJ_LOPGAN SO3600_LoopGainParameter;
+extern AF_PARA SO3600_OpenAfParameter;
+#endif
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A( int, int );
+extern 	void RamRead32A( unsigned short, void * );
+/* for Wait timer [Need to adjust for your system] */ 
+extern void	WitTim( unsigned short	UsWitTim );
+
+//****************************************************
+//	EXTERN LIST
+//****************************************************
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+
+  extern const AF_PARA SO_OpenAfParameter;
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+stAdjPar	StAdjPar ;				// temporary buffer for caribration data 
+UINT16		UsGzoVal ;				// Gyro A/D Offset X
+
+#ifdef	SEL_SHIFT_COR
+stPosOff	StPosOff ;				//!< Execute Command Parameter
+stAclVal	StAclVal ;				//!< Execute Command Parameter
+#endif	//SEL_SHIFT_COR
+
+#ifdef	ZERO_SERVO
+stZeroServo			StZeroServoX;
+stZeroServo			StZeroServoY;
+stZeroServo			StZeroServoZ;
+#endif	//ZERO_SERVO
+
+//****************************************************
+//	Parameter E2Prom defines
+//****************************************************
+#define HALLCROSSXX		0x7FFFFFFF
+#define HALLCROSSXY		0x00000000
+#define HALLCROSSYY		0x7FFFFFFF
+#define HALLCROSSYX		0x00000000
+#define HALLCROSSXSHIFT	0x00
+#define HALLCROSSYSHIFT	0x00
+
+
+//****************************************************
+//	DEFINE LIST
+//****************************************************
+#define E2P_ONSEMI_AREA_SIZE	(8*2)
+#define E2P_USER_AREA_SIZE		(8*13)
+
+#define LSB 0
+#define MSB 8 
+
+
+#define CHECK_SUM_ADR	0x7D
+
+//********************************************************************************
+// Function Name 	: UnlockCodeSet
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Flash Memory> Unlock Code Set
+// History			: First edition
+//********************************************************************************
+unsigned char UnlockCodeSet( void )
+{
+	unsigned long UlReadVal;
+
+	DMIOWrite32( E2P_UNLK_CODE1, 0xAAAAAAAA );	// UNLK_CODE1(E0_7554h) = AAAA_AAAAh
+	DMIOWrite32( E2P_UNLK_CODE2, 0x55555555 );	// UNLK_CODE2(E0_7AA8h) = 5555_5555h
+	DMIOWrite32( E2P_RSTB, 		 0x00000001 );	// RSTB_FLA_WR(E0_74CCh[0])=1
+	DMIOWrite32( E2P_CLKON, 	 0x00000010 );	// FLA_WR_ON(E0_7664h[4])=1
+	DMIOWrite32( E2P_UNLK_CODE3, 0x0000ACD5 );	// Additional Unllock Code Set
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , E2P_WPB	) ;
+	RamRead32A(  CMD_IO_DAT_ACCESS , &UlReadVal ) ;
+	if ( (UlReadVal & 0x00000002) != 2 ) return(1);
+
+	return(0);	
+
+}
+
+//********************************************************************************
+// Function Name 	: UnlockCodeClear
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: <Flash Memory> Clear Unlock Code
+// History			: First edition
+//********************************************************************************
+unsigned char UnlockCodeClear(void)
+{
+	unsigned long UlReadVal;
+
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_WPB );				// UNLOCK_CLR(E0_7014h[4])=1
+	RamWrite32A( CMD_IO_DAT_ACCESS, 0x00000010 );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( (UlReadVal & 0x00000080) != 0 )	return (3);						
+	
+	return(0);	
+}
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: WriteE2Prom
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+unsigned char WriteE2Prom( unsigned char address, unsigned char data )
+{
+	UINT32 UlReadVal, UlCnt;
+	unsigned char ans;
+		
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return (ans);							// Unlock Code Set
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 			// FLG CLR
+	
+	switch ( (address & 0x0F) ){
+		case 0 : 	DMIOWrite32( E2P_WDAT00, data );	break;
+		case 1 : 	DMIOWrite32( E2P_WDAT01, data );	break;
+		case 2 : 	DMIOWrite32( E2P_WDAT02, data );	break;
+		case 3 : 	DMIOWrite32( E2P_WDAT03, data );	break;
+		case 4 : 	DMIOWrite32( E2P_WDAT04, data );	break;
+		case 5 : 	DMIOWrite32( E2P_WDAT05, data );	break;
+		case 6 : 	DMIOWrite32( E2P_WDAT06, data );	break;
+		case 7 : 	DMIOWrite32( E2P_WDAT07, data );	break;
+		case 8 : 	DMIOWrite32( E2P_WDAT08, data );	break;
+		case 9 : 	DMIOWrite32( E2P_WDAT09, data );	break;
+		case 10 : 	DMIOWrite32( E2P_WDAT10, data );	break;
+		case 11 : 	DMIOWrite32( E2P_WDAT11, data );	break;
+		case 12 : 	DMIOWrite32( E2P_WDAT12, data );	break;
+		case 13 : 	DMIOWrite32( E2P_WDAT13, data );	break;
+		case 14 : 	DMIOWrite32( E2P_WDAT14, data );	break;
+		case 15 : 	DMIOWrite32( E2P_WDAT15, data );	break;
+	}	
+	
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){	ans = 2;	break;	} ;	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	UnlockCodeClear();							// Unlock Code Clear
+	
+	return(ans);
+
+} 
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: ReadE2Prom
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+void ReadE2Prom( unsigned char address, unsigned char * val )
+{
+	UINT32 UlReadVal;
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_ASCNT, 0 );		// Count Number
+	DMIOWrite32( E2P_CMD, 1 ); 			// Re-Program
+	// Read Exe
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_RDAT );
+	RamRead32A ( CMD_IO_DAT_ACCESS, &UlReadVal );			// Read Access
+	
+	*val = (unsigned char)UlReadVal;
+}
+
+//********************************************************************************
+// Function Name 	: BurstReadE2Prom
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+void BurstReadE2Prom( unsigned char address, unsigned char * val, unsigned char cnt )
+{
+	UINT32 UlReadVal;
+	unsigned char i;
+
+	DMIOWrite32( E2P_ADR, address );	// Start Address
+	DMIOWrite32( E2P_ASCNT, (cnt -1) );		// Count Number
+	DMIOWrite32( E2P_CMD, 1 ); 			// Re-Program
+	// Read Exe
+	RamWrite32A( CMD_IO_ADR_ACCESS, E2P_RDAT );
+	for(i=0; i<cnt; i++ ){
+		RamRead32A ( CMD_IO_DAT_ACCESS, &UlReadVal );			// Read Access
+		val[i] = (unsigned char)UlReadVal;
+	}
+}
+
+
+//********************************************************************************
+// Function Name 	: E2PromVerificationONSEMI
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8 E2PromVerificationONSEMI( void )
+{
+	UINT32 Verify;
+	UINT8 cnt;
+	UINT8 temp[16];
+
+	// Create Checksum
+	Verify = 0;
+	BurstReadE2Prom( EEPROM_ONSEMI_LDO , temp, E2P_ONSEMI_AREA_SIZE );
+	for( cnt= 0 ; cnt <(E2P_ONSEMI_AREA_SIZE -1); cnt++ ){
+		Verify += temp[cnt];
+	}
+	if ( (UINT8)Verify != temp[ (E2P_ONSEMI_AREA_SIZE -1) ])	return( FAILURE );
+
+	return( SUCCESS	 );
+}
+
+//********************************************************************************
+// Function Name 	: E2PromVerificationONSEMI
+// Retun Value		: data
+// Argment Value	: NON
+// Explanation		: Read data from E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8 E2PromVerification( void )
+{
+	UINT32 Verify;
+	UINT8 cnt;
+	UINT8 temp[ E2P_USER_AREA_SIZE ];
+
+	// Create Checksum
+	Verify = 0;
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL , temp, E2P_USER_AREA_SIZE );
+	for( cnt= 0; cnt < (E2P_USER_AREA_SIZE -1); cnt++ ){
+		Verify += temp[cnt];
+	}
+	if ( (UINT8)Verify != temp[ (E2P_USER_AREA_SIZE-1) ])	return( FAILURE );
+	return( SUCCESS	 );
+}
+
+//********************************************************************************
+// Function Name 	: WrI2cSlaveAddr
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+extern unsigned char I2cSlvAddrWr;
+
+UINT8 WrI2cSlaveAddr( unsigned char Addr )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans;
+
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if( Addr == 0x74 ) {
+		DMIOWrite32( E2P_WDAT00, 0x7F );		// IDSEL(Slave Addr = 0x74)
+	} else {
+		DMIOWrite32( E2P_WDAT00, 0xFF );		// IDSEL(Slave Addr = 0x7C)
+	}
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	return( 0 );
+}
+
+
+//********************************************************************************
+// Function Name 	: WrHallCalData
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write data to E2Prom
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrHallCalData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	StAdjPar.StHalAdj.UlAdjPhs |= ( (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~( HALL_CALB_FLG | HALL_CALB_BIT )) ); 
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if ( I2cSlvAddrWr == 0x7C ) {
+		DMIOWrite32( E2P_WDAT00, 0xF7 );									// IDSEL
+	} else {
+		DMIOWrite32( E2P_WDAT00, 0x77 );									// IDSEL
+	}
+
+	DMIOWrite32( E2P_WDAT08, (UINT8)((StAdjPar.StHalAdj.UlAdjPhs)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((StAdjPar.StHalAdj.UlAdjPhs)>>MSB ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)((StAdjPar.StHalAdj.UsHlxMxa)>>LSB ) ); // OIS Hall X Max After
+	DMIOWrite32( E2P_WDAT11, (UINT8)((StAdjPar.StHalAdj.UsHlxMxa)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)((StAdjPar.StHalAdj.UsHlxMna)>>LSB ) ); // OIS Hall X Min After	
+	DMIOWrite32( E2P_WDAT13, (UINT8)((StAdjPar.StHalAdj.UsHlxMna)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, (UINT8)((StAdjPar.StHalAdj.UsHlyMxa)>>LSB ) ); // OIS Hall Y Max After
+	DMIOWrite32( E2P_WDAT15, (UINT8)((StAdjPar.StHalAdj.UsHlyMxa)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x20-0x2F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x20 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)((StAdjPar.StHalAdj.UsHlyMna)>>LSB ) ); // OIS Hall Y Min After
+	DMIOWrite32( E2P_WDAT01, (UINT8)((StAdjPar.StHalAdj.UsHlyMna)>>MSB ) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)((StAdjPar.StHalAdj.UsHlxGan)>>8 ) );		// OIS Hall Bias X
+	DMIOWrite32( E2P_WDAT03, (UINT8)((StAdjPar.StHalAdj.UsHlxOff)>>8 ) );		// OIS Hall Offset X
+	DMIOWrite32( E2P_WDAT04, (UINT8)((StAdjPar.StHalAdj.UsHlyGan)>>8 ) );		// OIS Hall Bias Y
+	DMIOWrite32( E2P_WDAT05, (UINT8)((StAdjPar.StHalAdj.UsHlyOff)>>8 ) );		// OIS Hall Offset Y
+	DMIOWrite32( E2P_WDAT06, (UINT8)((StAdjPar.StLopGan.UlLxgVal)>>16  ) );	// OIS Hall Loop Gain X
+	DMIOWrite32( E2P_WDAT07, (UINT8)((StAdjPar.StLopGan.UlLxgVal)>>24  ) );	// OIS Hall Loop Gain X
+	DMIOWrite32( E2P_WDAT08, (UINT8)((StAdjPar.StLopGan.UlLygVal)>>16  ) );   // OIS Hall Loop Gain Y
+	DMIOWrite32( E2P_WDAT09, (UINT8)((StAdjPar.StLopGan.UlLygVal)>>24  ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)((StAdjPar.StHalAdj.UsAdxOff)>>LSB ) );   // OIS Mecha center X
+	DMIOWrite32( E2P_WDAT11, (UINT8)((StAdjPar.StHalAdj.UsAdxOff)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)((StAdjPar.StHalAdj.UsAdyOff)>>LSB ) ); 	// OIS Mecha center Y
+	DMIOWrite32( E2P_WDAT13, (UINT8)((StAdjPar.StHalAdj.UsAdyOff)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, 0xFF );	//GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT15, 0xFF );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x32) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, 0xFF );	// GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT01, 0x3F );
+	DMIOWrite32( E2P_WDAT02, 0xFF );	//	GyroFilterTableY_gyzoom
+	DMIOWrite32( E2P_WDAT03, 0xFF );
+	DMIOWrite32( E2P_WDAT04, 0xFF );
+	DMIOWrite32( E2P_WDAT05, 0x3F );	
+	
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 5 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+#if 0
+	DMIOWrite32( E2P_ADR, 0x50 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT06, 0 );	// OIS gyro offset X
+	DMIOWrite32( E2P_WDAT07, (UINT8)(HALLCROSSXX>>16) );	// CrossXX lower Byte
+	DMIOWrite32( E2P_WDAT08, (UINT8)(HALLCROSSXX>>24) );	// CrossXX Higher Byte
+	DMIOWrite32( E2P_WDAT09, (UINT8)(HALLCROSSXY>>16) );	// CrossXY lower Byte
+	DMIOWrite32( E2P_WDAT10, (UINT8)(HALLCROSSXY>>24) );	// CrossXY Higher Byte
+	DMIOWrite32( E2P_WDAT11, (UINT8)(HALLCROSSYY>>16) );	// CrossYY lower Byte
+	DMIOWrite32( E2P_WDAT12, (UINT8)(HALLCROSSYY>>24) );	// CrossYY Higher Byte
+	DMIOWrite32( E2P_WDAT13, (UINT8)(HALLCROSSYX>>16) );	// CrossYX lower Byte
+	DMIOWrite32( E2P_WDAT14, (UINT8)(HALLCROSSYX>>24) );	// CrossYX Higher Byte
+	DMIOWrite32( E2P_WDAT15, HALLCROSSXSHIFT );	// CrsXsft
+	DMIOWrite32( E2P_WDAT10, HALLCROSSYSHIFT );	// CrsYsft
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+#endif
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+#if 0
+	DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, CH2SEL );	// DrvY direction 
+	DMIOWrite32( E2P_WDAT01, CH3SEL );	// DrvZ direction 
+	DMIOWrite32( E2P_WDAT02, (UINT8)(AF_FST_FREQ)      );	// AfFreq
+	DMIOWrite32( E2P_WDAT03, (UINT8)(AF_FST_FREQ>>8)   );	// AfFreq
+	DMIOWrite32( E2P_WDAT04, (UINT8)(AF_FST_UCOEF>>16) );	// AfUcode
+	DMIOWrite32( E2P_WDAT05, (UINT8)(AF_FST_UCOEF>>24) );	// AfUcode
+	DMIOWrite32( E2P_WDAT06, (UINT8)(AF_FST_DCOEF>>16) );	// AfDcode
+	DMIOWrite32( E2P_WDAT07, (UINT8)(AF_FST_DCOEF>>24) );	// AfDcode
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+#endif
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+
+} 
+//********************************************************************************
+// Function Name 	: WrGyroGainData
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: NON
+// Explanation		: Flash Write Hall Calibration Data Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrGyroGainData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	UINT32	UlZoomX, UlZoomY;
+
+	// Read the Gyro Gain value
+	RamRead32A(  GyroFilterTableX_gxzoom , &UlZoomX ) ;
+	RamRead32A(  GyroFilterTableY_gyzoom , &UlZoomY ) ;
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~GYRO_GAIN_FLG) ; 
+		
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+//	DMIOWrite32( E2P_WDAT00,  );	// IDSEL	
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x20-0x2F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x20 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT14, (UINT8)(UlZoomX>>0) );//GyroFilterTableX_gxzoom
+	DMIOWrite32( E2P_WDAT15, (UINT8)(UlZoomX>>8) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x3F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)(UlZoomX>>16) );
+	DMIOWrite32( E2P_WDAT01, (UINT8)(UlZoomX>>24) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)(UlZoomY>>0) );	//	GyroFilterTableY_gyzoom
+	DMIOWrite32( E2P_WDAT03, (UINT8)(UlZoomY>>8) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)(UlZoomY>>16) );
+	DMIOWrite32( E2P_WDAT05, (UINT8)(UlZoomY>>24) );	
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+		
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return(ans);
+}
+
+#if 0
+//********************************************************************************
+// Function Name 	: WrGyroGainData_NV
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: UlReadValX: gyro gain X, UlReadValY: gyro gain Y
+// Explanation		: Flash Write Hall Calibration Data Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrGyroGainData_NV( UINT32 UlReadValX , UINT32 UlReadValY )
+{
+
+}
+#endif
+
+
+#ifdef	ZERO_SERVO
+//********************************************************************************
+// Function Name 	: WrZeroServoData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Flash Write Zero Servo data Function
+// History			: First edition 									2016.9.5
+//********************************************************************************
+UINT8	WrZeroServoData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~ZSRV_CAL_FLG) ; 
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+//------------------------------------------------------------------------------------------------
+// Page 3 (0x30-0x3F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x30 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT01, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT02, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT03, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT04, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT05, (UINT8)(  );
+	DMIOWrite32( E2P_WDAT06, (UINT8)( ((StZeroServoX.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT07, (UINT8)( ((StZeroServoX.SlOffset)>>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT08, (UINT8)( ((StZeroServoX.SlShift) >> 0)>>LSB ) );
+	DMIOWrite32( E2P_WDAT09, (UINT8)( ((StZeroServoX.SlShift) >> 0)>>MSB ) );
+	DMIOWrite32( E2P_WDAT10, (UINT8)( ((StZeroServoX.SlGcora) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT11, (UINT8)( ((StZeroServoX.SlGcora) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT12, (UINT8)( ((StZeroServoX.SlGaina) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT13, (UINT8)( ((StZeroServoX.SlGaina) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT14, (UINT8)( ((StZeroServoY.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT15, (UINT8)( ((StZeroServoY.SlOffset)>>16)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 4 (0x40-0x4F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x40 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT00, (UINT8)( ((StZeroServoY.SlShift) >> 0)>>LSB ) );
+	DMIOWrite32( E2P_WDAT01, (UINT8)( ((StZeroServoY.SlShift) >> 0)>>MSB ) );
+	DMIOWrite32( E2P_WDAT02, (UINT8)( ((StZeroServoY.SlGcora) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT03, (UINT8)( ((StZeroServoY.SlGcora) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)( ((StZeroServoY.SlGaina) >>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT05, (UINT8)( ((StZeroServoY.SlGaina) >>16)>>MSB ) );
+	DMIOWrite32( E2P_WDAT06, (UINT8)( ((StZeroServoZ.SlOffset)>>16)>>LSB ) );
+	DMIOWrite32( E2P_WDAT07, (UINT8)( ((StZeroServoZ.SlOffset)>>16)>>MSB ) );
+//	DMIOWrite32( E2P_WDAT08, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT09, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT10, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT11, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT12, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT13, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT14, (UINT8)(  );
+//	DMIOWrite32( E2P_WDAT15, (UINT8)(  );
+
+	DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 4 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+
+#endif	//ZERO_SERVO
+
+//********************************************************************************
+// Function Name 	: WrAfParameter
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: SelectAct
+// Explanation		: Flash Write Af paramter Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	WrAfParameter( UINT8 SelectAct )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt;
+	UINT32 ReadVerify, Parity;
+	AF_PARA* AfParaPtr;
+	// Select parameter
+	
+	if( SelectAct == ACT_SO2820 ){
+		AfParaPtr = (AF_PARA*)&SO2820_OpenAfParameter;
+	}else if( SelectAct == ACT_SO3600 ){
+		AfParaPtr = (AF_PARA*)&SO3600_OpenAfParameter;
+	}else{
+		return( 7 );	/* Error */
+	}
+
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+//	DMIOWrite32( E2P_WDAT00,  );	// IDSEL	
+	DMIOWrite32( E2P_WDAT01, (UINT8)( AfParaPtr->DrvDir )); 					// Af driver direction
+	DMIOWrite32( E2P_WDAT02, (UINT8)((AfParaPtr->Rrmd1ToMacro)>>LSB ) ); 	// Af rrmd1 para to macro
+	DMIOWrite32( E2P_WDAT03, (UINT8)((AfParaPtr->Rrmd1ToMacro)>>MSB ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)((AfParaPtr->Rrmd1ToInfini)>>LSB ) ); 	// Af rrmd1 para to inf
+	DMIOWrite32( E2P_WDAT05, (UINT8)((AfParaPtr->Rrmd1ToInfini)>>MSB ) );
+	DMIOWrite32( E2P_WDAT06, (UINT8)((AfParaPtr->Freq)>>LSB ) ); 			// Af freq
+	DMIOWrite32( E2P_WDAT07, (UINT8)((AfParaPtr->Freq)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+		
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	DMIOWrite32( DRVCH3SEL,				(UINT32)AfParaPtr->DrvDir ); 					// Af driver direction
+	RamWrite32A( OLAF_COEF_FSTVAL0,		((UINT32)AfParaPtr->Rrmd1ToMacro)<<16  ); 		// Af rrmd1 para to macro
+	RamWrite32A( OLAF_COEF_FSTVAL1,		((UINT32)AfParaPtr->Rrmd1ToInfini)<<16 ); 		// Af rrmd1 para to inf
+	RamWrite32A( OLAF_COEF_FSTVAL2, 	(UINT32)AfParaPtr->Freq ); 						// Af freq
+	RamWrite32A( OLAF_DMB_FT, 			(UINT32)AfParaPtr->Freq ); 						// Af freq
+	
+	return(ans);
+}
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: WrHallLnData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: EEPROM Write Hall Linearity data Function
+// History			: First edition 									2017.6.27
+//********************************************************************************
+UINT8	WrHallLnData(  UINT8 UcMode, mlLinearityValue *linval )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	double		*pPosX, *pPosY;
+	UINT32	PosDifX, PosDifY;
+	DSPVER Info;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	if( UcMode ){
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~HLLN_CALB_FLG) ; 
+	}else{
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) | (HLLN_CALB_FLG) ; 
+	}
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+//------------------------------------------------------------------------------------------------
+// Page 4 (0x40-0x4F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x40 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+	if( UcMode ){
+
+		if( Info.ActType == ACT_SO2820 ){
+		//(XYSWAP == 0)
+			pPosX = linval->positionX;
+			pPosY = linval->positionY;
+		}else if( Info.ActType == ACT_SO3600 ){
+		//(XYSWAP == 1)
+			pPosY = linval->positionX;
+			pPosX = linval->positionY;
+		}else{
+		//(XYSWAP == 1)
+			pPosY = linval->positionX;
+			pPosX = linval->positionY;
+		}
+
+	//	DMIOWrite32( E2P_WDAT00, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT01, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)(  ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)(  ) );
+		DMIOWrite32( E2P_WDAT08, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS1 X
+		DMIOWrite32( E2P_WDAT09, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;	
+		DMIOWrite32( E2P_WDAT10, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS1 Y
+		DMIOWrite32( E2P_WDAT11, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+		DMIOWrite32( E2P_WDAT12, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS2 X
+		DMIOWrite32( E2P_WDAT13, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+		DMIOWrite32( E2P_WDAT14, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS2 Y
+		DMIOWrite32( E2P_WDAT15, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+	}else{
+		DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );		// POS1 X
+		DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );		
+		DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );		// POS1 Y
+		DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );	
+		DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );		// POS2 X
+		DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );	
+		DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );		// POS2 Y
+		DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );	
+	}
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// Page 5 (0x50-0x5F) 
+//------------------------------------------------------------------------------------------------
+			DMIOWrite32( E2P_ADR, 0x50 );	// Start Address
+			DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+			
+		if( UcMode ){
+			DMIOWrite32( E2P_WDAT00, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS3 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT02, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS3 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT04, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS4 X
+			DMIOWrite32( E2P_WDAT05, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT06, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS4 Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT08, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS5 X
+			DMIOWrite32( E2P_WDAT09, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT10, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS5 Y
+			DMIOWrite32( E2P_WDAT11, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+			DMIOWrite32( E2P_WDAT12, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS6 X
+			DMIOWrite32( E2P_WDAT13, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );	pPosX++;
+			DMIOWrite32( E2P_WDAT14, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS6 Y
+			DMIOWrite32( E2P_WDAT15, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );	pPosY++;
+		}else{
+			DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );	// POS3 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT02, (UINT8)0xFF );	// POS3 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT04, (UINT8)0xFF );	// POS4 X
+			DMIOWrite32( E2P_WDAT05, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT06, (UINT8)0xFF );	// POS4 Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );	// POS5 X
+			DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );	// POS5 Y
+			DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );	// POS6 X
+			DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );	// POS6 Y
+			DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );
+		}
+			DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+			WitTim( 20 ) ;
+			UlCnt=0;
+			do{
+				if( UlCnt++ > 10 ){
+					UnlockCodeClear();							// Unlock Code Clear
+					return( 4 );	
+				}	
+				RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+				RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+			}while ( (UlReadVal & 0x00000080) != 0 );
+			
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x60-0x6F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+		if( UcMode ){
+			DMIOWrite32( E2P_WDAT00, (UINT8)( (UINT32)(*pPosX * 10)>>LSB ) );				// POS7 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)( (UINT32)(*pPosX * 10)>>MSB ) );
+			DMIOWrite32( E2P_WDAT02, (UINT8)( (UINT32)(*pPosY * 10)>>LSB ) );				// POS7 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)( (UINT32)(*pPosY * 10)>>MSB ) );
+
+			if( Info.ActType == ACT_SO2820 ){
+			//(XYSWAP == 0)
+				PosDifX = (linval->dacX[1] - linval->dacX[0]); 
+				PosDifY = (linval->dacY[1] - linval->dacY[0]); 
+			}else if( Info.ActType == ACT_SO3600 ){
+			//(XYSWAP == 1)
+				PosDifY = (linval->dacX[1] - linval->dacX[0]); 
+				PosDifX = (linval->dacY[1] - linval->dacY[0]); 
+			}else{
+			//(XYSWAP == 1)
+				PosDifY = (linval->dacX[1] - linval->dacX[0]); 
+				PosDifX = (linval->dacY[1] - linval->dacY[0]); 
+			}
+
+			DMIOWrite32( E2P_WDAT04, (UINT8)( (UINT16)(PosDifX>>16)>>LSB ) );				// STEP X
+			DMIOWrite32( E2P_WDAT05, (UINT8)( (UINT16)(PosDifX>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT06, (UINT8)( (UINT16)(PosDifY>>16)>>LSB ) );				// STEP Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)( (UINT16)(PosDifY>>16)>>MSB ) );
+		}else{
+			DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );				// POS7 X
+			DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT02, (UINT8)0xFF );				// POS7 Y
+			DMIOWrite32( E2P_WDAT03, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT04, (UINT8)0xFF );				// STEP X
+			DMIOWrite32( E2P_WDAT05, (UINT8)0xFF );
+			DMIOWrite32( E2P_WDAT06, (UINT8)0xFF );				// STEP Y
+			DMIOWrite32( E2P_WDAT07, (UINT8)0xFF );
+		}
+	//	DMIOWrite32( E2P_WDAT08, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT09, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT10, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT11, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT12, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT13, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT14, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT15, (UINT8)( ) );
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+
+//********************************************************************************
+// Function Name 	: WrMixCalData
+// Retun Value		: SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: EEPROM Writecross talk data Function
+// History			: First edition 									2017.6.27
+//********************************************************************************
+UINT8	WrMixCalData(  UINT8 UcMode, mlMixingValue *mixval )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt, UcReadVal[2];
+	UINT32 ReadVerify, Parity;
+	DSPVER Info;
+	
+	// Read the Status & Update
+	BurstReadE2Prom( EEPROM_Calibration_Status_LSB, UcReadVal, 2 );
+	if( UcMode ){
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) & (~MIXI_CALB_FLG) ; 
+	}else{
+		UlReadVal = (((UINT32)UcReadVal[1]<<8) +UcReadVal[0]) | (MIXI_CALB_FLG) ; 
+	}
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) return ( 1 );							// Unlock Code Set
+	
+//------------------------------------------------------------------------------------------------
+// Page 1 (0x10-0x1F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x10 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+//	DMIOWrite32( E2P_WDAT00, 0xF7 );										// IDSEL
+	DMIOWrite32( E2P_WDAT08, (UINT8)((UlReadVal)>>LSB ) ); // Calibration Status
+	DMIOWrite32( E2P_WDAT09, (UINT8)((UlReadVal)>>MSB ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 2 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+
+//------------------------------------------------------------------------------------------------
+// Page 6 (0x60-0x6F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x60 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+		
+	//	DMIOWrite32( E2P_WDAT00, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT01, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)( ) );
+	
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+	
+	if( Info.ActType == ACT_SO2820 ){
+		
+		mixval->hx45yL = (-1)*mixval->hx45yL;
+		mixval->hy45xL = (-1)*mixval->hy45xL;
+	
+		if(mixval->hy45yL<0){			/* for MeasurementLibrary 1.X */
+			mixval->hy45yL = (-1)*mixval->hy45yL;
+			mixval->hx45yL = (-1)*mixval->hx45yL;
+		}
+	}else if( Info.ActType == ACT_SO3600 ){
+		
+		mixval->hx45yL = (-1)*mixval->hx45yL;
+		mixval->hy45xL = (-1)*mixval->hy45xL;
+	
+		if(mixval->hy45yL<0){			/* for MeasurementLibrary 1.X */
+			mixval->hy45yL = (-1)*mixval->hy45yL;
+			mixval->hx45yL = (-1)*mixval->hx45yL;
+		}
+	} 
+//*****************************************************//
+//	if( XYSTPDIR == 0x10 || XYSTPDIR == 0x01  ){
+//		mixval->hx45yL = (-1)*mixval->hx45yL;
+//		mixval->hy45xL = (-1)*mixval->hy45xL;
+//	}
+//****************************************************//
+	
+	if( UcMode ){
+		if( Info.ActType == ACT_SO2820 ){
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT08, (UINT8)(( mixval->hx45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT09, (UINT8)(( mixval->hx45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT10, (UINT8)(( mixval->hx45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT11, (UINT8)(( mixval->hx45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT12, (UINT8)(( mixval->hy45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT13, (UINT8)(( mixval->hy45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT14, (UINT8)(( mixval->hy45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT15, (UINT8)(( mixval->hy45xL>>16)>>MSB ) );
+		}else if( Info.ActType == ACT_SO3600 ){
+			/* XYSWAP == 1 */
+			DMIOWrite32( E2P_WDAT08, (UINT8)(( mixval->hy45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT09, (UINT8)(( mixval->hy45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT10, (UINT8)(( mixval->hy45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT11, (UINT8)(( mixval->hy45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT12, (UINT8)(( mixval->hx45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT13, (UINT8)(( mixval->hx45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT14, (UINT8)(( mixval->hx45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT15, (UINT8)(( mixval->hx45yL>>16)>>MSB ) );
+		}else{
+			/* XYSWAP == 1 */
+			DMIOWrite32( E2P_WDAT08, (UINT8)(( mixval->hy45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT09, (UINT8)(( mixval->hy45yL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT10, (UINT8)(( mixval->hy45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT11, (UINT8)(( mixval->hy45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT12, (UINT8)(( mixval->hx45xL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT13, (UINT8)(( mixval->hx45xL>>16)>>MSB ) );
+			DMIOWrite32( E2P_WDAT14, (UINT8)(( mixval->hx45yL>>16)>>LSB ) );
+			DMIOWrite32( E2P_WDAT15, (UINT8)(( mixval->hx45yL>>16)>>MSB ) );
+		}
+	}else{
+		DMIOWrite32( E2P_WDAT08, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT09, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT10, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT11, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT12, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT13, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT14, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT15, (UINT8)0xFF );
+	}
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+		DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+		DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+
+	if( UcMode ){
+		if( Info.ActType == ACT_SO2820 ){
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT00, (UINT8)( mixval->hxsx ) );
+			DMIOWrite32( E2P_WDAT01, (UINT8)( mixval->hysx ) );
+		}else if( Info.ActType == ACT_SO3600 ){
+			/* XYSWAP == 0 */
+			DMIOWrite32( E2P_WDAT00, (UINT8)( mixval->hxsx ) );
+			DMIOWrite32( E2P_WDAT01, (UINT8)( mixval->hysx ) );
+		}else{
+			/* XYSWAP == 1 */
+			DMIOWrite32( E2P_WDAT00, (UINT8)( mixval->hysx ) );
+			DMIOWrite32( E2P_WDAT01, (UINT8)( mixval->hxsx ) );
+		}
+	}else{
+		DMIOWrite32( E2P_WDAT00, (UINT8)0xFF );
+		DMIOWrite32( E2P_WDAT01, (UINT8)0xFF );
+	}
+	//	DMIOWrite32( E2P_WDAT02, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT03, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT04, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT05, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT06, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT07, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT08, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT09, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT10, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT11, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT12, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT13, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT14, (UINT8)( ) );
+	//	DMIOWrite32( E2P_WDAT15, (UINT8)( ) );
+
+		DMIOWrite32( E2P_CMD, 2 ); 		// Re-Program
+		WitTim( 20 ) ;
+		UlCnt=0;
+		do{
+			if( UlCnt++ > 10 ){
+				UnlockCodeClear();							// Unlock Code Clear
+				return( 4 );	
+			}	
+			RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+			RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+		}while ( (UlReadVal & 0x00000080) != 0 );
+		
+//	}
+	
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity)	return( 6 );  
+	
+	return( 0 );
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+//********************************************************************************
+// Function Name 	: WrOptOffsetData
+// Retun Value		: error
+// Argment Value	: NON
+// Explanation		: Write opt offset data to E2Prom
+// History			: First edition
+//********************************************************************************
+UINT8	WrOptOffsetData( void )
+{
+	UINT32 UlReadVal, UlCnt;
+	UINT8 ans, data[CHECK_SUM_NUM], cnt;
+	UINT32 ReadVerify, Parity;
+
+	UINT32	UlHxoff;
+	UINT32	UlHyoff;
+	
+	RamRead32A( ZeroServoRAM_X_OUT , &UlHxoff ) ;	// ZeroServoRAM_X_OUT // 0x03BC
+	RamRead32A( ZeroServoRAM_Y_OUT , &UlHyoff ) ;	// ZeroServoRAM_Y_OUT // 0x03D4
+//	UlHxoff = 0xFFFFFFFF;
+//	UlHyoff = 0xFFFFFFFF;
+
+TRACE("UlHxoff = %08X\n", UlHxoff);
+TRACE("UlHyoff = %08X\n", UlHyoff);
+	
+	// Flash write�€”õ
+	ans = UnlockCodeSet();
+	if ( ans != 0 ) {
+		TRACE("Error 1 \n");
+		return ( 1 );							// Unlock Code Set
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 2 (0x72-0x75) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 		// FLG CLR
+	
+	DMIOWrite32( E2P_WDAT02, (UINT8)((UlHxoff)>>(16+LSB) ) );   // optical center X
+	DMIOWrite32( E2P_WDAT03, (UINT8)((UlHxoff)>>(16+MSB) ) );
+	DMIOWrite32( E2P_WDAT04, (UINT8)((UlHyoff)>>(16+LSB) ) ); 	// optical center Y
+	DMIOWrite32( E2P_WDAT05, (UINT8)((UlHyoff)>>(16+MSB) ) );
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+TRACE("Error 2 \n");
+			return( 3 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+//------------------------------------------------------------------------------------------------
+// CheckSum Creating 
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	Parity = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		Parity +=  data[cnt];
+	}
+
+//------------------------------------------------------------------------------------------------
+// Page 7 (0x70-0x7F) 
+//------------------------------------------------------------------------------------------------
+	DMIOWrite32( E2P_ADR, 0x70 );	// Start Address
+	DMIOWrite32( E2P_DFG, 0 ); 				// FLG CLR
+
+	DMIOWrite32( E2P_WDAT13, (UINT8)(Parity) ); // CheckSum:0x7D
+
+	DMIOWrite32( E2P_CMD, 2 ); 			// Re-Program
+	WitTim( 20 ) ;
+	UlCnt=0;
+	do{
+		if( UlCnt++ > 10 ){
+			UnlockCodeClear();							// Unlock Code Clear
+TRACE("Error 3 \n");
+			return( 5 );	
+		}	
+		RamWrite32A( CMD_IO_ADR_ACCESS , E2P_INT );
+		RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	}while ( (UlReadVal & 0x00000080) != 0 );
+
+	UnlockCodeClear();							// Unlock Code Clear
+//------------------------------------------------------------------------------------------------
+// Checksum Verification
+//------------------------------------------------------------------------------------------------
+	BurstReadE2Prom( EEPROM_ONSEMI_IDSEL, data, CHECK_SUM_NUM );
+	ReadVerify = 0;
+	for( cnt=0; cnt < CHECK_SUM_NUM; cnt++ ){
+		ReadVerify +=  data[cnt];
+	}
+	ReadE2Prom( CHECK_SUM_ADR, &cnt );
+	Parity = cnt;
+	if( (UINT8)ReadVerify != (UINT8)Parity){
+TRACE("Error 4 \n");
+			return( 6 );  
+	}
+	
+TRACE("Pass All \n");
+	return( 0 );
+
+} 
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/HighLevelCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/HighLevelCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..6d95e08c272a217fecf232469ed5077cb83ba547
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/HighLevelCmd.c
@@ -0,0 +1,2058 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//	    Program Name	: OisCmd.c
+//		Design			: Y.Shigoeka
+//		History			: First edition						
+//********************************************************************************
+//**************************
+//	Include Header File		
+//**************************
+#include	"Ois.h"
+#include	<stdlib.h>
+#include	<math.h>
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+extern UINT8 GetInfomationAfterDownload( DSPVER* Info );
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+extern void BurstReadE2Prom( UINT8 startaddress, UINT8* val, UINT8 cnt );
+extern void ReadE2Prom( unsigned char address, unsigned char * val );
+//**************************
+//	STRICT
+//**************************
+typedef struct {
+	INT32				SiSampleNum ;			// Measure Sample Number
+	INT32				SiSampleMax ;			// Measure Sample Number Max
+
+	struct {
+		INT32			SiMax1 ;				// Max Measure Result
+		INT32			SiMin1 ;				// Min Measure Result
+		UINT32	UiAmp1 ;				// Amplitude Measure Result
+		INT64		LLiIntegral1 ;			// Integration Measure Result
+		INT64		LLiAbsInteg1 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam1 ;			// Measure Delay RAM Address
+	} MeasureFilterA ;
+
+	struct {
+		INT32			SiMax2 ;				// Max Measure Result
+		INT32			SiMin2 ;				// Min Measure Result
+		UINT32	UiAmp2 ;				// Amplitude Measure Result
+		INT64		LLiIntegral2 ;			// Integration Measure Result
+		INT64		LLiAbsInteg2 ;			// Absolute Integration Measure Result
+		INT32			PiMeasureRam2 ;			// Measure Delay RAM Address
+	} MeasureFilterB ;
+} MeasureFunction_Type ;
+
+//**************************
+//	Local Function LIST
+//**************************
+void	MesFil( UINT8 ) ;									// Measure Filter Setting
+void	ClrMesFil( void );
+void	MeasureStart( INT32 , UINT32 , UINT32 ) ;				// Measure Start Function
+void	MeasureWait( void ) ;								// Measure Wait
+void	MemoryClear( UINT16 , UINT16 ) ;					// Memory Cloear
+void	SetWaitTime( UINT16 ) ; 							// Set Wait Timer
+void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans );
+
+void	OisEnaNCL( void );
+void	OisEnaDrCl( void );
+void	OisEnaDrNcl( void );
+void	OisDis( void );
+void	SetRec( void );
+void	SetStill( void );
+
+UINT8	MesRam( INT32 , INT32 , INT32 , stMesRam* , stMesRam* );
+
+UINT8	RdStatus( UINT8 UcStBitChk );
+void	MeasureStart2( INT32 SlMeasureParameterNum , INT32 SlMeasureParameterA , INT32 SlMeasureParameterB , UINT16 UsTime );
+void	MesFil2( UINT16	UsMesFreq )	;
+void	SetLinearityParameter( void );
+void	SetGyroCoef( UINT8 );
+void	SetAccelCoef( UINT8 );
+
+extern	stAclVal	StAclVal ;				//!< Execute Command Parameter
+
+//**************************
+//	define					
+//**************************
+#define 	ONE_MSEC_COUNT	18			// 18.0288kHz * 18 �à 1ms
+
+//#define 	HALL_ADJ		0
+#define 	LOOPGAIN		1
+#define 	THROUGH			2
+#define 	NOISE			3
+#define		OSCCHK			4
+
+#define		CNT050MS		 676
+#define		CNT100MS		1352
+#define		CNT200MS		2703
+
+//********************************************************************************
+// Function Name 	: SetTregAf
+// Retun Value		: 
+// Argment Value	: Min:000h Max:7FFh (11bit) in the case of Bi-direction
+// Argment Value	: Min:000h Max:3FFh (10bit) in the case of Uni-direction
+// Explanation		: 
+// History			: First edition 						2014.06.19 T.Tokoro
+//********************************************************************************
+void	SetTregAf( UINT16 UsTregAf )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+
+	RamWrite32A( CMD_AF_POSITION,	UsTregAf| 0x00010000 ) ;		// bit 16 : FST mode
+	while( UcStRd && ( UlStCnt++ < CNT050MS) ) {
+		UcStRd = RdStatus(1);
+	}
+TRACE("SetTregAf( status , cnt ) = %02x , %08x\n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: PreparationForPowerOff
+// Retun Value		: 
+// Argment Value	: 
+// Explanation		: 
+// History			: First edition 						
+//********************************************************************************
+void PreparationForPowerOff( void )
+{
+	UINT32 UlReadVa;
+	DSPVER Dspcode;
+		
+	/* SPI communication pending */
+	RamRead32A ( (GYRO_RAM_GYRO_AF_Switch & 0xFFFC), &UlReadVa );
+	RamWrite32A( (GYRO_RAM_GYRO_AF_Switch & 0xFFFC), (UlReadVa|0x00008000) );
+
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVa );
+	if ( UlReadVa == 0x01 ){
+		/* Normal Ram program execution */
+		GetInfomationAfterDownload( &Dspcode );
+		switch ( Dspcode.GyroType ){
+		case GYRO_LSM6DSM:
+			/* Gyro SPI disable command set for ST by secondary SPI*/
+			RamWrite32A( CMD_GYRO_WR_ACCS, 0x70000000 );
+		 	break;
+		} 
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MesFil
+// Retun Value		: NON
+// Argment Value	: Measure Filter Mode
+// Explanation		: Measure Filter Setting Function
+// History			: First edition 		
+//********************************************************************************
+void	MesFil( UINT8	UcMesMod )		// 20.019kHz
+{
+	UINT32	UlMeasFilaA , UlMeasFilaB , UlMeasFilaC ;
+	UINT32	UlMeasFilbA , UlMeasFilbB , UlMeasFilbC ;
+
+	if( !UcMesMod ) {								// Hall Bias&Offset Adjust
+		
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF 150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+		
+	} else if( UcMesMod == LOOPGAIN ) {				// Loop Gain Adjust
+
+		UlMeasFilaA	=	0x12FEA055 ;	// LPF1000Hz
+		UlMeasFilaB	=	0x12FEA055 ;
+		UlMeasFilaC	=	0x5A02BF55 ;
+		UlMeasFilbA	=	0x7F559791 ;	// HPF30Hz
+		UlMeasFilbB	=	0x80AA686F ;
+		UlMeasFilbC	=	0x7EAB2F23 ;
+		
+	} else if( UcMesMod == THROUGH ) {				// for Through
+
+		UlMeasFilaA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilaB	=	0x00000000 ;
+		UlMeasFilaC	=	0x00000000 ;
+		UlMeasFilbA	=	0x7FFFFFFF ;	// Through
+		UlMeasFilbB	=	0x00000000 ;
+		UlMeasFilbC	=	0x00000000 ;
+
+	} else if( UcMesMod == NOISE ) {				// SINE WAVE TEST for NOISE
+
+		UlMeasFilaA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilaB	=	0x0342AD4D ;
+		UlMeasFilaC	=	0x797AA565 ;
+		UlMeasFilbA	=	0x0342AD4D ;	// LPF150Hz
+		UlMeasFilbB	=	0x0342AD4D ;
+		UlMeasFilbC	=	0x797AA565 ;
+
+	} else if(UcMesMod == OSCCHK) {
+		UlMeasFilaA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilaB	=	0x065BE349 ;
+		UlMeasFilaC	=	0x7348396D ;
+		UlMeasFilbA	=	0x065BE349 ;	// LPF300Hz
+		UlMeasFilbB	=	0x065BE349 ;
+		UlMeasFilbC	=	0x7348396D ;
+	}
+	
+	RamWrite32A ( MeasureFilterA_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A ( MeasureFilterA_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c2	, UlMeasFilbC ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a1	, UlMeasFilaA ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b1	, UlMeasFilaB ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c1	, UlMeasFilaC ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a2	, UlMeasFilbA ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b2	, UlMeasFilbB ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c2	, UlMeasFilbC ) ;
+}
+
+//********************************************************************************
+// Function Name 	: ClrMesFil
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Clear Measure Filter Function
+// History			: First edition 						
+//********************************************************************************
+void	ClrMesFil( void )
+{
+	RamWrite32A ( MeasureFilterA_Delay_z11	, 0 ) ;
+	RamWrite32A ( MeasureFilterA_Delay_z12	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterA_Delay_z21	, 0 ) ;
+	RamWrite32A ( MeasureFilterA_Delay_z22	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterB_Delay_z11	, 0 ) ;
+	RamWrite32A ( MeasureFilterB_Delay_z12	, 0 ) ;
+
+	RamWrite32A ( MeasureFilterB_Delay_z21	, 0 ) ;
+	RamWrite32A ( MeasureFilterB_Delay_z22	, 0 ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetWaitTime
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Set Timer wait Function
+// History			: First edition 						
+//********************************************************************************
+void	SetWaitTime( UINT16 UsWaitTime )
+{
+	RamWrite32A( WaitTimerData_UiWaitCounter	, 0 ) ;
+	RamWrite32A( WaitTimerData_UiTargetCount	, (UINT32)(ONE_MSEC_COUNT * UsWaitTime)) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetTransDataAdr
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Trans Address for Data Function
+// History			: First edition 						
+//********************************************************************************
+void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans )
+{
+	UnDwdVal	StTrsVal ;
+	
+	if( UlLowAdrBeforeTrans < 0x00009000 ){
+		StTrsVal.UlDwdVal = UlLowAdrBeforeTrans ;
+	}else{
+		StTrsVal.StDwdVal.UsHigVal = (UINT16)(( UlLowAdrBeforeTrans & 0x0000F000 ) >> 8 ) ;
+		StTrsVal.StDwdVal.UsLowVal = (UINT16)( UlLowAdrBeforeTrans & 0x00000FFF ) ;
+	}
+//TRACE(" TRANS  ADR = %04xh , DAT = %08xh \n",UsLowAddress , StTrsVal.UlDwdVal ) ;
+	RamWrite32A( UsLowAddress	,	StTrsVal.UlDwdVal );
+	
+}
+
+//********************************************************************************
+// Function Name 	: MemoryClear
+// Retun Value		: NON
+// Argment Value	: Top pointer , Size
+// Explanation		: Memory Clear Function
+// History			: First edition 						
+//********************************************************************************
+void	MemoryClear( UINT16 UsSourceAddress, UINT16 UsClearSize )
+{
+	UINT16	UsLoopIndex ;
+
+	for ( UsLoopIndex = 0 ; UsLoopIndex < UsClearSize ; UsLoopIndex += 4 ) {
+		RamWrite32A( UsSourceAddress + UsLoopIndex	, 	0x00000000 ) ;				// 4Byte
+//TRACE("MEM CLR ADR = %04xh \n",UsSourceAddress + UsLoopIndex) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureStart( INT32 SlMeasureParameterNum , UINT32 SlMeasureParameterA , UINT32 SlMeasureParameterB )
+{
+	MemoryClear( StMeasFunc_SiSampleNum , sizeof( MeasureFunction_Type ) ) ;
+	RamWrite32A( StMeasFunc_MFA_SiMax1	 , 0x80000000 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFB_SiMax2	 , 0x80000000 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFA_SiMin1	 , 0x7FFFFFFF ) ;					// Set Max 
+	RamWrite32A( StMeasFunc_MFB_SiMin2	 , 0x7FFFFFFF ) ;					// Set Max 
+	
+	SetTransDataAdr( StMeasFunc_MFA_PiMeasureRam1	 , SlMeasureParameterA ) ;		// Set Measure Filter A Ram Address
+	SetTransDataAdr( StMeasFunc_MFB_PiMeasureRam2	 , SlMeasureParameterB ) ;		// Set Measure Filter B Ram Address
+	RamWrite32A( StMeasFunc_SiSampleNum	 , 0 ) ;													// Clear Measure Counter 
+	ClrMesFil() ;						// Clear Delay Ram
+//	SetWaitTime(50) ;
+	SetWaitTime(1) ;
+	RamWrite32A( StMeasFunc_SiSampleMax	 , SlMeasureParameterNum ) ;						// Set Measure Max Number
+
+}
+	
+//********************************************************************************
+// Function Name 	: MeasureWait
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Wait complete of Measure Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureWait( void )
+{
+	UINT32			SlWaitTimerSt ;
+	
+	SlWaitTimerSt = 1 ;
+	while( SlWaitTimerSt ){
+		RamRead32A( StMeasFunc_SiSampleMax , &SlWaitTimerSt ) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: set the gyro offset data. before do this before Remapmain.
+// History			: First edition 						
+//********************************************************************************
+void	SetGyroOffset( UINT16 GyroOffsetX, UINT16 GyroOffsetY, UINT16 GyroOffsetZ )
+{
+	RamWrite32A( GYRO_RAM_GXOFFZ , (( GyroOffsetX << 16 ) & 0xFFFF0000 ) ) ;		// X axis Gyro offset
+	RamWrite32A( GYRO_RAM_GYOFFZ , (( GyroOffsetY << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+	RamWrite32A( GYRO_RAM_GZOFFZ , (( GyroOffsetZ << 16 ) & 0xFFFF0000 ) ) ;		// Z axis Gyro offset
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStart
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStart( void )	
+{
+	MesFil( THROUGH ) ;								// Set Measure Filter
+	MeasureStart( GYROF_NUM , GYRO_RAM_GX_ADIDAT , GYRO_RAM_GY_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	:GyroOffsetMeasureStartZ
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+void GyroOffsetMeasureStartZ( void )	
+{
+	MesFil( THROUGH ) ;								// Set Measure Filter
+	MeasureStart( GYROF_NUM , GYRO_RAM_GZ_ADIDAT , GYRO_RAM_GZ_ADIDAT ) ;	// Start measure
+}
+
+//********************************************************************************
+// Function Name 	: GetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: get the gyro offset adjustment result
+// History			: First edition 						
+//********************************************************************************
+UINT8 GetGyroOffset( UINT16* GyroOffsetX, UINT16* GyroOffsetY, INT16 GYROF_UPPER, INT16 GYROF_LOWER   )
+{
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	INT32			SlMeasureMaxValue , SlMeasureMinValue ;
+	UINT32 UlReadVal, UlCnt=0;
+	UINT8 ans=0;
+
+	// Wait complete of measurement
+	do{
+		if( UlCnt++ > 100 ){
+			/* timeout error */
+			*GyroOffsetX = 0;
+			*GyroOffsetY = 0;
+			return( 4 );
+		}
+		RamRead32A( StMeasFunc_SiSampleMax , &UlReadVal ) ;
+	}while ( UlReadVal != 0 );
+	
+	RamRead32A( StMeasFunc_MFA_SiMax1 , ( UINT32 * )&SlMeasureMaxValue ) ;	// Max value
+	RamRead32A( StMeasFunc_MFA_SiMin1 , ( UINT32 * )&SlMeasureMinValue ) ;	// Min value
+	if (SlMeasureMaxValue == SlMeasureMinValue )
+	{
+		return( 8 ); 
+	}
+	
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+	SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / GYROF_NUM ) ;
+	SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / GYROF_NUM ) ;
+	
+	SlMeasureAveValueA = ( SlMeasureAveValueA >> 16 ) & 0x0000FFFF ;
+	SlMeasureAveValueB = ( SlMeasureAveValueB >> 16 ) & 0x0000FFFF ;
+	// EP1‚Å‚Í”½“]�ˆ—�‚µ‚È‚¢�B
+//	SlMeasureAveValueA = 0x00010000 - SlMeasureAveValueA ;
+//	SlMeasureAveValueB = 0x00010000 - SlMeasureAveValueB ;
+	
+	*GyroOffsetX = ( UINT16 )( SlMeasureAveValueA & 0x0000FFFF );		//Measure Result Store
+	*GyroOffsetY = ( UINT16 )( SlMeasureAveValueB & 0x0000FFFF );		//Measure Result Store
+
+	if(( (INT16)(*GyroOffsetX) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetX) < GYROF_LOWER )){
+		ans |= 1; 
+	}
+	if(( (INT16)(*GyroOffsetY) > GYROF_UPPER ) || ( (INT16)(*GyroOffsetY) < GYROF_LOWER )){
+		ans |= 2; 
+	}
+
+	return( ans ); 
+}
+
+#ifdef	SEL_SHIFT_COR
+//********************************************************************************
+// Function Name 	: SetAcclOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: set the accl offset data. before do this before Remapmain.
+// History			: First edition 						
+//********************************************************************************
+void	SetAcclOffset( UINT16 AcclOffsetX, UINT16 AcclOffsetY, UINT16 AcclOffsetZ )
+{
+	RamWrite32A( ZeroServoRAM_X_OFFSET , ( ( AcclOffsetX << 16 ) & 0xFFFF0000 ) ) ;		// X axis Accl offset
+	RamWrite32A( ZeroServoRAM_Y_OFFSET , ( ( AcclOffsetY << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Accl offset
+	RamWrite32A( ZeroServoRAM_Z_OFFSET , ( ( AcclOffsetZ << 16 ) & 0xFFFF0000 ) ) ;		// Z axis Accl offset
+}
+
+//********************************************************************************
+// Function Name 	: GetAcclOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: get the accl offset adjustment result
+// History			: First edition 						
+//********************************************************************************
+void	GetAcclOffset( UINT16* AcclOffsetX, UINT16* AcclOffsetY, UINT16* AcclOffsetZ )
+{
+	*AcclOffsetX = ( UINT16 )( StAclVal.StAccel.SlOffsetX & 0x0000FFFF );
+	*AcclOffsetY = ( UINT16 )( StAclVal.StAccel.SlOffsetY & 0x0000FFFF );
+	*AcclOffsetZ = ( UINT16 )( StAclVal.StAccel.SlOffsetZ & 0x0000FFFF );	
+}
+#endif	//SEL_SHIFT_COR
+
+//********************************************************************************
+// Function Name 	: RtnCen
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Return to center Command Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	RtnCen( UINT8	UcCmdPar )
+{
+	UINT8	UcSndDat = 1 ;
+	UINT32	UlStCnt = 0;
+	
+	if( !UcCmdPar ){								// X,Y centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , BOTH_SRV_ON ) ;
+	}else if( UcCmdPar == XONLY_ON ){				// only X centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , XAXS_SRV_ON ) ;
+	}else if( UcCmdPar == YONLY_ON ){				// only Y centering
+		RamWrite32A( CMD_RETURN_TO_CENTER , YAXS_SRV_ON ) ;
+	}else{											// Both off
+		RamWrite32A( CMD_RETURN_TO_CENTER , BOTH_SRV_OFF ) ;
+	}
+	
+	while( UcSndDat && (UlStCnt++ < CNT200MS )) {
+		UcSndDat = RdStatus(1);
+	}
+TRACE("RtnCen( cmd , status , cnt ) = %02x , %02x , %08x \n", UcCmdPar , UcSndDat , (int)UlStCnt ) ;
+	return( UcSndDat );
+}
+
+
+
+//********************************************************************************
+// Function Name 	: ZsvCnt
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Zero servo control Command Function
+// History			: First edition
+//********************************************************************************
+UINT8	ZscCnt( UINT8	UcCmdPar )
+{
+	UINT8	UcSndDat = 1 ;
+	UINT32	UlStCnt = 0;
+
+TRACE("ZscCnt(%02x) = ", UcCmdPar ) ;
+	if( !UcCmdPar ){								// Zero servo off
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_DISABLE ) ;
+	}else if( UcCmdPar == 1 ){						// Zero servo on
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_ENABLE ) ;
+	}else if( UcCmdPar == 3 ){						// Zero servo hold
+		RamWrite32A( CMD_ZSRV_MODE , ZSRV_HOLD ) ;
+	}else{
+		return( 2 );
+	}
+	
+	while( UcSndDat && (UlStCnt++ < CNT050MS )) {
+		UcSndDat = RdStatus(1);
+	}
+TRACE("ZscCnt( cmd , status , cnt ) = %02x , %02x , %08x \n", UcCmdPar , UcSndDat , (int)UlStCnt ) ;
+	
+	return( UcSndDat );
+}
+
+//********************************************************************************
+// Function Name 	: OisEna
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function
+// History			: First edition 						
+//********************************************************************************
+void	OisEna( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	UINT32	gyro_gain_x, gyro_gain_y ;
+	
+	RamRead32A( GyroFilterTableX_gxzoom, &gyro_gain_x ) ;
+	RamRead32A( GyroFilterTableY_gyzoom, &gyro_gain_y ) ;
+	RamWrite32A( GyroFilterTableX_gxzoom, gyro_gain_y ) ;
+	RamWrite32A( GyroFilterTableY_gyzoom, gyro_gain_x ) ;
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEna( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaNCL
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaNCL( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_NCL | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaNCL( Status , cnt ) = %02x %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaDrCl
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaDrCl( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_DOF | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaDrCl( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: OisEnaDrNcl
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Enable Control Function w/o delay clear
+// History			: First edition 						
+//********************************************************************************
+void	OisEnaDrNcl( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_ENA_DOF | OIS_ENA_NCL | OIS_ENABLE ) ;
+	while( UcStRd && (UlStCnt++ < CNT050MS )) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisEnaDrCl( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+//********************************************************************************
+// Function Name 	: OisDis
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: OIS Disable Control Function
+// History			: First edition 						
+//********************************************************************************
+void	OisDis( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_OIS_ENABLE , OIS_DISABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" OisDis( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SscEna
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Ssc Enable Control Function
+// History			: First edition
+//********************************************************************************
+void	SscEna( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+
+	RamWrite32A( CMD_SSC_ENABLE , SSC_ENABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SscEna( Status) = %02x\n", UcStRd ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SscDis
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Ssc Disable Control Function
+// History			: First edition
+//********************************************************************************
+void	SscDis( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+
+	RamWrite32A( CMD_SSC_ENABLE , SSC_DISABLE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SscDis( Status) = %02x\n", UcStRd ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetRec
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Rec Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetRec( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetRec( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetStill
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Set Still Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetStill( void )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE ) ;
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetStill( Status , cnt ) = %02x , %08x \n", UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetRecPreview
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Rec Preview Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetRecPreview( UINT8 mode )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch( mode ){
+	case 0:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE ) ;
+		break;
+	case 1:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE1 ) ;
+		break;
+	case 2:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE2 ) ;
+		break;
+	case 3:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	MOVIE_MODE3 ) ;
+		break;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetRec( %02x )( status , cnt ) = %02x , %08x , \n", mode , UcStRd ,(int)UlStCnt ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: SetStillPreview
+// Retun Value		: NON
+// Argment Value	: Command Parameter
+// Explanation		: Set Still Preview Mode Enable Function
+// History			: First edition 						
+//********************************************************************************
+void	SetStillPreview( unsigned char mode )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch( mode ){
+	case 0:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE ) ;
+		break;
+	case 1:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE1 ) ;
+		break;
+	case 2:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE2 ) ;
+		break;
+	case 3:
+		RamWrite32A( CMD_MOVE_STILL_MODE ,	STILL_MODE3 ) ;
+		break;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" SetStill( %02x )( status , cnt ) = %02x , %08x \n", mode , UcStRd , (int)UlStCnt ) ;
+}
+
+//********************************************************************************
+// Function Name 	: SetPanTiltMode
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Pan-Tilt Enable/Disable
+// History			: First edition 						
+//********************************************************************************
+void	SetPanTiltMode( UINT8 UcPnTmod )
+{
+	UINT8	UcStRd = 1;
+	UINT32	UlStCnt = 0;
+	
+	switch ( UcPnTmod ) {
+		case OFF :
+			RamWrite32A( CMD_PAN_TILT ,	PAN_TILT_OFF ) ;
+//TRACE(" PanTilt OFF\n");
+			break ;
+		case ON :
+			RamWrite32A( CMD_PAN_TILT ,	PAN_TILT_ON ) ;
+//TRACE(" PanTilt ON\n");
+			break ;
+	}
+	while( UcStRd && ( UlStCnt++ < CNT050MS)) {
+		UcStRd = RdStatus(1);
+	}
+TRACE(" PanTilt( Status , mode , cnt ) = %02x , %02x , %08x \n", UcStRd , UcPnTmod , (int)UlStCnt ) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: AfStbyRls
+// Retun Value		: Command Status
+// Argment Value	: Command Parameter
+// Explanation		: Af Standby release Command Function
+// History			: First edition
+//********************************************************************************
+UINT8	AfStbyRls( void )
+{
+
+TRACE("AfStbyRls \n" ) ;
+	DMIOWrite32( SYSDSP_STBOTH, 0x00000C00 );	
+	
+	return( SUCCESS );
+}
+
+//********************************************************************************
+// Function Name 	: RdStatus
+// Retun Value		: 0:success 1:FAILURE
+// Argment Value	: bit check  0:ALL  1:bit24
+// Explanation		: High level status check Function
+// History			: First edition 						
+//********************************************************************************
+UINT8	RdStatus( UINT8 UcStBitChk )
+{
+	UINT32	UlReadVal ;
+	
+	RamRead32A( CMD_READ_STATUS , &UlReadVal );
+//TRACE(" (Rd St) = %08x\n", (unsigned INT16)UlReadVal ) ;
+	if( UcStBitChk ){
+		UlReadVal &= READ_STATUS_INI ;
+	}
+	if( !UlReadVal ){
+		return( SUCCESS );
+	}else{
+		return( FAILURE );
+	}
+}
+
+
+//********************************************************************************
+// Function Name 	: SetSinWavGenInt
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Sine wave generator initial Function
+// History			: First edition 						
+//********************************************************************************
+void	SetSinWavGenInt( void )
+{
+	
+	RamWrite32A( SinWave_Offset		,	0x00000000 ) ;		// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+	RamWrite32A( SinWave_Phase		,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+	RamWrite32A( SinWave_Gain		,	0x00000000 ) ;		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚Í0[dB])
+//	RamWrite32A( SinWave_Gain		,	0x7FFFFFFF ) ;		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚ÍCut)
+//	SetTransDataAdr( SinWave_OutAddr	,	(UINT32)SinWave_Output ) ;		// �‰Šú’l‚Ì�o—Í�æƒAƒhƒŒƒX‚Í�AŽ©•ª‚̃�ƒ“ƒo
+
+	RamWrite32A( CosWave_Offset		,	0x00000000 );		// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+	RamWrite32A( CosWave_Phase 		,	0x00000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	RamWrite32A( CosWave_Gain 		,	0x00000000 );		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚ÍCut)
+//	RamWrite32A( CosWave_Gain 		,	0x7FFFFFFF );		// ”­�¶Žü”g�”‚̃Aƒbƒeƒl�[ƒ^(�‰Šú’l‚Í0[dB])
+//	SetTransDataAdr( CosWave_OutAddr	,	(UINT32)CosWave_Output );		// �‰Šú’l‚Ì�o—Í�æƒAƒhƒŒƒX‚Í�AŽ©•ª‚̃�ƒ“ƒo
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+}
+
+
+//********************************************************************************
+// Function Name 	: TstActMov
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Hall Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+// #define		ACT_CHK_LVL		0x33320000		// 0.4
+ #define		ACT_CHK_FRQ		0x00074528		// 4Hz
+ #define		ACT_CHK_NUM		4507			// 18.0288/0.004 
+ #define		ACT_THR			0x000003E8		// 20dB 10*100
+ #define		ACT_MARGIN		0.75f			// 
+ 
+UINT8	TstActMov( UINT8 UcDirSel )
+{
+	UINT8	UcRsltSts = 0;
+	INT32	SlMeasureParameterNum ;
+	INT32	SlMeasureParameterA , SlMeasureParameterB ;
+	UnllnVal	StMeasValueA  , StMeasValueB ;
+	float		SfLimit , Sfzoom , Sflenz , Sfshift ;
+	UINT32		UlLimit , Ulzoom , Ullenz , Ulshift , UlActChkLvl ;
+	UINT8		i;
+	UINT32		UlReturnVal;
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		RamRead32A( Gyro_Limiter_X 			, ( UINT32 * )&UlLimit ) ;	// 
+		RamRead32A( GyroFilterTableX_gxzoom , ( UINT32 * )&Ulzoom ) ;	// 
+		RamRead32A( GyroFilterTableX_gxlenz , ( UINT32 * )&Ullenz ) ;	// 
+		RamRead32A( Gyro_ShiftX_RG 			, ( UINT32 * )&Ulshift ) ;	// 
+	}else{
+		RamRead32A( Gyro_Limiter_Y 			, ( UINT32 * )&UlLimit ) ;	// 
+		RamRead32A( GyroFilterTableY_gyzoom , ( UINT32 * )&Ulzoom ) ;	// 
+		RamRead32A( GyroFilterTableY_gylenz , ( UINT32 * )&Ullenz ) ;	// 
+		RamRead32A( Gyro_ShiftY_RG 			, ( UINT32 * )&Ulshift ) ;	// 
+	}
+
+TRACE(" DIR = %d, lmt = %08x, zom = %08x , lnz = %08x ,sft = %08x \n", UcDirSel, (unsigned int)UlLimit , (unsigned int)Ulzoom , (unsigned int)Ullenz , (unsigned int)Ulshift  ) ;
+
+	SfLimit = (float)UlLimit / (float)0x7FFFFFFF;
+	if( Ulzoom == 0){
+		Sfzoom = 0;
+	}else{
+		Sfzoom = (float)abs(Ulzoom) / (float)0x7FFFFFFF;
+	}
+	if( Ullenz == 0){
+		Sflenz = 0;
+	}else{
+		Sflenz = (float)Ullenz / (float)0x7FFFFFFF;
+	}
+	Ulshift = ( Ulshift & 0x0000FF00) >> 8 ;	// 2X4XB
+	Sfshift = 1;
+	for( i = 0 ; i < Ulshift ; i++ ){
+		Sfshift *= 2;
+	}
+	UlActChkLvl = (UINT32)( (float)0x7FFFFFFF * SfLimit * Sfzoom * Sflenz * Sfshift * ACT_MARGIN );
+//TRACE(" lvl = %08x \n", (unsigned int)UlActChkLvl  ) ;
+
+	SlMeasureParameterNum	=	ACT_CHK_NUM ;
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXOUT0 ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HXDAZ1 ;		// Set Measure RAM Address
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYOUT0 ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HYDAZ1 ;		// Set Measure RAM Address
+	}
+	SetSinWavGenInt();
+	
+	RamWrite32A( SinWave_Offset		,	ACT_CHK_FRQ ) ;				// Freq Setting = Freq * 80000000h / Fs	: 5Hz
+	RamWrite32A( SinWave_Gain		,	UlActChkLvl ) ;				// Set Sine Wave Gain
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;				// Sine Wave Start
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;	// Set Sine Wave Input RAM
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;	// Set Sine Wave Input RAM
+	}
+	MesFil( NOISE ) ;					// ‘ª’è—pƒtƒBƒ‹ƒ^�[‚ð�Ý’è‚·‚é�B
+
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+
+	UlReturnVal = (INT32)((INT64)StMeasValueA.UllnValue * 100 / (INT64)StMeasValueB.UllnValue  ) ;
+
+
+TRACE(" Ret = %d \n", (unsigned int)UlReturnVal ) ;
+
+	
+	UcRsltSts = EXE_END ;
+	if( UlReturnVal < ACT_THR ){
+		if ( !UcDirSel ) {					// AXIS X
+			UcRsltSts = EXE_HXMVER ;
+		}else{								// AXIS Y
+			UcRsltSts = EXE_HYMVER ;
+		}
+	}
+
+	return( UcRsltSts ) ;
+
+}
+//********************************************************************************
+// Function Name 	: RunHea
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Hall Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+UINT8	RunHea( void )
+{
+	UINT8 	UcRst ;
+	UcRst = EXE_END ;
+	UcRst |= TstActMov( X_DIR) ;
+	UcRst |= TstActMov( Y_DIR) ;
+	
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	return( UcRst ) ;
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: RunGea
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+#define 	GEA_NUM		512			// 512times
+// #define		GEA_DIF_HIG		0x0062			// 2021_32.8lsb/�‹/s    max 3.0�‹/s-p-p
+ #define		GEA_DIF_HIG		0x0057			// 2030_87.5lsb/�‹/s    max 1.0�‹/s-p-p
+ #define		GEA_DIF_LOW		0x0001				// Gyro Examination of Acceptance
+ 
+UINT8	RunGea( void )
+{
+	UnllnVal	StMeasValueA , StMeasValueB ;
+	INT32		SlMeasureParameterA , SlMeasureParameterB ;
+	UINT8 		UcRst, UcCnt, UcXLowCnt, UcYLowCnt, UcXHigCnt, UcYHigCnt ;
+	UINT16		UsGxoVal[10], UsGyoVal[10], UsDif;
+	INT32		SlMeasureParameterNum , SlMeasureAveValueA , SlMeasureAveValueB ;
+
+	
+	UcRst = EXE_END ;
+	UcXLowCnt = UcYLowCnt = UcXHigCnt = UcYHigCnt = 0 ;
+	
+	MesFil( THROUGH ) ;				// ‘ª’è—pƒtƒBƒ‹ƒ^�[‚ð�Ý’è‚·‚é�B
+	
+	for( UcCnt = 0 ; UcCnt < 10 ; UcCnt++ )
+	{
+		//•½‹Ï’l‘ª’è
+	
+		MesFil( THROUGH ) ;					// Set Measure Filter
+
+		SlMeasureParameterNum	=	GEA_NUM ;					// Measurement times
+		SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+		
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+		MeasureWait() ;					// Wait complete of measurement
+	
+//TRACE("Read Adr = %04x, %04xh \n",StMeasFunc_MFA_LLiIntegral1 + 4 , StMeasFunc_MFA_LLiIntegral1) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+//TRACE("GX_OFT = %08x, %08xh \n",(unsigned int)StMeasValueA.StUllnVal.UlHigVal,(unsigned int)StMeasValueA.StUllnVal.UlLowVal) ;
+//TRACE("GY_OFT = %08x, %08xh \n",(unsigned int)StMeasValueB.StUllnVal.UlHigVal,(unsigned int)StMeasValueB.StUllnVal.UlLowVal) ;
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+//TRACE("GX_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+//TRACE("GY_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+		// X
+		UsGxoVal[UcCnt] = (UINT16)( SlMeasureAveValueA >> 16 );	// •½‹Ï’l‘ª’è
+		
+		// Y
+		UsGyoVal[UcCnt] = (UINT16)( SlMeasureAveValueB >> 16 );	// •½‹Ï’l‘ª’è
+		
+//TRACE("UcCnt = %02x, UsGxoVal[UcCnt] = %04x\n", UcCnt, UsGxoVal[UcCnt] ) ;
+//TRACE("UcCnt = %02x, UsGyoVal[UcCnt] = %04x\n", UcCnt, UsGyoVal[UcCnt] ) ;
+		
+		
+		if( UcCnt > 0 )
+		{
+			if ( (INT16)UsGxoVal[0] > (INT16)UsGxoVal[UcCnt] ) {
+				UsDif = (UINT16)((INT16)UsGxoVal[0] - (INT16)UsGxoVal[UcCnt]) ;
+			} else {
+				UsDif = (UINT16)((INT16)UsGxoVal[UcCnt] - (INT16)UsGxoVal[0]) ;
+			}
+			
+			if( UsDif > GEA_DIF_HIG ) {
+				//UcRst = UcRst | EXE_GXABOVE ;
+				UcXHigCnt ++ ;
+			}
+			if( UsDif < GEA_DIF_LOW ) {
+				//UcRst = UcRst | EXE_GXBELOW ;
+				UcXLowCnt ++ ;
+			}
+//TRACE("CNT = %02x  ,  X diff = %04x ", UcCnt , UsDif ) ;
+			
+			if ( (INT16)UsGyoVal[0] > (INT16)UsGyoVal[UcCnt] ) {
+				UsDif = (UINT16)((INT16)UsGyoVal[0] - (INT16)UsGyoVal[UcCnt]) ;
+			} else {
+				UsDif = (UINT16)((INT16)UsGyoVal[UcCnt] - (INT16)UsGyoVal[0]) ;
+			}
+			
+			if( UsDif > GEA_DIF_HIG ) {
+				//UcRst = UcRst | EXE_GYABOVE ;
+				UcYHigCnt ++ ;
+			}
+			if( UsDif < GEA_DIF_LOW ) {
+				//UcRst = UcRst | EXE_GYBELOW ;
+				UcYLowCnt ++ ;
+			}
+//TRACE("  Y diff = %04x \n", UsDif ) ;
+		}
+	}
+	
+	if( UcXHigCnt >= 1 ) {
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( UcXLowCnt > 8 ) {
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	
+	if( UcYHigCnt >= 1 ) {
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+	if( UcYLowCnt > 8 ) {
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	
+	return( UcRst ) ;
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: GetGyroWhoAmI
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Get Gyro Who Am I
+// History			: First edition 						
+//********************************************************************************
+void GetGyroWhoAmI( UINT8 * UcWho )
+{
+	UINT32	UlVal ;
+	
+	RamWrite32A( 0xF01D , 0x75000000 ) ;
+	WitTim( 5 ) ;
+	
+	RamRead32A( 0xF01D , &UlVal ) ;
+//TRACE("%08x \n", UlVal );
+	
+	*UcWho = (UINT8)( UlVal >> 24 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: GetGyroID
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Get Gyro ID
+// History			: First edition 						
+//********************************************************************************
+void GetGyroID( UINT8 * UcGid )
+{
+	UINT32	UlCnt;
+	UINT32	UlVal;
+	
+	for( UlCnt = 0; UlCnt < 8; UlCnt++ ){
+		RamWrite32A( 0xF01E, 0x6D000000 ) ;
+		WitTim( 5 ) ;
+		
+		RamWrite32A( 0xF01E, ( 0x6E000000 | ( UlCnt << 16 ) ) ) ;
+		WitTim( 5 ) ;
+		
+		RamWrite32A( 0xF01D, 0x6F000000 ) ;
+		WitTim( 5 ) ;
+		
+		RamRead32A( 0xF01D, &UlVal ) ;
+//TRACE("%08x \n", UlVal );
+		
+		WitTim( 5 ) ;
+		UcGid[UlCnt] = (UINT8)( UlVal >> 24 ) ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: GyroSleep
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Sleep Control
+// History			: First edition 						
+//********************************************************************************
+void GyroSleep( UINT8 UcCtrl )
+{
+	UINT8	UcReg;
+	UINT32	UlVal;
+	
+	RamWrite32A( 0xF01D, 0x6B000000 ) ;
+	WitTim( 5 ) ;
+	
+	RamRead32A( 0xF01D, &UlVal ) ;
+	WitTim( 5 ) ;
+	
+	UcReg = (UINT8)( UlVal >> 24 ) ;
+	
+	if( UcCtrl == ON ){
+		UcReg = UcReg | 0x40;	// Bit6(SLEEP) ON
+	}
+	else if( UcCtrl == OFF ){
+		UcReg = UcReg & 0xBF;	// Bit6(SLEEP) OFF
+	}
+	
+	RamWrite32A( 0xF01E, ( 0x6B000000 | ( UcReg << 16 ) ) ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MesRam
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure 
+// History			: First edition 						2015.07.06 
+//********************************************************************************
+UINT8	 MesRam( INT32 SlMeasureParameterA, INT32 SlMeasureParameterB, INT32 SlMeasureParameterNum, stMesRam* pStMesRamA, stMesRam* pStMesRamB )
+{
+	UnllnVal	StMeasValueA , StMeasValueB ;
+	
+	MesFil( THROUGH ) ;							// Set Measure Filter
+	
+	MeasureStart( SlMeasureParameterNum,  SlMeasureParameterA, SlMeasureParameterB	) ;		// Start measure
+	
+	MeasureWait() ;								// Wait complete of measurement
+	
+	// A : X axis
+	RamRead32A( StMeasFunc_MFA_SiMax1 , &(pStMesRamA->SlMeasureMaxValue) ) ;			// Max value
+	RamRead32A( StMeasFunc_MFA_SiMin1 , &(pStMesRamA->SlMeasureMinValue) ) ;			// Min value
+	RamRead32A( StMeasFunc_MFA_UiAmp1 , &(pStMesRamA->SlMeasureAmpValue) ) ;			// Amp value
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1,	 &(StMeasValueA.StUllnVal.UlLowVal) ) ;	// Integration Low
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &(StMeasValueA.StUllnVal.UlHigVal) ) ;	// Integration Hig
+	pStMesRamA->SlMeasureAveValue = 
+				(INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;	// Ave value
+	
+	// B : Y axis
+	RamRead32A( StMeasFunc_MFB_SiMax2 , &(pStMesRamB->SlMeasureMaxValue) ) ;			// Max value
+	RamRead32A( StMeasFunc_MFB_SiMin2 , &(pStMesRamB->SlMeasureMinValue) ) ;			// Min value
+	RamRead32A( StMeasFunc_MFB_UiAmp2 , &(pStMesRamB->SlMeasureAmpValue) ) ;			// Amp value
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2,	 &(StMeasValueB.StUllnVal.UlLowVal) ) ;	// Integration Low
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &(StMeasValueB.StUllnVal.UlHigVal) ) ;	// Integration Hig
+	pStMesRamB->SlMeasureAveValue = 
+				(INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;	// Ave value
+	
+	return( 0 );
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: RunGea2
+// Retun Value		: Result
+// Argment Value	: NON
+// Explanation		: Gyro Examination of Acceptance
+// History			: First edition 						
+//********************************************************************************
+#define 	GEA_NUM2		2048			// 2048times
+// level of judgement
+#define		GEA_MAX_LVL		0x0A41			// 2030_87.5lsb/�‹/s    max 30�‹/s-p-p
+#define		GEA_MIN_LVL		0x1482			// 2030_87.5lsb/�‹/s    min 60�‹/s-p-p
+UINT8	RunGea2( UINT8 UcMode )
+{
+	INT32	SlMeasureParameterA , SlMeasureParameterB ;
+	UINT8 	UcRst ;
+	UINT16	UsGyrXval , UsGyrYval;
+	INT32	SlMeasureParameterNum ;
+	UINT8	UcStRd;
+	UINT32	UlSwRd , UlGyroConfig ; //, UlGyCnt;
+	
+	stMesRam 		StMesRamA ;
+	stMesRam 		StMesRamB ;
+	
+	UcRst = EXE_END ;
+	
+	OisDis() ;
+	
+	RamRead32A( GYRO_RAM_GYRO_Switch , &UlSwRd);
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlSwRd & 0xFFFFFFFC ) ;
+	
+	RamWrite32A( CMD_GYRO_RD_ACCS , 0x1B000000 );
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	RamRead32A( CMD_GYRO_RD_ACCS , &UlGyroConfig );		/* FS_SEL backup */
+//TRACE("GYCONFIG = %08x \n",(UINT32)UlGyroConfig ) ;
+
+////////// ////////// ////////// ////////// //////////
+
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1B180000 );		/* FS_SEL=3΁Տ & Disable Self Test */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+	SlMeasureParameterNum	=	GEA_NUM2 ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+	
+	MesRam( SlMeasureParameterA, SlMeasureParameterB, SlMeasureParameterNum, &StMesRamA, &StMesRamB );
+	
+	if( UcMode == GEA_MINMAX_MODE ){	// min, max mode
+		
+//TRACE("GX [max] = %08x, [min] = %08xh \n", (unsigned int)StMesRamA.SlMeasureMaxValue, (unsigned int)StMesRamA.SlMeasureMinValue) ;
+//TRACE("GY [max] = %08x, [min] = %08xh \n", (unsigned int)StMesRamB.SlMeasureMaxValue, (unsigned int)StMesRamB.SlMeasureMinValue) ;
+
+//TRACE("ABS_GX [max] = %08x, [min] = %08xh \n", (unsigned int)abs(StMesRamA.SlMeasureMaxValue), (unsigned int)abs(StMesRamA.SlMeasureMinValue)) ;
+//TRACE("ABS_GY [max] = %08x, [min] = %08xh \n", (unsigned int)abs(StMesRamB.SlMeasureMaxValue), (unsigned int)abs(StMesRamB.SlMeasureMinValue)) ;
+		
+		// X
+		if( abs(StMesRamA.SlMeasureMaxValue) >= abs(StMesRamA.SlMeasureMinValue) ) {
+			UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureMaxValue) >> 16 );		// max value
+		}
+		else{
+			UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureMinValue) >> 16 );		// max value
+		}
+		
+		// Y
+		if( abs(StMesRamB.SlMeasureMaxValue) >= abs(StMesRamB.SlMeasureMinValue) ) {
+			UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureMaxValue) >> 16 );		// max value
+		}
+		else{
+			UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureMinValue) >> 16 );		// max value
+		}
+		
+	}
+	else{								// mean mode
+		
+//TRACE("GX [ave] = %08xh \n", (UINT32)StMesRamA.SlMeasureAveValue) ;
+//TRACE("GY [ave] = %08xh \n", (UINT32)StMesRamB.SlMeasureAveValue) ;
+		
+//TRACE("ABS_GX [ave] = %08xh \n", (UINT32)abs(StMesRamA.SlMeasureAveValue)) ;
+//TRACE("ABS_GY [ave] = %08xh \n", (UINT32)abs(StMesRamB.SlMeasureAveValue)) ;
+		
+		// X
+		UsGyrXval = (UINT16)( abs(StMesRamA.SlMeasureAveValue) >> 16 );		// ave value
+		
+		// Y
+		UsGyrYval = (UINT16)( abs(StMesRamB.SlMeasureAveValue) >> 16 );		// ave value
+		
+	}
+		
+//TRACE("UsGyrXval = %04x\n", UsGyrXval ) ;
+//TRACE("UsGyrYval = %04x\n", UsGyrYval ) ;
+		
+	if( UsGyrXval > GEA_MAX_LVL ) {
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( UsGyrYval > GEA_MAX_LVL ) {
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+	
+	if( StMesRamA.SlMeasureMinValue == StMesRamA.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GXABOVE ;
+	}
+	if( StMesRamB.SlMeasureMinValue == StMesRamB.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GYABOVE ;
+	}
+
+////////// ////////// ////////// ////////// //////////
+
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1BD80000 );		/* FS_SEL=3΁Տ & Enable Self Test */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+	WitTim( 50 ) ;					/* 50ms*/
+	
+	SlMeasureParameterNum	=	GEA_NUM2 ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+
+	MesRam( SlMeasureParameterA, SlMeasureParameterB, SlMeasureParameterNum, &StMesRamA, &StMesRamB );
+
+	if( UcMode == GEA_MINMAX_MODE ){	// min, max mode
+
+//TRACE("GX [max] = %08x, [min] = %08xh \n", (UINT32)StMesRamA.SlMeasureMaxValue, (UINT32)StMesRamA.SlMeasureMinValue) ;
+//TRACE("GY [max] = %08x, [min] = %08xh \n", (UINT32)StMesRamB.SlMeasureMaxValue, (UINT32)StMesRamB.SlMeasureMinValue) ;
+
+		// X
+		UsGyrXval = (UINT16)( StMesRamA.SlMeasureMinValue >> 16 );		// min value
+		
+		// Y
+		UsGyrYval = (UINT16)( StMesRamB.SlMeasureMinValue >> 16 );		// min value
+	
+	}
+	else{								// mean mode
+//TRACE("GX [ave] = %08xh \n", (UINT32)StMesRamA.SlMeasureAveValue) ;
+//TRACE("GY [ave] = %08xh \n", (UINT32)StMesRamB.SlMeasureAveValue) ;
+		
+		// X
+		UsGyrXval = (UINT16)( StMesRamA.SlMeasureAveValue >> 16 );		// ave value
+		
+		// Y
+		UsGyrYval = (UINT16)( StMesRamB.SlMeasureAveValue >> 16 );		// ave value
+		
+	}
+	
+//TRACE("UsGyrXval = %04x\n", UsGyrXval ) ;
+//TRACE("UsGyrYval = %04x\n", UsGyrYval ) ;
+	
+	if( UsGyrXval < GEA_MIN_LVL ) {
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	if( UsGyrYval < GEA_MIN_LVL ) {
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+	if( StMesRamA.SlMeasureMinValue == StMesRamA.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GXBELOW ;
+	}
+	if( StMesRamB.SlMeasureMinValue == StMesRamB.SlMeasureMaxValue ){
+		UcRst = UcRst | EXE_GYBELOW ;
+	}
+	
+	RamWrite32A( CMD_GYRO_WR_ACCS , 0x1B000000 | ( UlGyroConfig >> 8));		/* Œ³‚Ì�Ý’è’l‚É–ß‚· */
+	UcStRd = 1;
+	while( UcStRd ) {
+		UcStRd = RdStatus(1);
+	}
+	
+//TRACE("GYCONFIG = %08x \n",(UINT32)(0x1B000000 | ( UlGyroConfig >> 8)) ) ;
+	
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlSwRd | 0x00000001 ) ;
+//TRACE("UcRst = %02x\n", UcRst ) ;
+	
+	return( UcRst ) ;
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+
+//********************************************************************************
+// Function Name 	: SetAngleCorrection
+// Retun Value		: True/Fail
+// Argment Value	: 
+// Explanation		: Angle Correction
+// History			: First edition
+//********************************************************************************
+/*  bit7  	HX GYR			Hall X  ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªGX?               0:GX  1:GY  */
+/*  bit6  	HX GYR pol		Hall X+ ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªX+‚ÆG+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit5  	HY GYR pol		Hall Y+ ‚Æ“¯•ûŒü‚ÌGyro�M�†‚ªY+‚ÆG+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit4  	GZ pol			Šî–{‹É�«‚ɑ΂µ‚ÄGyroZ�M�†‚ª“¯•ûŒü?            0:NEG 1:POS */
+/*  bit3  	HX ACL			Hall X  ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªAX?               0:AX  1:AY  */
+/*  bit2  	HX ACL pol		Hall X+ ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªX+‚ÆA+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit1  	HY ACL pol		Hall Y+ ‚Æ“¯•ûŒü‚ÌAccl�M�†‚ªY+‚ÆA+‚Å“¯•ûŒü?   0:NEG 1:POS */
+/*  bit0  	AZ pol			Šî–{‹É�«‚ɑ΂µ‚ÄAcclZ�M�†‚ª“¯•ûŒü?            0:NEG 1:POS */
+                      //   top0�‹btm0�‹//
+const UINT8 PACT0Tbl[] = { 0xFF, 0xFF };	/* Dummy table */
+const UINT8 PACT1Tbl[] = { 0x20, 0xDF };	
+const UINT8 PACT2Tbl[] = { 0x26, 0xD9 };	/* ACT_45DEG */
+
+
+UINT8 SetAngleCorrection( float DegreeGap, UINT8 SelectAct, UINT8 Arrangement )
+{
+	double OffsetAngle = 0.0f;
+	INT32 Slgx45x = 0, Slgx45y = 0;
+	INT32 Slgy45y = 0, Slgy45x = 0;
+	
+//	INT32 Slgx45m = 0, Slgx45s = 0;
+//	INT32 Slgy45m = 0, Slgy45s = 0;
+	UINT8	UcCnvF = 0;
+
+	if( ( DegreeGap > 180.0f) || ( DegreeGap < -180.0f ) ) return ( 1 );
+	if( Arrangement >= 2 ) return ( 1 );
+
+/************************************************************************/
+/*      	Gyro angle correction										*/
+/************************************************************************/
+	switch(SelectAct) {
+		case ACT_45DEG :
+			OffsetAngle = (double)( 45.0f + DegreeGap ) * 3.141592653589793238 / 180.0f ;
+			UcCnvF = PACT2Tbl[ Arrangement ];
+			break;
+		case ACT_SO2820 :
+		case ACT_SO3600 :
+			OffsetAngle = (double)( DegreeGap ) * 3.141592653589793238 / 180.0f ;
+			UcCnvF = PACT1Tbl[ Arrangement ];
+			break;
+		default :
+			break;
+	}
+	
+	SetGyroCoef( UcCnvF );
+	SetAccelCoef( UcCnvF );
+
+	//***********************************************//
+	// Gyro & Accel rotation correction
+	// Zero Servo angle correction
+	//***********************************************//
+	Slgx45x = (INT32)( cos( OffsetAngle )*2147483647.0);
+	Slgx45y = (INT32)(-sin( OffsetAngle )*2147483647.0);
+	Slgy45y = (INT32)( cos( OffsetAngle )*2147483647.0);
+	Slgy45x = (INT32)( sin( OffsetAngle )*2147483647.0);
+	
+	RamWrite32A( GyroFilterTableX_gx45x , 			(UINT32)Slgx45x );
+	RamWrite32A( GyroFilterTableX_gx45y , 			(UINT32)Slgx45y );
+	RamWrite32A( GyroFilterTableY_gy45y , 			(UINT32)Slgy45y );
+	RamWrite32A( GyroFilterTableY_gy45x , 			(UINT32)Slgy45x );
+#ifdef ACCEL_SERVO
+	RamWrite32A( Accl45Filter_XAmain , 				(UINT32)Slgx45x );
+	RamWrite32A( Accl45Filter_XAsub  , 				(UINT32)Slgx45y );
+	RamWrite32A( Accl45Filter_YAmain , 				(UINT32)Slgy45y );
+	RamWrite32A( Accl45Filter_YAsub  , 				(UINT32)Slgy45x );
+#endif
+	
+#ifdef ZERO_SERVO
+	RamWrite32A( ZeroServoFilterTableX_g45main 	, 	(UINT32)Slgx45x );
+	RamWrite32A( ZeroServoFilterTableX_g45sub 	, 	(UINT32)Slgx45y );
+	RamWrite32A( ZeroServoFilterTableY_g45main 	, 	(UINT32)Slgy45y );
+	RamWrite32A( ZeroServoFilterTableY_g45sub 	, 	(UINT32)Slgy45x );
+#endif
+	
+	return ( 0 );
+}
+
+void	SetGyroCoef( UINT8 UcCnvF )
+{
+	INT32 Slgxx = 0, Slgxy = 0;
+	INT32 Slgyy = 0, Slgyx = 0;
+	INT32 Slgzp = 0;
+	/************************************************/
+	/*  signal convet								*/
+	/************************************************/
+	switch( UcCnvF & 0xE0 ){
+		/* HX <== GX , HY <== GY */
+	case 0x00:
+		Slgxx = 0x7FFFFFFF ;	Slgxy = 0x00000000 ;	Slgyy = 0x7FFFFFFF ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(NEG), HY<==GY(NEG)
+	case 0x20:
+		Slgxx = 0x7FFFFFFF ;	Slgxy = 0x00000000 ;	Slgyy = 0x80000001 ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(NEG), HY<==GY(POS)
+	case 0x40:
+		Slgxx = 0x80000001 ;	Slgxy = 0x00000000 ;	Slgyy = 0x7FFFFFFF ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(POS), HY<==GY(NEG)
+	case 0x60:
+		Slgxx = 0x80000001 ;	Slgxy = 0x00000000 ;	Slgyy = 0x80000001 ;	Slgyx = 0x00000000 ;	break;	//HX<==GX(POS), HY<==GY(POS)
+		/* HX <== GY , HY <== GX */
+	case 0x80:
+		Slgxx = 0x00000000 ;	Slgxy = 0x7FFFFFFF ;	Slgyy = 0x00000000 ;	Slgyx = 0x7FFFFFFF ;	break;	//HX<==GY(NEG), HY<==GX(NEG)
+	case 0xA0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x7FFFFFFF ;	Slgyy = 0x00000000 ;	Slgyx = 0x80000001 ;	break;	//HX<==GY(NEG), HY<==GX(POS)
+	case 0xC0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x80000001 ;	Slgyy = 0x00000000 ;	Slgyx = 0x7FFFFFFF ;	break;	//HX<==GY(POS), HY<==GX(NEG)
+	case 0xE0:
+		Slgxx = 0x00000000 ;	Slgxy = 0x80000001 ;	Slgyy = 0x00000000 ;	Slgyx = 0x80000001 ;	break;	//HX<==GY(NEG), HY<==GX(NEG)
+	}
+	switch( UcCnvF & 0x10 ){
+	case 0x00:
+		Slgzp = 0x7FFFFFFF ;	break;																			//GZ(POS)
+	case 0x10:
+		Slgzp = 0x80000001 ;	break;																			//GZ(NEG)
+	}
+	RamWrite32A( GCNV_XX , (UINT32)Slgxx );
+	RamWrite32A( GCNV_XY , (UINT32)Slgxy );
+	RamWrite32A( GCNV_YY , (UINT32)Slgyy );
+	RamWrite32A( GCNV_YX , (UINT32)Slgyx );
+	RamWrite32A( GCNV_ZP , (UINT32)Slgzp );
+}
+
+void	SetAccelCoef( UINT8 UcCnvF )
+{
+	INT32 Slaxx = 0, Slaxy = 0;
+	INT32 Slayy = 0, Slayx = 0;
+	INT32 Slazp = 0;
+	
+	switch( UcCnvF & 0x0E ){
+		/* HX <== AX , HY <== AY */
+	case 0x00:
+		Slaxx = 0x7FFFFFFF ;	Slaxy = 0x00000000 ;	Slayy = 0x7FFFFFFF ;	Slayx = 0x00000000 ;	break;	//HX<==AX(NEG), HY<==AY(NEG)
+	case 0x02:
+		Slaxx = 0x7FFFFFFF ;	Slaxy = 0x00000000 ;	Slayy = 0x80000001 ;	Slayx = 0x00000000 ;	break;	//HX<==AX(NEG), HY<==AY(POS)
+	case 0x04:
+		Slaxx = 0x80000001 ;	Slaxy = 0x00000000 ;	Slayy = 0x7FFFFFFF ;	Slayx = 0x00000000 ;	break;	//HX<==AX(POS), HY<==AY(NEG)
+	case 0x06:
+		Slaxx = 0x80000001 ;	Slaxy = 0x00000000 ;	Slayy = 0x80000001 ;	Slayx = 0x00000000 ;	break;	//HX<==AX(POS), HY<==AY(POS)
+		/* HX <== AY , HY <== AX */
+	case 0x08:
+		Slaxx = 0x00000000 ;	Slaxy = 0x7FFFFFFF ;	Slayy = 0x00000000 ;	Slayx = 0x7FFFFFFF ;	break;	//HX<==AY(NEG), HY<==AX(NEG)
+	case 0x0A:
+		Slaxx = 0x00000000 ;	Slaxy = 0x7FFFFFFF ;	Slayy = 0x00000000 ;	Slayx = 0x80000001 ;	break;	//HX<==AY(NEG), HY<==AX(POS)
+	case 0x0C:
+		Slaxx = 0x00000000 ;	Slaxy = 0x80000001 ;	Slayy = 0x00000000 ;	Slayx = 0x7FFFFFFF ;	break;	//HX<==AY(POS), HY<==AX(NEG)
+	case 0x0E:
+		Slaxx = 0x00000000 ;	Slaxy = 0x80000001 ;	Slayy = 0x00000000 ;	Slayx = 0x80000001 ;	break;	//HX<==AY(NEG), HY<==AX(NEG)
+	}
+	switch( UcCnvF & 0x01 ){
+	case 0x00:
+		Slazp = 0x7FFFFFFF ;	break;																			//AZ(POS)
+	case 0x01:
+		Slazp = 0x80000001 ;	break;																			//AZ(NEG)
+	}
+	RamWrite32A( ACNV_XX , (UINT32)Slaxx );
+	RamWrite32A( ACNV_XY , (UINT32)Slaxy );
+	RamWrite32A( ACNV_YY , (UINT32)Slayy );
+	RamWrite32A( ACNV_YX , (UINT32)Slayx );
+	RamWrite32A( ACNV_ZP , (UINT32)Slazp );
+}
+
+//********************************************************************************
+// Function Name 	: SetGyroAccelCoef
+// Retun Value		: non
+// Argment Value	: 
+// Explanation		: Set Gyro Coef and Accel Coef
+// History			: First edition
+//********************************************************************************
+void SetGyroAccelCoef( UINT8 SelectAct ){
+	switch(SelectAct) {
+#ifndef UP_SIDE_GYRO
+		case ACT_SO2820 :
+			RamWrite32A( GCNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_XY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( GCNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( GCNV_ZP , (UINT32)0x7FFFFFFF );
+			
+			RamWrite32A( ACNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_XY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+			break;
+		case ACT_SO3600 :
+			RamWrite32A( GCNV_XX , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YY , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_ZP , (UINT32)0x7FFFFFFF );
+
+			RamWrite32A( ACNV_XX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YY , (UINT32)0x80000001 );
+			RamWrite32A( ACNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+		break;
+#else
+ #if USE_BOSCH
+		case ACT_SO2820 :
+			RamWrite32A( GCNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_XY , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( GCNV_ZP , (UINT32)0x80000001 );
+			
+			RamWrite32A( ACNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_XY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+			break;
+		case ACT_SO3600 :
+			RamWrite32A( GCNV_XX , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( GCNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_ZP , (UINT32)0x80000001 );
+
+			RamWrite32A( ACNV_XX , (UINT32)0x80000001 );
+			RamWrite32A( ACNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YY , (UINT32)0x80000001 );
+			RamWrite32A( ACNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+		break;
+  #else
+		case ACT_SO2820 :
+			RamWrite32A( GCNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_XY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( GCNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YX , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_ZP , (UINT32)0x80000001 );
+			
+			RamWrite32A( ACNV_XX , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+			break;
+		case ACT_SO3600 :
+			RamWrite32A( GCNV_XX , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_XY , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_YY , (UINT32)0x80000001 );
+			RamWrite32A( GCNV_YX , (UINT32)0x00000000 );
+			RamWrite32A( GCNV_ZP , (UINT32)0x80000001 );
+
+			RamWrite32A( ACNV_XX , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_XY , (UINT32)0x7FFFFFFF );
+			RamWrite32A( ACNV_YY , (UINT32)0x00000000 );
+			RamWrite32A( ACNV_YX , (UINT32)0x80000001 );
+			RamWrite32A( ACNV_ZP , (UINT32)0x7FFFFFFF );
+		break;
+  #endif	// USE_BOSCH
+#endif		// UP_SIDE_GYRO
+	}
+}
+
+//********************************************************************************
+// Function Name 	: MeasGain
+// Retun Value		: Hall amp & Sine amp
+// Argment Value	: X,Y Direction, Freq
+// Explanation		: Measuring Hall Paek To Peak
+// History			: First edition 						
+//********************************************************************************
+#define	FS4TIME	(UINT32)0x000119B3		// 18028.8 * 4
+#define	FRQOFST	(UINT32)0x0001D14A		// 80000000h / 18028.8
+
+UINT32	MeasGain ( UINT16	UcDirSel, UINT16	UsMeasFreq , UINT32 UlMesAmp )
+{
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum , SlSineWaveOffset;
+	UnllnVal		StMeasValueA  , StMeasValueB ;
+	UINT32	UlReturnVal;
+
+	StMeasValueA.UllnValue = 0;
+	StMeasValueB.UllnValue = 0;
+	SlMeasureParameterNum	=	(INT32)( FS4TIME / (UINT32)UsMeasFreq) * 2;	// 
+	
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXOUT0 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HXDAZ1 ;	// Set Measure RAM Address
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYOUT0 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HallFilterD_HYDAZ1 ;	// Set Measure RAM Address
+	}
+	SetSinWavGenInt();
+	
+	SlSineWaveOffset = (INT32)( FRQOFST * (UINT32)UsMeasFreq );
+	RamWrite32A( SinWave_Offset		,	SlSineWaveOffset ) ;		// Freq Setting = Freq * 80000000h / Fs	
+
+	RamWrite32A( SinWave_Gain		,	UlMesAmp ) ;			// Set Sine Wave Gain
+
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;				// Sine Wave Start
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;	// Set Sine Wave Input RAM
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;	// Set Sine Wave Input RAM
+	}
+	
+	MesFil2( UsMeasFreq ) ;					// Filter setting for measurement
+
+	MeasureStart2( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB , 8000/UsMeasFreq ) ;			// Start measure
+	
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;								// Sine Wave Stop
+	
+	if( UcDirSel == X_DIR ) {
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else if( UcDirSel == Y_DIR ){
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}
+
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	
+	UlReturnVal = (INT32)((INT64)StMeasValueA.UllnValue * 100 / (INT64)StMeasValueB.UllnValue  ) ;
+
+
+	return( UlReturnVal ) ;
+}
+//********************************************************************************
+// Function Name 	: MesFil2
+// Retun Value		: NON
+// Argment Value	: Measure Filter Mode
+// Explanation		: Measure Filter Setting Function
+// History			: First edition 		
+//********************************************************************************
+#define	DivOffset	5741.65f		/* 18028.8/3.14 */
+
+void	MesFil2( UINT16	UsMesFreq )		
+{
+	UINT32	UlMeasFilA1 , UlMeasFilB1 , UlMeasFilC1 , UlTempval ;
+	UINT32	UlMeasFilA2 , UlMeasFilC2 ;
+		
+	UlTempval = (UINT32)(2147483647 * (float)UsMesFreq / ((float)UsMesFreq + DivOffset ));
+	UlMeasFilA1	=	0x7fffffff - UlTempval;
+	UlMeasFilB1	=	~UlMeasFilA1 + 0x00000001;	
+	UlMeasFilC1	=	0x7FFFFFFF - ( UlTempval << 1 ) ;
+
+	UlMeasFilA2	=	UlTempval ;	
+	UlMeasFilC2	=	UlMeasFilC1 ;
+
+	
+	RamWrite32A ( MeasureFilterA_Coeff_a1	, UlMeasFilA1 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b1	, UlMeasFilB1 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c1	, UlMeasFilC1 ) ;
+
+	RamWrite32A ( MeasureFilterA_Coeff_a2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_b2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterA_Coeff_c2	, UlMeasFilC2 ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a1	, UlMeasFilA1 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b1	, UlMeasFilB1 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c1	, UlMeasFilC1 ) ;
+
+	RamWrite32A ( MeasureFilterB_Coeff_a2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_b2	, UlMeasFilA2 ) ;
+	RamWrite32A ( MeasureFilterB_Coeff_c2	, UlMeasFilC2 ) ;
+}
+
+//********************************************************************************
+// Function Name 	: MeasureStart2
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	MeasureStart2( INT32 SlMeasureParameterNum , INT32 SlMeasureParameterA , INT32 SlMeasureParameterB , UINT16 UsTime )
+{
+	MemoryClear( StMeasFunc_SiSampleNum , sizeof( MeasureFunction_Type ) ) ;
+	RamWrite32A( StMeasFunc_MFA_SiMax1	 , 0x80000001 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFB_SiMax2	 , 0x80000001 ) ;					// Set Min 
+	RamWrite32A( StMeasFunc_MFA_SiMin1	 , 0x7FFFFFFF ) ;					// Set Max 
+	RamWrite32A( StMeasFunc_MFB_SiMin2	 , 0x7FFFFFFF ) ;					// Set Max 
+	
+	SetTransDataAdr( StMeasFunc_MFA_PiMeasureRam1	 , ( UINT32 )SlMeasureParameterA ) ;		// Set Measure Filter A Ram Address
+	SetTransDataAdr( StMeasFunc_MFB_PiMeasureRam2	 , ( UINT32 )SlMeasureParameterB ) ;		// Set Measure Filter B Ram Address
+	RamWrite32A( StMeasFunc_SiSampleNum	 , 0 ) ;													// Clear Measure Counter 
+	ClrMesFil() ;						// Clear Delay Ram
+	RamWrite32A( StMeasFunc_SiSampleMax	 , SlMeasureParameterNum ) ;						// Set Measure Max Number
+	SetWaitTime(UsTime) ;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: LinearityCalculation
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition 						
+//********************************************************************************
+void	LinearityCalculation( void )
+{
+	UINT8  tempL[32];
+//	UINT8  tempC[10];
+	UINT16 tblX[7],tblY[7];
+	INT16  stpx,stpy;
+//	UINT16 tblC[5];
+	UINT8	i,n,cnt;
+	UINT16  adr;
+	INT32	dacx[7],dacy[7];
+	INT16	pixx[7],pixy[7];
+	INT16	cfax[6],cfbx[6],cfzx[5];
+	INT16	cfay[6],cfby[6],cfzy[5];
+	float	cffax[6];
+	float	cffay[6];
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(HLLN_CALB_FLG>>8) );
+	if( cnt & (UINT8)(HLLN_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_POSITION_1X_LSB  , tempL, 32 );
+//	BurstReadE2Prom( EEPROM_CROSSTALK_XX_LSB , tempC, 10 );
+	
+TRACE("\n E2prom POSITION Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[0],tempL[1],tempL[2],tempL[3],tempL[4],tempL[5],tempL[6],tempL[7]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[8],tempL[9],tempL[10],tempL[11],tempL[12],tempL[13],tempL[14],tempL[15]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[16],tempL[17],tempL[18],tempL[19],tempL[20],tempL[21],tempL[22],tempL[23]) ;
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempL[24],tempL[25],tempL[26],tempL[27],tempL[28],tempL[29],tempL[30],tempL[31]) ;
+TRACE("\n E2prom CROSS TALK Read \n" );
+//TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3],tempC[4],tempC[5],tempC[6],tempC[7]) ;
+//TRACE(" %02xh %02xh \n",tempC[8],tempC[9]) ;
+
+	/****** Linearity ******/
+	for( i=0 , n=0 ; n<7 ; n++ ){
+		tblX[n] = tempL[i] + (tempL[i+1]<<8);
+		i += 2;
+		tblY[n] = tempL[i] + (tempL[i+1]<<8);
+		i += 2;
+	}
+	stpx = (INT16)(tempL[i] + (tempL[i+1]<<8));
+	i += 2;
+	stpy = (INT16)(tempL[i] + (tempL[i+1]<<8));
+TRACE("\n POSITION TBL \n" );
+TRACE("[x] %04xh %04xh %04xh %04xh %04xh %04xh %04xh \n",tblX[0],tblX[1],tblX[2],tblX[3],tblX[4],tblX[5],tblX[6]) ;
+TRACE("[y] %04xh %04xh %04xh %04xh %04xh %04xh %04xh \n",tblY[0],tblY[1],tblY[2],tblY[3],tblY[4],tblY[5],tblY[6]) ;
+TRACE("[s] %04xh %04xh \n",stpx,stpy) ;
+	
+	for( i=0 ; i<7 ; i++ ){
+		dacx[i] = (( i - 3 ) * stpx)<<4;	/* 2^16/4096 = 2^4 */
+		dacy[i] = (( i - 3 ) * stpy)<<4;	/* 2^16/4096 = 2^4 */
+		pixx[i] = tblX[i] - tblX[3];
+		pixy[i] = tblY[i] - tblY[3];
+	}
+	for( i=0 ; i<6 ; i++ ){
+		if(i == 3){
+//			cfax[i] = (INT16)((float)pixx[i+1] / (float)dacx[i+1] * 524287.0f);
+//			cfay[i] = (INT16)((float)pixy[i+1] / (float)dacy[i+1] * 524287.0f);
+			cffax[i] = ((float)pixx[i+1] / (float)dacx[i+1] * 524287.0f);
+			cffay[i] = ((float)pixy[i+1] / (float)dacy[i+1] * 524287.0f);
+			cfax[i] = (INT16)cffax[i];
+			cfay[i] = (INT16)cffay[i];
+			cfbx[i] = (INT16)0;
+			cfby[i] = (INT16)0;
+		}else{
+//			cfax[i] = (INT16)(( dacx[i] - dacx[i+1] ) / ( pixx[i] - pixx[i+1] ));
+//			cfay[i] = (INT16)(( dacy[i] - dacy[i+1] ) / ( pixy[i] - pixy[i+1] ));
+			cffax[i] = (float)( dacx[i] - dacx[i+1] ) / (float)( pixx[i] - pixx[i+1] );
+			cffay[i] = (float)( dacy[i] - dacy[i+1] ) / (float)( pixy[i] - pixy[i+1] );
+			cfax[i] = (INT16)cffax[i];
+			cfay[i] = (INT16)cffay[i];
+			if(i == 2){
+				cfbx[i] = (INT16)0;
+				cfby[i] = (INT16)0;
+			}else{
+//				cfbx[i] = (INT16)( dacx[i] - (INT32)cfax[i] * (INT32)pixx[i] );
+//				cfby[i] = (INT16)( dacy[i] - (INT32)cfay[i] * (INT32)pixy[i] );
+				cfbx[i] = (INT16)( (float)dacx[i] - cffax[i] * (float)pixx[i] );
+				cfby[i] = (INT16)( (float)dacy[i] - cffay[i] * (float)pixy[i] );
+			}
+		}
+		if(i<5){
+			cfzx[i] = pixx[i+1];
+			cfzy[i] = pixy[i+1];
+		}
+	}
+TRACE("\n CALCULATE \n" );
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[0],pixx[0],(int)dacy[0],pixy[0]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[1],pixx[1],(int)dacy[1],pixy[1]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[2],pixx[2],(int)dacy[2],pixy[2]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[3],pixx[3],(int)dacy[3],pixy[3]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[4],pixx[4],(int)dacy[4],pixy[4]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n",(int)dacx[5],pixx[5],(int)dacy[5],pixy[5]) ;
+TRACE(" [%08xh , %04xh] [%08xh , %04xh]\n\n",(int)dacx[6],pixx[6],(int)dacy[6],pixy[6]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[0],cfax[0],cfbx[0],cfzy[0],cfay[0],cfby[0]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[1],cfax[1],cfbx[1],cfzy[1],cfay[1],cfby[1]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[2],cfax[2],cfbx[2],cfzy[2],cfay[2],cfby[2]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[3],cfax[3],cfbx[3],cfzy[3],cfay[3],cfby[3]) ;
+TRACE(" [%04xh , %04xh , %04xh] [%04xh , %04xh , %04xh]\n",cfzx[4],cfax[4],cfbx[4],cfzy[4],cfay[4],cfby[4]) ;
+TRACE(" [----- , %04xh , %04xh] [----- , %04xh , %04xh]\n"        ,cfax[5],cfbx[5]        ,cfay[5],cfby[5]) ;
+	adr = HAL_LN_CORRECT;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[0] + ((UINT16)cfax[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[2] + ((UINT16)cfax[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfax[4] + ((UINT16)cfax[5]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[0] + ((UINT16)cfbx[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[2] + ((UINT16)cfbx[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfbx[4] + ((UINT16)cfbx[5]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[0] + ((UINT16)cfzx[1]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[2] + ((UINT16)cfzx[3]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzx[4] + ((UINT16)cfay[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[1] + ((UINT16)cfay[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[3] + ((UINT16)cfay[4]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfay[5] + ((UINT16)cfby[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[1] + ((UINT16)cfby[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[3] + ((UINT16)cfby[4]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfby[5] + ((UINT16)cfzy[0]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzy[1] + ((UINT16)cfzy[2]<<16 )));		adr += 0x0004;
+	RamWrite32A( adr , (UINT32)( (UINT16)cfzy[3] + ((UINT16)cfzy[4]<<16 )));
+
+	SetLinearityParameter();
+	
+//	/****** Cross talk ******/
+//	for( i=0 , n=0 ; n<5 ; n++ ){
+//		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+//		i += 2;
+//	}
+//TRACE("[XX] %04xh [XY]%04xh [SFT]%02xh\n",tblC[0],tblC[1],(unsigned char)(tblC[4]>>0)) ;
+//TRACE("[YY] %04xh [YX]%04xh [SFT]%02xh\n",tblC[2],tblC[3],(unsigned char)(tblC[4]>>8)) ;
+//	RamWrite32A( HF_hx45x , (UINT32)(tblC[0]<<16));
+//	RamWrite32A( HF_hx45y , (UINT32)(tblC[1]<<16));
+//	RamWrite32A( HF_hy45y , (UINT32)(tblC[2]<<16));
+//	RamWrite32A( HF_hy45x , (UINT32)(tblC[3]<<16));
+//	RamWrite32A( HF_ShiftX , (UINT32)(tblC[4]));
+	
+}	
+
+void	SetLinearityParameter( void )
+{
+	UINT32 UlGyroSw;
+	
+	
+	RamRead32A( GYRO_RAM_GYRO_Switch , &UlGyroSw );
+	UlGyroSw	|=	0x00000008;
+	RamWrite32A( GYRO_RAM_GYRO_Switch , UlGyroSw );
+	
+}
+
+//********************************************************************************
+// Function Name 	: CrosstalkCalculation
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	CrosstalkCalculation( void )
+{
+	UINT16 tblC[5];
+	UINT8  tempC[10];
+	UINT8	i,n,cnt;
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(MIXI_CALB_FLG>>8) );
+	if( cnt & (UINT8)(MIXI_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_CROSSTALK_XX_LSB , tempC, 10 );
+	
+TRACE("\n E2prom CROSS TALK Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3],tempC[4],tempC[5],tempC[6],tempC[7]) ;
+TRACE(" %02xh %02xh \n",tempC[8],tempC[9]) ;
+	
+	/****** Cross talk ******/
+	for( i=0 , n=0 ; n<5 ; n++ ){
+		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+		i += 2;
+	}
+TRACE("[XX] %04xh [XY]%04xh [SFT]%02xh\n",tblC[0],tblC[1],(unsigned char)(tblC[4]>>0)) ;
+TRACE("[YY] %04xh [YX]%04xh [SFT]%02xh\n",tblC[2],tblC[3],(unsigned char)(tblC[4]>>8)) ;
+	RamWrite32A( HF_hx45x , (UINT32)(tblC[0]<<16));
+	RamWrite32A( HF_hx45y , (UINT32)(tblC[1]<<16));
+	RamWrite32A( HF_hy45y , (UINT32)(tblC[2]<<16));
+	RamWrite32A( HF_hy45x , (UINT32)(tblC[3]<<16));
+	RamWrite32A( HF_ShiftX , (UINT32)(tblC[4]));
+
+}
+
+//********************************************************************************
+// Function Name 	: SetOpticalOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	SetOpticalOffset( void )
+{
+	UINT16 tblC[2];
+	UINT8  tempC[4];
+	UINT8	i,n,cnt;
+	
+	ReadE2Prom( EEPROM_Calibration_Status_MSB, &cnt );
+TRACE("E2prom Read 0x19 = %02x   &  %02x  \n", cnt , (UINT8)(HALL_CALB_FLG>>8) );
+	if( cnt & (UINT8)(HALL_CALB_FLG>>8) ){
+		return;
+	}
+	
+	BurstReadE2Prom( EEPROM_Optical_LensOffsetX_LSB , tempC, 4 );
+	
+TRACE("\n EEPROM_Optical_LensOffset Read \n" );
+TRACE(" %02xh %02xh %02xh %02xh \n",tempC[0],tempC[1],tempC[2],tempC[3]) ;
+	
+	/****** Cross talk ******/
+	for( i=0 , n=0 ; n<2 ; n++ ){
+		tblC[n] = tempC[i] + (tempC[i+1]<<8);
+		i += 2;
+	}
+	
+	if( tblC[ 0 ] == 0xFFFF ) {
+		tblC[ 0 ]	= 0 ;
+	}
+	
+	if( tblC[ 1 ] == 0xFFFF ) {
+		tblC[ 1 ]	= 0 ;
+	}
+	
+TRACE("[XX] %04xh [XY]%04xh \n", tblC[0], tblC[1]) ;
+	RamWrite32A( Optical_Offset_X , (UINT32)(tblC[0]<<16));
+	RamWrite32A( Optical_Offset_Y , (UINT32)(tblC[1]<<16));
+
+}
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2820.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2820.h
new file mode 100644
index 0000000000000000000000000000000000000000..c50df8b14aa16e5f7cb63a2a1d04add4ebe3bed3
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2820.h
@@ -0,0 +1,162 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft>>
+//		Program Name	: LC898124EP3_Calibration_SO2820.h
+// 		Explanation		: LC898124 calibration parameters 
+//		Design			: K.abe
+//		History			: First edition	
+//********************************************************************************
+
+// Version Name : 00-00-0000
+
+// for	"SOXXXX"
+
+//********************************************************************************
+// defines
+//********************************************************************************
+//#define		XY_BIAS			(0x40000000 )
+#define		XY_BIAS			(0x80000000 )
+//#define		XY_OFST			(0x80000000 )
+#define		XY_OFST			(0x10000000 )
+
+#ifdef	HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x0300		)	// Margin
+ #define 	BIAS_RANGE_XY 	(0x6666		)	// 40%	SO2820	//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0x7332		)	// 45%			//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0x7FFF		)	// 50%	SO3600	//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0x9999		)	// 60%			//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0xCCCC		)	// 80%
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */
+ #define	SINE_GAIN		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#else	//HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x1000		)	// VDD-Margin,GND-MARGIN
+ #define 	BIAS_RANGE_XY	(0x8CCC		)	// 55%
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */ 
+ #define	SINE_GAIN		(0x4D780000	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬ 115mA (115mA*7fff/190mA)  190mA(min) */
+ 
+ 
+#if 0
+ #define 	MARGIN_F		(0x0300		)	// Margin
+ #define 	BIAS_RANGE_XY_F	(0xB332		)	// 70%
+ #define	SINE_OFFSET_F	(0x00122CE4 )	/* Freq * 80000000h / 18.0288kHz   : 10Hz */
+ #define	SINE_GAIN_F		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#endif
+ 
+ 
+#endif	//HALLADJ_FULLCURRENT
+
+#define 	ADJMARG			(0x0300		)	// Margin
+#define 	DECRE_CAL		(0x0100		)	// decrease value
+
+#define		SXGAIN_LOP		(0x30000000 )	// 0.375000
+#define		SYGAIN_LOP		(0x30000000 )	// 0.375000
+
+#define 	LOOP_NUM		(2508		)	// 18.0288kHz/0.130kHz*16times
+#define 	LOOP_FREQ		(0x00D10422	)	// Freq * 80000000h / Fs
+#define 	LOOP_GAIN		(0x09249249	)	// -22.92dB
+
+#define 	LOOP_MAX_X		(SXGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_X		(SXGAIN_LOP >> 1)	// x0.5
+#define 	LOOP_MAX_Y		(SYGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_Y		(SYGAIN_LOP >> 1)	// x0.5
+
+#define		GAIN_GAP		(1000)			// 20*log(1000/1000)=0dB
+
+#define		AF_DrvDir		0x01				// AF Drive output signal 0:Pos  1:Neg 
+#define		AF_RRMD1_TM		0x4200				// to Macro  RRMD1
+#define		AF_RRMD1_TI		0x4400				// to Infini RRMD1
+#define		AF_Ft			0x00D9				/* Ft	fs/Freq	*/
+
+#define		ACT_MAX_DRIVE_X		0x7FFFFFFF
+#define		ACT_MAX_DRIVE_Y		0x7FFFFFFF
+#define		ACT_MIN_DRIVE_X		0xD6000000
+#define		ACT_MIN_DRIVE_Y		0xD2000000
+
+//********************************************************************************
+// structure for calibration
+//********************************************************************************
+ const ADJ_HALL SO2820_HallCalParameter = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN,
+/* TargetRange */	BIAS_RANGE_XY,
+/* TargetMax */		(BIAS_RANGE_XY + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY - ADJMARG),
+/* SinNum */		(4500),				// 18.0288/0.004 > x
+/* SinFreq */		SINE_OFFSET,
+/* SinGain */		SINE_GAIN,
+/* DecrementStep */ DECRE_CAL,
+/* ActMaxDrive */	ACT_MAX_DRIVE_X,
+/* ActMaxDrive */	ACT_MAX_DRIVE_Y,
+/* ActMinDrive */	ACT_MIN_DRIVE_X,
+/* ActMinDrive */	ACT_MIN_DRIVE_Y
+}; //   
+
+#if 0
+ const ADJ_HALL SO2820_HallCalParameter_F = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN_F,
+/* TargetRange */	BIAS_RANGE_XY_F,
+/* TargetMax */		(BIAS_RANGE_XY_F + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY_F - ADJMARG),
+/* SinNum */		(1800),				// 18.0288/0.01 > x
+/* SinFreq */		SINE_OFFSET_F,
+/* SinGain */		SINE_GAIN_F,
+/* DecrementStep */ DECRE_CAL,
+}; //   
+#endif
+
+const ADJ_LOPGAN SO2820_LoopGainParameter = { 
+/* Hxgain */		SXGAIN_LOP,
+/* Hygain */		SYGAIN_LOP,
+/* NoiseNum */		LOOP_NUM,
+/* NoiseFreq */		LOOP_FREQ,
+/* NoiseGain */		LOOP_GAIN, 
+/* Gap  */			GAIN_GAP,
+/* XJudgeHigh */ 	LOOP_MAX_X,
+/* XJudgeLow  */ 	LOOP_MIN_X,
+/* YJudgeHigh */ 	LOOP_MAX_Y,
+/* YJudgeLow  */ 	LOOP_MIN_Y,
+}; //   
+
+ const AF_PARA SO2820_OpenAfParameter = { 
+/* DriveDir*/		AF_DrvDir,
+/* RRMD1 to Mcr*/	AF_RRMD1_TM,
+/* RRMD1 to Inf*/	AF_RRMD1_TI,
+/* resonance frq*/	AF_Ft,
+}; //   
+
+#undef	OFFSET_DIV
+#undef	IME_OUT
+#undef	BIAS_HLMT
+#undef	BIAS_LLMT
+#undef	XY_BIAS
+#undef	XY_OFST
+#undef	MARGIN
+#undef	BIAS_RANGE_XY
+#undef	SINE_OFFSET
+#undef	SINE_GAIN
+#undef	ADJMARG
+#undef	DECRE_CAL
+
+#undef	SXGAIN_LOP
+#undef	SYGAIN_LOP
+#undef	LOOP_NUM
+#undef	LOOP_FREQ
+#undef	LOOP_GAIN
+#undef	GAIN_GAP
+#undef	LOOP_MAX_X
+#undef	LOOP_MIN_X
+#undef	LOOP_MAX_Y
+#undef	LOOP_MIN_Y
+
+#undef	AF_DrvDir
+#undef	AF_RRMD1_TM
+#undef	AF_RRMD1_TI
+#undef	AF_Ft
+
+#undef	ACT_MAX_DRIVE_X
+#undef	ACT_MAX_DRIVE_Y
+#undef	ACT_MIN_DRIVE_X
+#undef	ACT_MIN_DRIVE_Y
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2821.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2821.h
new file mode 100644
index 0000000000000000000000000000000000000000..8e3effc2980feb7973bf508780e6e16b83c340ee
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO2821.h
@@ -0,0 +1,178 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft>>
+//		Program Name	: LC898124EP3_Calibration_SO2821.h
+// 		Explanation		: LC898124 calibration parameters 
+//		Design			: K.abe
+//		History			: First edition	
+//********************************************************************************
+
+// Version Name : 00-00-0000
+
+// for	"SOXXXX"
+
+//********************************************************************************
+// defines
+//********************************************************************************
+#define		XY_BIAS			(0x80000000 )
+#define		XY_OFST			(0x10000000 )
+
+#ifdef	HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x0400		)	// Margin
+ #define 	BIAS_RANGE_XY 	(0x6400		)	// 40%	SO2821
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */
+ #define	SINE_GAIN		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#else	//HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x1000		)	// VDD-Margin,GND-MARGIN
+ #define 	BIAS_RANGE_XY	(0x8CCC		)	// 55%
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */ 
+ #define	SINE_GAIN		(0x4D780000	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬ 115mA (115mA*7fff/190mA)  190mA(min) */
+ 
+ 
+#if 0
+ #define 	MARGIN_F		(0x0300		)	// Margin
+ #define 	BIAS_RANGE_XY_F	(0xB332		)	// 70%
+ #define	SINE_OFFSET_F	(0x00122CE4 )	/* Freq * 80000000h / 18.0288kHz   : 10Hz */
+ #define	SINE_GAIN_F		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#endif
+ 
+ 
+#endif	//HALLADJ_FULLCURRENT
+
+#define 	ADJMARG			(0x0300		)	// Margin
+#define 	DECRE_CAL		(0x0100		)	// decrease value
+
+#define		SXGAIN_LOP		(0x30000000 )	// 0.375000
+#define		SYGAIN_LOP		(0x30000000 )	// 0.375000
+
+#define 	LOOP_NUM		(2508		)	// 18.0288kHz/0.130kHz*16times
+#define 	LOOP_FREQ		(0x00D10422	)	// Freq * 80000000h / Fs
+#define 	LOOP_GAIN		(0x09249249	)	// -22.92dB
+
+#define 	LOOP_MAX_X		(SXGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_X		(SXGAIN_LOP >> 1)	// x0.5
+#define 	LOOP_MAX_Y		(SYGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_Y		(SYGAIN_LOP >> 1)	// x0.5
+
+#define		GAIN_GAP		(1000)			// 20*log(1000/1000)=0dB
+
+#define		AF_DrvDir		0x01				// AF Drive output signal 0:Pos  1:Neg 
+#define		AF_RRMD1_TM		0x4200				// to Macro  RRMD1
+#define		AF_RRMD1_TI		0x4400				// to Infini RRMD1
+#define		AF_Ft			0x00D9				/* Ft	fs/Freq	*/
+
+#define		ACT_MAX_DRIVE_X		0x7FFFFFFF
+#define		ACT_MAX_DRIVE_Y		0x7FFFFFFF
+#define		ACT_MIN_DRIVE_X		0xD0000000
+#define		ACT_MIN_DRIVE_Y		0xC0000000
+
+#define		MAGNETIC_OFFSET_X	0x0890
+#define		MAGNETIC_OFFSET_Y	0x0900
+
+#define		Xch_Hall_MAX			3			//  3%
+#define		Ych_Hall_MAX			3			//  3%
+#define		Xch_Hall_MIN			5			//  5%
+#define		Ych_Hall_MIN			5			//  5%
+
+//********************************************************************************
+// structure for calibration
+//********************************************************************************
+ const ADJ_HALL SO2821_HallCalParameter = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN,
+/* TargetRange */	BIAS_RANGE_XY,
+/* TargetMax */		(BIAS_RANGE_XY + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY - ADJMARG),
+/* SinNum */		(4500),				// 18.0288/0.004 > x
+/* SinFreq */		SINE_OFFSET,
+/* SinGain */		SINE_GAIN,
+/* DecrementStep */ DECRE_CAL,
+/* ActMaxDrive */	ACT_MAX_DRIVE_X,
+/* ActMaxDrive */	ACT_MAX_DRIVE_Y,
+/* ActMinDrive */	ACT_MIN_DRIVE_X,
+/* ActMinDrive */	ACT_MIN_DRIVE_Y,
+/* MagneticOff */	MAGNETIC_OFFSET_X,
+/* MagneticOff */	MAGNETIC_OFFSET_Y,
+/* HallMAX_X */		Xch_Hall_MAX,
+/* HallMAX_Y */		Ych_Hall_MAX,
+/* HallMIN_X */		Xch_Hall_MIN,
+/* HallMIN_Y */		Ych_Hall_MIN,
+}; //   
+
+#if 0
+ const ADJ_HALL SO2821_HallCalParameter_F = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN_F,
+/* TargetRange */	BIAS_RANGE_XY_F,
+/* TargetMax */		(BIAS_RANGE_XY_F + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY_F - ADJMARG),
+/* SinNum */		(1800),				// 18.0288/0.01 > x
+/* SinFreq */		SINE_OFFSET_F,
+/* SinGain */		SINE_GAIN_F,
+/* DecrementStep */ DECRE_CAL,
+}; //   
+#endif
+
+const ADJ_LOPGAN SO2821_LoopGainParameter = { 
+/* Hxgain */		SXGAIN_LOP,
+/* Hygain */		SYGAIN_LOP,
+/* NoiseNum */		LOOP_NUM,
+/* NoiseFreq */		LOOP_FREQ,
+/* NoiseGain */		LOOP_GAIN, 
+/* Gap  */			GAIN_GAP,
+/* XJudgeHigh */ 	LOOP_MAX_X,
+/* XJudgeLow  */ 	LOOP_MIN_X,
+/* YJudgeHigh */ 	LOOP_MAX_Y,
+/* YJudgeLow  */ 	LOOP_MIN_Y,
+}; //   
+
+ const AF_PARA SO2821_OpenAfParameter = { 
+/* DriveDir*/		AF_DrvDir,
+/* RRMD1 to Mcr*/	AF_RRMD1_TM,
+/* RRMD1 to Inf*/	AF_RRMD1_TI,
+/* resonance frq*/	AF_Ft,
+}; //   
+
+#undef	OFFSET_DIV
+#undef	IME_OUT
+#undef	BIAS_HLMT
+#undef	BIAS_LLMT
+#undef	XY_BIAS
+#undef	XY_OFST
+#undef	MARGIN
+#undef	BIAS_RANGE_XY
+#undef	SINE_OFFSET
+#undef	SINE_GAIN
+#undef	ADJMARG
+#undef	DECRE_CAL
+
+#undef	SXGAIN_LOP
+#undef	SYGAIN_LOP
+#undef	LOOP_NUM
+#undef	LOOP_FREQ
+#undef	LOOP_GAIN
+#undef	GAIN_GAP
+#undef	LOOP_MAX_X
+#undef	LOOP_MIN_X
+#undef	LOOP_MAX_Y
+#undef	LOOP_MIN_Y
+
+#undef	AF_DrvDir
+#undef	AF_RRMD1_TM
+#undef	AF_RRMD1_TI
+#undef	AF_Ft
+
+#undef	ACT_MAX_DRIVE_X
+#undef	ACT_MAX_DRIVE_Y
+#undef	ACT_MIN_DRIVE_X
+#undef	ACT_MIN_DRIVE_Y
+
+#undef	MAGNETIC_OFFSET_X
+#undef	MAGNETIC_OFFSET_Y
+
+#undef		Xch_Hall_MAX
+#undef		Xch_Hall_MIN
+#undef		Ych_Hall_MAX
+#undef		Ych_Hall_MIN
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO3600.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO3600.h
new file mode 100644
index 0000000000000000000000000000000000000000..a4baf084865aedfab751eb4458aa7d20f93c8e82
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Calibration_SO3600.h
@@ -0,0 +1,162 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft>>
+//		Program Name	: LC898124EP3_Calibration_SO3600.h
+// 		Explanation		: LC898124 calibration parameters 
+//		Design			: K.abe
+//		History			: First edition	
+//********************************************************************************
+
+// Version Name : 00-00-0000
+
+// for	"SOXXXX"
+
+//********************************************************************************
+// defines
+//********************************************************************************
+//#define		XY_BIAS			(0x40000000 )
+#define		XY_BIAS			(0x80000000 )
+//#define		XY_OFST			(0x80000000 )
+#define		XY_OFST			(0x10000000 )
+
+#ifdef	HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x0300		)	// Margin
+// #define 	BIAS_RANGE_XY 	(0x6666		)	// 40%	SO2820	//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0x7332		)	// 45%			//20180905 Komori
+ #define 	BIAS_RANGE_XY 	(0x7FFF		)	// 50%	SO3600	//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0x9999		)	// 60%			//20180905 Komori
+// #define 	BIAS_RANGE_XY 	(0xCCCC		)	// 80%
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */
+ #define	SINE_GAIN		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#else	//HALLADJ_FULLCURRENT
+ #define 	MARGIN			(0x1000		)	// VDD-Margin,GND-MARGIN
+ #define 	BIAS_RANGE_XY	(0x8CCC		)	// 55%
+ #define	SINE_OFFSET		(0x00074528 )	/* Freq * 80000000h / 18.0288kHz   : 4Hz */ 
+ #define	SINE_GAIN		(0x4D780000	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬ 115mA (115mA*7fff/190mA)  190mA(min) */
+ 
+ 
+#if 0
+ #define 	MARGIN_F		(0x0300		)	// Margin
+ #define 	BIAS_RANGE_XY_F	(0xB332		)	// 70%
+ #define	SINE_OFFSET_F	(0x00122CE4 )	/* Freq * 80000000h / 18.0288kHz   : 10Hz */
+ #define	SINE_GAIN_F		(0x7FFFFFFF	)	/*“ü—ÍSine”g‚Ì�Å‘å“d—¬*/
+#endif
+ 
+ 
+#endif	//HALLADJ_FULLCURRENT
+
+#define 	ADJMARG			(0x0300		)	// Margin
+#define 	DECRE_CAL		(0x0100		)	// decrease value
+
+#define		SXGAIN_LOP		(0x30000000 )	// 0.375000
+#define		SYGAIN_LOP		(0x30000000 )	// 0.375000
+
+#define 	LOOP_NUM		(2508		)	// 18.0288kHz/0.115kHz*16times
+#define 	LOOP_FREQ		(0x00D10445	)	// Freq * 80000000h / Fs
+#define 	LOOP_GAIN		(0x0207567A	)	// -32dB
+
+#define 	LOOP_MAX_X		(SXGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_X		(SXGAIN_LOP >> 1)	// x0.5
+#define 	LOOP_MAX_Y		(SYGAIN_LOP << 1)	// x2
+#define 	LOOP_MIN_Y		(SYGAIN_LOP >> 1)	// x0.5
+
+#define		GAIN_GAP		(1000)			// 20*log(1000/1000)=0dB
+
+#define		AF_DrvDir		0x01				// AF Drive output signal 0:Pos  1:Neg 
+#define		AF_RRMD1_TM		0x4200				// to Macro  RRMD1
+#define		AF_RRMD1_TI		0x4400				// to Infini RRMD1
+#define		AF_Ft			0x00D9				/* Ft	fs/Freq	*/
+
+#define		ACT_MAX_DRIVE_X		0x6FFFFFFF
+#define		ACT_MAX_DRIVE_Y		0x5FFFFFFF
+#define		ACT_MIN_DRIVE_X		0xC0000000
+#define		ACT_MIN_DRIVE_Y		0xC0000000
+
+//********************************************************************************
+// structure for calibration
+//********************************************************************************
+ const ADJ_HALL SO3600_HallCalParameter = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN,
+/* TargetRange */	BIAS_RANGE_XY,
+/* TargetMax */		(BIAS_RANGE_XY + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY - ADJMARG),
+/* SinNum */		(4500),				// 18.0288/0.004 > x
+/* SinFreq */		SINE_OFFSET,
+/* SinGain */		SINE_GAIN,
+/* DecrementStep */ DECRE_CAL,
+/* ActMaxDrive */	ACT_MAX_DRIVE_X,
+/* ActMaxDrive */	ACT_MAX_DRIVE_Y,
+/* ActMinDrive */	ACT_MIN_DRIVE_X,
+/* ActMinDrive */	ACT_MIN_DRIVE_Y
+}; //   
+
+#if 0
+ const ADJ_HALL SO3600_HallCalParameter_F = { 
+/* BiasInit */		XY_BIAS,
+/* OffsetInit */	XY_OFST,
+/* OffsetMargin */	MARGIN_F,
+/* TargetRange */	BIAS_RANGE_XY_F,
+/* TargetMax */		(BIAS_RANGE_XY_F + ADJMARG),
+/* TargetMin */		(BIAS_RANGE_XY_F - ADJMARG),
+/* SinNum */		(1800),				// 18.0288/0.01 > x
+/* SinFreq */		SINE_OFFSET_F,
+/* SinGain */		SINE_GAIN_F,
+/* DecrementStep */ DECRE_CAL,
+}; //   
+#endif
+
+const ADJ_LOPGAN SO3600_LoopGainParameter = { 
+/* Hxgain */		SXGAIN_LOP,
+/* Hygain */		SYGAIN_LOP,
+/* NoiseNum */		LOOP_NUM,
+/* NoiseFreq */		LOOP_FREQ,
+/* NoiseGain */		LOOP_GAIN, 
+/* Gap  */			GAIN_GAP,
+/* XJudgeHigh */ 	LOOP_MAX_X,
+/* XJudgeLow  */ 	LOOP_MIN_X,
+/* YJudgeHigh */ 	LOOP_MAX_Y,
+/* YJudgeLow  */ 	LOOP_MIN_Y,
+}; //   
+
+ const AF_PARA SO3600_OpenAfParameter = { 
+/* DriveDir*/		AF_DrvDir,
+/* RRMD1 to Mcr*/	AF_RRMD1_TM,
+/* RRMD1 to Inf*/	AF_RRMD1_TI,
+/* resonance frq*/	AF_Ft,
+}; //   
+
+#undef	OFFSET_DIV
+#undef	IME_OUT
+#undef	BIAS_HLMT
+#undef	BIAS_LLMT
+#undef	XY_BIAS
+#undef	XY_OFST
+#undef	MARGIN
+#undef	BIAS_RANGE_XY
+#undef	SINE_OFFSET
+#undef	SINE_GAIN
+#undef	ADJMARG
+#undef	DECRE_CAL
+
+#undef	SXGAIN_LOP
+#undef	SYGAIN_LOP
+#undef	LOOP_NUM
+#undef	LOOP_FREQ
+#undef	LOOP_GAIN
+#undef	GAIN_GAP
+#undef	LOOP_MAX_X
+#undef	LOOP_MIN_X
+#undef	LOOP_MAX_Y
+#undef	LOOP_MIN_Y
+
+#undef	AF_DrvDir
+#undef	AF_RRMD1_TM
+#undef	AF_RRMD1_TI
+#undef	AF_Ft
+
+#undef	ACT_MAX_DRIVE_X
+#undef	ACT_MAX_DRIVE_Y
+#undef	ACT_MIN_DRIVE_X
+#undef	ACT_MIN_DRIVE_Y
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..adc8c0063f934f684994f6686dc4f67babc4175f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_0.h
@@ -0,0 +1,2312 @@
+// Time Stamp : 2019-04-17 22:09:31
+
+//VERNUM [011b0001] [02070002]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			0
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		2
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_1_0_2_2_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_0_2_2_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_0_2_2_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_0_2_2_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_0_2_2_0		0x0498
+#define LC898124EP3_DMB_CheckSum_0_1_0_2_2_0		0xAFC59251
+
+#define LC898124EP3_PMCheckSum_0_1_0_2_2_0		0x000B7E4F
+#define LC898124EP3_PMSize_0_1_0_2_2_0			1969
+
+const unsigned char LC898124EP3_DM_0_1_0_2_2_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x01,
+0xA0, 0x04, 0x02, 0x07, 0x00, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x5a, 0x9d, 0xf7, 0xab,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x84, 0xbd, 0xe2, 0xd3,
+0xA1, 0x60, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x64, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x05, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x05,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xc5, 0x41, 0xd3, 0x39,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3d, 0x33, 0x66, 0xff,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xc5, 0x41, 0xd3, 0x39,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3d, 0x33, 0x66, 0xff,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x91, 0x9e,
+0xA4, 0xCC, 0x00, 0x00, 0x06, 0x99,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x01, 0x14,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0x9a,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0b, 0x7c,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x58,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x36,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0xcc, 0xcc, 0xd0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0xA8, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0xAC, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xB8, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xBC, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xC0, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xC4, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xCC, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_1_0_2_2_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xba, 0x47,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xbd, 0xc7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x84, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x62, 0xfe, 0x22,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xc9,
+0x5c, 0x81, 0x00, 0x40, 0x0a,
+0x54, 0x4b, 0xaa, 0xc0, 0x61,
+0x5c, 0x10, 0xf0, 0x40, 0x49,
+0x5c, 0x02, 0xf9, 0xc1, 0x00,
+0x5c, 0x00, 0x68, 0x00, 0x48,
+0x80, 0x04, 0x88, 0x02, 0xc8,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0xb0, 0x62, 0x08, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x80, 0x05, 0x08, 0x40, 0x50,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4a, 0x80,
+0x66, 0x00, 0x00, 0xf3, 0x60,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x76, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x00, 0xc1, 0x00,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x63, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xc6, 0x60,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4d, 0x00, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x39, 0x06, 0x80, 0x00,
+0x06, 0x32, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x09, 0x82, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x2d, 0x16, 0x60, 0x00,
+0x0c, 0xe4, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc2, 0x87,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0xc3, 0x20,
+0x66, 0x00, 0x00, 0xbd, 0xe0,
+0x66, 0x00, 0x00, 0x6d, 0x40,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x74, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6b, 0xc0,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4b, 0xa8,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4b, 0xa8,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4b, 0xa8,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x08, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x00,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x00,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x63, 0x60,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x63, 0x60,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x65, 0x88,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x63, 0x20,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x0a, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x98, 0x20,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x67, 0x48,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x64, 0x48,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x82, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x82, 0x80,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7e, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xe4, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x3d, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x3d, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x97, 0x68,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xad, 0x88,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xad, 0x88,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0xa7, 0x48,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x0a, 0x74, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x0a, 0x78, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xab, 0x28,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0x3c, 0x20,
+0x5c, 0x0b, 0x62, 0xc0, 0x20,
+0x5c, 0x00, 0x30, 0x40, 0x09,
+0x51, 0x87, 0x7a, 0x04, 0x41,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x51, 0x8b, 0xc0, 0x08, 0x09,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0d, 0xa2, 0x28, 0x48, 0x08,
+0xa0, 0x06, 0x08, 0x10, 0x50,
+0x6c, 0x40, 0x01, 0x98, 0x49,
+0x6c, 0x40, 0x01, 0x9a, 0x49,
+0x6c, 0x40, 0x02, 0x2c, 0x4b,
+0x6c, 0x40, 0x01, 0x06, 0x48,
+0x6c, 0x40, 0x01, 0x08, 0x48,
+0x94, 0x24, 0x64, 0x60, 0xa4,
+0x05, 0x07, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x67,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x50, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0x95, 0x20, 0xd5,
+0xb0, 0x40, 0x58, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x1d, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xcb,
+0x80, 0x1c, 0x98, 0x00, 0x7a,
+0x84, 0x05, 0x15, 0xc8, 0x71,
+0x00, 0x15, 0x28, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x1c, 0x78, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xc9,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8c, 0xb8, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0xa8, 0x01, 0x49,
+0x5c, 0x1a, 0x3a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xc9,
+0x5c, 0x87, 0x18, 0x01, 0xcb,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8b, 0x18, 0x03, 0xd0,
+0x80, 0x17, 0xa8, 0x00, 0x7a,
+0xb0, 0x47, 0xd8, 0x01, 0xc9,
+0x80, 0x2c, 0x8a, 0x00, 0x01,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8c, 0x10, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x15, 0x08, 0x02, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x01, 0xe0, 0x02, 0xc8,
+0x5c, 0x82, 0x08, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xe0, 0x00, 0x7a,
+0xb0, 0x51, 0x68, 0x01, 0xca,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x03, 0x41, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x6b, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0x68, 0x00, 0x01, 0xc5, 0x24,
+0x6c, 0x00, 0x03, 0xa0, 0x09,
+0x5b, 0x0a, 0x22, 0xbf, 0x90,
+0x5c, 0x81, 0x00, 0x60, 0x09,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0xa4, 0x10, 0x48, 0x40, 0x0a,
+0x5b, 0x0c, 0x38, 0x20, 0x49,
+0x82, 0x04, 0x88, 0x20, 0x4b,
+0x82, 0x04, 0x88, 0x20, 0x4a,
+0x86, 0x04, 0x98, 0x81, 0xf6,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x17, 0x00, 0x86, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x31, 0x80, 0xa8, 0x80, 0x4a,
+0x88, 0x0c, 0x98, 0x81, 0x48,
+0x66, 0x00, 0x40, 0xfd, 0x68,
+0x40, 0x00, 0x02, 0x24, 0xa0,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x39, 0x06, 0x06, 0x80, 0x00,
+0x1c, 0x52, 0x18, 0x02, 0x08,
+0x86, 0x00, 0x95, 0x70, 0xb0,
+0x00, 0xa0, 0x98, 0x60, 0x88,
+0x57, 0x09, 0x50, 0x82, 0xe0,
+0x88, 0x24, 0x28, 0x83, 0x61,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x6e, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0xe2, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x55, 0x01, 0x28, 0x83, 0x20,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x71, 0x24,
+0x66, 0x00, 0x00, 0xf1, 0x48,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x2a, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x73, 0x24,
+0x66, 0x00, 0x00, 0xf1, 0x48,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x32, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x10, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x13,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x03, 0x01, 0x80,
+0xbc, 0x03, 0xa5, 0x50, 0x1c,
+0x08, 0x00, 0x9b, 0x00, 0x08,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x0f,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x38,
+0xbc, 0x03, 0x13, 0x20, 0x00,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x04, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x08,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4d, 0x40, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xd8, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4d, 0x84, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x6b, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0xc3, 0xa4,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x3f, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x33, 0xfa, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..588bcd9b1043e2c03ab1c6faf6cda1334a9ebbe5
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_0_2_2_1.h
@@ -0,0 +1,1986 @@
+// Time Stamp : 2019-04-17 22:08:57
+
+//VERNUM [011b0001] [02070002]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			0
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		2
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_1_0_2_2_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_0_2_2_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_0_2_2_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_0_2_2_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_0_2_2_1		0x0470
+#define LC898124EP3_DMB_CheckSum_0_1_0_2_2_1		0x67A5E572
+
+#define LC898124EP3_PMCheckSum_0_1_0_2_2_1		0x0009797F
+#define LC898124EP3_PMSize_0_1_0_2_2_1			1653
+
+const unsigned char LC898124EP3_DM_0_1_0_2_2_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x01,
+0xA0, 0x04, 0x02, 0x07, 0x00, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x5a, 0x9d, 0xf7, 0xab,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x84, 0xbd, 0xe2, 0xd3,
+0xA1, 0x60, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x64, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x05, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x05,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x91, 0x9e,
+0xA4, 0xCC, 0x00, 0x00, 0x06, 0x99,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x01, 0x14,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0x8e,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x06, 0x70,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x4c,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x2a,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0xcc, 0xcc, 0xd0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_1_0_2_2_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x69, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x6d, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x33, 0x48,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x62, 0xfe, 0x22,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xc9,
+0x5c, 0x81, 0x00, 0x40, 0x0a,
+0x54, 0x4b, 0xaa, 0xc0, 0x61,
+0x5c, 0x10, 0xf0, 0x40, 0x49,
+0x5c, 0x02, 0xf9, 0xc1, 0x00,
+0x5c, 0x00, 0x68, 0x00, 0x48,
+0x80, 0x04, 0x88, 0x02, 0xc8,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0xb0, 0x62, 0x08, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x80, 0x05, 0x08, 0x40, 0x50,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1a, 0xe0,
+0x66, 0x00, 0x00, 0x80, 0xa0,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x6a, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x00, 0x70, 0x40,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x65, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x75, 0xa0,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xd0, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x96, 0x20,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x08, 0x81, 0x60,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0x3a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x39, 0x06, 0x80, 0x00,
+0x06, 0x5a, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x06, 0x72, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x2d, 0x16, 0x60, 0x00,
+0x07, 0xd8, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc2, 0x87,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0x72, 0x60,
+0x66, 0x00, 0x00, 0x6d, 0x20,
+0x66, 0x00, 0x00, 0x1c, 0x00,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x6c, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x68, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x65, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6a, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x67, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x31, 0xc0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x31, 0xc0,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2d, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xd4, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0d, 0x1a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xfa, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xfa, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x46, 0xa8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x5c, 0xc8,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x5c, 0xc8,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x56, 0x88,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x05, 0x68, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x05, 0x6c, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x5a, 0x68,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0x3c, 0x20,
+0x5c, 0x0b, 0x62, 0xc0, 0x20,
+0x5c, 0x00, 0x30, 0x40, 0x09,
+0x51, 0x87, 0x7a, 0x04, 0x41,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x51, 0x8b, 0xc0, 0x08, 0x09,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0d, 0xa2, 0x28, 0x48, 0x08,
+0xa0, 0x06, 0x08, 0x10, 0x50,
+0x6c, 0x40, 0x01, 0x98, 0x49,
+0x6c, 0x40, 0x01, 0x9a, 0x49,
+0x6c, 0x40, 0x02, 0x2c, 0x4b,
+0x6c, 0x40, 0x01, 0x06, 0x48,
+0x6c, 0x40, 0x01, 0x08, 0x48,
+0x94, 0x24, 0x64, 0x60, 0xa4,
+0x05, 0x07, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x67,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x50, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0x95, 0x20, 0xd5,
+0xb0, 0x40, 0x58, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x1d, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xcb,
+0x80, 0x1c, 0x98, 0x00, 0x7a,
+0x84, 0x05, 0x15, 0xc8, 0x71,
+0x00, 0x15, 0x28, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x1c, 0x78, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xc9,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8c, 0xb8, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0xa8, 0x01, 0x49,
+0x5c, 0x1a, 0x3a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xc9,
+0x5c, 0x87, 0x18, 0x01, 0xcb,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8b, 0x18, 0x03, 0xd0,
+0x80, 0x17, 0xa8, 0x00, 0x7a,
+0xb0, 0x47, 0xd8, 0x01, 0xc9,
+0x80, 0x2c, 0x8a, 0x00, 0x01,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8c, 0x10, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x15, 0x08, 0x02, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x01, 0xe0, 0x02, 0xc8,
+0x5c, 0x82, 0x08, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xe0, 0x00, 0x7a,
+0xb0, 0x51, 0x68, 0x01, 0xca,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xfe, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xff, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x02, 0x01, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xfc, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1f, 0xca, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x83, 0x68,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x86, 0x08,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x87, 0xa0,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xb2, 0x28,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0c, 0x62, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xb2, 0x28,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0c, 0x62, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x5b, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x26, 0x42, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x08, 0xa0, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x27, 0x8a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x08, 0xca, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x81, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x09, 0x08, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x89, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xba, 0x08,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x29, 0x22, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xbf, 0x08,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x9a, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x09, 0x16, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0xa2, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x09, 0x24, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0xaa, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xba, 0x08,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x2b, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xbf, 0x08,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0xbc, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x25, 0xba, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x09, 0x32, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0xc4, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x40, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x5b, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xb9, 0x28,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xb5, 0x88,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xc1, 0xe0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xc1, 0xe0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0b, 0xf0, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xc2, 0x80,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xc2, 0x88,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xc2, 0x88,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xc2, 0x88,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xc2, 0x80,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xc2, 0x88,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xc2, 0x80,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xc2, 0x88,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..204637814350b756d24245d9e4698901d5c43256
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_0.h
@@ -0,0 +1,2283 @@
+// Time Stamp : 2019-04-15 16:56:33
+
+//VERNUM [011b001c] [00020202]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_1_2_2_0_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_2_2_0_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_2_2_0_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_2_2_0_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_2_2_0_0		0x0498
+#define LC898124EP3_DMB_CheckSum_0_1_2_2_0_0		0x0658C874
+
+#define LC898124EP3_PMCheckSum_0_1_2_2_0_0		0x000B653F
+#define LC898124EP3_PMSize_0_1_2_2_0_0			1940
+
+const unsigned char LC898124EP3_DM_0_1_2_2_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x00, 0x02, 0x02, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0xdd, 0x95, 0x8b,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xc7, 0x22, 0xaf, 0x7e,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3b, 0x24, 0x01, 0x8b,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xc7, 0x22, 0xaf, 0x7e,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3b, 0x24, 0x01, 0x8b,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0xb4,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0b, 0x96,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x72,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x50,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0xA8, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0xAC, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xB8, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xBC, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xC0, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xC4, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xCC, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_1_2_2_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xbb, 0xe7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xbf, 0x67,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x85, 0xa8,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x10, 0xf2, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x0a, 0x2b, 0x06, 0x20,
+0x5c, 0x00, 0x68, 0x03, 0x49,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x00, 0x0d, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0x84, 0x05, 0x0a, 0x00, 0x80,
+0xb0, 0x80, 0x86, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x00, 0x50,
+0x84, 0x05, 0x0a, 0x20, 0x20,
+0x86, 0x04, 0x88, 0x00, 0x49,
+0x80, 0x04, 0xaa, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x16, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x80, 0x24, 0xaa, 0xc4, 0x00,
+0x84, 0x80, 0x05, 0x24, 0xe3,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x30, 0x60, 0x78, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4c, 0x20,
+0x66, 0x00, 0x00, 0xef, 0xc0,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x16, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x18, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x90, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x69, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xc2, 0xc0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4d, 0x00, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0xd2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0x9a, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x09, 0xea, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x0c, 0xaa, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x8b,
+0x80, 0x00, 0xa8, 0x00, 0x00,
+0x68, 0x00, 0x01, 0x88, 0x24,
+0x80, 0x10, 0x18, 0x22, 0x52,
+0xac, 0x7e, 0x28, 0x61, 0xcb,
+0x80, 0x15, 0x36, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x0b,
+0x52, 0x4b, 0xe8, 0x20, 0xc8,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x84, 0x8d, 0x08, 0x62, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0xbf, 0x80,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x0c, 0xaa, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0xca, 0xa8,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x6e, 0xe0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x6a, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6d, 0x60,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x0f, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x60, 0xa0,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x60, 0xa0,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x65, 0x00,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x65, 0x00,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x67, 0x28,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x69, 0xa0,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x10, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x9e, 0xa0,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x68, 0xe8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x65, 0xe8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x84, 0x20,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x84, 0x20,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7f, 0xe8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xfe, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0xb2, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x44, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x44, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x99, 0x08,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0xa8, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x0a, 0x8e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x0a, 0x92, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xac, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x67,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x50, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0x95, 0x20, 0xd5,
+0xb0, 0x40, 0x58, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x1d, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xcb,
+0x80, 0x1c, 0x98, 0x00, 0x7a,
+0x84, 0x05, 0x15, 0xc8, 0x71,
+0x00, 0x15, 0x28, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x1c, 0x78, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xc9,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8c, 0xb8, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0xa8, 0x01, 0x49,
+0x5c, 0x1a, 0x3a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xc9,
+0x5c, 0x87, 0x18, 0x01, 0xcb,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8b, 0x18, 0x03, 0xd0,
+0x80, 0x17, 0xa8, 0x00, 0x7a,
+0xb0, 0x47, 0xd8, 0x01, 0xc9,
+0x80, 0x2c, 0x8a, 0x00, 0x01,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8c, 0x10, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x15, 0x08, 0x02, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x01, 0xe0, 0x02, 0xc8,
+0x5c, 0x82, 0x08, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xe0, 0x00, 0x7a,
+0xb0, 0x51, 0x68, 0x01, 0xca,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x03, 0x32, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x5c, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0x68, 0x00, 0x01, 0xc5, 0x24,
+0x6c, 0x00, 0x03, 0xa0, 0x09,
+0x5b, 0x0a, 0x22, 0xbf, 0x90,
+0x5c, 0x81, 0x00, 0x60, 0x09,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0xa4, 0x10, 0x48, 0x40, 0x0a,
+0x5b, 0x0c, 0x38, 0x20, 0x49,
+0x82, 0x04, 0x88, 0x20, 0x4b,
+0x82, 0x04, 0x88, 0x20, 0x4a,
+0x86, 0x04, 0x98, 0x81, 0xf6,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x17, 0x00, 0x86, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x31, 0x80, 0xa8, 0x80, 0x4a,
+0x88, 0x0c, 0x98, 0x81, 0x48,
+0x66, 0x00, 0x40, 0xfd, 0x68,
+0x40, 0x00, 0x02, 0x24, 0xa0,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x39, 0x06, 0x06, 0x80, 0x00,
+0x1c, 0x52, 0x18, 0x02, 0x08,
+0x86, 0x00, 0x95, 0x70, 0xb0,
+0x00, 0xa0, 0x98, 0x60, 0x88,
+0x57, 0x09, 0x50, 0x82, 0xe0,
+0x88, 0x24, 0x28, 0x83, 0x61,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x6e, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0xe2, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x55, 0x01, 0x28, 0x83, 0x20,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x71, 0x24,
+0x66, 0x00, 0x00, 0xed, 0xa8,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x2a, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x73, 0x24,
+0x66, 0x00, 0x00, 0xed, 0xa8,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x32, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x10, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x13,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x03, 0x01, 0x80,
+0xbc, 0x03, 0xa5, 0x50, 0x1c,
+0x08, 0x00, 0x9b, 0x00, 0x08,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x0f,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x38,
+0xbc, 0x03, 0x13, 0x20, 0x00,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x04, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x08,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4d, 0x40, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xd8, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4d, 0x84, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x6b, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0xb5, 0x24,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x31, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x33, 0x12, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..ccc7288a214157dc6583568f9393003c2d19edee
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_2_0_1.h
@@ -0,0 +1,1957 @@
+// Time Stamp : 2019-04-15 16:54:55
+
+//VERNUM [011b001c] [00020202]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_1_2_2_0_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_2_2_0_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_2_2_0_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_2_2_0_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_2_2_0_1		0x0470
+#define LC898124EP3_DMB_CheckSum_0_1_2_2_0_1		0xBE962DF3
+
+#define LC898124EP3_PMCheckSum_0_1_2_2_0_1		0x000960EA
+#define LC898124EP3_PMSize_0_1_2_2_0_1			1624
+
+const unsigned char LC898124EP3_DM_0_1_2_2_0_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x00, 0x02, 0x02, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0xdd, 0x95, 0x8b,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0xa8,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x06, 0x8a,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x66,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x44,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_1_2_2_0_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x6b, 0x27,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x6e, 0xa7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x34, 0xe8,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x10, 0xf2, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x0a, 0x2b, 0x06, 0x20,
+0x5c, 0x00, 0x68, 0x03, 0x49,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x00, 0x0d, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0x84, 0x05, 0x0a, 0x00, 0x80,
+0xb0, 0x80, 0x86, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x00, 0x50,
+0x84, 0x05, 0x0a, 0x20, 0x20,
+0x86, 0x04, 0x88, 0x00, 0x49,
+0x80, 0x04, 0xaa, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x16, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x80, 0x24, 0xaa, 0xc4, 0x00,
+0x84, 0x80, 0x05, 0x24, 0xe3,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x30, 0x60, 0x78, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1c, 0x80,
+0x66, 0x00, 0x00, 0x7d, 0x00,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x16, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x18, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x84, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x72, 0x00,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xd0, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x92, 0x80,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0xa2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0xc2, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x06, 0xda, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x07, 0x9e, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x8b,
+0x80, 0x00, 0xa8, 0x00, 0x00,
+0x68, 0x00, 0x01, 0x88, 0x24,
+0x80, 0x10, 0x18, 0x22, 0x52,
+0xac, 0x7e, 0x28, 0x61, 0xcb,
+0x80, 0x15, 0x36, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x0b,
+0x52, 0x4b, 0xe8, 0x20, 0xc8,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x84, 0x8d, 0x08, 0x62, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0x6e, 0xc0,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x07, 0x9e, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0x79, 0xe8,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x1d, 0xa0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x62, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x6f, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x70, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6d, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x33, 0x60,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x33, 0x60,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2e, 0xe8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xee, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0d, 0x82, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x01, 0x01, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x01, 0x01, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x5e, 0x68,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x5e, 0x68,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x58, 0x28,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x05, 0x82, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x05, 0x86, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x5c, 0x08,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x67,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x50, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0x95, 0x20, 0xd5,
+0xb0, 0x40, 0x58, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x1d, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xcb,
+0x80, 0x1c, 0x98, 0x00, 0x7a,
+0x84, 0x05, 0x15, 0xc8, 0x71,
+0x00, 0x15, 0x28, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x1c, 0x78, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xc9,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8c, 0xb8, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x0b,
+0x25, 0x9b, 0x8b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0xa8, 0x01, 0x49,
+0x5c, 0x1a, 0x3a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xc9,
+0x5c, 0x87, 0x18, 0x01, 0xcb,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8b, 0x18, 0x03, 0xd0,
+0x80, 0x17, 0xa8, 0x00, 0x7a,
+0xb0, 0x47, 0xd8, 0x01, 0xc9,
+0x80, 0x2c, 0x8a, 0x00, 0x01,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x09,
+0x25, 0x9a, 0x8b, 0xff, 0xc1,
+0x5c, 0x8c, 0x10, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x15, 0x08, 0x02, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x01, 0xe0, 0x02, 0xc8,
+0x5c, 0x82, 0x08, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xe0, 0x00, 0x7a,
+0xb0, 0x51, 0x68, 0x01, 0xca,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xef, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xf1, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xf2, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1e, 0xe2, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x7f, 0xc8,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x82, 0x68,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x84, 0x00,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xae, 0x88,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0c, 0x28, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xae, 0x88,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0c, 0x28, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x4d, 0x2c,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x25, 0x5a, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x08, 0x66, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x26, 0xa2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x08, 0x90, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x72, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xce, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x7a, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb6, 0x68,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x28, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xbb, 0x68,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x8c, 0x23,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xdc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x94, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xea, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x9c, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb6, 0x68,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x2a, 0x52, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xbb, 0x68,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0xad, 0xa3,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0xd2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xf8, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0xb5, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x06, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x4d, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xb5, 0x88,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xb1, 0xe8,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xbe, 0x40,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xbe, 0x40,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0b, 0xb6, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbe, 0xe0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xbe, 0xe8,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xbe, 0xe8,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xbe, 0xe8,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbe, 0xe0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xbe, 0xe8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbe, 0xe0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xbe, 0xe8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..7169551c22630f810166f18ca8d61ec8064b732e
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_0.h
@@ -0,0 +1,2261 @@
+// Time Stamp : 2019-04-15 16:55:51
+
+//VERNUM [011b001c] [00020203]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_1_2_3_0_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_2_3_0_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_2_3_0_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_2_3_0_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_2_3_0_0		0x0498
+#define LC898124EP3_DMB_CheckSum_0_1_2_3_0_0		0xEB869D1B
+
+#define LC898124EP3_PMCheckSum_0_1_2_3_0_0		0x000B43E8
+#define LC898124EP3_PMSize_0_1_2_3_0_0			1918
+
+const unsigned char LC898124EP3_DM_0_1_2_3_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x00, 0x02, 0x02, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0x80, 0xc5, 0x34, 0x72, 0xdb,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3d, 0x26, 0x06, 0xa1,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0xE0, 0xc5, 0x34, 0x72, 0xdb,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3d, 0x26, 0x06, 0xa1,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0xb4,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0b, 0x96,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x72,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x50,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0xA8, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0xAC, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xB8, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xBC, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xC0, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xC4, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xCC, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_1_2_3_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xbb, 0xe7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xbf, 0x67,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x85, 0xa8,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x03,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x87, 0x12, 0x03, 0x20,
+0x5c, 0x10, 0xf0, 0x40, 0x0b,
+0x52, 0x0b, 0xeb, 0x06, 0x27,
+0x5c, 0x02, 0xc0, 0x03, 0xc9,
+0x5c, 0x00, 0x68, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x0f, 0xa8, 0x03, 0x7a,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x04, 0xba, 0x02, 0x20,
+0x84, 0x00, 0xb6, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x5d,
+0x31, 0xdf, 0x75, 0xc0, 0xe1,
+0x00, 0x0d, 0x26, 0xc6, 0x80,
+0x80, 0x85, 0x05, 0xc0, 0xdb,
+0x84, 0x04, 0xba, 0x00, 0x80,
+0xb0, 0x80, 0x86, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x00, 0x50,
+0x84, 0x05, 0x0a, 0x20, 0x20,
+0x86, 0x04, 0x88, 0x00, 0x49,
+0x80, 0x04, 0xaa, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x16, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x80, 0x24, 0xaa, 0xc4, 0x00,
+0x84, 0x80, 0x05, 0x24, 0xe3,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x30, 0x60, 0x78, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4c, 0x20,
+0x66, 0x00, 0x00, 0xed, 0x00,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x16, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x18, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x90, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x69, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xc2, 0xc0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4d, 0x00, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0xd2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0x9a, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x09, 0xea, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x0c, 0x7c, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x87, 0x08, 0x40, 0x0a,
+0x5c, 0x00, 0x58, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x80,
+0x80, 0x00, 0xb8, 0x00, 0x02,
+0x80, 0x10, 0x16, 0x80, 0x00,
+0x18, 0xe2, 0x4a, 0xc7, 0xe2,
+0x82, 0x2d, 0x08, 0x01, 0x53,
+0x86, 0x0d, 0x26, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x00,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x52, 0x4a, 0x28, 0x20, 0x4b,
+0x84, 0x8c, 0x88, 0x61, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0xbf, 0x80,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x0c, 0x7c, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0xc7, 0xc8,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x6e, 0xe0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x6a, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6d, 0x60,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4d, 0x48,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x0f, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x60, 0xa0,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x60, 0xa0,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x65, 0x00,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x65, 0x00,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x67, 0x28,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x69, 0xa0,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x10, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x9e, 0xa0,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x68, 0xe8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x65, 0xe8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x84, 0x20,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x84, 0x20,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7f, 0xe8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xfe, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0xb2, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x44, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x44, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x99, 0x08,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0xa8, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x0a, 0x8e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x0a, 0x92, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xac, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x65,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x00, 0xd0, 0x48, 0x00,
+0x52, 0x4a, 0x02, 0x0b, 0x22,
+0x5c, 0x00, 0x40, 0x48, 0x50,
+0xa0, 0x0e, 0x08, 0x50, 0x0b,
+0x52, 0x0d, 0xcb, 0x04, 0xc7,
+0x85, 0x05, 0x10, 0x00, 0x00,
+0x84, 0x80, 0x12, 0x41, 0x49,
+0x84, 0x85, 0x15, 0xc8, 0xb1,
+0x00, 0x34, 0x88, 0x02, 0xc9,
+0x5c, 0x88, 0x18, 0x01, 0xfa,
+0x80, 0x07, 0xa8, 0x40, 0x4b,
+0x80, 0x17, 0xa8, 0x03, 0xd2,
+0xa0, 0x00, 0x18, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x04, 0x50, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x0d, 0x08, 0x03, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x18, 0x01, 0xd0,
+0x5c, 0x02, 0x20, 0x03, 0xc8,
+0x5c, 0x82, 0x08, 0x02, 0xc8,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xa2, 0x00, 0x01,
+0x80, 0x07, 0xab, 0x04, 0x66,
+0x84, 0x8c, 0xa8, 0x01, 0x7a,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x04, 0x66,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x70, 0x40, 0x7a,
+0xa0, 0x16, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x03, 0x27, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x51, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0x68, 0x00, 0x01, 0xc5, 0x24,
+0x6c, 0x00, 0x03, 0xa0, 0x09,
+0x5b, 0x0a, 0x22, 0xbf, 0x90,
+0x5c, 0x81, 0x00, 0x60, 0x09,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0xa4, 0x10, 0x48, 0x40, 0x0a,
+0x5b, 0x0c, 0x38, 0x20, 0x49,
+0x82, 0x04, 0x88, 0x20, 0x4b,
+0x82, 0x04, 0x88, 0x20, 0x4a,
+0x86, 0x04, 0x98, 0x81, 0xf6,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x17, 0x00, 0x86, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x31, 0x80, 0xa8, 0x80, 0x4a,
+0x88, 0x0c, 0x98, 0x81, 0x48,
+0x66, 0x00, 0x40, 0xfd, 0x68,
+0x40, 0x00, 0x02, 0x24, 0xa0,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x39, 0x06, 0x06, 0x80, 0x00,
+0x1c, 0x52, 0x18, 0x02, 0x08,
+0x86, 0x00, 0x95, 0x70, 0xb0,
+0x00, 0xa0, 0x98, 0x60, 0x88,
+0x57, 0x09, 0x50, 0x82, 0xe0,
+0x88, 0x24, 0x28, 0x83, 0x61,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x6e, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0xe2, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x55, 0x01, 0x28, 0x83, 0x20,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x71, 0x24,
+0x66, 0x00, 0x00, 0xea, 0xe8,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x2a, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x73, 0x24,
+0x66, 0x00, 0x00, 0xea, 0xe8,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x32, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x10, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x13,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x03, 0x01, 0x80,
+0xbc, 0x03, 0xa5, 0x50, 0x1c,
+0x08, 0x00, 0x9b, 0x00, 0x08,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x0f,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x38,
+0xbc, 0x03, 0x13, 0x20, 0x00,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x04, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x08,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4d, 0x40, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xd8, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4d, 0x84, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x6b, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0xaa, 0x24,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x26, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x32, 0x62, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..b1e3f63de0f514b89422c016844ecb0853466c79
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_2_3_0_1.h
@@ -0,0 +1,1935 @@
+// Time Stamp : 2019-04-15 16:54:18
+
+//VERNUM [011b001c] [00020203]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_1_2_3_0_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_2_3_0_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_2_3_0_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_2_3_0_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_2_3_0_1		0x0470
+#define LC898124EP3_DMB_CheckSum_0_1_2_3_0_1		0xB619BBDC
+
+#define LC898124EP3_PMCheckSum_0_1_2_3_0_1		0x000934A0
+#define LC898124EP3_PMSize_0_1_2_3_0_1			1602
+
+const unsigned char LC898124EP3_DM_0_1_2_3_0_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x00, 0x02, 0x02, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0xa8,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x06, 0x8a,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x66,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x44,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_1_2_3_0_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x6b, 0x27,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x6e, 0xa7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x34, 0xe8,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x03,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x87, 0x12, 0x03, 0x20,
+0x5c, 0x10, 0xf0, 0x40, 0x0b,
+0x52, 0x0b, 0xeb, 0x06, 0x27,
+0x5c, 0x02, 0xc0, 0x03, 0xc9,
+0x5c, 0x00, 0x68, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x0f, 0xa8, 0x03, 0x7a,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x04, 0xba, 0x02, 0x20,
+0x84, 0x00, 0xb6, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x5d,
+0x31, 0xdf, 0x75, 0xc0, 0xe1,
+0x00, 0x0d, 0x26, 0xc6, 0x80,
+0x80, 0x85, 0x05, 0xc0, 0xdb,
+0x84, 0x04, 0xba, 0x00, 0x80,
+0xb0, 0x80, 0x86, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x00, 0x50,
+0x84, 0x05, 0x0a, 0x20, 0x20,
+0x86, 0x04, 0x88, 0x00, 0x49,
+0x80, 0x04, 0xaa, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x16, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x80, 0x24, 0xaa, 0xc4, 0x00,
+0x84, 0x80, 0x05, 0x24, 0xe3,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x30, 0x60, 0x78, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1c, 0x80,
+0x66, 0x00, 0x00, 0x7a, 0x40,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x16, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x18, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x84, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x72, 0x00,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xd0, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x8f, 0xc0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0xa2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0xc2, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x06, 0xda, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x07, 0x70, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x87, 0x08, 0x40, 0x0a,
+0x5c, 0x00, 0x58, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x80,
+0x80, 0x00, 0xb8, 0x00, 0x02,
+0x80, 0x10, 0x16, 0x80, 0x00,
+0x18, 0xe2, 0x4a, 0xc7, 0xe2,
+0x82, 0x2d, 0x08, 0x01, 0x53,
+0x86, 0x0d, 0x26, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x00,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x52, 0x4a, 0x28, 0x20, 0x4b,
+0x84, 0x8c, 0x88, 0x61, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0x6e, 0xc0,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x07, 0x70, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0x77, 0x08,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x1d, 0xa0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x62, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x6f, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x70, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6d, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x33, 0x60,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x33, 0x60,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2e, 0xe8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xee, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0d, 0x82, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x01, 0x01, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x01, 0x01, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x5e, 0x68,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x5e, 0x68,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x58, 0x28,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x05, 0x82, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x05, 0x86, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x5c, 0x08,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x65,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x00, 0xd0, 0x48, 0x00,
+0x52, 0x4a, 0x02, 0x0b, 0x22,
+0x5c, 0x00, 0x40, 0x48, 0x50,
+0xa0, 0x0e, 0x08, 0x50, 0x0b,
+0x52, 0x0d, 0xcb, 0x04, 0xc7,
+0x85, 0x05, 0x10, 0x00, 0x00,
+0x84, 0x80, 0x12, 0x41, 0x49,
+0x84, 0x85, 0x15, 0xc8, 0xb1,
+0x00, 0x34, 0x88, 0x02, 0xc9,
+0x5c, 0x88, 0x18, 0x01, 0xfa,
+0x80, 0x07, 0xa8, 0x40, 0x4b,
+0x80, 0x17, 0xa8, 0x03, 0xd2,
+0xa0, 0x00, 0x18, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x04, 0x50, 0x48, 0xd0,
+0xa0, 0x4c, 0x08, 0x00, 0x09,
+0x80, 0x0d, 0x08, 0x03, 0xd0,
+0x80, 0x05, 0x26, 0xc4, 0x00,
+0x4d, 0x24, 0x90, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x18, 0x01, 0xd0,
+0x5c, 0x02, 0x20, 0x03, 0xc8,
+0x5c, 0x82, 0x08, 0x02, 0xc8,
+0x5c, 0x88, 0x08, 0x00, 0xfa,
+0x5c, 0x03, 0xa2, 0x00, 0x01,
+0x80, 0x07, 0xab, 0x04, 0x66,
+0x84, 0x8c, 0xa8, 0x01, 0x7a,
+0x46, 0x0a, 0x40, 0x02, 0xc8,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x04, 0x66,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x70, 0x40, 0x7a,
+0xa0, 0x16, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x01, 0xe4, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xe7, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xe3, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1e, 0x32, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x7d, 0x08,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x7f, 0xa8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x81, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xab, 0xc8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xfc, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xab, 0xc8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xfc, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x42, 0x2c,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x24, 0xaa, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x08, 0x3a, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x25, 0xf2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x08, 0x64, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x67, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xa2, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x6f, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb3, 0xa8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x27, 0x8a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb8, 0xa8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x81, 0x23,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xb0, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x89, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xbe, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x91, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb3, 0xa8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x29, 0xa2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb8, 0xa8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0xa2, 0xa3,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x24, 0x22, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0xaa, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x08, 0xda, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x42, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xb2, 0xc8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xbb, 0x80,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xbb, 0x80,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0b, 0x8a, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbc, 0x20,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xbc, 0x28,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xbc, 0x28,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xbc, 0x28,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbc, 0x20,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xbc, 0x28,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xbc, 0x20,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xbc, 0x28,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..04050884cdfb40d34b9f6e0d34b26b44e36e6e44
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_0.h
@@ -0,0 +1,2239 @@
+// Time Stamp : 2019-04-15 16:56:12
+
+//VERNUM [011b001c] [01020302]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_1_3_2_1_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_3_2_1_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_3_2_1_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_3_2_1_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_3_2_1_0		0x0498
+#define LC898124EP3_DMB_CheckSum_0_1_3_2_1_0		0xD0CEA0CC
+
+#define LC898124EP3_PMCheckSum_0_1_3_2_1_0		0x000B1911
+#define LC898124EP3_PMSize_0_1_3_2_1_0			1896
+
+const unsigned char LC898124EP3_DM_0_1_3_2_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x01, 0x02, 0x03, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x84, 0x86, 0xb5, 0x9b,
+0xA0, 0xB8, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xBC, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x84, 0x86, 0xb5, 0x9b,
+0xA1, 0x54, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x58, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA1, 0x5C, 0x8a, 0xab, 0x37, 0x41,
+0xA1, 0x60, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x64, 0x76, 0x26, 0xe0, 0xaf,
+0xA1, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xc4, 0x9c, 0xc2, 0x19,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3d, 0xaa, 0x73, 0x5b,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xc8, 0xa8, 0xde, 0x66,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x39, 0x80, 0xda, 0xd5,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x44, 0x7f, 0xf4, 0x95, 0x03,
+0xA3, 0x48, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0xa2,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0b, 0x84,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x60,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x3e,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0xA8, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0xAC, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xB8, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xBC, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xC0, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xC4, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xCC, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_1_3_2_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xba, 0xc7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xbe, 0x47,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x84, 0x88,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x83, 0x0a, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x4a, 0x2b, 0x06, 0x20,
+0x5c, 0x00, 0x68, 0x03, 0x49,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x40, 0x7a,
+0xa0, 0x10, 0x08, 0x40, 0x7a,
+0xa0, 0x58, 0x05, 0xc0, 0x0b,
+0x00, 0x24, 0xa8, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4b, 0x00,
+0x66, 0x00, 0x00, 0xea, 0x40,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x20, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x22, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x7e, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x65, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xc4, 0xc0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4d, 0x00, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0x8a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x52, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0xc1, 0x80,
+0x66, 0x00, 0x00, 0xbe, 0x60,
+0x66, 0x00, 0x00, 0x6d, 0xc0,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x7e, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6c, 0x40,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x0a, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x80,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x80,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x63, 0xe0,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x63, 0xe0,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x66, 0x08,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x65, 0x20,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x0c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x67, 0xc8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x64, 0xc8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x83, 0x00,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x83, 0x00,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7e, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xec, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0x6a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x3f, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x3f, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x97, 0xe8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0xa7, 0xc8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x0a, 0x7c, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x0a, 0x80, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xab, 0xa8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x22, 0xff, 0xe1,
+0x5c, 0x00, 0x70, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x00, 0x14,
+0x5c, 0x8f, 0x00, 0x40, 0x50,
+0x5c, 0x82, 0x11, 0xc0, 0x80,
+0x5c, 0x84, 0x08, 0x40, 0x4a,
+0xa0, 0x10, 0x08, 0x02, 0x48,
+0x80, 0x17, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x00, 0x20,
+0x84, 0x04, 0xaa, 0x04, 0xc0,
+0x84, 0x00, 0xaa, 0x01, 0xc0,
+0x80, 0x24, 0x88, 0x01, 0x7a,
+0x6c, 0x40, 0x04, 0xd2, 0x4a,
+0x46, 0x0a, 0x40, 0x00, 0xfa,
+0x84, 0x07, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x03, 0x1c, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x46, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0x68, 0x00, 0x01, 0xc5, 0x24,
+0x5c, 0x81, 0x02, 0xbf, 0x90,
+0x86, 0x00, 0x95, 0xb0, 0xa2,
+0xa4, 0x10, 0x46, 0x80, 0x00,
+0x1b, 0xa2, 0x06, 0xc0, 0x00,
+0x3a, 0x00, 0x88, 0x40, 0x0a,
+0x82, 0x04, 0x98, 0x20, 0x48,
+0x5b, 0x0c, 0x30, 0x20, 0x4a,
+0x82, 0x04, 0x88, 0x20, 0x4a,
+0x86, 0x04, 0x98, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x31, 0x80, 0xa6, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x17, 0x00, 0x88, 0x81, 0xc8,
+0x88, 0x14, 0x98, 0x80, 0xca,
+0x66, 0x00, 0x40, 0xfd, 0x68,
+0x40, 0x00, 0x02, 0x24, 0xa0,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x39, 0x06, 0x06, 0x80, 0x00,
+0x1c, 0x52, 0x18, 0x02, 0x08,
+0x86, 0x00, 0x95, 0x70, 0xb0,
+0x00, 0xa0, 0x98, 0x60, 0x88,
+0x57, 0x09, 0x50, 0x82, 0xe0,
+0x88, 0x24, 0x28, 0x83, 0x61,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x6e, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0xe2, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x55, 0x01, 0x28, 0x83, 0x20,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x71, 0x24,
+0x66, 0x00, 0x00, 0xe8, 0x28,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x2a, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x73, 0x24,
+0x66, 0x00, 0x00, 0xe8, 0x28,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x32, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x18, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x13,
+0x88, 0x10, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x03, 0x01, 0x80,
+0xbc, 0x03, 0xa5, 0x50, 0x1c,
+0x08, 0x08, 0x9b, 0x00, 0x08,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x0f,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x38,
+0xbc, 0x03, 0x13, 0x20, 0x00,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x0c, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x88,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4d, 0x40, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xd8, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4d, 0x84, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x6b, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0x9f, 0x24,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x1b, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x31, 0xb2, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..09134b8f10271fb69c80fabddf78682fadaab4d0
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_2_1_1.h
@@ -0,0 +1,1913 @@
+// Time Stamp : 2019-04-15 16:54:36
+
+//VERNUM [011b001c] [01020302]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_1_3_2_1_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_3_2_1_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_3_2_1_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_3_2_1_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_3_2_1_1		0x0470
+#define LC898124EP3_DMB_CheckSum_0_1_3_2_1_1		0x892879AE
+
+#define LC898124EP3_PMCheckSum_0_1_3_2_1_1		0x0009102B
+#define LC898124EP3_PMSize_0_1_3_2_1_1			1580
+
+const unsigned char LC898124EP3_DM_0_1_3_2_1_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x01, 0x02, 0x03, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x84, 0x86, 0xb5, 0x9b,
+0xA0, 0xB8, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xBC, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x84, 0x86, 0xb5, 0x9b,
+0xA1, 0x54, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x58, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA1, 0x5C, 0x8a, 0xab, 0x37, 0x41,
+0xA1, 0x60, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x64, 0x76, 0x26, 0xe0, 0xaf,
+0xA1, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x44, 0x7f, 0xf4, 0x95, 0x03,
+0xA3, 0x48, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0x96,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x06, 0x78,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x54,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x32,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_1_3_2_1_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x6a, 0x07,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x6d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x33, 0xc8,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x83, 0x0a, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x4a, 0x2b, 0x06, 0x20,
+0x5c, 0x00, 0x68, 0x03, 0x49,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x40, 0x7a,
+0xa0, 0x10, 0x08, 0x40, 0x7a,
+0xa0, 0x58, 0x05, 0xc0, 0x0b,
+0x00, 0x24, 0xa8, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1b, 0x60,
+0x66, 0x00, 0x00, 0x77, 0x80,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x20, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x22, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x72, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x67, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x74, 0x00,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xd0, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x8d, 0x00,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x08, 0x81, 0x60,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0x5a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x7a, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0x70, 0xc0,
+0x66, 0x00, 0x00, 0x6d, 0xa0,
+0x66, 0x00, 0x00, 0x1c, 0x80,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x76, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x6a, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x67, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x69, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x32, 0x40,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x32, 0x40,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2d, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xdc, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0d, 0x3a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xfc, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xfc, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x5d, 0x48,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x5d, 0x48,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x57, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x05, 0x70, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x05, 0x74, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x5a, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x22, 0xff, 0xe1,
+0x5c, 0x00, 0x70, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x00, 0x14,
+0x5c, 0x8f, 0x00, 0x40, 0x50,
+0x5c, 0x82, 0x11, 0xc0, 0x80,
+0x5c, 0x84, 0x08, 0x40, 0x4a,
+0xa0, 0x10, 0x08, 0x02, 0x48,
+0x80, 0x17, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x00, 0x20,
+0x84, 0x04, 0xaa, 0x04, 0xc0,
+0x84, 0x00, 0xaa, 0x01, 0xc0,
+0x80, 0x24, 0x88, 0x01, 0x7a,
+0x6c, 0x40, 0x04, 0xd2, 0x4a,
+0x46, 0x0a, 0x40, 0x00, 0xfa,
+0x84, 0x07, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xd9, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xdb, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xdc, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xd8, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1d, 0x82, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x7a, 0x48,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x7c, 0xe8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x7e, 0x80,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa9, 0x08,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xd0, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa9, 0x08,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xd0, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x37, 0x2c,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x23, 0xfa, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x08, 0x0e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x25, 0x42, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x08, 0x38, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x5c, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x76, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x64, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb0, 0xe8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x26, 0xda, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb5, 0xe8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x76, 0x23,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x84, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x7e, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x92, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x86, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb0, 0xe8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x28, 0xf2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb5, 0xe8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x97, 0xa3,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xa0, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x9f, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x08, 0xae, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x37, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xb0, 0x08,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xac, 0x68,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xb8, 0xc0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xb8, 0xc0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0b, 0x5e, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..905279213e0122ff8b2ec63647af8c1b6ef6637e
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_0.h
@@ -0,0 +1,2239 @@
+// Time Stamp : 2019-04-15 16:55:30
+
+//VERNUM [011b001c] [01020303]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_1_3_3_1_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_3_3_1_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_3_3_1_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_3_3_1_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_3_3_1_0		0x0498
+#define LC898124EP3_DMB_CheckSum_0_1_3_3_1_0		0xA37339CD
+
+#define LC898124EP3_PMCheckSum_0_1_3_3_1_0		0x000B1B04
+#define LC898124EP3_PMSize_0_1_3_3_1_0			1896
+
+const unsigned char LC898124EP3_DM_0_1_3_3_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x01, 0x02, 0x03, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x8d, 0xce, 0xbb,
+0xA0, 0xB4, 0x82, 0x69, 0x56, 0x8f,
+0xA0, 0xB8, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xBC, 0x7e, 0x06, 0xe7, 0xb9,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x8d, 0xce, 0xbb,
+0xA1, 0x50, 0x82, 0x69, 0x56, 0x8f,
+0xA1, 0x54, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x58, 0x7e, 0x06, 0xe7, 0xb9,
+0xA1, 0x5C, 0x8c, 0x51, 0x61, 0x95,
+0xA1, 0x60, 0x67, 0xc4, 0xa0, 0x91,
+0xA1, 0x64, 0x74, 0x16, 0x02, 0x25,
+0xA1, 0x74, 0x78, 0xd6, 0xfc, 0x9f,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x65, 0xac, 0x8c, 0x2f,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x04, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x02, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x07,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x3e, 0x70, 0x63, 0xff,
+0xA2, 0x80, 0xc7, 0x78, 0xa1, 0x1f,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3a, 0xf1, 0x80, 0xcb,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0xE0, 0xc6, 0xd8, 0xbb, 0xcd,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3b, 0x63, 0x21, 0x77,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0xa2,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0b, 0x84,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x60,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x3e,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0xA8, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0xAC, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xB8, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xBC, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xC0, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xC4, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xCC, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_1_3_3_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xba, 0xc7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xbe, 0x47,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x84, 0x88,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4b, 0x00,
+0x66, 0x00, 0x00, 0xea, 0x40,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x20, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x22, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x7e, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x65, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xc4, 0xc0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4d, 0x00, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0x8a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x52, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x87, 0x08, 0x40, 0x0a,
+0x5c, 0x00, 0x58, 0x40, 0x88,
+0x86, 0x08, 0x08, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8b,
+0x82, 0x00, 0x28, 0x21, 0x01,
+0x68, 0x00, 0x01, 0x8e, 0x20,
+0xac, 0x7e, 0x28, 0x02, 0xd0,
+0x82, 0x15, 0x38, 0x40, 0xd2,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0x06, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xa2,
+0x80, 0x04, 0xb8, 0x48, 0xc8,
+0x84, 0x15, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0xc1, 0x80,
+0x66, 0x00, 0x00, 0xbe, 0x60,
+0x66, 0x00, 0x00, 0x6d, 0xc0,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x7e, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6c, 0x40,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x28,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x0a, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x80,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0x80,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x63, 0xe0,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x63, 0xe0,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x66, 0x08,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x65, 0x20,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x0c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x67, 0xc8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x64, 0xc8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x83, 0x00,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x83, 0x00,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7e, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xec, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0x6a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x3f, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x3f, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x97, 0xe8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0xa7, 0xc8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x0a, 0x7c, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x0a, 0x80, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xab, 0xa8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x22, 0xff, 0xe1,
+0x5c, 0x00, 0x70, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x00, 0x14,
+0x5c, 0x8f, 0x00, 0x40, 0x50,
+0x5c, 0x82, 0x11, 0xc0, 0x80,
+0x5c, 0x84, 0x08, 0x40, 0x4a,
+0xa0, 0x10, 0x08, 0x02, 0x48,
+0x80, 0x17, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x00, 0x20,
+0x84, 0x04, 0xaa, 0x04, 0xc0,
+0x84, 0x00, 0xaa, 0x01, 0xc0,
+0x80, 0x24, 0x88, 0x01, 0x7a,
+0x6c, 0x40, 0x04, 0xd2, 0x4a,
+0x46, 0x0a, 0x40, 0x00, 0xfa,
+0x84, 0x07, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x03, 0x1c, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x46, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0x68, 0x00, 0x01, 0xc5, 0x24,
+0x5c, 0x81, 0x02, 0xbf, 0x90,
+0x86, 0x00, 0x95, 0xb0, 0xa2,
+0xa4, 0x10, 0x46, 0x80, 0x00,
+0x1b, 0xa2, 0x06, 0xc0, 0x00,
+0x3a, 0x00, 0x88, 0x40, 0x0a,
+0x82, 0x04, 0x98, 0x20, 0x48,
+0x5b, 0x0c, 0x30, 0x20, 0x4a,
+0x82, 0x04, 0x88, 0x20, 0x4a,
+0x86, 0x04, 0x98, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x31, 0x80, 0xa6, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x17, 0x00, 0x88, 0x81, 0xc8,
+0x88, 0x14, 0x98, 0x80, 0xca,
+0x66, 0x00, 0x40, 0xfd, 0x68,
+0x40, 0x00, 0x02, 0x24, 0xa0,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x39, 0x06, 0x06, 0x80, 0x00,
+0x1c, 0x52, 0x18, 0x02, 0x08,
+0x86, 0x00, 0x95, 0x70, 0xb0,
+0x00, 0xa0, 0x98, 0x60, 0x88,
+0x57, 0x09, 0x50, 0x82, 0xe0,
+0x88, 0x24, 0x28, 0x83, 0x61,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x6e, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0xe2, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x55, 0x01, 0x28, 0x83, 0x20,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x71, 0x24,
+0x66, 0x00, 0x00, 0xe8, 0x28,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x2a, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x73, 0x24,
+0x66, 0x00, 0x00, 0xe8, 0x28,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x32, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x18, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x13,
+0x88, 0x10, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x03, 0x01, 0x80,
+0xbc, 0x03, 0xa5, 0x50, 0x1c,
+0x08, 0x08, 0x9b, 0x00, 0x08,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x0f,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x38,
+0xbc, 0x03, 0x13, 0x20, 0x00,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x0c, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x88,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4d, 0x40, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xd8, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4d, 0x84, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x6b, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0x9f, 0x24,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x1b, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x31, 0xb2, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..49db391cfde9fac9d61f1d3cf9c017e599b9e778
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_1_3_3_1_1.h
@@ -0,0 +1,1913 @@
+// Time Stamp : 2019-04-15 16:53:59
+
+//VERNUM [011b001c] [01020303]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_1_3_3_1_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_1_3_3_1_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_1_3_3_1_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_1_3_3_1_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_1_3_3_1_1		0x0470
+#define LC898124EP3_DMB_CheckSum_0_1_3_3_1_1		0x6E154184
+
+#define LC898124EP3_PMCheckSum_0_1_3_3_1_1		0x0009121E
+#define LC898124EP3_PMSize_0_1_3_3_1_1			1580
+
+const unsigned char LC898124EP3_DM_0_1_3_3_1_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1c,
+0xA0, 0x04, 0x01, 0x02, 0x03, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x8d, 0xce, 0xbb,
+0xA0, 0xB4, 0x82, 0x69, 0x56, 0x8f,
+0xA0, 0xB8, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xBC, 0x7e, 0x06, 0xe7, 0xb9,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x8d, 0xce, 0xbb,
+0xA1, 0x50, 0x82, 0x69, 0x56, 0x8f,
+0xA1, 0x54, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x58, 0x7e, 0x06, 0xe7, 0xb9,
+0xA1, 0x5C, 0x8c, 0x51, 0x61, 0x95,
+0xA1, 0x60, 0x67, 0xc4, 0xa0, 0x91,
+0xA1, 0x64, 0x74, 0x16, 0x02, 0x25,
+0xA1, 0x74, 0x78, 0xd6, 0xfc, 0x9f,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x65, 0xac, 0x8c, 0x2f,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x04, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x02, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x07,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x40, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x70, 0x92,
+0xA4, 0xCC, 0x00, 0x01, 0x19, 0x68,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x01, 0xc0, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0x96,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x06, 0x78,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x54,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x32,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x2a, 0x00, 0x00, 0x00,
+0xA8, 0x30, 0x30, 0x00, 0x00, 0x00,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0x44, 0x3a, 0x00, 0x00, 0x00,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x04, 0x00, 0x00, 0x00,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x03, 0x00, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0xA0, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_1_3_3_1_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x6a, 0x07,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x6d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x33, 0xc8,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1b, 0x60,
+0x66, 0x00, 0x00, 0x77, 0x80,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6c, 0x40, 0x04, 0x20, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x08,
+0x30, 0x16, 0x0b, 0xc0, 0x41,
+0x6c, 0x40, 0x04, 0x22, 0x09,
+0x6c, 0x40, 0x00, 0x78, 0x49,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x72, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x68, 0x00, 0x01, 0x30, 0x20,
+0x6c, 0x40, 0x02, 0x4e, 0x08,
+0x6c, 0x40, 0x02, 0x2a, 0x48,
+0x5c, 0x00, 0x73, 0x01, 0x6d,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x5c, 0x04, 0x21, 0x46, 0x66,
+0x5c, 0x0d, 0xf8, 0x40, 0x49,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x67, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x74, 0x00,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xd0, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x8d, 0x00,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x08, 0x81, 0x60,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0x5a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x7a, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x87, 0x08, 0x40, 0x0a,
+0x5c, 0x00, 0x58, 0x40, 0x88,
+0x86, 0x08, 0x08, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8b,
+0x82, 0x00, 0x28, 0x21, 0x01,
+0x68, 0x00, 0x01, 0x8e, 0x20,
+0xac, 0x7e, 0x28, 0x02, 0xd0,
+0x82, 0x15, 0x38, 0x40, 0xd2,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0x06, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xa2,
+0x80, 0x04, 0xb8, 0x48, 0xc8,
+0x84, 0x15, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0x70, 0xc0,
+0x66, 0x00, 0x00, 0x6d, 0xa0,
+0x66, 0x00, 0x00, 0x1c, 0x80,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x76, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x6a, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x67, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x69, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x5c, 0x08, 0xa0, 0x08, 0x0b,
+0x80, 0x08, 0x96, 0x82, 0x00,
+0x04, 0xb2, 0x44, 0x43, 0x80,
+0x04, 0x00, 0x98, 0x20, 0x0a,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x31, 0x02, 0xbf, 0x70,
+0x52, 0xc9, 0xc0, 0x81, 0x64,
+0x88, 0x1e, 0x18, 0x82, 0x76,
+0x88, 0x2d, 0x69, 0x04, 0x58,
+0x42, 0x04, 0x48, 0x85, 0x54,
+0x90, 0x35, 0xa0, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x86, 0x0a,
+0x40, 0x00, 0x03, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x40, 0x00, 0x00, 0x86, 0x61,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x09,
+0x5c, 0x84, 0x10, 0x81, 0xa1,
+0x5c, 0x83, 0x00, 0x85, 0xa0,
+0x5c, 0x81, 0x08, 0x81, 0xc8,
+0xa0, 0x58, 0x09, 0x04, 0x10,
+0x84, 0x80, 0x98, 0x01, 0x08,
+0x88, 0x51, 0x44, 0x40, 0xc0,
+0x08, 0x12, 0x16, 0xc0, 0x00,
+0x1d, 0xe0, 0x95, 0x40, 0xa0,
+0x04, 0x80, 0x98, 0x86, 0x21,
+0x98, 0x00, 0xaa, 0x0d, 0x81,
+0x90, 0x31, 0x08, 0x09, 0x08,
+0x88, 0x29, 0x44, 0x40, 0xc0,
+0x00, 0x24, 0xa8, 0x81, 0x4a,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x6c, 0x00, 0x01, 0xea, 0x09,
+0x54, 0x0a, 0x00, 0x02, 0x88,
+0x57, 0x09, 0x91, 0x80, 0x09,
+0x51, 0x60, 0x80, 0x0a, 0x49,
+0x51, 0x20, 0x00, 0x82, 0xc9,
+0x98, 0x00, 0x88, 0x0a, 0x8a,
+0x57, 0x0d, 0x40, 0x83, 0x61,
+0x51, 0x60, 0x00, 0x83, 0xe0,
+0x98, 0x00, 0x92, 0x91, 0x65,
+0x6c, 0x40, 0x03, 0x2a, 0x49,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x66, 0x00, 0x00, 0x32, 0x40,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x32, 0x40,
+0x88, 0x18, 0x98, 0x82, 0x8a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x81, 0x09,
+0x54, 0x05, 0x50, 0x83, 0x21,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x3a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2d, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xdc, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x83, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x83, 0x21,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0d, 0x3a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x69, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xfc, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xfc, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x40,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x25, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x02, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x00, 0x00,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x10, 0x50,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x40, 0x02,
+0x5c, 0x00, 0x2a, 0x10, 0x10,
+0x95, 0x03, 0x69, 0x40, 0x31,
+0xa0, 0x47, 0x18, 0x81, 0x52,
+0xa4, 0x14, 0x06, 0x80, 0x00,
+0x15, 0x32, 0x22, 0x30, 0xac,
+0x55, 0x03, 0x61, 0x82, 0x29,
+0x5d, 0x48, 0x29, 0xd0, 0x83,
+0x59, 0x0f, 0x41, 0x58, 0x37,
+0x57, 0x0d, 0xd9, 0x58, 0xb4,
+0x57, 0x03, 0x01, 0xc0, 0x84,
+0x43, 0xf9, 0xd1, 0x60, 0x73,
+0x96, 0x0f, 0x05, 0x1a, 0x0a,
+0x24, 0x22, 0x35, 0xb0, 0x81,
+0x2c, 0x0c, 0x15, 0x15, 0x88,
+0x20, 0x02, 0x25, 0x70, 0x89,
+0x08, 0x26, 0x15, 0x70, 0x89,
+0x88, 0x37, 0x65, 0x15, 0x8d,
+0x88, 0x1c, 0x85, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x93,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x40, 0x81,
+0x01, 0x87, 0xa5, 0x15, 0x80,
+0x01, 0x84, 0xa5, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x38, 0x82, 0xe3,
+0x88, 0x3e, 0x2a, 0x41, 0x41,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x5d, 0x48,
+0x40, 0x00, 0x02, 0x00, 0x60,
+0x5c, 0x07, 0xc0, 0x81, 0x88,
+0x51, 0x61, 0x23, 0x00, 0x51,
+0x5b, 0x48, 0x10, 0x82, 0x20,
+0x37, 0x08, 0x35, 0x70, 0x60,
+0x18, 0xe8, 0x35, 0x04, 0x09,
+0x08, 0x1d, 0x03, 0x68, 0x40,
+0x68, 0x20, 0x02, 0x62, 0x22,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x8b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x15, 0xc8, 0x10,
+0x2c, 0x0c, 0x18, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0xa3,
+0x51, 0xa1, 0x21, 0x01, 0x58,
+0x5b, 0x08, 0x00, 0x82, 0xd4,
+0x57, 0x08, 0x10, 0x84, 0x48,
+0x2e, 0x11, 0x35, 0x15, 0x8d,
+0x88, 0x3a, 0x05, 0x15, 0x89,
+0x01, 0x84, 0x35, 0x15, 0x80,
+0x01, 0x84, 0x25, 0x40, 0x90,
+0x01, 0x84, 0x05, 0x15, 0x93,
+0x01, 0x87, 0xa5, 0x40, 0x81,
+0x01, 0x84, 0xa5, 0x15, 0x80,
+0x20, 0x05, 0x05, 0x15, 0x88,
+0x01, 0x84, 0x08, 0x1a, 0xc0,
+0x88, 0x06, 0x3a, 0x04, 0x61,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x5d, 0x48,
+0x40, 0x00, 0x02, 0x08, 0x22,
+0x5c, 0x07, 0xc0, 0x84, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x20,
+0x5b, 0x48, 0x13, 0x80, 0x00,
+0x5b, 0x84, 0x1a, 0x00, 0x10,
+0x57, 0x06, 0x19, 0x01, 0x10,
+0x68, 0x20, 0x02, 0x62, 0xa2,
+0x50, 0x46, 0x90, 0x82, 0x94,
+0x5c, 0x00, 0x18, 0x81, 0x53,
+0x55, 0x02, 0xf3, 0x00, 0xfd,
+0x23, 0x09, 0xb5, 0x18, 0x59,
+0x98, 0x4e, 0x89, 0x84, 0xe9,
+0x9c, 0x00, 0x19, 0xc0, 0x83,
+0x94, 0x83, 0x39, 0x58, 0x31,
+0x2e, 0x0c, 0xb3, 0x68, 0xc1,
+0x37, 0x04, 0x72, 0xe1, 0xed,
+0x62, 0x00, 0x00, 0x00, 0x15,
+0x50, 0x4a, 0x49, 0x8e, 0xb5,
+0x00, 0x00, 0x02, 0xf8, 0x09,
+0x55, 0xd4, 0xd8, 0x81, 0x0b,
+0x32, 0x01, 0x8b, 0xc0, 0x2b,
+0x98, 0x34, 0x93, 0x61, 0x45,
+0x62, 0x00, 0x00, 0x00, 0x27,
+0x2a, 0x01, 0x15, 0xb4, 0xa1,
+0x98, 0xeb, 0x52, 0xf8, 0xc9,
+0x29, 0x96, 0x33, 0x20, 0x18,
+0xbc, 0x03, 0xb9, 0x83, 0x41,
+0x36, 0x04, 0x52, 0xa0, 0x29,
+0x5d, 0x4c, 0x19, 0xd0, 0x01,
+0x32, 0x19, 0x8b, 0xfd, 0x6a,
+0x94, 0x87, 0x10, 0x00, 0x00,
+0x6e, 0x40, 0x04, 0xc4, 0x34,
+0x6e, 0x40, 0x04, 0xc5, 0x30,
+0x51, 0xa1, 0x20, 0x83, 0x36,
+0x54, 0x81, 0x23, 0xa1, 0x48,
+0x6c, 0x40, 0x03, 0x2c, 0x48,
+0x40, 0x00, 0x02, 0x80, 0xc0,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x57, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x05, 0x70, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x05, 0x74, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x5a, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x22, 0xff, 0xe1,
+0x5c, 0x00, 0x70, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x00, 0x14,
+0x5c, 0x8f, 0x00, 0x40, 0x50,
+0x5c, 0x82, 0x11, 0xc0, 0x80,
+0x5c, 0x84, 0x08, 0x40, 0x4a,
+0xa0, 0x10, 0x08, 0x02, 0x48,
+0x80, 0x17, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xaa, 0x00, 0x20,
+0x84, 0x04, 0xaa, 0x04, 0xc0,
+0x84, 0x00, 0xaa, 0x01, 0xc0,
+0x80, 0x24, 0x88, 0x01, 0x7a,
+0x6c, 0x40, 0x04, 0xd2, 0x4a,
+0x46, 0x0a, 0x40, 0x00, 0xfa,
+0x84, 0x07, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xd9, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xdb, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xdc, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xd8, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1d, 0x82, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x7a, 0x48,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x7c, 0xe8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x7e, 0x80,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa9, 0x08,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xd0, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa9, 0x08,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0xd0, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x37, 0x2c,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x23, 0xfa, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x08, 0x0e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x25, 0x42, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x08, 0x38, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x5c, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x76, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x64, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb0, 0xe8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x26, 0xda, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb5, 0xe8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x76, 0x23,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x84, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x7e, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x92, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x86, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xb0, 0xe8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x28, 0xf2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xb5, 0xe8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x97, 0xa3,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x23, 0x72, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0xa0, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x9f, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x08, 0xae, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x37, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xb0, 0x08,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xac, 0x68,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xb8, 0xc0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xb8, 0xc0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0b, 0x5e, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb9, 0x60,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb9, 0x68,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..cff7afcf9f4d88ecd32cbd335361628386b4073c
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_0.h
@@ -0,0 +1,2171 @@
+// Time Stamp : 2019/03/18 21:24:21
+
+//VERNUM [021b0007] [00000602]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			6
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_2_6_2_0_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_2_6_2_0_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_2_6_2_0_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_2_6_2_0_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_2_6_2_0_0		0x0488
+#define LC898124EP3_DMB_CheckSum_0_2_6_2_0_0		0x5D154D99
+
+#define LC898124EP3_PMCheckSum_0_2_6_2_0_0		0x000AB64F
+#define LC898124EP3_PMSize_0_2_6_2_0_0			1832
+
+const unsigned char LC898124EP3_DM_0_2_6_2_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x07,
+0xA0, 0x04, 0x00, 0x00, 0x06, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xd1, 0x93, 0x7c, 0xb7,
+0xA0, 0xA0, 0x7f, 0xd2, 0x5a, 0x25,
+0xA0, 0xA4, 0x2e, 0x9a, 0x29, 0x23,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x0a, 0x2a, 0xda, 0xd1,
+0xA0, 0xB4, 0xaa, 0xba, 0x7f, 0xa9,
+0xA0, 0xB8, 0x72, 0x14, 0x59, 0xc5,
+0xA0, 0xBC, 0x56, 0x1b, 0x90, 0x25,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x1C, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0x20, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0x24, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0x28, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xd1, 0x93, 0x7c, 0xb7,
+0xA1, 0x3C, 0x7f, 0xd2, 0x5a, 0x25,
+0xA1, 0x40, 0x2e, 0x9a, 0x29, 0x23,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x0a, 0x2a, 0xda, 0xd1,
+0xA1, 0x50, 0xaa, 0xba, 0x7f, 0xa9,
+0xA1, 0x54, 0x72, 0x14, 0x59, 0xc5,
+0xA1, 0x58, 0x56, 0x1b, 0x90, 0x25,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xB8, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0xBC, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0xC0, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0xC4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xC8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xCC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xD4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD8, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xDC, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xE8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xEC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xF0, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xF4, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xF8, 0x03, 0x04, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x04,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0x84, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0x88, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0xE4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xE8, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x22, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0x92,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0a, 0xf0,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x50,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x2e,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0x90, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0x94, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xA0, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xA4, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xA8, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xAC, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xB4, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_2_6_2_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xb1, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xb5, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x83, 0x88,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x10, 0xf2, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x06, 0x24,
+0x80, 0x35, 0x08, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x0f, 0xa8, 0x40, 0x7a,
+0xa0, 0x4e, 0x05, 0xc0, 0x0b,
+0x00, 0x24, 0xa8, 0x40, 0x48,
+0xa0, 0x22, 0x08, 0x40, 0x08,
+0x68, 0x00, 0x06, 0x00, 0x00,
+0x54, 0x81, 0x03, 0x1d, 0xf4,
+0x5c, 0x0e, 0x00, 0x00, 0xd0,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xa0, 0x40, 0x48,
+0xa0, 0x08, 0x0b, 0x08, 0x0f,
+0x80, 0x04, 0xb6, 0x83, 0x40,
+0x84, 0xa2, 0x4b, 0x10, 0x17,
+0x84, 0x04, 0xba, 0x20, 0x20,
+0x86, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x04, 0xa6, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x18, 0x60, 0x0b,
+0x52, 0x01, 0xfa, 0xc5, 0x80,
+0x80, 0x24, 0xab, 0x06, 0x06,
+0x84, 0x80, 0x05, 0x24, 0x82,
+0x2c, 0x40, 0x08, 0x48, 0x48,
+0x80, 0x24, 0xa8, 0x60, 0x4b,
+0x84, 0x04, 0xab, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4b, 0x20,
+0x66, 0x00, 0x00, 0xe2, 0x40,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x6e, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x6c, 0x40, 0x02, 0x4e, 0x0a,
+0x5c, 0x0b, 0x6b, 0x00, 0x84,
+0x6c, 0x40, 0x02, 0x2a, 0x4a,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x65, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xb8, 0x60,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4c, 0x40, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0x4a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0x5a, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x09, 0xaa, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x0b, 0xe6, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x8b,
+0x80, 0x00, 0xa8, 0x00, 0x00,
+0x68, 0x00, 0x01, 0x88, 0x24,
+0x80, 0x10, 0x18, 0x22, 0x52,
+0xac, 0x7e, 0x28, 0x61, 0xcb,
+0x80, 0x15, 0x36, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x0b,
+0x52, 0x4b, 0xe8, 0x20, 0xc8,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x84, 0x8d, 0x08, 0x62, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0xb5, 0x20,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x0b, 0xe6, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0xbe, 0x68,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x6d, 0xe0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x6a, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6c, 0x60,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x48,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4c, 0x48,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4c, 0x48,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x0b, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0xa0,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x5f, 0xa0,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x64, 0x00,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x64, 0x00,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x66, 0x28,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x65, 0xa0,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x0c, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x9a, 0xa0,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x67, 0xe8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x64, 0xe8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x82, 0x00,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x82, 0x00,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7d, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xdc, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x21, 0x2a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x3b, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x3b, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x96, 0xe8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xa4, 0xc8,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xa4, 0xc8,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x9e, 0x88,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x09, 0xe8, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x09, 0xec, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xa2, 0x68,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x61,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x10, 0x48, 0x00,
+0x52, 0x42, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x68, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0xb5, 0x20, 0xdd,
+0xb0, 0x40, 0x78, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x05, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xd1,
+0x80, 0x1c, 0xb8, 0x00, 0x7a,
+0x84, 0x05, 0x25, 0xc8, 0x71,
+0x00, 0x14, 0x98, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x1c, 0x50, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xcb,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8d, 0x28, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0x90, 0x01, 0x4b,
+0x5c, 0x1a, 0x2a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xd2,
+0x80, 0x1c, 0x98, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x8c, 0x08, 0x02, 0xc8,
+0x5c, 0x01, 0xf3, 0x05, 0x14,
+0x5c, 0x88, 0x08, 0x02, 0xca,
+0x5c, 0x03, 0xf0, 0x01, 0x7a,
+0x80, 0x07, 0xa8, 0x01, 0xc8,
+0x46, 0x0a, 0x40, 0x02, 0xca,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x03, 0x01, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x2b, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0xab, 0xf9, 0x06, 0xc0, 0x00,
+0x17, 0x00, 0x86, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x31, 0x80, 0xa8, 0x80, 0x4a,
+0x88, 0x0c, 0x98, 0x81, 0x48,
+0x88, 0x1f, 0x66, 0x60, 0x04,
+0x0f, 0xd6, 0x8a, 0x41, 0x00,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x5c, 0x83, 0x02, 0xc0, 0x21,
+0x68, 0x00, 0x01, 0xc5, 0x21,
+0xd8, 0x88, 0x15, 0x70, 0xd5,
+0x00, 0xa0, 0x08, 0x60, 0x09,
+0x57, 0x0a, 0x00, 0x83, 0x60,
+0x88, 0x24, 0x08, 0x82, 0xe1,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x89,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x68, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0x82, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x55, 0x01, 0x28, 0x82, 0xa0,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x6b, 0x24,
+0x66, 0x00, 0x00, 0xe0, 0x28,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x32, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x6d, 0x24,
+0x66, 0x00, 0x00, 0xe0, 0x28,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x2a, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x10, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x10,
+0x08, 0x08, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x23, 0x01, 0x90,
+0xbc, 0x03, 0xa5, 0x50, 0x01,
+0x08, 0x00, 0x9b, 0x00, 0x0a,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x00,
+0xbc, 0x03, 0x13, 0x20, 0x10,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x04, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x08,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4c, 0x80, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xcc, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4c, 0xc4, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x65, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0x7f, 0x24,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x03, 0x00, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x30, 0x02, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..c2110f42f635fc24e74e7dbf53a8c8e9103dcaff
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_6_2_0_1.h
@@ -0,0 +1,1855 @@
+// Time Stamp : 2019/03/18 21:23:09
+
+//VERNUM [021b0007] [00000602]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			6
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_2_6_2_0_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_2_6_2_0_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_2_6_2_0_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_2_6_2_0_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_2_6_2_0_1		0x0460
+#define LC898124EP3_DMB_CheckSum_0_2_6_2_0_1		0x460A6526
+
+#define LC898124EP3_PMCheckSum_0_2_6_2_0_1		0x0008BA6C
+#define LC898124EP3_PMSize_0_2_6_2_0_1			1526
+
+const unsigned char LC898124EP3_DM_0_2_6_2_0_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x07,
+0xA0, 0x04, 0x00, 0x00, 0x06, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xd1, 0x93, 0x7c, 0xb7,
+0xA0, 0xA0, 0x7f, 0xd2, 0x5a, 0x25,
+0xA0, 0xA4, 0x2e, 0x9a, 0x29, 0x23,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x0a, 0x2a, 0xda, 0xd1,
+0xA0, 0xB4, 0xaa, 0xba, 0x7f, 0xa9,
+0xA0, 0xB8, 0x72, 0x14, 0x59, 0xc5,
+0xA0, 0xBC, 0x56, 0x1b, 0x90, 0x25,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x1C, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0x20, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0x24, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0x28, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xd1, 0x93, 0x7c, 0xb7,
+0xA1, 0x3C, 0x7f, 0xd2, 0x5a, 0x25,
+0xA1, 0x40, 0x2e, 0x9a, 0x29, 0x23,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x0a, 0x2a, 0xda, 0xd1,
+0xA1, 0x50, 0xaa, 0xba, 0x7f, 0xa9,
+0xA1, 0x54, 0x72, 0x14, 0x59, 0xc5,
+0xA1, 0x58, 0x56, 0x1b, 0x90, 0x25,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xB8, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0xBC, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0xC0, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0xC4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xC8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xCC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xD4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD8, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xDC, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xE8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xEC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xF0, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xF4, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xF8, 0x03, 0x04, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x04,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x22, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0x86,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x05, 0xe4,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x44,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x22,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_2_6_2_0_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x60, 0xc7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x64, 0x47,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x32, 0xc8,
+0x40, 0x00, 0x02, 0xbf, 0xd0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x4a,
+0x5c, 0x10, 0xf2, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x08, 0x03, 0x06, 0x24,
+0x80, 0x35, 0x08, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x0f, 0xa8, 0x40, 0x7a,
+0xa0, 0x4e, 0x05, 0xc0, 0x0b,
+0x00, 0x24, 0xa8, 0x40, 0x48,
+0xa0, 0x22, 0x08, 0x40, 0x08,
+0x68, 0x00, 0x06, 0x00, 0x00,
+0x54, 0x81, 0x03, 0x1d, 0xf4,
+0x5c, 0x0e, 0x00, 0x00, 0xd0,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xa0, 0x40, 0x48,
+0xa0, 0x08, 0x0b, 0x08, 0x0f,
+0x80, 0x04, 0xb6, 0x83, 0x40,
+0x84, 0xa2, 0x4b, 0x10, 0x17,
+0x84, 0x04, 0xba, 0x20, 0x20,
+0x86, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x04, 0xa6, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc7, 0xe0,
+0x80, 0x04, 0xa6, 0x82, 0x00,
+0x14, 0xf2, 0x18, 0x60, 0x0b,
+0x52, 0x01, 0xfa, 0xc5, 0x80,
+0x80, 0x24, 0xab, 0x06, 0x06,
+0x84, 0x80, 0x05, 0x24, 0x82,
+0x2c, 0x40, 0x08, 0x48, 0x48,
+0x80, 0x24, 0xa8, 0x60, 0x4b,
+0x84, 0x04, 0xab, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x80,
+0x5c, 0x81, 0x02, 0x40, 0x80,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x80,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1b, 0x80,
+0x66, 0x00, 0x00, 0x70, 0xc0,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x62, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x6c, 0x40, 0x02, 0x4e, 0x0a,
+0x5c, 0x0b, 0x6b, 0x00, 0x84,
+0x6c, 0x40, 0x02, 0x2a, 0x4a,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x68, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x67, 0xa0,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x86, 0x40,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x1e, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0e, 0x1a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x43, 0x06, 0x80, 0x00,
+0x06, 0x82, 0x09, 0x88, 0x08,
+0x6c, 0x00, 0x01, 0xb0, 0x09,
+0x30, 0x12, 0x86, 0x80, 0x00,
+0x06, 0x9a, 0x0b, 0xc0, 0x88,
+0x98, 0x80, 0x83, 0x01, 0x28,
+0xbc, 0x37, 0x16, 0x60, 0x00,
+0x06, 0xda, 0x89, 0x8e, 0x88,
+0x40, 0x00, 0x03, 0xc3, 0x27,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x02,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x88, 0x12, 0x08, 0x60, 0x8b,
+0x80, 0x00, 0xa8, 0x00, 0x00,
+0x68, 0x00, 0x01, 0x88, 0x24,
+0x80, 0x10, 0x18, 0x22, 0x52,
+0xac, 0x7e, 0x28, 0x61, 0xcb,
+0x80, 0x15, 0x36, 0x80, 0x00,
+0x17, 0xc2, 0x18, 0x40, 0x0b,
+0x52, 0x4b, 0xe8, 0x20, 0xc8,
+0x6c, 0x00, 0x02, 0xf8, 0x4a,
+0x84, 0x8d, 0x08, 0x62, 0x51,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x66, 0x00, 0x00, 0x64, 0x60,
+0x6c, 0x40, 0x04, 0x9a, 0x09,
+0x32, 0x82, 0x8b, 0xc0, 0x49,
+0x98, 0xe8, 0x86, 0x60, 0x00,
+0x06, 0xda, 0x0b, 0xc0, 0x47,
+0x66, 0x00, 0x00, 0x6d, 0xa8,
+0x40, 0x00, 0x03, 0x00, 0x0c,
+0x66, 0x00, 0x00, 0x1c, 0xa0,
+0x88, 0x1a, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x62, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x6b, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x68, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x6c, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x69, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x31, 0x40,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x31, 0x40,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2c, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xcc, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0c, 0xfa, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xf8, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xf8, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x46, 0x28,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x54, 0x08,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x54, 0x08,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x4d, 0xc8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0xdc, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0xe0, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x51, 0xa8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x01, 0x61,
+0x5c, 0x00, 0xa0, 0x40, 0x00,
+0x52, 0x0c, 0x02, 0xc0, 0x62,
+0x68, 0x34, 0x00, 0x17, 0x21,
+0x5c, 0x8c, 0x08, 0x40, 0x50,
+0x5c, 0x82, 0x18, 0x48, 0x7a,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0x5c, 0x1c, 0x10, 0x48, 0x00,
+0x52, 0x42, 0x02, 0x0b, 0x22,
+0x5c, 0x04, 0x68, 0x48, 0x50,
+0x5c, 0x00, 0x42, 0x00, 0xe0,
+0x85, 0x00, 0xb5, 0x20, 0xdd,
+0xb0, 0x40, 0x78, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x48, 0x03,
+0x24, 0x05, 0xb8, 0x48, 0x53,
+0x5c, 0x8b, 0x10, 0x03, 0x48,
+0x5c, 0x88, 0x08, 0x02, 0xd1,
+0x80, 0x1c, 0xb8, 0x00, 0x7a,
+0x84, 0x05, 0x25, 0xc8, 0x71,
+0x00, 0x14, 0x98, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x1c, 0x50, 0x03, 0x50,
+0x5c, 0x8b, 0x18, 0x01, 0xcb,
+0xa0, 0x00, 0x18, 0x00, 0x7a,
+0x84, 0x8d, 0x28, 0x01, 0xc8,
+0x80, 0x2c, 0x88, 0x00, 0x50,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x82, 0x10, 0x03, 0x50,
+0x5c, 0x1c, 0x90, 0x01, 0x4b,
+0x5c, 0x1a, 0x2a, 0x00, 0x01,
+0x80, 0x07, 0xa8, 0x48, 0xd2,
+0x80, 0x1c, 0x98, 0x02, 0xc8,
+0x80, 0x05, 0x00, 0x00, 0x00,
+0x6c, 0x70, 0x10, 0x0e, 0x02,
+0x25, 0x99, 0x0b, 0xff, 0xc1,
+0x5c, 0x83, 0x08, 0x00, 0xd0,
+0x5c, 0x8c, 0x08, 0x02, 0xc8,
+0x5c, 0x01, 0xf3, 0x05, 0x14,
+0x5c, 0x88, 0x08, 0x02, 0xca,
+0x5c, 0x03, 0xf0, 0x01, 0x7a,
+0x80, 0x07, 0xa8, 0x01, 0xc8,
+0x46, 0x0a, 0x40, 0x02, 0xca,
+0x84, 0x05, 0x00, 0x00, 0x00,
+0x32, 0x02, 0x0b, 0xc0, 0xc0,
+0x68, 0x38, 0x08, 0x02, 0x20,
+0x5c, 0x03, 0xa2, 0xc1, 0x00,
+0x5c, 0x04, 0x70, 0x40, 0x48,
+0xa0, 0x18, 0x04, 0x60, 0xa4,
+0x00, 0x24, 0x88, 0x40, 0x4a,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x03, 0x20,
+0x5c, 0x03, 0xe3, 0x05, 0x16,
+0x5c, 0x88, 0x00, 0x40, 0x4a,
+0x5c, 0x00, 0x72, 0x01, 0x60,
+0x46, 0x0a, 0x40, 0x02, 0x48,
+0x84, 0x04, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xbe, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc0, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc1, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xbd, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1b, 0xd2, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x73, 0x88,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x76, 0x28,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x77, 0xc0,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa2, 0x48,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0x64, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xa2, 0x48,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0x64, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x1c, 0x2c,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x22, 0x4a, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x07, 0xa2, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x23, 0x92, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x07, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x41, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x0a, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x49, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xaa, 0x28,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x25, 0x2a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x5b, 0x23,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x18, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x63, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x26, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x6b, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xaa, 0x28,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x27, 0x42, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xaf, 0x28,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x7c, 0xa3,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x21, 0xc2, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x08, 0x34, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x84, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x08, 0x42, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x1c, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xa9, 0x48,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xa5, 0xa8,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xb2, 0x00,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xb2, 0x00,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0a, 0xf2, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb2, 0xa0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb2, 0xa8,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xb2, 0xa8,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb2, 0xa8,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb2, 0xa0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xb2, 0xa8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xb2, 0xa0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xb2, 0xa8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..b401e6de63eddee3e7276f8b27b1e0d4f31bbea8
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_0.h
@@ -0,0 +1,2134 @@
+// Time Stamp : 2019/03/18 21:24:07
+
+//VERNUM [021b0007] [01000702]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			7
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define CHECKSUM_COMMAND_DMA_0_2_7_2_1_0			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_2_7_2_1_0			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_2_7_2_1_0		0x0054
+#define LC898124EP3_DMA_CheckSum_0_2_7_2_1_0		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_2_7_2_1_0		0x0488
+#define LC898124EP3_DMB_CheckSum_0_2_7_2_1_0		0xBB4A0067
+
+#define LC898124EP3_PMCheckSum_0_2_7_2_1_0		0x000A82A0
+#define LC898124EP3_PMSize_0_2_7_2_1_0			1795
+
+const unsigned char LC898124EP3_DM_0_2_7_2_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x07,
+0xA0, 0x04, 0x01, 0x00, 0x07, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xf2, 0x4b, 0x39, 0xd9,
+0xA0, 0xA0, 0x7f, 0xdd, 0xc2, 0x15,
+0xA0, 0xA4, 0x0d, 0xc5, 0xef, 0x83,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x10, 0x1d, 0x3f, 0x2d,
+0xA0, 0xB4, 0xa9, 0xec, 0x1c, 0x59,
+0xA0, 0xB8, 0x75, 0x50, 0x33, 0x99,
+0xA0, 0xBC, 0x57, 0x97, 0x3f, 0xa9,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x50, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x1C, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0x20, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0x24, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x28, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xf2, 0x4b, 0x39, 0xd9,
+0xA1, 0x3C, 0x7f, 0xdd, 0xc2, 0x15,
+0xA1, 0x40, 0x0d, 0xc5, 0xef, 0x83,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x10, 0x1d, 0x3f, 0x2d,
+0xA1, 0x50, 0xa9, 0xec, 0x1c, 0x59,
+0xA1, 0x54, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x58, 0x57, 0x97, 0x3f, 0xa9,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x50, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xB8, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0xBC, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0xC0, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0xC4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xC8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xCC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xD4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD8, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xDC, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xE0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xE4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xEC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xF0, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xF4, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xF8, 0x03, 0x02, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x02,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0x84, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0x88, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0xE4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xE8, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x22, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x08, 0x80,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x0a, 0xde,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x09, 0x3e,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x09, 0x1c,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+0xA9, 0x90, 0x00, 0x0c, 0x00, 0x00,
+0xA9, 0x94, 0x00, 0x00, 0x07, 0x0a,
+0xA9, 0xA0, 0xbd, 0x2b, 0x06, 0x35,
+0xA9, 0xA4, 0x7f, 0xa4, 0xc4, 0x91,
+0xA9, 0xA8, 0x43, 0x30, 0x35, 0x39,
+0xA9, 0xAC, 0x00, 0x00, 0x00, 0x90,
+0xA9, 0xB4, 0x00, 0x00, 0x00, 0x90,
+};
+
+const unsigned char LC898124EP3_PM_0_2_7_2_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0xb0, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0xb3, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x82, 0x68,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x83, 0x0a, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x48, 0x03, 0x06, 0x24,
+0x5c, 0x00, 0x80, 0x03, 0x50,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x40, 0x7a,
+0xa0, 0x10, 0x08, 0x40, 0x7a,
+0xa0, 0x58, 0x05, 0xc0, 0xdb,
+0x00, 0x24, 0xa8, 0x40, 0x48,
+0xa0, 0x22, 0x08, 0x40, 0x08,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x85, 0x13, 0x1d, 0xf4,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x84, 0x04, 0x8a, 0x00, 0x80,
+0xb0, 0x80, 0xc6, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x40, 0x48,
+0x84, 0x0c, 0x8a, 0x20, 0x20,
+0x86, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x05, 0x0a, 0xc7, 0xe0,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x80, 0x05, 0x06, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x84, 0x80, 0xb5, 0x24, 0xdf,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x00, 0x25, 0x0b, 0x06, 0x07,
+0xac, 0x40, 0x08, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x4a, 0x00,
+0x66, 0x00, 0x00, 0xdd, 0xa0,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x09, 0x5c, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x6c, 0x40, 0x02, 0x4e, 0x0a,
+0x5c, 0x0b, 0x6b, 0x00, 0x84,
+0x6c, 0x40, 0x02, 0x2a, 0x4a,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x61, 0x20,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0xba, 0x60,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x81, 0x02, 0xfa, 0xc1,
+0x5c, 0x0e, 0xa1, 0xc0, 0x80,
+0x88, 0x06, 0x0a, 0x00, 0x20,
+0x88, 0x0e, 0x0a, 0x00, 0x20,
+0x88, 0x16, 0x06, 0x80, 0x00,
+0x0e, 0x02, 0x46, 0xc4, 0x00,
+0x4c, 0x40, 0x9a, 0x00, 0x20,
+0x82, 0x04, 0x9a, 0x00, 0x20,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x86, 0x0f, 0xa8, 0x60, 0x7a,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x22, 0x02, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x12, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0xb7, 0x20,
+0x66, 0x00, 0x00, 0xb4, 0x00,
+0x66, 0x00, 0x00, 0x6c, 0xc0,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x7e, 0xf3, 0x81, 0xd4,
+0xab, 0xfc, 0x08, 0x82, 0x76,
+0x66, 0x00, 0x00, 0x6b, 0x40,
+0x68, 0x00, 0x00, 0xce, 0x20,
+0x5c, 0x81, 0x01, 0x8e, 0x8a,
+0x5c, 0x08, 0x20, 0x00, 0x01,
+0x55, 0x01, 0xa8, 0x00, 0x03,
+0x55, 0x01, 0x52, 0x00, 0xe1,
+0x94, 0x82, 0x85, 0x2c, 0x80,
+0x04, 0x00, 0xbb, 0xc0, 0x89,
+0x55, 0x01, 0x62, 0x0c, 0x60,
+0x68, 0x00, 0x00, 0xc4, 0x21,
+0x00, 0x00, 0x08, 0x08, 0x08,
+0x84, 0x88, 0x98, 0x48, 0x0a,
+0x4b, 0x8b, 0x9b, 0x01, 0x0c,
+0x52, 0xc8, 0x00, 0x00, 0x41,
+0x57, 0x0f, 0x48, 0x00, 0x43,
+0x5c, 0x82, 0x0b, 0xc0, 0x79,
+0x5c, 0x00, 0x28, 0x02, 0xc1,
+0x68, 0x00, 0x00, 0xc7, 0x21,
+0x00, 0x00, 0x08, 0x48, 0x89,
+0x84, 0x80, 0x23, 0x91, 0x82,
+0x80, 0x00, 0x85, 0x40, 0x50,
+0x00, 0x30, 0x85, 0x40, 0xb1,
+0x18, 0x00, 0x96, 0xc4, 0x00,
+0x13, 0xe0, 0x84, 0x42, 0x00,
+0x18, 0x08, 0x96, 0xe4, 0x00,
+0x19, 0xd2, 0x42, 0x01, 0x00,
+0x6c, 0x40, 0x01, 0x6e, 0x0a,
+0x6e, 0x40, 0x01, 0x9f, 0x24,
+0x44, 0x30, 0x00, 0x00, 0x40,
+0x20, 0x10, 0x06, 0xc4, 0x00,
+0x33, 0xc0, 0x88, 0x01, 0x40,
+0x68, 0x20, 0x01, 0x16, 0x21,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x04, 0x80, 0x96, 0xe4, 0x00,
+0x48, 0xd2, 0x66, 0xc4, 0x00,
+0x27, 0x80, 0x85, 0x00, 0xc0,
+0x20, 0x56, 0x05, 0x80, 0x94,
+0x00, 0x2c, 0x0b, 0xc1, 0x3d,
+0x88, 0x2e, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x6c, 0x09,
+0x6c, 0x00, 0x01, 0xb4, 0x0a,
+0x2e, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x44, 0x92, 0x29, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x7b,
+0x6c, 0x40, 0x02, 0x2c, 0x49,
+0x80, 0xa4, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x4c, 0x09,
+0x84, 0x84, 0x9a, 0x00, 0x21,
+0x40, 0x00, 0x00, 0x83, 0x61,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x6c, 0x00, 0x01, 0x6e, 0x48,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x88, 0x2a, 0x18, 0x83, 0x20,
+0x66, 0x00, 0x40, 0xb8, 0xe0,
+0x88, 0x2a, 0x06, 0x82, 0x00,
+0x0d, 0xe2, 0x38, 0x41, 0x0a,
+0x68, 0x20, 0x00, 0xdf, 0xac,
+0x68, 0x20, 0x00, 0xdc, 0x2d,
+0x88, 0x16, 0x36, 0xc0, 0x00,
+0x18, 0x04, 0x86, 0xc0, 0x00,
+0x31, 0x64, 0xa6, 0x80, 0x00,
+0x0b, 0x22, 0x06, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x80, 0x00,
+0x0d, 0xc2, 0x26, 0x82, 0x00,
+0x0d, 0x32, 0x58, 0x80, 0x6c,
+0x40, 0x00, 0x00, 0x80, 0xed,
+0x68, 0x00, 0x00, 0xe1, 0x23,
+0x66, 0x00, 0x00, 0x4b, 0x28,
+0x6c, 0x00, 0x01, 0x6e, 0x09,
+0x68, 0x20, 0x00, 0xe0, 0x2c,
+0x68, 0x00, 0x00, 0xe1, 0x21,
+0x68, 0x00, 0x00, 0xb2, 0x20,
+0x88, 0x06, 0xca, 0x08, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0d, 0xd2, 0xc6, 0x82, 0x00,
+0x0d, 0xea, 0xd6, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x80, 0x00,
+0x0d, 0xe2, 0x26, 0x82, 0x00,
+0x0d, 0x52, 0x58, 0x80, 0xec,
+0x40, 0x00, 0x00, 0x81, 0x6d,
+0x66, 0x00, 0x00, 0x4b, 0x28,
+0x6c, 0x00, 0x01, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xbb, 0x20,
+0x68, 0x20, 0x01, 0xb6, 0x23,
+0x84, 0x34, 0x86, 0x82, 0x00,
+0x0e, 0x0a, 0xc6, 0x82, 0x00,
+0x1b, 0x52, 0xd8, 0x81, 0x63,
+0x68, 0x00, 0x01, 0x86, 0x20,
+0x68, 0x00, 0x01, 0x76, 0x21,
+0x68, 0x20, 0x01, 0x9b, 0x24,
+0x68, 0x00, 0x01, 0x80, 0x22,
+0x68, 0x20, 0x01, 0xb3, 0x25,
+0x88, 0x06, 0xc8, 0x80, 0xed,
+0x68, 0x00, 0x00, 0x47, 0x23,
+0x66, 0x00, 0x00, 0x4b, 0x28,
+0x6c, 0x00, 0x03, 0x16, 0x09,
+0x68, 0x00, 0x01, 0x06, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x68, 0x00, 0x01, 0x86, 0x21,
+0x88, 0x23, 0x6b, 0xa1, 0x48,
+0x84, 0xb4, 0x8a, 0x80, 0x40,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x5c, 0x85, 0x02, 0xbf, 0xb0,
+0x80, 0x20, 0x98, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xb7, 0x2c,
+0x88, 0x1f, 0x66, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x80, 0x00,
+0x18, 0x22, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x00, 0x00, 0xc1, 0x20,
+0x39, 0x0a, 0x08, 0x02, 0x09,
+0x88, 0x26, 0x06, 0x82, 0x00,
+0x1b, 0x92, 0xc6, 0xc0, 0x00,
+0x30, 0x44, 0x86, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x80, 0x00,
+0x18, 0x42, 0x08, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xde, 0x80,
+0x68, 0x20, 0x00, 0xdc, 0x2c,
+0x6c, 0x00, 0x03, 0x08, 0x48,
+0x68, 0x00, 0x00, 0x9e, 0x20,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x68, 0x20, 0x00, 0xce, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x04,
+0x0d, 0xfe, 0x86, 0xc0, 0x00,
+0x30, 0x40, 0x98, 0x81, 0x20,
+0x68, 0x20, 0x00, 0xdd, 0x2c,
+0x84, 0x04, 0x86, 0x80, 0x00,
+0x0a, 0x82, 0x06, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x58, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0xdf, 0xe8,
+0x6c, 0x00, 0x03, 0x08, 0x09,
+0x55, 0x01, 0x28, 0x81, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0x21,
+0x80, 0x20, 0x88, 0x48, 0x49,
+0x40, 0x00, 0x00, 0x81, 0x60,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x5e, 0x80,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x80, 0x20, 0x88, 0x82, 0x60,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x5e, 0x80,
+0x40, 0x00, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x00, 0x9e, 0x21,
+0x68, 0x20, 0x00, 0x9c, 0x24,
+0x66, 0x00, 0x00, 0x62, 0xe0,
+0x68, 0x00, 0x00, 0xd1, 0x21,
+0x5c, 0x81, 0x00, 0x82, 0x20,
+0x80, 0x84, 0x88, 0x82, 0xe1,
+0x68, 0x00, 0x00, 0xa8, 0x21,
+0x68, 0x20, 0x00, 0xb4, 0x24,
+0x66, 0x00, 0x00, 0x62, 0xe0,
+0x68, 0x20, 0x00, 0xd7, 0x20,
+0x5c, 0x81, 0x00, 0x82, 0xa4,
+0x5c, 0x85, 0x00, 0x00, 0x09,
+0x5d, 0x0a, 0x2a, 0x20, 0x03,
+0x51, 0x85, 0x60, 0x20, 0x48,
+0x98, 0x22, 0x88, 0x83, 0x60,
+0x9c, 0x00, 0x08, 0x40, 0x08,
+0x68, 0x20, 0x00, 0xcc, 0x20,
+0x68, 0x20, 0x00, 0xcd, 0x21,
+0x84, 0x04, 0x88, 0x48, 0x48,
+0x40, 0x00, 0x00, 0x83, 0xe4,
+0x68, 0x00, 0x00, 0xd1, 0x22,
+0x66, 0x00, 0x40, 0xc6, 0x80,
+0x5c, 0x09, 0x20, 0x83, 0xa0,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x39, 0x06, 0x06, 0xc4, 0x00,
+0x25, 0x00, 0xb6, 0xc4, 0x00,
+0x4b, 0xe0, 0xab, 0xc0, 0x8f,
+0x6c, 0x40, 0x04, 0xa8, 0x08,
+0x68, 0x20, 0x02, 0x58, 0x20,
+0x6c, 0x40, 0x04, 0xc0, 0x0a,
+0x80, 0x20, 0x88, 0x40, 0x0b,
+0x5c, 0x09, 0x40, 0x82, 0xa0,
+0x52, 0xc1, 0x40, 0x84, 0xc8,
+0x42, 0x08, 0x40, 0x84, 0x4a,
+0x88, 0x2c, 0xb6, 0x82, 0x00,
+0x0a, 0x82, 0x48, 0x82, 0x88,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x68, 0x20, 0x00, 0xc0, 0x21,
+0x88, 0x40, 0x98, 0x60, 0xc9,
+0x00, 0x00, 0x04, 0x22, 0xbf,
+0x88, 0x3a, 0x08, 0x48, 0xc9,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0xa2, 0x0a,
+0x66, 0x00, 0x00, 0x65, 0x08,
+0x5c, 0x00, 0x28, 0x40, 0x0b,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x32, 0x02, 0x8b, 0xc3, 0x01,
+0x6e, 0x40, 0x01, 0xbf, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0xc1,
+0x6e, 0x40, 0x01, 0xc0, 0x2d,
+0x32, 0x02, 0x8b, 0xc2, 0x81,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x83, 0x20,
+0x51, 0x85, 0x71, 0x8e, 0x82,
+0x98, 0x2a, 0x89, 0xc0, 0x00,
+0x6c, 0x40, 0x04, 0x9e, 0x0a,
+0x84, 0x00, 0xb0, 0x8e, 0x00,
+0x98, 0x00, 0xa2, 0xe1, 0xa6,
+0x32, 0x03, 0x0b, 0xc0, 0x5d,
+0x55, 0x00, 0x80, 0x82, 0x89,
+0x55, 0x01, 0xb8, 0x84, 0x8a,
+0x08, 0xe2, 0x02, 0xe0, 0xaa,
+0x6c, 0x40, 0x01, 0x50, 0x09,
+0x98, 0x08, 0xa3, 0x01, 0xa8,
+0xbc, 0x0b, 0x56, 0xc4, 0x00,
+0x4a, 0x00, 0x92, 0xe1, 0x2d,
+0x32, 0x02, 0x8b, 0xc0, 0x63,
+0x6c, 0x40, 0x01, 0x80, 0x4a,
+0x6c, 0x40, 0x01, 0x50, 0x4a,
+0xbc, 0x05, 0xf8, 0x83, 0xa0,
+0xbc, 0x03, 0xf8, 0x83, 0xa0,
+0x5c, 0x00, 0x00, 0x83, 0xa0,
+0x38, 0x12, 0x59, 0x40, 0x2e,
+0x25, 0x97, 0x0b, 0xc1, 0x41,
+0x6c, 0x40, 0x04, 0xbc, 0x09,
+0x57, 0x0b, 0x28, 0x84, 0x08,
+0x6c, 0x40, 0x01, 0x52, 0x48,
+0x32, 0x02, 0x8b, 0xc0, 0x6d,
+0x6c, 0x40, 0x01, 0x82, 0x48,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x4c, 0x20, 0xa0, 0x86, 0x00,
+0x57, 0x01, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x01, 0x82, 0x40,
+0x6c, 0x40, 0x01, 0x52, 0x40,
+0x5c, 0x81, 0x02, 0x04, 0xc1,
+0x88, 0x12, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x09, 0xe2, 0x16, 0x82, 0x00,
+0x09, 0xc2, 0x46, 0x82, 0x00,
+0x0c, 0xe2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x85, 0x00, 0x81, 0x21,
+0x88, 0x22, 0x08, 0x08, 0x09,
+0x88, 0x16, 0x16, 0x80, 0x00,
+0x0a, 0x82, 0x16, 0x82, 0x00,
+0x0b, 0x42, 0x46, 0x82, 0x00,
+0x0c, 0xf2, 0x56, 0x60, 0x04,
+0x0b, 0xbe, 0x89, 0x82, 0x48,
+0x5c, 0x08, 0xa0, 0x81, 0x20,
+0x00, 0x00, 0x09, 0x40, 0x2d,
+0x25, 0x92, 0x8b, 0xc0, 0x40,
+0x6c, 0x00, 0x01, 0x74, 0x7a,
+0x6c, 0x00, 0x01, 0x86, 0x7a,
+0x38, 0x13, 0x42, 0x59, 0x28,
+0xbc, 0x0d, 0x06, 0x80, 0x00,
+0x13, 0x32, 0x06, 0xc4, 0x00,
+0x21, 0xc0, 0x85, 0xc8, 0x10,
+0x18, 0xe8, 0x99, 0x42, 0x45,
+0x6c, 0x40, 0x01, 0x5a, 0x48,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x42, 0x1a, 0x38, 0x40, 0x7a,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x68, 0x00, 0x00, 0xbf, 0x21,
+0x66, 0x00, 0x40, 0xee, 0x40,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc1, 0xa1,
+0x68, 0x20, 0x01, 0x11, 0x21,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0xa0, 0xc2, 0x28, 0x81, 0x62,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x88, 0x12, 0x26, 0x82, 0x00,
+0x0c, 0x52, 0x06, 0x82, 0x00,
+0x11, 0x12, 0x16, 0x60, 0x04,
+0x0f, 0x34, 0x08, 0x81, 0x20,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x84, 0x30, 0x93, 0x01, 0x28,
+0xbc, 0x15, 0x16, 0xc0, 0x00,
+0x1b, 0x27, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xab, 0xc1, 0x07,
+0x68, 0x20, 0x00, 0xad, 0x20,
+0x68, 0x20, 0x01, 0x12, 0x21,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x20, 0x01, 0x0f, 0x22,
+0x68, 0x20, 0x00, 0xc5, 0x20,
+0x66, 0x00, 0x40, 0xf3, 0x48,
+0x40, 0x00, 0x02, 0x10, 0x61,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x30, 0x12, 0x8b, 0xc4, 0x20,
+0x6e, 0x00, 0x02, 0x66, 0x24,
+0x32, 0x06, 0x0b, 0xc3, 0xe0,
+0x6c, 0x00, 0x01, 0x70, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x63,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x38, 0x10, 0x62, 0x41, 0xad,
+0x6c, 0x00, 0x01, 0xb6, 0x49,
+0x32, 0x02, 0x0b, 0xc0, 0x65,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x38, 0x10, 0xd2, 0x41, 0x64,
+0x6c, 0x00, 0x01, 0xb6, 0x48,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x20, 0x83, 0x20, 0x20,
+0xbc, 0x06, 0xb3, 0x81, 0x25,
+0x6c, 0x00, 0x01, 0xb6, 0x0a,
+0x24, 0x17, 0x56, 0xc0, 0x00,
+0x1b, 0x64, 0x93, 0x20, 0x20,
+0xbc, 0x07, 0xd3, 0x81, 0x2c,
+0x6c, 0x00, 0x01, 0xb6, 0x09,
+0x24, 0x12, 0xc6, 0xc0, 0x00,
+0x1b, 0x64, 0x80, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xb6, 0x08,
+0x2a, 0x8e, 0x53, 0x20, 0xe8,
+0xbc, 0x03, 0x0b, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x5a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x09,
+0x6c, 0x40, 0x01, 0x5a, 0x49,
+0x38, 0x18, 0x52, 0x89, 0x64,
+0x30, 0x16, 0x0b, 0xc0, 0x40,
+0x40, 0x00, 0x03, 0xc0, 0x6f,
+0x6c, 0x40, 0x01, 0x8a, 0x7a,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x6c, 0x40, 0x01, 0x8a, 0x48,
+0x68, 0x00, 0x00, 0x61, 0x20,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x40, 0x00, 0x02, 0x80, 0x50,
+0x68, 0x00, 0x01, 0x08, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0xc0, 0x0a,
+0x6c, 0x40, 0x02, 0x36, 0x09,
+0x58, 0x0b, 0x82, 0xbf, 0xf0,
+0xbc, 0x71, 0x88, 0x80, 0x4a,
+0x38, 0x11, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x38,
+0xbc, 0x6b, 0x16, 0xc4, 0x00,
+0x22, 0xe0, 0xb6, 0xc4, 0x00,
+0x24, 0x00, 0x06, 0xc0, 0x00,
+0x16, 0xa0, 0x16, 0xc0, 0x00,
+0x17, 0xc0, 0x83, 0x00, 0x38,
+0xbc, 0x45, 0xd8, 0x80, 0xd1,
+0x30, 0x17, 0x0b, 0xc3, 0xc8,
+0x6c, 0x40, 0x02, 0x2e, 0x7a,
+0x68, 0x00, 0x01, 0xee, 0x21,
+0x5c, 0x83, 0x0b, 0x01, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x00,
+0x6c, 0x00, 0x03, 0xde, 0x0a,
+0x50, 0x41, 0x90, 0x08, 0x8b,
+0x20, 0x83, 0x94, 0xa5, 0x1b,
+0xb0, 0x1f, 0xe5, 0x04, 0xc5,
+0x80, 0xa0, 0xb2, 0xc8, 0x5b,
+0x54, 0x06, 0x58, 0x0a, 0x01,
+0x68, 0x00, 0x00, 0xe1, 0x22,
+0x22, 0x85, 0xb5, 0x04, 0x1d,
+0x85, 0x04, 0xf2, 0x08, 0x08,
+0x28, 0x01, 0x82, 0x09, 0x83,
+0x2c, 0x85, 0xb3, 0x68, 0x82,
+0x54, 0x06, 0x19, 0x80, 0x82,
+0x6c, 0x40, 0x02, 0x42, 0x00,
+0x30, 0x01, 0x02, 0x28, 0x5a,
+0x85, 0x0c, 0xeb, 0xc1, 0x0b,
+0x88, 0x00, 0xa2, 0xe0, 0x7f,
+0x36, 0x9c, 0x19, 0x80, 0x4b,
+0x30, 0x03, 0x8b, 0xc0, 0xa3,
+0x5c, 0x00, 0xfb, 0xa1, 0x11,
+0x44, 0x58, 0x00, 0x80, 0x8a,
+0x98, 0x30, 0xb2, 0x28, 0xbf,
+0x57, 0x4b, 0xeb, 0xc0, 0x3f,
+0x6c, 0x00, 0x01, 0xc0, 0x49,
+0x88, 0x08, 0xa8, 0x0a, 0x4a,
+0x80, 0x8c, 0xa8, 0x0a, 0x48,
+0x42, 0x06, 0x38, 0x48, 0x48,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x83, 0x0b, 0xc0, 0x8f,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x68, 0x00, 0x01, 0xee, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x8a,
+0x5c, 0x83, 0x0b, 0x80, 0x00,
+0x6c, 0x00, 0x03, 0xdc, 0x09,
+0x2f, 0x1a, 0xd8, 0x00, 0xc9,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x2e, 0x92, 0xd8, 0x02, 0x49,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x22, 0xe0, 0x95, 0x50, 0x36,
+0x84, 0x00, 0x06, 0xc0, 0x00,
+0x3d, 0xe0, 0xb2, 0xf1, 0x04,
+0x57, 0x4d, 0xf0, 0x40, 0x48,
+0x6c, 0x00, 0x03, 0xde, 0x4a,
+0x6c, 0x40, 0x02, 0x2e, 0x49,
+0x68, 0x00, 0x00, 0x96, 0x20,
+0x40, 0x00, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0xab, 0xfc, 0x08, 0x80, 0x64,
+0xa0, 0x90, 0x1a, 0x22, 0x84,
+0x88, 0x0e, 0x38, 0x81, 0x65,
+0x88, 0x1e, 0x28, 0x82, 0x60,
+0x88, 0x2f, 0x66, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x48, 0x81, 0xa0,
+0xa2, 0x0e, 0x48, 0x60, 0x48,
+0xa2, 0x48, 0x48, 0x83, 0x64,
+0x68, 0x20, 0x00, 0xd0, 0x24,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x5c, 0x83, 0x00, 0x83, 0x20,
+0x6c, 0x40, 0x01, 0xae, 0x09,
+0x5d, 0x0a, 0x28, 0x02, 0x48,
+0x23, 0x0a, 0xd6, 0x82, 0x00,
+0x13, 0xe2, 0x48, 0x40, 0x0a,
+0x57, 0x0d, 0x01, 0x82, 0x69,
+0x9e, 0x08, 0x49, 0x80, 0x02,
+0x5b, 0x44, 0x28, 0x60, 0x01,
+0x58, 0x03, 0x40, 0x80, 0x22,
+0x88, 0x52, 0x4a, 0x10, 0x81,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x6c, 0x40, 0x02, 0x1c, 0x08,
+0x96, 0x03, 0x8a, 0x08, 0x62,
+0xa0, 0x8a, 0x34, 0x20, 0x25,
+0x20, 0x0c, 0x08, 0x02, 0x09,
+0x38, 0x12, 0xb2, 0x58, 0xf8,
+0xbc, 0x7c, 0x08, 0x84, 0x26,
+0x88, 0x12, 0x59, 0x70, 0x2f,
+0x59, 0x03, 0xc0, 0x68, 0x7a,
+0x00, 0x00, 0x04, 0x20, 0x84,
+0x88, 0x1a, 0x58, 0x82, 0x27,
+0x86, 0x88, 0xb3, 0x01, 0xb8,
+0xbc, 0x07, 0xb8, 0x7b, 0x8b,
+0x30, 0x1f, 0x0b, 0xc0, 0x94,
+0x98, 0xe8, 0xb8, 0x68, 0xca,
+0x97, 0x06, 0x7b, 0xc0, 0x57,
+0x30, 0x1f, 0x0b, 0xc0, 0x3a,
+0x98, 0xe8, 0xb9, 0x70, 0x67,
+0x86, 0x8c, 0xa0, 0x00, 0x00,
+0x84, 0x98, 0x26, 0xc4, 0x00,
+0x26, 0x80, 0xb3, 0x01, 0xd0,
+0xbc, 0x25, 0x83, 0x90, 0x21,
+0x68, 0x20, 0x01, 0x32, 0x27,
+0x5c, 0x82, 0x10, 0x4a, 0x82,
+0x83, 0x88, 0x15, 0x70, 0x29,
+0xa1, 0x80, 0x65, 0x90, 0x04,
+0x01, 0xb5, 0x30, 0x00, 0x00,
+0x87, 0x80, 0x28, 0x58, 0x01,
+0x57, 0x04, 0x48, 0x79, 0x02,
+0x85, 0x85, 0x1b, 0xc0, 0x6c,
+0x84, 0xa8, 0x13, 0x00, 0x88,
+0xbc, 0x08, 0x28, 0x49, 0xcb,
+0x85, 0x15, 0x2b, 0xc0, 0x57,
+0x30, 0x08, 0x8b, 0xc0, 0x34,
+0x84, 0x9c, 0xb8, 0x51, 0x52,
+0x00, 0x00, 0x08, 0x58, 0x02,
+0x6c, 0x40, 0x02, 0x70, 0x0b,
+0x57, 0x05, 0xd0, 0x32, 0x8b,
+0x57, 0x0e, 0x90, 0x84, 0xa2,
+0xbc, 0x03, 0xf8, 0x70, 0x42,
+0x88, 0x4a, 0x20, 0x00, 0x00,
+0x00, 0x00, 0x08, 0x50, 0x0b,
+0x30, 0x13, 0x8b, 0xc0, 0xb3,
+0x6c, 0x40, 0x02, 0x52, 0x02,
+0x28, 0x0b, 0xf3, 0x09, 0x38,
+0xbc, 0x03, 0x4b, 0xc0, 0x6f,
+0x5c, 0x0b, 0xe0, 0x50, 0x4b,
+0xbc, 0x03, 0xf5, 0xc0, 0xbe,
+0x05, 0x04, 0x83, 0x81, 0x7c,
+0x25, 0x90, 0x0b, 0xc0, 0x28,
+0x38, 0x16, 0x7b, 0xc0, 0x27,
+0x25, 0x9c, 0x0b, 0xc1, 0x31,
+0x25, 0x90, 0x0b, 0xc0, 0x20,
+0xbc, 0x1c, 0xf3, 0x81, 0x74,
+0x25, 0x9c, 0x0b, 0xc1, 0x99,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x03, 0x99, 0x8e, 0x88,
+0x32, 0x02, 0x8b, 0xc0, 0x54,
+0x38, 0x17, 0x72, 0x59, 0xc0,
+0xbc, 0x10, 0x03, 0x20, 0x28,
+0xbc, 0x0e, 0x39, 0x60, 0x74,
+0xbc, 0x0c, 0x73, 0x81, 0x74,
+0x25, 0x90, 0x0b, 0xc0, 0x21,
+0x32, 0x02, 0x8b, 0xc0, 0x52,
+0x38, 0x17, 0x42, 0x59, 0x00,
+0xbc, 0x04, 0x03, 0x20, 0x28,
+0xbc, 0x02, 0x52, 0x41, 0xc0,
+0x96, 0x07, 0x0b, 0xc3, 0xdf,
+0x88, 0x12, 0x33, 0x20, 0x10,
+0xbc, 0x04, 0xc8, 0x81, 0xa5,
+0x57, 0x03, 0x93, 0xc0, 0x4f,
+0x86, 0x8c, 0x22, 0x81, 0x8a,
+0x40, 0x00, 0x00, 0x68, 0xc2,
+0x68, 0x20, 0x01, 0x37, 0x21,
+0x5c, 0x88, 0x08, 0x81, 0x23,
+0x80, 0xa8, 0x28, 0x58, 0x01,
+0x55, 0x02, 0x48, 0x84, 0x26,
+0x58, 0x04, 0x40, 0x58, 0x51,
+0x42, 0x02, 0xeb, 0x00, 0x09,
+0x5c, 0x81, 0x09, 0x70, 0x61,
+0xbc, 0x03, 0xf5, 0xc0, 0xbd,
+0x05, 0x85, 0x23, 0x81, 0x7a,
+0x52, 0xc4, 0x02, 0xc0, 0xe2,
+0x80, 0x88, 0x18, 0x08, 0x83,
+0x81, 0x0d, 0x18, 0x50, 0x53,
+0x00, 0x00, 0x08, 0x0b, 0x01,
+0x88, 0x4a, 0x68, 0x48, 0x03,
+0x42, 0x05, 0x40, 0x50, 0xd1,
+0x5c, 0x00, 0x00, 0x70, 0x53,
+0x24, 0x08, 0x25, 0x90, 0x14,
+0x16, 0x07, 0x2b, 0xc0, 0x4d,
+0x38, 0x17, 0x09, 0x60, 0x3a,
+0x24, 0x01, 0x09, 0x60, 0x70,
+0x5c, 0x09, 0x20, 0x49, 0x48,
+0x25, 0x93, 0x8b, 0xc0, 0x70,
+0x6c, 0x40, 0x04, 0xa4, 0x08,
+0x6c, 0x40, 0x01, 0x50, 0x48,
+0x6c, 0x40, 0x01, 0x80, 0x48,
+0x00, 0x00, 0x08, 0x68, 0x8b,
+0x80, 0x24, 0xb8, 0x80, 0x60,
+0x66, 0x00, 0x00, 0x66, 0xc8,
+0x40, 0x00, 0x00, 0x58, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2e,
+0x5c, 0x08, 0xa8, 0x80, 0x20,
+0x25, 0x97, 0x0b, 0xc2, 0xf9,
+0x84, 0x04, 0x80, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x2c, 0x09,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x79,
+0x88, 0x0a, 0x46, 0xc0, 0x00,
+0x1c, 0x00, 0x86, 0xc4, 0x00,
+0x23, 0x60, 0xb3, 0x01, 0xe0,
+0xbc, 0x20, 0x95, 0xc0, 0x97,
+0x86, 0x00, 0x02, 0x59, 0xf0,
+0xbc, 0x0d, 0x98, 0x82, 0x22,
+0x28, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0xb3, 0x01, 0xf0,
+0xbc, 0x01, 0x58, 0x50, 0x4b,
+0x2e, 0x10, 0x28, 0x50, 0x0a,
+0x98, 0x08, 0x83, 0x01, 0x30,
+0xbc, 0x01, 0x38, 0x50, 0x48,
+0x00, 0x00, 0x08, 0x50, 0x08,
+0x86, 0x00, 0xa3, 0x01, 0xa0,
+0xbc, 0x03, 0xb2, 0x29, 0x6d,
+0x2e, 0x14, 0x28, 0x60, 0x42,
+0x00, 0x00, 0x08, 0x50, 0x0a,
+0x86, 0x00, 0x83, 0x01, 0x30,
+0xbc, 0x02, 0x52, 0x81, 0x40,
+0x86, 0x04, 0x00, 0x00, 0x00,
+0x88, 0x2b, 0x68, 0x43, 0x8a,
+0x46, 0x0a, 0x40, 0x40, 0x09,
+0x57, 0x0b, 0x82, 0x80, 0x40,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x55, 0x01, 0x2a, 0xbf, 0xd0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xb2, 0x21, 0x62,
+0x52, 0xcd, 0x00, 0x80, 0xe2,
+0xa0, 0x88, 0x14, 0x20, 0x8c,
+0x88, 0x17, 0x68, 0x80, 0x61,
+0xa1, 0x06, 0x18, 0x81, 0xe4,
+0xa0, 0x80, 0x48, 0x80, 0x22,
+0x88, 0x26, 0x0a, 0x10, 0x41,
+0x88, 0x2c, 0x96, 0x60, 0x04,
+0x05, 0x34, 0x8a, 0x08, 0x00,
+0x88, 0x22, 0x08, 0x80, 0xa2,
+0x84, 0x24, 0x80, 0x00, 0x00,
+0x88, 0x1a, 0x48, 0x82, 0x89,
+0x00, 0x00, 0x08, 0x53, 0x08,
+0x08, 0x40, 0x08, 0x41, 0x40,
+0x66, 0x00, 0x40, 0xb9, 0xa0,
+0x6e, 0x00, 0x02, 0x66, 0x25,
+0x59, 0x03, 0x40, 0x80, 0x24,
+0xbc, 0x10, 0x8a, 0x20, 0x20,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x12, 0x42, 0x59, 0x28,
+0xbc, 0x15, 0x88, 0x80, 0xa4,
+0x6c, 0x40, 0x02, 0x50, 0x09,
+0x66, 0x00, 0x00, 0x63, 0xc8,
+0x86, 0x08, 0xa8, 0x80, 0xa0,
+0x00, 0x00, 0x08, 0x40, 0xc8,
+0xbc, 0x0b, 0x78, 0x60, 0x89,
+0x6c, 0x40, 0x02, 0x32, 0x08,
+0x36, 0x94, 0x53, 0x01, 0x60,
+0xbc, 0x05, 0x58, 0x80, 0xa0,
+0x6c, 0x40, 0x02, 0x70, 0x09,
+0x84, 0x0c, 0x90, 0x00, 0x00,
+0x88, 0x13, 0x6b, 0xa1, 0x48,
+0xa8, 0x03, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x02, 0x08, 0x81,
+0xa2, 0x16, 0x4d, 0x20, 0x80,
+0x44, 0x10, 0x00, 0x20, 0x08,
+0x84, 0x80, 0xa4, 0x44, 0x40,
+0x04, 0x10, 0x84, 0x60, 0xa4,
+0x06, 0x00, 0xa0, 0x82, 0x80,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x30, 0x1a, 0x8b, 0xc0, 0xe8,
+0x6c, 0x40, 0x04, 0xb6, 0x08,
+0x84, 0x00, 0xb3, 0x69, 0xc0,
+0x98, 0x00, 0xb3, 0x09, 0x38,
+0xbc, 0x06, 0x46, 0xc4, 0x00,
+0x4b, 0x40, 0x82, 0x81, 0x30,
+0x42, 0x01, 0x79, 0x80, 0x0a,
+0x2f, 0x17, 0x59, 0x82, 0x89,
+0xba, 0x14, 0x89, 0x82, 0x48,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x46, 0x08, 0x8a, 0xbf, 0xe0,
+0x51, 0x61, 0xb0, 0x80, 0x49,
+0x51, 0x61, 0xe0, 0x80, 0xf6,
+0x1a, 0x0a, 0x29, 0x83, 0x09,
+0x98, 0x38, 0x82, 0x81, 0x2d,
+0x88, 0x14, 0x96, 0x60, 0x04,
+0x0c, 0x2e, 0x8b, 0xa1, 0x01,
+0x88, 0x10, 0x94, 0x40, 0x80,
+0x08, 0x00, 0x99, 0x80, 0x08,
+0x23, 0x42, 0x43, 0x01, 0x60,
+0xbc, 0x02, 0x5b, 0xc0, 0x2f,
+0x2e, 0x16, 0x49, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x38, 0x12, 0x26, 0xc4, 0x00,
+0x22, 0xc0, 0x12, 0x58, 0xa0,
+0x40, 0x00, 0x03, 0xc0, 0x49,
+0x55, 0x00, 0x79, 0x82, 0xc2,
+0x6c, 0x40, 0x04, 0xba, 0x01,
+0x6c, 0x40, 0x02, 0x78, 0x03,
+0x30, 0x0f, 0x8b, 0xc0, 0x70,
+0x68, 0x00, 0x01, 0x52, 0x08,
+0x30, 0x10, 0x0b, 0xc0, 0x4c,
+0x98, 0xe8, 0x89, 0x82, 0xc8,
+0xbc, 0x01, 0x72, 0xa0, 0x0c,
+0x6e, 0x00, 0x02, 0x66, 0x27,
+0x32, 0x03, 0x8b, 0xc1, 0x91,
+0x30, 0x0e, 0x0b, 0xc1, 0x71,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc1, 0x33,
+0x6c, 0x00, 0x01, 0xb2, 0x00,
+0x30, 0x10, 0x0b, 0xc0, 0xc3,
+0x6c, 0x00, 0x01, 0xc6, 0x08,
+0x2a, 0x06, 0x43, 0x22, 0xa0,
+0x6c, 0x00, 0x01, 0xc6, 0x48,
+0xbc, 0x05, 0x52, 0xa0, 0x44,
+0x6c, 0x00, 0x01, 0xb2, 0x48,
+0x6c, 0x00, 0x01, 0xc6, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x1b, 0x20, 0x83, 0x20, 0x78,
+0x48, 0xb3, 0xa3, 0xc0, 0x88,
+0x9a, 0x04, 0x13, 0x01, 0x90,
+0xbc, 0x0b, 0x43, 0x01, 0x90,
+0xbc, 0x09, 0xb9, 0x82, 0x88,
+0x98, 0x2c, 0x8b, 0xa1, 0x40,
+0x32, 0x02, 0x8b, 0xc0, 0x44,
+0x32, 0x02, 0x8b, 0xc0, 0x2b,
+0x98, 0x28, 0x89, 0x82, 0xc8,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0xe0, 0x0b,
+0x6c, 0x00, 0x01, 0xec, 0x01,
+0x6c, 0x00, 0x01, 0xe2, 0x0a,
+0x6c, 0x00, 0x01, 0xee, 0x03,
+0x2e, 0x1f, 0x22, 0xe0, 0x59,
+0x6c, 0x00, 0x01, 0xd4, 0x09,
+0x6c, 0x00, 0x01, 0xd6, 0x08,
+0x6c, 0x00, 0x03, 0x8c, 0x42,
+0x6c, 0x00, 0x03, 0xa2, 0x41,
+0x57, 0x0b, 0x03, 0xa1, 0x48,
+0x6c, 0x00, 0x03, 0x76, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x80, 0xe0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x80, 0xe0,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x7c, 0xa8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x07, 0xca, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x20, 0xe2, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x02, 0x37, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x02, 0x37, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x95, 0xc8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0xa3, 0xa8,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0xa3, 0xa8,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x9d, 0x68,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x09, 0xd6, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x09, 0xda, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0xa1, 0x48,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x00, 0x14,
+0x84, 0x00, 0x02, 0x41, 0x86,
+0x84, 0x04, 0xaa, 0x00, 0xe0,
+0x84, 0x04, 0x8a, 0x05, 0xe0,
+0x84, 0x07, 0xaa, 0x00, 0x40,
+0x46, 0x0a, 0x40, 0x40, 0x7a,
+0x84, 0x27, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x02, 0xef, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xc6, 0x20,
+0x5c, 0x81, 0x0a, 0xc0, 0xc0,
+0x6c, 0x40, 0x03, 0xa6, 0x09,
+0x80, 0x08, 0x86, 0x80, 0x00,
+0x1b, 0xb2, 0x46, 0x80, 0x00,
+0x1d, 0x12, 0x14, 0x40, 0x90,
+0x02, 0x08, 0x96, 0xc4, 0x00,
+0x39, 0xe0, 0x84, 0x42, 0x08,
+0x00, 0x88, 0x96, 0xc4, 0x00,
+0x3a, 0xe0, 0x84, 0x42, 0x00,
+0x3a, 0x11, 0x16, 0xc4, 0x00,
+0x3b, 0x40, 0x8a, 0xbf, 0xd0,
+0x88, 0x2f, 0x69, 0xa0, 0x02,
+0x4d, 0x25, 0x00, 0x02, 0x4a,
+0x51, 0x62, 0x09, 0x80, 0x4a,
+0x44, 0x40, 0x00, 0x0a, 0x49,
+0x51, 0x62, 0x00, 0x22, 0x4a,
+0x51, 0x62, 0x91, 0x83, 0x09,
+0x88, 0x26, 0x48, 0x80, 0x4d,
+0x84, 0x84, 0xe8, 0x81, 0x49,
+0x88, 0x0e, 0x18, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xe0, 0x24,
+0x66, 0x00, 0x40, 0xf7, 0xe8,
+0x46, 0x08, 0x08, 0x80, 0x0a,
+0x88, 0x22, 0x08, 0x80, 0x09,
+0x84, 0x04, 0x86, 0x82, 0x00,
+0x1e, 0x32, 0x46, 0x60, 0x04,
+0x0f, 0x7e, 0x88, 0x81, 0x0a,
+0x5c, 0x82, 0x00, 0x82, 0x20,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x04, 0x88, 0x80, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x92, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0x60,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0x9e, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x82, 0x00, 0x80, 0xa0,
+0x88, 0x1a, 0x48, 0x00, 0x09,
+0x86, 0x14, 0x88, 0x81, 0xe0,
+0x68, 0x20, 0x01, 0xbf, 0x24,
+0x68, 0x00, 0x01, 0xaa, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x21,
+0x68, 0x20, 0x01, 0xbf, 0x20,
+0x88, 0x0a, 0x2a, 0x00, 0x64,
+0x80, 0x80, 0x98, 0x51, 0x48,
+0x88, 0x0e, 0x48, 0x82, 0x61,
+0x68, 0x00, 0x01, 0x92, 0x23,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x02, 0x18, 0x40,
+0x5c, 0x81, 0x00, 0x80, 0x20,
+0x88, 0x12, 0x16, 0x80, 0x00,
+0x19, 0xe2, 0x48, 0x40, 0xc8,
+0xa2, 0x04, 0x08, 0x08, 0x09,
+0x88, 0x0a, 0x48, 0x80, 0x61,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x81, 0x00, 0x81, 0x20,
+0x68, 0x00, 0x01, 0xaa, 0x24,
+0x84, 0x0c, 0x8a, 0x20, 0x40,
+0x88, 0x1a, 0x18, 0x80, 0xa4,
+0x80, 0x80, 0x98, 0x80, 0xe1,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x81, 0xa0,
+0x88, 0x22, 0x48, 0x40, 0xc8,
+0xa2, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0x24,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x5c, 0x83, 0x00, 0x80, 0xa4,
+0x00, 0x00, 0x0a, 0x20, 0x00,
+0xa0, 0x4a, 0x08, 0x22, 0x09,
+0x66, 0x00, 0x40, 0xf7, 0x68,
+0x86, 0x00, 0x88, 0x82, 0xb6,
+0x68, 0x00, 0x03, 0x19, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x0a, 0x80, 0x30,
+0xab, 0xf9, 0x06, 0xc0, 0x00,
+0x17, 0x00, 0x86, 0xc0, 0x00,
+0x18, 0x20, 0x96, 0xc0, 0x00,
+0x31, 0x80, 0xa8, 0x80, 0x4a,
+0x88, 0x0c, 0x98, 0x81, 0x48,
+0x88, 0x1f, 0x66, 0x60, 0x04,
+0x0f, 0xd6, 0x8a, 0x41, 0x00,
+0x68, 0x00, 0x01, 0xba, 0x20,
+0x68, 0x20, 0x01, 0xdc, 0x24,
+0x5c, 0x83, 0x02, 0xc0, 0x21,
+0x68, 0x00, 0x01, 0xc5, 0x21,
+0xd8, 0x88, 0x15, 0x70, 0xd5,
+0x00, 0xa0, 0x08, 0x60, 0x09,
+0x57, 0x0a, 0x00, 0x83, 0x60,
+0x88, 0x24, 0x08, 0x82, 0xe1,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x01, 0x80, 0x89,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x40, 0x00, 0x00, 0x82, 0x09,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x02, 0x68, 0x24,
+0x84, 0x08, 0x96, 0x80, 0x00,
+0x1e, 0x82, 0x06, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x83, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x86, 0x04, 0x86, 0x82, 0x00,
+0x26, 0x82, 0x48, 0x40, 0x89,
+0x68, 0x00, 0x01, 0xea, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x86, 0x00, 0x83, 0x24,
+0x55, 0x01, 0x28, 0x82, 0xa0,
+0x82, 0x00, 0x88, 0x40, 0x49,
+0x40, 0x00, 0x00, 0x82, 0x64,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x5c, 0x86, 0x00, 0x82, 0xa4,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x82, 0x00, 0x88, 0x83, 0xe4,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf8, 0x60,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x68, 0x00, 0x01, 0x9c, 0x20,
+0x40, 0x00, 0x00, 0x60, 0x08,
+0x68, 0x20, 0x01, 0xbc, 0x24,
+0x66, 0x00, 0x40, 0xf9, 0x80,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x00, 0x00, 0x08, 0x62, 0x0a,
+0x68, 0x20, 0x02, 0x6b, 0x24,
+0x66, 0x00, 0x00, 0xdb, 0x88,
+0x6c, 0x00, 0x03, 0x2e, 0x09,
+0x88, 0x32, 0x46, 0xc0, 0x00,
+0x34, 0x60, 0x98, 0x63, 0x48,
+0x68, 0x00, 0x01, 0xa3, 0x20,
+0x68, 0x20, 0x02, 0x6d, 0x24,
+0x66, 0x00, 0x00, 0xdb, 0x88,
+0x40, 0x00, 0x00, 0x42, 0x0a,
+0x5c, 0x83, 0x00, 0x82, 0x24,
+0x88, 0x2a, 0x08, 0x22, 0x09,
+0x84, 0x34, 0x88, 0x82, 0x64,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x68, 0x00, 0x01, 0xe4, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x5c, 0x83, 0x00, 0x83, 0xa0,
+0x68, 0x20, 0x02, 0x47, 0x24,
+0x80, 0x20, 0x98, 0x82, 0xe0,
+0x68, 0x00, 0x01, 0xe6, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x88, 0x10, 0x93, 0x69, 0x44,
+0x6c, 0x40, 0x03, 0xb0, 0x0a,
+0x58, 0x0d, 0x01, 0x8e, 0x88,
+0xbc, 0x03, 0xa5, 0x50, 0x10,
+0x08, 0x08, 0x9b, 0x00, 0x0c,
+0x36, 0x94, 0x23, 0x01, 0x90,
+0xbc, 0x03, 0xa5, 0x50, 0x01,
+0x08, 0x00, 0x9b, 0x00, 0x0a,
+0x36, 0x94, 0x53, 0x01, 0xa8,
+0xbc, 0x01, 0x2b, 0x00, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0x69,
+0x88, 0x22, 0x43, 0x20, 0x00,
+0xbc, 0x03, 0x13, 0x20, 0x10,
+0x40, 0x00, 0x03, 0xc0, 0x60,
+0x6c, 0x40, 0x03, 0xb2, 0x09,
+0x6c, 0x00, 0x03, 0xaa, 0x49,
+0x6c, 0x00, 0x03, 0xac, 0x49,
+0x68, 0x00, 0x01, 0xe0, 0x20,
+0x86, 0x00, 0x96, 0x82, 0x00,
+0x0a, 0xa2, 0x46, 0x60, 0x04,
+0x05, 0x34, 0x08, 0x82, 0xa0,
+0x88, 0x04, 0x86, 0x82, 0x00,
+0x0c, 0x22, 0x48, 0x40, 0x09,
+0x68, 0x00, 0x01, 0xe2, 0x20,
+0x66, 0x00, 0x40, 0x53, 0x40,
+0x66, 0x00, 0x41, 0x01, 0x48,
+0x55, 0x01, 0x28, 0x80, 0x08,
+0x6c, 0x00, 0x03, 0xaa, 0x09,
+0x32, 0x02, 0x8b, 0xc0, 0xac,
+0x39, 0x04, 0x16, 0x80, 0x00,
+0x1b, 0xd2, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x08, 0x78, 0x60, 0xc9,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x68, 0x00, 0x01, 0x97, 0x24,
+0x5c, 0x81, 0x02, 0xc0, 0x62,
+0x55, 0x3f, 0x68, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xa4, 0x96, 0xc0, 0x00,
+0x37, 0xc7, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3a, 0xc0, 0x93, 0x20, 0x28,
+0xbc, 0x07, 0x46, 0x80, 0x00,
+0x1c, 0x82, 0x40, 0x00, 0x00,
+0x40, 0x00, 0x00, 0x60, 0x09,
+0x42, 0x06, 0x38, 0x60, 0xc9,
+0x68, 0x00, 0x01, 0xa3, 0x24,
+0x2a, 0x7e, 0xd8, 0x20, 0xfa,
+0x82, 0x27, 0xa8, 0x21, 0x7a,
+0x82, 0x27, 0xa6, 0xc0, 0x00,
+0x3a, 0xc4, 0x96, 0xc0, 0x00,
+0x39, 0x27, 0xa8, 0x60, 0x7a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x3b, 0x20, 0x93, 0x20, 0x28,
+0xbc, 0x04, 0x06, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc0, 0x00,
+0x39, 0x27, 0xa3, 0x81, 0x2c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x25, 0x92, 0x8b, 0xc2, 0x89,
+0x88, 0x22, 0x43, 0x81, 0x3c,
+0x25, 0x92, 0x8b, 0xc2, 0x41,
+0x6c, 0x00, 0x03, 0xca, 0x09,
+0x36, 0x94, 0x06, 0xc4, 0x00,
+0x4c, 0x80, 0x99, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc1, 0x24,
+0x6c, 0x00, 0x03, 0xce, 0x08,
+0x36, 0x90, 0x09, 0x80, 0x08,
+0x30, 0x96, 0x0b, 0xc0, 0xc4,
+0x6c, 0x40, 0x04, 0xcc, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x20,
+0x2a, 0x7e, 0xd6, 0xc0, 0x00,
+0x39, 0x27, 0xa6, 0xc0, 0x00,
+0x37, 0xc7, 0xa6, 0xc4, 0x00,
+0x4c, 0xc4, 0x9b, 0xc0, 0xa7,
+0x68, 0x20, 0x02, 0x65, 0x20,
+0x6c, 0x00, 0x03, 0x7c, 0x7a,
+0x6c, 0x00, 0x03, 0x92, 0x7a,
+0x00, 0x00, 0x08, 0x40, 0x09,
+0x40, 0x00, 0x00, 0x40, 0xc9,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x86, 0x20, 0x98, 0x82, 0xa4,
+0x6c, 0x00, 0x03, 0x06, 0x48,
+0x66, 0x00, 0x40, 0xfb, 0x68,
+0x40, 0x00, 0x00, 0x62, 0x09,
+0x6c, 0x00, 0x03, 0x0a, 0x48,
+0x68, 0x00, 0x03, 0x6c, 0xa4,
+0x88, 0x1b, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x02, 0xea, 0x64,
+0x40, 0x00, 0x02, 0x80, 0x70,
+0x68, 0x00, 0x02, 0xed, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x57, 0x0d, 0x40, 0x60, 0x89,
+0x2e, 0x14, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x0b, 0xc0, 0xe4,
+0x32, 0x02, 0x0b, 0xc1, 0x83,
+0x86, 0x00, 0xa2, 0xe1, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x0f, 0x53, 0x61, 0x85,
+0x86, 0x0c, 0x9b, 0xa1, 0x40,
+0x86, 0x00, 0xa2, 0x81, 0xad,
+0x5b, 0x4a, 0x00, 0x60, 0xc9,
+0x98, 0x00, 0x96, 0xc4, 0x00,
+0x24, 0x60, 0xa3, 0x01, 0xa8,
+0xbc, 0x03, 0x5b, 0xa1, 0x48,
+0x86, 0x0c, 0xa0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x2e, 0xda, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..3e7cf24a82f6817e4f8ad4478d341d1655877ac2
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Code_0_2_7_2_1_1.h
@@ -0,0 +1,1818 @@
+// Time Stamp : 2019/03/18 21:22:54
+
+//VERNUM [021b0007] [01000702]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			7
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			1
+
+#define CHECKSUM_COMMAND_DMA_0_2_7_2_1_1			0x00041834
+#define CHECKSUM_COMMAND_DMB_0_2_7_2_1_1			0x0004186e
+
+#define LC898124EP3_DMA_ByteSize_0_2_7_2_1_1		0x0054
+#define LC898124EP3_DMA_CheckSum_0_2_7_2_1_1		0x0800650D
+
+#define LC898124EP3_DMB_ByteSize_0_2_7_2_1_1		0x0460
+#define LC898124EP3_DMB_CheckSum_0_2_7_2_1_1		0xA43F17F4
+
+#define LC898124EP3_PMCheckSum_0_2_7_2_1_1		0x000880FD
+#define LC898124EP3_PMSize_0_2_7_2_1_1			1489
+
+const unsigned char LC898124EP3_DM_0_2_7_2_1_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0xec,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x07,
+0xA0, 0x04, 0x01, 0x00, 0x07, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xf2, 0x4b, 0x39, 0xd9,
+0xA0, 0xA0, 0x7f, 0xdd, 0xc2, 0x15,
+0xA0, 0xA4, 0x0d, 0xc5, 0xef, 0x83,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x10, 0x1d, 0x3f, 0x2d,
+0xA0, 0xB4, 0xa9, 0xec, 0x1c, 0x59,
+0xA0, 0xB8, 0x75, 0x50, 0x33, 0x99,
+0xA0, 0xBC, 0x57, 0x97, 0x3f, 0xa9,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x50, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x1C, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0x20, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0x24, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x28, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xf2, 0x4b, 0x39, 0xd9,
+0xA1, 0x3C, 0x7f, 0xdd, 0xc2, 0x15,
+0xA1, 0x40, 0x0d, 0xc5, 0xef, 0x83,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x10, 0x1d, 0x3f, 0x2d,
+0xA1, 0x50, 0xa9, 0xec, 0x1c, 0x59,
+0xA1, 0x54, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x58, 0x57, 0x97, 0x3f, 0xa9,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x50, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xB8, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0xBC, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0xC0, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0xC4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xC8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xCC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xD4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD8, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xDC, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xE0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xE4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xEC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xF0, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xF4, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xF8, 0x03, 0x02, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x02,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0x98, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x9C, 0x00, 0x22, 0x00, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x03, 0x74,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x00, 0x05, 0xd2,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x1a, 0x80,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x04, 0x32,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x00, 0x04, 0x10,
+0xA6, 0x20, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x24, 0x00, 0x04, 0x1b, 0xbe,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x78, 0x47, 0xae, 0xfe, 0x3f,
+0xA6, 0xBC, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xC0, 0x53, 0xba, 0x13, 0xe3,
+0xA6, 0xC4, 0x16, 0x22, 0xf6, 0x0f,
+0xA6, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA6, 0xF0, 0x82, 0x35, 0xee, 0x09,
+0xA6, 0xF4, 0x7d, 0x6c, 0xb0, 0xcd,
+0xA6, 0xF8, 0x7f, 0xa2, 0x9e, 0xd5,
+0xA6, 0xFC, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x00, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x04, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x08, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x0C, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x10, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x14, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x18, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x1C, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x20, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x24, 0x7f, 0xa9, 0x52, 0xcb,
+0xA7, 0x28, 0x00, 0x2b, 0x56, 0x9b,
+0xA7, 0x2C, 0x00, 0x74, 0x52, 0x6f,
+0xA7, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x34, 0x3a, 0x99, 0x29, 0xc5,
+0xA7, 0x38, 0x00, 0x00, 0x00, 0x02,
+0xA7, 0x3C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x4C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x5C, 0x01, 0xff, 0xff, 0xff,
+0xA7, 0x60, 0x03, 0xc5, 0x18, 0xe6,
+0xA7, 0x64, 0x00, 0x00, 0x1a, 0x68,
+0xA7, 0x68, 0x00, 0x13, 0x9d, 0x01,
+0xA7, 0x6C, 0x00, 0x0f, 0xff, 0xff,
+0xA7, 0x7C, 0x13, 0xff, 0xff, 0xff,
+0xA7, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0x98, 0x00, 0x00, 0x00, 0xe1,
+0xA7, 0x9C, 0x00, 0x00, 0xf0, 0xe3,
+0xA7, 0xA0, 0x00, 0x7d, 0x86, 0x6e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x18, 0x01, 0x00, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_PM_0_2_7_2_1_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x5f, 0xa7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x63, 0x27,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x31, 0xa8,
+0x40, 0x00, 0x02, 0xbf, 0xc0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x02,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x83, 0x0a, 0x03, 0x20,
+0x5c, 0x02, 0xf8, 0x40, 0x00,
+0x52, 0x48, 0x03, 0x06, 0x24,
+0x5c, 0x00, 0x80, 0x03, 0x50,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x40, 0x7a,
+0xa0, 0x10, 0x08, 0x40, 0x7a,
+0xa0, 0x58, 0x05, 0xc0, 0xdb,
+0x00, 0x24, 0xa8, 0x40, 0x48,
+0xa0, 0x22, 0x08, 0x40, 0x08,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x85, 0x13, 0x1d, 0xf4,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x84, 0x04, 0x8a, 0x00, 0x80,
+0xb0, 0x80, 0xc6, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x40, 0x48,
+0x84, 0x0c, 0x8a, 0x20, 0x20,
+0x86, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x05, 0x0a, 0xc7, 0xe0,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x80, 0x05, 0x06, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x84, 0x80, 0xb5, 0x24, 0xdf,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x00, 0x25, 0x0b, 0x06, 0x07,
+0xac, 0x40, 0x08, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0xc0,
+0x5c, 0x81, 0x02, 0x40, 0xc0,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0xc0,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x05, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0xcf,
+0x5c, 0x00, 0x6b, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x5c, 0x08, 0xf3, 0x00, 0x0d,
+0x52, 0x0d, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x40, 0x03, 0x1e, 0x49,
+0x6c, 0x40, 0x03, 0x1a, 0x49,
+0x66, 0x00, 0x00, 0x1a, 0x60,
+0x66, 0x00, 0x00, 0x6c, 0x20,
+0x6e, 0x00, 0x00, 0x8c, 0xad,
+0x38, 0x1b, 0xc3, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x40,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x04, 0x50, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x6c, 0x40, 0x02, 0x4e, 0x0a,
+0x5c, 0x0b, 0x6b, 0x00, 0x84,
+0x6c, 0x40, 0x02, 0x2a, 0x4a,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0x63, 0xa0,
+0x6c, 0x00, 0x01, 0xb0, 0x60,
+0x66, 0x00, 0x00, 0x69, 0xa0,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x6c, 0x00, 0x00, 0x8e, 0x7a,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x81, 0xa0,
+0x68, 0x38, 0x08, 0x46, 0x20,
+0x5c, 0x0e, 0xa2, 0xfa, 0xc0,
+0x9c, 0x00, 0x08, 0x80, 0x60,
+0xa0, 0x02, 0x08, 0x80, 0xe0,
+0xa0, 0x02, 0x08, 0x81, 0x60,
+0xa0, 0x02, 0x0a, 0x00, 0x20,
+0x88, 0x1e, 0x0b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x26, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0d, 0xd2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x38, 0x13, 0xc6, 0xe0, 0x00,
+0x1a, 0xea, 0xd2, 0x59, 0x28,
+0xbc, 0x2f, 0x06, 0x80, 0x00,
+0x06, 0x3a, 0x06, 0xc0, 0x00,
+0x1b, 0x00, 0x99, 0x88, 0x08,
+0x30, 0x12, 0x8b, 0xc2, 0x81,
+0x6c, 0x70, 0x10, 0x8c, 0x08,
+0x5c, 0x08, 0x28, 0x80, 0x20,
+0x52, 0x0b, 0x20, 0x80, 0xa4,
+0x6c, 0x70, 0x10, 0x8c, 0x48,
+0x5c, 0x81, 0x02, 0xfc, 0xc2,
+0x5c, 0x00, 0x58, 0x40, 0x00,
+0x5c, 0x83, 0x08, 0x40, 0x88,
+0x86, 0x08, 0xb8, 0x81, 0x20,
+0x88, 0x1a, 0x48, 0x40, 0x8a,
+0x82, 0x00, 0x26, 0x80, 0x00,
+0x18, 0x82, 0x08, 0x21, 0x01,
+0x80, 0x25, 0x0a, 0xc7, 0xe2,
+0x84, 0x1c, 0xb8, 0x21, 0x53,
+0x68, 0x00, 0x01, 0x7c, 0x21,
+0x86, 0x00, 0xb6, 0xc0, 0x00,
+0x2f, 0x84, 0xa5, 0x24, 0xbe,
+0x80, 0x0c, 0x88, 0x48, 0xd2,
+0x84, 0x25, 0x18, 0x60, 0x49,
+0x66, 0x00, 0x00, 0x66, 0x60,
+0x66, 0x00, 0x00, 0x63, 0x40,
+0x66, 0x00, 0x00, 0x1b, 0x80,
+0x88, 0x22, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x06, 0xc4, 0x00,
+0x49, 0xa0, 0xa2, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x59, 0x41, 0x80, 0x44, 0x48,
+0xbc, 0x07, 0x06, 0xc0, 0x00,
+0x1b, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x02, 0xea, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0x76, 0xf3, 0x81, 0xd4,
+0x68, 0x00, 0x00, 0x66, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x63, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x68, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x65, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x06, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x76, 0x20,
+0x2a, 0x06, 0x43, 0xa1, 0x04,
+0x32, 0x2a, 0x0b, 0xff, 0xca,
+0x80, 0x07, 0xa6, 0xc0, 0x00,
+0x1c, 0x67, 0xa0, 0x00, 0x00,
+0x6c, 0x40, 0x02, 0x78, 0x08,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x1b, 0x24, 0x80, 0x00, 0x00,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x30, 0x20,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x30, 0x20,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x2b, 0xa8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0xba, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0c, 0xb2, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xf4, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xf4, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x76, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x3d,
+0x52, 0x4b, 0xc3, 0xc0, 0x6f,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x4d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x49, 0xae,
+0x6c, 0x40, 0x03, 0x76, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x45, 0x08,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x52, 0xe8,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x52, 0xe8,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x4c, 0xa8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0xca, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0xce, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x50, 0x88,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x1c, 0x08,
+0x5c, 0x0e, 0x33, 0x01, 0x05,
+0x24, 0x1a, 0x46, 0xe0, 0x00,
+0x1a, 0xe2, 0xf2, 0x59, 0x60,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0xbc, 0x05, 0x83, 0x81, 0x15,
+0x52, 0x4b, 0xc3, 0xc0, 0xcf,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x52, 0x0b, 0xc3, 0x01, 0x0d,
+0x25, 0x96, 0x0b, 0xc0, 0x68,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x6c, 0x00, 0x01, 0x46, 0x7a,
+0x6c, 0x00, 0x01, 0x5a, 0x7a,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x52, 0x8d, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0x92, 0x51, 0xae,
+0x6c, 0x40, 0x03, 0x1c, 0x48,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x46, 0x0a, 0x40, 0x02, 0x4a,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x08,
+0x32, 0x82, 0x0b, 0xc2, 0xa1,
+0x6c, 0x00, 0x01, 0x88, 0x08,
+0x6c, 0x40, 0x04, 0x98, 0x0a,
+0x30, 0x93, 0x0b, 0xc1, 0x29,
+0x5c, 0x80, 0x81, 0x8e, 0x8a,
+0x68, 0x20, 0x02, 0x4b, 0xa0,
+0x39, 0x02, 0x19, 0x40, 0x3c,
+0x55, 0x03, 0x22, 0x00, 0x01,
+0x3a, 0x90, 0x49, 0x42, 0xd4,
+0x00, 0x00, 0x09, 0x40, 0x38,
+0x30, 0x02, 0x0b, 0xc1, 0x62,
+0x46, 0x0a, 0x41, 0x4a, 0x56,
+0x94, 0x87, 0x60, 0x00, 0x00,
+0x68, 0x20, 0x02, 0x4b, 0x21,
+0x39, 0x04, 0x19, 0x48, 0x1a,
+0x55, 0x02, 0x91, 0x48, 0x56,
+0x5d, 0x44, 0x20, 0x0a, 0xc8,
+0x00, 0x00, 0x09, 0x48, 0x3a,
+0x30, 0x0a, 0x0b, 0xc0, 0x6a,
+0x5c, 0x00, 0x41, 0x49, 0x74,
+0x80, 0x2d, 0x09, 0x40, 0x56,
+0x94, 0x05, 0x68, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x68, 0x20, 0x01, 0xad, 0x21,
+0x68, 0x00, 0x01, 0x7c, 0x22,
+0x5c, 0x81, 0x02, 0x08, 0x23,
+0xa1, 0xde, 0x48, 0x50, 0x88,
+0x86, 0x00, 0x94, 0x40, 0x80,
+0x22, 0x02, 0x08, 0x50, 0x0a,
+0x80, 0x00, 0x96, 0x80, 0x00,
+0x18, 0xe2, 0x54, 0x44, 0xc0,
+0x04, 0x80, 0x94, 0x44, 0x88,
+0x22, 0xce, 0x1a, 0x01, 0x04,
+0xda, 0x08, 0x04, 0x43, 0x10,
+0x05, 0x80, 0xa4, 0x41, 0x4a,
+0x04, 0x80, 0x88, 0x20, 0x0a,
+0x44, 0x15, 0x40, 0x20, 0x0a,
+0x6c, 0x00, 0x01, 0xe2, 0x40,
+0x08, 0x20, 0x08, 0x60, 0x08,
+0x68, 0x00, 0x00, 0xc4, 0x22,
+0x44, 0x24, 0x00, 0x68, 0x08,
+0x84, 0x00, 0x94, 0x40, 0x90,
+0x01, 0x04, 0x26, 0xc0, 0x00,
+0x1d, 0x64, 0x16, 0xc0, 0x00,
+0x1e, 0xe4, 0x28, 0x10, 0x40,
+0x00, 0x00, 0x08, 0x49, 0x08,
+0x86, 0x30, 0x94, 0x40, 0x80,
+0x3a, 0x14, 0x88, 0x50, 0x40,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x38, 0x08, 0x08, 0x20,
+0x5c, 0x08, 0x33, 0x00, 0x14,
+0x84, 0x00, 0x02, 0x41, 0x86,
+0x84, 0x04, 0xaa, 0x00, 0xe0,
+0x84, 0x04, 0x8a, 0x05, 0xe0,
+0x84, 0x07, 0xaa, 0x00, 0x40,
+0x46, 0x0a, 0x40, 0x40, 0x7a,
+0x84, 0x27, 0xa0, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xac, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xad, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xaf, 0x20,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x68, 0x00, 0x01, 0xaa, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x00, 0x00, 0x00,
+0x5c, 0x81, 0x01, 0x8e, 0x88,
+0x68, 0x00, 0x01, 0x90, 0x20,
+0x68, 0x00, 0x01, 0x9c, 0x21,
+0x68, 0x00, 0x01, 0xa8, 0x22,
+0x55, 0x01, 0x33, 0x80, 0x00,
+0x55, 0x03, 0xb0, 0x00, 0x7a,
+0x5d, 0x0c, 0x30, 0x08, 0x7a,
+0x32, 0x2b, 0x0b, 0xff, 0xaa,
+0x40, 0x00, 0x00, 0x10, 0x7a,
+0x68, 0x00, 0x01, 0xc1, 0x22,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0x68, 0x00, 0x01, 0xb6, 0x20,
+0x55, 0x03, 0x20, 0x10, 0x7a,
+0x5d, 0x08, 0x20, 0x08, 0x7a,
+0x32, 0x26, 0x0b, 0xff, 0xaa,
+0x80, 0x07, 0xa6, 0x80, 0x00,
+0x1d, 0x52, 0x06, 0x80, 0x00,
+0x1a, 0xaa, 0x16, 0xc4, 0x00,
+0x3b, 0x20, 0x86, 0xc0, 0x00,
+0x2e, 0xa6, 0x14, 0x60, 0xa4,
+0x04, 0x04, 0x88, 0x40, 0xc8,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x6e, 0xe8,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x71, 0x88,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x73, 0x20,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x9d, 0xa8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0x1a, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x9d, 0xa8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x0b, 0x1a, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x02, 0x09, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x21, 0x22, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x07, 0x58, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x22, 0x6a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x07, 0x82, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x2f, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x07, 0xc0, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x37, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xa5, 0x88,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x24, 0x02, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xaa, 0x88,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x48, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x07, 0xce, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x50, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x07, 0xdc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x58, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0xa5, 0x88,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x26, 0x1a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0xaa, 0x88,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x6a, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x20, 0x9a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x07, 0xea, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x72, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x07, 0xf8, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x02, 0x09, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0xa4, 0xa8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0xa1, 0x08,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0xad, 0x60,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0xad, 0x60,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x0a, 0xa8, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xae, 0x00,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xae, 0x00,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0xae, 0x00,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0xae, 0x08,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..2308dddf22aaf759c843e99ec226c454f9042391
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_0.h
@@ -0,0 +1,967 @@
+// Time Stamp : 2019-03-07 11:50:03
+
+//VERNUM [011b0001] [02100002]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			0
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		2
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_0_2_2_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_0_2_2_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_0_2_2_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_0_2_2_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_0_2_2_0		0x03C8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_0_2_2_0		0x289D76A6
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_0_2_2_0		0x0003DDF8
+#define LC898124EP3_SERVO_ON_PMSize_0_1_0_2_2_0			676
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_0_2_2_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x01,
+0xA0, 0x04, 0x02, 0x10, 0x00, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x5a, 0x9d, 0xf7, 0xab,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x84, 0xbd, 0xe2, 0xd3,
+0xA1, 0x60, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x64, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x05, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x05,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xc5, 0x41, 0xd3, 0x39,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3d, 0x33, 0x66, 0xff,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xc5, 0x41, 0xd3, 0x39,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3d, 0x33, 0x66, 0xff,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xd2,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x6e,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0xcc, 0xcc, 0xd0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_0_2_2_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x50, 0xe7,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0x67,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x27, 0x88,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x62, 0xfe, 0x22,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xc9,
+0x5c, 0x81, 0x00, 0x40, 0x0a,
+0x54, 0x4b, 0xaa, 0xc0, 0x61,
+0x5c, 0x10, 0xf0, 0x40, 0x49,
+0x5c, 0x02, 0xf9, 0xc1, 0x00,
+0x5c, 0x00, 0x68, 0x00, 0x48,
+0x80, 0x04, 0x88, 0x02, 0xc8,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0xb0, 0x62, 0x08, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x80, 0x05, 0x08, 0x40, 0x50,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x8c, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x4a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x11, 0xe0,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x00,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x00,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x21, 0xc8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x1c, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x2a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcb, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcb, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x38, 0xc8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x46, 0xa8,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x46, 0xa8,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0x68,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x06, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x0a, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0x48,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..2859477a47ac4bfb5117047245d16d77e737a0e0
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_0_2_2_1.h
@@ -0,0 +1,1575 @@
+// Time Stamp : 2019-03-07 11:49:49
+
+//VERNUM [011b0001] [02100002]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			0
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		2
+//#define FRA_ENABLE			1
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_0_2_2_1			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_0_2_2_1			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_0_2_2_1		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_0_2_2_1		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_0_2_2_1		0x03BC
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_0_2_2_1		0x6089E644
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_0_2_2_1		0x00075EDD
+#define LC898124EP3_SERVO_ON_PMSize_0_1_0_2_2_1			1287
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_0_2_2_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x01,
+0xA0, 0x04, 0x02, 0x10, 0x00, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x84, 0xbd, 0xe2, 0xd3,
+0xA0, 0xC4, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xC8, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA0, 0xD8, 0x5a, 0x9d, 0xf7, 0xab,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x1C, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0x20, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0x24, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x28, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x84, 0xbd, 0xe2, 0xd3,
+0xA1, 0x60, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x64, 0x7c, 0x1e, 0xd2, 0x0d,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x05, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x05,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xe4,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x80,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0xcc, 0xcc, 0xd0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_0_2_2_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x52, 0x07,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x55, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0xa8,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x62, 0xfe, 0x22,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xc9,
+0x5c, 0x81, 0x00, 0x40, 0x0a,
+0x54, 0x4b, 0xaa, 0xc0, 0x61,
+0x5c, 0x10, 0xf0, 0x40, 0x49,
+0x5c, 0x02, 0xf9, 0xc1, 0x00,
+0x5c, 0x00, 0x68, 0x00, 0x48,
+0x80, 0x04, 0x88, 0x02, 0xc8,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0xb0, 0x62, 0x08, 0x40, 0x50,
+0xa0, 0x22, 0x08, 0x40, 0x00,
+0x68, 0x00, 0x06, 0x00, 0x02,
+0x54, 0x84, 0x13, 0x1d, 0xf0,
+0x5c, 0x0e, 0x10, 0x00, 0xd2,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xb8, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x80, 0x05, 0x08, 0x40, 0x50,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x9e, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x68, 0x60,
+0x38, 0x1d, 0x4b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0b, 0x92, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x80,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xb4, 0xf3, 0x81, 0xd4,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x27, 0x20,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x27, 0x20,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x22, 0xa8,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0x2a, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x72, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xd0, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xd0, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0xe8,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0xc8,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0xc8,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x41, 0x88,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x18, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x1c, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x45, 0x68,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x55, 0xa8,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x58, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x59, 0xe0,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0x68,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x86, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0x68,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x86, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x01, 0xa4, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x1a, 0xd2, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x05, 0xc4, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x1c, 0x1a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x05, 0xee, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xca, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x2c, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xd2, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0x48,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1d, 0xb2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0x48,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x01, 0xe3, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x3a, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xeb, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x48, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xf3, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0x48,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1f, 0xca, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0x48,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x05, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x4a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x56, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x0d, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x06, 0x64, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x01, 0xa4, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0x8b, 0x68,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0x87, 0xc8,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x94, 0x20,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x94, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x09, 0x14, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x94, 0xc0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x94, 0xc8,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0x94, 0xc8,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x94, 0xc8,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x94, 0xc0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x94, 0xc8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x94, 0xc0,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x94, 0xc8,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..b86d4bc14fddea14a66ee3deba1f6d8c448f79be
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_0.h
@@ -0,0 +1,971 @@
+// Time Stamp : 2019-02-28 21:06:51
+
+//VERNUM [011b001b] [00100202]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_2_2_0_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_2_2_0_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_2_2_0_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_2_0_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_2_2_0_0		0x03C8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_2_2_0_0		0x489EAFED
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_2_2_0_0		0x0003E5C0
+#define LC898124EP3_SERVO_ON_PMSize_0_1_2_2_0_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_2_2_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x00, 0x10, 0x02, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xc7, 0x22, 0xaf, 0x7e,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3b, 0x24, 0x01, 0x8b,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xc7, 0x22, 0xaf, 0x7e,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3b, 0x24, 0x01, 0x8b,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_2_2_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x20, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x00, 0x60,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..e6be57b7ad801e396e67eeef5fb6e8dac674e4e3
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_2_0_1.h
@@ -0,0 +1,1579 @@
+// Time Stamp : 2019-02-28 21:06:04
+
+//VERNUM [011b001b] [00100202]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			1
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_2_2_0_1			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_2_2_0_1			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_2_2_0_1		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_2_0_1		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_2_2_0_1		0x03BC
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_2_2_0_1		0x80E831E9
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_2_2_0_1		0x000767D3
+#define LC898124EP3_SERVO_ON_PMSize_0_1_2_2_0_1			1291
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_2_2_0_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x00, 0x10, 0x02, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xec,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x88,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_2_2_0_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x52, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x56, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x29, 0x28,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x20, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x00, 0x60,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0xa6, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x68, 0xe0,
+0x38, 0x1d, 0x4b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x13, 0x00,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xb4, 0xf3, 0x81, 0xd4,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x23, 0x28,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0x32, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x92, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x3a, 0x68,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x42, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x20, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x24, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x45, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x56, 0x28,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x58, 0xc8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x5a, 0x60,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x01, 0xa6, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x1a, 0xf2, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x05, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x1c, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x05, 0xf6, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x34, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xd4, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1d, 0xd2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x01, 0xe5, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x42, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xed, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x50, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xf5, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1f, 0xea, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x07, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x5e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x0f, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x06, 0x6c, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x01, 0xa6, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0x8b, 0xe8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0x88, 0x48,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x09, 0x1c, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..97c5748e2fad37122a59f011596eadfc5913def3
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_0.h
@@ -0,0 +1,971 @@
+// Time Stamp : 2019-02-28 21:06:29
+
+//VERNUM [011b001b] [00100203]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_2_3_0_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_2_3_0_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_2_3_0_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_3_0_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_2_3_0_0		0x03C8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_2_3_0_0		0x3648F6AC
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_2_3_0_0		0x0003E5C0
+#define LC898124EP3_SERVO_ON_PMSize_0_1_2_3_0_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_2_3_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x00, 0x10, 0x02, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0x80, 0xc5, 0x34, 0x72, 0xdb,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3d, 0x26, 0x06, 0xa1,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0xE0, 0xc5, 0x34, 0x72, 0xdb,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3d, 0x26, 0x06, 0xa1,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_2_3_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x20, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x00, 0x60,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..0c200bdfda5fa5b52b3c777295ca494b7500c484
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_2_3_0_1.h
@@ -0,0 +1,1579 @@
+// Time Stamp : 2019-02-28 21:05:43
+
+//VERNUM [011b001b] [00100203]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			2
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			1
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_2_3_0_1			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_2_3_0_1			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_2_3_0_1		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_2_3_0_1		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_2_3_0_1		0x03BC
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_2_3_0_1		0x80E831EA
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_2_3_0_1		0x000767D3
+#define LC898124EP3_SERVO_ON_PMSize_0_1_2_3_0_1			1291
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_2_3_0_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x00, 0x10, 0x02, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x04, 0x0c, 0x37, 0x13,
+0xA0, 0xB4, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA0, 0xB8, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xBC, 0x76, 0x5b, 0x66, 0xab,
+0xA0, 0xC0, 0x82, 0xa1, 0x75, 0xb3,
+0xA0, 0xC4, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xC8, 0x7e, 0x3f, 0x06, 0xdd,
+0xA0, 0xD8, 0x72, 0x14, 0x82, 0xbf,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x1C, 0xcc, 0x16, 0x08, 0x07,
+0xA1, 0x20, 0x00, 0x50, 0xdf, 0x45,
+0xA1, 0x24, 0x73, 0x48, 0x39, 0x6d,
+0xA1, 0x28, 0x00, 0x28, 0x6f, 0xa3,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x04, 0x0c, 0x37, 0x13,
+0xA1, 0x50, 0x8a, 0xdf, 0xbd, 0x3f,
+0xA1, 0x54, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x58, 0x76, 0x5b, 0x66, 0xab,
+0xA1, 0x5C, 0x82, 0xa1, 0x75, 0xb3,
+0xA1, 0x60, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x64, 0x7e, 0x3f, 0x06, 0xdd,
+0xA1, 0x74, 0x5a, 0x9d, 0xf7, 0xab,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xB8, 0xca, 0x3d, 0x97, 0xb5,
+0xA1, 0xBC, 0x00, 0x39, 0x1a, 0x59,
+0xA1, 0xC0, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0xC4, 0x00, 0x1c, 0x8d, 0x2d,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xc8, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x02, 0x06, 0x00, 0x01,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x02, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x03, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x28, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x28, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xec,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x88,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x04, 0x28, 0xf5, 0xc0,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x05, 0x1e, 0xb8, 0x50,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_2_3_0_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x52, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x56, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x29, 0x28,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x20, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x00, 0x60,
+0x84, 0x07, 0xaa, 0x04, 0xe0,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0xa6, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x68, 0xe0,
+0x38, 0x1d, 0x4b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x13, 0x00,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xb4, 0xf3, 0x81, 0xd4,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x23, 0x28,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0x32, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x92, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x3a, 0x68,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x42, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x20, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x24, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x45, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x56, 0x28,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x58, 0xc8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x5a, 0x60,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x01, 0xa6, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x1a, 0xf2, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x05, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x1c, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x05, 0xf6, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x34, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xd4, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1d, 0xd2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x01, 0xe5, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x42, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xed, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x50, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xf5, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1f, 0xea, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x07, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x5e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x0f, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x06, 0x6c, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x01, 0xa6, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0x8b, 0xe8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0x88, 0x48,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x09, 0x1c, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..9e56ae4760f209074e3bcee06ba50381a98e78fa
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_0.h
@@ -0,0 +1,971 @@
+// Time Stamp : 2019-02-28 21:06:40
+
+//VERNUM [011b001b] [01100302]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_3_2_1_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_3_2_1_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_3_2_1_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_3_2_1_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_3_2_1_0		0x03C8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_3_2_1_0		0x1B6CD4E2
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_3_2_1_0		0x0003E506
+#define LC898124EP3_SERVO_ON_PMSize_0_1_3_2_1_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_3_2_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x01, 0x10, 0x03, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x84, 0x86, 0xb5, 0x9b,
+0xA0, 0xB8, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xBC, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x84, 0x86, 0xb5, 0x9b,
+0xA1, 0x54, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x58, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA1, 0x5C, 0x8a, 0xab, 0x37, 0x41,
+0xA1, 0x60, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x64, 0x76, 0x26, 0xe0, 0xaf,
+0xA1, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xcb, 0x19, 0x22, 0x49,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x37, 0x1c, 0x8a, 0xfd,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xca, 0x89, 0xd4, 0x95,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x37, 0x8d, 0x18, 0x41,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x44, 0x7f, 0xf4, 0x95, 0x03,
+0xA3, 0x48, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_3_2_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..66893e5491e7f8ffc91c664c593b27df021cc3cc
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_2_1_1.h
@@ -0,0 +1,1579 @@
+// Time Stamp : 2019-02-28 21:05:54
+
+//VERNUM [011b001b] [01100302]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			1
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_3_2_1_1			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_3_2_1_1			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_3_2_1_1		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_3_2_1_1		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_3_2_1_1		0x03BC
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_3_2_1_1		0x53F71ED4
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_3_2_1_1		0x00076719
+#define LC898124EP3_SERVO_ON_PMSize_0_1_3_2_1_1			1291
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_3_2_1_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x01, 0x10, 0x03, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x07, 0x56, 0x79,
+0xA0, 0xB4, 0x84, 0x86, 0xb5, 0x9b,
+0xA0, 0xB8, 0x77, 0x60, 0xef, 0x39,
+0xA0, 0xBC, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x07, 0x56, 0x79,
+0xA1, 0x50, 0x84, 0x86, 0xb5, 0x9b,
+0xA1, 0x54, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x58, 0x7b, 0xe7, 0xa4, 0xd5,
+0xA1, 0x5C, 0x8a, 0xab, 0x37, 0x41,
+0xA1, 0x60, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x64, 0x76, 0x26, 0xe0, 0xaf,
+0xA1, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x03, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x01, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x06,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x44, 0x7f, 0xf4, 0x95, 0x03,
+0xA3, 0x48, 0x00, 0x05, 0xb5, 0x7f,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xec,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x88,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_3_2_1_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x52, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x56, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x29, 0x28,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0xa6, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x68, 0xe0,
+0x38, 0x1d, 0x4b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x13, 0x00,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xb4, 0xf3, 0x81, 0xd4,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x23, 0x28,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0x32, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x92, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x3a, 0x68,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x42, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x20, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x24, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x45, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x56, 0x28,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x58, 0xc8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x5a, 0x60,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x01, 0xa6, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x1a, 0xf2, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x05, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x1c, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x05, 0xf6, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x34, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xd4, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1d, 0xd2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x01, 0xe5, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x42, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xed, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x50, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xf5, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1f, 0xea, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x07, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x5e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x0f, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x06, 0x6c, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x01, 0xa6, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0x8b, 0xe8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0x88, 0x48,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x09, 0x1c, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..f64aec977057bf5ae44c43e01ec45b0852f86fda
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_0.h
@@ -0,0 +1,971 @@
+// Time Stamp : 2019-02-28 21:06:19
+
+//VERNUM [011b001b] [01100303]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_3_3_1_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_3_3_1_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_3_3_1_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_3_3_1_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_3_3_1_0		0x03C8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_3_3_1_0		0xEE35C276
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_3_3_1_0		0x0003E506
+#define LC898124EP3_SERVO_ON_PMSize_0_1_3_3_1_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_3_3_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x01, 0x10, 0x03, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x8d, 0xce, 0xbb,
+0xA0, 0xB4, 0x82, 0x69, 0x56, 0x8f,
+0xA0, 0xB8, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xBC, 0x7e, 0x06, 0xe7, 0xb9,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x8d, 0xce, 0xbb,
+0xA1, 0x50, 0x82, 0x69, 0x56, 0x8f,
+0xA1, 0x54, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x58, 0x7e, 0x06, 0xe7, 0xb9,
+0xA1, 0x5C, 0x8c, 0x51, 0x61, 0x95,
+0xA1, 0x60, 0x67, 0xc4, 0xa0, 0x91,
+0xA1, 0x64, 0x74, 0x16, 0x02, 0x25,
+0xA1, 0x74, 0x78, 0xd6, 0xfc, 0x9f,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x65, 0xac, 0x8c, 0x2f,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x04, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x02, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x07,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x3e, 0x70, 0x63, 0xff,
+0xA2, 0x80, 0xc7, 0x78, 0xa1, 0x1f,
+0xA2, 0x84, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0x88, 0x3a, 0xf1, 0x80, 0xcb,
+0xA2, 0x8C, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x3e, 0x70, 0x59, 0x2b,
+0xA2, 0xE0, 0xc6, 0xd8, 0xbb, 0xcd,
+0xA2, 0xE4, 0x6f, 0x51, 0xae, 0x5d,
+0xA2, 0xE8, 0x3b, 0x63, 0x21, 0x77,
+0xA2, 0xEC, 0xad, 0x72, 0xde, 0x6b,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x52, 0x96, 0x44, 0x0d,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_3_3_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_1.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_1.h
new file mode 100644
index 0000000000000000000000000000000000000000..bee96e8589c9ca8db5266fe85adaa85bdd6de923
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_1_3_3_1_1.h
@@ -0,0 +1,1579 @@
+// Time Stamp : 2019-02-28 21:05:33
+
+//VERNUM [011b001b] [01100303]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		1
+//#define	SELECT_ACT			3
+//#define	SELECT_GYRO			3
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			1
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_1_3_3_1_1			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_1_3_3_1_1			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_1_3_3_1_1		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_1_3_3_1_1		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_1_3_3_1_1		0x03BC
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_1_3_3_1_1		0x38E3E6AA
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_1_3_3_1_1		0x00076719
+#define LC898124EP3_SERVO_ON_PMSize_0_1_3_3_1_1			1291
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_1_3_3_1_1[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x01, 0x1b, 0x00, 0x1b,
+0xA0, 0x04, 0x01, 0x10, 0x03, 0x03,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0xA4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x02, 0x8d, 0xce, 0xbb,
+0xA0, 0xB4, 0x82, 0x69, 0x56, 0x8f,
+0xA0, 0xB8, 0x7b, 0x9d, 0x91, 0x2b,
+0xA0, 0xBC, 0x7e, 0x06, 0xe7, 0xb9,
+0xA0, 0xC0, 0x8a, 0xab, 0x37, 0x41,
+0xA0, 0xC4, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA0, 0xC8, 0x76, 0x26, 0xe0, 0xaf,
+0xA0, 0xD8, 0x47, 0xfa, 0xcc, 0xf1,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x1C, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0x20, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0x24, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0x28, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x40, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x02, 0x8d, 0xce, 0xbb,
+0xA1, 0x50, 0x82, 0x69, 0x56, 0x8f,
+0xA1, 0x54, 0x7b, 0x9d, 0x91, 0x2b,
+0xA1, 0x58, 0x7e, 0x06, 0xe7, 0xb9,
+0xA1, 0x5C, 0x8c, 0x51, 0x61, 0x95,
+0xA1, 0x60, 0x67, 0xc4, 0xa0, 0x91,
+0xA1, 0x64, 0x74, 0x16, 0x02, 0x25,
+0xA1, 0x74, 0x78, 0xd6, 0xfc, 0x9f,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x65, 0xac, 0x8c, 0x2f,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xB8, 0xc8, 0x54, 0xbc, 0xe5,
+0xA1, 0xBC, 0x00, 0x25, 0x29, 0xf1,
+0xA1, 0xC0, 0x77, 0x60, 0xef, 0x39,
+0xA1, 0xC4, 0x00, 0x12, 0x94, 0xf9,
+0xA1, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xCC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xD4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xD8, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xDC, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xE4, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xEC, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0xF0, 0x60, 0x00, 0x00, 0x00,
+0xA1, 0xF4, 0xa0, 0x00, 0x00, 0x00,
+0xA1, 0xF8, 0x04, 0x06, 0x00, 0x02,
+0xA1, 0xFC, 0x00, 0x02, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x07,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xad, 0x72, 0xde, 0x6b,
+0xA4, 0xD4, 0x52, 0x96, 0x44, 0x0d,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xec,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x88,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA7, 0xFC, 0x02, 0xb0, 0x20, 0xc4,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x14, 0x02, 0x8f, 0x5c, 0x28,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA8, 0x64, 0x5f, 0x37, 0x59, 0xdf,
+0xA8, 0x68, 0x5f, 0xff, 0xff, 0xff,
+0xA8, 0x6C, 0x00, 0x58, 0xb9, 0x0b,
+0xA8, 0x70, 0x10, 0x00, 0x00, 0x00,
+0xA8, 0x74, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x78, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0x7C, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0x80, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0x84, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0x88, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0x8C, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0x90, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0x94, 0x37, 0x96, 0xf6, 0x29,
+0xA8, 0x98, 0x2a, 0xaa, 0xaa, 0xaa,
+0xA8, 0x9C, 0x19, 0x99, 0x99, 0x99,
+0xA8, 0xA0, 0x12, 0x49, 0x24, 0x92,
+0xA8, 0xA4, 0x0e, 0x38, 0xe3, 0x8e,
+0xA8, 0xA8, 0x0b, 0xa2, 0xe8, 0xba,
+0xA8, 0xAC, 0x09, 0xd8, 0x9d, 0x89,
+0xA8, 0xB0, 0x08, 0x88, 0x88, 0x88,
+0xA8, 0xB4, 0x07, 0x87, 0x87, 0x87,
+0xA8, 0xB8, 0x32, 0x43, 0xf6, 0xa6,
+0xA8, 0xBC, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xC0, 0x32, 0x43, 0xf6, 0xa7,
+0xA8, 0xC4, 0xcd, 0xbc, 0x09, 0x59,
+0xA8, 0xC8, 0x80, 0x00, 0x00, 0x00,
+0xA8, 0xCC, 0x00, 0x0c, 0x90, 0xfe,
+0xA8, 0xD0, 0x00, 0x19, 0x21, 0xfb,
+0xA8, 0xD4, 0x1f, 0xff, 0xff, 0xff,
+0xA8, 0xD8, 0x61, 0x89, 0x37, 0x4b,
+0xA8, 0xDC, 0x1e, 0x76, 0xc8, 0xb4,
+0xA8, 0xE0, 0x64, 0x87, 0xed, 0x4d,
+0xA8, 0xE4, 0x9b, 0x78, 0x12, 0xb3,
+0xA8, 0xE8, 0x32, 0x43, 0xf6, 0xa9,
+0xA8, 0xEC, 0x64, 0x87, 0xed, 0x51,
+0xA8, 0xF0, 0x00, 0x2d, 0x82, 0xd8,
+0xA8, 0xF4, 0xfa, 0xaa, 0xaa, 0xab,
+0xA8, 0xF8, 0x40, 0x00, 0x00, 0x00,
+0xA8, 0xFC, 0x1c, 0xa5, 0xdb, 0xe1,
+0xA9, 0x00, 0x16, 0x7f, 0xff, 0x4c,
+0xA9, 0x04, 0x2c, 0xff, 0xfe, 0x98,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_1_3_3_1_1[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x52, 0x87,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x56, 0x07,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x29, 0x28,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x63, 0x01, 0x05,
+0x6c, 0x70, 0x28, 0x06, 0x48,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0xa2,
+0xb0, 0x62, 0x05, 0xc0, 0x06,
+0x80, 0x2c, 0x98, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x00, 0xb0, 0x02, 0x4a,
+0x84, 0x05, 0x0a, 0x02, 0x20,
+0x84, 0x00, 0x06, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x41,
+0x31, 0xdf, 0x05, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xb5, 0xc0, 0xdb,
+0xa0, 0x06, 0x08, 0x40, 0x50,
+0xa0, 0x08, 0x0b, 0x08, 0x08,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0x84, 0x05, 0x08, 0x40, 0xd0,
+0xa2, 0x02, 0x08, 0x60, 0x48,
+0x80, 0x04, 0x98, 0x00, 0x4a,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x30, 0x60, 0x08,
+0x52, 0x05, 0x23, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0xa6, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x09,
+0x38, 0x1d, 0x62, 0x59, 0xa8,
+0xbc, 0x05, 0x83, 0x81, 0xc4,
+0x52, 0x49, 0x6b, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x49,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x09,
+0x39, 0x02, 0x08, 0x00, 0x49,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x66, 0x00, 0x00, 0x68, 0xe0,
+0x38, 0x1d, 0x4b, 0xc0, 0x4f,
+0x5c, 0x00, 0xea, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x93, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x34,
+0x82, 0x24, 0x86, 0x80, 0x00,
+0x0b, 0xb2, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x98, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x13, 0x00,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x38, 0x10, 0x42, 0x59, 0x28,
+0xbc, 0x03, 0x16, 0xc0, 0x00,
+0x13, 0xc2, 0x0b, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xb4, 0xf3, 0x81, 0xd4,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x27, 0xa0,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x68, 0x00, 0x01, 0x5d, 0x22,
+0x66, 0x00, 0x00, 0x23, 0x28,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x80, 0x00,
+0x16, 0x02, 0x26, 0x60, 0x00,
+0x02, 0x32, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x5c, 0x81, 0x02, 0xbf, 0xb0,
+0x88, 0x16, 0x0a, 0x00, 0x43,
+0xa0, 0x80, 0x0a, 0x10, 0x01,
+0x81, 0xa0, 0x88, 0x58, 0x0a,
+0x57, 0x0d, 0x00, 0x10, 0x0a,
+0x49, 0x28, 0x80, 0x81, 0xe3,
+0x57, 0x0a, 0x92, 0x18, 0x43,
+0x98, 0x08, 0x98, 0x49, 0x49,
+0xa2, 0x80, 0x1a, 0x28, 0x26,
+0x88, 0x52, 0x58, 0x82, 0x63,
+0xa3, 0x02, 0x3a, 0x18, 0x27,
+0xa2, 0x06, 0x48, 0x50, 0x40,
+0x88, 0x06, 0x78, 0x82, 0xe7,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x8a, 0x30, 0x02,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x4a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x06, 0x14, 0x8a, 0x05, 0xe5,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x20, 0x00, 0x00,
+0x85, 0x18, 0xa8, 0x68, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x86, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa5,
+0x88, 0x52, 0x28, 0x81, 0x24,
+0x88, 0x1a, 0x0a, 0x28, 0x21,
+0x88, 0x43, 0x6a, 0x10, 0x25,
+0xa8, 0x05, 0x0a, 0x00, 0x40,
+0x40, 0x00, 0x02, 0x20, 0x64,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x92, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xd2, 0x20,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x3a, 0x68,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x48, 0x48,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x42, 0x08,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x20, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x24, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x45, 0xe8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+0x44, 0x28, 0x02, 0xc0, 0x20,
+0x5c, 0x04, 0x29, 0x80, 0x08,
+0x22, 0x8e, 0x09, 0x80, 0x0a,
+0x68, 0x3f, 0xcb, 0xfc, 0xcb,
+0x68, 0x20, 0x02, 0x3c, 0x20,
+0x08, 0xe0, 0x05, 0x10, 0x20,
+0x00, 0x00, 0xb5, 0x40, 0xe0,
+0x80, 0x00, 0x29, 0x80, 0x4b,
+0x44, 0x70, 0x80, 0x40, 0x00,
+0x22, 0x04, 0x92, 0x80, 0x8a,
+0x98, 0x08, 0xb0, 0x8e, 0x20,
+0x22, 0x05, 0x22, 0x80, 0x12,
+0x98, 0x08, 0xa0, 0x82, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x28, 0x16, 0x52, 0x29, 0x6d,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x22, 0x05, 0x29, 0x80, 0x88,
+0x2a, 0x12, 0x52, 0x28, 0xed,
+0x2e, 0x14, 0x50, 0x81, 0x20,
+0x51, 0x02, 0x93, 0xa1, 0x48,
+0x98, 0x08, 0x82, 0xe1, 0x04,
+0x5b, 0x4a, 0x02, 0xbf, 0xf0,
+0x6c, 0x40, 0x04, 0x74, 0x02,
+0x30, 0x08, 0x0b, 0xc0, 0x7a,
+0x5c, 0x00, 0x10, 0x80, 0x76,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x47, 0x60, 0x25, 0x70, 0x40,
+0x30, 0x00, 0xa8, 0x80, 0xd2,
+0x66, 0x00, 0x00, 0x56, 0x28,
+0x23, 0x04, 0x58, 0x80, 0x80,
+0x32, 0x00, 0x0b, 0xc0, 0x38,
+0x51, 0x43, 0x20, 0x80, 0x36,
+0x36, 0x10, 0x4b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0xab, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x58, 0xc8,
+0x6c, 0x00, 0x01, 0x46, 0x09,
+0x68, 0x20, 0x02, 0x35, 0x20,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x51, 0x06, 0x00, 0x02, 0x09,
+0x57, 0x0a, 0x12, 0x00, 0x41,
+0x51, 0x85, 0x28, 0x08, 0x08,
+0x57, 0x0b, 0x01, 0x80, 0x88,
+0x51, 0x85, 0x20, 0x08, 0x09,
+0x6c, 0x00, 0x01, 0x46, 0x02,
+0x44, 0x24, 0x00, 0x40, 0x0a,
+0x54, 0x0c, 0x90, 0x08, 0x08,
+0x58, 0x08, 0x80, 0x48, 0x09,
+0xbc, 0x03, 0xd9, 0x81, 0x08,
+0x28, 0x15, 0x02, 0x81, 0x42,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x46, 0x42,
+0x40, 0x00, 0x02, 0x80, 0x10,
+0xab, 0xfe, 0x08, 0x80, 0x49,
+0x88, 0x0c, 0x88, 0x81, 0x76,
+0x66, 0x00, 0x00, 0x5a, 0x60,
+0x5c, 0x81, 0x00, 0x80, 0x09,
+0x68, 0x00, 0x00, 0xb1, 0x20,
+0x44, 0x20, 0x00, 0x80, 0x89,
+0x44, 0x21, 0x00, 0x02, 0x08,
+0x6c, 0x40, 0x04, 0x84, 0x0a,
+0x44, 0x10, 0x80, 0x40, 0x09,
+0xa0, 0x00, 0x18, 0x00, 0x48,
+0x51, 0x02, 0x41, 0xa0, 0x01,
+0x51, 0x63, 0xd0, 0x81, 0x36,
+0x28, 0x01, 0x02, 0xe1, 0x40,
+0x51, 0x63, 0x10, 0x40, 0x40,
+0xa0, 0x06, 0x08, 0x02, 0x08,
+0x44, 0x10, 0x00, 0x49, 0x40,
+0x22, 0x04, 0x05, 0x40, 0x08,
+0x04, 0x00, 0x92, 0xe1, 0x40,
+0x84, 0x14, 0x04, 0x60, 0xa4,
+0x00, 0x04, 0x88, 0x40, 0x40,
+0x40, 0x00, 0x02, 0x80, 0x20,
+0x68, 0x00, 0x00, 0xb2, 0x25,
+0x68, 0x20, 0x02, 0x42, 0x27,
+0x5c, 0x81, 0x02, 0x2c, 0x44,
+0x86, 0x80, 0x08, 0x78, 0x08,
+0x86, 0x00, 0xa4, 0x44, 0x60,
+0x23, 0x82, 0x65, 0x10, 0x80,
+0x07, 0x00, 0x84, 0x44, 0x10,
+0x23, 0x02, 0x5a, 0x28, 0x07,
+0x82, 0x80, 0xa5, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x41, 0x10,
+0x06, 0x80, 0x99, 0x80, 0x0a,
+0x44, 0x4c, 0x42, 0x20, 0xa4,
+0x51, 0x08, 0x02, 0x24, 0x46,
+0x84, 0x04, 0x0a, 0x2c, 0x60,
+0x87, 0x80, 0x94, 0x44, 0x80,
+0x06, 0x80, 0xa4, 0x41, 0x60,
+0x20, 0x02, 0x52, 0x21, 0x00,
+0x84, 0x84, 0x00, 0x00, 0x00,
+0x86, 0x00, 0x08, 0x70, 0x08,
+0x84, 0x00, 0xa4, 0x41, 0x60,
+0x02, 0x80, 0xa4, 0x41, 0x10,
+0x22, 0x80, 0x15, 0x10, 0x80,
+0x02, 0x80, 0x95, 0x10, 0x88,
+0x18, 0x00, 0x84, 0x40, 0x80,
+0x18, 0x00, 0xb8, 0x68, 0x0a,
+0x08, 0xe8, 0x02, 0x21, 0x00,
+0x85, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x80, 0xa4, 0x47, 0x00,
+0x06, 0x80, 0xa0, 0x82, 0xc0,
+0x51, 0x08, 0x03, 0xa1, 0x48,
+0x85, 0x84, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0x84, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xa4, 0x0a, 0x80, 0x10,
+0x84, 0x00, 0x94, 0x42, 0x80,
+0x04, 0x80, 0x94, 0x42, 0xc0,
+0x2b, 0xff, 0x08, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x84, 0xe8,
+0x98, 0x00, 0x98, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xc4, 0x8a, 0x80, 0x10,
+0xab, 0xff, 0x08, 0x40, 0x0a,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x09, 0x8e, 0x88, 0x48, 0x09,
+0x6c, 0x40, 0x04, 0x7e, 0x09,
+0x44, 0x08, 0x00, 0x80, 0x36,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x17, 0xe4, 0x0a, 0x80, 0x10,
+0x68, 0x00, 0x00, 0xbe, 0x20,
+0x39, 0x04, 0x08, 0x02, 0x0a,
+0x80, 0x20, 0x95, 0x70, 0xb8,
+0x20, 0x0a, 0x18, 0x0a, 0x0a,
+0x80, 0xa0, 0x96, 0xc4, 0x00,
+0x48, 0x00, 0x85, 0x70, 0xb8,
+0x04, 0x05, 0x03, 0x01, 0x00,
+0xbc, 0x07, 0xd8, 0x48, 0x50,
+0x00, 0x00, 0x06, 0xc4, 0x00,
+0x48, 0x20, 0xa2, 0xe1, 0x86,
+0x6c, 0x00, 0x01, 0x76, 0x4a,
+0x36, 0x10, 0x68, 0x48, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x73,
+0x6c, 0x40, 0x04, 0x82, 0x0a,
+0x54, 0x0d, 0x23, 0xa1, 0x48,
+0x6c, 0x00, 0x01, 0x76, 0x48,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x68, 0x00, 0x01, 0xa6, 0xac,
+0x84, 0x07, 0xaa, 0x04, 0x60,
+0x84, 0x07, 0xa4, 0x60, 0xa4,
+0x20, 0x42, 0x08, 0x40, 0x6c,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x1c, 0x16, 0x80, 0x00,
+0x0a, 0x02, 0x05, 0xc8, 0x30,
+0x98, 0xe8, 0x06, 0xc4, 0x00,
+0x46, 0x60, 0x85, 0xc8, 0x20,
+0x00, 0x0f, 0xa5, 0xc8, 0x10,
+0x80, 0x0c, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0xc0, 0x58,
+0x8c, 0x05, 0x88, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x80, 0x0f, 0xa8, 0x00, 0xfa,
+0x84, 0x07, 0xa6, 0x80, 0x00,
+0x1a, 0xf2, 0x14, 0x60, 0xa4,
+0x20, 0x6e, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x0b, 0xa1, 0x40,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x2a, 0xbf, 0xf0,
+0x25, 0x96, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc4, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xa4, 0x20,
+0x5c, 0x82, 0x02, 0xc0, 0x21,
+0x80, 0x02, 0x18, 0xc0, 0x30,
+0x84, 0x80, 0x82, 0x09, 0x62,
+0x28, 0x01, 0x08, 0xc2, 0xd8,
+0x00, 0x00, 0x08, 0x40, 0x21,
+0xa0, 0x0a, 0x08, 0x48, 0x08,
+0x50, 0x4b, 0x10, 0xc0, 0x31,
+0x28, 0x05, 0x28, 0xc0, 0x7a,
+0xa0, 0x52, 0x08, 0x40, 0x08,
+0x32, 0x02, 0x05, 0x53, 0xf2,
+0xbc, 0x28, 0x98, 0x40, 0x49,
+0x68, 0x00, 0x00, 0xa2, 0x20,
+0x38, 0x00, 0xc8, 0x02, 0x89,
+0x21, 0x16, 0x42, 0xa7, 0xe4,
+0x84, 0x04, 0x8a, 0x00, 0xe0,
+0x8c, 0x03, 0x15, 0x70, 0x20,
+0x0c, 0x07, 0x85, 0x04, 0xa0,
+0x20, 0x0c, 0x09, 0x83, 0x08,
+0x80, 0x24, 0x80, 0x00, 0x00,
+0x8c, 0x03, 0x05, 0x70, 0x08,
+0x0c, 0x07, 0xa5, 0x04, 0xa0,
+0x20, 0x06, 0x09, 0x83, 0x09,
+0x84, 0x04, 0x9a, 0x05, 0xe0,
+0x88, 0x0e, 0x06, 0x60, 0x00,
+0x05, 0xcc, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xff, 0xc8,
+0x84, 0x00, 0x92, 0xa0, 0x6d,
+0x30, 0x12, 0x8b, 0xc0, 0x5d,
+0x84, 0x04, 0x96, 0x80, 0x00,
+0x1c, 0x3a, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x00, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0xa0, 0x82, 0x2a, 0x10, 0x23,
+0x88, 0x0e, 0x36, 0x60, 0x00,
+0x05, 0xf6, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xcc, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x34, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xd4, 0x21,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x78, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1d, 0xd2, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0x84, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb6, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x01, 0xe5, 0xa3,
+0xa1, 0x72, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb6, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x42, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xed, 0xa1,
+0xa0, 0x72, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x50, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x01, 0xf5, 0xa1,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x09,
+0x5c, 0x08, 0x22, 0xbf, 0xf0,
+0x25, 0x92, 0x8b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc1, 0x1f,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x20, 0x02, 0x1b, 0x20,
+0x66, 0x00, 0x00, 0x8c, 0xc8,
+0x6c, 0x00, 0x01, 0x7c, 0x09,
+0x5c, 0x05, 0x2b, 0xa1, 0x11,
+0x08, 0x10, 0x06, 0x80, 0x00,
+0x1f, 0xea, 0x06, 0xc0, 0x00,
+0x13, 0xc6, 0x06, 0xc0, 0x00,
+0x17, 0xc4, 0xc0, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0x46, 0x08, 0x0a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x2b, 0xc1, 0x0f,
+0x6c, 0x00, 0x01, 0x3c, 0x62,
+0x68, 0x00, 0x00, 0xb8, 0x22,
+0x00, 0x00, 0x0a, 0x10, 0x23,
+0x88, 0x0e, 0x3a, 0x10, 0x00,
+0x66, 0x00, 0x00, 0x91, 0xc8,
+0xa1, 0x80, 0x18, 0x80, 0xa2,
+0x68, 0x00, 0x02, 0x07, 0x23,
+0xa1, 0x76, 0x28, 0x50, 0x63,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x5c, 0x08, 0x32, 0xbf, 0xf0,
+0x25, 0x9a, 0x0b, 0xc0, 0x88,
+0x88, 0x07, 0x66, 0xc0, 0x00,
+0x13, 0xe7, 0xa6, 0x80, 0x00,
+0x1a, 0x6a, 0x0b, 0xc0, 0xef,
+0x6c, 0x00, 0x01, 0x3c, 0x60,
+0x68, 0x00, 0x00, 0xb8, 0x20,
+0x00, 0x00, 0x0a, 0x00, 0x21,
+0x88, 0x0e, 0x16, 0x60, 0x00,
+0x06, 0x5e, 0x08, 0x80, 0xa0,
+0x68, 0x00, 0x02, 0x0f, 0x21,
+0xa0, 0x76, 0x08, 0x40, 0x61,
+0x00, 0x00, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x01, 0x3e, 0x08,
+0x38, 0x10, 0x62, 0x59, 0xa0,
+0xbc, 0x05, 0x9a, 0xbf, 0xf0,
+0x88, 0x07, 0x66, 0x60, 0x00,
+0x06, 0x6c, 0x08, 0x80, 0x36,
+0x6c, 0x00, 0x01, 0x3e, 0x7a,
+0x68, 0x00, 0x01, 0xa6, 0xa0,
+0xba, 0x14, 0x86, 0xc0, 0x00,
+0x13, 0xc6, 0x0a, 0x80, 0x10,
+0x5b, 0x8a, 0x3b, 0x00, 0xf0,
+0x57, 0x0e, 0x03, 0x00, 0x0e,
+0x50, 0x81, 0x83, 0x04, 0xea,
+0x55, 0x33, 0xe3, 0x3c, 0x09,
+0x13, 0x82, 0x72, 0x01, 0x07,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x23, 0x5d, 0x45, 0x40, 0xf0,
+0x04, 0x00, 0xb5, 0x14, 0x22,
+0x04, 0x08, 0x02, 0xe1, 0x3a,
+0x22, 0xdd, 0x72, 0x80, 0x79,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x54, 0x48, 0xbb, 0x00, 0xfc,
+0x36, 0x84, 0x22, 0x81, 0x09,
+0x23, 0x23, 0xf2, 0x10, 0x74,
+0x20, 0x8b, 0xf2, 0x28, 0x6e,
+0x28, 0x1e, 0x70, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x88,
+0x08, 0x32, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x29, 0x80, 0x88,
+0x08, 0xc2, 0x02, 0x20, 0x52,
+0x98, 0x08, 0xb0, 0x8b, 0x20,
+0x22, 0x3d, 0x29, 0x80, 0x8a,
+0x08, 0xb2, 0x02, 0x23, 0xd2,
+0x2e, 0x08, 0x09, 0x80, 0x0a,
+0x08, 0xe0, 0x02, 0x20, 0x40,
+0x46, 0x0a, 0x41, 0x80, 0x0a,
+0x08, 0x90, 0x09, 0x80, 0x08,
+0x32, 0x02, 0x8b, 0xc3, 0x58,
+0x22, 0x86, 0xe5, 0xb8, 0xa2,
+0x30, 0x0f, 0x05, 0x70, 0x80,
+0x30, 0x00, 0xf5, 0x08, 0x1c,
+0x30, 0x4e, 0xa2, 0xa6, 0x63,
+0x4b, 0xc1, 0x23, 0x3c, 0x08,
+0x20, 0x0c, 0xd2, 0x35, 0xd4,
+0x68, 0x20, 0x02, 0x19, 0x20,
+0x28, 0x16, 0x25, 0x14, 0x2a,
+0x84, 0x00, 0x85, 0x70, 0xb0,
+0xb0, 0x0f, 0xa5, 0x16, 0xe6,
+0x04, 0x08, 0x92, 0x80, 0x20,
+0x68, 0x1f, 0xff, 0xff, 0xc8,
+0x36, 0x80, 0x35, 0x44, 0x84,
+0x98, 0x0c, 0x82, 0x32, 0x09,
+0x28, 0x08, 0x02, 0x10, 0x3f,
+0x20, 0x90, 0xc2, 0x81, 0x3f,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0x80, 0x83, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0x80, 0x8c, 0x00,
+0x22, 0x04, 0x09, 0x80, 0x0b,
+0x08, 0xb0, 0x02, 0x23, 0xc0,
+0x98, 0x00, 0xa0, 0x8b, 0x00,
+0x22, 0x3c, 0x02, 0xe0, 0x28,
+0x98, 0x00, 0xa4, 0x47, 0x00,
+0x3a, 0x14, 0x82, 0x20, 0x40,
+0x98, 0x00, 0x8b, 0xa1, 0x48,
+0x98, 0xe8, 0x80, 0x00, 0x00,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x2a, 0x02, 0x85, 0xc0, 0x02,
+0x18, 0xeb, 0x52, 0xf9, 0x80,
+0x32, 0x03, 0x0b, 0xc0, 0x48,
+0x98, 0x30, 0x9b, 0xa1, 0x48,
+0x23, 0x86, 0xc0, 0x00, 0x00,
+0x40, 0x00, 0x03, 0xa1, 0x40,
+0x59, 0x01, 0x42, 0xbf, 0xc0,
+0x84, 0x50, 0x84, 0x22, 0x2c,
+0x08, 0x0f, 0x68, 0x80, 0x48,
+0x5b, 0x8a, 0x23, 0x00, 0xf0,
+0x57, 0x08, 0x23, 0x00, 0x08,
+0x50, 0x88, 0x02, 0xc0, 0x20,
+0x46, 0x08, 0x88, 0x00, 0x0a,
+0x58, 0x01, 0x40, 0x81, 0x60,
+0x44, 0x40, 0x83, 0xc3, 0x18,
+0x88, 0x1c, 0xd3, 0x81, 0x04,
+0x20, 0x92, 0x92, 0x09, 0x00,
+0x51, 0xb8, 0x49, 0x02, 0x58,
+0x5b, 0x40, 0x11, 0x03, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x21, 0x19, 0x03, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x03, 0xb8, 0x81, 0x20,
+0x36, 0x00, 0x03, 0x78, 0x00,
+0x5c, 0x81, 0x01, 0x83, 0x09,
+0x55, 0x3f, 0x68, 0x00, 0x08,
+0x54, 0x09, 0x70, 0x81, 0x60,
+0x66, 0x00, 0x00, 0x8b, 0xe8,
+0x57, 0x09, 0x6b, 0x80, 0x00,
+0x44, 0x00, 0x00, 0x81, 0x20,
+0x39, 0x02, 0x06, 0x00, 0x00,
+0x00, 0x03, 0x85, 0x50, 0x10,
+0x18, 0x00, 0xa4, 0x44, 0x10,
+0x00, 0x00, 0x99, 0x80, 0x88,
+0x4c, 0xa4, 0x00, 0x00, 0x09,
+0x51, 0x02, 0x00, 0x81, 0x88,
+0x98, 0x00, 0x95, 0x15, 0x17,
+0x3c, 0x05, 0xf5, 0x40, 0xd2,
+0x08, 0x00, 0x9b, 0xa1, 0x01,
+0x88, 0x18, 0x88, 0x80, 0x09,
+0x44, 0x08, 0x03, 0xc0, 0x4f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x46, 0x08, 0x09, 0x8e, 0x88,
+0x88, 0x0b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+0x84, 0x00, 0x85, 0xb4, 0x80,
+0x04, 0x80, 0x95, 0xb4, 0xa0,
+0x18, 0x00, 0xa5, 0xb8, 0xc0,
+0x18, 0x00, 0x25, 0xb8, 0x43,
+0xab, 0xfd, 0x05, 0x80, 0xe0,
+0x08, 0x0e, 0x24, 0x20, 0x35,
+0x88, 0x17, 0x68, 0x80, 0x63,
+0x32, 0x03, 0x0b, 0xc0, 0x10,
+0x2a, 0x00, 0x7b, 0xc0, 0x4f,
+0x2a, 0x03, 0x83, 0x20, 0x10,
+0xbc, 0x01, 0x02, 0xa0, 0x38,
+0x20, 0x02, 0x25, 0x00, 0x14,
+0x18, 0x08, 0x84, 0x40, 0x00,
+0x18, 0x00, 0x94, 0x42, 0xc0,
+0x08, 0x24, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x00, 0x88, 0x48,
+0x98, 0x10, 0x98, 0x81, 0x89,
+0x44, 0x20, 0x00, 0x82, 0x09,
+0x44, 0x21, 0x00, 0x80, 0xa2,
+0x51, 0x1e, 0x00, 0x80, 0x23,
+0x51, 0x1e, 0x90, 0x81, 0x36,
+0x46, 0x0a, 0x40, 0x50, 0x40,
+0x85, 0x84, 0x2a, 0x80, 0x30,
+0x60, 0x00, 0x20, 0x00, 0x20,
+0x36, 0x98, 0x45, 0xb4, 0xa0,
+0x18, 0xeb, 0x52, 0xf9, 0x00,
+0xba, 0x14, 0x89, 0x83, 0x08,
+0x51, 0xc3, 0x23, 0x80, 0x00,
+0x59, 0x01, 0x42, 0xbf, 0xf0,
+0xbc, 0x07, 0xb8, 0x80, 0x76,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x5c, 0x3f, 0xeb, 0xc0, 0x4f,
+0x54, 0xcb, 0x23, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x94, 0xa0,
+0x44, 0x00, 0x02, 0xc0, 0x20,
+0x55, 0x01, 0x01, 0x80, 0x09,
+0x44, 0x08, 0x80, 0x80, 0x36,
+0x98, 0x04, 0x80, 0x81, 0x10,
+0x68, 0x20, 0x02, 0x26, 0x20,
+0x98, 0x04, 0xa4, 0x44, 0x88,
+0x00, 0x00, 0xb4, 0x46, 0x60,
+0x18, 0x04, 0x80, 0x81, 0x10,
+0x98, 0x04, 0xb4, 0x46, 0x90,
+0x18, 0x2c, 0x18, 0x00, 0x0b,
+0x44, 0x74, 0x01, 0x80, 0x8a,
+0x44, 0x49, 0x80, 0x00, 0x0b,
+0x44, 0x67, 0x01, 0x80, 0xc8,
+0x44, 0x08, 0x01, 0x82, 0x03,
+0x55, 0x00, 0x78, 0x00, 0x08,
+0x44, 0x1c, 0xc0, 0x00, 0x08,
+0x44, 0x16, 0xa0, 0x00, 0x08,
+0x55, 0x00, 0xf1, 0x80, 0x0b,
+0x4f, 0xbd, 0x00, 0x00, 0x09,
+0x44, 0x3e, 0x20, 0x40, 0x09,
+0x46, 0x0a, 0x41, 0x80, 0x8a,
+0x44, 0x34, 0x02, 0x80, 0x10,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x68, 0x20, 0x02, 0x2e, 0x23,
+0x5c, 0x81, 0x02, 0xbf, 0xc0,
+0x81, 0x80, 0x88, 0x18, 0x00,
+0x81, 0x80, 0x28, 0x58, 0x0b,
+0x88, 0x06, 0x3a, 0x40, 0xc2,
+0xa4, 0x0e, 0x38, 0x50, 0x4a,
+0x85, 0x84, 0x98, 0x80, 0xcb,
+0x88, 0x15, 0x28, 0x81, 0xd0,
+0x88, 0x24, 0x88, 0x82, 0xf6,
+0xa1, 0x00, 0x06, 0x60, 0x00,
+0x09, 0x1c, 0x8a, 0x18, 0x01,
+0x88, 0x02, 0x28, 0x83, 0x0a,
+0x85, 0x08, 0x93, 0x01, 0x70,
+0xbc, 0x03, 0x12, 0xa0, 0x76,
+0x88, 0x34, 0xa0, 0x00, 0x00,
+0x88, 0x38, 0xa3, 0x01, 0x70,
+0xbc, 0x02, 0x12, 0xa0, 0x76,
+0x88, 0x3c, 0xa0, 0x00, 0x00,
+0x88, 0x30, 0x93, 0x20, 0x28,
+0xbc, 0x55, 0x88, 0x83, 0x8a,
+0x32, 0x02, 0x8b, 0xc2, 0xfc,
+0x36, 0x18, 0x43, 0x20, 0x30,
+0xbc, 0x15, 0xc3, 0x61, 0x45,
+0x30, 0x12, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x28, 0x1a, 0x84, 0x22, 0x6f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x2e, 0x1a, 0x84, 0x22, 0x1f,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x30, 0x1a, 0x8b, 0xc0, 0xca,
+0x55, 0x01, 0x71, 0x82, 0x88,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x40, 0x00, 0x01, 0x82, 0x09,
+0x51, 0x45, 0x30, 0x81, 0x89,
+0x57, 0x0d, 0x43, 0xc3, 0x6f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x31, 0x82, 0x89,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x54, 0x0d, 0x43, 0xc2, 0xcf,
+0x98, 0x00, 0x83, 0x20, 0x30,
+0xbc, 0x11, 0x43, 0x01, 0x28,
+0x40, 0x00, 0x03, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x2e, 0x1a, 0x84, 0x20, 0xff,
+0x98, 0x00, 0xa3, 0x61, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x19, 0xf2, 0x28, 0xa4,
+0x30, 0x1a, 0x8b, 0xc0, 0x84,
+0x66, 0x00, 0x00, 0x95, 0x40,
+0x51, 0x45, 0x30, 0x82, 0x09,
+0x57, 0x0d, 0x43, 0xc1, 0x0f,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x66, 0x00, 0x00, 0x95, 0x48,
+0x55, 0x01, 0x71, 0x82, 0x89,
+0xbc, 0x09, 0xf2, 0x28, 0xa4,
+0x32, 0x03, 0x0b, 0xc0, 0x50,
+0x32, 0x03, 0x0b, 0xc0, 0x4c,
+0x88, 0x10, 0x88, 0x80, 0x88,
+0xbc, 0x01, 0x79, 0x8e, 0x88,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x04, 0x00, 0x00, 0x00,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_6_2_0_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_6_2_0_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..2e4fb3c186d74b1bc35c803deadce6c6a808cc75
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_6_2_0_0.h
@@ -0,0 +1,967 @@
+// Time Stamp : 2019-03-20 16:44:35
+
+//VERNUM [021b0006] [00000602]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			6
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		0
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_2_6_2_0_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_2_6_2_0_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_2_6_2_0_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_2_6_2_0_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_2_6_2_0_0		0x03B8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_2_6_2_0_0		0xBB823CC1
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_2_6_2_0_0		0x0003E472
+#define LC898124EP3_SERVO_ON_PMSize_0_2_6_2_0_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_2_6_2_0_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x06,
+0xA0, 0x04, 0x00, 0x00, 0x06, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xd1, 0x93, 0x7c, 0xb7,
+0xA0, 0xA0, 0x7f, 0xd2, 0x5a, 0x25,
+0xA0, 0xA4, 0x2e, 0x9a, 0x29, 0x23,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x0a, 0x2a, 0xda, 0xd1,
+0xA0, 0xB4, 0xaa, 0xba, 0x7f, 0xa9,
+0xA0, 0xB8, 0x72, 0x14, 0x59, 0xc5,
+0xA0, 0xBC, 0x56, 0x1b, 0x90, 0x25,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x38, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x1C, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0x20, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0x24, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0x28, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xd1, 0x93, 0x7c, 0xb7,
+0xA1, 0x3C, 0x7f, 0xd2, 0x5a, 0x25,
+0xA1, 0x40, 0x2e, 0x9a, 0x29, 0x23,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x0a, 0x2a, 0xda, 0xd1,
+0xA1, 0x50, 0xaa, 0xba, 0x7f, 0xa9,
+0xA1, 0x54, 0x72, 0x14, 0x59, 0xc5,
+0xA1, 0x58, 0x56, 0x1b, 0x90, 0x25,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x38, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xB8, 0xcf, 0x98, 0x10, 0xbc,
+0xA1, 0xBC, 0x00, 0x8b, 0x20, 0x73,
+0xA1, 0xC0, 0x6f, 0x51, 0xae, 0x5d,
+0xA1, 0xC4, 0x00, 0x45, 0x90, 0x39,
+0xA1, 0xC8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xCC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xD4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xD8, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xDC, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE0, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xE4, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xE8, 0x1c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xEC, 0xe3, 0x33, 0x33, 0x33,
+0xA1, 0xF0, 0x73, 0x33, 0x33, 0x33,
+0xA1, 0xF4, 0x8c, 0xcc, 0xcc, 0xcc,
+0xA1, 0xF8, 0x03, 0x04, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x04,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0x84, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0x88, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0xE4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xE8, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0x54, 0x6e,
+0xA4, 0xCC, 0x00, 0x00, 0x3a, 0x62,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf0, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x04, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_2_6_2_0_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x20, 0x80,
+0x30, 0x62, 0x48, 0x02, 0xd0,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x40, 0x7a,
+0xa0, 0x06, 0x08, 0x40, 0x7a,
+0xa0, 0x4e, 0x05, 0xc0, 0x0b,
+0x00, 0x24, 0xa8, 0x40, 0x48,
+0xa0, 0x22, 0x08, 0x40, 0x08,
+0x68, 0x00, 0x06, 0x00, 0x00,
+0x54, 0x81, 0x03, 0x1d, 0xf4,
+0x5c, 0x0e, 0x00, 0x40, 0x50,
+0x6c, 0x68, 0x08, 0x08, 0x4b,
+0x5c, 0x0d, 0xba, 0x00, 0x60,
+0x84, 0x04, 0x8a, 0x00, 0x80,
+0xb0, 0x80, 0xc8, 0x40, 0x48,
+0x68, 0x34, 0x08, 0x4a, 0x24,
+0xb1, 0x01, 0x48, 0x40, 0xc8,
+0xa2, 0x02, 0x08, 0x60, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x4a,
+0x68, 0x00, 0x00, 0x2b, 0x24,
+0xac, 0x7e, 0x08, 0x00, 0x4a,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x86, 0x00, 0x85, 0x20, 0x12,
+0x2c, 0x58, 0x08, 0x02, 0x4a,
+0xac, 0x40, 0x08, 0x48, 0x00,
+0x52, 0x4e, 0x33, 0x06, 0x07,
+0x86, 0x04, 0x88, 0x02, 0x4b,
+0x84, 0x84, 0xa8, 0x40, 0x4b,
+0xb0, 0x01, 0xc6, 0x60, 0x04,
+0x03, 0x66, 0x8a, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_7_2_1_0.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_7_2_1_0.h
new file mode 100644
index 0000000000000000000000000000000000000000..761db6b5666c5e8a45b809fda8b088cbacfb41ad
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/LC898124EP3_Servo_On_Code_0_2_7_2_1_0.h
@@ -0,0 +1,967 @@
+// Time Stamp : 2019-03-20 16:44:25
+
+//VERNUM [021b0006] [01000702]
+
+//#define	SEL_MODEL			0
+//#define	SELECT_VENDOR		2
+//#define	SELECT_ACT			7
+//#define	SELECT_GYRO			2
+//#define	MASTER_SLAVE		1
+//#define FRA_ENABLE			0
+
+#define SERVO_ON_CHECKSUM_COMMAND_DMA_0_2_7_2_1_0			0x00041834
+#define SERVO_ON_CHECKSUM_COMMAND_DMB_0_2_7_2_1_0			0x0004186e
+
+#define LC898124EP3_SERVO_ON_DMA_ByteSize_0_2_7_2_1_0		0x0054
+#define LC898124EP3_SERVO_ON_DMA_CheckSum_0_2_7_2_1_0		0x08006479
+
+#define LC898124EP3_SERVO_ON_DMB_ByteSize_0_2_7_2_1_0		0x03B8
+#define LC898124EP3_SERVO_ON_DMB_CheckSum_0_2_7_2_1_0		0x19B6EFD7
+
+#define LC898124EP3_SERVO_ON_PMCheckSum_0_2_7_2_1_0		0x0003E89C
+#define LC898124EP3_SERVO_ON_PMSize_0_2_7_2_1_0			680
+
+const unsigned char LC898124EP3_SERVO_ON_DM_0_2_7_2_1_0[] = {
+0x20, 0xC0, 0x00, 0x80, 0x06, 0x30,
+0x20, 0xC4, 0x00, 0x80, 0x06, 0x34,
+0x20, 0xC8, 0x00, 0x80, 0x06, 0x38,
+0x20, 0xCC, 0x00, 0x80, 0x06, 0x3c,
+0x20, 0xD0, 0x00, 0x80, 0x06, 0x40,
+0x20, 0xD4, 0x00, 0x80, 0x06, 0x44,
+0x20, 0xD8, 0x00, 0x80, 0x06, 0x48,
+0x20, 0xDC, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE0, 0x00, 0x80, 0x06, 0x4c,
+0x20, 0xE4, 0x00, 0x80, 0x06, 0x50,
+0x20, 0xE8, 0x00, 0x80, 0x06, 0x54,
+0x20, 0xEC, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF0, 0x00, 0x80, 0x06, 0x58,
+0x20, 0xF4, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xF8, 0x00, 0x80, 0x06, 0x5c,
+0x20, 0xFC, 0x00, 0x80, 0x06, 0x2c,
+0x27, 0x68, 0x00, 0x00, 0x00, 0x05,
+0x27, 0x6C, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0x27, 0x74, 0x80, 0x00, 0x00, 0x01,
+0x27, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x00, 0x02, 0x1b, 0x00, 0x06,
+0xA0, 0x04, 0x01, 0x00, 0x07, 0x02,
+0xA0, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x94, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0x98, 0x80, 0x00, 0x00, 0x01,
+0xA0, 0x9C, 0xf2, 0x4b, 0x39, 0xd9,
+0xA0, 0xA0, 0x7f, 0xdd, 0xc2, 0x15,
+0xA0, 0xA4, 0x0d, 0xc5, 0xef, 0x83,
+0xA0, 0xAC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xB0, 0x10, 0x1d, 0x3f, 0x2d,
+0xA0, 0xB4, 0xa9, 0xec, 0x1c, 0x59,
+0xA0, 0xB8, 0x75, 0x50, 0x33, 0x99,
+0xA0, 0xBC, 0x57, 0x97, 0x3f, 0xa9,
+0xA0, 0xC8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xDC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE4, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xE8, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xEC, 0x7f, 0xff, 0xff, 0xff,
+0xA0, 0xF0, 0x50, 0x00, 0x00, 0x00,
+0xA0, 0xF4, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x18, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x1C, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0x20, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0x24, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0x28, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0x2C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x30, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA1, 0x38, 0xf2, 0x4b, 0x39, 0xd9,
+0xA1, 0x3C, 0x7f, 0xdd, 0xc2, 0x15,
+0xA1, 0x40, 0x0d, 0xc5, 0xef, 0x83,
+0xA1, 0x48, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x4C, 0x10, 0x1d, 0x3f, 0x2d,
+0xA1, 0x50, 0xa9, 0xec, 0x1c, 0x59,
+0xA1, 0x54, 0x75, 0x50, 0x33, 0x99,
+0xA1, 0x58, 0x57, 0x97, 0x3f, 0xa9,
+0xA1, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x7C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x80, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x84, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x88, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x8C, 0x50, 0x00, 0x00, 0x00,
+0xA1, 0x90, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0x9C, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB0, 0x7f, 0xff, 0xff, 0xff,
+0xA1, 0xB4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xB8, 0xd2, 0xdf, 0x64, 0xa3,
+0xA1, 0xBC, 0x00, 0xd2, 0x78, 0xf8,
+0xA1, 0xC0, 0x6b, 0x7b, 0xa9, 0x6d,
+0xA1, 0xC4, 0x00, 0x69, 0x3c, 0x7b,
+0xA1, 0xC8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xCC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xD4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xD8, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xDC, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xE0, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xE4, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA1, 0xEC, 0xe6, 0x66, 0x66, 0x66,
+0xA1, 0xF0, 0x66, 0x66, 0x66, 0x66,
+0xA1, 0xF4, 0x99, 0x99, 0x99, 0x99,
+0xA1, 0xF8, 0x03, 0x02, 0x00, 0x00,
+0xA1, 0xFC, 0x00, 0x00, 0x01, 0x00,
+0xA2, 0x00, 0x01, 0x00, 0x03, 0x02,
+0xA2, 0x04, 0x00, 0x12, 0x74, 0x74,
+0xA2, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x1C, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x6C, 0x00, 0x07, 0xff, 0xff,
+0xA2, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x78, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0x7C, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0x80, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0x84, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0x88, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0x8C, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0x90, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0x94, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0x98, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA2, 0xA4, 0x0c, 0xdc, 0x61, 0x39,
+0xA2, 0xA8, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xAC, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA2, 0xB0, 0x00, 0xe2, 0xd1, 0x41,
+0xA2, 0xB4, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xB8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xBC, 0x5f, 0xfc, 0x88, 0x91,
+0xA2, 0xC0, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xC4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xC8, 0x16, 0x22, 0xf6, 0x0f,
+0xA2, 0xCC, 0x3f, 0xff, 0xff, 0xff,
+0xA2, 0xD0, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xD8, 0x7f, 0xff, 0xff, 0xff,
+0xA2, 0xDC, 0x47, 0xae, 0xfe, 0x3f,
+0xA2, 0xE0, 0xae, 0xaa, 0x1a, 0x6f,
+0xA2, 0xE4, 0x53, 0xba, 0x13, 0xe3,
+0xA2, 0xE8, 0x56, 0xd8, 0x58, 0x0d,
+0xA2, 0xEC, 0xaa, 0xb2, 0x47, 0x65,
+0xA2, 0xF0, 0x7f, 0xf6, 0xdd, 0x87,
+0xA2, 0xF4, 0x55, 0x56, 0xdb, 0x13,
+0xA2, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x00, 0x7f, 0xfe, 0x20, 0x00,
+0xA3, 0x04, 0x0c, 0xdc, 0x61, 0x39,
+0xA3, 0x08, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x0C, 0x7e, 0x3a, 0x5d, 0x7d,
+0xA3, 0x10, 0x00, 0xe2, 0xd1, 0x41,
+0xA3, 0x14, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x1C, 0x5f, 0xfc, 0x88, 0x91,
+0xA3, 0x20, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x24, 0x53, 0xba, 0x13, 0xe3,
+0xA3, 0x28, 0x16, 0x22, 0xf6, 0x0f,
+0xA3, 0x2C, 0x3f, 0xff, 0xff, 0xff,
+0xA3, 0x38, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x3C, 0x01, 0x00, 0x02, 0x01,
+0xA3, 0x40, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x44, 0x7f, 0xe9, 0x2b, 0x09,
+0xA3, 0x48, 0x00, 0x0b, 0x6a, 0x7b,
+0xA3, 0x60, 0x20, 0x00, 0x00, 0x00,
+0xA3, 0x64, 0x0c, 0x99, 0x97, 0x19,
+0xA3, 0x68, 0x0a, 0xcc, 0xca, 0xa8,
+0xA3, 0x6C, 0x0e, 0x66, 0x63, 0x8a,
+0xA3, 0x70, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0x74, 0x7f, 0xff, 0xff, 0xff,
+0xA3, 0xF4, 0x00, 0x64, 0x00, 0x05,
+0xA4, 0x0C, 0x00, 0x00, 0x02, 0xd8,
+0xA4, 0x24, 0x00, 0x00, 0x02, 0xfc,
+0xA4, 0x34, 0x80, 0x00, 0x00, 0x01,
+0xA4, 0x38, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x3C, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x44, 0x00, 0x30, 0x77, 0xae,
+0xA4, 0x48, 0x1c, 0x66, 0x20, 0x7e,
+0xA4, 0x4C, 0x00, 0x00, 0x00, 0x1e,
+0xA4, 0x50, 0x00, 0x00, 0x00, 0x01,
+0xA4, 0x54, 0x00, 0x04, 0x00, 0x00,
+0xA4, 0x58, 0x00, 0x00, 0x00, 0x80,
+0xA4, 0x60, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x64, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0x68, 0x00, 0x00, 0x40, 0x00,
+0xA4, 0x6C, 0x00, 0x10, 0x00, 0x00,
+0xA4, 0x70, 0x00, 0x00, 0x03, 0xe8,
+0xA4, 0x74, 0x00, 0x00, 0x00, 0x04,
+0xA4, 0x78, 0x00, 0x00, 0x32, 0x00,
+0xA4, 0x7C, 0x0a, 0x3d, 0x00, 0x00,
+0xA4, 0x80, 0x00, 0x00, 0x06, 0x29,
+0xA4, 0x84, 0x00, 0x30, 0x00, 0x00,
+0xA4, 0x88, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0x8C, 0x00, 0x00, 0x80, 0x00,
+0xA4, 0xA0, 0x7f, 0xfe, 0x20, 0x00,
+0xA4, 0xA4, 0x00, 0x07, 0x69, 0x8a,
+0xA4, 0xA8, 0x54, 0x91, 0x9a, 0x57,
+0xA4, 0xAC, 0x00, 0x00, 0x00, 0xec,
+0xA4, 0xB8, 0x00, 0x02, 0x6c, 0x62,
+0xA4, 0xBC, 0xad, 0x99, 0x86, 0xfc,
+0xA4, 0xC0, 0x7c, 0x7a, 0xf7, 0x9f,
+0xA4, 0xC4, 0x55, 0xeb, 0x81, 0x65,
+0xA4, 0xC8, 0x00, 0x00, 0xa8, 0xdc,
+0xA4, 0xCC, 0x00, 0x00, 0x14, 0xc4,
+0xA4, 0xD0, 0xaa, 0xb2, 0x47, 0x65,
+0xA4, 0xD4, 0x55, 0x56, 0xdb, 0x13,
+0xA4, 0xD8, 0x00, 0x00, 0x00, 0x5c,
+0xA4, 0xDC, 0x00, 0x00, 0x08, 0xcd,
+0xA4, 0xE0, 0x7f, 0xff, 0xff, 0xff,
+0xA4, 0xE8, 0x20, 0x00, 0x00, 0x00,
+0xA4, 0xEC, 0x61, 0x86, 0x18, 0x60,
+0xA4, 0xF0, 0x00, 0x00, 0x0a, 0x30,
+0xA4, 0xF8, 0x02, 0x40, 0x00, 0x00,
+0xA4, 0xFC, 0x00, 0xbe, 0x00, 0x00,
+0xA5, 0x00, 0x00, 0xe6, 0x00, 0x00,
+0xA5, 0x04, 0x01, 0x1d, 0x00, 0x00,
+0xA5, 0x88, 0x5f, 0x37, 0x59, 0xdf,
+0xA5, 0x8C, 0x5f, 0xff, 0xff, 0xff,
+0xA5, 0x9C, 0x00, 0xb4, 0x00, 0xb4,
+0xA5, 0xA0, 0x06, 0x00, 0x00, 0x00,
+0xA5, 0xEC, 0x00, 0x00, 0x02, 0xda,
+0xA5, 0xF0, 0x00, 0x04, 0x18, 0xac,
+0xA5, 0xF4, 0x00, 0x04, 0x15, 0x1e,
+0xA5, 0xF8, 0x00, 0x04, 0x18, 0xf4,
+0xA5, 0xFC, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x00, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x04, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x08, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x0C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x10, 0x00, 0x00, 0x03, 0x76,
+0xA6, 0x14, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x18, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x1C, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x20, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x24, 0x00, 0x04, 0x15, 0x1e,
+0xA6, 0x28, 0x00, 0x04, 0x15, 0x1e,
+0xA7, 0xAC, 0x00, 0x00, 0x00, 0x04,
+0xA7, 0xB0, 0x00, 0x08, 0xbe, 0x1d,
+0xA7, 0xB4, 0x00, 0x00, 0x27, 0x10,
+0xA7, 0xB8, 0x00, 0x00, 0x00, 0x0a,
+0xA7, 0xF8, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x00, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x04, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x10, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x18, 0x7f, 0xff, 0xff, 0xff,
+0xA8, 0x1C, 0x80, 0x00, 0x00, 0x01,
+0xA8, 0x20, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x24, 0x7f, 0xf5, 0xb7, 0xaf,
+0xA8, 0x28, 0x00, 0x05, 0x24, 0x28,
+0xA8, 0x2C, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x30, 0x19, 0x99, 0x99, 0xa0,
+0xA8, 0x38, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x40, 0x26, 0x66, 0x66, 0x80,
+0xA8, 0x44, 0x33, 0x33, 0x33, 0x40,
+0xA8, 0x4C, 0xe0, 0x00, 0x00, 0x01,
+0xA8, 0x54, 0x80, 0x02, 0x92, 0x21,
+0xA8, 0x58, 0x7f, 0xfa, 0xdb, 0xbd,
+0xA8, 0x5C, 0x7f, 0xfd, 0x6d, 0xdf,
+0xA8, 0x60, 0x00, 0x40, 0x00, 0x00,
+0xA9, 0x1C, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x20, 0x7f, 0xd2, 0x5a, 0x25,
+0xA9, 0x24, 0x00, 0x16, 0xd2, 0xed,
+0xA9, 0x28, 0x00, 0x06, 0x00, 0x0a,
+0xA9, 0x3C, 0x3f, 0xff, 0xff, 0xff,
+0xA9, 0x40, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x44, 0x7f, 0xfe, 0x20, 0x00,
+0xA9, 0x48, 0x7f, 0xb0, 0x00, 0x00,
+0xA9, 0x4C, 0x00, 0x00, 0x20, 0x00,
+0xA9, 0x50, 0x00, 0x80, 0x00, 0x00,
+0xA9, 0x54, 0x7f, 0xf4, 0x00, 0x00,
+0xA9, 0x60, 0x00, 0x48, 0x00, 0x00,
+0xA9, 0x64, 0x7f, 0xf8, 0x00, 0x00,
+0xA9, 0x68, 0x00, 0x00, 0x02, 0x00,
+0xA9, 0x6C, 0x1f, 0xff, 0xff, 0xff,
+0xA9, 0x70, 0x7f, 0x00, 0x00, 0x00,
+0xA9, 0x74, 0x00, 0x00, 0x02, 0x8c,
+0xA9, 0x7C, 0x0c, 0xdc, 0x61, 0x39,
+0xA9, 0x80, 0x0a, 0x49, 0xe7, 0x60,
+0xA9, 0x84, 0x00, 0xa0, 0x00, 0x00,
+0xA9, 0x88, 0x01, 0x20, 0x00, 0x00,
+};
+
+const unsigned char LC898124EP3_SERVO_ON_PM_0_2_7_2_1_0[] = {
+0x64, 0x00, 0x00, 0x02, 0x07,
+0x64, 0x00, 0x00, 0x51, 0x67,
+0x64, 0x00, 0x40, 0x1d, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x00, 0x54, 0xe7,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x64, 0x00, 0x40, 0x23, 0x47,
+0x64, 0x00, 0x40, 0x27, 0x87,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x46, 0x0b, 0x03, 0x80, 0x00,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x66, 0x00, 0x00, 0x28, 0x08,
+0x40, 0x00, 0x02, 0xbf, 0xe0,
+0x5c, 0x00, 0x6b, 0x01, 0x04,
+0x6c, 0x70, 0x28, 0x06, 0x49,
+0x68, 0x34, 0x00, 0x1b, 0x20,
+0x68, 0x03, 0xf9, 0xff, 0xca,
+0x5c, 0x81, 0x00, 0x40, 0x0b,
+0x54, 0x4d, 0xf2, 0xc5, 0x01,
+0x5c, 0x10, 0xf0, 0x40, 0x4a,
+0x5c, 0x02, 0xfa, 0x03, 0x20,
+0x84, 0x00, 0x05, 0x24, 0x80,
+0x30, 0x62, 0x45, 0xc0, 0x08,
+0x00, 0x2d, 0x08, 0x00, 0x7a,
+0x80, 0x07, 0xa8, 0x00, 0x7a,
+0x84, 0x07, 0xaa, 0x01, 0x00,
+0x84, 0x07, 0xaa, 0x05, 0x80,
+0x5c, 0x0d, 0xb0, 0x02, 0x4a,
+0x84, 0x04, 0x8a, 0x02, 0x20,
+0x84, 0x00, 0x86, 0x80, 0x00,
+0x60, 0x00, 0x25, 0x48, 0x51,
+0x31, 0xdf, 0x45, 0xc0, 0xe1,
+0x04, 0x05, 0x26, 0xc6, 0x80,
+0x80, 0x84, 0xba, 0x00, 0x60,
+0x84, 0x04, 0x8a, 0x00, 0x80,
+0xb0, 0x80, 0xc6, 0x83, 0x40,
+0x84, 0xa2, 0x48, 0x40, 0x48,
+0x84, 0x0c, 0x8a, 0x20, 0x20,
+0x86, 0x07, 0xa8, 0x00, 0x7a,
+0x80, 0x05, 0x0a, 0xc7, 0xe0,
+0x68, 0x20, 0x01, 0x4f, 0x21,
+0x80, 0x05, 0x06, 0x80, 0x00,
+0x02, 0xb2, 0x4a, 0xc5, 0x80,
+0x84, 0x80, 0xb5, 0x24, 0xdf,
+0x06, 0x00, 0x85, 0x20, 0x52,
+0x00, 0x25, 0x0b, 0x06, 0x07,
+0xac, 0x40, 0x08, 0x60, 0x48,
+0x80, 0x24, 0xb8, 0x48, 0x4a,
+0x84, 0x04, 0xbb, 0x00, 0x1c,
+0x66, 0x00, 0x40, 0x36, 0x68,
+0x40, 0x00, 0x02, 0x40, 0x40,
+0x5c, 0x81, 0x02, 0x40, 0x40,
+0x94, 0x02, 0xdb, 0x07, 0xfc,
+0x30, 0x12, 0x8b, 0xc1, 0x08,
+0x68, 0x20, 0x00, 0x1b, 0x24,
+0x23, 0x4e, 0xd8, 0x20, 0x49,
+0x88, 0x06, 0x46, 0x60, 0x04,
+0x03, 0x66, 0x85, 0xc0, 0x06,
+0xb0, 0x03, 0xca, 0x40, 0x40,
+0x94, 0x02, 0xd5, 0x1a, 0x76,
+0x88, 0x02, 0x0b, 0xc0, 0x6f,
+0x40, 0x00, 0x00, 0x40, 0x49,
+0x6c, 0x40, 0x00, 0x36, 0x7a,
+0x40, 0x00, 0x00, 0x60, 0xfa,
+0x66, 0x00, 0x40, 0x42, 0xa0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x59, 0x28,
+0xbc, 0x03, 0x06, 0x60, 0x04,
+0x02, 0xdc, 0x0b, 0xc0, 0x87,
+0x66, 0x00, 0x40, 0x2d, 0xc0,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x38, 0x11, 0xc2, 0x41, 0x28,
+0x6e, 0x00, 0x01, 0xae, 0x60,
+0x5c, 0x0d, 0xeb, 0x00, 0x0c,
+0x6e, 0x00, 0x00, 0x8c, 0xae,
+0x6c, 0x40, 0x03, 0x1a, 0x48,
+0x30, 0x17, 0x0b, 0xc0, 0x68,
+0x6c, 0x40, 0x03, 0x1e, 0x48,
+0x68, 0x00, 0x3f, 0xff, 0xc9,
+0x6e, 0x40, 0x00, 0x08, 0x75,
+0x66, 0x00, 0x41, 0x38, 0x40,
+0x6e, 0x40, 0x00, 0x08, 0x3d,
+0x68, 0x00, 0x01, 0x00, 0x08,
+0x28, 0x92, 0xc3, 0x20, 0x20,
+0xbc, 0x09, 0x93, 0x81, 0x1d,
+0x6e, 0x00, 0x01, 0xae, 0x2c,
+0x24, 0x16, 0x06, 0xe0, 0x00,
+0x1a, 0xe6, 0x06, 0x60, 0x00,
+0x03, 0x94, 0x83, 0x80, 0x04,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x46, 0x80,
+0x66, 0x00, 0x40, 0xea, 0xc0,
+0x5c, 0x0b, 0x6b, 0x03, 0x6e,
+0x6c, 0x00, 0x02, 0x60, 0x49,
+0x5c, 0x0d, 0xfb, 0x80, 0x00,
+0x66, 0x00, 0x40, 0x2e, 0xe8,
+0x5c, 0x1f, 0x6b, 0x00, 0x84,
+0x6c, 0x00, 0x00, 0x56, 0x08,
+0x38, 0x1d, 0x52, 0x59, 0x60,
+0xbc, 0x05, 0x83, 0x81, 0xc6,
+0x52, 0x4d, 0x23, 0x80, 0x00,
+0x6c, 0x00, 0x00, 0x56, 0x48,
+0x68, 0x00, 0x00, 0xe0, 0x20,
+0x6c, 0x40, 0x04, 0xc4, 0x08,
+0x39, 0x02, 0x08, 0x00, 0x48,
+0x84, 0x0f, 0xa8, 0x40, 0x7a,
+0x40, 0x00, 0x03, 0xc0, 0x4f,
+0x5c, 0x00, 0xe2, 0xc4, 0xc0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x00, 0x02, 0xc6, 0x0a,
+0x32, 0xa3, 0x0b, 0xff, 0xa1,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x6c, 0x00, 0x02, 0xc6, 0x7a,
+0xa0, 0x00, 0x48, 0x02, 0x0a,
+0x25, 0x97, 0x0b, 0xc0, 0x89,
+0x88, 0x06, 0x02, 0x49, 0x75,
+0x82, 0x24, 0x96, 0x80, 0x00,
+0x0b, 0x6a, 0x06, 0xc4, 0x00,
+0x31, 0x84, 0x88, 0x60, 0x60,
+0x66, 0x00, 0x00, 0x12, 0x60,
+0x88, 0x02, 0x00, 0x00, 0x00,
+0x84, 0x02, 0x0b, 0xa0, 0x80,
+0x6c, 0x00, 0x00, 0xf0, 0x09,
+0x6c, 0x00, 0x01, 0x1a, 0x08,
+0x22, 0x86, 0xd6, 0x83, 0x40,
+0x80, 0x02, 0x02, 0x28, 0x64,
+0x6c, 0x68, 0x10, 0x00, 0x49,
+0x40, 0x00, 0x00, 0x44, 0x48,
+0x66, 0x00, 0x41, 0xca, 0x40,
+0x6c, 0x00, 0x02, 0x3c, 0x20,
+0x40, 0x00, 0x03, 0xa0, 0x80,
+0x68, 0x00, 0x01, 0x16, 0x20,
+0x68, 0x20, 0x00, 0xf1, 0x24,
+0x68, 0x00, 0x01, 0x1a, 0x21,
+0x68, 0x20, 0x00, 0xf7, 0x25,
+0x68, 0x00, 0x01, 0x00, 0x22,
+0x66, 0x00, 0x40, 0x5d, 0x00,
+0x68, 0x00, 0x01, 0x2b, 0x20,
+0x66, 0x00, 0x41, 0x48, 0x20,
+0x46, 0x0e, 0x03, 0x80, 0x00,
+0xbf, 0xbb, 0xf3, 0x81, 0xd5,
+0x68, 0x20, 0x00, 0x24, 0x21,
+0x5c, 0x82, 0x02, 0xbf, 0x70,
+0x5c, 0x08, 0xb0, 0x08, 0x08,
+0x68, 0x00, 0x00, 0x9a, 0x20,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x84, 0x00, 0x94, 0x42, 0x00,
+0x02, 0x00, 0x98, 0x40, 0x88,
+0x6e, 0x00, 0x01, 0xae, 0x2f,
+0x44, 0x09, 0x00, 0x81, 0x64,
+0x52, 0xcd, 0xc0, 0x81, 0xe1,
+0x88, 0x27, 0x68, 0x82, 0xd6,
+0x90, 0x45, 0x84, 0x20, 0x3c,
+0x88, 0x55, 0x49, 0x03, 0x5a,
+0x00, 0x00, 0x06, 0xc0, 0x00,
+0x18, 0x60, 0xab, 0xc0, 0x7f,
+0x6c, 0x00, 0x01, 0x74, 0x09,
+0x68, 0x00, 0x00, 0x9c, 0x20,
+0x00, 0x00, 0x08, 0x40, 0x8a,
+0x84, 0x00, 0x98, 0x85, 0xca,
+0x40, 0x00, 0x00, 0x86, 0x49,
+0x68, 0x20, 0x00, 0x85, 0x24,
+0x66, 0x00, 0x40, 0x88, 0xe8,
+0x6e, 0x40, 0x01, 0x12, 0x27,
+0x68, 0x20, 0x00, 0x85, 0x20,
+0x88, 0x84, 0x8a, 0x00, 0x88,
+0x94, 0x02, 0x78, 0x86, 0x0a,
+0x88, 0x58, 0x96, 0x60, 0x04,
+0x08, 0x8e, 0x8a, 0x04, 0x4c,
+0x6e, 0x00, 0x01, 0xae, 0x2d,
+0x5c, 0x08, 0xf0, 0x85, 0xc8,
+0x52, 0xcd, 0x40, 0x88, 0xc8,
+0xbc, 0x21, 0x98, 0x88, 0x09,
+0x68, 0x20, 0x00, 0x90, 0x2c,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x4a, 0x09,
+0x44, 0x08, 0x00, 0x85, 0x89,
+0x68, 0x20, 0x00, 0x98, 0xac,
+0x88, 0x84, 0x86, 0x82, 0x00,
+0x09, 0x2a, 0x46, 0x82, 0x00,
+0x09, 0x5a, 0x58, 0x80, 0x6c,
+0x90, 0x65, 0x88, 0x85, 0xd4,
+0x66, 0x00, 0x40, 0x78, 0x80,
+0x6c, 0x40, 0x00, 0x98, 0x09,
+0x40, 0x00, 0x03, 0xc0, 0xcf,
+0x44, 0x08, 0x00, 0x88, 0xc8,
+0x6c, 0x40, 0x00, 0x4a, 0x08,
+0x44, 0x21, 0x00, 0x85, 0x89,
+0x6c, 0x40, 0x00, 0x98, 0x08,
+0x44, 0x20, 0x01, 0x06, 0x5a,
+0x40, 0x00, 0x00, 0x85, 0xd6,
+0x68, 0x00, 0x00, 0x7d, 0x20,
+0x90, 0x61, 0x2a, 0x04, 0x21,
+0x88, 0x59, 0x68, 0x85, 0xe1,
+0x90, 0x65, 0x88, 0x87, 0x54,
+0x66, 0x00, 0x40, 0x52, 0x08,
+0x5c, 0x00, 0x71, 0x80, 0x89,
+0x90, 0x61, 0x06, 0x80, 0x00,
+0x09, 0x22, 0x08, 0x87, 0x14,
+0xa0, 0x42, 0x18, 0x86, 0xc8,
+0x88, 0x66, 0x16, 0x60, 0x04,
+0x05, 0x20, 0x85, 0xc0, 0x07,
+0x18, 0x00, 0x98, 0x86, 0x20,
+0x88, 0x12, 0x1a, 0x05, 0x84,
+0x90, 0x31, 0x08, 0x48, 0x09,
+0x88, 0x29, 0x48, 0x81, 0x48,
+0x68, 0x00, 0x01, 0x34, 0x21,
+0x88, 0x5a, 0x08, 0x60, 0x08,
+0x44, 0x0c, 0x00, 0x81, 0xa5,
+0xa0, 0x58, 0x09, 0x04, 0x12,
+0x86, 0x80, 0x88, 0x40, 0x0a,
+0x88, 0x51, 0x66, 0xc0, 0x00,
+0x1e, 0xa0, 0xb4, 0x44, 0x4c,
+0x08, 0x1e, 0x45, 0x40, 0xe1,
+0x08, 0x2e, 0x09, 0x80, 0x8a,
+0x6c, 0x00, 0x01, 0xde, 0x09,
+0x54, 0x0a, 0x40, 0x62, 0x4a,
+0x98, 0x00, 0x98, 0x42, 0x49,
+0x88, 0x34, 0xa8, 0x83, 0xc9,
+0x68, 0x20, 0x01, 0xfc, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x13, 0xa2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x02, 0x02, 0x24,
+0x66, 0x00, 0x00, 0x26, 0x80,
+0x88, 0x10, 0x98, 0x83, 0x0a,
+0x54, 0x0b, 0x80, 0x86, 0x82,
+0x54, 0x08, 0x00, 0x83, 0x89,
+0x54, 0x05, 0x50, 0x81, 0xa1,
+0x88, 0x80, 0x95, 0x40, 0xa9,
+0x08, 0x2a, 0x08, 0x49, 0x40,
+0x68, 0x20, 0x00, 0x7e, 0x2c,
+0x88, 0x8c, 0x88, 0x41, 0x42,
+0x68, 0x00, 0x00, 0x48, 0x21,
+0x68, 0x20, 0x00, 0x24, 0x24,
+0x68, 0x20, 0x00, 0x72, 0x25,
+0x40, 0x00, 0x00, 0x80, 0x6c,
+0x66, 0x00, 0x00, 0x22, 0x48,
+0x6c, 0x00, 0x02, 0xb6, 0x09,
+0x68, 0x20, 0x00, 0x7f, 0xac,
+0x88, 0x84, 0x86, 0x80, 0x00,
+0x05, 0xc2, 0x18, 0x81, 0xa0,
+0x68, 0x20, 0x00, 0x4b, 0x24,
+0x68, 0x20, 0x00, 0x78, 0x25,
+0x88, 0x06, 0xc6, 0x60, 0x00,
+0x02, 0x24, 0x86, 0xc0, 0x00,
+0x2b, 0x80, 0x98, 0x88, 0xc8,
+0x68, 0x20, 0x00, 0x83, 0x20,
+0x68, 0x20, 0x00, 0x84, 0x21,
+0xa4, 0x22, 0x36, 0x60, 0x04,
+0x0c, 0x68, 0x8a, 0x42, 0x02,
+0x5c, 0x8d, 0x00, 0x82, 0xa0,
+0x5c, 0x08, 0x61, 0x8e, 0x89,
+0xa0, 0x28, 0x09, 0x42, 0x0f,
+0x25, 0x93, 0x8b, 0xc0, 0x39,
+0x55, 0x01, 0x70, 0x81, 0xa1,
+0x88, 0x80, 0xa8, 0x40, 0x0b,
+0x54, 0x0f, 0x82, 0x0a, 0x81,
+0x94, 0xa0, 0xe2, 0x59, 0x30,
+0xbc, 0x03, 0x98, 0x40, 0xc0,
+0x00, 0x00, 0x08, 0x88, 0x89,
+0x00, 0x00, 0x08, 0x48, 0x08,
+0x54, 0x09, 0x40, 0x82, 0x36,
+0xba, 0x14, 0x88, 0x48, 0xc0,
+0x40, 0x00, 0x02, 0x80, 0x90,
+0x98, 0x84, 0x8a, 0x28, 0x01,
+0xa0, 0x04, 0x5a, 0x2c, 0x22,
+0x86, 0x80, 0xaa, 0x10, 0x45,
+0xab, 0xfb, 0x08, 0x81, 0xe2,
+0x88, 0x16, 0x09, 0x82, 0x20,
+0x85, 0x00, 0x85, 0x70, 0x98,
+0x20, 0x82, 0x25, 0x50, 0x00,
+0x21, 0x02, 0x35, 0x70, 0xa0,
+0x21, 0x82, 0x68, 0x80, 0x66,
+0x88, 0x2e, 0x68, 0x82, 0x65,
+0xa2, 0x06, 0x48, 0x85, 0x25,
+0x88, 0x36, 0x48, 0x83, 0xe0,
+0x88, 0x47, 0x66, 0x60, 0x04,
+0x06, 0xa6, 0x89, 0x80, 0x09,
+0x5c, 0x08, 0x28, 0x82, 0x20,
+0x88, 0x1a, 0x1a, 0x02, 0x20,
+0x94, 0x02, 0xf5, 0x2c, 0xbc,
+0x04, 0x94, 0x8a, 0x05, 0xe1,
+0x42, 0x02, 0xc8, 0x83, 0x24,
+0x5c, 0x00, 0x30, 0x83, 0xa0,
+0x88, 0x12, 0x50, 0x00, 0x00,
+0x86, 0x98, 0xa8, 0x48, 0x09,
+0x54, 0x0b, 0x82, 0x01, 0x40,
+0x98, 0x00, 0x9a, 0x22, 0xe4,
+0x84, 0x8c, 0x98, 0x81, 0x64,
+0x88, 0x1e, 0x06, 0x60, 0x04,
+0x07, 0x0c, 0x08, 0x82, 0xa1,
+0x88, 0x52, 0x58, 0x81, 0x24,
+0x88, 0x1a, 0x08, 0x84, 0x36,
+0xa2, 0x82, 0x5a, 0x80, 0x50,
+0xa0, 0x04, 0x0a, 0x20, 0x64,
+0x40, 0x00, 0x02, 0x08, 0x21,
+0x64, 0x00, 0x40, 0x71, 0xaf,
+0x55, 0x01, 0x2a, 0x08, 0x22,
+0xa2, 0x08, 0x4a, 0x20, 0x22,
+0x84, 0x40, 0x98, 0x60, 0x0a,
+0x57, 0x8b, 0xaa, 0xbf, 0xe0,
+0xa1, 0x4a, 0x4a, 0x08, 0x00,
+0x85, 0x00, 0x88, 0x80, 0x64,
+0x88, 0x0e, 0x08, 0x81, 0x76,
+0x66, 0x00, 0x40, 0x53, 0x48,
+0x2e, 0x96, 0x58, 0x80, 0x20,
+0x88, 0x0a, 0x48, 0x41, 0x89,
+0x44, 0x08, 0x00, 0x81, 0x36,
+0x46, 0x0a, 0x41, 0x80, 0x08,
+0x86, 0x14, 0x8a, 0x80, 0x20,
+0x68, 0x00, 0x00, 0x2c, 0x20,
+0x5c, 0x81, 0x03, 0x02, 0x74,
+0x68, 0x01, 0x05, 0xdb, 0x2c,
+0x80, 0x06, 0xc6, 0x80, 0x00,
+0x0a, 0x4a, 0x18, 0x00, 0x61,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0x6c, 0x00, 0x02, 0xcc, 0x48,
+0x46, 0x0a, 0x40, 0x00, 0x61,
+0x84, 0x06, 0x10, 0x00, 0x00,
+0x68, 0x00, 0x00, 0x07, 0x60,
+0xab, 0xff, 0x09, 0x40, 0x2c,
+0x55, 0x5f, 0x22, 0x04, 0x10,
+0x59, 0x01, 0x00, 0x80, 0x76,
+0xbc, 0x29, 0x89, 0x40, 0x2e,
+0x32, 0x06, 0x0b, 0xc1, 0x40,
+0x32, 0x0a, 0x0b, 0xc3, 0x51,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x63, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc2, 0xb7,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc2, 0x37,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x20, 0x02, 0x4d, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc1, 0x97,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x4b, 0xc1, 0x17,
+0x32, 0x0b, 0x0b, 0xc0, 0x88,
+0x68, 0x00, 0x01, 0x8f, 0x20,
+0x68, 0x00, 0x00, 0x07, 0xa1,
+0x66, 0x00, 0x41, 0x53, 0x60,
+0x40, 0x00, 0x03, 0xc0, 0x77,
+0x68, 0x00, 0x00, 0x07, 0x21,
+0x66, 0x00, 0x41, 0x54, 0x40,
+0x66, 0x00, 0x41, 0x52, 0x08,
+0xb0, 0x02, 0x48, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x10,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6c, 0x40, 0x03, 0x18, 0x09,
+0x5d, 0x0a, 0x23, 0x01, 0xc6,
+0x52, 0x0d, 0x72, 0xbf, 0xe0,
+0x59, 0x01, 0x00, 0x80, 0xfa,
+0x6c, 0x40, 0x03, 0x18, 0x4a,
+0x88, 0x17, 0x64, 0x20, 0x74,
+0x18, 0xe8, 0x95, 0x50, 0x16,
+0x08, 0x04, 0x89, 0x8e, 0x88,
+0x88, 0x00, 0x93, 0x20, 0x68,
+0xbc, 0x07, 0x8b, 0x00, 0x0d,
+0x88, 0x00, 0x95, 0x90, 0x54,
+0x30, 0x00, 0xdb, 0xc0, 0x29,
+0x98, 0x24, 0x89, 0x8e, 0x89,
+0x88, 0x0c, 0x93, 0x20, 0x68,
+0xbc, 0x09, 0x98, 0x81, 0xc8,
+0x66, 0x00, 0x40, 0x77, 0x00,
+0x68, 0x00, 0x00, 0x72, 0x20,
+0x5c, 0x81, 0x00, 0x81, 0x88,
+0x80, 0x20, 0x98, 0x40, 0x49,
+0x32, 0x06, 0x0b, 0xc0, 0x71,
+0x66, 0x00, 0x40, 0x77, 0xc0,
+0x68, 0x00, 0x00, 0x87, 0x20,
+0x39, 0x02, 0x08, 0x02, 0x09,
+0x84, 0x04, 0x99, 0x8e, 0x88,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x08, 0x9b, 0x00, 0x0c,
+0x68, 0x00, 0x00, 0x84, 0x20,
+0x68, 0x00, 0x00, 0x99, 0x21,
+0x66, 0x00, 0x41, 0x44, 0xe8,
+0x88, 0x18, 0x98, 0x80, 0x09,
+0x32, 0x02, 0x8b, 0xc1, 0x01,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x2a, 0xc4, 0xc0,
+0x84, 0x00, 0x82, 0x51, 0x64,
+0x6c, 0x40, 0x03, 0x18, 0x0a,
+0x52, 0x8b, 0xa8, 0x02, 0x48,
+0x6c, 0x40, 0x03, 0x18, 0x49,
+0x68, 0x01, 0x05, 0x47, 0xa1,
+0xbc, 0x05, 0xf8, 0x40, 0x61,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x00, 0x00, 0x08, 0x81, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x20,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x71, 0x20,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x84, 0x00, 0x88, 0x50, 0x0a,
+0x58, 0x0d, 0x02, 0xbf, 0xf0,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0xbc, 0x03, 0x88, 0x80, 0x76,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x68, 0x00, 0x00, 0x86, 0x20,
+0x6c, 0x40, 0x01, 0x04, 0x08,
+0x84, 0x00, 0xa3, 0x01, 0x30,
+0x68, 0x20, 0x00, 0x82, 0x22,
+0x40, 0x00, 0x03, 0xc0, 0x48,
+0x68, 0x20, 0x00, 0x81, 0x21,
+0x66, 0x00, 0x40, 0xf3, 0x40,
+0x6c, 0x00, 0x00, 0xe2, 0x08,
+0x6c, 0x40, 0x01, 0x04, 0x0a,
+0x30, 0x1a, 0x0b, 0xc0, 0x41,
+0x6c, 0x00, 0x01, 0x0c, 0x08,
+0x30, 0x1a, 0x0b, 0xc0, 0x60,
+0x68, 0x00, 0x00, 0xcd, 0xa0,
+0x40, 0x00, 0x03, 0xc1, 0x1f,
+0x6c, 0x00, 0x00, 0x0a, 0x60,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa2, 0x49, 0x36,
+0x6c, 0x40, 0x03, 0x18, 0x00,
+0x52, 0x88, 0x20, 0x02, 0x4a,
+0x68, 0x01, 0x05, 0x47, 0xa2,
+0x6c, 0x40, 0x03, 0x18, 0x48,
+0x84, 0x06, 0x20, 0x00, 0x00,
+0x88, 0x03, 0x6b, 0xa1, 0x48,
+0xa8, 0x01, 0x00, 0x00, 0x00,
+0x6c, 0x40, 0x03, 0x28, 0x08,
+0x5c, 0x0e, 0x32, 0xbf, 0xf0,
+0x52, 0x0d, 0x20, 0x80, 0x76,
+0x6c, 0x40, 0x03, 0x28, 0x48,
+0x66, 0x00, 0x00, 0x39, 0x48,
+0x5c, 0x00, 0x63, 0x80, 0x00,
+0x68, 0x00, 0x00, 0x2b, 0x20,
+0x5c, 0x0e, 0x22, 0xc4, 0xc0,
+0x84, 0x00, 0xa5, 0x24, 0x9b,
+0x08, 0x03, 0x66, 0xc4, 0x00,
+0x32, 0x80, 0x05, 0x24, 0x82,
+0x00, 0x24, 0xa6, 0xc4, 0x00,
+0x32, 0x84, 0x86, 0x80, 0x10,
+0x54, 0x7a, 0xcb, 0xa1, 0x48,
+0x84, 0x06, 0xca, 0x80, 0x10,
+0x59, 0x01, 0x02, 0xbf, 0x60,
+0xbc, 0x0f, 0x96, 0x80, 0x00,
+0x15, 0xa2, 0x16, 0x80, 0x00,
+0x15, 0x32, 0x05, 0xc8, 0x10,
+0x18, 0xe8, 0x86, 0x80, 0x00,
+0x1f, 0x22, 0x12, 0xa0, 0x64,
+0x5d, 0x48, 0x20, 0x08, 0x0a,
+0x32, 0x1e, 0x0b, 0xff, 0xba,
+0x40, 0x00, 0x00, 0x00, 0x4a,
+0x68, 0x00, 0x01, 0x56, 0x22,
+0x5c, 0x81, 0x00, 0x48, 0x0b,
+0x5c, 0x00, 0x19, 0x50, 0x35,
+0x95, 0x0b, 0x0a, 0x40, 0xc0,
+0x68, 0x00, 0x01, 0x53, 0x22,
+0x23, 0x09, 0xc5, 0x50, 0x2e,
+0x18, 0x22, 0x95, 0xd4, 0x81,
+0x9d, 0x08, 0x15, 0x90, 0xec,
+0x14, 0x83, 0x65, 0x70, 0xb9,
+0x14, 0x8b, 0x45, 0x70, 0x10,
+0x9c, 0x08, 0x34, 0x3f, 0x9d,
+0x15, 0x87, 0x29, 0x58, 0xf1,
+0x51, 0xa1, 0xe2, 0x41, 0xa1,
+0x5b, 0x08, 0x0a, 0xc0, 0xc1,
+0x51, 0x58, 0x42, 0x00, 0x22,
+0x57, 0x08, 0x4a, 0x00, 0x60,
+0x57, 0x08, 0x50, 0x81, 0xf6,
+0x51, 0x58, 0x90, 0x81, 0x4b,
+0x51, 0x58, 0x48, 0x08, 0x42,
+0x51, 0x59, 0x30, 0x08, 0x41,
+0x54, 0x09, 0x00, 0x08, 0x40,
+0x54, 0x08, 0x08, 0x08, 0x7a,
+0x51, 0x58, 0x00, 0x08, 0x4a,
+0x51, 0x58, 0x40, 0x08, 0x40,
+0x80, 0xac, 0x08, 0x80, 0x61,
+0x88, 0x26, 0x18, 0x82, 0xe2,
+0x68, 0x20, 0x00, 0x90, 0x23,
+0x68, 0x20, 0x00, 0x8a, 0x24,
+0x68, 0x20, 0x00, 0x8d, 0x25,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0x40, 0x00, 0x02, 0x40, 0xc1,
+0x5c, 0x81, 0x00, 0x81, 0x08,
+0x51, 0x61, 0x20, 0x82, 0x23,
+0x51, 0xa1, 0x22, 0xc0, 0xc1,
+0x5b, 0x08, 0x08, 0x82, 0xa0,
+0x22, 0xb0, 0x85, 0x70, 0x84,
+0xa0, 0x05, 0x05, 0x70, 0x85,
+0x20, 0x46, 0x12, 0x2b, 0x12,
+0x51, 0x58, 0x48, 0x18, 0x42,
+0x51, 0x59, 0x30, 0x18, 0x41,
+0x54, 0x09, 0x00, 0x18, 0x40,
+0x54, 0x08, 0x08, 0x18, 0x7a,
+0x51, 0x58, 0x00, 0x18, 0x4a,
+0x51, 0x58, 0x40, 0x18, 0x40,
+0x81, 0xac, 0x08, 0x80, 0x63,
+0x68, 0x20, 0x00, 0x98, 0xa3,
+0x68, 0x20, 0x00, 0x92, 0xa4,
+0x68, 0x20, 0x00, 0x95, 0xa5,
+0x66, 0x00, 0x00, 0x47, 0x28,
+0xa0, 0x82, 0x28, 0x81, 0xb6,
+0xba, 0x14, 0x8a, 0x80, 0xa0,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0xba, 0x14, 0x82, 0xe1, 0xa8,
+0x40, 0x00, 0x01, 0x80, 0x08,
+0x59, 0x06, 0x42, 0xbf, 0xd0,
+0x49, 0xa9, 0xb8, 0x80, 0x76,
+0xbc, 0x19, 0x89, 0xa0, 0x00,
+0x32, 0x03, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x76,
+0x68, 0x00, 0x09, 0xc4, 0x09,
+0x50, 0x41, 0x83, 0xa1, 0x11,
+0x44, 0x08, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x1a, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xc1, 0x77,
+0x32, 0x02, 0x0b, 0xc0, 0x29,
+0x38, 0x10, 0x02, 0xa0, 0x64,
+0x68, 0x01, 0xff, 0xff, 0xc9,
+0x50, 0x41, 0x03, 0xa1, 0x11,
+0x44, 0x48, 0x81, 0x01, 0x58,
+0x5b, 0x40, 0x11, 0x02, 0x59,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x42, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x19, 0x02, 0x12,
+0x29, 0x85, 0x13, 0x20, 0x08,
+0xbc, 0x02, 0x33, 0x60, 0x00,
+0x37, 0x80, 0x08, 0x80, 0x36,
+0xba, 0x14, 0x8a, 0x80, 0x30,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x5b, 0x02, 0x03, 0x01, 0x01,
+0x50, 0x43, 0x11, 0x84, 0x0a,
+0x46, 0x08, 0x89, 0x83, 0x88,
+0x44, 0x41, 0x09, 0x84, 0x8b,
+0x98, 0x30, 0xa4, 0x47, 0x44,
+0xab, 0xfe, 0x05, 0x08, 0x20,
+0x08, 0x07, 0x60, 0x88, 0x82,
+0x37, 0x80, 0x06, 0x80, 0x00,
+0x9c, 0x40, 0x80, 0x84, 0x80,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x5b, 0x44, 0x11, 0x01, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x0b, 0xa1, 0x01,
+0x90, 0x11, 0x26, 0xa0, 0x00,
+0x9c, 0x40, 0x12, 0x98, 0x52,
+0x32, 0x01, 0x0b, 0xc0, 0x3b,
+0x88, 0x03, 0x63, 0x60, 0x00,
+0x37, 0x80, 0x0b, 0xa1, 0x48,
+0xa8, 0x02, 0x00, 0x00, 0x00,
+0xab, 0xf8, 0x09, 0x40, 0x36,
+0x88, 0x04, 0xa8, 0x80, 0xe5,
+0x88, 0x16, 0x48, 0x81, 0xe3,
+0x88, 0x26, 0x28, 0x82, 0xf6,
+0x66, 0x00, 0x00, 0x40, 0xe8,
+0x40, 0x00, 0x01, 0x48, 0x35,
+0x6a, 0x00, 0x09, 0xc4, 0x00,
+0x5b, 0x40, 0x00, 0x83, 0x48,
+0x5c, 0x00, 0x21, 0x05, 0x58,
+0x88, 0x3c, 0x88, 0x84, 0x54,
+0x00, 0x00, 0x08, 0x80, 0x0a,
+0x51, 0x85, 0x20, 0x82, 0x22,
+0x98, 0x22, 0x89, 0xd0, 0x02,
+0x88, 0x4e, 0x86, 0x60, 0x00,
+0x04, 0x0e, 0x89, 0x50, 0x35,
+0x5b, 0x48, 0x3b, 0x01, 0xfe,
+0x25, 0x9a, 0x06, 0x80, 0x01,
+0xff, 0xfc, 0xab, 0xc0, 0x88,
+0x55, 0x01, 0x00, 0x86, 0x48,
+0x30, 0x1b, 0x8b, 0xc0, 0xcd,
+0x88, 0x38, 0x16, 0x80, 0x01,
+0xff, 0xfc, 0x0b, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0a,
+0x30, 0x1b, 0x8b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x83, 0x81,
+0x68, 0x00, 0x20, 0x00, 0x00,
+0x59, 0x0a, 0x40, 0x81, 0xa2,
+0xbc, 0x03, 0xb5, 0x50, 0x13,
+0xac, 0x01, 0x09, 0x50, 0x50,
+0x55, 0x02, 0x60, 0x81, 0xe2,
+0x00, 0x00, 0x08, 0x84, 0xa8,
+0x88, 0x82, 0x35, 0x18, 0x52,
+0x08, 0x4c, 0x89, 0xd8, 0x04,
+0x98, 0x22, 0x88, 0x60, 0x08,
+0x9d, 0x80, 0x38, 0x83, 0x0a,
+0x88, 0x6e, 0x46, 0x60, 0x00,
+0x04, 0x12, 0x88, 0x58, 0x09,
+0x88, 0x38, 0x83, 0x20, 0xe0,
+0xbc, 0x13, 0x85, 0xc0, 0xfe,
+0x19, 0x20, 0x19, 0x05, 0x12,
+0x40, 0x00, 0x01, 0x07, 0x58,
+0x66, 0x00, 0x41, 0x49, 0x68,
+0x5b, 0x40, 0x08, 0x84, 0x16,
+0x55, 0x00, 0x09, 0x07, 0x10,
+0x6a, 0x00, 0x09, 0xc4, 0x02,
+0x29, 0x88, 0x23, 0x20, 0x10,
+0xbc, 0x03, 0xb3, 0x81, 0xfc,
+0x36, 0x04, 0x13, 0x78, 0x41,
+0x52, 0xc8, 0x41, 0x83, 0x48,
+0x68, 0x00, 0x1f, 0xff, 0xcb,
+0xbc, 0x07, 0x83, 0x69, 0x04,
+0x30, 0x1e, 0x0b, 0xc0, 0xa5,
+0x6a, 0x00, 0x1f, 0xff, 0xc1,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x25,
+0x6a, 0x00, 0x20, 0x00, 0x01,
+0x5c, 0x80, 0x80, 0x81, 0x22,
+0x98, 0x34, 0x19, 0x50, 0x51,
+0x88, 0x16, 0x20, 0x00, 0x00,
+0x88, 0x6a, 0x38, 0x83, 0x08,
+0x66, 0x00, 0x00, 0x44, 0xc8,
+0x55, 0x00, 0x08, 0x58, 0x09,
+0x5c, 0x0f, 0xf9, 0x83, 0x08,
+0x25, 0x9c, 0x05, 0xb4, 0x82,
+0x3c, 0x09, 0x86, 0x80, 0x01,
+0xff, 0xfc, 0xb3, 0x01, 0xe0,
+0xbc, 0x0d, 0xd8, 0x84, 0x88,
+0x6a, 0x00, 0x1f, 0xff, 0xc0,
+0x40, 0x00, 0x03, 0xc0, 0x87,
+0x68, 0x00, 0x20, 0x00, 0x0b,
+0x30, 0x1e, 0x0b, 0xc0, 0x4d,
+0x40, 0x00, 0x00, 0x84, 0x88,
+0x6a, 0x00, 0x20, 0x00, 0x00,
+0x5c, 0x80, 0x80, 0x80, 0xa2,
+0x5d, 0x88, 0x21, 0x83, 0x00,
+0x59, 0x0d, 0x00, 0x86, 0x0b,
+0x95, 0x05, 0x08, 0x83, 0x4b,
+0x88, 0x3c, 0x88, 0x80, 0xe2,
+0xbf, 0x77, 0xa8, 0x80, 0x0a,
+0x88, 0x2b, 0x6b, 0xa1, 0x48,
+0xa8, 0x08, 0x00, 0x00, 0x00,
+0xab, 0xfd, 0x08, 0x80, 0xc9,
+0x5c, 0x09, 0xf8, 0x80, 0x4b,
+0x88, 0x17, 0x59, 0x02, 0x5b,
+0x88, 0x1d, 0x70, 0x00, 0x00,
+0x6e, 0x00, 0x01, 0x08, 0x2d,
+0x25, 0x9e, 0x8b, 0xc0, 0x60,
+0x6c, 0x68, 0x08, 0x10, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0xc0, 0x67,
+0x6c, 0x68, 0x08, 0x16, 0x03,
+0x6c, 0x00, 0x01, 0x34, 0x53,
+0x40, 0x00, 0x03, 0x80, 0x00,
+0x6e, 0x00, 0x01, 0x32, 0x2b,
+0x25, 0x9d, 0x8b, 0xc0, 0x50,
+0x6c, 0x68, 0x08, 0x12, 0x09,
+0x6c, 0x00, 0x01, 0x36, 0x49,
+0xbc, 0x07, 0x72, 0x59, 0xe8,
+0xbc, 0x05, 0x06, 0xc6, 0x80,
+0x81, 0x60, 0x96, 0xc0, 0x00,
+0x13, 0x64, 0x90, 0x00, 0x00,
+0x5c, 0x02, 0x29, 0x02, 0x13,
+0x68, 0x00, 0x00, 0x00, 0x75,
+0x6c, 0x68, 0x08, 0x06, 0x75,
+0x6c, 0x00, 0x02, 0xc6, 0x49,
+0x00, 0x00, 0x08, 0x81, 0x97,
+0x88, 0x00, 0xb4, 0x60, 0xb4,
+0x08, 0x13, 0x58, 0x80, 0x89,
+0x40, 0x00, 0x02, 0x80, 0x30,
+0x40, 0x00, 0x03, 0xa1, 0x60,
+};
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois.h
new file mode 100644
index 0000000000000000000000000000000000000000..72a1070409f05490746410df59dc4cff1ea7e0d2
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois.h
@@ -0,0 +1,560 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft>>
+//		Program Name	: Ois.h
+// 		Explanation		: LC898124 Global Declaration & ProtType Declaration
+//		Design			: Y.Yamada
+//		History			: First edition	
+//********************************************************************************
+#include "OisLc898124EP3.h"
+
+//****************************************************
+//	MODE SELECTORS (Compile Switches)
+//****************************************************
+#define		__OIS_UIOIS_GYRO_USE__
+//#define		UP_SIDE_GYRO
+
+//#define		__OIS_BIG_ENDIAN__
+
+//#define		EEPROM_FULL_ERASE		// E2Prom full erase
+
+#define	SELECT_MODEL		0	// --- select model ---//
+									// 0 : OnePlus 7
+
+#define	SELECT_VENDOR		0x81	// --- select vender ---//
+									// 0bit : SEMCO
+									// 7bit : OnePlus
+
+#define	MASTER_SLAVE		1	// --- select spi i/f mode ---//
+								// 0 : only master
+								// 1 : there are master&slave (for dual )
+
+#define	EP3_ES				2	// --- LC898124EP3 ES ---//
+								// 0 : none
+								// 1 : ES1
+								// 2 : ES2
+
+#if (SELECT_VENDOR == 0x01)					// SEMCO
+ #define	FW_VER				0x01		//ATMEL Version
+ #define	SUB_VER				0x02		//ATMEL SUB Version
+#else //(SELECT_VENDOR == 0x03)				// ALL
+ #define	FW_VER				0x00		//ATMEL Version for ALL
+ #define	SUB_VER				0x00		//ATMEL SUB Version
+#endif
+
+								
+//#define		ZERO_SERVO
+#define		ACCEL_SERVO
+#define		SEL_SHIFT_COR
+#define		LIN_CRSTLK
+
+#define		USE_FRA			// uncomment if use FRA function
+
+//****************************************************
+//	TYPE
+//****************************************************
+#define		INT8	int8_t//char
+#define		INT16	int16_t//short
+#define		INT32	int32_t//long
+#define		INT64	int64_t//long long
+#define		UINT8	uint8_t//unsigned char
+#define		UINT16	uint16_t//unsigned short
+#define		UINT32	uint32_t//unsigned long
+#define		UINT64	uint64_t//unsigned long long
+
+//****************************************************
+//	Defines
+//****************************************************
+/**************** Filter sampling **************/
+#define	FS_FREQ			18038.84615F	// 45[MHz]/4/624
+
+#define		SLT_OFFSET_HORIZONTAL_SO2821	(-2218L)
+#define		SLT_OFFSET_VERTICAL_SO2821		(2218L)
+
+// Command Status
+#define		EXE_END		0x00000002L		// Execute End (Adjust OK)
+#define		EXE_ERROR	0x00000003L		// Adjust NG : Execution Failure 
+#define		EXE_HXADJ	0x00000006L		// Adjust NG : X Hall NG (Gain or Offset)
+#define		EXE_HYADJ	0x0000000AL		// Adjust NG : Y Hall NG (Gain or Offset)
+#define		EXE_LXADJ	0x00000012L		// Adjust NG : X Loop NG (Gain)
+#define		EXE_LYADJ	0x00000022L		// Adjust NG : Y Loop NG (Gain)
+#define		EXE_GXADJ	0x00000042L		// Adjust NG : X Gyro NG (offset)
+#define		EXE_GYADJ	0x00000082L		// Adjust NG : Y Gyro NG (offset)
+
+#ifdef	SEL_SHIFT_COR
+#define		EXE_GZADJ	0x00400002L		// Adjust NG : Z Gyro NG (offset)
+#endif	//SEL_SHIFT_COR
+
+#define		EXE_HXMVER	0x06		// X Err
+#define		EXE_HYMVER	0x0A		// Y Err
+// Gyro Examination of Acceptance
+#define		EXE_GXABOVE	0x06		// X Above
+#define		EXE_GXBELOW	0x0A		// X Below
+#define		EXE_GYABOVE	0x12		// Y Above
+#define		EXE_GYBELOW	0x22		// Y Below
+
+// Common Define
+#define	SUCCESS			0x00		// Success
+#define	FAILURE			0x01		// Failure
+
+#ifndef ON
+ #define	ON				0x01		// ON
+ #define	OFF				0x00		// OFF
+#endif
+
+#define	X_DIR			0x00		// X Direction
+#define	Y_DIR			0x01		// Y Direction
+#define Z_DIR			0x02		// Z Direction
+
+// mode
+#define		GEA_MINMAX_MODE		0x00		// min, max mode
+#define		GEA_MEAN_MODE		0x01		// mean mode
+
+#define		BOTH_ON			0x00
+#define		XONLY_ON		0x01
+#define		YONLY_ON		0x02
+#define		BOTH_OFF		0x03
+
+#ifdef	SEL_SHIFT_COR
+//#define		ZEROG_MRGN_Z	(204 << 16)			// Zero G tolerance for Z
+//#define		ZEROG_MRGN_XY	(204 << 16)			// Zero G tolerance for XY
+//#define		ACCL_SENS		2048
+#define		ZEROG_MRGN_Z	(409 << 16)			// Zero G tolerance for Z
+#define		ZEROG_MRGN_XY	(409 << 16)			// Zero G tolerance for XY
+#define		ACCL_SENS		4096
+#define		ACCL_SENS_M		-4096
+#endif	//SEL_SHIFT_COR
+
+#define CHECK_SUM_NUM	109		// 0x6D
+
+//****************************************************
+//	Command
+//****************************************************
+#define		OIS_POS_FLG			0x00000100			// OIS position by AF measurement
+
+//==============================================================================
+// Calibration Data Memory Map
+//==============================================================================
+// Calibration Status
+#define	CALIBRATION_STATUS		(  0 )
+// Hall amplitude Calibration X
+#define	HALL_MAX_BEFORE_X		(  1 )
+#define	HALL_MIN_BEFORE_X		(  2 )
+#define	HALL_MAX_AFTER_X		(  3 )
+#define	HALL_MIN_AFTER_X		(  4 )
+// Hall amplitude Calibration Y
+#define	HALL_MAX_BEFORE_Y		(  5 )
+#define	HALL_MIN_BEFORE_Y		(  6 )
+#define	HALL_MAX_AFTER_Y		(  7 )
+#define	HALL_MIN_AFTER_Y		(  8 )
+// Hall Bias/Offset
+#define	HALL_BIAS_DAC_X			(  9 )
+#define	HALL_OFFSET_DAC_X		( 10 )
+#define	HALL_BIAS_DAC_Y			( 11 )
+#define	HALL_OFFSET_DAC_Y		( 12 )
+// Loop Gain Calibration X
+#define	LOOP_GAIN_X				( 13 )
+// Loop Gain Calibration Y
+#define	LOOP_GAIN_Y				( 14 )
+// Lens Center Calibration
+#define	MECHA_CENTER_X			( 15 )
+#define	MECHA_CENTER_Y			( 16 )
+// Optical Center Calibration
+#define	OPT_CENTER_X			( 17 )
+#define	OPT_CENTER_Y			( 18 )
+// Gyro Offset Calibration
+#define	GYRO_OFFSET_X			( 19 )
+#define	GYRO_OFFSET_Y			( 20 )
+// Gyro Gain Calibration
+#define	GYRO_GAIN_X				( 21 )
+#define	GYRO_GAIN_Y				( 22 )
+// AF calibration
+#define	OIS_POS_BY_AF_X1		( 23 )
+#define	OIS_POS_BY_AF_X2		( 24 )
+#define	OIS_POS_BY_AF_X3		( 25 )
+#define	OIS_POS_BY_AF_X4		( 26 )
+#define	OIS_POS_BY_AF_X5		( 27 )
+#define	OIS_POS_BY_AF_X6		( 28 )
+#define	OIS_POS_BY_AF_X7		( 29 )
+#define	OIS_POS_BY_AF_X8		( 30 )
+#define	OIS_POS_BY_AF_X9		( 31 )
+// Gyro mixing correction
+#define MIXING_HX45X			( 32 )
+#define MIXING_HX45Y			( 33 )
+#define MIXING_HY45Y			( 34 )
+#define MIXING_HY45X			( 35 )
+#define MIXING_HXSX				( 36 )
+#define MIXING_HYSX				( 36 )
+// Gyro angle correction
+#define MIXING_GX45X			( 37 )
+#define MIXING_GX45Y			( 38 )
+#define MIXING_GY45Y			( 39 )
+#define MIXING_GY45X			( 40 )
+// Liniearity correction
+#define LN_POS1					( 41 )
+#define LN_POS2					( 42 )
+#define LN_POS3					( 43 )
+#define LN_POS4					( 44 )
+#define LN_POS5					( 45 )
+#define LN_POS6					( 46 )
+#define LN_POS7					( 47 )
+#define LN_STEP					( 48 )
+// Factory Gyro Gain Calibration
+#define	GYRO_FCTRY_OFST_X		( 49 )
+#define	GYRO_FCTRY_OFST_Y		( 50 )
+// Gyro Offset Calibration
+#define	GYRO_OFFSET_Z			( 51 )
+// Accl offset
+//#define	ACCL_OFFSET_X			( 52 )
+//#define	ACCL_OFFSET_Y			( 53 )
+#define	DEFAULT_GAIN_X			( 52 )
+#define	DEFAULT_GAIN_Y			( 53 )
+#define	ACCL_OFFSET_Z			( 54 )
+#define	OIS_POS_BY_AF_Y1		( 55 )
+#define	OIS_POS_BY_AF_Y2		( 56 )
+#define	OIS_POS_BY_AF_Y3		( 57 )
+#define	OIS_POS_BY_AF_Y4		( 58 )
+#define	OIS_POS_BY_AF_Y5		( 59 )
+#define	OIS_POS_BY_AF_Y6		( 60 )
+#define	OIS_POS_BY_AF_Y7		( 61 )
+#define	OIS_POS_BY_AF_Y8		( 62 )
+#define	OIS_POS_BY_AF_Y9		( 63 )
+
+
+//****************************************************
+//	Generic memory 
+//****************************************************
+#ifdef __OIS_BIG_ENDIAN__
+// Big endian
+// Word Data Union
+union	WRDVAL{
+	INT16	SsWrdVal ;
+	UINT16	UsWrdVal ;
+	UINT8	UcWrkVal[ 2 ] ;
+	signed char		ScWrkVal[ 2 ] ;
+	struct {
+		UINT8	UcHigVal ;
+		UINT8	UcLowVal ;
+	} StWrdVal ;
+} ;
+
+
+union	DWDVAL {
+	UINT32	UlDwdVal ;
+	UINT16	UsDwdVal[ 2 ] ;
+	struct {
+		UINT16	UsHigVal ;
+		UINT16	UsLowVal ;
+	} StDwdVal ;
+	struct {
+		UINT8	UcRamVa3 ;
+		UINT8	UcRamVa2 ;
+		UINT8	UcRamVa1 ;
+		UINT8	UcRamVa0 ;
+	} StCdwVal ;
+} ;
+
+union	ULLNVAL {
+	UINT64	UllnValue ;
+	UINT32	UlnValue[ 2 ] ;
+	struct {
+		UINT32	UlHigVal ;
+		UINT32	UlLowVal ;
+	} StUllnVal ;
+} ;
+
+
+// Float Data Union
+union	FLTVAL {
+	float			SfFltVal ;
+	UINT32	UlLngVal ;
+	UINT16	UsDwdVal[ 2 ] ;
+	struct {
+		UINT16	UsHigVal ;
+		UINT16	UsLowVal ;
+	} StFltVal ;
+} ;
+
+#else	// BIG_ENDDIAN
+// Little endian
+// Word Data Union
+union	WRDVAL{
+	INT16	SsWrdVal ;
+	UINT16	UsWrdVal ;
+	UINT8	UcWrkVal[ 2 ] ;
+	signed char		ScWrkVal[ 2 ] ;
+	struct {
+		UINT8	UcLowVal ;
+		UINT8	UcHigVal ;
+	} StWrdVal ;
+} ;
+
+union	DWDVAL {
+	UINT32	UlDwdVal ;
+	UINT16	UsDwdVal[ 2 ] ;
+	struct {
+		UINT16	UsLowVal ;
+		UINT16	UsHigVal ;
+	} StDwdVal ;
+	struct {
+		UINT8	UcRamVa0 ;
+		UINT8	UcRamVa1 ;
+		UINT8	UcRamVa2 ;
+		UINT8	UcRamVa3 ;
+	} StCdwVal ;
+} ;
+
+union	ULLNVAL {
+	UINT64	UllnValue ;
+	UINT32	UlnValue[ 2 ] ;
+	struct {
+		UINT32	UlLowVal ;
+		UINT32	UlHigVal ;
+	} StUllnVal ;
+} ;
+
+// Float Data Union
+union	FLTVAL {
+	float			SfFltVal ;
+	UINT32	UlLngVal ;
+	UINT16	UsDwdVal[ 2 ] ;
+	struct {
+		UINT16	UsLowVal ;
+		UINT16	UsHigVal ;
+	} StFltVal ;
+} ;
+#endif	// __OIS_BIG_ENDIAN__
+
+typedef union WRDVAL	UnWrdVal ;
+typedef union DWDVAL	UnDwdVal;
+typedef union ULLNVAL	UnllnVal;
+typedef union FLTVAL	UnFltVal ;
+
+
+typedef struct STMESRAM {
+	INT32	SlMeasureMaxValue ;
+	INT32	SlMeasureMinValue ;
+	INT32	SlMeasureAmpValue ;
+	INT32	SlMeasureAveValue ;
+} stMesRam ;									// Struct Measure Ram
+
+typedef struct {
+	UINT8	DrvDir;
+	UINT16	Rrmd1ToMacro;
+	UINT16	Rrmd1ToInfini;
+	UINT16	Freq;
+} AF_PARA;
+
+typedef struct {
+	UINT32 BiasInit;
+	UINT32 OffsetInit;
+	UINT32 OffsetMargin;
+	UINT32 TargetRange;
+	UINT32 TargetMax;
+	UINT32 TargetMin;
+	UINT32 SinNum;
+	UINT32 SinFreq;
+	UINT32 SinGain;
+	UINT32 DecrementStep;
+	UINT32 ActMaxDrive_X;
+	UINT32 ActMaxDrive_Y;
+	UINT32 ActMinDrive_X;
+	UINT32 ActMinDrive_Y;
+	UINT16 MagneticOffset_X;
+	UINT16 MagneticOffset_Y;
+	UINT16 HallMax_X;
+	UINT16 HallMax_Y;
+	UINT16 HallMin_X;
+	UINT16 HallMin_Y;
+} ADJ_HALL;
+
+typedef struct {
+	UINT32 Hxgain;
+	UINT32 Hygain;
+	UINT32 NoiseNum;
+	UINT32 NoiseFreq;
+	UINT32 NoiseGain;
+	UINT32 Gap;
+	UINT32 XJudgeHigh;
+	UINT32 XJudgeLow;
+	UINT32 YJudgeHigh;
+	UINT32 YJudgeLow;
+} ADJ_LOPGAN;
+	
+typedef struct {
+	UINT8 Vendor;
+	UINT8 User;
+	UINT8 Model;
+	UINT8 Version;
+	UINT8 SpiMode;
+	UINT8 Reserve1;
+	UINT8 ActType;
+	UINT8 GyroType;
+} DSPVER;
+
+typedef struct {
+	UINT16	Cmd ;
+	UINT8	FWType ;
+	const UINT8* DataPM;
+	UINT32 LengthPM;
+	UINT32 Parity;
+	const UINT8* DataDM;
+	UINT32 LengthDMA;
+	UINT32 LengthDMB;
+}DOWNLOAD_TBL ;
+
+//****************************************************
+//	Structure of calibration data for GUI
+//****************************************************
+typedef struct STADJPAR {
+	struct {
+		UINT32	UlAdjPhs ;				// Hall Adjust Phase
+
+		UINT16	UsHlxCna ;				// Hall Center Value after Hall Adjust
+		UINT16	UsHlxMax ;				// Hall Max Value
+		UINT16	UsHlxMxa ;				// Hall Max Value after Hall Adjust
+		UINT16	UsHlxMin ;				// Hall Min Value
+		UINT16	UsHlxMna ;				// Hall Min Value after Hall Adjust
+		UINT16	UsHlxGan ;				// Hall Gain Value
+		UINT16	UsHlxOff ;				// Hall Offset Value
+		UINT16	UsAdxOff ;				// Hall A/D Offset Value
+		UINT16	UsHlxCen ;				// Hall Center Value
+
+		UINT16	UsHlyCna ;				// Hall Center Value after Hall Adjust
+		UINT16	UsHlyMax ;				// Hall Max Value
+		UINT16	UsHlyMxa ;				// Hall Max Value after Hall Adjust
+		UINT16	UsHlyMin ;				// Hall Min Value
+		UINT16	UsHlyMna ;				// Hall Min Value after Hall Adjust
+		UINT16	UsHlyGan ;				// Hall Gain Value
+		UINT16	UsHlyOff ;				// Hall Offset Value
+		UINT16	UsAdyOff ;				// Hall A/D Offset Value
+		UINT16	UsHlyCen ;				// Hall Center Value
+	} StHalAdj ;
+
+	struct {
+		UINT32	UlLxgVal ;				// Loop Gain X
+		UINT32	UlLygVal ;				// Loop Gain Y
+	} StLopGan ;
+
+	struct {
+		UINT16	UsGxoVal ;				// Gyro A/D Offset X
+		UINT16	UsGyoVal ;				// Gyro A/D Offset Y
+		UINT16	UsGxoSts ;				// Gyro Offset X Status
+		UINT16	UsGyoSts ;				// Gyro Offset Y Status
+	} StGvcOff ;
+	
+	UINT8		UcOscVal ;				// OSC value
+
+} stAdjPar ;
+
+#ifdef	ZERO_SERVO
+typedef struct STZEROSERVO {
+	INT32				SlOffset ;					// 
+	INT32				SlG45m ;					// 
+	INT32				SlG45s ;					// 
+	INT32				SlGcora ;					// 
+	INT32				SlGaina ;					// 
+	INT32				SlShift ;					// 
+} stZeroServo ;
+#endif	//ZERO_SERVO
+
+#ifdef	SEL_SHIFT_COR
+typedef struct STPOSOFF {
+	struct {
+		INT32	Pos[6][3];
+	} StPos;
+	UINT32		UlAclOfSt ;				//!< accel offset status
+
+} stPosOff ;
+
+typedef struct STACLVAL {
+	struct {
+		INT32	SlOffsetX ;
+		INT32	SlOffsetY ;
+		INT32	SlOffsetZ ;
+	} StAccel ;
+
+	INT32	SlInvMatrix[9] ;
+
+} stAclVal ;
+#endif	//SEL_SHIFT_COR
+
+struct tagMlMixingValue
+{
+	double	radianX;
+	double	radianY;
+
+	double	hx45x;
+	double	hy45x;
+	double	hy45y;
+	double	hx45y;
+
+	UINT8	hxsx;
+	UINT8	hysx;
+
+	INT32	hx45xL;		//! for Fixed point
+	INT32	hy45xL;		//! for Fixed point
+	INT32	hy45yL;		//! for Fixed point
+	INT32	hx45yL;		//! for Fixed point
+
+	double XonXmove[7];
+	double YonXmove[7];
+	double XonYmove[7];
+	double YonYmove[7];
+};
+typedef	struct tagMlMixingValue		mlMixingValue;
+
+struct tagMlLinearityValue
+{
+	INT32	measurecount;	//! input parameter
+	UINT32	*dacX;			//! input parameter
+	UINT32	*dacY;			//! input parameter
+
+	double	*positionX;
+	double	*positionY;
+	UINT16	*thresholdX;
+	UINT16	*thresholdY;
+
+	UINT32	*coefAXL;		//! for Fixed point
+	UINT32	*coefBXL;		//! for Fixed point
+	UINT32	*coefAYL;		//! for Fixed point
+	UINT32	*coefBYL;		//! for Fixed point
+};
+typedef	struct tagMlLinearityValue		mlLinearityValue;
+
+struct ACT_MOV_t {
+	int	startcode ;
+	int	endcode ;
+	int	step ;
+} ;
+
+typedef struct ACT_MOV_t	Act_Mov_t ;
+
+
+
+//	for SetSinWavePara
+#define		SINEWAVE		0
+#define		XHALWAVE		1
+#define		YHALWAVE		2
+#define		ZHALWAVE		3
+#define		XACTTEST		10
+#define		YACTTEST		11
+#define		CIRCWAVE		255
+
+
+//****************************************************
+//	Debug
+//****************************************************
+#ifdef DEBUG
+#include <AT91SAM7S.h>
+#include <us.h>
+ #define TRACE_INIT(x)			dbgu_init(x)
+ #define TRACE(fmt, ...)		dbgu_printf(fmt, ## __VA_ARGS__)
+ #define TRACE_DUMP(x,y)		dbg_Dump(x,y)
+ #define TRACE_USB(fmt, ...)	dbg_UsbData(fmt, ## __VA_ARGS__)
+#else
+ #define TRACE_INIT(x)
+ #define TRACE(...)
+ #define TRACE_DUMP(x,y)
+ #define TRACE_USB(...)	
+#endif
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisAPI.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisAPI.h
new file mode 100644
index 0000000000000000000000000000000000000000..522a44caa635f9b6b35d1c4772bd3779e7ae6966
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisAPI.h
@@ -0,0 +1,95 @@
+//********************************************************************************
+//		<< LC898124EP3 Evaluation Soft>>
+//		Program Name	: OisAPI
+// 		Explanation		: API List for customers
+//		History			: First edition						2016.03.15 K.abe
+//********************************************************************************
+//****************************************************
+//	API FUNCTION LIST	
+//****************************************************
+/* Program Download & Start */
+extern void RemapMain( void );							// make download code start. 
+extern unsigned char SelectDownload( UINT8 GyroSelect, UINT8 ActSelect, UINT8 MasterSlave );	// download
+
+/* Code information check such as version */
+extern UINT8 GetInfomationAfterDownload( DSPVER* Info );	// get code information after download.
+
+/* Power off for SPI interface */
+extern void PreparationForPowerOff( void );				// SPI interface stop before power off
+
+/* E2Prom Access */
+extern UINT8 E2PromVerification( void );				// E2Prom verification for user area by using check sum. O:SUCCESS, 1:FAUILRE
+extern UINT8 E2PromVerificationONSEMI( void );			// E2Prom verification for ONSEMI area by using check sum. O:SUCCESS, 1:FAUILRE
+extern void BurstReadE2Prom( UINT8 address, UINT8 * val, UINT8 cnt );	// E2Prom reading continuously for every area.
+extern void ReadE2Prom( unsigned char address, unsigned char * val );	// Read data from E2Prom
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern UINT8 WriteE2Prom( UINT8 address, UINT8 data );	// E2Prom writing for user area 1byte.
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+/* Gyro Offset Adjustment */
+extern void GyroOffsetMeasureStart( void );				// start the gyro offset adjustment
+extern UINT8 GetGyroOffset( UINT16* GyroOffsetX, UINT16* GyroOffsetY, INT16 GYROF_UPPER, INT16 GYROF_LOWER   );	// get the gyro offset values.
+extern void	SetGyroOffset( UINT16 GyroOffsetX, UINT16 GyroOffsetY, UINT16 GyroOffsetZ );	// set the gyro offset data. before do this before Remapmain.
+
+/* Angle correction for 45deg*/
+extern UINT8 SetAngleCorrection( float DegreeGap, UINT8 SelectAct, unsigned char Arrangement );
+
+extern void	SetGyroAccelCoef( UINT8 );
+
+/* AF position Control [mandatory] */
+extern void		SetTregAf( UINT16 UsTregAf );			// Bi-direction :  Min:000h Max:7FFh (11bit) 
+
+/* Status Read and OIS enable [mandatory] */
+extern	UINT8	RdStatus( UINT8 UcStBitChk );			// Status Read whether initialization finish or not.
+extern	void	OisEna( void );							// OIS Enable Function
+
+/* Others [option] */
+extern	UINT8	RtnCen( UINT8	UcCmdPar ) ;			// Return to Center Function. Hall servo on/off
+extern	UINT8	ZscCnt( UINT8 ) ;						// Zero servo control 
+extern	UINT8	AfStbyRls( void );						// Af Standby release Command Function
+extern	void	SetPanTiltMode( UINT8 UcPnTmod );		// default ON.
+extern  void	SetSinWavePara( UINT8 , UINT8 ) ;		// Circle movement 
+
+extern	UINT8	RunHea( void ) ;						// Hall Examination of Acceptance
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern	UINT8	RunGea( void ) ;						// Gyro Examination of Acceptance
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+extern void GyroOffsetMeasureStartZ( void );			// start the gyro Z offset adjustment
+extern UINT32	TneZeroServo( UINT8 , float );			/* zero servo adjustment command */
+extern UINT8	ZeroServoLmt( UINT8 UCMODE );
+extern UINT32	TneAvc( UINT8 ucposture );				// Accel offset adjustment
+
+/* Accl Offset Adjustment */
+extern void	SetAcclOffset( UINT16  AcclOffsetX, UINT16  AcclOffsetY, UINT16  AcclOffsetZ );	// set the accl offset data. before do this before Remapmain.
+extern void	GetAcclOffset( UINT16* AcclOffsetX, UINT16* AcclOffsetY, UINT16* AcclOffsetZ );	// get the accl offset values.
+
+extern void	LinearityCalculation( void );				// Linearity correction
+extern void	CrosstalkCalculation( void );				// Crosstalk correction
+extern void	SetOpticalOffset( void );					// optical offset
+
+
+//****************************************************
+//	API FUNCTION LIST	for module maker
+//****************************************************
+/* Calibration Main [mandatory] */
+extern	UINT32	TneRun( void );							// calibration for bi-direction AF
+
+/* E2Prom Access */
+extern UINT8	WrHallCalData( void );					// upload the calibration data except gyro gain to eeprom
+extern UINT8	WrOptOffsetData( void );				// upload the opt offset data
+extern UINT8	WrGyroGainData( void );					// upload the gyro gain to eeprom
+extern UINT8	WrAfParameter( UINT8 );					// upload af parameter to eeprom
+extern UINT8	WrZeroServoData( void );				// upload the servo servo parameter to eepom
+
+//extern UINT8	WrLinCrsData( UINT8 writemode );		// upload linearity & cross talk parameter to eeprom
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+extern UINT8	WrHallLnData(  UINT8 UcMode, mlLinearityValue *linval );	// upload linearity position to eeprom
+extern UINT8	WrMixCalData(  UINT8 UcMode, mlMixingValue *mixval );		// upload cross talk to eeprom
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+/* NOTEST */
+//extern UINT8 	NotestMain( void );						// for NOTEST (E2prom erase & data set)
+//extern	void	TimPro( void );							// for NOTEST (OSC measurement function for 1msec interruption)
+
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisCmd.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisCmd.c
new file mode 100644
index 0000000000000000000000000000000000000000..2168537c1fa6608798afc318a84614165c2b848f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisCmd.c
@@ -0,0 +1,2800 @@
+//********************************************************************************
+//		<< LC898124 Evaluation Soft >>
+//	    Program Name	: OisCmd.c
+//		Design			: Y.Shigoeka
+//		History			: First edition						
+//********************************************************************************
+//**************************
+//	Include Header File		
+//**************************
+#include	<stdlib.h>	/* use for abs() */
+#include	<math.h>	/* use for sqrt() */
+
+#include	"Ois.h"
+#include	"OisAPI.h"
+#include	"OisLc898124EP3.h"
+#include 	"Ois_BOSCH.h"
+
+
+//****************************************************
+//	MODE SELECTORS (Compile Switches)
+//****************************************************
+//#define		NEUTRAL_CENTER			// Upper Position Current 0mA Measurement
+//#define		NEUTRAL_CENTER_FINE		// Optimize natural center current
+
+#define		HALL_ADJ_SERVO_ON		// 
+
+#define	HALLADJ_FULLCURRENT
+
+#define	TNE_PTP_NO_SIN
+
+//****************************************************
+//	LC898124 calibration parameters 
+//****************************************************
+ #if ((SELECT_VENDOR&0x01) == 0x01)				// SEMCO
+	#include 	"LC898124EP3_Calibration_SO2820.h"
+	#include 	"LC898124EP3_Calibration_SO3600.h"
+ #endif
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */ 
+extern	void RamWrite32A(int addr, int data);
+extern 	void RamRead32A( unsigned short addr, void * data );
+extern void	WitTim( unsigned short	UsWitTim );
+extern void		ClearLaser( void ) ;
+extern short	GetLaser( void ) ;
+extern void	OisDis( void );
+
+extern void RamRead_260( unsigned char Addr, unsigned char *pData);
+extern void RamWrite_260( unsigned char Addr, unsigned char Data);
+
+//****************************************************
+//	extern  Function LIST
+//****************************************************
+extern void	MesFil( UINT8 ) ;									// Measure Filter Setting
+extern void	MeasureStart( INT32 , UINT32 , UINT32 ) ;				// Measure Start Function
+extern void	MeasureWait( void ) ;								// Measure Wait
+extern void	SetTransDataAdr( UINT16 UsLowAddress , UINT32 UlLowAdrBeforeTrans );
+
+extern void	SetSinWavGenInt( void );
+
+extern	stAdjPar	StAdjPar ;				// Execute Command Parameter
+extern	UINT16		UsGzoVal ;				// Gyro A/D Offset X
+
+#ifdef	SEL_SHIFT_COR
+extern	stPosOff	StPosOff ;				//!< Execute Command Parameter
+extern	stAclVal	StAclVal ;				//!< Execute Command Parameter
+#endif	//SEL_SHIFT_COR
+
+extern void DMIOWrite32( UINT32 IOadrs, UINT32 IOdata );
+
+#ifdef	ZERO_SERVO
+
+extern	stZeroServo		StZeroServoX;
+extern	stZeroServo		StZeroServoY;
+extern	stZeroServo		StZeroServoZ;
+
+INT32					GYROZ_OFFSET;
+
+typedef struct STZEROSERVOMES{
+	INT32				SlHallP ;					// 
+	INT32				SlAcclP ;					// 
+} stZeroServoMes ;
+
+stZeroServoMes			StZeroServoMesX;
+stZeroServoMes			StZeroServoMesY;
+
+INT32					UlPostureSt;
+
+#endif	//ZERO_SERVO
+
+//****************************************************
+//	Local Function LIST
+//****************************************************
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+UINT32	TnePtp ( UINT8	UcDirSel, UINT8	UcBfrAft, ADJ_HALL* p );
+UINT32	TneCen( UINT8 UcTneAxs, ADJ_HALL* ptr  );
+void	TneOff( UnDwdVal, UINT8 ) ;							// Hall Offset Tuning
+void	TneBia( UnDwdVal, UINT8, UINT16 ) ;							// Hall Bias Tuning
+UINT32	LopGan( UINT8 UcDirSel, ADJ_LOPGAN* ptr );
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+void	TneHvc( void );
+UINT32	TneGvc( void );
+void	TneFin( ADJ_LOPGAN* ptr );
+
+//****************************************************
+//	Parameter LIST
+//****************************************************
+//#define 	HALL_ADJ		0
+//#define 	LOOPGAIN		1
+#define 	THROUGH			2
+#define 	NOISE			3
+#define		OSCCHK			4
+// Measure Mode
+
+#define		PTP_BEFORE		0
+#define		PTP_AFTER		1
+
+#define 	TNE 			80								// Waiting Time For Movement
+#define 	OFFSET_DIV		2								// Divide Difference For Offset Step
+#define 	TIME_OUT		20								// Time Out Count
+
+#define		BIAS_HLMT		(0xBF000000 )
+#define		BIAS_LLMT		(0x20000000 )
+
+//#ifdef	ZERO_SERVO
+/************** posture check ************/
+#define		SENSITIVITY		4096						// LSB/g
+#define		PSENS_MARG		(SENSITIVITY / 4)			// 1/4g
+#define		POSTURETH_P		(SENSITIVITY - PSENS_MARG)	// LSB/g
+#define		POSTURETH_M		(-POSTURETH_P)				// LSB/g
+/************** posture check ************/
+//#endif	//ZERO_SERVO
+
+//****************************************************
+//	LOCAL RAM LIST
+//****************************************************
+INT16		SsNvcX = 1 ;									// NVC move direction X
+INT16		SsNvcY = 1 ;									// NVC move direction Y
+
+UINT8	BeforeControl;
+
+Act_Mov_t	StActMov = {
+	0x19998000,
+	0xE6668000,
+	0xFCCD0000
+} ;
+
+//UINT32	UlHall_ActMov[ 16 ] ;
+
+//********************************************************************************
+// Function Name 	: DacControl
+// Retun Value		: Firmware version
+// Argment Value	: NON
+// Explanation		: Dac Control Function
+// History			: First edition 						
+//********************************************************************************
+void	DacControl( UINT32 UiChannel, UINT32 PuiData )
+{
+	DMIOWrite32( ADDA_DASEL, UiChannel );	
+	DMIOWrite32( ADDA_DAO, PuiData );	
+}
+
+#ifndef __OIS_UIOIS_GYRO_USE__
+//********************************************************************************
+// Function Name 	: GetGyroOffset
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: start the gyro offset adjustment and get result
+// History			: First edition 						
+//********************************************************************************
+#define 	GYROF_NUM		2048			// 2048times
+#define 	GYROF_UPPER		0x06D6			// 
+#define 	GYROF_LOWER		0xF92A			// 
+UINT32	TneGvc( void )
+{
+	UINT32	UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	
+	
+	//•½‹Ï’l‘ª’è
+	
+	MesFil( THROUGH ) ;					// Set Measure Filter
+
+	SlMeasureParameterNum	=	GYROF_NUM ;					// Measurement times
+	SlMeasureParameterA		=	GYRO_RAM_GX_ADIDAT ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	GYRO_RAM_GY_ADIDAT ;		// Set Measure RAM Address
+	
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+	
+	MeasureWait() ;					// Wait complete of measurement
+	
+TRACE("Read Adr = %04x, %04xh \n",StMeasFunc_MFA_LLiIntegral1 + 4 , StMeasFunc_MFA_LLiIntegral1) ;
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+TRACE("GX_OFT = %08x, %08xh \n",(unsigned int)StMeasValueA.StUllnVal.UlHigVal,(unsigned int)StMeasValueA.StUllnVal.UlLowVal) ;
+TRACE("GY_OFT = %08x, %08xh \n",(unsigned int)StMeasValueB.StUllnVal.UlHigVal,(unsigned int)StMeasValueB.StUllnVal.UlLowVal) ;
+	SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+	SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+TRACE("GX_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+TRACE("GY_AVEOFT = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+	
+	SlMeasureAveValueA = ( SlMeasureAveValueA >> 16 ) & 0x0000FFFF ;
+	SlMeasureAveValueB = ( SlMeasureAveValueB >> 16 ) & 0x0000FFFF ;
+	// EP1‚Å‚Í”½“]�ˆ—�‚µ‚È‚¢�B
+//	SlMeasureAveValueA = 0x00010000 - SlMeasureAveValueA ;
+//	SlMeasureAveValueB = 0x00010000 - SlMeasureAveValueB ;
+	
+	UlRsltSts = EXE_END ;
+	StAdjPar.StGvcOff.UsGxoVal = ( UINT16 )( SlMeasureAveValueA & 0x0000FFFF );		//Measure Result Store
+	if(( (INT16)StAdjPar.StGvcOff.UsGxoVal > (INT16)GYROF_UPPER ) || ( (INT16)StAdjPar.StGvcOff.UsGxoVal < (INT16)GYROF_LOWER )){
+		UlRsltSts |= EXE_GXADJ ;
+	}
+	RamWrite32A( GYRO_RAM_GXOFFZ , (( SlMeasureAveValueA << 16 ) & 0xFFFF0000 ) ) ;		// X axis Gyro offset
+	
+	StAdjPar.StGvcOff.UsGyoVal = ( UINT16 )( SlMeasureAveValueB & 0x0000FFFF );		//Measure Result Store
+	if(( (INT16)StAdjPar.StGvcOff.UsGyoVal > (INT16)GYROF_UPPER ) || ( (INT16)StAdjPar.StGvcOff.UsGyoVal < (INT16)GYROF_LOWER )){
+		UlRsltSts |= EXE_GYADJ ;
+	}
+	RamWrite32A( GYRO_RAM_GYOFFZ , (( SlMeasureAveValueB << 16 ) & 0xFFFF0000 ) ) ;		// Y axis Gyro offset
+	
+TRACE("GX_AVEOFT_RV = %08xh \n",(unsigned int)SlMeasureAveValueA) ;
+TRACE("GY_AVEOFT_RV = %08xh \n",(unsigned int)SlMeasureAveValueB) ;
+	
+	RamWrite32A( GYRO_RAM_GYROX_OFFSET , 0x00000000 ) ;			// X axis Drift Gyro offset
+	RamWrite32A( GYRO_RAM_GYROY_OFFSET , 0x00000000 ) ;			// Y axis Drift Gyro offset
+	RamWrite32A( GyroFilterDelayX_GXH1Z2 , 0x00000000 ) ;		// X axis H1Z2 Clear
+	RamWrite32A( GyroFilterDelayY_GYH1Z2 , 0x00000000 ) ;		// Y axis H1Z2 Clear
+	
+	return( UlRsltSts );
+	
+		
+}
+#endif
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: HallAdj
+// Retun Value		: Hall Tuning SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Hall System Auto Adjustment Function
+// History			: First edition 						
+//********************************************************************************
+UINT32 HallAdj( ADJ_HALL* Ptr, ADJ_LOPGAN *LopgainPtr )
+{
+	UINT32	UlHlxSts, UlHlySts, UlReadVal;
+	
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( TNE ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+	RamWrite32A( HALL_RAM_HXOFF,  0x00000000 ) ;		// X Offset Clr
+	RamWrite32A( HALL_RAM_HYOFF,  0x00000000 ) ;		// Y Offset Clr
+	RamWrite32A( HallFilterCoeffX_hxgain0 , LopgainPtr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , LopgainPtr->Hygain ) ;
+#endif
+	DacControl( HLXBO , Ptr->BiasInit ) ;
+	RamWrite32A( StCaliData_UiHallBias_X , Ptr->BiasInit ) ;
+	DacControl( HLYBO , Ptr->BiasInit ) ;
+	RamWrite32A( StCaliData_UiHallBias_Y , Ptr->BiasInit ) ;
+	DacControl( HLXO, Ptr->OffsetInit ) ;
+	RamWrite32A( StCaliData_UiHallOffset_X , Ptr->OffsetInit ) ;
+	DacControl( HLYO, Ptr->OffsetInit ) ;
+	RamWrite32A( StCaliData_UiHallOffset_Y , Ptr->OffsetInit ) ;
+	
+	BeforeControl=1;
+	UlHlySts = TneCen( Y_DIR, Ptr ) ;
+	RamWrite32A( HALL_RAM_HYOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyCen << 16 ) & 0xFFFF0000 ) ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+	RtnCen( YONLY_ON ) ;		// Y ON / X OFF
+#endif
+	WitTim( TNE ) ;
+	BeforeControl=1;
+	UlHlxSts = TneCen( X_DIR, Ptr ) ;
+
+	if( (UlHlxSts != EXE_HXADJ) && (UlHlySts != EXE_HYADJ) ){
+		RamWrite32A( HALL_RAM_HXOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlxCen << 16 ) & 0xFFFF0000 ) ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+		RtnCen( XONLY_ON ) ;		// Y OFF / X ON
+#endif
+		WitTim( TNE ) ;
+
+		UlHlySts = TneCen( Y_DIR, Ptr ) ;
+		RamWrite32A( HALL_RAM_HYOFF, ( ( ( UINT32 )StAdjPar.StHalAdj.UsHlyCna << 16 ) & 0xFFFF0000 ) ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+		RtnCen( YONLY_ON ) ;		// Y ON / X OFF
+#endif
+		WitTim( TNE ) ;
+		UlHlxSts = TneCen( X_DIR, Ptr ) ;
+#ifdef	HALL_ADJ_SERVO_ON
+		RtnCen( BOTH_OFF ) ;		// Both OFF
+#endif
+		WitTim( TNE ) ;
+	}	
+	
+	RamRead32A( StCaliData_UiHallOffset_X , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlxOff = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallBias_X , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlxGan = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallOffset_Y , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlyOff = (UINT16)( UlReadVal >> 16 ) ;
+		
+	RamRead32A( StCaliData_UiHallBias_Y , &UlReadVal ) ;
+	StAdjPar.StHalAdj.UsHlyGan = (UINT16)( UlReadVal >> 16 ) ;
+		
+#ifdef	HALL_ADJ_SERVO_ON
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( TNE ) ;
+#endif	
+	return ( UlHlySts | UlHlxSts );
+}
+
+
+//********************************************************************************
+// Function Name 	: TneRun
+// Retun Value		: Hall Tuning SUCCESS or FAILURE
+// Argment Value	: NON
+// Explanation		: Hall System Auto Adjustment Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	TneRun( void )
+{
+	UINT32	UlFinSts, UlReadVal;
+	ADJ_HALL* HallPtr;
+	ADJ_LOPGAN* LopgainPtr;
+	DSPVER Info;
+
+	// Check the status
+	RamWrite32A( CMD_IO_ADR_ACCESS , ROMINFO );
+	RamRead32A( CMD_IO_DAT_ACCESS, &UlReadVal );
+	if( UlReadVal != 0x01)	return( EXE_ERROR );
+
+	// Select parameter
+	if( GetInfomationAfterDownload( &Info ) != 0) return( EXE_ERROR );
+
+	else if( Info.ActType == ACT_SO2820 ) {
+		HallPtr = 		(ADJ_HALL*)&SO2820_HallCalParameter;
+		LopgainPtr = (ADJ_LOPGAN* )&SO2820_LoopGainParameter;
+
+	}else if( Info.ActType == ACT_SO3600 ) {
+		HallPtr = 		(ADJ_HALL*)&SO3600_HallCalParameter;
+		LopgainPtr = (ADJ_LOPGAN* )&SO3600_LoopGainParameter;
+
+	}else{
+		return( EXE_ERROR );
+	}
+
+	/* Hall Adjustment */
+	UlFinSts = HallAdj( HallPtr, LopgainPtr );
+//	if( Info.ActType == ACT_SEMCO ) {
+//		if( ((UlFinSts & EXE_HXADJ) == EXE_HXADJ) || ((UlFinSts & EXE_HYADJ) == EXE_HYADJ) ){
+//			HallPtr = (ADJ_HALL*)&SO_HallCalParameter_F;
+//			UlFinSts = HallAdj( HallPtr );
+//		}
+//	}else{
+		if( ((UlFinSts & EXE_HXADJ) == EXE_HXADJ) || ((UlFinSts & EXE_HYADJ) == EXE_HYADJ) ) return ( UlFinSts );
+//	}
+
+	/* Hall Offser (neutral center)*/
+#ifdef	NEUTRAL_CENTER
+	TneHvc();
+#endif
+
+#ifdef	NEUTRAL_CENTER_FINE
+	TneFin( LopgainPtr );
+#endif
+
+//20180906 Komori
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+TRACE("    Xadof = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    Yadof = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+//20180906 Komori
+	
+	/* Loop gain Adjustment */
+	RamWrite32A( HallFilterCoeffX_hxgain0 , LopgainPtr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , LopgainPtr->Hygain ) ;
+	RtnCen( BOTH_ON ) ;		// Y ON / X ON
+	WitTim( TNE ) ;
+	UlFinSts |= LopGan( X_DIR, LopgainPtr ) ;	// X Loop Gain Adjust
+	UlFinSts |= LopGan( Y_DIR, LopgainPtr ) ;	// Y Loop Gain Adjust
+
+	/* Gyro DC offset Adjustment */
+#ifdef __OIS_UIOIS_GYRO_USE__
+#else
+	UlFinSts |= TneGvc() ;
+#endif
+	StAdjPar.StHalAdj.UlAdjPhs = UlFinSts ;
+	return( UlFinSts ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: TnePtp
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: X,Y Direction, Adjust Before After Parameter
+// Explanation		: Measuring Hall Paek To Peak
+// History			: First edition 						
+//********************************************************************************
+UINT32	TnePtp ( UINT8	UcDirSel, UINT8	UcBfrAft, ADJ_HALL* p )
+{
+	UnDwdVal		StTneVal ;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	INT32			SlMeasureMaxValue , SlMeasureMinValue ;
+	INT32			sl_act_min_drv, sl_act_max_drv ;
+	UINT16			UsSinAdr ;
+
+TRACE("TnePtp\n ") ;
+#ifdef	HALLADJ_FULLCURRENT
+	DMIOWrite32( OISDRVFC1 , 0x00000003 );
+#endif	//HALLADJ_FULLCURRENT
+
+	if( UcDirSel == X_DIR ) {								// X axis
+		SlMeasureParameterA		=	HALL_RAM_HXIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HYIDAT ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDX1;
+		sl_act_max_drv			=	p->ActMaxDrive_X ;
+		sl_act_min_drv			=	p->ActMinDrive_X ;
+	} else if( UcDirSel == Y_DIR ) {						// Y axis
+		SlMeasureParameterA		=	HALL_RAM_HYIDAT ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HXIDAT ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDY1;
+		sl_act_max_drv			=	p->ActMaxDrive_Y ;
+		sl_act_min_drv			=	p->ActMinDrive_Y ;
+	}
+	
+	MesFil( THROUGH ) ;					// Filter setting for measurement
+
+	SlMeasureParameterNum	=	2000 ;
+
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;		// Start measure
+	
+	RamWrite32A( UsSinAdr, sl_act_max_drv ) ;
+
+	MeasureWait() ;						// Wait complete of measurement
+	
+	RamRead32A( StMeasFunc_MFA_SiMin1 , ( UINT32 * )&SlMeasureMinValue ) ;	// Min value
+	
+	SlMeasureParameterNum	=	2000 ;
+	
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;		// Start measure
+	
+	RamWrite32A( UsSinAdr, sl_act_min_drv ) ;
+	
+	MeasureWait() ;						// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_SiMax1 , ( UINT32 * )&SlMeasureMaxValue ) ;	// Max value
+
+	StTneVal.StDwdVal.UsHigVal = (UINT16)((SlMeasureMaxValue >> 16) & 0x0000FFFF );
+	StTneVal.StDwdVal.UsLowVal = (UINT16)((SlMeasureMinValue >> 16) & 0x0000FFFF );
+
+	RamWrite32A( UsSinAdr, 0 ) ;
+	
+#ifdef	HALLADJ_FULLCURRENT
+	DMIOWrite32( OISDRVFC1 , 0x00000000 );
+#endif	//HALLADJ_FULLCURRENT
+
+TRACE("\nPTP topbtm H = %04xh , L = %04xh , AXIS = %02x \n", StTneVal.StDwdVal.UsHigVal,StTneVal.StDwdVal.UsLowVal ,UcDirSel ) ;
+	
+	if( UcBfrAft == 0 ) {
+		if( UcDirSel == X_DIR ) {
+			StAdjPar.StHalAdj.UsHlxCen	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlxMax	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlxMin	= StTneVal.StDwdVal.UsLowVal ;
+		} else if( UcDirSel == Y_DIR ){
+			StAdjPar.StHalAdj.UsHlyCen	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlyMax	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlyMin	= StTneVal.StDwdVal.UsLowVal ;
+		}
+	} else {
+		if( UcDirSel == X_DIR ){
+			StAdjPar.StHalAdj.UsHlxCna	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlxMxa	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlxMna	= StTneVal.StDwdVal.UsLowVal ;
+		} else if( UcDirSel == Y_DIR ){
+			StAdjPar.StHalAdj.UsHlyCna	= ( ( INT16 )StTneVal.StDwdVal.UsHigVal + ( INT16 )StTneVal.StDwdVal.UsLowVal ) / 2 ;
+			StAdjPar.StHalAdj.UsHlyMxa	= StTneVal.StDwdVal.UsHigVal ;
+			StAdjPar.StHalAdj.UsHlyMna	= StTneVal.StDwdVal.UsLowVal ;
+		}
+	}
+
+TRACE("		ADJ(%d) MAX = %04x, MIN = %04x, CNT = %04x, ", UcDirSel, StTneVal.StDwdVal.UsHigVal, StTneVal.StDwdVal.UsLowVal, ( ( signed int )StTneVal.StDwdVal.UsHigVal + ( signed int )StTneVal.StDwdVal.UsLowVal ) / 2 ) ;
+	StTneVal.StDwdVal.UsHigVal	= 0x7fff - StTneVal.StDwdVal.UsHigVal ;		// Maximum Gap = Maximum - Hall Peak Top
+	StTneVal.StDwdVal.UsLowVal	= StTneVal.StDwdVal.UsLowVal - 0x8000 ; 	// Minimum Gap = Hall Peak Bottom - Minimum
+
+TRACE("	GapH = %04x, GapL = %04x\n", StTneVal.StDwdVal.UsHigVal, StTneVal.StDwdVal.UsLowVal ) ;
+TRACE("		Raw MAX = %08x, MIN = %08x\n", (unsigned int)SlMeasureMaxValue , (unsigned int)SlMeasureMinValue ) ;
+	
+	return( StTneVal.UlDwdVal ) ;
+}
+
+//********************************************************************************
+// Function Name 	: TneCen
+// Retun Value		: Hall Center Tuning Result
+// Argment Value	: X,Y Direction, Hall Top & Bottom Gaps
+// Explanation		: Hall Center Tuning Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	TneCen( UINT8 UcTneAxs, ADJ_HALL* ptr  )
+{
+	UnDwdVal		StTneVal ;
+	UINT8 	UcTmeOut =1, UcTofRst= FAILURE ;
+	UINT16	UsBiasVal ;
+	UINT32	UlTneRst = FAILURE, UlBiasVal , UlValNow ;
+	UINT16	UsValBef,UsValNow ;
+	UINT32	UlBiaBef,UlBiaNow ;
+
+	if (BeforeControl != 0)	StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_BEFORE, ptr ) ;
+	else					StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_AFTER, ptr ) ;
+	BeforeControl=0;
+
+	TneOff( StTneVal, UcTneAxs ) ;
+	UcTofRst	= SUCCESS ;				/* Žb’è‚ÅOK‚É‚·‚é */
+
+	while ( UlTneRst && (UINT32)UcTmeOut )
+	{
+		if( UcTofRst == FAILURE ) {
+TRACE(" UcTofRst == FAILURE\n" ) ;
+			TneOff( StTneVal, UcTneAxs ) ;
+			StTneVal.UlDwdVal = TnePtp( UcTneAxs, PTP_AFTER, ptr ) ;
+		} else {
+TRACE(" else\n" ) ;
+			if( UcTneAxs == X_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_X , &UlBiaBef ) ;		
+			} else if( UcTneAxs == Y_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_Y , &UlBiaBef ) ;		
+			}
+			TneBia( StTneVal, UcTneAxs, ptr->TargetRange ) ;
+			if( UcTneAxs == X_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_X , &UlBiaNow ) ;		
+			} else if( UcTneAxs == Y_DIR ) {
+				RamRead32A( StCaliData_UiHallBias_Y , &UlBiaNow ) ;		
+			}
+			if((( UlBiaBef == BIAS_HLMT ) && ( UlBiaNow == BIAS_HLMT ))
+			|| (( UlBiaBef == BIAS_LLMT ) && ( UlBiaNow == BIAS_LLMT ))){
+				UcTmeOut += 10;
+TRACE("	No = %04d (bias count up)\n", UcTmeOut ) ;
+			}
+			StTneVal.UlDwdVal	= TnePtp( UcTneAxs , PTP_AFTER, ptr ) ;
+
+			UcTofRst	= FAILURE ;
+//			if( UcTneAxs == X_DIR ) {
+//				RamRead32A( StCaliData_UiHallBias_X , &UlBiasVal ) ;
+//			}else if( UcTneAxs == Y_DIR ){
+//				RamRead32A( StCaliData_UiHallBias_Y , &UlBiasVal ) ;
+//			}
+//			if(UlBiasVal == 0x00000000){
+//				UcTmeOut = TIME_OUT;
+//			}
+		}
+
+		if( (StTneVal.StDwdVal.UsHigVal > ptr->OffsetMargin ) && (StTneVal.StDwdVal.UsLowVal > ptr->OffsetMargin ) )	/* position check */
+		{
+			UcTofRst	= SUCCESS ;
+TRACE("  TofR = SUCC\n" ) ;
+			UsValBef = UsValNow = 0x0000 ;
+		}else if( (StTneVal.StDwdVal.UsHigVal <= ptr->OffsetMargin ) && (StTneVal.StDwdVal.UsLowVal <= ptr->OffsetMargin ) ){
+			UcTofRst	= SUCCESS ;
+			UlTneRst	= (UINT32)FAILURE ;
+		}else{
+			UcTofRst	= FAILURE ;
+TRACE("  TofR = FAIL\n" ) ;
+			
+			UsValBef = UsValNow ;
+
+			if( UcTneAxs == X_DIR  ) {
+				RamRead32A( StCaliData_UiHallOffset_X , &UlValNow ) ;
+				UsValNow = (UINT16)( UlValNow >> 16 ) ;
+			}else if( UcTneAxs == Y_DIR ){
+				RamRead32A( StCaliData_UiHallOffset_Y , &UlValNow ) ;
+				UsValNow = (UINT16)( UlValNow >> 16 ) ;
+			}
+			if( ((( UsValBef & 0xFF00 ) == 0x1000 ) && ( UsValNow & 0xFF00 ) == 0x1000 )
+			 || ((( UsValBef & 0xFF00 ) == 0xEF00 ) && ( UsValNow & 0xFF00 ) == 0xEF00 ) )
+			{
+				UcTmeOut += 10;
+TRACE("	No = %04d (offset count up)\n", UcTmeOut ) ;
+				if( UcTneAxs == X_DIR ) {
+					RamRead32A( StCaliData_UiHallBias_X , &UlBiasVal ) ;
+					UsBiasVal = (UINT16)( UlBiasVal >> 16 ) ;
+				}else if( UcTneAxs == Y_DIR ){
+					RamRead32A( StCaliData_UiHallBias_Y , &UlBiasVal ) ;
+					UsBiasVal = (UINT16)( UlBiasVal >> 16 ) ;
+				}
+				
+				if( UsBiasVal > ptr->DecrementStep )
+				{
+					UsBiasVal -= ptr->DecrementStep ;
+				}
+				
+				if( UcTneAxs == X_DIR ) {
+					UlBiasVal = ( UINT32 )( UsBiasVal << 16 ) ;
+					DacControl( HLXBO , UlBiasVal ) ;
+					RamWrite32A( StCaliData_UiHallBias_X , UlBiasVal ) ;
+				}else if( UcTneAxs == Y_DIR ){
+					UlBiasVal = ( UINT32 )( UsBiasVal << 16 ) ;
+					DacControl( HLYBO , UlBiasVal ) ;
+					RamWrite32A( StCaliData_UiHallBias_Y , UlBiasVal ) ;
+				}
+			}
+
+		}
+		
+		if((( (UINT16)0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal )) < ptr->TargetMax )
+		&& (( (UINT16)0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal )) > ptr->TargetMin ) ) {
+			if(UcTofRst	== SUCCESS)
+			{
+				UlTneRst	= (UINT32)SUCCESS ;
+				break ;
+			}
+		}
+		UlTneRst	= (UINT32)FAILURE ;
+		UcTmeOut++ ;
+TRACE("  Tne = FAIL\n" ) ;
+
+TRACE("	No = %04d", UcTmeOut ) ;
+		if ( UcTmeOut >= TIME_OUT ) {
+			UcTmeOut	= 0 ;
+		}		 																							// Set Time Out Count
+	}
+
+	SetSinWavGenInt() ;		// 
+	
+	if( UlTneRst == (UINT32)FAILURE ) {
+		if( UcTneAxs == X_DIR ) {
+			UlTneRst					= EXE_HXADJ ;
+			StAdjPar.StHalAdj.UsHlxGan	= 0xFFFF ;
+			StAdjPar.StHalAdj.UsHlxOff	= 0xFFFF ;
+		}else if( UcTneAxs == Y_DIR ) {
+			UlTneRst					= EXE_HYADJ ;
+			StAdjPar.StHalAdj.UsHlyGan	= 0xFFFF ;
+			StAdjPar.StHalAdj.UsHlyOff	= 0xFFFF ;
+		}
+	} else {
+		UlTneRst	= EXE_END ;
+	}
+
+	return( UlTneRst ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: TneBia
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: Hall Top & Bottom Gaps , X,Y Direction
+// Explanation		: Hall Bias Tuning Function
+// History			: First edition 						
+//********************************************************************************
+void TneBia( UnDwdVal StTneVal, UINT8 UcTneAxs, UINT16 UsHalAdjRange  )
+{
+	UINT32			UlSetBia ;
+
+TRACE("TneBia\n " ) ;
+	if( UcTneAxs == X_DIR ) {
+		RamRead32A( StCaliData_UiHallBias_X , &UlSetBia ) ;
+	} else if( UcTneAxs == Y_DIR ) {
+		RamRead32A( StCaliData_UiHallBias_Y , &UlSetBia ) ;
+	}
+
+TRACE("		UlSetBia = %08x\n ", (unsigned int)UlSetBia ) ;
+	if( UlSetBia == 0x00000000 )	UlSetBia = 0x01000000 ;
+	UlSetBia = (( UlSetBia >> 16 ) & (UINT32)0x0000FF00 ) ;
+	UlSetBia *= (UINT32)UsHalAdjRange ;
+	if(( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal ) == 0xFFFF ){
+		UlSetBia = BIAS_HLMT ;
+	}else{
+		UlSetBia /= (UINT32)( 0xFFFF - ( StTneVal.StDwdVal.UsHigVal + StTneVal.StDwdVal.UsLowVal )) ;
+		if( UlSetBia > (UINT32)0x0000FFFF )		UlSetBia = 0x0000FFFF ;
+		UlSetBia = ( UlSetBia << 16 ) ;
+		if( UlSetBia > BIAS_HLMT )		UlSetBia = BIAS_HLMT ;
+		if( UlSetBia < BIAS_LLMT )		UlSetBia = BIAS_LLMT ;
+	}
+
+	if( UcTneAxs == X_DIR ) {
+		DacControl( HLXBO , UlSetBia ) ;
+TRACE("		HLXBO = %08x\n ",  (unsigned int)UlSetBia ) ;
+		RamWrite32A( StCaliData_UiHallBias_X , UlSetBia) ;
+	} else if( UcTneAxs == Y_DIR ){
+		DacControl( HLYBO , UlSetBia ) ;
+TRACE("		HLYBO = %08x\n ",  (unsigned int)UlSetBia ) ;
+		RamWrite32A( StCaliData_UiHallBias_Y , UlSetBia) ;
+	}
+TRACE("		( AXIS = %02x , BIAS = %08xh ) , \n", UcTneAxs , (unsigned int)UlSetBia ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: TneOff
+// Retun Value		: Hall Top & Bottom Gaps
+// Argment Value	: Hall Top & Bottom Gaps , X,Y Direction
+// Explanation		: Hall Offset Tuning Function
+// History			: First edition 						
+//********************************************************************************
+void TneOff( UnDwdVal StTneVal, UINT8 UcTneAxs )
+{
+	UINT32	UlSetOff ;
+	UINT32	UlSetVal ;
+	
+TRACE("TneOff\n ") ;
+	if( UcTneAxs == X_DIR ) {
+		RamRead32A( StCaliData_UiHallOffset_X , &UlSetOff ) ;
+	} else if( UcTneAxs == Y_DIR ){
+		RamRead32A( StCaliData_UiHallOffset_Y , &UlSetOff ) ;
+	}
+	UlSetOff 	= ( UlSetOff >> 16 ) ;
+
+	if ( StTneVal.StDwdVal.UsHigVal > StTneVal.StDwdVal.UsLowVal ) {
+		UlSetVal	= ( UINT32 )(( StTneVal.StDwdVal.UsHigVal - StTneVal.StDwdVal.UsLowVal ) / OFFSET_DIV ) ;	// Calculating Value For Increase Step
+		UlSetOff	+= UlSetVal ;	// Calculating Value For Increase Step
+		if( UlSetOff > 0x0000FFFF )		UlSetOff = 0x0000FFFF ;
+	} else {
+		UlSetVal	= ( UINT32 )(( StTneVal.StDwdVal.UsLowVal - StTneVal.StDwdVal.UsHigVal ) / OFFSET_DIV ) ;	// Calculating Value For Decrease Step
+		if( UlSetOff < UlSetVal ){
+			UlSetOff	= 0x00000000 ;
+		}else{
+			UlSetOff	-= UlSetVal ;	// Calculating Value For Decrease Step
+		}
+	}
+
+TRACE("		UlSetOff = %08x\n ",  (unsigned int)UlSetOff ) ;
+	if( UlSetOff > ( INT32 )0x0000EFFF ) {
+		UlSetOff	= 0x0000EFFF ;
+	} else if( UlSetOff < ( INT32 )0x00001000 ) {
+		UlSetOff	= 0x00001000 ;
+	}
+
+	UlSetOff = ( UlSetOff << 16 ) ;
+	
+	if( UcTneAxs == X_DIR ) {
+		DacControl( HLXO, UlSetOff ) ;
+TRACE("		HLXO = %08x\n ",  (unsigned int)UlSetOff ) ;
+		RamWrite32A( StCaliData_UiHallOffset_X , UlSetOff ) ;
+	} else if( UcTneAxs == Y_DIR ){
+		DacControl( HLYO, UlSetOff ) ;
+TRACE("		HLYO = %08x\n ",  (unsigned int)UlSetOff ) ;
+		RamWrite32A( StCaliData_UiHallOffset_Y , UlSetOff ) ;
+	}
+TRACE("		( AXIS = %02x , OFST = %08xh ) , \n", UcTneAxs , (unsigned int)UlSetOff ) ;
+
+}
+
+
+//********************************************************************************
+// Function Name 	: LopGan
+// Retun Value		: Execute Result
+// Argment Value	: X,Y Direction
+// Explanation		: Loop Gain Adjust Function
+// History			: First edition 						
+//********************************************************************************
+UINT32	LopGan( UINT8 UcDirSel, ADJ_LOPGAN* ptr )
+{
+#if 1
+	UINT32			UlReturnState ;
+	
+	if( UcDirSel == X_DIR ) {							// X axis
+		RamWrite32A( HallFilterCoeffX_hxgain0 , ptr->Hxgain ) ;
+		StAdjPar.StLopGan.UlLxgVal = ptr->Hxgain ;
+		UlReturnState = EXE_END ;
+	} else if( UcDirSel == Y_DIR ){						// Y axis
+		RamWrite32A( HallFilterCoeffY_hygain0 , ptr->Hygain ) ;
+		StAdjPar.StLopGan.UlLygVal = ptr->Hygain ;
+		UlReturnState = EXE_END ;
+	}
+	
+	return( UlReturnState ) ;
+#else
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	UINT64	UllCalculateVal ;
+	UINT32	UlReturnState ;
+	UINT16	UsSinAdr ;
+	
+	if( UcDirSel == X_DIR ) {		// X axis
+TRACE("LopGain X_DIR \n") ;
+		SlMeasureParameterA		=	HALL_RAM_HXOUT1 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HXLOP ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDX0;
+	} else if( UcDirSel == Y_DIR ){						// Y axis
+TRACE("LopGain Y_DIR \n") ;
+		SlMeasureParameterA		=	HALL_RAM_HYOUT1 ;		// Set Measure RAM Address
+		SlMeasureParameterB		=	HALL_RAM_HYLOP ;		// Set Measure RAM Address
+		UsSinAdr = HALL_RAM_SINDY0;
+	}
+	
+	SetSinWavGenInt();
+	RamWrite32A( SinWave_Offset		,	ptr->NoiseFreq ) ;								// Freq Setting
+	RamWrite32A( SinWave_Gain		,	ptr->NoiseGain ) ;								// Set Sine Wave Gain					
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;								// Sine Wave Start
+
+TRACE("LopGain NoiseFreq = %08xh \n", (unsigned int)ptr->NoiseFreq ) ;
+TRACE("LopGain NoiseGain = %08xh \n", (unsigned int)ptr->NoiseGain ) ;
+
+	SetTransDataAdr( SinWave_OutAddr	,	( UINT32 )UsSinAdr ) ;	// Set Sine Wave Input RAM
+	
+	MesFil( 1/*LOOPGAIN*/ ) ;					// Filter setting for measurement
+	MeasureStart( ptr->NoiseNum , SlMeasureParameterA , SlMeasureParameterB ) ;			// Start measure
+	MeasureWait() ;						// Wait complete of measurement
+
+	SetSinWavGenInt();		// Sine wave stop
+	
+	SetTransDataAdr( SinWave_OutAddr	,	(UINT32)0x00000000 ) ;	// Set Sine Wave Input RAM
+	RamWrite32A( UsSinAdr		,	0x00000000 ) ;				// DelayRam Clear
+	
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiAbsInteg1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiAbsInteg2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+TRACE("LopGain StMeasValueA.UllnValue = %08xh \n", (unsigned int)StMeasValueA.StUllnVal.UlHigVal ) ;
+TRACE("LopGain StMeasValueB.UllnValue = %08xh \n", (unsigned int)StMeasValueB.StUllnVal.UlHigVal ) ;
+	
+	if( UcDirSel == X_DIR ) {		// X axis
+		UllCalculateVal = ( StMeasValueB.UllnValue * 1000 / StMeasValueA.UllnValue ) * ptr->Hxgain / ptr->Gap ;
+		if( UllCalculateVal > (UINT64)0x000000007FFFFFFF )		UllCalculateVal = (UINT64)0x000000007FFFFFFF ;
+		StAdjPar.StLopGan.UlLxgVal = (UINT32)UllCalculateVal ;
+		RamWrite32A( HallFilterCoeffX_hxgain0 , StAdjPar.StLopGan.UlLxgVal ) ;
+TRACE("LopGain UlLxgVal = %08xh \n", (unsigned int)StAdjPar.StLopGan.UlLxgVal ) ;
+		if( (UllCalculateVal > ptr->XJudgeHigh) || ( UllCalculateVal < ptr->XJudgeLow ) ){
+			UlReturnState = EXE_LXADJ ;
+		}else{
+			UlReturnState = EXE_END ;
+		}
+		
+	}else if( UcDirSel == Y_DIR ){							// Y axis
+		UllCalculateVal = ( StMeasValueB.UllnValue * 1000 / StMeasValueA.UllnValue ) * ptr->Hygain / ptr->Gap ;
+		if( UllCalculateVal > (UINT64)0x000000007FFFFFFF )		UllCalculateVal = (UINT64)0x000000007FFFFFFF ;
+		StAdjPar.StLopGan.UlLygVal = (UINT32)UllCalculateVal ;
+		RamWrite32A( HallFilterCoeffY_hygain0 , StAdjPar.StLopGan.UlLygVal ) ;
+TRACE("LopGain UlLygVal = %08xh \n", (unsigned int)StAdjPar.StLopGan.UlLygVal ) ;
+		if( (UllCalculateVal > ptr->YJudgeHigh) || ( UllCalculateVal < ptr->YJudgeLow ) ){
+			UlReturnState = EXE_LYADJ ;
+		}else{
+			UlReturnState = EXE_END ;
+		}
+	}
+
+TRACE("LopGain UlReturnState = %08xh \n", (unsigned int)UlReturnState ) ;
+	return( UlReturnState ) ;
+#endif
+}
+#endif //((SELECT_VENDOR & 0x80 ) != 0x80)
+
+//********************************************************************************
+// Function Name 	: SetSinWavePara
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Sine wave Test Function
+// History			: First edition 						
+//********************************************************************************
+/* Servo Sampling Clock		=	18.0288kHz						*/
+/* Freq						=	SinFreq*80000000h/Fs			*/
+/* 05 00 XX MM 				XX:Freq MM:Sin or Circle */
+const UINT32	CucFreqVal[ 17 ]	= {
+		0xFFFFFFFF,				//  0:  Stop
+		0x0001D14A,				//  1: 1Hz
+		0x0003A294,				//  2: 2Hz
+		0x000573DE,				//  3: 3Hz	
+		0x00074528,				//  4: 4Hz
+		0x00091672,				//  5: 5Hz
+		0x000AE7BC,				//  6: 6Hz
+		0x000CB906,				//  7: 7Hz
+		0x000E8A50,				//  8: 8Hz
+		0x00105B9A,				//  9: 9Hz
+		0x00122CE4,				//  A: 10Hz
+		0x0013FE2E,				//  B: 11Hz
+		0x0015CF78,				//  C: 12Hz
+		0x0017A0C2,				//  D: 13Hz
+		0x0019720C,				//  E: 14Hz
+		0x001B4356,				//  F: 15Hz
+		0x001D14A0				// 10: 16Hz
+	} ;
+	
+void	SetSinWavePara( UINT8 UcTableVal ,  UINT8 UcMethodVal )
+{
+	UINT32	UlFreqDat ;
+
+	if(UcTableVal > 0x10 )	UcTableVal = 0x10 ;			/* Limit */
+	UlFreqDat = CucFreqVal[ UcTableVal ] ;	
+	
+	if( UcMethodVal == 255/*CIRCWAVE*/) {
+		RamWrite32A( SinWave_Phase	,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+		RamWrite32A( CosWave_Phase 	,	0x00000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	}else{
+		RamWrite32A( SinWave_Phase	,	0x60000000 ) ;		// �³Œ·”g‚̈ʑŠ—Ê
+		RamWrite32A( CosWave_Phase 	,	0x60000000 );		// �³Œ·”g‚̈ʑŠ—Ê
+	}
+
+	if( UlFreqDat == 0xFFFFFFFF )			/* Sine”g’†Ž~ */
+	{
+		RamWrite32A( SinWave_Offset		,	0x00000000 ) ;									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( SinWave_Phase		,	0x60000000 ) ;									// �³Œ·”g‚̈ʑŠ—Ê
+
+		RamWrite32A( CosWave_Offset		,	0x00000000 );									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( CosWave_Phase 		,	0x60000000 );									// �³Œ·”g‚̈ʑŠ—Ê
+
+		RamWrite32A( SinWaveC_Regsiter	,	0x00000000 ) ;									// Sine Wave Stop
+		SetTransDataAdr( SinWave_OutAddr	,	0x00000000 ) ;		// �o—Í�æƒAƒhƒŒƒX
+		SetTransDataAdr( CosWave_OutAddr	,	0x00000000 );		// �o—Í�æƒAƒhƒŒƒX
+		RamWrite32A( HALL_RAM_HXOFF1		,	0x00000000 ) ;				// DelayRam Clear
+		RamWrite32A( HALL_RAM_HYOFF1		,	0x00000000 ) ;				// DelayRam Clear
+	}else{
+		RamWrite32A( SinWave_Offset		,	UlFreqDat ) ;									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+		RamWrite32A( CosWave_Offset		,	UlFreqDat );									// ”­�¶Žü”g�”‚̃IƒtƒZƒbƒg‚ð�Ý’è
+
+		RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;									// Sine Wave Start
+		SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_HXOFF1 ) ;		// �o—Í�æƒAƒhƒŒƒX
+		SetTransDataAdr( CosWave_OutAddr	,	(UINT32)HALL_RAM_HYOFF1 ) ;		// �o—Í�æƒAƒhƒŒƒX
+
+	}
+}
+
+//********************************************************************************
+// Function Name 	: TneHvc
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Hall VC offset
+// History			: First edition 				
+//********************************************************************************
+#define		ADOFF_ROUGH_NUM		64
+void	TneHvc( void )
+{
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	
+	RamWrite32A( HALL_RAM_HXOFF,  0x00000000 ) ;		// X Offset Clr
+	RamWrite32A( HALL_RAM_HYOFF,  0x00000000 ) ;		// Y Offset Clr
+	
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+	WitTim( 500 ) ;
+	
+	MesFil( THROUGH ) ;					// Set Measure Filter
+	MeasureStart( ADOFF_ROUGH_NUM , HALL_RAM_HXIDAT , HALL_RAM_HYIDAT ) ;					// Start measure
+	MeasureWait() ;					// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 	, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_ROUGH_NUM ) / 100 ) ;
+	SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_ROUGH_NUM ) / 100 ) ;
+
+	StAdjPar.StHalAdj.UsHlxCna = ( UINT16 )(( SlMeasureAveValueA >> 16 ) & 0x0000FFFF );		//Measure Result Store
+	StAdjPar.StHalAdj.UsHlxCen = StAdjPar.StHalAdj.UsHlxCna;									//Measure Result Store
+
+	StAdjPar.StHalAdj.UsHlyCna = ( UINT16 )(( SlMeasureAveValueB >> 16 ) & 0x0000FFFF );		//Measure Result Store
+	StAdjPar.StHalAdj.UsHlyCen = StAdjPar.StHalAdj.UsHlyCna;											//Measure Result Store
+
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+TRACE("    Xadof = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    Yadof = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: TneFin
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Hall VC offset current optimize
+// History			: First edition 				
+//********************************************************************************
+#define		ADOFF_FINE_NUM		2000	
+void	TneFin( ADJ_LOPGAN* ptr )
+{
+	UINT32	UlReadVal ;
+	UINT16	UsAdxOff, UsAdyOff ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	UINT32	UlMinimumValueA, UlMinimumValueB ;
+	UINT16	UsAdxMin, UsAdyMin ;
+	UINT8	UcFin ;
+	
+	// Loop gain set for servo
+	RamWrite32A( HallFilterCoeffX_hxgain0 , ptr->Hxgain ) ;
+	RamWrite32A( HallFilterCoeffY_hygain0 , ptr->Hygain ) ;
+	
+	// Get natural center offset
+	RamRead32A( HALL_RAM_HXOFF,  &UlReadVal ) ;
+	UsAdxOff = UsAdxMin = (UINT16)( UlReadVal >> 16 ) ;
+
+	RamRead32A( HALL_RAM_HYOFF,  &UlReadVal ) ;
+	UsAdyOff = UsAdyMin = (UINT16)( UlReadVal >> 16 ) ;
+//TRACE("*****************************************************\n" );
+//TRACE("TneFin: Before Adx=%04X, Ady=%04X\n", UsAdxOff, UsAdyOff );
+
+	// Servo ON
+	RtnCen( BOTH_ON ) ;
+	WitTim( TNE ) ;
+
+	MesFil( THROUGH ) ;					// Filter setting for measurement
+	MeasureStart( ADOFF_FINE_NUM , HALL_RAM_HALL_X_OUT , HALL_RAM_HALL_Y_OUT ) ;					// Start measure
+	MeasureWait() ;						// Wait complete of measurement
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 	, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 , &StMeasValueA.StUllnVal.UlHigVal ) ;
+	SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 	, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+	SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+	UlMinimumValueA = abs(SlMeasureAveValueA) ;
+	UlMinimumValueB = abs(SlMeasureAveValueB) ;
+	UcFin = 0x11 ;
+
+	while( UcFin ) {
+		if( UcFin & 0x01 ) {
+			if( UlMinimumValueA >= abs(SlMeasureAveValueA) ) {
+				UlMinimumValueA = abs(SlMeasureAveValueA) ;
+				UsAdxMin = UsAdxOff ;
+				// Žû‘©‚ð‘�‚߂邽‚ß‚É�A�o—Í’l‚É”ä—Ⴓ‚¹‚é
+				if( SlMeasureAveValueA > 0 )
+					UsAdxOff = (INT16)UsAdxOff + (SlMeasureAveValueA >> 17) + 1 ;
+				else
+					UsAdxOff = (INT16)UsAdxOff + (SlMeasureAveValueA >> 17) - 1 ;
+
+				RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+			} else {
+//TRACE("X fine\n");
+				UcFin &= 0xFE ;
+			}
+		}
+
+		if( UcFin & 0x10 ) {
+			if( UlMinimumValueB >= abs(SlMeasureAveValueB) ) {
+				UlMinimumValueB = abs(SlMeasureAveValueB) ;
+				UsAdyMin = UsAdyOff ;
+				// Žû‘©‚ð‘�‚߂邽‚ß‚É�A�o—Í’l‚É”ä—Ⴓ‚¹‚é
+				if( SlMeasureAveValueB > 0 )
+					UsAdyOff = (INT16)UsAdyOff + (SlMeasureAveValueB >> 17) + 1 ;
+				else
+					UsAdyOff = (INT16)UsAdyOff + (SlMeasureAveValueB >> 17) - 1 ;
+
+				RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+			} else {
+//TRACE("Y fine\n");
+				UcFin &= 0xEF ;
+			}
+		}
+		
+		MeasureStart( ADOFF_FINE_NUM , HALL_RAM_HALL_X_OUT , HALL_RAM_HALL_Y_OUT ) ;					// Start measure
+		MeasureWait() ;						// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 	, &StMeasValueA.StUllnVal.UlLowVal ) ;	// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4 , &StMeasValueA.StUllnVal.UlHigVal ) ;
+		SlMeasureAveValueA = (INT32)((( (INT64)StMeasValueA.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 	, &StMeasValueB.StUllnVal.UlLowVal ) ;	// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4	, &StMeasValueB.StUllnVal.UlHigVal ) ;
+		SlMeasureAveValueB = (INT32)((( (INT64)StMeasValueB.UllnValue * 100 ) / ADOFF_FINE_NUM ) / 100 ) ;
+//TRACE("-->Adx %04X, Ady %04X\n", UsAdxOff, UsAdyOff );
+	}	// while
+//TRACE("TneFin: After Adx=%04X, Ady=%04X\n", UsAdxMin, UsAdyMin );
+	StAdjPar.StHalAdj.UsHlxCna = UsAdxMin;								//Measure Result Store
+	StAdjPar.StHalAdj.UsHlxCen = StAdjPar.StHalAdj.UsHlxCna;			//Measure Result Store
+
+	StAdjPar.StHalAdj.UsHlyCna = UsAdyMin;								//Measure Result Store
+	StAdjPar.StHalAdj.UsHlyCen = StAdjPar.StHalAdj.UsHlyCna;			//Measure Result Store
+
+	StAdjPar.StHalAdj.UsAdxOff = StAdjPar.StHalAdj.UsHlxCna  ;
+	StAdjPar.StHalAdj.UsAdyOff = StAdjPar.StHalAdj.UsHlyCna  ;
+
+	// Servo OFF
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+
+
+TRACE("    XadofFin = %04xh \n", StAdjPar.StHalAdj.UsAdxOff ) ;
+TRACE("    YadofFin = %04xh \n", StAdjPar.StHalAdj.UsAdyOff ) ;
+	RamWrite32A( HALL_RAM_HXOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdxOff << 16 ) & 0xFFFF0000 )) ;
+	RamWrite32A( HALL_RAM_HYOFF,  (UINT32)((StAdjPar.StHalAdj.UsAdyOff << 16 ) & 0xFFFF0000 )) ;
+
+}
+
+/***************************************/
+#define		SLT_OFFSET		(0x1000)
+#define		LENS_MARGIN		(0x0800)
+#define		PIXEL_SIZE		(1.12f)							// pixel size 1.12um
+#define		SPEC_RANGE		(120.0f)						// spec need movable range 130um
+#define		SPEC_PIXEL		(PIXEL_SIZE / SPEC_RANGE)		// spec need movable range pixel
+/***************************************/
+//********************************************************************************
+// Function Name 	: IniNvc
+// Retun Value		: NON
+// Argment Value	: direction
+// Explanation		: Set each direction sign function
+//********************************************************************************
+void	IniNvc( INT16 SsX, INT16 SsY )
+{
+	SsNvcX = SsX ;
+	SsNvcY = SsY ;
+}
+
+//********************************************************************************
+// Function Name 	: TneSltPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneSltPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)((SsOff * SsNvcX) << 16) ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)((SsOff * SsNvcY) << 16) ) ;
+
+}
+
+//********************************************************************************
+// Function Name 	: TneVrtPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneVrtPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)0 ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)((SsOff * SsNvcY) << 16) ) ;
+}
+
+//********************************************************************************
+// Function Name 	: TneHrzPos
+// Retun Value		: NON
+// Argment Value	: Position number(1, 2, 3, 4, 5, 6, 7, 0:reset)
+// Explanation		: Move measurement position function
+//********************************************************************************
+void	TneHrzPos( UINT8 UcPos )
+{
+	INT16 SsOff = 0x0000 ;
+
+	UcPos &= 0x07 ;
+	
+	if ( UcPos ) {
+		SsOff = SLT_OFFSET * (UcPos - 4);
+	}
+
+//TRACE("X = %04X, Y = %04X \n", SsOff, SsOff );
+
+	RamWrite32A( HALL_RAM_HXOFF1,  (INT32)((SsOff * SsNvcX) << 16) ) ;
+	RamWrite32A( HALL_RAM_HYOFF1,  (INT32)0 ) ;
+}
+
+
+
+
+//********************************************************************************
+// Function Name 	: TneADO
+// Retun Value		: 0x0000:PASS, 0x0001:X MAX OVER, 0x0002:Y MAX OVER, 0x0003:X MIN OVER, 0x0004:Y MIN OVER, FFFF:Verify error
+//					: 0x0100:X MAX RANGE ERROR, 0x0200:Y MAX RANGE ERROR, 0x0300:X MIN RANGE ERROR, 0x0400:Y MIN ERROR
+// Argment Value	: 
+// Explanation		: calculation margin Function
+// History			: First edition 						
+//********************************************************************************
+UINT16	TneADO( )
+{
+	UINT16	UsSts = 0 ;
+#if 0	
+	INT32	iRetVal;
+	INT32 limit ;
+	INT32 gxgain ;
+	INT32 gygain ;
+	INT16 gout_x_marginp ;
+	INT16 gout_x_marginm ;
+	INT16 gout_y_marginp ;
+	INT16 gout_y_marginm ;
+
+	INT16 x_max ;
+	INT16 x_min ;
+	INT16 x_off ;
+	INT16 y_max ;
+	INT16 y_min ;
+	INT16 y_off ;
+	INT16 x_max_after ;
+	INT16 x_min_after ;
+	INT16 y_max_after ;
+	INT16 y_min_after ;
+	INT16 gout_x ;
+	INT16 gout_y ;
+
+	//
+	// Flash update procedure
+	//
+	// Read calibration sector to buffer
+	iRetVal = Calibration_VerifyUpdate_PreRead();
+	if(iRetVal != 0) return(iRetVal);
+
+	// Read calibration data
+	RdHallCalData();
+
+	x_max = (INT16)StAdjPar.StHalAdj.UsHlxMxa ;
+	x_min = (INT16)StAdjPar.StHalAdj.UsHlxMna ;
+	x_off = (INT16)StAdjPar.StHalAdj.UsAdxOff ;
+	y_max = (INT16)StAdjPar.StHalAdj.UsHlyMxa ;
+	y_min = (INT16)StAdjPar.StHalAdj.UsHlyMna ;
+	y_off = (INT16)StAdjPar.StHalAdj.UsAdyOff ;
+
+	RamRead32A( GF_LimitX_HLIMT,	&limit ) ;
+	RamRead32A( StCaliData_SiGyroGain_X,	&gxgain ) ;
+	RamRead32A( StCaliData_SiGyroGain_Y,	&gygain ) ;
+
+	x_max_after = (x_max - x_off) ;
+	if (x_off < 0)
+	{
+	    if ((0x7FFF - abs(x_max)) < abs(x_off)) x_max_after = 0x7FFF ;
+	}
+
+	x_min_after = (x_min - x_off) ;
+	if (x_off > 0)
+	{
+	    if ((0x7FFF - abs(x_min)) < abs(x_off)) x_min_after = 0x8001 ;
+	}
+
+	y_max_after = (y_max - y_off) ;
+	if (y_off < 0)
+	{
+	    if ((0x7FFF - abs(y_max)) < abs(y_off)) y_max_after = 0x7FFF ;
+	}
+
+	y_min_after = (y_min - y_off);
+	if (y_off > 0)
+	{
+	    if ((0x7FFF - abs(y_min)) < abs(y_off)) y_min_after = 0x8001 ;
+	}
+
+	gout_x = (INT16)((INT32)(((float)gxgain / 0x7FFFFFFF) * limit * 4) >> 16);
+	gout_y = (INT16)((INT32)(((float)gygain / 0x7FFFFFFF) * limit * 4) >> 16);
+
+//TRACE( "ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+//TRACE( "ADOFF Y\t=\t0x%04X\r\n", y_off ) ;
+//TRACE( "MAX GOUT X\t=\t0x%04X\r\n", gout_x ) ;
+//TRACE( "MIN GOUT X\t=\t0x%04X\r\n", (gout_x * -1) ) ;
+//TRACE( "MAX GOUT Y\t=\t0x%04X\r\n", gout_y) ;
+//TRACE( "MIN GOUT Y\t=\t0x%04X\r\n", (gout_y * -1) ) ;
+
+	gout_x_marginp = (INT16)(gout_x + LENS_MARGIN);			// MARGIN X+
+	gout_x_marginm = (INT16)((gout_x + LENS_MARGIN) * -1);	// MARGIN X-
+	gout_y_marginp = (INT16)(gout_y + LENS_MARGIN);			// MARGIN Y+
+	gout_y_marginm = (INT16)((gout_y + LENS_MARGIN) * -1);	// MARGIN Y-
+
+//TRACE( "MAX GOUT with margin X\t=\t0x%04X\r\n", gout_x_marginp ) ;
+//TRACE( "MIN GOUT with margin X\t=\t0x%04X\r\n", gout_x_marginm ) ;
+//TRACE( "MAX GOUT with margin Y\t=\t0x%04X\r\n", gout_y_marginp ) ;
+//TRACE( "MIN GOUT with margin Y\t=\t0x%04X\r\n", gout_y_marginm ) ;
+
+//TRACE( "MAX AFTER X\t=\t0x%04X\r\n", x_max_after ) ;
+//TRACE( "MIN AFTER X\t=\t0x%04X\r\n", x_min_after ) ;
+//TRACE( "MAX AFTER Y\t=\t0x%04X\r\n", y_max_after ) ;
+//TRACE( "MIN AFTER Y\t=\t0x%04X\r\n", y_min_after ) ;
+
+	// ƒ}�[ƒWƒ“‚ª‚Ü‚Á‚½‚­‚È‚¢‚à‚Ì‚Í•s—Ç‚Æ‚·‚é
+	if (x_max_after < gout_x) {
+		UsSts = 1 ;
+	}
+	else if (y_max_after < gout_y) {
+		UsSts = 2 ;
+	}
+	else if (x_min_after > (gout_x * -1)) {
+		UsSts = 3 ;
+	}
+	else if (y_min_after > (gout_y * -1)) {
+		UsSts = 4 ;
+	}
+	else {
+		// ƒ}�[ƒWƒ“ƒI�[ƒo�[‚Å‚ ‚ê‚Î�AADOFFSET‚ð�X�V‚·‚é
+		if (x_max_after < gout_x_marginp) {
+			x_off -= (gout_x_marginp - x_max_after);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+		}
+		if (x_min_after > gout_x_marginm) {
+			x_off += abs(x_min_after - gout_x_marginm);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", x_off ) ;
+		}
+		if (y_max_after < gout_y_marginp) {
+			y_off -= (gout_y_marginp - y_max_after);
+//TRACE( "UPDATE ADOFF Y\t=\t0x%04X\r\n", y_off ) ;
+		}
+		if (y_min_after > gout_y_marginm) {
+			y_off += abs(y_min_after - gout_y_marginm);
+//TRACE( "UPDATE ADOFF X\t=\t0x%04X\r\n", y_off ) ;
+		}
+		
+		if ( (StAdjPar.StHalAdj.UsAdxOff != (UINT16)x_off) || (StAdjPar.StHalAdj.UsAdyOff != (UINT16)y_off) ) {
+			StAdjPar.StHalAdj.UsAdxOff = x_off ;
+			StAdjPar.StHalAdj.UsAdyOff = y_off ;
+
+			RamWrite32A( StCaliData_SiLensCen_Offset_X ,	(UINT32)(StAdjPar.StHalAdj.UsAdxOff << 16) ) ;
+			RamWrite32A( StCaliData_SiLensCen_Offset_Y ,	(UINT32)(StAdjPar.StHalAdj.UsAdyOff << 16) ) ;
+
+			_PUT_UINT32( (UINT32)(StAdjPar.StHalAdj.UsAdxOff << 16),	LENS_CENTER_VALUE_X	) ;
+			_PUT_UINT32( (UINT32)(StAdjPar.StHalAdj.UsAdyOff << 16),	LENS_CENTER_VALUE_Y	) ;
+			iRetVal = Calibration_VerifyUpdate();
+		}
+	}
+
+	// *******************************
+	// effective range check
+	// *******************************
+	if (UsSts == 0) {
+		UINT16 UsReadVal ;
+		float flDistanceX, flDistanceY ;
+		float flDistanceAD = SLT_OFFSET * 6 ;
+
+		// effective range check
+		_GET_UINT16( UsReadVal,	DISTANCE_X	) ;
+		flDistanceX = (float)UsReadVal / 10.0f ;
+//TRACE("DISTANCE (X, Y) pixel = (%04X", UsReadVal );
+
+		_GET_UINT16( UsReadVal,	DISTANCE_Y	) ;
+		flDistanceY = (float)UsReadVal / 10.0f ;
+//TRACE(", %04X)\r\n", UsReadVal );
+
+//TRACE("DISTANCE (X, Y) pixel = (%x, %x)\r\n", (int)(flDistanceX * 10.0), (int)(flDistanceY * 10.0) );
+//TRACE("X MAX um = %d\r\n", (int)((x_max_after * (flDistanceX / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("Y MAX um = %d\r\n", (int)((y_max_after * (flDistanceY / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("X MIN um = %d\r\n", (int)((abs(x_min_after) * (flDistanceX / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("Y MIN um = %d\r\n", (int)((abs(y_min_after) * (flDistanceY / flDistanceAD)) * PIXEL_SIZE) ) ;
+//TRACE("SPEC PIXEL = %d\r\n", (int)SPEC_PIXEL ) ;
+
+		if ( (x_max_after * (flDistanceX / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("X MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0100 ;
+		}
+		else if ( (y_max_after * (flDistanceY / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("Y MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0200 ;
+		}
+		else if ( (abs(x_min_after) * (flDistanceX / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("X MIN < 85um\r\n");
+			// error
+			UsSts |= 0x0300 ;
+		}
+		else if ( (abs(y_min_after) * (flDistanceY / flDistanceAD)) < SPEC_PIXEL ) {
+//TRACE("Y MAX < 85um\r\n");
+			// error
+			UsSts |= 0x0400 ;
+		}
+	}
+#endif	
+	return( UsSts ) ;
+
+}
+
+#if 0
+//********************************************************************************
+// Function Name 	: FrqDet
+// Retun Value		: 0:PASS, 1:OIS X NG, 2:OIS Y NG, 4:CLAF NG
+// Argment Value	: NON
+// Explanation		: Module Check 
+// History			: First edition 						
+//********************************************************************************
+// Threshold of osciration amplitude
+#define ULTHDVAL	0x01000000								// Threshold of the hale value
+UINT8 FrqDet( void )
+{
+	INT32 SlMeasureParameterA , SlMeasureParameterB ;
+	INT32 SlMeasureParameterNum ;
+	UINT32 UlXasP_P , UlYasP_P ;
+	UINT8 UcRtnVal;
+
+	UcRtnVal = 0;
+
+	//Measurement Setup
+	MesFil( OSCCHK ) ;													// Set Measure Filter
+
+	SlMeasureParameterNum	=	1000 ;									// 1000times( 50ms )
+	SlMeasureParameterA		=	(UINT32)HALL_RAM_HXOUT0 ;		// Set Measure RAM Address
+	SlMeasureParameterB		=	(UINT32)HALL_RAM_HYOUT0 ;		// Set Measure RAM Address
+
+	// impulse Set
+//	RamWrite32A( HALL_RAM_HXOFF1 , STEP1 ) ;							// X manual 
+//	RamWrite32A( HALL_RAM_HYOFF1 , STEP1 ) ;							// Y manual
+
+//	RamWrite32A( HALL_RAM_HXOFF1 , STEP2 ) ;							// X manual 
+//	RamWrite32A( HALL_RAM_HYOFF1 , STEP2 ) ;							// Y manual
+	WitTim( 300 ) ;
+
+	// Start measure
+	MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;	
+	MeasureWait() ;														// Wait complete of measurement
+	RamRead32A( StMeasFunc_MFA_UiAmp1, &UlXasP_P ) ;					// X Axis Peak to Peak
+	RamRead32A( StMeasFunc_MFB_UiAmp2, &UlYasP_P ) ;					// Y Axis Peak to Peak
+//TRACE("UlXasP_P = %X\r\n", (unsigned int)UlXasP_P ) ;
+//TRACE("UlYasP_P = %X\r\n", (unsigned int)UlYasP_P ) ;
+
+	WitTim( 50 ) ;
+
+	// Osc Value Check X
+	if(  UlXasP_P > ULTHDVAL ){
+		UcRtnVal = 1;
+	}
+	// Osc Value Check Y
+	if(  UlYasP_P > ULTHDVAL ){
+		UcRtnVal |= 2;
+	}
+
+
+	return(UcRtnVal);													// Retun Status value
+}
+#endif
+
+#ifdef	ZERO_SERVO
+//********************************************************************************
+// Function Name 	: TneZeroServo
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes Zero Servo Parameter
+// History			: First edition
+//********************************************************************************
+#define 	ZERO_SERVO_NUM		4096				// 4096times
+UINT32	TneZeroServo( UINT8 ucposture , float DegreeGap )
+{
+	UINT32			UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	double			dTemp;
+	UINT8			i;
+	UINT32			UlRdVal;
+	double			OffsetAngle;
+	
+	UlRsltSts = EXE_END ;
+	if( ucposture < 0x80 ){
+		RamRead32A( CMD_RETURN_TO_CENTER , &UlRdVal );
+		if( UlRdVal != 0x00000000 ){
+			RtnCen( BOTH_OFF ) ;
+		}
+
+		RamRead32A( CMD_ZSRV_MODE , &UlRdVal );
+		if( ( UlRdVal & 0x00000001) == ZSRV_ENABLE ){
+			RamWrite32A( CMD_ZSRV_MODE , ZSRV_DISABLE );
+		}
+		
+		//•½‹Ï’l‘ª’è
+			MesFil( THROUGH ) ;					// Set Measure Filter
+
+			SlMeasureParameterNum	=	ZERO_SERVO_NUM ;					// Measurement times
+
+		if( ucposture != 0 && ucposture != 2 ){
+			UlRsltSts = EXE_ERROR;
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+			return( UlRsltSts );
+		}
+			
+		for( i=ucposture ; i< (ucposture+2) ; i++ )
+		{
+			switch( i ){
+			case 0:				/* +Y */
+				SlMeasureParameterA		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	GYRO_RAM_GZ_ADIDAT ;		// Set Measure RAM Address
+				break;
+			case 1:
+				SlMeasureParameterA		=	HALL_RAM_HYOUT2 ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+				break;
+			case 2:				/* +X */
+				SlMeasureParameterA		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+				break;
+			case 3:
+				SlMeasureParameterA		=	HALL_RAM_HXOUT2 ;			// Set Measure RAM Address
+				SlMeasureParameterB		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+				break;
+			}
+
+			MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+			MeasureWait() ;					// Wait complete of measurement
+
+			RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+			RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+			RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+			RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+			SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+			SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+			
+			switch( i ){
+			case 0:
+				StZeroServoX.SlOffset = SlMeasureAveValueA ;		// i case 0 : ZeroServoRAM_X_IN
+				GYROZ_OFFSET = SlMeasureAveValueB ;
+				break;
+			case 2:
+				StZeroServoY.SlOffset = SlMeasureAveValueA ;		// i case 2 : ZeroServoRAM_Y_IN
+				StZeroServoZ.SlOffset = SlMeasureAveValueB ;
+				break;
+			default :
+				break;
+			}
+		}
+
+TRACE("VAL(H,A) pos = \t%08xh\t%08xh\t%d \n",(int)SlMeasureAveValueA, (int)SlMeasureAveValueB, ucposture ) ;
+			
+			
+			switch( ucposture ){
+			case 0:		/* +Y */
+				if( SlMeasureAveValueB < (int)(POSTURETH_P<<16) ){
+					UlRsltSts = EXE_ERROR ;
+					StZeroServoX.SlOffset = 0 ;
+				}else{
+					StZeroServoMesY.SlHallP = SlMeasureAveValueA ;	// i case 1 : HALL_RAM_HYOUT2
+					StZeroServoMesY.SlAcclP = SlMeasureAveValueB ;	// i case 1 : ZeroServoRAM_Y_IN
+					UlPostureSt |= 0x00000001;
+				}
+				break;
+			case 2:		/* +X */
+				if( SlMeasureAveValueB < (int)(POSTURETH_P<<16) ){
+					UlRsltSts = EXE_ERROR ;
+					StZeroServoY.SlOffset = 0 ;
+				}else{
+					StZeroServoMesX.SlHallP = SlMeasureAveValueA ;	// i case 3 : HALL_RAM_HXOUT2
+					StZeroServoMesX.SlAcclP = SlMeasureAveValueB ;	// i case 3 : ZeroServoRAM_X_IN
+					UlPostureSt |= 0x00000004;
+				}
+				break;
+			}
+	}else{
+		switch(ucposture){
+		case 0x80:	/* ŒvŽZ */
+			
+			if( UlPostureSt == 0x05L ){
+				// ( Xhp ) / ( Xap)
+				StZeroServoMesX.SlAcclP -= StZeroServoX.SlOffset;
+				dTemp = (double)2147483647.0  / (double)( StZeroServoMesX.SlAcclP );
+				for( StZeroServoX.SlShift = 0 ; StZeroServoX.SlShift <= 5;  StZeroServoX.SlShift++){
+					if( fabs(dTemp) <= 1 ){
+						break;
+					}
+					dTemp = dTemp / (double)2 ;
+				}
+				StZeroServoX.SlGcora = (INT32)(dTemp * (double)2147483647.0);
+				StZeroServoX.SlShift = StZeroServoX.SlShift << 8;
+
+				// ( Yhp ) / ( Yap )
+				StZeroServoMesY.SlAcclP -= StZeroServoY.SlOffset;
+				dTemp = (double)2147483647.0 / (double)( StZeroServoMesY.SlAcclP );
+				for( StZeroServoY.SlShift = 0 ; StZeroServoY.SlShift <= 5;  StZeroServoY.SlShift++){
+					if( fabs(dTemp) <= 1 ){
+						break;
+					}
+					dTemp = dTemp / 2 ;
+				}
+				StZeroServoY.SlGcora = (INT32)(dTemp * (double)2147483647.0);
+				StZeroServoY.SlShift = StZeroServoY.SlShift << 8;
+				
+				OffsetAngle = (double)( DegreeGap ) * 3.141592653589793238 / 180.0f ;
+
+
+
+				
+				StZeroServoX.SlGaina = (INT32)( (float)StZeroServoMesX.SlHallP / cos( OffsetAngle ) ) ;
+				StZeroServoY.SlGaina = (INT32)( (float)StZeroServoMesY.SlHallP / cos( OffsetAngle ) ) ;
+				
+TRACE("   X    ,   Y    ,   angle = %f \n", DegreeGap ) ;
+TRACE("%08xh,%08xh(Offset)\n",(int)StZeroServoX.SlOffset, (int)StZeroServoY.SlOffset) ;
+TRACE("%08xh,%08xh(Gcora)\n",(int)StZeroServoX.SlGcora, (int)StZeroServoY.SlGcora) ;
+TRACE("%08xh,%08xh(Gaina)\n",(int)StZeroServoX.SlGaina, (int)StZeroServoY.SlGaina) ;
+TRACE("%08xh,%08xh(Shift)\n",(int)StZeroServoX.SlShift, (int)StZeroServoY.SlShift) ;
+TRACE("%08xh,%08xh(AZ , GZ)\n",(int)StZeroServoZ.SlOffset, (int)GYROZ_OFFSET) ;
+				RamWrite32A( ZeroServoRAM_X_OFFSET 			, StZeroServoX.SlOffset );
+				RamWrite32A( ZeroServoFilterTableX_gcora	, StZeroServoX.SlGcora );
+				RamWrite32A( ZeroServoFilterTableX_gaina 	, StZeroServoX.SlGaina );
+				RamWrite32A( ZeroServoFilterTableX_shift 	, StZeroServoX.SlShift );
+
+				RamWrite32A( ZeroServoRAM_Y_OFFSET 			, StZeroServoY.SlOffset );
+				RamWrite32A( ZeroServoFilterTableY_gcora	, StZeroServoY.SlGcora );
+				RamWrite32A( ZeroServoFilterTableY_gaina 	, StZeroServoY.SlGaina );
+				RamWrite32A( ZeroServoFilterTableY_shift 	, StZeroServoY.SlShift );
+
+				RamWrite32A( ZeroServoRAM_Z_OFFSET 			, StZeroServoZ.SlOffset );
+				RamWrite32A( GYRO_RAM_GZOFFZ 				, GYROZ_OFFSET );
+				
+			}else{
+				UlRsltSts = EXE_ERROR ;
+			}
+			break;
+		case 0xFF:	/* RAM clear */
+			UlPostureSt = 0L;
+			break;
+		}
+	}
+
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+	return( UlRsltSts );
+}
+
+//********************************************************************************
+// Function Name 	: ZeroServoLmt
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Zero Servo Limit Parameter
+// History			: First edition
+//********************************************************************************
+UINT8	ZeroServoLmt( UINT8 UCMODE )
+{
+	UINT32			UlRsltSts;
+#if (EP3_ES == 2)
+	double			dTemp1;
+#else
+	double			dTemp1, dTemp2;
+	UINT32			UlFilCoef;
+	UINT16			Usshift , UsShiftx , UsShifty;
+	UINT32			Ulcoef , Ulgainx , Ulgainy;
+#endif
+	
+TRACE(" ZSRV LMT ( %d )%\n" , UCMODE ) ;
+	UlRsltSts = EXE_END ;
+	if(( UCMODE > 0x64 ) || ( UCMODE < 0x0A )){
+TRACE(" 	error \n" ) ;
+		return( EXE_ERROR ) ;
+	}
+
+#if (EP3_ES == 2)
+	dTemp1 = (double)UCMODE /(double)100.0 * (double)2147483647;
+	
+	RamWrite32A( ZS_LMT_limitx 	, (INT32)dTemp1 );
+	RamWrite32A( ZS_LMT_limity 	, (INT32)dTemp1 );
+	
+#else // ES1
+	RamRead32A( ZeroServoFilterTableX_gcora 	, &StZeroServoX.SlGcora );
+	RamRead32A( ZeroServoFilterTableX_shift 	, &StZeroServoX.SlShift );
+	RamRead32A( ZeroServoFilterTableY_gcora		, &StZeroServoY.SlGcora );
+	RamRead32A( ZeroServoFilterTableY_shift 	, &StZeroServoY.SlShift );
+	RamRead32A( ZeroServoFilterTableX_coeff1_0 	, &UlFilCoef );
+	
+TRACE("		before X (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)StZeroServoX.SlGcora ,(int)StZeroServoX.SlShift ,(int)UlFilCoef   ) ;
+TRACE("		before Y (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)StZeroServoY.SlGcora ,(int)StZeroServoY.SlShift ,(int)UlFilCoef   ) ;
+	dTemp1 = (double)100.0 / (double)UCMODE;
+	dTemp2 = (double)UCMODE / (double)100.0;
+	
+	for( Usshift = 0 ; Usshift <= 4;  Usshift++){
+		if( fabs(dTemp1) <= 1 ){
+			break;
+		}
+		dTemp1 = dTemp1 / (double)2 ;
+	}
+	
+	Ulgainx = (INT32)(dTemp1 * (double)StZeroServoX.SlGcora);
+	Ulgainy = (INT32)(dTemp1 * (double)StZeroServoY.SlGcora);
+	UsShiftx = (UINT16)StZeroServoX.SlShift + (UINT16)(Usshift<<8);
+	UsShifty = (UINT16)StZeroServoY.SlShift + (UINT16)(Usshift<<8);
+	Ulcoef = (INT32)(dTemp2 * (double)UlFilCoef);
+TRACE("		after  X (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)Ulgainx ,(int)UsShiftx ,(int)Ulcoef   ) ;
+TRACE("		after  Y (gain , shift , coeff) = ( %08x , %08x , %08x )\n",(int)Ulgainy ,(int)UsShifty ,(int)Ulcoef   ) ;
+	
+	RamWrite32A( ZeroServoFilterTableX_gcora 	, Ulgainx );
+	RamWrite32A( ZeroServoFilterTableX_shift 	, (UINT32)UsShiftx );
+	RamWrite32A( ZeroServoFilterTableY_gcora	, Ulgainy );
+	RamWrite32A( ZeroServoFilterTableY_shift 	, (UINT32)UsShifty );
+	RamWrite32A( ZeroServoFilterTableX_coeff1_0 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableX_coeff1_2 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableY_coeff1_0 , Ulcoef );
+	RamWrite32A( ZeroServoFilterTableY_coeff1_2 , Ulcoef );
+#endif
+
+TRACE(" Result = %08x\n",(int)UlRsltSts ) ;
+	return( UlRsltSts );
+}
+#endif	//ZERO_SERVO
+
+#ifdef	SEL_SHIFT_COR
+//********************************************************************************
+// Function Name 	: MemClr
+// Retun Value		: void
+// Argment Value	: Clear Target Pointer, Clear Byte Number
+// Explanation		: Memory Clear Function
+// History			: First edition 						
+//********************************************************************************
+void	MemClr( UINT8	*NcTgtPtr, UINT16	UsClrSiz )
+{
+	UINT16	UsClrIdx ;
+
+	for ( UsClrIdx = 0 ; UsClrIdx < UsClrSiz ; UsClrIdx++ )
+	{
+		*NcTgtPtr	= 0 ;
+		NcTgtPtr++ ;
+	}
+}
+
+//********************************************************************************
+// Function Name 	: TneAvc
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Tunes the Accel VC offset for All
+// History			: First edition
+//********************************************************************************
+#define 	ACCLOF_NUM		4096				// 4096times
+UINT32	TneAvc( UINT8 ucposture )
+{
+	UINT32			UlRsltSts;
+	INT32			SlMeasureParameterA , SlMeasureParameterB ;
+	INT32			SlMeasureParameterNum ;
+	UnllnVal		StMeasValueA , StMeasValueB ;
+	INT32			SlMeasureAveValueA , SlMeasureAveValueB ;
+	INT32			SlMeasureRetValueX , SlMeasureRetValueY , SlMeasureRetValueZ;
+	UINT8			j , k;
+//	UINT8			i , j , k;
+//	INT32			mtrx[9] , imtrx[9];
+//	float			detA;
+	INT32			SlDiff[3] ;
+
+	UlRsltSts = EXE_END ;
+	if( ucposture < 0x7f ){
+		//•½‹Ï’l‘ª’è
+		MesFil( THROUGH ) ;					// Set Measure Filter
+
+		SlMeasureParameterNum	=	ACCLOF_NUM ;					// Measurement times
+		/******* 1st *******/
+		SlMeasureParameterA		=	ZeroServoRAM_X_IN ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	ZeroServoRAM_Y_IN ;			// Set Measure RAM Address
+
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+		MeasureWait() ;					// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+
+		SlMeasureRetValueX = SlMeasureAveValueA ;
+		SlMeasureRetValueY = SlMeasureAveValueB ;
+
+		/******* 2nd *******/
+		SlMeasureParameterA		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+		SlMeasureParameterB		=	ZeroServoRAM_Z_IN ;			// Set Measure RAM Address
+
+		MeasureStart( SlMeasureParameterNum , SlMeasureParameterA , SlMeasureParameterB ) ;					// Start measure
+
+		MeasureWait() ;					// Wait complete of measurement
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 		, &StMeasValueA.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4		, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 		, &StMeasValueB.StUllnVal.UlLowVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4		, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		SlMeasureAveValueA = (INT32)( (INT64)StMeasValueA.UllnValue / SlMeasureParameterNum ) ;
+		SlMeasureAveValueB = (INT32)( (INT64)StMeasValueB.UllnValue / SlMeasureParameterNum ) ;
+
+		SlMeasureRetValueZ = SlMeasureAveValueA ;
+		
+
+
+TRACE("VAL(X,Y,Z) pos = \t%08xh\t%08xh\t%08xh\t%d \n", (unsigned int)SlMeasureRetValueX, (unsigned int)SlMeasureRetValueY, (unsigned int)SlMeasureRetValueZ, ucposture ) ;
+		if(( SlMeasureRetValueZ < (INT32)(POSTURETH_P<<16)) && (ucposture == 0x10)){
+				UlRsltSts = EXE_ERROR ;
+TRACE(" POS14 [ERROR] \t%08xh < %08xh\n", (unsigned int)(SlMeasureRetValueZ), (unsigned int)(POSTURETH_P<<16) ) ;
+		}else if(( SlMeasureRetValueZ > (INT32)(POSTURETH_M<<16)) && (ucposture == 0x11)){
+				UlRsltSts = EXE_ERROR ;
+TRACE(" POS14 [ERROR] \t%08xh > %08xh\n", (unsigned int)(SlMeasureRetValueZ), (unsigned int)(POSTURETH_M<<16) ) ;
+		}else{
+TRACE("DEBUG = \t%08xh\t \n", abs( (INT32)(ACCL_SENS << 16) - abs(SlMeasureRetValueZ) ) ) ;
+			if( abs(SlMeasureRetValueX) > ZEROG_MRGN_XY )									UlRsltSts |= EXE_GXADJ ;
+			if( abs(SlMeasureRetValueY) > ZEROG_MRGN_XY )									UlRsltSts |= EXE_GYADJ ;
+			if( abs( (INT32)(ACCL_SENS << 16) - abs(SlMeasureRetValueZ)) > ZEROG_MRGN_Z )	UlRsltSts |= EXE_GZADJ ;
+			if( UlRsltSts == EXE_END ){
+//				StPosOff.StPos.Pos[4][0] = SlMeasureRetValueX;
+//				StPosOff.StPos.Pos[4][1] = SlMeasureRetValueY;
+//				StPosOff.StPos.Pos[4][2] = SlMeasureRetValueZ;
+				StPosOff.UlAclOfSt |= 0x0000003F;
+TRACE("POS14(X,Y,Z) st = \t%08xh\t%08xh\t%08xh\t%08xh \n", (unsigned int)StPosOff.StPos.Pos[4][0], (unsigned int)StPosOff.StPos.Pos[4][1], (unsigned int)StPosOff.StPos.Pos[4][2], (unsigned int)StPosOff.UlAclOfSt ) ;
+
+				SlDiff[0] = SlMeasureRetValueX - (INT32)0;
+				SlDiff[1] = SlMeasureRetValueY - (INT32)0;
+				if(ucposture == 0x10){
+					SlDiff[2] = SlMeasureRetValueZ - (INT32)(ACCL_SENS << 16);
+				}else{
+					SlDiff[2] = SlMeasureRetValueZ - (INT32)(ACCL_SENS_M << 16);
+				}
+				StPosOff.StPos.Pos[4][0] = SlDiff[0];
+				StPosOff.StPos.Pos[4][1] = SlDiff[1];
+				StPosOff.StPos.Pos[4][2] = SlDiff[2];
+			}
+		}
+	}else{
+		switch(ucposture){
+		case 0x80:	/* ŒvŽZ */
+
+			if(StPosOff.UlAclOfSt == 0x3fL ){
+				/*X offset*/
+				StAclVal.StAccel.SlOffsetX = StPosOff.StPos.Pos[4][0] ;
+				/*Y offset*/
+				StAclVal.StAccel.SlOffsetY = StPosOff.StPos.Pos[4][1] ;
+				/*Z offset*/
+				StAclVal.StAccel.SlOffsetZ = StPosOff.StPos.Pos[4][2] ;
+#ifdef DEBUG
+TRACE("ACLOFST(X,Y,Z) = \t%08xh\t%08xh\t%08xh \n", (unsigned int)StAclVal.StAccel.SlOffsetX, (unsigned int)StAclVal.StAccel.SlOffsetY, (unsigned int)StAclVal.StAccel.SlOffsetZ   ) ;
+#endif //DEBUG
+				
+				RamWrite32A( ZeroServoRAM_X_OFFSET , StAclVal.StAccel.SlOffsetX ) ;	// X axis Accel offset
+				RamWrite32A( ZeroServoRAM_Y_OFFSET , StAclVal.StAccel.SlOffsetY ) ;	// Y axis Accel offset
+				RamWrite32A( ZeroServoRAM_Z_OFFSET , StAclVal.StAccel.SlOffsetZ ) ;	// Z axis Accel offset
+				
+				StAclVal.StAccel.SlOffsetX = ( StAclVal.StAccel.SlOffsetX >> 16 ) & 0x0000FFFF;
+				StAclVal.StAccel.SlOffsetY = ( StAclVal.StAccel.SlOffsetY >> 16 ) & 0x0000FFFF;
+				StAclVal.StAccel.SlOffsetZ = ( StAclVal.StAccel.SlOffsetZ >> 16 ) & 0x0000FFFF;
+				
+				for( j=0 ; j < 6 ; j++ ){
+					k = 4 * j;
+					RamWrite32A( AcclFilDly_X + k , 0x00000000 ) ;			// X axis Accl LPF Clear
+					RamWrite32A( AcclFilDly_Y + k , 0x00000000 ) ;			// Y axis Accl LPF Clear
+					RamWrite32A( AcclFilDly_Z + k , 0x00000000 ) ;			// Z axis Accl LPF Clear
+				}
+
+			}else{
+				UlRsltSts = EXE_ERROR ;
+			}
+			break;
+		case 0xFF:	/* RAM clear */
+			MemClr( ( UINT8 * )&StPosOff, sizeof( stPosOff ) ) ;	// Adjust Parameter Clear
+			MemClr( ( UINT8 * )&StAclVal, sizeof( stAclVal ) ) ;	// Adjust Parameter Clear
+//			StPosOff.UlAclOfSt = 0L;
+			break;
+		}
+	}
+
+TRACE(" Result = %08x\n", (unsigned int)UlRsltSts ) ;
+	return( UlRsltSts );
+
+
+}
+#endif	//SEL_SHIFT_COR
+
+
+
+//********************************************************************************
+// Function Name 	: Actuator_Moving
+// Retun Value		: Status
+// Argment Value	: X or Y axis, Actuator Moving Parameter Pointer, Hall Data Pointer
+// Explanation		: Actuator Moving Test Function
+// History			: First edition 		
+//********************************************************************************
+UINT8	Actuator_Moving( UINT8 uc_axis, Act_Mov_t *pt_parameter, int *ul_readval )
+{
+	UINT8		uc_status	= SUCCESS ;
+	UnllnVal	StMeasValueA, StMeasValueB ;
+	int			targetcode ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;															// X,Y Servo On
+
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+
+	MesFil( NOISE ) ;																			// Measure Filter Setting
+
+	targetcode	= pt_parameter->startcode ;														// Set Initial Position
+
+	while( targetcode > pt_parameter->endcode ) {
+		// Move to measuring porision
+		if( !uc_axis ) {																		// X Axis
+			RamWrite32A( HALL_RAM_GYROX_OUT, targetcode ) ;
+		} else {																				// Y Axis
+			RamWrite32A( HALL_RAM_GYROY_OUT, targetcode ) ;
+		}
+
+		// Measure position
+		WitTim( 100 ) ;																			// Wait 100ms
+
+		MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;								// Measurement Starting
+
+		MeasureWait() ;																			// Wait for finishing measure
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;			// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;			// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		if( !uc_axis ) {																		// X Axis
+			*ul_readval	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) ;
+		} else {																				// Y Axis
+			*ul_readval	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) ;
+		}
+
+//		if( ( *( ul_readval - 1 ) - *ul_readval ) < abs( pt_parameter->step / 2 ) ) {
+//			uc_status	= FAILURE ;
+//		}
+
+		targetcode	+= pt_parameter->step ;
+		ul_readval++ ;
+	}
+
+	// Move to center position
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;
+	return( uc_status ) ;
+}
+
+
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=  ‚±‚±‚©‚ç’ljÁ by K.Otake                                                                     +=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//********************************************************************************
+// Function Name 	: Laser_LinearityCorrection
+// Retun Value		: Status
+// Argment Value	: None
+// Explanation		: Linearity correction by laser displacement meter Function
+// History			: First edition 		
+//********************************************************************************
+#define	RATED_STROKE_RANGE	80L
+UINT8	Laser_LinearityCorrection( void )
+{
+	UINT16	us_peak_to_peak_x, us_rated_peak_to_peak_x, us_peak_to_peak_y, us_rated_peak_to_peak_y ;
+	INT32	sl_step_x, sl_position_x[ 7 ], sl_step_y, sl_position_y[ 7 ] ;
+	INT16	ss_laser_x[ 7 ], ss_laser_y[ 7 ] ;
+	UINT8	i, us_status	= SUCCESS ;
+	INT32	sl_gyro_switch, sl_calib_status ;
+	
+	// Initialize
+	if( ( short )StAdjPar.StHalAdj.UsHlxMxa < ( short )StAdjPar.StHalAdj.UsHlxMna ) {
+		us_status	= FAILURE ;
+		return( us_status ) ;
+	}
+	
+	if( ( short )StAdjPar.StHalAdj.UsHlyMxa < ( short )StAdjPar.StHalAdj.UsHlyMna ) {
+		us_status	= FAILURE ;
+		return( us_status ) ;
+	}
+	
+	// Linearity correction disable
+	RamRead32A( GYRO_RAM_GYRO_Switch, &sl_gyro_switch ) ;
+	sl_gyro_switch	&= 0xFFFFFFF7 ;
+	RamWrite32A( GYRO_RAM_GYRO_Switch, sl_gyro_switch ) ;
+	
+	// Servo ON
+	RamWrite32A( CMD_RETURN_TO_CENTER, BOTH_SRV_ON ) ;
+	WitTim( 100 ) ;
+
+	// Calculate the moving position
+	us_peak_to_peak_x		= ( unsigned short )( ( long )StAdjPar.StHalAdj.UsHlxMxa - ( long )StAdjPar.StHalAdj.UsHlxMna ) ;
+	us_rated_peak_to_peak_x	= ( unsigned short )( ( long )us_peak_to_peak_x * RATED_STROKE_RANGE / 100L ) ;
+	sl_step_x				= us_rated_peak_to_peak_x / 6 ;
+
+	us_peak_to_peak_y		= ( unsigned short )( ( long )StAdjPar.StHalAdj.UsHlyMxa - ( long )StAdjPar.StHalAdj.UsHlyMna ) ;
+	us_rated_peak_to_peak_y	= ( unsigned short )( ( long )us_peak_to_peak_y * RATED_STROKE_RANGE / 100L ) ;
+	sl_step_y				= us_rated_peak_to_peak_y / 6 ;
+	for( i = 0 ; i < 7 ; i++ ) {
+		sl_position_x[ i ]	= ( long )( 0 + ( sl_step_x * ( i - 3 ) ) ) << 16 ;
+		sl_position_y[ i ]	= ( long )( 0 + ( sl_step_y * ( i - 3 ) ) ) << 16 ;
+	}
+	
+	// Move the position x to initial position
+	RamWrite32A( HALL_RAM_GYROX_OUT, ( unsigned long )sl_position_x[ 0 ] ) ;
+	WitTim( 100 ) ;
+	
+	// Please set laser displacement meter to 0um
+	ClearLaser() ;
+	
+	// Please take laser displacement data while the actuator move
+	// Please take X axis laser data
+	for( i = 0 ; i < 7 ; i++ ) {
+		RamWrite32A( HALL_RAM_GYROX_OUT, ( unsigned long )sl_position_x[ i ] ) ;
+		WitTim( 100 ) ;
+		ss_laser_x[ i ]	= GetLaser() ;
+	}
+	
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;										// Return to center position
+	WitTim( 100 ) ;
+	
+	// Move the position y to initial position
+	RamWrite32A( HALL_RAM_GYROY_OUT, ( unsigned long )sl_position_y[ 0 ] ) ;
+	WitTim( 100 ) ;
+	
+	// Please set laser displacement meter to 0um
+	ClearLaser() ;
+	
+	// Please take Y axis laser data
+	for( i = 0 ; i < 7 ; i++ ) {
+		RamWrite32A( HALL_RAM_GYROY_OUT, ( unsigned long )sl_position_y[ i ] ) ;
+		WitTim( 100 ) ;
+		ss_laser_y[ i ]	= GetLaser() ;
+	}
+	
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;										// Return to center position
+	
+	// Test
+	ss_laser_x[ 0 ]	= 0 ;
+	ss_laser_x[ 1 ]	= 42 ;
+	ss_laser_x[ 2 ]	= 97 ;
+	ss_laser_x[ 3 ]	= 154 ;
+	ss_laser_x[ 4 ]	= 217 ;
+	ss_laser_x[ 5 ]	= 286 ;
+	ss_laser_x[ 6 ]	= 358 ;
+	sl_step_x		= 3538 ;
+	
+	ss_laser_y[ 0 ]	= 0 ;
+	ss_laser_y[ 1 ]	= 51 ;
+	ss_laser_y[ 2 ]	= 91 ;
+	ss_laser_y[ 3 ]	= 146 ;
+	ss_laser_y[ 4 ]	= 201 ;
+	ss_laser_y[ 5 ]	= 267 ;
+	ss_laser_y[ 6 ]	= 330 ;
+	sl_step_y		= 3482 ;
+
+	// Send laser displacement data to DSP
+	RamWrite32A( StPosition_0, ( unsigned long )( ( long )( ( ss_laser_x[ 0 ] * 10 ) << 16 ) | ( ss_laser_y[ 0 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_1, ( unsigned long )( ( long )( ( ss_laser_x[ 1 ] * 10 ) << 16 ) | ( ss_laser_y[ 1 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_2, ( unsigned long )( ( long )( ( ss_laser_x[ 2 ] * 10 ) << 16 ) | ( ss_laser_y[ 2 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_3, ( unsigned long )( ( long )( ( ss_laser_x[ 3 ] * 10 ) << 16 ) | ( ss_laser_y[ 3 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_4, ( unsigned long )( ( long )( ( ss_laser_x[ 4 ] * 10 ) << 16 ) | ( ss_laser_y[ 4 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_5, ( unsigned long )( ( long )( ( ss_laser_x[ 5 ] * 10 ) << 16 ) | ( ss_laser_y[ 5 ] * 10 ) ) ) ;
+	RamWrite32A( StPosition_6, ( unsigned long )( ( long )( ( ss_laser_x[ 6 ] * 10 ) << 16 ) | ( ss_laser_y[ 6 ] * 10 ) ) ) ;
+	RamWrite32A( SiStepXY, ( unsigned long )( sl_step_x << 16 | sl_step_y ) ) ;
+	
+	// Linearity correction enable
+	RamRead32A( GYRO_RAM_GYRO_Switch, &sl_gyro_switch ) ;
+	sl_gyro_switch	|= 0x00000008 ;
+	RamWrite32A( GYRO_RAM_GYRO_Switch, sl_gyro_switch ) ;
+
+	// Linearity Data enable
+	RamRead32A( StCaliData_UsCalibrationStatus, &sl_calib_status ) ;
+	sl_calib_status	&= 0xFFFFFBFF ;
+	RamWrite32A( StCaliData_UsCalibrationStatus, sl_calib_status ) ;
+	
+	// Calculate the coefficient for linearity correction
+	RamWrite32A( CMD_LASER_LINEAR_DATA, 0 ) ;
+	
+	return( us_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: CircleTest
+// Retun Value		: Status
+// Argment Value	: Frequency, XX% Mechanical Stroke
+// Explanation		: Sine Wave Test Function
+// History			: First edition 		
+//********************************************************************************
+#define	TRACKING_THRESHOLD	0x08000000
+UINT8	CircleTest( UINT8 uc_freq, UINT8 us_amp )
+{
+	UINT16	us_amplitude_x, us_amplitude_y ;
+	UINT32	ul_gain_x, ul_gain_y ;
+	UINT8	uc_status = SUCCESS ;
+	INT32	sl_sample_num, sl_ach_max, sl_ach_min, sl_bch_max, sl_bch_min ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;
+
+	// Sine wave amplitude setting
+	SetSinWavGenInt() ;
+	
+	if( StAdjPar.StHalAdj.UsHlxMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlxMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlxMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlxMna ;
+	}
+	
+	us_amplitude_x	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+
+	if( StAdjPar.StHalAdj.UsHlyMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlyMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlyMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlyMna ;
+	}
+	
+	us_amplitude_y	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+	
+	ul_gain_x	= ( UINT32 )( ( UINT32 )us_amplitude_x * us_amp / 100 ) << 16 ;
+	ul_gain_y	= ( UINT32 )( ( UINT32 )us_amplitude_y * us_amp / 100 ) << 16 ;
+
+	// Sine wave generation
+	SetSinWavePara( uc_freq, CIRCWAVE ) ;
+	
+	RamWrite32A( SinWave_Gain, ul_gain_x ) ;									// Sine wave gain
+	RamWrite32A( CosWave_Gain, ul_gain_y ) ;									// Cosine wave gain
+	
+	// Measurement initialize
+	MesFil( NOISE ) ;
+	
+	sl_sample_num	= ( INT32 )( FS_FREQ / ( float )uc_freq ) ;
+	
+	// Start peak to peak measurement
+	MeasureStart( sl_sample_num, HALL_RAM_HXOUT0, HALL_RAM_HYOUT0 ) ;
+	
+	MeasureWait() ;
+	
+	// Check tracking
+	RamRead32A( StMeasFunc_MFA_SiMax1, &sl_ach_max ) ;
+	RamRead32A( StMeasFunc_MFA_SiMin1, &sl_ach_min ) ;
+	RamRead32A( StMeasFunc_MFB_SiMax2, &sl_bch_max ) ;
+	RamRead32A( StMeasFunc_MFB_SiMin2, &sl_bch_min ) ;
+	
+	if( ( ( sl_ach_max - sl_ach_min ) > TRACKING_THRESHOLD ) || ( ( sl_bch_max - sl_bch_min ) > TRACKING_THRESHOLD ) ) {
+		uc_status	= FAILURE ;
+	}
+	
+	// Step sine wave
+	SetSinWavePara( 0, CIRCWAVE ) ;
+	
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OscillationDetection
+// Retun Value		: Status
+// Argment Value	: XX% X axis Mechanical Stroke, XX% Y axis Mechanical Stroke
+// Explanation		: Sine Wave Test Function
+// History			: First edition 		
+//********************************************************************************
+#define	OSCILLATION_THRESHOLD	0x01000000
+UINT8	OscillationDetection( INT8 sc_offset_x, INT8 sc_offset_y, UINT16 us_wait_time )
+{
+	UINT16	us_amplitude_x, us_amplitude_y ;
+	INT32	sl_offset_x, sl_offset_y ;
+	UINT8	uc_status = SUCCESS ;
+	INT32	sl_ach_max, sl_ach_min, sl_bch_max, sl_bch_min ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_ON ) ;
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;
+
+	// Add Offset
+	if( StAdjPar.StHalAdj.UsHlxMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlxMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlxMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlxMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlxMna ;
+	}
+	
+	us_amplitude_x	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+
+	if( StAdjPar.StHalAdj.UsHlyMxa > 32767 ) {
+		sl_ach_max	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMxa ;
+	} else {
+		sl_ach_max	= ( INT32 )StAdjPar.StHalAdj.UsHlyMxa ;
+	}
+	
+	if( StAdjPar.StHalAdj.UsHlyMna > 32767 ) {
+		sl_ach_min	= ( INT32 )0xFFFF0000 | StAdjPar.StHalAdj.UsHlyMna ;
+	} else {
+		sl_ach_min	= ( INT32 )StAdjPar.StHalAdj.UsHlyMna ;
+	}
+	
+	us_amplitude_y	= ( UINT16 )( ( sl_ach_max - sl_ach_min ) / 2 ) ;
+	
+	sl_offset_x	= ( UINT32 )( ( UINT32 )us_amplitude_x * sc_offset_x / 100 ) << 16 ;
+	sl_offset_y	= ( UINT32 )( ( UINT32 )us_amplitude_y * sc_offset_y / 100 ) << 16 ;
+	TRACE( "Offset X = %x\n", sl_offset_x ) ;
+	TRACE( "Offset Y = %x\n", sl_offset_y ) ;
+
+	RamWrite32A( HALL_RAM_GYROX_OUT, ( UINT32 )sl_offset_x ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, ( UINT32 )sl_offset_y ) ;
+
+	WitTim( 100 ) ;
+
+	RamWrite32A( HALL_RAM_GYROX_OUT, 0 ) ;
+	RamWrite32A( HALL_RAM_GYROY_OUT, 0 ) ;
+
+	WitTim( us_wait_time ) ;
+
+	// Measurement initialize
+	MesFil( NOISE ) ;
+	
+	// Start peak to peak measurement
+	MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;
+	
+	MeasureWait() ;
+	
+	// Check Oscillation
+	RamRead32A( StMeasFunc_MFA_SiMax1, &sl_ach_max ) ;
+	RamRead32A( StMeasFunc_MFA_SiMin1, &sl_ach_min ) ;
+	RamRead32A( StMeasFunc_MFB_SiMax2, &sl_bch_max ) ;
+	RamRead32A( StMeasFunc_MFB_SiMin2, &sl_bch_min ) ;
+	TRACE( "sl_ach_max = %x\n", sl_ach_max ) ;
+	TRACE( "sl_ach_min = %x\n", sl_ach_min ) ;
+	TRACE( "sl_bch_max = %x\n", sl_bch_max ) ;
+	TRACE( "sl_bch_min = %x\n", sl_bch_min ) ;
+	
+	if( ( ( sl_ach_max - sl_ach_min ) > OSCILLATION_THRESHOLD ) || ( ( sl_bch_max - sl_bch_min ) > OSCILLATION_THRESHOLD ) ) {
+		uc_status	= FAILURE ;
+	}
+	
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OIS_PosMes_by_AF
+// Retun Value		: Status
+// Argment Value	: None
+// Explanation		: OIS Position Measurement by AF Function
+// History			: First edition 		
+//********************************************************************************
+#define	OIS_POSITION_THRESHOLD	0x15000000
+UINT16	Us_Af_Position[ 9 ]	= { 0x0000, 0x0080, 0x0100, 0x0180, 0x0200, 0x0280, 0x0300, 0x0380, 0x03FF } ;
+UINT32	UlBufDat[ 64 ] ;							//!< Calibration data write buffer(256 bytes)
+extern void ReadCalDataEP3( UINT32 *BufDat, UINT32 *ChkSum );
+extern UINT8 EraseCalDataEP3( void );
+extern UINT8 WriteCalDataEP3( UINT32 *BufDat, UINT32 *ChkSum );
+INT32	Sl_Hall_X_by_AF[ 9 ] ;
+INT32	Sl_Hall_Y_by_AF[ 9 ] ;
+INT32	Sl_Hall_X_Slope_by_AF[ 8 ] ;
+INT32	Sl_Hall_Y_Slope_by_AF[ 8 ] ;
+
+UINT8	OIS_PosMes_by_AF( void )
+{
+	UINT8		uc_status, i ;
+	INT32		sl_hall_x[ 9 ], sl_hall_y[ 9 ], sl_default_x, sl_default_y ;
+	UnllnVal	StMeasValueA, StMeasValueB ;
+	UINT32		UiChkSum1, UiChkSum2 ;
+	UINT32		UlSrvStat, UlOisStat ;
+
+	// Initialize
+	uc_status	= RtnCen( BOTH_OFF ) ;														// X,Y Servo Off
+	
+	if( uc_status != SUCCESS ) {
+		return( uc_status ) ;
+	}
+	
+	OisDis() ;																				// OIS disable
+
+	MesFil( NOISE ) ;																		// Measure filter setting
+
+	// Measure default position
+	WitTim( 100 ) ;																		// Wait 100ms
+	
+	MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;							// Measurement Starting
+	
+	MeasureWait() ;																		// Wait for finishing measure
+
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;		// X axis
+	RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;		// Y axis
+	RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+	sl_default_x	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) ;
+	sl_default_y	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) ;
+	
+	// OIS position measurement while moving AF
+	for( i = 0 ; i < 9 ; i++ ) {
+		// Please insert AF moving code here
+
+		WitTim( 100 ) ;																		// Wait 100ms
+		
+		MeasureStart( 1024, HALL_RAM_HXIDAT, HALL_RAM_HYIDAT ) ;							// Measurement Starting
+		
+		MeasureWait() ;																		// Wait for finishing measure
+
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1, &StMeasValueA.StUllnVal.UlLowVal ) ;		// X axis
+		RamRead32A( StMeasFunc_MFA_LLiIntegral1 + 4, &StMeasValueA.StUllnVal.UlHigVal ) ;
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2, &StMeasValueB.StUllnVal.UlLowVal ) ;		// Y axis
+		RamRead32A( StMeasFunc_MFB_LLiIntegral2 + 4, &StMeasValueB.StUllnVal.UlHigVal ) ;
+
+		sl_hall_x[ i ]	= ( INT32 )( ( INT64 )StMeasValueA.UllnValue / 1024 ) - sl_default_x ;
+		sl_hall_y[ i ]	= ( INT32 )( ( INT64 )StMeasValueB.UllnValue / 1024 ) - sl_default_y ;
+	}
+	
+	for( i = 1 ; i < 9 ; i++ ) {
+		if( abs( sl_hall_x[ i ] - sl_hall_x[ i - 1 ] ) > OIS_POSITION_THRESHOLD ) {
+			return( FAILURE ) ;
+		}
+
+		if( abs( sl_hall_y[ i ] - sl_hall_y[ i - 1 ] ) > OIS_POSITION_THRESHOLD ) {
+			return( FAILURE ) ;
+		}
+	}
+	
+	// Store measurement results in NVR2
+//------------------------------------------------------------------------------------------------
+// Servo Off & Get OIS enable status (for F40)
+//------------------------------------------------------------------------------------------------
+	RamRead32A( CMD_RETURN_TO_CENTER , &UlSrvStat ) ;
+	RamRead32A( CMD_OIS_ENABLE , &UlOisStat ) ;
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+//------------------------------------------------------------------------------------------------
+// Backup ALL Calibration data
+//------------------------------------------------------------------------------------------------
+//	ReadCalDataF40(UlBufDat, &UiChkSum2 );
+	ReadCalDataEP3( (UINT32 *)&UlBufDat, &UiChkSum2 );
+//------------------------------------------------------------------------------------------------
+// Sector erase NVR2 Calibration area
+//------------------------------------------------------------------------------------------------
+//	uc_status = EraseCalDataF40();
+	uc_status = EraseCalDataEP3();
+	if ( uc_status == 0 ) {
+//------------------------------------------------------------------------------------------------
+// Calibration Status flag set
+//------------------------------------------------------------------------------------------------
+		UlBufDat[0] &= ~OIS_POS_FLG ;
+//------------------------------------------------------------------------------------------------
+// Set Calibration data
+//------------------------------------------------------------------------------------------------
+		UlBufDat[ OIS_POS_BY_AF_X1 ]	= ( UINT32 )sl_hall_x[ 0 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X2 ]	= ( UINT32 )sl_hall_x[ 1 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X3 ]	= ( UINT32 )sl_hall_x[ 2 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X4 ]	= ( UINT32 )sl_hall_x[ 3 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X5 ]	= ( UINT32 )sl_hall_x[ 4 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X6 ]	= ( UINT32 )sl_hall_x[ 5 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X7 ]	= ( UINT32 )sl_hall_x[ 6 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X8 ]	= ( UINT32 )sl_hall_x[ 7 ] ;
+		UlBufDat[ OIS_POS_BY_AF_X9 ]	= ( UINT32 )sl_hall_x[ 8 ] ;
+
+		UlBufDat[ OIS_POS_BY_AF_Y1 ]	= ( UINT32 )sl_hall_y[ 0 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y2 ]	= ( UINT32 )sl_hall_y[ 1 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y3 ]	= ( UINT32 )sl_hall_y[ 2 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y4 ]	= ( UINT32 )sl_hall_y[ 3 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y5 ]	= ( UINT32 )sl_hall_y[ 4 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y6 ]	= ( UINT32 )sl_hall_y[ 5 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y7 ]	= ( UINT32 )sl_hall_y[ 6 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y8 ]	= ( UINT32 )sl_hall_y[ 7 ] ;
+		UlBufDat[ OIS_POS_BY_AF_Y9 ]	= ( UINT32 )sl_hall_y[ 8 ] ;
+
+//------------------------------------------------------------------------------------------------
+// Write Hall calibration data
+//------------------------------------------------------------------------------------------------
+//		WriteCalDataF40( UlBufDat, &UiChkSum1 );							// NVR2‚Ö’²�®’l‚ðwrite‚µCheckSum‚ðŒvŽZ
+		WriteCalDataEP3( UlBufDat, &UiChkSum1 );
+//------------------------------------------------------------------------------------------------
+// Calculate calibration data checksum
+//------------------------------------------------------------------------------------------------
+//		ReadCalDataF40( UlBufDat, &UiChkSum2 );								// NVR2‚Öwrite‚³‚ê‚Ä‚¢‚é’²�®’l‚ÌCheckSum‚ðŒvŽZ
+		ReadCalDataEP3( UlBufDat, &UiChkSum2 );
+
+		if( UiChkSum1 != UiChkSum2 ) {
+			uc_status	= 0x10 ;											// CheckSumƒGƒ‰�[
+		}
+	}
+//------------------------------------------------------------------------------------------------
+// Resume
+//------------------------------------------------------------------------------------------------
+	if( !UlSrvStat ) {
+		RtnCen( BOTH_OFF ) ;
+	} else if( UlSrvStat == 3 ) {
+		RtnCen( BOTH_ON ) ;
+	} else {
+		RtnCen( UlSrvStat ) ;
+	}
+
+	if( UlOisStat != 0 )	OisEna() ;
+
+	return( uc_status ) ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: Read_OIS_PosData_by_AF
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Read OIS Position Data by AF Function
+// History			: First edition 		
+//********************************************************************************
+void	Read_OIS_PosData_by_AF( void )
+{
+	UINT32		UiChkSum ;
+	UINT32		UlSrvStat, UlOisStat ;
+	UINT8		i ;
+
+//------------------------------------------------------------------------------------------------
+// Servo Off & Get OIS enable status (for F40)
+//------------------------------------------------------------------------------------------------
+	RamRead32A( CMD_RETURN_TO_CENTER , &UlSrvStat ) ;
+	RamRead32A( CMD_OIS_ENABLE , &UlOisStat ) ;
+	RtnCen( BOTH_OFF ) ;		// Both OFF
+//------------------------------------------------------------------------------------------------
+// Backup ALL Calibration data
+//------------------------------------------------------------------------------------------------
+//	ReadCalDataF40(UlBufDat, &UiChkSum );
+	ReadCalDataEP3(UlBufDat, &UiChkSum );
+//------------------------------------------------------------------------------------------------
+// Read Calibration data
+//------------------------------------------------------------------------------------------------
+	Sl_Hall_X_by_AF[ 0 ]	= UlBufDat[ OIS_POS_BY_AF_X1 ] ;
+	Sl_Hall_X_by_AF[ 1 ]	= UlBufDat[ OIS_POS_BY_AF_X2 ] ;
+	Sl_Hall_X_by_AF[ 2 ]	= UlBufDat[ OIS_POS_BY_AF_X3 ] ;
+	Sl_Hall_X_by_AF[ 3 ]	= UlBufDat[ OIS_POS_BY_AF_X4 ] ;
+	Sl_Hall_X_by_AF[ 4 ]	= UlBufDat[ OIS_POS_BY_AF_X5 ] ;
+	Sl_Hall_X_by_AF[ 5 ]	= UlBufDat[ OIS_POS_BY_AF_X6 ] ;
+	Sl_Hall_X_by_AF[ 6 ]	= UlBufDat[ OIS_POS_BY_AF_X7 ] ;
+	Sl_Hall_X_by_AF[ 7 ]	= UlBufDat[ OIS_POS_BY_AF_X8 ] ;
+	Sl_Hall_X_by_AF[ 8 ]	= UlBufDat[ OIS_POS_BY_AF_X9 ] ;
+
+	Sl_Hall_Y_by_AF[ 0 ]	= UlBufDat[ OIS_POS_BY_AF_Y1 ] ;
+	Sl_Hall_Y_by_AF[ 1 ]	= UlBufDat[ OIS_POS_BY_AF_Y2 ] ;
+	Sl_Hall_Y_by_AF[ 2 ]	= UlBufDat[ OIS_POS_BY_AF_Y3 ] ;
+	Sl_Hall_Y_by_AF[ 3 ]	= UlBufDat[ OIS_POS_BY_AF_Y4 ] ;
+	Sl_Hall_Y_by_AF[ 4 ]	= UlBufDat[ OIS_POS_BY_AF_Y5 ] ;
+	Sl_Hall_Y_by_AF[ 5 ]	= UlBufDat[ OIS_POS_BY_AF_Y6 ] ;
+	Sl_Hall_Y_by_AF[ 6 ]	= UlBufDat[ OIS_POS_BY_AF_Y7 ] ;
+	Sl_Hall_Y_by_AF[ 7 ]	= UlBufDat[ OIS_POS_BY_AF_Y8 ] ;
+	Sl_Hall_Y_by_AF[ 8 ]	= UlBufDat[ OIS_POS_BY_AF_Y9 ] ;
+
+//------------------------------------------------------------------------------------------------
+// Calculate the slope
+//------------------------------------------------------------------------------------------------
+	for( i = 0 ; i < 8 ; i++ ) {
+		Sl_Hall_X_Slope_by_AF[ i ] = ( INT32 )( ( Sl_Hall_X_by_AF[ i + 1 ] - Sl_Hall_X_by_AF[ i ] ) / ( Us_Af_Position[ i + 1 ] - Us_Af_Position[ i ] ) ) ;
+		Sl_Hall_Y_Slope_by_AF[ i ] = ( INT32 )( ( Sl_Hall_Y_by_AF[ i + 1 ] - Sl_Hall_Y_by_AF[ i ] ) / ( Us_Af_Position[ i + 1 ] - Us_Af_Position[ i ] ) ) ;
+	}
+
+//------------------------------------------------------------------------------------------------
+// Resume
+//------------------------------------------------------------------------------------------------
+	if( !UlSrvStat ) {
+		RtnCen( BOTH_OFF ) ;
+	} else if( UlSrvStat == 3 ) {
+		RtnCen( BOTH_ON ) ;
+	} else {
+		RtnCen( UlSrvStat ) ;
+	}
+
+	if( UlOisStat != 0 )	OisEna() ;
+
+	return ;
+}
+
+
+
+//********************************************************************************
+// Function Name 	: OIS_Pos_Correction_by_AF
+// Retun Value		: None
+// Argment Value	: AF Code
+// Explanation		: OIS Position Correction by AF Function
+// History			: First edition 		
+//********************************************************************************
+void	OIS_Pos_Correction_by_AF( UINT16	us_af_code )
+{
+	UINT8	i ;
+	INT32	sl_offset_x, sl_offset_y ;
+
+	for( i = 1 ; i < 9 ; i++ ) {
+		if( us_af_code < Us_Af_Position[ i ] ) {
+			sl_offset_x	= ( INT32 )( Sl_Hall_X_Slope_by_AF[ i - 1 ] * ( us_af_code - Us_Af_Position[ i - 1 ] ) + Sl_Hall_X_by_AF[ i - 1 ] ) ;
+			sl_offset_y	= ( INT32 )( Sl_Hall_Y_Slope_by_AF[ i - 1 ] * ( us_af_code - Us_Af_Position[ i - 1 ] ) + Sl_Hall_Y_by_AF[ i - 1 ] ) ;
+			break ;
+		}
+	}
+	
+	RamWrite32A( HALL_RAM_HXOFF1, sl_offset_x ) ;
+	RamWrite32A( HALL_RAM_HYOFF1, sl_offset_y ) ;
+}
+
+
+#if ((SELECT_VENDOR & 0x80 ) != 0x80)
+//********************************************************************************
+// Function Name 	: CalcSetMizxAndLinearityData
+// Retun Value		: 0:OK, 1:NG
+// Argment Value	: UcMode	0:disable	1:enable
+//					: mlLinearityValue *linval
+// Explanation		: Flash write linearity correction data function
+// History			: First edition
+//********************************************************************************
+#define N 7  /* ƒf�[ƒ^�” */
+
+UINT8	CalcSetMizxAndLinearityData( mlLinearityValue *linval ,  mlMixingValue *mixval )
+{
+	double		*pPosX, *pPosY;
+	int i;
+ 	double Xa = 0, Ya = 0;
+  	double Xsum_xy = 0, Xsum_x = 0, Xsum_y = 0, Xsum_x2 = 0;
+  	double Ysum_xy = 0, Ysum_x = 0, Ysum_y = 0, Ysum_x2 = 0;
+	UINT32		UlReadVal ;
+	UINT32		UiChkSum1,	UiChkSum2, UlSrvStat,	UlOisStat ;
+	UINT8		ans;
+	
+	// **************************************************
+	// �Å�¬2�æ–@
+	// **************************************************
+#ifdef __MIX_LIB_METHOD__		// TESTAPP library method
+	for (i=0; i<N; i++) {
+		Xsum_xy += i * mixval->XonXmove[i];
+		Xsum_x  += i;
+		Xsum_y  += mixval->XonXmove[i];
+		
+		Ysum_xy += i * mixval->YonXmove[i];
+		Ysum_y  += mixval->YonXmove[i];
+	}
+ 	Xa = ((N * Ysum_xy) - (Xsum_x * Ysum_y)) / ((N * Xsum_xy) - (Xsum_x * Xsum_y));
+
+  	Xsum_xy = Xsum_x = Xsum_y = Xsum_x2 = 0;
+  	Ysum_xy = Ysum_x = Ysum_y = Ysum_x2 = 0;
+
+	for (i=0; i<N; i++) {
+		Xsum_xy += i * mixval->XonYmove[i];
+		Xsum_x  += i;
+		Xsum_y  += mixval->XonYmove[i];
+
+		Ysum_xy += i * mixval->YonYmove[i];
+		Ysum_y  += mixval->YonYmove[i];
+	}
+ 	Ya = ((N * Xsum_xy) - (Xsum_x * Xsum_y)) / ((N * Ysum_xy) - (Xsum_x * Ysum_y));
+#else
+	for (i=0; i<N; i++) {
+		Xsum_xy += mixval->XonXmove[i] * mixval->YonXmove[i];
+		Xsum_x  += mixval->XonXmove[i];
+		Xsum_y  += mixval->YonXmove[i];
+		Xsum_x2 += pow(mixval->XonXmove[i], 2);
+
+		Ysum_xy += mixval->YonYmove[i] * mixval->XonYmove[i];
+		Ysum_x  += mixval->YonYmove[i];
+		Ysum_y  += mixval->XonYmove[i];
+		Ysum_x2 += pow(mixval->YonYmove[i], 2);
+	}
+ 	Xa = ((N * Xsum_xy) - (Xsum_x * Xsum_y)) / ((N * Xsum_x2) - pow(Xsum_x, 2));
+ 	Ya = ((N * Ysum_xy) - (Ysum_x * Ysum_y)) / ((N * Ysum_x2) - pow(Ysum_x, 2));
+#endif
+
+TRACE("Xa = %f\n", Xa);
+TRACE("Ya = %f\n", Ya);
+
+	// **************************************************
+	// MIXINGŒW�”ŒvŽZ
+	// **************************************************
+TRACE("degreeX  = %f\n", -atan(Xa)*180/3.14159265358979323846 );
+TRACE("degreeY  = %f\n", +atan(Ya)*180/3.14159265358979323846 );
+#if (SLT_XY_SWAP ==1)
+	mixval->radianX = +atan(Ya);
+	mixval->radianY = -atan(Xa);
+#else
+	mixval->radianX = -atan(Xa);
+	mixval->radianY = +atan(Ya);
+#endif
+//TRACE("radianX  = %f\n", mixval->radianX);
+//TRACE("radianY  = %f\n", mixval->radianY);
+
+	mixval->hx45x = +(cos(mixval->radianY) / cos(mixval->radianX - mixval->radianY));
+    mixval->hx45y = -(sin(mixval->radianY) / cos(mixval->radianX - mixval->radianY));
+//    mixval->hy45y = -(cos(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+//    mixval->hy45x = -(sin(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+    mixval->hy45y = +(cos(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+    mixval->hy45x = +(sin(mixval->radianX) / cos(mixval->radianX - mixval->radianY));
+
+	mixval->hxsx = (unsigned char)abs(mixval->hx45x);                                     // >1‚È‚ç‚΃Vƒtƒg�”‚Æ‚µ‚Ä�Ý’è
+	mixval->hysx = (unsigned char)abs(mixval->hy45y);                                     // >1‚È‚ç‚΃Vƒtƒg�”‚Æ‚µ‚Ä�Ý’è
+
+    mixval->hx45x = mixval->hx45x / pow(2, (double)mixval->hxsx);        // ƒVƒtƒg‚ð‰Á–¡‚µ‚Ä�ÄŒvŽZ
+    mixval->hy45y = mixval->hy45y / pow(2, (double)mixval->hysx);        // ƒVƒtƒg‚ð‰Á–¡‚µ‚Ä�ÄŒvŽZ
+
+TRACE("hx45x  = %f\n", mixval->hx45x);
+TRACE("hx45y  = %f\n", mixval->hx45y);
+TRACE("hy45y  = %f\n", mixval->hy45y);
+TRACE("hy45x  = %f\n", mixval->hy45x);
+TRACE("hxsx  = %02X\n", mixval->hxsx);
+TRACE("hysx  = %02X\n", mixval->hysx);
+
+	mixval->hx45xL = (long)(mixval->hx45x * 0x7FFFFFFF);
+	mixval->hx45yL = (long)(mixval->hx45y * 0x7FFFFFFF);
+	mixval->hy45yL = (long)(mixval->hy45y * 0x7FFFFFFF);
+	mixval->hy45xL = (long)(mixval->hy45x * 0x7FFFFFFF);
+
+TRACE("hx45xL  = %08X\n", mixval->hx45xL);
+TRACE("hx45yL  = %08X\n", mixval->hx45yL);
+TRACE("hy45yL  = %08X\n", mixval->hy45yL);
+TRACE("hy45xL  = %08X\n", mixval->hy45xL);
+
+	// **************************************************
+	// RAM‚ɃZƒbƒg‚·‚é
+	// **************************************************
+	RamWrite32A( HF_hx45x, mixval->hx45xL ) ; 
+	RamWrite32A( HF_hx45y, mixval->hx45yL ) ; 
+	RamWrite32A( HF_hy45y, mixval->hy45yL ) ; 
+	RamWrite32A( HF_hy45x, mixval->hy45xL ) ; 
+	RamWrite32A( HF_ShiftX, ( (UINT32) mixval->hxsx << 0) | ((UINT32)mixval->hysx << 8) ) ; 
+
+//------------------------------------------------------------------------------------------------
+// Servo Off & Get OIS enable status (for F40)
+//------------------------------------------------------------------------------------------------
+	RamRead32A( CMD_RETURN_TO_CENTER , &UlSrvStat ) ;
+	RamRead32A( CMD_OIS_ENABLE , &UlOisStat ) ;
+	RtnCen( BOTH_OFF ) ;													// Both OFF
+//------------------------------------------------------------------------------------------------
+// Backup ALL Calibration data
+//------------------------------------------------------------------------------------------------
+//	ReadCalDataF40( UlBufDat, &UiChkSum2 );
+	ReadCalDataEP3( UlBufDat, &UiChkSum2 );
+//------------------------------------------------------------------------------------------------
+// Sector erase NVR2 Calibration area
+//------------------------------------------------------------------------------------------------
+//	ans = EraseCalDataF40();
+	ans = EraseCalDataEP3();
+	if ( ans == 0 ){
+//------------------------------------------------------------------------------------------------
+// Calibration Status flag set
+//------------------------------------------------------------------------------------------------
+		UlReadVal = UlBufDat[0];											// Flash‚æ‚èread‚µ‚½CalibrationStatus‚ðƒZƒbƒg
+		UlReadVal &= ~CROS_TALK_FLG;
+		UlReadVal &= ~HLLN_CALB_FLG;
+//------------------------------------------------------------------------------------------------
+// Set Calibration data
+//------------------------------------------------------------------------------------------------
+		UlBufDat[ 0 ] 	= UlReadVal;										// Calibration Status
+#if (SLT_XY_SWAP ==1)
+		pPosX = linval->positionY;
+		pPosY = linval->positionX;
+		UlBufDat[ LN_STEP ]	=  (SLT_OFFSET_VERTICAL << 16) | (SLT_OFFSET_HORIZONTAL & 0x0000FFFF );				// Step
+#else
+		pPosX = linval->positionX;
+		pPosY = linval->positionY;
+		UlBufDat[ LN_STEP ]	=  (SLT_OFFSET_HORIZONTAL << 16) | (SLT_OFFSET_VERTICAL & 0x0000FFFF);					// Step
+#endif
+
+
+#ifdef	_BIG_ENDIAN_
+		UlBufDat[ LN_POS1 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 2
+		UlBufDat[ LN_POS2 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 2
+		UlBufDat[ LN_POS3 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 3
+		UlBufDat[ LN_POS4 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 4
+		UlBufDat[ LN_POS5 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 5
+		UlBufDat[ LN_POS6 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 6
+		UlBufDat[ LN_POS7 ]	= (UINT32)(*pPosX * 10) | ((UINT32)(*pPosY *10) << 16); pPosX++; pPosY++;		// Position 7
+#else
+		UlBufDat[ LN_POS1 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 1
+		UlBufDat[ LN_POS2 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 2
+		UlBufDat[ LN_POS3 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 3
+		UlBufDat[ LN_POS4 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 4
+		UlBufDat[ LN_POS5 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 5
+		UlBufDat[ LN_POS6 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 6
+		UlBufDat[ LN_POS7 ]	= (UINT32)(*pPosY * 10) | ((UINT32)(*pPosX *10) << 16); pPosX++; pPosY++;		// Position 7
+#endif
+//		UlBufDat[ LN_STEP ]	= ((linval->dacY[1] - linval->dacY[0]) >> 16) | ((linval->dacX[1] - linval->dacX[0]) & 0xFFFF0000);					// Step
+//  Horisontal 16, Vertical 16bit 
+
+//TRACE("STEP=%d (0x%x)\n", (int)UlBufDat[ LN_STEP ], UlBufDat[ LN_STEP ] );
+
+		UlBufDat[ MIXING_HX45X	 ] 	= mixval->hx45xL;
+		UlBufDat[ MIXING_HX45Y	 ] 	= mixval->hx45yL;
+		UlBufDat[ MIXING_HY45Y	 ] 	= mixval->hy45yL;
+		UlBufDat[ MIXING_HY45X	 ] 	= mixval->hy45xL ;
+		UlBufDat[ MIXING_HXSX	 ]	= ( ((UINT32) mixval->hxsx << 16) | ((UINT32)mixval->hysx << 0) ) ;
+
+//------------------------------------------------------------------------------------------------
+// Write gyro calibration data
+//------------------------------------------------------------------------------------------------
+//		WriteCalDataF40( UlBufDat, &UiChkSum1 );							// NVR2‚Ö’²�®’l‚ðwrite‚µCheckSum‚ðŒvŽZ
+		WriteCalDataEP3( UlBufDat, &UiChkSum1 );
+//------------------------------------------------------------------------------------------------
+// Calculate calibration data checksum
+//------------------------------------------------------------------------------------------------
+//		ReadCalDataF40( UlBufDat, &UiChkSum2 );								// NVR2‚Öwrite‚³‚ê‚Ä‚¢‚é’²�®’l‚ÌCheckSum‚ðŒvŽZ
+		ReadCalDataEP3( UlBufDat, &UiChkSum2 );
+
+		if(UiChkSum1 != UiChkSum2 ){
+			TRACE("CheckSum error\n");
+			TRACE("UiChkSum1 = %08X, UiChkSum2 = %08X\n",(UINT32)UiChkSum1, (UINT32)UiChkSum2 );
+			ans = 0x10;														// CheckSumƒGƒ‰�[
+		}
+		TRACE("CheckSum OK\n");
+		TRACE("UiChkSum1 = %08X, UiChkSum2 = %08X\n",(UINT32)UiChkSum1, (UINT32)UiChkSum2 );
+	}
+//------------------------------------------------------------------------------------------------
+// Resume
+//------------------------------------------------------------------------------------------------
+	if( !UlSrvStat ) {
+		RtnCen( BOTH_OFF ) ;
+	} else if( UlSrvStat == 3 ) {
+		RtnCen( BOTH_ON ) ;
+	} else {
+		RtnCen( UlSrvStat ) ;
+	}
+
+	if( UlOisStat != 0)               OisEna() ;
+
+	return( ans );															// CheckSum OK
+
+}
+#endif
+
+//********************************************************************************
+// Function Name 	: Read_BMI260_CHIP_ID
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Read CHIP_ID from BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 Read_BMI260_CHIP_ID( void )
+{
+	unsigned char ReadData;
+
+	RamRead_260( CHIP_ID_260, (unsigned char *)&ReadData );
+
+	return ReadData;
+}
+
+//********************************************************************************
+// Function Name 	: Init_BMI260
+// Retun Value		: None
+// Argment Value	: None
+// Explanation		: Initialize BOSCH BMI260
+// History			: First edition
+//********************************************************************************
+UINT8 Init_BMI260( void )
+{
+	unsigned char WriteData;
+	unsigned char ReadData;
+	char          Count;
+	unsigned char Status = FAILURE;									// 0x01=NG  0x00=OK
+
+	// PWR_CTRL(0x7D) to set bit ACC_EN and GYR_EN to neable them
+	Count = 0;
+	do {
+		WriteData = 0x0E;
+		RamWrite_260( PWR_CTRL_260, WriteData );	
+		RamRead_260( PWR_CTRL_260, (unsigned char *)&ReadData );
+		if( WriteData == ReadData ) {
+			Status = SUCCESS;
+			break;
+		}
+	} while( Count++ < 10 );
+
+	if( Status == FAILURE ) return Status;
+
+	// Please set as necessary.
+	// Setting accelerometer interface
+//	RamWrite_260( ACC_CONF_260, 0xA8);		// ACC_CONF(0x40) to set accelerometer interface ODR bandwidth
+	RamWrite_260( ACC_RANGE_260, 0x00);		// ACC_RANGE(0x41) to set accelerometer interface range
+//
+	// Setting gyro interface
+	RamWrite_260( GYR_RANGE_260, 0x04);		// GYR_RANGE(0x43) to select OIS RANGE
+//	RamWrite_260( GYR_CONF_260, 0xA9);		// GYR_CONF(0x42)
+
+//	RamWrite_260( PWR_CONF_260, 0x02);		// PWR_CONF(0x7C)
+
+	// IF_CONF(0x6B) to select OIS interface as 3-wire or 4-wire SPI and enable OIS function
+	RamWrite_260( IF_CONF_260, 0x10 );
+
+	return Status;
+}
+
+
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=  ‚±‚±‚Ü‚Å by K.Otake                                                                         +=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+//+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=+=
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.c
new file mode 100644
index 0000000000000000000000000000000000000000..777e40cd0481345fbc3e29b3af314bbe816ba821
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.c
@@ -0,0 +1,445 @@
+/**
+ * @brief		FRA measurement command for LC898123 F40
+ *
+ * @author		Copyright (C) 2016, ON Semiconductor, all right reserved.
+ *
+ * @file		OisFRA.c
+ * @date		svn:$Date:: 2016-06-17 16:42:32 +0900#$
+ * @version	svn:$Revision: 54 $
+ * @attention
+ **/
+
+//**************************
+//	Include Header File
+//**************************
+#define		__OISFRA__
+
+#include	<math.h>
+#include	"Ois.h"
+#include	"OisAPI.h"
+#include	"OisFRA.h"
+
+
+//#define ACT_THROUGH_CLOSE		// for ball type
+//#define CLOSED_RESPONSE			// for openloop measurement
+
+//****************************************************
+//	CUSTOMER NECESSARY CREATING LIST
+//****************************************************
+/* for I2C communication */
+extern	void RamWrite32A( INT32, INT32 );
+extern 	void RamRead32A( UINT16, void * );
+/* for Wait timer [Need to adjust for your system] */
+extern void	WitTim( UINT16 );
+
+//**************************
+//	External Function Prototype
+//**************************
+extern void	SetSineWave(   UINT8 , UINT8 );
+extern void	SetSinWavGenInt( void );
+extern void	SetTransDataAdr( UINT16, UINT32  ) ;
+extern void	MeasureWait( void ) ;
+extern void	ClrMesFil( void ) ;
+extern void	SetWaitTime( UINT16 ) ;
+
+#ifdef ACT_THROUGH_CLOSE
+UINT_32 BackupParameter[30];
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : SetThroughParameter 		                                         */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+void SetThroughParameter(UINT_8	UcDirSel )
+{
+	if( UcDirSel == X_DIR ) {
+		BackupParameter[29] = X_DIR;
+		RamRead32A( HallFilterCoeffX_hxdgain0, &BackupParameter[0]);
+		RamRead32A( HallFilterCoeffX_hxpgain0, &BackupParameter[1]);
+		RamRead32A( HallFilterCoeffX_hxpgain1, &BackupParameter[2]);
+		RamRead32A( HallFilterCoeffX_hxigain0, &BackupParameter[3]);
+		RamRead32A( HallFilterCoeffX_hxgain0, &BackupParameter[4]);	
+		RamRead32A( HallFilterShiftX, &BackupParameter[5]);	
+		RamRead32A( (HallFilterShiftX+4), &BackupParameter[6]);	
+		RamRead32A( HallFilterCoeffX_hxsa, &BackupParameter[7]);
+		RamRead32A( HallFilterCoeffX_hxsb, &BackupParameter[8]);
+		RamRead32A( HallFilterCoeffX_hxsc, &BackupParameter[9]);
+		RamRead32A( HallFilterCoeffX_hxoa, &BackupParameter[10]);
+		RamRead32A( HallFilterCoeffX_hxob, &BackupParameter[11]);
+		RamRead32A( HallFilterCoeffX_hxoc, &BackupParameter[12]);
+		RamRead32A( HallFilterCoeffX_hxod, &BackupParameter[13]);
+		RamRead32A( HallFilterCoeffX_hxoe, &BackupParameter[14]);
+		RamRead32A( HallFilterCoeffX_hxpa, &BackupParameter[15]);
+		RamRead32A( HallFilterCoeffX_hxpb, &BackupParameter[16]);
+		RamRead32A( HallFilterCoeffX_hxpc, &BackupParameter[17]);
+		RamRead32A( HallFilterCoeffX_hxpd, &BackupParameter[18]);
+		RamRead32A( HallFilterCoeffX_hxpe, &BackupParameter[19]);
+
+		RamWrite32A( HallFilterCoeffX_hxdgain0, 0x00000000);	//RAMW32	80EC	00000000
+		RamWrite32A( HallFilterCoeffX_hxpgain0, 0x7fffffff);	//RAMW32	80D8	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxpgain1, 0x7fffffff);	//RAMW32	80E4	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxigain0, 0x00000000);	//RAMW32	80E8	00000000
+		RamWrite32A( HallFilterCoeffX_hxgain0, 0x7fffffff);		//RAMW32	80F0	7fffffff
+		RamWrite32A( HallFilterShiftX, 0x00000000);				//RAMW32	81F8	00000000
+		RamWrite32A( (HallFilterShiftX+4), 0x00000000);			//RAMW32	81FC	00000000
+		RamWrite32A( HallFilterCoeffX_hxsa, 0x7fffffff);		//RAMW32	8100	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxsb, 0x00000000);		//RAMW32	80F8	00000000
+		RamWrite32A( HallFilterCoeffX_hxsc, 0x00000000);		//RAMW32	80FC	00000000
+		RamWrite32A( HallFilterCoeffX_hxoa, 0x7fffffff);		//RAMW32	8114	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxob, 0x00000000);		//RAMW32	8104	00000000
+		RamWrite32A( HallFilterCoeffX_hxoc, 0x00000000);		//RAMW32	8108	00000000
+		RamWrite32A( HallFilterCoeffX_hxod, 0x00000000);		//RAMW32	810C	00000000
+		RamWrite32A( HallFilterCoeffX_hxoe, 0x00000000);		//RAMW32	8110	00000000
+		RamWrite32A( HallFilterCoeffX_hxpa, 0x7fffffff);		//RAMW32	8128	7fffffff
+		RamWrite32A( HallFilterCoeffX_hxpb, 0x00000000);		//RAMW32	8118	00000000
+		RamWrite32A( HallFilterCoeffX_hxpc, 0x00000000);		//RAMW32	811C	00000000
+		RamWrite32A( HallFilterCoeffX_hxpd, 0x00000000);		//RAMW32	8120	00000000
+		RamWrite32A( HallFilterCoeffX_hxpe, 0x00000000);		//RAMW32	8124	00000000
+	}else if( UcDirSel == Y_DIR ){
+		BackupParameter[29] = Y_DIR;
+		RamRead32A( HallFilterCoeffY_hydgain0, &BackupParameter[0]);
+		RamRead32A( HallFilterCoeffY_hypgain0, &BackupParameter[1]);
+		RamRead32A( HallFilterCoeffY_hypgain1, &BackupParameter[2]);
+		RamRead32A( HallFilterCoeffY_hyigain0, &BackupParameter[3]);
+		RamRead32A( HallFilterCoeffY_hygain0, &BackupParameter[4]);
+		RamRead32A( HallFilterShiftY, &BackupParameter[5]);	
+		RamRead32A( HallFilterCoeffY_hysa, &BackupParameter[6]);
+		RamRead32A( HallFilterCoeffY_hysb, &BackupParameter[7]);
+		RamRead32A( HallFilterCoeffY_hysc, &BackupParameter[8]);
+		RamRead32A( HallFilterCoeffY_hyoa, &BackupParameter[9]);
+		RamRead32A( HallFilterCoeffY_hyob, &BackupParameter[10]);
+		RamRead32A( HallFilterCoeffY_hyoc, &BackupParameter[11]);
+		RamRead32A( HallFilterCoeffY_hyod, &BackupParameter[12]);
+		RamRead32A( HallFilterCoeffY_hyoe, &BackupParameter[13]);
+		RamRead32A( HallFilterCoeffY_hypa, &BackupParameter[14]);
+		RamRead32A( HallFilterCoeffY_hypb, &BackupParameter[15]);
+		RamRead32A( HallFilterCoeffY_hypc, &BackupParameter[16]);
+		RamRead32A( HallFilterCoeffY_hypd, &BackupParameter[17]);
+		RamRead32A( HallFilterCoeffY_hype, &BackupParameter[18]);
+		
+		RamWrite32A( HallFilterCoeffY_hydgain0, 0x00000000);	//RAMW32	8188	00000000
+		RamWrite32A( HallFilterCoeffY_hypgain0, 0x7fffffff);	//RAMW32	8174	7fffffff
+		RamWrite32A( HallFilterCoeffY_hypgain1, 0x7fffffff);	//RAMW32	8180	7fffffff
+		RamWrite32A( HallFilterCoeffY_hyigain0, 0x00000000);	//RAMW32	8184	00000000
+		RamWrite32A( HallFilterCoeffY_hygain0, 0x7fffffff);		//RAMW32	818C	7fffffff
+		RamWrite32A( HallFilterShiftY, 0x00000000);				//RAMW32	8200	00000000
+		RamWrite32A( HallFilterCoeffY_hysa, 0x7fffffff);		//RAMW32	819C	7fffffff
+		RamWrite32A( HallFilterCoeffY_hysb, 0x00000000);		//RAMW32	8194	00000000
+		RamWrite32A( HallFilterCoeffY_hysc, 0x00000000);		//RAMW32	8198	00000000
+		RamWrite32A( HallFilterCoeffY_hyoa, 0x7fffffff);		//RAMW32	81B0	7fffffff
+		RamWrite32A( HallFilterCoeffY_hyob, 0x00000000);		//RAMW32	81A0	00000000
+		RamWrite32A( HallFilterCoeffY_hyoc, 0x00000000);		//RAMW32	81A4	00000000
+		RamWrite32A( HallFilterCoeffY_hyod, 0x00000000);		//RAMW32	81A8	00000000
+		RamWrite32A( HallFilterCoeffY_hyoe, 0x00000000);		//RAMW32	81AC	00000000
+		RamWrite32A( HallFilterCoeffY_hypa, 0x7fffffff);		//RAMW32	81C4	7fffffff
+		RamWrite32A( HallFilterCoeffY_hypb, 0x00000000);		//RAMW32	81B4	00000000
+		RamWrite32A( HallFilterCoeffY_hypc, 0x00000000);		//RAMW32	81B8	00000000
+		RamWrite32A( HallFilterCoeffY_hypd, 0x00000000);		//RAMW32	81BC	00000000
+		RamWrite32A( HallFilterCoeffY_hype, 0x00000000);		//RAMW32	81C0	00000000
+	}else if( UcDirSel == Z_DIR ){
+		}
+	}
+
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : ResetThroughParameter 		                                     */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+void ResetThroughParameter(void)
+{
+	if( BackupParameter[29] == X_DIR ) {
+		RamWrite32A( HallFilterCoeffX_hxdgain0, BackupParameter[0]);
+		RamWrite32A( HallFilterCoeffX_hxpgain0, BackupParameter[1]);
+		RamWrite32A( HallFilterCoeffX_hxpgain1, BackupParameter[2]);
+		RamWrite32A( HallFilterCoeffX_hxigain0, BackupParameter[3]);
+		RamWrite32A( HallFilterCoeffX_hxgain0, BackupParameter[4]);	
+		RamWrite32A( HallFilterShiftX, BackupParameter[5]);	
+		RamWrite32A( (HallFilterShiftX+4), BackupParameter[6]);	
+		RamWrite32A( HallFilterCoeffX_hxsa, BackupParameter[7]);
+		RamWrite32A( HallFilterCoeffX_hxsb, BackupParameter[8]);
+		RamWrite32A( HallFilterCoeffX_hxsc, BackupParameter[9]);
+		RamWrite32A( HallFilterCoeffX_hxoa, BackupParameter[10]);
+		RamWrite32A( HallFilterCoeffX_hxob, BackupParameter[11]);
+		RamWrite32A( HallFilterCoeffX_hxoc, BackupParameter[12]);
+		RamWrite32A( HallFilterCoeffX_hxod, BackupParameter[13]);
+		RamWrite32A( HallFilterCoeffX_hxoe, BackupParameter[14]);
+		RamWrite32A( HallFilterCoeffX_hxpa, BackupParameter[15]);
+		RamWrite32A( HallFilterCoeffX_hxpb, BackupParameter[16]);
+		RamWrite32A( HallFilterCoeffX_hxpc, BackupParameter[17]);
+		RamWrite32A( HallFilterCoeffX_hxpd, BackupParameter[18]);
+		RamWrite32A( HallFilterCoeffX_hxpe, BackupParameter[19]);
+	}else if( BackupParameter[29] == Y_DIR ){
+		RamWrite32A( HallFilterCoeffY_hydgain0, BackupParameter[0]);
+		RamWrite32A( HallFilterCoeffY_hypgain0, BackupParameter[1]);
+		RamWrite32A( HallFilterCoeffY_hypgain1, BackupParameter[2]);
+		RamWrite32A( HallFilterCoeffY_hyigain0, BackupParameter[3]);
+		RamWrite32A( HallFilterCoeffY_hygain0, BackupParameter[4]);
+		RamWrite32A( HallFilterShiftY, BackupParameter[5]);	
+		RamWrite32A( HallFilterCoeffY_hysa, BackupParameter[6]);
+		RamWrite32A( HallFilterCoeffY_hysb, BackupParameter[7]);
+		RamWrite32A( HallFilterCoeffY_hysc, BackupParameter[8]);
+		RamWrite32A( HallFilterCoeffY_hyoa, BackupParameter[9]);
+		RamWrite32A( HallFilterCoeffY_hyob, BackupParameter[10]);
+		RamWrite32A( HallFilterCoeffY_hyoc, BackupParameter[11]);
+		RamWrite32A( HallFilterCoeffY_hyod, BackupParameter[12]);
+		RamWrite32A( HallFilterCoeffY_hyoe, BackupParameter[13]);
+		RamWrite32A( HallFilterCoeffY_hypa, BackupParameter[14]);
+		RamWrite32A( HallFilterCoeffY_hypb, BackupParameter[15]);
+		RamWrite32A( HallFilterCoeffY_hypc, BackupParameter[16]);
+		RamWrite32A( HallFilterCoeffY_hypd, BackupParameter[17]);
+		RamWrite32A( HallFilterCoeffY_hype, BackupParameter[18]);
+	}else if( BackupParameter[29] == Z_DIR ){
+	}
+}
+#endif
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+/* function name    : CoeffGenerate  		                                             */
+/* input parameter  :                                                                    */
+/* output parameter :                                                                    */
+/* comment          : DFT‚ÌŒW�””­�¶    			                                         */
+/*                                                                            2018.01.18 */
+/*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*=*/
+#define	Q31 	( 0x7FFFFFFF )
+#define	Q23 	( 0x007FFFFF )
+#define	Q21 	( 0x001FFFFF )
+#define	PAI 	( 3.14159265358979323846 )
+#define N 		( 2048 )
+int     nDivision;
+
+void CoeffGenerate( double fc )
+{
+	double  df, fs; 
+	int     point, C0, S0, CN, SN;
+	double  theta;			// theta = 2*Pi*f/Fs
+
+	if 		( fc > 40 ){ nDivision = 0; fs = (FS_FREQ    ); }
+	else if ( fc > 20 ){ nDivision = 1; fs = (FS_FREQ / 2); }
+	else if ( fc > 10 ){ nDivision = 2; fs = (FS_FREQ / 4); }
+	else if ( fc >  5 ){ nDivision = 3; fs = (FS_FREQ / 8); }
+	else 			   { nDivision = 4; fs = (FS_FREQ /16); }
+
+	//***** Žæ“¾‚µ‚½Žü”g�”ƒe�[ƒuƒ‹‚©‚ç”»’èƒ|ƒCƒ“ƒg‚Æ”»’ètheta‚ÌŽZ�o *****
+	df = fs / (double)N;									// FFT‚Ì1ƒ|ƒCƒ“ƒg“–‚½‚è‚ÌŽü”g�”
+	point = (int)(fc / df + 0.5);							// ”»’èƒ|ƒCƒ“ƒg‚ÌŽZ�o
+	theta = 2.0 * PAI * (double)point * df / fs;			// ”»’èƒ|ƒCƒ“ƒg‚ł̈ʑŠ‚ÌŽZ�o
+
+	C0 = (int)((double)Q31 * cos(theta) + 0.5);
+	S0 = (int)((double)Q31 * sin(theta) + 0.5);
+	CN = (int)((double)Q31 * cos(((double)N - 1.0) * theta) + 0.5);
+	SN = (int)((double)Q31 * sin(((double)N - 1.0) * theta) + 0.5);
+
+	RamWrite32A( FRA_DMA_DeciShift, nDivision );	
+	RamWrite32A( FRA_DMB_C0, C0 ) ;
+	RamWrite32A( FRA_DMB_S0, S0 ) ;
+	RamWrite32A( FRA_DMB_CN, CN ) ;
+	RamWrite32A( FRA_DMB_SN, SN ) ;
+
+TRACE("0x%08X, 0x%08X, 0x%08X, 0x%08X,\n", C0, S0, CN, SN);
+}
+
+//********************************************************************************
+// Function Name 	: Freq_Convert
+// Retun Value		: Phase Step Value
+// Argment Value	: Frequency
+// Explanation		: Convert Frequency
+// History			: First edition
+//********************************************************************************
+UINT32	Freq_Convert( float SfFreq )
+{
+	UINT32	UlPhsStep;
+	
+	UlPhsStep	= ( UINT32 )( ( SfFreq * ( float )0x100000000 / FS_FREQ + 0.5F ) / 2.0F ) ;
+
+	return( UlPhsStep ) ;
+}
+
+
+//********************************************************************************
+// Function Name 	: MesStart_FRA_Single
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Measure start setting Function
+// History			: First edition
+//********************************************************************************
+void	MesStart_FRA_Single( UINT8	UcDirSel )
+{
+	float	SfTmp ;
+	INT32	GainQ23, PhaseQ21 ;
+	UINT32	UlReadVal ;	
+
+
+	SetSinWavGenInt() ;
+	// Change Frequency 
+	RamWrite32A( SinWave_Offset,	Freq_Convert( StFRAParam.StHostCom.SfFrqCom.SfFltVal ) ) ;		// Freq Setting = Freq * 80000000h / Fs	: 10Hz
+
+	SfTmp	= StFRAParam.StHostCom.SfAmpCom.SfFltVal / 1400.0F ;									// AVDD 2800mV / 2 = 1400mV
+	RamWrite32A( SinWave_Gain,		( UINT32 )( ( float )0x7FFFFFFF * SfTmp ) ) ;					// Set Sine Wave Gain
+
+	if ( StFRAParam.StHostCom.UcAvgCycl == 10) 	{  		// Actuator Through
+#ifdef ACT_THROUGH_CLOSE
+		SetThroughParameter( UcDirSel );
+
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_XSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XHOUTA ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_XHOUTB ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_YSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YHOUTA ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_YHOUTB ) ;
+		}else if( UcDirSel == Z_DIR ){
+		}
+#else
+		RtnCen( BOTH_OFF ) ;
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_SINDX1 ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_RAM_SINDX1 ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_RAM_HXIDAT ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_RAM_SINDY1 ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, HALL_RAM_SINDY1 ) ;
+			RamWrite32A( FRA_DMA_OutputData, HALL_RAM_HXIDAT ) ;
+		}
+ #ifdef SEL_CLOSED_AF
+		else if( UcDirSel == Z_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)CLAF_RAMA_AFOUT ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+			RamWrite32A( FRA_DMA_InputData, CLAF_RAMA_AFOUT ) ;
+			RamWrite32A( FRA_DMA_OutputData, CLAF_RAMA_AFADIN ) ;
+	}
+ #endif
+#endif
+		} else {
+		if( UcDirSel == X_DIR ) {
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_XSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XSININ ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_XHOUTA ) ;
+#endif
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_XHOUTB ) ;
+		}else if( UcDirSel == Y_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)HALL_FRA_YSININ ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YSININ  ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, HALL_FRA_YHOUTA ) ;
+#endif			
+			RamWrite32A( FRA_DMA_OutputData, HALL_FRA_YHOUTB ) ;
+		}
+#ifdef SEL_CLOSED_AF
+		else if( UcDirSel == Z_DIR ){
+			SetTransDataAdr( SinWave_OutAddr	,	(UINT32)CLAF_RAMA_AFSINE ) ;								// Set Sine Wave Input RAM
+			// Set parameter and input/output address
+#ifdef CLOSED_RESPONSE
+			RamWrite32A( FRA_DMA_InputData, CLAF_RAMA_AFSINE  ) ;
+#else
+			RamWrite32A( FRA_DMA_InputData, CLAF_DELAY_AFDZ0 ) ;
+#endif			
+			RamWrite32A( FRA_DMA_OutputData, CLAF_RAMA_AFDEV ) ;
+		}
+#endif // SEL_CLOSED_AF
+	}
+	RamWrite32A( SinWaveC_Regsiter	,	0x00000001 ) ;												// Sine Wave Start
+
+
+	CoeffGenerate( StFRAParam.StHostCom.SfFrqCom.SfFltVal );
+//	WitTim(10);
+	// Start to measure
+	RamWrite32A( FRA_DMA_Control,1 ) ;
+
+	if (nDivision == 0)	WitTim(100);
+	if (nDivision == 1)	WitTim(200);
+	if (nDivision == 2)	WitTim(400);
+	if (nDivision == 3)	WitTim(800);
+	if (nDivision == 4)	WitTim(1600);
+	do{
+		WitTim(10);
+		RamRead32A( FRA_DMA_Control	, &UlReadVal ) ;	
+	}while (UlReadVal == 1);
+	// Read answer
+	RamRead32A( FRA_DMA_Gain	, &GainQ23 ) ;		// Gain
+	RamRead32A( FRA_DMA_Phase	, &PhaseQ21 ) ;		// Phase
+	StFRAParam.StMesRslt.SfGainAvg = (float)GainQ23 / Q23; //0x007FFFFF;
+	StFRAParam.StMesRslt.SfPhaseAvg = (float)PhaseQ21 / Q21; //0x001FFFFF;	
+
+	TRACE("Phase %f deg : Gain %f dB\n", StFRAParam.StMesRslt.SfPhaseAvg, StFRAParam.StMesRslt.SfGainAvg );
+
+}
+
+
+
+//********************************************************************************
+// Function Name 	: MesStart_FRA_Continue
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Continue Measurement Function
+// History			: First edition
+//********************************************************************************
+void	MesStart_FRA_Continue( void )
+{
+	INT32	GainQ23, PhaseQ21 ;
+	UINT32	UlReadVal ;	
+	
+	// Change Frequency 
+	RamWrite32A( SinWave_Offset,	Freq_Convert( StFRAParam.StHostCom.SfFrqCom.SfFltVal ) ) ;
+	// Set parameter
+	CoeffGenerate( StFRAParam.StHostCom.SfFrqCom.SfFltVal );
+//	WitTim(10)
+	// Start to measure
+	RamWrite32A( FRA_DMA_Control,1 ) ;									// Integral Value Clear
+	if (nDivision == 0)	WitTim(100);
+	if (nDivision == 1)	WitTim(200);
+	if (nDivision == 2)	WitTim(400);
+	if (nDivision == 3)	WitTim(800);
+	if (nDivision == 4)	WitTim(1600);
+	do{
+		WitTim(10);	
+		RamRead32A( FRA_DMA_Control	, &UlReadVal ) ;	
+	}while (UlReadVal == 1);
+	// Read answer
+	RamRead32A( FRA_DMA_Gain	, &GainQ23 ) ;		// Gain
+	RamRead32A( FRA_DMA_Phase	, &PhaseQ21 ) ;		// Phase
+	StFRAParam.StMesRslt.SfGainAvg = (float)GainQ23 / Q23;
+	StFRAParam.StMesRslt.SfPhaseAvg = (float)PhaseQ21 / Q21;	
+
+	TRACE("Phase %f deg : Gain %f dB\n", StFRAParam.StMesRslt.SfPhaseAvg, StFRAParam.StMesRslt.SfGainAvg );
+}
+
+
+
+//********************************************************************************
+// Function Name 	: MesEnd_FRA_Sweep
+// Retun Value		: NON
+// Argment Value	: NON
+// Explanation		: Stop Measurement Function
+// History			: First edition
+//********************************************************************************
+void	MesEnd_FRA_Sweep( void )
+{
+	// Stop Sine Wave
+	RamWrite32A( SinWaveC_Regsiter,		0x00000000 ) ;					// Sine Wave Stop
+	SetTransDataAdr( SinWave_OutAddr,	( UINT32 )0x00000000 ) ;		// Set Sine Wave Input RAM
+
+	if ( StFRAParam.StHostCom.UcAvgCycl == 10) 	{  		// Actuator Through
+#ifdef ACT_THROUGH_CLOSE
+		ResetThroughParameter( );
+#else
+		RtnCen( BOTH_ON ) ;
+#endif
+	}
+	RamWrite32A( HALL_RAM_SINDX0,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_RAM_SINDY0,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_FRA_XSININ,	0x00000000 ) ;		// DelayRam Clear
+	RamWrite32A( HALL_FRA_YSININ,	0x00000000 ) ;		// DelayRam Clear
+
+}
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.h
new file mode 100644
index 0000000000000000000000000000000000000000..94dab4eaa1d01535d82c0c6d767fb58338c9221f
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisFRA.h
@@ -0,0 +1,62 @@
+/**
+ * @brief		FRA measurement header for LC898123 F40
+ * 				API List for customers
+ *
+ * @author		Copyright (C) 2016, ON Semiconductor, all right reserved.
+ *
+ * @file		OisAPI.h
+ * @date		svn:$Date:: 2016-04-28 14:30:21 +0900#$
+ * @version		svn:$Revision: 43 $
+ * @attention
+ **/
+#ifndef OISFRA_H_
+#define OISFRA_H_
+
+//****************************************************
+//	extern selector for API
+//****************************************************
+#ifdef	__OISFRA__
+	#define	__OIS_FRA_HEADER__
+#else
+	#define	__OIS_FRA_HEADER__		extern
+#endif
+
+typedef struct STFRA_PARAM {
+	struct {
+		UnFltVal		SfFrqCom ;
+		UnFltVal		SfAmpCom ;
+		unsigned char	UcAvgCycl ;
+	} StHostCom ;
+
+	float				SfGain[ 10 ] ;
+	float				SfPhase[ 10 ] ;
+
+	struct {
+		float			SfGainAvg ;
+		float			SfPhaseAvg ;
+	} StMesRslt ;
+} StFRAParam_t ;
+
+__OIS_FRA_HEADER__	StFRAParam_t	StFRAParam ;
+/*
+typedef struct STFRA_MES {
+	UINT_64	UllCumulAdd1 ;
+	UINT_64	UllCumulAdd2 ;
+	UINT_16	UsFsCount ;
+} StFRAMes_t ;
+
+__OIS_FRA_HEADER__	StFRAMes_t		StFRAMes ;
+
+typedef struct  {
+	INT_32	a1 ;
+	INT_32	b1 ;
+	INT_32	c1 ;
+	INT_32	a2 ;
+	INT_32	b2 ;
+	INT_32	c2 ;
+} StMesFCoeff_t ;
+
+*/
+
+
+#endif	// OISFRA_H_
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisLc898124EP3.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisLc898124EP3.h
new file mode 100644
index 0000000000000000000000000000000000000000..140896a007846b5b17b3057d5512aa4c563c9c78
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/OisLc898124EP3.h
@@ -0,0 +1,903 @@
+//********************************************************************************
+//
+//		<< LC898124EP3 Evaluation Soft>>
+//		Program Name	: OisLC898124EP1.h
+// 		Explanation		: LC898124 Global Declaration & ProtType Declaration
+//		Design			: K.abe
+//		History			: First edition
+//********************************************************************************
+/************************************************/
+/*	Command										*/
+/************************************************/
+
+//#define	ACT_SEMCO			0x01	// SEMCO
+//#define	ACT_SEMCO			0x00	// SEMCO
+#define		ACT_SO2820			0x02	// SEMCO SO2820(Wide)
+#define		ACT_SO3600			0x03	// SEMCO SO3600(Tele)
+#define		ACT_M12337_A1		0x06	// JAHWA M12337(Wide)
+#define		ACT_M10235_A1		0x07	// JAHWA M10235(Tele)
+
+#define		CMD_IO_ADR_ACCESS				0xC000				// IO Write Access
+#define		CMD_IO_DAT_ACCESS				0xD000				// IO Read Access
+#define		CMD_REMAP						0xF001				// Remap
+#define		CMD_REBOOT						0xF003				// Reboot
+#define		CMD_ROMVER						0xF00F				// Rom code version read
+#define		OLD_VER							0x20161121
+#define		CUR_VER							0x20170410
+#define		CMD_RETURN_TO_CENTER			0xF010				// Center Servo ON/OFF choose axis
+#define		BOTH_SRV_OFF					0x00000000			// Both   Servo OFF
+#define		XAXS_SRV_ON						0x00000001			// X axis Servo ON
+#define		YAXS_SRV_ON						0x00000002			// Y axis Servo ON
+#define		BOTH_SRV_ON						0x00000003			// Both   Servo ON
+#define		ZAXS_SRV_OFF					0x00000004			// Z axis Servo OFF
+#define		ZAXS_SRV_ON						0x00000005			// Z axis Servo ON
+#define		CMD_PAN_TILT					0xF011				// Pan Tilt Enable/Disable
+#define		PAN_TILT_OFF					0x00000000			// Pan/Tilt OFF
+#define		PAN_TILT_ON						0x00000001			// Pan/Tilt ON
+#define		CMD_OIS_ENABLE					0xF012				// Ois Enable/Disable
+#define		OIS_DISABLE						0x00000000			// OIS Disable
+#define		OIS_ENABLE						0x00000001			// OIS Enable
+#define		OIS_ENA_NCL						0x00000002			// OIS Enable ( none Delay clear )
+#define		OIS_ENA_DOF						0x00000004			// OIS Enable ( Drift offset exec )
+#define		CMD_MOVE_STILL_MODE				0xF013				// Select mode
+#define		MOVIE_MODE						0x00000000			// Movie mode
+#define		STILL_MODE						0x00000001			// Still mode
+#define		MOVIE_MODE1						0x00000002			// Movie Preview mode 1
+#define		STILL_MODE1						0x00000003			// Still Preview mode 1
+#define		MOVIE_MODE2						0x00000004			// Movie Preview mode 2
+#define		STILL_MODE2						0x00000005			// Still Preview mode 2
+#define		MOVIE_MODE3						0x00000006			// Movie Preview mode 3
+#define		STILL_MODE3						0x00000007			// Still Preview mode 3
+#define		CMD_CHASE_CONFIRMATION			0xF015				// Hall Chase confirmation
+#define		CMD_GYRO_SIG_CONFIRMATION		0xF016				// Gyro Signal confirmation
+#define		CMD_FLASH_LOAD					0xF017				// Flash Load
+#define		HALL_CALB_FLG					0x00008000
+#define		HALL_CALB_BIT					0x00FF00FF
+#define		GYRO_GAIN_FLG					0x00004000
+#define		ANGL_CORR_FLG					0x00002000
+#define		FOCL_GAIN_FLG					0x00001000
+#define		ZSRV_CAL_FLG					0x00000800			// ZeroServo calibration data
+#define		HLLN_CALB_FLG					0x00000400			// Hall linear calibration
+#define		MIXI_CALB_FLG					0x00000200			// Mixing calibration
+#define		CROS_TALK_FLG					0x00000200			//!< Cross talk calibration
+#define		CMD_LASER_LINEAR_DATA			0xF019
+#define		CMD_AF_POSITION					0xF01A				// AF Position
+#define		CMD_SSC_ENABLE					0xF01C				//!< Select mode
+#define		SSC_DISABLE						0x00000000			//!< Ssc Disable
+#define		SSC_ENABLE						0x00000001			//!< Ssc Enable
+#define		CMD_GYRO_RD_ACCS				0xF01D				// Gyro Read Acess
+#define		CMD_GYRO_WR_ACCS				0xF01E				// Gyro Write Acess
+
+#define		CMD_READ_STATUS					0xF100				// Status Read
+#define		READ_STATUS_INI					0x01000000
+
+#define		CMD_ZSRV_MODE					0xF01F
+#define		ZSRV_DISABLE					0x00000000
+#define		ZSRV_ENABLE						0x00000001
+#define		ZSRV_HOLD						0x00000003
+
+#define		OIS_POS_FLG			0x00000100			// OIS position by AF measurement
+
+//==============================================================================
+//E2PROM
+//==============================================================================
+#define		EEPROM_ONSEMI_LDO					0x00
+#define		EEPROM_ONSEMI_CP1					0x01
+#define		EEPROM_ONSEMI_CP2					0x02
+#define		EEPROM_ONSEMI_CP3					0x03
+#define		EEPROM_ONSEMI_OSCS					0x04
+#define		EEPROM_ONSEMI_DRVGAINAF				0x05
+#define		EEPROM_ONSEMI_DRVOFSTAF				0x06
+#define		EEPROM_ONSEMI_DRVOFSTAFM			0x07
+#define		EEPROM_ONSEMI_DRVGAINX				0x08
+#define		EEPROM_ONSEMI_DRVOFSTX				0x09
+#define		EEPROM_ONSEMI_DRVOFSTXM				0x0A
+#define		EEPROM_ONSEMI_DRVGAINY				0x0B
+#define		EEPROM_ONSEMI_DRVOFSTY				0x0C
+#define		EEPROM_ONSEMI_DRVOFSTYM				0x0D
+#define		EEPROM_ONSEMI_MARK					0x0E
+#define		EEPROM_ONSEMI_CHECKSUM				0x0F		/* target area 0x00~0x0E */
+
+#define		EEPROM_ONSEMI_IDSEL					0x10
+#define		EEPROM_DrvZdir						0x11
+#define		EEPROM_AfUcoef_LSB					0x12
+#define		EEPROM_AfUcoef_MSB					0x13
+#define		EEPROM_AfDcoef_LSB					0x14
+#define		EEPROM_AfDcoef_MSB					0x15
+#define		EEPROM_AfFrq_LSB					0x16
+#define		EEPROM_AfFrq_MSB					0x17
+
+#define		EEPROM_Calibration_Status_LSB		0x18
+#define		EEPROM_Calibration_Status_MSB		0x19
+#define		EEPROM_Calibration_HallMaxX_LSB		0x1A
+#define		EEPROM_Calibration_HallMaxX_MSB		0x1B
+#define		EEPROM_Calibration_HallMinX_LSB		0x1C
+#define		EEPROM_Calibration_HallMinX_MSB		0x1D
+#define		EEPROM_Calibration_HallMaxY_LSB		0x1E
+#define		EEPROM_Calibration_HallMaxY_MSB		0x1F
+
+#define		EEPROM_Calibration_HallMinY_LSB		0x20
+#define		EEPROM_Calibration_HallMinY_MSB		0x21
+#define		EEPROM_Calibration_HallBiasX		0x22
+#define		EEPROM_Calibration_HallOffsetX		0x23
+#define		EEPROM_Calibration_HallBiasY		0x24
+#define		EEPROM_Calibration_HallOffsetY		0x25
+#define		EEPROM_Calibration_LoopGainX_LSB	0x26
+#define		EEPROM_Calibration_LoopGainX_MSB	0x27
+
+#define		EEPROM_Calibration_LoopGainY_LSB	0x28
+#define		EEPROM_Calibration_LoopGainY_MSB	0x29
+#define		EEPROM_Calibration_LensOffsetX_LSB	0x2A
+#define		EEPROM_Calibration_LensOffsetX_MSB	0x2B
+#define		EEPROM_Calibration_LensOffsetY_LSB	0x2C
+#define		EEPROM_Calibration_LensOffsetY_MSB	0x2D
+
+#define		EEPROM_Calibration_GyroGainX_0Byte	0x2E
+#define		EEPROM_Calibration_GyroGainX_1Byte	0x2F
+#define		EEPROM_Calibration_GyroGainX_2Byte	0x30
+#define		EEPROM_Calibration_GyroGainX_3Byte	0x31
+#define		EEPROM_Calibration_GyroGainY_0Byte	0x32
+#define		EEPROM_Calibration_GyroGainY_1Byte	0x33
+#define		EEPROM_Calibration_GyroGainY_2Byte	0x34
+#define		EEPROM_Calibration_GyroGainY_3Byte	0x35
+
+#if 0
+#define		EEPROM_Calibration_ZSX_offset_0Byte		0x36
+#define		EEPROM_Calibration_ZSX_offset_1Byte		0x37
+#define		EEPROM_Calibration_ZSX_shift_0Byte		0x38
+#define		EEPROM_Calibration_ZSX_shift_1Byte		0x39
+#define		EEPROM_Calibration_ZSX_gcore_0Byte		0x3A
+#define		EEPROM_Calibration_ZSX_gcore_1Byte		0x3B
+#define		EEPROM_Calibration_ZSX_gaina_0Byte		0x3C
+#define		EEPROM_Calibration_ZSX_gaina_1Byte		0x3D
+
+#define		EEPROM_Calibration_ZSY_offset_0Byte		0x3E
+#define		EEPROM_Calibration_ZSY_offset_1Byte		0x3F
+#define		EEPROM_Calibration_ZSY_shift_0Byte		0x40
+#define		EEPROM_Calibration_ZSY_shift_1Byte		0x41
+#define		EEPROM_Calibration_ZSY_gcore_0Byte		0x42
+#define		EEPROM_Calibration_ZSY_gcore_1Byte		0x43
+#define		EEPROM_Calibration_ZSY_gaina_0Byte		0x44
+#define		EEPROM_Calibration_ZSY_gaina_1Byte		0x45
+
+#define		EEPROM_Calibration_ZSZ_offset_0Byte		0x46
+#define		EEPROM_Calibration_ZSZ_offset_1Byte		0x47
+#endif
+
+#define		EEPROM_POSITION_1X_LSB				0x48
+#define		EEPROM_POSITION_1X_MSB				0x49
+#define		EEPROM_POSITION_1Y_LSB				0x4A
+#define		EEPROM_POSITION_1Y_MSB				0x4B
+#define		EEPROM_POSITION_2X_LSB				0x4C
+#define		EEPROM_POSITION_2X_MSB				0x4D
+#define		EEPROM_POSITION_2Y_LSB				0x4E
+#define		EEPROM_POSITION_2Y_MSB				0x4F
+
+#define		EEPROM_POSITION_3X_LSB				0x50
+#define		EEPROM_POSITION_3X_MSB				0x51
+#define		EEPROM_POSITION_3Y_LSB				0x52
+#define		EEPROM_POSITION_3Y_MSB				0x53
+#define		EEPROM_POSITION_4X_LSB				0x54
+#define		EEPROM_POSITION_4X_MSB				0x55
+#define		EEPROM_POSITION_4Y_LSB				0x56
+#define		EEPROM_POSITION_4Y_MSB				0x57
+
+#define		EEPROM_POSITION_5X_LSB				0x58
+#define		EEPROM_POSITION_5X_MSB				0x59
+#define		EEPROM_POSITION_5Y_LSB				0x5A
+#define		EEPROM_POSITION_5Y_MSB				0x5B
+#define		EEPROM_POSITION_6X_LSB				0x5C
+#define		EEPROM_POSITION_6X_MSB				0x5D
+#define		EEPROM_POSITION_6Y_LSB				0x5E
+#define		EEPROM_POSITION_6Y_MSB				0x5F
+
+#define		EEPROM_POSITION_7X_LSB				0x60
+#define		EEPROM_POSITION_7X_MSB				0x61
+#define		EEPROM_POSITION_7Y_LSB				0x62
+#define		EEPROM_POSITION_7Y_MSB				0x63
+#define		EEPROM_STEPX_0Byte					0x64
+#define		EEPROM_STEPX_1Byte					0x65
+#define		EEPROM_STEPY_0Byte					0x66
+#define		EEPROM_STEPY_1Byte					0x67
+
+#define		EEPROM_CROSSTALK_XX_LSB				0x68
+#define		EEPROM_CROSSTALK_XX_MSB				0x69
+#define		EEPROM_CROSSTALK_XY_LSB				0x6A
+#define		EEPROM_CROSSTALK_XY_MSB				0x6B
+#define		EEPROM_CROSSTALK_YY_LSB				0x6C
+#define		EEPROM_CROSSTALK_YY_MSB				0x6D
+#define		EEPROM_CROSSTALK_YX_LSB				0x6E
+#define		EEPROM_CROSSTALK_YX_MSB				0x6F
+
+#define		EEPROM_CROSSTALK_XSHIFT				0x70
+#define		EEPROM_CROSSTALK_YSHIFT				0x71
+
+#define		EEPROM_Optical_LensOffsetX_LSB		0x72
+#define		EEPROM_Optical_LensOffsetX_MSB		0x73
+#define		EEPROM_Optical_LensOffsetY_LSB		0x74
+#define		EEPROM_Optical_LensOffsetY_MSB		0x75
+
+////////////////////////////////////////////////////
+
+//#define		EEPROM_Calibration_Reserve_78		0x78
+//#define		EEPROM_Calibration_Reserve_79		0x79
+//#define		EEPROM_Calibration_Reserve_7A		0x7A
+//#define		EEPROM_Calibration_Reserve_7B		0x7B
+//#define		EEPROM_Calibration_Reserve_7C		0x7C
+
+#define		EEPROM_CheckSum						0x7D	/* target area 0x10~0x7c */
+#define		EEPROM_CheckCode1					0x7E
+#define		EEPROM_CheckCode2					0x7F
+
+//==============================================================================
+//DMA
+//==============================================================================
+
+#define		DmCheck_CheckSumDMA				0x0100
+#define		DmCheck_CheckSumDMB				0x0104
+
+#define 	PmCheck							0x0108
+#define 		PmCheck_PmemAddr				(0x0000 + PmCheck)						// 0x0108
+#define 		PmCheck_Size					(0x0004 + PmCheck_PmemAddr)				// 0x010C
+#define 		PmCheck_CheckSum				(0x0004 + PmCheck_Size)					// 0x0110
+#define 		PmCheck_EndFlag					(0x0004 + PmCheck_CheckSum)				// 0x0114
+
+#define		HallFilterD_HXDAZ1				0x0130	//0x0080
+#define		HallFilterD_HYDAZ1				0x0180	//0x00D0
+
+#define		HALL_RAM_X_COMMON				0x01C0	//0x0110
+#define			HALL_RAM_HXOFF					(0x0000 + HALL_RAM_X_COMMON)		// 0x01C0
+#define			HALL_RAM_HXOFF1					(0x0004 + HALL_RAM_X_COMMON)		// 0x01C4
+#define			HALL_RAM_HXOUT0					(0x0008 + HALL_RAM_X_COMMON)		// 0x01C8
+#define			HALL_RAM_HXOUT1					(0x000C + HALL_RAM_X_COMMON)		// 0x01CC
+#define			HALL_RAM_HXOUT2					(0x0010 + HALL_RAM_X_COMMON)		// 0x01D0
+#define			HALL_RAM_SINDX0					(0x0014 + HALL_RAM_X_COMMON)		// 0x01D4
+#define			HALL_RAM_HXLOP					(0x0018 + HALL_RAM_X_COMMON)		// 0x01D8
+#define			HALL_RAM_SINDX1					(0x001C + HALL_RAM_X_COMMON)		// 0x01DC
+#define			HALL_RAM_HALL_X_OUT				(0x0020 + HALL_RAM_X_COMMON)		// 0x01E0
+#define		HALL_RAM_HALL_SwitchX			0x0210	//0x015c
+
+#define		HALL_RAM_Y_COMMON				0x0214	//0x0160
+#define			HALL_RAM_HYOFF					(0x0000 + HALL_RAM_Y_COMMON)		// 0x0214
+#define			HALL_RAM_HYOFF1					(0x0004 + HALL_RAM_Y_COMMON)		// 0x0218
+#define			HALL_RAM_HYOUT0					(0x0008 + HALL_RAM_Y_COMMON)		// 0x021C
+#define			HALL_RAM_HYOUT1					(0x000C + HALL_RAM_Y_COMMON)		// 0x0220
+#define			HALL_RAM_HYOUT2					(0x0010 + HALL_RAM_Y_COMMON)		// 0x0224
+#define			HALL_RAM_SINDY0					(0x0014 + HALL_RAM_Y_COMMON)		// 0x0228
+#define			HALL_RAM_HYLOP					(0x0018 + HALL_RAM_Y_COMMON)		// 0x022C
+#define			HALL_RAM_SINDY1					(0x001C + HALL_RAM_Y_COMMON)		// 0x0230
+#define			HALL_RAM_HALL_Y_OUT				(0x0020 + HALL_RAM_Y_COMMON)		// 0x0234
+#define		HALL_RAM_HALL_SwitchY			0x0264	//0x01AC
+
+
+#define		HALL_RAM_COMMON					0x0268	//0x01B0
+//  HallFilterDelay.h HALL_RAM_COMMON_t
+#define			HALL_RAM_HXIDAT					(0x0000 + HALL_RAM_COMMON)			// 0x0268
+#define			HALL_RAM_HYIDAT					(0x0004 + HALL_RAM_COMMON)			// 0x026C
+#define			HALL_RAM_GYROX_OUT				(0x0008 + HALL_RAM_COMMON)			// 0x0270
+#define			HALL_RAM_GYROY_OUT				(0x000C + HALL_RAM_COMMON)			// 0x0274
+
+#define		GyroFilterDelayX_delay2			0x278
+#define		GyroFilterDelayX_delay3			0x288	//0x1D0
+#define			GyroFilterDelayX_GXH1Z1			(0x0000 + GyroFilterDelayX_delay3)	// 0x0288
+#define			GyroFilterDelayX_GXH1Z2			(0x0004 + GyroFilterDelayX_delay3)	// 0x028C
+#define			GyroFilterDelayX_GXK1Z1			(0x0008 + GyroFilterDelayX_delay3)	// 0x0290
+#define			GyroFilterDelayX_GXK1Z2			(0x000C + GyroFilterDelayX_delay3)	// 0x0294
+#define		GyroFilterDelayX_delay4			0x298
+
+#define		GyroFilterDelayY_delay2			0x2A0
+#define		GyroFilterDelayY_delay3			0x2B0	//0x1F8
+#define			GyroFilterDelayY_GYH1Z1			(0x0000 + GyroFilterDelayY_delay3)	// 0x02B0
+#define			GyroFilterDelayY_GYH1Z2			(0x0004 + GyroFilterDelayY_delay3)	// 0x02B4
+#define			GyroFilterDelayY_GYK1Z1			(0x0008 + GyroFilterDelayY_delay3)	// 0x02B8
+#define			GyroFilterDelayY_GYK1Z2			(0x000C + GyroFilterDelayY_delay3)	// 0x02BC
+#define		GyroFilterDelayY_delay4			0x2C0
+
+#define		GYRO_RAM_X						0x02C8	//0x0210
+// GyroFilterDelay.h GYRO_RAM_t
+#define			GYRO_RAM_GYROX_OFFSET			(0x0000 + GYRO_RAM_X)				// 0x02C8
+#define			GYRO_RAM_GX2X4XF_IN				(0x0004 + GYRO_RAM_GYROX_OFFSET)	// 0x02CC
+#define			GYRO_RAM_GX2X4XF_OUT			(0x0004 + GYRO_RAM_GX2X4XF_IN)		// 0x02D0
+#define			GYRO_RAM_GXFAST					(0x0004 + GYRO_RAM_GX2X4XF_OUT)		// 0x02D4
+#define			GYRO_RAM_GXSLOW					(0x0004 + GYRO_RAM_GXFAST)			// 0x02D8
+#define			GYRO_RAM_GYROX_G1OUT			(0x0004 + GYRO_RAM_GXSLOW)			// 0x02DC
+#define			GYRO_RAM_GYROX_G2OUT			(0x0004 + GYRO_RAM_GYROX_G1OUT)		// 0x02E0
+#define			GYRO_RAM_GYROX_G3OUT			(0x0004 + GYRO_RAM_GYROX_G2OUT)		// 0x02E4
+#define			GYRO_RAM_GYROX_OUT				(0x0004 + GYRO_RAM_GYROX_G3OUT)		// 0x02E8
+#define		GYRO_RAM_Y						0x02EC	//0x0234
+// GyroFilterDelay.h GYRO_RAM_t
+#define			GYRO_RAM_GYROY_OFFSET			(0x0000 + GYRO_RAM_Y)				// 0x02EC
+#define			GYRO_RAM_GY2X4XF_IN				(0x0004 + GYRO_RAM_GYROY_OFFSET)	// 0x02F0
+#define			GYRO_RAM_GY2X4XF_OUT			(0x0004 + GYRO_RAM_GY2X4XF_IN)		// 0x02F4
+#define			GYRO_RAM_GYFAST					(0x0004 + GYRO_RAM_GY2X4XF_OUT)		// 0x02F8
+#define			GYRO_RAM_GYSLOW					(0x0004 + GYRO_RAM_GYFAST)			// 0x02FC
+#define			GYRO_RAM_GYROY_G1OUT			(0x0004 + GYRO_RAM_GYSLOW)			// 0x0300
+#define			GYRO_RAM_GYROY_G2OUT			(0x0004 + GYRO_RAM_GYROY_G1OUT)		// 0x0304
+#define			GYRO_RAM_GYROY_G3OUT			(0x0004 + GYRO_RAM_GYROY_G2OUT)		// 0x0308
+#define			GYRO_RAM_GYROY_OUT				(0x0004 + GYRO_RAM_GYROY_G3OUT)		// 0x030C
+
+#define		GYRO_RAM_COMMON					0x0310	//0x0258
+// GyroFilterDelay.h GYRO_RAM_COMMON_t
+#define			GYRO_RAM_GX_ADIDAT				(0x0000 + GYRO_RAM_COMMON)			// 0x0310
+#define			GYRO_RAM_GY_ADIDAT				(0x0004 + GYRO_RAM_GX_ADIDAT)		// 0x0314
+#define			GYRO_RAM_GZ_ADIDAT				(0x0004 + GYRO_RAM_GY_ADIDAT)		// 0x0318
+#define			GYRO_RAM_SINDX					(0x0004 + GYRO_RAM_GZ_ADIDAT)		// 0x031C
+#define			GYRO_RAM_SINDY					(0x0004 + GYRO_RAM_SINDX)			// 0x0320
+#define			GYRO_RAM_GXLENSZ				(0x0004 + GYRO_RAM_SINDY)			// 0x0324
+#define			GYRO_RAM_GYLENSZ				(0x0004 + GYRO_RAM_GXLENSZ)			// 0x0328
+#define			GYRO_RAM_GZLENSZ				(0x0004 + GYRO_RAM_GYLENSZ)			// 0x032C
+#define			GYRO_RAM_GXOX_OUT				(0x0004 + GYRO_RAM_GZLENSZ)			// 0x0330
+#define			GYRO_RAM_GYOX_OUT				(0x0004 + GYRO_RAM_GXOX_OUT)		// 0x0334
+#define			GYRO_RAM_GXOFFZ					(0x0004 + GYRO_RAM_GYOX_OUT)		// 0x0338
+#define			GYRO_RAM_GYOFFZ					(0x0004 + GYRO_RAM_GXOFFZ)			// 0x033C
+#define			GYRO_RAM_GZOFFZ					(0x0004 + GYRO_RAM_GYOFFZ)			// 0x0340
+#define			GYRO_RAM_LIMITX					(0x0004 + GYRO_RAM_GZOFFZ)			// 0x0344
+#define			GYRO_RAM_LIMITY					(0x0004 + GYRO_RAM_LIMITX)			// 0x0348
+#define			GYRO_RAM_LIMITZ					(0x0004 + GYRO_RAM_LIMITY)			// 0x034C
+#define			GXFILIN							(0x0004 + GYRO_RAM_LIMITZ)			// 0x0350
+#define			GYFILIN							(0x0004 + GXFILIN)					// 0x0354
+#define			GZFILIN							(0x0004 + GYFILIN)					// 0x0358
+#define			GYRO_RAM_GYRO_Switch			(0x0004 + GZFILIN)					// 0x035C
+#define			GYRO_RAM_GYRO_AF_Switch			(0x0001 + GYRO_RAM_GYRO_Switch)		// 0x035D
+
+//#ifdef	ZERO_SERVO
+#define		ZeroServoRAM_X					0x03A8
+#define 		ZeroServoRAM_X_OFFSET			(0x0000 + ZeroServoRAM_X)			// 0x03A8
+#define 		ZeroServoRAM_X_IN				(0x0004 + ZeroServoRAM_X_OFFSET)	// 0x03AC
+#define 		ZeroServoRAM_X_LPFIN			(0x0004 + ZeroServoRAM_X_IN	)		// 0x03B0
+#define 		ZeroServoRAM_X_LPFOUT			(0x0004 + ZeroServoRAM_X_LPFIN)		// 0x03B4
+#define 		ZeroServoRAM_X_ANGOUT			(0x0004 + ZeroServoRAM_X_LPFOUT)	// 0x03B8
+#define 		ZeroServoRAM_X_OUT				(0x0004 + ZeroServoRAM_X_ANGOUT)	// 0x03BC
+#define		ZeroServoRAM_Y					0x03C0
+#define 		ZeroServoRAM_Y_OFFSET			(0x0000 + ZeroServoRAM_Y)			// 0x03C0
+#define 		ZeroServoRAM_Y_IN				(0x0004 + ZeroServoRAM_Y_OFFSET)	// 0x03C4
+#define 		ZeroServoRAM_Y_LPFIN			(0x0004 + ZeroServoRAM_Y_IN	)		// 0x03C8
+#define 		ZeroServoRAM_Y_LPFOUT			(0x0004 + ZeroServoRAM_Y_LPFIN)		// 0x03CC
+#define 		ZeroServoRAM_Y_ANGOUT			(0x0004 + ZeroServoRAM_Y_LPFOUT)	// 0x03D0
+#define 		ZeroServoRAM_Y_OUT				(0x0004 + ZeroServoRAM_Y_ANGOUT)	// 0x03D4
+#define		ZeroServoRAM_Z					0x03D8
+#define 		ZeroServoRAM_Z_OFFSET			(0x0000 + ZeroServoRAM_Z)			// 0x03D8
+#define 		ZeroServoRAM_Z_IN				(0x0004 + ZeroServoRAM_Z_OFFSET)	// 0x03DC
+#define 		ZeroServoRAM_Z_LPFIN			(0x0004 + ZeroServoRAM_Z_IN	)		// 0x03E0
+#define 		ZeroServoRAM_Z_LPFOUT			(0x0004 + ZeroServoRAM_Z_LPFIN)		// 0x03E4
+#define 		ZeroServoRAM_Z_ANGOUT			(0x0004 + ZeroServoRAM_Z_LPFOUT)	// 0x03E8
+#define 		ZeroServoRAM_Z_OUT				(0x0004 + ZeroServoRAM_Z_ANGOUT)	// 0x03EC
+//#endif	//ZERO_SERVO
+
+#define		StMeasureFunc					0x0400	//0x02B0
+#define			StMeasFunc_SiSampleNum			(0x0000 + StMeasureFunc		)			// 0x0400
+#define			StMeasFunc_SiSampleMax			(0x0004 + StMeasFunc_SiSampleNum)		// 0x0404
+
+#define		StMeasureFunc_MFA				0x0408	//0x02B8
+#define			StMeasFunc_MFA_SiMax1			(0x0000 + StMeasureFunc_MFA		)		// 0x0408
+#define			StMeasFunc_MFA_SiMin1			(0x0004 + StMeasFunc_MFA_SiMax1	)		// 0x040C
+#define			StMeasFunc_MFA_UiAmp1			(0x0004 + StMeasFunc_MFA_SiMin1	)		// 0x0410
+#define			StMeasFunc_MFA_UiDUMMY1			(0x0004 + StMeasFunc_MFA_UiAmp1	)		// 0x0414
+#define			StMeasFunc_MFA_LLiIntegral1		(0x0004 + StMeasFunc_MFA_UiDUMMY1)		// 0x0418	// 8Byte
+#define			StMeasFunc_MFA_LLiAbsInteg1		(0x0008 + StMeasFunc_MFA_LLiIntegral1)	// 0x0420	// 8Byte
+#define			StMeasFunc_MFA_PiMeasureRam1	(0x0008 + StMeasFunc_MFA_LLiAbsInteg1)	// 0x0428
+#define			StMeasFunc_MFA_UiDUMMY2			(0x0004 + StMeasFunc_MFA_PiMeasureRam1)	// 0x042C
+
+#define		StMeasureFunc_MFB				0x0430	//0x02E0
+#define			StMeasFunc_MFB_SiMax2			(0x0000 + StMeasureFunc_MFB			)	// 0x0430
+#define			StMeasFunc_MFB_SiMin2			(0x0004 + StMeasFunc_MFB_SiMax2		)	// 0x0434
+#define			StMeasFunc_MFB_UiAmp2			(0x0004 + StMeasFunc_MFB_SiMin2		)	// 0x0438
+#define			StMeasFunc_MFB_UiDUMMY1			(0x0004 + StMeasFunc_MFB_UiAmp2		)	// 0x043C
+#define			StMeasFunc_MFB_LLiIntegral2		(0x0004 + StMeasFunc_MFB_UiDUMMY1	)	// 0x0440	// 8Byte
+#define			StMeasFunc_MFB_LLiAbsInteg2		(0x0008 + StMeasFunc_MFB_LLiIntegral2)	// 0x0448	// 8Byte
+#define			StMeasFunc_MFB_PiMeasureRam2	(0x0008 + StMeasFunc_MFB_LLiAbsInteg2)	// 0x0450
+
+#define		MeasureFilterA_Delay			0x0458	//0x0308
+// MeasureFilter.h	MeasureFilter_Delay_Type
+#define			MeasureFilterA_Delay_z11		(0x0000 + MeasureFilterA_Delay)			// 0x0458
+#define			MeasureFilterA_Delay_z12		(0x0004 + MeasureFilterA_Delay_z11)		// 0x045C
+#define			MeasureFilterA_Delay_z21		(0x0004 + MeasureFilterA_Delay_z12)		// 0x0460
+#define			MeasureFilterA_Delay_z22		(0x0004 + MeasureFilterA_Delay_z21)		// 0x0464
+
+#define		MeasureFilterB_Delay			0x0468	//0x0318
+// MeasureFilter.h	MeasureFilter_Delay_Type
+#define			MeasureFilterB_Delay_z11		(0x0000 + MeasureFilterB_Delay)			// 0x0468
+#define			MeasureFilterB_Delay_z12		(0x0004 + MeasureFilterB_Delay_z11)		// 0x046C
+#define			MeasureFilterB_Delay_z21		(0x0004 + MeasureFilterB_Delay_z12)		// 0x0470
+#define			MeasureFilterB_Delay_z22		(0x0004 + MeasureFilterB_Delay_z21)		// 0x0474
+
+#define		SinWaveC						0x0478	//0x0328
+#define			SinWaveC_Pt						(0x0000 + SinWaveC)						// 0x0478
+#define			SinWaveC_Regsiter				(0x0004 + SinWaveC_Pt)					// 0x047C
+#define			SinWaveC_SignFlag				(0x0004 + SinWaveC_Regsiter)			// 0x0480
+
+#define		SinWave							0x0484	//0x0334
+// SinGenerator.h SinWave_t
+#define			SinWave_Offset					(0x0000 + SinWave)						// 0x0484
+#define			SinWave_Phase					(0x0004 + SinWave_Offset)				// 0x0488
+#define			SinWave_Gain					(0x0004 + SinWave_Phase)				// 0x048C
+#define			SinWave_Output					(0x0004 + SinWave_Gain)					// 0x0490
+#define			SinWave_OutAddr					(0x0004 + SinWave_Output)				// 0x0494
+#define		CosWave							0x0498	//0x0348
+// SinGenerator.h SinWave_t
+#define			CosWave_Offset					(0x0000 + CosWave)						// 0x0498
+#define			CosWave_Phase					(0x0004 + CosWave_Offset)				// 0x049C
+#define			CosWave_Gain					(0x0004 + CosWave_Phase)				// 0x04A0
+#define			CosWave_Output					(0x0004 + CosWave_Gain)					// 0x04A4
+#define			CosWave_OutAddr					(0x0004 + CosWave_Output)				// 0x04A8
+
+#define		WaitTimerData					0x04AC	//0x035C
+// CommonLibrary.h  WaitTimer_Type
+#define			WaitTimerData_UiWaitCounter		(0x0000 + WaitTimerData	)				// 0x04AC
+#define			WaitTimerData_UiTargetCount		(0x0004 + WaitTimerData_UiWaitCounter)	// 0x04B0
+#define			WaitTimerData_UiBaseCount		(0x0004 + WaitTimerData_UiTargetCount)	// 0x04B4
+
+#define		PanTilt_DMA_ScTpdSts			0x04CC	//0x037C
+
+
+
+#define		StPosition						0x054C
+// StPosition[8]
+#define			StPosition_0					(0x0000 + StPosition )					// 0x054C
+#define			StPosition_1					(0x0004 + StPosition )					// 0x0550
+#define			StPosition_2					(0x0008 + StPosition )					// 0x0554
+#define			StPosition_3					(0x000C + StPosition )					// 0x0558
+#define			StPosition_4					(0x0010 + StPosition )					// 0x055C
+#define			StPosition_5					(0x0014 + StPosition )					// 0x0560
+#define			StPosition_6					(0x0018 + StPosition )					// 0x0564
+#define			SiStepXY						(0x001C + StPosition )					// 0x0568
+
+#define		Optical_Offset					0x056C
+#define			Optical_Offset_X				(0x0000 + Optical_Offset )				// 0x056C
+#define			Optical_Offset_Y				(0x0004 + Optical_Offset )				// 0x0570
+
+#define		GYRO_RAM_Z						0x0618	//0x0618
+#define			GYRO_RAM_GYROZ_OFFSET			(0x0000 + GYRO_RAM_Z)					// 0x0618
+
+#define		GyroTemp						0x063C
+
+#define		AcclFilDly_X					0x0640
+#define		AcclFilDly_Y					0x0670
+#define		AcclFilDly_Z					0x06A0
+
+#define		AcclRAM_X						0x06D0
+#define			ACCLRAM_X_AC_ADIDAT			0x0000 + AcclRAM_X
+#define			ACCLRAM_X_AC_OFFSET			0x0004 + AcclRAM_X
+
+#define		AcclRAM_Y						0x06FC
+#define			ACCLRAM_Y_AC_ADIDAT			0x0000 + AcclRAM_Y
+#define			ACCLRAM_Y_AC_OFFSET			0x0004 + AcclRAM_Y
+
+#define		AcclRAM_Z						0x0728
+#define			ACCLRAM_Z_AC_ADIDAT			0x0000 + AcclRAM_Z
+#define			ACCLRAM_Z_AC_OFFSET			0x0004 + AcclRAM_Z
+
+
+#define		FRA_DMA							(0x278)
+#define			FRA_DMA_Control				(0x04 + FRA_DMA	)
+//#define			FRA_DMA_DeciCount			(0x0C + FRA_DMA	)
+#define			FRA_DMA_DeciShift			(0x10 + FRA_DMA	)
+#define			FRA_DMA_InputData			(0x18 + FRA_DMA	)
+#define			FRA_DMA_OutputData			(0x1C + FRA_DMA	)
+
+#define			FRA_DMA_Gain				(0x70 + FRA_DMA	)
+#define			FRA_DMA_Phase				(0x74 + FRA_DMA	)
+
+#define		HALL_FRA_X_COMMON				0x0574
+#define			HALL_FRA_XSININ					0x0000 + HALL_FRA_X_COMMON
+#define			HALL_FRA_XHOUTB					0x0004 + HALL_FRA_XSININ
+#define			HALL_FRA_XHOUTA					0x0004 + HALL_FRA_XHOUTB
+
+#define		HALL_FRA_Y_COMMON				0x0580
+#define			HALL_FRA_YSININ					0x0000 + HALL_FRA_Y_COMMON
+#define			HALL_FRA_YHOUTB					0x0004 + HALL_FRA_YSININ
+#define			HALL_FRA_YHOUTA					0x0004 + HALL_FRA_YHOUTB
+
+
+
+//==============================================================================
+//DMB
+//==============================================================================
+#define		SiVerNum						0x8000
+#define		SPI_MST				0x00
+#define		SPI_SLV				0x01
+#define		SPI_SNGL			0x02
+
+#define		ACT_SO2821			0x00	// SEMCO SO2821
+
+#define		ACT_45DEG			0xff	// dummy
+
+#define		GYRO_ICM20690		0x00
+#define		GYRO_LSM6DSM		0x02
+
+#define		StCalibrationData				0x8010
+// Calibration.h  CalibrationData_Type
+#define			StCaliData_UsCalibrationStatus	(0x0000 + StCalibrationData)
+#define			StCaliData_SiHallMax_Before_X	(0x0004 + StCaliData_UsCalibrationStatus)
+#define			StCaliData_SiHallMin_Before_X	(0x0004 + StCaliData_SiHallMax_Before_X)
+#define			StCaliData_SiHallMax_After_X	(0x0004 + StCaliData_SiHallMin_Before_X)
+#define			StCaliData_SiHallMin_After_X	(0x0004 + StCaliData_SiHallMax_After_X)
+#define			StCaliData_SiHallMax_Before_Y	(0x0004 + StCaliData_SiHallMin_After_X)
+#define			StCaliData_SiHallMin_Before_Y	(0x0004 + StCaliData_SiHallMax_Before_Y)
+#define			StCaliData_SiHallMax_After_Y	(0x0004 + StCaliData_SiHallMin_Before_Y)
+#define			StCaliData_SiHallMin_After_Y	(0x0004 + StCaliData_SiHallMax_After_Y)
+#define			StCaliData_UiHallBias_X			(0x0004 + StCaliData_SiHallMin_After_Y)
+#define			StCaliData_UiHallOffset_X		(0x0004 + StCaliData_UiHallBias_X)
+#define			StCaliData_UiHallBias_Y			(0x0004 + StCaliData_UiHallOffset_X)
+#define			StCaliData_UiHallOffset_Y		(0x0004 + StCaliData_UiHallBias_Y)
+#define			StCaliData_SiLoopGain_X			(0x0004 + StCaliData_UiHallOffset_Y)
+#define			StCaliData_SiLoopGain_Y			(0x0004 + StCaliData_SiLoopGain_X)
+#define			StCaliData_SiLensCen_Offset_X	(0x0004 + StCaliData_SiLoopGain_Y)
+#define			StCaliData_SiLensCen_Offset_Y	(0x0004 + StCaliData_SiLensCen_Offset_X)
+#define			StCaliData_SiOtpCen_Offset_X	(0x0004 + StCaliData_SiLensCen_Offset_Y)
+#define			StCaliData_SiOtpCen_Offset_Y	(0x0004 + StCaliData_SiOtpCen_Offset_X)
+#define			StCaliData_SiGyroOffset_X		(0x0004 + StCaliData_SiOtpCen_Offset_Y)
+#define			StCaliData_SiGyroOffset_Y		(0x0004 + StCaliData_SiGyroOffset_X)
+#define			StCaliData_SiGyroGain_X			(0x0004 + StCaliData_SiGyroOffset_Y)
+#define			StCaliData_SiGyroGain_Y			(0x0004 + StCaliData_SiGyroGain_X)
+#define			StCaliData_UiHallBias_AF		(0x0004 + StCaliData_SiGyroGain_Y)
+#define			StCaliData_UiHallOffset_AF		(0x0004 + StCaliData_UiHallBias_AF)
+#define			StCaliData_SiLoopGain_AF		(0x0004 + StCaliData_UiHallOffset_AF)
+#define			StCaliData_SiAD_Offset_AF		(0x0004 + StCaliData_SiLoopGain_AF)
+#define			StCaliData_SiMagnification_AF	(0x0004 + StCaliData_SiAD_Offset_AF)
+#define			StCaliData_SiHallMax_Before_AF	(0x0004 + StCaliData_SiMagnification_AF)
+#define			StCaliData_SiHallMin_Before_AF	(0x0004 + StCaliData_SiHallMax_Before_AF)
+#define			StCaliData_SiHallMax_After_AF	(0x0004 + StCaliData_SiHallMin_Before_AF)
+#define			StCaliData_SiHallMin_After_AF	(0x0004 + StCaliData_SiHallMax_After_AF)
+
+#define		HallFilterCoeffX				0x8090
+// HallFilterCoeff.h  DM_HFC_t
+#define			HallFilterCoeffX_HXIGAIN		(0x0000 + HallFilterCoeffX)
+#define			HallFilterCoeffX_GYROXOUTGAIN	(0x0004 + HallFilterCoeffX_HXIGAIN)
+#define			HallFilterCoeffX_HXOFFGAIN		(0x0004 + HallFilterCoeffX_GYROXOUTGAIN)
+
+#define			HallFilterCoeffX_hxiab			(0x0004 + HallFilterCoeffX_HXOFFGAIN)
+#define			HallFilterCoeffX_hxiac			(0x0004 + HallFilterCoeffX_hxiab)
+#define			HallFilterCoeffX_hxiaa			(0x0004 + HallFilterCoeffX_hxiac)
+#define			HallFilterCoeffX_hxibb			(0x0004 + HallFilterCoeffX_hxiaa)
+#define			HallFilterCoeffX_hxibc			(0x0004 + HallFilterCoeffX_hxibb)
+#define			HallFilterCoeffX_hxiba			(0x0004 + HallFilterCoeffX_hxibc)
+#define			HallFilterCoeffX_hxdab			(0x0004 + HallFilterCoeffX_hxiba)
+#define			HallFilterCoeffX_hxdac			(0x0004 + HallFilterCoeffX_hxdab)
+#define			HallFilterCoeffX_hxdaa			(0x0004 + HallFilterCoeffX_hxdac)
+#define			HallFilterCoeffX_hxdbb			(0x0004 + HallFilterCoeffX_hxdaa)
+#define			HallFilterCoeffX_hxdbc			(0x0004 + HallFilterCoeffX_hxdbb)
+#define			HallFilterCoeffX_hxdba			(0x0004 + HallFilterCoeffX_hxdbc)
+#define			HallFilterCoeffX_hxdcc			(0x0004 + HallFilterCoeffX_hxdba)
+#define			HallFilterCoeffX_hxdcb			(0x0004 + HallFilterCoeffX_hxdcc)
+#define			HallFilterCoeffX_hxdca			(0x0004 + HallFilterCoeffX_hxdcb)
+#define			HallFilterCoeffX_hxpgain0		(0x0004 + HallFilterCoeffX_hxdca)
+#define			HallFilterCoeffX_hxigain0		(0x0004 + HallFilterCoeffX_hxpgain0)
+#define			HallFilterCoeffX_hxdgain0		(0x0004 + HallFilterCoeffX_hxigain0)
+#define			HallFilterCoeffX_hxpgain1		(0x0004 + HallFilterCoeffX_hxdgain0)
+#define			HallFilterCoeffX_hxigain1		(0x0004 + HallFilterCoeffX_hxpgain1)
+#define			HallFilterCoeffX_hxdgain1		(0x0004 + HallFilterCoeffX_hxigain1)
+#define			HallFilterCoeffX_hxgain0		(0x0004 + HallFilterCoeffX_hxdgain1)
+#define			HallFilterCoeffX_hxgain1		(0x0004 + HallFilterCoeffX_hxgain0)
+
+#define			HallFilterCoeffX_hxsb			(0x0004 + HallFilterCoeffX_hxgain1)
+#define			HallFilterCoeffX_hxsc			(0x0004 + HallFilterCoeffX_hxsb)
+#define			HallFilterCoeffX_hxsa			(0x0004 + HallFilterCoeffX_hxsc)
+
+#define			HallFilterCoeffX_hxob			(0x0004 + HallFilterCoeffX_hxsa)
+#define			HallFilterCoeffX_hxoc			(0x0004 + HallFilterCoeffX_hxob)
+#define			HallFilterCoeffX_hxod			(0x0004 + HallFilterCoeffX_hxoc)
+#define			HallFilterCoeffX_hxoe			(0x0004 + HallFilterCoeffX_hxod)
+#define			HallFilterCoeffX_hxoa			(0x0004 + HallFilterCoeffX_hxoe)
+#define			HallFilterCoeffX_hxpb			(0x0004 + HallFilterCoeffX_hxoa)
+#define			HallFilterCoeffX_hxpc			(0x0004 + HallFilterCoeffX_hxpb)
+#define			HallFilterCoeffX_hxpd			(0x0004 + HallFilterCoeffX_hxpc)
+#define			HallFilterCoeffX_hxpe			(0x0004 + HallFilterCoeffX_hxpd)
+#define			HallFilterCoeffX_hxpa			(0x0004 + HallFilterCoeffX_hxpe)
+
+#define		HallFilterCoeffY				0x812c
+// HallFilterCoeff.h  DM_HFC_t
+#define			HallFilterCoeffY_HYIGAIN		(0x0000 + HallFilterCoeffY)
+#define			HallFilterCoeffY_GYROYOUTGAIN	(0x0004 + HallFilterCoeffY_HYIGAIN)
+#define			HallFilterCoeffY_HYOFFGAIN		(0x0004 + HallFilterCoeffY_GYROYOUTGAIN)
+
+#define			HallFilterCoeffY_hyiab			(0x0004 + HallFilterCoeffY_HYOFFGAIN)
+#define			HallFilterCoeffY_hyiac			(0x0004 + HallFilterCoeffY_hyiab)
+#define			HallFilterCoeffY_hyiaa			(0x0004 + HallFilterCoeffY_hyiac)
+#define			HallFilterCoeffY_hyibb			(0x0004 + HallFilterCoeffY_hyiaa)
+#define			HallFilterCoeffY_hyibc			(0x0004 + HallFilterCoeffY_hyibb)
+#define			HallFilterCoeffY_hyiba			(0x0004 + HallFilterCoeffY_hyibc)
+#define			HallFilterCoeffY_hydab			(0x0004 + HallFilterCoeffY_hyiba)
+#define			HallFilterCoeffY_hydac			(0x0004 + HallFilterCoeffY_hydab)
+#define			HallFilterCoeffY_hydaa			(0x0004 + HallFilterCoeffY_hydac)
+#define			HallFilterCoeffY_hydbb			(0x0004 + HallFilterCoeffY_hydaa)
+#define			HallFilterCoeffY_hydbc			(0x0004 + HallFilterCoeffY_hydbb)
+#define			HallFilterCoeffY_hydba			(0x0004 + HallFilterCoeffY_hydbc)
+#define			HallFilterCoeffY_hydcc			(0x0004 + HallFilterCoeffY_hydba)
+#define			HallFilterCoeffY_hydcb			(0x0004 + HallFilterCoeffY_hydcc)
+#define			HallFilterCoeffY_hydca			(0x0004 + HallFilterCoeffY_hydcb)
+#define			HallFilterCoeffY_hypgain0		(0x0004 + HallFilterCoeffY_hydca)
+#define			HallFilterCoeffY_hyigain0		(0x0004 + HallFilterCoeffY_hypgain0)
+#define			HallFilterCoeffY_hydgain0		(0x0004 + HallFilterCoeffY_hyigain0)
+#define			HallFilterCoeffY_hypgain1		(0x0004 + HallFilterCoeffY_hydgain0)
+#define			HallFilterCoeffY_hyigain1		(0x0004 + HallFilterCoeffY_hypgain1)
+#define			HallFilterCoeffY_hydgain1		(0x0004 + HallFilterCoeffY_hyigain1)
+#define			HallFilterCoeffY_hygain0		(0x0004 + HallFilterCoeffY_hydgain1)
+#define			HallFilterCoeffY_hygain1		(0x0004 + HallFilterCoeffY_hygain0)
+#define			HallFilterCoeffY_hysb			(0x0004 + HallFilterCoeffY_hygain1)
+#define			HallFilterCoeffY_hysc			(0x0004 + HallFilterCoeffY_hysb)
+#define			HallFilterCoeffY_hysa			(0x0004 + HallFilterCoeffY_hysc)
+#define			HallFilterCoeffY_hyob			(0x0004 + HallFilterCoeffY_hysa)
+#define			HallFilterCoeffY_hyoc			(0x0004 + HallFilterCoeffY_hyob)
+#define			HallFilterCoeffY_hyod			(0x0004 + HallFilterCoeffY_hyoc)
+#define			HallFilterCoeffY_hyoe			(0x0004 + HallFilterCoeffY_hyod)
+#define			HallFilterCoeffY_hyoa			(0x0004 + HallFilterCoeffY_hyoe)
+#define			HallFilterCoeffY_hypb			(0x0004 + HallFilterCoeffY_hyoa)
+#define			HallFilterCoeffY_hypc			(0x0004 + HallFilterCoeffY_hypb)
+#define			HallFilterCoeffY_hypd			(0x0004 + HallFilterCoeffY_hypc)
+#define			HallFilterCoeffY_hype			(0x0004 + HallFilterCoeffY_hypd)
+#define			HallFilterCoeffY_hypa			(0x0004 + HallFilterCoeffY_hype)
+
+#define		HallFilterLimitX				0x81c8
+#define		HallFilterLimitY				0x81e0
+#define		HallFilterShiftX				0x81f8
+#define		HallFilterShiftY				0x81fe
+
+#define		HF_MIXING						0x8214
+#define			HF_hx45x						(0x0000 + HF_MIXING	)		//0x008005E4 : HallMixingCoeff.hx45x
+#define			HF_hx45y						(0x0004 + HF_MIXING	)		//0x008005E8 : HallMixingCoeff.hx45y
+#define			HF_hy45y						(0x0008 + HF_MIXING	)		//0x008005EC : HallMixingCoeff.hy45y
+#define			HF_hy45x						(0x000C + HF_MIXING	)		//0x008005F0 : HallMixingCoeff.hy45x
+#define			HF_ShiftX						(0x0010 + HF_MIXING )
+
+#define		HAL_LN_CORRECT					0x8228
+#define			HAL_LN_COEFAX					(0x0000 + HAL_LN_CORRECT)	// HallLinearCorrAX.zone_coef[6]
+#define			HAL_LN_COEFBX					(0x000C + HAL_LN_COEFAX	)	// HallLinearCorrBX.zone_coef[6]
+#define			HAL_LN_ZONEX					(0x000C + HAL_LN_COEFBX	)	// HallLinearZoneX.zone_area[5]
+#define			HAL_LN_COEFAY					(0x000A + HAL_LN_ZONEX	)	// HallLinearCorrAY.zone_coef[6]
+#define			HAL_LN_COEFBY					(0x000C + HAL_LN_COEFAY	)	// HallLinearCorrBY.zone_coef[6]
+#define			HAL_LN_ZONEY					(0x000C + HAL_LN_COEFBY	)	// HallLinearZoneY.zone_area[5]
+
+#define		GyroFilterTableX				0x8270
+// GyroFilterCoeff.h  DM_GFC_t
+#define			GyroFilterTableX_gx45x			(0x0000 + GyroFilterTableX)
+#define			GyroFilterTableX_gx45y			(0x0004 + GyroFilterTableX_gx45x)
+#define			GyroFilterTableX_gxgyro			(0x0004 + GyroFilterTableX_gx45y)
+#define			GyroFilterTableX_gxsengen		(0x0004 + GyroFilterTableX_gxgyro)
+#define			GyroFilterTableX_gxl1b			(0x0004 + GyroFilterTableX_gxsengen)
+#define			GyroFilterTableX_gxl1c			(0x0004 + GyroFilterTableX_gxl1b)
+#define			GyroFilterTableX_gxl1a			(0x0004 + GyroFilterTableX_gxl1c)
+#define			GyroFilterTableX_gxl2b			(0x0004 + GyroFilterTableX_gxl1a)
+#define			GyroFilterTableX_gxl2c			(0x0004 + GyroFilterTableX_gxl2b)
+#define			GyroFilterTableX_gxl2a			(0x0004 + GyroFilterTableX_gxl2c)
+#define			GyroFilterTableX_gxigain		(0x0004 + GyroFilterTableX_gxl2a)
+#define			GyroFilterTableX_gxh1b			(0x0004 + GyroFilterTableX_gxigain)
+#define			GyroFilterTableX_gxh1c			(0x0004 + GyroFilterTableX_gxh1b)
+#define			GyroFilterTableX_gxh1a			(0x0004 + GyroFilterTableX_gxh1c)
+#define			GyroFilterTableX_gxk1b			(0x0004 + GyroFilterTableX_gxh1a)
+#define			GyroFilterTableX_gxk1c			(0x0004 + GyroFilterTableX_gxk1b)
+#define			GyroFilterTableX_gxk1a			(0x0004 + GyroFilterTableX_gxk1c)
+#define			GyroFilterTableX_gxgain			(0x0004 + GyroFilterTableX_gxk1a)
+#define			GyroFilterTableX_gxzoom			(0x0004 + GyroFilterTableX_gxgain)
+#define			GyroFilterTableX_gxlenz			(0x0004 + GyroFilterTableX_gxzoom)
+#define			GyroFilterTableX_gxt2b			(0x0004 + GyroFilterTableX_gxlenz)
+#define			GyroFilterTableX_gxt2c			(0x0004 + GyroFilterTableX_gxt2b)
+#define			GyroFilterTableX_gxt2a			(0x0004 + GyroFilterTableX_gxt2c)
+#define			GyroFilterTableX_afzoom			(0x0004 + GyroFilterTableX_gxt2a)
+
+#define		GyroFilterTableY				0x82D0
+// GyroFilterCoeff.h  DM_GFC_t
+#define			GyroFilterTableY_gy45y			(0x0000 + GyroFilterTableY)
+#define			GyroFilterTableY_gy45x			(0x0004 + GyroFilterTableY_gy45y)
+#define			GyroFilterTableY_gygyro			(0x0004 + GyroFilterTableY_gy45x)
+#define			GyroFilterTableY_gysengen		(0x0004 + GyroFilterTableY_gygyro)
+#define			GyroFilterTableY_gyl1b			(0x0004 + GyroFilterTableY_gysengen)
+#define			GyroFilterTableY_gyl1c			(0x0004 + GyroFilterTableY_gyl1b)
+#define			GyroFilterTableY_gyl1a			(0x0004 + GyroFilterTableY_gyl1c)
+#define			GyroFilterTableY_gyl2b			(0x0004 + GyroFilterTableY_gyl1a)
+#define			GyroFilterTableY_gyl2c			(0x0004 + GyroFilterTableY_gyl2b)
+#define			GyroFilterTableY_gyl2a			(0x0004 + GyroFilterTableY_gyl2c)
+#define			GyroFilterTableY_gyigain		(0x0004 + GyroFilterTableY_gyl2a)
+#define			GyroFilterTableY_gyh1b			(0x0004 + GyroFilterTableY_gyigain)
+#define			GyroFilterTableY_gyh1c			(0x0004 + GyroFilterTableY_gyh1b)
+#define			GyroFilterTableY_gyh1a			(0x0004 + GyroFilterTableY_gyh1c)
+#define			GyroFilterTableY_gyk1b			(0x0004 + GyroFilterTableY_gyh1a)
+#define			GyroFilterTableY_gyk1c			(0x0004 + GyroFilterTableY_gyk1b)
+#define			GyroFilterTableY_gyk1a			(0x0004 + GyroFilterTableY_gyk1c)
+#define			GyroFilterTableY_gygain			(0x0004 + GyroFilterTableY_gyk1a)
+#define			GyroFilterTableY_gyzoom			(0x0004 + GyroFilterTableY_gygain)
+#define			GyroFilterTableY_gylenz			(0x0004 + GyroFilterTableY_gyzoom)
+#define			GyroFilterTableY_gyt2b			(0x0004 + GyroFilterTableY_gylenz)
+#define			GyroFilterTableY_gyt2c			(0x0004 + GyroFilterTableY_gyt2b)
+#define			GyroFilterTableY_gyt2a			(0x0004 + GyroFilterTableY_gyt2c)
+#define			GyroFilterTableY_afzoom			(0x0004 + GyroFilterTableY_gyt2a)
+
+#define			Gyro_Limiter_X				0x8330
+#define			Gyro_Limiter_Y				0x8334
+#define			Gyro_ShiftX_RG				0x8338
+#define			Gyro_ShiftY_RG				0x833C
+
+#define		ZeroServoFilterTableX			0x8384
+#define			ZeroServoFilterTableX_coeff1_0	(0x0000 + ZeroServoFilterTableX)			// 0x8384
+#define			ZeroServoFilterTableX_coeff1_1	(0x0004 + ZeroServoFilterTableX_coeff1_0)	// 0x8388
+#define			ZeroServoFilterTableX_coeff1_2	(0x0004 + ZeroServoFilterTableX_coeff1_1)	// 0x838C
+#define			ZeroServoFilterTableX_g45main	(0x0004 + ZeroServoFilterTableX_coeff1_2)	// 0x8390
+#define			ZeroServoFilterTableX_g45sub	(0x0004 + ZeroServoFilterTableX_g45main)	// 0x8394
+#define			ZeroServoFilterTableX_gcora		(0x0004 + ZeroServoFilterTableX_g45sub)		// 0x8398
+#define			ZeroServoFilterTableX_gaina		(0x0004 + ZeroServoFilterTableX_gcora)		// 0x839C
+#define			ZeroServoFilterTableX_shift		(0x0004 + ZeroServoFilterTableX_gaina)		// 0x83A0
+
+#define		ZeroServoFilterTableY			0x83A4
+#define			ZeroServoFilterTableY_coeff1_0	(0x0000 + ZeroServoFilterTableY)			// 0x83A4
+#define			ZeroServoFilterTableY_coeff1_1	(0x0004 + ZeroServoFilterTableY_coeff1_0)	// 0x83A8
+#define			ZeroServoFilterTableY_coeff1_2	(0x0004 + ZeroServoFilterTableY_coeff1_1)	// 0x83AC
+#define			ZeroServoFilterTableY_g45main	(0x0004 + ZeroServoFilterTableY_coeff1_2)	// 0x83B0
+#define			ZeroServoFilterTableY_g45sub	(0x0004 + ZeroServoFilterTableY_g45main)	// 0x83B4
+#define			ZeroServoFilterTableY_gcora		(0x0004 + ZeroServoFilterTableY_g45sub)		// 0x83B8
+#define			ZeroServoFilterTableY_gaina		(0x0004 + ZeroServoFilterTableY_gcora)		// 0x83BC
+#define			ZeroServoFilterTableY_shift		(0x0004 + ZeroServoFilterTableY_gaina)		// 0x83C0
+
+#define		MeasureFilterA_Coeff			0x83C4	//0x8380
+// MeasureFilter.h  MeasureFilter_Type
+#define			MeasureFilterA_Coeff_b1			(0x0000 + MeasureFilterA_Coeff)
+#define			MeasureFilterA_Coeff_c1			(0x0004 + MeasureFilterA_Coeff_b1)
+#define			MeasureFilterA_Coeff_a1			(0x0004 + MeasureFilterA_Coeff_c1)
+#define			MeasureFilterA_Coeff_b2			(0x0004 + MeasureFilterA_Coeff_a1)
+#define			MeasureFilterA_Coeff_c2			(0x0004 + MeasureFilterA_Coeff_b2)
+#define			MeasureFilterA_Coeff_a2			(0x0004 + MeasureFilterA_Coeff_c2)
+
+#define		MeasureFilterB_Coeff			0x83DC	//0x8398
+// MeasureFilter.h  MeasureFilter_Type
+#define			MeasureFilterB_Coeff_b1			(0x0000 + MeasureFilterB_Coeff)
+#define			MeasureFilterB_Coeff_c1			(0x0004 + MeasureFilterB_Coeff_b1)
+#define			MeasureFilterB_Coeff_a1			(0x0004 + MeasureFilterB_Coeff_c1)
+#define			MeasureFilterB_Coeff_b2			(0x0004 + MeasureFilterB_Coeff_a1)
+#define			MeasureFilterB_Coeff_c2			(0x0004 + MeasureFilterB_Coeff_b2)
+#define			MeasureFilterB_Coeff_a2			(0x0004 + MeasureFilterB_Coeff_c2)
+
+#define		OLAF_DMB_FT						0x8510
+
+#define		OLAF_COEF						0x854C
+#define			OLAF_COEF_FSTVAL0				(0x0000 + OLAF_COEF)
+#define			OLAF_COEF_FSTVAL1				(0x0004 + OLAF_COEF)
+#define			OLAF_COEF_FSTVAL2				(0x0008 + OLAF_COEF)
+
+
+#define		CommandDecodeTable				0x85AC
+// Command.cpp  CommandTable in Rom
+#define			CommandDecodeTable_08			(0x0020 + CommandDecodeTable)
+
+#define		GCNV_XX							0x86A4
+#define		GCNV_XY							0x86A8
+#define		GCNV_YY							0x86AC
+#define		GCNV_YX							0x86B0
+#define		GCNV_ZP							0x86C8
+#define		ACNV_XX							0x86B4
+#define		ACNV_XY							0x86B8
+#define		ACNV_YY							0x867C
+#define		ACNV_YX							0x8680
+#define		ACNV_ZP							0x8684
+
+#define		Accl45Filter					0x8780
+#define			Accl45Filter_XAdir				(0x0000 + Accl45Filter )
+#define			Accl45Filter_XAmain				(0x0004 + Accl45Filter )
+#define			Accl45Filter_XAsub				(0x0008 + Accl45Filter )
+#define			Accl45Filter_YAdir				(0x000C + Accl45Filter )
+#define			Accl45Filter_YAmain				(0x0010 + Accl45Filter )
+#define			Accl45Filter_YAsub				(0x0014 + Accl45Filter )
+
+#define		ZS_LMT							0x87A4
+#define			ZS_LMT_limitx					(0x0000 + ZS_LMT )
+#define			ZS_LMT_limity					(0x0004 + ZS_LMT )
+
+
+#define			FRA_DMB_C0 					0x8908		//FRA_DMB.C0
+#define			FRA_DMB_S0 					0x890C		//FRA_DMB.S0
+#define			FRA_DMB_CN 					0x8910		//FRA_DMB.CN
+#define			FRA_DMB_SN 					0x8914		//FRA_DMB.SN
+
+
+//==============================================================================
+//IO
+//==============================================================================
+// System Control”z’uƒAƒhƒŒƒX
+#define 	PERICLKON						0xD00000
+#define 	SYSDSP_DSPDIV					0xD00014
+#define 	IOPLEV							0xD00020
+#define 	IOPDIR							0xD00024
+#define 	IOPUDON							0xD00028
+#define 	IOPUD							0xD0002C
+#define 	SYSDSP_SOFTRES					0xD0006C
+#define 	SYSDSP_STBOTH					0xD00078
+#define 	SYSDSP_DACI						0xD00088
+#define 	SYSDSP_OPGSEL					0xD0008C
+#define 	OSCRSEL							0xD00090
+#define 	OSCCURSEL						0xD00094
+#define 	FRQTRM							0xD00098
+#define 	SYSDSP_REMAP					0xD000AC
+#define 	OSCCNT							0xD000D4
+#define 	SYSDSP_CVER						0xD00100
+#define 	IOPLEVR							0xD00104
+#define 	OSCCKCNT						0xD00108
+
+#define 	ADDA_FSCNT						0xD01004
+#define 	ADDA_FSCTRL						0xD01008
+#define 	ADDA_ADDAINT					0xD0100C
+#define 	ADDA_ADE						0xD01010
+#define 	ADDA_ADAV						0xD01014
+#define 	ADDA_ADORDER					0xD01018
+#define 	ADDA_EXTEND						0xD0101C
+#define 	ADDA_AD0O						0xD01020
+#define 	ADDA_AD1O						0xD01024
+#define 	ADDA_AD2O						0xD01028
+#define 	ADDA_AD3O						0xD0102C
+
+#define 	ADDA_DASELW						0xD01040
+#define 	ADDA_DASU						0xD01044
+#define 	ADDA_DAHD						0xD01048
+#define 	ADDA_DASWAP						0xD0104C
+#define 	ADDA_DASEL						0xD01050
+#define	HLXO								0x00000001			// D/A Converter Channel Select HLXO
+#define	HLYO								0x00000002			// D/A Converter Channel Select HLYO
+#define	HLXBO								0x00000004			// D/A Converter Channel Select HLXBO
+#define	HLYBO								0x00000008			// D/A Converter Channel Select HLYBO
+#define	HLAFO								0x00000010			// D/A Converter Channel Select HLAFO
+#define	HLAFBO								0x00000020			// D/A Converter Channel Select HLAFBO
+
+#define 	ADDA_DAO						0xD01054
+
+// PWM I/F”z’uƒAƒhƒŒƒX
+#define 	OISDRVFC1						0xD02100
+#define 	OISDRVFC4						0xD0210C
+#define 	OISDRVFC5						0xD02110
+#define 	OISDRVFC6						0xD02114
+#define 	OISDRVFC7						0xD02118
+#define 	OISDRVFC8						0xD0211C
+#define 	OISDRVFC9						0xD02120
+
+#define 	DRVCH1SEL						0xD02128
+#define 	DRVCH2SEL						0xD0212C
+
+#define 	OISGAINAM						0xD02190
+#define 	OISOFSTAM						0xD02194
+#define 	OISGAINBM						0xD02198
+#define 	OISOFSTBM						0xD0219C
+
+#define 	AFDRVFC1						0xD02200
+#define 	AFDRVFC4						0xD0220C
+#define 	AFDRVFC5						0xD02210
+#define 	AFDRVFC6						0xD02214
+#define 	AFDRVFC7						0xD02218
+
+#define 	DRVCH3SEL						0xD02220
+
+#define 	AFGAINM							0xD02290
+#define 	AFSOFSTM						0xD02294
+
+//Periphral
+#define 	ROMINFO							0xE0500C
+#define 	SADR							0xE05030
+
+// E2PROM ”z’uƒAƒhƒŒƒX
+#define 	E2P_RDAT						0xE07000
+#define 	E2P_ADR							0xE07008
+#define 	E2P_ASCNT						0xE0700C
+#define 	E2P_CMD							0xE07010
+#define 	E2P_WPB							0xE07014
+#define 	E2P_INT							0xE07018
+
+#define 	E2P_WDAT00						0xE07040
+#define 	E2P_WDAT01						0xE07044
+#define 	E2P_WDAT02						0xE07048
+#define 	E2P_WDAT03						0xE0704C
+#define 	E2P_WDAT04						0xE07050
+#define 	E2P_WDAT05						0xE07054
+#define 	E2P_WDAT06						0xE07058
+#define 	E2P_WDAT07						0xE0705C
+#define 	E2P_WDAT08						0xE07060
+#define 	E2P_WDAT09						0xE07064
+#define 	E2P_WDAT10						0xE07068
+#define 	E2P_WDAT11						0xE0706C
+#define 	E2P_WDAT12						0xE07070
+#define 	E2P_WDAT13						0xE07074
+#define 	E2P_WDAT14						0xE07078
+#define 	E2P_WDAT15						0xE0707C
+#define 	E2P_DFG							0xE07080
+
+#define 	E2P_RSTB						0xE074CC
+#define 	E2P_UNLK_CODE1					0xE07554
+#define 	E2P_CLKON						0xE07664
+#define 	E2P_UNLK_CODE2					0xE07AA8
+#define 	E2P_UNLK_CODE3					0xE07CCC
+
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois_BOSCH.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois_BOSCH.h
new file mode 100644
index 0000000000000000000000000000000000000000..8b90bd5075d788713a73f96fc76239e6042ea5c8
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_ois/ois_fw/Ois_BOSCH.h
@@ -0,0 +1,32 @@
+//********************************************************************************
+//
+//		<< BMI260 Evaluation Soft>>
+//		Program Name	: Ois_BOSCH.h
+// 		Explanation		: BMI260 Global Declaration & ProtType Declaration
+//		Design			: K.abe
+//		History			: First edition	
+//********************************************************************************
+#define BMI260_SlvAddrWr	0xD0		// I2C Slave Address
+#define BMI260_SlvAddrRd	0xD1		// I2C Slave Address
+
+/************************************************/
+/*	Command Addrss								*/
+/************************************************/
+#define CHIP_ID_260			0x00
+
+#define	ACC_CONF_260		0x40
+#define ACC_RANGE_260		0x41
+#define	GYR_CONF_260		0x42
+#define GYR_RANGE_260		0x43
+#define IF_CONF_260			0x6B
+#define PWR_CONF_260		0x7C
+#define PWR_CTRL_260		0x7D
+
+/************************************************/
+/*	Data										*/
+/************************************************/
+#define AUX_EN_260			0
+#define GYR_EN_260			1
+#define ACC_EN_260			2
+#define	TEMP_EN_260			3
+
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_res_mgr/cam_res_mgr.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_res_mgr/cam_res_mgr.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/CAM_SENSOR_SETTINGS.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/CAM_SENSOR_SETTINGS.h
new file mode 100755
index 0000000000000000000000000000000000000000..bf046b8f627a751547c282fe2c004ee7ec546903
--- /dev/null
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/CAM_SENSOR_SETTINGS.h
@@ -0,0 +1,1843 @@
+.imx586_setting0 =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x0136, .reg_data = 0x13, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0137, .reg_data = 0x33, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7F, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0111, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3702, .reg_data = 0x1F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3706, .reg_data = 0x17, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3707, .reg_data = 0x6F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x380C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C00, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C01, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C02, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C03, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C04, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C05, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C06, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C07, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C08, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C09, .reg_data = 0xFF, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0B, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0D, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0E, .reg_data = 0xFF, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C0F, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F86, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F88, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F89, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F8E, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F8F, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D14, .reg_data = 0xA6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D29, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D45, .reg_data = 0x74, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D49, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D53, .reg_data = 0xB1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D55, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D5C, .reg_data = 0xA6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D71, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D7B, .reg_data = 0x51, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D8D, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D91, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D99, .reg_data = 0x3C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D9B, .reg_data = 0x17, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4D9D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DA4, .reg_data = 0xA6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DB9, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DD5, .reg_data = 0x72, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DD9, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DE3, .reg_data = 0xF5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DE5, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4DEC, .reg_data = 0xA6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E01, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E1D, .reg_data = 0x4A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E2B, .reg_data = 0x69, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E2D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E34, .reg_data = 0xA6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E49, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E65, .reg_data = 0x49, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E69, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E73, .reg_data = 0x7C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E75, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E81, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E85, .reg_data = 0x51, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E87, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E95, .reg_data = 0xBF, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4E97, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5282, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5715, .reg_data = 0x09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5717, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5729, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x572B, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x572D, .reg_data = 0x0C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x572F, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x578F, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x57BF, .reg_data = 0x5C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5855, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5857, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x585B, .reg_data = 0x52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x585F, .reg_data = 0x52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5861, .reg_data = 0x84, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5863, .reg_data = 0x9E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x586F, .reg_data = 0xA4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5C49, .reg_data = 0x59, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5C4A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5C4B, .reg_data = 0x9C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D0A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D0B, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D28, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D29, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D4A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D4B, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D68, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5D69, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x646F, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6607, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6630, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6659, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6682, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x66AB, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x66D4, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x66FD, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6726, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x674F, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6778, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C1C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C1D, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C1E, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C1F, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C5C, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C5D, .reg_data = 0x74, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C5E, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C60, .reg_data = 0x95, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C61, .reg_data = 0x1B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C63, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C64, .reg_data = 0x15, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C65, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C66, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C67, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C68, .reg_data = 0x4A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6A, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6B, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6C, .reg_data = 0x49, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6D, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6E, .reg_data = 0x99, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C6F, .reg_data = 0x13, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C71, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C72, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C73, .reg_data = 0x5E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C74, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C76, .reg_data = 0x74, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C77, .reg_data = 0xF9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C79, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C7A, .reg_data = 0x54, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C7B, .reg_data = 0x8E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C7D, .reg_data = 0x95, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C7E, .reg_data = 0x8B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C80, .reg_data = 0x2E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C81, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C82, .reg_data = 0x44, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C83, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C84, .reg_data = 0x45, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C85, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C87, .reg_data = 0x0C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C88, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C89, .reg_data = 0x51, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C8A, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C8B, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C8C, .reg_data = 0x19, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C8E, .reg_data = 0x45, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C8F, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C90, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C91, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C92, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C94, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C96, .reg_data = 0x60, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C97, .reg_data = 0x73, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C98, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C99, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9A, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9B, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9C, .reg_data = 0xC4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9D, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9E, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6C9F, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA0, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA1, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA2, .reg_data = 0x56, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA4, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA5, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA6, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA7, .reg_data = 0x60, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA8, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CA9, .reg_data = 0x15, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CAB, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CAC, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CAD, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CAE, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CAF, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB0, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB1, .reg_data = 0xFC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB2, .reg_data = 0xD0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB3, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB4, .reg_data = 0x63, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB5, .reg_data = 0x8A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB6, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB7, .reg_data = 0x09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CB8, .reg_data = 0x4B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBA, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBB, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBC, .reg_data = 0xE2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBD, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBE, .reg_data = 0x4A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CBF, .reg_data = 0x56, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC1, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC2, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC3, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC4, .reg_data = 0xE0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC5, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC6, .reg_data = 0x96, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC8, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CC9, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CCA, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CCB, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CCC, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CCD, .reg_data = 0x75, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CCE, .reg_data = 0xF9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD0, .reg_data = 0x60, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD1, .reg_data = 0x53, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD2, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD3, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD4, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD5, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD6, .reg_data = 0xC4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD7, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD8, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CD9, .reg_data = 0xE3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CDA, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CDB, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CDC, .reg_data = 0x52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CDE, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CDF, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE0, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE1, .reg_data = 0xE0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE2, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE3, .reg_data = 0x15, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE5, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE6, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE7, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE8, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CE9, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CEA, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CEB, .reg_data = 0x69, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CED, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CEE, .reg_data = 0x63, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CEF, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF0, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF1, .reg_data = 0x09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF2, .reg_data = 0x4B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF4, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF5, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF6, .reg_data = 0xE2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF7, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF8, .reg_data = 0x6A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CF9, .reg_data = 0x52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6CFB, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6E47, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F29, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F2A, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7100, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7101, .reg_data = 0x41, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7102, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7103, .reg_data = 0x92, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7104, .reg_data = 0x95, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7106, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7107, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7108, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7109, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x710A, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x710B, .reg_data = 0x75, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x710C, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x710E, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x710F, .reg_data = 0x53, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7110, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7111, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7112, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7113, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7114, .reg_data = 0x84, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7115, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7116, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7117, .reg_data = 0xC2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7118, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7119, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x711A, .reg_data = 0x46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x711C, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x711D, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x711E, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x711F, .reg_data = 0xE0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7120, .reg_data = 0x61, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7121, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7123, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7124, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7125, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7126, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7127, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7128, .reg_data = 0x64, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7129, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x712B, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x712C, .reg_data = 0x53, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x712D, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x712E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x712F, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7130, .reg_data = 0x0B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7132, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7133, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7134, .reg_data = 0xC2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7135, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7136, .reg_data = 0x65, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7137, .reg_data = 0x46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7139, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x713A, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+    },
+    .size = 300,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+
+},
+
+.imx586_setting1 =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x713B, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x713C, .reg_data = 0xE0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x713D, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x713E, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7140, .reg_data = 0x43, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7141, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7142, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7143, .reg_data = 0x68, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7144, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7145, .reg_data = 0x64, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7146, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7148, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7149, .reg_data = 0x63, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714A, .reg_data = 0x0E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714B, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714C, .reg_data = 0x89, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714D, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714E, .reg_data = 0x84, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x714F, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7150, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7151, .reg_data = 0xE3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7152, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7153, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7154, .reg_data = 0x4E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7156, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7157, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7158, .reg_data = 0x39, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7159, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x715A, .reg_data = 0x61, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x715B, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x715D, .reg_data = 0x44, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x715E, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x715F, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7160, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7161, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7162, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7163, .reg_data = 0x79, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7165, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7166, .reg_data = 0x63, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7167, .reg_data = 0x8E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7168, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7169, .reg_data = 0x09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x716A, .reg_data = 0x3B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x716C, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x716D, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x716E, .reg_data = 0xE4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x716F, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7170, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7171, .reg_data = 0x52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7173, .reg_data = 0x09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7174, .reg_data = 0x86, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7175, .reg_data = 0x41, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7176, .reg_data = 0x60, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7177, .reg_data = 0x72, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7178, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x717E, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7180, .reg_data = 0x79, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7189, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71C4, .reg_data = 0xE4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71C9, .reg_data = 0xC9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71CB, .reg_data = 0x3B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71CD, .reg_data = 0x9D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71CE, .reg_data = 0x53, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D0, .reg_data = 0xC9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D2, .reg_data = 0x1B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D4, .reg_data = 0x9D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D5, .reg_data = 0x63, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D7, .reg_data = 0xC9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71D9, .reg_data = 0xE2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71DA, .reg_data = 0x75, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71E7, .reg_data = 0xDA, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x71EC, .reg_data = 0xDA, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x895C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x895D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8962, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8967, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x896B, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x896F, .reg_data = 0x25, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8976, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8977, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9004, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9200, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9201, .reg_data = 0xA7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9202, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9203, .reg_data = 0xAA, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9204, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9205, .reg_data = 0xAD, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9206, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9207, .reg_data = 0xB0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9208, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9209, .reg_data = 0xB3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920A, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920B, .reg_data = 0x34, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920C, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920D, .reg_data = 0x36, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920E, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x920F, .reg_data = 0x37, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9210, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9211, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9212, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9213, .reg_data = 0x39, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9214, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9215, .reg_data = 0x3A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9216, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9217, .reg_data = 0x3C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9218, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9219, .reg_data = 0x3D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921A, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921B, .reg_data = 0x3E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921C, .reg_data = 0xB7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921D, .reg_data = 0x3F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921E, .reg_data = 0x77, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x921F, .reg_data = 0x77, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9222, .reg_data = 0xC4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9223, .reg_data = 0x4B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9224, .reg_data = 0xC4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9225, .reg_data = 0x4C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9226, .reg_data = 0xC4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9227, .reg_data = 0x4D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9385, .reg_data = 0xE6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9387, .reg_data = 0x55, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9389, .reg_data = 0x55, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x938B, .reg_data = 0x55, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x938D, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x938F, .reg_data = 0x3C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9391, .reg_data = 0x3C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9393, .reg_data = 0x32, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9395, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9397, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9399, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x939B, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x939D, .reg_data = 0x46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x939F, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93A1, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93A3, .reg_data = 0xB4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93A5, .reg_data = 0x8C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93A7, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93A9, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93AB, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93AD, .reg_data = 0xB4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93AF, .reg_data = 0x8C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93B1, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93B3, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93B5, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93B7, .reg_data = 0x64, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93B9, .reg_data = 0x64, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93BB, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93BD, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93BF, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93C1, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93C3, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93C5, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93C7, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93C9, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93CB, .reg_data = 0x8C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93CD, .reg_data = 0x8C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93CF, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93D1, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93D3, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93D5, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93D7, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93D9, .reg_data = 0x5A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93DB, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93DD, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93DF, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93E1, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93E3, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93E5, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93E7, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9810, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9814, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99B2, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99B3, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99B4, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99B5, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99B6, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E4, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E5, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E6, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E7, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E8, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99E9, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99EA, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99EB, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99EC, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99ED, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC76, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC77, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC79, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC7B, .reg_data = 0x78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC7C, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC7D, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xBC7F, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC020, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC027, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC13C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC140, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC141, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC142, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC143, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC145, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC146, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC149, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC448, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC44B, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC44C, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC44D, .reg_data = 0x2D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC44F, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC451, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC452, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC455, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC61D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC625, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC638, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xC63B, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xE286, .reg_data = 0x31, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xE2A6, .reg_data = 0x32, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xE2C6, .reg_data = 0x33, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xEC00, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0112, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0113, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0114, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0342, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0343, .reg_data = 0xC0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0340, .reg_data = 0x0E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0341, .reg_data = 0xFC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0344, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0345, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0346, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0347, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0348, .reg_data = 0x1F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0349, .reg_data = 0x3F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034A, .reg_data = 0x17, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034B, .reg_data = 0x6F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0220, .reg_data = 0x62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0222, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0900, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0901, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0902, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3140, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3246, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3247, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F15, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0401, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0404, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0405, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0408, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0409, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040B, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040C, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040D, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040E, .reg_data = 0x0B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040F, .reg_data = 0xB8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034C, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034D, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034E, .reg_data = 0x0B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034F, .reg_data = 0xB8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0301, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0303, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0305, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0306, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0307, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030B, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030D, .reg_data = 0x0C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030F, .reg_data = 0x45, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0310, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3620, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3621, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C11, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C12, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C13, .reg_data = 0x2D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F0C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F14, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F80, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F81, .reg_data = 0x90, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F8C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F8D, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FF8, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FF9, .reg_data = 0x2A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFE, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFF, .reg_data = 0x6C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0202, .reg_data = 0x0E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0203, .reg_data = 0xCC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0224, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0225, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE0, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE1, .reg_data = 0xF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0204, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0205, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0216, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0217, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0218, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0219, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020E, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020F, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0210, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0211, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0212, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0213, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0214, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0215, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE2, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE3, .reg_data = 0x70, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE4, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FE5, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0100, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+     },
+    .size = 308,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+
+},
+
+.streamoff =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x0100, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+     },
+    .size = 1,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+},
+
+.s5k3m5_setting =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x6028, .reg_data = 0x4000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0000, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0000, .reg_data = 0x30D5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6214, .reg_data = 0x7971, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6218, .reg_data = 0x7150, .delay = 0x03, .data_mask = 0x00},
+        {.reg_addr = 0x0A02, .reg_data = 0x7800, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6028, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x3EAC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0549, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0448, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x054A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC1F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC804, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x101A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA1F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xCC04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1BB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4210, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2E50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x10B5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4FF9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9949, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0120, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0880, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x10BD, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2DE9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF041, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x974C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x954F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0026, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB4F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6A52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3888, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x08B1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA4F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6A62, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x43F9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3E80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA4F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6A52, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xBDE8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF081, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2DE9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF041, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0746, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8C48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0E46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4068, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x84B2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x050C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2146, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2846, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x36F9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3146, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3846, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x37F9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x874F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4DF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0C26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4FF4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8061, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3A78, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3046, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x29F9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7878, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB8B3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8021, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3046, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x22F9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8048, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0088, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x804B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5C02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7E48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x001D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0088, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5E02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5C02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5E12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4218, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x02D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8002, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB0FB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF2F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x91B2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x784A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6012, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB2F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1602, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB2F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1422, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9805, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9A25, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8018, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x04D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9202, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB2FB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF0F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9C05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9C05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0A18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x01FB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x40F3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9510, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1028, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x06DC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0028, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x05DA, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x03E0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xFFE7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0122, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC5E7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6849, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0880, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2146, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2846, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xBDE8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF041, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0122, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xE2B8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF0B5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x644C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xDDE9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0565, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x08B1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2788, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0760, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x09B1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6088, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0860, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x12B1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA088, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x401C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1060, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0BB1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xE088, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1860, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0EB1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA07B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3060, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x002D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x01D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xE07B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2860, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF0BD, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x70B5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0646, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5048, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8068, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x84B2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x050C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2146, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2846, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xBEF8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3046, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC5F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5248, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0368, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7401, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x010A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5048, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4268, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5010, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7511, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5210, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7811, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x090A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5810, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7911, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5A10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x33F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF01F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0068, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x090A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xCE1F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5978, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8170, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5988, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x090A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0171, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xD978, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8171, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x988C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9074, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2500, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1075, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xD88C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9075, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2700, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1076, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB3F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7E00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB100, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2F48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x90F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB313, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8210, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x90F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB103, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8400, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xB400, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8600, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8800, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6211, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9610, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0112, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9E10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0212, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA010, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA200, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA400, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0512, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA610, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0612, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA810, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0712, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAA10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAC00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x5A20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAD00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x93F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0902, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x82F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAE00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2146, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2846, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xBDE8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7040, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0122, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x47B8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x10B5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0F4C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2080, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAFF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3321, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1748, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0161, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAFF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2D21, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x8161, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAFF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1121, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1448, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x45F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAFF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2911, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6060, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1148, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3EF8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0022, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xAFF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6B11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA060, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0F48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00F0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x37F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xE060, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x10BD, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4200, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2E50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x41D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x9404, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x38E0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xD000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xA410, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2C66, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0890, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3620, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0840, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x020D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x67CD, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3AE1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x45F6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x250C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x45F6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xF31C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4AF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xD74C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x40F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0D2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x010C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x46F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xCD7C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x4AF6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xE75C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0xC0F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x6047, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x30D5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x00FC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x41D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0100, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x1662, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x1E00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x1C9A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0FF2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0EF6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0100, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x23B2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0FE4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0107, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x07D0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x12F8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x3D09, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0E18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0040, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x1066, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x000C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x13DE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x12F2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0F0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x13DC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x806F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xF46E, .reg_data = 0x00C3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xF46C, .reg_data = 0xBFA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xF44A, .reg_data = 0x0007, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xF456, .reg_data = 0x000A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6028, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x12F6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x7008, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0BC6, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0B36, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6214, .reg_data = 0x7971, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6218, .reg_data = 0x7150, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0344, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0346, .reg_data = 0x0008, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0348, .reg_data = 0x1077, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034A, .reg_data = 0x0C37, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034C, .reg_data = 0x1070, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034E, .reg_data = 0x0C30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0340, .reg_data = 0x0CF0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0342, .reg_data = 0x12DC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0900, .reg_data = 0x0011, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0380, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0382, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0384, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0386, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0402, .reg_data = 0x1010, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0404, .reg_data = 0x1000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0350, .reg_data = 0x0008, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0352, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0136, .reg_data = 0x1333, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x013E, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0300, .reg_data = 0x0008, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0302, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0304, .reg_data = 0x0005, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0306, .reg_data = 0x00FB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0308, .reg_data = 0x0008, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030A, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030C, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030E, .reg_data = 0x0003, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0310, .reg_data = 0x0071, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0312, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0B06, .reg_data = 0x0101, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6028, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x1FF6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x021E, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0202, .reg_data = 0x0100, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0204, .reg_data = 0x0020, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0D00, .reg_data = 0x0101, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0D02, .reg_data = 0x0101, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0114, .reg_data = 0x0301, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0D06, .reg_data = 0x0208, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0D08, .reg_data = 0x0300, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6028, .reg_data = 0x2000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0F10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0003, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x0F12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0200, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x602A, .reg_data = 0x2BC0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x6F12, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0B30, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0B32, .reg_data = 0x0000, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0B34, .reg_data = 0x0001, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0100, .reg_data = 0x0100, .delay = 0x00, .data_mask = 0x00},
+    },
+    .size = 503,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .delay = 1,
+},
+
+.imx471_setting =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x0136, .reg_data = 0x13, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0137, .reg_data = 0x33, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7F, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x300A, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E35, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E36, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E37, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F7F, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4431, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531D, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5928, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5929, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592B, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592D, .reg_data = 0x32, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592E, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592F, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5930, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5931, .reg_data = 0x3D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5932, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5933, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5938, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5939, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593B, .reg_data = 0x7A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593D, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593E, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593F, .reg_data = 0x7A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5940, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5941, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5942, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5943, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5E12, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5E13, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F06, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F07, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0B, .reg_data = 0xEB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0C, .reg_data = 0xAE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0D, .reg_data = 0x15, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0E, .reg_data = 0x6E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0F, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F10, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F11, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F12, .reg_data = 0x92, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F13, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F14, .reg_data = 0x5E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F17, .reg_data = 0x5E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F18, .reg_data = 0xDC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F19, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1A, .reg_data = 0xDB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1B, .reg_data = 0xC7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1C, .reg_data = 0x5B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1D, .reg_data = 0x7E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1E, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1F, .reg_data = 0x51, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F20, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F21, .reg_data = 0x46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F22, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F23, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F24, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F25, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F26, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F27, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F28, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F29, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2A, .reg_data = 0x1A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2B, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2C, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2D, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2E, .reg_data = 0x61, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2F, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F30, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F31, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F32, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F33, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F34, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F35, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F36, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F37, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F38, .reg_data = 0x1A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F39, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3A, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3B, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3C, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3D, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3E, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3F, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F40, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F41, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F42, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F43, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F44, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F45, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F46, .reg_data = 0x2A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F47, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F48, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F49, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F4A, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F4B, .reg_data = 0xC0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F75, .reg_data = 0x27, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F76, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F77, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F78, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F79, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7990, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7993, .reg_data = 0x5D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7994, .reg_data = 0x5D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7995, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x799A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x799D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8169, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8359, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9300, .reg_data = 0x2A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9301, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9302, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9304, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9305, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9306, .reg_data = 0x1F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9308, .reg_data = 0x2D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9309, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930A, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930C, .reg_data = 0x2E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930D, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930E, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9310, .reg_data = 0x2E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9311, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9312, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9314, .reg_data = 0x31, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9315, .reg_data = 0x31, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9316, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9317, .reg_data = 0x19, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB046, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB048, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0112, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0113, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0114, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0342, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0343, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0340, .reg_data = 0x0E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0341, .reg_data = 0xB2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0344, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0345, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0346, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0347, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0348, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0349, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034A, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034B, .reg_data = 0xA7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0381, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0383, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0385, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0387, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0900, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0901, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0902, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F4C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F4D, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0408, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0409, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040B, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040C, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040D, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040E, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040F, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034C, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034D, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034E, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034F, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0301, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0303, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0305, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0306, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0307, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030B, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030D, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030E, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030F, .reg_data = 0xD4, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0310, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F78, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F79, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFE, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFF, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0A, .reg_data = 0xB2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0202, .reg_data = 0x0E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0203, .reg_data = 0xA0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0204, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0205, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020E, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020F, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0100, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+    },
+    .size = 198,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+},
+
+.gc5035_setting =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0xfc, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf4, .reg_data = 0x40, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf5, .reg_data = 0xc1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf6, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf8, .reg_data = 0x49, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf9, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfa, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x36, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd3, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x36, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x33, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x01, .reg_data = 0xe7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf7, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xee, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x87, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x90, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x05, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x06, .reg_data = 0xda, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9d, .reg_data = 0x0c, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x09, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0a, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0b, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0c, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0d, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0e, .reg_data = 0xa8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0f, .reg_data = 0x0a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x10, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x11, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x17, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x19, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x30, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x31, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd9, .reg_data = 0xc0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x1b, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x21, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x28, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x29, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x44, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4b, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4e, .reg_data = 0x1a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x50, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x52, .reg_data = 0x33, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x53, .reg_data = 0x44, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x55, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5b, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xc5, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x1a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x33, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x32, .reg_data = 0x38, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x91, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x92, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x95, .reg_data = 0xa0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x96, .reg_data = 0xe0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd5, .reg_data = 0xfc, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x97, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x16, .reg_data = 0x0c, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x1a, .reg_data = 0x1a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x1f, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x20, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x46, .reg_data = 0xe3, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4a, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x54, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x62, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x72, .reg_data = 0xcf, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x73, .reg_data = 0xc9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7a, .reg_data = 0x05, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7d, .reg_data = 0xcc, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x90, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xce, .reg_data = 0x98, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd0, .reg_data = 0xb2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd2, .reg_data = 0x40, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xe6, .reg_data = 0xe0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x12, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x13, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x14, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x15, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x22, .reg_data = 0xfc, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb0, .reg_data = 0x6e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb1, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb2, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb3, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb4, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xb6, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x53, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x89, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x60, .reg_data = 0x40, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x42, .reg_data = 0x21, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x49, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4a, .reg_data = 0xff, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4b, .reg_data = 0xc0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x55, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x41, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4c, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4d, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4e, .reg_data = 0x3c, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x44, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x48, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x91, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x92, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x94, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x95, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x96, .reg_data = 0x98, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x97, .reg_data = 0x0a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x98, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x02, .reg_data = 0x57, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x03, .reg_data = 0xb7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x15, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x18, .reg_data = 0x0f, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x21, .reg_data = 0x22, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x22, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x23, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x24, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x25, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x26, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x29, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x2a, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x2b, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3e, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf4, .reg_data = 0x40, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf5, .reg_data = 0xc1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf6, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf8, .reg_data = 0x49, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf9, .reg_data = 0x82, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfa, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x36, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd3, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x36, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x33, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x01, .reg_data = 0xe7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xf7, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xee, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x87, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x90, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x05, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x06, .reg_data = 0xda, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9d, .reg_data = 0x0c, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x09, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0a, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0b, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0c, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0d, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0e, .reg_data = 0xa8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0f, .reg_data = 0x0a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x10, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd9, .reg_data = 0xc0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x21, .reg_data = 0x48, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x29, .reg_data = 0x58, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x44, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4e, .reg_data = 0x1a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x1a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x91, .reg_data = 0x80, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x92, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x95, .reg_data = 0xa0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x96, .reg_data = 0xe0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd5, .reg_data = 0xfc, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x97, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x1f, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xce, .reg_data = 0x98, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xd0, .reg_data = 0xb2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x14, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x15, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfc, .reg_data = 0x8e, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x49, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4a, .reg_data = 0xff, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4b, .reg_data = 0xc0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x4e, .reg_data = 0x3c, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x44, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x91, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x92, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x93, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x94, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x95, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x96, .reg_data = 0x98, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x97, .reg_data = 0x0a, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x98, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x99, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x02, .reg_data = 0x57, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x22, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x26, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x29, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x2b, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8c, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xfe, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3e, .reg_data = 0x91, .delay = 0x00, .data_mask = 0x00},
+    },
+    .size = 249,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+
+},
+
+
+.imx481_setting =
+{
+    .reg_setting =
+    {
+        {.reg_addr = 0x0136, .reg_data = 0x13, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0137, .reg_data = 0x33, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7E, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3C7F, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F7F, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531D, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x531E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5928, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5929, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592B, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592D, .reg_data = 0x32, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592E, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x592F, .reg_data = 0x88, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5930, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5931, .reg_data = 0x3D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5932, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5933, .reg_data = 0x93, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5938, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5939, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593B, .reg_data = 0x7A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593C, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593D, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593E, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x593F, .reg_data = 0x7A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5940, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5941, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5942, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5943, .reg_data = 0x85, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5E12, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5E13, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F06, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F07, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0B, .reg_data = 0xEB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0C, .reg_data = 0xAE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0D, .reg_data = 0x15, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0E, .reg_data = 0x6E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0F, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F10, .reg_data = 0xA5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F11, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F12, .reg_data = 0x92, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F13, .reg_data = 0xB9, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F14, .reg_data = 0x5E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F17, .reg_data = 0x5E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F18, .reg_data = 0xDC, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F19, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1A, .reg_data = 0xDB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1B, .reg_data = 0xC7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1C, .reg_data = 0x5B, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1D, .reg_data = 0x7E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1E, .reg_data = 0x20, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F1F, .reg_data = 0x51, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F20, .reg_data = 0xA2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F21, .reg_data = 0x46, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F22, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F23, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F24, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F25, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F26, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F27, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F28, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F29, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2A, .reg_data = 0x1A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2B, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2C, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2D, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2E, .reg_data = 0x61, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F2F, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F30, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F31, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F32, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F33, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F34, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F35, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F36, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F37, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F38, .reg_data = 0x1A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F39, .reg_data = 0x1C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3A, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3B, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3C, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3D, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3E, .reg_data = 0x87, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F3F, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F40, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F41, .reg_data = 0x10, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F42, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F43, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F44, .reg_data = 0xC6, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F45, .reg_data = 0x07, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F46, .reg_data = 0x2A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F47, .reg_data = 0x1D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F48, .reg_data = 0x08, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F49, .reg_data = 0x76, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F4A, .reg_data = 0x81, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F4B, .reg_data = 0xC0, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F75, .reg_data = 0x27, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F76, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F77, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F78, .reg_data = 0xEE, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F79, .reg_data = 0xE5, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7990, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7993, .reg_data = 0x5D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7994, .reg_data = 0x5D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x7995, .reg_data = 0xA1, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x799A, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x799D, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8169, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x8359, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x88C7, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x88D4, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9300, .reg_data = 0x2A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9301, .reg_data = 0x24, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9302, .reg_data = 0x1E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9304, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9305, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9306, .reg_data = 0x1F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9308, .reg_data = 0x2D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9309, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930A, .reg_data = 0x26, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930C, .reg_data = 0x2E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930D, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x930E, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9310, .reg_data = 0x2E, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9311, .reg_data = 0x28, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9312, .reg_data = 0x23, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9314, .reg_data = 0x31, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9315, .reg_data = 0x31, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9316, .reg_data = 0x2C, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9317, .reg_data = 0x19, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9960, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9963, .reg_data = 0x64, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x9964, .reg_data = 0x50, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xA391, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB046, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB048, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0112, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0113, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0114, .reg_data = 0x03, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0342, .reg_data = 0x14, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0343, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0340, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0341, .reg_data = 0xEA, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0344, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0345, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0346, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0347, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0348, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0349, .reg_data = 0x2F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034A, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034B, .reg_data = 0xA7, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0381, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0383, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0385, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0387, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0900, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0901, .reg_data = 0x11, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0902, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F4C, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F4D, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0408, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0409, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040A, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040B, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040C, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040D, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040E, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x040F, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034C, .reg_data = 0x12, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034D, .reg_data = 0x30, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034E, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x034F, .reg_data = 0xA8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0301, .reg_data = 0x06, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0303, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0305, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0306, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0307, .reg_data = 0xAB, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030B, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030D, .reg_data = 0x0F, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030E, .reg_data = 0x04, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x030F, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0310, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E20, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E37, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3E3B, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F78, .reg_data = 0x02, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3F79, .reg_data = 0x0A, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFE, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x3FFF, .reg_data = 0x18, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x5F0A, .reg_data = 0xB2, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xA828, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xA829, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xA84F, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xA850, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB2DF, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0xB2E5, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0202, .reg_data = 0x0D, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0203, .reg_data = 0xD8, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0204, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0205, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020E, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x020F, .reg_data = 0x00, .delay = 0x00, .data_mask = 0x00},
+        {.reg_addr = 0x0100, .reg_data = 0x01, .delay = 0x00, .data_mask = 0x00},
+    },
+    .size = 206,
+    .addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+    .data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+    .delay = 1,
+},
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_core.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_core.c
old mode 100644
new mode 100755
index edd0cd28bd00d943297112aa9e4d6a6800432432..e82d543f7bbf4e27a199b03cb165709d96272d77
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_core.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_core.c
@@ -18,6 +18,271 @@
 #include "cam_trace.h"
 #include "cam_common_util.h"
 
+#include <linux/project_info.h>
+
+struct camera_vendor_match_tbl {
+	uint16_t sensor_id;
+	char sensor_name[32];
+	char vendor_name[32];
+};
+
+static struct camera_vendor_match_tbl match_tbl[] = {
+	{0x586,  "imx586", "Sony"    },
+	{0x30d5, "s5k3m5", "Samsung" },
+	{0x5035, "gc5035", "Gayxyc"  },
+	{0x471,  "imx471", "Sony"    },
+	{0x481,  "imx481", "Sony"    },
+};
+
+//imx471 DFCT info
+#define FD_DFCT_NUM_ADDR 0x7678
+#define SG_DFCT_NUM_ADDR 0x767A
+#define FD_DFCT_ADDR 0x8B00
+#define SG_DFCT_ADDR 0x8B10
+
+#define V_ADDR_SHIFT 12
+#define H_DATA_MASK 0xFFF80000
+#define V_DATA_MASK 0x0007FF80
+
+struct sony_dfct_tbl_t imx471_dfct_tbl;
+
+static int sensor_imx471_get_dpc_data(struct cam_sensor_ctrl_t *s_ctrl)
+{
+    int i = 0, j = 0;
+    int rc = 0;
+    int check_reg_val, dfct_data_h, dfct_data_l;
+    int dfct_data = 0;
+    int fd_dfct_num = 0, sg_dfct_num = 0;
+    int retry_cnt = 5;
+    int data_h = 0, data_v = 0;
+    int fd_dfct_addr = FD_DFCT_ADDR;
+    int sg_dfct_addr = SG_DFCT_ADDR;
+
+    CAM_INFO(CAM_SENSOR, "sensor_imx471_get_dpc_data enter");
+    if (s_ctrl == NULL) {
+        CAM_ERR(CAM_SENSOR, "Invalid Args");
+        return -EINVAL;
+    }
+
+    memset(&imx471_dfct_tbl, 0, sizeof(struct sony_dfct_tbl_t));
+
+    for (i = 0; i < retry_cnt; i++) {
+        check_reg_val = 0;
+        rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+            FD_DFCT_NUM_ADDR, &check_reg_val,
+            CAMERA_SENSOR_I2C_TYPE_WORD,
+            CAMERA_SENSOR_I2C_TYPE_BYTE);
+
+        if (0 == rc) {
+            fd_dfct_num = check_reg_val & 0x07;
+            if (fd_dfct_num > FD_DFCT_MAX_NUM)
+                fd_dfct_num = FD_DFCT_MAX_NUM;
+            break;
+        }
+    }
+
+    for (i = 0; i < retry_cnt; i++) {
+        check_reg_val = 0;
+        rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+            SG_DFCT_NUM_ADDR, &check_reg_val,
+            CAMERA_SENSOR_I2C_TYPE_WORD,
+            CAMERA_SENSOR_I2C_TYPE_WORD);
+
+        if (0 == rc) {
+            sg_dfct_num = check_reg_val & 0x01FF;
+            if (sg_dfct_num > SG_DFCT_MAX_NUM)
+                sg_dfct_num = SG_DFCT_MAX_NUM;
+            break;
+        }
+    }
+
+    CAM_INFO(CAM_SENSOR, " fd_dfct_num = %d, sg_dfct_num = %d", fd_dfct_num, sg_dfct_num);
+    imx471_dfct_tbl.fd_dfct_num = fd_dfct_num;
+    imx471_dfct_tbl.sg_dfct_num = sg_dfct_num;
+
+    if (fd_dfct_num > 0) {
+        for (j = 0; j < fd_dfct_num; j++) {
+            dfct_data = 0;
+            for (i = 0; i < retry_cnt; i++) {
+                dfct_data_h = 0;
+                rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+                        fd_dfct_addr, &dfct_data_h,
+                        CAMERA_SENSOR_I2C_TYPE_WORD,
+                        CAMERA_SENSOR_I2C_TYPE_WORD);
+                if (0 == rc) {
+                    break;
+                }
+            }
+            for (i = 0; i < retry_cnt; i++) {
+                dfct_data_l = 0;
+                rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+                        fd_dfct_addr+2, &dfct_data_l,
+                        CAMERA_SENSOR_I2C_TYPE_WORD,
+                        CAMERA_SENSOR_I2C_TYPE_WORD);
+                if (0 == rc) {
+                    break;
+                }
+            }
+            CAM_DBG(CAM_SENSOR, " dfct_data_h = 0x%x, dfct_data_l = 0x%x", dfct_data_h, dfct_data_l);
+            dfct_data = (dfct_data_h << 16) | dfct_data_l;
+            data_h = 0;
+            data_v = 0;
+            data_h = (dfct_data & (H_DATA_MASK >> j%8)) >> (19 - j%8); //19 = 32 -13;
+            data_v = (dfct_data & (V_DATA_MASK >> j%8)) >> (7 - j%8);  // 7 = 32 -13 -12;
+            CAM_DBG(CAM_SENSOR, "j = %d, H = %d, V = %d", j, data_h, data_v);
+            imx471_dfct_tbl.fd_dfct_addr[j] = ((data_h & 0x1FFF) << V_ADDR_SHIFT) | (data_v & 0x0FFF);
+            CAM_DBG(CAM_SENSOR, "fd_dfct_data[%d] = 0x%08x", j, imx471_dfct_tbl.fd_dfct_addr[j]);
+            fd_dfct_addr = fd_dfct_addr + 3 + ((j+1)%8 == 0);
+        }
+    }
+    if (sg_dfct_num > 0) {
+        for (j = 0; j < sg_dfct_num; j++) {
+            dfct_data = 0;
+            for (i = 0; i < retry_cnt; i++) {
+                dfct_data_h = 0;
+                rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+                        sg_dfct_addr, &dfct_data_h,
+                        CAMERA_SENSOR_I2C_TYPE_WORD,
+                        CAMERA_SENSOR_I2C_TYPE_WORD);
+                if (0 == rc) {
+                    break;
+                }
+            }
+            for (i = 0; i < retry_cnt; i++) {
+                dfct_data_l = 0;
+                rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+                        sg_dfct_addr+2, &dfct_data_l,
+                        CAMERA_SENSOR_I2C_TYPE_WORD,
+                        CAMERA_SENSOR_I2C_TYPE_WORD);
+                if (0 == rc) {
+                    break;
+                }
+            }
+            CAM_DBG(CAM_SENSOR, " dfct_data_h = 0x%x, dfct_data_l = 0x%x", dfct_data_h, dfct_data_l);
+            dfct_data = (dfct_data_h << 16) | dfct_data_l;
+            data_h = 0;
+            data_v = 0;
+            data_h = (dfct_data & (H_DATA_MASK >> j%8)) >> (19 - j%8); //19 = 32 -13;
+            data_v = (dfct_data & (V_DATA_MASK >> j%8)) >> (7 - j%8);  // 7 = 32 -13 -12;
+            CAM_DBG(CAM_SENSOR, "j = %d, H = %d, V = %d", j, data_h, data_v);
+            imx471_dfct_tbl.sg_dfct_addr[j] = ((data_h & 0x1FFF) << V_ADDR_SHIFT) | (data_v & 0x0FFF);
+            CAM_DBG(CAM_SENSOR, "sg_dfct_data[%d] = 0x%08x", j, imx471_dfct_tbl.sg_dfct_addr[j]);
+            sg_dfct_addr = sg_dfct_addr + 3 + ((j+1)%8 == 0);
+        }
+    }
+
+    CAM_INFO(CAM_SENSOR, "exit");
+    return rc;
+}
+
+static struct cam_sensor_i2c_reg_array lotid_on_setting[2] = {
+	{
+		.reg_addr = 0x0A02,
+		.reg_data = 0x7F,
+		.delay = 0x01,
+		.data_mask = 0x00
+	},
+	{
+		.reg_addr = 0x0A00,
+		.reg_data = 0x01,
+		.delay = 0x01,
+		.data_mask = 0x00
+	},
+};
+
+static struct cam_sensor_i2c_reg_array lotid_off_setting = {
+	.reg_addr = 0x0A00,
+	.reg_data = 0x00,
+	.delay = 0x01,
+	.data_mask = 0x00
+};
+
+static struct cam_sensor_i2c_reg_setting lotid_on = {
+	.reg_setting = lotid_on_setting,
+	.size = 2,
+	.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+	.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+	.delay = 5,
+};
+
+static struct cam_sensor_i2c_reg_setting lotid_off = {
+	.reg_setting = &lotid_off_setting,
+	.size = 1,
+	.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD,
+	.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE,
+	.delay = 5,
+};
+
+#define LOTID_START_ADDR 0x0A1F
+#define LOTID_LENGTH 8
+
+static char fuse_id[64] = {'\0'};
+
+static int sensor_get_fuseid(struct cam_sensor_ctrl_t *s_ctrl)
+{
+	int rc = 0;
+	uint16_t lotid_addr = LOTID_START_ADDR;
+	struct cam_camera_slave_info *slave_info;
+
+	int i = 0;
+	uint32_t check_reg_val = 0;
+	int retry_cnt = 5;
+	char str_tmp[6] = {'\0'};
+
+	slave_info = &(s_ctrl->sensordata->slave_info);
+	if (!slave_info) {
+		CAM_ERR(CAM_SENSOR, "slave_info is NULL: %pK",
+			slave_info);
+		return -EINVAL;
+	}
+
+	rc = camera_io_dev_read(
+		&(s_ctrl->io_master_info),
+		0x0A01,
+		&check_reg_val, CAMERA_SENSOR_I2C_TYPE_WORD,
+		CAMERA_SENSOR_I2C_TYPE_BYTE);
+
+	//enable read lot id
+	rc = camera_io_dev_write(
+		&(s_ctrl->io_master_info),
+		&lotid_on);
+
+	//verify lot id availability
+	for (i = 0; i < retry_cnt; i++) {
+		rc = camera_io_dev_read(
+			&(s_ctrl->io_master_info),
+			0x0A01,
+			&check_reg_val, CAMERA_SENSOR_I2C_TYPE_WORD,
+			CAMERA_SENSOR_I2C_TYPE_BYTE);
+		if (check_reg_val & (0x1))
+			break;
+	}
+
+	if (i == retry_cnt) {
+		CAM_ERR(CAM_SENSOR, "lot id not available");
+		return -EINVAL;
+	}
+
+	//read lot id
+	for (i = 0; i < LOTID_LENGTH; i++) {
+		rc = camera_io_dev_read(
+			&(s_ctrl->io_master_info),
+			lotid_addr+i,
+			&check_reg_val, CAMERA_SENSOR_I2C_TYPE_WORD,
+			CAMERA_SENSOR_I2C_TYPE_BYTE);
+		snprintf(str_tmp, sizeof(str_tmp), "%02x",
+			(check_reg_val&0x00FF));
+		strlcat(fuse_id, str_tmp, sizeof(fuse_id));
+	}
+
+	//disable read lot id
+	rc = camera_io_dev_write(
+		&(s_ctrl->io_master_info),
+		&lotid_off);
+
+	return 0;
+}
+
 static void cam_sensor_update_req_mgr(
 	struct cam_sensor_ctrl_t *s_ctrl,
 	struct cam_packet *csl_packet)
@@ -374,6 +639,10 @@ int32_t cam_sensor_update_slave_info(struct cam_cmd_probe *probe_info,
 		probe_info->expected_data;
 	s_ctrl->sensordata->slave_info.sensor_id_mask =
 		probe_info->data_mask;
+	s_ctrl->sensordata->slave_info.addr_type =
+		probe_info->addr_type;
+	s_ctrl->sensordata->slave_info.data_type =
+		probe_info->data_type;
 	/* Userspace passes the pipeline delay in reserved field */
 	s_ctrl->pipeline_delay =
 		probe_info->reserved;
@@ -381,14 +650,43 @@ int32_t cam_sensor_update_slave_info(struct cam_cmd_probe *probe_info,
 	s_ctrl->sensor_probe_addr_type =  probe_info->addr_type;
 	s_ctrl->sensor_probe_data_type =  probe_info->data_type;
 	CAM_DBG(CAM_SENSOR,
-		"Sensor Addr: 0x%x sensor_id: 0x%x sensor_mask: 0x%x sensor_pipeline_delay:0x%x",
+		"Sensor Addr: 0x%x Sensor Addr Type: 0x%x Sensor Data Type: 0x%x sensor_id: 0x%x sensor_mask: 0x%x sensor_pipeline_delay:0x%x",
 		s_ctrl->sensordata->slave_info.sensor_id_reg_addr,
+		s_ctrl->sensordata->slave_info.addr_type,
+		s_ctrl->sensordata->slave_info.data_type,
 		s_ctrl->sensordata->slave_info.sensor_id,
 		s_ctrl->sensordata->slave_info.sensor_id_mask,
 		s_ctrl->pipeline_delay);
 	return rc;
 }
 
+int32_t cam_sensor_update_id_info(struct cam_cmd_probe *probe_info,
+	struct cam_sensor_ctrl_t *s_ctrl)
+{
+	int32_t rc = 0;
+    
+	s_ctrl->sensordata->id_info.sensor_slave_addr =
+		probe_info->reserved;
+	s_ctrl->sensordata->id_info.sensor_id_reg_addr =
+		probe_info->reg_addr;
+	s_ctrl->sensordata->id_info.sensor_id_mask =
+		probe_info->data_mask;
+	s_ctrl->sensordata->id_info.sensor_id =
+		probe_info->expected_data;
+	s_ctrl->sensordata->id_info.sensor_addr_type =
+		probe_info->addr_type;
+	s_ctrl->sensordata->id_info.sensor_data_type =
+		probe_info->data_type;
+
+	CAM_INFO(CAM_SENSOR,
+		"eeprom_slave_addr:  0x%x, vendor_id_Addr: 0x%08x, vendorID: 0x%02x, vendor_mask: 0x%x",
+		s_ctrl->sensordata->id_info.sensor_slave_addr,
+		s_ctrl->sensordata->id_info.sensor_id_reg_addr,
+		s_ctrl->sensordata->id_info.sensor_id,
+		s_ctrl->sensordata->id_info.sensor_id_mask);
+	return rc;
+}
+
 int32_t cam_handle_cmd_buffers_for_probe(void *cmd_buf,
 	struct cam_sensor_ctrl_t *s_ctrl,
 	int32_t cmd_buf_num, int cmd_buf_length)
@@ -413,6 +711,15 @@ int32_t cam_handle_cmd_buffers_for_probe(void *cmd_buf,
 			CAM_ERR(CAM_SENSOR, "Updating the slave Info");
 			return rc;
 		}
+
+		probe_info = (struct cam_cmd_probe *)
+			(cmd_buf + sizeof(struct cam_cmd_i2c_info) + sizeof(struct cam_cmd_probe));
+		rc = cam_sensor_update_id_info(probe_info, s_ctrl);
+		if (rc < 0) {
+			CAM_ERR(CAM_SENSOR, "Updating the id Info");
+			return rc;
+		}
+
 		cmd_buf = probe_info;
 	}
 		break;
@@ -591,6 +898,10 @@ int cam_sensor_match_id(struct cam_sensor_ctrl_t *s_ctrl)
 	int rc = 0;
 	uint32_t chipid = 0;
 	struct cam_camera_slave_info *slave_info;
+	uint16_t sensor_slave_addr = 0;
+	uint32_t id = 0;
+	uint32_t id_l = 0;
+	uint32_t id_h = 0;
 
 	slave_info = &(s_ctrl->sensordata->slave_info);
 
@@ -603,16 +914,57 @@ int cam_sensor_match_id(struct cam_sensor_ctrl_t *s_ctrl)
 	rc = camera_io_dev_read(
 		&(s_ctrl->io_master_info),
 		slave_info->sensor_id_reg_addr,
-		&chipid, CAMERA_SENSOR_I2C_TYPE_WORD,
+		&chipid, slave_info->addr_type,
 		CAMERA_SENSOR_I2C_TYPE_WORD);
 
-	CAM_DBG(CAM_SENSOR, "read id: 0x%x expected id 0x%x:",
+	CAM_INFO(CAM_SENSOR, "read id: 0x%x expected id 0x%x:",
 			 chipid, slave_info->sensor_id);
 	if (cam_sensor_id_by_mask(s_ctrl, chipid) != slave_info->sensor_id) {
 		CAM_ERR(CAM_SENSOR, "chip id %x does not match %x",
 				chipid, slave_info->sensor_id);
 		return -ENODEV;
 	}
+
+	if ((s_ctrl->sensordata->id_info.sensor_id_reg_addr != 0) && (s_ctrl->sensordata->id_info.sensor_id != 0)){
+	    sensor_slave_addr = s_ctrl->io_master_info.cci_client->sid;
+	    s_ctrl->io_master_info.cci_client->sid = s_ctrl->sensordata->id_info.sensor_slave_addr >> 1;
+	    if (0x30d5 == slave_info->sensor_id) {//s5k3m5 eeprom located at imx586, set imx586 CCI master
+	    	s_ctrl->io_master_info.cci_client->cci_i2c_master = MASTER_1;
+	    }
+
+	    rc = camera_io_dev_read( &(s_ctrl->io_master_info),
+	            s_ctrl->sensordata->id_info.sensor_id_reg_addr & 0xFFFF,
+	            &id_l, s_ctrl->sensordata->id_info.sensor_addr_type,
+	            s_ctrl->sensordata->id_info.sensor_data_type);
+	    rc = camera_io_dev_read(&(s_ctrl->io_master_info),
+	            s_ctrl->sensordata->id_info.sensor_id_reg_addr >> 16,
+	            &id_h, s_ctrl->sensordata->id_info.sensor_addr_type,
+	            s_ctrl->sensordata->id_info.sensor_data_type);
+
+	    s_ctrl->io_master_info.cci_client->sid = sensor_slave_addr;
+	    if (0x30d5 == slave_info->sensor_id) {//set the CCI master back to s5k3m5
+	    	s_ctrl->io_master_info.cci_client->cci_i2c_master = MASTER_0;
+	    }
+
+	    id = (id_h << 8) | id_l;
+	    if (s_ctrl->sensordata->id_info.sensor_id != id) {
+	        CAM_INFO(CAM_SENSOR, "sensor_id: 0x%x, vendor_id 0x%x, does not match 0x%x",
+	            slave_info->sensor_id, id, s_ctrl->sensordata->id_info.sensor_id);
+	        return -1;
+	    } else {
+	        CAM_INFO(CAM_SENSOR, "sensor_id: 0x%x, vendor_id 0x%x matched", slave_info->sensor_id, id);
+	    }
+	}
+
+	if (slave_info->sensor_id == 0x0471) {
+		sensor_imx471_get_dpc_data(s_ctrl);
+	} else if (slave_info->sensor_id == 0x586 && fuse_id[0] == '\0') {
+		sensor_get_fuseid(s_ctrl);
+		CAM_INFO(CAM_SENSOR,
+		    "sensor_id: 0x%x, fuse_id:%s",
+		    slave_info->sensor_id, fuse_id);
+	}
+
 	return rc;
 }
 
@@ -623,6 +975,9 @@ int32_t cam_sensor_driver_cmd(struct cam_sensor_ctrl_t *s_ctrl,
 	struct cam_control *cmd = (struct cam_control *)arg;
 	struct cam_sensor_power_ctrl_t *power_info =
 		&s_ctrl->sensordata->power_info;
+	uint32_t count = 0, i;
+	int retry = 3;
+	enum COMPONENT_TYPE CameraID;
 	if (!s_ctrl || !arg) {
 		CAM_ERR(CAM_SENSOR, "s_ctrl is NULL");
 		return -EINVAL;
@@ -690,16 +1045,38 @@ int32_t cam_sensor_driver_cmd(struct cam_sensor_ctrl_t *s_ctrl,
 			goto free_power_settings;
 		}
 
-		/* Match sensor ID */
-		rc = cam_sensor_match_id(s_ctrl);
-		if (rc < 0) {
-			cam_sensor_power_down(s_ctrl);
-			msleep(20);
-			goto free_power_settings;
-		}
+		do {
+			/* Match sensor ID */
+			rc = cam_sensor_match_id(s_ctrl);
+			if (rc == -EINVAL || rc == -ENODEV) {
+				CAM_ERR(CAM_SENSOR,
+					"cam_sensor_match_id failed, rc %d", rc);
+
+				cam_sensor_power_down(s_ctrl);
+				msleep(20);
+				if (retry == 1) {
+					goto free_power_settings;
+				}
+
+				rc = cam_sensor_power_up(s_ctrl);
+				if (rc < 0) {
+					CAM_ERR(CAM_SENSOR, "fail in Sensor Power Down");
+					goto free_power_settings;
+				}
+			} else if (rc == -1) {
+				CAM_ERR(CAM_SENSOR,
+					"cam_sensor_match_id failed, vendor mismatch, rc %d", rc);
+				cam_sensor_power_down(s_ctrl);
+				msleep(20);
+				goto free_power_settings;
+			} else {
+				break;
+			}
+			retry--;
+		} while (retry > 0);
 
 		CAM_INFO(CAM_SENSOR,
-			"Probe success,slot:%d,slave_addr:0x%x,sensor_id:0x%x",
+			"Probe success,slot:%d, slave_addr:0x%x, sensor_id:0x%x",
 			s_ctrl->soc_info.index,
 			s_ctrl->sensordata->slave_info.sensor_slave_addr,
 			s_ctrl->sensordata->slave_info.sensor_id);
@@ -715,6 +1092,31 @@ int32_t cam_sensor_driver_cmd(struct cam_sensor_ctrl_t *s_ctrl,
 		 */
 		s_ctrl->is_probe_succeed = 1;
 		s_ctrl->sensor_state = CAM_SENSOR_INIT;
+
+		if (s_ctrl->id == 0)
+			CameraID = R_CAMERA;
+		else if (s_ctrl->id == 1)
+			CameraID = SECOND_R_CAMERA;
+		else if (s_ctrl->id == 2)
+			CameraID = F_CAMERA;
+		else if (s_ctrl->id == 3)
+			CameraID = THIRD_R_CAMERA;
+		else
+			CameraID = -1;
+
+		count = ARRAY_SIZE(match_tbl);
+		for (i = 0; i < count; i++) {
+			if (s_ctrl->sensordata->slave_info.sensor_id
+				== match_tbl[i].sensor_id)
+				break;
+		}
+		if (i >= count)
+			CAM_ERR(CAM_SENSOR, "current sensor name is 0x%x",
+				s_ctrl->sensordata->slave_info.sensor_id);
+		else
+			push_component_info(CameraID, match_tbl[i].sensor_name,
+				match_tbl[i].vendor_name);
+
 	}
 		break;
 	case CAM_ACQUIRE_DEV: {
@@ -943,6 +1345,35 @@ int32_t cam_sensor_driver_cmd(struct cam_sensor_ctrl_t *s_ctrl,
 		}
 	}
 		break;
+	case CAM_GET_DPC_DATA: {
+		if (0x0471 != s_ctrl->sensordata->slave_info.sensor_id) {
+			rc = -EFAULT;
+			goto release_mutex;
+		}
+		CAM_INFO(CAM_SENSOR, "imx471_dfct_tbl: fd_dfct_num=%d, sg_dfct_num=%d",
+			imx471_dfct_tbl.fd_dfct_num, imx471_dfct_tbl.sg_dfct_num);
+		if (copy_to_user((void __user *) cmd->handle, &imx471_dfct_tbl,
+			sizeof(struct  sony_dfct_tbl_t))) {
+			CAM_ERR(CAM_SENSOR, "Failed Copy to User");
+			rc = -EFAULT;
+			goto release_mutex;
+		}
+	}
+		break;
+	case CAM_GET_FUSE_ID: {
+		CAM_INFO(CAM_SENSOR, "fuse_id:%s", fuse_id);
+		if (fuse_id[0] == '\0') {
+			CAM_INFO(CAM_SENSOR, "fuse_id is empty");
+			rc = -EFAULT;
+			goto release_mutex;
+		} else if (copy_to_user((void __user *) cmd->handle, &fuse_id,
+			sizeof(fuse_id))) {
+			CAM_ERR(CAM_SENSOR, "Failed Copy to User");
+			rc = -EFAULT;
+			goto release_mutex;
+		}
+	}
+		break;
 	default:
 		CAM_ERR(CAM_SENSOR, "Invalid Opcode: %d", cmd->op_code);
 		rc = -EINVAL;
@@ -1094,6 +1525,7 @@ int cam_sensor_power_down(struct cam_sensor_ctrl_t *s_ctrl)
 		CAM_ERR(CAM_SENSOR, "failed: power_info %pK", power_info);
 		return -EINVAL;
 	}
+	cam_request_timeout_ws();
 	rc = cam_sensor_util_power_down(power_info, soc_info);
 	if (rc < 0) {
 		CAM_ERR(CAM_SENSOR, "power down the core is failed:%d", rc);
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.c
old mode 100644
new mode 100755
index 5207eee15f050b6a2ed7eb560a80b4068c3525ba..56781e4210d539eb3131e7b4c2793d3b736ac2d1
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.c
@@ -15,17 +15,159 @@
 #include "cam_sensor_soc.h"
 #include "cam_sensor_core.h"
 
+struct cam_sensor_i2c_reg_setting_array {
+	struct cam_sensor_i2c_reg_array reg_setting[1024];
+	unsigned short size;
+	enum camera_sensor_i2c_type addr_type;
+	enum camera_sensor_i2c_type data_type;
+	unsigned short delay;
+};
+
+struct cam_sensor_settings {
+    struct cam_sensor_i2c_reg_setting_array imx586_setting0;
+    struct cam_sensor_i2c_reg_setting_array imx586_setting1;
+    struct cam_sensor_i2c_reg_setting_array streamoff;
+    struct cam_sensor_i2c_reg_setting_array s5k3m5_setting;
+    struct cam_sensor_i2c_reg_setting_array imx471_setting;
+    struct cam_sensor_i2c_reg_setting_array imx481_setting;
+	struct cam_sensor_i2c_reg_setting_array gc5035_setting;
+};
+
+struct cam_sensor_settings sensor_settings = {
+#include "CAM_SENSOR_SETTINGS.h"
+};
+static bool is_ftm_current_test = false;
+static struct wakeup_source *cam_clk_ws;
+#define CAM_CLK_WS_TIMEOUT 50
+
+void cam_request_timeout_ws(void)
+{
+	__pm_wakeup_event(cam_clk_ws, CAM_CLK_WS_TIMEOUT);
+}
+
 static long cam_sensor_subdev_ioctl(struct v4l2_subdev *sd,
 	unsigned int cmd, void *arg)
 {
 	int rc = 0;
 	struct cam_sensor_ctrl_t *s_ctrl =
 		v4l2_get_subdevdata(sd);
-
+/* Add for AT camera test */
+	struct cam_sensor_i2c_reg_setting sensor_setting;
 	switch (cmd) {
 	case VIDIOC_CAM_CONTROL:
 		rc = cam_sensor_driver_cmd(s_ctrl, arg);
 		break;
+/* Add for AT camera test */
+	case VIDIOC_CAM_FTM_POWNER_DOWN:
+		CAM_ERR(CAM_SENSOR, "FTM stream off");
+        if (s_ctrl->sensordata->slave_info.sensor_id == 0x586
+                ||s_ctrl->sensordata->slave_info.sensor_id == 0x30d5
+                ||s_ctrl->sensordata->slave_info.sensor_id == 0x471
+                ||s_ctrl->sensordata->slave_info.sensor_id == 0x481
+                ||s_ctrl->sensordata->slave_info.sensor_id == 0x5035) {
+			          sensor_setting.reg_setting = sensor_settings.streamoff.reg_setting;
+			          sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+			          sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+			          sensor_setting.size = sensor_settings.streamoff.size;
+			          sensor_setting.delay = sensor_settings.streamoff.delay;
+            rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+
+            if (rc < 0) {
+    			/* If the I2C reg write failed for the first section reg, send
+                the result instead of keeping writing the next section of reg. */
+                CAM_ERR(CAM_SENSOR, "FTM Failed to stream off setting,rc=%d.",rc);
+            } else {
+                    CAM_ERR(CAM_SENSOR, "FTM successfully to stream off");
+            }
+        }
+		rc = cam_sensor_power_down(s_ctrl);
+        CAM_ERR(CAM_SENSOR, "FTM power down.rc=%d",rc);
+		break;
+	case VIDIOC_CAM_FTM_POWNER_UP:
+		rc = cam_sensor_power_up(s_ctrl);
+		CAM_ERR(CAM_SENSOR, "FTM power up sensor id 0x%x,result %d",s_ctrl->sensordata->slave_info.sensor_id,rc);
+		if (rc < 0) {
+			CAM_ERR(CAM_SENSOR, "FTM power up failed!");
+			break;
+		}
+        is_ftm_current_test = true;
+		if (s_ctrl->sensordata->slave_info.sensor_id == 0x586) {
+			CAM_ERR(CAM_SENSOR, "FTM sensor setting 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+			sensor_setting.reg_setting = sensor_settings.imx586_setting0.reg_setting;
+			sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+			sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+			sensor_setting.size = sensor_settings.imx586_setting0.size;
+			sensor_setting.delay = sensor_settings.imx586_setting0.delay;
+
+            rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+
+            if (rc < 0) {
+    			/* If the I2C reg write failed for the first section reg, send
+                the result instead of keeping writing the next section of reg. */
+                CAM_ERR(CAM_SENSOR, "FTM Failed to write sensor setting 1/2");
+				break;
+            } else {
+                    CAM_ERR(CAM_SENSOR, "FTM successfully to write sensor setting 1/2");
+            }
+
+            sensor_setting.reg_setting = sensor_settings.imx586_setting1.reg_setting;
+            sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+            sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+            sensor_setting.size = sensor_settings.imx586_setting1.size;
+            sensor_setting.delay = sensor_settings.imx586_setting1.delay;
+
+            rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+
+            if (rc < 0) {
+                    CAM_ERR(CAM_SENSOR, "FTM Failed to write sensor setting 2/2");
+            } else {
+                    CAM_ERR(CAM_SENSOR, "FTM successfully to write sensor setting 2/2");
+            }
+		} else {
+			if (s_ctrl->sensordata->slave_info.sensor_id == 0x30d5) {
+				CAM_ERR(CAM_SENSOR, "FTM sensor setting 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+				sensor_setting.reg_setting = sensor_settings.s5k3m5_setting.reg_setting;
+				sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+				sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+				sensor_setting.size = sensor_settings.s5k3m5_setting.size;
+				sensor_setting.delay = sensor_settings.s5k3m5_setting.delay;
+                rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+			} else if (s_ctrl->sensordata->slave_info.sensor_id == 0x5035) {
+				CAM_ERR(CAM_SENSOR, "FTM sensor setting 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+				sensor_setting.reg_setting = sensor_settings.gc5035_setting.reg_setting;
+				sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+				sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+				sensor_setting.size = sensor_settings.gc5035_setting.size;
+				sensor_setting.delay = sensor_settings.gc5035_setting.delay;
+                rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+			}else if (s_ctrl->sensordata->slave_info.sensor_id == 0x471) {
+				CAM_ERR(CAM_SENSOR, "FTM sensor setting 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+				sensor_setting.reg_setting = sensor_settings.imx471_setting.reg_setting;
+				sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+				sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+				sensor_setting.size = sensor_settings.imx471_setting.size;
+				sensor_setting.delay = sensor_settings.imx471_setting.delay;
+                rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+			} else if (s_ctrl->sensordata->slave_info.sensor_id == 0x481) {
+				CAM_ERR(CAM_SENSOR, "FTM sensor setting 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+				sensor_setting.reg_setting = sensor_settings.imx481_setting.reg_setting;
+				sensor_setting.addr_type = CAMERA_SENSOR_I2C_TYPE_WORD;
+				sensor_setting.data_type = CAMERA_SENSOR_I2C_TYPE_BYTE;
+				sensor_setting.size = sensor_settings.imx481_setting.size;
+				sensor_setting.delay = sensor_settings.imx481_setting.delay;
+                rc = camera_io_dev_write(&(s_ctrl->io_master_info), &sensor_setting);
+			}else{
+                CAM_ERR(CAM_SENSOR, "FTM unknown sensor id 0x%x",s_ctrl->sensordata->slave_info.sensor_id);
+                rc = -1;
+            }
+
+			if (rc < 0) {
+				CAM_ERR(CAM_SENSOR, "FTM Failed to write sensor setting");
+			} else {
+				CAM_ERR(CAM_SENSOR, "FTM successfully to write sensor setting");
+			}
+		}
+		break;
 	default:
 		CAM_ERR(CAM_SENSOR, "Invalid ioctl cmd: %d", cmd);
 		rc = -EINVAL;
@@ -46,7 +188,8 @@ static int cam_sensor_subdev_close(struct v4l2_subdev *sd,
 	}
 
 	mutex_lock(&(s_ctrl->cam_sensor_mutex));
-	cam_sensor_shutdown(s_ctrl);
+    if(!is_ftm_current_test)
+    	cam_sensor_shutdown(s_ctrl);
 	mutex_unlock(&(s_ctrl->cam_sensor_mutex));
 
 	return 0;
@@ -275,6 +418,7 @@ static int32_t cam_sensor_driver_platform_probe(
 	int32_t rc = 0, i = 0;
 	struct cam_sensor_ctrl_t *s_ctrl = NULL;
 	struct cam_hw_soc_info *soc_info = NULL;
+	static bool cam_clk_ws_flag = true;
 
 	/* Create sensor control structure */
 	s_ctrl = devm_kzalloc(&pdev->dev,
@@ -338,6 +482,11 @@ static int32_t cam_sensor_driver_platform_probe(
 	platform_set_drvdata(pdev, s_ctrl);
 	s_ctrl->sensor_state = CAM_SENSOR_INIT;
 
+	if (cam_clk_ws_flag) {
+		cam_clk_ws = wakeup_source_register("cam_clk");
+		cam_clk_ws_flag = false;
+	}
+
 	return rc;
 unreg_subdev:
 	cam_unregister_subdev(&(s_ctrl->v4l2_dev_str));
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.h
index e98a592dd5ea6a8cd9759b85fe934ede5a4d6e2a..6795033ce68698f0cb19ee68592779b1362a77d9 100644
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.h
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor/cam_sensor_dev.h
@@ -124,4 +124,5 @@ struct cam_sensor_ctrl_t {
 	uint16_t pipeline_delay;
 };
 
+void cam_request_timeout_ws(void);
 #endif /* _CAM_SENSOR_DEV_H_ */
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_io/cam_sensor_io.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_io/cam_sensor_io.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_io/cam_sensor_qup_i2c.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_io/cam_sensor_qup_i2c.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_cmn_header.h b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_cmn_header.h
old mode 100644
new mode 100755
index 5c5310987f62a653b2c64b5d30838dd7b4b26ddf..f7b07e2fe0847a6cc1ebd4da6b085498c8709a00
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_cmn_header.h
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_cmn_header.h
@@ -313,6 +313,17 @@ struct cam_camera_slave_info {
 	uint16_t sensor_id_reg_addr;
 	uint16_t sensor_id;
 	uint16_t sensor_id_mask;
+	uint8_t  addr_type;
+	uint8_t  data_type;
+};
+
+struct cam_camera_id_info {
+	uint16_t sensor_slave_addr;
+	uint16_t sensor_id_mask;
+	uint32_t sensor_id_reg_addr;
+	uint32_t sensor_id;
+	uint8_t sensor_addr_type;
+	uint8_t sensor_data_type;
 };
 
 struct msm_sensor_init_params {
@@ -353,6 +364,7 @@ struct cam_sensor_power_setting {
 
 struct cam_sensor_board_info {
 	struct cam_camera_slave_info slave_info;
+	struct cam_camera_id_info id_info;
 	int32_t sensor_mount_angle;
 	int32_t secure_mode;
 	int modes_supported;
diff --git a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_util.c b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_util.c
old mode 100644
new mode 100755
index a308c08010f5cab76148a838ede613915db31416..7dad9d43540ab2bda2fd5f9c964c2549458b4bca
--- a/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_util.c
+++ b/drivers/media/platform/msm/camera/cam_sensor_module/cam_sensor_utils/cam_sensor_util.c
@@ -26,7 +26,7 @@ static struct i2c_settings_list*
 		uint32_t size)
 {
 	struct i2c_settings_list *tmp;
-
+	int  retry_time = 3;
 	tmp = (struct i2c_settings_list *)
 		kzalloc(sizeof(struct i2c_settings_list), GFP_KERNEL);
 
@@ -39,6 +39,16 @@ static struct i2c_settings_list*
 	tmp->i2c_settings.reg_setting = (struct cam_sensor_i2c_reg_array *)
 		kcalloc(size, sizeof(struct cam_sensor_i2c_reg_array),
 			GFP_KERNEL);
+
+	while (tmp->i2c_settings.reg_setting == NULL && retry_time > 0) {
+		msleep(5);
+		tmp->i2c_settings.reg_setting = (struct cam_sensor_i2c_reg_array *)
+			kcalloc(size, sizeof(struct cam_sensor_i2c_reg_array),
+				GFP_KERNEL);
+		retry_time--;
+		CAM_ERR(CAM_SENSOR, "fail to alloc memory, retry = %d", retry_time);
+	}
+
 	if (tmp->i2c_settings.reg_setting == NULL) {
 		list_del(&(tmp->list));
 		kfree(tmp);
diff --git a/drivers/media/platform/msm/camera/cam_sync/cam_sync.c b/drivers/media/platform/msm/camera/cam_sync/cam_sync.c
index 7a772f1c4269d07ac087fbbea7e1ed678748b26f..cf60abecef75c7d2eedc28b0a9e106d09b4ba1b3 100644
--- a/drivers/media/platform/msm/camera/cam_sync/cam_sync.c
+++ b/drivers/media/platform/msm/camera/cam_sync/cam_sync.c
@@ -29,6 +29,20 @@ struct sync_device *sync_dev;
  */
 static bool trigger_cb_without_switch;
 
+static void cam_sync_print_table(void)
+{
+	int i = 0;
+
+	CAM_INFO(CAM_SYNC, "start to print sync obj table");
+
+	for (i = 0; i < CAM_SYNC_MAX_OBJS; i++) {
+		if (sync_dev->sync_table[i].state == CAM_SYNC_STATE_ACTIVE) {
+			CAM_INFO(CAM_SYNC, "sync id: %d, name %s",
+				i, sync_dev->sync_table[i].name);
+		}
+	}
+}
+
 int cam_sync_create(int32_t *sync_obj, const char *name)
 {
 	int rc;
@@ -37,8 +51,10 @@ int cam_sync_create(int32_t *sync_obj, const char *name)
 
 	do {
 		idx = find_first_zero_bit(sync_dev->bitmap, CAM_SYNC_MAX_OBJS);
-		if (idx >= CAM_SYNC_MAX_OBJS)
+		if (idx >= CAM_SYNC_MAX_OBJS) {
+			cam_sync_print_table();
 			return -ENOMEM;
+		}
 		CAM_DBG(CAM_SYNC, "Index location available at idx: %ld", idx);
 		bit = test_and_set_bit(idx, sync_dev->bitmap);
 	} while (bit);
diff --git a/drivers/media/platform/msm/camera/cam_utils/cam_debug_util.c b/drivers/media/platform/msm/camera/cam_utils/cam_debug_util.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_utils/cam_packet_util.c b/drivers/media/platform/msm/camera/cam_utils/cam_packet_util.c
old mode 100644
new mode 100755
diff --git a/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.c b/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.c
index f51b9d8472c615456bc98f6eaf590e66c72cc79b..bb1ba115bab401b93abc3edc40e82cdbc20adb01 100644
--- a/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.c
+++ b/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -574,7 +574,7 @@ int cam_soc_util_clk_disable(struct clk *clk, const char *clk_name)
 	if (!clk || !clk_name)
 		return -EINVAL;
 
-	CAM_DBG(CAM_UTIL, "disable %s", clk_name);
+	CAM_INFO(CAM_UTIL, "disable %s", clk_name);
 	clk_disable_unprepare(clk);
 
 	return 0;
@@ -1718,3 +1718,24 @@ int cam_soc_util_reg_dump(struct cam_hw_soc_info *soc_info,
 	return 0;
 }
 
+uint32_t cam_soc_util_get_vote_level(struct cam_hw_soc_info *soc_info,
+	uint64_t clock_rate)
+{
+	int i = 0;
+
+	if (!clock_rate)
+		return CAM_SVS_VOTE;
+
+	for (i = 0; i < CAM_MAX_VOTE; i++) {
+		if (soc_info->clk_level_valid[i] &&
+			soc_info->clk_rate[i][soc_info->src_clk_idx] >=
+			clock_rate) {
+			CAM_INFO(CAM_UTIL,
+				"Clock rate %lld, selected clock level %d",
+				clock_rate, i);
+			return i;
+		}
+	}
+
+	return CAM_TURBO_VOTE;
+}
diff --git a/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.h b/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.h
index 0880572a130d945143427a60700699c94dba52d4..0ee8445c0129fb6be103af91d55b8fcfac99197c 100644
--- a/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.h
+++ b/drivers/media/platform/msm/camera/cam_utils/cam_soc_util.h
@@ -1,4 +1,4 @@
-/* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -631,4 +631,7 @@ void cam_soc_util_clk_disable_default(struct cam_hw_soc_info *soc_info);
 int cam_soc_util_clk_enable_default(struct cam_hw_soc_info *soc_info,
 	enum cam_vote_level clk_level);
 
+uint32_t cam_soc_util_get_vote_level(struct cam_hw_soc_info *soc_info,
+	uint64_t clock_rate);
+
 #endif /* _CAM_SOC_UTIL_H_ */
diff --git a/drivers/media/platform/msm/sde/rotator/sde_rotator_base.c b/drivers/media/platform/msm/sde/rotator/sde_rotator_base.c
index fde1d1a9f0e71e0d1509fdc29b8eeea1d4e8bfbf..ca88421b5bad4723f07ed438e496224b3e9889a2 100644
--- a/drivers/media/platform/msm/sde/rotator/sde_rotator_base.c
+++ b/drivers/media/platform/msm/sde/rotator/sde_rotator_base.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2012, 2015-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2012, 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -145,6 +145,7 @@ void sde_mdp_halt_vbif_xin(struct sde_mdp_vbif_halt_params *params)
 	struct sde_rot_data_type *mdata = sde_rot_get_mdata();
 	u32 reg_val;
 	bool forced_on;
+	int rc = 0;
 
 	if (!mdata || !params || !params->reg_off_mdp_clk_ctrl) {
 		SDEROT_ERR("null input parameter\n");
@@ -166,7 +167,9 @@ void sde_mdp_halt_vbif_xin(struct sde_mdp_vbif_halt_params *params)
 		reg_val | BIT(params->xin_id));
 
 	/* this is a polling operation */
-	sde_mdp_wait_for_xin_halt(params->xin_id);
+	rc = sde_mdp_wait_for_xin_halt(params->xin_id);
+	if (rc == -ETIMEDOUT)
+		params->xin_timeout = BIT(params->xin_id);
 
 	reg_val = SDE_VBIF_READ(mdata, MMSS_VBIF_XIN_HALT_CTRL0);
 	SDE_VBIF_WRITE(mdata, MMSS_VBIF_XIN_HALT_CTRL0,
diff --git a/drivers/media/platform/msm/sde/rotator/sde_rotator_base.h b/drivers/media/platform/msm/sde/rotator/sde_rotator_base.h
index e2cf9f19ad6d95fab5bcca36a7be5c1ce842f344..371e6718b0c75721e36a8180beeedb90244462fa 100644
--- a/drivers/media/platform/msm/sde/rotator/sde_rotator_base.h
+++ b/drivers/media/platform/msm/sde/rotator/sde_rotator_base.h
@@ -1,4 +1,4 @@
-/* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -76,11 +76,13 @@ struct sde_mdp_set_ot_params {
  * @xin_id: xin port number of vbif
  * @reg_off_mdp_clk_ctrl: reg offset for vbif clock control
  * @bit_off_mdp_clk_ctrl: bit offset for vbif clock control
+ * @xin_timeout: bit position indicates timeout on corresponding xin id
  */
 struct sde_mdp_vbif_halt_params {
 	u32 xin_id;
 	u32 reg_off_mdp_clk_ctrl;
 	u32 bit_off_mdp_clk_ctrl;
+	u32 xin_timeout;
 };
 
 enum sde_bus_vote_type {
diff --git a/drivers/media/platform/msm/sde/rotator/sde_rotator_r3.c b/drivers/media/platform/msm/sde/rotator/sde_rotator_r3.c
index 17580250b0c7e5ae03d06e0e4f79af3c2277a9c1..ccbd63116fcb8205055146d08c0922f29c46f1a8 100644
--- a/drivers/media/platform/msm/sde/rotator/sde_rotator_r3.c
+++ b/drivers/media/platform/msm/sde/rotator/sde_rotator_r3.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2015-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2015-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -973,9 +973,10 @@ static int sde_hw_rotator_enable_irq(struct sde_hw_rotator *rot)
 	return ret;
 }
 
-static void sde_hw_rotator_halt_vbif_xin_client(void)
+static int sde_hw_rotator_halt_vbif_xin_client(void)
 {
 	struct sde_mdp_vbif_halt_params halt_params;
+	int rc = 0;
 
 	memset(&halt_params, 0, sizeof(struct sde_mdp_vbif_halt_params));
 	halt_params.xin_id = XIN_SSPP;
@@ -983,6 +984,7 @@ static void sde_hw_rotator_halt_vbif_xin_client(void)
 	halt_params.bit_off_mdp_clk_ctrl =
 		MMSS_VBIF_NRT_VBIF_CLK_FORCE_CTRL0_XIN0;
 	sde_mdp_halt_vbif_xin(&halt_params);
+	rc |=  halt_params.xin_timeout;
 
 	memset(&halt_params, 0, sizeof(struct sde_mdp_vbif_halt_params));
 	halt_params.xin_id = XIN_WRITEBACK;
@@ -990,6 +992,9 @@ static void sde_hw_rotator_halt_vbif_xin_client(void)
 	halt_params.bit_off_mdp_clk_ctrl =
 		MMSS_VBIF_NRT_VBIF_CLK_FORCE_CTRL0_XIN1;
 	sde_mdp_halt_vbif_xin(&halt_params);
+	rc |=  halt_params.xin_timeout;
+
+	return rc;
 }
 
 /**
@@ -2306,7 +2311,10 @@ static u32 sde_hw_rotator_wait_done_regdma(
 					__sde_hw_rotator_get_timestamp(rot,
 					ROT_QUEUE_LOW_PRIORITY);
 
-			if (ubwcerr || abort) {
+			spin_unlock_irqrestore(&rot->rotisr_lock, flags);
+
+			if (ubwcerr || abort ||
+					sde_hw_rotator_halt_vbif_xin_client()) {
 				/*
 				 * Perform recovery for ROT SSPP UBWC decode
 				 * error.
@@ -2314,16 +2322,15 @@ static u32 sde_hw_rotator_wait_done_regdma(
 				 * - reset TS logic so all pending rotation
 				 *   in hw queue got done signalled
 				 */
-				spin_unlock_irqrestore(&rot->rotisr_lock,
-						flags);
 				if (!sde_hw_rotator_reset(rot, ctx))
 					status = REGDMA_INCOMPLETE_CMD;
 				else
 					status = ROT_ERROR_BIT;
-				spin_lock_irqsave(&rot->rotisr_lock, flags);
 			} else {
 				status = ROT_ERROR_BIT;
 			}
+
+			spin_lock_irqsave(&rot->rotisr_lock, flags);
 		} else {
 			if (rc == 1)
 				SDEROT_WARN(
diff --git a/drivers/media/platform/msm/vidc/msm_vidc.c b/drivers/media/platform/msm/vidc/msm_vidc.c
index 438d1df63465323644dd1c2912eae933c0916c8f..94ddce07de1efa9dfe859e7897097ff8d3dd1cb9 100644
--- a/drivers/media/platform/msm/vidc/msm_vidc.c
+++ b/drivers/media/platform/msm/vidc/msm_vidc.c
@@ -1845,7 +1845,7 @@ void *msm_vidc_open(int core_id, int session_type)
 		goto err_invalid_core;
 	}
 
-	pr_info(VIDC_DBG_TAG "Opening video instance: %pK, %d\n",
+	pr_debug(VIDC_DBG_TAG "Opening video instance: %pK, %d\n",
 		"info", inst, session_type);
 	mutex_init(&inst->sync_lock);
 	mutex_init(&inst->bufq[CAPTURE_PORT].lock);
@@ -2121,7 +2121,7 @@ int msm_vidc_destroy(struct msm_vidc_inst *inst)
 
 	msm_vidc_debugfs_deinit_inst(inst);
 
-	pr_info(VIDC_DBG_TAG "Closed video instance: %pK\n",
+	pr_debug(VIDC_DBG_TAG "Closed video instance: %pK\n",
 			"info", inst);
 	kfree(inst);
 	return 0;
diff --git a/drivers/media/platform/msm/vidc/msm_vidc_common.c b/drivers/media/platform/msm/vidc/msm_vidc_common.c
index b050879b79c6177c65f90673049afd70933030bf..f4630fb36f5055c253d44f61937d3e2771928c8a 100644
--- a/drivers/media/platform/msm/vidc/msm_vidc_common.c
+++ b/drivers/media/platform/msm/vidc/msm_vidc_common.c
@@ -6331,8 +6331,8 @@ int msm_comm_qbuf_cache_operations(struct msm_vidc_inst *inst,
 					V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
 				if (!i) { /* yuv */
 					skip = false;
-					offset = vb->planes[i].data_offset;
-					size = vb->planes[i].bytesused;
+					offset = 0;
+					size = vb->planes[i].length;
 					cache_op = SMEM_CACHE_INVALIDATE;
 				}
 			}
@@ -6348,8 +6348,8 @@ int msm_comm_qbuf_cache_operations(struct msm_vidc_inst *inst,
 					V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
 				if (!i) { /* bitstream */
 					skip = false;
-					offset = vb->planes[i].data_offset;
-					size = vb->planes[i].bytesused;
+					offset = 0;
+					size = vb->planes[i].length;
 					cache_op = SMEM_CACHE_INVALIDATE;
 				}
 			}
diff --git a/drivers/media/usb/em28xx/em28xx-dvb.c b/drivers/media/usb/em28xx/em28xx-dvb.c
index 4a7db623fe291031cec327a3189b866ffa14e843..29cdaaf1ed90bf4ccdc36a5d9d97c6af6018eef4 100644
--- a/drivers/media/usb/em28xx/em28xx-dvb.c
+++ b/drivers/media/usb/em28xx/em28xx-dvb.c
@@ -2105,6 +2105,8 @@ static int em28xx_dvb_fini(struct em28xx *dev)
 		}
 	}
 
+	em28xx_unregister_dvb(dvb);
+
 	/* remove I2C SEC */
 	client = dvb->i2c_client_sec;
 	if (client) {
@@ -2126,7 +2128,6 @@ static int em28xx_dvb_fini(struct em28xx *dev)
 		i2c_unregister_device(client);
 	}
 
-	em28xx_unregister_dvb(dvb);
 	kfree(dvb);
 	dev->dvb = NULL;
 	kref_put(&dev->ref, em28xx_free_device);
diff --git a/drivers/misc/Kconfig b/drivers/misc/Kconfig
index b4bff76aa5e5bb52e0d017f84b3097b8b820cb37..8fd1fee1333398a44a0c4e7e7d0872eeada4b917 100644
--- a/drivers/misc/Kconfig
+++ b/drivers/misc/Kconfig
@@ -553,6 +553,14 @@ config QPNP_MISC
 	  and the driver provides an API to check if this interrupt
 	  is available on the current PMIC chip.
 
+#add by xcb
+config BOOTLOADER_LOG
+	tristate "show bootloader log"
+	depends on OF
+	default y
+	help
+	  show bootloader log in kernel
+
 source "drivers/misc/c2port/Kconfig"
 source "drivers/misc/eeprom/Kconfig"
 source "drivers/misc/cb710/Kconfig"
diff --git a/drivers/misc/Makefile b/drivers/misc/Makefile
index cede44e65424f1c556fbba7fefaa2a1236366ef6..b2cef09030b831cd3f19391c535898ae947a2f9c 100644
--- a/drivers/misc/Makefile
+++ b/drivers/misc/Makefile
@@ -84,4 +84,5 @@ targets += lkdtm_rodata.o lkdtm_rodata_objcopy.o
 $(obj)/lkdtm_rodata_objcopy.o: $(obj)/lkdtm_rodata.o FORCE
 	$(call if_changed,objcopy)
 
+obj-$(CONFIG_BOOTLOADER_LOG)	+= bootloader_log.o
 obj-$(CONFIG_OKL4_LINK_SHBUF)    += okl4-link-shbuf.o
diff --git a/drivers/misc/bootloader_log.c b/drivers/misc/bootloader_log.c
new file mode 100644
index 0000000000000000000000000000000000000000..6b3be597e2e3b7483ede698e9cdc37f8711c4524
--- /dev/null
+++ b/drivers/misc/bootloader_log.c
@@ -0,0 +1,228 @@
+/* Copyright (c) 2016 OnePlus. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/kernel.h>
+#include <linux/mm.h>
+#include <asm/pgtable.h>
+#include <linux/err.h>
+#include <linux/module.h>
+#include <linux/device.h>
+#include <linux/types.h>
+#include <linux/platform_device.h>
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+#include <linux/of_address.h>
+#include <linux/fs.h>
+#include <linux/init.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+
+struct bootloader_log_platform_data {
+	unsigned long	mem_size;
+	unsigned long	mem_address;
+	unsigned int	mem_type;
+
+};
+
+struct bootloader_log_ram_zone_t {
+	phys_addr_t paddr;
+	size_t size;
+	void *vaddr;
+	char *buffer;
+
+} bootloader_log_ram_zone;
+
+static int bootloader_log_proc_show(struct seq_file *m, void *v)
+{
+	seq_printf(m, "%s\n", bootloader_log_ram_zone.buffer);
+	return 0;
+}
+
+static int bootloader_log_proc_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, bootloader_log_proc_show, NULL);
+}
+
+static const struct file_operations bootloader_log_proc_fops = {
+	.open		= bootloader_log_proc_open,
+	.read		= seq_read,
+	.llseek		= seq_lseek,
+	.release	= single_release,
+};
+
+static int proc_bootloader_log_init(void)
+{
+	proc_create("bootloader_log", 0, NULL, &bootloader_log_proc_fops);
+	return 0;
+}
+
+
+static int __init of_bootloader_log_platform_data(struct device_node *node,
+	struct bootloader_log_platform_data *pdata)
+{
+	const u32 *addr;
+	u64 size;
+	struct device_node *pnode;
+
+	memset(pdata, 0, sizeof(*pdata));
+
+	pnode = of_parse_phandle(node, "linux,contiguous-region", 0);
+	if (pnode) {
+		addr = of_get_address(pnode, 0, &size, NULL);
+		if (!addr) {
+			pr_err("failed to parse the bootloader log memory address\n");
+			of_node_put(pnode);
+			return -EINVAL;
+		}
+		pdata->mem_address = of_read_ulong(addr, 2);
+		pdata->mem_size = (unsigned long) size;
+		of_node_put(pnode);
+	} else {
+		pr_err("mem reservation for bootloader log not present\n");
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static void *persistent_ram_vmap(phys_addr_t start, size_t size)
+{
+	struct page **pages;
+	phys_addr_t page_start;
+	unsigned int page_count;
+	pgprot_t prot;
+	unsigned int i;
+	void *vaddr;
+
+	page_start = start - offset_in_page(start);
+	page_count = DIV_ROUND_UP(size + offset_in_page(start), PAGE_SIZE);
+
+	prot = pgprot_noncached(PAGE_KERNEL);
+
+
+	pages = kmalloc_array(page_count, sizeof(struct page *), GFP_KERNEL);
+	if (!pages)
+		return NULL;
+
+	for (i = 0; i < page_count; i++) {
+		phys_addr_t addr = page_start + i * PAGE_SIZE;
+
+		pages[i] = pfn_to_page(addr >> PAGE_SHIFT);
+	}
+	vaddr = vmap(pages, page_count, VM_MAP, prot);
+	kfree(pages);
+
+	return vaddr;
+}
+
+
+static int persistent_ram_buffer_map(phys_addr_t start, size_t size,
+		struct bootloader_log_ram_zone_t *blrz)
+{
+	blrz->paddr = start;
+	blrz->size = size;
+
+	blrz->vaddr = persistent_ram_vmap(start, size);
+
+	if (!blrz->vaddr) {
+		pr_err("%s: Failed to map 0x%llx pages at 0x%llx\n", __func__,
+			(unsigned long long)size, (unsigned long long)start);
+		return -ENOMEM;
+	}
+
+	blrz->buffer = blrz->vaddr + offset_in_page(start);
+	return 0;
+}
+
+
+static int bootloader_log_probe(struct platform_device *pdev)
+{
+	struct bootloader_log_platform_data *pdata = pdev->dev.platform_data;
+	struct bootloader_log_platform_data of_pdata;
+
+	phys_addr_t paddr;
+	int err = -EINVAL;
+
+	pr_err("bootloader_log_probe\n");
+
+	if (pdev->dev.of_node) {
+		if (of_bootloader_log_platform_data(pdev->dev.of_node,
+			&of_pdata)) {
+			pr_err("Invalid bootloader log device tree data\n");
+			goto fail_out;
+		}
+		pdata = &of_pdata;
+	}
+
+	if (!pdata->mem_size) {
+		pr_err("memory size and record size must be non-zero\n");
+		goto fail_out;
+	}
+
+	paddr = pdata->mem_address;
+
+
+	err = persistent_ram_buffer_map(paddr, pdata->mem_size,
+		&bootloader_log_ram_zone);
+	if (err)
+		goto fail_out;
+
+	proc_bootloader_log_init();
+
+
+	pr_info("bootloader_log!\n");
+
+	return 0;
+
+fail_out:
+	pr_err("bootloader_log, fail_out!\n");
+	return err;
+}
+
+static int __exit bootloader_log_remove(struct platform_device *pdev)
+{
+	return -EBUSY;
+}
+
+static const struct of_device_id bootloader_log_of_match[] = {
+	{ .compatible = "bootloader_log", },
+	{ },
+};
+MODULE_DEVICE_TABLE(of, bootloader_log_of_match);
+
+static struct platform_driver bootloader_log_driver = {
+	.probe		= bootloader_log_probe,
+	.remove		= __exit_p(bootloader_log_remove),
+	.driver		= {
+		.name	= "bootloader_log",
+		.owner	= THIS_MODULE,
+		.of_match_table = bootloader_log_of_match,
+	},
+};
+
+
+static int __init bootloader_log_init(void)
+{
+	return platform_driver_register(&bootloader_log_driver);
+}
+postcore_initcall(bootloader_log_init);
+
+static void __exit bootloader_log_exit(void)
+{
+	platform_driver_unregister(&bootloader_log_driver);
+
+}
+module_exit(bootloader_log_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("software");
+
diff --git a/drivers/misc/qseecom.c b/drivers/misc/qseecom.c
index e2f9364555745fb35dda5e67bd3e0a21db1dadf8..37322bb70a13c6344b2db1fe9ea4e25a5c3a0cc7 100644
--- a/drivers/misc/qseecom.c
+++ b/drivers/misc/qseecom.c
@@ -334,11 +334,13 @@ struct qseecom_client_handle {
 	char app_name[MAX_APP_NAME_SIZE];
 	u32  app_arch;
 	struct qseecom_sec_buf_fd_info sec_buf_fd[MAX_ION_FD];
+	bool from_smcinvoke;
 };
 
 struct qseecom_listener_handle {
 	u32               id;
 	bool              unregister_pending;
+	bool              release_called;
 };
 
 static struct qseecom_control qseecom;
@@ -1473,6 +1475,9 @@ static void __qseecom_processing_pending_lsnr_unregister(void)
 		if (entry && entry->data) {
 			pr_debug("process pending unregister %d\n",
 					entry->data->listener.id);
+			/* don't process if qseecom_release is not called*/
+			if (!entry->data->listener.release_called)
+				break;
 			ptr_svc = __qseecom_find_svc(
 						entry->data->listener.id);
 			if (ptr_svc) {
@@ -2037,6 +2042,7 @@ static int __qseecom_process_reentrancy_blocked_on_listener(
 	sigset_t old_sigset;
 	unsigned long flags;
 	bool found_app = false;
+	struct qseecom_registered_app_list dummy_app_entry = { {NULL} };
 
 	if (!resp || !data) {
 		pr_err("invalid resp or data pointer\n");
@@ -2046,24 +2052,31 @@ static int __qseecom_process_reentrancy_blocked_on_listener(
 
 	/* find app_id & img_name from list */
 	if (!ptr_app) {
-		spin_lock_irqsave(&qseecom.registered_app_list_lock, flags);
-		list_for_each_entry(ptr_app, &qseecom.registered_app_list_head,
-							list) {
-			if ((ptr_app->app_id == data->client.app_id) &&
-				(!strcmp(ptr_app->app_name,
+		if (data->client.from_smcinvoke) {
+			pr_debug("This request is from smcinvoke\n");
+			ptr_app = &dummy_app_entry;
+			ptr_app->app_id = data->client.app_id;
+		} else {
+			spin_lock_irqsave(&qseecom.registered_app_list_lock,
+						flags);
+			list_for_each_entry(ptr_app,
+				&qseecom.registered_app_list_head, list) {
+				if ((ptr_app->app_id == data->client.app_id) &&
+					(!strcmp(ptr_app->app_name,
 						data->client.app_name))) {
-				found_app = true;
-				break;
+					found_app = true;
+					break;
+				}
+			}
+			spin_unlock_irqrestore(
+				&qseecom.registered_app_list_lock, flags);
+			if (!found_app) {
+				pr_err("app_id %d (%s) is not found\n",
+					data->client.app_id,
+					(char *)data->client.app_name);
+				ret = -ENOENT;
+				goto exit;
 			}
-		}
-		spin_unlock_irqrestore(&qseecom.registered_app_list_lock,
-					flags);
-		if (!found_app) {
-			pr_err("app_id %d (%s) is not found\n",
-				data->client.app_id,
-				(char *)data->client.app_name);
-			ret = -ENOENT;
-			goto exit;
 		}
 	}
 
@@ -2330,8 +2343,10 @@ static int __qseecom_reentrancy_process_incomplete_cmd(
 				ret = -EINVAL;
 				goto exit;
 			}
+			mutex_unlock(&listener_access_lock);
 			ret = __qseecom_process_reentrancy_blocked_on_listener(
 					resp, NULL, data);
+			mutex_lock(&listener_access_lock);
 			if (ret) {
 				pr_err("failed to process App(%d) %s blocked on listener %d\n",
 					data->client.app_id,
@@ -4923,6 +4938,7 @@ int qseecom_process_listener_from_smcinvoke(struct scm_desc *desc)
 	resp.data = desc->ret[2];	/*listener_id*/
 
 	dummy_private_data.client.app_id = desc->ret[1];
+	dummy_private_data.client.from_smcinvoke = true;
 	dummy_app_entry.app_id = desc->ret[1];
 
 	mutex_lock(&app_access_lock);
@@ -7872,6 +7888,7 @@ static int qseecom_release(struct inode *inode, struct file *file)
 			free_private_data = false;
 			mutex_lock(&listener_access_lock);
 			ret = qseecom_unregister_listener(data);
+			data->listener.release_called = true;
 			mutex_unlock(&listener_access_lock);
 			break;
 		case QSEECOM_CLIENT_APP:
diff --git a/drivers/misc/uid_sys_stats.c b/drivers/misc/uid_sys_stats.c
index 88dc1cd3a2046c0d61b9b2dde27d133d4d45bd8c..6c5067c680ba63e497436eac637204fd7b234e47 100644
--- a/drivers/misc/uid_sys_stats.c
+++ b/drivers/misc/uid_sys_stats.c
@@ -370,7 +370,10 @@ static int uid_cputime_show(struct seq_file *m, void *v)
 		u64 total_stime = uid_entry->stime +
 							uid_entry->active_stime;
 		seq_printf(m, "%d: %llu %llu\n", uid_entry->uid,
-			ktime_to_ms(total_utime), ktime_to_ms(total_stime));
+			(unsigned long long)ktime_to_ms(
+					total_utime) * USEC_PER_MSEC,
+			(unsigned long long)ktime_to_ms(
+					total_stime) * USEC_PER_MSEC);
 	}
 
 	rt_mutex_unlock(&uid_lock);
diff --git a/drivers/net/ethernet/qualcomm/rmnet/rmnet_config.c b/drivers/net/ethernet/qualcomm/rmnet/rmnet_config.c
index 7eee43d5fb75284d84114ebe6e0f81d562df1754..237e52c0a6f3d8b1fefeaadc5c480ed595f4e3c1 100644
--- a/drivers/net/ethernet/qualcomm/rmnet/rmnet_config.c
+++ b/drivers/net/ethernet/qualcomm/rmnet/rmnet_config.c
@@ -604,6 +604,30 @@ void rmnet_enable_all_flows(void *port)
 }
 EXPORT_SYMBOL(rmnet_enable_all_flows);
 
+bool rmnet_all_flows_enabled(void *port)
+{
+	struct rmnet_endpoint *ep;
+	unsigned long bkt;
+	bool ret = true;
+
+	if (unlikely(!port))
+		return true;
+
+	rcu_read_lock();
+	hash_for_each_rcu(((struct rmnet_port *)port)->muxed_ep,
+			  bkt, ep, hlnode) {
+		if (!qmi_rmnet_all_flows_enabled(ep->egress_dev)) {
+			ret = false;
+			goto out;
+		}
+	}
+out:
+	rcu_read_unlock();
+
+	return ret;
+}
+EXPORT_SYMBOL(rmnet_all_flows_enabled);
+
 int rmnet_get_powersave_notif(void *port)
 {
 	if (!port)
diff --git a/drivers/net/ethernet/qualcomm/rmnet/rmnet_handlers.c b/drivers/net/ethernet/qualcomm/rmnet/rmnet_handlers.c
index e4ed5bd72a7ca59bd40345678730285510ff0fd3..b92633ab2a1d7e3c90aa03b4846ffd7529e917ea 100644
--- a/drivers/net/ethernet/qualcomm/rmnet/rmnet_handlers.c
+++ b/drivers/net/ethernet/qualcomm/rmnet/rmnet_handlers.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2013-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -142,6 +142,7 @@ __rmnet_map_ingress_handler(struct sk_buff *skb,
 	u8 mux_id;
 
 	if (RMNET_MAP_GET_CD_BIT(skb)) {
+		qmi_rmnet_set_dl_msg_active(port);
 		if (port->data_format & RMNET_INGRESS_FORMAT_DL_MARKER) {
 			if (!rmnet_map_flow_command(skb, port, false))
 				return;
@@ -254,8 +255,8 @@ static int rmnet_map_egress_handler(struct sk_buff *skb,
 			return -ENOMEM;
 	}
 
-	if (port->data_format & RMNET_INGRESS_FORMAT_PS)
-		qmi_rmnet_work_maybe_restart(port);
+//	if (port->data_format & RMNET_INGRESS_FORMAT_PS)
+//		qmi_rmnet_work_maybe_restart(port);
 
 	if (port->data_format & RMNET_FLAGS_EGRESS_MAP_CKSUMV4)
 		rmnet_map_checksum_uplink_packet(skb, orig_dev);
diff --git a/drivers/net/ethernet/qualcomm/rmnet/rmnet_vnd.c b/drivers/net/ethernet/qualcomm/rmnet/rmnet_vnd.c
index f054733b5ef946031d74c3094d3fae87587bf178..983604457ad8d40e246eba8111bdac23dff3a663 100644
--- a/drivers/net/ethernet/qualcomm/rmnet/rmnet_vnd.c
+++ b/drivers/net/ethernet/qualcomm/rmnet/rmnet_vnd.c
@@ -25,6 +25,7 @@
 #include "rmnet_vnd.h"
 
 #include <soc/qcom/qmi_rmnet.h>
+#include <soc/qcom/rmnet_qmi.h>
 #define CREATE_TRACE_POINTS
 #include <trace/events/rmnet.h>
 
@@ -75,6 +76,9 @@ static netdev_tx_t rmnet_vnd_start_xmit(struct sk_buff *skb,
 		trace_rmnet_xmit_skb(skb);
 		rmnet_egress_handler(skb);
 		qmi_rmnet_burst_fc_check(dev, ip_type, mark, len);
+
+		qmi_rmnet_work_maybe_restart(rmnet_get_rmnet_port(dev));
+
 	} else {
 		this_cpu_inc(priv->pcpu_stats->stats.tx_drops);
 		kfree_skb(skb);
diff --git a/drivers/nfc/Kconfig b/drivers/nfc/Kconfig
index ce35eca4fc92ba8fceb0590ebeb02a5fc6d60285..fa4a45babf92d578d1f9079ddd3dcf67ebafa2f7 100644
--- a/drivers/nfc/Kconfig
+++ b/drivers/nfc/Kconfig
@@ -75,3 +75,19 @@ config NTAG_NQ
           This enables NTAG driver for NTx based devices.
           NTAG is NFC tags that combine passive NFC interface with contact i2c interface.
           This is for i2c connected version.
+
+config NFC_PN5XX
+        tristate "NXP NFC Driver"
+        depends on I2C
+        help
+          This enables the NFC driver for NXP NFC based devices.
+
+config NFC_PN80T
+        tristate "NFC eSE driver for NXP PN80T using NFC_PN5XX"
+        depends on I2C
+        depends on SPI
+        depends on NFC_PN5XX
+        help
+          This enables the SPI driver for the NXP PN80T-based embedded
+          secure element using the NFC_PN5XX driver to control the power.
+
diff --git a/drivers/nfc/Makefile b/drivers/nfc/Makefile
index d8d45190599ebbcae79406c8414fa9a44ec2ebe7..b9aef627e5499359811de9d53c92406dd0ca601a 100644
--- a/drivers/nfc/Makefile
+++ b/drivers/nfc/Makefile
@@ -19,3 +19,6 @@ obj-$(CONFIG_NFC_S3FWRN5)	+= s3fwrn5/
 obj-$(CONFIG_NFC_ST95HF)	+= st95hf/
 obj-$(CONFIG_NFC_NQ)		+= nq-nci.o
 obj-$(CONFIG_NTAG_NQ)		+= nq-ntag.o
+obj-$(CONFIG_NFC_PN5XX)		+= pn5xx.o
+obj-$(CONFIG_NFC_PN80T)		+= ese/
+
diff --git a/drivers/nfc/ese/Makefile b/drivers/nfc/ese/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..bd1615fabe2fae46e30689848dc88793d774c081
--- /dev/null
+++ b/drivers/nfc/ese/Makefile
@@ -0,0 +1,8 @@
+#
+# Makefile for embedded secure element devices
+#
+
+obj-$(CONFIG_NFC_PN80T)		+= p73.o
+
+ccflags-$(CONFIG_NFC_PN80T) := -DDEBUG
+
diff --git a/drivers/nfc/ese/p73.c b/drivers/nfc/ese/p73.c
new file mode 100755
index 0000000000000000000000000000000000000000..b1fec60f33b486093486f7d92caae648ce18d91e
--- /dev/null
+++ b/drivers/nfc/ese/p73.c
@@ -0,0 +1,742 @@
+/*
+ * Copyright (C) 2012-2014 NXP Semiconductors
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *      http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+ /**
+ * \addtogroup spi_driver
+ *
+ * @{ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/list.h>
+#include <linux/irq.h>
+#include <linux/jiffies.h>
+#include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/miscdevice.h>
+#include <linux/spinlock.h>
+#include <linux/spi/spi.h>
+#include <linux/sched.h>
+#include <linux/poll.h>
+#include <linux/regulator/consumer.h>
+#include "p73.h"
+#include "../pn5xx.h"
+
+extern long  pn544_dev_ioctl(struct file *filp, unsigned int cmd,
+        unsigned long arg);
+
+/* Device driver's configuration macro */
+/* Macro to configure poll/interrupt based req*/
+//#define P61_IRQ_ENABLE
+
+/* Macro to configure Hard/Soft reset to P61 */
+//#define P61_HARD_RESET
+
+/* Macro to define SPI clock frequency */
+
+//#define P61_SPI_CLOCK_7Mzh
+#undef P61_SPI_CLOCK_7Mzh
+#undef P61_SPI_CLOCK_10Mzh
+#define P61_SPI_CLOCK_8Mzh
+
+#ifdef P61_SPI_CLOCK_7Mzh
+#define P61_SPI_CLOCK     7000000L;
+#else
+#ifdef P61_SPI_CLOCK_8Mzh
+#define P61_SPI_CLOCK     8000000L;
+#else
+#ifdef P61_SPI_CLOCK_10Mzh
+#define P61_SPI_CLOCK     10000000L;
+#else
+#define P61_SPI_CLOCK     4000000L;
+#endif
+#endif
+#endif
+
+/* size of maximum read/write buffer supported by driver */
+#define MAX_BUFFER_SIZE   258U
+
+/* Different driver debug lever */
+enum P61_DEBUG_LEVEL {
+    P61_DEBUG_OFF,
+    P61_FULL_DEBUG
+};
+
+#define READ_THROUGH_PUT 0x01
+#define WRITE_THROUGH_PUT 0x02
+#define MXAX_THROUGH_PUT_TIME 999000L
+/* Variable to store current debug level request by ioctl */
+static unsigned char debug_level;
+
+#define P61_DBG_MSG(msg...)  \
+        switch(debug_level)      \
+        {                        \
+        case P61_DEBUG_OFF:      \
+        break;                 \
+        case P61_FULL_DEBUG:     \
+        printk(KERN_INFO "[NXP-P61] :  " msg); \
+        break; \
+        default:                 \
+        printk(KERN_ERR "[NXP-P61] :  Wrong debug level %d", debug_level); \
+        break; \
+        } \
+
+#define P61_ERR_MSG(msg...) printk(KERN_ERR "[NFC-P61] : " msg );
+
+/* Device specific macro and structure */
+struct p61_dev {
+    wait_queue_head_t read_wq; /* wait queue for read interrupt */
+    struct mutex read_mutex; /* read mutex */
+    struct mutex write_mutex; /* write mutex */
+    struct spi_device *spi;  /* spi device structure */
+    struct miscdevice p61_device; /* char device as misc driver */
+    unsigned int rst_gpio; /* SW Reset gpio */
+    unsigned int irq_gpio; /* P61 will interrupt DH for any ntf */
+    bool irq_enabled; /* flag to indicate irq is used */
+    unsigned char enable_poll_mode; /* enable the poll mode */
+    spinlock_t irq_enabled_lock; /*spin lock for read irq */
+    /* read buffer */
+    size_t kbuflen;
+    u8 *kbuf;
+};
+
+/* T==1 protocol specific global data */
+const unsigned char SOF = 0xA5u;
+struct p61_through_put {
+    struct timeval rstart_tv;
+    struct timeval rstop_tv;
+    struct timeval wstart_tv;
+    struct timeval wstop_tv;
+    unsigned long total_through_put_wbytes;
+    unsigned long total_through_put_rbytes;
+    unsigned long  total_through_put_rtime;
+    unsigned long total_through_put_wtime;
+    bool enable_through_put_measure;
+};
+static struct p61_through_put p61_through_put_t;
+
+static void p61_start_throughput_measurement(unsigned int type);
+static void p61_stop_throughput_measurement(unsigned int type, int no_of_bytes);
+
+static void p61_start_throughput_measurement(unsigned int type)
+{
+    if (type == READ_THROUGH_PUT)
+    {
+        memset(&p61_through_put_t.rstart_tv, 0x00, sizeof(struct timeval));
+        do_gettimeofday(&p61_through_put_t.rstart_tv);
+    }
+    else if (type == WRITE_THROUGH_PUT)
+    {
+        memset(&p61_through_put_t.wstart_tv, 0x00, sizeof(struct timeval));
+        do_gettimeofday(&p61_through_put_t.wstart_tv);
+
+    }
+    else
+    {
+        P61_DBG_MSG(KERN_ALERT " p61_start_throughput_measurement: wrong type = %d", type);
+    }
+
+}
+static void p61_stop_throughput_measurement(unsigned int type, int no_of_bytes)
+{
+    if (type == READ_THROUGH_PUT)
+    {
+        memset(&p61_through_put_t.rstop_tv, 0x00, sizeof(struct timeval));
+        do_gettimeofday(&p61_through_put_t.rstop_tv);
+        p61_through_put_t.total_through_put_rbytes += no_of_bytes;
+        p61_through_put_t.total_through_put_rtime += (p61_through_put_t.rstop_tv.tv_usec -
+                                                     p61_through_put_t.rstart_tv.tv_usec) +
+                                                     ((p61_through_put_t.rstop_tv.tv_sec -
+                                                     p61_through_put_t.rstart_tv.tv_sec) * 1000000);
+
+        if(p61_through_put_t.total_through_put_rtime >= MXAX_THROUGH_PUT_TIME)
+        {
+            printk(KERN_ALERT " **************** Read Throughput: **************");
+            printk(KERN_ALERT " No of Read Bytes = %ld", p61_through_put_t.total_through_put_rbytes);
+            printk(KERN_ALERT " Total Read Time (uSec) = %ld", p61_through_put_t.total_through_put_rtime);
+            p61_through_put_t.total_through_put_rbytes = 0;
+            p61_through_put_t.total_through_put_rtime = 0;
+            printk(KERN_ALERT " **************** Read Throughput: **************");
+        }
+    printk(KERN_ALERT " No of Read Bytes = %ld", p61_through_put_t.total_through_put_rbytes);
+    printk(KERN_ALERT " Total Read Time (uSec) = %ld", p61_through_put_t.total_through_put_rtime);
+    }
+    else if (type == WRITE_THROUGH_PUT)
+    {
+        memset(&p61_through_put_t.wstop_tv, 0x00, sizeof(struct timeval));
+        do_gettimeofday(&p61_through_put_t.wstop_tv);
+        p61_through_put_t.total_through_put_wbytes += no_of_bytes;
+        p61_through_put_t.total_through_put_wtime += (p61_through_put_t.wstop_tv.tv_usec -
+                                                     p61_through_put_t.wstart_tv.tv_usec) +
+                                                     ((p61_through_put_t.wstop_tv.tv_sec -
+                                                     p61_through_put_t.wstart_tv.tv_sec) * 1000000);
+
+        if(p61_through_put_t.total_through_put_wtime >= MXAX_THROUGH_PUT_TIME)
+        {
+            printk(KERN_ALERT " **************** Write Throughput: **************");
+            printk(KERN_ALERT " No of Write Bytes = %ld", p61_through_put_t.total_through_put_wbytes);
+            printk(KERN_ALERT " Total Write Time (uSec) = %ld", p61_through_put_t.total_through_put_wtime);
+            p61_through_put_t.total_through_put_wbytes = 0;
+            p61_through_put_t.total_through_put_wtime = 0;
+            printk(KERN_ALERT " **************** WRITE Throughput: **************");
+        }
+        printk(KERN_ALERT " No of Write Bytes = %ld", p61_through_put_t.total_through_put_wbytes);
+    printk(KERN_ALERT " Total Write Time (uSec) = %ld", p61_through_put_t.total_through_put_wtime);
+    }
+    else
+    {
+        printk(KERN_ALERT " p61_stop_throughput_measurement: wrong type = %d", type);
+    }
+}
+/**
+ * \ingroup spi_driver
+ * \brief Called from SPI LibEse to initilaize the P61 device
+ *
+ * \param[in]       struct inode *
+ * \param[in]       struct file *
+ *
+ * \retval 0 if ok.
+ *
+*/
+
+static int p61_dev_open(struct inode *inode, struct file *filp) {
+
+    struct p61_dev
+    *p61_dev = container_of(filp->private_data,
+            struct p61_dev,
+            p61_device);
+
+    filp->private_data = p61_dev;
+    P61_DBG_MSG(
+            "%s : Major No: %d, Minor No: %d\n", __func__, imajor(inode), iminor(inode));
+
+    return 0;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief To configure the P61_SET_PWR/P61_SET_DBG/P61_SET_POLL
+ * \n         P61_SET_PWR - hard reset (arg=2), soft reset (arg=1)
+ * \n         P61_SET_DBG - Enable/Disable (based on arg value) the driver logs
+ * \n         P61_SET_POLL - Configure the driver in poll (arg = 1), interrupt (arg = 0) based read operation
+ * \param[in]       struct file *
+ * \param[in]       unsigned int
+ * \param[in]       unsigned long
+ *
+ * \retval 0 if ok.
+ *
+*/
+
+static long p61_dev_ioctl(struct file *filp, unsigned int cmd,
+        unsigned long arg)
+{
+    int ret = 0;
+    struct p61_dev *p61_dev = NULL;
+
+    unsigned char buf[100];
+
+
+    P61_DBG_MSG(KERN_ALERT "p61_dev_ioctl-Enter %u arg = %ld\n", cmd, arg);
+    p61_dev = filp->private_data;
+
+    switch (cmd) {
+    case P61_SET_PWR:
+        if (arg == 2)
+        {
+            /* Do nothing*/
+        }
+        else if (arg == 1)
+        {
+            P61_DBG_MSG(KERN_ALERT " Soft Reset");
+            //gpio_set_value(p61_dev->rst_gpio, 1);
+            //msleep(20);
+            gpio_set_value(p61_dev->rst_gpio, 0);
+            msleep(50);
+            ret = spi_read (p61_dev -> spi,(void *) buf, sizeof(buf));
+            msleep(50);
+            gpio_set_value(p61_dev->rst_gpio, 1);
+            msleep(20);
+
+        }
+        break;
+
+    case P61_SET_DBG:
+        debug_level = (unsigned char )arg;
+        P61_DBG_MSG(KERN_INFO"[NXP-P61] -  Debug level %d", debug_level);
+        break;
+
+    case P61_SET_POLL:
+
+        p61_dev-> enable_poll_mode = (unsigned char )arg;
+        if (p61_dev-> enable_poll_mode == 0)
+        {
+            P61_DBG_MSG(KERN_INFO"[NXP-P61] - IRQ Mode is set \n");
+        }
+        else
+        {
+            P61_DBG_MSG(KERN_INFO"[NXP-P61] - Poll Mode is set \n");
+            p61_dev->enable_poll_mode = 1;
+        }
+        break;
+    case P61_SET_SPM_PWR:
+        P61_DBG_MSG(KERN_ALERT " P61_SET_SPM_PWR: enter");
+        ret = pn544_dev_ioctl(filp, P61_SET_SPI_PWR, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_SET_SPM_PWR: exit");
+    break;
+    case P61_GET_SPM_STATUS:
+        P61_DBG_MSG(KERN_ALERT " P61_GET_SPM_STATUS: enter");
+        ret = pn544_dev_ioctl(filp, P61_GET_PWR_STATUS, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_GET_SPM_STATUS: exit");
+    break;
+    case P61_SET_DWNLD_STATUS:
+        P61_DBG_MSG(KERN_ALERT " P61_SET_DWNLD_STATUS: enter");
+        ret = pn544_dev_ioctl(filp, PN544_SET_DWNLD_STATUS, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_SET_DWNLD_STATUS: =%lu exit",arg);
+    break;
+    case P61_SET_THROUGHPUT:
+        p61_through_put_t.enable_through_put_measure = true;
+        P61_DBG_MSG(KERN_INFO"[NXP-P61] -  P61_SET_THROUGHPUT enable %d", p61_through_put_t.enable_through_put_measure);
+        break;
+    case P61_GET_ESE_ACCESS:
+        P61_DBG_MSG(KERN_ALERT " P61_GET_ESE_ACCESS: enter");
+        ret = pn544_dev_ioctl(filp, P544_GET_ESE_ACCESS, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_GET_ESE_ACCESS ret: %d exit",ret);
+    break;
+    case P61_SET_POWER_SCHEME:
+        P61_DBG_MSG(KERN_ALERT " P61_SET_POWER_SCHEME: enter");
+        ret = pn544_dev_ioctl(filp, P544_SET_POWER_SCHEME, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_SET_POWER_SCHEME ret: %d exit",ret);
+    break;
+    case P61_INHIBIT_PWR_CNTRL:
+        P61_DBG_MSG(KERN_ALERT " P61_INHIBIT_PWR_CNTRL: enter");
+        ret = pn544_dev_ioctl(filp, P544_SECURE_TIMER_SESSION, arg);
+        P61_DBG_MSG(KERN_ALERT " P61_INHIBIT_PWR_CNTRL ret: %d exit", ret);
+    break;
+    default:
+        P61_DBG_MSG(KERN_ALERT " Error case");
+        ret = -EINVAL;
+    }
+
+    P61_DBG_MSG(KERN_ALERT "p61_dev_ioctl-exit %u arg = %lu\n", cmd, arg);
+    return ret;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief Write data to P61 on SPI
+ *
+ * \param[in]       struct file *
+ * \param[in]       const char *
+ * \param[in]       size_t
+ * \param[in]       loff_t *
+ *
+ * \retval data size
+ *
+*/
+
+static ssize_t p61_dev_write(struct file *filp, const char *buf, size_t count,
+        loff_t *offset)
+{
+
+    int ret = -1;
+    struct p61_dev *p61_dev;
+    char *tmp = NULL;
+
+    P61_DBG_MSG(KERN_ALERT "p61_dev_write -Enter count %zu\n", count);
+
+    p61_dev = filp->private_data;
+
+    mutex_lock(&p61_dev->write_mutex);
+    if (count > MAX_BUFFER_SIZE)
+        count = MAX_BUFFER_SIZE;
+
+    tmp = memdup_user(buf, count);
+    if (IS_ERR(tmp)) {
+        pr_info("%s: memdup_user failed\n", __func__);
+        ret = PTR_ERR(tmp);
+        return ret;
+    }
+    if(p61_through_put_t.enable_through_put_measure)
+        p61_start_throughput_measurement(WRITE_THROUGH_PUT);
+    /* Write data */
+    ret = spi_write(p61_dev->spi, tmp, count);
+    if (ret < 0)
+    {
+        ret = -EIO;
+    }
+    else
+    {
+        ret = count;
+        if(p61_through_put_t.enable_through_put_measure)
+            p61_stop_throughput_measurement(WRITE_THROUGH_PUT, ret);
+    }
+
+    kfree(tmp);
+    mutex_unlock(&p61_dev->write_mutex);
+    P61_DBG_MSG(KERN_ALERT "p61_dev_write ret %d- Exit \n", ret);
+    return ret;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief Used to read data from P61 in Poll/interrupt mode configured using ioctl call
+ *
+ * \param[in]       struct file *
+ * \param[in]       char *
+ * \param[in]       size_t
+ * \param[in]       loff_t *
+ *
+ * \retval read size
+ *
+*/
+
+static ssize_t p61_dev_read(struct file *filp, char *buf, size_t count,
+        loff_t *offset)
+{
+    int ret = -EIO;
+    struct p61_dev *p61_dev = filp->private_data;
+    unsigned char *tmp = NULL;
+
+    P61_DBG_MSG("p61_dev_read count %zu - Enter \n", count);
+
+    mutex_lock(&p61_dev->read_mutex);
+    if (count > MAX_BUFFER_SIZE)
+    {
+        count = MAX_BUFFER_SIZE;
+    }
+
+    tmp = p61_dev->kbuf;
+    if (!tmp) {
+        pr_info("%s: device doesn't exist anymore.\n", __func__);
+        ret = -ENODEV;
+        goto fail;
+    }
+    memset(tmp, 0x00, MAX_BUFFER_SIZE);
+
+    if (p61_dev->enable_poll_mode)
+    {
+        P61_DBG_MSG(" %s Poll Mode Enabled \n", __FUNCTION__);
+
+        P61_DBG_MSG(KERN_INFO"SPI_READ returned 0x%zx", count);
+        ret = spi_read(p61_dev->spi, tmp, count);
+        if (0 > ret)
+        {
+            P61_ERR_MSG(KERN_ALERT "spi_read failed [SOF] \n");
+            goto fail;
+        }
+    }
+    else
+    {
+        P61_DBG_MSG(" %s P61_IRQ_ENABLE not Enabled \n", __FUNCTION__);
+        ret = spi_read(p61_dev->spi, tmp, count);
+        if (0 > ret)
+        {
+            P61_DBG_MSG(KERN_INFO"SPI_READ returned 0x%x", ret);
+            ret = -EIO;
+            goto fail;
+        }
+    }
+
+
+    if(p61_through_put_t.enable_through_put_measure)
+        p61_start_throughput_measurement(READ_THROUGH_PUT);
+
+    if(p61_through_put_t.enable_through_put_measure)
+        p61_stop_throughput_measurement (READ_THROUGH_PUT, count);
+    P61_DBG_MSG(KERN_INFO"total_count = %zu", count);
+
+    if (copy_to_user(buf, tmp, count))
+    {
+        P61_ERR_MSG("%s : failed to copy to user space\n", __func__);
+        ret = -EFAULT;
+        goto fail;
+    }
+    P61_DBG_MSG("p61_dev_read ret %d Exit\n", ret);
+
+    mutex_unlock(&p61_dev->read_mutex);
+
+    return ret;
+
+    fail:
+    P61_ERR_MSG("Error p61_dev_read ret %d Exit\n", ret);
+    mutex_unlock(&p61_dev->read_mutex);
+    return ret;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief It will configure the GPIOs required for soft reset, read interrupt & regulated power supply to P61.
+ *
+ * \param[in]       struct p61_spi_platform_data *
+ * \param[in]       struct p61_dev *
+ * \param[in]       struct spi_device *
+ *
+ * \retval 0 if ok.
+ *
+*/
+
+static int p61_hw_setup(struct p61_spi_platform_data *platform_data,
+       struct p61_dev *p61_dev, struct spi_device *spi)
+{
+    int ret = -1;
+
+    P61_DBG_MSG("Entry : %s\n", __FUNCTION__);
+    ret = 0;
+    P61_DBG_MSG("Exit : %s\n", __FUNCTION__);
+    return ret;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief Set the P61 device specific context for future use.
+ *
+ * \param[in]       struct spi_device *
+ * \param[in]       void *
+ *
+ * \retval void
+ *
+*/
+
+static inline void p61_set_data(struct spi_device *spi, void *data)
+{
+    dev_set_drvdata(&spi->dev, data);
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief Get the P61 device specific context.
+ *
+ * \param[in]       const struct spi_device *
+ *
+ * \retval Device Parameters
+ *
+*/
+
+static inline void *p61_get_data(const struct spi_device *spi)
+{
+    return dev_get_drvdata(&spi->dev);
+}
+
+/* possible fops on the p61 device */
+static const struct file_operations p61_dev_fops = {
+        .owner = THIS_MODULE,
+        .read = p61_dev_read,
+        .write = p61_dev_write,
+        .open = p61_dev_open,
+        .unlocked_ioctl = p61_dev_ioctl,
+};
+static int p61_parse_dt(struct device *dev,
+    struct p61_spi_platform_data *data)
+{
+    int errorno = 0;
+
+    return errorno;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief To probe for P61 SPI interface. If found initialize the SPI clock, bit rate & SPI mode.
+          It will create the dev entry (P61) for user space.
+ *
+ * \param[in]       struct spi_device *
+ *
+ * \retval 0 if ok.
+ *
+*/
+
+static int p61_probe(struct spi_device *spi)
+{
+    int ret = -1;
+    struct p61_spi_platform_data *platform_data = NULL;
+    struct p61_spi_platform_data platform_data1;
+    struct p61_dev *p61_dev = NULL;
+
+    P61_DBG_MSG("%s chip select : %d , bus number = %d \n",
+            __FUNCTION__, spi->chip_select, spi->master->bus_num);
+
+    ret = p61_parse_dt(&spi->dev, &platform_data1);
+    if (ret) {
+        pr_err("%s - Failed to parse DT\n", __func__);
+        goto err_exit;
+    }
+    platform_data = &platform_data1;
+    p61_dev = kzalloc(sizeof(*p61_dev), GFP_KERNEL);
+    if (p61_dev == NULL)
+    {
+        P61_ERR_MSG("failed to allocate memory for module data\n");
+        ret = -ENOMEM;
+        goto err_exit;
+    }
+    p61_dev->kbuflen = MAX_BUFFER_SIZE;
+    p61_dev->kbuf = kzalloc(MAX_BUFFER_SIZE, GFP_KERNEL);
+    if (!p61_dev->kbuf) {
+        pr_err("failed to allocate memory for p61_dev->kbuf");
+        ret = -ENOMEM;
+        goto err_free_dev;
+    }
+    ret = p61_hw_setup (platform_data, p61_dev, spi);
+    if (ret < 0)
+    {
+        P61_ERR_MSG("Failed to p61_enable_P61_IRQ_ENABLE\n");
+        goto err_exit0;
+    }
+
+    spi->bits_per_word = 8;
+    spi->mode = SPI_MODE_0;
+    spi->max_speed_hz = P61_SPI_CLOCK;
+    //spi->chip_select = SPI_NO_CS;
+    ret = spi_setup(spi);
+    if (ret < 0)
+    {
+        P61_ERR_MSG("failed to do spi_setup()\n");
+        goto err_exit0;
+    }
+
+    p61_dev -> spi = spi;
+    p61_dev -> p61_device.minor = MISC_DYNAMIC_MINOR;
+    p61_dev -> p61_device.name = "p73";
+    p61_dev -> p61_device.fops = &p61_dev_fops;
+    p61_dev -> p61_device.parent = &spi->dev;
+    p61_dev->irq_gpio = platform_data->irq_gpio;
+    p61_dev->rst_gpio  = platform_data->rst_gpio;
+
+
+    dev_set_drvdata(&spi->dev, p61_dev);
+
+    /* init mutex and queues */
+    init_waitqueue_head(&p61_dev->read_wq);
+    mutex_init(&p61_dev->read_mutex);
+    mutex_init(&p61_dev->write_mutex);
+
+    ret = misc_register(&p61_dev->p61_device);
+    if (ret < 0)
+    {
+        P61_ERR_MSG("misc_register failed! %d\n", ret);
+        goto err_exit0;
+    }
+
+    p61_dev-> enable_poll_mode = 0; /* Default IRQ read mode */
+    P61_DBG_MSG("Exit : %s\n", __FUNCTION__);
+    return ret;
+    misc_deregister(&p61_dev->p61_device);
+    err_exit0:
+    mutex_destroy(&p61_dev->read_mutex);
+    mutex_destroy(&p61_dev->write_mutex);
+    kfree(p61_dev->kbuf);
+    err_free_dev:
+    if(p61_dev != NULL)
+        kfree(p61_dev);
+    err_exit:
+    P61_DBG_MSG("ERROR: Exit : %s ret %d\n", __FUNCTION__, ret);
+    return ret;
+}
+
+/**
+ * \ingroup spi_driver
+ * \brief Will get called when the device is removed to release the resources.
+ *
+ * \param[in]       struct spi_device
+ *
+ * \retval 0 if ok.
+ *
+*/
+
+static int p61_remove(struct spi_device *spi)
+{
+    struct p61_dev *p61_dev = p61_get_data(spi);
+    P61_DBG_MSG("Entry : %s\n", __FUNCTION__);
+
+    gpio_free(p61_dev->rst_gpio);
+
+    mutex_destroy(&p61_dev->read_mutex);
+    misc_deregister(&p61_dev->p61_device);
+
+    if(p61_dev != NULL)
+        kfree(p61_dev);
+    P61_DBG_MSG("Exit : %s\n", __FUNCTION__);
+    return 0;
+}
+static struct of_device_id p61_dt_match[] = {
+    {
+        .compatible = "nxp,p61",
+    },
+    {}
+};
+static struct spi_driver p61_driver = {
+        .driver = {
+                .name = "p61",
+                .bus = &spi_bus_type,
+                .owner = THIS_MODULE,
+                .of_match_table = p61_dt_match,
+        },
+        .probe =  p61_probe,
+        .remove = (p61_remove),
+};
+
+/**
+ * \ingroup spi_driver
+ * \brief Module init interface
+ *
+ * \param[in]       void
+ *
+ * \retval handle
+ *
+*/
+
+static int __init p61_dev_init(void)
+{
+    debug_level = P61_DEBUG_OFF;
+
+    P61_DBG_MSG("Entry : %s\n", __FUNCTION__);
+
+    return spi_register_driver(&p61_driver);
+
+    P61_DBG_MSG("Exit : %s\n", __FUNCTION__);
+}
+module_init( p61_dev_init);
+
+/**
+ * \ingroup spi_driver
+ * \brief Module exit interface
+ *
+ * \param[in]       void
+ *
+ * \retval void
+ *
+*/
+
+static void __exit p61_dev_exit(void)
+{
+    P61_DBG_MSG("Entry : %s\n", __FUNCTION__);
+
+    spi_unregister_driver(&p61_driver);
+    P61_DBG_MSG("Exit : %s\n", __FUNCTION__);
+}
+module_exit( p61_dev_exit);
+
+MODULE_AUTHOR("BHUPENDRA PAWAR");
+MODULE_DESCRIPTION("NXP P61 SPI driver");
+MODULE_LICENSE("GPL");
+
+/** @} */
diff --git a/drivers/nfc/ese/p73.h b/drivers/nfc/ese/p73.h
new file mode 100755
index 0000000000000000000000000000000000000000..911d8e617631c71987eb339e569269e0593a6709
--- /dev/null
+++ b/drivers/nfc/ese/p73.h
@@ -0,0 +1,46 @@
+/*
+ * Copyright (C) 2012-2014 NXP Semiconductors
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *      http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#define P61_MAGIC 0xEA
+#define P61_SET_PWR _IOW(P61_MAGIC, 0x01, long)
+#define P61_SET_DBG _IOW(P61_MAGIC, 0x02, long)
+#define P61_SET_POLL _IOW(P61_MAGIC, 0x03, long)
+/*
+ * SPI Request NFCC to enable p61 power, only in param
+ * Only for SPI
+ * level 1 = Enable power
+ * level 0 = Disable power
+ */
+#define P61_SET_SPM_PWR    _IOW(P61_MAGIC, 0x04, long)
+
+/* SPI or DWP can call this ioctl to get the current
+ * power state of P61
+ *
+*/
+#define P61_GET_SPM_STATUS    _IOR(P61_MAGIC, 0x05, long)
+
+#define P61_SET_THROUGHPUT    _IOW(P61_MAGIC, 0x06, long)
+#define P61_GET_ESE_ACCESS    _IOW(P61_MAGIC, 0x07, long)
+
+#define P61_SET_POWER_SCHEME  _IOW(P61_MAGIC, 0x08, long)
+
+#define P61_SET_DWNLD_STATUS    _IOW(P61_MAGIC, 0x09, long)
+
+#define P61_INHIBIT_PWR_CNTRL  _IOW(P61_MAGIC, 0x0A, long)
+struct p61_spi_platform_data {
+    unsigned int irq_gpio;
+    unsigned int rst_gpio;
+};
diff --git a/drivers/nfc/nq-nci.c b/drivers/nfc/nq-nci.c
index 70ec2dbddb7eb466136c00f44f8fde6ee0554fba..8622662adbbdec939345907f4874b71453a9c325 100644
--- a/drivers/nfc/nq-nci.c
+++ b/drivers/nfc/nq-nci.c
@@ -750,6 +750,7 @@ static const struct file_operations nfc_dev_fops = {
 #endif
 };
 
+#ifdef NFC_HW_CHECK
 /* Check for availability of NQ_ NFC controller hardware */
 static int nfcc_hw_check(struct i2c_client *client, struct nqx_dev *nqx_dev)
 {
@@ -976,6 +977,7 @@ static int nfcc_hw_check(struct i2c_client *client, struct nqx_dev *nqx_dev)
 
 	return ret;
 }
+#endif
 
 /*
  * Routine to enable clock.
@@ -1306,6 +1308,7 @@ static int nqx_probe(struct i2c_client *client,
 	 * present before attempting further hardware initialisation.
 	 *
 	 */
+#ifdef NFC_HW_CHECK
 	r = nfcc_hw_check(client, nqx_dev);
 	if (r) {
 		/* make sure NFCC is not enabled */
@@ -1313,6 +1316,7 @@ static int nqx_probe(struct i2c_client *client,
 		/* We don't think there is hardware switch NFC OFF */
 		goto err_request_hw_check_failed;
 	}
+#endif
 
 	/* Register reboot notifier here */
 	r = register_reboot_notifier(&nfcc_notifier);
diff --git a/drivers/nfc/pn5xx.c b/drivers/nfc/pn5xx.c
new file mode 100644
index 0000000000000000000000000000000000000000..99986c35646d1aaa089ffa2d2192a4898fbef7e9
--- /dev/null
+++ b/drivers/nfc/pn5xx.c
@@ -0,0 +1,1555 @@
+/*
+ * Copyright (C) 2010 Trusted Logic S.A.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ */
+/******************************************************************************
+ *
+ *  The original Work has been changed by NXP Semiconductors.
+ *
+ *  Copyright (C) 2013-2018 NXP Semiconductors
+ *   *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *
+ ******************************************************************************/
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/list.h>
+#include <linux/i2c.h>
+#include <linux/irq.h>
+#include <linux/jiffies.h>
+#include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/miscdevice.h>
+#include <linux/spinlock.h>
+#include <asm/siginfo.h>
+#include <linux/rcupdate.h>
+#include <linux/sched.h>
+// #include <linux/signal.h>
+#include <linux/sched/signal.h>
+#include <linux/workqueue.h>
+/* HiKey Compilation fix */
+#define HiKey_620_COMPILATION_FIX 1
+#ifndef HiKey_620_COMPILATION_FIX
+#include <linux/wakelock.h>
+#endif
+#include <linux/project_info.h>
+#include <linux/timer.h>
+#include <linux/clk.h>
+#include "pn5xx.h"
+
+#define NEXUS5x    0
+#define HWINFO     1
+#define DRAGON_NFC 1
+#define SIG_NFC 44
+#define MAX_BUFFER_SIZE 512
+#define MAX_SECURE_SESSIONS 1
+/* Macro added to disable SVDD power toggling */
+/* #define JCOP_4X_VALIDATION */
+#define WAKEUP_SRC_TIMEOUT 5000
+
+//#define CLOCK_CTRL
+
+struct pn544_dev    {
+    wait_queue_head_t   read_wq;
+    struct mutex        read_mutex;
+    struct i2c_client   *client;
+    struct miscdevice   pn544_device;
+    unsigned int        ven_gpio;
+    unsigned int        firm_gpio;
+    unsigned int        irq_gpio;
+    unsigned int        clkreq_gpio;
+    unsigned int        ese_pwr_gpio; /* gpio used by SPI to provide power to p61 via NFCC */
+    p61_access_state_t  p61_current_state; /* stores the current P61 state */
+    bool                nfc_ven_enabled; /* stores the VEN pin state powered by Nfc */
+    bool                spi_ven_enabled; /* stores the VEN pin state powered by Spi */
+    bool                irq_enabled;
+    spinlock_t          irq_enabled_lock;
+    long                nfc_service_pid; /*used to signal the nfc the nfc service */
+    chip_pwr_scheme_t   chip_pwr_scheme;
+    unsigned int        secure_timer_cnt;
+    unsigned long       dwpLinkUpdateStat; /*DWP link update status*/
+    struct workqueue_struct *pSecureTimerCbWq;
+    struct work_struct wq_task;
+    const char *clk_src_name;
+#ifdef CLOCK_CTRL
+    struct clk          *s_clk;
+#endif
+    /* read buffer*/
+    size_t kbuflen;
+    u8 *kbuf;
+};
+/* HiKey Compilation fix */
+#ifndef HiKey_620_COMPILATION_FIX
+struct wake_lock nfc_wake_lock;
+static bool  sIsWakeLocked = false;
+#endif
+#if HWINFO
+struct hw_type_info hw_info;
+#endif
+static struct pn544_dev *pn544_dev;
+static struct semaphore ese_access_sema;
+static struct semaphore svdd_sync_onoff_sema;
+/*semaphore to wait till JNI operation is completed for SPI on/off*/
+static struct completion dwp_onoff_sema;
+/* semaphore to lock SPI open request until signal handling is complete */
+static struct semaphore dwp_onoff_release_sema;
+static struct timer_list secure_timer;
+static void release_ese_lock(p61_access_state_t  p61_current_state);
+int get_ese_lock(p61_access_state_t  p61_current_state, int timeout);
+static long set_jcop_download_state(unsigned long arg);
+static long start_seccure_timer(unsigned long timer_value);
+static long secure_timer_operation(struct pn544_dev *pn544_dev, unsigned long arg);
+#if HWINFO
+static void check_hw_info(void);
+#endif
+#define SECURE_TIMER_WORK_QUEUE "SecTimerCbWq"
+
+static void pn544_disable_irq(struct pn544_dev *pn544_dev) {
+    unsigned long flags;
+
+    spin_lock_irqsave(&pn544_dev->irq_enabled_lock, flags);
+    if (pn544_dev->irq_enabled) {
+        disable_irq_nosync(pn544_dev->client->irq);
+        //disable_irq_wake(pn544_dev->client->irq);
+        pn544_dev->irq_enabled = false;
+    }
+    spin_unlock_irqrestore(&pn544_dev->irq_enabled_lock, flags);
+}
+
+static irqreturn_t pn544_dev_irq_handler(int irq, void *dev_id) {
+    struct pn544_dev *pn544_dev = dev_id;
+
+    if (device_may_wakeup(&pn544_dev->client->dev)) {
+        pm_wakeup_event(&pn544_dev->client->dev, WAKEUP_SRC_TIMEOUT);
+    }
+
+    pn544_disable_irq(pn544_dev);
+    /* HiKey Compilation fix */
+#ifndef HiKey_620_COMPILATION_FIX
+    if (sIsWakeLocked == false) {
+        wake_lock(&nfc_wake_lock);
+        sIsWakeLocked = true;
+    } else {
+        pr_debug("%s already wake locked!\n", __func__);
+    }
+#endif
+    /* Wake up waiting readers */
+    wake_up(&pn544_dev->read_wq);
+
+
+    return IRQ_HANDLED;
+}
+
+static ssize_t pn544_dev_read(struct file *filp, char __user *buf,
+                              size_t count, loff_t *offset) {
+    struct pn544_dev *pn544_dev = filp->private_data;
+    unsigned char *tmp = NULL;
+    int ret;
+
+    if (count > pn544_dev->kbuflen)
+        count = pn544_dev->kbuflen;
+
+    //pr_debug("%s : reading   %zu bytes.\n", __func__, count);
+
+    mutex_lock(&pn544_dev->read_mutex);
+
+    if (!gpio_get_value(pn544_dev->irq_gpio)) {
+        if (filp->f_flags & O_NONBLOCK) {
+            ret = -EAGAIN;
+            goto fail;
+        }
+
+        while (1) {
+            pn544_dev->irq_enabled = true;
+            enable_irq(pn544_dev->client->irq);
+            //enable_irq_wake(pn544_dev->client->irq);
+            ret = wait_event_interruptible(
+                      pn544_dev->read_wq,
+                      !pn544_dev->irq_enabled);
+
+            pn544_disable_irq(pn544_dev);
+
+            if (ret)
+                goto fail;
+
+            if (gpio_get_value(pn544_dev->irq_gpio))
+                break;
+
+            pr_warning("%s: spurious interrupt detected\n", __func__);
+        }
+    }
+
+    tmp = pn544_dev->kbuf;
+    if (!tmp) {
+        pr_info("%s: device doesn't exist anymore\n", __func__);
+        ret = -ENODEV;
+        goto fail;
+    }
+    memset(tmp, 0x00, count);
+
+    /* Read data */
+    ret = i2c_master_recv(pn544_dev->client, tmp, count);
+#ifndef HiKey_620_COMPILATION_FIX
+    /* HiKey Compilation fix */
+    if (sIsWakeLocked == true) {
+        wake_unlock(&nfc_wake_lock);
+        sIsWakeLocked = false;
+    }
+#endif
+    mutex_unlock(&pn544_dev->read_mutex);
+
+    /* pn544 seems to be slow in handling I2C read requests
+     * so add 1ms delay after recv operation */
+    udelay(1000);
+
+    if (ret < 0) {
+        pr_err("%s: i2c_master_recv returned %d\n", __func__, ret);
+        return ret;
+    }
+    if (ret > count) {
+        pr_err("%s: received too many bytes from i2c (%d)\n",
+               __func__, ret);
+        return -EIO;
+    }
+    if (copy_to_user(buf, tmp, ret)) {
+        pr_warning("%s : failed to copy to user space\n", __func__);
+        return -EFAULT;
+    }
+    return ret;
+
+fail:
+    mutex_unlock(&pn544_dev->read_mutex);
+    return ret;
+}
+
+static ssize_t pn544_dev_write(struct file *filp, const char __user *buf,
+                               size_t count, loff_t *offset) {
+    struct pn544_dev  *pn544_dev;
+    char *tmp = NULL;
+    int ret;
+
+    pn544_dev = filp->private_data;
+
+    if (count > pn544_dev->kbuflen) {
+        pr_err("%s: out of memory\n", __func__);
+        ret = -ENOMEM;
+        goto out;
+    }
+
+    tmp = memdup_user(buf, count);
+    if (IS_ERR(tmp)) {
+        pr_info("%s: memdup_user failed\n", __func__);
+        ret = PTR_ERR(tmp);
+        goto out;
+    }
+
+    //pr_debug("%s : writing %zu bytes.\n", __func__, count);
+    /* Write data */
+    ret = i2c_master_send(pn544_dev->client, tmp, count);
+    if (ret != count) {
+        pr_err("%s : i2c_master_send returned %d\n", __func__, ret);
+        ret = -EIO;
+    }
+
+    /* pn544 seems to be slow in handling I2C write requests
+     * so add 1ms delay after I2C send oparation */
+    udelay(1000);
+    kfree(tmp);
+out:
+    return ret;
+}
+
+static void p61_update_access_state(struct pn544_dev *pn544_dev, p61_access_state_t current_state, bool set) {
+    //pr_info("%s: Enter current_state = %x\n", __func__, pn544_dev->p61_current_state);
+    if (current_state) {
+        if(set) {
+            if(pn544_dev->p61_current_state == P61_STATE_IDLE)
+                pn544_dev->p61_current_state = P61_STATE_INVALID;
+            pn544_dev->p61_current_state |= current_state;
+        } else {
+            pn544_dev->p61_current_state ^= current_state;
+            if(!pn544_dev->p61_current_state)
+                pn544_dev->p61_current_state = P61_STATE_IDLE;
+        }
+    }
+    //pr_info("%s: Exit current_state = %x\n", __func__, pn544_dev->p61_current_state);
+}
+
+static void p61_get_access_state(struct pn544_dev *pn544_dev, p61_access_state_t *current_state) {
+
+    if (current_state == NULL) {
+        //*current_state = P61_STATE_INVALID;
+        //pr_err("%s : invalid state of p61_access_state_t current state  \n", __func__);
+    } else {
+        *current_state = pn544_dev->p61_current_state;
+    }
+}
+
+static int signal_handler(int state, long nfc_pid) {
+    struct siginfo sinfo;
+    pid_t pid;
+    struct task_struct *task;
+    int sigret = 0, ret = 0;
+    //pr_info("%s: Enter\n", __func__);
+
+    if(nfc_pid == 0) {
+        pr_info("nfc_pid is clear don't call signal_handler.\n");
+    } else {
+        memset(&sinfo, 0, sizeof(struct siginfo));
+        sinfo.si_signo = SIG_NFC;
+        sinfo.si_code = SI_QUEUE;
+        sinfo.si_int = state;
+        pid = nfc_pid;
+
+        task = pid_task(find_vpid(pid), PIDTYPE_PID);
+        if(task) {
+            pr_info("%s.\n", task->comm);
+            sigret = force_sig_info(SIG_NFC, &sinfo, task);
+            if(sigret < 0) {
+                pr_info("send_sig_info failed..... sigret %d.\n", sigret);
+                ret = -1;
+                //msleep(60);
+            }
+        } else {
+            pr_info("finding task from PID failed\r\n");
+            ret = -1;
+        }
+    }
+    //pr_info("%s: Exit ret = %d\n", __func__, ret);
+    return ret;
+}
+static STATUS svdd_sync_onoff(long nfc_service_pid, p61_access_state_t origin) {
+    int timeout = 4500; // 4500 ms timeout
+    unsigned long tempJ = msecs_to_jiffies(timeout);
+    //pr_info("%s: Enter nfc_service_pid: %ld\n", __func__, nfc_service_pid);
+    sema_init(&svdd_sync_onoff_sema, 0);
+    if (nfc_service_pid) {
+        if (0 == signal_handler(origin, nfc_service_pid)) {
+            pr_info("Waiting for svdd protection response");
+            if (down_timeout(&svdd_sync_onoff_sema, tempJ) != 0) {
+                pr_info("svdd wait protection: Timeout");
+                return STATUS_FAILED;
+            }
+            msleep(10);
+            //pr_info("svdd wait protection : released");
+        }
+    }
+    return (pn544_dev->dwpLinkUpdateStat == 0x00) ? STATUS_SUCCESS : STATUS_FAILED;
+    //pr_info("%s: Exit\n", __func__);
+}
+static int release_svdd_wait(void) {
+    //pr_info("%s: Enter \n", __func__);
+    up(&svdd_sync_onoff_sema);
+    //pr_info("%s: Exit\n", __func__);
+    return 0;
+}
+
+static STATUS dwp_OnOff(long nfc_service_pid, p61_access_state_t origin) {
+    int timeout = 4500; // 4500 ms timeout
+    unsigned long tempJ = msecs_to_jiffies(timeout);
+    init_completion(&dwp_onoff_sema);
+    if (nfc_service_pid) {
+        if (0 == signal_handler(origin, nfc_service_pid)) {
+            if (wait_for_completion_timeout(&dwp_onoff_sema, tempJ) == 0) {
+                pr_info("Dwp On/off wait protection: Timeout");
+                return STATUS_FAILED;
+            }
+            //pr_info("Dwp On/Off wait protection : released");
+        }
+    }
+    pr_info("%s: dwpLinkUpdateStat = %lu\n", __func__, pn544_dev->dwpLinkUpdateStat);
+    //return (pn544_dev->dwpLinkUpdateStat == 0x00) ? STATUS_SUCCESS : STATUS_FAILED;
+    return STATUS_SUCCESS;
+}
+static int release_dwpOnOff_wait(void) {
+    int timeout = 500; // 500 ms timeout
+    unsigned long tempJ = msecs_to_jiffies(timeout);
+    pr_info("%s: Enter \n", __func__);
+    complete(&dwp_onoff_sema);
+    {
+        sema_init(&dwp_onoff_release_sema, 0);
+        /*release JNI only after all the SPI On related actions are completed*/
+        if (down_timeout(&dwp_onoff_release_sema, tempJ) != 0) {
+            //pr_info("Dwp On/off release wait protection: Timeout");
+        }
+        //pr_info("Dwp On/Off release wait protection : released");
+    }
+    return 0;
+}
+
+static int pn544_dev_open(struct inode *inode, struct file *filp) {
+    struct pn544_dev *pn544_dev = container_of(filp->private_data,
+                                  struct pn544_dev,
+                                  pn544_device);
+
+    filp->private_data = pn544_dev;
+
+    pr_debug("%s : %d,%d\n", __func__, imajor(inode), iminor(inode));
+
+    return 0;
+}
+
+static int set_nfc_pid(unsigned long arg) {
+    pr_info("%s : The NFC Service PID is %ld\n", __func__, arg);
+    pn544_dev->nfc_service_pid = arg;
+    return 0;
+}
+
+long  pn544_dev_ioctl(struct file *filp, unsigned int cmd,
+                      unsigned long arg) {
+    pr_info("%s :enter cmd = %u, arg = %ld\n", __func__, cmd, arg);
+
+    /* Free pass autobahn area, not protected. Use it carefullly. START */
+    switch(cmd) {
+    case P544_GET_ESE_ACCESS:
+        return get_ese_lock(P61_STATE_WIRED, arg);
+        break;
+    case P544_REL_SVDD_WAIT:
+        pr_info("%s :enter cmd P544_REL_SVDD_WAIT, arg = %ld\n", __func__, arg);
+        pn544_dev->dwpLinkUpdateStat = arg;
+        return release_svdd_wait();
+        break;
+    case P544_SET_NFC_SERVICE_PID:
+        return set_nfc_pid(arg);
+        break;
+    case P544_REL_DWPONOFF_WAIT:
+        pr_info("%s :enter cmd P544_REL_DWPONOFF_WAIT, arg = %ld\n", __func__, arg);
+        pn544_dev->dwpLinkUpdateStat = arg;
+        return release_dwpOnOff_wait();
+        break;
+    default:
+        break;
+    }
+    /* Free pass autobahn area, not protected. Use it carefullly. END */
+
+    switch (cmd) {
+    case PN544_SET_PWR: {
+        p61_access_state_t current_state = P61_STATE_INVALID;
+        p61_get_access_state(pn544_dev, &current_state);
+        if (arg == 2) {
+            if (current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO) && (pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME)) {
+                /* NFCC fw/download should not be allowed if p61 is used
+                 * by SPI
+                 */
+                pr_info("%s NFCC should not be allowed to reset/FW download \n", __func__);
+                return -EBUSY; /* Device or resource busy */
+            }
+            pn544_dev->nfc_ven_enabled = true;
+            if ((pn544_dev->spi_ven_enabled == false && !(pn544_dev->secure_timer_cnt))
+                    || (pn544_dev->chip_pwr_scheme == PN80T_EXT_PMU_SCHEME)) {
+                /* power on with firmware download (requires hw reset)
+                 */
+                pr_info("%s power on with firmware\n", __func__);
+                gpio_set_value(pn544_dev->ven_gpio, 1);
+                msleep(10);
+                if (pn544_dev->firm_gpio) {
+                    p61_update_access_state(pn544_dev, P61_STATE_DWNLD, true);
+                    gpio_set_value(pn544_dev->firm_gpio, 1);
+                }
+                msleep(10);
+                gpio_set_value(pn544_dev->ven_gpio, 0);
+                msleep(10);
+                gpio_set_value(pn544_dev->ven_gpio, 1);
+                msleep(10);
+            }
+        } else if (arg == 1) {
+            /* power on */
+            pr_info("%s power on\n", __func__);
+            if (pn544_dev->firm_gpio) {
+                if ((current_state & (P61_STATE_WIRED|P61_STATE_SPI|P61_STATE_SPI_PRIO))== 0) {
+                    p61_update_access_state(pn544_dev, P61_STATE_IDLE, true);
+                }
+                if(current_state & P61_STATE_DWNLD) {
+                    p61_update_access_state(pn544_dev, P61_STATE_DWNLD, false);
+                }
+                gpio_set_value(pn544_dev->firm_gpio, 0);
+            }
+
+            pn544_dev->nfc_ven_enabled = true;
+            if (pn544_dev->spi_ven_enabled == false || (pn544_dev->chip_pwr_scheme == PN80T_EXT_PMU_SCHEME)) {
+                gpio_set_value(pn544_dev->ven_gpio, 1);
+            }
+        } else if (arg == 0) {
+            /* power off */
+            pr_info("%s power off\n", __func__);
+            if (pn544_dev->firm_gpio) {
+                if ((current_state & (P61_STATE_WIRED|P61_STATE_SPI|P61_STATE_SPI_PRIO))== 0) {
+                    p61_update_access_state(pn544_dev, P61_STATE_IDLE, true);
+                }
+                gpio_set_value(pn544_dev->firm_gpio, 0);
+            }
+
+            pn544_dev->nfc_ven_enabled = false;
+            /* Don't change Ven state if spi made it high */
+            if ((pn544_dev->spi_ven_enabled == false && !(pn544_dev->secure_timer_cnt))
+                    || (pn544_dev->chip_pwr_scheme == PN80T_EXT_PMU_SCHEME)) {
+                gpio_set_value(pn544_dev->ven_gpio, 0);
+            }
+            /* HiKey Compilation fix */
+#ifndef HiKey_620_COMPILATION_FIX
+            if (sIsWakeLocked == true) {
+                wake_unlock(&nfc_wake_lock);
+                sIsWakeLocked = false;
+            }
+#endif
+        } else if (arg == 3) {
+            /*NFC Service called ISO-RST*/
+            p61_access_state_t current_state = P61_STATE_INVALID;
+            p61_get_access_state(pn544_dev, &current_state);
+            if(current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) {
+                return -EPERM; /* Operation not permitted */
+            }
+            if(current_state & P61_STATE_WIRED) {
+                p61_update_access_state(pn544_dev, P61_STATE_WIRED, false);
+            }
+        } else if (arg == 4) {
+            pr_info("%s FW dwldioctl called from NFC \n", __func__);
+            /*NFC Service called FW dwnld*/
+            if (pn544_dev->firm_gpio) {
+                p61_update_access_state(pn544_dev, P61_STATE_DWNLD, true);
+                gpio_set_value(pn544_dev->firm_gpio, 1);
+                msleep(10);
+            }
+        } else {
+            pr_err("%s bad arg %lu\n", __func__, arg);
+            /* changed the p61 state to idle*/
+            return -EINVAL;
+        }
+    }
+    break;
+    case P61_SET_SPI_PWR: {
+        bool isSignalTriggerReqd = !(arg & 0x10);
+        unsigned long pwrLevel = arg & 0x0F;
+        p61_access_state_t current_state = P61_STATE_INVALID;
+        p61_get_access_state(pn544_dev, &current_state);
+        /*For chipType pn557 (5th bit of arg) do not trigger signal*/
+        if (pwrLevel == 1) {
+            pr_info("%s : PN61_SET_SPI_PWR - power on ese\n", __func__);
+            if (((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) == 0) || (current_state & P61_STATE_SPI_FAILED)) {
+                /*To handle triple mode protection signal
+                NFC service when SPI session started*/
+                if (isSignalTriggerReqd && !(current_state & P61_STATE_JCP_DWNLD)) {
+                    if(pn544_dev->nfc_service_pid) {
+                        STATUS stat = dwp_OnOff(pn544_dev->nfc_service_pid, P61_STATE_SPI);
+                        pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        if(stat != STATUS_SUCCESS) {
+                            pr_info(" %s DWP link activation failed. Returning..", __func__);
+                            p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, true);
+                            return stat;
+                        }
+                    } else {
+                        pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                    }
+                }
+
+                pn544_dev->spi_ven_enabled = true;
+
+                if(pn544_dev->chip_pwr_scheme == PN80T_EXT_PMU_SCHEME)
+                    break;
+
+                if (pn544_dev->nfc_ven_enabled == false) {
+                    /* provide power to NFCC if, NFC service not provided */
+                    gpio_set_value(pn544_dev->ven_gpio, 1);
+                    msleep(10);
+                }
+                /* pull the gpio to high once NFCC is power on*/
+                gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+
+                /* Delay (10ms) after SVDD_PWR_ON to allow JCOP to bootup (5ms jcop boot time + 5ms guard time) */
+                usleep_range(10000, 12000);
+                if(current_state & P61_STATE_SPI_FAILED) {
+                    p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, false);
+                }
+                p61_update_access_state(pn544_dev, P61_STATE_SPI, true);
+                if (pn544_dev->nfc_service_pid) {
+                    up(&dwp_onoff_release_sema);
+                }
+
+            } else if ((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO))
+                       && (gpio_get_value(pn544_dev->ese_pwr_gpio)) && (gpio_get_value(pn544_dev->ven_gpio))) {
+                /* Returning success if SET_SPM_POWER called while already SPI is open */
+                return 0;
+            } else {
+                pr_info("%s : PN61_SET_SPI_PWR -  power on ese failed \n", __func__);
+                return -EBUSY; /* Device or resource busy */
+            }
+        } else if (pwrLevel == 0) {
+            pr_info("%s : PN61_SET_SPI_PWR - power off ese\n", __func__);
+            if(current_state & P61_STATE_SPI_PRIO) {
+                p61_update_access_state(pn544_dev, P61_STATE_SPI_PRIO, false);
+                if (!(current_state & P61_STATE_JCP_DWNLD)) {
+                    if(pn544_dev->nfc_service_pid) {
+                        //pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        if(!(current_state & P61_STATE_WIRED)) {
+                            svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START |
+                                            P61_STATE_SPI_PRIO_END);
+                        } else {
+                            signal_handler(P61_STATE_SPI_PRIO_END, pn544_dev->nfc_service_pid);
+                        }
+                    } else {
+                        pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                    }
+                } else if (!(current_state & P61_STATE_WIRED)) {
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START);
+                }
+                pn544_dev->spi_ven_enabled = false;
+
+                if(pn544_dev->chip_pwr_scheme == PN80T_EXT_PMU_SCHEME)
+                    break;
+
+                /* if secure timer is running, Delay the SPI close by 25ms after sending End of Apdu to enable eSE go into DPD
+                    gracefully (20ms after EOS + 5ms DPD settlement time) */
+                if(pn544_dev->secure_timer_cnt)
+                    usleep_range(25000, 30000);
+
+                if (!(current_state & P61_STATE_WIRED) && !(pn544_dev->secure_timer_cnt)) {
+#ifndef JCOP_4X_VALIDATION
+                    gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+                    /* Delay (2.5ms) after SVDD_PWR_OFF for the shutdown settlement time */
+                    usleep_range(2500, 3000);
+#endif
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+                }
+#ifndef JCOP_4X_VALIDATION
+                if ((pn544_dev->nfc_ven_enabled == false) && !(pn544_dev->secure_timer_cnt)) {
+                    gpio_set_value(pn544_dev->ven_gpio, 0);
+                    msleep(10);
+                }
+#endif
+            } else if((current_state & P61_STATE_SPI) || (current_state & P61_STATE_SPI_FAILED)) {
+                if (!(current_state & P61_STATE_WIRED) &&
+                        (pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME) &&
+                        !(current_state & P61_STATE_JCP_DWNLD)) {
+                    if(isSignalTriggerReqd) {
+                        if(pn544_dev->nfc_service_pid) {
+                            //pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                            STATUS stat = svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START | P61_STATE_SPI_END);
+                            if(stat != STATUS_SUCCESS) {
+                                pr_info(" %s DWP link deactivation Failed. Returning..", __func__);
+                                p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, true);
+                                return stat;
+                            }
+                        } else {
+                            pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        }
+                    }
+
+                    /* if secure timer is running, Delay the SPI close by 25ms after sending End of Apdu to enable eSE go into DPD
+                         gracefully (20ms after EOS + 5ms DPD settlement time) */
+                    if(pn544_dev->secure_timer_cnt)
+                        usleep_range(25000, 30000);
+
+                    if (!(pn544_dev->secure_timer_cnt)) {
+#ifndef JCOP_4X_VALIDATION
+                        gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+                        /* Delay (2.5ms) after SVDD_PWR_OFF for the shutdown settlement time */
+                        usleep_range(2500, 3000);
+#endif
+                        if(current_state & P61_STATE_SPI_FAILED) {
+                            p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, false);
+                        }
+                        if(current_state & P61_STATE_SPI)
+                            p61_update_access_state(pn544_dev, P61_STATE_SPI,
+                                                    false);
+                        if(isSignalTriggerReqd)
+                            svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+                    }
+                }
+                /*If JCOP3.2 or 3.3 for handling triple mode
+                protection signal NFC service */
+                else {
+                    if(isSignalTriggerReqd) {
+                        if (!(current_state & P61_STATE_JCP_DWNLD)) {
+                            if(pn544_dev->nfc_service_pid) {
+                                //pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                                if(pn544_dev->chip_pwr_scheme == PN80T_LEGACY_PWR_SCHEME) {
+                                    STATUS stat = svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START | P61_STATE_SPI_END);
+                                    if(stat != STATUS_SUCCESS) {
+                                        pr_info(" %s DWP link deactivation Failed. Returning..", __func__);
+                                        p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, true);
+                                        return stat;
+                                    }
+                                } else {
+                                    signal_handler(P61_STATE_SPI_END, pn544_dev->nfc_service_pid);
+                                }
+                            } else {
+                                pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                            }
+                        } else if (pn544_dev->chip_pwr_scheme == PN80T_LEGACY_PWR_SCHEME) {
+                            svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START);
+                        }
+                    }
+                    if(pn544_dev->chip_pwr_scheme == PN80T_LEGACY_PWR_SCHEME) {
+#ifndef JCOP_4X_VALIDATION
+                        gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+#endif
+                        if(current_state & P61_STATE_SPI_FAILED) {
+                            p61_update_access_state(pn544_dev, P61_STATE_SPI_FAILED, false);
+                        }
+                        if(current_state & P61_STATE_SPI)
+                            p61_update_access_state(pn544_dev, P61_STATE_SPI,
+                                                    false);
+                        if(isSignalTriggerReqd)
+                            svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+                        //pr_info("PN80T legacy ese_pwr_gpio off %s", __func__);
+                    }
+                }
+                pn544_dev->spi_ven_enabled = false;
+                if (pn544_dev->nfc_ven_enabled == false && (pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME)
+                        && !(pn544_dev->secure_timer_cnt)) {
+                    gpio_set_value(pn544_dev->ven_gpio, 0);
+                    msleep(10);
+                }
+            } else {
+                pr_err("%s : PN61_SET_SPI_PWR - failed, current_state = %x \n",
+                       __func__, pn544_dev->p61_current_state);
+                return -EPERM; /* Operation not permitted */
+            }
+        } else if (arg == 2) {
+            pr_info("%s : PN61_SET_SPI_PWR - reset\n", __func__);
+            if (current_state & (P61_STATE_IDLE|P61_STATE_SPI|P61_STATE_SPI_PRIO)) {
+                if (pn544_dev->spi_ven_enabled == false) {
+                    pn544_dev->spi_ven_enabled = true;
+                    if ((pn544_dev->nfc_ven_enabled == false) && (pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME)) {
+                        /* provide power to NFCC if, NFC service not provided */
+                        gpio_set_value(pn544_dev->ven_gpio, 1);
+                        msleep(10);
+                    }
+                }
+                if(pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME  && !(pn544_dev->secure_timer_cnt)) {
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START);
+#ifndef JCOP_4X_VALIDATION
+                    gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+#endif
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+                    msleep(10);
+                    if(!gpio_get_value(pn544_dev->ese_pwr_gpio))
+                        gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+                    msleep(10);
+                }
+            } else {
+                pr_info("%s : PN61_SET_SPI_PWR - reset  failed \n", __func__);
+                return -EBUSY; /* Device or resource busy */
+            }
+        } else if (arg == 3) {
+            pr_info("%s : PN61_SET_SPI_PWR - Prio Session Start power on ese\n", __func__);
+            if ((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) == 0) {
+                p61_update_access_state(pn544_dev, P61_STATE_SPI_PRIO, true);
+                if (current_state & P61_STATE_WIRED) {
+                    if(pn544_dev->nfc_service_pid) {
+                        pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        /*signal_handler(P61_STATE_SPI_PRIO, pn544_dev->nfc_service_pid);*/
+                        dwp_OnOff(pn544_dev->nfc_service_pid, P61_STATE_SPI_PRIO);
+                    } else {
+                        pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                    }
+                }
+                pn544_dev->spi_ven_enabled = true;
+                if(pn544_dev->chip_pwr_scheme != PN80T_EXT_PMU_SCHEME) {
+                    if (pn544_dev->nfc_ven_enabled == false) {
+                        /* provide power to NFCC if, NFC service not provided */
+                        gpio_set_value(pn544_dev->ven_gpio, 1);
+                        msleep(10);
+                    }
+                    /* pull the gpio to high once NFCC is power on*/
+                    gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+
+                    /* Delay (10ms) after SVDD_PWR_ON to allow JCOP to bootup (5ms jcop boot time + 5ms guard time) */
+                    usleep_range(10000, 12000);
+                }
+            } else {
+                pr_info("%s : Prio Session Start power on ese failed \n", __func__);
+                return -EBUSY; /* Device or resource busy */
+            }
+        } else if (arg == 4) {
+            if (current_state & P61_STATE_SPI_PRIO) {
+                pr_info("%s : PN61_SET_SPI_PWR - Prio Session Ending...\n", __func__);
+                p61_update_access_state(pn544_dev, P61_STATE_SPI_PRIO, false);
+                /*after SPI prio timeout, the state is changing from SPI prio to SPI */
+                p61_update_access_state(pn544_dev, P61_STATE_SPI, true);
+                if (current_state & P61_STATE_WIRED) {
+                    if(pn544_dev->nfc_service_pid) {
+                        pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        signal_handler(P61_STATE_SPI_PRIO_END, pn544_dev->nfc_service_pid);
+                    } else {
+                        pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                    }
+                }
+            } else {
+                pr_info("%s : PN61_SET_SPI_PWR -  Prio Session End failed \n", __func__);
+                return -EBADRQC; /* Device or resource busy */
+            }
+        } else if(arg == 5) {
+            release_ese_lock(P61_STATE_SPI);
+        } else if (arg == 6) {
+            /*SPI Service called ISO-RST*/
+            p61_access_state_t current_state = P61_STATE_INVALID;
+            p61_get_access_state(pn544_dev, &current_state);
+            if(current_state & P61_STATE_WIRED) {
+                return -EPERM; /* Operation not permitted */
+            }
+            if(current_state & P61_STATE_SPI) {
+                p61_update_access_state(pn544_dev, P61_STATE_SPI, false);
+            } else if(current_state & P61_STATE_SPI_PRIO) {
+                p61_update_access_state(pn544_dev, P61_STATE_SPI_PRIO, false);
+            }
+        } else {
+            pr_info("%s bad ese pwr arg %lu\n", __func__, arg);
+            return -EBADRQC; /* Invalid request code */
+        }
+    }
+    break;
+
+    case P61_GET_PWR_STATUS: {
+        p61_access_state_t current_state = P61_STATE_INVALID;
+        p61_get_access_state(pn544_dev, &current_state);
+        //pr_info("%s: P61_GET_PWR_STATUS  = %x",__func__, current_state);
+        put_user(current_state, (int __user *)arg);
+    }
+    break;
+
+    case PN544_SET_DWNLD_STATUS: {
+        long ret;
+        ret = set_jcop_download_state(arg);
+        if(ret < 0) {
+            return ret;
+        }
+    }
+    break;
+
+    case P61_SET_WIRED_ACCESS: {
+        p61_access_state_t current_state = P61_STATE_INVALID;
+        p61_get_access_state(pn544_dev, &current_state);
+        if (arg == 1) {
+            if (current_state) {
+                //pr_info("%s : P61_SET_WIRED_ACCESS - enabling\n", __func__);
+                p61_update_access_state(pn544_dev, P61_STATE_WIRED, true);
+                if (current_state & P61_STATE_SPI_PRIO) {
+                    if(pn544_dev->nfc_service_pid) {
+                        //pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                        signal_handler(P61_STATE_SPI_PRIO, pn544_dev->nfc_service_pid);
+                    } else {
+                        pr_info(" invalid nfc service pid....signalling failed%s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+                    }
+                }
+                if((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) == 0 && (pn544_dev->chip_pwr_scheme == PN67T_PWR_SCHEME))
+                    gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+            } else {
+                pr_info("%s : P61_SET_WIRED_ACCESS -  enabling failed \n", __func__);
+                return -EBUSY; /* Device or resource busy */
+            }
+        } else if (arg == 0) {
+            //pr_info("%s : P61_SET_WIRED_ACCESS - disabling \n", __func__);
+            if (current_state & P61_STATE_WIRED) {
+                p61_update_access_state(pn544_dev, P61_STATE_WIRED, false);
+                if((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) == 0 && (pn544_dev->chip_pwr_scheme == PN67T_PWR_SCHEME)) {
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START);
+                    gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+                    svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+                }
+            } else {
+                pr_err("%s : P61_SET_WIRED_ACCESS - failed, current_state = %x \n",
+                       __func__, pn544_dev->p61_current_state);
+                return -EPERM; /* Operation not permitted */
+            }
+        } else if(arg == 2) {
+            //pr_info("%s : P61_ESE_GPIO_LOW  \n", __func__);
+            if(pn544_dev->chip_pwr_scheme == PN67T_PWR_SCHEME) {
+                svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_START);
+                gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+                svdd_sync_onoff(pn544_dev->nfc_service_pid, P61_STATE_SPI_SVDD_SYNC_END);
+            }
+        } else if(arg == 3) {
+            //pr_info("%s : P61_ESE_GPIO_HIGH  \n", __func__);
+            if(pn544_dev->chip_pwr_scheme == PN67T_PWR_SCHEME)
+                gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+        } else if(arg == 4) {
+            release_ese_lock(P61_STATE_WIRED);
+        } else if(arg == 5) {
+            gpio_set_value(pn544_dev->ese_pwr_gpio, 1);
+            if (gpio_get_value(pn544_dev->ese_pwr_gpio)) {
+                pr_info("%s: ese_pwr gpio is enabled\n", __func__);
+            }
+        } else if(arg == 6) {
+            gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+            pr_info("%s: ese_pwr gpio set to low\n", __func__);
+        } else {
+            pr_info("%s P61_SET_WIRED_ACCESS - bad arg %lu\n", __func__, arg);
+            return -EBADRQC; /* Invalid request code */
+        }
+    }
+    break;
+    case P544_SET_POWER_SCHEME: {
+        if(arg == PN67T_PWR_SCHEME) {
+            pn544_dev->chip_pwr_scheme = PN67T_PWR_SCHEME;
+            //pr_info("%s : The power scheme is set to PN67T legacy \n", __func__);
+        } else if(arg == PN80T_LEGACY_PWR_SCHEME) {
+            pn544_dev->chip_pwr_scheme = PN80T_LEGACY_PWR_SCHEME;
+            //pr_info("%s : The power scheme is set to PN80T_LEGACY_PWR_SCHEME,\n", __func__);
+        } else if(arg == PN80T_EXT_PMU_SCHEME) {
+            pn544_dev->chip_pwr_scheme = PN80T_EXT_PMU_SCHEME;
+            //pr_info("%s : The power scheme is set to PN80T_EXT_PMU_SCHEME,\n", __func__);
+        } else {
+            pr_info("%s : The power scheme is invalid,\n", __func__);
+        }
+    }
+    break;
+    case P544_SECURE_TIMER_SESSION: {
+        secure_timer_operation(pn544_dev, arg);
+    }
+    break;
+    default:
+        pr_err("%s bad ioctl %u\n", __func__, cmd);
+        return -EINVAL;
+    }
+    pr_info("%s :exit cmd = %u, arg = %ld\n", __func__, cmd, arg);
+    return 0;
+}
+EXPORT_SYMBOL(pn544_dev_ioctl);
+
+static void secure_timer_workqueue(struct work_struct *Wq) {
+    p61_access_state_t current_state = P61_STATE_INVALID;
+    printk( KERN_INFO "secure_timer_callback: called (%lu).\n", jiffies);
+    /* Locking the critical section: ESE_PWR_OFF to allow eSE to shutdown peacefully :: START */
+    get_ese_lock(P61_STATE_WIRED, MAX_ESE_ACCESS_TIME_OUT_MS);
+    p61_update_access_state(pn544_dev, P61_STATE_SECURE_MODE, false);
+    p61_get_access_state(pn544_dev, &current_state);
+
+    if((current_state & (P61_STATE_SPI|P61_STATE_SPI_PRIO)) == 0) {
+        printk( KERN_INFO "secure_timer_callback: make se_pwer_gpio low, state = %d", current_state);
+        gpio_set_value(pn544_dev->ese_pwr_gpio, 0);
+        /* Delay (2.5ms) after SVDD_PWR_OFF for the shutdown settlement time */
+        usleep_range(2500, 3000);
+        if(pn544_dev->nfc_service_pid == 0x00) {
+            gpio_set_value(pn544_dev->ven_gpio, 0);
+            printk( KERN_INFO "secure_timer_callback :make ven_gpio low, state = %d", current_state);
+        }
+    }
+    pn544_dev->secure_timer_cnt = 0;
+    /* Locking the critical section: ESE_PWR_OFF to allow eSE to shutdown peacefully :: END */
+    release_ese_lock(P61_STATE_WIRED);
+    return;
+}
+
+static void secure_timer_callback( unsigned long data ) {
+    /* Flush and push the timer callback event to the bottom half(work queue)
+    to be executed later, at a safer time */
+    flush_workqueue(pn544_dev->pSecureTimerCbWq);
+    queue_work(pn544_dev->pSecureTimerCbWq, &pn544_dev->wq_task);
+    return;
+}
+
+static long start_seccure_timer(unsigned long timer_value) {
+    long ret = -EINVAL;
+    pr_info("start_seccure_timer: enter\n");
+    /* Delete the timer if timer pending */
+    if(timer_pending(&secure_timer) == 1) {
+        pr_info("start_seccure_timer: delete pending timer \n");
+        /* delete timer if already pending */
+        del_timer(&secure_timer);
+    }
+    /* Start the timer if timer value is non-zero */
+    if(timer_value) {
+        init_timer(&secure_timer);
+        setup_timer( &secure_timer, secure_timer_callback, 0 );
+
+        pr_info("start_seccure_timer: timeout %lums (%lu)\n",timer_value, jiffies );
+        ret = mod_timer( &secure_timer, jiffies + msecs_to_jiffies(timer_value));
+        if (ret)
+            pr_info("start_seccure_timer: Error in mod_timer\n");
+    }
+    return ret;
+}
+
+static long secure_timer_operation(struct pn544_dev *pn544_dev, unsigned long arg) {
+    long ret = -EINVAL;
+    unsigned long timer_value =  arg;
+
+    printk( KERN_INFO "secure_timer_operation, %d\n",pn544_dev->chip_pwr_scheme);
+    if(pn544_dev->chip_pwr_scheme == PN80T_LEGACY_PWR_SCHEME) {
+        ret = start_seccure_timer(timer_value);
+        if(!ret) {
+            pn544_dev->secure_timer_cnt  = 1;
+            p61_update_access_state(pn544_dev, P61_STATE_SECURE_MODE, true);
+        } else {
+            pn544_dev->secure_timer_cnt  = 0;
+            p61_update_access_state(pn544_dev, P61_STATE_SECURE_MODE, false);
+            pr_info("%s :Secure timer reset \n", __func__);
+        }
+    } else {
+        pr_info("%s :Secure timer session not applicable  \n", __func__);
+    }
+    return ret;
+}
+
+static long set_jcop_download_state(unsigned long arg) {
+    p61_access_state_t current_state = P61_STATE_INVALID;
+    long ret = 0;
+    p61_get_access_state(pn544_dev, &current_state);
+    pr_info("%s:Enter PN544_SET_DWNLD_STATUS:JCOP Dwnld state arg = %ld",__func__, arg);
+    if(arg == JCP_DWNLD_INIT) {
+        if(pn544_dev->nfc_service_pid) {
+            pr_info("nfc service pid %s   ---- %ld", __func__, pn544_dev->nfc_service_pid);
+            signal_handler(JCP_DWNLD_INIT, pn544_dev->nfc_service_pid);
+        } else {
+            if (current_state & P61_STATE_JCP_DWNLD) {
+                ret = -EINVAL;
+            } else {
+                p61_update_access_state(pn544_dev, P61_STATE_JCP_DWNLD, true);
+            }
+        }
+    } else if (arg == JCP_DWNLD_START) {
+        if (current_state & P61_STATE_JCP_DWNLD) {
+            ret = -EINVAL;
+        } else {
+            p61_update_access_state(pn544_dev, P61_STATE_JCP_DWNLD, true);
+        }
+    } else if (arg == JCP_SPI_DWNLD_COMPLETE) {
+        if(pn544_dev->nfc_service_pid) {
+            signal_handler(JCP_DWP_DWNLD_COMPLETE, pn544_dev->nfc_service_pid);
+        }
+        p61_update_access_state(pn544_dev, P61_STATE_JCP_DWNLD, false);
+    } else if (arg == JCP_DWP_DWNLD_COMPLETE) {
+        p61_update_access_state(pn544_dev, P61_STATE_JCP_DWNLD, false);
+    } else {
+        pr_info("%s bad ese pwr arg %lu\n", __func__, arg);
+        return -EBADRQC; /* Invalid request code */
+    }
+    pr_info("%s: PN544_SET_DWNLD_STATUS  = %x",__func__, current_state);
+
+    return ret;
+}
+
+int get_ese_lock(p61_access_state_t  p61_current_state, int timeout) {
+    unsigned long tempJ = msecs_to_jiffies(timeout);
+    if(down_timeout(&ese_access_sema, tempJ) != 0) {
+        printk("get_ese_lock: timeout p61_current_state = %d\n", p61_current_state);
+        return -EBUSY;
+    }
+    return 0;
+}
+EXPORT_SYMBOL(get_ese_lock);
+
+static void release_ese_lock(p61_access_state_t  p61_current_state) {
+    up(&ese_access_sema);
+}
+
+
+static const struct file_operations pn544_dev_fops = {
+    .owner  = THIS_MODULE,
+    .llseek = no_llseek,
+    .read   = pn544_dev_read,
+    .write  = pn544_dev_write,
+    .open   = pn544_dev_open,
+    .unlocked_ioctl  = pn544_dev_ioctl,
+};
+static int pn544_parse_dt(struct device *dev,
+                          struct pn544_i2c_platform_data *data) {
+    struct device_node *np = dev->of_node;
+    int errorno = 0;
+
+    data->irq_gpio = of_get_named_gpio(np, "nxp,pn544-irq", 0);
+    if ((!gpio_is_valid(data->irq_gpio)))
+        return -EINVAL;
+
+    data->ven_gpio = of_get_named_gpio(np, "nxp,pn544-ven", 0);
+    if ((!gpio_is_valid(data->ven_gpio)))
+        return -EINVAL;
+
+    data->firm_gpio = of_get_named_gpio(np, "nxp,pn544-fw-dwnld", 0);
+    if ((!gpio_is_valid(data->firm_gpio)))
+        return -EINVAL;
+
+    data->ese_pwr_gpio = of_get_named_gpio(np, "nxp,pn544-ese-pwr", 0);
+    if ((!gpio_is_valid(data->ese_pwr_gpio)))
+        return -EINVAL;
+
+    data->clkreq_gpio = of_get_named_gpio(np, "nxp,pn544-clk-gpio", 0);
+    if ((!gpio_is_valid(data->clkreq_gpio)))
+        return -EINVAL;
+
+    of_property_read_string(np, "qcom,clk-src", &data->clk_src_name);
+
+    pr_info("%s: %d, %d, %d, %d, %d error:%d\n", __func__,
+            data->irq_gpio, data->ven_gpio, data->firm_gpio,
+            data->ese_pwr_gpio, data->clkreq_gpio, errorno);
+
+    return errorno;
+}
+
+static int pn544_probe(struct i2c_client *client,
+                       const struct i2c_device_id *id) {
+    int ret;
+    struct pn544_i2c_platform_data *platform_data;
+    //struct pn544_dev *pn544_dev;
+
+    struct device_node *node = client->dev.of_node;
+
+    if (node) {
+        platform_data = devm_kzalloc(&client->dev,
+                                     sizeof(struct pn544_i2c_platform_data), GFP_KERNEL);
+        if (!platform_data) {
+            dev_err(&client->dev,
+                    "nfc-nci probe: Failed to allocate memory\n");
+            return -ENOMEM;
+        }
+        ret = pn544_parse_dt(&client->dev, platform_data);
+        if (ret) {
+            pr_info("%s pn544_parse_dt failed", __func__);
+        }
+        client->irq = gpio_to_irq(platform_data->irq_gpio);
+        if (client->irq < 0) {
+            pr_info("%s gpio to irq failed", __func__);
+        }
+    } else {
+        platform_data = client->dev.platform_data;
+    }
+    if (platform_data == NULL) {
+        pr_err("%s : nfc probe fail\n", __func__);
+        return  -ENODEV;
+    }
+
+    if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+        pr_err("%s : need I2C_FUNC_I2C\n", __func__);
+        return  -ENODEV;
+    }
+    pn544_dev = kzalloc(sizeof(*pn544_dev), GFP_KERNEL);
+    if (pn544_dev == NULL) {
+        dev_err(&client->dev,
+                "failed to allocate memory for module data\n");
+        ret = -ENOMEM;
+        goto err_exit;
+    }
+
+    pn544_dev->kbuflen = MAX_BUFFER_SIZE;
+    pn544_dev->kbuf = kzalloc(MAX_BUFFER_SIZE, GFP_KERNEL);
+    if (!pn544_dev->kbuf) {
+        pr_err("failed to allocate memory for pn544_dev->kbuf\n");
+        ret = -ENOMEM;
+        goto err_free_dev;
+    }
+
+    pn544_dev->irq_gpio = platform_data->irq_gpio;
+    pn544_dev->ven_gpio  = platform_data->ven_gpio;
+    pn544_dev->firm_gpio  = platform_data->firm_gpio;
+    pn544_dev->ese_pwr_gpio  = platform_data->ese_pwr_gpio;
+    pn544_dev->clkreq_gpio = platform_data->clkreq_gpio;
+    pn544_dev->clk_src_name = platform_data->clk_src_name;
+    pn544_dev->p61_current_state = P61_STATE_IDLE;
+    pn544_dev->nfc_ven_enabled = false;
+    pn544_dev->spi_ven_enabled = false;
+    pn544_dev->chip_pwr_scheme = PN67T_PWR_SCHEME;
+    pn544_dev->client   = client;
+    pn544_dev->secure_timer_cnt = 0;
+
+#ifdef CLOCK_CTRL
+    if (!strcmp(pn544_dev->clk_src_name, "BBCLK3")) {
+        pr_info("get %s\n", pn544_dev->clk_src_name);
+        pn544_dev->s_clk = clk_get(&pn544_dev->client->dev, "ref_clk");
+        if (IS_ERR(pn544_dev->s_clk)) {
+            pr_err("no pclk defined\n");
+            goto err_clk;
+        }
+    }
+    clk_set_rate(pn544_dev->s_clk, 19200000);
+    ret = clk_prepare_enable(pn544_dev->s_clk);
+    pr_info("clk_prepare_enable. ret = %d\n", ret);
+    if (ret)
+        pr_err("Can't enable s_clk\n");
+#endif
+
+    ret = gpio_request(platform_data->irq_gpio, "nfc_int");
+    if (ret < 0) {
+        pr_err("%s :not able to set irq_gpio as input\n", __func__);
+        goto err_irq;
+    }
+    ret = gpio_request(platform_data->ven_gpio, "nfc_ven");
+    if (ret < 0) {
+        pr_err("%s : not able to set ven_gpio as output\n", __func__);
+        goto err_ven;
+    }
+    ret = gpio_request(platform_data->ese_pwr_gpio, "nfc_ese_pwr");
+    if (ret < 0) {
+        pr_err("%s : not able to set ese_pwr gpio as output\n", __func__);
+        goto err_ese_pwr;
+    }
+    ret = gpio_request(platform_data->clkreq_gpio, "nfc_clk_gpio");
+    if (ret < 0) {
+        pr_err("%s :not able to set clkreq_gpio as input\n", __func__);
+        goto err_clkreq;
+    }
+    if (platform_data->firm_gpio) {
+        ret = gpio_request(platform_data->firm_gpio, "nfc_firm");
+        if (ret < 0) {
+            pr_err("%s : not able to set firm_gpio as output\n",
+                   __func__);
+            goto err_firm;
+        }
+    }
+
+    ret = gpio_direction_input(pn544_dev->irq_gpio);
+    if (ret < 0) {
+        pr_err("%s :not able to set irq_gpio as input\n", __func__);
+        goto err_gpio_set;
+    }
+    ret = gpio_direction_output(pn544_dev->ven_gpio, 0);
+    if (ret < 0) {
+        pr_err("%s : not able to set ven_gpio as output\n", __func__);
+        goto err_gpio_set;
+    }
+    ret = gpio_direction_output(pn544_dev->ese_pwr_gpio, 0);
+    if (ret < 0) {
+        pr_err("%s : not able to set ese_pwr gpio as output\n", __func__);
+        goto err_gpio_set;
+    }
+    ret = gpio_direction_input(pn544_dev->clkreq_gpio);
+    if (ret < 0) {
+        pr_err("%s :not able to set clkreq_gpio as input\n", __func__);
+        goto err_gpio_set;
+    }
+    if (platform_data->firm_gpio) {
+        ret = gpio_direction_output(pn544_dev->firm_gpio, 0);
+        if (ret < 0) {
+            pr_err("%s : not able to set firm_gpio as output\n",
+                   __func__);
+            goto err_gpio_set;
+        }
+    }
+    /* init mutex and queues */
+    init_waitqueue_head(&pn544_dev->read_wq);
+    mutex_init(&pn544_dev->read_mutex);
+    sema_init(&ese_access_sema, 1);
+    sema_init(&dwp_onoff_release_sema, 0);
+    spin_lock_init(&pn544_dev->irq_enabled_lock);
+    pn544_dev->pSecureTimerCbWq = create_workqueue(SECURE_TIMER_WORK_QUEUE);
+    INIT_WORK(&pn544_dev->wq_task, secure_timer_workqueue);
+    pn544_dev->pn544_device.minor = MISC_DYNAMIC_MINOR;
+    pn544_dev->pn544_device.name = "nq-nci";
+    pn544_dev->pn544_device.fops = &pn544_dev_fops;
+
+    ret = misc_register(&pn544_dev->pn544_device);
+    if (ret) {
+        pr_err("%s : misc_register failed\n", __FILE__);
+        goto err_misc_register;
+    }
+    /* HiKey Compilation fix */
+#ifndef HiKey_620_COMPILATION_FIX
+    wake_lock_init(&nfc_wake_lock, WAKE_LOCK_SUSPEND, "NFCWAKE");
+#endif
+    /* request irq.  the irq is set whenever the chip has data available
+     * for reading.  it is cleared when all data has been read.
+     */
+    pr_info("%s : requesting IRQ %d\n", __func__, client->irq);
+    pn544_dev->irq_enabled = true;
+    ret = request_irq(client->irq, pn544_dev_irq_handler,
+                      IRQF_TRIGGER_HIGH, client->name, pn544_dev);
+    if (ret) {
+        dev_err(&client->dev, "request_irq failed\n");
+        goto err_request_irq_failed;
+    }
+    enable_irq_wake(pn544_dev->client->irq);
+    device_init_wakeup(&client->dev, true);
+    device_set_wakeup_capable(&client->dev, true);
+    pn544_disable_irq(pn544_dev);
+    i2c_set_clientdata(client, pn544_dev);
+#if HWINFO
+    /*
+     * This function is used only if
+     * hardware info is required during probe*/
+    check_hw_info();
+#endif
+
+    return 0;
+
+err_request_irq_failed:
+    misc_deregister(&pn544_dev->pn544_device);
+err_misc_register:
+    mutex_destroy(&pn544_dev->read_mutex);
+err_gpio_set:
+    if (pn544_dev->firm_gpio)
+        gpio_free(platform_data->firm_gpio);
+err_firm:
+    gpio_free(platform_data->clkreq_gpio);
+err_clkreq:
+    gpio_free(platform_data->ese_pwr_gpio);
+err_ese_pwr:
+    gpio_free(platform_data->ven_gpio);
+err_ven:
+    gpio_free(platform_data->irq_gpio);
+err_irq:
+#ifdef CLOCK_CTRL
+    clk_disable(pn544_dev->s_clk);
+    clk_put(pn544_dev->s_clk);
+err_clk:
+#endif
+    kfree(pn544_dev->kbuf);
+err_free_dev:
+    kfree(pn544_dev);
+err_exit:
+    return ret;
+}
+
+static int pn544_remove(struct i2c_client *client) {
+    struct pn544_dev *pn544_dev;
+
+    pn544_dev = i2c_get_clientdata(client);
+#ifdef CLOCK_CTRL
+    clk_disable(pn544_dev->s_clk);
+    clk_put(pn544_dev->s_clk);
+#endif
+    free_irq(client->irq, pn544_dev);
+    misc_deregister(&pn544_dev->pn544_device);
+    mutex_destroy(&pn544_dev->read_mutex);
+    gpio_free(pn544_dev->irq_gpio);
+    gpio_free(pn544_dev->ven_gpio);
+    gpio_free(pn544_dev->ese_pwr_gpio);
+    gpio_free(pn544_dev->clkreq_gpio);
+    destroy_workqueue(pn544_dev->pSecureTimerCbWq);
+    pn544_dev->p61_current_state = P61_STATE_INVALID;
+    pn544_dev->nfc_ven_enabled = false;
+    pn544_dev->spi_ven_enabled = false;
+
+    if (pn544_dev->firm_gpio)
+        gpio_free(pn544_dev->firm_gpio);
+    kfree(pn544_dev->kbuf);
+    kfree(pn544_dev);
+
+    return 0;
+}
+
+static int pn544_suspend(struct device *device) {
+    struct i2c_client *client = to_i2c_client(device);
+    pn544_dev = i2c_get_clientdata(client);
+
+    if (pn544_dev->nfc_ven_enabled && gpio_get_value(pn544_dev->irq_gpio)) {
+        pm_wakeup_event(&pn544_dev->client->dev, WAKEUP_SRC_TIMEOUT);
+        return -1;
+    }
+
+    return 0;
+}
+
+static int pn544_resume(struct device *device) {
+    return 0;
+}
+
+static const struct dev_pm_ops nfc_pm_ops = {
+    SET_SYSTEM_SLEEP_PM_OPS(pn544_suspend, pn544_resume)
+};
+
+static const struct i2c_device_id pn544_id[] = {
+    { "pn544", 0 },
+    { }
+};
+static struct of_device_id pn544_i2c_dt_match[] = {
+    {
+        .compatible = "nxp,pn544",
+    },
+    {}
+};
+static struct i2c_driver pn544_driver = {
+    .id_table   = pn544_id,
+    .probe      = pn544_probe,
+    .remove     = pn544_remove,
+    .driver     = {
+        .owner = THIS_MODULE,
+        .name  = "pn544",
+        .of_match_table = pn544_i2c_dt_match,
+        .pm = &nfc_pm_ops,
+    },
+};
+#if HWINFO
+/******************************************************************************
+ * Function         check_hw_info
+ *
+ * Description      This function is called during pn544_probe to retrieve
+ *                  HW info.
+ *                  Useful get HW information in case of previous FW download is
+ *                  interrupted and core reset is not allowed.
+ *                  This function checks if core reset  is allowed, if not
+ *                  sets DWNLD_REQ(firm_gpio) , ven reset and sends firmware
+ *                  get version command.
+ *                  In response HW information will be received.
+ *
+ * Returns          None
+ *
+ ******************************************************************************/
+static void check_hw_info() {
+    //char read_data[20];
+    int ret, get_version_len = 8, retry_count = 0;
+    // static uint8_t cmd_reset_nci[] = {0x20, 0x00, 0x01, 0x00};
+    char get_version_cmd[] =
+    {0x00, 0x04, 0xF1, 0x00, 0x00, 0x00, 0x6E, 0xEF};
+
+    char *tmp = kzalloc(MAX_BUFFER_SIZE,GFP_KERNEL);
+    if (tmp == NULL) {
+        pr_err("%s: failed to allocate memory for transfer data\n", __func__);
+        return;
+    }
+
+    memcpy(tmp, get_version_cmd, get_version_len);
+
+
+    pr_info("%s :Enter\n", __func__);
+
+    /*
+     * Ven Reset  before sending core Reset
+     * This is to check core reset is allowed or not.
+     * If not allowed then previous FW download is interrupted in between
+     * */
+
+    /*
+     * Core reset  failed.
+     * set the DWNLD_REQ , do ven reset
+     * send firmware download info command
+     * */
+    // pr_err("%s : write failed\n", __func__);
+    pr_info("%s power on with firmware\n", __func__);
+    gpio_set_value(pn544_dev->ven_gpio, 1);
+    msleep(10);
+    if (pn544_dev->firm_gpio) {
+        p61_update_access_state(pn544_dev, P61_STATE_DWNLD, true);
+        gpio_set_value(pn544_dev->firm_gpio, 1);
+    }
+    msleep(10);
+    gpio_set_value(pn544_dev->ven_gpio, 0);
+    msleep(10);
+    gpio_set_value(pn544_dev->ven_gpio, 1);
+    msleep(10);
+    ret = i2c_master_send(pn544_dev->client, tmp, get_version_len);
+    if (ret != get_version_len) {
+        pr_err("%s : write_failed ret=%d\n", __func__,ret);
+        kfree(tmp);
+        return ;
+    } else {
+        pr_info("%s :data sent\n", __func__);
+    }
+
+    ret = 0;
+
+    while (retry_count < 10) {
+
+        /*
+         * Wait for read interrupt
+         * If spurious interrupt is received retry again
+         * */
+        pn544_dev->irq_enabled = true;
+        enable_irq(pn544_dev->client->irq);
+        //enable_irq_wake(pn544_dev->client->irq);
+        ret = wait_event_interruptible(
+                  pn544_dev->read_wq,
+                  !pn544_dev->irq_enabled);
+
+        pn544_disable_irq(pn544_dev);
+
+        if (gpio_get_value(pn544_dev->irq_gpio))
+            break;
+
+        pr_warning("%s: spurious interrupt detected\n", __func__);
+        retry_count ++;
+    }
+
+    if(ret) {
+        return;
+    }
+
+    memset(tmp, 0x00, MAX_BUFFER_SIZE);
+    /*
+     * Read response data and copy into hw_type_info
+     * */
+    ret = i2c_master_recv(pn544_dev->client, tmp, 14);
+
+    if(ret > 0) {
+        memcpy(hw_info.data, tmp, ret);
+        hw_info.len = ret;
+        pr_info("%s :Hardware Version  : %d\n", __func__,hw_info.data[3]);
+
+        switch (hw_info.data[3]) {
+        case NFCC_NQ_210:
+            push_component_info(NFC, "NQ210", "NXP");
+            break;
+        case NFCC_NQ_220:
+            push_component_info(NFC, "NQ220", "NXP");
+            break;
+        case NFCC_NQ_310:
+            push_component_info(NFC, "NQ310", "NXP");
+            break;
+        case NFCC_NQ_310_V2:
+            push_component_info(NFC, "NQ310", "NXP");
+            break;
+        case NFCC_NQ_330:
+            push_component_info(NFC, "NQ330", "NXP");
+            break;
+        case NFCC_PN66T:
+            push_component_info(NFC, "PN66T", "NXP");
+            break;
+        default:
+            pr_err("%s: spurious interrupt detected\n", __func__);
+            break;
+        }
+
+    } else {
+        pr_err("%s :Read Failed\n", __func__);
+    }
+    p61_update_access_state(pn544_dev, P61_STATE_DWNLD, false);
+    gpio_set_value(pn544_dev->firm_gpio, 0);
+    msleep(10);
+    gpio_set_value(pn544_dev->ven_gpio, 0);
+    udelay(1000);
+    kfree(tmp);
+}
+#endif
+/*
+ * module load/unload record keeping
+ */
+
+static int __init pn544_dev_init(void) {
+    pr_info("Loading pn544 driver\n");
+    return i2c_add_driver(&pn544_driver);
+}
+module_init(pn544_dev_init);
+
+static void __exit pn544_dev_exit(void) {
+    pr_info("Unloading pn544 driver\n");
+    i2c_del_driver(&pn544_driver);
+}
+module_exit(pn544_dev_exit);
+
+MODULE_AUTHOR("Sylvain Fonteneau");
+MODULE_DESCRIPTION("NFC PN544 driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/nfc/pn5xx.h b/drivers/nfc/pn5xx.h
new file mode 100644
index 0000000000000000000000000000000000000000..fca85aa8eca42a8cfc1e7c0bcea23a7367c8ed60
--- /dev/null
+++ b/drivers/nfc/pn5xx.h
@@ -0,0 +1,181 @@
+/*
+ * Copyright (C) 2010 Trusted Logic S.A.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+/******************************************************************************
+ *
+ *  The original Work has been changed by NXP Semiconductors.
+ *
+ *  Copyright (C) 2013-2014 NXP Semiconductors
+ *   *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *
+ ******************************************************************************/
+#ifndef _PN553_H_
+#define _PN553_H_
+#define PN544_MAGIC 0xE9
+
+/*
+ * PN544 power control via ioctl
+ * PN544_SET_PWR(0): power off
+ * PN544_SET_PWR(1): power on
+ * PN544_SET_PWR(2): reset and power on with firmware download enabled
+ */
+#define PN544_SET_PWR    _IOW(PN544_MAGIC, 0x01, int)
+
+/*
+ * SPI Request NFCC to enable p61 power, only in param
+ * Only for SPI
+ * level 1 = Enable power
+ * level 0 = Disable power
+ */
+#define P61_SET_SPI_PWR    _IOW(PN544_MAGIC, 0x02, int)
+
+/* SPI or DWP can call this ioctl to get the current
+ * power state of P61
+ *
+*/
+#define P61_GET_PWR_STATUS    _IOR(PN544_MAGIC, 0x03, int)
+
+/* DWP side this ioctl will be called
+ * level 1 = Wired access is enabled/ongoing
+ * level 0 = Wired access is disalbed/stopped
+*/
+#define P61_SET_WIRED_ACCESS _IOW(PN544_MAGIC, 0x04, int)
+
+/*
+  NFC Init will call the ioctl to register the PID with the i2c driver
+*/
+#define P544_SET_NFC_SERVICE_PID _IOW(PN544_MAGIC, 0x05, int)
+
+/*
+  NFC and SPI will call the ioctl to get the i2c/spi bus access
+*/
+#define P544_GET_ESE_ACCESS _IOW(PN544_MAGIC, 0x06, int)
+/*
+  NFC and SPI will call the ioctl to update the power scheme
+*/
+#define P544_SET_POWER_SCHEME _IOW(PN544_MAGIC, 0x07, int)
+
+/*
+  NFC will call the ioctl to release the svdd protection
+*/
+#define P544_REL_SVDD_WAIT _IOW(PN544_MAGIC, 0x08, int)
+
+/* SPI or DWP can call this ioctl to get the current
+ * power state of P61
+ *
+*/
+#define PN544_SET_DWNLD_STATUS    _IOW(PN544_MAGIC, 0x09, int)
+/*
+  NFC will call the ioctl to release the dwp on/off protection
+*/
+#define P544_REL_DWPONOFF_WAIT _IOW(PN544_MAGIC, 0x0A, int)
+
+/*
+  NFC will call the ioctl to start Secure Timer
+*/
+
+#define P544_SECURE_TIMER_SESSION _IOW(PN544_MAGIC, 0x0B, int)
+
+#define MAX_ESE_ACCESS_TIME_OUT_MS 200 /*100 milliseconds*/
+
+typedef enum p61_access_state {
+    P61_STATE_INVALID = 0x0000,
+    P61_STATE_IDLE = 0x0100, /* p61 is free to use */
+    P61_STATE_WIRED = 0x0200,  /* p61 is being accessed by DWP (NFCC)*/
+    P61_STATE_SPI = 0x0400, /* P61 is being accessed by SPI */
+    P61_STATE_DWNLD = 0x0800, /* NFCC fw download is in progress */
+    P61_STATE_SPI_PRIO = 0x1000, /*Start of p61 access by SPI on priority*/
+    P61_STATE_SPI_PRIO_END = 0x2000, /*End of p61 access by SPI on priority*/
+    P61_STATE_SPI_END = 0x4000,
+    P61_STATE_JCP_DWNLD = 0x8000,/* JCOP downlad in progress */
+    P61_STATE_SECURE_MODE = 0x100000, /* secure mode state*/
+    P61_STATE_SPI_SVDD_SYNC_START = 0x0001, /*ESE_VDD Low req by SPI*/
+    P61_STATE_SPI_SVDD_SYNC_END = 0x0002, /*ESE_VDD is Low by SPI*/
+    P61_STATE_DWP_SVDD_SYNC_START = 0x0004, /*ESE_VDD  Low req by Nfc*/
+    P61_STATE_DWP_SVDD_SYNC_END = 0x0008, /*ESE_VDD is Low by Nfc*/
+    P61_STATE_SPI_FAILED = 0x0010 /*SPI open/close failed*/
+} p61_access_state_t;
+
+typedef enum chip_type_pwr_scheme {
+    PN67T_PWR_SCHEME = 0x01,
+    PN80T_LEGACY_PWR_SCHEME,
+    PN80T_EXT_PMU_SCHEME,
+} chip_pwr_scheme_t;
+
+typedef enum {
+    STATUS_FAILED = -1,
+    STATUS_SUCCESS = (0x0000),
+} STATUS;
+
+typedef enum jcop_dwnld_state {
+    JCP_DWNLD_IDLE = P61_STATE_JCP_DWNLD,   /* jcop dwnld is ongoing*/
+    JCP_DWNLD_INIT=0x8010,                         /* jcop dwonload init state*/
+    JCP_DWNLD_START=0x8020,                        /* download started */
+    JCP_SPI_DWNLD_COMPLETE=0x8040,                 /* jcop download complete in spi interface*/
+    JCP_DWP_DWNLD_COMPLETE=0x8080,                 /* jcop download complete */
+} jcop_dwnld_state_t;
+
+struct pn544_i2c_platform_data {
+    unsigned int irq_gpio;
+    unsigned int ven_gpio;
+    unsigned int firm_gpio;
+    unsigned int clkreq_gpio;
+    unsigned int ese_pwr_gpio; /* gpio to give power to p61, only TEE should use this */
+    const char *clk_src_name;
+};
+
+struct hw_type_info {
+    /*
+     * Response of get_version_cmd will be stored in data
+     * byte structure :
+     * byte 0-1     : Header
+     * byte 2       : Status
+     * byte 3       : Hardware Version
+     * byte 4       : ROM code
+     * byte 5       : 0x00 constant
+     * byte 6-7     : Protected data version
+     * byte 8-9     : Trim data version
+     * byte 10-11   : FW version
+     * byte 12-13   : CRC
+     * */
+    char data[20];
+    int len;
+};
+
+enum nfcc_chip_variant {
+    NFCC_NQ_210			= 0x48,	/**< NFCC NQ210 */
+    NFCC_NQ_220			= 0x58,	/**< NFCC NQ220 */
+    NFCC_NQ_310			= 0x40,	/**< NFCC NQ310 */
+    NFCC_NQ_310_V2			= 0x41,	/**< NFCC NQ310 */
+    NFCC_NQ_330			= 0x51,	/**< NFCC NQ330 */
+    NFCC_PN66T			= 0x18,	/**< NFCC PN66T */
+    NFCC_NOT_SUPPORTED	        = 0xFF	/**< NFCC is not supported */
+};
+#endif
diff --git a/drivers/oem_debug/Kconfig b/drivers/oem_debug/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..4fc467d0e00d4ba7f081d84ef88f88e4a1f1ad79
--- /dev/null
+++ b/drivers/oem_debug/Kconfig
@@ -0,0 +1,3 @@
+config OEM_FORCE_DUMP
+	default y
+	bool "OEM force dump function, it will enable goto the force dump"
diff --git a/drivers/oem_debug/Makefile b/drivers/oem_debug/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..d5e9797014bab869b1f1249bf4e780026a2836ee
--- /dev/null
+++ b/drivers/oem_debug/Makefile
@@ -0,0 +1,2 @@
+#obj-$(CONFIG_OEM_FORCE_DUMP) += oem_force_dump.o
+obj-y += oem_force_dump.o
diff --git a/drivers/oem_debug/oem_force_dump.c b/drivers/oem_debug/oem_force_dump.c
new file mode 100644
index 0000000000000000000000000000000000000000..36ac1a7f81574911329e986cb52582fa1057ff1e
--- /dev/null
+++ b/drivers/oem_debug/oem_force_dump.c
@@ -0,0 +1,212 @@
+/*
+ * oem_force_dump.c
+ *
+ * drivers supporting debug functions for Oneplus device.
+ *
+ * hefaxi@filesystems, 2015/07/03.
+ */
+#include <linux/reboot.h>
+#include <linux/input.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/timer.h>
+#include <linux/time.h>
+#include <linux/types.h>
+#include <net/sock.h>
+#include <net/netlink.h>
+#include <linux/string.h>
+#include <linux/task_work.h>
+#include <linux/oem_force_dump.h>
+
+struct sock *nl_sk;
+static int fd = -1;
+static struct workqueue_struct *smg_workwq;
+static struct work_struct smg_work;
+
+#define MAX_MSGSIZE 1024
+static int message_state = -1;
+
+
+/*
+ * the way goto force dump:
+ * 1. press the voluemup key and then relase it.
+ * 2. press the volumedown key and then relase it.
+ * 3. long press volumeup key, without release it.
+ * 4. press twice power key, and release it.
+ * 5. release the volumeup key.
+ * 6. presss the volumeup key, without release it.
+ * 7. press the power key.
+ * after those step, the device will goto the force dump.
+ */
+void oem_check_force_dump_key(unsigned int code, int value)
+{
+	static enum { NONE, STEP1, STEP2, STEP3, STEP4, STEP5,
+	STEP6, STEP7, STEP8, STEP9, STEP10, STEP11, STEP_DEBUG1} state = NONE;
+
+	switch (state) {
+	case NONE:
+		if (code == KEY_VOLUMEUP && value)
+			state = STEP1;
+		else
+			state = NONE;
+		break;
+	case STEP1:
+		if (code == KEY_VOLUMEUP && !value)
+			state = STEP2;
+		else
+			state = NONE;
+		break;
+	case STEP2:
+		if (code == KEY_VOLUMEDOWN && value)
+			state = STEP3;
+		else
+			state = NONE;
+		break;
+	case STEP3:
+		if (code == KEY_VOLUMEDOWN && !value)
+			state = STEP4;
+		else
+			state = NONE;
+		break;
+	case STEP4:
+		if (code == KEY_VOLUMEUP && value)
+			state = STEP5;
+		else
+			state = NONE;
+		break;
+	case STEP5:
+		if (code == KEY_POWER && value)
+			state = STEP6;
+		else
+			state = NONE;
+		break;
+	case STEP6:
+		if (code == KEY_POWER && !value)
+			state = STEP7;
+		else
+			state = NONE;
+		break;
+	case STEP7:
+		if (code == KEY_POWER && value)
+			state = STEP8;
+		else
+			state = NONE;
+		break;
+	case STEP8:
+		if (code == KEY_POWER && !value)
+			state = STEP9;
+		else
+			state = NONE;
+		break;
+	case STEP9:
+		if (code == KEY_VOLUMEUP && !value)
+			state = STEP10;
+		else
+			state = NONE;
+		break;
+	case STEP10:
+		if (code == KEY_VOLUMEUP && value)
+			state = STEP11;
+		else if (code == KEY_VOLUMEDOWN && value)
+			state = STEP_DEBUG1;
+		else
+			state = NONE;
+		break;
+	case STEP11:
+		if (code == KEY_POWER && value) {
+			if (oem_get_download_mode())
+				panic("Force Dump");
+		} else
+			state = NONE;
+		break;
+
+	case STEP_DEBUG1:
+		if (code == KEY_VOLUMEDOWN && !value) {
+			message_state = 2;
+			queue_work(smg_workwq, &smg_work);
+			state = NONE;
+		} else
+			state = NONE;
+		break;
+	}
+}
+
+static void send_msg_worker(struct work_struct *work)
+{
+	if (message_state == 1)
+		send_msg("Enable DEBUG!");
+	else if (message_state == 2) {
+		pr_info("force oem serial\n");
+		msm_serial_oem_init();
+		send_msg("ENABLE_OEM_FORCE_SERIAL");
+	}
+	message_state = 0;
+}
+
+void send_msg(char *message)
+{
+	struct sk_buff *skb;
+	struct nlmsghdr *nlh;
+	int len = NLMSG_SPACE(MAX_MSGSIZE);
+
+	if (!message || !nl_sk)
+		return;
+
+	skb = alloc_skb(len, GFP_KERNEL);
+	if (!skb)
+		return;
+	nlh = nlmsg_put(skb, 0, 0, 0, MAX_MSGSIZE, 0);
+	NETLINK_CB(skb).portid = 0;
+	NETLINK_CB(skb).dst_group = 0;
+	strlcpy(NLMSG_DATA(nlh), message, MAX_MSGSIZE);
+	netlink_unicast(nl_sk, skb, fd, MSG_DONTWAIT);
+}
+
+void recv_nlmsg(struct sk_buff *skb)
+{
+	struct nlmsghdr *nlh = nlmsg_hdr(skb);
+
+	if (nlh->nlmsg_len < NLMSG_HDRLEN || skb->len < nlh->nlmsg_len)
+		return;
+	fd = nlh->nlmsg_pid;
+	pr_err("received:%s %d\n", (char *)NLMSG_DATA(nlh), fd);
+}
+
+struct netlink_kernel_cfg nl_kernel_cfg = {
+	.groups = 0,
+	.flags = 0,
+	.input = recv_nlmsg,
+	.cb_mutex = NULL,
+	.bind = NULL,
+	.compare = NULL,
+};
+
+int op_netlink_init(void)
+{
+	nl_sk = netlink_kernel_create(&init_net, NETLINK_ADB, &nl_kernel_cfg);
+	if (!nl_sk) {
+		pr_err("%s: Create netlink socket error.\n", __func__);
+		return 1;
+	}
+	smg_workwq = create_singlethread_workqueue("oem_key_dump");
+	if (!smg_workwq) {
+		pr_err("%s: Create oem_key_dump error.\n", __func__);
+		return 1;
+	}
+	INIT_WORK(&smg_work, send_msg_worker);
+	pr_err("%s\n", __func__);
+	return 0;
+}
+
+static void op_netlink_exit(void)
+{
+	if (nl_sk != NULL)
+		sock_release(nl_sk->sk_socket);
+	if (smg_workwq != NULL)
+		destroy_workqueue(smg_workwq);
+	pr_err("%s\n", __func__);
+}
+
+module_init(op_netlink_init);
+module_exit(op_netlink_exit);
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/of/fdt.c b/drivers/of/fdt.c
index b1103e519ef615cc10f4cbb2c9d38ac22429e4a1..b56bc8a9931100761c085fb8fb0d1b58a06834d5 100644
--- a/drivers/of/fdt.c
+++ b/drivers/of/fdt.c
@@ -33,6 +33,8 @@
 
 #include "of_private.h"
 
+void init_param_mem_base_size(phys_addr_t base, unsigned long size);
+
 /*
  * of_fdt_limit_memory - limit the number of regions in the /memory node
  * @limit: maximum entries
@@ -613,6 +615,9 @@ static int __init __reserved_mem_reserve_reg(unsigned long node,
 			pr_info("Reserved memory: failed to reserve memory for node '%s': base %pa, size %ld MiB\n",
 				uname, &base, (unsigned long)size / SZ_1M);
 
+		if (!strncmp(uname, "param_mem", 9))
+			init_param_mem_base_size(base, size);
+
 		len -= t_len;
 		if (first) {
 			fdt_reserved_mem_save_node(node, uname, base, size);
diff --git a/drivers/oneplus/Kconfig b/drivers/oneplus/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..ca10ab48aabc6e0238f309dac7b758326adf5622
--- /dev/null
+++ b/drivers/oneplus/Kconfig
@@ -0,0 +1,17 @@
+config OEM_BOOT_MODE
+	bool "detect oem boot mode"
+	default y
+	help
+          detect oem boot mode  If unsure, say y.
+
+config OEM_TRACE_SUPPORT
+	default y
+	depends on OEM_DEBUG_SUPPORT
+	bool "OEM debug function, enable it will register the device, which under /dev/otracer."
+
+
+config WB_KERNEL_LOG
+	tristate "reserve kernel log to partition driver"
+	default n
+
+source "drivers/oneplus/coretech/Kconfig"
diff --git a/drivers/oneplus/Makefile b/drivers/oneplus/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..fd31b705c22cc3fd93846c252ef1b81e1ab7fe3e
--- /dev/null
+++ b/drivers/oneplus/Makefile
@@ -0,0 +1,9 @@
+obj-$(CONFIG_OEM_BOOT_MODE) += boot_mode.o
+ifdef CONFIG_OEM_DEBUG_SUPPORT
+# oem trace
+obj-$(CONFIG_OEM_TRACE_SUPPORT) += oem_trace.o
+endif
+
+obj-$(CONFIG_WB_KERNEL_LOG) += wb_kernel_log.o
+
+obj-y += coretech/
diff --git a/drivers/oneplus/boot_mode.c b/drivers/oneplus/boot_mode.c
new file mode 100644
index 0000000000000000000000000000000000000000..486982999d47540f9a7da141eccb00ce4b14c60c
--- /dev/null
+++ b/drivers/oneplus/boot_mode.c
@@ -0,0 +1,111 @@
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/oneplus/boot_mode.h>
+
+static enum oem_boot_mode boot_mode = MSM_BOOT_MODE__NORMAL;
+int oem_project = 0;
+int second_board_absent = 0;
+
+char *enum_ftm_mode[] = {"normal",
+						 "fastboot",
+						 "recovery",
+						 "aging",
+						 "ftm_at",
+						 "ftm_rf",
+						 "ftm_wlan",
+						 "ftm_mos",
+						 "charge"
+};
+
+enum oem_boot_mode get_boot_mode(void)
+{
+	return boot_mode;
+}
+EXPORT_SYMBOL(get_boot_mode);
+
+static int __init boot_mode_init(char *str)
+{
+
+	pr_info("boot_mode_init %s\n", str);
+
+	if (str) {
+		if (strncmp(str, "ftm_at", 6) == 0)
+			boot_mode = MSM_BOOT_MODE__FACTORY;
+		else if (strncmp(str, "ftm_rf", 6) == 0)
+			boot_mode = MSM_BOOT_MODE__RF;
+		else if (strncmp(str, "ftm_wlan", 8) == 0)
+			boot_mode = MSM_BOOT_MODE__WLAN;
+		else if (strncmp(str, "ftm_mos", 7) == 0)
+			boot_mode = MSM_BOOT_MODE__MOS;
+		else if (strncmp(str, "ftm_recovery", 12) == 0)
+			boot_mode = MSM_BOOT_MODE__RECOVERY;
+		else if (strncmp(str, "ftm_aging", 9) == 0)
+			boot_mode = MSM_BOOT_MODE__AGING;
+	}
+
+	pr_info("kernel boot_mode = %s[%d]\n",
+			enum_ftm_mode[boot_mode], boot_mode);
+	return 0;
+}
+__setup("androidboot.ftm_mode=", boot_mode_init);
+
+static int __init boot_mode_init_normal(void)
+{
+	char *substrftm = strnstr(boot_command_line,
+		"androidboot.ftm_mode=", strlen(boot_command_line));
+	char *substrnormal = strnstr(boot_command_line,
+		"androidboot.mode=", strlen(boot_command_line));
+	char *substrftmstr = NULL;
+	char *substrnormalstr = NULL;
+
+	substrftmstr = substrftm + strlen("androidboot.ftm_mode=");
+	substrnormalstr = substrnormal + strlen("androidboot.mode=");
+
+	if (substrftm != NULL && substrftmstr != NULL) {
+
+	} else if (substrnormal != NULL && substrnormalstr != NULL) {
+		if (strncmp(substrnormalstr, "recovery", 8) == 0)
+			boot_mode = MSM_BOOT_MODE__RECOVERY;
+		else if (strncmp(substrnormalstr, "charger", 7) == 0)
+			boot_mode = MSM_BOOT_MODE__CHARGE;
+			}
+
+	pr_info("kernel normal boot_mode = %s[%d]\n",
+	enum_ftm_mode[boot_mode], boot_mode);
+
+	return 0;
+}
+arch_initcall(boot_mode_init_normal);
+
+
+int get_oem_project(void)
+{
+	return oem_project;
+}
+EXPORT_SYMBOL(get_oem_project);
+
+static int __init get_oem_project_init(char *str)
+{
+	oem_project=simple_strtol(str, NULL, 0);
+	pr_info("kernel oem_project %d\n",oem_project);
+	return 0;
+}
+
+__setup("androidboot.project_name=", get_oem_project_init);
+
+int get_second_board_absent(void)
+{
+	return second_board_absent;
+}
+EXPORT_SYMBOL(get_second_board_absent);
+
+static int __init get_second_board_absent_init(char *str)
+{
+	second_board_absent=simple_strtol(str, NULL, 0);
+	pr_info("kernel second_board_absent %d\n",second_board_absent);
+	return 0;
+}
+
+__setup("androidboot.sec_bd_abs=", get_second_board_absent_init);
+
+
diff --git a/drivers/oneplus/coretech/Kconfig b/drivers/oneplus/coretech/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..76a96e04ed519c52f37376f038d549d6abdcd528
--- /dev/null
+++ b/drivers/oneplus/coretech/Kconfig
@@ -0,0 +1,34 @@
+config OPCHAIN
+	default n
+	bool "Oneplus CoreTech helper, used for opchain module"
+
+config DEFRAG_HELPER
+	default n
+	bool "Oneplus CoreTech helper, used for defrag module"
+
+config CRPL_HELPER
+	default n
+	bool "Oneplus CoreTech helper, used for crpl module"
+
+config ADJ_CHAIN
+	default n
+	bool "Chain task adj for victim select"
+	help
+	 To chain task adj for any purpose
+
+config HOUSTON
+	default n
+	bool "houston rocket play your temperature guard"
+	help
+	 Realtime temperature monitor
+
+config MEMPLUS
+	default n
+	bool "memory+ feature"
+	help
+	 Memory+ feature
+config FSC
+	default n
+	bool "system layer file status cache"
+	help
+	 To cache absence file and avoid stat call storm
diff --git a/drivers/oneplus/coretech/Makefile b/drivers/oneplus/coretech/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..e31fdd828b913c04ac41d0cdc80a8e40e53e6ac1
--- /dev/null
+++ b/drivers/oneplus/coretech/Makefile
@@ -0,0 +1,8 @@
+obj-y += coretech_helper.o
+obj-$(CONFIG_ADJ_CHAIN) += adj_chain/
+obj-$(CONFIG_CRPL) += crpl/
+obj-$(CONFIG_DEFRAG_HELPER) += defrag/
+obj-$(CONFIG_OPCHAIN) += opchain/
+obj-$(CONFIG_HOUSTON) += houston/
+obj-$(CONFIG_MEMPLUS) += memplus/
+obj-$(CONFIG_FSC) += fsc/
diff --git a/drivers/oneplus/coretech/adj_chain/Makefile b/drivers/oneplus/coretech/adj_chain/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..8360bc80ce0069e5bc593a035c9557f7c176aae0
--- /dev/null
+++ b/drivers/oneplus/coretech/adj_chain/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_ADJ_CHAIN) += adj_chain.o
diff --git a/drivers/oneplus/coretech/adj_chain/adj_chain.c b/drivers/oneplus/coretech/adj_chain/adj_chain.c
new file mode 100644
index 0000000000000000000000000000000000000000..ed84b37858b802627822b27b9ae57a8a24bb2fa5
--- /dev/null
+++ b/drivers/oneplus/coretech/adj_chain/adj_chain.c
@@ -0,0 +1,87 @@
+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
+
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/adj_chain.h>
+
+struct list_head adj_chain[ADJ_CHAIN_MAX + 1];
+EXPORT_SYMBOL(adj_chain);
+
+int adj_chain_ready = 0;
+EXPORT_SYMBOL(adj_chain_ready);
+
+int adj_chain_hist_high = 0;
+EXPORT_SYMBOL(adj_chain_hist_high);
+
+static void __adj_chain_detach(struct task_struct *p)
+{
+	p->adj_chain_status |= 1 << AC_DETACH;
+	list_del_rcu(&p->adj_chain_tasks);
+	p->adj_chain_status &= ~(1 << AC_DETACH);
+}
+
+static void __adj_chain_attach(struct task_struct *p)
+{
+	p->adj_chain_status |= 1 << AC_ATTACH;
+	list_add_tail_rcu(&p->adj_chain_tasks, &adj_chain[__adjc(get_oom_score_adj(p))]);
+	p->adj_chain_status &= ~(1 << AC_ATTACH);
+	if (__adjc(get_oom_score_adj(p)) > adj_chain_hist_high)
+		adj_chain_hist_high = __adjc(get_oom_score_adj(p));
+}
+
+void adj_chain_update_oom_score_adj(struct task_struct *p)
+{
+	if (likely(adj_chain_ready)) {
+		/* sync with system task_list */
+		write_lock_irq(&tasklist_lock);
+		spin_lock(&current->sighand->siglock);
+		if (!thread_group_leader(p)) {
+			pr_warn("%s '%d' not update from group leader: %s '%d', leader: %s '%d'\n",
+				current->comm, current->pid,
+				p->comm, p->pid, p->group_leader->comm, p->group_leader->pid);
+			p = p->group_leader;
+		}
+		if (unlikely(p->flags & PF_EXITING))
+			goto done;
+		p->adj_chain_status |= 1 << AC_UPDATE_ADJ;
+		__adj_chain_detach(p);
+		__adj_chain_attach(p);
+		p->adj_chain_status &= ~(1 << AC_UPDATE_ADJ);
+done:
+		spin_unlock(&current->sighand->siglock);
+		write_unlock_irq(&tasklist_lock);
+	}
+}
+EXPORT_SYMBOL(adj_chain_update_oom_score_adj);
+
+void adj_chain_attach(struct task_struct *p)
+{
+	if (likely(adj_chain_ready)) {
+		__adj_chain_attach(p);
+	}
+}
+EXPORT_SYMBOL(adj_chain_attach);
+
+void adj_chain_detach(struct task_struct *p)
+{
+	if (likely(adj_chain_ready)) {
+		__adj_chain_detach(p);
+	}
+}
+EXPORT_SYMBOL(adj_chain_detach);
+
+static int init_adj_chain(void)
+{
+	int i = 0;
+
+	for (i = 0; i <= ADJ_CHAIN_MAX; ++i) {
+		INIT_LIST_HEAD(&adj_chain[i]);
+	}
+	pr_info("adj_chain init completed\n");
+	adj_chain_ready = 1;
+	return 0;
+}
+
+pure_initcall(init_adj_chain);
+MODULE_DESCRIPTION("Oneplus adj chain");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/oneplus/coretech/coretech_helper.c b/drivers/oneplus/coretech/coretech_helper.c
new file mode 100644
index 0000000000000000000000000000000000000000..7c78c2251d68d49f8aedf35ba73c4f1e0e7874d0
--- /dev/null
+++ b/drivers/oneplus/coretech/coretech_helper.c
@@ -0,0 +1,22 @@
+/*
+ * Copyright (c) 2011-2013,2015 The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+
+
+#include <linux/ktime.h>
+
+s64 ctech_get_time(void)
+{
+	return ktime_to_ms(ktime_get());
+}
+EXPORT_SYMBOL(ctech_get_time);
diff --git a/drivers/oneplus/coretech/coretech_helper.h b/drivers/oneplus/coretech/coretech_helper.h
new file mode 100644
index 0000000000000000000000000000000000000000..3bbeb78aed50912fe12a06b2b4a699f8237604fd
--- /dev/null
+++ b/drivers/oneplus/coretech/coretech_helper.h
@@ -0,0 +1,6 @@
+#ifndef _LINUX_CORETECH_HELPER_H
+#define _LINUX_CORETECH_HELPER_H
+
+extern s64 ctech_get_time(void);
+
+#endif
diff --git a/drivers/oneplus/coretech/defrag/Kconfig b/drivers/oneplus/coretech/defrag/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..66f762ea14e6b55a6d07326a4c522c7c8fd2f061
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/Kconfig
@@ -0,0 +1,3 @@
+config DEFRAG
+	default y
+	bool "Oneplus CoreTech helper, used for defrag module"
diff --git a/drivers/oneplus/coretech/defrag/Makefile b/drivers/oneplus/coretech/defrag/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..a70dfbf7412ae6984e422a178a9924d85cfd7c46
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/Makefile
@@ -0,0 +1,3 @@
+obj-$(CONFIG_DEFRAG_HELPER) += defrag_helper.o op_struct_offset_helper.o
+obj-$(CONFIG_DEFRAG_HELPER) += defrag.o
+defrag-objs := defrag_core.o defrag_proxy.o
diff --git a/drivers/oneplus/coretech/defrag/defrag.h b/drivers/oneplus/coretech/defrag/defrag.h
new file mode 100644
index 0000000000000000000000000000000000000000..f8c333aa9e0c3d49ed7aac222db1ee4aa6474ffa
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/defrag.h
@@ -0,0 +1,43 @@
+/*
+ * Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above
+ *       copyright notice, this list of conditions and the following
+ *       disclaimer in the documentation and/or other materials provided
+ *       with the distribution.
+ *     * Neither the name of The Linux Foundation nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#ifndef _LINUX_MODULE_DEFRAG_H
+#define _LINUX_MODULE_DEFRAG_H
+
+#include <linux/compiler.h>
+#include <linux/module.h>
+#include "defrag_helper.h"
+#include "op_struct_offset_helper.h"
+
+void __mod_zone_page_state(struct zone *, enum zone_stat_item item, long);
+bool check_alloc_type(int migratetype, int order);
+bool check_alloc_flag(int alloc_flag, int order);
+int request_reserved_block(void);
+
+#endif /* _LINUX_MODULE_DEFRAG_H */
diff --git a/drivers/oneplus/coretech/defrag/defrag_core.o_shipped b/drivers/oneplus/coretech/defrag/defrag_core.o_shipped
new file mode 100644
index 0000000000000000000000000000000000000000..4b527fb29aa1fa8094cdc60ffd6609147887e23e
Binary files /dev/null and b/drivers/oneplus/coretech/defrag/defrag_core.o_shipped differ
diff --git a/drivers/oneplus/coretech/defrag/defrag_helper.c b/drivers/oneplus/coretech/defrag/defrag_helper.c
new file mode 100644
index 0000000000000000000000000000000000000000..fa99b188b443c4547a30d88120fbdeaefb781b69
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/defrag_helper.c
@@ -0,0 +1,224 @@
+/*
+ * Copyright (c) 2014, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/types.h>
+#include <asm/pgtable.h>
+#include <linux/mmzone.h>
+#include <linux/page-isolation.h>
+#include <linux/atomic.h>
+#include <linux/moduleparam.h>
+#include <linux/module.h>
+#include "defrag_helper.h"
+
+atomic64_t fp_order_usage[MAX_ORDER] = {ATOMIC64_INIT(0)};
+atomic64_t fp_order_fail[MAX_ORDER] = {ATOMIC64_INIT(0)};
+struct page *(*ctech_defrag_alloc_t)(struct zone *zone, unsigned long flags,
+			int migratetype, int order) = NULL;
+long (*ctech_defrag_calc_t)(struct zone *zone, int order,
+			int alloc_flag) = NULL;
+bool (*ctech_check_alloc_flag_t)(int alloc_flag, int order) = NULL;
+void __mod_zone_page_state(struct zone *, enum zone_stat_item item, long);
+
+
+/* calling functions */
+bool ctech_check_alloc_flag(int alloc_flag, int order)
+{
+	if (ctech_check_alloc_flag_t)
+		return ctech_check_alloc_flag_t(alloc_flag, order);
+	return false;
+}
+struct page *ctech_defrag_alloc(struct zone *zone, unsigned long flags,
+			int migratetype, int order)
+{
+	if (ctech_defrag_alloc_t)
+		return ctech_defrag_alloc_t(zone, flags, migratetype, order);
+	return 0;
+}
+
+long ctech_defrag_calc(struct zone *zone, int order, int alloc_flag)
+{
+	if (likely(ctech_defrag_calc_t))
+		return ctech_defrag_calc_t(zone, order, alloc_flag);
+	else
+		return ctech_zone_page_state(zone, NR_FREE_DEFRAG_POOL);
+}
+
+/* register functions */
+void ctech_check_alloc_flag_reg(bool (*fn)(int alloc_flag, int order))
+{
+	ctech_check_alloc_flag_t = fn;
+}
+EXPORT_SYMBOL(ctech_check_alloc_flag_reg);
+
+void ctech_defrag_alloc_reg(struct page *(*fn)(struct zone *zone,
+			unsigned long flags, int migratetype, int order))
+{
+	ctech_defrag_alloc_t = fn;
+}
+EXPORT_SYMBOL(ctech_defrag_alloc_reg);
+
+void ctech_defrag_calc_reg(long (*fn)(struct zone *zone,
+			int order, int alloc_flag))
+{
+	ctech_defrag_calc_t = fn;
+}
+EXPORT_SYMBOL(ctech_defrag_calc_reg);
+
+struct zone *ctech_first_zone(void)
+{
+	return NODE_DATA(first_online_node)->node_zones;
+}
+EXPORT_SYMBOL(ctech_first_zone);
+
+struct zone *ctech_next_zone(struct zone *zone)
+{
+	return next_zone(zone);
+}
+EXPORT_SYMBOL(ctech_next_zone);
+
+void ctech_set_pageblock_migratetype(struct page *page, int migratetype)
+{
+	set_pageblock_migratetype(page, migratetype);
+}
+EXPORT_SYMBOL(ctech_set_pageblock_migratetype);
+
+unsigned long ctech_get_pageblock_migratetype(struct page *page)
+{
+	return get_pageblock_migratetype(page);
+}
+EXPORT_SYMBOL(ctech_get_pageblock_migratetype);
+
+int ctech_move_freepages_block(struct zone *zone, struct page *page,
+		int migratetype, int old_mt)
+{
+	return move_freepages_block(zone, page, migratetype, NULL, old_mt);
+}
+EXPORT_SYMBOL(ctech_move_freepages_block);
+
+unsigned long ctech_zone_page_state(struct zone *zone, enum zone_stat_item item)
+{
+	long x = atomic_long_read(&zone->vm_stat[item]);
+#ifdef CONFIG_SMP
+	if (x < 0)
+		x = 0;
+#endif
+	return x;
+}
+EXPORT_SYMBOL(ctech_zone_page_state);
+
+unsigned long ctech_zone_end_pfn(const struct zone *zone)
+{
+	return zone_end_pfn(zone);
+}
+EXPORT_SYMBOL(ctech_zone_end_pfn);
+
+int ctech_pfn_valid(unsigned long pfn)
+{
+	return pfn_valid(pfn);
+}
+EXPORT_SYMBOL(ctech_pfn_valid);
+
+struct page *ctech_pfn_to_page(unsigned long pfn)
+{
+	return pfn_to_page(pfn);
+}
+EXPORT_SYMBOL(ctech_pfn_to_page);
+
+static void release_migratetype(void)
+{
+	struct zone *zone;
+	unsigned long start_pfn, pfn, end_pfn;
+	unsigned long block_migratetype;
+	unsigned long flags;
+	struct page *page;
+	int counter, pages_moved;
+
+	for_each_zone(zone) {
+		spin_lock_irqsave(&zone->lock, flags);
+		start_pfn = zone->zone_start_pfn;
+		end_pfn = zone_end_pfn(zone);
+		start_pfn = roundup(start_pfn, pageblock_nr_pages);
+		counter = 0;
+
+		for (pfn = start_pfn; pfn < end_pfn;
+					pfn += pageblock_nr_pages) {
+			if (!pfn_valid(pfn))
+				continue;
+			page = pfn_to_page(pfn);
+			block_migratetype = get_pageblock_migratetype(page);
+			if (block_migratetype ==
+					MIGRATE_UNMOVABLE_DEFRAG_POOL){
+				set_pageblock_migratetype(page,
+						MIGRATE_MOVABLE);
+				pages_moved = move_freepages_block(zone, page,
+							MIGRATE_MOVABLE, NULL,
+					MIGRATE_UNMOVABLE_DEFRAG_POOL);
+				__mod_zone_page_state(zone,
+				NR_FREE_DEFRAG_POOL, -pages_moved);
+			}
+		}
+		spin_unlock_irqrestore(&zone->lock, flags);
+	}
+}
+
+unsigned int __read_mostly alloc_status = 1;
+
+static int alloc_status_show(char *buf, const struct kernel_param *kp)
+{
+	return snprintf(buf, PAGE_SIZE, "%u", alloc_status);
+}
+
+static int alloc_status_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+
+	if (sscanf(buf, "%u\n", &val) <= 0)
+		return -EINVAL;
+	if (!strncmp(buf, "1", 1))
+		alloc_status = val;
+	else
+		alloc_status = 0;
+	return 0;
+}
+
+static const struct kernel_param_ops param_ops_alloc_status = {
+	.get = alloc_status_show,
+	.set = alloc_status_store,
+};
+module_param_cb(alloc_status, &param_ops_alloc_status, NULL, 0644);
+
+unsigned int __read_mostly disable;
+
+static int disable_show(char *buf, const struct kernel_param *kp)
+{
+	return snprintf(buf, PAGE_SIZE, "%u", disable);
+}
+
+static int disable_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+
+	if (sscanf(buf, "%u\n", &val) <= 0)
+		return -EINVAL;
+	if (!strncmp(buf, "1", 1)) {
+		disable = val;
+		release_migratetype();
+	}
+	return 0;
+}
+
+static const struct kernel_param_ops param_ops_disable = {
+	.get = disable_show,
+	.set = disable_store,
+};
+module_param_cb(disable, &param_ops_disable, NULL, 0644);
diff --git a/drivers/oneplus/coretech/defrag/defrag_helper.h b/drivers/oneplus/coretech/defrag/defrag_helper.h
new file mode 100644
index 0000000000000000000000000000000000000000..f7207b9128ccd5fb277c539cb93ddab969b85c04
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/defrag_helper.h
@@ -0,0 +1,80 @@
+/*
+ * Copyright (c) 2014, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef _LINUX_DEFRAG_HELPER_H
+#define _LINUX_DEFRAG_HELPER_H
+#include <linux/seq_file.h>
+
+struct page *ctech_defrag_alloc(struct zone *zone, unsigned long flags,
+			int migratetype, int order);
+long ctech_defrag_calc(struct zone *zone, int order, int alloc_flag);
+
+bool ctech_check_alloc_flag(int alloc_flag, int order);
+
+void ctech_check_alloc_flag_reg(bool (*fn)(int alloc_flag, int order));
+
+void ctech_defrag_alloc_reg(struct page *(*fn)(struct zone *zone,
+			unsigned long flags, int migratetype, int order));
+void ctech_defrag_calc_reg(long (*fn)(struct zone *zone, int order,
+			int alloc_flag));
+struct pglist_data *ctech_first_online_pgdat(void);
+struct zone *ctech_first_zone(void);
+struct zone *ctech_next_zone(struct zone *zone);
+void ctech_set_pageblock_migratetype(struct page *page,
+			int migratetype);
+int ctech_move_freepages_block(struct zone *zone, struct page *page,
+			int migratetype, int old_mt);
+unsigned long ctech_get_pageblock_migratetype(struct page *page);
+struct page *ctech___rmqueue(struct zone *zone, unsigned int order,
+			int migratetype);
+unsigned long ctech_zone_page_state(struct zone *zone,
+			enum zone_stat_item item);
+unsigned long ctech_zone_end_pfn(const struct zone *zone);
+int ctech_pfn_valid(unsigned long pfn);
+struct page *ctech_pfn_to_page(unsigned long pfn);
+
+
+extern atomic64_t fp_order_usage[MAX_ORDER];
+extern atomic64_t fp_order_fail[MAX_ORDER];
+extern unsigned int alloc_status;
+
+static inline void fp_usage_add(int order)
+{
+	if (alloc_status)
+		atomic64_add(1, &fp_order_usage[order]);
+}
+static inline void fp_fail_add(int order)
+{
+	if (alloc_status)
+		atomic64_add(1, &fp_order_fail[order]);
+}
+
+
+static inline void print_fp_statistics(struct seq_file *m)
+{
+	int order;
+
+	if (!alloc_status)
+		return;
+	seq_printf(m, "fp_usage\t\t");
+	for (order = 0; order < MAX_ORDER; ++order)
+		seq_printf(m, "%6lu ", atomic64_read(&fp_order_usage[order]));
+	seq_putc(m, '\n');
+	seq_printf(m, "fp_fail \t\t");
+	for (order = 0; order < MAX_ORDER; ++order)
+		seq_printf(m, "%6lu ", atomic64_read(&fp_order_fail[order]));
+	seq_putc(m, '\n');
+}
+
+#endif
+
diff --git a/drivers/oneplus/coretech/defrag/defrag_proxy.c b/drivers/oneplus/coretech/defrag/defrag_proxy.c
new file mode 100644
index 0000000000000000000000000000000000000000..c72a0cdb15df0b279d38384cf11c59407e076f23
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/defrag_proxy.c
@@ -0,0 +1,146 @@
+/*
+ * Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above
+ *       copyright notice, this list of conditions and the following
+ *       disclaimer in the documentation and/or other materials provided
+ *       with the distribution.
+ *     * Neither the name of The Linux Foundation nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include "defrag.h"
+static bool defrag_check_flag(int alloc_flag, int order)
+{
+	return !check_alloc_flag(alloc_flag, order);
+}
+static struct page *defrag_pool_alloc(struct zone *zone, unsigned long flags,
+			int migratetype, int order)
+{
+	struct page *page = NULL;
+	static bool prev_empty;
+
+	/* if target zone has no space left for defrag, just skip it */
+	if (unlikely(prev_empty && ctech_zone_page_state(zone,
+					NR_FREE_DEFRAG_POOL) == 0))
+		return NULL;
+
+	if (check_alloc_type(migratetype, order)) {
+		spin_lock_irqsave(&zone->lock, flags);
+		page = ctech___rmqueue(zone, order,
+					MIGRATE_UNMOVABLE_DEFRAG_POOL);
+
+		if (page) {
+			spin_unlock(&zone->lock);
+			__mod_zone_page_state(zone, NR_FREE_PAGES,
+							-(1 << order));
+			__mod_zone_page_state(zone, NR_FREE_DEFRAG_POOL,
+							-(1 << order));
+			local_irq_restore(flags);
+		} else
+			spin_unlock_irqrestore(&zone->lock, flags);
+	}
+
+	if (unlikely(page == NULL))
+		prev_empty = true;
+
+	return page;
+}
+
+/* return pool size, if this allocation cannot use our pool */
+static long calculate_reserved_pool(struct zone *z, int order, int alloc_flag)
+{
+	if (check_alloc_flag(alloc_flag, order))
+		return ctech_zone_page_state(z, NR_FREE_DEFRAG_POOL);
+	else
+		return 0;
+}
+
+static void release_unused_area(int request)
+{
+	struct zone *zone;
+	unsigned long start_pfn, pfn, end_pfn;
+	unsigned long block_mt;
+	unsigned long flags;
+	struct page *page;
+	int counter, pages_moved;
+
+	if (request)
+		request = request_reserved_block();
+
+	/* for_each_zone(zone) { */
+	for (zone = ctech_first_zone(); zone; zone = ctech_next_zone(zone)) {
+		if (strstr(zone->name, "Movable") != NULL)
+			continue;
+		spin_lock_irqsave(&zone->lock, flags);
+		start_pfn = ZONE_ZSP_R(zone);
+		end_pfn = ctech_zone_end_pfn(zone);
+		start_pfn = roundup(start_pfn, pageblock_nr_pages);
+		counter = 0;
+
+		for (pfn = start_pfn; pfn < end_pfn;
+					pfn += pageblock_nr_pages) {
+			if (!ctech_pfn_valid(pfn))
+				continue;
+			page = ctech_pfn_to_page(pfn);
+			block_mt = ctech_get_pageblock_migratetype(page);
+			if (block_mt == MIGRATE_UNMOVABLE_DEFRAG_POOL) {
+				if (++counter <= request)
+					continue;
+				else {
+					ctech_set_pageblock_migratetype(page,
+							MIGRATE_MOVABLE);
+					pages_moved = ctech_move_freepages_block(zone,
+							page, MIGRATE_MOVABLE,
+						MIGRATE_UNMOVABLE_DEFRAG_POOL);
+					__mod_zone_page_state(zone,
+						NR_FREE_DEFRAG_POOL,
+							-pages_moved);
+				}
+			}
+		}
+		spin_unlock_irqrestore(&zone->lock, flags);
+	}
+}
+
+
+static int __init defrag_pool_init(void)
+{
+	release_unused_area(1);
+	ctech_defrag_alloc_reg(defrag_pool_alloc);
+	ctech_defrag_calc_reg(calculate_reserved_pool);
+	ctech_check_alloc_flag_reg(defrag_check_flag);
+	return 0;
+}
+
+static void __exit defrag_pool_exit(void)
+{
+	ctech_defrag_alloc_reg(NULL);
+	ctech_defrag_calc_reg(NULL);
+	ctech_check_alloc_flag_reg(NULL);
+	release_unused_area(0);
+}
+
+module_init(defrag_pool_init);
+module_exit(defrag_pool_exit);
+
+MODULE_DESCRIPTION("OnePlus Defragger");
+MODULE_LICENSE("GPL");
diff --git a/drivers/oneplus/coretech/defrag/op_struct_offset_helper.c b/drivers/oneplus/coretech/defrag/op_struct_offset_helper.c
new file mode 100644
index 0000000000000000000000000000000000000000..e857d402bb82f75a76100e41c67d3be6ab225204
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/op_struct_offset_helper.c
@@ -0,0 +1,32 @@
+/*
+ * Copyright (c) 2015, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/stddef.h>
+#include <linux/cpufreq.h>
+#include <linux/module.h>
+
+#include "op_struct_offset_helper.h"
+
+/* struct zone */
+unsigned int _zone_offset[__ZONE_OFFSET_MAX] = {
+	[ZONE_OFFSET_LOCK] = offsetof(struct zone, lock),
+	[ZONE_OFFSET_ZSP] = offsetof(struct zone, zone_start_pfn)
+};
+gen_type_offset_impl(zone);
+
+/* struct pglist_data */
+unsigned int _pglist_data_offset[__PGLIST_DATA_OFFSET_MAX] = {
+	[PGLIST_DATA_OFFSET_NODE_ZONES] = offsetof(struct pglist_data,
+								node_zones)
+};
+gen_type_offset_impl(pglist_data);
diff --git a/drivers/oneplus/coretech/defrag/op_struct_offset_helper.h b/drivers/oneplus/coretech/defrag/op_struct_offset_helper.h
new file mode 100644
index 0000000000000000000000000000000000000000..9680b5ce93d68639371661c25807c882df9c9a28
--- /dev/null
+++ b/drivers/oneplus/coretech/defrag/op_struct_offset_helper.h
@@ -0,0 +1,50 @@
+/*
+ * Copyright (c) 2015, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef _OP_STRUCT_OFFSET_HELPER_INC_
+#define _OP_STRUCT_OFFSET_HELPER_INC_
+
+/* define macro to extern function declaration */
+#define gen_type_offset(type) \
+	extern unsigned int get_##type##_offset(int m)
+
+/* define macro to create offset impl and export get offset/value symbol */
+#define gen_type_offset_impl(type) \
+	unsigned int get_##type##_offset(int m) \
+		{ return _##type##_offset[m]; } \
+	EXPORT_SYMBOL(get_##type##_offset)
+
+/* enum of struct zone */
+enum {
+	ZONE_OFFSET_LOCK,
+	ZONE_OFFSET_ZSP,
+
+	__ZONE_OFFSET_MAX
+};
+#define ZONE_LOCK_R(zone) ((spinlock_t *)((char *)zone \
+			+ get_zone_offset(ZONE_OFFSET_LOCK)))
+#define ZONE_ZSP_R(zone) (*(unsigned long *)((char *)zone \
+			+ get_zone_offset(ZONE_OFFSET_ZSP)))
+gen_type_offset(zone);
+
+/* enum of struct pglist_data */
+enum {
+	PGLIST_DATA_OFFSET_NODE_ZONES,
+
+	__PGLIST_DATA_OFFSET_MAX
+};
+#define PGLIST_DATA_NODE_ZONES_R(pglist_data) ((struct zone *) \
+			((char *)pglist_data + \
+			get_pglist_data_offset(PGLIST_DATA_OFFSET_NODE_ZONES)))
+gen_type_offset(pglist_data);
+#endif //_OP_STRUCT_OFFSET_HELPER_INC_
diff --git a/drivers/oneplus/coretech/fsc/Makefile b/drivers/oneplus/coretech/fsc/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..418f3edafa583dcd4bd50fce014daf37b6321ec6
--- /dev/null
+++ b/drivers/oneplus/coretech/fsc/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_FSC) += fsc.o
diff --git a/drivers/oneplus/coretech/fsc/fsc.c b/drivers/oneplus/coretech/fsc/fsc.c
new file mode 100644
index 0000000000000000000000000000000000000000..1aa272a2c22a17b59d8b53fa20de3d8e3e1a3127
--- /dev/null
+++ b/drivers/oneplus/coretech/fsc/fsc.c
@@ -0,0 +1,860 @@
+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
+
+#include <linux/init.h>
+#include <linux/kthread.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+#include <linux/list.h>
+#include <linux/jiffies.h>
+#include <linux/slab.h>
+#include <linux/stringhash.h>
+#include <linux/fs.h>
+#include <linux/mutex.h>
+
+#include <linux/fsc.h>
+
+struct file_status_cache {
+	char path[FSC_PATH_MAX];
+	atomic_t refcnt;
+	u64 last_scan_ts;
+	u64 last_ref_ts;
+	u64 first_ref_ts;
+	u32 hidx;
+	struct list_head node;
+	int allow_idx; /* allow list index */
+	atomic_t d_cnt; /* direct return cnt */
+	u32 d_ret_ceil;
+};
+
+/* hashing algorithm */
+struct fsc_hash {
+	struct list_head head;
+	atomic_t cnt;
+	spinlock_t lock;
+} fsc_htbl[FSC_HASH_BUCKET];
+
+unsigned int fsc_enable = 0;
+static bool fsc_ready = false;
+static bool fsc_details = false;
+module_param_named(details, fsc_details, bool, 0644);
+static u32 fsc_d_ret = 128;
+module_param_named(d_ret, fsc_d_ret, uint, 0644);
+
+/* Set a ceil for fsc obj allocation */
+unsigned int fsc_max_val = 100000;
+module_param_named(fsc_max_val, fsc_max_val, uint, 0644);
+static atomic_t fsc_cur_used;
+
+/*
+ * Allowed list
+ * trailing character should not contain '/'
+ * Interface for add/ del allow listi
+ */
+#define FSC_ALLOW_LIST_SIZE (32)
+
+struct allow_obj {
+	char *path;
+	int idx;
+	size_t len;
+};
+
+/* leave the last one always empty */
+static struct allow_obj fsc_allow_list[FSC_ALLOW_LIST_SIZE + 1];
+static int allow_idx_map[FSC_ALLOW_LIST_SIZE];
+static atomic_t fsc_allow_list_cnt[FSC_ALLOW_LIST_SIZE];
+int fsc_allow_list_cur;
+
+static inline int get_empty_allow_idx(void) {
+	int i = 0;
+	for (; i < FSC_ALLOW_LIST_SIZE; ++i) {
+		if (!allow_idx_map[i]) {
+			allow_idx_map[i] = 1;
+			return i;
+		}
+	}
+	return -1;
+}
+
+/* To reclaim `out of date` fsc object */
+struct fsc_reclaimer {
+	struct list_head head;
+	atomic_t cnt;
+	struct task_struct *tsk;
+	unsigned long period;
+	unsigned int thres;
+	char path[FSC_PATH_MAX];
+} period, instcln;
+
+void fsc_spin_lock(u32 hidx)
+{
+	spin_lock(&fsc_htbl[hidx].lock);
+}
+
+void fsc_spin_unlock(u32 hidx)
+{
+	spin_unlock(&fsc_htbl[hidx].lock);
+}
+
+/* dcache helper to get absolute path */
+char *fsc_absolute_path(struct path* path, struct dentry* dentry, char *buf, size_t buflen)
+{
+	char localbuf[FSC_PATH_MAX] = {0};
+	char *abspath = NULL;
+	size_t rlen, dlen;
+
+	if (!path || !dentry || dentry->d_name.name[0] == '\0')
+		return NULL;
+
+	abspath = d_absolute_path((const struct path*) path, localbuf, FSC_PATH_MAX);
+	if (IS_ERR(abspath))
+		return NULL;
+	rlen = strlen(abspath);
+	dlen = strlen(dentry->d_name.name);
+	if (rlen + dlen + 2 > buflen)
+		return NULL;
+	memcpy(buf, abspath, rlen);
+	buf[rlen] = '/';
+	memcpy(buf + rlen + 1, dentry->d_name.name, dlen);
+	buf[rlen + 1 + dlen] = '\0';
+
+	pr_debug("%s get %s\n", __func__, buf);
+	return buf;
+}
+
+/* Using kernel string hash algo to get hash value, and mod to fit bucket */
+unsigned int fsc_get_hidx(const char* path, size_t len)
+{
+	u32 hidx = full_name_hash(NULL, path, len) % FSC_HASH_BUCKET;
+	pr_debug("%s hashing str: %s to %u\n", __func__, path, hidx);
+	return hidx;
+}
+
+/* Allock fsc object with initialed value */
+static struct file_status_cache* fsc_alloc(const char* path, size_t len, u32 hidx, int allow_idx)
+{
+	struct file_status_cache* obj;
+	unsigned int cur_used = atomic_read(&fsc_cur_used);
+
+	if (cur_used >= fsc_max_val) {
+		pr_debug("%s reach alloc max %u\n", __func__, cur_used);
+		return NULL;
+	}
+
+	obj = kzalloc(sizeof(struct file_status_cache), GFP_NOWAIT);
+	if (!obj) {
+		pr_warn("%s create failed\n", __func__);
+		return NULL;
+	}
+
+	/* init */
+	strncpy(obj->path, path, len);
+	obj->path[len] = '\0';
+	atomic_set(&obj->refcnt, 1);
+	obj->last_scan_ts = 0;
+	obj->first_ref_ts = jiffies;
+	obj->last_ref_ts = jiffies;
+	obj->hidx = hidx;
+	obj->d_ret_ceil = 1;
+	obj->allow_idx = allow_idx;
+	atomic_set(&obj->d_cnt, obj->d_ret_ceil);
+	atomic_inc(&fsc_allow_list_cnt[obj->allow_idx]);
+	/* For some apps, it will catch too much during installing stage, remove those records */
+	if (likely(instcln.tsk) &&
+		atomic_read(&fsc_allow_list_cnt[obj->allow_idx]) >= instcln.thres) {
+		wake_up_process(instcln.tsk);
+	}
+	pr_debug("%s: %s %lu %p\n", __func__, obj->path, strlen(obj->path), obj);
+	atomic_inc(&fsc_cur_used);
+	return obj;
+}
+
+/* Free it */
+static void fsc_free(struct file_status_cache* obj)
+{
+	pr_debug("%s: %p\n", __func__, obj);
+	if (obj) {
+		atomic_dec(&fsc_cur_used);
+		atomic_dec(&fsc_allow_list_cnt[obj->allow_idx]);
+		kfree(obj);
+	}
+}
+
+static int fsc_allow_list_add_store(const char *buf, const struct kernel_param *kp)
+{
+	size_t len = strlen(buf);
+	int i = 0, allow_idx = -1;
+	char *path;
+
+	if (!len)
+		return 0;
+
+	if (fsc_allow_list_cur >= FSC_ALLOW_LIST_SIZE) {
+		pr_warn("allow list add failed due to reach list limitation\n");
+		return -EINVAL;
+	}
+
+	path = kzalloc(len + 1, GFP_KERNEL);
+	if (!path) {
+		pr_err("memory allocation failed\n");
+		return -EINVAL;
+	}
+
+	if (sscanf(buf, "%s", path) <= 0) {
+		kfree(path);
+		return -EINVAL;
+	}
+
+	len = strlen(path);
+	for (i = 0; i < fsc_allow_list_cur && i < FSC_ALLOW_LIST_SIZE; ++i) {
+		/* to avoid add duplicate list */
+		if (strlen(fsc_allow_list[i].path) == len && !strncmp(fsc_allow_list[i].path, path, len)) {
+			kfree(path);
+			return 0;
+		}
+	}
+	allow_idx = get_empty_allow_idx();
+	if (allow_idx == -1) {
+		pr_err("Can't get allow idx\n");
+		kfree(path);
+		return 0;
+	}
+	fsc_allow_list[fsc_allow_list_cur].path = path;
+	fsc_allow_list[fsc_allow_list_cur].idx = allow_idx;
+	fsc_allow_list[fsc_allow_list_cur].len = len;
+	++fsc_allow_list_cur;
+
+	return 0;
+}
+
+static struct kernel_param_ops fsc_allow_list_add_ops = {
+	.set = fsc_allow_list_add_store,
+};
+module_param_cb(allow_list_add, &fsc_allow_list_add_ops, NULL, 0220);
+
+static int fsc_allow_list_del_store(const char *buf, const struct kernel_param *kp)
+{
+	size_t len = strlen(buf);
+	char *path;
+	int i = 0, allow_idx;
+
+	if (!len)
+		return 0;
+
+	path = kzalloc(len + 1, GFP_KERNEL);
+	if (!path) {
+		pr_err("memory allocation failed\n");
+		return -EINVAL;
+	}
+
+	if (sscanf(buf, "%s", path) <= 0) {
+		kfree(path);
+		return -EINVAL;
+	}
+
+	len = strlen(path);
+	for (i = 0; i < fsc_allow_list_cur && i < FSC_ALLOW_LIST_SIZE; ++i) {
+		if (strlen(fsc_allow_list[i].path) == len && !strncmp(fsc_allow_list[i].path, path, len)) {
+			kfree(path);
+			path = fsc_allow_list[i].path;
+			allow_idx = fsc_allow_list[i].idx;
+			memset(instcln.path, '\0', FSC_PATH_MAX);
+			strncpy(instcln.path, path, len);
+
+			for (; i < fsc_allow_list_cur && i < FSC_ALLOW_LIST_SIZE; ++i) {
+				fsc_allow_list[i].path = fsc_allow_list[i + 1].path;
+				fsc_allow_list[i].idx = fsc_allow_list[i + 1].idx;
+				fsc_allow_list[i].len = fsc_allow_list[i + 1].len;
+			}
+			--fsc_allow_list_cur;
+
+			/* release obj */
+			wake_up_process(instcln.tsk);
+			allow_idx_map[allow_idx] = 0;
+			break;
+		}
+	}
+	kfree(path);
+	return 0;
+}
+
+static struct kernel_param_ops fsc_allow_list_del_ops = {
+	.set = fsc_allow_list_del_store,
+};
+module_param_cb(allow_list_del, &fsc_allow_list_del_ops, NULL, 0220);
+
+static int fsc_dump_allow_list_show(struct seq_file *m, void *v)
+{
+	int i;
+
+	seq_printf(m, "fsc allow list: Total %u\n", fsc_allow_list_cur);
+	for (i = 0; i < fsc_allow_list_cur && i < FSC_ALLOW_LIST_SIZE; ++i)
+		seq_printf(m, "%s, cnt: %u\n", fsc_allow_list[i].path, atomic_read(&fsc_allow_list_cnt[fsc_allow_list[i].idx]));
+	return 0;
+}
+
+static int fsc_dump_allow_list_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, fsc_dump_allow_list_show, NULL);
+}
+
+static const struct file_operations fsc_dump_allow_list_fops = {
+	.open= fsc_dump_allow_list_open,
+	.read= seq_read,
+	.llseek= seq_lseek,
+	.release= single_release,
+};
+
+static bool fsc_path_allow(const char* path, size_t len, int *allow_idx)
+{
+	int i = 0;
+	size_t flen = 0;
+	size_t offset = 0;
+
+	/*
+	 * enhance for this most frequency case: user 0
+	 * /storage/emulated/0/Android/data/
+	 */
+#define FSC_ALLOW_COMMON_PREFIX "/storage/emulated/0/Android/data/"
+#define FSC_ALLOW_COMMON_PREFIX_LEN (33)
+	if (len < FSC_ALLOW_COMMON_PREFIX_LEN - 1) {
+		/* at least len >= /storage/emulated//Android/data/ */
+		return false;
+	}
+
+	if (strncmp(FSC_ALLOW_COMMON_PREFIX, path, FSC_ALLOW_COMMON_PREFIX_LEN))
+		goto fsc_slow_check;
+
+	/* fsc_fast_check only applied on user 0 */
+	offset = FSC_ALLOW_COMMON_PREFIX_LEN;
+	path += offset;
+	len -= offset;
+	for (i = 0; i < fsc_allow_list_cur && fsc_allow_list[i].path && i < FSC_ALLOW_LIST_SIZE; ++i) {
+		char *check_path = fsc_allow_list[i].path + offset;
+		flen = fsc_allow_list[i].len - offset;
+		if (len >= flen && !strncmp(path, check_path, flen)) {
+			*allow_idx = fsc_allow_list[i].idx;
+			return true;
+		}
+	}
+	return false;
+
+fsc_slow_check:
+	for (i = 0; i < fsc_allow_list_cur && fsc_allow_list[i].path && i < FSC_ALLOW_LIST_SIZE; ++i) {
+		flen = fsc_allow_list[i].len;
+		if (len >= flen && !strncmp(path, fsc_allow_list[i].path, flen)) {
+			*allow_idx = fsc_allow_list[i].idx;
+			return true;
+		}
+	}
+	return false;
+}
+
+/*
+ * To check if path already cached.
+ * Calling with lock & unlock
+ * Note:
+ *   if cached, then
+ *     inc refcnt
+ *     update ref timestamp
+ */
+bool fsc_is_absence_path_exist_locked(const char* path, size_t len, u32 hidx, bool d_check)
+{
+	struct file_status_cache* fsc = NULL;
+	int allow_idx = -1;
+
+	if (list_empty(&fsc_htbl[hidx].head))
+		return false;
+
+	if (!fsc_path_allow(path, len, &allow_idx))
+		return false;
+
+	list_for_each_entry(fsc, &fsc_htbl[hidx].head, node) {
+		if (strlen(fsc->path) == len && !strncmp(path, fsc->path, len)) {
+			/* update ref status */
+			fsc->last_ref_ts = jiffies;
+			atomic_inc(&fsc->refcnt);
+			/* direct return check */
+			pr_debug("%s %s exits in bucket %u, d_check: %u, called from %pS\n",
+				__func__, path, hidx, d_check, __builtin_return_address(0));
+			if (d_check) {
+				/* if d_cnt == 0, do real check; otherwise directly return */
+				if (atomic_dec_and_test(&fsc->d_cnt)) {
+					/* set next d_cnt by shift d_ret_ceil 1 */
+					if (fsc->d_ret_ceil < fsc_d_ret)
+						fsc->d_ret_ceil <<= 1;
+					/* set direct return ceil */
+					atomic_set(&fsc->d_cnt, fsc->d_ret_ceil);
+					return false;
+				}
+			}
+			return true;
+		}
+	}
+	return false;
+}
+
+/* To check if path is good to apply fsc */
+bool fsc_path_check(struct filename *name, size_t *len)
+{
+	const char *sc;
+
+	if (name->name[0] != '/')
+		return false;
+
+	for (sc = name->name; *sc != '\0'; ++sc) {
+		/* ignore // .. cases */
+		if (sc != name->name && *sc == *(sc - 1) && (*sc == '/' || *sc == '.'))
+			return false;
+		/* ignore /./ case */
+		else if (sc - name->name > 1 && *sc == '/' && *(sc - 1) == '.' && *(sc - 2) == '/')
+			return false;
+	}
+	*len = sc - name->name;
+	return name->name[*len - 1] != '/' && *len < FSC_PATH_MAX;
+}
+
+/*
+ * To check if path already cahced.
+ * Lock unlock inside
+ */
+bool fsc_absence_check(const char* path, size_t len)
+{
+	unsigned int hidx = 0;
+
+	hidx = fsc_get_hidx(path, len);
+	fsc_spin_lock(hidx);
+	if (fsc_is_absence_path_exist_locked(path, len, hidx, true)) {
+		fsc_spin_unlock(hidx);
+		return true;
+	}
+	fsc_spin_unlock(hidx);
+	return false;
+}
+
+/*
+ * To insert absence path to hash table
+ * Calling with lock & unlock
+ * Check if file alread cached before calling
+ */
+void fsc_insert_absence_path_locked(const char* path, size_t len, u32 hidx)
+{
+	struct file_status_cache* fsc;
+	int allow_idx = -1;
+
+	if (!fsc_path_allow(path, len, &allow_idx))
+		return;
+
+	if (fsc_is_absence_path_exist_locked(path, len, hidx, false))
+		return;
+
+	fsc = fsc_alloc(path, len, hidx, allow_idx);
+	if (!fsc)
+		return;
+
+	list_add(&fsc->node, &fsc_htbl[hidx].head);
+	atomic_inc(&fsc_htbl[hidx].cnt);
+	pr_debug("%s %s insert to bucket %u, called from %pS\n",
+			__func__, path, hidx, __builtin_return_address(0));
+}
+
+/*
+ * To delete absence path from hash table
+ * Calling with lock & unlock
+ */
+void fsc_delete_absence_path_locked(const char* path, size_t len, u32 hidx)
+{
+	struct file_status_cache* fsc;
+	int allow_idx = -1;
+
+	if (!fsc_path_allow(path, len, &allow_idx))
+		return;
+
+	/* remove fsc obj from hashing list */
+	list_for_each_entry(fsc, &fsc_htbl[hidx].head, node) {
+		if (strlen(fsc->path) == len && !strncmp(path, fsc->path, len)) {
+			atomic_dec(&fsc_htbl[hidx].cnt);
+			list_del(&fsc->node);
+			pr_debug("%s %s delete from bucket %u, called from %pS\n",
+				__func__, path, hidx, __builtin_return_address(0));
+			fsc_free(fsc);
+			return;
+		}
+	}
+}
+
+/*
+ * To delete absence path dentry from hash table
+ * Lock and unlock inside function
+ */
+void fsc_delete_absence_path_dentry(struct path* path, struct dentry* dentry)
+{
+	char buf[FSC_PATH_MAX] = {0};
+	char *abspath;
+
+	abspath = fsc_absolute_path(path, dentry, buf, FSC_PATH_MAX);
+
+	if (abspath) {
+		size_t len = strlen(abspath);
+		unsigned int hidx = fsc_get_hidx(abspath, len);
+		fsc_spin_lock(hidx);
+		fsc_delete_absence_path_locked(abspath, len, hidx);
+		fsc_spin_unlock(hidx);
+		pr_debug("%s %s delete from bucket %u, called from %pS\n",
+			__func__, abspath, hidx, __builtin_return_address(0));
+	}
+}
+
+/* summary */
+struct fsc_summary {
+	char path[FSC_PATH_MAX];
+	char package[FSC_PATH_MAX];
+	size_t len;
+	size_t plen;
+	u32 cnt;
+};
+
+static const char* prefix = "/storage/emulated/0/Android/data";
+static struct fsc_summary* summary[FSC_SUMMARY_MAX];
+static unsigned int summary_idx = 0;
+
+/* Debug for dump hash tabl */
+static unsigned int total_max;
+static unsigned int len_max;
+static int fsc_dump_htbl_proc_show(struct seq_file *m, void *v)
+{
+	int hidx;
+	unsigned int total = 0;
+	struct file_status_cache *fsc;
+	size_t len, prefix_len = strlen(prefix);
+	int i = 0;
+
+	for (hidx = 0; hidx < FSC_HASH_BUCKET; ++hidx) {
+		unsigned int cnt = 0;
+		fsc_spin_lock(hidx);
+		cnt = atomic_read(&fsc_htbl[hidx].cnt);
+		total += cnt;
+		if (!list_empty(&fsc_htbl[hidx].head)) {
+			if (fsc_details)
+				seq_printf(m, "hidx: %d, cnt: %d\n", hidx, cnt);
+			/* cached list */
+			list_for_each_entry(fsc, &fsc_htbl[hidx].head, node) {
+				len = strlen(fsc->path);
+				/* check if need summary */
+				if (len > prefix_len && !strncmp(prefix, fsc->path, prefix_len) && summary_idx < FSC_SUMMARY_MAX) {
+					char package[FSC_PATH_MAX] = {0};
+					char *token = NULL, *end = NULL;
+					memcpy(package, fsc->path, FSC_PATH_MAX);
+					end = package + prefix_len;
+					strsep(&end, "/");
+					token = end;
+					if (token) {
+						size_t plen;
+						bool need_alloc = true;
+						strsep(&end, "/");
+						if (end) {
+							plen = strlen(token);
+
+							/* check if need allocate summary object */
+							for (i = 0; i < summary_idx; ++i) {
+								if (plen == summary[i]->plen && !strncmp(token, summary[i]->package, plen)) {
+									need_alloc = false;
+									break;
+								}
+							}
+
+							if (need_alloc) {
+								summary[summary_idx] = kzalloc(sizeof(struct fsc_summary), GFP_NOWAIT);
+								if (summary[summary_idx]) {
+									memcpy(summary[summary_idx]->path, fsc->path, prefix_len + 1 + plen + 1);
+									memcpy(summary[summary_idx]->package, token, plen);
+									summary[summary_idx]->len = strlen(summary[summary_idx]->path);
+									summary[summary_idx]->plen = plen;
+									pr_debug("%s summary path: %s\n", __func__, summary[summary_idx]->path);
+									pr_debug("%s summary package: %s\n", __func__, summary[summary_idx]->package);
+									pr_debug("%s summary len: %lu, plen: %lu\n", __func__,
+											summary[summary_idx]->len, summary[summary_idx]->plen);
+									pr_debug("%s summary cnt: %u\n", __func__, summary[summary_idx]->cnt);
+									++summary_idx;
+								} else
+									pr_warn("%s summary alloc failed\n", __func__);
+							}
+						}
+
+						/* summary package information */
+						for (i = 0; i < summary_idx; ++i) {
+							if (len > summary[i]->len && !strncmp(fsc->path, summary[i]->path, summary[i]->len)) {
+								++summary[i]->cnt;
+								break;
+							}
+						}
+					}
+				}
+
+				if (len > len_max)
+					len_max = len;
+				if (fsc_details)
+					seq_printf(m, "  C:  %d %s %lu %llu %llu %u %u %d\n",
+						atomic_read(&fsc->refcnt), fsc->path, strlen(fsc->path), fsc->first_ref_ts, fsc->last_ref_ts, fsc->d_ret_ceil, atomic_read(&fsc->d_cnt), fsc->allow_idx);
+			}
+		}
+		fsc_spin_unlock(hidx);
+	}
+	if (total > total_max)
+		total_max = total;
+	seq_printf(m, "Cache: %u, Used: %u, history max: %u, len: %u, current: %lu\n",
+		total, atomic_read(&fsc_cur_used), total_max, len_max, jiffies);
+
+	if (summary_idx) {
+		/* dump summary and reset summary */
+		seq_printf(m, "Summary:\n");
+		for (i = 0; i < summary_idx; ++i) {
+			seq_printf(m, "\t[%d]: package: %s, absence file records: %u\n", i, summary[i]->package, summary[i]->cnt);
+			if (summary[i])
+				kfree(summary[i]);
+		}
+		summary_idx = 0;
+	}
+	return 0;
+}
+
+static int fsc_dump_htbl_proc_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, fsc_dump_htbl_proc_show, NULL);
+}
+
+static const struct file_operations fsc_dump_htbl_fops = {
+	.open= fsc_dump_htbl_proc_open,
+	.read= seq_read,
+	.llseek= seq_lseek,
+	.release= single_release,
+};
+
+static int fsc_enable_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+	int hidx;
+
+	if (unlikely(!fsc_ready))
+		return 0;
+
+	if (sscanf(buf, "%u", &val) <= 0)
+		return -EINVAL;
+
+	fsc_enable = val;
+
+	if (fsc_enable)
+		return 0;
+
+	/* if turn off, flush table */
+	for (hidx = 0; hidx < FSC_HASH_BUCKET; ++hidx) {
+		fsc_spin_lock(hidx);
+		if (!list_empty(&fsc_htbl[hidx].head)) {
+			struct file_status_cache *fsc, *tmp;
+			list_for_each_entry_safe(fsc, tmp, &fsc_htbl[hidx].head, node) {
+				if (fsc) {
+					list_del(&fsc->node);
+					fsc_free(fsc);
+					atomic_dec(&fsc_htbl[hidx].cnt);
+				}
+			}
+		}
+		fsc_spin_unlock(hidx);
+	}
+	return 0;
+}
+
+static int fsc_enable_show(char *buf, const struct kernel_param *kp)
+{
+	return snprintf(buf, PAGE_SIZE, "%u", fsc_enable);
+}
+
+static struct kernel_param_ops fsc_enable_ops = {
+	.set = fsc_enable_store,
+	.get = fsc_enable_show,
+};
+module_param_cb(enable, &fsc_enable_ops, NULL, 0644);
+
+static int period_reclaim(void *arg)
+{
+	static unsigned int hidx = 0;
+	while (!kthread_should_stop()) {
+		int i = 0;
+
+		if (!fsc_enable) {
+			msleep(period.period);
+			continue;
+		}
+
+		for (i = 0; i < FSC_SCAN_BULK; ++i) {
+			hidx %= FSC_HASH_BUCKET;
+			fsc_spin_lock(hidx);
+			if (!list_empty(&fsc_htbl[hidx].head)) {
+				struct file_status_cache *fsc, *tmp;
+				list_for_each_entry_safe(fsc, tmp, &fsc_htbl[hidx].head, node) {
+					if (fsc) {
+						/* get rid of obj after 2 days (48 hours) passed */
+						int delta = (jiffies - fsc->last_ref_ts)/(HZ * 172800L);
+						if (delta) {
+							/* time to go home */
+							list_del(&fsc->node);
+							atomic_dec(&fsc_htbl[hidx].cnt);
+							list_add(&fsc->node, &period.head);
+							pr_debug("%s decay: %s out\n", __func__, fsc->path);
+						}
+					}
+				}
+			}
+			fsc_spin_unlock(hidx);
+			++hidx;
+		}
+
+		/* free them */
+		if (!list_empty(&period.head)) {
+			struct file_status_cache *fsc, *tmp;
+			list_for_each_entry_safe(fsc, tmp, &period.head, node) {
+				list_del(&fsc->node);
+				fsc_free(fsc);
+			}
+		}
+		msleep(period.period);
+	}
+	return 0;
+}
+
+/* scan for out of limit fsc object */
+static int instcln_reclaim(void* args)
+{
+	unsigned int i = 0;
+	char *uninst_pkg = (char *)args;
+	int uninst_len;
+	bool uninst_ing = false;
+	bool remove = false;
+	int target;
+
+	while (!kthread_should_stop()) {
+		/* always reset target before really reclaim */
+		target = -1;
+
+		if (!fsc_enable) {
+			usleep_range(instcln.period, instcln.period + 1000000);
+			continue;
+		}
+
+		/* step 1. find out which package is going to uninstall */
+		uninst_len = strlen(uninst_pkg);
+		if (unlikely(uninst_len)) {
+			uninst_ing = true;
+			goto redo;
+		}
+
+		/* step 2. find out which package over limit */
+		for (i = 0; target == -1 && i < fsc_allow_list_cur; ++i) {
+			if (atomic_read(&fsc_allow_list_cnt[fsc_allow_list[i].idx]) >= instcln.thres) {
+				target = i;
+				break;
+			}
+		}
+
+		if (target == -1)
+			goto done;
+
+redo:
+		/* step 3. reclaim objs */
+		for (i = 0; i < FSC_HASH_BUCKET; ++i) {
+			fsc_spin_lock(i);
+			/* drop target fsc object */
+			if (!list_empty(&fsc_htbl[i].head)) {
+				struct file_status_cache *fsc, *tmp;
+				list_for_each_entry_safe(fsc, tmp, &fsc_htbl[i].head, node) {
+					if (likely(fsc)) {
+						remove = false;
+						if (uninst_ing && !strncmp(fsc->path, uninst_pkg, uninst_len))
+							remove = true;
+						else if (!uninst_ing && fsc->allow_idx == target)
+							remove = true;
+						if (remove) {
+							list_del(&fsc->node);
+							atomic_dec(&fsc_htbl[i].cnt);
+							list_add(&fsc->node, &instcln.head);
+						}
+					}
+				}
+			}
+			fsc_spin_unlock(i);
+		}
+
+		if (!list_empty(&instcln.head)) {
+			struct file_status_cache *fsc, *tmp;
+			list_for_each_entry_safe(fsc, tmp, &instcln.head, node) {
+				list_del(&fsc->node);
+				fsc_free(fsc);
+			}
+		}
+
+		/* step 4. check if any uninstall event happened during reclaim period */
+		if (uninst_ing)
+			uninst_pkg[0] = '\0';
+		uninst_len = strlen(uninst_pkg);
+		if (unlikely(uninst_len)) {
+			uninst_ing = true;
+			goto redo;
+		}
+done:
+		uninst_ing = false;
+		usleep_range(instcln.period, instcln.period + 1000000);
+	}
+	return 0;
+}
+
+static int __init fsc_init(void)
+{
+	int i = 0;
+	pr_info("%s\n", __func__);
+
+	atomic_set(&fsc_cur_used, 0);
+	for (i = 0; i < FSC_HASH_BUCKET; ++i) {
+		INIT_LIST_HEAD(&fsc_htbl[i].head);
+		atomic_set(&fsc_htbl[i].cnt, 0);
+		spin_lock_init(&fsc_htbl[i].lock);
+	}
+
+	for (i = 0; i < FSC_ALLOW_LIST_SIZE; ++i)
+		atomic_set(&fsc_allow_list_cnt[i], 0);
+
+	/* init for period & instcln reclaimer */
+	INIT_LIST_HEAD(&period.head);
+	period.period = 1 * 60 * 60 * 1000; // 1 hour, ms
+	period.tsk = kthread_run(period_reclaim, NULL, "fsc_period_reclaimer");
+	if (!period.tsk) {
+		pr_err("%s: init period reclaimer failed\n", __func__);
+		return 0;
+	}
+
+	INIT_LIST_HEAD(&instcln.head);
+	instcln.period = 1L * 60L * 60L * 1000L * 1000L; // 1 hour, us
+	instcln.thres = 10000; // per package should not cache more than this thres.
+	instcln.path[0] = '\0';;
+	instcln.tsk = kthread_run(instcln_reclaim, instcln.path, "fsc_instcln_reclaimer");
+	if (!instcln.tsk) {
+		pr_err("%s: init instcln reclaimer failed\n", __func__);
+		kthread_stop(period.tsk);
+		return 0;
+	}
+
+	/* info */
+	proc_create("fsc_dump", S_IFREG | 0400, NULL, &fsc_dump_htbl_fops);
+	proc_create("fsc_allow_list", S_IFREG | 0400, NULL, &fsc_dump_allow_list_fops);
+
+	pr_info("%s done\n", __func__);
+
+	fsc_ready = true;
+	return 0;
+}
+pure_initcall(fsc_init);
+
+MODULE_AUTHOR("tedlin");
+MODULE_DESCRIPTION("Oneplus File Status Cache");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/oneplus/coretech/fsc/test/Android.mk b/drivers/oneplus/coretech/fsc/test/Android.mk
new file mode 100644
index 0000000000000000000000000000000000000000..91e2835a8ebd5356bf936ea63d48564f2d31c571
--- /dev/null
+++ b/drivers/oneplus/coretech/fsc/test/Android.mk
@@ -0,0 +1,9 @@
+LOCAL_PATH:= $(call my-dir)
+
+include $(CLEAR_VARS)
+LOCAL_MODULE := fsc-unit-tests
+LOCAL_MODULE_TAGS := tests
+LOCAL_CFLAGS = -Wall -Wextra -Werror
+LOCAL_SHARED_LIBRARIES := libcutils libbase
+LOCAL_SRC_FILES := fsc_test.cpp
+include $(BUILD_NATIVE_TEST)
diff --git a/drivers/oneplus/coretech/fsc/test/fsc_test.cpp b/drivers/oneplus/coretech/fsc/test/fsc_test.cpp
new file mode 100644
index 0000000000000000000000000000000000000000..b127799cb3f7019bbfa3dc817d00f846d292aa29
--- /dev/null
+++ b/drivers/oneplus/coretech/fsc/test/fsc_test.cpp
@@ -0,0 +1,221 @@
+#include <ctype.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <unistd.h>
+#include <fstream>
+#include <string>
+#include <pthread.h>
+
+#include <android-base/file.h>
+#include <android-base/macros.h>
+#include <android-base/stringprintf.h>
+#include <gtest/gtest.h>
+
+#define TARGET_ALLOW_LIST "/data/local/tmp"
+#define FSC_ENABLE "/sys/module/fsc/parameters/enable"
+#define ADD_ALLOW_LIST_ENTRY "/sys/module/fsc/parameters/allow_list_add"
+#define DEL_ALLOW_LIST_ENTRY "/sys/module/fsc/parameters/allow_list_del"
+#define ALLOW_LIST_DUMP "/proc/fsc_allow_list"
+
+#define EMPTY_FILE "/data/local/tmp/fsc_test_file"
+#define EMPTY_FILE_ALIAS_0 "/data/local/tmp/fsc_test_file"
+#define EMPTY_FILE_ALIAS_1 "fsc_test_file"
+#define EMPTY_FILE_ALIAS_2 "./fsc_test_file"
+#define EMPTY_FILE_ALIAS_3 "../tmp/./././fsc_test_file"
+#define EMPTY_FILE_ALIAS_4 ".././././//./tmp/fsc_test_file"
+#define EMPTY_FILE_ALIAS_5 ".././//tmp/././//./fsc_test_file"
+
+#define PREPARE_FILE "/data/local/tmp/fsc_prepare_file"
+
+
+static void fsc_test_init(void) {
+	/* reset fsc first */
+	android::base::WriteStringToFile("0", FSC_ENABLE);
+	android::base::WriteStringToFile("1", FSC_ENABLE);
+	android::base::WriteStringToFile(TARGET_ALLOW_LIST, ADD_ALLOW_LIST_ENTRY);
+}
+
+static void fsc_test_deinit(void) {
+	android::base::WriteStringToFile(TARGET_ALLOW_LIST, DEL_ALLOW_LIST_ENTRY);
+}
+
+static bool fsc_check_allow_list(void) {
+	std::ifstream infile(ALLOW_LIST_DUMP);
+	std::string path;
+	while (std::getline(infile, path)) {
+		int coma = path.find(",");
+		path = path.substr(0, coma);
+		if (path == TARGET_ALLOW_LIST)
+			return true;
+	}
+	return false;
+}
+
+static int fsc_check_file_exist(const char *name) {
+	struct stat sb;
+	return stat(name, &sb);
+}
+
+static int fsc_create_file(const char *name, int flags, mode_t mode) {
+	int fd = open(name, flags, mode);
+	if (fd) EXPECT_EQ(close(fd), 0);
+	return fd;
+}
+
+TEST(fsc, add_allow_list) {
+	int cnt = 1000;
+	while (--cnt) {
+		fsc_test_init();
+		ASSERT_TRUE(fsc_check_allow_list());
+		fsc_test_deinit();
+	}
+}
+
+/*
+ * testing coverage:
+ * open related
+ */
+#define GEN_TEST_OPEN_ALIAS(num) \
+TEST(fsc, open_alias_##num) { \
+	const char* target = EMPTY_FILE_ALIAS_##num; \
+	fsc_test_init(); \
+	ASSERT_TRUE(fsc_check_allow_list()); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), -1); \
+	EXPECT_GE(fsc_create_file(target, O_CREAT, S_IRUSR|S_IWUSR), 0); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(EMPTY_FILE), 0); \
+	fsc_test_deinit(); \
+}
+
+GEN_TEST_OPEN_ALIAS(0);
+GEN_TEST_OPEN_ALIAS(1);
+GEN_TEST_OPEN_ALIAS(2);
+GEN_TEST_OPEN_ALIAS(3);
+GEN_TEST_OPEN_ALIAS(4);
+GEN_TEST_OPEN_ALIAS(5);
+
+/*
+ * testing coverage:
+ * mv rename
+ */
+#define GEN_TEST_RENAME_ALIAS(num) \
+TEST(fsc, rename_alias_##num) { \
+	const char* from  = PREPARE_FILE; \
+	const char* to = EMPTY_FILE_ALIAS_##num; \
+	fsc_test_init(); \
+	ASSERT_TRUE(fsc_check_allow_list()); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), -1); \
+	EXPECT_GE(fsc_create_file(from, O_CREAT, S_IRUSR|S_IWUSR), 0); \
+	EXPECT_EQ(rename(from, to), 0); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(EMPTY_FILE), 0); \
+	fsc_test_deinit(); \
+}
+
+GEN_TEST_RENAME_ALIAS(0)
+GEN_TEST_RENAME_ALIAS(1)
+GEN_TEST_RENAME_ALIAS(2)
+GEN_TEST_RENAME_ALIAS(3)
+GEN_TEST_RENAME_ALIAS(4)
+GEN_TEST_RENAME_ALIAS(5)
+
+/*
+ * testing coverage:
+ * link symlink
+ */
+#define GEN_TEST_LINK_ALIAS(num) \
+TEST(fsc, link_##num) { \
+	const char* from  = PREPARE_FILE; \
+	const char* to = EMPTY_FILE_ALIAS_##num; \
+	fsc_test_init(); \
+	ASSERT_TRUE(fsc_check_allow_list()); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), -1); \
+	EXPECT_GE(fsc_create_file(from, O_CREAT, S_IRUSR|S_IWUSR), 0); \
+	EXPECT_EQ(link(from, to), 0); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(from), 0); \
+	fsc_test_deinit(); \
+}
+
+GEN_TEST_LINK_ALIAS(0)
+GEN_TEST_LINK_ALIAS(1)
+GEN_TEST_LINK_ALIAS(2)
+GEN_TEST_LINK_ALIAS(3)
+GEN_TEST_LINK_ALIAS(4)
+GEN_TEST_LINK_ALIAS(5)
+
+#define GEN_TEST_SYMLINK_ALIAS(num) \
+TEST(fsc, symlink_##num) { \
+	const char* from  = PREPARE_FILE; \
+	const char* to = EMPTY_FILE_ALIAS_##num; \
+	fsc_test_init(); \
+	ASSERT_TRUE(fsc_check_allow_list()); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), -1); \
+	EXPECT_GE(fsc_create_file(from, O_CREAT, S_IRUSR|S_IWUSR), 0); \
+	EXPECT_EQ(symlink(from, to), 0); \
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(EMPTY_FILE), 0); \
+	EXPECT_EQ(unlink(from), 0); \
+	fsc_test_deinit(); \
+}
+
+GEN_TEST_SYMLINK_ALIAS(0)
+GEN_TEST_SYMLINK_ALIAS(1)
+GEN_TEST_SYMLINK_ALIAS(2)
+GEN_TEST_SYMLINK_ALIAS(3)
+GEN_TEST_SYMLINK_ALIAS(4)
+GEN_TEST_SYMLINK_ALIAS(5)
+
+/*
+ * testing for race
+ */
+static void *thread_stat(void *arg __unused) {
+	struct stat sb;
+	while (stat(EMPTY_FILE, &sb));
+	return NULL;
+}
+
+static void *thread_open(void *arg __unused) {
+	int fd = -1;
+	fd = open(EMPTY_FILE, O_CREAT, 0644);
+	if (fd) close(fd);
+	return NULL;
+}
+
+#define TEST_ROUNDS (100000)
+#define THREAD_MAX (10)
+TEST(fsc, race) {
+	int ceil, i = 0;
+	int test = 0, test_ceil = TEST_ROUNDS;
+	pthread_t stat_tids[THREAD_MAX];
+	pthread_t open_tid;
+
+	fsc_test_init();
+	ASSERT_TRUE(fsc_check_allow_list());
+	EXPECT_EQ(fsc_check_file_exist(EMPTY_FILE), -1);
+
+	GTEST_LOG_(INFO) << "RACE TEST: this test will take around 3 minutes to complete.";
+	while (test++ != test_ceil) {
+		srand(time(NULL));
+		ceil = rand() % THREAD_MAX;
+
+		for (i = 0; i <= ceil; ++i)
+			pthread_create(&stat_tids[i], NULL, &thread_stat, NULL);
+
+		pthread_create(&open_tid, NULL, &thread_open, NULL);
+
+		for (i = 0; i <= ceil; ++i)
+			pthread_join(stat_tids[i], NULL);
+
+		pthread_join(open_tid, NULL);
+
+		EXPECT_EQ(unlink(EMPTY_FILE), 0);
+		//GTEST_LOG_(INFO) << "RACE TEST: (" << test << "/" << test_ceil << ") pass";
+	}
+	fsc_test_deinit();
+}
diff --git a/drivers/oneplus/coretech/fsc/test/prebuilt/arm/fsc-unit-tests b/drivers/oneplus/coretech/fsc/test/prebuilt/arm/fsc-unit-tests
new file mode 100755
index 0000000000000000000000000000000000000000..0277b94748b6c88d52a803285c322354a1036b6c
Binary files /dev/null and b/drivers/oneplus/coretech/fsc/test/prebuilt/arm/fsc-unit-tests differ
diff --git a/drivers/oneplus/coretech/fsc/test/prebuilt/arm64/fsc-unit-tests b/drivers/oneplus/coretech/fsc/test/prebuilt/arm64/fsc-unit-tests
new file mode 100755
index 0000000000000000000000000000000000000000..239bcdc57bafd069e035fff835bbf5ad680fe8e0
Binary files /dev/null and b/drivers/oneplus/coretech/fsc/test/prebuilt/arm64/fsc-unit-tests differ
diff --git a/drivers/oneplus/coretech/fsc/test/prebuilt/fsc-unit-tests.config b/drivers/oneplus/coretech/fsc/test/prebuilt/fsc-unit-tests.config
new file mode 100644
index 0000000000000000000000000000000000000000..32fd307dc39cb265a25a49e4ee816e65c4622062
--- /dev/null
+++ b/drivers/oneplus/coretech/fsc/test/prebuilt/fsc-unit-tests.config
@@ -0,0 +1,27 @@
+<?xml version="1.0" encoding="utf-8"?>
+<!-- Copyright (C) 2017 The Android Open Source Project
+
+     Licensed under the Apache License, Version 2.0 (the "License");
+     you may not use this file except in compliance with the License.
+     You may obtain a copy of the License at
+
+          http://www.apache.org/licenses/LICENSE-2.0
+
+     Unless required by applicable law or agreed to in writing, software
+     distributed under the License is distributed on an "AS IS" BASIS,
+     WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+     See the License for the specific language governing permissions and
+     limitations under the License.
+-->
+<!-- This test config file is auto-generated. -->
+<configuration description="Runs fsc-unit-tests.">
+    <target_preparer class="com.android.tradefed.targetprep.PushFilePreparer">
+        <option name="cleanup" value="true" />
+        <option name="push" value="fsc-unit-tests->/data/local/tmp/fsc-unit-tests" />
+    </target_preparer>
+
+    <test class="com.android.tradefed.testtype.GTest" >
+        <option name="native-test-device-path" value="/data/local/tmp" />
+        <option name="module-name" value="fsc-unit-tests" />
+    </test>
+</configuration>
diff --git a/drivers/oneplus/coretech/memplus/Makefile b/drivers/oneplus/coretech/memplus/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..e7703389041fe50c49d578715015dbdbf3eb356c
--- /dev/null
+++ b/drivers/oneplus/coretech/memplus/Makefile
@@ -0,0 +1 @@
+obj-y += memplus_core.o
diff --git a/drivers/oneplus/coretech/memplus/memplus_core.c b/drivers/oneplus/coretech/memplus/memplus_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..fc218e5492d6da01f8f742dd5b78302829b9c55c
--- /dev/null
+++ b/drivers/oneplus/coretech/memplus/memplus_core.c
@@ -0,0 +1,647 @@
+#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
+
+#include <linux/mm.h>
+#include <linux/module.h>
+#include <linux/gfp.h>
+#include <linux/kernel_stat.h>
+#include <linux/pagemap.h>
+#include <linux/init.h>
+#include <linux/highmem.h>
+#include <linux/vmpressure.h>
+#include <linux/vmstat.h>
+#include <linux/file.h>
+#include <linux/writeback.h>
+#include <linux/blkdev.h>
+#include <linux/mm_inline.h>
+#include <linux/backing-dev.h>
+#include <linux/rmap.h>
+#include <linux/topology.h>
+#include <linux/cpu.h>
+#include <linux/cpuset.h>
+#include <linux/compaction.h>
+#include <linux/notifier.h>
+#include <linux/rwsem.h>
+#include <linux/delay.h>
+#include <linux/kthread.h>
+#include <linux/freezer.h>
+#include <linux/memcontrol.h>
+#include <linux/delayacct.h>
+#include <linux/sysctl.h>
+#include <linux/oom.h>
+#include <linux/prefetch.h>
+#include <linux/printk.h>
+#include <linux/dax.h>
+
+#include <asm/tlbflush.h>
+#include <asm/div64.h>
+
+#include <linux/swapops.h>
+#include <linux/balloon_compaction.h>
+#include <linux/swap.h>
+#include <linux/sched/mm.h>
+#include <linux/page-flags.h>
+
+#define PF_NO_TAIL(page, enforce) ({					\
+		VM_BUG_ON_PGFLAGS(enforce && PageTail(page), page);	\
+		compound_head(page);})
+
+#define RD_SIZE 128
+#define DEBUG_TIME_INFO 0
+#define FEAT_RECLAIM_LIMIT 0
+
+struct mp_reclaim_param {
+	struct vm_area_struct *vma;
+	/* Number of pages scanned */
+	int nr_scanned;
+#if FEAT_RECLAIM_LIMIT
+	unsigned long start_jiffies;
+#endif
+	/* max pages to reclaim */
+	int nr_to_reclaim;
+	/* pages reclaimed */
+	int nr_reclaimed;
+	int type;
+};
+
+struct reclaim_data {
+	pid_t pid;
+	int prev_adj;
+};
+
+struct reclaim_info {
+	struct reclaim_data rd[RD_SIZE];
+	int i_idx;
+	int o_idx;
+	int count;
+};
+
+struct reclaim_info ri = { {{0}}, 0, 0, 0 };
+struct reclaim_info si = { {{0}}, 0, 0, 0 };
+static struct task_struct *reclaimd_tsk = NULL;
+static struct task_struct *swapind_tsk = NULL;
+static DEFINE_SPINLOCK(rd_lock);
+
+/* -1 = system free to use swap, 0 = disable retention, swap not available, 1 = enable retention */
+int vm_memory_plus __read_mostly = 0;
+int vm_memory_plus_test_worstcase __read_mostly = 0;
+int swapin_walk_pmd_entry(pmd_t *pmd, unsigned long start, unsigned long end, struct mm_walk *walk);
+unsigned long memplus_reclaim_pages(struct list_head *page_list, struct vm_area_struct *vma);
+unsigned long swapout_to_zram(struct list_head *page_list, struct vm_area_struct *vma);
+unsigned long swapout_to_disk(struct list_head *page_list, struct vm_area_struct *vma);
+extern bool enough_swap_size(unsigned long req_size, int swap_bdv);
+
+bool current_is_reclaimd() {
+	return current == reclaimd_tsk;
+}
+
+bool current_is_swapind() {
+	return current == swapind_tsk;
+}
+
+__always_inline void memplus_move_swapcache_to_anon_lru(struct page *page)
+{
+	struct zone *zone = page_zone(page);
+	unsigned long flag;
+
+	spin_lock_irqsave(zone_lru_lock(zone), flag);
+	if (PageLRU(page)) {
+		struct lruvec *lruvec;
+		enum lru_list lru, oldlru = page_lru(page);
+
+		clear_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+		lru = page_lru(page);
+		lruvec = mem_cgroup_page_lruvec(page, zone->zone_pgdat);
+		list_move(&page->lru, &lruvec->lists[lru]);
+#ifdef CONFIG_SMART_BOOST
+		update_lru_size(lruvec, oldlru, page_zonenum(page),
+				-hpage_nr_pages(page), PageUIDLRU(page) ? true:false);
+		update_lru_size(lruvec, lru, page_zonenum(page),
+				hpage_nr_pages(page), PageUIDLRU(page) ? true:false);
+#else
+		update_lru_size(lruvec, oldlru, page_zonenum(page), -hpage_nr_pages(page));
+		update_lru_size(lruvec, lru, page_zonenum(page), hpage_nr_pages(page));
+#endif
+	} else
+		clear_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+	spin_unlock_irqrestore(zone_lru_lock(zone), flag);
+}
+
+__always_inline void memplus_move_anon_to_swapcache_lru(struct page *page)
+{
+	struct zone *zone = page_zone(page);
+	unsigned long flag;
+
+	spin_lock_irqsave(zone_lru_lock(zone), flag);
+	if (likely(!PageLRU(page)))
+		set_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+	else {
+		struct lruvec *lruvec;
+		enum lru_list lru, oldlru = page_lru(page);
+
+		set_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+		lru = page_lru(page);
+		lruvec = mem_cgroup_page_lruvec(page, zone->zone_pgdat);
+		list_move(&page->lru, &lruvec->lists[lru]);
+#ifdef CONFIG_SMART_BOOST
+		update_lru_size(lruvec, oldlru, page_zonenum(page),
+				-hpage_nr_pages(page), PageUIDLRU(page) ? true:false);
+		update_lru_size(lruvec, lru, page_zonenum(page),
+				hpage_nr_pages(page), PageUIDLRU(page) ? true:false);
+#else
+		update_lru_size(lruvec, oldlru, page_zonenum(page), -hpage_nr_pages(page));
+		update_lru_size(lruvec, lru, page_zonenum(page), hpage_nr_pages(page));
+#endif
+	}
+	spin_unlock_irqrestore(zone_lru_lock(zone), flag);
+}
+
+
+static void enqueue_reclaim_data(pid_t nr, int prev_adj, struct reclaim_info *info)
+{
+	int idx;
+	struct task_struct *waken_task;
+
+	waken_task = (info == &ri? reclaimd_tsk : swapind_tsk);
+	if (!waken_task)
+		return;
+
+	spin_lock(&rd_lock);
+	if (info->count < RD_SIZE) {
+		info->count++;
+		idx = info->i_idx++ % RD_SIZE;
+		info->rd[idx].pid = nr;
+		info->rd[idx].prev_adj = prev_adj;
+	}
+	spin_unlock(&rd_lock);
+	BUG_ON(info->count > RD_SIZE || info->count < 0);
+
+	if (waken_task->state == TASK_INTERRUPTIBLE)
+		wake_up_process(waken_task);
+}
+
+bool memplus_enabled(void)
+{
+	return vm_memory_plus > 0 && total_swap_pages;
+}
+
+void memplus_state_check(int cur_adj, int prev_adj, struct task_struct* task)
+{
+	int uid = task_uid(task).val;
+
+	if (!memplus_enabled())
+		return;
+
+	if (task->signal->memplus_type == TYPE_SYS_IGNORE)
+		return;
+
+	if (task->signal->memplus_type == TYPE_WILL_NEED)
+		goto queue_swapin;
+
+	if (unlikely((prev_adj == -1) || (cur_adj == prev_adj)))
+		return;
+
+	if (uid < AID_APP) {
+		//trace_printk("QUIT-reclaim %s (pid %d) (adj %d -> %d) (uid %d)\n", task->comm, task->pid, prev_adj, cur_adj, uid);
+		return;
+	}
+
+	if (cur_adj >= 800 && time_after_eq(jiffies, task->signal->reclaim_timeout)) {
+		spin_lock(&task->signal->reclaim_state_lock);
+		/* reclaim should not kick-in within 2 secs */
+		task->signal->reclaim_timeout = jiffies + 2*HZ;
+
+		if (task->signal->swapin_should_readahead_m == RECLAIM_STANDBY) {
+			task->signal->swapin_should_readahead_m = RECLAIM_QUEUE;
+			//trace_printk("Q-reclaim %s (pid %d) (adj %d -> %d) (uid %d)\n", task->comm, task->pid, prev_adj, cur_adj, uid);
+			enqueue_reclaim_data(task->pid, prev_adj, &ri);
+		}
+		spin_unlock(&task->signal->reclaim_state_lock);
+	} else if (cur_adj == 0) {
+queue_swapin:
+		spin_lock(&task->signal->reclaim_state_lock);
+		/* swapin kicked in, don't reclaim within 2 secs */
+		task->signal->reclaim_timeout = jiffies + 2*HZ;
+
+		if (task->signal->swapin_should_readahead_m == RECLAIM_QUEUE) {
+			task->signal->swapin_should_readahead_m = RECLAIM_STANDBY;
+		} else if (task->signal->swapin_should_readahead_m == RECLAIM_DONE) {
+			task->signal->swapin_should_readahead_m = SWAPIN_QUEUE;
+			//trace_printk("Q-swapin %s (pid %d) (adj %d -> %d) (uid %d)\n", task->comm, task->pid, prev_adj, cur_adj, uid);
+			enqueue_reclaim_data(task->pid, prev_adj, &si);
+		}
+		spin_unlock(&task->signal->reclaim_state_lock);
+	}
+}
+
+static bool dequeue_reclaim_data(struct reclaim_data *data, struct reclaim_info *info)
+{
+	int idx;
+	bool has_data = false;
+
+	spin_lock(&rd_lock);
+	if (info->count > 0) {
+		has_data = true;
+		info->count--;
+		idx = info->o_idx++ % RD_SIZE;
+		*data = info->rd[idx];
+	}
+	spin_unlock(&rd_lock);
+	BUG_ON(info->count > RD_SIZE || info->count < 0);
+
+	return has_data;
+}
+
+static ssize_t swapin_anon(struct task_struct *task, int prev_adj)
+{
+	struct mm_struct *mm;
+	struct vm_area_struct *vma;
+	struct mm_walk walk = {};
+	int task_anon = 0, task_swap = 0, err = 0;
+	//u64 time_ns = 0;
+#if DEBUG_TIME_INFO
+	struct timespec ts1, ts2;
+	getnstimeofday(&ts1);
+#endif
+
+retry:
+	/* TODO: do we need to use p = find_lock_task_mm(tsk); in case main thread got killed */
+	mm = get_task_mm(task);
+	if (!mm)
+		goto out;
+
+	task_anon = get_mm_counter(mm, MM_ANONPAGES);
+	task_swap = get_mm_counter(mm, MM_SWAPENTS);
+
+	/* swapin only for large APP, flip 33000, bow 60000, eightpoll 16000 */
+	if (task_swap <= 10000) {
+		mmput(mm);
+		//trace_printk("SMALL swapin: this task is too small\n");
+		goto out;
+	}
+
+	walk.mm = mm;
+	walk.pmd_entry = swapin_walk_pmd_entry;
+
+	down_read(&mm->mmap_sem);
+
+	for (vma = mm->mmap; vma; vma = vma->vm_next) {
+		if (vma->memplus_flags)
+			continue;
+
+		if (is_vm_hugetlb_page(vma))
+			continue;
+
+		if (vma->vm_file)
+			continue;
+
+		/* if mlocked, don't reclaim it */
+		if (vma->vm_flags & VM_LOCKED)
+			continue;
+
+		walk.private = vma;
+		err = walk_page_range(vma->vm_start, vma->vm_end, &walk);
+		if (err == -1)
+			break;
+		vma->memplus_flags = 1;
+	}
+
+	flush_tlb_mm(mm);
+	up_read(&mm->mmap_sem);
+	mmput(mm);
+	if (err) {
+		err = 0;
+		//schedule();
+		goto retry;
+	}
+out:
+		/* TODO */
+	lru_add_drain();	/* Push any new pages onto the LRU now */
+#if DEBUG_TIME_INFO
+	getnstimeofday(&ts2);
+	ts2 = timespec_sub(ts2, ts1);
+	time_ns = timespec_to_ns(&ts2);
+#endif
+	//trace_printk("%s (pid %d)(size %d-%d) (adj %d -> %d) consumed %llu ms %llu us\n", task->comm, task->pid, task_anon, task_swap, prev_adj, task->signal->oom_score_adj, (time_ns/1000000), (time_ns/1000)%1000);
+
+	spin_lock(&task->signal->reclaim_state_lock);
+	BUG_ON(task->signal->swapin_should_readahead_m != SWAPIN_QUEUE);
+	task->signal->swapin_should_readahead_m = RECLAIM_STANDBY;
+	spin_unlock(&task->signal->reclaim_state_lock);
+
+	return 0;
+}
+
+//TODO: blk_plug don't seem to work
+static int swapind_fn(void *p)
+{
+	struct reclaim_data data;
+	struct task_struct *tsk;
+
+	set_freezable();
+	for ( ; ; ) {
+		while (!pm_freezing && dequeue_reclaim_data(&data, &si)) {
+			rcu_read_lock();
+			tsk = find_task_by_vpid(data.pid);
+
+			/* KTHREAD is almost impossible to hit this */
+			//if (tsk->flags & PF_KTHREAD) {
+			//  rcu_read_unlock();
+			//	continue;
+			//}
+
+			if (!tsk) {
+				rcu_read_unlock();
+				continue;
+			}
+
+			get_task_struct(tsk);
+			rcu_read_unlock();
+
+			swapin_anon(tsk, data.prev_adj);
+			put_task_struct(tsk);
+		}
+
+		set_current_state(TASK_INTERRUPTIBLE);
+		freezable_schedule();
+
+		if (kthread_should_stop())
+			break;
+	}
+
+	return 0;
+}
+
+static int memplus_reclaim_pte(pmd_t *pmd, unsigned long addr,
+				unsigned long end, struct mm_walk *walk)
+{
+	struct mp_reclaim_param *rp = walk->private;
+	struct vm_area_struct *vma = rp->vma;
+	pte_t *pte, ptent;
+	spinlock_t *ptl;
+	struct page *page;
+	LIST_HEAD(page_list);
+	int isolated;
+	int reclaimed = 0;
+	int reclaim_type = rp->type;
+
+	split_huge_pmd(vma, addr, pmd);
+	if (pmd_trans_unstable(pmd) || !rp->nr_to_reclaim)
+		return 0;
+cont:
+	isolated = 0;
+	pte = pte_offset_map_lock(vma->vm_mm, pmd, addr, &ptl);
+	for (; addr != end; pte++, addr += PAGE_SIZE) {
+		ptent = *pte;
+		if (!pte_present(ptent))
+			continue;
+
+		page = vm_normal_page(vma, addr, ptent);
+		if (!page)
+			continue;
+
+		/* About 11% of pages have more than 1 map_count
+		 * only take care mapcount == 1 is good enough */
+		if (page_mapcount(page) != 1)
+			continue;
+
+		if (isolate_lru_page(page))
+			continue;
+
+		if (PageAnon(page) && !PageSwapBacked(page)) {
+			putback_lru_page(page);
+			continue;
+		}
+
+		list_add(&page->lru, &page_list);
+		inc_node_page_state(page, NR_ISOLATED_ANON +
+				page_is_file_cache(page));
+		isolated++;
+		rp->nr_scanned++;
+
+		if ((isolated >= SWAP_CLUSTER_MAX) || !rp->nr_to_reclaim)
+			break;
+	}
+	pte_unmap_unlock(pte - 1, ptl);
+
+	if (reclaim_type == TYPE_NORMAL)
+		reclaimed = swapout_to_disk(&page_list, vma);
+	else if (reclaim_type == TYPE_FREQUENT)
+		reclaimed = swapout_to_zram(&page_list, vma);
+
+	rp->nr_reclaimed += reclaimed;
+	rp->nr_to_reclaim -= reclaimed;
+	if (rp->nr_to_reclaim < 0)
+		rp->nr_to_reclaim = 0;
+
+#if FEAT_RECLAIM_LIMIT
+	/* TODO: early quit */
+	/* timeout (range from 10~20ms), emergency quit back to reclaim_anon() */
+	/* statistics shows 90% of reclaim finish within 60ms, should be a good timeout value */
+	/* statistics shows 80% of reclaim finish within 26ms, should be a good timeout value */
+	/* statistics shows 77% of reclaim finish within 20ms, should be a good timeout value */
+	/* statistics shows 68% of reclaim finish within 10ms, should be a good timeout value */
+	//if (time_after_eq(jiffies, rp->start_jiffies + 2)) {
+	//	rp->nr_to_reclaim = 0;
+	//	return 1;
+	//}
+
+	/* this will make black screen shorter */
+	//if (rp->nr_reclaimed > 2000) {
+	//	rp->nr_to_reclaim = 0;
+	//	return 1;
+	//}
+#endif
+
+	if (rp->nr_to_reclaim && (addr != end))
+		goto cont;
+
+	/* TODO: is there other reschedule point we can add */
+	cond_resched();
+
+	return 0;
+}
+
+/* get_task_struct before using this function */
+static ssize_t reclaim_anon(struct task_struct *task, int prev_adj)
+{
+	struct mm_struct *mm;
+	struct vm_area_struct *vma;
+	struct mm_walk reclaim_walk = {};
+	struct mp_reclaim_param rp;
+	int task_anon = 0, task_swap = 0;
+	int a_task_anon = 0, a_task_swap = 0;
+
+	//u64 time_ns = 0;
+#if DEBUG_TIME_INFO
+	struct timespec ts1, ts2;
+	getnstimeofday(&ts1);
+#endif
+#if FEAT_RECLAIM_LIMIT
+	rp.start_jiffies = jiffies;
+#endif
+
+	spin_lock(&task->signal->reclaim_state_lock);
+
+	/*TODO: additional handle for PF_EXITING do_exit()->exit_signal()*/
+	if (task->signal->swapin_should_readahead_m != RECLAIM_QUEUE) {
+		//trace_printk("EXIT reclaim: this task is either (reclaimed) or (adj 0 swapin)\n");
+		spin_unlock(&task->signal->reclaim_state_lock);
+		goto out;
+	}
+	task->signal->swapin_should_readahead_m = RECLAIM_DONE;
+	spin_unlock(&task->signal->reclaim_state_lock);
+
+	/* if available swap is less than 4MB, quit early */
+	if (!enough_swap_size(1024, task->signal->memplus_type))
+		goto out;
+
+	/* TODO: do we need to use p = find_lock_task_mm(tsk); in case main thread got killed */
+	mm = get_task_mm(task);
+	if (!mm)
+		goto out;
+
+	task_anon = get_mm_counter(mm, MM_ANONPAGES);
+	task_swap = get_mm_counter(mm, MM_SWAPENTS);
+
+	reclaim_walk.mm = mm;
+	reclaim_walk.pmd_entry = memplus_reclaim_pte;
+
+	rp.nr_to_reclaim = INT_MAX;
+	rp.nr_reclaimed = 0;
+	rp.nr_scanned = 0;
+
+	/* if app is larger than 200MB, override its property to frequent */
+	if (task_anon + task_swap > 51200) {
+		rp.type = TYPE_FREQUENT;
+	} else
+		rp.type = task->signal->memplus_type;
+
+	reclaim_walk.private = &rp;
+
+	down_read(&mm->mmap_sem);
+	for (vma = mm->mmap; vma; vma = vma->vm_next) {
+		if (is_vm_hugetlb_page(vma))
+			continue;
+
+		if (vma->vm_file)
+			continue;
+
+		/* if mlocked, don't reclaim it */
+		if (vma->vm_flags & VM_LOCKED)
+			continue;
+
+		if (task->signal->swapin_should_readahead_m != RECLAIM_DONE)
+			break;
+
+		rp.vma = vma;
+		walk_page_range(vma->vm_start, vma->vm_end,
+				&reclaim_walk);
+
+		vma->memplus_flags = 0;
+		if (!rp.nr_to_reclaim)
+			break;
+	}
+
+	flush_tlb_mm(mm);
+	up_read(&mm->mmap_sem);
+	a_task_anon = get_mm_counter(mm, MM_ANONPAGES);
+	a_task_swap = get_mm_counter(mm, MM_SWAPENTS);
+	mmput(mm);
+out:
+#if DEBUG_TIME_INFO
+	getnstimeofday(&ts2);
+	ts2 = timespec_sub(ts2, ts1);
+	time_ns = timespec_to_ns(&ts2);
+#endif
+	/* it's possible that rp data isn't initialized because mm don't exist */
+	//trace_printk("%s (pid %d)(size %d-%d to %d-%d) (adj %d -> %d) reclaimed %d scan %d consumed %llu ms %llu us\n"
+	//		, task->comm, task->pid, task_anon, task_swap, a_task_anon, a_task_swap
+	//		, prev_adj, task->signal->oom_score_adj, rp.nr_reclaimed, rp.nr_scanned
+	//		, (time_ns/1000000), (time_ns/1000)%1000);
+
+	/* TODO : return proper value */
+	return 0;
+}
+
+//TODO: should we mark reclaimd/swapind freezable?
+static int reclaimd_fn(void *p)
+{
+	struct reclaim_data data;
+	struct task_struct *tsk;
+
+	set_freezable();
+	for ( ; ; ) {
+		while (!pm_freezing && dequeue_reclaim_data(&data, &ri)) {
+			rcu_read_lock();
+			tsk = find_task_by_vpid(data.pid);
+
+			/* KTHREAD is almost impossible to hit this */
+			//if (tsk->flags & PF_KTHREAD) {
+			//  rcu_read_unlock();
+			//	continue;
+			//}
+
+			if (!tsk) {
+				rcu_read_unlock();
+				continue;
+			}
+
+			get_task_struct(tsk);
+			rcu_read_unlock();
+
+			do {
+				msleep(30);
+			} while (swapind_tsk && (swapind_tsk->state == TASK_RUNNING));
+
+			reclaim_anon(tsk, data.prev_adj);
+			put_task_struct(tsk);
+		}
+
+		set_current_state(TASK_INTERRUPTIBLE);
+		freezable_schedule();
+
+		if (kthread_should_stop())
+			break;
+	}
+
+	return 0;
+}
+
+void memplus_stop(void)
+{
+	if (reclaimd_tsk) {
+		kthread_stop(reclaimd_tsk);
+		reclaimd_tsk = NULL;
+	}
+	if (swapind_tsk) {
+		kthread_stop(swapind_tsk);
+		swapind_tsk = NULL;
+	}
+}
+
+static int __init memplus_init(void)
+{
+	//TODO: priority tuning for reclaimd/swapind
+	//struct sched_param param = { .sched_priority = MAX_USER_RT_PRIO -1 };
+	//struct sched_param param = { .sched_priority = 1 };
+
+	reclaimd_tsk = kthread_run(reclaimd_fn, 0, "reclaimd");
+	if (IS_ERR(reclaimd_tsk)) {
+		pr_err("Failed to start reclaimd\n");
+		reclaimd_tsk = NULL;
+	}
+
+	swapind_tsk = kthread_run(swapind_fn, 0, "swapind");
+	if (IS_ERR(swapind_tsk)) {
+		pr_err("Failed to start swapind\n");
+		swapind_tsk = NULL;
+	} else {
+		//if (sched_setscheduler_nocheck(swapind_tsk, SCHED_FIFO, &param)) {
+		//	pr_warn("%s: failed to set SCHED_FIFO\n", __func__);
+		//}
+	}
+
+	return 0;
+}
+
+module_init(memplus_init)
diff --git a/drivers/oneplus/coretech/opchain/Kconfig b/drivers/oneplus/coretech/opchain/Kconfig
new file mode 100755
index 0000000000000000000000000000000000000000..e69de29bb2d1d6434b8b29ae775ad8c2e48c5391
diff --git a/drivers/oneplus/coretech/opchain/Makefile b/drivers/oneplus/coretech/opchain/Makefile
new file mode 100755
index 0000000000000000000000000000000000000000..6ba0d7ee297727de96c37b1334de845971a34bb5
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/Makefile
@@ -0,0 +1,3 @@
+obj-y += opchain_helper.o opchain_struct_offset_helper.o
+opchain-objs := opchain_proxy.o opchain_core.o
+obj-m := opchain.o
diff --git a/drivers/oneplus/coretech/opchain/opchain_binder.h b/drivers/oneplus/coretech/opchain/opchain_binder.h
new file mode 100755
index 0000000000000000000000000000000000000000..46564c4cc0d0ecf88c900921076a7ebf32128094
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_binder.h
@@ -0,0 +1,6 @@
+#ifndef _LINUX_OPCHAIN_BINDER_H
+#define _LINUX_OPCHAIN_BINDER_H
+
+extern void opc_binder_pass(size_t data_size, uint32_t *data, int send);
+extern void opc_binder_pass_cb(void (*cb)(size_t dsize, uint32_t *data, int send));
+#endif
diff --git a/drivers/oneplus/coretech/opchain/opchain_core.h b/drivers/oneplus/coretech/opchain/opchain_core.h
new file mode 100755
index 0000000000000000000000000000000000000000..6aa51f252481dadb2e77ffd184f0c2842f88d5a4
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_core.h
@@ -0,0 +1,8 @@
+#ifndef _LINUX_OPCHAIN_CORE_H
+#define _LINUX_OPCHAIN_CORE_H
+
+#if UX_DEBUG
+extern int opchain_status_show_core(char *buf, const struct kernel_param *kp);
+#endif
+extern void __exit opc_exit_module(void);
+#endif
diff --git a/drivers/oneplus/coretech/opchain/opchain_core.o_shipped b/drivers/oneplus/coretech/opchain/opchain_core.o_shipped
new file mode 100755
index 0000000000000000000000000000000000000000..3fdd58db8efe8fe2ddd138fb1fa25ffd9d36cdb1
Binary files /dev/null and b/drivers/oneplus/coretech/opchain/opchain_core.o_shipped differ
diff --git a/drivers/oneplus/coretech/opchain/opchain_define.h b/drivers/oneplus/coretech/opchain/opchain_define.h
new file mode 100755
index 0000000000000000000000000000000000000000..6c4606d630f60355f726a45041a5db0f4cb0b73e
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_define.h
@@ -0,0 +1,45 @@
+/*
+ * Copyright (c) 2014, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef _LINUX_OPCHAIN_DEFINE_H
+#define _LINUX_OPCHAIN_DEFINE_H
+
+#define UX_DEBUG			0
+#define UTASK				0
+#define UT_CLK_BASE			0x01
+#define UT_ETASK			0x02
+#define UT_LATEST_ONE			0x04
+#define UT_FORE				(UT_CLK_BASE | UT_ETASK)
+
+#define OP_CLAIM_S			-1
+#define OP_PATH_SLAVE			-4
+#define OP_PATH_CLAIM			-3
+#define OP_PATH_NORMAL			-2
+#define OP_PATH_OCCUPIED		-1
+#define MIN_POWER_CPU			0
+#define FPSVALUE			60
+
+#define ONESEC_NANO 1000000000
+
+#if 1
+/* for MSM8998, SDM845*/
+#define FIRST_BIG_CORE			4
+#define NUMS_CPU			8
+#define CPU_VIRTUAL_PLUG_IN(i) (opc_cpu_active(i) && !opc_cpu_isolated(i))
+#else
+/* for MSM8996*/
+#define FIRST_BIG_CORE			2
+#define NUMS_CPU			4
+#define CPU_VIRTUAL_PLUG_IN(i) (opc_cpu_active(i))
+#endif
+#endif
diff --git a/drivers/oneplus/coretech/opchain/opchain_helper.c b/drivers/oneplus/coretech/opchain/opchain_helper.c
new file mode 100755
index 0000000000000000000000000000000000000000..c9b7d9e0462524df24a4e31dfa141f6840100085
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_helper.c
@@ -0,0 +1,213 @@
+/*
+ * Copyright (c) 2015-2017, The OnePlus corporation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above
+ *       copyright notice, this list of conditions and the following
+ *       disclaimer in the documentation and/or other materials provided
+ *       with the distribution.
+ *     * Neither the name of The Linux Foundation nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <linux/module.h>
+#include <linux/types.h>
+#include "../kernel/sched/sched.h"
+#include "opchain_define.h"
+
+void (*opc_binder_pass_t)(size_t dsize, uint32_t *data, int send) = NULL;
+bool (*is_opc_task_t)(struct task_struct *t, int type) = NULL;
+void (*opc_task_switch_t)(bool enqueue, int cpu, struct task_struct *p, u64 clock) = NULL;
+int (*opc_get_claim_on_cpu_t)(int cpu) = NULL;
+unsigned int (*opc_get_claims_t)(void) = NULL;
+int (*opc_select_path_t)(struct task_struct *cur, struct task_struct *t, int prev_cpu) = NULL;
+long (*opc_cpu_util_t)(long util, int cpu, struct task_struct *t, int op_path) = NULL;
+bool (*opc_fps_check_t)(int lvl);
+void (*opc_add_to_chain_t)(struct task_struct *t);
+
+unsigned int *opc_boost_tl;
+EXPORT_SYMBOL(opc_boost_tl);
+
+void opc_binder_pass(size_t data_size, uint32_t *data, int send)
+{
+	if (opc_binder_pass_t)
+		opc_binder_pass_t(data_size, data, send);
+}
+EXPORT_SYMBOL(opc_binder_pass);
+
+void opc_binder_pass_cb(void (*cb)(size_t dsize, uint32_t *data, int send))
+{
+	opc_binder_pass_t = cb;
+}
+EXPORT_SYMBOL(opc_binder_pass_cb);
+
+bool is_opc_task(struct task_struct *t, int type)
+{
+	if (is_opc_task_t)
+		return is_opc_task_t(t, type);
+	return 0;
+}
+EXPORT_SYMBOL(is_opc_task);
+
+void is_opc_task_cb(bool (*cb)(struct task_struct *t, int type))
+{
+	is_opc_task_t = cb;
+}
+EXPORT_SYMBOL(is_opc_task_cb);
+
+void opc_task_switch(bool enqueue, int cpu, struct task_struct *p, u64 clock) {
+    if (opc_task_switch_t)
+        opc_task_switch_t(enqueue, cpu, (struct task_struct *)p, clock);
+}
+EXPORT_SYMBOL(opc_task_switch);
+
+void opc_task_switch_cb(
+		   void (*cb)(bool enqueue, int cpu, struct task_struct *p, u64 clock))
+{
+	opc_task_switch_t = cb;
+}
+EXPORT_SYMBOL(opc_task_switch_cb);
+
+int opc_get_claim_on_cpu(int cpu)
+{
+	if (opc_get_claim_on_cpu_t)
+		return opc_get_claim_on_cpu_t(cpu);
+	return 0;
+}
+EXPORT_SYMBOL(opc_get_claim_on_cpu);
+
+void opc_get_claim_on_cpu_cb(
+    int (*cb)(int cpu))
+{
+	opc_get_claim_on_cpu_t = cb;
+}
+EXPORT_SYMBOL(opc_get_claim_on_cpu_cb);
+
+unsigned int opc_get_claims(void)
+{
+	if (opc_get_claims_t)
+		return opc_get_claims_t();
+	return 0;
+}
+EXPORT_SYMBOL(opc_get_claims);
+
+void opc_get_claims_cb(unsigned int (*cb)(void))
+{
+	opc_get_claims_t = cb;
+}
+EXPORT_SYMBOL(opc_get_claims_cb);
+
+int opc_select_path(struct task_struct *cur, struct task_struct *t, int prev_cpu)
+{
+	if (opc_select_path_t)
+		return opc_select_path_t(cur, t, prev_cpu);
+	return OP_PATH_NORMAL;
+}
+EXPORT_SYMBOL(opc_select_path);
+
+void opc_select_path_cb(int (*cb)(struct task_struct *cur, struct task_struct *t, int prev_cpu))
+{
+	opc_select_path_t = cb;
+}
+EXPORT_SYMBOL(opc_select_path_cb);
+
+long opc_cpu_util(long util, int cpu, struct task_struct *t, int op_path)
+{
+	if (opc_cpu_util_t)
+		return opc_cpu_util_t(util, cpu, t, op_path);
+	return util;
+}
+EXPORT_SYMBOL(opc_cpu_util);
+
+void opc_cpu_util_cb(long (*cb)(long util, int cpu, struct task_struct *t, int op_path))
+{
+	opc_cpu_util_t = cb;
+}
+EXPORT_SYMBOL(opc_cpu_util_cb);
+
+bool opc_fps_check(int lvl)
+{
+	if (opc_fps_check_t)
+		return opc_fps_check_t(lvl);
+	return false;
+}
+EXPORT_SYMBOL(opc_fps_check);
+
+void opc_fps_check_cb(bool (*cb)(int i))
+{
+	opc_fps_check_t = cb;
+}
+EXPORT_SYMBOL(opc_fps_check_cb);
+
+void opc_add_to_chain(struct task_struct *t)
+{
+	if(opc_add_to_chain_t)
+		opc_add_to_chain_t(t);
+}
+
+void opc_add_to_chain_cb(void (*cb)(struct task_struct *t))
+{
+	opc_add_to_chain_t = cb;
+}
+EXPORT_SYMBOL(opc_add_to_chain_cb);
+
+struct rq *opc_task_rq(struct task_struct *t)
+{
+	return task_rq(t);
+}
+EXPORT_SYMBOL(opc_task_rq);
+
+struct rq *opc_cpu_rq(int cpu)
+{
+	return cpu_rq(cpu);
+}
+EXPORT_SYMBOL(opc_cpu_rq);
+
+unsigned int opc_task_load(struct task_struct *p)
+{
+	return task_load(p);
+}
+EXPORT_SYMBOL(opc_task_load);
+
+int opc_cpu_active(int cpu)
+{
+	return cpu_active(cpu);
+}
+EXPORT_SYMBOL(opc_cpu_active);
+
+int opc_cpu_isolated(int cpu)
+{
+	return cpu_isolated(cpu);
+}
+EXPORT_SYMBOL(opc_cpu_isolated);
+
+void __exit opc_exit_module(void)
+{
+	opc_binder_pass_t = NULL;
+	is_opc_task_t = NULL;
+	opc_task_switch_t = NULL;
+	opc_get_claim_on_cpu_t = NULL;
+	opc_get_claims_t = NULL;
+	opc_select_path_t = NULL;
+	opc_cpu_util_t = NULL;
+	opc_fps_check_t = NULL;
+	opc_boost_tl = NULL;
+}
+EXPORT_SYMBOL(opc_exit_module);
diff --git a/drivers/oneplus/coretech/opchain/opchain_helper.h b/drivers/oneplus/coretech/opchain/opchain_helper.h
new file mode 100755
index 0000000000000000000000000000000000000000..be6fa18ed2ed92b6b14b22c014f7fa3f4ae97799
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_helper.h
@@ -0,0 +1,29 @@
+#ifndef _LINUX_OPCHAIN_HELPER_H
+#define _LINUX_OPCHAIN_HELPER_H
+#include "opchain_define.h"
+
+extern unsigned int *opc_boost;
+extern unsigned int *opc_boost_tl;
+extern unsigned int *opc_boost_min_sample_time;
+
+extern bool is_opc_task(struct task_struct *t, int type);
+extern void is_opc_task_cb(bool (*cb)(struct task_struct *t, int type));
+extern void opc_task_switch(bool enqueue, int cpu, struct task_struct *p, u64 clock);
+extern void opc_task_switch_cb(void (*cb)(bool enqueue, int cpu, struct task_struct *p, u64 clock));
+extern int opc_get_claim_on_cpu(int cpu);
+extern void opc_get_claim_on_cpu_cb(int (*cb)(int cpu));
+extern unsigned int opc_get_claims(void);
+extern void opc_get_claims_cb(unsigned int (*cb)(void));
+extern int opc_select_path(struct task_struct *cur, struct task_struct *t, int prev_cpu);
+extern void opc_select_path_cb(int (*cb)(struct task_struct *cur, struct task_struct *t, int prev_cpu));
+extern long opc_cpu_util(long util, int cpu, struct task_struct *t, int op_path);
+extern void opc_cpu_util_cb(long (*cb)(long util, int cpu, struct task_struct *t, int op_path));
+extern bool opc_fps_check(int lvl);
+extern void opc_fps_check_cb(bool (*cb)(int i));
+extern void opc_add_to_chain_cb(void (*cb)(struct task_struct *t));
+extern void *opc_task_rq(void *t);
+extern struct rq *opc_cpu_rq(int cpu);
+extern unsigned int opc_task_load(struct task_struct *p);
+extern int opc_cpu_active(int cpu);
+extern int opc_cpu_isolated(int cpu);
+#endif
diff --git a/drivers/oneplus/coretech/opchain/opchain_proxy.c b/drivers/oneplus/coretech/opchain/opchain_proxy.c
new file mode 100755
index 0000000000000000000000000000000000000000..cf2573733b0b09f979000289754ca8b01f4afa09
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_proxy.c
@@ -0,0 +1,120 @@
+/*
+ * Copyright (c) 2015-2017, The OnePlus corporation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above
+ *       copyright notice, this list of conditions and the following
+ *       disclaimer in the documentation and/or other materials provided
+ *       with the distribution.
+ *     * Neither the name of The Linux Foundation nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <linux/module.h>
+#include <linux/types.h>
+#include <asm/page.h>
+
+#include "../kernel/sched/sched.h"
+#include "opchain_define.h"
+#include "opchain_core.h"
+
+unsigned int __read_mostly boost;
+unsigned int __read_mostly boost_tl = 1;
+unsigned int __read_mostly boost_sample_time = 1;
+unsigned int __read_mostly chain_on = 1;
+unsigned int __read_mostly fps = FPSVALUE;
+unsigned int __read_mostly latest_ms = 100;
+unsigned int __read_mostly latest_threshold = 100000000;
+unsigned int __read_mostly onefps_nano = ONESEC_NANO / FPSVALUE + 1;
+
+#if UX_DEBUG
+static int opchain_status_show(char *buf, const struct kernel_param *kp)
+{
+	return opchain_status_show_core(buf, kp);
+}
+
+static const struct kernel_param_ops param_ops_opchain_status = {
+	.get = opchain_status_show,
+};
+module_param_cb(opchain_status, &param_ops_opchain_status, NULL, 0644);
+#endif
+
+void ctech_update_frame_time(int new_fps)
+{
+	onefps_nano = (ONESEC_NANO / new_fps) + 1;
+}
+
+static int latest_ms_show(char *buf, const struct kernel_param *kp)
+{
+	return snprintf(buf, PAGE_SIZE,	"%u", latest_ms);
+}
+
+static int latest_ms_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+
+	if (sscanf(buf, "%u\n", &val) <= 0)
+		return -EINVAL;
+	latest_ms = val;
+	latest_threshold = val * 1000000;
+	return 0;
+}
+
+static const struct kernel_param_ops param_ops_latest_ms = {
+	.get = latest_ms_show,
+	.set = latest_ms_store,
+};
+
+static int fps_show(char *buf, const struct kernel_param *kp)
+{
+	return snprintf(buf, PAGE_SIZE,	"%u", fps);
+}
+
+static int fps_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+
+	if (sscanf(buf, "%u\n", &val) <= 0)
+		return -EINVAL;
+	fps = val;
+	ctech_update_frame_time(val);
+	pr_info("new frame should be shorter than %u\n",
+	    (1000000000 / fps + 1));
+	return 0;
+}
+
+static const struct kernel_param_ops param_ops_fps = {
+	.get = fps_show,
+	.set = fps_store,
+};
+
+module_param(boost, uint, 0644);
+module_param(boost_sample_time, uint, 0644);
+module_param(boost_tl, uint, 0644);
+module_param(chain_on, uint, 0644);
+module_param_cb(fps, &param_ops_fps, NULL, 0644);
+module_param_cb(latest_ms, &param_ops_latest_ms, NULL, 0644);
+
+static void __exit opchain_exit_module(void)
+{
+	opc_exit_module();
+}
+
+module_exit(opchain_exit_module);
diff --git a/drivers/oneplus/coretech/opchain/opchain_proxy.h b/drivers/oneplus/coretech/opchain/opchain_proxy.h
new file mode 100755
index 0000000000000000000000000000000000000000..bbb218c10bfef0729d0e0164ce67955e558e1288
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_proxy.h
@@ -0,0 +1,11 @@
+#ifndef _LINUX_OPCHAIN_PROXY_H
+#define _LINUX_OPCHAIN_PROXY_H
+
+extern unsigned int __read_mostly boost;
+extern unsigned int __read_mostly boost_tl;
+extern unsigned int __read_mostly boost_sample_time;
+extern unsigned int __read_mostly chain_on;
+extern unsigned int __read_mostly latest_threshold;
+extern unsigned int __read_mostly fps;
+extern unsigned int __read_mostly onefps_nano;
+#endif
diff --git a/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.c b/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.c
new file mode 100755
index 0000000000000000000000000000000000000000..6b4eb6a88f9432dda94c238f532001bf470bc063
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.c
@@ -0,0 +1,64 @@
+/*
+ * Copyright (c) 2015-2017, The OnePlus corporation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above
+ *       copyright notice, this list of conditions and the following
+ *       disclaimer in the documentation and/or other materials provided
+ *       with the distribution.
+ *     * Neither the name of The Linux Foundation nor the names of its
+ *       contributors may be used to endorse or promote products derived
+ *       from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <linux/stddef.h>
+#include <linux/module.h>
+
+#include "opchain_struct_offset_helper.h"
+#include "../kernel/sched/sched.h"
+
+/* struct task_struct */
+unsigned int opchain_task_struct_offset[__TASK_OFFSET_MAX] = {
+	[TASK_OFFSET_WAKEE_FLIPS] = offsetof(struct task_struct, wakee_flips),
+	[TASK_OFFSET_CPUS_ALLOWED] = offsetof(struct task_struct, cpus_allowed),
+	[TASK_OFFSET_PID] = offsetof(struct task_struct, pid),
+	[TASK_OFFSET_TGID] = offsetof(struct task_struct, tgid),
+	[TASK_OFFSET_GROUP_LEADER] = offsetof(struct task_struct, group_leader),
+	[TASK_OFFSET_COMM] = offsetof(struct task_struct, comm),
+	[TASK_OFFSET_UTASK_TAG] = offsetof(struct task_struct, utask_tag),
+	[TASK_OFFSET_UTASK_TAG_BASE] = offsetof(struct task_struct, utask_tag_base),
+	[TASK_OFFSET_ETASK_CLAIM] = offsetof(struct task_struct, etask_claim),
+	[TASK_OFFSET_CLAIM_CPU] = offsetof(struct task_struct, claim_cpu),
+	[TASK_OFFSET_UTASK_SLAVE] = offsetof(struct task_struct, utask_slave),
+	[TASK_OFFSET_EXIT_STATE] = offsetof(struct task_struct, exit_state)
+};
+gen_type_offset_impl(task_struct);
+
+/* struct rq */
+unsigned int opchain_rq_offset[__RQ_OFFSET_MAX] = {
+#ifdef CONFIG_SMP
+	[RQ_OFFSET_CPU_CAPACITY_ORIG] = offsetof(struct rq, cpu_capacity_orig),
+	[RQ_OFFSET_CPU] = offsetof(struct rq, cpu),
+#endif
+#ifdef CONFIG_SCHED_HMP
+	[RQ_OFFSET_WINDOW_START] = offsetof(struct rq, window_start),
+#endif
+	[RQ_OFFSET_CLOCK] = offsetof(struct rq, clock)
+};
+gen_type_offset_impl(rq);
diff --git a/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.h b/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.h
new file mode 100755
index 0000000000000000000000000000000000000000..feff6f495cf31e6bafd4c490a2018c83724fa8a8
--- /dev/null
+++ b/drivers/oneplus/coretech/opchain/opchain_struct_offset_helper.h
@@ -0,0 +1,68 @@
+#ifndef _OPCHAIN_STRUCT_OFFSET_HELPER_INC_
+#define _OPCHAIN_STRUCT_OFFSET_HELPER_INC_
+
+/* define macro to extern function declaration */
+#define gen_type_offset(type) \
+	extern unsigned int opchain_get_##type##_offset(int m);
+
+/* define macro to create offset impl and export get offset/value symbol */
+#define gen_type_offset_impl(type) \
+	unsigned int opchain_get_##type##_offset(int m) { \
+		return opchain_##type##_offset[m]; } \
+	EXPORT_SYMBOL(opchain_get_##type##_offset);
+
+/* enum of struct task struct */
+enum {
+	TASK_OFFSET_WAKEE_FLIPS,
+	TASK_OFFSET_CPUS_ALLOWED,
+	TASK_OFFSET_PID,
+	TASK_OFFSET_TGID,
+	TASK_OFFSET_GROUP_LEADER,
+	TASK_OFFSET_COMM,
+	TASK_OFFSET_UTASK_TAG,
+	TASK_OFFSET_UTASK_TAG_BASE,
+	TASK_OFFSET_ETASK_CLAIM,
+	TASK_OFFSET_CLAIM_CPU,
+	TASK_OFFSET_UTASK_SLAVE,
+	TASK_OFFSET_EXIT_STATE,
+
+	__TASK_OFFSET_MAX
+};
+#define TASK_WAKEE_FLIPS_R(t) (*(unsigned long *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_WAKEE_FLIPS)))
+#define TASK_CPUS_ALLOWED_ADDR(t) (cpumask_t *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_CPUS_ALLOWED))
+#define TASK_PID_R(t) (*(pid_t *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_PID)))
+#define TASK_TGID_R(t) (*(pid_t *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_TGID)))
+#define TASK_GROUP_LEADER_R(t) (*(struct task_struct **)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_GROUP_LEADER)))
+#define TASK_COMM_R(t) ((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_COMM))
+#define TASK_UTASK_TAG_R(t) (*(u64 *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_UTASK_TAG)))
+#define TASK_UTASK_TAG_BASE_R(t) (*(u64 *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_UTASK_TAG_BASE)))
+#define TASK_ETASK_CLAIM_R(t) (*(int *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_ETASK_CLAIM)))
+#define TASK_CLAIM_CPU_R(t) (*(int *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_CLAIM_CPU)))
+#define TASK_UTASK_SLAVE_R(t) (*(bool *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_UTASK_SLAVE)))
+#define TASK_EXIT_STATE_R(t) (*(bool *)((char *)t + opchain_get_task_struct_offset(TASK_OFFSET_EXIT_STATE)))
+gen_type_offset(task_struct);
+
+/* enum of struct rq */
+enum {
+	RQ_OFFSET_CLOCK,
+#ifdef CONFIG_SMP
+	RQ_OFFSET_CPU_CAPACITY_ORIG,
+	RQ_OFFSET_CPU,
+#endif
+#ifdef CONFIG_SCHED_HMP
+	RQ_OFFSET_WINDOW_START,
+#endif
+
+	__RQ_OFFSET_MAX
+};
+#define RQ_CLOCK_R(rq) (*(u64 *)((char *)rq + opchain_get_rq_offset(RQ_OFFSET_CLOCK)))
+#ifdef CONFIG_SMP
+#define RQ_CPU_CAPACITY_ORIG_R(rq) (*(unsigned long *)((char *)rq + opchain_get_rq_offset(RQ_OFFSET_CPU_CAPACITY_ORIG)))
+#define RQ_CPU_R(rq) (*(int *)((char *)rq + opchain_get_rq_offset(RQ_OFFSET_CPU)))
+#endif
+#ifdef CONFIG_SCHED_HMP
+#define RQ_WINDOW_START_R(rq) (*(u64 *)((char *)rq + opchain_get_rq_offset(RQ_OFFSET_WINDOW_START)))
+#endif
+gen_type_offset(rq);
+
+#endif //_OPCHAIN_STRUCT_OFFSET_HELPER_INC_
diff --git a/drivers/oneplus/oem_trace.c b/drivers/oneplus/oem_trace.c
new file mode 100644
index 0000000000000000000000000000000000000000..5ba53d409e91c9f5d480675bf56a29c589a1b753
--- /dev/null
+++ b/drivers/oneplus/oem_trace.c
@@ -0,0 +1,542 @@
+/*
+ * Copyright (C) 2010 op, Inc.
+ * Author: Andy
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+#include <linux/module.h>
+#include <linux/fs.h>
+#include <linux/miscdevice.h>
+#include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/poll.h>
+#include <linux/time.h>
+#include <asm/ioctls.h>
+#include <linux/completion.h>
+#include <linux/interrupt.h>
+#include <linux/module.h>
+#include <linux/sched.h>
+#include <linux/stacktrace.h>
+#include <linux/hugetlb.h>
+#include <linux/mm.h>
+#include <linux/mman.h>
+#include <linux/mmzone.h>
+#include <linux/swap.h>
+#include <linux/vmstat.h>
+/*#include <asm/atomic.h>*/
+#include <linux/atomic.h>
+
+#include <asm/page.h>
+#include <asm/pgtable.h>
+#include <linux/slab.h>
+#include <linux/io.h>
+#include <linux/workqueue.h>
+#include <linux/seq_file.h>
+#include <linux/proc_fs.h>
+#ifdef CONFIG_CMA
+#include <linux/cma.h>
+#endif
+
+#include "oem_trace.h"
+
+
+#define IOCTL_OTRACER_TEST			(1<<0)
+#define IOCTL_OTRACER_STACK			(1<<1)
+#define IOCTL_OTRACER_MEMINFO		(1<<2)
+#define IOCTL_OTRACER_TASKINFO		(1<<3)
+#define IOCTL_OTRACER_ALLINFO		(1<<4)
+#define IOCTL_OTRACER_TOLCD			(1<<5)
+
+#define IOCTL_OTRACER_PANIC		(1<<12)
+
+struct vmalloc_info {
+	unsigned long	used;
+	unsigned long	largest_chunk;
+};
+
+
+void backtrace_test_saved(void)
+{
+	struct stack_trace trace;
+	unsigned long entries[8];
+
+	pr_info("\nThe following trace is a kernel self test and not a bug!\n");
+
+	trace.nr_entries = 0;
+	trace.max_entries = ARRAY_SIZE(entries);
+	trace.entries = entries;
+	trace.skip = 0;
+
+	pr_info("Testing a dump_stack.\n");
+	dump_stack();
+	pr_info("Testing a print_stack_trace.\n");
+	print_stack_trace(&trace, 0);
+}
+
+void tasks_mem_get(
+struct mm_struct *mm, unsigned long *vsize, unsigned long *vrss)
+{
+	unsigned long hiwater_vm, total_vm, hiwater_rss, total_rss;
+
+	hiwater_vm = total_vm = mm->total_vm;
+	if (hiwater_vm < mm->hiwater_vm)
+		hiwater_vm = mm->hiwater_vm;
+	hiwater_rss = total_rss = get_mm_rss(mm);
+	if (hiwater_rss < mm->hiwater_rss)
+		hiwater_rss = mm->hiwater_rss;
+
+	*vsize = total_vm << (PAGE_SHIFT-10);
+	*vrss = total_rss << (PAGE_SHIFT-10);
+}
+
+static char *task_state_array[] = {
+	"R-0",		/*	0 (running) */
+	"S-1",		/*	1 (sleeping) */
+	"D-2",	/*	2 (disk sleep) */
+	"T-4",		/*	4 (stopped) */
+	"T-8",	/*	8 (tracing stop) */
+	"Z-F",		/* 16 (zombie) */
+	"X-"		/* 32 (dead) */
+};
+
+static inline const char *get_task_state(struct task_struct *tsk)
+{
+	unsigned int state = (tsk->state & TASK_REPORT) | tsk->exit_state;
+	char **p = &task_state_array[0];
+
+	while (state) {
+		p++;
+		state >>= 1;
+	}
+	return *p;
+}
+
+void tasks_test_saved(void)
+{
+	struct task_struct *p;
+	struct cred *cred = NULL;
+	struct mm_struct *mm;
+	unsigned long vsize = 0, vrss = 0;
+
+	pr_info("\nThe following trace is a kernel tasks test and not a bug!\n");
+
+	pr_info("USER\tPID\tVSIZE\tRSS\tSTATE\tNAME\n");
+	write_lock_irq(&tasklist_lock);
+	for_each_process(p) {
+
+		cred = (struct cred *)get_cred((struct cred *) __task_cred(p));
+
+		vsize = 0;
+		vrss = 0;
+		mm = get_task_mm(p);
+
+		if (mm)
+			tasks_mem_get(mm, &vsize, &vrss);
+
+		pr_info("%u\t%d\t%ld\t%ld\t%s\t%s\n",
+			(cred->uid).val,
+			task_pid_nr(p),
+			vsize,
+			vrss,
+			get_task_state(p),
+			p->comm);
+	}
+	write_unlock_irq(&tasklist_lock);
+}
+
+void meminfo_test_saved(void)
+{
+struct sysinfo i;
+	unsigned long committed;
+	unsigned long allowed;
+	long cached;
+	unsigned long pages[NR_LRU_LISTS];
+	int lru;
+
+/*
+ * display in kilobytes.
+ */
+#define K(x) ((x) << (PAGE_SHIFT - 10))
+	si_meminfo(&i);
+	si_swapinfo(&i);
+	committed = percpu_counter_read_positive(&vm_committed_as);
+	allowed = ((totalram_pages - hugetlb_total_pages())
+		* sysctl_overcommit_ratio / 100) + total_swap_pages;
+
+	cached = global_page_state(NR_FILE_PAGES) -
+			total_swapcache_pages() - i.bufferram;
+	if (cached < 0)
+		cached = 0;
+
+
+	for (lru = LRU_BASE; lru < NR_LRU_LISTS; lru++)
+		pages[lru] = global_page_state(NR_LRU_BASE + lru);
+
+	/*
+	 * Tagged format, for easy grepping and expansion.
+	 */
+	pr_info("Meminfo:\n"
+		"MemTotal:		 %8lu kB\n"
+		"MemFree:		 %8lu kB\n"
+		"Buffers:		 %8lu kB\n"
+		"Cached:		 %8lu kB\n"
+		"SwapCached:	 %8lu kB\n"
+		"Active:		 %8lu kB\n"
+		"Inactive:		 %8lu kB\n"
+		"Active(anon):	 %8lu kB\n"
+		"Inactive(anon): %8lu kB\n"
+		"Active(file):	 %8lu kB\n"
+		"Inactive(file): %8lu kB\n"
+		"Unevictable:	 %8lu kB\n"
+		"Mlocked:		 %8lu kB\n"
+#ifdef CONFIG_HIGHMEM
+		"HighTotal:      %8lu kB\n"
+		"HighFree:		 %8lu kB\n"
+		"LowTotal:		 %8lu kB\n"
+		"LowFree:		 %8lu kB\n"
+#endif
+#ifndef CONFIG_MMU
+		"MmapCopy:		 %8lu kB\n"
+#endif
+		"SwapTotal:      %8lu kB\n"
+		"SwapFree:       %8lu kB\n"
+		"Dirty:          %8lu kB\n"
+		"Writeback:      %8lu kB\n"
+		"AnonPages:      %8lu kB\n"
+		"Mapped:		 %8lu kB\n"
+		"Shmem:          %8lu kB\n"
+		"Slab:			 %8lu kB\n"
+		"SReclaimable:	 %8lu kB\n"
+		"SUnreclaim:	 %8lu kB\n"
+		"KernelStack:	 %8lu kB\n"
+		"PageTables:	 %8lu kB\n"
+#ifdef CONFIG_QUICKLIST
+		"Quicklists:	 %8lu kB\n"
+#endif
+		"NFS_Unstable:	 %8lu kB\n"
+		"Bounce:		 %8lu kB\n"
+		"WritebackTmp:	 %8lu kB\n"
+		"CommitLimit:	 %8lu kB\n"
+		"Committed_AS:	 %8lu kB\n"
+		"VmallocTotal:	 %8lu kB\n"
+		"VmallocUsed:	 %8lu kB\n"
+		"VmallocChunk:	 %8lu kB\n"
+#ifdef CONFIG_MEMORY_FAILURE
+		"HardwareCorrupted: %5lu kB\n"
+#endif
+#ifdef CONFIG_TRANSPARENT_HUGEPAGE
+		"AnonHugePages:  %8lu kB\n"
+#endif
+#ifdef CONFIG_CMA
+		"CmaTotal:		 %8lu kB\n"
+		"CmaFree:		 %8lu kB\n"
+#endif
+		,
+		K(i.totalram),
+		K(i.freeram),
+		K(i.bufferram),
+		K(cached),
+		K(total_swapcache_pages()),
+		K(pages[LRU_ACTIVE_ANON]   + pages[LRU_ACTIVE_FILE]),
+		K(pages[LRU_INACTIVE_ANON] + pages[LRU_INACTIVE_FILE]),
+		K(pages[LRU_ACTIVE_ANON]),
+		K(pages[LRU_INACTIVE_ANON]),
+		K(pages[LRU_ACTIVE_FILE]),
+		K(pages[LRU_INACTIVE_FILE]),
+		K(pages[LRU_UNEVICTABLE]),
+		K(global_page_state(NR_MLOCK)),
+#ifdef CONFIG_HIGHMEM
+		K(i.totalhigh),
+		K(i.freehigh),
+		K(i.totalram-i.totalhigh),
+		K(i.freeram-i.freehigh),
+#endif
+#ifndef CONFIG_MMU
+		K((unsigned long) atomic_long_read(&mmap_pages_allocated)),
+#endif
+		K(i.totalswap),
+		K(i.freeswap),
+		K(global_page_state(NR_FILE_DIRTY)),
+		K(global_page_state(NR_WRITEBACK)),
+#ifdef CONFIG_TRANSPARENT_HUGEPAGE
+		K(global_page_state(NR_PAGETABLE)
+		  + global_page_state(NR_ANON_TRANSPARENT_HUGEPAGES) *
+		  HPAGE_PMD_NR),
+#else
+		K(global_page_state(NR_PAGETABLE)),
+#endif
+		K(global_page_state(NR_FILE_MAPPED)),
+		K(global_page_state(NR_SHMEM)),
+		K(global_page_state(NR_SLAB_RECLAIMABLE) +
+				global_page_state(NR_SLAB_UNRECLAIMABLE)),
+		K(global_page_state(NR_SLAB_RECLAIMABLE)),
+		K(global_page_state(NR_SLAB_UNRECLAIMABLE)),
+		global_page_state(NR_KERNEL_STACK_KB) * THREAD_SIZE / 1024,
+		K(global_page_state(NR_PAGETABLE)),
+#ifdef CONFIG_QUICKLIST
+		K(quicklist_total_size()),
+#endif
+		K(global_page_state(NR_UNSTABLE_NFS)),
+		K(global_page_state(NR_BOUNCE)),
+		K(global_page_state(NR_WRITEBACK_TEMP)),
+		K(allowed),
+		K(committed),
+		(unsigned long)VMALLOC_TOTAL >> 10,
+	   0ul, /* used to be vmalloc 'used'*/
+	   0ul	/* used to be vmalloc 'largest_chunk'*/
+#ifdef CONFIG_MEMORY_FAILURE
+		, atomic_long_read(&num_poisoned_pages) << (PAGE_SHIFT - 10)
+#endif
+#ifdef CONFIG_TRANSPARENT_HUGEPAGE
+		, K(global_page_state(NR_ANON_TRANSPARENT_HUGEPAGES) *
+		   HPAGE_PMD_NR)
+#endif
+#ifdef CONFIG_CMA
+		, K(totalcma_pages)
+		, K(global_page_state(NR_FREE_CMA_PAGES))
+#endif
+		);
+#undef K
+}
+
+int oem_con_write(const unsigned char *buf, int count)
+{
+	return 0;
+}
+
+void console_activate(void)
+{
+}
+
+
+static ssize_t otracer_read(struct file *filp, char __user *buf,
+				size_t size, loff_t *offp)
+{
+	pr_info("otracer_read: initialized\n");
+	return 0;
+}
+
+
+static int otrace_on = -1;
+
+
+bool is_otrace_on(void)
+{
+	return !!otrace_on;
+}
+static ssize_t otracer_write(struct file *filp, const char __user *buf,
+						size_t count, loff_t *offp)
+{
+	char *kbuf = NULL;
+
+	if (!is_otrace_on())
+		return count;
+
+	pr_info("otracer_write\n");
+	kbuf = kzalloc(PAGE_SIZE, GFP_KERNEL);
+
+	if (kbuf == NULL)
+		goto end;
+
+	if (!count)
+		goto free_buf;
+
+	if (copy_from_user(kbuf, buf, ((count > PAGE_SIZE)?PAGE_SIZE:count)))
+		goto free_buf;
+
+	oem_con_write(kbuf, ((count > PAGE_SIZE)?PAGE_SIZE:count));
+	kfree(kbuf);
+
+	return count;
+free_buf:
+	kfree(kbuf);
+end:
+	pr_info("otracer_write fail!\n");
+	return -EFAULT;
+}
+
+static long otracer_ioctl(struct file *filp,
+		   unsigned int cmd, unsigned long arg)
+{
+	unsigned int cmdv = cmd;
+	int i;
+
+	cmdv = cmd;
+
+	pr_info("otracer_ioctl: initialized. cmd=0x%x\n", cmd);
+
+	/*
+	* mwalker give a chance to change reboot
+	* result to android for android framework.
+	*/
+	if (cmd == IOCTL_TRACE_UPDATE_REBOOTFLAG) {
+		pr_info("android update reboot flag\n");
+		goto end;
+	}
+
+	for (i = 0; i < 16; i++) {
+		if (cmdv == 0)
+			break;
+
+		if (cmdv & IOCTL_OTRACER_TOLCD)
+			cmdv &= (~IOCTL_OTRACER_TOLCD);
+
+		if (cmdv & IOCTL_OTRACER_STACK) {
+			backtrace_test_saved();
+			cmdv &= (~IOCTL_OTRACER_STACK);
+		}
+		if (cmdv & IOCTL_OTRACER_MEMINFO) {
+			meminfo_test_saved();
+			cmdv &= (~IOCTL_OTRACER_MEMINFO);
+		}
+		if (cmdv & IOCTL_OTRACER_TASKINFO) {
+			tasks_test_saved();
+			cmdv &= (~IOCTL_OTRACER_TASKINFO);
+		}
+		if (cmdv & IOCTL_OTRACER_ALLINFO) {
+			backtrace_test_saved();
+			meminfo_test_saved();
+			tasks_test_saved();
+			cmdv &= (~IOCTL_OTRACER_ALLINFO);
+		}
+		if (cmdv & IOCTL_OTRACER_PANIC) {
+			pr_info("ioctl panic reboot\n");
+			panic("android");
+			cmdv &= (~IOCTL_OTRACER_PANIC);
+		}
+	}
+end:
+	return 0;
+}
+static int otracer_open(struct inode *inode, struct file *file)
+{
+	pr_info("%s\n", __func__);
+	return nonseekable_open(inode, file);
+}
+static int otracer_close(struct inode *inode, struct file *file)
+{
+	pr_info("%s\n", __func__);
+	return 0;
+}
+static const struct file_operations otracer_fops = {
+	.owner = THIS_MODULE,
+	.open = otracer_open,
+	.release = otracer_close,
+	.read = otracer_read,
+	.write = otracer_write,
+	.unlocked_ioctl = otracer_ioctl,
+};
+
+static struct miscdevice otracer_misc = {
+	.minor = MISC_DYNAMIC_MINOR,
+	.name = "otracer",
+	.fops = &otracer_fops,
+};
+static int otrace_proc_show(struct seq_file *m, void *v)
+{
+	seq_printf(m, "\notrace_on:%d\n", is_otrace_on());
+	return 0;
+}
+static int otrace_proc_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, otrace_proc_show, NULL);
+}
+static ssize_t otrace_proc_write(struct file *file, const char __user *buffer,
+				 size_t count, loff_t *pos)
+{
+	unsigned char *lbuf;
+	size_t local_count;
+	unsigned long val;
+	ssize_t ret;
+
+	if (count <= 0)
+		return 0;
+
+#define LBUFSIZE 1200UL
+	lbuf = kmalloc(LBUFSIZE, GFP_KERNEL);
+	if (!lbuf)
+		return 0;
+
+	local_count = (LBUFSIZE - 1) > count?count:(LBUFSIZE - 1);
+	if (copy_from_user(lbuf, buffer, local_count) != 0) {
+		kfree(lbuf);
+		return -EFAULT;
+	}
+
+	ret = kstrtoul(lbuf, 10, &val);
+	if (ret)
+		return ret;
+
+	if (val == 7978)
+		otrace_on = 1;
+	else
+		otrace_on = 0;
+
+	pr_info("val:%ld, otrace_on:%d\n", val, otrace_on);
+
+	kfree(lbuf);
+	return count;
+}
+
+
+
+static const struct file_operations otrace_proc_fops = {
+	.owner		= THIS_MODULE,
+	.open		= otrace_proc_open,
+	.read		= seq_read,
+	.llseek		= seq_lseek,
+	.release	= single_release,
+	.write		= otrace_proc_write,
+};
+
+static struct proc_dir_entry *otrace_entry;
+static int __init otracer_init(void)
+{
+	int ret;
+
+	ret = misc_register(&otracer_misc);
+	if (unlikely(ret)) {
+		pr_err("otracer: failed to register misc device!\n");
+		return ret;
+	}
+
+	/* Set up the proc file system */
+	otrace_entry = proc_create("otrace_on", 0644, NULL, &otrace_proc_fops);
+	if (!otrace_entry) {
+		ret = -ENOMEM;
+		goto out_misc;
+	}
+
+	pr_info("otracer: initialized\n");
+
+	return 0;
+out_misc:
+	misc_deregister(&otracer_misc);
+	return ret;
+}
+
+static void __exit otracer_exit(void)
+{
+
+	remove_proc_entry("otrace_on", NULL);
+
+	misc_deregister(&otracer_misc);
+
+	pr_info("otracer: exit\n");
+}
+
+module_init(otracer_init);
+module_exit(otracer_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_DESCRIPTION("oem tracer");
+MODULE_AUTHOR("Andy");
+
+
diff --git a/drivers/oneplus/oem_trace.h b/drivers/oneplus/oem_trace.h
new file mode 100644
index 0000000000000000000000000000000000000000..d7105943d7466eb156cd76eb41eee7082c02e8c2
--- /dev/null
+++ b/drivers/oneplus/oem_trace.h
@@ -0,0 +1,10 @@
+/*add by jiachenghui for support oem trace,2015/05/09*/
+#ifndef _OEM_TRACE_H
+#define _OEM_TRACE_H
+
+#include <linux/ioctl.h>
+
+#define IOCTL_TRACE_UPDATE_REBOOTFLAG             _IO('t', 3)
+
+
+#endif
diff --git a/drivers/oneplus/wb_kernel_log.c b/drivers/oneplus/wb_kernel_log.c
new file mode 100644
index 0000000000000000000000000000000000000000..ad7f79de1412efd67c39a9715858df14c3254a8d
--- /dev/null
+++ b/drivers/oneplus/wb_kernel_log.c
@@ -0,0 +1,117 @@
+/*
+ * This program is used to reserve kernel log in kernel
+ */
+
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/kernel.h>
+#include <linux/fs.h>
+#include <linux/file.h>
+#include <linux/types.h>
+#include <linux/unistd.h>
+#include <linux/uaccess.h>
+#include <linux/vmalloc.h>
+#include <linux/slab.h>
+#include <linux/buffer_head.h>
+
+MODULE_LICENSE("Dual BSD/GPL");
+
+#define LOG_RESOURCE "/dev/kmsg"
+#define LOG_TARGET "/dev/block/by-name/reserve1" //reserve1 partition
+#define LOG_SIZE 655360 //log limit size
+#define WB_BLOCK_SIZE 4096
+
+struct delayed_work wb_workq;
+
+void wb_workqueue_handler(struct work_struct *work)
+{
+	struct file *log_res_filp = NULL;
+	struct file *log_tar_filp = NULL;
+	char *buf = NULL;
+	int write_size = 0;
+	unsigned int ret = 0;
+	unsigned int stop_size = 0;
+
+	log_res_filp = filp_open(LOG_RESOURCE, O_RDONLY, 0600);
+	if (IS_ERR(log_res_filp)) {
+		ret = PTR_ERR(log_res_filp);
+		log_res_filp = NULL;
+		/*
+		 * pr_info("[Op_kernel_log] Open fail %s error number is %d\n",
+		 * LOG_RESOURCE, ret);
+		 */
+		goto out;
+	}
+
+	log_tar_filp = filp_open(LOG_TARGET, O_RDWR, 0600);
+	if (IS_ERR(log_tar_filp)) {
+		ret = PTR_ERR(log_tar_filp);
+		log_tar_filp = NULL;
+		/*
+		 * pr_info("[Op_kernel_log] Open fail %s error number is %d\n",
+		 * LOG_TARGET, ret);
+		 */
+		goto out;
+	}
+
+	log_res_filp->f_pos = 0;
+	log_tar_filp->f_pos = 0;
+
+	buf = vmalloc(WB_BLOCK_SIZE);
+	if (!buf)
+		goto out;
+	memset(buf, 0, WB_BLOCK_SIZE);
+
+	pr_info("[Op_kernel_log] syncing...\n");
+
+	while ((ret = vfs_read(log_res_filp, buf, WB_BLOCK_SIZE,
+		&log_res_filp->f_pos)) > 0) {
+
+		write_size = 0;
+
+		if ((stop_size + ret) > LOG_SIZE) {
+			pr_info("[Op_kernel_log] Record stop\n");
+			break;
+		}
+
+		while (ret) {
+			write_size = vfs_write
+				(log_tar_filp, buf, ret, &log_tar_filp->f_pos);
+			if (write_size <= 0) {
+				pr_info("[Op_kernel_log] Write back log fail\n");
+				goto out;
+			}
+			stop_size += write_size;
+			ret -= write_size;
+		}
+		memset(buf, 0, WB_BLOCK_SIZE);
+	}
+
+out:
+	if (buf != NULL)
+		kvfree(buf);
+	if (log_res_filp != NULL)
+		filp_close(log_res_filp, NULL);
+	if (log_tar_filp != NULL)
+		filp_close(log_tar_filp, NULL);
+	if (stop_size == 0)
+		schedule_delayed_work(&wb_workq, HZ/10);
+	else {
+		cancel_delayed_work_sync(&wb_workq);
+		pr_info
+			("[Op_kernel_log]Stop write back from work queue\n");
+	}
+}
+
+static int kernel_log_wb_int(void)
+{
+	pr_info("[Op_kernel_log] Start init\n");
+	INIT_DELAYED_WORK(&wb_workq, wb_workqueue_handler);
+	schedule_delayed_work(&wb_workq, HZ/10);
+	pr_info("[Op_kernel_log] End init\n");
+	return 0;
+}
+
+pure_initcall(kernel_log_wb_int);
diff --git a/drivers/param_read_write/Kconfig b/drivers/param_read_write/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..5527917c6708815ce7e6535eeba72a60459ed660
--- /dev/null
+++ b/drivers/param_read_write/Kconfig
@@ -0,0 +1,6 @@
+config PARAM_READ_WRITE
+	bool "Param partition read/write support"
+	default n
+	help
+		if you want to read/write the param partition in kernel,
+		then you must say Y here.
diff --git a/drivers/param_read_write/Makefile b/drivers/param_read_write/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..449ee0926bbafbecf70baf6ae91fd032759d55ad
--- /dev/null
+++ b/drivers/param_read_write/Makefile
@@ -0,0 +1,2 @@
+obj-y 	+= param_read_write.o
+
diff --git a/drivers/param_read_write/param_read_write.c b/drivers/param_read_write/param_read_write.c
new file mode 100644
index 0000000000000000000000000000000000000000..dd8626294cfc53c54daf1ca357faf7b8213b6d83
--- /dev/null
+++ b/drivers/param_read_write/param_read_write.c
@@ -0,0 +1,401 @@
+/*
+ * drivers/param_read_write/param_read_write.c
+ *
+ * hefaxi@filesystems,2015/04/30
+ *
+ * This program is used to read/write param partition in kernel
+ */
+
+#include <linux/mm.h>
+#include <linux/fs.h>
+#include <linux/file.h>
+#include <linux/uaccess.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/moduleparam.h>
+#include <linux/device.h>
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+#include <linux/ctype.h>
+#include <linux/miscdevice.h>
+#include <linux/proc_fs.h>
+#include <linux/param_rw.h>
+
+
+#define PARAM_PARTITION "/dev/block/bootdevice/by-name/param"
+#define READ_CHUNK_MAX_SIZE (1024)
+#define WRITE_CHUNK_MAX_SIZE (1024)
+
+typedef struct{
+	phys_addr_t paddr;
+	size_t size;
+	void *vaddr;
+	void *buffer;
+	struct mutex mutex;
+}param_ram_zone_t;
+
+static DEFINE_MUTEX(param_lock);
+static bool param_init_done = 0;
+static param_ram_zone_t param_ram_zone;
+
+static int write_param_partition(const char *buf, unsigned long count,
+            loff_t offset)
+{
+	struct file *filp;
+	mm_segment_t fs;
+	int ret = 0;
+
+	filp = filp_open(PARAM_PARTITION,O_RDWR|O_SYNC,0);
+	if(IS_ERR(filp)) {
+	    ret = PTR_ERR(filp);
+		pr_err("open file %s failed.(%d)\n",PARAM_PARTITION,ret);
+		return ret;
+	}
+
+	fs = get_fs();
+	set_fs(get_ds());
+
+	ret = filp->f_op->llseek(filp, offset, SEEK_SET);
+	if(ret < 0){
+		pr_err("%s: llseek failed.(%d)\n",__func__,ret);
+		goto out;
+	}
+	//ret = filp->f_op->write(filp,(char __user *)buf,count,&filp->f_pos);
+	ret = vfs_write(filp, (char __user *)buf, count, &filp->f_pos);
+
+out:
+	set_fs(fs);
+	filp_close(filp,NULL);
+	return ret;
+}
+
+int get_param_by_index_and_offset(uint32 sid_index,
+            uint32 offset, void * buf, int length)
+{
+    int ret = length;
+    uint32 file_offset;
+	mutex_lock(&param_ram_zone.mutex);
+	pr_debug("%s[%d]  sid_index = %d offset = %d buf = %p length = %d\n",
+			__func__, __LINE__,sid_index,offset,buf,length);
+
+    file_offset = PARAM_SID_LENGTH*sid_index+ offset;
+
+	if (buf && ((offset + length) <= PARAM_SID_LENGTH) &&
+			(file_offset + length) <=  param_ram_zone.size)
+		memcpy(buf,(param_ram_zone.buffer +file_offset), length);
+	else{
+		pr_info("%s:invaild argument, sid_index=%d offset=%d buf=%p length=%d\n",
+				__func__, sid_index, offset, buf, length);
+		ret = -EINVAL;
+	}
+
+	mutex_unlock(&param_ram_zone.mutex);
+	return ret;
+}
+EXPORT_SYMBOL(get_param_by_index_and_offset);
+
+int set_param_by_index_and_offset(uint32 sid_index,
+        uint32 offset, void * buf, int length)
+{
+    int ret;
+    uint32 file_offset;
+	mutex_lock(&param_ram_zone.mutex);
+	pr_info("%s[%d]sid_index = %d offset = %d buf = %p length = %d\n",
+			__func__, __LINE__,sid_index,offset,buf,length);
+
+    file_offset = PARAM_SID_LENGTH*sid_index + offset;
+
+	if (buf && ((offset + length) <= PARAM_SID_LENGTH) &&
+			(file_offset + length) <=  param_ram_zone.size)
+		memcpy((param_ram_zone.buffer+file_offset),buf,length);
+	else{
+		pr_info("%s:invaild argument,sid_index=%d offset=%d buf=%p length=%d\n",
+		      __func__,sid_index,offset,buf,length);
+		ret = -EINVAL;
+		goto out;
+	}
+
+    ret = write_param_partition((param_ram_zone.buffer+file_offset),
+                    length,file_offset);
+	if ( ret < 0){
+		pr_info("Error write param partition.(%d)\n",ret);
+	}
+out:
+	mutex_unlock(&param_ram_zone.mutex);
+	return ret;
+}
+EXPORT_SYMBOL(set_param_by_index_and_offset);
+
+static void *persistent_ram_vmap(phys_addr_t start, size_t size)
+{
+	struct page **pages;
+	phys_addr_t page_start;
+	unsigned int page_count;
+	pgprot_t prot;
+	unsigned int i;
+	void *vaddr;
+
+	page_start = start - offset_in_page(start);
+	page_count = DIV_ROUND_UP(size + offset_in_page(start), PAGE_SIZE);
+
+	/* prot = pgprot_noncached(PAGE_KERNEL); */
+	prot = pgprot_writecombine(PAGE_KERNEL);
+
+	pages = kmalloc(sizeof(struct page *) * page_count, GFP_KERNEL);
+	if (!pages) {
+		pr_err("%s: Failed to allocate array for %u pages\n", __func__,
+				page_count);
+		return NULL;
+	}
+
+	for (i = 0; i < page_count; i++) {
+		phys_addr_t addr = page_start + i * PAGE_SIZE;
+		pages[i] = pfn_to_page(addr >> PAGE_SHIFT);
+	}
+	vaddr = vmap(pages, page_count, VM_MAP, prot);
+	kfree(pages);
+	return vaddr;
+}
+
+static int param_ram_buffer_map(phys_addr_t start, phys_addr_t size,
+		param_ram_zone_t *prz)
+{
+	prz->paddr = start;
+	prz->size = size;
+	prz->vaddr = persistent_ram_vmap(start, size);
+
+	if (!prz->vaddr) {
+		pr_err("%s: Failed to map 0x%llx pages at 0x%llx\n", __func__,
+				(unsigned long long)size, (unsigned long long)start);
+		return -ENOMEM;
+	}
+
+	prz->buffer = prz->vaddr + offset_in_page(start);
+	return 0;
+}
+
+static ssize_t param_read(struct file *file, char __user *buff,
+			size_t count, loff_t *pos)
+{
+	void * temp_buffer;
+	int chunk_sz;
+	int copied;
+	int left;
+	int ret;
+
+	if (mutex_lock_interruptible(&param_lock))
+		return -ERESTARTSYS;
+
+	chunk_sz = count < READ_CHUNK_MAX_SIZE ? count : READ_CHUNK_MAX_SIZE;
+	temp_buffer = kzalloc(chunk_sz, GFP_KERNEL);
+
+	if (temp_buffer == NULL)
+		return -ENOMEM;
+
+	left = count;
+	copied = 0;
+
+	while (left) {
+		chunk_sz = (left <= READ_CHUNK_MAX_SIZE) ?
+			left : READ_CHUNK_MAX_SIZE;
+		ret = get_param_by_index_and_offset(*pos/PARAM_SID_LENGTH,
+				*pos%PARAM_SID_LENGTH, temp_buffer, chunk_sz);
+
+		if (ret < 0) {
+			pr_err("get_param_by_index_and_offset fail %d\n", ret);
+			goto out;
+		}
+
+		if (copy_to_user(buff + copied, temp_buffer, chunk_sz)) {
+			ret =  -EFAULT;
+			pr_info("copy_to_user failure\n");
+			goto out;
+		}
+
+		*pos += chunk_sz;
+		left -= chunk_sz;
+		copied += chunk_sz;
+	}
+
+out:
+	kfree(temp_buffer);
+	mutex_unlock(&param_lock);
+	return copied;
+}
+
+static ssize_t param_write(struct file *file, const char __user *buff,
+		size_t count, loff_t *pos)
+{
+
+	void * temp_buffer;
+	int chunk_sz;
+	int written;
+	int left;
+	int ret;
+	if (mutex_lock_interruptible(&param_lock))
+		return -ERESTARTSYS;
+
+	chunk_sz = count < WRITE_CHUNK_MAX_SIZE ? count : WRITE_CHUNK_MAX_SIZE;
+	temp_buffer = kzalloc(chunk_sz, GFP_KERNEL);
+
+	if (temp_buffer == NULL)
+		return -ENOMEM;
+
+	left = count;
+	written = 0;
+
+	while (left > 0) {
+		chunk_sz = (left <= WRITE_CHUNK_MAX_SIZE) ?
+					left : WRITE_CHUNK_MAX_SIZE;
+		ret = copy_from_user(temp_buffer, buff + written, chunk_sz);
+		if (ret < 0) {
+			pr_info("copy_from_user failure %d\n", ret);
+			goto out;
+		}
+
+		ret = set_param_by_index_and_offset(*pos / PARAM_SID_LENGTH,
+				*pos % PARAM_SID_LENGTH, temp_buffer, chunk_sz);
+
+		if (ret < 0) {
+			pr_err("set_param_by_index_and_offset failure %d\n",
+					ret);
+			goto out;
+		}
+
+		*pos += chunk_sz;
+		left -= chunk_sz;
+		written += chunk_sz;
+	}
+out:
+	kfree(temp_buffer);
+	mutex_unlock(&param_lock);
+	return written;
+}
+
+static const struct file_operations param_fops = {
+	.owner          = THIS_MODULE,
+	.read           = param_read,
+	.write          = param_write,
+	.llseek		= default_llseek,
+};
+
+struct miscdevice param_misc = {
+	.minor = MISC_DYNAMIC_MINOR,
+	.name = "param",
+	.fops = &param_fops,
+};
+
+static int __init param_core_init(void)
+{
+
+	if(param_ram_buffer_map((phys_addr_t)param_ram_zone.paddr,
+	        param_ram_zone.size, (param_ram_zone_t *)&param_ram_zone)){
+		pr_err("param_ram_buffer_map failred\n");
+		return -1;
+	}
+	mutex_init(&param_ram_zone.mutex);
+
+	param_init_done= 1;
+	return 0;
+}
+pure_initcall(param_core_init);
+
+static int __init param_device_init(void)
+{
+    int ret;
+    ret = misc_register(&param_misc);
+    if(ret){
+        pr_err("misc_register failure %d\n",ret);
+        return -1;
+    }
+    return ret;
+}
+device_initcall(param_device_init);
+
+void init_param_mem_base_size(phys_addr_t base, unsigned long size)
+{
+	param_ram_zone.paddr = base;
+	param_ram_zone.size = size;
+}
+EXPORT_SYMBOL(init_param_mem_base_size);
+
+/*
+*Add more function here
+*
+*/
+
+int restart_08_count;
+int add_restart_08_count(void)
+{
+	int ret;
+
+	ret = get_param_by_index_and_offset(9, 0x15c,
+		&restart_08_count, sizeof(restart_08_count));
+
+	restart_08_count = restart_08_count + 1;
+
+	ret = set_param_by_index_and_offset(9, 0x15c,
+		&restart_08_count, sizeof(restart_08_count));
+
+	if (ret < 0)
+		pr_info("%s[%d]  failed!\n", __func__, __LINE__);
+
+	return ret;
+}
+EXPORT_SYMBOL(add_restart_08_count);
+
+static int param_get_restart_08_count(char *val, const struct kernel_param *kp)
+{
+
+	int cnt = 0;
+	int ret;
+
+	ret = get_param_by_index_and_offset(9, 0x15c,
+		&restart_08_count, sizeof(restart_08_count));
+
+	if (ret < 0)
+		pr_info("%s[%d]  failed!\n", __func__, __LINE__);
+
+	cnt = snprintf(val, 4, "%d", restart_08_count);
+
+	return cnt;
+}
+module_param_call(restart_08_count, NULL, param_get_restart_08_count, &restart_08_count, 0644);
+
+int restart_other_count=0;
+int add_restart_other_count(void)
+{
+	int ret;
+
+	ret = get_param_by_index_and_offset(9, 0x160,
+		&restart_other_count, sizeof(restart_other_count));
+
+	restart_other_count = restart_other_count + 1;
+
+	ret = set_param_by_index_and_offset(9, 0x160,
+		&restart_other_count, sizeof(restart_other_count));
+
+	if (ret < 0)
+		pr_info("%s[%d]  failed!\n", __func__, __LINE__);
+
+	return ret;
+}
+EXPORT_SYMBOL(add_restart_other_count);
+static int param_get_restart_other_count(char *val, const struct kernel_param *kp)
+{
+
+	int cnt = 0;
+	int ret;
+
+	ret = get_param_by_index_and_offset(9, 0x160,
+		&restart_other_count, sizeof(restart_other_count));
+
+	if (ret < 0)
+		pr_info("%s[%d]  failed!\n", __func__, __LINE__);
+
+	cnt = snprintf(val, 4, "%d", restart_other_count);
+
+	return cnt;
+}
+module_param_call(restart_other_count, NULL, param_get_restart_other_count, &restart_other_count, 0644);
+//end
diff --git a/drivers/phy/qualcomm/phy-qcom-ufs.c b/drivers/phy/qualcomm/phy-qcom-ufs.c
index 6028f6ec4891935bbdc02e8c0c9f70f40cba0145..91ad4426828c9385baf65ef8865a2f07418518f0 100644
--- a/drivers/phy/qualcomm/phy-qcom-ufs.c
+++ b/drivers/phy/qualcomm/phy-qcom-ufs.c
@@ -455,9 +455,26 @@ static int ufs_qcom_phy_disable_vreg(struct device *dev,
 {
 	int ret = 0;
 
-	if (!vreg || !vreg->enabled || vreg->is_always_on)
+	if (!vreg || !vreg->enabled)
 		goto out;
 
+	if (vreg->is_always_on) {
+		/* voting 0 uA load will keep regulator in LPM mode */
+		ret = regulator_set_load(vreg->reg, 0);
+		if (ret >= 0) {
+			/*
+			 * regulator_set_load() returns new regulator
+			 * mode upon success.
+			 */
+			ret = 0;
+		} else {
+			dev_err(dev, "%s: %s set optimum mode(uA_load=0) failed, err=%d\n",
+					__func__, vreg->name, ret);
+		}
+
+		goto out;
+	}
+
 	ret = regulator_disable(vreg->reg);
 
 	if (!ret) {
diff --git a/drivers/pinctrl/qcom/pinctrl-msm.c b/drivers/pinctrl/qcom/pinctrl-msm.c
index b25503a13c6ea77ba26f63402a5196a0a3cc8092..e3a9e6f239f3442ed7851ace753130c76a7c40ef 100644
--- a/drivers/pinctrl/qcom/pinctrl-msm.c
+++ b/drivers/pinctrl/qcom/pinctrl-msm.c
@@ -589,6 +589,7 @@ static void msm_gpio_dbg_show_one(struct seq_file *s,
 	pull = (ctl_reg >> g->pull_bit) & 3;
 
 	seq_printf(s, " %-8s: %-3s %d", g->name, is_out ? "out" : "in", func);
+	seq_printf(s, " %s", chip->get(chip, offset) ? "hi":"lo");
 	seq_printf(s, " %dmA", msm_regval_to_drive(drive));
 	seq_printf(s, " %s", pulls[pull]);
 }
@@ -597,8 +598,14 @@ static void msm_gpio_dbg_show(struct seq_file *s, struct gpio_chip *chip)
 {
 	unsigned gpio = chip->base;
 	unsigned i;
-
+	seq_puts(s, " name     dir f val drv pull \n");
 	for (i = 0; i < chip->ngpio; i++, gpio++) {
+
+        if( gpio ==0 || gpio ==1 || gpio ==2 || gpio == 3 ||
+            gpio ==4 || gpio ==5 || gpio ==83 || gpio == 84 ||
+            gpio ==126 || gpio ==127 || gpio ==128 || gpio == 129)
+            continue;
+
 		msm_gpio_dbg_show_one(s, NULL, chip, i, gpio);
 		seq_puts(s, "\n");
 	}
diff --git a/drivers/pinctrl/qcom/pinctrl-spmi-gpio.c b/drivers/pinctrl/qcom/pinctrl-spmi-gpio.c
index c8a416f6443f3a2a50ee2273d8e3f417bf96535e..bcc90e76c3d1cc8ebc97d3fb8a6184d6a823b8f4 100644
--- a/drivers/pinctrl/qcom/pinctrl-spmi-gpio.c
+++ b/drivers/pinctrl/qcom/pinctrl-spmi-gpio.c
@@ -800,6 +800,8 @@ static void pmic_gpio_dbg_show(struct seq_file *s, struct gpio_chip *chip)
 	struct pmic_gpio_state *state = gpiochip_get_data(chip);
 	unsigned i;
 
+	seq_puts(s, "\n name  : dir  func    p_s        biases              buffer_types  val strength atest dtest\n");
+
 	for (i = 0; i < chip->ngpio; i++) {
 		pmic_gpio_config_dbg_show(state->ctrl, s, i);
 		seq_puts(s, "\n");
diff --git a/drivers/platform/msm/gsi/gsi.c b/drivers/platform/msm/gsi/gsi.c
index c5415037ab7163131946f1def1728bcd07ea37e9..f28cf5a44e8ce72699c289045d189dfb98854f4e 100644
--- a/drivers/platform/msm/gsi/gsi.c
+++ b/drivers/platform/msm/gsi/gsi.c
@@ -25,7 +25,7 @@
 #define GSI_CMD_TIMEOUT (5*HZ)
 #define GSI_START_CMD_TIMEOUT_MS 1000
 #define GSI_CMD_POLL_CNT 5
-#define GSI_STOP_CMD_TIMEOUT_MS 200
+#define GSI_STOP_CMD_TIMEOUT_MS 500
 #define GSI_MAX_CH_LOW_WEIGHT 15
 
 #define GSI_STOP_CMD_POLL_CNT 4
@@ -2797,6 +2797,8 @@ int gsi_stop_channel(unsigned long chan_hdl)
 
 free_lock:
 	mutex_unlock(&gsi_ctx->mlock);
+	if (res == -GSI_STATUS_TIMED_OUT)
+		BUG();
 	return res;
 }
 EXPORT_SYMBOL(gsi_stop_channel);
diff --git a/drivers/platform/msm/ipa/ipa_v3/ipa_pm.c b/drivers/platform/msm/ipa/ipa_v3/ipa_pm.c
index 96c00616f94be01ae94cfac9e9643ab959105aa6..f28f230fb5a163e2cfadb38183f66c8dd20300ec 100644
--- a/drivers/platform/msm/ipa/ipa_v3/ipa_pm.c
+++ b/drivers/platform/msm/ipa/ipa_v3/ipa_pm.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -751,6 +751,8 @@ int ipa_pm_register(struct ipa_pm_register_params *params, u32 *hdl)
 	wlock = &client->wlock;
 	wakeup_source_init(wlock, client->name);
 
+	init_completion(&client->complete);
+
 	/* add client to exception list */
 	if (add_client_to_exception_list(*hdl)) {
 		ipa_pm_deregister(*hdl);
@@ -945,7 +947,7 @@ static int ipa_pm_activate_helper(struct ipa_pm_client *client, bool sync)
 	}
 
 	client->state = IPA_PM_ACTIVATE_IN_PROGRESS;
-	init_completion(&client->complete);
+	reinit_completion(&client->complete);
 	queue_work(ipa_pm_ctx->wq, &client->activate_work);
 	spin_unlock_irqrestore(&client->state_lock, flags);
 	IPA_PM_DBG_STATE(client->hdl, client->name, client->state);
diff --git a/drivers/platform/msm/ipa/ipa_v3/ipa_qmi_service.c b/drivers/platform/msm/ipa/ipa_v3/ipa_qmi_service.c
index 0bdbf3caaf631c418e779e944be19d3b6bac91eb..7961993113c9e60bdfaf31f05b5d85df5a77a0a8 100644
--- a/drivers/platform/msm/ipa/ipa_v3/ipa_qmi_service.c
+++ b/drivers/platform/msm/ipa/ipa_v3/ipa_qmi_service.c
@@ -49,6 +49,7 @@ struct ipa3_qmi_context *ipa3_qmi_ctx;
 static bool workqueues_stopped;
 static bool ipa3_modem_init_cmplt;
 static bool first_time_handshake;
+static bool send_qmi_init_q6;
 struct mutex ipa3_qmi_lock;
 struct ipa_msg_desc {
 	uint16_t msg_id;
@@ -1091,6 +1092,8 @@ static void ipa3_q6_clnt_svc_arrive(struct work_struct *work)
 		IPAWANERR("Couldnt connect Server\n");
 		return;
 	}
+	if (!send_qmi_init_q6)
+		return;
 
 	IPAWANDBG("Q6 QMI service available now\n");
 	/* Initialize modem IPA-driver */
@@ -1147,6 +1150,7 @@ static void ipa3_q6_clnt_svc_arrive(struct work_struct *work)
 		IPAWANERR("not send indication (%d)\n",
 		ipa3_qmi_indication_fin);
 	}
+	send_qmi_init_q6 = false;
 }
 
 static void ipa3_q6_clnt_svc_exit(struct work_struct *work)
@@ -1402,6 +1406,7 @@ int ipa3_qmi_service_init(uint32_t wan_platform_type)
 	ipa3_qmi_modem_init_fin = false;
 	ipa3_qmi_indication_fin = false;
 	ipa3_modem_init_cmplt = false;
+	send_qmi_init_q6 = true;
 	workqueues_stopped = false;
 
 	if (!ipa3_svc_handle) {
@@ -1448,6 +1453,7 @@ void ipa3_qmi_service_exit(void)
 	ipa3_qmi_modem_init_fin = false;
 	ipa3_qmi_indication_fin = false;
 	ipa3_modem_init_cmplt = false;
+	send_qmi_init_q6 = true;
 }
 
 void ipa3_qmi_stop_workqueues(void)
diff --git a/drivers/platform/msm/ipa/ipa_v3/ipa_uc.c b/drivers/platform/msm/ipa/ipa_v3/ipa_uc.c
index 2c5a7ef7f9b3ad4a4e759c0e24a75d1d0a830bcc..b1d976b13e6b0ea05fe4dd9beb8f300749fdf184 100644
--- a/drivers/platform/msm/ipa/ipa_v3/ipa_uc.c
+++ b/drivers/platform/msm/ipa/ipa_v3/ipa_uc.c
@@ -526,11 +526,13 @@ static void ipa3_uc_response_hdlr(enum ipa_irq_type interrupt,
 
 void ipa3_uc_map_cntr_reg_notify(void)
 {
+	IPA_ACTIVE_CLIENTS_INC_SPECIAL("QMI_IPA_UC");
 	IPAWANDBG("complete the mapping of G_RD_CNTR register\n");
 	ipa3_uc_send_cmd(0,
 		IPA_CPU_2_HW_CMD_DEBUG_GET_INFO,
 		IPA_HW_2_CPU_RESPONSE_CMD_COMPLETED,
 		false, 6*HZ);
+	IPA_ACTIVE_CLIENTS_DEC_SPECIAL("QMI_IPA_UC");
 }
 
 static int ipa3_uc_send_cmd_64b_param(u32 cmd_lo, u32 cmd_hi, u32 opcode,
diff --git a/drivers/power/reset/msm-poweroff.c b/drivers/power/reset/msm-poweroff.c
index ba2e5faffd36a74ba82ffb58d95cbb87653254e0..2e9b01fe62e4c274bf913472740087cd50b3776b 100644
--- a/drivers/power/reset/msm-poweroff.c
+++ b/drivers/power/reset/msm-poweroff.c
@@ -34,6 +34,7 @@
 #include <soc/qcom/restart.h>
 #include <soc/qcom/watchdog.h>
 #include <soc/qcom/minidump.h>
+#include "msm-poweroff.h"
 
 #define EMERGENCY_DLOAD_MAGIC1    0x322A4F99
 #define EMERGENCY_DLOAD_MAGIC2    0xC67E4350
@@ -103,6 +104,11 @@ struct reset_attribute {
 module_param_call(download_mode, dload_set, param_get_int,
 			&download_mode, 0644);
 
+int oem_get_download_mode(void)
+{
+	return download_mode && (dload_type & SCM_DLOAD_FULLDUMP);
+}
+
 static int panic_prep_restart(struct notifier_block *this,
 			      unsigned long event, void *ptr)
 {
@@ -121,7 +127,6 @@ int scm_set_dload_mode(int arg1, int arg2)
 		.args[1] = arg2,
 		.arginfo = SCM_ARGS(2),
 	};
-
 	if (!scm_dload_supported) {
 		if (tcsr_boot_misc_detect)
 			return scm_io_write(tcsr_boot_misc_detect, arg1);
@@ -136,18 +141,27 @@ int scm_set_dload_mode(int arg1, int arg2)
 static void set_dload_mode(int on)
 {
 	int ret;
+	u64 read_ret;
+	pr_info("set_dload_mode %s\n", on ? "ON" : "OFF");
 
+	pr_err("[MDM] on [%d] dload_mode_addr [%p]\n", on, dload_mode_addr);
 	if (dload_mode_addr) {
-		__raw_writel(on ? 0xE47B337D : 0, dload_mode_addr);
-		__raw_writel(on ? 0xCE14091A : 0,
-		       dload_mode_addr + sizeof(unsigned int));
+		pr_err("[MDM] modem_5G_panic is [%d]\n", modem_5G_panic);
+		if (modem_5G_panic == true) {
+			__raw_writel(on ? 0xABCDABCD : 0, dload_mode_addr);
+			pr_err("[MDM] modem_5G_panic enter\n");
+		} else {
+			__raw_writel(on ? 0x0 : 0, dload_mode_addr);
+		}
 		/* Make sure the download cookie is updated */
 		mb();
+		read_ret = __raw_readl(dload_mode_addr);
+		pr_err("[MDM] read_ret is [0x%X]\n", read_ret);
 	}
 
 	ret = scm_set_dload_mode(on ? dload_type : 0, 0);
 	if (ret)
-		pr_err("Failed to set secure DLOAD mode: %d\n", ret);
+		pr_err("[MDM] Failed to set secure DLOAD mode: %d\n", ret);
 
 	dload_mode_enabled = on;
 }
@@ -298,7 +312,31 @@ static void msm_restart_prepare(const char *cmd)
 		qpnp_pon_system_pwr_off(PON_POWER_OFF_HARD_RESET);
 
 	if (cmd != NULL) {
-		if (!strncmp(cmd, "bootloader", 10)) {
+		if (!strncmp(cmd, "rf", 2)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_RF);
+			__raw_writel(RF_MODE, restart_reason);
+		} else if (!strncmp(cmd, "wlan", 4)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_WLAN);
+			__raw_writel(WLAN_MODE, restart_reason);
+		} else if (!strncmp(cmd, "mos", 3)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_MOS);
+			__raw_writel(MOS_MODE, restart_reason);
+		} else if (!strncmp(cmd, "ftm", 3)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_FACTORY);
+			__raw_writel(FACTORY_MODE, restart_reason);
+		} else if (!strncmp(cmd, "kernel", 6)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_KERNEL);
+			__raw_writel(KERNEL_MODE, restart_reason);
+		} else if (!strncmp(cmd, "modem", 5)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_MODEM);
+			__raw_writel(MODEM_MODE, restart_reason);
+		} else if (!strncmp(cmd, "android", 7)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_ANDROID);
+			__raw_writel(ANDROID_MODE, restart_reason);
+		} else if (!strncmp(cmd, "aging", 5)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_AGING);
+			__raw_writel(AGING_MODE, restart_reason);
+		} else if (!strncmp(cmd, "bootloader", 10)) {
 			qpnp_pon_set_restart_reason(
 				PON_RESTART_REASON_BOOTLOADER);
 			__raw_writel(0x77665500, restart_reason);
@@ -332,6 +370,30 @@ static void msm_restart_prepare(const char *cmd)
 					     restart_reason);
 		} else if (!strncmp(cmd, "edl", 3)) {
 			enable_emergency_dload_mode();
+		} else if (!strncmp(cmd, "rf", 2)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_RF);
+			__raw_writel(RF_MODE, restart_reason);
+		} else if (!strncmp(cmd, "wlan", 4)){
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_WLAN);
+			__raw_writel(WLAN_MODE, restart_reason);
+		} else if (!strncmp(cmd, "mos", 3)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_MOS);
+			__raw_writel(MOS_MODE, restart_reason);
+		} else if (!strncmp(cmd, "ftm", 3)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_FACTORY);
+			__raw_writel(FACTORY_MODE, restart_reason);
+		} else if (!strncmp(cmd, "kernel", 6)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_KERNEL);
+			__raw_writel(KERNEL_MODE, restart_reason);
+		} else if (!strncmp(cmd, "modem", 5)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_MODEM);
+			__raw_writel(MODEM_MODE, restart_reason);
+		} else if (!strncmp(cmd, "android", 7)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_ANDROID);
+			__raw_writel(ANDROID_MODE, restart_reason);
+		} else if (!strncmp(cmd, "aging", 5)) {
+			qpnp_pon_set_restart_reason(PON_RESTART_REASON_AGING);
+			__raw_writel(AGING_MODE, restart_reason);
 		} else {
 			__raw_writel(0x77665501, restart_reason);
 		}
diff --git a/drivers/power/reset/msm-poweroff.h b/drivers/power/reset/msm-poweroff.h
new file mode 100644
index 0000000000000000000000000000000000000000..52198919a147ca6b7421336c89dad496912a5200
--- /dev/null
+++ b/drivers/power/reset/msm-poweroff.h
@@ -0,0 +1,2 @@
+extern int scm_set_dload_mode(int arg1, int arg2);
+extern bool modem_5G_panic;
diff --git a/drivers/power/supply/power_supply_sysfs.c b/drivers/power/supply/power_supply_sysfs.c
index 0b6798490d1e0811a0e626a785273aa283a7d67d..a75266b20bd08180f4663126dd80349a4fdf173d 100644
--- a/drivers/power/supply/power_supply_sysfs.c
+++ b/drivers/power/supply/power_supply_sysfs.c
@@ -45,9 +45,13 @@ static const char * const power_supply_type_text[] = {
 	"USB_DCP", "USB_CDP", "USB_ACA", "USB_C",
 	"USB_PD", "USB_PD_DRP", "BrickID",
 	"USB_HVDCP", "USB_HVDCP_3", "Wireless", "USB_FLOAT",
-	"BMS", "Parallel", "Main", "Wipower", "USB_C_UFP", "USB_C_DFP",
-	"Charge_Pump",
+	"BMS", "Parallel", "Main", "Wipower",
+	"USB_C_UFP", "USB_C_DFP",
+	"Charge_Pump", "DASH",
 };
+	static const char *const cc_orientation_text[] = {
+		"Unknown", "cc1", "cc2"
+	};
 
 static const char * const power_supply_status_text[] = {
 	"Unknown", "Charging", "Discharging", "Not charging", "Full"
@@ -146,6 +150,10 @@ static ssize_t power_supply_show_property(struct device *dev,
 	else if (off == POWER_SUPPLY_PROP_TYPEC_POWER_ROLE)
 		return scnprintf(buf, PAGE_SIZE, "%s\n",
 			       power_supply_usbc_pr_text[value.intval]);
+	else if (off == POWER_SUPPLY_PROP_OEM_TYPEC_CC_ORIENTATION)
+		return snprintf(
+		buf, 255, "%s\n",
+		cc_orientation_text[value.intval]);
 	else if (off == POWER_SUPPLY_PROP_TYPEC_SRC_RP)
 		return scnprintf(buf, PAGE_SIZE, "%s\n",
 			       power_supply_typec_src_rp_text[value.intval]);
@@ -223,6 +231,27 @@ static ssize_t power_supply_store_property(struct device *dev,
 static struct device_attribute power_supply_attrs[] = {
 	/* Properties of type `int' */
 	POWER_SUPPLY_ATTR(status),
+	POWER_SUPPLY_ATTR(set_allow_read_extern_fg_iic),
+	POWER_SUPPLY_ATTR(cc_to_cv_point),
+	POWER_SUPPLY_ATTR(chg_protect_status),
+	POWER_SUPPLY_ATTR(fastchg_status_is_ok),
+	POWER_SUPPLY_ATTR(fastchg_status),
+	POWER_SUPPLY_ATTR(fastchg_starting),
+	POWER_SUPPLY_ATTR(cutoff_volt_with_charger),
+	POWER_SUPPLY_ATTR(update_lcd_is_off),
+	POWER_SUPPLY_ATTR(check_usb_unplug),
+	POWER_SUPPLY_ATTR(otg_switch),
+	POWER_SUPPLY_ATTR(hw_detect),
+	POWER_SUPPLY_ATTR(switch_dash),
+	POWER_SUPPLY_ATTR(notify_charger_set_parameter),
+	POWER_SUPPLY_ATTR(fg_capacity),
+	POWER_SUPPLY_ATTR(fg_current_now),
+	POWER_SUPPLY_ATTR(fg_voltage_now),
+	POWER_SUPPLY_ATTR(is_aging_test),
+	POWER_SUPPLY_ATTR(connecter_temp),
+	POWER_SUPPLY_ATTR(connect_disable),
+	POWER_SUPPLY_ATTR(bq_soc),
+	POWER_SUPPLY_ATTR(oem_cc_orientation),
 	POWER_SUPPLY_ATTR(charge_type),
 	POWER_SUPPLY_ATTR(health),
 	POWER_SUPPLY_ATTR(present),
diff --git a/drivers/power/supply/qcom/Kconfig b/drivers/power/supply/qcom/Kconfig
index 1a11411df083dc6b39d8305d87ad100efc3c90d5..e9459d1734a10ab48fffc1a3df7c68d09dc268be 100644
--- a/drivers/power/supply/qcom/Kconfig
+++ b/drivers/power/supply/qcom/Kconfig
@@ -1,5 +1,32 @@
 menu "Qualcomm Technologies, Inc. Charger and Fuel Gauge support"
 
+config FG_BQ27541
+	tristate "TI bq27541 fg"
+	depends on I2C
+	help
+	  Say Y here to enable the TI Fuel Gauge driver.This adds support
+	  for battery fuel gauging and state of charge of battery connected to
+	  the fuel gauge. The state of charge is reported through a BMS power
+	  supply property and also sends uevents when the capacity is updated.
+
+config OP_DEBUG_CHG
+	tristate "OP DEBUG CHARGE"
+	depends on MFD_SPMI_PMIC
+	help
+	  Enables support for the debug charging peripheral
+	  When use agingboot,can dump pmic register and
+	  print vbus vbat current information
+	  a
+
+config ONEPLUS_FASTCHG
+	tristate "ONEPLUS FAST CHARGE"
+	depends on I2C
+	help
+	  Say Y here to enable the ONEPLUS FAST CHARGE driver.This adds support
+	  for VOOC charge and state of charge of battery connected to
+	  the battery. The state of charge is reported through a battery power
+	  supply property
+
 config QPNP_FG_GEN3
 	tristate "QPNP GEN3 fuel gauge driver"
 	depends on MFD_SPMI_PMIC
diff --git a/drivers/power/supply/qcom/Makefile b/drivers/power/supply/qcom/Makefile
index 4207b049107c075936211f31c1b6e4ae06ce82cb..71e8025dde146043af422e96741f5157df53eafb 100644
--- a/drivers/power/supply/qcom/Makefile
+++ b/drivers/power/supply/qcom/Makefile
@@ -5,6 +5,8 @@ obj-$(CONFIG_SMB1351_USB_CHARGER) += smb1351-charger.o pmic-voter.o battery.o
 obj-$(CONFIG_SMB1355_SLAVE_CHARGER)   += smb1355-charger.o pmic-voter.o
 obj-$(CONFIG_QPNP_SMB2)		+= step-chg-jeita.o battery.o qpnp-smb2.o smb-lib.o pmic-voter.o storm-watch.o
 obj-$(CONFIG_SMB138X_CHARGER)	+= step-chg-jeita.o smb138x-charger.o smb-lib.o pmic-voter.o storm-watch.o battery.o
+obj-$(CONFIG_FG_BQ27541)	+= bq27541_fuelgauger.o
+obj-$(CONFIG_ONEPLUS_FASTCHG)	+= oneplus_fastchg.o op_dash_adapter.o
 obj-$(CONFIG_QPNP_QNOVO)	+= qpnp-qnovo.o battery.o
 obj-$(CONFIG_QPNP_QNOVO5)	+= qpnp-qnovo5.o battery.o
 obj-$(CONFIG_QPNP_SMB5)		+= step-chg-jeita.o battery.o qpnp-smb5.o smb5-lib.o pmic-voter.o storm-watch.o schgm-flash.o
diff --git a/drivers/power/supply/qcom/battery.c b/drivers/power/supply/qcom/battery.c
index d147466eebdb69a96b160a1cdba6caebc8ac276e..3aa33b4878b3957c55a0bfe1a242505880cc7bcf 100644
--- a/drivers/power/supply/qcom/battery.c
+++ b/drivers/power/supply/qcom/battery.c
@@ -668,6 +668,7 @@ static int pl_fcc_vote_callback(struct votable *votable, void *data,
 
 	if (!chip->main_psy)
 		return 0;
+	pr_info("total_fcc_ua=%d\n", total_fcc_ua);
 
 	if (!chip->cp_ilim_votable)
 		chip->cp_ilim_votable = find_votable("CP_ILIM");
@@ -898,7 +899,7 @@ static int pl_fv_vote_callback(struct votable *votable, void *data,
 		return 0;
 
 	pval.intval = fv_uv;
-
+	pr_info("fv_uv=%d\n", fv_uv);
 	rc = power_supply_set_property(chip->main_psy,
 			POWER_SUPPLY_PROP_VOLTAGE_MAX, &pval);
 	if (rc < 0) {
diff --git a/drivers/power/supply/qcom/bq27541_fuelgauger.c b/drivers/power/supply/qcom/bq27541_fuelgauger.c
new file mode 100644
index 0000000000000000000000000000000000000000..8742bab2e083007ba282e05121de5d56f01dbb0c
--- /dev/null
+++ b/drivers/power/supply/qcom/bq27541_fuelgauger.c
@@ -0,0 +1,2075 @@
+/* Copyright (C) 2008 Rodolfo Giometti <giometti@linux.it>
+ * Copyright (C) 2008 Eurotech S.p.A. <info@eurotech.it>
+ * Based on a previous work by Copyright (C) 2008 Texas Instruments, Inc.
+ *
+ * Copyright (c) 2011, Code Aurora Forum. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+#define pr_fmt(fmt) "BQ: %s: " fmt, __func__
+
+#include <linux/module.h>
+#include <linux/param.h>
+#include <linux/jiffies.h>
+#include <linux/workqueue.h>
+#include <linux/delay.h>
+#include <linux/platform_device.h>
+#include <linux/power_supply.h>
+#include <linux/idr.h>
+#include <linux/i2c.h>
+#include <linux/slab.h>
+#include <asm/unaligned.h>
+#include <linux/time.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
+#include <linux/regulator/machine.h>
+#include <linux/err.h>
+#include <linux/rtc.h>
+
+#ifdef CONFIG_OF
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#endif
+#include <linux/proc_fs.h>
+
+#include <linux/power/oem_external_fg.h>
+
+/* david.liu@bsp, 20161004 Add BQ27411 support */
+#define CONFIG_GAUGE_BQ27411		1
+#define DEVICE_TYPE_BQ27541		0x0541
+#define DEVICE_TYPE_BQ27411		0x0421
+#define DEVICE_BQ27541			0
+#define DEVICE_BQ27411			1
+
+#define DRIVER_VERSION			"1.1.0"
+/* Bq27541 standard data commands */
+#define BQ27541_REG_CNTL		0x00
+#define BQ27541_REG_AR			0x02
+#define BQ27541_REG_ARTTE		0x04
+#define BQ27541_REG_TEMP		0x06
+#define BQ27541_REG_VOLT		0x08
+#define BQ27541_REG_FLAGS		0x0A
+#define BQ27541_REG_NAC			0x0C
+#define BQ27541_REG_FAC			0x0e
+#define BQ27541_REG_RM			0x10
+#define BQ27541_REG_FCC			0x12
+#define BQ27541_REG_AI			0x14
+#define BQ27541_REG_TTE			0x16
+#define BQ27541_REG_TTF			0x18
+#define BQ27541_REG_SI			0x1a
+#define BQ27541_REG_STTE		0x1c
+#define BQ27541_REG_MLI			0x1e
+#define BQ27541_REG_MLTTE		0x20
+#define BQ27541_REG_AE			0x22
+#define BQ27541_REG_AP			0x24
+#define BQ27541_REG_TTECP		0x26
+#define BQ27541_REG_SOH			0x28
+#define BQ27541_REG_SOC			0x2c
+#define BQ27541_REG_NIC			0x2e
+#define BQ27541_REG_ICR			0x30
+#define BQ27541_REG_LOGIDX		0x32
+#define BQ27541_REG_LOGBUF		0x34
+
+#define BQ27541_FLAG_DSC		BIT(0)
+#define BQ27541_FLAG_FC			BIT(9)
+
+#define BQ27541_CS_DLOGEN		BIT(15)
+#define BQ27541_CS_SS		    BIT(13)
+
+#ifdef CONFIG_GAUGE_BQ27411
+/* david.liu@bsp, 20161004 Add BQ27411 support */
+/* Bq27411 standard data commands */
+#define BQ27411_REG_TEMP                0x02
+#define BQ27411_REG_VOLT                0x04
+#define BQ27411_REG_RM                  0x0c
+#define BQ27411_REG_AI                  0x10
+#define BQ27411_REG_SOC                 0x1c
+#define BQ27411_REG_HEALTH              0x20
+
+#define CONTROL_CMD                 0x00
+#define CONTROL_STATUS              0x00
+#define SEAL_POLLING_RETRY_LIMIT    100
+#define BQ27541_UNSEAL_KEY          0x11151986
+#define BQ27411_UNSEAL_KEY          0x80008000
+
+#define BQ27541_RESET_SUBCMD        0x0041
+#define BQ27411_RESET_SUBCMD        0x0042
+#define SEAL_SUBCMD                 0x0020
+
+#define BQ27411_CONFIG_MODE_POLLING_LIMIT	60
+#define BQ27411_CONFIG_MODE_BIT                 BIT(4)
+#define BQ27411_BLOCK_DATA_CONTROL		0x61
+#define BQ27411_DATA_CLASS_ACCESS		0x003e
+#define BQ27411_CC_DEAD_BAND_ID                 0x006b
+#define BQ27411_CC_DEAD_BAND_ADDR		0x42
+#define BQ27411_CHECKSUM_ADDR				0x60
+#define BQ27411_CC_DEAD_BAND_POWERUP_VALUE		0x11
+#define BQ27411_CC_DEAD_BAND_SHUTDOWN_VALUE		0x71
+
+#define BQ27411_OPCONFIGB_ID                            0x0040
+#define BQ27411_OPCONFIGB_ADDR                          0x42
+#define BQ27411_OPCONFIGB_POWERUP_VALUE                 0x07
+#define BQ27411_OPCONFIGB_SHUTDOWN_VALUE                0x0f
+
+#define BQ27411_DODATEOC_ID                           0x0024
+#define BQ27411_DODATEOC_ADDR                         0x48
+#define BQ27411_DODATEOC_POWERUP_VALUE                0x32
+#define BQ27411_DODATEOC_SHUTDOWN_VALUE               0x32
+
+#endif
+
+/* BQ27541 Control subcommands */
+#define BQ27541_SUBCMD_CTNL_STATUS  0x0000
+#define BQ27541_SUBCMD_DEVCIE_TYPE  0x0001
+#define BQ27541_SUBCMD_FW_VER  0x0002
+#define BQ27541_SUBCMD_HW_VER  0x0003
+#define BQ27541_SUBCMD_DF_CSUM 0x0004
+#define BQ27541_SUBCMD_PREV_MACW   0x0007
+#define BQ27541_SUBCMD_CHEM_ID     0x0008
+#define BQ27541_SUBCMD_BD_OFFSET   0x0009
+#define BQ27541_SUBCMD_INT_OFFSET  0x000a
+#define BQ27541_SUBCMD_CC_VER   0x000b
+#define BQ27541_SUBCMD_OCV      0x000c
+#define BQ27541_SUBCMD_BAT_INS   0x000d
+#define BQ27541_SUBCMD_BAT_REM   0x000e
+#define BQ27541_SUBCMD_SET_HIB   0x0011
+#define BQ27541_SUBCMD_CLR_HIB   0x0012
+#define BQ27541_SUBCMD_SET_SLP   0x0013
+#define BQ27541_SUBCMD_CLR_SLP   0x0014
+#define BQ27541_SUBCMD_FCT_RES   0x0015
+#define BQ27541_SUBCMD_ENABLE_DLOG  0x0018
+#define BQ27541_SUBCMD_DISABLE_DLOG 0x0019
+#define BQ27541_SUBCMD_SEALED       0x0020
+#define BQ27541_SUBCMD_ENABLE_IT    0x0021
+#define BQ27541_SUBCMD_DISABLE_IT   0x0023
+#define BQ27541_SUBCMD_CAL_MODE  0x0040
+#define BQ27541_SUBCMD_RESET     0x0041
+#define ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN   (-2731)
+#define BQ27541_INIT_DELAY   ((HZ)*1)
+#define SET_BQ_PARAM_DELAY_MS 6000
+
+
+/* Bq27411 sub commands */
+#define BQ27411_SUBCMD_CNTL_STATUS				0x0000
+#define BQ27411_SUBCMD_DEVICE_TYPE				0x0001
+#define BQ27411_SUBCMD_FW_VER                                   0x0002
+#define BQ27411_SUBCMD_DM_CODE					0x0004
+#define BQ27411_SUBCMD_CONFIG_MODE				0x0006
+#define BQ27411_SUBCMD_PREV_MACW				0x0007
+#define BQ27411_SUBCMD_CHEM_ID					0x0008
+#define BQ27411_SUBCMD_SET_HIB					0x0011
+#define BQ27411_SUBCMD_CLR_HIB					0x0012
+#define BQ27411_SUBCMD_SET_CFG					0x0013
+#define BQ27411_SUBCMD_SEALED					0x0020
+#define BQ27411_SUBCMD_RESET                                    0x0041
+#define BQ27411_SUBCMD_SOFTRESET				0x0042
+#define BQ27411_SUBCMD_EXIT_CFG                                 0x0043
+
+#define BQ27411_SUBCMD_ENABLE_DLOG				0x0018
+#define BQ27411_SUBCMD_DISABLE_DLOG				0x0019
+#define BQ27411_SUBCMD_ENABLE_IT				0x0021
+#define BQ27411_SUBCMD_DISABLE_IT				0x0023
+
+#define BQ27541_BQ27411_CMD_INVALID			0xFF
+
+
+#define ERROR_SOC  33
+#define ERROR_BATT_VOL  (3800 * 1000)
+/* If the system has several batteries we need a different name for each
+ * of them...
+ */
+static DEFINE_IDR(battery_id);
+static DEFINE_MUTEX(battery_mutex);
+
+struct bq27541_device_info;
+struct bq27541_access_methods {
+	int (*read)(u8 reg, int *rt_value, int b_single,
+			struct bq27541_device_info *di);
+};
+
+#ifdef CONFIG_GAUGE_BQ27411
+/* david.liu@bsp, 20161004 Add BQ27411 support */
+struct cmd_address {
+	u8	reg_temp;
+	u8	reg_volt;
+	u8	reg_rm;
+	u8	reg_ai;
+	u8	reg_soc;
+	u8	reg_helth;
+};
+#endif
+
+struct bq27541_device_info {
+	struct device			*dev;
+	int				id;
+	struct bq27541_access_methods	*bus;
+	struct i2c_client		*client;
+	struct work_struct		counter;
+	/* 300ms delay is needed after bq27541 is powered up
+	 * and before any successful I2C transaction
+	 */
+	struct  delayed_work		hw_config;
+	struct  delayed_work		modify_soc_smooth_parameter;
+	struct  delayed_work		battery_soc_work;
+	struct wakeup_source update_soc_wake_lock;
+	struct power_supply	*batt_psy;
+	int saltate_counter;
+	/*  Add for retry when config fail */
+	int retry_count;
+	/*  Add for get right soc when sleep long time */
+	int soc_pre;
+	int  batt_vol_pre;
+	int current_pre;
+	int health_pre;
+	unsigned long rtc_resume_time;
+	unsigned long rtc_suspend_time;
+	atomic_t suspended;
+	int temp_pre;
+	int lcd_off_delt_soc;
+	int  t_count;
+	int  temp_thr_update_count;
+
+	bool lcd_is_off;
+	bool allow_reading;
+	bool fastchg_started;
+	bool bq_present;
+	bool set_smoothing;
+	bool disable_calib_soc;
+	unsigned long	lcd_off_time;
+	unsigned long	soc_pre_time;
+	unsigned long	soc_store_time;
+#ifdef CONFIG_GAUGE_BQ27411
+	int device_type;
+	struct cmd_address cmd_addr;
+	bool modify_soc_smooth;
+	bool already_modify_smooth;
+#endif
+};
+
+#include <linux/workqueue.h>
+
+struct update_pre_capacity_data {
+	struct delayed_work work;
+	struct workqueue_struct *workqueue;
+	int suspend_time;
+};
+static struct update_pre_capacity_data update_pre_capacity_data;
+static int __debug_temp_mask;
+module_param_named(
+	debug_temp_mask, __debug_temp_mask, int, 0600
+);
+static void bq27411_modify_soc_smooth_parameter(
+	struct bq27541_device_info *di, bool is_powerup);
+
+static int bq27541_i2c_txsubcmd(u8 reg, unsigned short subcmd,
+		struct bq27541_device_info *di);
+static int bq27541_average_current(struct bq27541_device_info *di);
+
+static int bq27541_read(u8 reg, int *rt_value, int b_single,
+		struct bq27541_device_info *di)
+{
+	return di->bus->read(reg, rt_value, b_single, di);
+}
+
+/*
+ * Return the battery temperature in tenths of degree Celsius
+ * Or < 0 if something fails.
+ */
+static int bq27541_battery_temperature(struct bq27541_device_info *di)
+{
+	int ret;
+	int temp = 0;
+	int error_temp;
+	static int count;
+
+	/* Add for get right*/
+	/*soc when sleep long time */
+	if (atomic_read(&di->suspended) == 1)
+		return di->temp_pre + ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN;
+
+	if (di->allow_reading) {
+
+#ifdef CONFIG_GAUGE_BQ27411
+		/* david.liu@bsp, 20161004 Add BQ27411 support */
+		ret = bq27541_read(di->cmd_addr.reg_temp,
+				&temp, 0, di);
+#else
+		ret = bq27541_read(BQ27541_REG_TEMP, &temp, 0, di);
+#endif
+		/* Add for don't report battery*/
+		/*not connect when reading error once. */
+		if (ret) {
+			count++;
+			pr_err("error reading temperature\n");
+			if (count > 1) {
+				count = 0;
+				/* Add for it report bad*/
+				/*status when plug out battery */
+				di->temp_pre =
+				-400 - ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN;
+				error_temp = -400;
+				return error_temp;
+			} else {
+				return di->temp_pre
+				+ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN;
+			}
+		}
+		count = 0;
+	} else {
+		return di->temp_pre + ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN;
+	}
+	di->temp_pre = temp;
+	return temp + ZERO_DEGREE_CELSIUS_IN_TENTH_KELVIN;
+}
+
+/*
+ * Return the battery Voltage in milivolts
+ * Or < 0 if something fails.
+ */
+static int bq27541_battery_voltage(struct bq27541_device_info *di)
+{
+	int ret;
+	int volt = 0;
+
+	/* Add for get right soc when sleep long time */
+	if (atomic_read(&di->suspended) == 1)
+		return di->batt_vol_pre;
+
+	if (di->allow_reading) {
+#ifdef CONFIG_GAUGE_BQ27411
+		/* david.liu@bsp, 20161004 Add BQ27411 support */
+		ret = bq27541_read(di->cmd_addr.reg_volt,
+				&volt, 0, di);
+#else
+		ret = bq27541_read(BQ27541_REG_VOLT, &volt, 0, di);
+#endif
+		if (ret) {
+			pr_err("error reading voltage,ret:%d\n", ret);
+			return ret;
+		}
+	} else {
+		return di->batt_vol_pre;
+	}
+	di->batt_vol_pre = volt * 1000;
+	return volt * 1000;
+}
+
+static void bq27541_cntl_cmd(struct bq27541_device_info *di,
+		int subcmd)
+{
+	mutex_lock(&battery_mutex);
+	bq27541_i2c_txsubcmd(BQ27541_REG_CNTL, subcmd, di);
+	mutex_unlock(&battery_mutex);
+
+}
+
+/*
+ * i2c specific code
+ */
+static int bq27541_i2c_txsubcmd(u8 reg, unsigned short subcmd,
+		struct bq27541_device_info *di)
+{
+	struct i2c_msg msg;
+	unsigned char data[3];
+	int ret;
+
+	if (!di->client)
+		return -ENODEV;
+
+	memset(data, 0, sizeof(data));
+	data[0] = reg;
+	data[1] = subcmd & 0x00FF;
+	data[2] = (subcmd & 0xFF00) >> 8;
+
+	msg.addr = di->client->addr;
+	msg.flags = 0;
+	msg.len = 3;
+	msg.buf = data;
+
+	ret = i2c_transfer(di->client->adapter, &msg, 1);
+	if (ret < 0)
+		return -EIO;
+
+	return 0;
+}
+
+static int bq27541_chip_config(struct bq27541_device_info *di)
+{
+	int flags = 0, ret = 0;
+
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_CTNL_STATUS);
+	udelay(66);
+	ret = bq27541_read(BQ27541_REG_CNTL, &flags, 0, di);
+	if (ret < 0) {
+		pr_err("error reading register %02x ret = %d\n",
+				BQ27541_REG_CNTL, ret);
+		return ret;
+	}
+	udelay(66);
+
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_ENABLE_IT);
+	udelay(66);
+
+	if (!(flags & BQ27541_CS_DLOGEN)) {
+		bq27541_cntl_cmd(di, BQ27541_SUBCMD_ENABLE_DLOG);
+		udelay(66);
+	}
+
+	return 0;
+}
+
+struct bq27541_device_info *bq27541_di;
+static struct i2c_client *new_client;
+
+#define TEN_PERCENT                            10
+#define SOC_SHUTDOWN_VALID_LIMITS              19
+#define TEN_MINUTES                            600
+#define FIVE_MINUTES                           300
+#define TWO_POINT_FIVE_MINUTES                 150
+#define ONE_MINUTE                             60
+#define TWENTY_MINUTES                         1200
+#define TWENTY_PERCENT                         20
+#define TWENTY_SECS                         20
+
+
+#define CAPACITY_SALTATE_COUNTER_60            38 /* 40 1min */
+#define CAPACITY_SALTATE_COUNTER_95            78 /* 60 2.5min */
+#define CAPACITY_SALTATE_COUNTER_FULL          200 /* 150 120 5min */
+#define CAPACITY_SALTATE_COUNTER_CHARGING_TERM 30 /* 30 1min */
+#define CAPACITY_SALTATE_COUNTER               4
+#define CAPACITY_SALTATE_COUNTER_NOT_CHARGING  24 /* >=40sec */
+#define LOW_BATTERY_PROTECT_VOLTAGE  3250000
+#define CAPACITY_CALIBRATE_TIME_60_PERCENT     45 /* 45s */
+#define LOW_BATTERY_CAPACITY_THRESHOLD         20
+
+static int get_current_time(unsigned long *now_tm_sec)
+{
+	struct rtc_time tm;
+	struct rtc_device *rtc;
+	int rc;
+
+	rtc = rtc_class_open(CONFIG_RTC_HCTOSYS_DEVICE);
+	if (rtc == NULL) {
+		pr_err("%s: unable to open rtc device (%s)\n",
+				__FILE__, CONFIG_RTC_HCTOSYS_DEVICE);
+		return -EINVAL;
+	}
+
+	rc = rtc_read_time(rtc, &tm);
+	if (rc) {
+		pr_err("Error reading rtc device (%s) : %d\n",
+				CONFIG_RTC_HCTOSYS_DEVICE, rc);
+		goto close_time;
+	}
+
+	rc = rtc_valid_tm(&tm);
+	if (rc) {
+		pr_err("Invalid RTC time (%s): %d\n",
+				CONFIG_RTC_HCTOSYS_DEVICE, rc);
+		goto close_time;
+	}
+	rtc_tm_to_time(&tm, now_tm_sec);
+
+close_time:
+	rtc_class_close(rtc);
+	return rc;
+}
+
+int get_prop_pre_shutdown_soc(void)
+{
+	int soc_load;
+
+	soc_load = load_soc();
+	if (soc_load == -1)
+		return 50;
+	else
+		return soc_load;
+}
+
+static int fg_soc_calibrate(struct  bq27541_device_info *di, int soc)
+{
+	union power_supply_propval ret = {0,};
+	unsigned int soc_calib;
+	unsigned long soc_current_time, time_last;
+	static bool first_enter;
+	static int charging_status, charging_status_pre;
+	bool chg_done;
+	int temp_region, vbat_mv, ibat_ma, soc_load, soc_temp, counter_temp = 0;
+
+	if (false == first_enter) {
+		di->batt_psy = power_supply_get_by_name("battery");
+		if (di->batt_psy) {
+			first_enter = true;
+			soc_load = load_soc();
+			pr_info("soc=%d, soc_load=%d\n", soc, soc_load);
+			if (soc_load < 0) {
+				/* get last soc error */
+				di->soc_pre = soc;
+			} else if (soc_load >= 0 && soc_load < 100) {
+				if (abs(soc_load - soc) > SOC_SHUTDOWN_VALID_LIMITS)
+					di->soc_pre = soc;
+				else if (soc_load > soc)
+					di->soc_pre = soc_load - 1;
+				else
+					di->soc_pre = soc_load;
+			} else if (soc_load == 100
+					&& abs(soc_load - soc) > TEN_PERCENT) {
+				/* decrease soc when gap between soc_load and */
+				/* real_soc is over 10%                       */
+				di->soc_pre = soc_load - 1;
+			} else {
+				di->soc_pre = soc_load;
+			}
+
+			if (!di->batt_psy) {
+				pr_err(
+				"batt_psy is absent, soc_pre=%d\n",
+				di->soc_pre);
+				return di->soc_pre;
+			}
+			/* store the soc when boot first time */
+			get_current_time(&di->soc_pre_time);
+			clean_backup_soc_ex();
+		} else {
+			return soc;
+		}
+	}
+	soc_temp = di->soc_pre;
+
+	if (!di->batt_psy) {
+		soc_calib = soc;
+		goto out;
+	}
+
+	ret.intval = get_charging_status();
+	di->batt_vol_pre = bq27541_battery_voltage(di);
+	chg_done = get_oem_charge_done_status();
+	temp_region = fuelgauge_battery_temp_region_get();
+	if ((temp_region == BATT_TEMP_LITTLE_COOL
+			|| temp_region == BATT_TEMP_COOL
+			|| temp_region == BATT_TEMP_NORMAL
+			|| temp_region == BATT_TEMP_PRE_NORMAL)
+			&& chg_done) {
+		ret.intval = POWER_SUPPLY_STATUS_FULL;
+	}
+
+	if (ret.intval == POWER_SUPPLY_STATUS_CHARGING
+			|| ret.intval == POWER_SUPPLY_STATUS_FULL
+			|| bq27541_di->fastchg_started)
+		charging_status = 1;
+	else
+		charging_status = 0;
+
+	if (charging_status ^ charging_status_pre) {
+		if (charging_status_pre) {
+			get_current_time(&soc_current_time);
+			di->soc_store_time =
+			soc_current_time - di->soc_pre_time;
+		}
+
+		get_current_time(&di->soc_pre_time);
+		if (!charging_status_pre && di->soc_store_time)
+			di->soc_pre_time -= di->soc_store_time;
+		charging_status_pre = charging_status;
+		di->saltate_counter = 0;
+	}
+
+	get_current_time(&soc_current_time);
+	time_last = soc_current_time - di->soc_pre_time;
+	if (charging_status) { /* is charging */
+		if (ret.intval == POWER_SUPPLY_STATUS_FULL) {
+			soc_calib = di->soc_pre;
+			if (di->soc_pre < 100
+					&& (temp_region == BATT_TEMP_LITTLE_COOL
+					|| temp_region == BATT_TEMP_NORMAL
+					|| temp_region == BATT_TEMP_PRE_NORMAL
+					|| temp_region == BATT_TEMP_COOL)) {
+				if (time_last > TWENTY_SECS)
+					soc_calib = di->soc_pre + 1;
+			}
+		} else {
+			if (soc - di->soc_pre > 0) {
+				di->saltate_counter++;
+				if ((bq27541_di->fastchg_started
+					&& time_last < 20)
+				|| (!bq27541_di->fastchg_started
+				&& time_last < 30))
+					return di->soc_pre;
+				di->saltate_counter = 0;
+				soc_calib = di->soc_pre + 1;
+			} else if (soc < (di->soc_pre - 1)) {
+				di->saltate_counter++;
+				if (di->soc_pre == 100) {
+					counter_temp =
+					CAPACITY_SALTATE_COUNTER_FULL;
+					/* t>=5min */
+				} else if (di->soc_pre > 95) {
+					counter_temp =
+					CAPACITY_SALTATE_COUNTER_95;
+					/* t>=2.5min */
+				} else if (di->soc_pre > 60) {
+					counter_temp =
+					CAPACITY_SALTATE_COUNTER_60;
+					/* t>=1min */
+				} else {
+					if (time_last >
+					CAPACITY_CALIBRATE_TIME_60_PERCENT
+						&& (soc - di->soc_pre) < 0)
+						counter_temp = 0;
+					else
+						/* t>=40sec */
+						counter_temp =
+					CAPACITY_SALTATE_COUNTER_NOT_CHARGING;
+				}
+
+				/* avoid dead battery shutdown */
+				if (di->batt_vol_pre <=
+					LOW_BATTERY_PROTECT_VOLTAGE
+					&& di->batt_vol_pre > 2500 * 1000
+					&& di->soc_pre
+					<= LOW_BATTERY_CAPACITY_THRESHOLD) {
+					/* check again */
+					vbat_mv =
+					bq27541_battery_voltage(di);
+					if (vbat_mv <=
+						LOW_BATTERY_PROTECT_VOLTAGE
+						&& vbat_mv > 2500 * 1000) {
+						/* about 9s */
+						counter_temp =
+						CAPACITY_SALTATE_COUNTER - 1;
+					}
+				}
+
+				ibat_ma = bq27541_average_current(di);
+				/* don't allow soc down*/
+				/*if chg current > -200mA */
+				if (di->saltate_counter < counter_temp
+						|| ibat_ma < -200 * 1000)
+					return di->soc_pre;
+				di->saltate_counter = 0;
+
+				soc_calib = di->soc_pre - 1;
+			} else if ((soc == 0 && soc < di->soc_pre)
+					&& di->soc_pre <= 2) {
+				di->saltate_counter++;
+				if (time_last >
+					CAPACITY_CALIBRATE_TIME_60_PERCENT
+						&& (soc - di->soc_pre) < 0)
+					counter_temp = 0;
+				else
+					/* t>=40sec */
+					counter_temp =
+					CAPACITY_SALTATE_COUNTER_NOT_CHARGING;
+
+				if (di->saltate_counter < counter_temp)
+					return di->soc_pre;
+				di->saltate_counter = 0;
+				soc_calib = di->soc_pre - 1;
+			} else {
+				soc_calib = di->soc_pre;
+			}
+		}
+	} else { /* not charging */
+		if ((soc < di->soc_pre)
+			|| (di->batt_vol_pre <= LOW_BATTERY_PROTECT_VOLTAGE
+			&& di->batt_vol_pre > 2500 * 1000)) {
+			if (di->soc_pre == 100) {
+				counter_temp = FIVE_MINUTES;
+			} else if (di->soc_pre >= 95) {
+				counter_temp = TWO_POINT_FIVE_MINUTES;
+			} else if (di->soc_pre >= 60) {
+				counter_temp = ONE_MINUTE;
+			} else {
+				if (time_last >=
+					CAPACITY_CALIBRATE_TIME_60_PERCENT
+						&& (soc - di->soc_pre) < 0)
+					counter_temp = 0;
+				else
+					/* t>=40sec */
+				counter_temp =
+				CAPACITY_SALTATE_COUNTER_NOT_CHARGING
+				+ 20;
+			}
+			/* avoid dead battery shutdown */
+			if (di->batt_vol_pre <=
+				LOW_BATTERY_PROTECT_VOLTAGE
+				&& di->batt_vol_pre > 2500 * 1000
+				&& di->soc_pre <=
+				LOW_BATTERY_CAPACITY_THRESHOLD) {
+				/* check again */
+				vbat_mv = bq27541_battery_voltage(di);
+				if (vbat_mv <= LOW_BATTERY_PROTECT_VOLTAGE
+				&& vbat_mv > 2500 * 1000 && time_last > 9)
+				counter_temp = 0;
+			}
+
+			if (time_last < counter_temp)
+				return di->soc_pre;
+		}
+
+		if (soc < di->soc_pre)
+			soc_calib = di->soc_pre - 1;
+		else if (di->batt_vol_pre <= LOW_BATTERY_PROTECT_VOLTAGE
+				&& di->batt_vol_pre > 2500 * 1000
+				&& di->soc_pre > 0 && time_last > 9)
+			soc_calib = di->soc_pre - 1;
+		else
+			soc_calib = di->soc_pre;
+	}
+
+out:
+	if (soc_calib > 100)
+		soc_calib = 100;
+	if (soc_calib < 0)
+		soc_calib = 0;
+	if (soc_calib == 0) {
+		if ((di->batt_vol_pre/1000) > 3300)
+			soc_calib = 1;
+	}
+	di->soc_pre = soc_calib;
+	if (soc_temp != soc_calib) {
+		get_current_time(&di->soc_pre_time);
+		/* store when soc changed */
+		power_supply_changed(di->batt_psy);
+		pr_info("soc:%d, soc_calib:%d, VOLT:%d, current:%d\n",
+		soc, soc_calib, bq27541_battery_voltage(di) / 1000,
+		bq27541_average_current(di) / 1000);
+	}
+
+	return soc_calib;
+}
+
+
+static int bq27541_battery_soc(
+struct bq27541_device_info *di, int suspend_time_ms)
+{
+	int ret;
+	int soc = 0;
+	int soc_delt = 0;
+	static int soc_pre;
+	bool fg_soc_changed = false;
+
+	/* Add for get right soc when sleep long time */
+	if (atomic_read(&di->suspended) == 1) {
+		dev_warn(di->dev,
+		"di->suspended di->soc_pre=%d\n", di->soc_pre);
+		return di->soc_pre;
+	}
+
+	if (di->allow_reading) {
+#ifdef CONFIG_GAUGE_BQ27411
+		/* david.liu@bsp, 20161004 Add BQ27411 support */
+		ret = bq27541_read(di->cmd_addr.reg_soc,
+				&soc, 0, di);
+#else
+		ret = bq27541_read(BQ27541_REG_SOC, &soc, 0, di);
+#endif
+		if (ret) {
+			pr_err("error reading soc=%d, ret:%d\n", soc, ret);
+			goto read_soc_err;
+		}
+		if (soc_pre != soc)
+			pr_err("bq27541_battery_soc = %d\n", soc);
+
+		soc_pre = soc;
+	} else {
+		if (di->soc_pre)
+			return di->soc_pre;
+		else
+			return 0;
+	}
+	/* Add for get right soc when sleep long time */
+	if (suspend_time_ms && di->lcd_is_off) {
+		if (soc < di->soc_pre) {
+			soc_delt  =  di->soc_pre - soc;
+			fg_soc_changed = (soc < TWENTY_PERCENT
+					|| soc_delt > di->lcd_off_delt_soc
+					|| suspend_time_ms > TEN_MINUTES);
+			pr_info("suspend_time_ms=%d,soc_delt=%d,di->lcd_off_delt_soc=%d\n",
+			suspend_time_ms, soc_delt, di->lcd_off_delt_soc);
+			if (fg_soc_changed) {
+				if (suspend_time_ms/TEN_MINUTES) {
+				di->soc_pre -=
+				(suspend_time_ms / TEN_MINUTES < soc_delt
+				? suspend_time_ms / TEN_MINUTES : soc_delt);
+				} else {
+					di->soc_pre -= 1;
+				}
+				/* store when soc changed */
+				get_current_time(&di->soc_pre_time);
+				power_supply_changed(di->batt_psy);
+				pr_err("system resume,soc:%d, soc_calib:%d,VOLT:%d,current:%d\n",
+				soc, di->soc_pre,
+				bq27541_battery_voltage(di) / 1000,
+				bq27541_average_current(di) / 1000);
+			}
+		}
+		goto read_soc_err;
+	}
+	if (di->disable_calib_soc)
+		return soc;
+	soc = fg_soc_calibrate(di, soc);
+	return soc;
+
+read_soc_err:
+	if (di->soc_pre) {
+		dev_warn(di->dev,
+		"read_soc_exit ,di->soc_pre=%d\n", di->soc_pre);
+		return di->soc_pre;
+	} else
+		return 0;
+}
+
+static int bq27541_average_current(struct bq27541_device_info *di)
+{
+	int ret;
+	int curr = 0;
+
+	/* Add for get right soc when sleep long time */
+	if (atomic_read(&di->suspended) == 1)
+		return -di->current_pre;
+
+	if (di->allow_reading) {
+#ifdef CONFIG_GAUGE_BQ27411
+		/* david.liu@bsp, 20161004 Add BQ27411 support */
+		ret = bq27541_read(di->cmd_addr.reg_ai,
+				&curr, 0, di);
+#else
+		ret = bq27541_read(BQ27541_REG_AI, &curr, 0, di);
+#endif
+		if (ret) {
+			pr_err("error reading current.\n");
+			return ret;
+		}
+	} else {
+		return -di->current_pre;
+	}
+	/* negative current */
+	if (curr & 0x8000)
+		curr = -((~(curr-1)) & 0xFFFF);
+	di->current_pre = 1000 * curr;
+	return -curr * 1000;
+}
+
+static int bq27541_remaining_capacity(struct bq27541_device_info *di)
+{
+	int ret;
+	int cap = 0;
+
+	if (di->allow_reading) {
+#ifdef CONFIG_GAUGE_BQ27411
+		/* david.liu@bsp, 20161004 Add BQ27411 support */
+		ret = bq27541_read(di->cmd_addr.reg_rm,
+				&cap, 0, di);
+#else
+		ret = bq27541_read(BQ27541_REG_RM, &cap, 0, di);
+#endif
+		if (ret) {
+			pr_err("error reading capacity.\n");
+			return ret;
+		}
+	}
+
+	return cap;
+}
+
+static int bq27541_batt_health(struct bq27541_device_info *di)
+{
+	int ret;
+	int health = 0;
+
+	if (di->allow_reading) {
+		ret = bq27541_read(di->cmd_addr.reg_helth,
+				&health, 0, di);
+		if (ret) {
+			pr_err("error reading health\n");
+			return ret;
+		}
+		if (di->device_type == DEVICE_BQ27411)
+			di->health_pre = (health & 0xFF);
+		else
+			di->health_pre = health;
+	}
+
+	return di->health_pre;
+}
+
+static int bq27541_get_battery_mvolts(void)
+{
+	return bq27541_battery_voltage(bq27541_di);
+}
+
+static int bq27541_get_batt_remaining_capacity(void)
+{
+	return bq27541_remaining_capacity(bq27541_di);
+}
+
+static int bq27541_get_batt_health(void)
+{
+	return bq27541_batt_health(bq27541_di);
+}
+static int bq27541_get_batt_bq_soc(void)
+{
+	int soc;
+
+	bq27541_di->disable_calib_soc = true;
+	soc = bq27541_battery_soc(bq27541_di, 0);
+	bq27541_di->disable_calib_soc = false;
+	return soc;
+}
+
+#define SHUTDOWN_TBAT 680
+static int bq27541_get_battery_temperature(void)
+{
+	int ret;
+	static unsigned long pre_time;
+	unsigned long current_time, time_last;
+
+	if (__debug_temp_mask)
+			return __debug_temp_mask;
+	ret = bq27541_battery_temperature(bq27541_di);
+	if (ret >= SHUTDOWN_TBAT) {
+		bq27541_di->t_count++;
+		if (bq27541_di->t_count == 1)
+			get_current_time(&pre_time);
+		get_current_time(&current_time);
+		time_last = current_time - pre_time;
+		if (time_last < 8)
+			return SHUTDOWN_TBAT - 1;
+		else {
+			pr_info("Tbat =%d T_tol=%d\n",
+				ret, (int)(current_time - pre_time));
+		}
+	}
+	bq27541_di->t_count = 0;
+	return ret;
+}
+static bool bq27541_is_battery_present(void)
+{
+	return true;
+}
+
+static bool bq27541_is_battery_temp_within_range(void)
+{
+	return true;
+}
+
+static bool bq27541_is_battery_id_valid(void)
+{
+	return true;
+}
+
+#ifdef CONFIG_GAUGE_BQ27411
+/* david.liu@bsp, 20161025 Add BQ27411 dash charging */
+static int bq27541_get_device_type(void)
+{
+	if (bq27541_di)
+		return bq27541_di->device_type;
+
+	return 0;
+}
+#endif
+
+static int bq27541_get_battery_soc(void)
+{
+	return bq27541_battery_soc(bq27541_di, 0);
+}
+
+static int bq27541_get_average_current(void)
+{
+	return bq27541_average_current(bq27541_di);
+}
+
+static int bq27541_set_allow_reading(int enable)
+{
+	if (bq27541_di)
+		bq27541_di->allow_reading = enable;
+
+	return 0;
+}
+
+static int bq27541_set_lcd_off_status(int off)
+{
+	int soc;
+
+	pr_info("off=%d\n", off);
+	if (bq27541_di) {
+		if (off) {
+			soc = bq27541_get_batt_bq_soc();
+			bq27541_di->lcd_off_delt_soc =
+					bq27541_di->soc_pre - soc;
+			pr_info("lcd_off_delt_soc:%d,soc=%d,soc_pre=%d\n",
+			bq27541_di->lcd_off_delt_soc, soc,
+					bq27541_di->soc_pre);
+			get_current_time(&bq27541_di->lcd_off_time);
+					bq27541_di->lcd_is_off = true;
+		} else {
+			bq27541_di->lcd_is_off = false;
+			bq27541_di->lcd_off_delt_soc = 0;
+		}
+	}
+	return 0;
+}
+
+static int bq27541_get_fastchg_started_status(bool fastchg_started_status)
+{
+	if (bq27541_di)
+		bq27541_di->fastchg_started = fastchg_started_status;
+
+	return 0;
+}
+
+static struct external_battery_gauge bq27541_batt_gauge = {
+	.get_battery_mvolts     = bq27541_get_battery_mvolts,
+	.get_battery_temperature    = bq27541_get_battery_temperature,
+	.is_battery_present     = bq27541_is_battery_present,
+	.is_battery_temp_within_range   = bq27541_is_battery_temp_within_range,
+	.is_battery_id_valid        = bq27541_is_battery_id_valid,
+	.get_batt_remaining_capacity
+		= bq27541_get_batt_remaining_capacity,
+	.get_batt_health        = bq27541_get_batt_health,
+	.get_batt_bq_soc		= bq27541_get_batt_bq_soc,
+#ifdef CONFIG_GAUGE_BQ27411
+	/* david.liu@bsp, 20161025 Add BQ27411 dash charging */
+	.get_device_type            = bq27541_get_device_type,
+#endif
+	.get_battery_soc            = bq27541_get_battery_soc,
+	.get_average_current        = bq27541_get_average_current,
+	.set_allow_reading           = bq27541_set_allow_reading,
+	.set_lcd_off_status         = bq27541_set_lcd_off_status,
+	.fast_chg_started_status    = bq27541_get_fastchg_started_status,
+};
+#define BATTERY_SOC_UPDATE_MS 12000
+#define LOW_BAT_SOC_UPDATE_MS 6000
+
+#define RESUME_SCHDULE_SOC_UPDATE_WORK_MS 60000
+
+static int is_usb_pluged(void)
+{
+	static struct power_supply *psy;
+	union power_supply_propval ret = {0,};
+	int usb_present, rc; /* david@bsp modified */
+
+	if (!psy) {
+		psy = power_supply_get_by_name("usb");
+		if (!psy) {
+			pr_err("failed to get ps usb\n");
+			return -EINVAL;
+		}
+	}
+
+	/* david@bsp modified */
+	rc = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT, &ret);
+	if (rc)
+		return -EINVAL;
+
+	if (ret.intval < 0)
+		return -EINVAL;
+
+	usb_present = ret.intval;
+	return usb_present;
+}
+
+static bool get_dash_started(void)
+{
+	if (bq27541_di && bq27541_di->fastchg_started)
+		return bq27541_di->fastchg_started;
+	else
+		return false;
+}
+#define TEMP_UPDATE_COUNT 5
+#define TEMP_UPDATE_THRESHOLD  450
+
+
+static int bq27541_temperature_thrshold_update(int temp)
+{
+	int ret;
+
+	if (!bq27541_di->batt_psy)
+		return 0;
+	if (temp >= TEMP_UPDATE_THRESHOLD) {
+		bq27541_di->temp_thr_update_count++;
+		if (bq27541_di->temp_thr_update_count > TEMP_UPDATE_COUNT) {
+			bq27541_di->temp_thr_update_count = 0;
+			power_supply_changed(bq27541_di->batt_psy);
+		}
+	} else {
+		bq27541_di->temp_thr_update_count = 0;
+	}
+
+	return ret;
+}
+
+static void update_battery_soc_work(struct work_struct *work)
+{
+	int schedule_time, vbat, temp;
+
+	if (is_usb_pluged() || get_dash_started()) {
+		schedule_delayed_work(
+				&bq27541_di->battery_soc_work,
+				msecs_to_jiffies(BATTERY_SOC_UPDATE_MS));
+		if (get_dash_started())
+			return;
+		if (bq27541_di->set_smoothing)
+			return;
+		if (!bq27541_di->allow_reading)
+			bq27541_set_allow_reading(true);
+		return;
+	}
+	bq27541_set_allow_reading(true);
+	vbat = bq27541_get_battery_mvolts()/1000;
+	bq27541_get_average_current();
+	temp = bq27541_get_battery_temperature();
+	bq27541_get_battery_soc();
+	bq27541_get_batt_remaining_capacity();
+	bq27541_set_allow_reading(false);
+	bq27541_temperature_thrshold_update(temp);
+	if (!bq27541_di->already_modify_smooth)
+		schedule_delayed_work(
+		&bq27541_di->modify_soc_smooth_parameter, 1000);
+	schedule_time =
+		vbat < 3600 ? LOW_BAT_SOC_UPDATE_MS : BATTERY_SOC_UPDATE_MS;
+	schedule_delayed_work(&bq27541_di->battery_soc_work,
+			msecs_to_jiffies(schedule_time));
+}
+
+static bool bq27541_registered;
+bool get_extern_fg_regist_done(void)
+{
+	return bq27541_registered;
+}
+bool get_extern_bq_present(void)
+{
+	if (bq27541_di)
+		return bq27541_di->bq_present;
+	return 0;
+}
+
+#ifdef CONFIG_GAUGE_BQ27411
+/* david.liu@bsp, 20161004 Add BQ27411 support */
+static void gauge_set_cmd_addr(int device_type)
+{
+	if (device_type == DEVICE_BQ27541) {
+		bq27541_di->cmd_addr.reg_temp = BQ27541_REG_TEMP;
+		bq27541_di->cmd_addr.reg_volt = BQ27541_REG_VOLT;
+		bq27541_di->cmd_addr.reg_rm = BQ27541_REG_RM;
+		bq27541_di->cmd_addr.reg_ai = BQ27541_REG_AI;
+		bq27541_di->cmd_addr.reg_soc = BQ27541_REG_SOC;
+		bq27541_di->cmd_addr.reg_helth = BQ27541_REG_NIC;
+	} else { /* device_bq27411 */
+		bq27541_di->cmd_addr.reg_temp = BQ27411_REG_TEMP;
+		bq27541_di->cmd_addr.reg_volt = BQ27411_REG_VOLT;
+		bq27541_di->cmd_addr.reg_rm = BQ27411_REG_RM;
+		bq27541_di->cmd_addr.reg_ai = BQ27411_REG_AI;
+		bq27541_di->cmd_addr.reg_soc = BQ27411_REG_SOC;
+		bq27541_di->cmd_addr.reg_helth = BQ27411_REG_HEALTH;
+	}
+}
+#endif
+
+static void bq_modify_soc_smooth_parameter(struct work_struct *work)
+{
+	struct bq27541_device_info *di;
+
+	di = container_of(work, struct bq27541_device_info,
+			modify_soc_smooth_parameter.work);
+	if (get_dash_started())
+		return;
+	if (di->already_modify_smooth)
+		return;
+	bq27541_set_allow_reading(false);
+	di->set_smoothing = true;
+	bq27411_modify_soc_smooth_parameter(di, true);
+	di->set_smoothing = false;
+	bq27541_set_allow_reading(true);
+}
+static ssize_t battery_exist_read(struct file *p_file,
+	char __user *puser_buf, size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static ssize_t battery_exist_write(struct file *p_file,
+	const char __user *puser_buf,
+	size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static const struct file_operations battery_exist_operations = {
+	.read = battery_exist_read,
+	.write = battery_exist_write,
+};
+
+static void init_battery_exist_node(void)
+{
+	if (!proc_create("battery_exist", 0644, NULL,
+			 &battery_exist_operations)){
+		pr_err("%s : Failed to register proc interface\n", __func__);
+	}
+}
+
+
+static bool check_bat_present(struct bq27541_device_info *di)
+{
+	int flags = 0, ret = 0;
+
+	ret = bq27541_read(BQ27541_SUBCMD_CHEM_ID, &flags, 0, di);
+	if (ret < 0) {
+		pr_err("read bq27541  fail\n");
+		di->bq_present = false;
+		return false;
+	}
+	di->bq_present = true;
+	return true;
+}
+
+static void bq27541_hw_config(struct work_struct *work)
+{
+	int ret = 0, flags = 0, type = 0, fw_ver = 0;
+	struct bq27541_device_info *di;
+
+	di = container_of(work, struct bq27541_device_info,
+			hw_config.work);
+	ret = bq27541_chip_config(di);
+	if (ret) {
+		pr_err("Failed to config Bq27541\n");
+		/* Add for retry when config fail */
+		di->retry_count--;
+		if (di->retry_count > 0)
+			schedule_delayed_work(&di->hw_config, HZ);
+		else
+			bq27541_registered = true;
+
+		return;
+	}
+	external_battery_gauge_register(&bq27541_batt_gauge);
+	bq27541_information_register(&bq27541_batt_gauge);
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_CTNL_STATUS);
+	udelay(66);
+	bq27541_read(BQ27541_REG_CNTL, &flags, 0, di);
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_DEVCIE_TYPE);
+	udelay(66);
+	bq27541_read(BQ27541_REG_CNTL, &type, 0, di);
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_FW_VER);
+	udelay(66);
+	bq27541_read(BQ27541_REG_CNTL, &fw_ver, 0, di);
+
+#ifdef CONFIG_GAUGE_BQ27411
+	/* david.liu@bsp, 20161004 Add BQ27411 support */
+	if (type == DEVICE_TYPE_BQ27411) {
+		di->device_type = DEVICE_BQ27411;
+		pr_info("DEVICE_BQ27411\n");
+	} else {
+		di->device_type = DEVICE_BQ27541;
+		pr_info("DEVICE_BQ27541\n");
+	}
+	gauge_set_cmd_addr(di->device_type);
+	di->allow_reading = true;
+#endif
+
+	bq27541_registered = true;
+	pr_info("DEVICE_TYPE is 0x%02X, FIRMWARE_VERSION is 0x%02X\n",
+			type, fw_ver);
+	pr_info("Complete bq27541 configuration 0x%02X\n", flags);
+	schedule_delayed_work(
+		&di->modify_soc_smooth_parameter,
+		SET_BQ_PARAM_DELAY_MS);
+}
+
+static int bq27541_read_i2c(u8 reg, int *rt_value, int b_single,
+		struct bq27541_device_info *di)
+{
+	struct i2c_client *client = di->client;
+	struct i2c_msg msg[2];
+	unsigned char data[2];
+	int err;
+
+	if (!client->adapter)
+		return -ENODEV;
+	mutex_lock(&battery_mutex);
+
+	/* Write register */
+	msg[0].addr = client->addr;
+	msg[0].flags = 0;
+	msg[0].len = 1;
+	msg[0].buf = data;
+	data[0] = reg;
+	/* Read data */
+	msg[1].addr = client->addr;
+	msg[1].flags = I2C_M_RD;
+	if (!b_single)
+		msg[1].len = 2;
+	else
+		msg[1].len = 1;
+	msg[1].buf = data;
+	err = i2c_transfer(client->adapter, msg, 2);
+	if (err >= 0) {
+		if (!b_single)
+			*rt_value = get_unaligned_le16(data);
+		else
+			*rt_value = data[0];
+		mutex_unlock(&battery_mutex);
+		return 0;
+	}
+	mutex_unlock(&battery_mutex);
+	return err;
+}
+
+#ifdef CONFIG_BQ27541_TEST_ENABLE
+static int reg;
+static int subcmd;
+static ssize_t bq27541_read_stdcmd(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int ret;
+	int temp = 0;
+	struct platform_device *client;
+	struct bq27541_device_info *di;
+
+	client = to_platform_device(dev);
+	di = platform_get_drvdata(client);
+
+	if (reg <= BQ27541_REG_ICR && reg > 0x00) {
+		ret = bq27541_read(reg, &temp, 0, di);
+		if (ret)
+			ret = snprintf(buf, PAGE_SIZE, "Read Error!\n");
+		else
+			ret = snprintf(buf, PAGE_SIZE, "0x%02x\n", temp);
+	} else
+		ret = snprintf(buf, PAGE_SIZE, "Register Error!\n");
+
+	return ret;
+}
+
+static ssize_t bq27541_write_stdcmd(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	ssize_t ret = strnlen(buf, PAGE_SIZE);
+	int cmd;
+	int rc;
+
+	rc = kstrtou32(buf, 0, &cmd);
+	if (rc != 1)
+		pr_err("%s,scanf error\n");
+	reg = cmd;
+	return ret;
+}
+
+static ssize_t bq27541_read_subcmd(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	int ret;
+	int temp = 0;
+	struct platform_device *client;
+	struct bq27541_device_info *di;
+
+	client = to_platform_device(dev);
+	di = platform_get_drvdata(client);
+
+	if (subcmd == BQ27541_SUBCMD_DEVCIE_TYPE ||
+			subcmd == BQ27541_SUBCMD_FW_VER ||
+			subcmd == BQ27541_SUBCMD_HW_VER ||
+			subcmd == BQ27541_SUBCMD_CHEM_ID) {
+
+		bq27541_cntl_cmd(di, subcmd); /* Retrieve Chip status */
+		udelay(66);
+		ret = bq27541_read(BQ27541_REG_CNTL, &temp, 0, di);
+
+		if (ret)
+			ret = snprintf(buf, PAGE_SIZE, "Read Error!\n");
+		else
+			ret = snprintf(buf, PAGE_SIZE, "0x%02x\n", temp);
+	} else
+		ret = snprintf(buf, PAGE_SIZE, "Register Error!\n");
+
+	return ret;
+}
+
+static ssize_t bq27541_write_subcmd(struct device *dev,
+		struct device_attribute *attr, const char *buf, size_t count)
+{
+	ssize_t ret = strnlen(buf, PAGE_SIZE);
+	int cmd, rc;
+
+	rc = kstrtou32(buf, 0, &cmd);
+	if (rc != 1)
+		pr_err("%s,scanf error\n");
+	subcmd = cmd;
+	return ret;
+}
+
+static DEVICE_ATTR(std_cmd, 0644, bq27541_read_stdcmd,
+		bq27541_write_stdcmd);
+static DEVICE_ATTR(sub_cmd, 0644, bq27541_read_subcmd,
+		bq27541_write_subcmd);
+static struct attribute *fs_attrs[] = {
+	&dev_attr_std_cmd.attr,
+	&dev_attr_sub_cmd.attr,
+	NULL,
+};
+static struct attribute_group fs_attr_group = {
+	.attrs = fs_attrs,
+};
+
+static struct platform_device this_device = {
+	.name			= "bq27541-test",
+	.id			= -1,
+	.dev.platform_data	= NULL,
+};
+#endif
+
+static void update_pre_capacity_func(struct work_struct *w)
+{
+	pr_info("enter\n");
+	bq27541_set_allow_reading(true);
+	bq27541_get_battery_temperature();
+	bq27541_battery_soc(bq27541_di, update_pre_capacity_data.suspend_time);
+	bq27541_set_allow_reading(false);
+	__pm_relax(&bq27541_di->update_soc_wake_lock);
+	pr_info("exit\n");
+}
+
+#define MAX_RETRY_COUNT	5
+#define DEFAULT_INVALID_SOC_PRE  -22
+
+static void bq27541_parse_dt(struct bq27541_device_info *di)
+{
+	struct device_node *node = di->dev->of_node;
+
+	di->modify_soc_smooth = of_property_read_bool(node,
+				"qcom,modify-soc-smooth");
+	pr_err("di->modify_soc_smooth=%d\n", di->modify_soc_smooth);
+}
+static int sealed(void)
+{
+	/*return control_cmd_read(di, CONTROL_STATUS) & (1 << 13);*/
+	int value = 0;
+
+	bq27541_cntl_cmd(bq27541_di, CONTROL_STATUS);
+	/*bq27541_cntl_cmd(di,CONTROL_STATUS);*/
+	usleep_range(10000, 10001);
+	bq27541_read_i2c(CONTROL_STATUS, &value, 0, bq27541_di);
+
+	pr_debug(" REG_CNTL: 0x%x\n", value);
+
+	if (bq27541_di->device_type == DEVICE_BQ27541)
+		return value & BIT(14);
+	else if (bq27541_di->device_type == DEVICE_BQ27411)
+		return value & BIT(13);
+	else
+		return 1;
+}
+
+static int seal(void)
+{
+	int i = 0;
+
+	if (sealed()) {
+		pr_err("bq27541/27411 sealed,return\n");
+		return 1;
+	}
+	bq27541_cntl_cmd(bq27541_di, SEAL_SUBCMD);
+	usleep_range(10000, 10001);
+	for (i = 0; i < SEAL_POLLING_RETRY_LIMIT; i++) {
+		if (sealed())
+			return 1;
+		usleep_range(10000, 10001);
+	}
+	return 0;
+}
+
+
+static int unseal(u32 key)
+{
+	int i = 0;
+
+	if (!sealed())
+		goto out;
+
+re_unseal:
+	if (bq27541_di->device_type == DEVICE_BQ27411) {
+		usleep_range(10000, 10001);
+	/*bq27541_write(CONTROL_CMD, key & 0xFFFF, false, di);*/
+		bq27541_cntl_cmd(bq27541_di, 0x8000);
+		usleep_range(10000, 10001);
+		bq27541_cntl_cmd(bq27541_di, 0x8000);
+		usleep_range(10000, 10001);
+	}
+	bq27541_cntl_cmd(bq27541_di, 0xffff);
+	usleep_range(10000, 10001);
+	bq27541_cntl_cmd(bq27541_di, 0xffff);
+	usleep_range(10000, 10001);
+
+	while (i < SEAL_POLLING_RETRY_LIMIT) {
+		i++;
+		if (!sealed())
+			break;
+		usleep_range(10000, 10001);
+		goto re_unseal;
+	}
+
+out:
+	pr_info("bq27541 : i=%d,bq27541_di->device_type=%d\n",
+		i, bq27541_di->device_type);
+
+	if (i == SEAL_POLLING_RETRY_LIMIT) {
+		pr_err("bq27541 failed\n");
+		return 0;
+	} else {
+		return 1;
+	}
+}
+
+static int bq27541_read_i2c_onebyte(u8 cmd, u8 *returnData)
+{
+	if (!new_client) {
+		pr_err(" new_client NULL,return\n");
+		return 0;
+	}
+	if (cmd == BQ27541_BQ27411_CMD_INVALID)
+		return 0;
+
+	mutex_lock(&battery_mutex);
+	*returnData = i2c_smbus_read_byte_data(new_client, cmd);
+
+	mutex_unlock(&battery_mutex);
+	/*pr_err(" cmd = 0x%x, returnData = 0x%x\r\n",cmd,*returnData)  ;*/
+	if (*returnData < 0)
+		return 1;
+	else
+		return 0;
+}
+
+static int bq27541_i2c_txsubcmd_onebyte(u8 cmd, u8 writeData)
+{
+	if (!new_client) {
+		pr_err(" new_client NULL,return\n");
+		return 0;
+	}
+	if (cmd == BQ27541_BQ27411_CMD_INVALID)
+		return 0;
+
+	mutex_lock(&battery_mutex);
+	i2c_smbus_write_byte_data(new_client, cmd, writeData);
+	mutex_unlock(&battery_mutex);
+	return 0;
+}
+
+
+static int bq27411_write_block_data_cmd(struct bq27541_device_info *di,
+				int block_id, u8 reg_addr, u8 new_value)
+{
+	int rc = 0;
+	u8 old_value = 0, old_csum = 0, new_csum = 0;
+	/*u8 new_csum_test = 0, csum_temp = 0;*/
+
+	usleep_range(1000, 1001);
+	bq27541_i2c_txsubcmd(BQ27411_DATA_CLASS_ACCESS, block_id, di);
+	usleep_range(10000, 10001);
+	rc = bq27541_read_i2c_onebyte(reg_addr, &old_value);
+	if (rc) {
+		pr_err("%s read reg_addr = 0x%x fail\n", __func__, reg_addr);
+		return 1;
+	}
+	if (old_value == new_value)
+		return 0;
+	usleep_range(1000, 1001);
+	rc = bq27541_read_i2c_onebyte(BQ27411_CHECKSUM_ADDR, &old_csum);
+	if (rc) {
+		pr_err("%s read checksum fail\n", __func__);
+		return 1;
+	}
+	usleep_range(1000, 1001);
+	bq27541_i2c_txsubcmd_onebyte(reg_addr, new_value);
+	usleep_range(1000, 1001);
+	new_csum = (old_value + old_csum - new_value) & 0xff;
+	usleep_range(1000, 1001);
+	bq27541_i2c_txsubcmd_onebyte(BQ27411_CHECKSUM_ADDR, new_csum);
+	pr_err("bq27411 write blk_id = 0x%x, addr = 0x%x, old_val = 0x%x, new_val = 0x%x, old_csum = 0x%x, new_csum = 0x%x\n",
+		block_id, reg_addr, old_value, new_value, old_csum, new_csum);
+	return 0;
+}
+
+static int bq27411_read_block_data_cmd(struct bq27541_device_info *di,
+				int block_id, u8 reg_addr)
+{
+	u8 value = 0;
+
+	usleep_range(1000, 1001);
+	bq27541_i2c_txsubcmd(BQ27411_DATA_CLASS_ACCESS, block_id, di);
+	usleep_range(10000, 10001);
+	bq27541_read_i2c_onebyte(reg_addr, &value);
+	return value;
+}
+
+static int bq27411_enable_config_mode(
+	struct bq27541_device_info *di, bool enable)
+{
+	int config_mode = 0, i = 0, rc = 0;
+
+	if (enable) {		/*enter config mode*/
+		usleep_range(1000, 1001);
+		bq27541_cntl_cmd(bq27541_di, BQ27411_SUBCMD_SET_CFG);
+		usleep_range(1000, 1001);
+		for (i = 0; i < BQ27411_CONFIG_MODE_POLLING_LIMIT; i++) {
+			i++;
+			rc = bq27541_read_i2c(BQ27411_SUBCMD_CONFIG_MODE,
+				&config_mode, 0, di);
+			if (rc < 0) {
+				pr_err("%s i2c read error\n", __func__);
+				return 1;
+			}
+			if (config_mode & BIT(4))
+				break;
+			msleep(50);
+		}
+	} else {		/* exit config mode*/
+		usleep_range(1000, 1001);
+		bq27541_cntl_cmd(bq27541_di, BQ27411_SUBCMD_EXIT_CFG);
+		usleep_range(1000, 1001);
+		for (i = 0; i < BQ27411_CONFIG_MODE_POLLING_LIMIT; i++) {
+			i++;
+			rc = bq27541_read_i2c(BQ27411_SUBCMD_CONFIG_MODE,
+				&config_mode, 0, di);
+			if (rc < 0) {
+				pr_err("%s i2c read error\n", __func__);
+				return 1;
+			}
+			if ((config_mode & BIT(4)) == 0)
+				break;
+			msleep(50);
+		}
+	}
+	if (i == BQ27411_CONFIG_MODE_POLLING_LIMIT) {
+		pr_err("%s fail config_mode = 0x%x, enable = %d\n",
+			__func__, config_mode, enable);
+		return 1;
+	}
+		pr_err("%s success i = %d, config_mode = 0x%x, enable = %d\n",
+			__func__, i, config_mode, enable);
+		return 0;
+}
+
+static bool bq27411_check_soc_smooth_parameter(
+	struct bq27541_device_info *di, bool is_powerup)
+{
+	int value_read = 0;
+	u8 dead_band_val = 0, op_cfgb_val = 0, dodat_val = 0, rc = 0;
+
+	return true;	/*not check because it costs 5.5 seconds*/
+
+	msleep(4000);
+	if (sealed()) {
+		if (!unseal(BQ27411_UNSEAL_KEY))
+			return false;
+		msleep(50);
+	}
+
+	if (is_powerup) {
+		dead_band_val = BQ27411_CC_DEAD_BAND_POWERUP_VALUE;
+		op_cfgb_val = BQ27411_OPCONFIGB_POWERUP_VALUE;
+		dodat_val = BQ27411_DODATEOC_POWERUP_VALUE;
+	} else {	/*shutdown*/
+		dead_band_val = BQ27411_CC_DEAD_BAND_SHUTDOWN_VALUE;
+		op_cfgb_val = BQ27411_OPCONFIGB_SHUTDOWN_VALUE;
+		dodat_val = BQ27411_DODATEOC_SHUTDOWN_VALUE;
+	}
+	rc = bq27411_enable_config_mode(di, true);
+	if (rc) {
+		pr_err("%s enable config mode fail\n", __func__);
+		return false;
+	}
+	/*enable block data control*/
+	rc = bq27541_i2c_txsubcmd_onebyte(BQ27411_BLOCK_DATA_CONTROL, 0x00);
+	if (rc) {
+		pr_err("%s enable block data control fail\n", __func__);
+		goto check_error;
+	}
+	usleep_range(5000, 5001);
+
+	/*check cc-dead-band*/
+	value_read = bq27411_read_block_data_cmd(di,
+	BQ27411_CC_DEAD_BAND_ID, BQ27411_CC_DEAD_BAND_ADDR);
+	if (value_read != dead_band_val) {
+		pr_err("%s cc_dead_band error, value_read = 0x%x\n",
+			__func__, value_read);
+		goto check_error;
+	}
+
+	/*check opconfigB*/
+	value_read = bq27411_read_block_data_cmd(di,
+	BQ27411_OPCONFIGB_ID,
+	BQ27411_OPCONFIGB_ADDR);
+	if (value_read != op_cfgb_val) {
+		pr_err("%s opconfigb error, value_read = 0x%x\n",
+			__func__, value_read);
+		goto check_error;
+	}
+
+	/*check dodateoc*/
+	value_read = bq27411_read_block_data_cmd(di,
+				BQ27411_DODATEOC_ID, BQ27411_DODATEOC_ADDR);
+	if (value_read != dodat_val) {
+		pr_err("%s dodateoc error, value_read = 0x%x\n",
+			__func__, value_read);
+		goto check_error;
+	}
+	bq27411_enable_config_mode(di, false);
+	return true;
+
+check_error:
+	bq27411_enable_config_mode(di, false);
+	return false;
+}
+
+static int bq27411_write_soc_smooth_parameter(
+	struct bq27541_device_info *di, bool is_powerup)
+{
+	int rc = 0;
+	u8 dead_band_val = 0, op_cfgb_val = 0, dodat_val = 0;
+
+	if (is_powerup) {
+		dead_band_val = BQ27411_CC_DEAD_BAND_POWERUP_VALUE;
+		op_cfgb_val = BQ27411_OPCONFIGB_POWERUP_VALUE;
+		dodat_val = BQ27411_DODATEOC_POWERUP_VALUE;
+	} else {	/*shutdown*/
+		dead_band_val = BQ27411_CC_DEAD_BAND_SHUTDOWN_VALUE;
+		op_cfgb_val = BQ27411_OPCONFIGB_SHUTDOWN_VALUE;
+		dodat_val = BQ27411_DODATEOC_SHUTDOWN_VALUE;
+	}
+
+	/*enter config mode*/
+	rc = bq27411_enable_config_mode(di, true);
+	if (rc) {
+		pr_err("%s enable config mode fail\n", __func__);
+		return 1;
+	}
+	/*enable block data control*/
+	bq27541_i2c_txsubcmd_onebyte(BQ27411_BLOCK_DATA_CONTROL, 0x00);
+
+	usleep_range(5000, 5001);
+	/*step1: update cc-dead-band*/
+	rc = bq27411_write_block_data_cmd(di, BQ27411_CC_DEAD_BAND_ID,
+			BQ27411_CC_DEAD_BAND_ADDR, dead_band_val);
+	if (rc) {
+		pr_err("%s cc_dead_band fail\n", __func__);
+		goto exit_config_mode;
+	}
+	/*step2: update opconfigB*/
+	rc = bq27411_write_block_data_cmd(di, BQ27411_OPCONFIGB_ID,
+			BQ27411_OPCONFIGB_ADDR, op_cfgb_val);
+	if (rc) {
+		pr_err("%s opconfigB fail\n", __func__);
+		goto exit_config_mode;
+	}
+	/*step3: update dodateoc*/
+	rc = bq27411_write_block_data_cmd(di, BQ27411_DODATEOC_ID,
+			BQ27411_DODATEOC_ADDR, dodat_val);
+	if (rc) {
+		pr_err("%s dodateoc fail\n", __func__);
+		goto exit_config_mode;
+	}
+	bq27411_enable_config_mode(di, false);
+	return 0;
+
+exit_config_mode:
+	bq27411_enable_config_mode(di, false);
+	return 1;
+}
+
+static void bq27411_modify_soc_smooth_parameter(
+	struct bq27541_device_info *di, bool is_powerup)
+{
+	int rc = 0;
+	bool check_result = false, tried_again = false;
+
+	if (di->modify_soc_smooth == false
+		|| di->device_type == DEVICE_BQ27541) {
+		return;
+	}
+
+	pr_err("%s begin\n", __func__);
+	if (sealed()) {
+		if (!unseal(BQ27411_UNSEAL_KEY))
+			return;
+		msleep(50);
+	}
+write_parameter:
+	rc = bq27411_write_soc_smooth_parameter(di, is_powerup);
+	if (rc && tried_again == false) {
+		tried_again = true;
+		goto write_parameter;
+	} else {
+		check_result =
+		bq27411_check_soc_smooth_parameter(di, is_powerup);
+		if (check_result == false && tried_again == false) {
+			tried_again = true;
+			goto write_parameter;
+		}
+	}
+
+	usleep_range(1000, 1001);
+	if (sealed() == 0) {
+		usleep_range(1000, 1001);
+		seal();
+	}
+	di->already_modify_smooth = true;
+	pr_err("%s end\n", __func__);
+}
+
+static int bq27541_battery_probe(struct i2c_client *client,
+		const struct i2c_device_id *id)
+{
+	char *name;
+	struct bq27541_device_info *di;
+	struct bq27541_access_methods *bus;
+	int num;
+	int retval = 0;
+
+	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
+		return -ENODEV;
+
+	update_pre_capacity_data.workqueue =
+		create_workqueue("update_pre_capacity");
+	INIT_DELAYED_WORK(&(update_pre_capacity_data.work),
+		update_pre_capacity_func);
+
+	mutex_lock(&battery_mutex);
+	num = idr_alloc(&battery_id, client, 0, 0, GFP_KERNEL);
+	mutex_unlock(&battery_mutex);
+	if (retval < 0)
+		return retval;
+
+	name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
+	if (!name) {
+		pr_err("failed to allocate device name\n");
+		retval = -ENOMEM;
+		goto batt_failed_1;
+	}
+
+	di = kzalloc(sizeof(*di), GFP_KERNEL);
+	if (!di) {
+		retval = -ENOMEM;
+		goto batt_failed_2;
+	}
+	di->id = num;
+
+	bus = kzalloc(sizeof(*bus), GFP_KERNEL);
+	if (!bus) {
+		retval = -ENOMEM;
+		goto batt_failed_3;
+	}
+
+	i2c_set_clientdata(client, di);
+	di->dev = &client->dev;
+	bus->read = &bq27541_read_i2c;
+	di->bus = bus;
+	di->client = client;
+
+	new_client = client;
+
+	wakeup_source_init(&di->update_soc_wake_lock, "bq_delt_soc_wake_lock");
+	di->soc_pre = DEFAULT_INVALID_SOC_PRE;
+	di->temp_pre = 0;
+#ifndef CONFIG_GAUGE_BQ27411
+	/* david.liu@bsp, 20161004 Add BQ27411 support */
+	di->allow_reading = true;
+#endif
+	/* Add for retry when config fail */
+	di->retry_count = MAX_RETRY_COUNT;
+	atomic_set(&di->suspended, 0);
+
+#ifdef CONFIG_BQ27541_TEST_ENABLE
+	platform_set_drvdata(&this_device, di);
+	retval = platform_device_register(&this_device);
+	if (!retval) {
+		retval = sysfs_create_group(&this_device.dev.kobj,
+				&fs_attr_group);
+		if (retval)
+			goto batt_failed_4;
+	} else
+		goto batt_failed_4;
+#endif
+
+	if (retval) {
+		pr_err("failed to setup bq27541\n");
+		goto batt_failed_4;
+	}
+
+	if (retval) {
+		pr_err("failed to powerup bq27541\n");
+		goto batt_failed_4;
+	}
+	bq27541_di = di;
+	bq27541_parse_dt(di);
+	di->t_count = 0;
+	di->lcd_is_off = false;
+	INIT_DELAYED_WORK(&di->hw_config, bq27541_hw_config);
+	INIT_DELAYED_WORK(&di->modify_soc_smooth_parameter,
+		bq_modify_soc_smooth_parameter);
+	INIT_DELAYED_WORK(&di->battery_soc_work, update_battery_soc_work);
+	schedule_delayed_work(&di->hw_config, BQ27541_INIT_DELAY);
+	schedule_delayed_work(&di->battery_soc_work, BATTERY_SOC_UPDATE_MS);
+	retval = check_bat_present(di);
+	if( retval ) {
+		init_battery_exist_node();
+		pr_info("probe success battery exist \n");
+	}
+	else {
+		pr_info("probe success battery not exist \n");
+	}
+	return 0;
+
+batt_failed_4:
+	kfree(bus);
+batt_failed_3:
+	kfree(di);
+batt_failed_2:
+	kfree(name);
+batt_failed_1:
+	mutex_lock(&battery_mutex);
+	idr_remove(&battery_id, num);
+	mutex_unlock(&battery_mutex);
+
+	return retval;
+}
+
+static int bq27541_battery_remove(struct i2c_client *client)
+{
+	struct bq27541_device_info *di = i2c_get_clientdata(client);
+
+	external_battery_gauge_unregister(&bq27541_batt_gauge);
+	bq27541_information_unregister(&bq27541_batt_gauge);
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_DISABLE_DLOG);
+	udelay(66);
+	bq27541_cntl_cmd(di, BQ27541_SUBCMD_DISABLE_IT);
+	cancel_delayed_work_sync(&di->hw_config);
+	cancel_delayed_work_sync(&di->modify_soc_smooth_parameter);
+	kfree(di->bus);
+
+	mutex_lock(&battery_mutex);
+	idr_remove(&battery_id, di->id);
+	mutex_unlock(&battery_mutex);
+
+	kfree(di);
+	return 0;
+}
+
+
+static int bq27541_battery_suspend(struct device *dev)
+{
+	int ret = 0;
+	struct bq27541_device_info *di = dev_get_drvdata(dev);
+	cancel_delayed_work_sync(&di->battery_soc_work);
+	atomic_set(&di->suspended, 1);
+	ret = get_current_time(&di->rtc_suspend_time);
+	if (ret) {
+		pr_err("Failed to read RTC time\n");
+		return 0;
+	}
+	return 0;
+}
+
+
+/*1 minute*/
+
+#define RESUME_TIME  60
+static int bq27541_battery_resume(struct device *dev)
+{
+	int ret = 0;
+	int suspend_time;
+	struct bq27541_device_info *di =  dev_get_drvdata(dev);
+
+	atomic_set(&di->suspended, 0);
+	ret = get_current_time(&di->rtc_resume_time);
+	if (ret) {
+		pr_err("Failed to read RTC time\n");
+		return 0;
+	}
+	suspend_time =  di->rtc_resume_time - di->rtc_suspend_time;
+	pr_info("suspend_time=%d\n", suspend_time);
+	update_pre_capacity_data.suspend_time = suspend_time;
+
+	if (di->rtc_resume_time - di->lcd_off_time >= TWO_POINT_FIVE_MINUTES) {
+		pr_err("di->rtc_resume_time - di->lcd_off_time=%ld\n",
+				di->rtc_resume_time - di->lcd_off_time);
+		__pm_stay_awake(&di->update_soc_wake_lock);
+		get_current_time(&di->lcd_off_time);
+		queue_delayed_work_on(0,
+				update_pre_capacity_data.workqueue,
+				&(update_pre_capacity_data.work),
+				msecs_to_jiffies(1000));
+	}
+	schedule_delayed_work(&bq27541_di->battery_soc_work,
+			msecs_to_jiffies(RESUME_SCHDULE_SOC_UPDATE_WORK_MS));
+	return 0;
+}
+
+
+static void bq27541_shutdown(struct i2c_client *client)
+{
+	struct bq27541_device_info *di = i2c_get_clientdata(client);
+
+	if (bq27541_di) {
+		if (di->already_modify_smooth)
+			bq27411_modify_soc_smooth_parameter(bq27541_di, false);
+	}
+
+	if (di->soc_pre != DEFAULT_INVALID_SOC_PRE)
+		backup_soc_ex(di->soc_pre);
+}
+
+static const struct of_device_id bq27541_match[] = {
+	{ .compatible = "ti,bq27541-battery" },
+	{ },
+};
+
+static const struct i2c_device_id bq27541_id[] = {
+	{ "bq27541-battery", 1 },
+	{},
+};
+MODULE_DEVICE_TABLE(i2c, BQ27541_id);
+static const struct dev_pm_ops bq27541_pm = {
+	SET_SYSTEM_SLEEP_PM_OPS(bq27541_battery_suspend, bq27541_battery_resume)
+};
+
+static struct i2c_driver bq27541_battery_driver = {
+	.driver		= {
+		.name = "bq27541-battery",
+		.pm = &bq27541_pm,
+	},
+	.probe		= bq27541_battery_probe,
+	.remove		= bq27541_battery_remove,
+	.shutdown	= bq27541_shutdown,
+	.id_table	= bq27541_id,
+};
+
+static int __init bq27541_battery_init(void)
+{
+	int ret;
+
+	ret = i2c_add_driver(&bq27541_battery_driver);
+	if (ret)
+		pr_err("Unable to register BQ27541 driver\n");
+
+	return ret;
+}
+module_init(bq27541_battery_init);
+
+static void __exit bq27541_battery_exit(void)
+{
+	i2c_del_driver(&bq27541_battery_driver);
+}
+module_exit(bq27541_battery_exit);
+
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("Qualcomm Innovation Center, Inc.");
+MODULE_DESCRIPTION("BQ27541 battery monitor driver");
diff --git a/drivers/power/supply/qcom/fg-core.h b/drivers/power/supply/qcom/fg-core.h
index b6d7a56a9d8a08038bbe580c4b8c6b1acf084bfc..d698c3a9367008e95e68f10455058dedc9b72c23 100644
--- a/drivers/power/supply/qcom/fg-core.h
+++ b/drivers/power/supply/qcom/fg-core.h
@@ -447,6 +447,8 @@ struct fg_dev {
 	bool			profile_available;
 	enum prof_load_status	profile_load_status;
 	bool			battery_missing;
+	bool			use_external_fg;
+	bool			delta_bsoc_irq_en;
 	bool			fg_restarting;
 	bool			charge_full;
 	bool			recharge_soc_adjusted;
diff --git a/drivers/power/supply/qcom/fg-util.c b/drivers/power/supply/qcom/fg-util.c
index 82c453fe63a7ebbcc94e96125999566efabbd2c5..f014a759e206a4107952bad947ff04f226cbe809 100644
--- a/drivers/power/supply/qcom/fg-util.c
+++ b/drivers/power/supply/qcom/fg-util.c
@@ -352,39 +352,35 @@ bool is_input_present(struct fg_dev *fg)
 	return is_usb_present(fg) || is_dc_present(fg);
 }
 
-void fg_notify_charger(struct fg_dev *fg)
+void fg_notify_charger(struct fg_dev *chip)
 {
 	union power_supply_propval prop = {0, };
 	int rc;
 
-	if (!fg->batt_psy)
+	if (!chip->batt_psy)
 		return;
 
-	if (!fg->profile_available)
+	if (!chip->profile_available)
 		return;
 
-	if (fg->bp.float_volt_uv > 0) {
-		prop.intval = fg->bp.float_volt_uv;
-		rc = power_supply_set_property(fg->batt_psy,
-				POWER_SUPPLY_PROP_VOLTAGE_MAX, &prop);
-		if (rc < 0) {
-			pr_err("Error in setting voltage_max property on batt_psy, rc=%d\n",
-				rc);
-			return;
-		}
+	prop.intval = chip->bp.fastchg_curr_ma * 1000;
+	rc = power_supply_set_property(chip->batt_psy,
+			POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX, &prop);
+	if (rc < 0) {
+		pr_err("Error in setting constant_charge_current_max property on batt_psy, rc=%d\n",
+			rc);
+		return;
 	}
 
-	if (fg->bp.fastchg_curr_ma > 0) {
-		prop.intval = fg->bp.fastchg_curr_ma * 1000;
-		rc = power_supply_set_property(fg->batt_psy,
-				POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
-				&prop);
-		if (rc < 0) {
-			pr_err("Error in setting constant_charge_current_max property on batt_psy, rc=%d\n",
-				rc);
-			return;
-		}
+	rc = power_supply_set_property(chip->batt_psy,
+			POWER_SUPPLY_PROP_NOTIFY_CHARGER_SET_PARAMETER, &prop);
+	if (rc < 0) {
+		pr_err("Error in setting voltage_max property on batt_psy, rc=%d\n",
+			rc);
+		return;
 	}
+
+	fg_dbg(chip, FG_STATUS, "Notified charger on float voltage and FCC\n");
 }
 
 bool batt_psy_initialized(struct fg_dev *fg)
diff --git a/drivers/power/supply/qcom/oneplus_fastchg.c b/drivers/power/supply/qcom/oneplus_fastchg.c
new file mode 100644
index 0000000000000000000000000000000000000000..abff2e170517ba8dca54600093fc4ea6fc862b7b
--- /dev/null
+++ b/drivers/power/supply/qcom/oneplus_fastchg.c
@@ -0,0 +1,1616 @@
+/****************************************************
+ **Description:fastchg update firmware and driver
+ *****************************************************/
+#define pr_fmt(fmt) "FASTCHG: %s: " fmt, __func__
+
+#include <linux/i2c.h>
+#include <linux/input.h>
+#include <linux/module.h>
+#include <linux/delay.h>
+#include <linux/kthread.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <linux/slab.h>
+#include <linux/project_info.h>
+#include <linux/miscdevice.h>
+#include <linux/uaccess.h>
+#include <linux/power_supply.h>
+#include <linux/interrupt.h>
+#include <linux/power/oem_external_fg.h>
+#include <linux/pm_qos.h>
+#include <linux/proc_fs.h>
+#include <linux/moduleparam.h>
+
+#define BYTE_OFFSET			2
+#define BYTES_TO_WRITE		16
+
+#define READ_COUNT			192
+#define	FW_CHECK_FAIL		0
+#define	FW_CHECK_SUCCESS	1
+
+#define SHOW_FW_VERSION_DELAY_MS 18000
+
+struct fastchg_device_info {
+	struct i2c_client		*client;
+	struct miscdevice   dash_device;
+	struct mutex        read_mutex;
+	wait_queue_head_t   read_wq;
+
+	struct pinctrl_state *pinctrl_state_active;
+	struct pinctrl_state *pinctrl_state_suspended;
+	struct pinctrl_state *pinctrl_mcu_data_state_active;
+	struct pinctrl_state *pinctrl_mcu_data_state_suspended;
+	struct pinctrl *pinctrl;
+	bool fast_chg_started;
+	bool fast_low_temp_full;
+	bool fast_chg_ing;
+	bool fast_switch_to_normal;
+	bool fast_normal_to_warm;
+	bool fast_chg_error;
+	bool irq_enabled;
+	bool fast_chg_allow;
+	bool firmware_already_updated;
+	bool n76e_present;
+	bool is_mcl_verion;
+	int mcu_reset_ahead;
+	int erase_count;
+	int addr_low;
+	int addr_high;
+	int adapter_update_report;
+	int adapter_update_real;
+	int battery_type;
+	int irq;
+	int mcu_en_gpio;
+	int usb_sw_1_gpio;
+	int usb_sw_2_gpio;
+	int ap_clk;
+	int ap_data;
+	int dash_enhance;
+	int dashchg_fw_ver_count;
+
+	struct power_supply		*batt_psy;
+	struct work_struct fastcg_work;
+	struct work_struct charger_present_status_work;
+	struct timer_list watchdog;
+	struct wakeup_source fastchg_wake_lock;
+	struct wakeup_source fastchg_update_fireware_lock;
+
+	struct delayed_work		update_firmware;
+	struct delayed_work update_fireware_version_work;
+	struct delayed_work adapter_update_work;
+	char fw_id[12];
+	char manu_name[12];
+};
+
+struct fastchg_device_info *fastchg_di;
+
+static unsigned char *dashchg_firmware_data;
+static struct i2c_client *mcu_client;
+
+static ssize_t warp_exist_read(struct file *p_file,
+	char __user *puser_buf, size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static ssize_t warp_exist_write(struct file *p_file,
+	const char __user *puser_buf,
+	size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static const struct file_operations warp_chg_exist_operations = {
+	.read = warp_exist_read,
+	.write = warp_exist_write,
+};
+static void init_warp_chg_exist_node(void)
+{
+	if (!proc_create("warp_chg_exit", 0644, NULL,
+			 &warp_chg_exist_operations)){
+		pr_info("Failed to register n76e node\n");
+	}
+}
+
+static ssize_t n76e_exist_read(struct file *p_file,
+	char __user *puser_buf, size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static ssize_t n76e_exist_write(struct file *p_file,
+	const char __user *puser_buf,
+	size_t count, loff_t *p_offset)
+{
+	return 0;
+}
+
+static const struct file_operations n76e_exist_operations = {
+	.read = n76e_exist_read,
+	.write = n76e_exist_write,
+};
+
+static void init_n76e_exist_node(void)
+{
+	if (!proc_create("n76e_exit", 0644, NULL,
+			 &n76e_exist_operations)){
+		pr_info("Failed to register n76e node\n");
+	}
+}
+#define PAGESIZE 512
+
+static ssize_t enhance_exist_read(struct file *file,
+			char __user *user_buf, size_t count, loff_t *ppos)
+{
+	int ret = 0;
+	char page[PAGESIZE];
+	struct fastchg_device_info *di = fastchg_di;
+
+	if (!di)
+		return ret;
+	ret = snprintf(page, 255, "%d", di->dash_enhance);
+	ret = simple_read_from_buffer(user_buf,
+			count, ppos, page, strlen(page));
+	return ret;
+}
+
+static ssize_t enhance_exist_write(struct file *file,
+			const char __user *buffer, size_t count, loff_t *ppos)
+{
+	struct fastchg_device_info *di = fastchg_di;
+	int ret = 0;
+	char buf[4] = {0};
+
+	if (count > 2)
+		return count;
+
+	if (copy_from_user(buf, buffer, count)) {
+		pr_err("%s: write proc dash error.\n", __func__);
+		return count;
+	}
+
+	if (-1 == sscanf(buf, "%d", &ret)) {
+		pr_err("%s sscanf error\n", __func__);
+		return count;
+	}
+	if (!di)
+		return count;
+	if ((ret == 0) || (ret == 1))
+		di->dash_enhance = ret;
+	pr_info("%s:the dash enhance is = %d\n",
+			__func__, di->dash_enhance);
+	return count;
+}
+
+static const struct file_operations enhance_exist_operations = {
+	.read = enhance_exist_read,
+	.write = enhance_exist_write,
+};
+
+static void init_enhance_dash_exist_node(void)
+{
+	if (!proc_create("enhance_dash", 0644, NULL,
+			 &enhance_exist_operations))
+		pr_err("Failed to register enhance dash node\n");
+}
+
+//for mcu_data irq delay issue 2017.10.14@Infi
+extern void msm_cpuidle_set_sleep_disable(bool disable);
+
+void opchg_set_data_active(struct fastchg_device_info *chip)
+{
+	gpio_direction_input(chip->ap_data);
+	if (chip->pinctrl &&
+		!IS_ERR_OR_NULL(chip->pinctrl_mcu_data_state_active))
+		pinctrl_select_state(chip->pinctrl,
+			chip->pinctrl_mcu_data_state_active);
+}
+
+void set_mcu_en_gpio_value(int value)
+{
+	if (gpio_is_valid(fastchg_di->mcu_en_gpio))
+		gpio_direction_output(fastchg_di->mcu_en_gpio, value);
+}
+
+void mcu_en_reset(void)
+{
+	if (gpio_is_valid(fastchg_di->mcu_en_gpio)) {
+		gpio_direction_output(fastchg_di->mcu_en_gpio, 1);
+	}
+}
+
+void mcu_en_gpio_set(int value)
+{
+	if (value) {
+		if (gpio_is_valid(fastchg_di->mcu_en_gpio))
+			gpio_direction_output(fastchg_di->mcu_en_gpio, 0);
+	} else {
+		if (gpio_is_valid(fastchg_di->mcu_en_gpio)) {
+			gpio_direction_output(fastchg_di->mcu_en_gpio, 1);
+			usleep_range(10000, 10001);
+			gpio_direction_output(fastchg_di->mcu_en_gpio, 0);
+		}
+	}
+}
+#define ADAPTER_UPDATE_DELAY              1400
+
+void usb_sw_gpio_set(int value)
+{
+	pr_info("set usb_sw_gpio=%d\n", value);
+	if (!gpio_is_valid(fastchg_di->usb_sw_1_gpio)
+		&& !gpio_is_valid(fastchg_di->usb_sw_2_gpio)) {
+		pr_err("gpio is invalid\n");
+		return;
+	}
+
+	if (value) {
+		gpio_direction_output(fastchg_di->usb_sw_1_gpio, 1);
+		gpio_direction_output(fastchg_di->usb_sw_2_gpio, 1);
+	} else {
+		gpio_direction_output(fastchg_di->usb_sw_1_gpio, 0);
+		gpio_direction_output(fastchg_di->usb_sw_2_gpio, 0);
+	}
+	fastchg_di->fast_chg_allow = value;
+	pr_info("get usb_sw_gpio=%d&%d\n"
+		, gpio_get_value(fastchg_di->usb_sw_1_gpio)
+		, gpio_get_value(fastchg_di->usb_sw_2_gpio));
+}
+
+static int set_property_on_smbcharger(
+	enum power_supply_property prop, bool data)
+{
+	static struct power_supply *psy;
+	union power_supply_propval value = {data, };
+	int ret;
+
+	if (!psy) {
+		psy = power_supply_get_by_name("battery");
+		if (!psy) {
+			pr_err("failed to get ps battery\n");
+			return -EINVAL;
+		}
+	}
+	ret = power_supply_set_property(psy, prop, &value);
+	if (ret)
+		return -EINVAL;
+
+	return 0;
+}
+
+
+static int oneplus_dash_i2c_read(
+	struct i2c_client *client, u8 addr, s32 len, u8 *rxbuf)
+{
+	return i2c_smbus_read_i2c_block_data(client, addr, len, rxbuf);
+}
+
+static int oneplus_dash_i2c_write(
+	struct i2c_client *client, u8 addr, s32 len, u8 *txbuf)
+{
+	return i2c_smbus_write_i2c_block_data(client, addr, len, txbuf);
+}
+
+static unsigned char addr_buf[2];
+static bool n76e_fw_check(struct fastchg_device_info *chip)
+{
+	unsigned char data_buf[16] = {0x0};
+	int rc = 0;
+	int j = 0, i;
+	int fw_line = 0;
+	int total_line = 0;
+
+	total_line = chip->dashchg_fw_ver_count / 18;
+
+	for (fw_line = 0; fw_line < total_line; fw_line++) {
+		addr_buf[0] = dashchg_firmware_data[fw_line * 18 + 1];
+		addr_buf[1] = dashchg_firmware_data[fw_line * 18];
+		rc = oneplus_dash_i2c_write(chip->client,
+				0x01, 2, &addr_buf[0]);
+		if (rc < 0) {
+			pr_err("i2c_write 0x01 error\n");
+			return FW_CHECK_FAIL;
+		}
+
+		data_buf[0] = 0;
+		oneplus_dash_i2c_write(chip->client, 0x03, 1, &data_buf[0]);
+		usleep_range(2000, 2100);
+		oneplus_dash_i2c_read(chip->client, 0x03, 16, &data_buf[0]);
+
+		for (j = 0; j < 16; j++) {
+			if (data_buf[j] != dashchg_firmware_data[fw_line * 18 + 2 + j]) {
+				pr_err("fail, data_buf[%d]:0x%x != n76e_firmware_data[%d]:0x%x\n",
+						j, data_buf[j], (fw_line * 18 + 2 + j),
+						dashchg_firmware_data[fw_line * 18 + 2 + j]);
+				for (i = 0; i < 16; i++)
+					pr_info("data_buf[%d]:0x%x\n", i, data_buf[i]);
+				pr_info("fail line=%d\n", fw_line);
+				return FW_CHECK_FAIL;
+			}
+		}
+	}
+		return FW_CHECK_SUCCESS;
+}
+
+
+static bool dashchg_fw_check(void)
+{
+	unsigned char addr_buf[2] = {0x88, 0x00};
+	unsigned char data_buf[32] = {0x0};
+	int rc, i, j, addr;
+	int fw_line = 0;
+
+	addr_buf[0] = fastchg_di->addr_low;
+	addr_buf[1] = fastchg_di->addr_high;
+	rc = oneplus_dash_i2c_write(mcu_client, 0x01, 2, &addr_buf[0]);
+	if (rc < 0) {
+		pr_err("%s i2c_write 0x01 error\n", __func__);
+		goto i2c_err;
+	}
+
+	usleep_range(2000, 2001);
+	for (i = 0; i < READ_COUNT; i++) {
+		oneplus_dash_i2c_read(mcu_client, 0x03, 16, &data_buf[0]);
+		usleep_range(2000, 2001);
+		oneplus_dash_i2c_read(mcu_client, 0x03, 16, &data_buf[16]);
+		addr = 0x8800 + i * 32;
+
+		/* compare recv_buf with dashchg_firmware_data[] begin */
+		if (addr == ((dashchg_firmware_data[fw_line * 34 + 1] << 8)
+			| dashchg_firmware_data[fw_line * 34])) {
+			for (j = 0; j < 32; j++) {
+			if (data_buf[j] != dashchg_firmware_data
+					[fw_line * 34 + 2 + j]) {
+				pr_info("%s fail,data_buf[%d]:0x%x!=dashchg_firmware_data[%d]:0x%x\n",
+				__func__, j, data_buf[j],
+				(fw_line * 34 + 2 + j),
+				dashchg_firmware_data[fw_line * 34 + 2 + j]);
+				pr_info("%s addr = 0x%x", __func__, addr);
+				for (j = 0; j <= 31; j++)
+					pr_info("%x\n", data_buf[i]);
+				return FW_CHECK_FAIL;
+				}
+			}
+			fw_line++;
+		} else {
+	/*pr_err("%s addr dismatch,addr:0x%x,stm_data:0x%x\n",__func__,*/
+	/*addr,(dashchg_firmware_data[fw_line * 34 + 1] << 8) | */
+	/*dashchg_firmware_data[fw_line * 34]);*/
+		}
+		/* compare recv_buf with dashchg_firmware_data[] end */
+	}
+	pr_info("result=success\n");
+	return FW_CHECK_SUCCESS;
+i2c_err:
+	pr_err("result=fail\n");
+	return FW_CHECK_FAIL;
+}
+
+static int dashchg_fw_write(
+	unsigned char *data_buf,
+	unsigned int offset, unsigned int length)
+{
+	unsigned int count = 0;
+	unsigned char zero_buf[1] = {0};
+	unsigned char temp_buf[1] = {0};
+	unsigned char addr_buf[2] = {0x88, 0x00};
+	int rc;
+
+	addr_buf[0] = fastchg_di->addr_low;
+	addr_buf[1] = fastchg_di->addr_high;
+	count = offset;
+	/* write data begin */
+	while (count < (offset + length)) {
+		addr_buf[0] = data_buf[count + 1];
+		addr_buf[1] = data_buf[count];
+
+		rc = oneplus_dash_i2c_write(mcu_client, 0x01, 2, &addr_buf[0]);
+		if (rc < 0) {
+			pr_err("i2c_write 0x01 error\n");
+			return -EFAULT;
+		}
+
+		/* write 16 bytes data to dashchg */
+		oneplus_dash_i2c_write(mcu_client,
+		0x02, BYTES_TO_WRITE, &data_buf[count+BYTE_OFFSET]);
+		oneplus_dash_i2c_write(mcu_client, 0x05, 1, &zero_buf[0]);
+		oneplus_dash_i2c_read(mcu_client, 0x05, 1, &temp_buf[0]);
+
+		/* write 16 bytes data to dashchg again */
+		if (!fastchg_di->n76e_present) {
+			oneplus_dash_i2c_write(mcu_client,
+			0x02, BYTES_TO_WRITE,
+			&data_buf[count+BYTE_OFFSET+BYTES_TO_WRITE]);
+			oneplus_dash_i2c_write(mcu_client,
+					0x05, 1, &zero_buf[0]);
+			oneplus_dash_i2c_read(mcu_client,
+					0x05, 1, &temp_buf[0]);
+			count = count + BYTE_OFFSET + 2 * BYTES_TO_WRITE;
+		} else
+			count = count + BYTE_OFFSET +  BYTES_TO_WRITE;
+
+		usleep_range(2000, 2001);
+		if (count > (offset + length - 1))
+			break;
+	}
+	return 0;
+}
+
+static irqreturn_t irq_rx_handler(int irq, void *dev_id);
+static void reset_mcu_and_request_irq(struct fastchg_device_info *di)
+{
+	int ret;
+
+	pr_info("\n");
+	gpio_direction_output(di->ap_clk, 1);
+	usleep_range(10000, 10001);
+	gpio_direction_output(di->mcu_en_gpio, 1);
+	usleep_range(10000, 10001);
+	gpio_direction_output(di->mcu_en_gpio, 0);
+	usleep_range(5000, 5001);
+	opchg_set_data_active(di);
+	di->irq = gpio_to_irq(di->ap_data);
+
+	/* 0x01:rising edge, 0x02:falling edge */
+	ret = request_irq(di->irq, irq_rx_handler,
+			IRQF_TRIGGER_RISING, "mcu_data", di);
+	if (ret < 0)
+		pr_err("request ap rx irq failed.\n");
+	else
+		di->irq_enabled = true;
+	irq_set_status_flags(di->irq, IRQ_DISABLE_UNLAZY);
+}
+
+
+static void dashchg_fw_update(struct work_struct *work)
+{
+	unsigned char zero_buf[1] = {0};
+	unsigned char addr_buf[2] = {0x88, 0x00};
+	unsigned char temp_buf[1] = {0};
+	int i, rc = 0;
+	unsigned int addr;
+	int download_again = 0;
+	struct fastchg_device_info *di = container_of(work,
+			struct fastchg_device_info,
+			update_firmware.work);
+
+	addr_buf[0] = fastchg_di->addr_low;
+	addr_buf[1] = fastchg_di->addr_high;
+	addr = (addr_buf[0] <<  8)  +  (addr_buf[1] & 0xFF);
+	__pm_stay_awake(&di->fastchg_update_fireware_lock);
+	if (di->n76e_present)
+		rc = n76e_fw_check(di);
+	else
+		rc = dashchg_fw_check();
+	if (rc == FW_CHECK_SUCCESS) {
+		di->firmware_already_updated = true;
+		reset_mcu_and_request_irq(di);
+		__pm_relax(&di->fastchg_update_fireware_lock);
+		set_property_on_smbcharger(POWER_SUPPLY_PROP_SWITCH_DASH, true);
+		pr_info("FW check success\n");
+		return;
+	}
+	pr_info("start erasing data.......\n");
+
+update_fw:
+	/* erase address 0x200-0x7FF */
+	for (i = 0; i < di->erase_count; i++) {
+		/* first:set address */
+		rc = oneplus_dash_i2c_write(mcu_client, 0x01, 2, &addr_buf[0]);
+		if (rc < 0) {
+			pr_err("dashchg_update_fw, i2c_write 0x01 error\n");
+			goto update_fw_err;
+		}
+
+		/* erase data:0x10 words once */
+		if (!di->n76e_present)
+			oneplus_dash_i2c_write(mcu_client,
+					0x04, 1, &zero_buf[0]);
+		usleep_range(1000, 1001);
+		oneplus_dash_i2c_read(mcu_client, 0x04, 1, &temp_buf[0]);
+		if (di->n76e_present)
+			usleep_range(7000, 7100);
+		/* erase data:0x10 words once */
+		addr = addr + 0x10;
+		addr_buf[0] = addr >> 8;
+		addr_buf[1] = addr & 0xFF;
+	}
+	usleep_range(10000, 10001);
+	dashchg_fw_write(dashchg_firmware_data, 0, di->dashchg_fw_ver_count);
+
+	/* fw check begin:read data from mcu and compare*/
+	/*it with dashchg_firmware_data[] */
+	if (di->n76e_present)
+		rc = n76e_fw_check(di);
+	else
+		rc = dashchg_fw_check();
+	if (rc == FW_CHECK_FAIL) {
+		download_again++;
+		if (download_again > 3)
+			goto update_fw_err;
+		mcu_en_gpio_set(0);
+		msleep(1000);
+		pr_err("fw check fail, download fw again\n");
+		goto update_fw;
+	}
+	/* fw check end */
+
+	usleep_range(2000, 2001);
+	/* jump to app code begin */
+	oneplus_dash_i2c_write(mcu_client, 0x06, 1, &zero_buf[0]);
+	oneplus_dash_i2c_read(mcu_client, 0x06, 1, &temp_buf[0]);
+	/* jump to app code end */
+	di->firmware_already_updated = true;
+	reset_mcu_and_request_irq(di);
+	__pm_relax(&di->fastchg_update_fireware_lock);
+	set_property_on_smbcharger(POWER_SUPPLY_PROP_SWITCH_DASH, true);
+	pr_info("result=success\n");
+	return;
+
+update_fw_err:
+	di->firmware_already_updated = true;
+	reset_mcu_and_request_irq(di);
+	__pm_relax(&di->fastchg_update_fireware_lock);
+	set_property_on_smbcharger(POWER_SUPPLY_PROP_SWITCH_DASH, true);
+	pr_err("result=fail\n");
+}
+
+
+static struct external_battery_gauge *bq27541_data;
+void bq27541_information_register(
+	struct external_battery_gauge *fast_chg)
+{
+	if (bq27541_data) {
+		bq27541_data = fast_chg;
+		pr_err("multiple battery gauge called\n");
+	} else {
+		bq27541_data = fast_chg;
+	}
+}
+EXPORT_SYMBOL(bq27541_information_register);
+
+void bq27541_information_unregister(struct external_battery_gauge *batt_gauge)
+{
+	bq27541_data = NULL;
+}
+
+static bool bq27541_fast_chg_started(void)
+{
+	if (fastchg_di)
+		return fastchg_di->fast_chg_started;
+
+	return false;
+}
+
+static bool get_fastchg_status(void)
+{
+	if (fastchg_di)
+		return !fastchg_di->fast_chg_error;
+	return true;
+}
+
+
+
+
+static bool bq27541_get_fast_low_temp_full(void)
+{
+	if (fastchg_di)
+		return fastchg_di->fast_low_temp_full;
+
+	return false;
+}
+
+static int bq27541_set_fast_chg_allow(bool enable)
+{
+	if (fastchg_di)
+		fastchg_di->fast_chg_allow = enable;
+
+	return 0;
+}
+
+static void clean_status(void)
+{
+	if (fastchg_di)
+		fastchg_di->dash_enhance = 0;
+}
+static bool bq27541_get_fast_chg_allow(void)
+{
+	if (fastchg_di)
+		return fastchg_di->fast_chg_allow;
+
+	return false;
+}
+
+static bool bq27541_fast_switch_to_normal(void)
+{
+	if (fastchg_di)
+		return fastchg_di->fast_switch_to_normal;
+
+	return false;
+}
+
+static bool bq27541_get_fast_chg_ing(void)
+{
+	if (fastchg_di)
+		return fastchg_di->fast_chg_ing;
+
+	return false;
+}
+
+
+static int bq27541_set_switch_to_noraml_false(void)
+{
+	if (fastchg_di)
+		fastchg_di->fast_switch_to_normal = false;
+
+	return 0;
+}
+
+static bool get_fastchg_firmware_already_updated(void)
+{
+	if (fastchg_di)
+		return fastchg_di->firmware_already_updated;
+
+	return false;
+}
+
+static bool fastchg_is_usb_switch_on(void)
+{
+	if (fastchg_di)
+		return gpio_get_value(fastchg_di->usb_sw_1_gpio);
+
+	return false;
+}
+
+static bool enhance_dash_on(void)
+{
+	if (fastchg_di)
+		return fastchg_di->dash_enhance;
+
+	return false;
+}
+int dash_get_adapter_update_status(void)
+{
+	if (!fastchg_di)
+		return ADAPTER_FW_UPDATE_NONE;
+	else
+		return fastchg_di->adapter_update_report;
+}
+static struct external_battery_gauge fastcharge_information  = {
+	.fast_chg_status_is_ok =
+		get_fastchg_status,
+	.fast_chg_started =
+		bq27541_fast_chg_started,
+	.get_fast_low_temp_full =
+		bq27541_get_fast_low_temp_full,
+	.fast_switch_to_normal =
+		bq27541_fast_switch_to_normal,
+	.get_fast_chg_ing =
+		bq27541_get_fast_chg_ing,
+	.set_fast_chg_allow =
+		bq27541_set_fast_chg_allow,
+	.get_fast_chg_allow =
+		bq27541_get_fast_chg_allow,
+	.set_switch_to_noraml_false =
+		bq27541_set_switch_to_noraml_false,
+	.get_fastchg_firmware_already_updated =
+		get_fastchg_firmware_already_updated,
+	.is_usb_switch_on = fastchg_is_usb_switch_on,
+	.get_adapter_update = dash_get_adapter_update_status,
+	.is_enhance_dash = enhance_dash_on,
+	.clean = clean_status,
+};
+
+static struct notify_dash_event *notify_event;
+
+void notify_dash_unplug_register(struct notify_dash_event *event)
+{
+	if (notify_event) {
+		notify_event = event;
+		pr_err("multiple battery gauge called\n");
+	} else {
+		notify_event = event;
+	}
+}
+EXPORT_SYMBOL(notify_dash_unplug_register);
+
+void notify_dash_unplug_unregister(struct notify_dash_event *notify_event)
+{
+	notify_event = NULL;
+}
+EXPORT_SYMBOL(notify_dash_unplug_unregister);
+
+static void mcu_init(struct fastchg_device_info *di)
+{
+	gpio_direction_output(di->ap_clk, 0);
+	usleep_range(1000, 1001);
+	gpio_direction_output(di->mcu_en_gpio, 1);
+	usleep_range(1000, 1001);
+	gpio_direction_output(di->mcu_en_gpio, 0);
+}
+
+static irqreturn_t irq_rx_handler(int irq, void *dev_id)
+{
+	struct fastchg_device_info *di = dev_id;
+
+	pr_debug("triggered\n");
+	schedule_work(&di->fastcg_work);
+	return IRQ_HANDLED;
+}
+
+static void oneplus_notify_dash_charger_present(bool status)
+{
+	if (notify_event && notify_event->notify_dash_charger_present)
+		notify_event->notify_dash_charger_present(status);
+}
+
+static void oneplus_notify_pmic_check_charger_present(void)
+{
+	if (notify_event && notify_event->notify_event)
+		notify_event->notify_event();
+}
+
+static void notify_check_usb_suspend(bool status, bool check_power_ok)
+{
+	if (notify_event && notify_event->op_contrl)
+		notify_event->op_contrl(status, check_power_ok);
+}
+
+static void update_charger_present_status(struct work_struct *work)
+{
+	notify_check_usb_suspend(true, true);
+	oneplus_notify_dash_charger_present(false);
+	oneplus_notify_pmic_check_charger_present();
+}
+
+static int op_get_device_type(void)
+{
+	if (bq27541_data && bq27541_data->get_device_type)
+		return bq27541_data->get_device_type();
+	else
+		return 0;
+}
+
+static int onplus_get_battery_mvolts(void)
+{
+	if (bq27541_data && bq27541_data->get_battery_mvolts)
+		return bq27541_data->get_battery_mvolts();
+	else
+		return 4010 * 1000; /* retrun 4.01v for default */
+}
+
+static int onplus_get_battery_temperature(void)
+{
+	if (bq27541_data && bq27541_data->get_battery_temperature)
+		return bq27541_data->get_battery_temperature();
+	else
+		return 255; /* retrun 25.5 for default temp */
+}
+
+static int onplus_get_batt_remaining_capacity(void)
+{
+	if (bq27541_data && bq27541_data->get_batt_remaining_capacity)
+		return bq27541_data->get_batt_remaining_capacity();
+	else
+		return 5; /* retrun 5 for default remaining_capacity */
+}
+
+static int onplus_get_battery_soc(void)
+{
+	if (bq27541_data && bq27541_data->get_battery_soc)
+		return bq27541_data->get_battery_soc();
+	else
+		return 50; /* retrun 50 for default soc */
+}
+
+static int onplus_get_average_current(void)
+{
+	if (bq27541_data && bq27541_data->get_average_current)
+		return bq27541_data->get_average_current();
+	else
+		return 666 * 1000; /* retrun 666ma for default current */
+}
+
+void op_check_charger_collapse_rerun_aicl(void);
+
+void switch_mode_to_normal(void)
+{
+	usb_sw_gpio_set(0);
+	mcu_en_gpio_set(1);
+	msm_cpuidle_set_sleep_disable(false);
+	op_check_charger_collapse_rerun_aicl();
+}
+
+static void update_fast_chg_started(void)
+{
+	if (bq27541_data && bq27541_data->fast_chg_started_status)
+		bq27541_data->fast_chg_started_status(
+		fastchg_di->fast_chg_started);
+}
+
+static void request_mcu_irq(struct fastchg_device_info *di)
+{
+	int retval;
+
+	opchg_set_data_active(di);
+	gpio_set_value(di->ap_clk, 0);
+	usleep_range(10000, 10001);
+	gpio_set_value(di->ap_clk, 1);
+	if (di->adapter_update_real
+		!= ADAPTER_FW_NEED_UPDATE) {
+		pr_info("%s\n", __func__);
+	if (!di->irq_enabled) {
+		retval = request_irq(di->irq, irq_rx_handler,
+				IRQF_TRIGGER_RISING, "mcu_data", di);
+		if (retval < 0)
+			pr_err("request ap rx irq failed.\n");
+		else
+			di->irq_enabled = true;
+		irq_set_status_flags(di->irq, IRQ_DISABLE_UNLAZY);
+		}
+	} else {
+			di->irq_enabled = true;
+	}
+}
+
+static void fastcg_work_func(struct work_struct *work)
+{
+	struct fastchg_device_info *di = container_of(work,
+			struct fastchg_device_info,
+			fastcg_work);
+	pr_info("\n");
+	if (di->irq_enabled) {
+		free_irq(di->irq, di);
+		msleep(25);
+		di->irq_enabled = false;
+		wake_up(&di->read_wq);
+	}
+}
+
+static void update_fireware_version_func(struct work_struct *work)
+{
+	struct fastchg_device_info *di = container_of(work,
+			struct fastchg_device_info,
+			update_fireware_version_work.work);
+
+	if (!dashchg_firmware_data || di->dashchg_fw_ver_count == 0)
+		return;
+
+	snprintf(di->fw_id, 255, "0x%x",
+	dashchg_firmware_data[di->dashchg_fw_ver_count - 4]);
+	snprintf(di->manu_name, 255, "%s", "ONEPLUS");
+	push_component_info(FAST_CHARGE, di->fw_id, di->manu_name);
+}
+void di_watchdog(unsigned long data)
+{
+	struct fastchg_device_info *di = (struct fastchg_device_info *)data;
+
+	pr_err("di_watchdog can't receive mcu data\n");
+	bq27541_data->set_allow_reading(true);
+	di->fast_chg_started = false;
+	di->fast_switch_to_normal = false;
+	di->fast_low_temp_full = false;
+	di->fast_chg_allow = false;
+	di->fast_normal_to_warm = false;
+	di->fast_chg_ing = false;
+	di->fast_chg_error = false;
+	/* switch off fast chg */
+	switch_mode_to_normal();
+	schedule_work(&di->charger_present_status_work);
+	pr_err("switch off fastchg\n");
+
+	__pm_relax(&di->fastchg_wake_lock);
+}
+
+#define MAX_BUFFER_SIZE 1024
+#define ALLOW_DATA 0x2
+#define REJECT_DATA 0x11
+static void dash_write(struct fastchg_device_info *di, int data)
+{
+	int i;
+	int device_type = op_get_device_type();
+
+	usleep_range(2000, 2001);
+	gpio_direction_output(di->ap_data, 0);
+	if (di->pinctrl &&
+		!IS_ERR_OR_NULL(di->pinctrl_mcu_data_state_suspended))
+		pinctrl_select_state(di->pinctrl,
+			di->pinctrl_mcu_data_state_suspended);
+	for (i = 0; i < 3; i++) {
+		if (i == 0)
+			gpio_set_value(di->ap_data, data >> 1);
+		else if (i == 1)
+			gpio_set_value(di->ap_data, data & 0x1);
+		else
+			gpio_set_value(di->ap_data, device_type);
+		gpio_set_value(di->ap_clk, 0);
+		usleep_range(1000, 1001);
+		gpio_set_value(di->ap_clk, 1);
+		usleep_range(19000, 19001);
+	}
+}
+
+static int dash_read(struct fastchg_device_info *di)
+{
+	int i;
+	int bit = 0;
+	int data = 0;
+
+	for (i = 0; i < 7; i++) {
+		gpio_set_value(di->ap_clk, 0);
+		usleep_range(1000, 1001);
+		gpio_set_value(di->ap_clk, 1);
+		usleep_range(19000, 19001);
+		bit = gpio_get_value(di->ap_data);
+		data |= bit<<(6-i);
+	}
+	pr_err("recv data:0x%x\n", data);
+	return data;
+}
+
+static int dash_dev_open(struct inode *inode, struct file *filp)
+{
+	struct fastchg_device_info *dash_dev = container_of(filp->private_data,
+			struct fastchg_device_info, dash_device);
+
+	filp->private_data = dash_dev;
+	pr_debug("%d,%d\n", imajor(inode), iminor(inode));
+	return 0;
+}
+
+static ssize_t dash_dev_read(struct file *filp, char __user *buf,
+		size_t count, loff_t *offset)
+{
+	struct fastchg_device_info *di = filp->private_data;
+
+	int data;
+	int ret = 0;
+
+	mutex_lock(&di->read_mutex);
+	while (1) {
+		ret = wait_event_interruptible(di->read_wq,
+				(!di->irq_enabled));
+		if (ret)
+			goto fail;
+		if (di->irq_enabled)
+			pr_err("dash false wakeup,ret=%d\n", ret);
+		data = dash_read(di);
+		mutex_unlock(&di->read_mutex);
+		if (copy_to_user(buf, &data, 1)) {
+			pr_err("failed to copy to user space\n");
+			return -EFAULT;
+		}
+		break;
+	}
+	return ret;
+fail:
+	mutex_unlock(&di->read_mutex);
+	return ret;
+}
+static struct op_adapter_chip *g_adapter_chip;
+
+static void adapter_update_work_func(struct work_struct *work)
+{
+	struct delayed_work *dwork = to_delayed_work(work);
+	struct fastchg_device_info *chip =
+		container_of(dwork,
+		struct fastchg_device_info, adapter_update_work);
+	bool update_result = false;
+	int i = 0;
+
+	if (!g_adapter_chip) {
+		pr_info("%s g_adapter_chip NULL\n", __func__);
+		return;
+	}
+	pr_info("%s begin\n", __func__);
+	opchg_set_data_active(chip);
+	/*pm_qos_update_request(&big_cpu_update_freq, MAX_CPUFREQ);*/
+	op_bus_vote(false);
+	msleep(1000);
+	for (i = 0; i < 3; i++) {
+		update_result =
+			g_adapter_chip->vops->adapter_update(g_adapter_chip,
+			chip->ap_clk, chip->ap_data);
+		if (update_result == true)
+			break;
+		if (i < 1)
+			msleep(1650);
+	}
+	msleep(5000);
+	if (update_result) {
+		chip->adapter_update_real = ADAPTER_FW_UPDATE_SUCCESS;
+	} else {
+		chip->adapter_update_real = ADAPTER_FW_UPDATE_FAIL;
+		chip->adapter_update_report = chip->adapter_update_real;
+	}
+	msleep(20);
+	mcu_en_gpio_set(1);
+	chip->fast_chg_started = false;
+	chip->fast_chg_allow = false;
+	chip->fast_chg_ing = false;
+	msleep(1000);
+	if (update_result) {
+		msleep(2000);
+		chip->adapter_update_report = ADAPTER_FW_UPDATE_SUCCESS;
+	}
+	notify_check_usb_suspend(true, false);
+	oneplus_notify_pmic_check_charger_present();
+	oneplus_notify_dash_charger_present(false);
+	reset_mcu_and_request_irq(chip);
+
+	pr_info("%s end update_result:%d\n",
+		__func__, update_result);
+	__pm_relax(&chip->fastchg_wake_lock);
+	op_bus_vote(true);
+
+}
+
+static void dash_adapter_update(struct fastchg_device_info *chip)
+{
+	pr_err("%s\n", __func__);
+	/*schedule_delayed_work_on(5,*/
+	/*&chip->adapter_update_work,*/
+	/*round_jiffies_relative(*/
+	/*msecs_to_jiffies(ADAPTER_UPDATE_DELAY)));*/
+	schedule_delayed_work(&chip->adapter_update_work,
+			msecs_to_jiffies(ADAPTER_UPDATE_DELAY));
+}
+void op_adapter_init(struct op_adapter_chip *chip)
+{
+	g_adapter_chip = chip;
+}
+
+#define DASH_IOC_MAGIC					0xff
+#define DASH_NOTIFY_FIRMWARE_UPDATE		_IO(DASH_IOC_MAGIC, 1)
+#define DASH_NOTIFY_FAST_PRESENT		_IOW(DASH_IOC_MAGIC, 2, int)
+#define DASH_NOTIFY_FAST_ABSENT			_IOW(DASH_IOC_MAGIC, 3, int)
+#define DASH_NOTIFY_NORMAL_TEMP_FULL	_IOW(DASH_IOC_MAGIC, 4, int)
+#define DASH_NOTIFY_LOW_TEMP_FULL		_IOW(DASH_IOC_MAGIC, 5, int)
+#define DASH_NOTIFY_BAD_CONNECTED		_IOW(DASH_IOC_MAGIC, 6, int)
+#define DASH_NOTIFY_TEMP_OVER			_IOW(DASH_IOC_MAGIC, 7, int)
+#define DASH_NOTIFY_ADAPTER_FW_UPDATE	_IOW(DASH_IOC_MAGIC, 8, int)
+#define DASH_NOTIFY_BTB_TEMP_OVER		_IOW(DASH_IOC_MAGIC, 9, int)
+#define DASH_NOTIFY_ALLOW_READING_IIC	_IOW(DASH_IOC_MAGIC, 10, int)
+#define DASH_NOTIFY_UNDEFINED_CMD		_IO(DASH_IOC_MAGIC, 11)
+#define DASH_NOTIFY_INVALID_DATA_CMD	_IO(DASH_IOC_MAGIC, 12)
+#define DASH_NOTIFY_REQUEST_IRQ			_IO(DASH_IOC_MAGIC, 13)
+#define DASH_NOTIFY_UPDATE_DASH_PRESENT	_IOW(DASH_IOC_MAGIC, 14, int)
+#define DASH_NOTIFY_UPDATE_ADAPTER_INFO	_IOW(DASH_IOC_MAGIC, 15, int)
+
+static long  dash_dev_ioctl(struct file *filp, unsigned int cmd,
+		unsigned long arg)
+{
+	struct fastchg_device_info *di = filp->private_data;
+	int volt = 0;
+	int temp = 0;
+	int soc = 0;
+	int current_now = 0;
+	int remain_cap = 0;
+
+		switch (cmd) {
+		case DASH_NOTIFY_FIRMWARE_UPDATE:
+			schedule_delayed_work(&di->update_firmware,
+					msecs_to_jiffies(2200));
+			break;
+		case DASH_NOTIFY_FAST_PRESENT:
+			oneplus_notify_dash_charger_present(true);
+			if (arg == DASH_NOTIFY_FAST_PRESENT + 1) {
+				__pm_stay_awake(&di->fastchg_wake_lock);
+				bq27541_data->set_allow_reading(false);
+				di->fast_chg_allow = false;
+				di->fast_normal_to_warm = false;
+				mod_timer(&di->watchdog,
+				jiffies + msecs_to_jiffies(15000));
+			} else if (arg == DASH_NOTIFY_FAST_PRESENT + 2) {
+				pr_err("REJECT_DATA\n");
+				dash_write(di, REJECT_DATA);
+			} else if (arg == DASH_NOTIFY_FAST_PRESENT + 3) {
+				notify_check_usb_suspend(false, false);
+				di->fast_chg_error = false;
+				dash_write(di, ALLOW_DATA);
+				di->fast_chg_started = true;
+				msm_cpuidle_set_sleep_disable(true);
+			}
+			break;
+		case DASH_NOTIFY_FAST_ABSENT:
+			if (arg == DASH_NOTIFY_FAST_ABSENT + 1) {
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+				di->fast_chg_allow = false;
+				di->fast_switch_to_normal = false;
+				di->fast_normal_to_warm = false;
+				di->fast_chg_ing = false;
+				di->dash_enhance = 0;
+				pr_err("fastchg stop unexpectly, switch off fastchg\n");
+				switch_mode_to_normal();
+				del_timer(&di->watchdog);
+				dash_write(di, REJECT_DATA);
+			} else if (arg == DASH_NOTIFY_FAST_ABSENT + 2) {
+				notify_check_usb_suspend(true, true);
+				oneplus_notify_dash_charger_present(false);
+				oneplus_notify_pmic_check_charger_present();
+				__pm_relax(&di->fastchg_wake_lock);
+			}
+			break;
+		case DASH_NOTIFY_ALLOW_READING_IIC:
+			if (arg == DASH_NOTIFY_ALLOW_READING_IIC + 1) {
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = true;
+				di->fast_chg_ing = true;
+				volt = onplus_get_battery_mvolts();
+				temp = onplus_get_battery_temperature();
+				remain_cap =
+				onplus_get_batt_remaining_capacity();
+				soc = onplus_get_battery_soc();
+				current_now = onplus_get_average_current();
+				pr_err("volt:%d,temp:%d,remain_cap:%d,soc:%d,current:%d\n",
+				volt, temp, remain_cap, soc, current_now);
+				if (!di->batt_psy)
+					di->batt_psy =
+					power_supply_get_by_name("battery");
+				if (di->batt_psy)
+					power_supply_changed(di->batt_psy);
+				bq27541_data->set_allow_reading(false);
+				mod_timer(&di->watchdog,
+				jiffies + msecs_to_jiffies(15000));
+				dash_write(di, ALLOW_DATA);
+			}
+			break;
+		case DASH_NOTIFY_BTB_TEMP_OVER:
+			if (di->fast_chg_ing)
+				mod_timer(&di->watchdog,
+					jiffies + msecs_to_jiffies(15000));
+			dash_write(di, ALLOW_DATA);
+			break;
+		case DASH_NOTIFY_UPDATE_ADAPTER_INFO:
+			di->dash_enhance = arg;
+			if (!di->batt_psy)
+				di->batt_psy =
+					power_supply_get_by_name("battery");
+			if (di->batt_psy)
+				power_supply_changed(di->batt_psy);
+			break;
+		case DASH_NOTIFY_BAD_CONNECTED:
+		case DASH_NOTIFY_NORMAL_TEMP_FULL:
+			if (arg == DASH_NOTIFY_NORMAL_TEMP_FULL + 1) {
+				pr_err("fastchg full, switch off fastchg, set usb_sw_gpio 0\n");
+				di->fast_switch_to_normal = true;
+				switch_mode_to_normal();
+				del_timer(&di->watchdog);
+			} else if (arg == DASH_NOTIFY_NORMAL_TEMP_FULL + 2) {
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+				di->fast_chg_allow = false;
+				di->fast_chg_ing = false;
+				di->fast_chg_error = false;
+				notify_check_usb_suspend(true, false);
+				oneplus_notify_pmic_check_charger_present();
+				__pm_relax(&di->fastchg_wake_lock);
+			} else if (arg == DASH_NOTIFY_NORMAL_TEMP_FULL + 3) {
+				op_switch_normal_set();
+			}
+			break;
+		case DASH_NOTIFY_TEMP_OVER:
+			if (arg == DASH_NOTIFY_TEMP_OVER + 1) {
+				pr_err("fastchg temp over\n");
+				switch_mode_to_normal();
+				del_timer(&di->watchdog);
+			} else if (arg == DASH_NOTIFY_TEMP_OVER + 2) {
+				di->fast_normal_to_warm = true;
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+				di->fast_chg_allow = false;
+				di->fast_chg_ing = false;
+				di->fast_chg_error = true;
+				notify_check_usb_suspend(true, false);
+				oneplus_notify_pmic_check_charger_present();
+				oneplus_notify_dash_charger_present(false);
+				__pm_relax(&di->fastchg_wake_lock);
+			}
+			break;
+		case DASH_NOTIFY_ADAPTER_FW_UPDATE:
+			if (arg == DASH_NOTIFY_ADAPTER_FW_UPDATE + 1) {
+				di->adapter_update_real
+					= ADAPTER_FW_NEED_UPDATE;
+				di->adapter_update_report
+					= di->adapter_update_real;
+			} else if (arg == DASH_NOTIFY_ADAPTER_FW_UPDATE + 2) {
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+				oneplus_notify_dash_charger_present(true);
+				dash_write(di, ALLOW_DATA);
+				__pm_stay_awake(&di->fastchg_wake_lock);
+				dash_adapter_update(di);
+			}
+			break;
+		case DASH_NOTIFY_UNDEFINED_CMD:
+			if (di->fast_chg_started) {
+				pr_err("UNDEFINED_CMD, switch off fastchg\n");
+				switch_mode_to_normal();
+				msleep(500); /* avoid i2c conflict */
+				/* data err */
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+			__pm_relax(&di->fastchg_wake_lock);
+				di->fast_chg_allow = false;
+				di->fast_switch_to_normal = false;
+				di->fast_normal_to_warm = false;
+				di->fast_chg_ing = false;
+				di->fast_chg_error = true;
+				notify_check_usb_suspend(true, false);
+			}
+			break;
+		case DASH_NOTIFY_INVALID_DATA_CMD:
+			if (di->fast_chg_started) {
+				bq27541_data->set_allow_reading(true);
+				di->fast_chg_started = false;
+				di->fast_chg_allow = false;
+				di->fast_switch_to_normal = false;
+				di->fast_normal_to_warm = false;
+				di->fast_chg_ing = false;
+				di->fast_chg_error = true;
+				pr_err("DASH_NOTIFY_INVALID_DATA_CMD, switch off fastchg\n");
+				switch_mode_to_normal();
+				del_timer(&di->watchdog);
+			__pm_relax(&di->fastchg_wake_lock);
+				notify_check_usb_suspend(true, true);
+				oneplus_notify_pmic_check_charger_present();
+			}
+			break;
+		case DASH_NOTIFY_REQUEST_IRQ:
+			request_mcu_irq(di);
+			break;
+		case DASH_NOTIFY_UPDATE_DASH_PRESENT:
+			if (arg == DASH_NOTIFY_UPDATE_DASH_PRESENT+1)
+				update_fast_chg_started();
+			break;
+		default:
+			pr_err("bad ioctl %u\n", cmd);
+	}
+	return 0;
+}
+
+static ssize_t dash_dev_write(struct file *filp, const char __user *buf,
+		size_t count, loff_t *offset)
+{
+	struct fastchg_device_info *di = filp->private_data;
+
+	dashchg_firmware_data = kmalloc(count, GFP_ATOMIC);
+	/*malloc for firmware, do not free*/
+	if (di->firmware_already_updated)
+		return 0;
+	di->dashchg_fw_ver_count = count;
+	if (copy_from_user(dashchg_firmware_data, buf, count)) {
+		pr_err("failed to copy from user space\n");
+		kfree(dashchg_firmware_data);
+		return -EFAULT;
+	}
+	schedule_delayed_work(&di->update_fireware_version_work,
+			msecs_to_jiffies(SHOW_FW_VERSION_DELAY_MS));
+	pr_info("fw_ver_count=%d\n", di->dashchg_fw_ver_count);
+	return count;
+}
+
+static const struct file_operations dash_dev_fops = {
+	.owner			= THIS_MODULE,
+	.llseek			= no_llseek,
+	.write			= dash_dev_write,
+	.read			= dash_dev_read,
+	.open			= dash_dev_open,
+	.unlocked_ioctl	= dash_dev_ioctl,
+};
+
+static int dash_parse_dt(struct fastchg_device_info *di)
+{
+	u32 flags;
+	int rc;
+	struct device_node *dev_node = di->client->dev.of_node;
+
+	if (!dev_node) {
+		pr_err("device tree info. missing\n");
+		return -EINVAL;
+	}
+
+	di->usb_sw_1_gpio = of_get_named_gpio_flags(dev_node,
+			"microchip,usb-sw-1-gpio", 0, &flags);
+	di->usb_sw_2_gpio = of_get_named_gpio_flags(dev_node,
+			"microchip,usb-sw-2-gpio", 0, &flags);
+	di->ap_clk = of_get_named_gpio_flags(dev_node,
+			"microchip,ap-clk", 0, &flags);
+	di->ap_data = of_get_named_gpio_flags(dev_node,
+			"microchip,ap-data", 0, &flags);
+	di->mcu_en_gpio = of_get_named_gpio_flags(dev_node,
+			"microchip,mcu-en-gpio", 0, &flags);
+	di->n76e_present = of_property_read_bool(dev_node,
+			"op,n76e_support");
+	di->is_mcl_verion = of_property_read_bool(dev_node,
+		"op,mcl_verion");
+	rc = of_property_read_u32(dev_node,
+			"op,fw-erase-count", &di->erase_count);
+	if (rc < 0)
+		di->erase_count = 384;
+	rc = of_property_read_u32(dev_node,
+			"op,fw-addr-low", &di->addr_low);
+	if (rc < 0)
+		di->addr_low = 0x88;
+	rc = of_property_read_u32(dev_node,
+			"op,fw-addr-high", &di->addr_high);
+	if (rc < 0)
+		di->addr_high = 0;
+	return 0;
+}
+
+static int request_dash_gpios(struct fastchg_device_info *di)
+{
+	int ret;
+
+	if (gpio_is_valid(di->usb_sw_1_gpio)
+		&& gpio_is_valid(di->usb_sw_2_gpio)) {
+		ret = gpio_request(di->usb_sw_1_gpio, "usb_sw_1_gpio");
+		if (ret) {
+			pr_err("gpio_request failed for %d ret=%d\n",
+			di->usb_sw_1_gpio, ret);
+			return -EINVAL;
+		}
+		gpio_direction_output(di->usb_sw_1_gpio, 0);
+
+		ret = gpio_request(di->usb_sw_2_gpio, "usb_sw_2_gpio");
+		if (ret) {
+			pr_err("gpio_request failed for %d ret=%d\n",
+			di->usb_sw_2_gpio, ret);
+			return -EINVAL;
+		}
+		gpio_direction_output(di->usb_sw_2_gpio, 0);
+
+	} else
+		return -EINVAL;
+
+	if (gpio_is_valid(di->ap_clk)) {
+		ret = gpio_request(di->ap_clk, "ap_clk");
+		if (ret)
+			pr_err("gpio_request failed for %d ret=%d\n",
+			di->ap_clk, ret);
+	}
+
+	if (gpio_is_valid(di->mcu_en_gpio)) {
+		ret = gpio_request(di->mcu_en_gpio, "mcu_en_gpio");
+		if (ret)
+			pr_err("gpio_request failed for %d ret=%d\n",
+			di->mcu_en_gpio, ret);
+		else
+			gpio_direction_output(di->mcu_en_gpio, 0);
+	}
+
+	if (gpio_is_valid(di->ap_data)) {
+		ret = gpio_request(di->ap_data, "mcu_data");
+		if (ret)
+			pr_err("gpio_request failed for %d ret=%d\n",
+			di->ap_data, ret);
+
+	}
+
+	return 0;
+}
+
+static int dash_pinctrl_init(struct fastchg_device_info *di)
+{
+	di->pinctrl = devm_pinctrl_get(&di->client->dev);
+	if (IS_ERR_OR_NULL(di->pinctrl)) {
+		dev_err(&di->client->dev,
+				"Unable to acquire pinctrl\n");
+		di->pinctrl = NULL;
+		return 0;
+	} else {
+	di->pinctrl_state_active =
+		pinctrl_lookup_state(di->pinctrl, "mux_fastchg_active");
+	if (IS_ERR_OR_NULL(di->pinctrl_state_active)) {
+		dev_err(&di->client->dev,
+				"Can not fastchg_active state\n");
+		devm_pinctrl_put(di->pinctrl);
+		di->pinctrl = NULL;
+		return PTR_ERR(di->pinctrl_state_active);
+	}
+	di->pinctrl_state_suspended =
+		pinctrl_lookup_state(di->pinctrl,
+				"mux_fastchg_suspend");
+	if (IS_ERR_OR_NULL(di->pinctrl_state_suspended)) {
+		dev_err(&di->client->dev,
+				"Can not fastchg_suspend state\n");
+		devm_pinctrl_put(di->pinctrl);
+		di->pinctrl = NULL;
+		return PTR_ERR(di->pinctrl_state_suspended);
+	}
+
+		di->pinctrl_mcu_data_state_active =
+			pinctrl_lookup_state(di->pinctrl,
+					"mcu_data_active");
+		if (IS_ERR_OR_NULL(di->pinctrl_mcu_data_state_active)) {
+			dev_err(&di->client->dev,
+					"Can not mcu_data_active state\n");
+			devm_pinctrl_put(di->pinctrl);
+			di->pinctrl = NULL;
+			return PTR_ERR(di->pinctrl_mcu_data_state_active);
+		}
+		di->pinctrl_mcu_data_state_suspended =
+					pinctrl_lookup_state(di->pinctrl,
+							"mcu_data_suspend");
+		if (IS_ERR_OR_NULL(di->pinctrl_mcu_data_state_suspended)) {
+			dev_err(&di->client->dev,
+					"Can not fastchg_suspend state\n");
+			devm_pinctrl_put(di->pinctrl);
+			di->pinctrl = NULL;
+			return PTR_ERR(di->pinctrl_mcu_data_state_suspended);
+		}
+	}
+
+	if (pinctrl_select_state(di->pinctrl,
+				di->pinctrl_state_active) < 0)
+		pr_err("pinctrl set active fail\n");
+
+	if (pinctrl_select_state(di->pinctrl,
+				di->pinctrl_mcu_data_state_active) < 0)
+		pr_err("pinctrl set pinctrl_mcu_data_state_active fail\n");
+
+	return 0;
+
+}
+
+static void check_n76e_support(struct fastchg_device_info *di)
+{
+	if (di->n76e_present) {
+		init_n76e_exist_node();
+		pr_info("n76e exist\n");
+	} else {
+		pr_info("n76e not exist\n");
+	}
+
+}
+
+static void check_enhance_support(struct fastchg_device_info *di)
+{
+	if (di->is_mcl_verion) {
+		init_warp_chg_exist_node();
+		pr_info("warp dash exist\n");
+	} else {
+		pr_info("warp dash not exist\n");
+	}
+
+}
+static int dash_probe(struct i2c_client *client, const struct i2c_device_id *id)
+{
+	struct fastchg_device_info *di;
+	int ret;
+
+	pr_info("dash_probe\n");
+	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+		pr_err("i2c_func error\n");
+		goto err_check_functionality_failed;
+	}
+
+	di = kzalloc(sizeof(*di), GFP_KERNEL);
+	if (!di) {
+		ret = -ENOMEM;
+		goto err_check_functionality_failed;
+	}
+	di->client = mcu_client = client;
+	di->firmware_already_updated = false;
+	di->irq_enabled = true;
+	di->fast_chg_ing = false;
+	di->fast_low_temp_full = false;
+	di->fast_chg_started = false;
+
+	fastchg_di = di;
+
+	ret = dash_parse_dt(di);
+	if (ret == -EINVAL)
+		goto err_read_dt;
+
+	ret = request_dash_gpios(di);
+    /*
+	if (ret < 0)
+		goto err_read_dt;
+    */
+	dash_pinctrl_init(di);
+	mutex_init(&di->read_mutex);
+
+	init_waitqueue_head(&di->read_wq);
+	wakeup_source_init(&di->fastchg_wake_lock, "fastcg_wake_lock");
+	wakeup_source_init(&di->fastchg_update_fireware_lock,
+		"fastchg_fireware_lock");
+
+	INIT_WORK(&di->fastcg_work, fastcg_work_func);
+	INIT_WORK(&di->charger_present_status_work,
+		update_charger_present_status);
+	INIT_DELAYED_WORK(&di->update_fireware_version_work,
+		update_fireware_version_func);
+	INIT_DELAYED_WORK(&di->update_firmware, dashchg_fw_update);
+	INIT_DELAYED_WORK(&di->adapter_update_work, adapter_update_work_func);
+
+	init_timer(&di->watchdog);
+	di->watchdog.data = (unsigned long)di;
+	di->watchdog.function = di_watchdog;
+
+	di->dash_device.minor = MISC_DYNAMIC_MINOR;
+	di->dash_device.name = "dash";
+	di->dash_device.fops = &dash_dev_fops;
+	ret = misc_register(&di->dash_device);
+	if (ret) {
+		pr_err("%s : misc_register failed\n", __FILE__);
+		goto err_misc_register_failed;
+	}
+
+	mcu_init(di);
+	check_n76e_support(di);
+	check_enhance_support(di);
+	init_enhance_dash_exist_node();
+	fastcharge_information_register(&fastcharge_information);
+	pr_info("dash_probe success\n");
+
+	return 0;
+
+err_misc_register_failed:
+err_read_dt:
+	kfree(di);
+err_check_functionality_failed:
+	pr_err("dash_probe fail\n");
+	return 0;
+}
+
+static int dash_remove(struct i2c_client *client)
+{
+	struct fastchg_device_info *di = dev_get_drvdata(&client->dev);
+
+	fastcharge_information_unregister(&fastcharge_information);
+	if (gpio_is_valid(di->mcu_en_gpio))
+		gpio_free(di->mcu_en_gpio);
+	if (gpio_is_valid(di->usb_sw_1_gpio))
+		gpio_free(di->usb_sw_1_gpio);
+	if (gpio_is_valid(di->usb_sw_2_gpio))
+		gpio_free(di->usb_sw_2_gpio);
+	if (gpio_is_valid(di->ap_clk))
+		gpio_free(di->ap_clk);
+	if (gpio_is_valid(di->ap_data))
+		gpio_free(di->ap_data);
+
+	return 0;
+}
+
+static void dash_shutdown(struct i2c_client *client)
+{
+	usb_sw_gpio_set(0);
+	mcu_en_reset();
+}
+
+static const struct of_device_id dash_match[] = {
+	{ .compatible = "microchip,oneplus_fastchg" },
+	{ },
+};
+
+static const struct i2c_device_id dash_id[] = {
+	{ "dash_fastchg", 1 },
+	{},
+};
+MODULE_DEVICE_TABLE(i2c, dash_id);
+
+static struct i2c_driver dash_fastcg_driver = {
+	.driver		= {
+		.name = "dash_fastchg",
+		.owner	= THIS_MODULE,
+		.of_match_table = dash_match,
+	},
+	.probe		= dash_probe,
+	.remove		= dash_remove,
+	.shutdown	= dash_shutdown,
+	.id_table	= dash_id,
+};
+
+static int __init dash_fastcg_init(void)
+{
+	return i2c_add_driver(&dash_fastcg_driver);
+}
+module_init(dash_fastcg_init);
+
+static void __exit dash_fastcg_exit(void)
+{
+	i2c_del_driver(&dash_fastcg_driver);
+}
+module_exit(dash_fastcg_exit);
diff --git a/drivers/power/supply/qcom/op_charge.h b/drivers/power/supply/qcom/op_charge.h
new file mode 100644
index 0000000000000000000000000000000000000000..c0501968b97ab302a018c85e326bc36f0b363073
--- /dev/null
+++ b/drivers/power/supply/qcom/op_charge.h
@@ -0,0 +1,691 @@
+/* Copyright (c) 2016-2018 The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef __OP_CHARGE_H__
+#define __OP_CHARGE_H__
+
+int con_temp_30k[] = {
+	-40,
+	-39,
+	-38,
+	-37,
+	-36,
+	-35,
+	-34,
+	-33,
+	-32,
+	-31,
+	-30,
+	-29,
+	-28,
+	-27,
+	-26,
+	-25,
+	-24,
+	-23,
+	-22,
+	-21,
+	-20,
+	-19,
+	-18,
+	-17,
+	-16,
+	-15,
+	-14,
+	-13,
+	-12,
+	-11,
+	-10,
+	-9,
+	-8,
+	-7,
+	-6,
+	-5,
+	-4,
+	-3,
+	-2,
+	-1,
+	0,
+	1,
+	2,
+	3,
+	4,
+	5,
+	6,
+	7,
+	8,
+	9,
+	10,
+	11,
+	12,
+	13,
+	14,
+	15,
+	16,
+	17,
+	18,
+	19,
+	20,
+	21,
+	22,
+	23,
+	24,
+	25,
+	26,
+	27,
+	28,
+	29,
+	30,
+	31,
+	32,
+	33,
+	34,
+	35,
+	36,
+	37,
+	38,
+	39,
+	40,
+	41,
+	42,
+	43,
+	44,
+	45,
+	46,
+	47,
+	48,
+	49,
+	50,
+	51,
+	52,
+	53,
+	54,
+	55,
+	56,
+	57,
+	58,
+	59,
+	60,
+	61,
+	62,
+	63,
+	64,
+	65,
+	66,
+	67,
+	68,
+	69,
+	70,
+	71,
+	72,
+	73,
+	74,
+	75,
+	76,
+	77,
+	78,
+	79,
+	80,
+	81,
+	82,
+	83,
+	84,
+	85,
+	86,
+	87,
+	88,
+	89,
+	90,
+	91,
+	92,
+	93,
+	94,
+	95,
+	96,
+	97,
+	98,
+	99,
+	100,
+	101,
+	102,
+	103,
+	104,
+	105,
+	106,
+	107,
+	108,
+	109,
+	110,
+	111,
+	112,
+	113,
+	114,
+	115,
+	116,
+	117,
+	118,
+	119,
+	120,
+	121,
+	122,
+	123,
+	124,
+	125,
+};
+
+int con_volt_30k[] = {
+	1774,
+	1773,
+	1771,
+	1769,
+	1767,
+	1764,
+	1762,
+	1759,
+	1757,
+	1754,
+	1751,
+	1747,
+	1744,
+	1740,
+	1737,
+	1733,
+	1728,
+	1724,
+	1719,
+	1714,
+	1709,
+	1704,
+	1698,
+	1692,
+	1686,
+	1679,
+	1672,
+	1665,
+	1658,
+	1650,
+	1642,
+	1633,
+	1624,
+	1615,
+	1605,
+	1595,
+	1585,
+	1574,
+	1563,
+	1552,
+	1540,
+	1527,
+	1515,
+	1501,
+	1488,
+	1474,
+	1460,
+	1445,
+	1430,
+	1414,
+	1399,
+	1382,
+	1366,
+	1349,
+	1332,
+	1314,
+	1296,
+	1278,
+	1260,
+	1241,
+	1222,
+	1203,
+	1184,
+	1164,
+	1144,
+	1125,
+	1105,
+	1084,
+	1064,
+	1044,
+	1024,
+	1004,
+	983,
+	963,
+	943,
+	923,
+	903,
+	883,
+	863,
+	843,
+	824,
+	804,
+	785,
+	766,
+	748,
+	729,
+	711,
+	693,
+	675,
+	658,
+	641,
+	624,
+	607,
+	591,
+	575,
+	559,
+	544,
+	529,
+	514,
+	500,
+	486,
+	472,
+	459,
+	446,
+	433,
+	421,
+	408,
+	397,
+	385,
+	374,
+	363,
+	352,
+	342,
+	332,
+	322,
+	313,
+	303,
+	294,
+	286,
+	278,
+	269,
+	261,
+	254,
+	246,
+	239,
+	232,
+	225,
+	218,
+	212,
+	206,
+	200,
+	194,
+	188,
+	182,
+	177,
+	172,
+	167,
+	162,
+	157,
+	153,
+	148,
+	144,
+	140,
+	136,
+	132,
+	128,
+	125,
+	121,
+	118,
+	114,
+	111,
+	108,
+	105,
+	102,
+	99,
+	96,
+	94,
+	91,
+	89,
+	86,
+	84,
+	82,
+	79,
+	77,
+	75,
+	73,
+};
+
+int con_volt[] = {
+	1721,
+	1716,
+	1710,
+	1704,
+	1697,
+	1690,
+	1683,
+	1675,
+	1667,
+	1658,
+	1649,
+	1640,
+	1630,
+	1620,
+	1609,
+	1597,
+	1586,
+	1573,
+	1560,
+	1547,
+	1533,
+	1519,
+	1504,
+	1488,
+	1472,
+	1456,
+	1438,
+	1421,
+	1403,
+	1384,
+	1365,
+	1346,
+	1326,
+	1305,
+	1285,
+	1263,
+	1242,
+	1220,
+	1198,
+	1176,
+	1153,
+	1130,
+	1107,
+	1084,
+	1061,
+	1038,
+	1014,
+	991,
+	967,
+	944,
+	921,
+	898,
+	875,
+	852,
+	829,
+	807,
+	785,
+	763,
+	741,
+	720,
+	699,
+	678,
+	658,
+	638,
+	619,
+	600,
+	581,
+	563,
+	545,
+	527,
+	510,
+	494,
+	477,
+	462,
+	446,
+	432,
+	417,
+	403,
+	389,
+	376,
+	363,
+	351,
+	339,
+	327,
+	316,
+	305,
+	295,
+	284,
+	274,
+	265,
+	256,
+	247,
+	238,
+	230,
+	222,
+	214,
+	207,
+	200,
+	193,
+	186,
+	180,
+	173,
+	167,
+	162,
+	156,
+	151,
+	145,
+	140,
+	136,
+	131,
+	127,
+	122,
+	118,
+	114,
+	110,
+	106,
+	103,
+	99,
+	96,
+	93,
+	90,
+	87,
+	84,
+	81,
+	79,
+	76,
+	73,
+	71,
+	69,
+	67,
+	64,
+	62,
+	60,
+	58,
+	57,
+	55,
+	53,
+	51,
+	50,
+	48,
+	47,
+	45,
+	44,
+	42,
+	41,
+	40,
+	39,
+	38,
+	36,
+	35,
+	34,
+	33,
+	32,
+	31,
+	30,
+	29,
+	29,
+	28,
+	27,
+	26,
+	25,
+	25,
+	24,
+	23,
+	23,
+	22,
+};
+
+int con_temp[] = {
+	-40,
+	-39,
+	-38,
+	-37,
+	-36,
+	-35,
+	-34,
+	-33,
+	-32,
+	-31,
+	-30,
+	-29,
+	-28,
+	-27,
+	-26,
+	-25,
+	-24,
+	-23,
+	-22,
+	-21,
+	-20,
+	-19,
+	-18,
+	-17,
+	-16,
+	-15,
+	-14,
+	-13,
+	-12,
+	-11,
+	-10,
+	-9,
+	-8,
+	-7,
+	-6,
+	-5,
+	-4,
+	-3,
+	-2,
+	-1,
+	0,
+	1,
+	2,
+	3,
+	4,
+	5,
+	6,
+	7,
+	8,
+	9,
+	10,
+	11,
+	12,
+	13,
+	14,
+	15,
+	16,
+	17,
+	18,
+	19,
+	20,
+	21,
+	22,
+	23,
+	24,
+	25,
+	26,
+	27,
+	28,
+	29,
+	30,
+	31,
+	32,
+	33,
+	34,
+	35,
+	36,
+	37,
+	38,
+	39,
+	40,
+	41,
+	42,
+	43,
+	44,
+	45,
+	46,
+	47,
+	48,
+	49,
+	50,
+	51,
+	52,
+	53,
+	54,
+	55,
+	56,
+	57,
+	58,
+	59,
+	60,
+	61,
+	62,
+	63,
+	64,
+	65,
+	66,
+	67,
+	68,
+	69,
+	70,
+	71,
+	72,
+	73,
+	74,
+	75,
+	76,
+	77,
+	78,
+	79,
+	80,
+	81,
+	82,
+	83,
+	84,
+	85,
+	86,
+	87,
+	88,
+	89,
+	90,
+	91,
+	92,
+	93,
+	94,
+	95,
+	96,
+	97,
+	98,
+	99,
+	100,
+	101,
+	102,
+	103,
+	104,
+	105,
+	106,
+	107,
+	108,
+	109,
+	110,
+	111,
+	112,
+	113,
+	114,
+	115,
+	116,
+	117,
+	118,
+	119,
+	120,
+	121,
+	122,
+	123,
+	124,
+	125,
+};
+#endif /* __OP_CHARGE_H__ */
diff --git a/drivers/power/supply/qcom/op_dash_adapter.c b/drivers/power/supply/qcom/op_dash_adapter.c
new file mode 100644
index 0000000000000000000000000000000000000000..9a9a200ff939bd280a3d05b03b0d2daad07d7aaf
--- /dev/null
+++ b/drivers/power/supply/qcom/op_dash_adapter.c
@@ -0,0 +1,598 @@
+#include <linux/gpio.h>
+#include <linux/delay.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/time.h>
+#include "op_dash_adapter.h"
+#include <linux/power/oem_external_fg.h>
+
+static struct op_adapter_chip *the_chip;
+
+#define DEFALUT_TX_VALUE 0xFF
+static void dash_uart_gpio_set_value(struct op_adapter_chip *chip,
+	unsigned long pin, bool value)
+{
+	if (chip->tx_invalid_val != value) {
+		gpio_set_value(pin, value);
+		chip->tx_invalid_val = value;
+	}
+}
+
+#define update_cycle 998
+#define  LOG_COUNT 30
+int rx_time[LOG_COUNT];
+int tx_time[LOG_COUNT];
+void print_oem(void)
+{
+	int i;
+
+	for (i = 0; i < LOG_COUNT - 1; i++)
+		pr_info("rx=%d, tx=%d\n", rx_time[i], tx_time[i]);
+}
+
+static int dash_uart_gpio_get_value(unsigned long pin)
+{
+	return gpio_get_value(pin);
+}
+
+void oem_delay(struct op_adapter_chip *chip, cycles_t begin_time)
+{
+	cycles_t time, curl_time;
+
+	if (chip->timer_delay == 52) {
+		do {
+			curl_time = get_cycles();
+			time = curl_time - begin_time;
+		} while (time < update_cycle);
+	} else if (chip->timer_delay == 78) {
+		do {
+			curl_time = get_cycles();
+			time = curl_time - begin_time;
+		} while (time < update_cycle * 3 / 2);
+	} else if (chip->timer_delay == 25) {
+		do {
+			curl_time = get_cycles();
+			time = curl_time - begin_time;
+		} while (time < update_cycle / 2);
+	} else if (chip->timer_delay == 2) {
+		do {
+			curl_time = get_cycles();
+			time = curl_time - begin_time;
+		} while (time < 30);
+	} else {
+		udelay(chip->timer_delay);
+	}
+}
+
+static void dash_uart_tx_bit(
+	struct op_adapter_chip *chip, unsigned char tx_data)
+{
+	static unsigned char tx_bit = BIT_START;
+
+	switch (tx_bit) {
+	case BIT_START:
+		chip->tx_byte_over = false;
+		dash_uart_gpio_set_value(
+			chip, chip->uart_tx_gpio, 0);
+		tx_bit = BIT_0;
+		break;
+	case BIT_0:
+	case BIT_1:
+	case BIT_2:
+	case BIT_3:
+	case BIT_4:
+	case BIT_5:
+	case BIT_6:
+	case BIT_7:
+		if (tx_data & (1 << tx_bit))
+			dash_uart_gpio_set_value(
+			chip, chip->uart_tx_gpio, 1);
+		else
+			dash_uart_gpio_set_value(
+			chip, chip->uart_tx_gpio, 0);
+			tx_bit++;
+		break;
+	case BIT_STOP:
+	case BIT_IDLE:
+		dash_uart_gpio_set_value(chip, chip->uart_tx_gpio, 1);
+		tx_bit = BIT_START;
+		chip->tx_byte_over = true;
+		break;
+	default:
+		break;
+	}
+}
+
+static int dash_uart_rx_bit(struct op_adapter_chip *chip)
+{
+	static unsigned char rx_bit = BIT_IDLE, rx_val;
+
+	switch (rx_bit) {
+	case BIT_IDLE:
+		chip->rx_byte_over = false;
+		if (!dash_uart_gpio_get_value(chip->uart_rx_gpio)) {
+			rx_bit = BIT_0;
+			chip->timer_delay = 78; /* 1.5 cycle */
+		} else {
+			chip->timer_delay = 2;	/* 0.02 cycle */
+		}
+		break;
+	case BIT_0:
+	case BIT_1:
+	case BIT_2:
+	case BIT_3:
+	case BIT_4:
+	case BIT_5:
+	case BIT_6:
+	case BIT_7:
+		chip->timer_delay = 52; /* 1 cycle */
+		if (dash_uart_gpio_get_value(chip->uart_rx_gpio))
+			rx_val |= (1 << rx_bit);
+		else
+			rx_val &= ~(1 << rx_bit);
+		rx_bit++;
+		break;
+	case BIT_STOP:
+		rx_bit = BIT_IDLE;
+		chip->rx_byte_over = true;
+		break;
+	default:
+		break;
+	}
+
+	return rx_val;
+}
+
+static void dash_uart_tx_byte(
+	struct op_adapter_chip *chip, unsigned char tx_data)
+{
+	cycles_t time, curl_time, begin_time;
+	int i = 0;
+
+	chip->timer_delay = 52;
+	while (1) {
+		begin_time = get_cycles();
+		mb();/*need const tx*/
+		dash_uart_tx_bit(chip, tx_data);
+		curl_time = get_cycles();
+		time = curl_time - begin_time;
+		tx_time[i++] = time;
+
+		if (i > LOG_COUNT - 1)
+			i = 0;
+
+		oem_delay(chip, begin_time);
+		if (chip->tx_byte_over) {
+			chip->timer_delay = 25;
+			break;
+		}
+	}
+}
+
+static unsigned char dash_uart_rx_byte(
+	struct op_adapter_chip *chip, unsigned int cmd)
+{
+	unsigned char rx_val = 0;
+	unsigned int count = 0;
+	unsigned int max_count = 0;
+	cycles_t time, curl_time, begin_time;
+	int i = 0;
+
+	if (cmd == Read_Addr_Line_Cmd)
+		max_count = Read_Addr_Line_Cmd_Count;
+	else if (cmd == Write_Addr_Line_Cmd)
+		max_count = Write_Addr_Line_Cmd_Count;
+	else if (cmd == Erase_Addr_Line_Cmd)
+		max_count = Erase_Addr_Line_Cmd_Count;
+	else if (cmd == Read_All_Cmd)
+		max_count = Read_All_Cmd_Count;
+	else if (cmd == Erase_All_Cmd)
+		max_count = Erase_All_Cmd_Count;
+	else if (cmd == Boot_Over_Cmd)
+		max_count = Boot_Over_Cmd_Count;
+	else
+		max_count = Other_Cmd_count;
+
+	chip->rx_timeout = false;
+	chip->timer_delay = 25;
+	while (1) {
+		begin_time = get_cycles();
+		mb();/*need a const rx*/
+		rx_val = dash_uart_rx_bit(chip);
+		curl_time = get_cycles();
+		time = curl_time - begin_time;
+		rx_time[i++] = time;
+
+		if (i > LOG_COUNT - 1)
+			i = 0;
+
+		oem_delay(chip, begin_time);
+		if (chip->rx_byte_over)
+			return rx_val;
+		if (count > max_count) {
+			chip->rx_timeout = true;
+			return 0x00;
+		}
+		count++;
+	}
+}
+
+static void dash_uart_irq_fiq_enable(bool enable)
+{
+	if (enable) {
+		preempt_enable();
+		local_fiq_enable();
+		local_irq_enable();
+	} else {
+		local_irq_disable();
+		local_fiq_disable();
+		preempt_disable();
+	}
+}
+
+static int dash_uart_write_some_addr(
+	struct op_adapter_chip *chip, u8 *fw_buf, int length)
+{
+	unsigned int write_addr = 0, i = 0, fw_count = 0;
+	unsigned char rx_val = 0;
+
+	while (1) {
+		/* tx: 0xF5 */
+		dash_uart_irq_fiq_enable(false);
+		dash_uart_tx_byte(chip, (Write_Addr_Line_Cmd >> 8) & 0xff);
+		/* tx: 0x02 */
+		dash_uart_tx_byte(chip, Write_Addr_Line_Cmd & 0xff);
+		/* count:16 bytes */
+		dash_uart_tx_byte(chip, 16);
+
+		/* addr: 2 byte */
+		if (write_addr == 0)
+			write_addr =
+			(fw_buf[fw_count + 1] << 8)
+			| fw_buf[fw_count];
+		dash_uart_tx_byte(chip, (write_addr >> 8) & 0xff);
+		dash_uart_tx_byte(chip, write_addr & 0xff);
+
+		if (!(write_addr % 0x20))
+			fw_count += 2;
+
+		/* data: 16 bytes */
+		for (i = 0; i < 16; i++) {
+			dash_uart_tx_byte(chip, fw_buf[fw_count]);
+			fw_count++;
+
+			if (i == 15)
+				rx_val = dash_uart_rx_byte(
+					chip, Write_Addr_Line_Cmd);
+		}
+
+		dash_uart_irq_fiq_enable(true);
+		write_addr += 16;
+		if (rx_val != UART_ACK || chip->rx_timeout) {
+			pr_err("%s err,write_addr:0x%x,chip->rx_timeout:%d,rx_val=%d\n",
+				__func__, write_addr,
+				chip->rx_timeout, rx_val);
+			return -EINVAL;
+		}
+		if (fw_count >= length)
+			return 0;
+	}
+}
+
+#define STM8S_ADAPTER_FIRST_ADDR	0x8C00
+#define STM8S_ADAPTER_LAST_ADDR		0x9FEF
+#define HALF_ONE_LINE			16
+
+static bool dash_uart_read_addr_line_and_check(
+	struct op_adapter_chip *chip, unsigned int addr)
+{
+	unsigned char fw_check_buf[20] = {0x00};
+	int i = 0;
+	static int fw_line;
+	bool check_result = false;
+	int addr_check_err = 0;
+
+	if (addr == STM8S_ADAPTER_FIRST_ADDR)
+		fw_line = 0;
+
+	/* Tx_Read_Addr_Line */
+	/* tx:0xF5 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Read_Addr_Line_Cmd >> 8) & 0xff);
+	/* tx:0x01 */
+	dash_uart_tx_byte(chip, Read_Addr_Line_Cmd & 0xff);
+	/* tx:0x9F */
+	dash_uart_tx_byte(chip, (addr >> 8) & 0xff);
+	/* tx:0xF0 */
+	dash_uart_tx_byte(chip, addr & 0xff);
+
+	fw_check_buf[0] = dash_uart_rx_byte(chip, Read_Addr_Line_Cmd);
+	if (chip->rx_timeout)
+		goto read_addr_line_err;
+
+	fw_check_buf[1] = dash_uart_rx_byte(chip, Read_Addr_Line_Cmd);
+	if (chip->rx_timeout)
+		goto read_addr_line_err;
+
+	if (addr != ((fw_check_buf[0] << 8) | fw_check_buf[1])) {
+		addr_check_err = 1;
+		goto read_addr_line_err;
+	}
+
+	for (i = 0; i < 16; i++) {
+		fw_check_buf[i + 2] =
+			dash_uart_rx_byte(chip, Read_Addr_Line_Cmd);
+		if (chip->rx_timeout)
+			goto  read_addr_line_err;
+	}
+
+	if (!(addr % 0x20)) {
+		if (addr == ((adapter_stm8s_firmware_data[fw_line * 34 + 1]
+			<< 8)
+			| (adapter_stm8s_firmware_data[fw_line * 34]))) {
+			for (i = 0; i < 16; i++) {
+				if (fw_check_buf[i + 2]
+					!= adapter_stm8s_firmware_data[
+					fw_line * 34 + 2 + i])
+					goto read_addr_line_err;
+			}
+		}
+	} else {
+		if ((addr - 16) ==
+			((adapter_stm8s_firmware_data[fw_line * 34 + 1] << 8)
+			| (adapter_stm8s_firmware_data[fw_line * 34]))) {
+			for (i = 0; i < 16; i++) {
+				if (fw_check_buf[i + 2]
+					!= adapter_stm8s_firmware_data[
+					fw_line * 34
+					+ 2 + HALF_ONE_LINE + i])
+					goto read_addr_line_err;
+			}
+		}
+		fw_line++;
+	}
+	check_result = true;
+
+read_addr_line_err:
+	dash_uart_irq_fiq_enable(true);
+	if (addr_check_err) {
+		pr_err("%s addr:0x%x,buf[0]:0x%x,buf[1]:0x%x\n",
+			__func__, addr, fw_check_buf[0], fw_check_buf[1]);
+	}
+	if (!check_result) {
+		pr_err("%s fw_check err,addr:0x%x,check_buf[%d]:0x%x != fw_data[%d]:0x%x\n",
+			__func__, addr, i + 2, fw_check_buf[i + 2],
+			(fw_line * 34 + 2 + i),
+			adapter_stm8s_firmware_data[fw_line * 34 + 2 + i]);
+		for (i = 0; i < 16; i++)
+			pr_err("fw_check_buf[%d]=0x%x\n",
+			i+2, fw_check_buf[i + 2]);
+	}
+	return check_result;
+}
+
+static int dash_uart_read_front_addr_and_check(struct op_adapter_chip *chip)
+{
+	unsigned int read_addr = STM8S_ADAPTER_FIRST_ADDR;
+	bool result = false;
+
+	while (read_addr < STM8S_ADAPTER_LAST_ADDR) {
+		result = dash_uart_read_addr_line_and_check(chip, read_addr);
+		read_addr = read_addr + 16;
+		if ((!result) || chip->rx_timeout) {
+			pr_err("%s result:%d,chip->rx_timeout:%d\n",
+				__func__, result, chip->rx_timeout);
+			return -EINVAL;
+		}
+	}
+	return 0;
+}
+
+static bool
+dash_adapter_update_handle(
+	struct op_adapter_chip *chip,
+	unsigned long tx_pin, unsigned long rx_pin)
+{
+	unsigned char rx_val = 0;
+	int rx_last_line_count = 0;
+	unsigned char rx_last_line[18] = {0x0};
+	int rc = 0;
+
+	pr_err("%s v1 begin\n", __func__);
+	chip->uart_tx_gpio = tx_pin;
+	chip->uart_rx_gpio = rx_pin;
+	chip->adapter_update_ing = true;
+	chip->tx_invalid_val = DEFALUT_TX_VALUE;
+	chip->rx_timeout = false;
+
+	/* step1: Tx_Erase_Addr_Line */
+	/* tx:0xF5 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Erase_Addr_Line_Cmd >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x03 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Erase_Addr_Line_Cmd & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x9F */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Last_Line_Addr >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0xF0 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Last_Line_Addr & 0xff);
+	rx_val = dash_uart_rx_byte(chip, Erase_Addr_Line_Cmd);
+	dash_uart_irq_fiq_enable(true);
+	if (rx_val != UART_ACK || chip->rx_timeout) {
+		pr_err("%s Tx_Erase_Addr_Line err,chip->rx_timeout:%d, rx_val:0x%x\n",
+			__func__, chip->rx_timeout, rx_val);
+		goto update_err;
+	}
+	/* Step2: Tx_Read_Addr_Line */
+	/* tx:0xF5 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Read_Addr_Line_Cmd >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x01 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Read_Addr_Line_Cmd & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x9F */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Last_Line_Addr >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0xF0 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Last_Line_Addr & 0xff);
+	for (rx_last_line_count = 0;
+		rx_last_line_count < 18; rx_last_line_count++) {
+		rx_last_line[rx_last_line_count]
+			= dash_uart_rx_byte(chip, Read_Addr_Line_Cmd);
+		if (chip->rx_timeout)
+			break;
+	}
+
+	dash_uart_irq_fiq_enable(true);
+	if ((rx_last_line[FW_EXIST_LOW] == 0x55 &&
+			rx_last_line[FW_EXIST_HIGH] == 0x34)
+			|| chip->rx_timeout) {
+		pr_err("%s Tx_Read_Addr_Line err,chip->rx_timeout:%d\n",
+			__func__, chip->rx_timeout);
+		goto update_err;
+	}
+
+	/* Step3: Tx_Erase_All */
+	/* tx:0xF5 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Erase_All_Cmd >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x05 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Erase_All_Cmd & 0xff);
+	rx_val = dash_uart_rx_byte(chip, Erase_All_Cmd);
+	dash_uart_irq_fiq_enable(true);
+	if (rx_val != UART_ACK || chip->rx_timeout) {
+		pr_err("%s Tx_Erase_All err,chip->rx_timeout:%d\n",
+			__func__, chip->rx_timeout);
+		goto update_err;
+	}
+
+	/* Step4: Tx_Write_Addr_Line */
+	rc = dash_uart_write_some_addr(chip, &adapter_stm8s_firmware_data[0],
+		(sizeof(adapter_stm8s_firmware_data) - 34));
+	if (rc) {
+		pr_err("%s Tx_Write_Addr_Line err\n", __func__);
+		goto update_err;
+	}
+
+	/* Step5: Tx_Read_All */
+	rc = dash_uart_read_front_addr_and_check(chip);
+	if (rc) {
+		pr_err("%s Tx_Read_All err\n", __func__);
+		goto update_err;
+	}
+
+	/* Step6: write the last line */
+	rc = dash_uart_write_some_addr(chip,
+			&adapter_stm8s_firmware_data[
+			sizeof(adapter_stm8s_firmware_data) - 34],
+			34);
+	if (rc) {
+		pr_err("%s write the last line err\n", __func__);
+		goto update_err;
+	}
+
+	/* Step7: Tx_Boot_Over */
+	/* tx:0xF5 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, (Boot_Over_Cmd >> 8) & 0xff);
+	dash_uart_irq_fiq_enable(true);
+
+	/* tx:0x06 */
+	dash_uart_irq_fiq_enable(false);
+	dash_uart_tx_byte(chip, Boot_Over_Cmd & 0xff);
+	rx_val = dash_uart_rx_byte(chip, Boot_Over_Cmd);
+	dash_uart_irq_fiq_enable(true);
+	if (rx_val != UART_ACK || chip->rx_timeout) {
+		pr_err("%s Tx_Boot_Over err,chip->rx_timeout:%d\n",
+			__func__, chip->rx_timeout);
+		goto update_err;
+	}
+	chip->rx_timeout = false;
+	chip->adapter_update_ing = false;
+	pr_err("%s success\n", __func__);
+	return true;
+
+update_err:
+	chip->rx_timeout = false;
+	chip->adapter_update_ing = false;
+	print_oem();
+	pr_err("%s err\n", __func__);
+	return false;
+}
+
+bool dash_adapter_update_is_tx_gpio(unsigned int gpio_num)
+{
+	if (!the_chip)
+		return false;
+	if (the_chip->adapter_update_ing && gpio_num == the_chip->uart_tx_gpio)
+		return true;
+	else
+		return false;
+}
+
+bool dash_adapter_update_is_rx_gpio(unsigned int gpio_num)
+{
+	if (!the_chip)
+		return false;
+
+	if (the_chip->adapter_update_ing && gpio_num == the_chip->uart_rx_gpio)
+		return true;
+	else
+		return false;
+}
+
+
+struct op_adapter_operations op_adapter_ops = {
+		.adapter_update = dash_adapter_update_handle,
+};
+
+static int __init dash_adapter_init(void)
+{
+	struct op_adapter_chip *chip = NULL;
+
+	chip = kzalloc(sizeof(struct op_adapter_chip), GFP_KERNEL);
+	if (!chip)
+		return -EINVAL;
+
+	chip->timer_delay = 0;
+	chip->tx_byte_over = false;
+	chip->rx_byte_over = false;
+	chip->rx_timeout = false;
+	chip->uart_tx_gpio = 0;
+	chip->uart_rx_gpio = 0;
+	chip->adapter_update_ing = false;
+	chip->adapter_firmware_data = adapter_stm8s_firmware_data;
+	chip->adapter_fw_data_count = sizeof(adapter_stm8s_firmware_data);
+	chip->vops = &op_adapter_ops;
+	op_adapter_init(chip);
+	the_chip = chip;
+
+	pr_info("%s success\n", __func__);
+	return 0;
+}
+
+static void __init dash_adapter_exit(void)
+{
+
+}
+
+module_init(dash_adapter_init);
+module_exit(dash_adapter_exit);
diff --git a/drivers/power/supply/qcom/op_dash_adapter.h b/drivers/power/supply/qcom/op_dash_adapter.h
new file mode 100644
index 0000000000000000000000000000000000000000..09489c806f83232043205d6c45363d4b02d5ebee
--- /dev/null
+++ b/drivers/power/supply/qcom/op_dash_adapter.h
@@ -0,0 +1,223 @@
+#ifndef _OP_DASH_ADAPTER_H_
+#define _OP_DASH_ADAPTER_H_
+
+/*ap_data---->rx     ap_clk---->tx*/
+#define BIT_0						0
+#define BIT_1						1
+#define BIT_2						2
+#define BIT_3						3
+#define BIT_4						4
+#define BIT_5						5
+#define BIT_6						6
+#define BIT_7						7
+#define BIT_STOP					8
+#define BIT_IDLE					9
+#define BIT_START					10
+
+#define UART_NOACK					0
+#define UART_ACK					1
+
+#define FW_VER_LOW					14
+#define FW_VER_HIGH					15
+#define FW_EXIST_LOW				16
+#define FW_EXIST_HIGH				17
+
+#define Tx_Read_Addr_Line		0x01
+#define Tx_Write_Addr_Line		0x02
+#define Tx_Erase_Addr_Line		0x03
+#define Tx_Read_All			0x04
+#define Tx_Erase_All			0x05
+#define Tx_Boot_Over			0x06
+#define Tx_Cmd_Invalid			0xff
+
+#define Rx_Read_Addr_Line		0x01
+#define Rx_Write_Addr_Line		0x02
+#define Rx_Erase_Addr_Line		0x03
+#define Rx_Read_All			0x04
+#define Rx_Erase_All			0x05
+#define Rx_Boot_Over			0x06
+#define Rx_Cmd_Invalid				0xff
+
+#define Read_Addr_Line_Cmd		0xF501
+#define Write_Addr_Line_Cmd		0xF502
+#define Erase_Addr_Line_Cmd		0xF503
+#define Read_All_Cmd			0xF504
+#define Erase_All_Cmd			0xF505
+#define Boot_Over_Cmd			0xF506
+#define Last_Line_Addr				0x9FF0
+
+#define Read_Addr_Line_Cmd_Count	2000	/*physical test: 27*/
+#define Write_Addr_Line_Cmd_Count	18000	/*physical test:8720*/
+#define Erase_Addr_Line_Cmd_Count	16000	/*physical test:7657*/
+#define Read_All_Cmd_Count		2000	/*physical test:27*/
+#define Erase_All_Cmd_Count		180000	/*physical test:86916*/
+#define Boot_Over_Cmd_Count		2000	/*physical test:34*/
+#define Other_Cmd_count			2000
+
+#include <linux/power/oem_external_fg.h>
+extern void op_adapter_init(struct op_adapter_chip *chip);
+/*fw_ver must be 0x0b/0x0c/0x0d/0x0e/0x0f because of pic1508/stm8s*/
+
+static unsigned char adapter_stm8s_firmware_data[] = {
+0x00,0x8c,0x82,0x00,0x9F,0x20,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,
+0x20,0x8C,0x82,0x00,0x93,0xBC,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,
+0x40,0x8C,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,
+0x60,0x8C,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,0x82,0x00,0x9F,0xCF,
+0x80,0x8C,0x3B,0x00,0x08,0x3F,0x08,0x20,0x0C,0x3D,0x08,0x26,0x03,0xCD,0x93,0x70,0xA6,0x14,0xCD,0x9E,0xA4,0xB6,0x08,0xA1,0x02,0x27,0x2A,0xCD,0x9F,0xC1,0xCD,0x91,0x69,0xAE,
+0xA0,0x8C,0x00,0x12,0xCD,0x91,0x2C,0xB7,0x08,0xA1,0x02,0x26,0x04,0xA6,0x01,0x20,0x14,0xA1,0x01,0x26,0x05,0xCD,0x92,0xDD,0x20,0xD6,0xA1,0x03,0x26,0xCB,0xA6,0x01,0xCD,0x92,
+0xC0,0x8C,0xF6,0x20,0xCB,0x32,0x00,0x08,0x81,0xCD,0x9A,0x2A,0xCD,0x99,0xF2,0xBF,0x0A,0x90,0xBF,0x08,0xB7,0x0D,0x3F,0x0C,0xCD,0x9F,0xC1,0xB6,0x0D,0xCD,0x8D,0xAE,0xA6,0x02,
+0xE0,0x8C,0xCD,0x93,0x29,0xBF,0x00,0xB3,0x0A,0x2F,0x06,0xBE,0x08,0xB3,0x00,0x2E,0x74,0xBE,0x00,0xB3,0x0A,0x2E,0x5C,0x3D,0x0D,0x27,0x49,0xA6,0x04,0xCD,0x93,0x29,0xA3,0x07,
+0x00,0x8D,0x03,0x24,0x60,0xC6,0x00,0x31,0xA1,0x05,0x24,0x09,0xC6,0x00,0x31,0x4C,0xC7,0x00,0x31,0x20,0x15,0xC6,0x00,0x32,0xA1,0x0A,0x24,0x0E,0xC6,0x00,0x32,0x4C,0xC7,0x00,
+0x20,0x8D,0x32,0xCD,0x92,0xDD,0x72,0x5F,0x00,0x31,0xC6,0x00,0x32,0xA1,0x0A,0x26,0x0A,0x35,0x0B,0x00,0x32,0x35,0x05,0x00,0x31,0x20,0x2A,0xC6,0x00,0x32,0xA1,0x0B,0x25,0x23,
+0x40,0x8D,0x20,0x0A,0xA6,0x04,0xCD,0x93,0x29,0xA3,0x07,0x2C,0x24,0x40,0xCD,0x92,0xDD,0x20,0x12,0xBE,0x08,0xB3,0x00,0x2E,0x0C,0xB6,0x0D,0xCD,0x92,0xF6,0x20,0x05,0xA6,0x02,
+0x60,0x8D,0xCD,0x9E,0xA4,0xB6,0x0C,0x4C,0xB7,0x0C,0xA6,0x02,0xCD,0x93,0x29,0xA3,0x05,0xBF,0x2F,0x14,0xC6,0x00,0x28,0xAB,0xF7,0xCD,0x93,0x1B,0xB6,0x0D,0xCD,0x8D,0xAE,0xA6,
+0x80,0x8D,0x14,0xCD,0x9E,0xA4,0x20,0x06,0xB6,0x0C,0xA1,0x0A,0x25,0xD2,0xA6,0x04,0xCD,0x93,0x29,0x3D,0x0D,0x27,0x06,0x90,0xAE,0x07,0x2B,0x20,0x04,0x90,0xAE,0x07,0x4E,0xBF,
+0xA0,0x8D,0x00,0x90,0xB3,0x00,0x2E,0x05,0xB6,0x0D,0xCD,0x92,0xF6,0xCC,0x9A,0x7E,0xA1,0x01,0x27,0x2F,0xA6,0x04,0xCD,0x93,0x29,0xA3,0x05,0x54,0x24,0x21,0xA6,0x02,0xCD,0x93,
+0xC0,0x8D,0x29,0xA3,0x02,0x8F,0x25,0x17,0xC6,0x00,0x30,0xA1,0x46,0x24,0x08,0xC6,0x00,0x30,0x4C,0xC7,0x00,0x30,0x81,0xCD,0x8E,0xAD,0xCD,0x8D,0xE2,0x20,0xFB,0x72,0x5F,0x00,
+0xE0,0x8D,0x30,0x81,0xCD,0x99,0xED,0x3B,0x00,0x0A,0x52,0x04,0x35,0x01,0x00,0x0A,0x90,0xAE,0x9F,0xCB,0x96,0x5C,0x89,0xA6,0x04,0xCD,0x9F,0x5F,0x85,0xCD,0x9F,0xC1,0xCD,0x8F,
+0x00,0x8E,0x12,0x7B,0x01,0xA1,0x1D,0x26,0x12,0x7B,0x02,0xA1,0x05,0x26,0x0C,0x7B,0x03,0xA1,0x14,0x26,0x06,0x7B,0x04,0xA1,0x08,0x27,0x4B,0xCD,0x9F,0xC1,0x7B,0x01,0xA1,0x1D,
+0x20,0x8E,0x27,0x13,0xCD,0x9F,0xC1,0x96,0x5C,0xCD,0x8E,0xC0,0x96,0x1C,0x00,0x02,0xBF,0x08,0x4D,0x26,0xE9,0x20,0x37,0xBE,0x08,0xCD,0x8E,0xC0,0xBE,0x08,0x5C,0xBF,0x08,0x4D,
+0x40,0x8E,0x26,0x02,0x3F,0x0A,0xCD,0x8E,0xC0,0xBE,0x08,0x5C,0xBF,0x08,0x4D,0x26,0x02,0x3F,0x0A,0xCD,0x8E,0xC0,0xBE,0x08,0x5C,0xBF,0x08,0x4D,0x26,0x02,0x3F,0x0A,0x3D,0x0A,
+0x60,0x8E,0x26,0x9F,0x20,0x08,0x35,0x01,0x00,0x2F,0x4F,0xCD,0x8E,0x74,0x5B,0x04,0x32,0x00,0x0A,0xCC,0x9A,0x85,0x4D,0x27,0x03,0xCD,0x8E,0xAD,0xC6,0x00,0x2F,0x26,0x03,0xCD,
+0x80,0x8E,0x93,0x70,0xCD,0x9F,0xC1,0xCD,0x9F,0x9B,0x72,0x1C,0x50,0x5B,0x72,0x1D,0x50,0x5C,0x72,0x5F,0x9F,0xFC,0x72,0x5F,0x9F,0xFD,0x72,0x5F,0x9F,0xFE,0x72,0x5F,0x9F,0xFF,
+0xA0,0x8E,0xCD,0x9F,0xC1,0xC6,0x50,0x5F,0xA5,0x05,0x27,0xF9,0xCC,0x93,0x70,0xA6,0x01,0xCD,0x94,0x82,0xA6,0x14,0xCD,0x9E,0xA4,0xA6,0xC8,0xCD,0x93,0x1B,0x4F,0xCC,0x95,0x1B,
+0xC0,0x8E,0xCD,0x99,0xED,0x3B,0x00,0x0A,0xBF,0x08,0xC6,0x52,0x30,0xB7,0x0A,0xCD,0x9F,0xC1,0x20,0x08,0xCD,0x9F,0xC1,0xC6,0x52,0x30,0xB7,0x0A,0xB6,0x0A,0xA5,0x20,0x27,0xF2,
+0xE0,0x8E,0xB6,0x0A,0xA5,0x09,0x27,0x09,0xC6,0x52,0x31,0x92,0xC7,0x08,0x4F,0x20,0x08,0xC6,0x52,0x31,0x92,0xC7,0x08,0xA6,0x01,0x32,0x00,0x0A,0xCC,0x9A,0x85,0x72,0x5F,0x52,
+0x00,0x8F,0x34,0x72,0x5F,0x52,0x36,0x72,0x5F,0x52,0x33,0x72,0x5F,0x52,0x32,0x72,0x5F,0x52,0x35,0x81,0x72,0x5F,0x50,0x12,0x72,0x5F,0x50,0x13,0x35,0x02,0x50,0x11,0x72,0x19,
+0x20,0x8F,0x52,0x34,0xC6,0x52,0x36,0xC7,0x52,0x36,0x35,0x01,0x52,0x33,0x35,0x34,0x52,0x32,0xC6,0x52,0x35,0xAA,0x0C,0xC7,0x52,0x35,0x81,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,
+0x40,0x8F,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x26,0x04,0x4F,0xCC,0x9A,0x85,0xBE,0x08,0x1C,0x00,0x08,0xF6,0x48,0x88,0xBE,0x08,0x1C,0x00,0x07,0xF6,0x48,0x48,0xB7,0x01,
+0x60,0x8F,0x84,0xBA,0x01,0xBE,0x08,0x1C,0x00,0x09,0xFA,0x90,0x5F,0x90,0x97,0xAE,0x00,0x52,0xBF,0x00,0x93,0xCD,0x9C,0x69,0x1C,0x03,0xD4,0xCF,0x00,0x26,0xCE,0x00,0x26,0x1C,
+0x80,0x8F,0xFF,0xCF,0xCF,0x00,0x24,0xCE,0x00,0x24,0xA3,0x04,0xEB,0x2F,0x06,0xAE,0x04,0xEA,0xCF,0x00,0x24,0xCE,0x00,0x26,0xA3,0x05,0x1C,0x2F,0x06,0xAE,0x05,0x1B,0xCF,0x00,
+0xA0,0x8F,0x26,0xA6,0x01,0xCC,0x9A,0x85,0x72,0x5F,0x00,0x1F,0x72,0x5F,0x00,0x20,0x35,0x01,0x00,0x21,0x35,0x01,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0x35,0x01,0x00,0x1F,
+0xC0,0x8F,0x72,0x5F,0x00,0x20,0x72,0x5F,0x00,0x21,0x35,0x01,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,
+0xE0,0x8F,0x00,0x27,0x08,0xBE,0x08,0x1C,0x00,0x03,0x7D,0x26,0x04,0x4F,0xCC,0x9A,0x85,0xA6,0x01,0xCC,0x9A,0x85,0x72,0x5F,0x00,0x1F,0x35,0x01,0x00,0x20,0x35,0x01,0x00,0x21,
+0x00,0x90,0x72,0x5F,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x26,0x04,0x4F,0xCC,0x9A,0x85,0xBE,
+0x20,0x90,0x08,0x1C,0x00,0x04,0x7D,0x26,0x0D,0xBE,0x08,0x1C,0x00,0x05,0x7D,0x27,0x05,0xA6,0x02,0xCC,0x9A,0x85,0xA6,0x01,0xCC,0x9A,0x85,0x35,0x01,0x00,0x1F,0x72,0x5F,0x00,
+0x40,0x90,0x20,0x72,0x5F,0x00,0x21,0x72,0x5F,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x27,0x15,
+0x60,0x90,0xBE,0x08,0x1C,0x00,0x04,0x7D,0x26,0x0D,0xBE,0x08,0x1C,0x00,0x05,0x7D,0x27,0x05,0xA6,0x01,0xCC,0x9A,0x85,0x4F,0xCC,0x9A,0x85,0xC6,0x9F,0xFC,0xB7,0x00,0x44,0x44,
+0x80,0x90,0x44,0xA4,0x01,0xC7,0x00,0x1F,0xB6,0x00,0x44,0x44,0xA4,0x01,0xC7,0x00,0x20,0xB6,0x00,0x44,0xA4,0x01,0xC7,0x00,0x21,0xB6,0x00,0xA4,0x01,0xC7,0x00,0x22,0xAE,0x00,
+0xA0,0x90,0x1C,0xCC,0x92,0x9B,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x26,0x05,0xA6,0x02,0xCC,0x9A,0x85,0xBE,0x08,0x1C,0x00,0x04,0xF6,
+0xC0,0x90,0xC7,0x00,0x2D,0xBE,0x08,0x1C,0x00,0x03,0x7D,0x26,0x04,0x4F,0xCC,0x9A,0x85,0xBE,0x08,0x1C,0x00,0x05,0xF6,0x4E,0xA4,0xF0,0xC7,0x00,0x29,0xBE,0x08,0x1C,0x00,0x06,
+0xE0,0x90,0xF6,0x48,0x48,0x48,0xCA,0x00,0x29,0xC7,0x00,0x29,0xBE,0x08,0x1C,0x00,0x07,0xF6,0x48,0x48,0xCA,0x00,0x29,0xC7,0x00,0x29,0xBE,0x08,0x1C,0x00,0x08,0xF6,0x48,0xCA,
+0x00,0x91,0x00,0x29,0xC7,0x00,0x29,0xBE,0x08,0x1C,0x00,0x09,0xF6,0xCA,0x00,0x29,0xC7,0x00,0x29,0xA6,0x01,0xCC,0x9A,0x85,0x72,0x5F,0x00,0x1F,0x35,0x01,0x00,0x20,0x72,0x5F,
+0x20,0x91,0x00,0x21,0x72,0x5F,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xCD,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x27,0x28,0xBE,0x08,0x1C,
+0x40,0x91,0x00,0x04,0xF6,0x48,0xBE,0x08,0x1C,0x00,0x05,0xFA,0xA1,0x03,0x26,0x05,0xA6,0x02,0xCC,0x9A,0x85,0xA1,0x02,0x26,0x05,0xA6,0x03,0xCC,0x9A,0x85,0xA1,0x01,0x26,0x05,
+0x60,0x91,0xA6,0x01,0xCC,0x9A,0x85,0x4F,0xCC,0x9A,0x85,0x72,0x5F,0x00,0x1F,0x72,0x5F,0x00,0x20,0x35,0x01,0x00,0x21,0x72,0x5F,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xCD,
+0x80,0x91,0x99,0xED,0xBF,0x08,0xCD,0x92,0x4D,0xBE,0x08,0xCD,0x92,0x33,0xA1,0x00,0x26,0x03,0xCC,0x92,0x19,0xBE,0x08,0x1C,0x00,0x03,0x7D,0x27,0x7E,0xBE,0x08,0x1C,0x00,0x05,
+0xA0,0x91,0xF6,0x5F,0x97,0xCD,0x9C,0xA9,0xBF,0x00,0xBE,0x08,0x1C,0x00,0x04,0xF6,0x5F,0x97,0xCD,0x9C,0xA8,0x01,0xBA,0x01,0x01,0xBA,0x00,0x01,0x90,0x93,0xBE,0x08,0x1C,0x00,
+0xC0,0x91,0x06,0xF6,0x5F,0x97,0x58,0x58,0x58,0xBF,0x00,0x93,0x01,0xBA,0x01,0x01,0xBA,0x00,0x01,0x90,0x93,0xBE,0x08,0x1C,0x00,0x07,0xF6,0x5F,0x97,0x58,0x58,0xBF,0x00,0x93,
+0xE0,0x91,0x01,0xBA,0x01,0x01,0xBA,0x00,0x01,0x90,0x93,0xBE,0x08,0x1C,0x00,0x08,0xF6,0x5F,0x97,0x58,0xBF,0x00,0x93,0x01,0xBA,0x01,0x01,0xBA,0x00,0x01,0x90,0xBE,0x08,0x72,
+0x00,0x92,0xA9,0x00,0x09,0x90,0xF6,0x90,0x5F,0x90,0x97,0x90,0xBF,0x00,0x01,0xBA,0x01,0x02,0xCD,0x9C,0xA9,0x1C,0x0D,0x4C,0xCC,0x9A,0x85,0x5F,0xCC,0x9A,0x85,0x72,0x5F,0x00,
+0x20,0x92,0x1F,0x72,0x5F,0x00,0x20,0x72,0x5F,0x00,0x21,0x35,0x01,0x00,0x22,0xAE,0x00,0x1C,0xCC,0x92,0x9B,0xF6,0xA1,0x01,0x26,0x13,0x90,0x93,0x90,0x5C,0x90,0x7D,0x26,0x0B,
+0x40,0x92,0x1C,0x00,0x02,0xF6,0xA1,0x01,0x26,0x03,0xA6,0x01,0x81,0x4F,0x81,0xCD,0x9A,0x2A,0x3B,0x00,0x0C,0xBF,0x08,0xCD,0x94,0xD9,0xCD,0x9F,0x52,0x3F,0x0C,0x20,0x19,0xCD,
+0x60,0x92,0x9F,0x6C,0x5F,0x41,0xB6,0x0C,0x41,0x72,0xBB,0x00,0x08,0xBF,0x0A,0xCD,0x94,0xA0,0x92,0xC7,0x0A,0xB6,0x0C,0x4C,0xB7,0x0C,0xB6,0x0C,0xA1,0x0A,0x24,0x17,0x4F,0xCD,
+0x80,0x92,0x94,0xE6,0xCD,0x9F,0x45,0xA6,0x01,0xCD,0x94,0xE6,0x3D,0x0C,0x26,0xD1,0xA6,0x04,0xCD,0x9E,0xA4,0x20,0xCD,0x32,0x00,0x0C,0xCC,0x9A,0x7A,0xCD,0x99,0xED,0x3B,0x00,
+0xA0,0x92,0x0A,0xBF,0x08,0xCD,0x94,0xC8,0xCD,0x94,0xF3,0xCD,0x9F,0x52,0x3F,0x0A,0x20,0x21,0x4F,0xCD,0x94,0xE6,0x5F,0x41,0xB6,0x0A,0x41,0x72,0xBB,0x00,0x08,0xF6,0xCD,0x94,
+0xC0,0x92,0xAA,0xCD,0x9F,0x45,0xA6,0x01,0xCD,0x94,0xE6,0xCD,0x9F,0x6C,0xB6,0x0A,0x4C,0xB7,0x0A,0xB6,0x0A,0xA1,0x08,0x25,0xD9,0x32,0x00,0x0A,0xCC,0x9A,0x85,0xC6,0x00,0x28,
+0xE0,0x92,0xA1,0xFF,0x27,0x07,0xC6,0x00,0x28,0x4C,0xC7,0x00,0x28,0xAE,0x00,0x28,0x35,0x01,0x00,0x00,0x4F,0xCC,0x9A,0x96,0x4D,0x26,0x0A,0xA6,0x04,0xCD,0x93,0x29,0xA3,0x04,
+0x00,0x93,0xC7,0x25,0x17,0xC6,0x00,0x28,0x27,0x07,0xC6,0x00,0x28,0x4A,0xC7,0x00,0x28,0xAE,0x00,0x28,0x35,0x01,0x00,0x00,0x4F,0xCD,0x9A,0x96,0x81,0xC7,0x00,0x28,0xAE,0x00,
+0x20,0x93,0x28,0x35,0x01,0x00,0x00,0x4F,0xCC,0x9A,0x96,0xCD,0x9A,0x2A,0xB7,0x08,0xA6,0x03,0xCD,0x93,0x59,0xBF,0x0A,0x26,0x04,0x5F,0x5C,0xBF,0x0A,0xB6,0x08,0xCD,0x93,0x59,
+0x40,0x93,0xBF,0x02,0x5F,0xBF,0x00,0xBF,0x08,0xCD,0x98,0x07,0x00,0x00,0x09,0xC4,0xCD,0x9A,0x89,0xCD,0x98,0x91,0xBE,0x02,0xCC,0x9A,0x7A,0xCD,0x99,0xED,0xB7,0x08,0xCD,0x9F,
+0x60,0x93,0xC1,0xB6,0x08,0xCD,0x9C,0xAE,0xBF,0x08,0xCD,0x9F,0xC1,0xBE,0x08,0xCC,0x9A,0x85,0x35,0x7F,0x50,0xD2,0x35,0x80,0x50,0xD1,0x35,0x7F,0x50,0xD2,0x81,0xCD,0x95,0x28,
+0x80,0x93,0xCD,0x95,0x0E,0xCD,0x94,0xD9,0xCD,0x94,0x71,0xCD,0x94,0x8F,0xCD,0x94,0xC8,0xCD,0x94,0xF3,0xA6,0x01,0xCD,0x94,0xAA,0xA6,0x01,0xCD,0x94,0xE6,0xCD,0x94,0x53,0x35,
+0xA0,0x93,0x01,0x00,0x1C,0x72,0x5F,0x00,0x1D,0x35,0x01,0x00,0x1E,0x72,0x5F,0x00,0x2A,0x72,0x5F,0x00,0x2B,0x72,0x5F,0x00,0x2D,0x72,0x5F,0x00,0x2F,0x81,0x8A,0x84,0xA4,0xBF,
+0xC0,0x93,0x88,0x86,0xCD,0x9A,0x20,0xCD,0x9A,0x25,0xC6,0x00,0x2A,0xA1,0x01,0x27,0x5E,0xC6,0x00,0x2B,0x4C,0xC7,0x00,0x2B,0xC6,0x00,0x2B,0xA1,0x33,0x24,0x50,0xA6,0x02,0xCD,
+0xE0,0x93,0x95,0x39,0xCD,0x95,0x04,0xB7,0x00,0xC6,0x00,0x10,0xA1,0x02,0x26,0x05,0xB6,0x00,0xC7,0x00,0x10,0x3D,0x00,0x26,0x07,0xC6,0x00,0x10,0xA1,0x01,0x27,0x0B,0xB6,0x00,
+0x00,0x94,0xA1,0x01,0x26,0x0C,0xC6,0x00,0x10,0x26,0x07,0xC6,0x00,0x2C,0x4C,0xC7,0x00,0x2C,0xC6,0x00,0x2C,0xA1,0x14,0x25,0x11,0x72,0x5F,0x00,0x2C,0x35,0x02,0x00,0x10,0x35,
+0x20,0x94,0x01,0x00,0x2A,0xCD,0x94,0x34,0x20,0x05,0xB6,0x00,0xC7,0x00,0x10,0xCD,0x9A,0x5C,0xCD,0x9A,0x51,0x80,0xCD,0x94,0xF3,0xA6,0x62,0xCC,0x95,0x39,0x9B,0x72,0x1B,0x50,
+0x40,0x94,0x11,0x72,0x1B,0x50,0x12,0x72,0x1A,0x50,0x13,0xC6,0x50,0xA0,0xA4,0x3F,0xC7,0x50,0xA0,0x9B,0x81,0x9B,0x72,0x1B,0x50,0x11,0x72,0x1B,0x50,0x12,0x72,0x1A,0x50,0x13,
+0x60,0x94,0xC6,0x50,0xA0,0xA4,0x3F,0xC7,0x50,0xA0,0x72,0x1C,0x50,0xA0,0x9A,0x81,0xCC,0x94,0xB7,0x72,0x1E,0x50,0x0C,0x72,0x1E,0x50,0x0D,0x72,0x1F,0x50,0x0E,0x72,0x1F,0x50,
+0x80,0x94,0x0A,0x81,0x4D,0x27,0x05,0x72,0x16,0x50,0x0A,0x81,0x72,0x17,0x50,0x0A,0x81,0x72,0x16,0x50,0x0C,0x72,0x16,0x50,0x0D,0x72,0x17,0x50,0x0E,0x72,0x17,0x50,0x0A,0x81,
+0xA0,0x94,0x72,0x0D,0x50,0x10,0x03,0xA6,0x01,0x81,0x4F,0x81,0x4D,0x27,0x05,0x72,0x1C,0x50,0x0F,0x81,0x72,0x1D,0x50,0x0F,0x81,0x72,0x1C,0x50,0x11,0x72,0x1C,0x50,0x12,0x72,
+0xC0,0x94,0x1D,0x50,0x13,0x72,0x1C,0x50,0x0F,0x81,0x72,0x1C,0x50,0x11,0x72,0x1C,0x50,0x12,0x72,0x1D,0x50,0x13,0x72,0x1D,0x50,0x0F,0x81,0x72,0x1D,0x50,0x11,0x72,0x1D,0x50,
+0xE0,0x94,0x12,0x72,0x1D,0x50,0x13,0x81,0x4D,0x27,0x05,0x72,0x1A,0x50,0x0F,0x81,0x72,0x1B,0x50,0x0F,0x81,0x72,0x1A,0x50,0x11,0x72,0x1A,0x50,0x12,0x72,0x1B,0x50,0x13,0x72,
+0x00,0x95,0x1B,0x50,0x0F,0x81,0x72,0x0B,0x50,0x10,0x03,0xA6,0x01,0x81,0x4F,0x81,0x72,0x1B,0x50,0x11,0x72,0x1B,0x50,0x12,0x72,0x1B,0x50,0x13,0x81,0x4D,0x27,0x05,0x72,0x18,
+0x20,0x95,0x50,0x0F,0x81,0x72,0x19,0x50,0x0F,0x81,0x72,0x18,0x50,0x11,0x72,0x18,0x50,0x12,0x72,0x19,0x50,0x13,0x72,0x19,0x50,0x0F,0x81,0xCD,0x99,0xED,0xB7,0x09,0x3F,0x08,
+0x40,0x95,0x4F,0xB7,0x08,0xB6,0x08,0xB1,0x09,0x24,0x0B,0xCD,0x9F,0x6C,0xB6,0x08,0xAB,0x01,0xB7,0x08,0x20,0xEF,0xCC,0x9A,0x85,0xCD,0x9A,0x2A,0xCD,0x9A,0x2F,0x52,0x05,0x4F,
+0x60,0x95,0x6B,0x03,0x6B,0x02,0x3F,0x0C,0x3F,0x0D,0x6B,0x01,0x3F,0x0A,0x3F,0x0B,0xCD,0x9F,0xC1,0xA6,0x28,0xCD,0x9E,0xA4,0xCD,0x8F,0xA6,0xAE,0x00,0x12,0xCD,0x8F,0x39,0xA1,
+0x80,0x95,0x00,0x26,0x03,0xCD,0x93,0x70,0x4F,0xCD,0x94,0x82,0xC6,0x00,0x29,0x90,0x5F,0x90,0x97,0xAE,0x00,0x05,0xBF,0x00,0x93,0xCD,0x9C,0x69,0x1C,0x01,0x04,0x1F,0x04,0x20,
+0xA0,0x95,0x10,0x0D,0x01,0x26,0x03,0xCD,0x8E,0xAD,0xA6,0x01,0x6B,0x01,0xA6,0x1E,0xCD,0x9E,0xA4,0xCD,0x9F,0xC1,0xA6,0x0F,0xCD,0x9E,0xA4,0xCD,0x92,0x1D,0xAE,0x00,0x12,0xCD,
+0xC0,0x95,0x91,0x7F,0xBF,0x08,0x26,0x03,0xCC,0x97,0x01,0xA3,0x11,0x2C,0x26,0x06,0x35,0x01,0x00,0x0A,0x20,0x13,0x3D,0x0A,0x27,0x0B,0xA3,0x0D,0x9C,0x26,0x06,0x35,0x01,0x00,
+0xE0,0x95,0x0B,0x20,0x04,0x3F,0x0A,0x3F,0x0B,0x3D,0x0A,0x27,0x04,0x3D,0x0B,0x26,0xB2,0x0D,0x01,0x26,0xAE,0xB6,0x0D,0xA1,0x1E,0x24,0x06,0x4C,0xB7,0x0D,0xCC,0x96,0x82,0x3F,
+0x00,0x96,0x0D,0xA6,0x02,0xCD,0x93,0x29,0x1C,0xFE,0x16,0x90,0xAE,0x00,0x52,0xCD,0x9C,0x87,0xA3,0x00,0x00,0x2F,0x10,0x1C,0x00,0x07,0xBF,0x00,0x1E,0x04,0x57,0x57,0xCD,0x9C,
+0x20,0x96,0x69,0xBF,0x0E,0x20,0x08,0x1E,0x04,0x57,0x72,0xFB,0x04,0xBF,0x0E,0xCD,0x9F,0x52,0xA6,0x04,0xCD,0x93,0x29,0xBF,0x02,0xAE,0x00,0x0B,0xBF,0x00,0xBE,0x02,0xCD,0x9C,
+0x40,0x96,0x69,0x90,0xAE,0x00,0x0E,0xCD,0x9C,0x87,0x90,0x93,0xBE,0x02,0x58,0xBF,0x00,0x93,0x72,0xBB,0x00,0x00,0xBF,0x00,0xBE,0x0E,0x72,0xBB,0x00,0x08,0xB3,0x00,0x2E,0x20,
+0x60,0x96,0xB6,0x0C,0x4C,0xB7,0x0C,0xA1,0x0B,0x25,0x19,0xCD,0x8F,0xBC,0x4F,0xCD,0x94,0xE6,0xCD,0x9F,0x52,0xA6,0x01,0xCD,0x94,0xE6,0xCD,0x9F,0x52,0xCD,0x93,0x70,0x20,0x02,
+0x80,0x96,0x3F,0x0C,0xA6,0x08,0xCD,0x9E,0xA4,0x0D,0x03,0x27,0x0F,0xA6,0x01,0x90,0xAE,0x02,0xF0,0xAE,0x02,0x8E,0xCD,0x8C,0xC7,0xCC,0x95,0xB1,0x0D,0x02,0x27,0x1E,0xBE,0x08,
+0xA0,0x96,0xA3,0x10,0xE1,0x2E,0x17,0xCE,0x00,0x26,0xA3,0x04,0x36,0x2E,0x2A,0xA6,0x01,0x90,0xCE,0x00,0x26,0xCE,0x00,0x24,0xCD,0x8C,0xC7,0xCC,0x95,0xB1,0xBE,0x08,0xA3,0x10,
+0xC0,0x96,0xCC,0x2F,0xEA,0x1C,0xEF,0x34,0xA3,0x00,0x15,0x24,0x1B,0xA6,0x01,0x6B,0x02,0xCE,0x00,0x26,0xA3,0x04,0x36,0x2F,0xD6,0xA6,0x01,0x90,0xAE,0x04,0x36,0xAE,0x03,0xD4,
+0xE0,0x96,0xCD,0x8C,0xC7,0xCC,0x95,0xB1,0xBE,0x08,0xA3,0x10,0xE1,0x2E,0x03,0xCC,0x95,0xB1,0xA6,0x01,0x6B,0x03,0x90,0xAE,0x02,0xF0,0xAE,0x02,0x8E,0xCD,0x8C,0xC7,0xCC,0x95,
+0x00,0x97,0xB1,0xCD,0x93,0x70,0xCC,0x95,0xB1,0xCD,0x9A,0x2A,0xCD,0x99,0xF2,0x3B,0x00,0x0E,0x3F,0x0C,0x3F,0x0E,0x3F,0x0D,0x3F,0x0B,0x3F,0x0A,0xCD,0x9F,0x33,0xA6,0x01,0xCD,
+0x20,0x97,0x94,0x82,0xA6,0xFF,0xCD,0x93,0x1B,0xA6,0x14,0xCD,0x9E,0xA4,0x4F,0xCD,0x94,0x82,0xCD,0x9F,0xC1,0xA6,0xC8,0xCD,0x9E,0xA4,0xA6,0xC8,0xCD,0x9E,0xA4,0xCD,0x9F,0xC1,
+0x40,0x97,0xA6,0xC8,0xCD,0x9E,0xA4,0xA6,0xB4,0xCD,0x9E,0xA4,0xA6,0x01,0xCD,0x95,0x1B,0x20,0x0D,0xCD,0x94,0x6E,0x3F,0x0C,0x3F,0x0E,0x3F,0x0D,0x72,0x5F,0x00,0x2E,0xCD,0x9F,
+0x60,0x97,0xC1,0xCD,0x8E,0xFD,0x4F,0x90,0xAE,0x03,0x10,0xAE,0x02,0x8E,0xCD,0x8C,0xC7,0xA6,0x14,0xCD,0x9E,0xA4,0xA6,0x02,0xCD,0x93,0x29,0xBF,0x08,0xA3,0x00,0x41,0x2E,0x20,
+0x80,0x97,0xB6,0x0B,0x4C,0xB7,0x0B,0xA1,0x03,0x25,0x19,0x35,0x03,0x00,0x0B,0x72,0x5F,0x00,0x2B,0x72,0x5F,0x00,0x2A,0x3F,0x0A,0x72,0x5F,0x00,0x2C,0xCD,0x94,0x53,0x20,0x02,
+0xA0,0x97,0x3F,0x0B,0xBE,0x08,0xA3,0x01,0x46,0x2E,0x05,0xC6,0x00,0x2A,0x27,0xA3,0x3D,0x0E,0x26,0x12,0xB6,0x0D,0xA1,0xC8,0x24,0xA6,0xCD,0x9F,0x84,0xB7,0x0E,0xB6,0x0D,0x4C,
+0xC0,0x97,0xB7,0x0D,0x20,0x9A,0xC6,0x00,0x2A,0x26,0x11,0xB6,0x0C,0xA1,0x64,0x24,0x05,0x4C,0xB7,0x0C,0x20,0x8A,0x35,0x64,0x00,0x0C,0x20,0x15,0x3D,0x0A,0x26,0x11,0x35,0x01,
+0xE0,0x97,0x00,0x0A,0xA6,0xC8,0xCD,0x9E,0xA4,0xA6,0xC8,0xCD,0x9E,0xA4,0xCD,0x9F,0xC1,0xCD,0x94,0x3C,0xCD,0x98,0xFE,0xA1,0x00,0x27,0x08,0xA6,0x50,0xCD,0x9E,0xA4,0xCC,0x97,
+0x00,0x98,0x5E,0x32,0x00,0x0E,0xCC,0x9A,0x7E,0xCD,0x9F,0x90,0x89,0xFE,0xBF,0x04,0x85,0xEE,0x02,0xBF,0x06,0xB6,0x00,0xBE,0x06,0x42,0x9F,0xB7,0x00,0xB6,0x01,0xBE,0x05,0x42,
+0x20,0x98,0x9F,0xBB,0x00,0xB7,0x00,0xB6,0x02,0xBE,0x04,0x42,0x9F,0xBB,0x00,0xB7,0x00,0xB6,0x03,0xBE,0x03,0x42,0x9F,0xBB,0x00,0xB7,0x00,0xB6,0x01,0xBE,0x06,0x42,0x3F,0x01,
+0x40,0x98,0x72,0xBB,0x00,0x00,0xBF,0x00,0xB6,0x02,0xBE,0x05,0x42,0x72,0xBB,0x00,0x00,0xBF,0x00,0xB6,0x03,0xBE,0x04,0x42,0x72,0xBB,0x00,0x00,0xBF,0x00,0xB6,0x02,0xBE,0x06,
+0x60,0x98,0x42,0x3F,0x02,0x72,0xBB,0x00,0x01,0xBF,0x01,0x24,0x02,0x3C,0x00,0xB6,0x03,0xBE,0x05,0x42,0x72,0xBB,0x00,0x01,0xBF,0x01,0x24,0x02,0x3C,0x00,0xB6,0x03,0xBE,0x06,
+0x80,0x98,0x42,0x3F,0x03,0x72,0xBB,0x00,0x02,0xBF,0x02,0x24,0x05,0xBE,0x00,0x5C,0xBF,0x00,0x81,0xBE,0x00,0x26,0x1E,0x90,0xBE,0x04,0x26,0x0C,0xBE,0x02,0x90,0xBE,0x06,0x65,
+0xA0,0x98,0xBF,0x02,0x90,0xBF,0x06,0x81,0xBF,0x04,0x45,0x02,0x06,0x45,0x03,0x07,0xBF,0x00,0xBF,0x02,0x81,0xA6,0x20,0x3D,0x00,0x26,0x0D,0xBE,0x01,0xBF,0x00,0x45,0x03,0x02,
+0xC0,0x98,0x3F,0x03,0x3A,0x03,0xA0,0x08,0x5F,0x90,0x5F,0x99,0x20,0x17,0x90,0x59,0x59,0xB3,0x04,0x26,0x03,0x90,0xB3,0x06,0x25,0x0B,0x72,0xB2,0x00,0x06,0x24,0x01,0x5A,0x72,
+0xE0,0x98,0xB0,0x00,0x04,0x39,0x03,0x39,0x02,0x39,0x01,0x39,0x00,0x4A,0x2A,0xDE,0xBF,0x04,0x90,0xBF,0x06,0xBE,0x00,0x53,0xBF,0x00,0xBE,0x02,0x53,0xBF,0x02,0x81,0xCD,0x9F,
+0x00,0x99,0xC1,0xCD,0x91,0x16,0xAE,0x00,0x12,0xCD,0x90,0xA4,0x4D,0x26,0x1C,0xC6,0x00,0x2D,0x26,0x03,0xCC,0x99,0xEA,0xA6,0x1E,0xCD,0x9E,0xA4,0xCD,0x90,0x79,0xAE,0x00,0x12,
+0x20,0x99,0xCD,0x90,0x4F,0xC7,0x00,0x2E,0xCC,0x99,0xEA,0xA1,0x01,0x27,0x03,0xCC,0x99,0xEA,0xC6,0x00,0x2E,0x27,0x23,0xA6,0x1E,0xCD,0x9E,0xA4,0xCD,0x90,0x39,0xAE,0x00,0x12,
+0x40,0x99,0xCD,0x90,0x0A,0xA1,0x02,0x26,0x0B,0x35,0x01,0x00,0x2F,0xA6,0x01,0xCD,0x8E,0x74,0x20,0x06,0x4D,0x26,0x03,0xCD,0x93,0x70,0xA6,0x1E,0xCD,0x9E,0xA4,0xC6,0x00,0x29,
+0x60,0x99,0xA1,0x05,0x26,0x31,0xA6,0xFF,0xCD,0x93,0x1B,0x20,0x0E,0x35,0x02,0x00,0x11,0xA6,0x50,0xCD,0x9E,0xA4,0xA6,0x01,0xCD,0x8D,0xAE,0xCD,0x9F,0xC1,0xCD,0x8F,0xF4,0xAE,
+0x80,0x99,0x00,0x12,0xCD,0x8F,0xD2,0xA1,0x00,0x26,0xE2,0xC6,0x00,0x11,0xA1,0x02,0x26,0x5A,0xCD,0x93,0x70,0x20,0xE4,0xA6,0x01,0xCD,0x94,0x82,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,
+0xA0,0x99,0xEB,0xCD,0x93,0x1B,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,0xDC,0xCD,0x93,0x1B,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,0xCD,0xCD,0x93,0x1B,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,0xBE,0xCD,
+0xC0,0x99,0x93,0x1B,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,0xAF,0xCD,0x93,0x1B,0xA6,0x0A,0xCD,0x9E,0xA4,0xA6,0xA0,0xCD,0x93,0x1B,0xA6,0x14,0xCD,0x9E,0xA4,0xCD,0x8C,0x80,0xA1,0x00,
+0xE0,0x99,0x27,0x05,0xCD,0x95,0x57,0x4F,0x81,0xCD,0x93,0x70,0xA6,0x01,0x81,0x88,0xA6,0x08,0x20,0x05,0x88,0xA6,0x0C,0x20,0x00,0x88,0x7B,0x02,0x88,0x7B,0x02,0x89,0x1E,0x06,
+0x00,0x9A,0x1F,0x04,0x5F,0x97,0xFE,0x1F,0x06,0x85,0x84,0x81,0x89,0x1E,0x05,0xBF,0x08,0x20,0x07,0x89,0x1E,0x05,0xBF,0x0C,0x20,0x00,0x1E,0x03,0x1F,0x05,0x85,0x5B,0x02,0x81,
+0x20,0x9A,0x88,0xA6,0x00,0x20,0x0F,0x88,0xA6,0x04,0x20,0x0A,0x88,0xA6,0x08,0x20,0x05,0x88,0xA6,0x0C,0x20,0x00,0x88,0x89,0x7B,0x04,0x88,0x7B,0x04,0x89,0x1E,0x08,0x1F,0x04,
+0x40,0x9A,0x5F,0x97,0x1F,0x08,0xFE,0x1F,0x06,0x1E,0x08,0x5C,0x5C,0xFE,0x1F,0x08,0x85,0x84,0x81,0x89,0x1E,0x05,0xBF,0x00,0x1E,0x07,0xBF,0x02,0x20,0x16,0x89,0x1E,0x05,0xBF,
+0x60,0x9A,0x04,0x1E,0x07,0xBF,0x06,0x20,0x0B,0x89,0x1E,0x05,0xBF,0x08,0x1E,0x07,0xBF,0x0A,0x20,0x00,0x1E,0x03,0x1F,0x07,0x85,0x5B,0x04,0x81,0xCD,0x9A,0x67,0x81,0xCD,0x9A,
+0x80,0x9A,0x11,0xCD,0x9A,0x67,0x81,0xCD,0x9A,0x0A,0x81,0x45,0x08,0x04,0x45,0x09,0x05,0x45,0x0A,0x06,0x45,0x0B,0x07,0x81,0xCD,0x9A,0x2A,0xB7,0x0A,0x45,0x00,0x0B,0xBF,0x08,
+0xA0,0x9A,0xCD,0x9F,0xC1,0x72,0x03,0x52,0x19,0x0B,0x72,0x12,0x52,0x11,0x72,0x02,0x52,0x11,0xFB,0x20,0xF0,0x72,0x10,0x52,0x11,0x72,0x01,0x52,0x17,0xFB,0x35,0x58,0x52,0x16,
+0xC0,0x9A,0xCD,0x9F,0xC1,0x72,0x03,0x52,0x17,0xFB,0xC6,0x52,0x19,0x72,0x0F,0x52,0x17,0xFB,0xB6,0x0A,0xC7,0x52,0x16,0x3D,0x0B,0x26,0x18,0x20,0x22,0x72,0x0F,0x52,0x17,0xFB,
+0xE0,0x9A,0x9D,0x92,0xC6,0x08,0xC7,0x52,0x16,0x9D,0x3D,0x0B,0x27,0x05,0xBE,0x08,0x5C,0xBF,0x08,0x45,0x0B,0x00,0xB6,0x00,0x4A,0xB7,0x0B,0x3D,0x00,0x26,0xDE,0xC6,0x52,0x17,
+0x00,0x9B,0xA4,0x84,0xA1,0x84,0x26,0xF7,0x72,0x12,0x52,0x11,0x72,0x02,0x52,0x11,0xFB,0xCD,0x9F,0xC1,0xCC,0x9A,0x7A,0x52,0x10,0x90,0xAE,0x9F,0xA4,0x96,0x5C,0x89,0xA6,0x08,
+0x20,0x9B,0xCD,0x9F,0x5F,0x85,0x90,0xAE,0x9F,0xAC,0x96,0x1C,0x00,0x09,0x89,0xA6,0x08,0xCD,0x9F,0x5F,0x85,0x96,0x5C,0xCD,0x9D,0x2F,0x96,0x1C,0x00,0x09,0xCD,0x9B,0x80,0x7B,
+0x40,0x9B,0x01,0xA1,0x09,0x26,0x34,0x35,0x01,0x00,0x02,0x20,0x24,0x90,0x5F,0x61,0x93,0x50,0xBF,0x00,0x96,0x1C,0x00,0x09,0x72,0xBB,0x00,0x00,0x1C,0x00,0x08,0xF6,0x96,0x5C,
+0x60,0x9B,0x90,0xBF,0x00,0x72,0xBB,0x00,0x00,0xF1,0x26,0x0F,0xB6,0x02,0x4C,0xB7,0x02,0xB6,0x02,0xA1,0x08,0x25,0xD6,0xA6,0x01,0x20,0x04,0xCD,0x9C,0x17,0x4F,0x5B,0x10,0x81,
+0x80,0x9B,0xCD,0x9A,0x2A,0x3B,0x00,0x0C,0xBF,0x08,0xCD,0x9B,0xD5,0x9D,0x9D,0xCD,0x9D,0x67,0xA6,0xCC,0xCD,0x9D,0x9E,0xA6,0x21,0xCD,0x9F,0xB4,0xA6,0xF0,0xCD,0x9D,0x9E,0xA6,
+0xA0,0x9B,0x21,0xCD,0x9F,0xB4,0xA6,0x20,0xCD,0x9D,0x9E,0xA6,0x21,0xCD,0x9F,0xB4,0x4F,0xCD,0x9D,0x9E,0x3F,0x0C,0x20,0x13,0x5F,0x41,0x72,0xBB,0x00,0x08,0xBF,0x0A,0xCD,0x9D,
+0xC0,0x9B,0xFE,0x92,0xC7,0x0A,0xB6,0x0C,0x4C,0xB7,0x0C,0xB6,0x0C,0xA1,0x08,0x25,0xE7,0x32,0x00,0x0C,0xCC,0x9A,0x7A,0xCD,0x9C,0x06,0xA6,0x01,0xCD,0x9B,0xF9,0xCD,0x9F,0x6C,
+0xE0,0x9B,0x4F,0xCD,0x9B,0xF9,0xCD,0x9F,0x6C,0xA6,0x4B,0xCD,0x9F,0xB4,0xCC,0x9C,0x17,0x72,0x05,0x50,0x01,0x03,0xA6,0x01,0x81,0x4F,0x81,0x4D,0x27,0x05,0x72,0x14,0x50,0x00,
+0x00,0x9C,0x81,0x72,0x15,0x50,0x00,0x81,0x72,0x14,0x50,0x02,0x72,0x14,0x50,0x03,0x72,0x15,0x50,0x04,0x72,0x15,0x50,0x00,0x81,0x72,0x15,0x50,0x02,0x72,0x15,0x50,0x03,0x72,
+0x20,0x9C,0x15,0x50,0x04,0x81,0xC6,0x50,0x05,0xAA,0x30,0xC7,0x50,0x05,0xC6,0x50,0x07,0xAA,0x30,0xC7,0x50,0x07,0xC6,0x50,0x08,0xA4,0xCF,0xC7,0x50,0x08,0xC6,0x50,0x09,0xAA,
+0x40,0x9C,0x30,0xC7,0x50,0x09,0x35,0x08,0x52,0x12,0x35,0x28,0x52,0x1B,0x72,0x5F,0x52,0x1C,0x35,0x09,0x52,0x1D,0x35,0xA2,0x52,0x13,0x72,0x1C,0x52,0x14,0x35,0x01,0x52,0x1A,
+0x60,0x9C,0x72,0x14,0x52,0x11,0x72,0x10,0x52,0x10,0x81,0x88,0x89,0x5E,0xB6,0x01,0x42,0x89,0x1E,0x03,0xB6,0x00,0x42,0x72,0xFB,0x01,0x4F,0x02,0x89,0x1E,0x05,0xB6,0x01,0x42,
+0x80,0x9C,0x72,0xFB,0x01,0x5B,0x06,0x84,0x81,0x5D,0x2B,0x06,0x90,0x5D,0x2B,0x0A,0x65,0x81,0x50,0x90,0x5D,0x2B,0x07,0x65,0x50,0x81,0x90,0x50,0x20,0xF9,0x90,0x50,0x20,0xEE,
+0xA0,0x9C,0x4D,0x27,0x04,0x58,0x4A,0x26,0xFC,0x81,0x58,0x58,0x58,0x58,0x58,0x81,0x3B,0x00,0x08,0xB7,0x08,0xCD,0x9E,0x85,0xB6,0x08,0xCA,0x54,0x00,0xC7,0x54,0x00,0xA6,0x32,
+0xC0,0x9C,0xB7,0x00,0x4A,0x3D,0x00,0x26,0xF9,0x72,0x10,0x54,0x01,0x72,0x0F,0x54,0x00,0xFB,0x72,0x1F,0x54,0x00,0xC6,0x54,0x05,0xB7,0x00,0xC6,0x54,0x04,0x5F,0x97,0x4F,0x02,
+0xE0,0x9C,0x90,0x5F,0xB6,0x00,0x61,0xBF,0x00,0x93,0x02,0xBA,0x00,0x01,0x32,0x00,0x08,0x81,0x3B,0x00,0x08,0xB7,0x08,0xCD,0x9C,0x06,0xA6,0x01,0xCD,0x9B,0xF9,0x9D,0x4F,0xCD,
+0x00,0x9D,0x9B,0xF9,0x3D,0x08,0x27,0x11,0xA6,0x03,0xCD,0x9F,0xB4,0xA6,0x01,0xCD,0x9B,0xF9,0xA6,0x21,0xCD,0x9F,0xB4,0x20,0x0F,0xA6,0x21,0xCD,0x9F,0xB4,0xA6,0x01,0xCD,0x9B,
+0x20,0x9D,0xF9,0xA6,0x03,0xCD,0x9F,0xB4,0xA6,0x03,0xCD,0x9F,0xB4,0x32,0x00,0x08,0x81,0xCD,0x9A,0x2A,0x3B,0x00,0x0C,0xBF,0x08,0xCD,0x9B,0xD5,0xCD,0x9D,0x67,0x9D,0x9D,0xA6,
+0x40,0x9D,0x33,0xCD,0x9D,0x9E,0x3F,0x0C,0x20,0x13,0x5F,0x41,0x72,0xBB,0x00,0x08,0xBF,0x0A,0xCD,0x9D,0xFE,0x92,0xC7,0x0A,0xB6,0x0C,0x4C,0xB7,0x0C,0xB6,0x0C,0xA1,0x08,0x25,
+0x60,0x9D,0xE7,0x32,0x00,0x0C,0xCC,0x9A,0x7A,0xCD,0x99,0xED,0x3B,0x00,0x0A,0xAE,0x01,0x2C,0xBF,0x08,0x3F,0x0A,0x20,0x04,0x35,0x01,0x00,0x0A,0xBE,0x08,0xA3,0x00,0x01,0x2F,
+0x80,0x9D,0x12,0x3D,0x0A,0x26,0x0E,0xCD,0x9B,0xEF,0xA1,0x00,0x27,0xEA,0xBE,0x08,0x5A,0xBF,0x08,0x20,0xE7,0xCD,0x9F,0x6C,0xB6,0x0A,0x32,0x00,0x0A,0xCC,0x9A,0x85,0xCD,0x99,
+0xA0,0x9D,0xED,0x3B,0x00,0x0A,0xB7,0x0A,0x35,0x01,0x00,0x09,0x3F,0x08,0x20,0x11,0xB6,0x09,0xB4,0x0A,0xCD,0x9C,0xF0,0xB6,0x09,0x48,0xB7,0x09,0xB6,0x08,0x4C,0xB7,0x08,0xB6,
+0xC0,0x9D,0x08,0xA1,0x08,0x25,0xE9,0xA6,0x37,0xCD,0x9F,0xB4,0x32,0x00,0x0A,0xCC,0x9A,0x85,0x3B,0x00,0x08,0xCD,0x9C,0x17,0x9D,0x9D,0x9D,0xCD,0x9C,0x06,0x4F,0xCD,0x9B,0xF9,
+0xE0,0x9D,0x9D,0xCD,0x9C,0x17,0xA6,0x03,0xCD,0x9F,0xB4,0x9D,0x9D,0xCD,0x9B,0xEF,0xB7,0x08,0xA6,0x21,0xCD,0x9F,0xB4,0xCD,0x9C,0x17,0xB6,0x08,0x32,0x00,0x08,0x81,0xCD,0x99,
+0x00,0x9E,0xED,0x3F,0x09,0x3F,0x08,0x20,0x14,0xCD,0x9D,0xD0,0x5F,0x97,0xB6,0x08,0xCD,0x9C,0xA0,0x9F,0xBA,0x09,0xB7,0x09,0xB6,0x08,0x4C,0xB7,0x08,0xB6,0x08,0xA1,0x08,0x25,
+0x20,0x9E,0xE6,0xB6,0x09,0xCC,0x9A,0x85,0x89,0xFE,0x90,0x93,0x85,0x5C,0x5C,0x90,0x5D,0x27,0x1C,0x89,0xFE,0xBF,0x00,0x85,0x5C,0x5C,0x89,0xFE,0xBF,0x02,0x85,0x5C,0x5C,0x51,
+0x40,0x9E,0x5A,0x92,0xD6,0x00,0x92,0xD7,0x02,0x5A,0x2A,0xF7,0x51,0x20,0xD9,0x81,0x72,0x15,0x50,0x11,0x72,0x15,0x50,0x12,0x72,0x15,0x50,0x13,0x72,0x17,0x50,0x11,0x72,0x17,
+0x60,0x9E,0x50,0x12,0x72,0x17,0x50,0x13,0x72,0x19,0x50,0x0C,0x72,0x19,0x50,0x0D,0x72,0x19,0x50,0x0E,0x81,0x9E,0xC2,0x00,0x21,0x00,0x12,0x00,0x00,0x9E,0x26,0x00,0x02,0x9F,
+0x80,0x9E,0xDC,0x00,0x10,0x00,0x00,0x72,0x5F,0x54,0x00,0xC6,0x54,0x01,0xA4,0x8F,0xC7,0x54,0x01,0xC6,0x54,0x01,0xC7,0x54,0x01,0x72,0x13,0x54,0x01,0x72,0x16,0x54,0x02,0x72,
+0xA0,0x9E,0x10,0x54,0x01,0x81,0xCD,0x99,0xED,0xB7,0x09,0x3F,0x08,0x4F,0xB7,0x08,0xB6,0x08,0xB1,0x09,0x24,0x0B,0xCD,0x9F,0x78,0xB6,0x08,0xAB,0x01,0xB7,0x08,0x20,0xEF,0xCC,
+0xC0,0x9E,0x9A,0x85,0x89,0xFE,0x90,0x93,0x85,0x5C,0x5C,0x90,0x5D,0x27,0x12,0x89,0xFE,0xBF,0x00,0x85,0x5C,0x5C,0x51,0x5A,0x92,0x6F,0x00,0x5A,0x2A,0xFA,0x51,0x20,0xE3,0x81,
+0xE0,0x9E,0x90,0xAE,0x9E,0x73,0x20,0x0A,0x93,0x1C,0x00,0x02,0x90,0xFE,0x90,0xFD,0x90,0x93,0x90,0xA3,0x9E,0x85,0x26,0xF0,0x81,0x35,0xCC,0x50,0xE0,0x35,0x55,0x50,0xE0,0x35,
+0x00,0x9F,0x06,0x50,0xE1,0x35,0xFF,0x50,0xE2,0x35,0xAA,0x50,0xE0,0x81,0xCD,0x99,0xED,0x52,0x02,0xBF,0x08,0xBE,0x08,0x1F,0x01,0x96,0x5C,0xA6,0x01,0xCD,0x9F,0xDB,0x20,0xF3,
+0x20,0x9F,0xAE,0x03,0xFF,0x94,0xCD,0x9F,0xD2,0x5D,0x27,0x03,0xCD,0x9E,0xE0,0xCD,0x97,0x07,0xCC,0x9F,0xD5,0xCD,0x9F,0xBC,0xCD,0x8E,0xFD,0xCD,0x93,0x7D,0xCD,0x9E,0x4E,0xCD,
+0x40,0x9F,0x9C,0x24,0xCC,0x9E,0xF7,0xA6,0x07,0xB7,0x00,0xB6,0x00,0xAB,0xFF,0x3D,0x00,0x26,0xF6,0x81,0xA6,0x1A,0xB7,0x00,0xB6,0x00,0xAB,0xFF,0x3D,0x00,0x26,0xF6,0x81,0x88,
+0x60,0x9F,0x90,0xF6,0xF7,0x5C,0x90,0x5C,0x0A,0x01,0x26,0xF6,0x84,0x81,0xAE,0x00,0xFA,0x90,0x93,0x93,0x5A,0x90,0x5D,0x26,0xF8,0x81,0xAE,0x01,0xF4,0x90,0x93,0x93,0x5A,0x90,
+0x80,0x9F,0x5D,0x26,0xF8,0x81,0xCD,0x9B,0x15,0xA1,0x01,0x26,0x03,0xA6,0x01,0x81,0x4F,0x81,0x1E,0x03,0x1C,0x00,0x04,0x1F,0x03,0x1D,0x00,0x04,0x81,0x35,0x56,0x50,0x62,0x35,
+0xA0,0x9F,0xAE,0x50,0x62,0x81,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xB7,0x00,0x4A,0x3D,0x00,0x26,0xF9,0x81,0x35,0x02,0x50,0xC6,
+0xC0,0x9F,0x81,0x35,0xAA,0x50,0xE0,0x81,0x89,0x85,0xCD,0x9F,0x0C,0x00,0x00,0x00,0x00,0xCC,0x9F,0xD8,0x5F,0x5C,0x81,0xCC,0x9F,0xC6,0x9D,0x20,0xFD,0x81,0x02,0x01,0x00,0x00,
+0xE0,0x9F,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0B,0x34,0x55,0x34,
+};
+#endif
diff --git a/drivers/power/supply/qcom/pmic-voter.c b/drivers/power/supply/qcom/pmic-voter.c
index e0a5150384d8757156262ddd7b78d95b16775bbd..1796e36690b3ca108721f306e04e4094bc31a775 100644
--- a/drivers/power/supply/qcom/pmic-voter.c
+++ b/drivers/power/supply/qcom/pmic-voter.c
@@ -392,7 +392,10 @@ int vote(struct votable *votable, const char *client_str, bool enabled, int val)
 			client_str, client_id, enabled ? "on" : "off", val);
 		goto out;
 	}
-
+	if (votable->name && (strcmp(votable->name, "USB_ICL") == 0))
+		pr_err("%s: %s,%d voting %s of val=%d\n",
+			votable->name,
+			client_str, client_id, enabled ? "on" : "off", val);
 	pr_debug("%s: %s,%d voting %s of val=%d\n",
 		votable->name,
 		client_str, client_id, enabled ? "on" : "off", val);
diff --git a/drivers/power/supply/qcom/qpnp-fg-gen4.c b/drivers/power/supply/qcom/qpnp-fg-gen4.c
index 00b365b01381d3ec30425dc03107f7ca3d8bff95..8e4b4551684079682daad89191b2785bce79fd00 100644
--- a/drivers/power/supply/qcom/qpnp-fg-gen4.c
+++ b/drivers/power/supply/qcom/qpnp-fg-gen4.c
@@ -22,6 +22,7 @@
 #include "fg-core.h"
 #include "fg-reg.h"
 #include "fg-alg.h"
+#include <linux/power/oem_external_fg.h>
 
 #define FG_GEN4_DEV_NAME	"qcom,fg-gen4"
 #define TTF_AWAKE_VOTER		"fg_ttf_awake"
@@ -154,6 +155,14 @@
 #define MONOTONIC_SOC_WORD		463
 #define MONOTONIC_SOC_OFFSET		0
 
+static void oem_update_cc_cv_setpoint(struct fg_dev *chip,
+	int cv_float_point);
+static void oneplus_set_allow_read_iic(struct fg_dev *chip,
+	bool status);
+static void oneplus_set_lcd_off_status(struct fg_dev *chip,
+	bool status);
+static struct external_battery_gauge *external_fg;
+
 /* v2 SRAM address and offset in ascending order */
 #define RSLOW_SCALE_FN_DISCHG_V2_WORD	281
 #define RSLOW_SCALE_FN_DISCHG_V2_OFFSET	0
@@ -280,6 +289,25 @@ module_param_named(
 	sram_dump_period_ms, fg_sram_dump_period_ms, int, 0600
 );
 
+void external_battery_gauge_register(
+				struct external_battery_gauge *batt_gauge)
+{
+	if (external_fg) {
+		external_fg = batt_gauge;
+		pr_err("multiple battery gauge called\n");
+	} else
+		external_fg = batt_gauge;
+}
+EXPORT_SYMBOL(external_battery_gauge_register);
+
+void external_battery_gauge_unregister(
+				struct external_battery_gauge *batt_gauge)
+{
+	external_fg = NULL;
+}
+EXPORT_SYMBOL(external_battery_gauge_unregister);
+
+
 static int fg_restart_mp;
 static bool fg_sram_dump;
 static bool fg_esr_fast_cal_en;
@@ -477,6 +505,8 @@ struct bias_config id_table[3] = {
 };
 
 #define MAX_BIAS_CODE	0x70E4
+
+#define OP_SW_DEFAULT_ID 200000
 static int fg_gen4_get_batt_id(struct fg_gen4_chip *chip)
 {
 	struct fg_dev *fg = &chip->fg;
@@ -523,7 +553,7 @@ static int fg_gen4_get_batt_id(struct fg_gen4_chip *chip)
 	 */
 	batt_id_kohms = (id_table[bias_id].bias_kohms * bias_code) * 10 /
 			(MAX_BIAS_CODE - bias_code);
-	fg->batt_id_ohms = (batt_id_kohms * 1000) / 10;
+	fg->batt_id_ohms = OP_SW_DEFAULT_ID;
 	return 0;
 }
 
@@ -2036,6 +2066,8 @@ static int fg_gen4_update_maint_soc(struct fg_dev *fg)
 	return rc;
 }
 
+#define DEFALUT_BATT_TEMP	250
+
 static int fg_gen4_configure_full_soc(struct fg_dev *fg, int bsoc)
 {
 	int rc;
@@ -2845,12 +2877,10 @@ static struct fg_irq_info fg_irqs[FG_GEN4_IRQ_MAX] = {
 	[MSOC_DELTA_IRQ] = {
 		.name		= "msoc-delta",
 		.handler	= fg_delta_msoc_irq_handler,
-		.wakeable	= true,
 	},
 	[BSOC_DELTA_IRQ] = {
 		.name		= "bsoc-delta",
 		.handler	= fg_delta_bsoc_irq_handler,
-		.wakeable	= true,
 	},
 	[SOC_READY_IRQ] = {
 		.name		= "soc-ready",
@@ -2865,7 +2895,7 @@ static struct fg_irq_info fg_irqs[FG_GEN4_IRQ_MAX] = {
 	[ESR_DELTA_IRQ] = {
 		.name		= "esr-delta",
 		.handler	= fg_delta_esr_irq_handler,
-		.wakeable	= true,
+		/*.wakeable	= true,*//*op disable ers calibration*/
 	},
 	[VBATT_LOW_IRQ] = {
 		.name		= "vbatt-low",
@@ -2905,7 +2935,6 @@ static struct fg_irq_info fg_irqs[FG_GEN4_IRQ_MAX] = {
 	[BATT_TEMP_COLD_IRQ] = {
 		.name		= "batt-temp-cold",
 		.handler	= fg_batt_temp_irq_handler,
-		.wakeable	= true,
 	},
 	[BATT_TEMP_HOT_IRQ] = {
 		.name		= "batt-temp-hot",
@@ -3080,6 +3109,7 @@ static void pl_current_en_work(struct work_struct *work)
 		return;
 
 	vote(chip->parallel_current_en_votable, FG_PARALLEL_EN_VOTER, en, 0);
+	vote(chip->mem_attn_irq_en_votable, MEM_ATTN_IRQ_VOTER, false, 0);
 }
 
 static void pl_enable_work(struct work_struct *work)
@@ -3173,6 +3203,8 @@ static void status_change_work(struct work_struct *work)
 	if (rc < 0)
 		pr_err("Error in adjusting FCC for ESR, rc=%d\n", rc);
 
+	if (is_parallel_charger_available(fg) &&
+		!delayed_work_pending(&chip->pl_current_en_work))
 	schedule_delayed_work(&chip->pl_current_en_work, 0);
 
 	ttf_update(chip->ttf, input_present);
@@ -3350,7 +3382,6 @@ static struct kernel_param_ops fg_esr_cal_ops = {
 module_param_cb(esr_fast_cal_en, &fg_esr_cal_ops, &fg_esr_fast_cal_en, 0644);
 
 /* All power supply functions here */
-
 static int fg_psy_get_property(struct power_supply *psy,
 				       enum power_supply_property psp,
 				       union power_supply_propval *pval)
@@ -3362,22 +3393,41 @@ static int fg_psy_get_property(struct power_supply *psy,
 
 	switch (psp) {
 	case POWER_SUPPLY_PROP_CAPACITY:
-		rc = fg_gen4_get_prop_capacity(fg, &pval->intval);
+		if (!get_extern_fg_regist_done())
+				pval->intval = get_prop_pre_shutdown_soc();
+		else if (fg->use_external_fg && external_fg
+					&& external_fg->get_battery_soc)
+			pval->intval = external_fg->get_battery_soc();
+		else
+			pval->intval = 50;
 		break;
 	case POWER_SUPPLY_PROP_CAPACITY_RAW:
 		rc = fg_get_msoc_raw(fg, &pval->intval);
 		break;
 	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-		if (fg->battery_missing)
-			pval->intval = 3700000;
+		if (fg->use_external_fg && external_fg
+				&& external_fg->get_battery_mvolts)
+			pval->intval = external_fg->get_battery_mvolts();
 		else
-			rc = fg_get_battery_voltage(fg, &pval->intval);
+			pval->intval = 4000000;
 		break;
 	case POWER_SUPPLY_PROP_CURRENT_NOW:
-		rc = fg_get_battery_current(fg, &pval->intval);
+		if (fg->use_external_fg && external_fg
+				&& external_fg->get_average_current)
+			pval->intval = external_fg->get_average_current();
+		else
+			pval->intval = 0;
 		break;
 	case POWER_SUPPLY_PROP_TEMP:
-		rc = fg_gen4_get_battery_temp(fg, &pval->intval);
+		if (!get_extern_fg_regist_done()
+				&& get_extern_bq_present())
+			pval->intval = DEFALUT_BATT_TEMP;
+		else if (fg->use_external_fg && external_fg
+					&& external_fg->get_average_current) {
+				pval->intval =
+					external_fg->get_battery_temperature();
+		} else
+				pval->intval = -400;
 		break;
 	case POWER_SUPPLY_PROP_RESISTANCE:
 		rc = fg_get_battery_resistance(fg, &pval->intval);
@@ -3439,6 +3489,25 @@ static int fg_psy_get_property(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_DEBUG_BATTERY:
 		pval->intval = is_debug_batt_id(fg);
 		break;
+	case POWER_SUPPLY_PROP_FG_CAPACITY:
+		rc = fg_gen4_get_prop_capacity(fg, &pval->intval);
+		break;
+	case POWER_SUPPLY_PROP_FG_VOLTAGE_NOW:
+		if (fg->battery_missing)
+			pval->intval = 3700000;
+		else
+			rc = fg_get_battery_voltage(fg, &pval->intval);
+		break;
+	case POWER_SUPPLY_PROP_FG_CURRENT_NOW:
+			rc = fg_get_battery_current(fg, &pval->intval);
+		break;
+	case POWER_SUPPLY_PROP_BQ_SOC:
+		if (fg->use_external_fg && external_fg
+				&& external_fg->get_batt_bq_soc)
+			pval->intval = external_fg->get_batt_bq_soc();
+		else
+			pval->intval = 50;
+		break;
 	case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
 		rc = fg_get_sram_prop(fg, FG_SRAM_VBATT_FULL, &pval->intval);
 		break;
@@ -3484,6 +3553,16 @@ static int fg_psy_set_property(struct power_supply *psy,
 	u8 val, mask;
 
 	switch (psp) {
+	case POWER_SUPPLY_PROP_CC_TO_CV_POINT:
+		oem_update_cc_cv_setpoint(&chip->fg, pval->intval);
+		break;
+	case POWER_SUPPLY_PROP_SET_ALLOW_READ_EXTERN_FG_IIC:
+		oneplus_set_allow_read_iic(&chip->fg, pval->intval);
+		break;
+	case POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF:
+		oneplus_set_lcd_off_status(&chip->fg, pval->intval);
+		break;
+
 	case POWER_SUPPLY_PROP_CHARGE_FULL:
 		if (chip->cl->active) {
 			pr_warn("Capacity learning active!\n");
@@ -3560,6 +3639,7 @@ static int fg_property_is_writeable(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_ESR_ACTUAL:
 	case POWER_SUPPLY_PROP_ESR_NOMINAL:
 	case POWER_SUPPLY_PROP_SOH:
+	case POWER_SUPPLY_PROP_SET_ALLOW_READ_EXTERN_FG_IIC:
 	case POWER_SUPPLY_PROP_CLEAR_SOH:
 		return 1;
 	default:
@@ -3597,6 +3677,9 @@ static enum power_supply_property fg_psy_props[] = {
 	POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
 	POWER_SUPPLY_PROP_CC_STEP,
 	POWER_SUPPLY_PROP_CC_STEP_SEL,
+	POWER_SUPPLY_PROP_SET_ALLOW_READ_EXTERN_FG_IIC,
+	POWER_SUPPLY_PROP_BQ_SOC,
+
 };
 
 static const struct power_supply_desc fg_psy_desc = {
@@ -3719,7 +3802,6 @@ static int fg_parallel_current_en_cb(struct votable *votable, void *data,
 
 	fg_dbg(fg, FG_STATUS, "Parallel current summing: %d\n", enable);
 
-	vote(chip->mem_attn_irq_en_votable, MEM_ATTN_IRQ_VOTER, false, 0);
 	return rc;
 }
 
@@ -3728,12 +3810,11 @@ static int fg_delta_bsoc_irq_en_cb(struct votable *votable, void *data,
 {
 	struct fg_dev *fg = data;
 
-	if (!fg->irqs[BSOC_DELTA_IRQ].irq)
+	if (!fg->irqs[BSOC_DELTA_IRQ].irq  || fg->delta_bsoc_irq_en == enable)
 		return 0;
-
+	fg->delta_bsoc_irq_en = enable;
 	if (enable) {
 		enable_irq(fg->irqs[BSOC_DELTA_IRQ].irq);
-		enable_irq_wake(fg->irqs[BSOC_DELTA_IRQ].irq);
 	} else {
 		disable_irq_wake(fg->irqs[BSOC_DELTA_IRQ].irq);
 		disable_irq_nosync(fg->irqs[BSOC_DELTA_IRQ].irq);
@@ -4015,6 +4096,13 @@ static int fg_gen4_hw_init(struct fg_gen4_chip *chip)
 		return rc;
 	}
 
+	rc = fg_masked_write(fg,
+			BATT_INFO_ESR_PULL_DN_CFG(fg), 0xFF, 0);
+	if (rc < 0) {
+		pr_err("Error in writing ESR PULL DN, rc=%d\n", rc);
+		return rc;
+	}
+
 	if (is_debug_batt_id(fg)) {
 		val = ESR_NO_PULL_DOWN;
 		rc = fg_masked_write(fg, BATT_INFO_ESR_PULL_DN_CFG(fg),
@@ -4524,6 +4612,10 @@ static int fg_gen4_parse_dt(struct fg_gen4_chip *chip)
 	chip->dt.force_load_profile = of_property_read_bool(node,
 					"qcom,fg-force-load-profile");
 
+	fg->use_external_fg =
+	of_property_read_bool(node, "oem,use_external_fg");
+	pr_info("use_external_fg=%d\n", fg->use_external_fg);
+
 	rc = of_property_read_u32(node, "qcom,cl-start-capacity", &temp);
 	if (rc < 0)
 		chip->cl->dt.max_start_soc = DEFAULT_CL_START_SOC;
@@ -4647,6 +4739,9 @@ static void fg_gen4_cleanup(struct fg_gen4_chip *chip)
 {
 	struct fg_dev *fg = &chip->fg;
 
+	if (fg->fg_psy)
+		power_supply_unregister(fg->fg_psy);
+
 	fg_unregister_interrupts(fg, chip, FG_GEN4_IRQ_MAX);
 
 	cancel_work(&fg->status_change_work);
@@ -4675,6 +4770,32 @@ static void fg_gen4_cleanup(struct fg_gen4_chip *chip)
 	dev_set_drvdata(fg->dev, NULL);
 }
 
+static void oem_update_cc_cv_setpoint(
+				struct fg_dev *chip, int cv_float_point)
+{
+	/* TODO: write CC_CV_SETPOINT_REG */
+}
+
+static void oneplus_set_allow_read_iic(struct fg_dev *chip,
+				bool status)
+{
+	if (chip->use_external_fg && external_fg
+			&& external_fg->set_allow_reading)
+		external_fg->set_allow_reading(status);
+	else
+		pr_info("set allow read extern fg iic fail\n");
+}
+
+static void oneplus_set_lcd_off_status(struct fg_dev *chip,
+				bool status)
+{
+	if (chip->use_external_fg && external_fg
+			&& external_fg->set_lcd_off_status)
+		external_fg->set_lcd_off_status(status);
+	else
+		pr_info("set lcd off status fail\n");
+}
+
 static int fg_gen4_probe(struct platform_device *pdev)
 {
 	struct fg_gen4_chip *chip;
diff --git a/drivers/power/supply/qcom/qpnp-smb5.c b/drivers/power/supply/qcom/qpnp-smb5.c
index 95c1589699ccb47ab710376ad90600ece6caabef..72b308d5b2352a96a58e0a9599a7d59bc353fcd2 100644
--- a/drivers/power/supply/qcom/qpnp-smb5.c
+++ b/drivers/power/supply/qcom/qpnp-smb5.c
@@ -10,6 +10,8 @@
  * GNU General Public License for more details.
  */
 
+#define pr_fmt(fmt) "SMB2: %s: " fmt, __func__
+
 #include <linux/debugfs.h>
 #include <linux/delay.h>
 #include <linux/device.h>
@@ -26,6 +28,13 @@
 #include <linux/regulator/machine.h>
 #include <linux/iio/consumer.h>
 #include <linux/pmic-voter.h>
+#include <linux/delay.h>
+#include <linux/proc_fs.h>
+#include <linux/msm-bus.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+
+#include <linux/oneplus/boot_mode.h>
 #include "smb5-reg.h"
 #include "smb5-lib.h"
 #include "schgm-flash.h"
@@ -205,7 +214,37 @@ struct smb5 {
 	struct smb_dt_props	dt;
 };
 
+static int smbchg_cutoff_volt_with_charger = 3240;
+struct smb_charger *g_chip;
+static const struct file_operations proc_ship_mode_operations;
+module_param_named(
+	cutoff_volt_with_charger,
+	smbchg_cutoff_volt_with_charger,
+	int, 0600);
+
+#define OF_PROP_READ(node, dt_property, prop, retval, optional)		\
+do {									\
+	if (retval)							\
+		break;							\
+	if (optional)							\
+		prop = -EINVAL;						\
+									\
+	retval = of_property_read_u32(node,		\
+					dt_property,	\
+					&prop);				\
+									\
+	if ((retval == -EINVAL) && optional)				\
+		retval = 0;						\
+	else if (retval)						\
+		pr_err("Error reading " #dt_property	\
+				" property rc = %d\n", rc);		\
+} while (0)
+
+#ifdef	CONFIG_OP_DEBUG_CHG
+	static int __debug_mask = PR_OP_DEBUG;
+#else
 static int __debug_mask;
+#endif
 module_param_named(
 	debug_mask, __debug_mask, int, 0600
 );
@@ -220,6 +259,19 @@ module_param_named(
 	weak_chg_icl_ua, __weak_chg_icl_ua, int, 0600
 );
 
+int __lpd_enable;
+
+int __lpd_result;
+module_param_named(
+	lpd_result, __lpd_result, int, 0600
+);
+
+static int lpd_enable_set(const char *val, const struct kernel_param *kp);
+module_param_call(lpd_enable, lpd_enable_set, param_get_int,
+			&__lpd_enable, 0644);
+MODULE_PARM_DESC(lpd_enable, "Enable lpd trigger control by user");
+
+
 #define PMI632_MAX_ICL_UA	3000000
 #define PM6150_MAX_FCC_UA	3000000
 static int smb5_chg_config_init(struct smb5 *chip)
@@ -305,7 +357,8 @@ static int smb5_parse_dt(struct smb5 *chip)
 {
 	struct smb_charger *chg = &chip->chg;
 	struct device_node *node = chg->dev->of_node;
-	int rc, byte_len;
+	int byte_len, rc = 0;
+	enum of_gpio_flags flags;
 
 	if (!node) {
 		pr_err("device tree node missing\n");
@@ -322,8 +375,180 @@ static int smb5_parse_dt(struct smb5 *chip)
 		chip->dt.sec_charger_config == POWER_SUPPLY_CHARGER_SEC_PL ||
 		chip->dt.sec_charger_config == POWER_SUPPLY_CHARGER_SEC_CP_PL;
 
-	chg->step_chg_enabled = of_property_read_bool(node,
-				"qcom,step-charging-enable");
+/*read ffc param*/
+	OF_PROP_READ(node, "ffc-pre-normal-decidegc",
+			chg->FFC_TEMP_T1, rc, 1);
+	OF_PROP_READ(node, "ffc-normal-decidegc",
+		chg->FFC_TEMP_T2, rc, 1);
+	OF_PROP_READ(node, "ffc-warm-decidegc",
+		chg->FFC_TEMP_T3, rc, 1);
+	OF_PROP_READ(node, "ffc-normal-fcc-ma",
+		chg->FFC_NOR_FCC, rc, 1);
+	OF_PROP_READ(node, "ffc-warm-fcc-ma",
+		chg->FFC_WARM_FCC, rc, 1);
+	OF_PROP_READ(node, "ffc-normal-cutoff-ma",
+		chg->FFC_NORMAL_CUTOFF, rc, 1);
+	OF_PROP_READ(node, "ffc-warm-cutoff-ma",
+		chg->FFC_WARM_CUTOFF, rc, 1);
+	OF_PROP_READ(node, "ffc-full-vbat-mv",
+		chg->FFC_VBAT_FULL, rc, 1);
+	pr_info("T1:%d, T2:%d, T3:%d, fcc1:%d, fcc1:%d, cut1:%d, cut2:%d,full:%d\n",
+		chg->FFC_TEMP_T1, chg->FFC_TEMP_T2, chg->FFC_TEMP_T3,
+		chg->FFC_NOR_FCC, chg->FFC_WARM_FCC, chg->FFC_NORMAL_CUTOFF,
+		chg->FFC_WARM_CUTOFF, chg->FFC_VBAT_FULL);
+
+/* @bsp, 2018/07/13 Battery & Charging porting */
+	/* read ibatmax setting for different temp regions */
+	OF_PROP_READ(node, "ibatmax-little-cold-ma",
+			chg->ibatmax[BATT_TEMP_LITTLE_COLD], rc, 1);
+	OF_PROP_READ(node, "ibatmax-cool-ma",
+			chg->ibatmax[BATT_TEMP_COOL], rc, 1);
+	OF_PROP_READ(node, "ibatmax-little-cool-ma",
+			chg->ibatmax[BATT_TEMP_LITTLE_COOL], rc, 1);
+	OF_PROP_READ(node, "ibatmax-pre-normal-ma",
+			chg->ibatmax[BATT_TEMP_PRE_NORMAL], rc, 1);
+	OF_PROP_READ(node, "ibatmax-normal-ma",
+			chg->ibatmax[BATT_TEMP_NORMAL], rc, 1);
+	OF_PROP_READ(node, "ibatmax-warm-ma",
+			chg->ibatmax[BATT_TEMP_WARM], rc, 1);
+
+	/* read vbatmax setting for different temp regions */
+	OF_PROP_READ(node, "vbatmax-little-cold-mv",
+			chg->vbatmax[BATT_TEMP_LITTLE_COLD], rc, 1);
+	OF_PROP_READ(node, "vbatmax-cool-mv",
+			chg->vbatmax[BATT_TEMP_COOL], rc, 1);
+	OF_PROP_READ(node, "vbatmax-little-cool-mv",
+			chg->vbatmax[BATT_TEMP_LITTLE_COOL], rc, 1);
+	OF_PROP_READ(node, "vbatmax-pre-normal-mv",
+			chg->vbatmax[BATT_TEMP_PRE_NORMAL], rc, 1);
+	OF_PROP_READ(node, "vbatmax-normal-mv",
+			chg->vbatmax[BATT_TEMP_NORMAL], rc, 1);
+	OF_PROP_READ(node, "vbatmax-warm-mv",
+			chg->vbatmax[BATT_TEMP_WARM], rc, 1);
+
+	/* read vbatdet setting for different temp regions */
+	OF_PROP_READ(node, "vbatdet-little-cold-mv",
+			chg->vbatdet[BATT_TEMP_LITTLE_COLD], rc, 1);
+	OF_PROP_READ(node, "vbatdet-cool-mv",
+			chg->vbatdet[BATT_TEMP_COOL], rc, 1);
+	OF_PROP_READ(node, "vbatdet-little-cool-mv",
+			chg->vbatdet[BATT_TEMP_LITTLE_COOL], rc, 1);
+	OF_PROP_READ(node, "vbatdet-pre-normal-mv",
+			chg->vbatdet[BATT_TEMP_PRE_NORMAL], rc, 1);
+	OF_PROP_READ(node, "vbatdet-normal-mv",
+			chg->vbatdet[BATT_TEMP_NORMAL], rc, 1);
+	OF_PROP_READ(node, "vbatdet-warm-mv",
+			chg->vbatdet[BATT_TEMP_WARM], rc, 1);
+	OF_PROP_READ(node, "little-cool-vbat-thr-mv",
+			chg->temp_littel_cool_voltage, rc, 1);
+	if (rc < 0)
+		chg->temp_littel_cool_voltage = 4180;
+	OF_PROP_READ(node, "cool-vbat-thr-mv",
+			chg->temp_cool_voltage, rc, 1);
+	if (rc < 0)
+		chg->temp_cool_voltage = 4180;
+	OF_PROP_READ(node, "ibatmax-little-cool-thr-ma",
+			chg->temp_littel_cool_current, rc, 1);
+	if (rc < 0)
+		chg->temp_littel_cool_current = 2000;
+	OF_PROP_READ(node, "ibatmax-cool-thr-ma",
+			chg->temp_cool_current, rc, 1);
+	if (rc < 0)
+		chg->temp_cool_current = 1140;
+	/* read temp region settings */
+	OF_PROP_READ(node, "cold-bat-decidegc",
+			chg->BATT_TEMP_T0, rc, 1);
+	chg->BATT_TEMP_T0 = 0 - chg->BATT_TEMP_T0;
+	OF_PROP_READ(node, "little-cold-bat-decidegc",
+			chg->BATT_TEMP_T1, rc, 1);
+	OF_PROP_READ(node, "cool-bat-decidegc",
+			chg->BATT_TEMP_T2, rc, 1);
+	OF_PROP_READ(node, "little-cool-bat-decidegc",
+			chg->BATT_TEMP_T3, rc, 1);
+	OF_PROP_READ(node, "pre-normal-bat-decidegc",
+			chg->BATT_TEMP_T4, rc, 1);
+	OF_PROP_READ(node, "warm-bat-decidegc",
+			chg->BATT_TEMP_T5, rc, 1);
+	OF_PROP_READ(node, "hot-bat-decidegc",
+			chg->BATT_TEMP_T6, rc, 1);
+	chg->pd_not_supported = of_property_read_bool(node,
+						"disable-pd");
+
+	chg->check_batt_full_by_sw = of_property_read_bool(node,
+				"op,sw-check-full-enable");
+	rc = of_property_read_u32(node,
+					"op,sw-iterm-ma",
+					&chg->sw_iterm_ma);
+	if (rc < 0)
+		chg->sw_iterm_ma = 150;
+	pr_info("sw_iterm_ma=%d,check_batt_full_by_sw=%d",
+				chg->sw_iterm_ma, chg->check_batt_full_by_sw);
+/*yangfb@bsp, 20171023 otg-icl set 1A if battery lower than 15%*/
+	chg->OTG_ICL_CTRL = of_property_read_bool(node,
+						"op,otg-icl-ctrl-enable");
+	OF_PROP_READ(node, "otg-low-battery-thr",
+			chg->OTG_LOW_BAT, rc, 1);
+	if (rc < 0)
+		chg->OTG_LOW_BAT = -EINVAL;
+	OF_PROP_READ(node, "otg-low-bat-icl-thr",
+			chg->OTG_LOW_BAT_ICL, rc, 1);
+	if (rc < 0)
+		chg->OTG_LOW_BAT_ICL = -EINVAL;
+	OF_PROP_READ(node, "otg-normal-bat-icl-thr",
+			chg->OTG_NORMAL_BAT_ICL, rc, 1);
+	if (rc < 0)
+		chg->OTG_NORMAL_BAT_ICL = -EINVAL;
+	pr_info("OTG_ICL:enable:%d,CapThr:%d,LowThr:%d,NorThr:%d\n",
+		chg->OTG_ICL_CTRL,
+		chg->OTG_LOW_BAT,
+		chg->OTG_LOW_BAT_ICL,
+		chg->OTG_NORMAL_BAT_ICL);
+/* @bsp, 2018/07/26 enable stm6620 sheepmode */
+	chg->shipmode_en = of_get_named_gpio_flags(node,
+						"op,stm-ctrl-gpio", 0, &flags);
+	chg->vbus_ctrl = of_get_named_gpio_flags(node,
+					"op,vbus-ctrl-gpio", 0, &flags);
+	chg->plug_irq = of_get_named_gpio_flags(node,
+					"op,usb-check", 0, &flags);
+	/* read other settings */
+	OF_PROP_READ(node, "qcom,cutoff-voltage-with-charger",
+				smbchg_cutoff_volt_with_charger, rc, 1);
+	chg->chg_enabled = !(of_property_read_bool(node,
+						"qcom,charging-disabled"));
+
+	pr_info("T0=%d, T1=%d, T2=%d, T3=%d, T4=%d, T5=%d, T6=%d\n",
+		chg->BATT_TEMP_T0, chg->BATT_TEMP_T1, chg->BATT_TEMP_T2,
+		chg->BATT_TEMP_T3, chg->BATT_TEMP_T4, chg->BATT_TEMP_T5,
+		chg->BATT_TEMP_T6);
+	pr_info("BATT_TEMP_LITTLE_COLD=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_LITTLE_COLD],
+		chg->vbatmax[BATT_TEMP_LITTLE_COLD],
+		chg->vbatdet[BATT_TEMP_LITTLE_COLD]);
+	pr_info("BATT_TEMP_COOL=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_COOL],
+		chg->vbatmax[BATT_TEMP_COOL],
+		chg->vbatdet[BATT_TEMP_COOL]);
+	pr_info("BATT_TEMP_LITTLE_COOL=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_LITTLE_COOL],
+		chg->vbatmax[BATT_TEMP_LITTLE_COOL],
+		chg->vbatdet[BATT_TEMP_LITTLE_COOL]);
+	pr_info("BATT_TEMP_PRE_NORMAL=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_PRE_NORMAL],
+		chg->vbatmax[BATT_TEMP_PRE_NORMAL],
+		chg->vbatdet[BATT_TEMP_PRE_NORMAL]);
+	pr_info("BATT_TEMP_NORMAL=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_NORMAL],
+		chg->vbatmax[BATT_TEMP_NORMAL],
+		chg->vbatdet[BATT_TEMP_NORMAL]);
+	pr_info("BATT_TEMP_WARM=%d, %d, %d\n",
+		chg->ibatmax[BATT_TEMP_WARM],
+		chg->vbatmax[BATT_TEMP_WARM],
+		chg->vbatdet[BATT_TEMP_WARM]);
+	pr_info("cutoff_volt_with_charger=%d, disable-pd=%d\n",
+		smbchg_cutoff_volt_with_charger, *chg->pd_disabled);
+
+	/* disable step_chg */
+	chg->step_chg_enabled = false;
 
 	chg->sw_jeita_enabled = of_property_read_bool(node,
 				"qcom,sw-jeita-enable");
@@ -445,9 +670,28 @@ static int smb5_parse_dt(struct smb5 *chip)
 	if (rc < 0)
 		chg->otg_delay_ms = OTG_DEFAULT_DEGLITCH_TIME_MS;
 
+	rc = of_property_match_string(node, "io-channel-names",
+			"gpio1_voltage");
+	if (rc >= 0) {
+		chg->iio.op_connector_temp_chan = iio_channel_get(chg->dev,
+				"gpio1_voltage");
+		if (IS_ERR(chg->iio.op_connector_temp_chan)) {
+			rc = PTR_ERR(chg->iio.op_connector_temp_chan);
+			if (rc != -EPROBE_DEFER)
+				dev_err(chg->dev,
+				"op_connector_temp_chan channel unavailable,%ld\n",
+				rc);
+			chg->iio.op_connector_temp_chan = NULL;
+			return rc;
+		}
+	}
+
+	chg->lpd_disabled = of_property_read_bool(node,
+				"qcom,lpd-disable");
 	chg->fcc_stepper_enable = of_property_read_bool(node,
 					"qcom,fcc-stepping-enable");
-
+	chg->low_voltage_charger = of_property_read_bool(node,
+					"op,low-voltage-charger");
 	chg->uusb_moisture_protection_enabled =
 				chg->uusb_moisture_protection_enabled &&
 				of_property_read_bool(node,
@@ -458,7 +702,7 @@ static int smb5_parse_dt(struct smb5 *chip)
 	if (rc < 0)
 		return rc;
 
-	if (!chg->iio.mid_chan) {
+	if (!chg->iio.mid_chan || chg->low_voltage_charger) {
 		rc = smblib_get_iio_channel(chg, "usb_in_voltage",
 				&chg->iio.usbin_v_chan);
 		if (rc < 0)
@@ -522,6 +766,9 @@ static enum power_supply_property smb5_usb_props[] = {
 	POWER_SUPPLY_PROP_TYPEC_MODE,
 	POWER_SUPPLY_PROP_TYPEC_POWER_ROLE,
 	POWER_SUPPLY_PROP_TYPEC_CC_ORIENTATION,
+	POWER_SUPPLY_PROP_OTG_SWITCH,
+	POWER_SUPPLY_PROP_HW_DETECT,
+	POWER_SUPPLY_PROP_OEM_TYPEC_CC_ORIENTATION,
 	POWER_SUPPLY_PROP_LOW_POWER,
 	POWER_SUPPLY_PROP_PD_ACTIVE,
 	POWER_SUPPLY_PROP_INPUT_CURRENT_SETTLED,
@@ -561,13 +808,18 @@ static int smb5_usb_get_prop(struct power_supply *psy,
 			break;
 
 		if (((chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_DEFAULT) ||
+			(chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_MEDIUM) ||
+			(chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_HIGH) ||
 		   (chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB))
-			&& (chg->real_charger_type == POWER_SUPPLY_TYPE_USB))
+			&& (chg->real_charger_type == POWER_SUPPLY_TYPE_USB ||
+			chg->real_charger_type == POWER_SUPPLY_TYPE_USB_CDP))
 			val->intval = 0;
 		else
 			val->intval = 1;
 
-		if (chg->real_charger_type == POWER_SUPPLY_TYPE_UNKNOWN)
+/* add to fix wrong charging type when boot with pd cable connected */
+		if (chg->real_charger_type == POWER_SUPPLY_TYPE_UNKNOWN &&
+			!chg->pd_active)
 			val->intval = 0;
 		break;
 	case POWER_SUPPLY_PROP_VOLTAGE_MAX:
@@ -594,6 +846,13 @@ static int smb5_usb_get_prop(struct power_supply *psy,
 		else
 			val->intval = chg->typec_mode;
 		break;
+	case POWER_SUPPLY_PROP_OTG_SWITCH:
+		val->intval = chg->otg_switch;
+		break;
+	case POWER_SUPPLY_PROP_HW_DETECT:
+		val->intval = chg->hw_detect;
+		break;
+
 	case POWER_SUPPLY_PROP_TYPEC_POWER_ROLE:
 		if (chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB)
 			val->intval = POWER_SUPPLY_TYPEC_PR_NONE;
@@ -601,6 +860,7 @@ static int smb5_usb_get_prop(struct power_supply *psy,
 			rc = smblib_get_prop_typec_power_role(chg, val);
 		break;
 	case POWER_SUPPLY_PROP_TYPEC_CC_ORIENTATION:
+	case POWER_SUPPLY_PROP_OEM_TYPEC_CC_ORIENTATION:
 		if (chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB)
 			val->intval = 0;
 		else
@@ -710,6 +970,10 @@ static int smb5_usb_set_prop(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_PD_CURRENT_MAX:
 		rc = smblib_set_prop_pd_current_max(chg, val);
 		break;
+	case POWER_SUPPLY_PROP_OTG_SWITCH:
+		rc = vote(chg->otg_toggle_votable, USER_VOTER,
+						val->intval, 0);
+		break;
 	case POWER_SUPPLY_PROP_TYPEC_POWER_ROLE:
 		rc = smblib_set_prop_typec_power_role(chg, val);
 		break;
@@ -761,6 +1025,7 @@ static int smb5_usb_prop_is_writeable(struct power_supply *psy,
 		enum power_supply_property psp)
 {
 	switch (psp) {
+	case POWER_SUPPLY_PROP_OTG_SWITCH:
 	case POWER_SUPPLY_PROP_CTM_CURRENT_MAX:
 	case POWER_SUPPLY_PROP_CONNECTOR_HEALTH:
 		return 1;
@@ -827,8 +1092,11 @@ static int smb5_usb_port_get_prop(struct power_supply *psy,
 			break;
 
 		if (((chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_DEFAULT) ||
+			(chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_MEDIUM) ||
+			(chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_HIGH) ||
 		   (chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB))
-			&& (chg->real_charger_type == POWER_SUPPLY_TYPE_USB))
+			&& (chg->real_charger_type == POWER_SUPPLY_TYPE_USB ||
+			chg->real_charger_type == POWER_SUPPLY_TYPE_USB_CDP))
 			val->intval = 1;
 		else
 			val->intval = 0;
@@ -1187,6 +1455,17 @@ static enum power_supply_property smb5_batt_props[] = {
 	POWER_SUPPLY_PROP_PRESENT,
 	POWER_SUPPLY_PROP_CHARGE_TYPE,
 	POWER_SUPPLY_PROP_CAPACITY,
+	POWER_SUPPLY_PROP_FASTCHG_IS_OK,
+	POWER_SUPPLY_PROP_CHARGE_NOW,
+	POWER_SUPPLY_PROP_CHG_PROTECT_STATUS,
+	POWER_SUPPLY_PROP_FASTCHG_STATUS,
+	POWER_SUPPLY_PROP_FASTCHG_STARTING,
+	POWER_SUPPLY_CUTOFF_VOLT_WITH_CHARGER,
+	POWER_SUPPLY_PROP_CHARGING_ENABLED,
+	POWER_SUPPLY_PROP_INPUT_CURRENT_MAX,
+	POWER_SUPPLY_PROP_IS_AGING_TEST,
+	POWER_SUPPLY_PROP_CONNECTER_TEMP,
+	POWER_SUPPLY_PROP_CONNECT_DISABLE,
 	POWER_SUPPLY_PROP_CHARGER_TEMP,
 	POWER_SUPPLY_PROP_CHARGER_TEMP_MAX,
 	POWER_SUPPLY_PROP_INPUT_CURRENT_LIMITED,
@@ -1226,7 +1505,10 @@ static int smb5_batt_get_prop(struct power_supply *psy,
 
 	switch (psp) {
 	case POWER_SUPPLY_PROP_STATUS:
-		rc = smblib_get_prop_batt_status(chg, val);
+		val->intval = get_prop_batt_status(chg);
+		break;
+	case POWER_SUPPLY_PROP_FASTCHG_IS_OK:
+		val->intval = get_prop_fastchg_is_ok(chg)?1:0;
 		break;
 	case POWER_SUPPLY_PROP_HEALTH:
 		rc = smblib_get_prop_batt_health(chg, val);
@@ -1243,6 +1525,36 @@ static int smb5_batt_get_prop(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_CAPACITY:
 		rc = smblib_get_prop_batt_capacity(chg, val);
 		break;
+	case POWER_SUPPLY_PROP_CHARGE_NOW:
+		rc = smblib_get_prop_usb_voltage_now(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_CHG_PROTECT_STATUS:
+		val->intval = get_prop_chg_protect_status(chg);
+		break;
+	case POWER_SUPPLY_PROP_FASTCHG_STATUS:
+		val->intval = get_prop_fastchg_status(chg);
+		break;
+	case POWER_SUPPLY_CUTOFF_VOLT_WITH_CHARGER:
+		val->intval = smbchg_cutoff_volt_with_charger;
+		break;
+	case POWER_SUPPLY_PROP_FASTCHG_STARTING:
+		val->intval = op_get_fastchg_ing(chg);
+		break;
+	case POWER_SUPPLY_PROP_CHARGING_ENABLED:
+		val->intval = chg->chg_enabled;
+		break;
+	case POWER_SUPPLY_PROP_INPUT_CURRENT_MAX:
+		rc = smblib_get_prop_input_current_limited(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_IS_AGING_TEST:
+		val->intval = chg->is_aging_test;
+		break;
+	case POWER_SUPPLY_PROP_CONNECTER_TEMP:
+		val->intval = chg->connecter_temp;
+		break;
+	case POWER_SUPPLY_PROP_CONNECT_DISABLE:
+		val->intval = chg->disconnect_vbus;
+		break;
 	case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
 		rc = smblib_get_prop_system_temp_level(chg, val);
 		break;
@@ -1279,8 +1591,6 @@ static int smb5_batt_get_prop(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_CURRENT_NOW:
 		rc = smblib_get_prop_from_bms(chg,
 				POWER_SUPPLY_PROP_CURRENT_NOW, val);
-		if (!rc)
-			val->intval *= (-1);
 		break;
 	case POWER_SUPPLY_PROP_CURRENT_QNOVO:
 		val->intval = get_client_vote_locked(chg->fcc_votable,
@@ -1294,7 +1604,7 @@ static int smb5_batt_get_prop(struct power_supply *psy,
 		rc = smblib_get_prop_batt_iterm(chg, val);
 		break;
 	case POWER_SUPPLY_PROP_TEMP:
-		rc = smblib_get_prop_from_bms(chg, POWER_SUPPLY_PROP_TEMP, val);
+		rc = smblib_get_prop_batt_temp(chg, val);
 		break;
 	case POWER_SUPPLY_PROP_TECHNOLOGY:
 		val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
@@ -1376,6 +1686,56 @@ static int smb5_batt_set_prop(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
 		rc = smblib_set_prop_system_temp_level(chg, val);
 		break;
+	case POWER_SUPPLY_PROP_CHECK_USB_UNPLUG:
+		if (chg->vbus_present && !chg->dash_present)
+			update_dash_unplug_status();
+		break;
+	case POWER_SUPPLY_PROP_SWITCH_DASH:
+		rc = check_allow_switch_dash(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_FASTCHG_IS_OK:
+		rc = 0;
+		break;
+	case POWER_SUPPLY_PROP_INPUT_CURRENT_MAX:
+		pr_info("set iusb %d mA\n", val->intval);
+		if (__debug_mask == PR_OP_DEBUG
+			|| val->intval == 2000000 || val->intval == 1700000
+			|| val->intval == 1500000 || val->intval == 1000000)
+		op_usb_icl_set(chg, val->intval);
+		break;
+	case POWER_SUPPLY_PROP_CONNECT_DISABLE:
+		op_disconnect_vbus(chg, (bool)val->intval);
+		break;
+	case POWER_SUPPLY_PROP_CHARGE_NOW:
+		rc = smblib_set_prop_chg_voltage(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_TEMP:
+		rc = smblib_set_prop_batt_temp(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_CHG_PROTECT_STATUS:
+		rc = smblib_set_prop_chg_protect_status(chg, val);
+		break;
+	case POWER_SUPPLY_PROP_NOTIFY_CHARGER_SET_PARAMETER:
+		rc = smblib_set_prop_charge_parameter_set(chg);
+		break;
+	case POWER_SUPPLY_PROP_CHARGING_ENABLED:
+		if (!val->intval) {
+			chg->dash_on = get_prop_fast_chg_started(chg);
+			if (chg->dash_on) {
+				switch_mode_to_normal();
+				op_set_fast_chg_allow(chg, false);
+			}
+		}
+		rc = vote(chg->usb_icl_votable, USER_VOTER,
+				!val->intval, 0);
+		rc = vote(chg->dc_suspend_votable, USER_VOTER,
+				!val->intval, 0);
+		chg->chg_enabled = (bool)val->intval;
+		break;
+	case POWER_SUPPLY_PROP_IS_AGING_TEST:
+		chg->is_aging_test = (bool)val->intval;
+		__debug_mask = PR_OP_DEBUG;
+		break;
 	case POWER_SUPPLY_PROP_CAPACITY:
 		rc = smblib_set_prop_batt_capacity(chg, val);
 		break;
@@ -1461,6 +1821,14 @@ static int smb5_batt_prop_is_writeable(struct power_supply *psy,
 	case POWER_SUPPLY_PROP_INPUT_SUSPEND:
 	case POWER_SUPPLY_PROP_SYSTEM_TEMP_LEVEL:
 	case POWER_SUPPLY_PROP_CAPACITY:
+	case POWER_SUPPLY_PROP_CHARGE_NOW:
+	case POWER_SUPPLY_PROP_TEMP:
+	case POWER_SUPPLY_PROP_CHG_PROTECT_STATUS:
+	case POWER_SUPPLY_PROP_CHARGING_ENABLED:
+	case POWER_SUPPLY_PROP_INPUT_CURRENT_MAX:
+	case POWER_SUPPLY_PROP_IS_AGING_TEST:
+	case POWER_SUPPLY_PROP_CONNECT_DISABLE:
+	case POWER_SUPPLY_PROP_FASTCHG_IS_OK:
 	case POWER_SUPPLY_PROP_PARALLEL_DISABLE:
 	case POWER_SUPPLY_PROP_DP_DM:
 	case POWER_SUPPLY_PROP_RERUN_AICL:
@@ -1597,6 +1965,7 @@ static int smb5_init_vconn_regulator(struct smb5 *chip)
 static int smb5_configure_typec(struct smb_charger *chg)
 {
 	int rc;
+	u8  stat, val;
 
 	smblib_apsd_enable(chg, true);
 	smblib_hvdcp_detect_enable(chg, false);
@@ -1610,24 +1979,64 @@ static int smb5_configure_typec(struct smb_charger *chg)
 		return rc;
 	}
 
+	/* add to fix huawei cable compatible issue */
+	rc = smblib_write(chg, DEBUG_ACCESS_SNK_CFG_REG, 0x7);
+	if (rc < 0) {
+		dev_err(chg->dev,
+			"Couldn't write DEBUG_ACCESS_SNK_CFG_REG rc=%d\n", rc);
+		return rc;
+	}
+
 	/* Use simple write to clear interrupts */
-	rc = smblib_write(chg, TYPE_C_INTERRUPT_EN_CFG_1_REG, 0);
+	/* For GCE-2351 issue Debug patch Set 0x155E[3]=1
+	 * TYPEC_CCOUT_DETACH_INT_EN
+	 */
+	rc = smblib_write(chg, TYPE_C_INTERRUPT_EN_CFG_1_REG,
+				TYPEC_CCOUT_DETACH_INT_EN_BIT);
 	if (rc < 0) {
 		dev_err(chg->dev,
 			"Couldn't configure Type-C interrupts rc=%d\n", rc);
 		return rc;
 	}
 
+	rc = smblib_read(chg, TYPE_C_INTERRUPT_EN_CFG_1_REG, &stat);
+	if (rc < 0) {
+		dev_err(chg->dev,
+			"Couldn't configure Type-C interrupts rc=%d\n", rc);
+	}
+	pr_info("TYPE_C_INTERRUPT_EN_CFG_1_REG:0x%02x=0x%02x\n",
+			TYPE_C_INTERRUPT_EN_CFG_1_REG, stat);
+
+	val = chg->lpd_disabled ? 0 : TYPEC_WATER_DETECTION_INT_EN_BIT;
+
 	/* Use simple write to enable only required interrupts */
 	rc = smblib_write(chg, TYPE_C_INTERRUPT_EN_CFG_2_REG,
 				TYPEC_SRC_BATT_HPWR_INT_EN_BIT |
-				TYPEC_WATER_DETECTION_INT_EN_BIT);
+				val);
 	if (rc < 0) {
 		dev_err(chg->dev,
 			"Couldn't configure Type-C interrupts rc=%d\n", rc);
 		return rc;
 	}
 
+	if (chg->otg_switch) {
+		rc = smblib_masked_write(chg, TYPE_C_MODE_CFG_REG,
+					EN_TRY_SNK_BIT, EN_TRY_SNK_BIT);
+		if (rc < 0) {
+			dev_err(chg->dev,
+				"Couldn't enable try.snk rc=%d\n", rc);
+			return rc;
+		}
+	} else {
+		rc = smblib_masked_write(chg, TYPE_C_MODE_CFG_REG,
+					EN_SNK_ONLY_BIT, EN_SNK_ONLY_BIT);
+		if (rc < 0) {
+			dev_err(chg->dev,
+				"Couldn't enable snk.only rc=%d\n", rc);
+			return rc;
+		}
+	}
+/*
 	rc = smblib_masked_write(chg, TYPE_C_MODE_CFG_REG,
 				EN_TRY_SNK_BIT, EN_TRY_SNK_BIT);
 	if (rc < 0) {
@@ -1638,6 +2047,7 @@ static int smb5_configure_typec(struct smb_charger *chg)
 		chg->typec_try_mode |= EN_TRY_SNK_BIT;
 	}
 
+*/
 	/* configure VCONN for software control */
 	rc = smblib_masked_write(chg, TYPE_C_VCONN_CONTROL_REG,
 				 VCONN_EN_SRC_BIT | VCONN_EN_VALUE_BIT,
@@ -1662,9 +2072,18 @@ static int smb5_configure_typec(struct smb_charger *chg)
 	rc = smblib_masked_write(chg, USBIN_LOAD_CFG_REG,
 		USBIN_IN_COLLAPSE_GF_SEL_MASK | USBIN_AICL_STEP_TIMING_SEL_MASK,
 		0);
-	if (rc < 0)
+	if (rc < 0) {
 		dev_err(chg->dev,
 			"Couldn't set USBIN_LOAD_CFG_REG rc=%d\n", rc);
+		return rc;
+	}
+
+	/* Set CC threshold to 1.6 V in source mode */
+	rc = smblib_masked_write(chg, TYPE_C_EXIT_STATE_CFG_REG,
+				SEL_SRC_UPPER_REF_BIT, SEL_SRC_UPPER_REF_BIT);
+	if (rc < 0)
+		dev_err(chg->dev,
+			"Couldn't configure CC threshold voltage rc=%d\n", rc);
 
 	return rc;
 }
@@ -1810,7 +2229,9 @@ static int smb5_init_hw(struct smb5 *chip)
 
 	smblib_get_charge_param(chg, &chg->param.usb_icl,
 				&chg->default_icl_ua);
-
+	pr_info("vbat_max=%d, ibat_max=%d, iusb_max=%d\n",
+		chg->batt_profile_fv_uv,
+		chg->batt_profile_fcc_ua, chip->dt.usb_icl_ua);
 	if (chg->charger_temp_max == -EINVAL) {
 		rc = smblib_get_thermal_threshold(chg,
 					DIE_REG_H_THRESHOLD_MSB_REG,
@@ -1921,30 +2342,20 @@ static int smb5_init_hw(struct smb5 *chip)
 		pr_err("Couldn't disable ICL override rc=%d\n", rc);
 		return rc;
 	}
-
+	vote(chg->usb_icl_votable,
+		DEFAULT_VOTER, !chg->chg_enabled, 0);
+	vote(chg->dc_suspend_votable,
+		DEFAULT_VOTER, !chg->chg_enabled, 0);
+	smblib_set_charge_param(chg, &chg->param.fcc,
+			chg->ibatmax[BATT_TEMP_NORMAL] * 1000);
+	smblib_set_charge_param(chg, &chg->param.fv,
+			chg->vbatmax[BATT_TEMP_NORMAL] * 1000);
 	/* set OTG current limit */
 	rc = smblib_set_charge_param(chg, &chg->param.otg_cl, chg->otg_cl_ua);
 	if (rc < 0) {
 		pr_err("Couldn't set otg current limit rc=%d\n", rc);
 		return rc;
 	}
-
-	/* vote 0mA on usb_icl for non battery platforms */
-	vote(chg->usb_icl_votable,
-		DEFAULT_VOTER, chip->dt.no_battery, 0);
-	vote(chg->dc_suspend_votable,
-		DEFAULT_VOTER, chip->dt.no_battery, 0);
-	vote(chg->fcc_votable, HW_LIMIT_VOTER,
-		chip->dt.batt_profile_fcc_ua > 0, chip->dt.batt_profile_fcc_ua);
-	vote(chg->fv_votable, HW_LIMIT_VOTER,
-		chip->dt.batt_profile_fv_uv > 0, chip->dt.batt_profile_fv_uv);
-	vote(chg->fcc_votable,
-		BATT_PROFILE_VOTER, chg->batt_profile_fcc_ua > 0,
-		chg->batt_profile_fcc_ua);
-	vote(chg->fv_votable,
-		BATT_PROFILE_VOTER, chg->batt_profile_fv_uv > 0,
-		chg->batt_profile_fv_uv);
-
 	/* Some h/w limit maximum supported ICL */
 	vote(chg->usb_icl_votable, HW_LIMIT_VOTER,
 			chg->hw_max_icl_ua > 0, chg->hw_max_icl_ua);
@@ -1956,6 +2367,17 @@ static int smb5_init_hw(struct smb5 *chip)
 			"Couldn't set dc_icl rc=%d\n", rc);
 		return rc;
 	}
+	/* disable HVDCP */
+	rc = smblib_masked_write(chg, USBIN_OPTIONS_1_CFG_REG,
+		HVDCP_EN_BIT, 0);
+	if (rc < 0)
+		dev_err(chg->dev, "Couldn't disable HVDCP rc=%d\n", rc);
+
+	/* aicl rerun time */
+	rc = smblib_masked_write(chg, AICL_RERUN_TIME_CFG_REG,
+		BIT(0)|BIT(1), 0);
+	if (rc < 0)
+		dev_err(chg->dev, "Couldn't set aicl rerunTimerc=%d\n", rc);
 
 	/* Disable DC Input missing poller function */
 	rc = smblib_masked_write(chg, DCIN_LOAD_CFG_REG,
@@ -2591,6 +3013,8 @@ static int smb5_request_interrupts(struct smb5 *chip)
 	}
 	if (chg->irq_info[USBIN_ICL_CHANGE_IRQ].irq)
 		chg->usb_icl_change_irq_enabled = true;
+	if (chg->irq_info[USBIN_ICL_CHANGE_IRQ].irq)
+		chg->init_irq_done = true;
 
 	/*
 	 * WDOG_SNARL_IRQ is required for SW Thermal Regulation WA only. In
@@ -2701,6 +3125,203 @@ static void smb5_create_debugfs(struct smb5 *chip)
 
 #endif
 
+#ifdef CONFIG_PROC_FS
+static ssize_t write_ship_mode(struct file *file, const char __user *buf,
+				   size_t count, loff_t *ppos)
+{
+
+	if (count) {
+		g_chip->ship_mode = true;
+		pr_err(" * * * XCB * * * write_ship_mode\n");
+	}
+	return count;
+}
+
+static const struct file_operations proc_ship_mode_operations = {
+	.write		= write_ship_mode,
+	.llseek		= noop_llseek,
+};
+#endif
+
+static int op_ship_mode_gpio_request(struct smb_charger *chip)
+{
+	int rc;
+
+	chip->pinctrl = devm_pinctrl_get(chip->dev);
+	if (IS_ERR_OR_NULL(chip->pinctrl)) {
+		dev_err(chip->dev,
+				"Unable to acquire pinctrl\n");
+		chip->pinctrl = NULL;
+		return -EINVAL;
+	}
+
+	chip->ship_mode_default =
+		pinctrl_lookup_state(chip->pinctrl, "op_ship_mode_default");
+	if (IS_ERR_OR_NULL(chip->ship_mode_default)) {
+		dev_err(chip->dev,
+				"Can not lookup ship_mode_default\n");
+		devm_pinctrl_put(chip->pinctrl);
+		chip->pinctrl = NULL;
+		return PTR_ERR(chip->ship_mode_default);
+	}
+
+	if (pinctrl_select_state(chip->pinctrl,
+				chip->ship_mode_default) < 0)
+		dev_err(chip->dev, "pinctrl set ship_mode_default fail\n");
+
+	if (gpio_is_valid(chip->shipmode_en)) {
+		rc = gpio_request(chip->shipmode_en, "stm6620_ctrl");
+		if (rc) {
+			pr_err("gpio_request failed for %d rc=%d\n",
+				chip->shipmode_en, rc);
+			return -EINVAL;
+		}
+		gpio_direction_output(chip->shipmode_en, 0);
+
+		pr_info("ship_mode_gpio_request default mode success!\n");
+	}
+
+	return 0;
+
+}
+
+void requset_vbus_ctrl_gpio(struct smb_charger *chg)
+{
+	int ret;
+
+	if (!gpio_is_valid(chg->vbus_ctrl))
+		return;
+	ret = gpio_request(chg->vbus_ctrl, "VbusCtrl");
+	if (ret)
+		pr_err("request failed,gpio:%d ret=%d\n", chg->vbus_ctrl, ret);
+}
+
+static int op_config_usb_temperature_adc(struct smb_charger *chip)
+{
+	if (IS_ERR_OR_NULL(chip->pinctrl)) {
+		chip->pinctrl = devm_pinctrl_get(chip->dev);
+		if (IS_ERR_OR_NULL(chip->pinctrl)) {
+			dev_err(chip->dev,
+					"Unable to acquire pinctrl\n");
+			chip->pinctrl = NULL;
+			return -EINVAL;
+		}
+	}
+
+	chip->usb_temperature_default =
+		pinctrl_lookup_state(chip->pinctrl, "op_usb_temp_adc_default");
+	if (IS_ERR_OR_NULL(chip->usb_temperature_default)) {
+		dev_err(chip->dev,
+				"Can not lookup op_usb_temp_adc_default\n");
+		devm_pinctrl_put(chip->pinctrl);
+		chip->pinctrl = NULL;
+		return PTR_ERR(chip->usb_temperature_default);
+	}
+
+	if (pinctrl_select_state(chip->pinctrl,
+				chip->usb_temperature_default) < 0)
+		dev_err(chip->dev, "pinctrl set op_usb_temp_adc_default fail\n");
+	return 0;
+}
+
+/*usb connector hw auto detection*/
+static irqreturn_t op_usb_plugin_irq_handler(int irq, void *dev_id)
+{
+	schedule_work(&g_chip->otg_switch_work);
+	return IRQ_HANDLED;
+}
+
+static void request_plug_irq(struct smb_charger *chip)
+{
+	int ret;
+
+	if (!gpio_is_valid(chip->plug_irq))
+		return;
+	ret = gpio_request(chip->plug_irq, "op_usb_plug");
+	if (ret) {
+		pr_err("request failed,gpio:%d ret=%d\n", chip->plug_irq, ret);
+		return;
+	}
+	gpio_direction_input(chip->plug_irq);
+	ret = request_irq(gpio_to_irq(chip->plug_irq),
+			op_usb_plugin_irq_handler,
+			IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
+			"op_usb_plug", chip);
+	if (ret < 0) {
+		pr_err("request usb_plug irq failed.\n");
+		return;
+	}
+	enable_irq_wake(gpio_to_irq(chip->plug_irq));
+	pr_info("request usb_plug irq success\n");
+	/*connect with usb cable when reboot, give a vote 1*/
+	if (!gpio_get_value(chip->plug_irq)) {
+		pr_info("%s:reboot time hw detect gpio low, vote 1\n",
+			__func__);
+		vote(chip->otg_toggle_votable, HW_DETECT_VOTER, 1, 0);
+		chip->hw_detect = 1;
+	}
+}
+
+static void check_factory_mode_disable_charge(struct smb_charger *chip)
+{
+	int boot_mode = get_boot_mode();
+	int rc;
+
+	if (boot_mode == MSM_BOOT_MODE__RF || boot_mode == MSM_BOOT_MODE__WLAN
+			|| boot_mode == MSM_BOOT_MODE__FACTORY) {
+		pr_info("RF/WLAN, suspending...\n");
+		rc = vote(chip->usb_icl_votable, USER_VOTER,
+				true, 0);
+		rc = vote(chip->dc_suspend_votable, USER_VOTER,
+				true, 0);
+	}
+}
+
+static int lpd_enable_set(const char *val, const struct kernel_param *kp)
+{
+	struct smb_charger *chg = g_chg;
+	unsigned long enable = 0;
+	int ret = 0;
+
+	ret = kstrtoul(val, 10, &enable);
+	if (ret)
+		return ret;
+
+	pr_err("Enable:%d\n", enable);
+
+	if (enable) {
+		__lpd_enable = 1;
+		/* lpd disabled by dts config*/
+		if (chg->lpd_disabled)
+			return 0;
+		/* enable water detection irq*/
+		ret = smblib_masked_write(chg, TYPE_C_INTERRUPT_EN_CFG_2_REG,
+					TYPEC_WATER_DETECTION_INT_EN_BIT,
+					TYPEC_WATER_DETECTION_INT_EN_BIT);
+		if (ret < 0) {
+			pr_err("Couldn't write TYPE_C_INTERRUPT_EN_CFG_2_REG rc=%d\n",
+				ret);
+			return ret;
+		}
+		pr_info("Enable water detection irq by user\n");
+	} else {
+		__lpd_enable = 0;
+		__lpd_result = 0;
+		/* disable water detection irq*/
+		ret = smblib_masked_write(chg, TYPE_C_INTERRUPT_EN_CFG_2_REG,
+					TYPEC_WATER_DETECTION_INT_EN_BIT,
+					0);
+		if (ret < 0) {
+			pr_err("Couldn't write TYPE_C_INTERRUPT_EN_CFG_2_REG rc=%d\n",
+				ret);
+			return ret;
+		}
+		pr_info("Disable water detection irq by user\n");
+	}
+
+	return 0;
+}
+
 static int smb5_show_charger_status(struct smb5 *chip)
 {
 	struct smb_charger *chg = &chip->chg;
@@ -2747,16 +3368,22 @@ static int smb5_probe(struct platform_device *pdev)
 	struct smb5 *chip;
 	struct smb_charger *chg;
 	int rc = 0;
+	struct msm_bus_scale_pdata *pdata;
+	union power_supply_propval val;
+	int usb_present;
 
 	chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL);
 	if (!chip)
 		return -ENOMEM;
 
 	chg = &chip->chg;
+	g_chip = chg;
 	chg->dev = &pdev->dev;
 	chg->debug_mask = &__debug_mask;
 	chg->pd_disabled = &__pd_disabled;
 	chg->weak_chg_icl_ua = &__weak_chg_icl_ua;
+	chg->lpd_enable = &__lpd_enable;
+	chg->lpd_result = &__lpd_result;
 	chg->mode = PARALLEL_MASTER;
 	chg->irq_info = smb5_irqs;
 	chg->die_health = -EINVAL;
@@ -2798,6 +3425,27 @@ static int smb5_probe(struct platform_device *pdev)
 	/* set driver data before resources request it */
 	platform_set_drvdata(pdev, chip);
 
+	op_charge_info_init(chg);
+	pdata = msm_bus_cl_get_pdata(pdev);
+	if (!pdata)
+		pr_err("GPIO** failed get_pdata client_id\n");
+	else
+		chg->bus_client = msm_bus_scale_register_client(pdata);
+
+	rc = smb5_init_vbus_regulator(chip);
+	if (rc < 0) {
+		pr_err("Couldn't initialize vbus regulator rc=%d\n",
+			rc);
+		goto cleanup;
+	}
+
+	rc = smb5_init_vconn_regulator(chip);
+	if (rc < 0) {
+		pr_err("Couldn't initialize vconn regulator rc=%d\n",
+				rc);
+		goto cleanup;
+	}
+
 	/* extcon registration */
 	chg->extcon = devm_extcon_dev_allocate(chg->dev, smblib_extcon_cable);
 	if (IS_ERR(chg->extcon)) {
@@ -2908,10 +3556,34 @@ static int smb5_probe(struct platform_device *pdev)
 		goto free_irq;
 	}
 
+#ifdef CONFIG_PROC_FS
+	if (!proc_create("ship_mode", 0644, NULL, &proc_ship_mode_operations))
+		pr_err("Failed to register proc interface\n");
+#endif
+	rc = smblib_get_prop_usb_present(chg, &val);
+	if (rc < 0) {
+		pr_err("Couldn't get usb present rc=%d\n", rc);
+		goto cleanup;
+	}
+	usb_present = val.intval;
+
+	if (usb_present) {
+		schedule_delayed_work(&chg->non_standard_charger_check_work,
+				msecs_to_jiffies(TIME_1000MS));
+		chg->boot_usb_present = true;
+	}
+	if (!usb_present && chg->vbus_present)
+		op_handle_usb_plugin(chg);
+
 	device_init_wakeup(chg->dev, true);
 
-	pr_info("QPNP SMB5 probed successfully\n");
+	op_ship_mode_gpio_request(chg);
+	requset_vbus_ctrl_gpio(chg);
+	op_config_usb_temperature_adc(chg);
+	request_plug_irq(chg);
+	check_factory_mode_disable_charge(chg);
 
+	pr_info("QPNP SMB5 probed successfully\n");
 	return rc;
 
 free_irq:
@@ -2938,11 +3610,43 @@ static int smb5_remove(struct platform_device *pdev)
 	return 0;
 }
 
+static void stm6620_enter_ship_mode(struct smb_charger *chg)
+{
+	int i;
+
+	for (i = 0; i < 5; i++) {
+		gpio_set_value(chg->shipmode_en, 1);
+		usleep_range(4000, 4001);
+		gpio_set_value(chg->shipmode_en, 0);
+		usleep_range(4000, 4001);
+	}
+}
+
 static void smb5_shutdown(struct platform_device *pdev)
 {
 	struct smb5 *chip = platform_get_drvdata(pdev);
 	struct smb_charger *chg = &chip->chg;
 
+#ifdef CONFIG_PROC_FS
+	pr_info("smbchg_shutdown\n");
+
+	if (chg->ship_mode) {
+		pr_info("smbchg_shutdown enter ship_mode\n");
+		if (gpio_is_valid(chg->shipmode_en)) {
+			vote(chg->usb_icl_votable,
+					DEFAULT_VOTER, true, 0);
+			stm6620_enter_ship_mode(chg);
+		} else {
+			smblib_masked_write(chg, SHIP_MODE_REG,
+			SHIP_MODE_EN_BIT, SHIP_MODE_EN_BIT);
+		}
+		msleep(1000);
+		pr_err("after 1s\n");
+		while (1)
+			;
+	}
+#endif
+
 	/* disable all interrupts */
 	smb5_disable_interrupts(chg);
 
diff --git a/drivers/power/supply/qcom/smb5-lib.c b/drivers/power/supply/qcom/smb5-lib.c
index eef4f1e99e08bbcf5adaa79980a8ed0543ddd7f6..82cfcf3009b1e4444245a9da02027976fd658f17 100644
--- a/drivers/power/supply/qcom/smb5-lib.c
+++ b/drivers/power/supply/qcom/smb5-lib.c
@@ -9,6 +9,10 @@
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
  */
+#define pr_fmt(fmt) "SMBLIB: %s: " fmt, __func__
+
+#define CONFIG_MSM_RDM_NOTIFY
+#undef CONFIG_FB
 
 #include <linux/device.h>
 #include <linux/regmap.h>
@@ -26,6 +30,67 @@
 #include "step-chg-jeita.h"
 #include "storm-watch.h"
 
+#include <linux/power/oem_external_fg.h>
+#include <linux/gpio.h>
+#include <linux/delay.h>
+#include <linux/input/qpnp-power-on.h>
+#include <linux/spmi.h>
+#if defined(CONFIG_FB)
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+#include <linux/msm_drm_notify.h>
+#include <linux/notifier.h>
+#endif /*CONFIG_FB*/
+#include <linux/moduleparam.h>
+#include <linux/msm-bus.h>
+#include "op_charge.h"
+#include <linux/oneplus/boot_mode.h>
+
+#define SOC_INVALID                   0x7E
+#define SOC_DATA_REG_0                0x88D
+#define SOC_FLAG_REG                  0x88E
+#define HEARTBEAT_INTERVAL_MS         6000
+#define CHG_TIMEOUT_COUNT             6000 /* 10hr */
+#define CHG_SOFT_OVP_MV               5800
+#define BATT_SOFT_OVP_MV              4500
+#define CHG_SOFT_UVP_MV               4300
+#define CHG_VOLTAGE_NORMAL            5000
+#define BATT_REMOVE_TEMP              -400
+#define BATT_TEMP_HYST                20
+#define DASH_VALID_TEMP_LOW_THRESHOLD	125
+#define DASH_VALID_TEMP_HIG_THRESHOLD	430
+
+struct smb_charger *g_chg;
+struct regmap *pm_regmap;
+
+static struct external_battery_gauge *fast_charger;
+static int op_charging_en(struct smb_charger *chg, bool en);
+static bool set_prop_fast_switch_to_normal_false(struct smb_charger *chg);
+
+static void op_battery_temp_region_set(struct smb_charger *chg,
+		enum temp_region_type batt_temp_region);
+static void set_usb_switch(struct smb_charger *chg, bool enable);
+static void op_handle_usb_removal(struct smb_charger *chg);
+static bool get_prop_fast_switch_to_normal(struct smb_charger *chg);
+static int get_prop_batt_temp(struct smb_charger *chg);
+static int get_prop_batt_capacity(struct smb_charger *chg);
+static int get_prop_batt_current_now(struct smb_charger *chg);
+static int get_prop_batt_voltage_now(struct smb_charger *chg);
+static int set_property_on_fg(struct smb_charger *chg,
+		enum power_supply_property prop, int val);
+static int set_dash_charger_present(int status);
+static enum temp_region_type
+		op_battery_temp_region_get(struct smb_charger *chg);
+static int get_prop_fg_capacity(struct smb_charger *chg);
+static int get_prop_fg_current_now(struct smb_charger *chg);
+static int get_prop_fg_voltage_now(struct smb_charger *chg);
+static void op_check_charger_collapse(struct smb_charger *chg);
+static int op_set_collapse_fet(struct smb_charger *chg, bool on);
+static int op_check_battery_temp(struct smb_charger *chg);
+static int get_usb_temp(struct smb_charger *chg);
+static void op_clean_dash_status(void);
+
 #define smblib_err(chg, fmt, ...)		\
 	pr_err("%s: %s: " fmt, chg->name,	\
 		__func__, ##__VA_ARGS__)	\
@@ -372,6 +437,48 @@ static void smblib_notify_usb_host(struct smb_charger *chg, bool enable)
 	extcon_set_state_sync(chg->extcon, EXTCON_USB_HOST, enable);
 }
 
+#define DEFAULT_SDP_MA		500
+#define DEFAULT_CDP_MA		1500
+#define DEFAULT_DCP_MA		1500
+#define DEFAULT_AGAING_CHG_MA		1200
+int op_rerun_apsd(struct smb_charger *chg)
+{
+	union power_supply_propval val;
+	int rc;
+
+	rc = smblib_get_prop_usb_present(chg, &val);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't get usb present rc = %d\n", rc);
+		return rc;
+	}
+
+	if (!val.intval)
+		return 0;
+		/* rerun APSD */
+		pr_info("OP Reruning APSD type\n");
+		chg->switch_on_fastchg = false;
+		rc = smblib_masked_write(chg, CMD_APSD_REG,
+					APSD_RERUN_BIT,
+					APSD_RERUN_BIT);
+		if (rc < 0) {
+			smblib_err(chg, "Couldn't rerun APSD rc = %d\n", rc);
+			return rc;
+		}
+	return 0;
+}
+
+static bool check_boot_mode_disabled_lpd(struct smb_charger *chip)
+{
+	int boot_mode = get_boot_mode();
+
+	if (boot_mode == MSM_BOOT_MODE__RF || boot_mode == MSM_BOOT_MODE__WLAN
+			|| boot_mode == MSM_BOOT_MODE__FACTORY) {
+		pr_err("RF/WLAN/FTM, for disabled lpd timer...\n");
+		return false;
+	}
+	return true;
+}
+
 /********************
  * REGISTER GETTERS *
  ********************/
@@ -514,7 +621,7 @@ static const struct apsd_result smblib_apsd_results[] = {
 	[FLOAT] = {
 		.name	= "FLOAT",
 		.bit	= FLOAT_CHARGER_BIT,
-		.pst	= POWER_SUPPLY_TYPE_USB_FLOAT
+		.pst	= POWER_SUPPLY_TYPE_USB_DCP
 	},
 	[HVDCP2] = {
 		.name	= "HVDCP2",
@@ -540,10 +647,10 @@ static const struct apsd_result *smblib_get_apsd_result(struct smb_charger *chg)
 		return result;
 	}
 	smblib_dbg(chg, PR_REGISTER, "APSD_STATUS = 0x%02x\n", apsd_stat);
-
-	if (!(apsd_stat & APSD_DTC_STATUS_DONE_BIT))
+	if (!(apsd_stat & APSD_DTC_STATUS_DONE_BIT)) {
+		pr_info("APSD_DTC_STATUS_DONE_BIT is 0\n");
 		return result;
-
+	}
 	rc = smblib_read(chg, APSD_RESULT_STATUS_REG, &stat);
 	if (rc < 0) {
 		smblib_err(chg, "Couldn't read APSD_RESULT_STATUS rc=%d\n",
@@ -704,6 +811,18 @@ int smblib_set_usb_suspend(struct smb_charger *chg, bool suspend)
 {
 	int rc = 0;
 	int irq = chg->irq_info[USBIN_ICL_CHANGE_IRQ].irq;
+	int boot_mode = get_boot_mode();
+	pr_info("suspend=%d\n", suspend);
+
+	if (!suspend) {
+		if (boot_mode == MSM_BOOT_MODE__RF
+			|| boot_mode == MSM_BOOT_MODE__WLAN
+			|| boot_mode == MSM_BOOT_MODE__FACTORY) {
+			pr_info("RF/WLAN, ingnore suspend=%d,keep charge disable!\n",
+				suspend);
+			return 0;
+		}
+	}
 
 	if (suspend && irq) {
 		if (chg->usb_icl_change_irq_enabled) {
@@ -718,6 +837,9 @@ int smblib_set_usb_suspend(struct smb_charger *chg, bool suspend)
 		smblib_err(chg, "Couldn't write %s to USBIN_SUSPEND_BIT rc=%d\n",
 			suspend ? "suspend" : "resume", rc);
 
+	if (!chg->init_irq_done)
+		return rc;
+
 	if (!suspend && irq) {
 		if (!chg->usb_icl_change_irq_enabled) {
 			enable_irq(irq);
@@ -731,6 +853,7 @@ int smblib_set_usb_suspend(struct smb_charger *chg, bool suspend)
 int smblib_set_dc_suspend(struct smb_charger *chg, bool suspend)
 {
 	int rc = 0;
+	pr_info("%d\n", suspend);
 
 	rc = smblib_masked_write(chg, DCIN_CMD_IL_REG, DCIN_SUSPEND_BIT,
 				 suspend ? DCIN_SUSPEND_BIT : 0);
@@ -919,17 +1042,14 @@ static const struct apsd_result *smblib_update_usb_type(struct smb_charger *chg)
 {
 	const struct apsd_result *apsd_result = smblib_get_apsd_result(chg);
 
-	/* if PD is active, APSD is disabled so won't have a valid result */
-	if (chg->pd_active) {
-		chg->real_charger_type = POWER_SUPPLY_TYPE_USB_PD;
+	if (chg->dash_on) {
+		chg->real_charger_type = POWER_SUPPLY_TYPE_DASH;
+		chg->usb_psy_desc.type = POWER_SUPPLY_TYPE_DASH;
 	} else {
-		/*
-		 * Update real charger type only if its not FLOAT
-		 * detected as as SDP
-		 */
-		if (!(apsd_result->pst == POWER_SUPPLY_TYPE_USB_FLOAT &&
-			chg->real_charger_type == POWER_SUPPLY_TYPE_USB))
-			chg->real_charger_type = apsd_result->pst;
+		chg->usb_psy_desc.type = apsd_result->pst;
+	/* if PD is active, APSD is disabled so won't have a valid result */
+		chg->real_charger_type = chg->pd_active ?
+				POWER_SUPPLY_TYPE_USB_PD : apsd_result->pst;
 	}
 
 	smblib_dbg(chg, PR_MISC, "APSD=%s PD=%d\n",
@@ -1171,7 +1291,6 @@ static int set_sdp_current(struct smb_charger *chg, int icl_ua)
 {
 	int rc;
 	u8 icl_options;
-	const struct apsd_result *apsd_result = smblib_get_apsd_result(chg);
 
 	/* power source is SDP */
 	switch (icl_ua) {
@@ -1195,21 +1314,6 @@ static int set_sdp_current(struct smb_charger *chg, int icl_ua)
 		return -EINVAL;
 	}
 
-	if (chg->real_charger_type == POWER_SUPPLY_TYPE_USB &&
-		apsd_result->pst == POWER_SUPPLY_TYPE_USB_FLOAT) {
-		/*
-		 * change the float charger configuration to SDP, if this
-		 * is the case of SDP being detected as FLOAT
-		 */
-		rc = smblib_masked_write(chg, USBIN_OPTIONS_2_CFG_REG,
-			FORCE_FLOAT_SDP_CFG_BIT, FORCE_FLOAT_SDP_CFG_BIT);
-		if (rc < 0) {
-			smblib_err(chg, "Couldn't set float ICL options rc=%d\n",
-						rc);
-			return rc;
-		}
-	}
-
 	rc = smblib_masked_write(chg, USBIN_ICL_OPTIONS_REG,
 			CFG_USB3P0_SEL_BIT | USB51_MODE_BIT, icl_options);
 	if (rc < 0) {
@@ -1226,6 +1330,62 @@ static int set_sdp_current(struct smb_charger *chg, int icl_ua)
 	return rc;
 }
 
+void op_bus_vote(int disable)
+{
+	int ret;
+
+	if (!g_chg)
+		return;
+
+	ret = msm_bus_scale_client_update_request(g_chg->bus_client, disable);
+
+	if (ret) {
+		pr_err("%s: failed: bus_client_handle=0x%x, vote=%d, err=%d\n",
+			__func__, g_chg->bus_client, disable, ret);
+	}
+	pr_info("enable =%d\n", disable);
+}
+
+int op_usb_icl_set(struct smb_charger *chg, int icl_ua)
+{
+	int rc = 0;
+	bool override;
+
+	pr_info("icl_ua=%d\n", icl_ua);
+
+	disable_irq_nosync(chg->irq_info[USBIN_ICL_CHANGE_IRQ].irq);
+	rc = smblib_set_charge_param(chg, &chg->param.usb_icl,
+			icl_ua);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't set HC ICL rc=%d\n", rc);
+		goto enable_icl_changed_interrupt;
+	}
+
+	/* determine if override needs to be enforced */
+	override = true;
+	/* enforce override */
+	rc = smblib_masked_write(chg, USBIN_ICL_OPTIONS_REG,
+		USBIN_MODE_CHG_BIT, override ? USBIN_MODE_CHG_BIT : 0);
+
+	rc = smblib_icl_override(chg, SW_OVERRIDE_HC_MODE);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't set ICL override rc=%d\n", rc);
+		goto enable_icl_changed_interrupt;
+	}
+
+	/* unsuspend after configuring current and override */
+	rc = smblib_set_usb_suspend(chg, false);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't resume input rc=%d\n", rc);
+		goto enable_icl_changed_interrupt;
+	}
+
+enable_icl_changed_interrupt:
+	enable_irq(chg->irq_info[USBIN_ICL_CHANGE_IRQ].irq);
+
+	return rc;
+}
+
 int smblib_set_icl_current(struct smb_charger *chg, int icl_ua)
 {
 	int rc = 0;
@@ -1233,6 +1393,8 @@ int smblib_set_icl_current(struct smb_charger *chg, int icl_ua)
 	/* suspend if 25mA or less is requested */
 	bool suspend = (icl_ua <= USBIN_25MA);
 
+	pr_info("icl_ua=%d\n", icl_ua);
+
 	if (chg->connector_type == POWER_SUPPLY_CONNECTOR_TYPEC) {
 		rc = smblib_masked_write(chg, USB_CMD_PULLDOWN_REG,
 				EN_PULLDOWN_USB_IN_BIT,
@@ -1255,6 +1417,13 @@ int smblib_set_icl_current(struct smb_charger *chg, int icl_ua)
 		&& (chg->typec_legacy
 		|| chg->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_DEFAULT
 		|| chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB)) {
+		if (chg->non_std_chg_present) {
+			rc = smblib_set_charge_param(chg, &chg->param.usb_icl,
+					icl_ua);
+			icl_override = HW_AUTO_MODE;
+		} else
+			rc = set_sdp_current(chg, icl_ua);
+
 		rc = set_sdp_current(chg, icl_ua);
 		if (rc < 0) {
 			smblib_err(chg, "Couldn't set SDP ICL rc=%d\n", rc);
@@ -1455,11 +1624,32 @@ static int smblib_dc_suspend_vote_callback(struct votable *votable, void *data,
 	return smblib_set_dc_suspend(chg, (bool)suspend);
 }
 
+/*usb connector hw auto detection*/
+static int smblib_otg_toggle_vote_callback(struct votable *votable,
+			void *data, int value, const char *client)
+{
+	struct smb_charger *chg = data;
+	int rc = 0;
+
+	if (value < 0)
+		value = 0;
+
+	rc = op_set_prop_otg_switch(chg, (bool)value);
+	if (rc < 0) {
+		smblib_err(chg, "Can not set otg switch,value=%d, rc=%d\n",
+			value, rc);
+		return rc;
+	}
+
+	return rc;
+}
+
 static int smblib_awake_vote_callback(struct votable *votable, void *data,
 			int awake, const char *client)
 {
 	struct smb_charger *chg = data;
 
+	pr_info("set awake=%d\n", awake);
 	if (awake)
 		pm_stay_awake(chg->dev);
 	else
@@ -1474,6 +1664,7 @@ static int smblib_chg_disable_vote_callback(struct votable *votable, void *data,
 	struct smb_charger *chg = data;
 	int rc;
 
+	pr_err("set chg_disable=%d\n", chg_disable);
 	rc = smblib_masked_write(chg, CHARGING_ENABLE_CMD_REG,
 				 CHARGING_ENABLE_CMD_BIT,
 				 chg_disable ? 0 : CHARGING_ENABLE_CMD_BIT);
@@ -1820,9 +2011,8 @@ int smblib_get_prop_batt_charge_type(struct smb_charger *chg,
 int smblib_get_prop_batt_health(struct smb_charger *chg,
 				union power_supply_propval *val)
 {
-	union power_supply_propval pval;
 	int rc;
-	int effective_fv_uv;
+
 	u8 stat;
 
 	rc = smblib_read(chg, BATTERY_CHARGER_STATUS_2_REG, &stat);
@@ -1835,21 +2025,7 @@ int smblib_get_prop_batt_health(struct smb_charger *chg,
 		   stat);
 
 	if (stat & CHARGER_ERROR_STATUS_BAT_OV_BIT) {
-		rc = smblib_get_prop_from_bms(chg,
-				POWER_SUPPLY_PROP_VOLTAGE_NOW, &pval);
-		if (!rc) {
-			/*
-			 * If Vbatt is within 40mV above Vfloat, then don't
-			 * treat it as overvoltage.
-			 */
-			effective_fv_uv = get_effective_result(chg->fv_votable);
-			if (pval.intval >= effective_fv_uv + 40000) {
-				val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
-				smblib_err(chg, "battery over-voltage vbat_fg = %duV, fv = %duV\n",
-						pval.intval, effective_fv_uv);
-				goto done;
-			}
-		}
+		val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
 	}
 
 	rc = smblib_read(chg, BATTERY_CHARGER_STATUS_7_REG, &stat);
@@ -1869,7 +2045,6 @@ int smblib_get_prop_batt_health(struct smb_charger *chg,
 	else
 		val->intval = POWER_SUPPLY_HEALTH_GOOD;
 
-done:
 	return rc;
 }
 
@@ -1946,6 +2121,24 @@ int smblib_get_prop_batt_iterm(struct smb_charger *chg,
 	return rc;
 }
 
+int smblib_get_prop_batt_temp(struct smb_charger *chg,
+					union power_supply_propval *val)
+{
+	int rc;
+
+	if (!chg->bms_psy)
+		return -EINVAL;
+
+	if (chg->use_fake_temp) {
+		val->intval = chg->fake_temp;
+		return 0;
+	}
+
+	rc = power_supply_get_property(chg->bms_psy,
+				POWER_SUPPLY_PROP_TEMP, val);
+	return rc;
+}
+
 int smblib_get_prop_batt_charge_done(struct smb_charger *chg,
 					union power_supply_propval *val)
 {
@@ -1992,6 +2185,94 @@ int smblib_set_prop_input_suspend(struct smb_charger *chg,
 	return rc;
 }
 
+int op_set_prop_otg_switch(struct smb_charger *chg,
+				  bool enable)
+{
+	int rc = 0;
+	u8 power_role;
+	u8 ctrl = 0;
+	bool pre_otg_switch;
+	int i = 0;
+
+	pre_otg_switch = chg->otg_switch;
+	chg->otg_switch = enable;
+
+	if (chg->otg_switch == pre_otg_switch)
+		return rc;
+
+	pr_info("set otg_switch=%d\n", chg->otg_switch);
+	if (chg->otg_switch)
+		power_role = EN_TRY_SNK_BIT;
+	else
+		power_role = EN_SNK_ONLY_BIT;
+
+	for (i = 0; i < 10; i++) {
+		rc = smblib_masked_write(chg,
+					TYPE_C_MODE_CFG_REG,
+					TYPEC_POWER_ROLE_CMD_MASK, power_role);
+		if (rc < 0) {
+			smblib_err(chg, "Couldn't write 0x%02x to 0x1544 rc=%d\n",
+				power_role, rc);
+			return rc;
+		}
+		usleep_range(30000, 31000);
+		ctrl = 0;
+		rc = smblib_read(chg,
+			TYPE_C_MODE_CFG_REG, &ctrl);
+		if (rc < 0) {
+			smblib_err(chg, "Couldn't read err=%d\n", rc);
+			return rc;
+		}
+		if ((power_role == EN_TRY_SNK_BIT) && (ctrl & EN_TRY_SNK_BIT))
+			break;
+		if ((power_role == EN_SNK_ONLY_BIT) && (ctrl & EN_SNK_ONLY_BIT))
+			break;
+	}
+	pr_info("retry time = %d,ctrl = %d\n", i, ctrl);
+	if (i == 10)
+		pr_err("retry time over\n");
+
+	return rc;
+
+}
+
+int smblib_set_prop_chg_voltage(struct smb_charger *chg,
+				  const union power_supply_propval *val)
+{
+	chg->fake_chgvol = val->intval;
+	chg->use_fake_chgvol = true;
+	power_supply_changed(chg->batt_psy);
+
+	return 0;
+}
+
+int smblib_set_prop_batt_temp(struct smb_charger *chg,
+				  const union power_supply_propval *val)
+{
+	chg->fake_temp = val->intval;
+	chg->use_fake_temp = true;
+	power_supply_changed(chg->batt_psy);
+
+	return 0;
+}
+
+int smblib_set_prop_chg_protect_status(struct smb_charger *chg,
+				  const union power_supply_propval *val)
+{
+	chg->fake_protect_sts = val->intval;
+	chg->use_fake_protect_sts = true;
+	power_supply_changed(chg->batt_psy);
+
+	return 0;
+}
+
+int smblib_set_prop_charge_parameter_set(struct smb_charger *chg)
+{
+	chg->is_power_changed = true;
+	op_check_battery_temp(chg);
+	return 0;
+}
+
 int smblib_set_prop_batt_capacity(struct smb_charger *chg,
 				  const union power_supply_propval *val)
 {
@@ -2086,6 +2367,9 @@ int smblib_rerun_aicl(struct smb_charger *chg)
 		return rc;
 
 	smblib_dbg(chg, PR_MISC, "re-running AICL\n");
+	rc = smblib_masked_write(chg, USBIN_AICL_OPTIONS_CFG_REG,
+				USBIN_AICL_PERIODIC_RERUN_EN_BIT,
+				USBIN_AICL_PERIODIC_RERUN_EN_BIT);
 
 	rc = smblib_masked_write(chg, AICL_CMD_REG, RERUN_AICL_BIT,
 				RERUN_AICL_BIT);
@@ -2778,6 +3062,10 @@ int smblib_get_prop_usb_online(struct smb_charger *chg,
 		return rc;
 	}
 
+	if (chg->vbus_present) {
+		val->intval = true;
+		return rc;
+	}
 	if (is_client_vote_enabled(chg->usb_icl_votable,
 					CHG_TERMINATION_VOTER)) {
 		rc = smblib_get_prop_usb_present(chg, val);
@@ -2847,7 +3135,7 @@ static int smblib_estimate_adaptor_voltage(struct smb_charger *chg,
 		val->intval = MICRO_5V;
 		break;
 	}
-
+	val->intval = val->intval / 1000;
 	return 0;
 }
 
@@ -2870,7 +3158,8 @@ static int smblib_read_mid_voltage_chan(struct smb_charger *chg,
 	 * Figure out voltage from registers and calculations.
 	 */
 	if (val->intval < 1000000)
-		return smblib_estimate_adaptor_voltage(chg, val);
+		smblib_estimate_adaptor_voltage(chg, val);
+	val->intval = val->intval / 1000;
 
 	return 0;
 }
@@ -2888,6 +3177,14 @@ static int smblib_read_usbin_voltage_chan(struct smb_charger *chg,
 		smblib_err(chg, "Couldn't read USBIN channel rc=%d\n", rc);
 		return rc;
 	}
+	val->intval = val->intval / 1000;
+/*
+	rc = iio_read_channel_processed(chg->iio.usbin_v_chan, &val->intval);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read USBIN channel rc=%d\n", rc);
+		return rc;
+	}
+*/
 
 	return 0;
 }
@@ -2915,7 +3212,7 @@ int smblib_get_prop_usb_voltage_now(struct smb_charger *chg,
 	 * to occur randomly in the USBIN channel, particularly at high
 	 * voltages.
 	 */
-	if (chg->smb_version == PM8150B_SUBTYPE)
+	if (chg->smb_version == PM8150B_SUBTYPE && !chg->low_voltage_charger)
 		return smblib_read_mid_voltage_chan(chg, val);
 	else
 		return smblib_read_usbin_voltage_chan(chg, val);
@@ -2952,8 +3249,12 @@ bool smblib_rsbux_low(struct smb_charger *chg, int r_thr)
 		goto cleanup;
 	}
 
+	pr_info("r_sbu1:(%d)uv, r_thr:(%d)uv\n", r_sbu1, r_thr);
+
 	if (r_sbu1 < r_thr) {
 		ret = true;
+		*chg->lpd_result = 1;
+		pr_info("sbux:__lpd_result(%d)\n", __lpd_result);
 		goto cleanup;
 	}
 
@@ -2970,8 +3271,13 @@ bool smblib_rsbux_low(struct smb_charger *chg, int r_thr)
 		goto cleanup;
 	}
 
-	if (r_sbu2 < r_thr)
+	pr_info("r_sbu1:(%d)uv, r_thr:(%d)uv\n", r_sbu1, r_thr);
+
+	if (r_sbu2 < r_thr) {
 		ret = true;
+		*chg->lpd_result = 1;
+		pr_info("sbux:__lpd_result(%d)\n", __lpd_result);
+	}
 cleanup:
 	/* enable crude sensors */
 	rc = smblib_masked_write(chg, TYPE_C_CRUDE_SENSOR_CFG_REG,
@@ -3064,6 +3370,8 @@ static int smblib_get_prop_ufp_mode(struct smb_charger *chg)
 
 	switch (stat & DETECTED_SRC_TYPE_MASK) {
 	case SNK_RP_STD_BIT:
+	/* add to fix huawei cable compatible issue */
+	case SNK_RP_RP_BIT:
 		return POWER_SUPPLY_TYPEC_SOURCE_DEFAULT;
 	case SNK_RP_1P5_BIT:
 		return POWER_SUPPLY_TYPEC_SOURCE_MEDIUM;
@@ -3096,6 +3404,7 @@ static int smblib_get_prop_dfp_mode(struct smb_charger *chg)
 
 	switch (stat & DETECTED_SNK_TYPE_MASK) {
 	case AUDIO_ACCESS_RA_RA_BIT:
+		chg->is_audio_adapter = true;
 		return POWER_SUPPLY_TYPEC_SINK_AUDIO_ADAPTER;
 	case SRC_DEBUG_ACCESS_BIT:
 		return POWER_SUPPLY_TYPEC_SINK_DEBUG_ACCESSORY;
@@ -3410,17 +3719,23 @@ int smblib_get_prop_connector_health(struct smb_charger *chg)
 #define SDP_CURRENT_UA			500000
 #define CDP_CURRENT_UA			1500000
 #define DCP_CURRENT_UA			1500000
+#define FLOAT_CURRENT_UA		1500000
 #define HVDCP_CURRENT_UA		3000000
 #define TYPEC_DEFAULT_CURRENT_UA	900000
 #define TYPEC_MEDIUM_CURRENT_UA		1500000
 #define TYPEC_HIGH_CURRENT_UA		3000000
+#define PD_PANELON_CURRENT_UA		2000000
 static int get_rp_based_dcp_current(struct smb_charger *chg, int typec_mode)
 {
 	int rp_ua;
 
 	switch (typec_mode) {
 	case POWER_SUPPLY_TYPEC_SOURCE_HIGH:
-		rp_ua = TYPEC_HIGH_CURRENT_UA;
+		/* add to set pd charging current 2.0A when panel on */
+		if (chg->oem_lcd_is_on)
+			rp_ua = PD_PANELON_CURRENT_UA;
+		else
+			rp_ua = TYPEC_HIGH_CURRENT_UA;
 		break;
 	case POWER_SUPPLY_TYPEC_SOURCE_MEDIUM:
 	case POWER_SUPPLY_TYPEC_SOURCE_DEFAULT:
@@ -3446,80 +3761,37 @@ int smblib_set_prop_pd_current_max(struct smb_charger *chg,
 	else
 		rc = -EPERM;
 
+	/* add to set pd charging current 2.0A when panel on */
+	if (chg->oem_lcd_is_on)
+		rc = vote(chg->usb_icl_votable,
+			SW_ICL_MAX_VOTER, true, PD_PANELON_CURRENT_UA);
+
 	return rc;
 }
 
 static int smblib_handle_usb_current(struct smb_charger *chg,
 					int usb_current)
 {
-	int rc = 0, rp_ua, typec_mode;
-
-	if (chg->real_charger_type == POWER_SUPPLY_TYPE_USB_FLOAT) {
-		if (usb_current == -ETIMEDOUT) {
-			if ((chg->float_cfg & FLOAT_OPTIONS_MASK)
-						== FORCE_FLOAT_SDP_CFG_BIT) {
-				/*
-				 * Confiugure USB500 mode if Float charger is
-				 * configured for SDP mode.
-				 */
-				rc = set_sdp_current(chg, USBIN_500MA);
-				if (rc < 0)
-					smblib_err(chg,
-						"Couldn't set SDP ICL rc=%d\n",
-						rc);
-
-				return rc;
-			}
+	int rc;
 
-			if (chg->connector_type ==
-					POWER_SUPPLY_CONNECTOR_TYPEC) {
-				/*
-				 * Valid FLOAT charger, report the current
-				 * based of Rp.
-				 */
-				typec_mode = smblib_get_prop_typec_mode(chg);
-				rp_ua = get_rp_based_dcp_current(chg,
-								typec_mode);
-				rc = vote(chg->usb_icl_votable,
-						SW_ICL_MAX_VOTER, true, rp_ua);
-				if (rc < 0)
-					return rc;
-			} else {
-				rc = vote(chg->usb_icl_votable,
-					SW_ICL_MAX_VOTER, true, DCP_CURRENT_UA);
-				if (rc < 0)
-					return rc;
-			}
-		} else {
-			/*
-			 * FLOAT charger detected as SDP by USB driver,
-			 * charge with the requested current and update the
-			 * real_charger_type
-			 */
-			chg->real_charger_type = POWER_SUPPLY_TYPE_USB;
-			rc = vote(chg->usb_icl_votable, USB_PSY_VOTER,
-						true, usb_current);
-			if (rc < 0)
-				return rc;
-			rc = vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER,
-							false, 0);
-			if (rc < 0)
-				return rc;
-		}
-	} else {
-		rc = vote(chg->usb_icl_votable, USB_PSY_VOTER,
-					true, usb_current);
-		if (rc < 0) {
-			pr_err("Couldn't vote ICL USB_PSY_VOTER rc=%d\n", rc);
-			return rc;
-		}
+	/*
+	 * USB driver will set icl the value -ETIMEDOUT in case of
+	 * float charger. Fixed in PM8150B and no longer needed.
+	 * Simply ignore.
+	 */
+	if (usb_current == -ETIMEDOUT)
+		return 0;
 
-		rc = vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, false, 0);
-		if (rc < 0) {
-			pr_err("Couldn't remove SW_ICL_MAX vote rc=%d\n", rc);
-			return rc;
-		}
+	rc = vote(chg->usb_icl_votable, USB_PSY_VOTER, true, usb_current);
+	if (rc < 0) {
+		pr_err("Couldn't vote ICL USB_PSY_VOTER rc=%d\n", rc);
+		return rc;
+	}
 
+	rc = vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, false, 0);
+	if (rc < 0) {
+		pr_err("Couldn't remove SW_ICL_MAX vote rc=%d\n", rc);
+		return rc;
 	}
 
 	return 0;
@@ -3531,6 +3803,7 @@ int smblib_set_prop_sdp_current_max(struct smb_charger *chg,
 	union power_supply_propval pval;
 	int rc = 0;
 
+	pr_err("set usb current_max=%d\n", val->intval);
 	if (!chg->pd_active) {
 		rc = smblib_get_prop_usb_present(chg, &pval);
 		if (rc < 0) {
@@ -3554,7 +3827,7 @@ int smblib_set_prop_sdp_current_max(struct smb_charger *chg,
 }
 
 int smblib_set_prop_boost_current(struct smb_charger *chg,
-					const union power_supply_propval *val)
+				    const union power_supply_propval *val)
 {
 	int rc = 0;
 
@@ -3597,6 +3870,8 @@ int smblib_set_prop_typec_power_role(struct smb_charger *chg,
 		smblib_err(chg, "power role %d not supported\n", val->intval);
 		return -EINVAL;
 	}
+	if (!chg->otg_switch)
+		power_role = EN_SNK_ONLY_BIT;
 
 	rc = smblib_masked_write(chg, TYPE_C_MODE_CFG_REG,
 				TYPEC_POWER_ROLE_CMD_MASK | TYPEC_TRY_MODE_MASK,
@@ -3707,6 +3982,12 @@ int smblib_set_prop_pd_active(struct smb_charger *chg,
 		vote(chg->usb_icl_votable, USB_PSY_VOTER, false, 0);
 		vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, false, 0);
 
+		/*
+		 * add to fix wrong charging current when boot with
+		 * pd cable connected, clear apsd current result.
+		 */
+		vote(chg->usb_icl_votable, DCP_VOTER, false, 0);
+
 		/*
 		 * For PPS, Charge Pump is preferred over parallel charger if
 		 * present.
@@ -4107,6 +4388,20 @@ irqreturn_t chg_state_change_irq_handler(int irq, void *data)
 	}
 
 	stat = stat & BATTERY_CHARGER_STATUS_MASK;
+	if (stat == TERMINATE_CHARGE) {
+		/* charge done, disable charge in software also */
+		chg->chg_done = true;
+		pr_info("TERMINATE_CHARGE: chg_done: CAP=%d (Q:%d),\
+			VBAT=%d (Q:%d), IBAT=%d (Q:%d), BAT_TEMP=%d\n",
+			get_prop_batt_capacity(chg),
+			get_prop_fg_capacity(chg),
+			get_prop_batt_voltage_now(chg) / 1000,
+			get_prop_fg_voltage_now(chg) / 1000,
+			get_prop_batt_current_now(chg) / 1000,
+			get_prop_fg_current_now(chg) / 1000,
+			get_prop_batt_temp(chg));
+		op_charging_en(chg, false);
+	}
 
 	if (chg->wa_flags & CHG_TERMINATION_WA)
 		smblib_eval_chg_termination(chg, stat);
@@ -4155,12 +4450,18 @@ irqreturn_t usbin_uv_irq_handler(int irq, void *data)
 	int rc;
 	u8 stat = 0, max_pulses = 0;
 
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_err("return directly because dash is online\n");
+		return IRQ_HANDLED;
+	}
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
 	if (!chg->irq_info[SWITCHER_POWER_OK_IRQ].irq_data)
 		return IRQ_HANDLED;
 
 	wdata = &chg->irq_info[SWITCHER_POWER_OK_IRQ].irq_data->storm_data;
 	reset_storm_count(wdata);
+	smblib_err(chg, "DEBUG: RESET STORM COUNT FOR POWER_OK\n");
 
 	/* Workaround for non-QC2.0-compliant chargers follows */
 	if (!chg->qc2_unsupported_voltage &&
@@ -4214,6 +4515,39 @@ irqreturn_t usbin_uv_irq_handler(int irq, void *data)
 	return IRQ_HANDLED;
 }
 
+char dump_val[2048];
+static inline void op_dump_reg(struct smb_charger *chip,
+	u16 addr_start, u16 addr_end)
+{
+	u8 reg = 0;
+	u16 addr;
+	char reg_val[19];
+	int rc;
+
+	memset(dump_val, 0, sizeof(dump_val));
+	for (addr = addr_start; addr <= addr_end; addr++) {
+		memset(reg_val, 0, sizeof(reg_val));
+		rc = smblib_read(chip, addr, &reg);
+		if (rc < 0)
+			smblib_err(chip, "op_dump_reg  read error rc=%d\n",
+					rc);
+		scnprintf(reg_val,
+			sizeof(reg_val), "%x=%0x;", addr, reg);
+		strlcat(dump_val, reg_val, sizeof(dump_val));
+	}
+	 pr_info("%s\n", dump_val);
+}
+
+static void op_dump_regs(struct smb_charger *chip)
+{
+	u16 addr, count;
+
+	count = 0x80;
+	for (addr = 0x1000; addr <= 0x1700; addr += count)
+		op_dump_reg(chip, addr, (addr + count));
+}
+
+
 #define USB_WEAK_INPUT_UA	1400000
 #define ICL_CHANGE_DELAY_MS	1000
 irqreturn_t icl_change_irq_handler(int irq, void *data)
@@ -4267,6 +4601,15 @@ void smblib_usb_plugin_hard_reset_locked(struct smb_charger *chg)
 	struct smb_irq_data *data;
 	struct storm_watch *wdata;
 
+	bool last_vbus_present;
+
+	last_vbus_present = chg->vbus_present;
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_err("return directly because dash is online\n");
+		return;
+	}
+
 	rc = smblib_read(chg, USBIN_BASE + INT_RT_STS_OFFSET, &stat);
 	if (rc < 0) {
 		smblib_err(chg, "Couldn't read USB_INT_RT_STS rc=%d\n", rc);
@@ -4274,11 +4617,24 @@ void smblib_usb_plugin_hard_reset_locked(struct smb_charger *chg)
 	}
 
 	vbus_rising = (bool)(stat & USBIN_PLUGIN_RT_STS_BIT);
-
+	chg->vbus_present = vbus_rising;
+	if (last_vbus_present != chg->vbus_present) {
+		if (chg->vbus_present) {
+			pr_info("acquire chg_wake_lock\n");
+			__pm_stay_awake(&chg->chg_wake_lock);
+		} else {
+			pr_info("release chg_wake_lock\n");
+			__pm_relax(&chg->chg_wake_lock);
+		}
+	}
 	if (vbus_rising) {
 		/* Remove FCC_STEPPER 1.5A init vote to allow FCC ramp up */
 		if (chg->fcc_stepper_enable)
 			vote(chg->fcc_votable, FCC_STEPPER_VOTER, false, 0);
+		/* add to fix some pd temp not update issue */
+		if (gpio_is_valid(chg->vbus_ctrl))
+			schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(200));
 	} else {
 		if (chg->wa_flags & BOOST_BACK_WA) {
 			data = chg->irq_info[SWITCHER_POWER_OK_IRQ].irq_data;
@@ -4297,6 +4653,11 @@ void smblib_usb_plugin_hard_reset_locked(struct smb_charger *chg)
 		if (chg->fcc_stepper_enable)
 			vote(chg->fcc_votable, FCC_STEPPER_VOTER,
 							true, 1500000);
+		rc = smblib_request_dpdm(chg, false);
+		if (rc < 0)
+			smblib_err(chg, "Couldn't disable DPDM rc=%d\n", rc);
+		if (last_vbus_present != chg->vbus_present)
+			op_handle_usb_removal(chg);
 	}
 
 	power_supply_changed(chg->usb_psy);
@@ -4313,6 +4674,16 @@ void smblib_usb_plugin_locked(struct smb_charger *chg)
 	struct smb_irq_data *data;
 	struct storm_watch *wdata;
 
+	union power_supply_propval vbus_val;
+	bool last_vbus_present;
+
+	last_vbus_present = chg->vbus_present;
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_err("return directly because dash is online\n");
+		return;
+	}
+
 	rc = smblib_read(chg, USBIN_BASE + INT_RT_STS_OFFSET, &stat);
 	if (rc < 0) {
 		smblib_err(chg, "Couldn't read USB_INT_RT_STS rc=%d\n", rc);
@@ -4323,11 +4694,31 @@ void smblib_usb_plugin_locked(struct smb_charger *chg)
 	smblib_set_opt_switcher_freq(chg, vbus_rising ? chg->chg_freq.freq_5V :
 						chg->chg_freq.freq_removal);
 
+	chg->vbus_present = vbus_rising;
+	if (last_vbus_present != chg->vbus_present) {
+		if (chg->vbus_present) {
+			pr_info("acquire chg_wake_lock\n");
+			__pm_stay_awake(&chg->chg_wake_lock);
+		} else {
+			pr_info("release chg_wake_lock\n");
+			__pm_relax(&chg->chg_wake_lock);
+		}
+	}
 	if (vbus_rising) {
 		rc = smblib_request_dpdm(chg, true);
 		if (rc < 0)
 			smblib_err(chg, "Couldn't to enable DPDM rc=%d\n", rc);
 
+	if (chg->charger_collpse) {
+		op_set_collapse_fet(chg, 0);
+		chg->charger_collpse = false;
+	}
+	chg->switch_on_fastchg = false;
+	schedule_delayed_work(&chg->op_check_apsd_work,
+			msecs_to_jiffies(TIME_1000MS));
+	if (gpio_is_valid(chg->vbus_ctrl))
+			schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(200));
 		/* Enable SW Thermal regulation */
 		rc = smblib_set_sw_thermal_regulation(chg, true);
 		if (rc < 0)
@@ -4370,7 +4761,8 @@ void smblib_usb_plugin_locked(struct smb_charger *chg)
 		rc = smblib_request_dpdm(chg, false);
 		if (rc < 0)
 			smblib_err(chg, "Couldn't disable DPDM rc=%d\n", rc);
-
+		if (last_vbus_present != chg->vbus_present)
+			op_handle_usb_removal(chg);
 		smblib_update_usb_type(chg);
 	}
 
@@ -4380,10 +4772,23 @@ void smblib_usb_plugin_locked(struct smb_charger *chg)
 	power_supply_changed(chg->usb_psy);
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: usbin-plugin %s\n",
 					vbus_rising ? "attached" : "detached");
-}
-
-irqreturn_t usb_plugin_irq_handler(int irq, void *data)
-{
+	if (!vbus_rising) {
+		rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+		if (rc < 0) {
+			pr_err("V  fail rc=%d\n", rc);
+		} else {
+			if (vbus_val.intval > 3000) {
+				pr_err("unplg,Vbus=%d", vbus_val.intval);
+				op_dump_regs(chg);
+			}
+		}
+	}
+	pr_err("IRQ: %s\n",
+			vbus_rising ? "attached" : "detached");
+}
+
+irqreturn_t usb_plugin_irq_handler(int irq, void *data)
+{
 	struct smb_irq_data *irq_data = data;
 	struct smb_charger *chg = irq_data->parent_data;
 
@@ -4395,6 +4800,14 @@ irqreturn_t usb_plugin_irq_handler(int irq, void *data)
 	return IRQ_HANDLED;
 }
 
+void op_handle_usb_plugin(struct smb_charger *chg)
+{
+	mutex_lock(&chg->smb_lock);
+	smblib_usb_plugin_locked(chg);
+	/*smblib_usb_typec_change(chg);*/
+	mutex_unlock(&chg->smb_lock);
+}
+
 static void smblib_handle_slow_plugin_timeout(struct smb_charger *chg,
 					      bool rising)
 {
@@ -4501,7 +4914,7 @@ static void update_sw_icl_max(struct smb_charger *chg, int pst)
 		if (!is_client_vote_enabled(chg->usb_icl_votable,
 								USB_PSY_VOTER))
 			vote(chg->usb_icl_votable, USB_PSY_VOTER, true,
-					SDP_100_MA);
+					500000);
 		vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, false, 0);
 		break;
 	case POWER_SUPPLY_TYPE_USB_CDP:
@@ -4510,15 +4923,11 @@ static void update_sw_icl_max(struct smb_charger *chg, int pst)
 		break;
 	case POWER_SUPPLY_TYPE_USB_DCP:
 		vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, true,
-					DCP_CURRENT_UA);
+					1500000);
 		break;
 	case POWER_SUPPLY_TYPE_USB_FLOAT:
-		/*
-		 * limit ICL to 100mA, the USB driver will enumerate to check
-		 * if this is a SDP and appropriately set the current
-		 */
 		vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, true,
-					SDP_100_MA);
+					1500000);
 		break;
 	case POWER_SUPPLY_TYPE_UNKNOWN:
 	default:
@@ -4531,6 +4940,7 @@ static void update_sw_icl_max(struct smb_charger *chg, int pst)
 static void smblib_handle_apsd_done(struct smb_charger *chg, bool rising)
 {
 	const struct apsd_result *apsd_result;
+	int temp_region = 0, current_limit_ua = 0;
 
 	if (!rising)
 		return;
@@ -4553,6 +4963,58 @@ static void smblib_handle_apsd_done(struct smb_charger *chg, bool rising)
 		break;
 	}
 
+	if ((apsd_result->bit) == SDP_CHARGER_BIT)
+		current_limit_ua = DEFAULT_SDP_MA*1000;
+	else if ((apsd_result->bit) == CDP_CHARGER_BIT)
+		current_limit_ua = DEFAULT_CDP_MA*1000;
+	else if ((apsd_result->bit) == DCP_CHARGER_BIT)
+		current_limit_ua = DEFAULT_DCP_MA*1000;
+	else if ((apsd_result->bit) == FLOAT_CHARGER_BIT) {
+		if (chg->usb_type_redet_done)
+			current_limit_ua = DEFAULT_DCP_MA*1000;
+		else
+			current_limit_ua = TYPEC_DEFAULT_CURRENT_UA*1000;
+	} else if ((apsd_result->bit) == OCP_CHARGER_BIT)
+		current_limit_ua = DEFAULT_DCP_MA*1000;
+
+	if (chg->is_aging_test)
+		current_limit_ua = DEFAULT_AGAING_CHG_MA*1000;
+	vote(chg->usb_icl_votable,
+		DCP_VOTER, true, current_limit_ua);
+	vote(chg->usb_icl_votable,
+		USB_PSY_VOTER, true, current_limit_ua);
+
+	smblib_set_prop_charge_parameter_set(chg);
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_COLD
+		&& temp_region != BATT_TEMP_HOT) {
+		op_charging_en(chg, true);
+	}
+
+	pr_info("apsd result=0x%x, name=%s, psy_type=%d\n",
+		apsd_result->bit, apsd_result->name, apsd_result->pst);
+	pr_info("apsd done,current_now=%d\n",
+		(get_prop_batt_current_now(chg) / 1000));
+	if (apsd_result->bit == DCP_CHARGER_BIT
+		|| apsd_result->bit == OCP_CHARGER_BIT) {
+		schedule_delayed_work(&chg->check_switch_dash_work,
+					msecs_to_jiffies(50));
+	} else {
+		if (!chg->usb_type_redet_done) {
+			schedule_delayed_work(&chg->re_det_work,
+				msecs_to_jiffies(TIME_1000MS));
+		} else {
+			schedule_delayed_work(
+			&chg->non_standard_charger_check_work,
+			msecs_to_jiffies(TIME_1000MS));
+		}
+	}
+	chg->op_apsd_done = true;
+
+	/* set allow read extern fg IIC */
+	set_property_on_fg(chg,
+		POWER_SUPPLY_PROP_SET_ALLOW_READ_EXTERN_FG_IIC, true);
+
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: apsd-done rising; %s detected\n",
 		   apsd_result->name);
 }
@@ -4564,6 +5026,12 @@ irqreturn_t usb_source_change_irq_handler(int irq, void *data)
 	int rc = 0;
 	u8 stat;
 
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (g_chg->dash_on || chg->switch_on_fastchg) {
+		pr_err("return directly because dash is dash_on\n");
+		return IRQ_HANDLED;
+	}
+
 	/* PD session is ongoing, ignore BC1.2 and QC detection */
 	if (chg->pd_active)
 		return IRQ_HANDLED;
@@ -4573,6 +5041,9 @@ irqreturn_t usb_source_change_irq_handler(int irq, void *data)
 		smblib_err(chg, "Couldn't read APSD_STATUS rc=%d\n", rc);
 		return IRQ_HANDLED;
 	}
+	smblib_dbg(chg, PR_REGISTER, "APSD_STATUS = 0x%02x\n", stat);
+	pr_info("APSD_STATUS=0x%02x\n", stat);
+
 	smblib_dbg(chg, PR_INTERRUPT, "APSD_STATUS = 0x%02x\n", stat);
 
 	if ((chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB)
@@ -4628,6 +5099,7 @@ enum alarmtimer_restart smblib_lpd_recheck_timer(struct alarm *alarm,
 							lpd_recheck_timer);
 	int rc;
 
+	pr_info("do lpd recheck!\n");
 	if (chg->lpd_reason == LPD_MOISTURE_DETECTED) {
 		pval.intval = POWER_SUPPLY_TYPEC_PR_DUAL;
 		rc = smblib_set_prop_typec_power_role(chg, &pval);
@@ -4636,6 +5108,8 @@ enum alarmtimer_restart smblib_lpd_recheck_timer(struct alarm *alarm,
 				pval.intval, rc);
 			return ALARMTIMER_NORESTART;
 		}
+		pr_info("lpd_reason:(%d),pr_role:(%d)\n",
+					chg->lpd_reason, pval.intval);
 	} else {
 		rc = smblib_masked_write(chg, TYPE_C_INTERRUPT_EN_CFG_2_REG,
 					TYPEC_WATER_DETECTION_INT_EN_BIT,
@@ -4649,6 +5123,8 @@ enum alarmtimer_restart smblib_lpd_recheck_timer(struct alarm *alarm,
 
 	chg->lpd_stage = LPD_STAGE_NONE;
 	chg->lpd_reason = LPD_NONE;
+	*chg->lpd_result = 0;
+	pr_info("timer reset:__lpd_result(%d)\n", __lpd_result);
 
 	return ALARMTIMER_NORESTART;
 }
@@ -4661,6 +5137,14 @@ static bool smblib_src_lpd(struct smb_charger *chg)
 	u8 stat;
 	int rc;
 
+	/*Add lpd detection switch*/
+	if (chg->lpd_disabled || (*chg->lpd_enable == 0)) {
+		pr_info("lpd_disabled(%d) or lpd_user_enable(%d) return!\n",
+				chg->lpd_disabled,
+				*chg->lpd_enable);
+		return false;
+	}
+
 	rc = smblib_read(chg, TYPE_C_SRC_STATUS_REG, &stat);
 	if (rc < 0) {
 		smblib_err(chg, "Couldn't read TYPE_C_SRC_STATUS_REG rc=%d\n",
@@ -4688,11 +5172,16 @@ static bool smblib_src_lpd(struct smb_charger *chg)
 			smblib_err(chg, "Couldn't write 0x%02x to TYPE_C_INTRPT_ENB_SOFTWARE_CTRL rc=%d\n",
 				pval.intval, rc);
 		chg->lpd_reason = LPD_MOISTURE_DETECTED;
-		alarm_start_relative(&chg->lpd_recheck_timer,
+		pr_info("lpd flag:(%d),lpd_reason:(%d),pr_role:(%d),\n",
+					lpd_flag, chg->lpd_reason, pval.intval);
+		if (check_boot_mode_disabled_lpd(chg))
+			alarm_start_relative(&chg->lpd_recheck_timer,
 						ms_to_ktime(60000));
 	} else {
 		chg->lpd_reason = LPD_NONE;
 		chg->typec_mode = smblib_get_prop_typec_mode(chg);
+		*chg->lpd_result = 0;
+		pr_info("src:__lpd_result(%d)\n", __lpd_result);
 	}
 
 	return lpd_flag;
@@ -4701,8 +5190,8 @@ static bool smblib_src_lpd(struct smb_charger *chg)
 static void typec_sink_insertion(struct smb_charger *chg)
 {
 	int rc;
-
-	vote(chg->usb_icl_votable, OTG_VOTER, true, 0);
+	if (!chg->is_audio_adapter)
+		vote(chg->usb_icl_votable, OTG_VOTER, true, 0);
 	rc = smblib_set_charge_param(chg, &chg->param.freq_switcher,
 					chg->chg_freq.freq_above_otg_threshold);
 	if (rc < 0)
@@ -4757,6 +5246,7 @@ static void typec_sink_removal(struct smb_charger *chg)
 			smblib_notify_usb_host(chg, false);
 		chg->otg_present = false;
 	}
+	chg->is_audio_adapter = false;
 }
 
 static void typec_src_removal(struct smb_charger *chg)
@@ -4793,7 +5283,7 @@ static void typec_src_removal(struct smb_charger *chg)
 	alarm_cancel(&chg->chg_termination_alarm);
 
 	/* reset input current limit voters */
-	vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, true, SDP_100_MA);
+	vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER, true, 500000);
 	vote(chg->usb_icl_votable, PD_VOTER, false, 0);
 	vote(chg->usb_icl_votable, USB_PSY_VOTER, false, 0);
 	vote(chg->usb_icl_votable, DCP_VOTER, false, 0);
@@ -4878,33 +5368,62 @@ static void smblib_handle_rp_change(struct smb_charger *chg, int typec_mode)
 {
 	const struct apsd_result *apsd = smblib_get_apsd_result(chg);
 
-	/*
-	 * We want the ICL vote @ 100mA for a FLOAT charger
-	 * until the detection by the USB stack is complete.
-	 * Ignore the Rp changes unless there is a
-	 * pre-existing valid vote or FLOAT is configured for
-	 * SDP current.
-	 */
-	if (apsd->pst == POWER_SUPPLY_TYPE_USB_FLOAT) {
-		if (get_client_vote(chg->usb_icl_votable, SW_ICL_MAX_VOTER)
-					<= USBIN_100MA
-			|| (chg->float_cfg & FLOAT_OPTIONS_MASK)
-					== FORCE_FLOAT_SDP_CFG_BIT)
-			return;
-	}
-
 	update_sw_icl_max(chg, apsd->pst);
 
 	smblib_dbg(chg, PR_MISC, "CC change old_mode=%d new_mode=%d\n",
 						chg->typec_mode, typec_mode);
 }
 
+static void smblib_lpd_launch_ra_open_work(struct smb_charger *chg)
+{
+	u8 stat;
+	int rc;
+
+	if (chg->lpd_disabled) {
+		pr_info("lpd_disabled(%d),return!\n",
+				chg->lpd_disabled);
+		return;
+	}
+
+	/*Add lpd detection switch*/
+	if (*chg->lpd_enable == 0) {
+		pr_info("lpd_user_enable(%d),disable water detection!\n",
+				*chg->lpd_enable);
+		/* disable water detection irq*/
+		rc = smblib_masked_write(chg, TYPE_C_INTERRUPT_EN_CFG_2_REG,
+					TYPEC_WATER_DETECTION_INT_EN_BIT,
+					0);
+		if (rc < 0) {
+			smblib_err(chg, "Couldn't write TYPE_C_INTERRUPT_EN_CFG_2_REG rc=%d\n",
+				rc);
+			return;
+		}
+
+		return;
+	}
+
+	rc = smblib_read(chg, TYPE_C_MISC_STATUS_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read TYPE_C_MISC_STATUS_REG rc=%d\n",
+			rc);
+		return;
+	}
+
+	if (!(stat & TYPEC_TCCDEBOUNCE_DONE_STATUS_BIT)
+			&& chg->lpd_stage == LPD_STAGE_NONE) {
+		chg->lpd_stage = LPD_STAGE_FLOAT;
+		cancel_delayed_work_sync(&chg->lpd_ra_open_work);
+		vote(chg->awake_votable, LPD_VOTER, true, 0);
+		schedule_delayed_work(&chg->lpd_ra_open_work,
+						msecs_to_jiffies(50));
+	}
+
+}
+
 irqreturn_t typec_or_rid_detection_change_irq_handler(int irq, void *data)
 {
 	struct smb_irq_data *irq_data = data;
 	struct smb_charger *chg = irq_data->parent_data;
-	u8 stat;
-	int rc;
 
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
 
@@ -4936,21 +5455,7 @@ irqreturn_t typec_or_rid_detection_change_irq_handler(int irq, void *data)
 	if (chg->pr_swap_in_progress || chg->pd_hard_reset)
 		goto out;
 
-	rc = smblib_read(chg, TYPE_C_MISC_STATUS_REG, &stat);
-	if (rc < 0) {
-		smblib_err(chg, "Couldn't read TYPE_C_MISC_STATUS_REG rc=%d\n",
-			rc);
-		goto out;
-	}
-
-	if (!(stat & TYPEC_TCCDEBOUNCE_DONE_STATUS_BIT)
-			&& chg->lpd_stage == LPD_STAGE_NONE) {
-		chg->lpd_stage = LPD_STAGE_FLOAT;
-		cancel_delayed_work_sync(&chg->lpd_ra_open_work);
-		vote(chg->awake_votable, LPD_VOTER, true, 0);
-		schedule_delayed_work(&chg->lpd_ra_open_work,
-						msecs_to_jiffies(300));
-	}
+	smblib_lpd_launch_ra_open_work(chg);
 
 	if (chg->usb_psy)
 		power_supply_changed(chg->usb_psy);
@@ -4959,11 +5464,32 @@ irqreturn_t typec_or_rid_detection_change_irq_handler(int irq, void *data)
 	return IRQ_HANDLED;
 }
 
+static void smblib_lpd_clear_ra_open_work(struct smb_charger *chg)
+{
+	if (chg->lpd_disabled || (*chg->lpd_enable == 0))
+		return;
+
+	cancel_delayed_work_sync(&chg->lpd_detach_work);
+	chg->lpd_stage = LPD_STAGE_FLOAT_CANCEL;
+	cancel_delayed_work_sync(&chg->lpd_ra_open_work);
+	vote(chg->awake_votable, LPD_VOTER, false, 0);
+}
+
 irqreturn_t typec_state_change_irq_handler(int irq, void *data)
 {
 	struct smb_irq_data *irq_data = data;
 	struct smb_charger *chg = irq_data->parent_data;
 	int typec_mode;
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_info("chg->dash_on = %d update typec state!\n",
+			chg->dash_on);
+		/*The dash charger will detected as CDP when boot up, this will
+		 *cause current_pr = 0 not update when dash charger remove, so
+		 * we can let dash charger update the cc state avoid this issue
+		 */
+		//return IRQ_HANDLED;
+	}
 
 	if (chg->connector_type == POWER_SUPPLY_CONNECTOR_MICRO_USB) {
 		smblib_dbg(chg, PR_INTERRUPT,
@@ -4972,10 +5498,10 @@ irqreturn_t typec_state_change_irq_handler(int irq, void *data)
 	}
 
 	typec_mode = smblib_get_prop_typec_mode(chg);
-	if (chg->sink_src_mode != UNATTACHED_MODE
-			&& (typec_mode != chg->typec_mode))
+	if (typec_mode != chg->typec_mode) {
 		smblib_handle_rp_change(chg, typec_mode);
-	chg->typec_mode = typec_mode;
+		chg->typec_mode = typec_mode;
+	}
 
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: cc-state-change; Type-C %s detected\n",
 				smblib_typec_mode_name[chg->typec_mode]);
@@ -4992,9 +5518,50 @@ irqreturn_t typec_attach_detach_irq_handler(int irq, void *data)
 	struct smb_charger *chg = irq_data->parent_data;
 	u8 stat;
 	int rc;
+	int i = 0, dump_offset = 6;
 
 	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
 
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_err("return directly because dash is online\n");
+		return IRQ_HANDLED;
+	}
+
+	for (i = 0; i <= 1; i++) {
+		rc = smblib_read(chg, (TYPEC_BASE + i*2 + dump_offset), &stat);
+		if (rc < 0) {
+			smblib_err(chg, "Couldn't read dump_reg:0x%02x, rc=%d\n",
+				(TYPEC_BASE + i*2 + dump_offset), rc);
+		}
+		pr_info("dump_reg:0x%02x = 0x%02x\n",
+			(TYPEC_BASE + i*2 + dump_offset), stat);
+	}
+
+	rc = smblib_read(chg, (TYPEC_BASE + 0x0b), &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read dump_reg:0x%02x, rc=%d\n",
+			(TYPEC_BASE + 0x0b), rc);
+	}
+	pr_info("dump_reg:0x%02x = 0x%02x\n",
+		(TYPEC_BASE + 0x0b), stat);
+
+	rc = smblib_read(chg, (TYPEC_BASE + 0x10), &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read dump_reg:0x%02x, rc=%d\n",
+			(TYPEC_BASE + 0x10), rc);
+	}
+	pr_info("dump_reg:0x%02x = 0x%02x\n",
+		(TYPEC_BASE + 0x10), stat);
+
+	rc = smblib_read(chg, TYPE_C_INTERRUPT_EN_CFG_1_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read dump_reg:0x%02x, rc=%d\n",
+			TYPE_C_INTERRUPT_EN_CFG_1_REG, rc);
+	}
+	pr_info("dump_reg:0x%02x = 0x%02x\n",
+			TYPE_C_INTERRUPT_EN_CFG_1_REG, stat);
+
 	rc = smblib_read(chg, TYPE_C_STATE_MACHINE_STATUS_REG, &stat);
 	if (rc < 0) {
 		smblib_err(chg, "Couldn't read TYPE_C_STATE_MACHINE_STATUS_REG rc=%d\n",
@@ -5003,9 +5570,7 @@ irqreturn_t typec_attach_detach_irq_handler(int irq, void *data)
 	}
 
 	if (stat & TYPEC_ATTACH_DETACH_STATE_BIT) {
-		chg->lpd_stage = LPD_STAGE_FLOAT_CANCEL;
-		cancel_delayed_work_sync(&chg->lpd_ra_open_work);
-		vote(chg->awake_votable, LPD_VOTER, false, 0);
+		smblib_lpd_clear_ra_open_work(chg);
 
 		rc = smblib_read(chg, TYPE_C_MISC_STATUS_REG, &stat);
 		if (rc < 0) {
@@ -5038,237 +5603,2906 @@ irqreturn_t typec_attach_detach_irq_handler(int irq, void *data)
 			break;
 		}
 
-		if (!chg->pr_swap_in_progress) {
-			chg->ok_to_pd = false;
-			chg->sink_src_mode = UNATTACHED_MODE;
-			chg->early_usb_attach = false;
-			smblib_apsd_enable(chg, true);
-		}
+		if (!chg->pr_swap_in_progress) {
+			chg->ok_to_pd = false;
+			chg->sink_src_mode = UNATTACHED_MODE;
+			chg->early_usb_attach = false;
+			smblib_apsd_enable(chg, true);
+		}
+
+		if (chg->lpd_stage == LPD_STAGE_FLOAT_CANCEL)
+			schedule_delayed_work(&chg->lpd_detach_work,
+					msecs_to_jiffies(100));
+	}
+
+	power_supply_changed(chg->usb_psy);
+
+	return IRQ_HANDLED;
+}
+
+irqreturn_t dc_plugin_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+	union power_supply_propval pval;
+	int input_present;
+	bool dcin_present, vbus_present;
+	int rc, wireless_vout = 0;
+	int sec_charger;
+
+	rc = iio_read_channel_processed(chg->iio.vph_v_chan,
+			&wireless_vout);
+	if (rc < 0)
+		return IRQ_HANDLED;
+
+	wireless_vout *= 2;
+	wireless_vout /= 100000;
+	wireless_vout *= 100000;
+
+	rc = smblib_is_input_present(chg, &input_present);
+	if (rc < 0)
+		return IRQ_HANDLED;
+
+	dcin_present = input_present & INPUT_PRESENT_DC;
+	vbus_present = input_present & INPUT_PRESENT_USB;
+
+	if (dcin_present) {
+		if (!vbus_present && chg->sec_cp_present) {
+			pval.intval = wireless_vout;
+			rc = smblib_set_prop_voltage_wls_output(chg, &pval);
+			if (rc < 0)
+				dev_err(chg->dev, "Couldn't set dc voltage to 2*vph  rc=%d\n",
+					rc);
+
+			rc = smblib_select_sec_charger(chg,
+					POWER_SUPPLY_CHARGER_SEC_CP,
+					POWER_SUPPLY_CP_WIRELESS, false);
+			if (rc < 0)
+				dev_err(chg->dev, "Couldn't enable secondary chargers  rc=%d\n",
+					rc);
+		}
+	} else if (chg->cp_reason == POWER_SUPPLY_CP_WIRELESS) {
+		sec_charger = chg->sec_pl_present ?
+					POWER_SUPPLY_CHARGER_SEC_PL :
+					POWER_SUPPLY_CHARGER_SEC_NONE;
+		rc = smblib_select_sec_charger(chg, sec_charger,
+					POWER_SUPPLY_CP_NONE, false);
+		if (rc < 0)
+			dev_err(chg->dev,
+				"Couldn't disable secondary charger rc=%d\n",
+						rc);
+	}
+
+	power_supply_changed(chg->dc_psy);
+
+	smblib_dbg(chg, PR_WLS, "dcin_present= %d, usbin_present= %d, cp_reason = %d\n",
+			dcin_present, vbus_present, chg->cp_reason);
+
+	return IRQ_HANDLED;
+}
+
+irqreturn_t high_duty_cycle_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+
+	chg->is_hdc = true;
+	/*
+	 * Disable usb IRQs after the flag set and re-enable IRQs after
+	 * the flag cleared in the delayed work queue, to avoid any IRQ
+	 * storming during the delays
+	 */
+	if (chg->irq_info[HIGH_DUTY_CYCLE_IRQ].irq)
+		disable_irq_nosync(chg->irq_info[HIGH_DUTY_CYCLE_IRQ].irq);
+
+	schedule_delayed_work(&chg->clear_hdc_work, msecs_to_jiffies(60));
+
+	return IRQ_HANDLED;
+}
+
+static void smblib_bb_removal_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work, struct smb_charger,
+						bb_removal_work.work);
+
+	vote(chg->usb_icl_votable, BOOST_BACK_VOTER, false, 0);
+	vote(chg->awake_votable, BOOST_BACK_VOTER, false, 0);
+}
+
+#define BOOST_BACK_UNVOTE_DELAY_MS		750
+#define BOOST_BACK_STORM_COUNT			3
+#define WEAK_CHG_STORM_COUNT			8
+irqreturn_t switcher_power_ok_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+	int rc, usb_icl;
+	u8 stat;
+	union power_supply_propval vbus_val;
+
+	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		pr_err("return directly because dash is online\n");
+		return IRQ_HANDLED;
+	}
+
+
+	if (!(chg->wa_flags & BOOST_BACK_WA))
+		return IRQ_HANDLED;
+
+	rc = smblib_read(chg, POWER_PATH_STATUS_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read POWER_PATH_STATUS rc=%d\n", rc);
+		return IRQ_HANDLED;
+	}
+
+	/* skip suspending input if its already suspended by some other voter */
+	usb_icl = get_effective_result(chg->usb_icl_votable);
+	if ((stat & USE_USBIN_BIT) && usb_icl >= 0 && usb_icl <= USBIN_25MA)
+		return IRQ_HANDLED;
+
+	if (stat & USE_DCIN_BIT)
+		return IRQ_HANDLED;
+
+	if (is_storming(&irq_data->storm_data)) {
+		smblib_err(chg, "Reverse boost detected\n");
+		rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+		if (rc < 0)
+			pr_err("fail to read usb_voltage rc=%d\n", rc);
+		else if (vbus_val.intval >= 2500)
+			pr_err("vbus_val.intval=%d\n", vbus_val.intval);
+		chg->revert_boost_trigger = true;
+		vote(chg->usb_icl_votable, BOOST_BACK_VOTER, true, 0);
+		schedule_delayed_work(&chg->recovery_suspend_work,
+				msecs_to_jiffies(TIME_100MS));
+	}
+
+	return IRQ_HANDLED;
+}
+
+irqreturn_t wdog_snarl_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+
+	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
+
+	if (chg->wa_flags & SW_THERM_REGULATION_WA) {
+		cancel_delayed_work_sync(&chg->thermal_regulation_work);
+		vote(chg->awake_votable, SW_THERM_REGULATION_VOTER, true, 0);
+		schedule_delayed_work(&chg->thermal_regulation_work, 0);
+	}
+
+	return IRQ_HANDLED;
+}
+
+irqreturn_t wdog_bark_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+	int rc;
+
+	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
+
+	rc = smblib_write(chg, BARK_BITE_WDOG_PET_REG, BARK_BITE_WDOG_PET_BIT);
+	if (rc < 0)
+		smblib_err(chg, "Couldn't pet the dog rc=%d\n", rc);
+
+	if (chg->step_chg_enabled)
+		power_supply_changed(chg->batt_psy);
+
+	return IRQ_HANDLED;
+}
+
+static void smblib_die_rst_icl_regulate(struct smb_charger *chg)
+{
+	int rc;
+	u8 temp;
+
+	rc = smblib_read(chg, DIE_TEMP_STATUS_REG, &temp);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read DIE_TEMP_STATUS_REG rc=%d\n",
+				rc);
+		return;
+	}
+
+	/* Regulate ICL on die temp crossing DIE_RST threshold */
+	vote(chg->usb_icl_votable, DIE_TEMP_VOTER,
+				temp & DIE_TEMP_RST_BIT, 500000);
+}
+
+/*
+ * triggered when DIE or SKIN or CONNECTOR temperature across
+ * either of the _REG_L, _REG_H, _RST, or _SHDN thresholds
+ */
+irqreturn_t temp_change_irq_handler(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+
+	smblib_die_rst_icl_regulate(chg);
+
+	return IRQ_HANDLED;
+}
+
+static void op_get_aicl_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work, struct smb_charger,
+							get_aicl_work);
+	int rc, settled_ua;
+
+	rc = smblib_get_charge_param(chg, &chg->param.icl_stat,
+				&settled_ua);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't get ICL status rc=%d\n", rc);
+		return;
+	}
+
+	pr_err("AICL result=%dmA\n", settled_ua / 1000);
+}
+
+#define NORMAL_CHECK_INTERVAL 300 /*ms*/
+#define FAST_CHECK_INTERVAL 100 /*ms*/
+#define HIGH_TEMP_SHORT_CHECK_TIMEOUT 1000 /*ms*/
+
+static void op_connect_temp_check_work(struct work_struct *work)
+{
+	struct delayed_work *dwork = to_delayed_work(work);
+	struct smb_charger *chg = container_of(dwork,
+				struct smb_charger, connecter_check_work);
+	int batt_temp = 0, interval_temp = 0;
+	int i;
+
+	if (!chg->vbus_present)
+		return;
+
+	chg->connecter_temp = get_usb_temp(chg);
+	batt_temp = get_prop_batt_temp(chg)/10;
+	interval_temp = chg->connecter_temp - batt_temp;
+
+	if (!chg->count_run) {/*count run state keep count_total not change*/
+		if (chg->connecter_temp >= 45) {
+			chg->count_total =
+			HIGH_TEMP_SHORT_CHECK_TIMEOUT/FAST_CHECK_INTERVAL;
+			smblib_dbg(chg, PR_FAST_DEBUG, "> 40! chg->count_total:%d",
+					chg->count_total);
+		} else {
+			chg->count_total =
+			HIGH_TEMP_SHORT_CHECK_TIMEOUT/NORMAL_CHECK_INTERVAL;
+			smblib_dbg(chg, PR_FAST_DEBUG, "<= 40! chg->count_total:%d",
+					chg->count_total);
+		}
+	}
+
+	if ((chg->connecter_temp > 45) || (interval_temp >= 10)) {
+		smblib_dbg(chg, PR_OP_DEBUG, "connecter_temp:%d,batt_temp:%d,\
+		interval_temp:%d,connector_short:%d\n",
+			chg->connecter_temp,
+			batt_temp,
+			interval_temp,
+			chg->connector_short);
+	}
+
+	smblib_dbg(chg, PR_FAST_DEBUG, "connecter_temp:%d,batt_temp:%d,\
+	interval_temp:%d,count_total:%d,count_run:%d,connector_short:%d\n",
+			chg->connecter_temp,
+			batt_temp,
+			interval_temp,
+			chg->count_total,
+			chg->count_run,
+			chg->connector_short);
+	/*error:EOC bit not set! cause connector_temp=125 other 75*/
+	if (chg->connecter_temp == 125 || chg->connecter_temp == 75) {
+		for (i = 0; i <= 9; i++) {
+			msleep(100);
+			smblib_dbg(chg, PR_FAST_DEBUG,
+			"EOC error!temp abormal delay count:%d\n",
+					i);
+		}
+		schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(100));
+		return; /*rerun check again*/
+	}
+
+	if ((chg->connecter_temp >= 60) || chg->connector_short) {
+		pr_info("connecter_temp=%d,connector_short=%d\n",
+				chg->connecter_temp,
+				chg->connector_short);
+		op_disconnect_vbus(chg, true);
+	}
+	else {/*< 60*/
+		if ((interval_temp >= 15) && (chg->connecter_temp >= 45)) {
+			/*interval > 15 && connecter > 50*/
+			pr_info("interval_temp=%d,connecter_temp=%d\n",
+					interval_temp,
+					chg->connecter_temp);
+			op_disconnect_vbus(chg, true);
+			return;
+		} else if (((interval_temp >= 10) && (interval_temp < 15)) &&
+					(chg->connecter_temp >= 45)) {
+		/* 10<= <15*/
+			if (chg->count_run <= chg->count_total) {
+			/*time out count*/
+				if (chg->count_run == 0)
+					chg->pre_temp = chg->connecter_temp;
+
+				/* time out check MAX=count_total*/
+				if (chg->count_run > 0) {
+					chg->current_temp = chg->connecter_temp;
+					if ((chg->current_temp - chg->pre_temp)
+						>= 3)
+						chg->connector_short = true;
+				}
+
+				chg->count_run++;/*count ++*/
+
+				if (chg->count_run > chg->count_total) {
+					chg->count_run = 0;
+					smblib_dbg(chg, PR_FAST_DEBUG, "count reset!\n");
+				}
+			}
+		} else {/*<10*/
+			if (chg->count_run)/* high temp cold down count reset.*/
+				chg->count_run = 0;
+			smblib_dbg(chg, PR_FAST_DEBUG,
+					"chg->dash_on:%d,connecter_temp:%d\n",
+					chg->dash_on,
+					chg->connecter_temp);
+		}
+	}
+
+	if (chg->connecter_temp < 45)
+		schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(NORMAL_CHECK_INTERVAL));
+	else if ((chg->connecter_temp >= 45) && (chg->connecter_temp < 60))
+		/*time need optimize depend on test*/
+		schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(FAST_CHECK_INTERVAL));
+	else
+		smblib_dbg(chg, PR_FAST_DEBUG, "connecter_temp:%d\n",
+				chg->connecter_temp);
+}
+
+irqreturn_t smblib_handle_aicl_done(int irq, void *data)
+{
+	struct smb_irq_data *irq_data = data;
+	struct smb_charger *chg = irq_data->parent_data;
+
+	cancel_work_sync(&chg->get_aicl_work);
+	schedule_work(&chg->get_aicl_work);
+
+	return IRQ_HANDLED;
+}
+
+int op_get_aicl_result(struct smb_charger *chg)
+{
+	int icl_ma, rc;
+
+	rc = smblib_get_charge_param(chg,
+				&chg->param.icl_stat, &icl_ma);
+	if (rc < 0) {
+		pr_err("Couldn't get ICL status rc=%d\n", rc);
+		return  -EINVAL;
+	}
+
+	pr_info("AICL result=%d\n", icl_ma);
+	return icl_ma;
+}
+static bool op_get_fast_chg_status_is_ok(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->fast_chg_status_is_ok)
+		return fast_charger->fast_chg_status_is_ok();
+	pr_err("no fast_charger register found\n");
+	return true;
+}
+
+static int get_property_from_fg(struct smb_charger *chg,
+		enum power_supply_property prop, int *val)
+{
+	int rc;
+	union power_supply_propval ret = {0, };
+
+	if (!chg->bms_psy)
+		chg->bms_psy = power_supply_get_by_name("bms");
+
+	if (chg->bms_psy) {
+		rc = power_supply_get_property(chg->bms_psy, prop, &ret);
+		if (rc) {
+			pr_err("bms psy doesn't support reading prop %d rc = %d\n",
+				prop, rc);
+			return rc;
+		}
+		*val = ret.intval;
+	} else {
+		pr_err("no bms psy found\n");
+		return -EINVAL;
+	}
+
+	return rc;
+}
+
+static int set_property_on_fg(struct smb_charger *chg,
+		enum power_supply_property prop, int val)
+{
+	int rc;
+	union power_supply_propval ret = {0, };
+
+	if (!chg->bms_psy)
+		chg->bms_psy = power_supply_get_by_name("bms");
+
+	if (chg->bms_psy) {
+		ret.intval = val;
+		rc = power_supply_set_property(chg->bms_psy, prop, &ret);
+		if (rc)
+			pr_err("bms psy does not allow updating prop %d rc = %d\n",
+				prop, rc);
+	} else {
+		pr_err("no bms psy found\n");
+		return -EINVAL;
+	}
+
+	return rc;
+}
+
+static int op_charging_en(struct smb_charger *chg, bool en)
+{
+	int rc;
+
+	pr_err("enable=%d\n", en);
+	rc = smblib_masked_write(chg, CHARGING_ENABLE_CMD_REG,
+				 CHARGING_ENABLE_CMD_BIT,
+				 en ? CHARGING_ENABLE_CMD_BIT : 0);
+	if (rc < 0) {
+		pr_err("Couldn't %s charging rc=%d\n",
+			en ? "enable" : "disable", rc);
+		return rc;
+	}
+
+	return 0;
+}
+
+static bool is_usb_present(struct smb_charger *chg)
+{
+	int rc = 0;
+	u8 stat;
+
+	rc = smblib_read(chg, USBIN_BASE + INT_RT_STS_OFFSET, &stat);
+	if (rc < 0) {
+		pr_err("Couldn't read TYPE_C_STATUS_4 rc=%d\n", rc);
+		return rc;
+	}
+	pr_debug("TYPE_C_STATUS_4 = 0x%02x\n", stat);
+	return (bool)(stat & USBIN_PLUGIN_RT_STS_BIT);
+}
+
+static bool op_get_fast_low_temp_full(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->get_fast_low_temp_full)
+		return fast_charger->get_fast_low_temp_full();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static bool get_fastchg_firmware_updated_status(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->get_fastchg_firmware_already_updated)
+		return fast_charger->get_fastchg_firmware_already_updated();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static bool get_prop_fast_switch_to_normal(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->fast_switch_to_normal)
+		return fast_charger->fast_switch_to_normal();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+bool is_fastchg_allowed(struct smb_charger *chg)
+{
+	int temp;
+	static int pre_temp;
+	static bool pre_switch_to_normal;
+	bool low_temp_full, switch_to_normal, fw_updated;
+
+	temp = get_prop_batt_temp(chg);
+	low_temp_full = op_get_fast_low_temp_full(chg);
+	fw_updated = get_fastchg_firmware_updated_status(chg);
+
+	if (!fw_updated)
+		return false;
+	if (chg->usb_enum_status)
+		return false;
+	if (temp < DASH_VALID_TEMP_LOW_THRESHOLD
+			|| temp > DASH_VALID_TEMP_HIG_THRESHOLD) {
+		if (temp != pre_temp)
+			pr_err("temp=%d is not allow to switch fastchg\n", temp);
+		pre_temp = temp;
+		return false;
+	}
+
+	switch_to_normal = get_prop_fast_switch_to_normal(chg);
+	if (pre_switch_to_normal != switch_to_normal)
+		pr_info("switch_to_normal =%d\n", switch_to_normal);
+	if (switch_to_normal)
+		return false;
+
+	return true;
+}
+
+void op_switch_normal_set(void)
+{
+	if (!g_chg)
+		return;
+	pr_info("switch_normal_set\n");
+	vote(g_chg->usb_icl_votable,
+		DCP_VOTER, true, 2000 * 1000);
+	vote(g_chg->fv_votable,
+		DEFAULT_VOTER, true, 4500 * 1000);
+	vote(g_chg->fcc_votable,
+		DEFAULT_VOTER, true, 1000 * 1000);
+	g_chg->ffc_status = FFC_FAST;
+}
+
+bool get_oem_charge_done_status(void)
+{
+#ifdef	CONFIG_OP_DEBUG_CHG
+	return false;
+#else
+	if (g_chg->is_aging_test)
+		return false;
+#endif
+	if (g_chg)
+		return (g_chg->chg_done || g_chg->recharge_status);
+	else
+		return false;
+}
+static bool ff_force;
+
+static void op_handle_usb_removal(struct smb_charger *chg)
+{
+	op_set_fast_chg_allow(chg, false);
+	set_prop_fast_switch_to_normal_false(chg);
+	set_usb_switch(chg, false);
+	set_dash_charger_present(false);
+	op_clean_dash_status();
+	ff_force = 0;
+
+	chg->chg_ovp = false;
+	chg->dash_on = false;
+	chg->chg_done = false;
+	chg->time_out = false;
+	chg->recharge_status = false;
+	chg->usb_enum_status = false;
+	chg->non_std_chg_present = false;
+	chg->usb_type_redet_done = false;
+	chg->boot_usb_present = false;
+	chg->revert_boost_trigger = false;
+	chg->is_audio_adapter = false;
+	chg->ffc_status = FFC_DEFAULT;
+	chg->non_stand_chg_current = 0;
+	chg->non_stand_chg_count = 0;
+	chg->redet_count = 0;
+	chg->dump_count = 0;
+	chg->op_apsd_done = 0;
+	chg->ck_dash_count = 0;
+	chg->re_trigr_dash_done = 0;
+	chg->recovery_boost_count = 0;
+	chg->ck_unplug_count = 0;
+	vote(chg->fcc_votable,
+		DEFAULT_VOTER, true, SDP_CURRENT_UA);
+	op_battery_temp_region_set(chg, BATT_TEMP_INVALID);
+}
+
+int update_dash_unplug_status(void)
+{
+	int rc;
+	union power_supply_propval vbus_val;
+
+	rc = smblib_get_prop_usb_voltage_now(g_chg, &vbus_val);
+	if (rc < 0)
+		pr_err("failed to read usb_voltage rc=%d\n", rc);
+	else if (vbus_val.intval <= 2500) {
+		op_handle_usb_plugin(g_chg);
+		smblib_update_usb_type(g_chg);
+		power_supply_changed(g_chg->usb_psy);
+		}
+
+	return 0;
+}
+#define USBIN_AICL_RERUN_EN_BIT			BIT(4)
+
+void op_check_charger_collapse_rerun_aicl(void)
+{
+	int rc;
+
+	rc = smblib_masked_write(g_chg, USBIN_AICL_OPTIONS_CFG_REG,
+	SUSPEND_ON_COLLAPSE_USBIN_BIT
+	|USBIN_AICL_START_AT_MAX_BIT
+	| USBIN_AICL_ADC_EN_BIT
+	|USBIN_AICL_RERUN_EN_BIT, USBIN_AICL_RERUN_EN_BIT);
+	if (rc < 0)
+		dev_err(g_chg->dev,
+			"Couldn't configure AICL rc=%d\n", rc);
+	smblib_rerun_aicl(g_chg);
+	smblib_err(g_chg, "%s done\n", __func__);
+}
+static int op_set_collapse_fet(struct smb_charger *chg, bool on)
+{
+	int rc = 0;
+	u8 stat;
+
+	rc = smblib_masked_write(chg, USBIN_5V_AICL_THRESHOLD_CFG_REG,
+		BIT(0) | BIT(1), on ? 0 : BIT(0) | BIT(1));
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't write %s to 0x%x rc=%d\n",
+			on ? "on" : "off", USBIN_5V_AICL_THRESHOLD_CFG_REG, rc);
+		return rc;
+	}
+
+	rc = smblib_read(chg, USBIN_5V_AICL_THRESHOLD_CFG_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read 0x%x rc=%d\n",
+			USBIN_5V_AICL_THRESHOLD_CFG_REG, rc);
+		return rc;
+	}
+	pr_info("USBIN_5V_AICL_THRESHOLD_CFG_REG(0x%x)=0x%x\n",
+			USBIN_5V_AICL_THRESHOLD_CFG_REG, stat);
+
+	rc = smblib_masked_write(chg, USBIN_CONT_AICL_THRESHOLD_CFG_REG,
+		BIT(0) | BIT(1), on ? 0 : BIT(0) | BIT(1));
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't write %s to 0x%x rc=%d\n",
+			on ? "on" : "off", USBIN_CONT_AICL_THRESHOLD_CFG_REG,
+			rc);
+		return rc;
+	}
+
+	rc = smblib_read(chg, USBIN_CONT_AICL_THRESHOLD_CFG_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read 0x%x rc=%d\n",
+			USBIN_CONT_AICL_THRESHOLD_CFG_REG, rc);
+		return rc;
+	}
+	pr_info("USBIN_CONT_AICL_THRESHOLD_CFG_REG(0x%x)=0x%x\n",
+			USBIN_CONT_AICL_THRESHOLD_CFG_REG, stat);
+
+	rc = smblib_masked_write(chg, USBIN_AICL_OPTIONS_CFG_REG,
+					SUSPEND_ON_COLLAPSE_USBIN_BIT
+					| USBIN_HV_COLLAPSE_RESPONSE_BIT
+					| USBIN_LV_COLLAPSE_RESPONSE_BIT
+					| USBIN_AICL_PERIODIC_RERUN_EN_BIT,
+					on ? 0 : SUSPEND_ON_COLLAPSE_USBIN_BIT
+					| USBIN_HV_COLLAPSE_RESPONSE_BIT
+					| USBIN_LV_COLLAPSE_RESPONSE_BIT);
+	if (rc < 0) {
+		smblib_err(chg,
+			"Couldn't write %s to 0x%x rc=%d\n",
+			on ? "on" : "off", USBIN_AICL_OPTIONS_CFG_REG, rc);
+		return rc;
+	}
+
+	rc = smblib_read(chg, USBIN_AICL_OPTIONS_CFG_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read 0x%x rc=%d\n",
+			USBIN_AICL_OPTIONS_CFG_REG, rc);
+		return rc;
+	}
+	pr_info("USBIN_AICL_OPTIONS_CFG_REG(0x%x)=0x%x\n",
+		USBIN_AICL_OPTIONS_CFG_REG, stat);
+
+	rc = smblib_masked_write(chg, USBIN_LOAD_CFG_REG, BIT(0)
+			| BIT(1), on ? 0 : BIT(0) | BIT(1));
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't write %s to 0x%x rc=%d\n",
+			on ? "on" : "off", USBIN_LOAD_CFG_REG, rc);
+		return rc;
+	}
+
+	rc = smblib_read(chg, USBIN_LOAD_CFG_REG, &stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read 0x%x rc=%d\n",
+			USBIN_LOAD_CFG_REG, rc);
+		return rc;
+	}
+	pr_info("USBIN_LOAD_CFG_REG(0x%x)=0x%x\n",
+			USBIN_LOAD_CFG_REG, stat);
+
+	return rc;
+}
+
+int op_handle_switcher_power_ok(void)
+{
+	int rc;
+	u8 stat;
+	union power_supply_propval vbus_val;
+
+	if (!g_chg)
+		return 0;
+	if (!(g_chg->wa_flags & BOOST_BACK_WA))
+		return 0;
+	rc = smblib_read(g_chg, POWER_PATH_STATUS_REG, &stat);
+	if (rc < 0) {
+		smblib_err(g_chg,
+			"Couldn't read POWER_PATH_STATUS rc=%d\n", rc);
+		return 0;
+	}
+	smblib_err(g_chg, "POWER_PATH_STATUS stat=0x%x\n", stat);
+
+	if ((stat & USE_USBIN_BIT) &&
+		get_effective_result(g_chg->usb_icl_votable)
+		< USBIN_25MA)
+		return 0;
+
+	if (stat & USE_DCIN_BIT)
+		return 0;
+	usleep_range(50000, 50002);
+	rc = smblib_get_prop_usb_voltage_now(g_chg, &vbus_val);
+	if (rc < 0) {
+		pr_err("fail to read usb_voltage rc=%d\n", rc);
+	} else if (vbus_val.intval >= 2500) {
+		op_dump_regs(g_chg);
+		pr_err("vbus_val.intval=%d\n", vbus_val.intval);
+		vote(g_chg->usb_icl_votable, BOOST_BACK_VOTER, true, 0);
+		schedule_delayed_work(&g_chg->recovery_suspend_work,
+				msecs_to_jiffies(TIME_100MS));
+		smblib_err(g_chg, "OP Reverse boost detected\n");
+	}
+
+	return 0;
+}
+
+int op_contrl(int enable, bool check_power_ok)
+{
+	pr_info("en=%d\n", enable);
+	if (!g_chg)
+		return 0;
+	if (enable) {
+		if (check_power_ok)
+		op_handle_switcher_power_ok();
+	} else{
+		op_set_collapse_fet(g_chg, enable);
+	}
+	return 0;
+}
+
+int get_prop_fast_adapter_update(struct smb_charger *chg)
+{
+	int update_status;
+
+	if (fast_charger && fast_charger->get_adapter_update)
+		update_status = fast_charger->get_adapter_update();
+	else {
+		pr_err("no fast_charger register found\n");
+		update_status = ADAPTER_FW_UPDATE_NONE;
+	}
+	return update_status;
+}
+
+bool get_prop_fast_chg_started(struct smb_charger *chg)
+{
+	if (get_prop_fast_adapter_update(chg)
+			== ADAPTER_FW_NEED_UPDATE)
+		return true;
+
+	if (fast_charger && fast_charger->fast_chg_started)
+		return fast_charger->fast_chg_started();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static bool set_prop_fast_switch_to_normal_false(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->set_switch_to_noraml_false)
+		return fast_charger->set_switch_to_noraml_false();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+bool op_get_fastchg_ing(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->get_fast_chg_ing)
+		return fast_charger->get_fast_chg_ing();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+bool op_set_fast_chg_allow(struct smb_charger *chg, bool enable)
+{
+	if (fast_charger && fast_charger->set_fast_chg_allow)
+		return fast_charger->set_fast_chg_allow(enable);
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static void op_clean_dash_status(void)
+{
+	if (fast_charger && fast_charger->clean)
+		return fast_charger->clean();
+	pr_err("no fast_charger register found\n");
+}
+
+static bool op_get_fast_chg_allow(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->get_fast_chg_allow)
+		return fast_charger->get_fast_chg_allow();
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static bool op_is_usb_switch_on(struct smb_charger *chg)
+{
+	if (fast_charger && fast_charger->is_usb_switch_on)
+		return fast_charger->is_usb_switch_on();
+
+	pr_err("no fast_charger register found\n");
+	return false;
+}
+
+static enum batt_status_type op_battery_status_get(struct smb_charger *chg)
+{
+	return chg->battery_status;
+}
+
+static enum temp_region_type op_battery_temp_region_get(struct smb_charger *chg)
+{
+	return chg->mBattTempRegion;
+}
+
+int fuelgauge_battery_temp_region_get(void)
+{
+	if (!g_chg)
+		return BATT_TEMP_NORMAL;
+
+	return op_battery_temp_region_get(g_chg);
+}
+
+static void op_battery_status_set(struct smb_charger *chg,
+		enum batt_status_type battery_status)
+{
+	chg->battery_status = battery_status;
+}
+
+static void op_battery_temp_region_set(struct smb_charger *chg,
+		enum temp_region_type batt_temp_region)
+{
+	chg->mBattTempRegion = batt_temp_region;
+	pr_err("set temp_region=%d\n", chg->mBattTempRegion);
+}
+
+static void set_prop_batt_health(struct smb_charger *chg, int batt_health)
+{
+	chg->batt_health = batt_health;
+}
+
+static void set_usb_switch(struct smb_charger *chg, bool enable)
+{
+	int retrger_time;
+
+	if (!fast_charger) {
+		pr_err("no fast_charger register found\n");
+		return;
+	}
+
+	if (enable) {
+		pr_err("switch on fastchg\n");
+		chg->switch_on_fastchg = true;
+		if (chg->boot_usb_present && chg->re_trigr_dash_done) {
+			vote(chg->usb_icl_votable, AICL_RERUN_VOTER,
+					true, 0);
+			usleep_range(500000, 510000);
+			vote(chg->usb_icl_votable, USB_PSY_VOTER, false, 0);
+			vote(chg->usb_icl_votable, AICL_RERUN_VOTER,
+					true, DEFAULT_DCP_MA*1000);
+		}
+		set_mcu_en_gpio_value(1);
+		usleep_range(10000, 10002);
+		usb_sw_gpio_set(1);
+		usleep_range(10000, 10002);
+		mcu_en_gpio_set(0);
+		if (chg->boot_usb_present)
+			retrger_time = TIME_3S;
+		else
+			retrger_time = TIME_200MS;
+		if (!chg->re_trigr_dash_done)
+			schedule_delayed_work(&chg->rechk_sw_dsh_work,
+					msecs_to_jiffies(retrger_time));
+	} else {
+		pr_err("switch off fastchg\n");
+		chg->switch_on_fastchg = false;
+		usb_sw_gpio_set(0);
+		mcu_en_gpio_set(1);
+	}
+}
+
+static void switch_fast_chg(struct smb_charger *chg)
+{
+	bool fastchg_allowed, is_allowed;
+	static bool pre_fastchg_allowed, pre_is_allowed;
+
+	mutex_lock(&chg->sw_dash_lock);
+	if (op_is_usb_switch_on(chg)) {
+		mutex_unlock(&chg->sw_dash_lock);
+		return;
+	}
+	if (!is_usb_present(chg)) {
+		mutex_unlock(&chg->sw_dash_lock);
+		return;
+	}
+
+	fastchg_allowed = op_get_fast_chg_allow(chg);
+	if (pre_fastchg_allowed != fastchg_allowed) {
+		pre_fastchg_allowed = fastchg_allowed;
+		pr_info("fastchg_allowed = %d\n", fastchg_allowed);
+	}
+	if (!fastchg_allowed) {
+		is_allowed = is_fastchg_allowed(chg);
+	if (pre_is_allowed != is_allowed) {
+		pre_is_allowed = is_allowed;
+		pr_info("is_allowed = %d\n", is_allowed);
+	}
+		if (is_allowed) {
+			set_usb_switch(chg, true);
+			op_set_fast_chg_allow(chg, true);
+		}
+	}
+	mutex_unlock(&chg->sw_dash_lock);
+}
+
+static void op_re_kick_allowed_voltage(struct smb_charger  *chg)
+{
+	const struct apsd_result *apsd_result;
+
+	if (!is_usb_present(chg))
+		return;
+
+	apsd_result = smblib_get_apsd_result(chg);
+	if (apsd_result->bit == SDP_CHARGER_BIT)
+		return;
+
+	pr_info("re-kick allowed voltage\n");
+	smblib_set_usb_pd_allowed_voltage(chg, MICRO_9V, MICRO_9V);
+	msleep(500);
+	smblib_set_usb_pd_allowed_voltage(chg, MICRO_5V, MICRO_5V);
+}
+
+static void op_re_kick_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			re_kick_work.work);
+
+	if (chg->vbus_present) {
+		op_re_kick_allowed_voltage(chg);
+		schedule_delayed_work(&chg->check_switch_dash_work,
+				msecs_to_jiffies(500));
+	}
+}
+
+static void op_usb_remove_check_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			unplug_check_work.work);
+
+	if (!chg->vbus_present) {
+		chg->ck_unplug_count = 0;
+		return;
+	}
+	if (chg->ck_unplug_count >= 4) {
+		pr_info("op usb remove checked\n");
+		update_dash_unplug_status();
+	} else {
+		chg->ck_unplug_count++;
+		schedule_delayed_work(&chg->unplug_check_work,
+				msecs_to_jiffies(TIME_100MS));
+	}
+}
+
+static void retrigger_dash_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			rechk_sw_dsh_work.work);
+	pr_debug("chg->ck_dash_count=%d\n", chg->ck_dash_count);
+	if (chg->usb_enum_status)
+		return;
+	if (chg->dash_present) {
+		chg->ck_dash_count = 0;
+		return;
+	}
+	if (!chg->vbus_present) {
+		chg->ck_dash_count = 0;
+		return;
+	}
+	if (chg->ck_dash_count >= DASH_CHECK_COUNT) {
+		pr_info("retrger dash\n");
+		chg->re_trigr_dash_done = true;
+		set_usb_switch(chg, false);
+		set_usb_switch(chg, true);
+		chg->ck_dash_count = 0;
+	} else {
+		chg->ck_dash_count++;
+		schedule_delayed_work(&chg->rechk_sw_dsh_work,
+				msecs_to_jiffies(TIME_200MS));
+	}
+}
+
+static void op_chek_apsd_done_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			op_check_apsd_work.work);
+	union power_supply_propval vbus_val;
+	int rc;
+	const struct apsd_result *apsd_result;
+
+	pr_debug("chg->ck_apsd_count=%d\n", chg->ck_apsd_count);
+	if (chg->usb_enum_status || chg->op_apsd_done) {
+		chg->ck_apsd_count = 0;
+		return;
+	}
+	rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+	if (rc < 0) {
+		chg->ck_apsd_count = 0;
+		pr_info("failed to read usb_voltage rc=%d\n", rc);
+		return;
+	}
+	if (vbus_val.intval < 2500) {
+		pr_info("vbus less 2.5v\n");
+		chg->ck_apsd_count = 0;
+		return;
+	}
+	apsd_result = smblib_get_apsd_result(chg);
+	if (apsd_result->bit) {
+		chg->ck_apsd_count = 0;
+		return;
+	}
+
+	if (chg->ck_apsd_count >= APSD_CHECK_COUTNT) {
+		pr_info("apsd done error\n");
+		chg->ck_apsd_count = 0;
+		op_dump_regs(chg);
+		op_rerun_apsd(chg);
+	} else {
+		chg->ck_apsd_count++;
+		schedule_delayed_work(&chg->op_check_apsd_work,
+				msecs_to_jiffies(TIME_1000MS));
+	}
+}
+
+static void op_recovery_usb_suspend_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			recovery_suspend_work.work);
+		int effect_result;
+
+		if (chg->recovery_boost_count >= BOOST_BACK_COUNT
+			|| (!is_usb_present(chg))) {
+			pr_info("recovery revert boost\n");
+			vote(chg->usb_icl_votable, BOOST_BACK_VOTER, false, 0);
+			if (is_usb_present(chg)) {
+				effect_result =
+				get_effective_result(chg->usb_icl_votable);
+				pr_info("effect_result=%d\n", effect_result);
+				if (effect_result
+					> DEFAULT_AGAING_CHG_MA*1000) {
+					vote(chg->usb_icl_votable, DCP_VOTER,
+					true, (effect_result - USBIN_150MA));
+					smblib_rerun_aicl(chg);
+				}
+			}
+			msleep(1000);
+			chg->revert_boost_trigger = false;
+		} else {
+			chg->recovery_boost_count++;
+			schedule_delayed_work(&chg->recovery_suspend_work,
+					msecs_to_jiffies(TIME_100MS));
+		}
+}
+
+static void op_check_allow_switch_dash_work(struct work_struct *work)
+{
+	struct delayed_work *dwork = to_delayed_work(work);
+	struct smb_charger *chg = container_of(dwork,
+			struct smb_charger, check_switch_dash_work);
+	const struct apsd_result *apsd_result;
+
+	if (!is_usb_present(chg))
+		return;
+	if (chg->usb_enum_status)
+		return;
+
+	apsd_result = smblib_get_apsd_result(chg);
+	if (((apsd_result->bit != SDP_CHARGER_BIT
+		&& apsd_result->bit != CDP_CHARGER_BIT)
+		&& apsd_result->bit)
+		|| chg->non_std_chg_present)
+		switch_fast_chg(chg);
+}
+
+int check_allow_switch_dash(struct smb_charger *chg,
+				const union power_supply_propval *val)
+{
+	if (val->intval < 0)
+		return -EINVAL;
+
+	schedule_delayed_work(&chg->check_switch_dash_work,
+				msecs_to_jiffies(500));
+	return 0;
+}
+
+#define DEFAULT_WALL_CHG_MA	1800
+static int set_dash_charger_present(int status)
+{
+	int charger_present;
+	bool pre_dash_present;
+
+	if (g_chg) {
+		pre_dash_present = g_chg->dash_present;
+		charger_present = is_usb_present(g_chg);
+		g_chg->dash_present = status && charger_present;
+		if (g_chg->dash_present && !pre_dash_present) {
+			pr_err("set dash online\n");
+			g_chg->usb_psy_desc.type = POWER_SUPPLY_TYPE_DASH;
+			vote(g_chg->usb_icl_votable, PD_VOTER, true,
+					DEFAULT_WALL_CHG_MA * 1000);
+		}
+		power_supply_changed(g_chg->batt_psy);
+		pr_info("dash_present = %d, charger_present = %d\n",
+				g_chg->dash_present, charger_present);
+	} else {
+		pr_err("set_dash_charger_present error\n");
+	}
+
+	return 0;
+}
+
+static void op_otg_icl_contrl(struct smb_charger *chg)
+{
+	int cap, rc;
+	static int icl_pre, icl;
+
+	if (!chg->OTG_ICL_CTRL)
+		return;
+	cap = get_prop_batt_capacity(chg);
+	if (cap <= chg->OTG_LOW_BAT) {
+		icl =  chg->OTG_LOW_BAT_ICL;
+	} else if (cap > chg->OTG_LOW_BAT
+		&& icl_pre == chg->OTG_LOW_BAT_ICL) {
+		icl =  chg->OTG_NORMAL_BAT_ICL;
+	}
+
+	if (icl_pre == icl)
+		return;
+	pr_info("cap=%d,icl=%d,icl_pre=%d\n", cap, icl, icl_pre);
+	rc = smblib_set_charge_param(chg, &chg->param.otg_cl,
+					icl);
+	if (rc < 0)
+		smblib_err(chg, "Couldn't set otg icl rc=%d\n", rc);
+	icl_pre = icl;
+}
+
+#ifndef CONFIG_OP_DEBUG_CHG
+static void op_check_charge_timeout(struct smb_charger *chg)
+{
+	static int batt_status, count;
+
+	if (chg->chg_done || chg->is_aging_test)
+		return;
+
+	batt_status = get_prop_batt_status(chg);
+	if (chg->vbus_present
+			&& batt_status == POWER_SUPPLY_STATUS_CHARGING)
+		count++;
+	else
+		count = 0;
+
+	if (count > CHG_TIMEOUT_COUNT) {
+		pr_err("chg timeout! stop chaging now\n");
+		op_charging_en(chg, false);
+		chg->time_out = true;
+	}
+}
+#endif
+
+static int get_prop_batt_present(struct smb_charger *chg)
+{
+	int rc;
+	u8 stat;
+
+	rc = smblib_read(chg, BATIF_BASE + INT_RT_STS_OFFSET, &stat);
+	if (rc < 0) {
+		pr_err("Couldn't read BATIF_INT_RT_STS rc=%d\n", rc);
+		return rc;
+	}
+
+	return !(stat & (BAT_THERM_OR_ID_MISSING_RT_STS_BIT
+					| BAT_TERMINAL_MISSING_RT_STS_BIT));
+}
+
+#define DEFAULT_BATT_CAPACITY	50
+static int get_prop_batt_capacity(struct smb_charger *chg)
+{
+	int capacity, rc;
+
+	if (chg->fake_capacity >= 0)
+		return chg->fake_capacity;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_CAPACITY, &capacity);
+	if (rc) {
+		pr_err("Couldn't get capacity rc=%d\n", rc);
+		capacity = DEFAULT_BATT_CAPACITY;
+	}
+
+	return capacity;
+}
+
+#define DEFAULT_BATT_TEMP		200
+static int get_prop_batt_temp(struct smb_charger *chg)
+{
+	int temp, rc;
+
+	if (chg->use_fake_temp)
+		return chg->fake_temp;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_TEMP, &temp);
+	if (rc) {
+		pr_err("Couldn't get temperature rc=%d\n", rc);
+		temp = DEFAULT_BATT_TEMP;
+	}
+
+	return temp;
+}
+
+#define DEFAULT_BATT_CURRENT_NOW	0
+static int get_prop_batt_current_now(struct smb_charger *chg)
+{
+	int ua, rc;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_CURRENT_NOW, &ua);
+	if (rc) {
+		pr_err("Couldn't get current rc=%d\n", rc);
+		ua = DEFAULT_BATT_CURRENT_NOW;
+	}
+
+	return ua;
+}
+
+#define DEFAULT_BATT_VOLTAGE_NOW	0
+static int get_prop_batt_voltage_now(struct smb_charger *chg)
+{
+	int uv, rc;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_VOLTAGE_NOW, &uv);
+	if (rc) {
+		pr_err("Couldn't get voltage rc=%d\n", rc);
+		uv = DEFAULT_BATT_VOLTAGE_NOW;
+	}
+
+	return uv;
+}
+
+static int get_prop_fg_capacity(struct smb_charger *chg)
+{
+	int capacity = 0, rc;
+
+	if (chg->fake_capacity >= 0)
+		return chg->fake_capacity;
+
+	rc = get_property_from_fg(chg,
+		POWER_SUPPLY_PROP_FG_CAPACITY, &capacity);
+	if (rc) {
+		pr_err("Couldn't get capacity rc=%d\n", rc);
+		capacity = DEFAULT_BATT_CAPACITY;
+	}
+
+	return capacity;
+}
+
+static int get_prop_fg_current_now(struct smb_charger *chg)
+{
+	int ua = 0, rc;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_FG_CURRENT_NOW, &ua);
+	if (rc) {
+		pr_err("Couldn't get current rc=%d\n", rc);
+		ua = DEFAULT_BATT_CURRENT_NOW;
+	}
+
+	return ua;
+}
+
+static int get_prop_fg_voltage_now(struct smb_charger *chg)
+{
+	int uv, rc;
+
+	rc = get_property_from_fg(chg, POWER_SUPPLY_PROP_FG_VOLTAGE_NOW, &uv);
+	if (rc) {
+		pr_err("Couldn't get voltage rc=%d\n", rc);
+		uv = DEFAULT_BATT_VOLTAGE_NOW;
+	}
+
+	return uv;
+}
+
+int get_prop_batt_status(struct smb_charger *chg)
+{
+	int capacity, batt_status, rc;
+	enum temp_region_type temp_region;
+	union power_supply_propval pval = {0, };
+
+	temp_region = op_battery_temp_region_get(chg);
+	capacity = get_prop_batt_capacity(chg);
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if ((chg->chg_done || chg->recharge_status)
+			&& (temp_region == BATT_TEMP_COOL
+			|| temp_region == BATT_TEMP_LITTLE_COOL
+			|| temp_region == BATT_TEMP_PRE_NORMAL
+			|| temp_region == BATT_TEMP_NORMAL)
+			&&	capacity == 100) {
+		return POWER_SUPPLY_STATUS_FULL;
+	} else if (chg->dash_on) {
+		return POWER_SUPPLY_STATUS_CHARGING;
+	}
+	if (chg->revert_boost_trigger && chg->vbus_present)
+		return POWER_SUPPLY_STATUS_CHARGING;
+
+	rc = smblib_get_prop_batt_status(chg, &pval);
+	if (rc)
+		batt_status = 0;
+	else
+		batt_status = pval.intval;
+
+	return batt_status;
+}
+
+int get_charging_status(void)
+{
+	int rc;
+	union power_supply_propval pval = {0, };
+
+	if (!g_chg)
+		return POWER_SUPPLY_STATUS_DISCHARGING;
+
+	rc = smblib_get_prop_batt_status(g_chg, &pval);
+	if (rc)
+		return POWER_SUPPLY_STATUS_UNKNOWN;
+
+	return pval.intval;
+}
+
+void set_chg_ibat_vbat_max(
+	struct smb_charger *chg, int ibat, int vfloat)
+{
+	pr_err("set ibatmax=%d and set vbatmax=%d\n",
+			ibat, vfloat);
+	if (chg->ffc_status != FFC_DEFAULT)
+		return;
+	vote(chg->fcc_votable,
+		DEFAULT_VOTER, true, ibat * 1000);
+	vote(chg->fv_votable,
+		DEFAULT_VOTER, true, vfloat * 1000);
+
+	/* set cc to cv 100mv lower than vfloat */
+	set_property_on_fg(chg, POWER_SUPPLY_PROP_CC_TO_CV_POINT, vfloat - 100);
+}
+
+static void op_temp_region_charging_en(struct smb_charger *chg, int vbatmax)
+{
+	int vbat_mv = 0;
+
+	vbat_mv = get_prop_batt_voltage_now(chg) / 1000;
+	pr_info("%s vbat_mv =%d\n", __func__, vbat_mv);
+	if (vbat_mv < vbatmax)
+		return;
+	op_charging_en(chg, false);
+	chg->chg_done = true;
+}
+
+/* Tbatt < -3C */
+static int handle_batt_temp_cold(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_COLD || chg->is_power_changed) {
+		pr_err("triggered\n");
+		chg->is_power_changed = false;
+
+		op_charging_en(chg, false);
+		op_battery_temp_region_set(chg, BATT_TEMP_COLD);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0 + BATT_TEMP_HYST;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_COLD);
+	}
+
+	return 0;
+}
+
+/* -3C <= Tbatt <= 0C */
+static int handle_batt_temp_little_cold(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_LITTLE_COLD
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->recharge_pending = false;
+		chg->is_power_changed = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+
+		op_temp_region_charging_en(chg,
+				chg->vbatmax[BATT_TEMP_LITTLE_COLD]);
+		set_chg_ibat_vbat_max(chg,
+				chg->ibatmax[BATT_TEMP_LITTLE_COLD],
+				chg->vbatmax[BATT_TEMP_LITTLE_COLD]);
+		op_battery_temp_region_set(chg, BATT_TEMP_LITTLE_COLD);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1 + BATT_TEMP_HYST;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+
+/* 0C < Tbatt <= 5C*/
+static int handle_batt_temp_cool(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+	int  vbat_mv;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_COOL
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->recharge_pending = false;
+		chg->is_power_changed = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+
+		vbat_mv = get_prop_batt_voltage_now(chg) / 1000;
+		if (vbat_mv > chg->temp_cool_voltage) {
+			set_chg_ibat_vbat_max(chg, chg->temp_cool_current,
+					chg->vbatmax[BATT_TEMP_COOL]);
+			chg->temp_littel_cool_set_current_0_point_25c = false;
+		} else {
+			set_chg_ibat_vbat_max(chg,
+					chg->ibatmax[BATT_TEMP_COOL],
+					chg->vbatmax[BATT_TEMP_COOL]);
+			chg->temp_littel_cool_set_current_0_point_25c = true;
+		}
+		op_battery_temp_region_set(chg, BATT_TEMP_COOL);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2 + BATT_TEMP_HYST;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+/* 5C < Tbatt <= 12C */
+static int handle_batt_temp_little_cool(struct smb_charger *chg)
+{
+	int temp_region, vbat_mv;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_LITTLE_COOL
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->recharge_pending = false;
+		chg->is_power_changed = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+
+		vbat_mv = get_prop_batt_voltage_now(chg) / 1000;
+		if (vbat_mv > chg->temp_littel_cool_voltage) {
+			set_chg_ibat_vbat_max(chg, chg->temp_littel_cool_current,
+					chg->vbatmax[BATT_TEMP_LITTLE_COOL]);
+			chg->temp_littel_cool_set_current_0_point_25c = false;
+		} else {
+			set_chg_ibat_vbat_max(chg,
+					chg->ibatmax[BATT_TEMP_LITTLE_COOL],
+					chg->vbatmax[BATT_TEMP_LITTLE_COOL]);
+			chg->temp_littel_cool_set_current_0_point_25c = true;
+		}
+		op_battery_temp_region_set(chg, BATT_TEMP_LITTLE_COOL);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3 + BATT_TEMP_HYST;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+
+/* 12C < Tbatt < 22C */
+static int handle_batt_temp_prenormal(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region != BATT_TEMP_PRE_NORMAL
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->recharge_pending = false;
+		chg->is_power_changed = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+
+		set_chg_ibat_vbat_max(chg,
+				chg->ibatmax[BATT_TEMP_PRE_NORMAL],
+				chg->vbatmax[BATT_TEMP_PRE_NORMAL]);
+		op_battery_temp_region_set(chg, BATT_TEMP_PRE_NORMAL);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4 + BATT_TEMP_HYST;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+
+/* 15C < Tbatt < 45C */
+static int handle_batt_temp_normal(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if ((temp_region != BATT_TEMP_NORMAL)
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->recharge_pending = false;
+		chg->is_power_changed = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+
+		set_chg_ibat_vbat_max(chg,
+				chg->ibatmax[BATT_TEMP_NORMAL],
+				chg->vbatmax[BATT_TEMP_NORMAL]);
+		op_battery_temp_region_set(chg, BATT_TEMP_NORMAL);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+
+/* 45C <= Tbatt <= 55C */
+static int handle_batt_temp_warm(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	if (chg->chg_ovp)
+		return 0;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if ((temp_region != BATT_TEMP_WARM)
+			|| chg->is_power_changed || chg->recharge_pending) {
+		pr_err("triggered\n");
+		chg->is_power_changed = false;
+		chg->recharge_pending = false;
+
+		if (temp_region == BATT_TEMP_HOT ||
+				temp_region == BATT_TEMP_COLD)
+			op_charging_en(chg, true);
+		op_temp_region_charging_en(chg,
+				chg->vbatmax[BATT_TEMP_WARM]);
+		set_chg_ibat_vbat_max(chg,
+				chg->ibatmax[BATT_TEMP_WARM],
+				chg->vbatmax[BATT_TEMP_WARM]);
+		op_battery_temp_region_set(chg, BATT_TEMP_WARM);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5 - BATT_TEMP_HYST;
+		chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+	}
+
+	return 0;
+}
+
+/* 55C < Tbatt */
+static int handle_batt_temp_hot(struct smb_charger *chg)
+{
+	enum temp_region_type temp_region;
+
+	temp_region = op_battery_temp_region_get(chg);
+	if ((temp_region != BATT_TEMP_HOT)
+			|| chg->is_power_changed) {
+		pr_err("triggered\n");
+		chg->is_power_changed = false;
+		op_charging_en(chg, false);
+		op_battery_temp_region_set(chg, BATT_TEMP_HOT);
+
+		/* Update the temperature boundaries */
+		chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+		chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+		chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+		chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+		chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+		chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+		chg->mBattTempBoundT6 =
+			chg->BATT_TEMP_T6 - BATT_TEMP_HYST;
+		/* from hot to warm */
+		set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_OVERHEAT);
+	}
+
+	return 0;
+}
+
+static int op_check_battery_temp(struct smb_charger *chg)
+{
+	int temp, rc = -1;
+
+	if (!chg->vbus_present)
+		return rc;
+
+	temp = get_prop_batt_temp(chg);
+	if (temp < chg->mBattTempBoundT0) /* COLD */
+		rc = handle_batt_temp_cold(chg);
+	else if (temp >=  chg->mBattTempBoundT0 &&
+			temp < chg->mBattTempBoundT1) /* LITTLE_COLD */
+		rc = handle_batt_temp_little_cold(chg);
+	else if (temp >=  chg->mBattTempBoundT1 &&
+			temp < chg->mBattTempBoundT2) /* COOL */
+		rc = handle_batt_temp_cool(chg);
+	else if (temp >= chg->mBattTempBoundT2 &&
+			temp < chg->mBattTempBoundT3) /* LITTLE_COOL */
+		rc = handle_batt_temp_little_cool(chg);
+	else if (temp >= chg->mBattTempBoundT3 &&
+			temp < chg->mBattTempBoundT4) /* PRE_NORMAL */
+		rc = handle_batt_temp_prenormal(chg);
+	else if (temp >= chg->mBattTempBoundT4 &&
+			temp < chg->mBattTempBoundT5) /* NORMAL */
+		rc = handle_batt_temp_normal(chg);
+	else if (temp >= chg->mBattTempBoundT5 &&
+			temp <=  chg->mBattTempBoundT6) /* WARM */
+		rc = handle_batt_temp_warm(chg);
+	else if (temp > chg->mBattTempBoundT6) /* HOT */
+		rc = handle_batt_temp_hot(chg);
+
+	return rc;
+}
+
+void op_charge_info_init(struct smb_charger *chg)
+{
+	op_battery_temp_region_set(chg, BATT_TEMP_NORMAL);
+
+	chg->mBattTempBoundT0 = chg->BATT_TEMP_T0;
+	chg->mBattTempBoundT1 = chg->BATT_TEMP_T1;
+	chg->mBattTempBoundT2 = chg->BATT_TEMP_T2;
+	chg->mBattTempBoundT3 = chg->BATT_TEMP_T3;
+	chg->mBattTempBoundT4 = chg->BATT_TEMP_T4;
+	chg->mBattTempBoundT5 = chg->BATT_TEMP_T5;
+	chg->mBattTempBoundT6 = chg->BATT_TEMP_T6;
+	chg->chg_ovp = false;
+	chg->is_power_changed = false;
+	chg->chg_done = false;
+	chg->recharge_pending = false;
+	chg->recharge_status = false;
+	chg->temp_littel_cool_set_current_0_point_25c = false;
+	chg->oem_lcd_is_on = false;
+	chg->time_out = false;
+	chg->battery_status = BATT_STATUS_GOOD;
+	chg->disable_normal_chg_for_dash = false;
+	chg->usb_enum_status = false;
+	chg->non_std_chg_present = false;
+	chg->is_audio_adapter = false;
+	chg->init_irq_done = false;
+}
+
+static int op_handle_battery_uovp(struct smb_charger *chg)
+{
+	pr_err("vbat is over voltage, stop charging\n");
+	set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_OVERVOLTAGE);
+	op_charging_en(chg, false);
+
+	return 0;
+}
+
+static int op_handle_battery_restore_from_uovp(struct smb_charger *chg)
+{
+	pr_err("vbat is back to normal, start charging\n");
+	/* restore charging form battery ovp */
+	op_charging_en(chg, true);
+	set_prop_batt_health(chg, POWER_SUPPLY_HEALTH_GOOD);
+
+	return 0;
+}
+
+static void op_check_battery_uovp(struct smb_charger *chg)
+{
+	int vbat_mv = 0;
+	enum batt_status_type battery_status_pre;
+
+	if (!chg->vbus_present)
+		return;
+
+	battery_status_pre = op_battery_status_get(chg);
+	vbat_mv = get_prop_batt_voltage_now(chg) / 1000;
+	pr_debug("bat vol:%d\n", vbat_mv);
+	if (vbat_mv > BATT_SOFT_OVP_MV) {
+		if (battery_status_pre == BATT_STATUS_GOOD) {
+			pr_err("BATTERY_SOFT_OVP_VOLTAGE\n");
+			op_battery_status_set(chg, BATT_STATUS_BAD);
+			op_handle_battery_uovp(chg);
+		}
+	} else {
+		if (battery_status_pre == BATT_STATUS_BAD) {
+			pr_err("battery_restore_from_uovp\n");
+			op_battery_status_set(chg, BATT_STATUS_GOOD);
+			op_handle_battery_restore_from_uovp(chg);
+		}
+	}
+
+}
+int op_get_charg_en(struct smb_charger *chg, int *chg_enabled)
+{
+	int rc = 0;
+	u8 temp;
+
+	rc = smblib_read(chg, CHARGING_ENABLE_CMD_REG, &temp);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read chg en rc=%d\n", rc);
+		return rc;
+	}
+	*chg_enabled = temp & CHARGING_ENABLE_CMD_BIT;
+
+	return rc;
+}
+
+static void op_check_charger_collapse(struct smb_charger *chg)
+{
+	int rc, is_usb_supend, curr, chg_en;
+	u8 stat = 0, chger_stat = 0, pwer_source_stats = 0;
+
+	if (!chg->vbus_present)
+		return;
+	if (chg->dash_present)
+		return;
+	rc = smblib_read(chg, BATTERY_CHARGER_STATUS_1_REG, &chger_stat);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read POWER_PATH_STATUS rc=%d\n",
+			rc);
+	}
+	rc = smblib_read(chg, POWER_PATH_STATUS_REG, &pwer_source_stats);
+	if (rc < 0) {
+		smblib_err(chg, "Couldn't read AICL_STATUS_REG rc=%d\n",
+			rc);
+	}
+	smblib_get_usb_suspend(chg, &is_usb_supend);
+	op_get_charg_en(chg, &chg_en);
+	pr_debug("chger_stat=0x%x, aicl_stats =0x%x, chg_en =%d\n",
+		chger_stat, pwer_source_stats, chg_en);
+	curr = get_prop_batt_current_now(chg) / 1000;
+	stat = !chg->chg_done
+			&& !is_usb_supend
+			&& (curr > 20)
+			&& chg_en
+			&& ((ZERO_CHARGE_CURRENT_BIT & chger_stat)
+				|| (pwer_source_stats == 0x72));
+
+	if (stat && !chg->charger_collpse) {
+		rc = smblib_masked_write(chg, USBIN_AICL_OPTIONS_CFG_REG,
+		SUSPEND_ON_COLLAPSE_USBIN_BIT
+		|USBIN_AICL_START_AT_MAX_BIT
+		| USBIN_AICL_ADC_EN_BIT
+		|USBIN_AICL_PERIODIC_RERUN_EN_BIT, USBIN_AICL_PERIODIC_RERUN_EN_BIT);
+		if (rc < 0)
+			dev_err(chg->dev,
+			"Couldn't configure AICL rc=%d\n", rc);
+	smblib_rerun_aicl(chg);
+	chg->charger_collpse = true;
+	schedule_delayed_work(&chg->op_re_set_work,
+				msecs_to_jiffies(TIME_1000MS));
+	smblib_err(chg, "op_check_charger_collapse done\n");
+	}
+}
+
+static void op_check_charger_uovp(struct smb_charger *chg, int vchg_mv)
+{
+	static int over_volt_count, not_over_volt_count;
+	static bool uovp_satus, pre_uovp_satus;
+	int detect_time = 3; /* 3 x 6s = 18s */
+
+	if (!chg->vbus_present)
+		return;
+
+	pr_debug("charger_voltage=%d charger_ovp=%d\n", vchg_mv, chg->chg_ovp);
+
+	if (!chg->chg_ovp) {
+		if (vchg_mv > CHG_SOFT_OVP_MV || vchg_mv <= CHG_SOFT_UVP_MV) {
+			pr_err("charger is over voltage, count=%d\n",
+				over_volt_count);
+			uovp_satus = true;
+			if (pre_uovp_satus)
+				over_volt_count++;
+			else
+				over_volt_count = 0;
+
+			pr_err("uovp_satus=%d,pre_uovp_satus=%d,over_volt_count=%d\n",
+				uovp_satus, pre_uovp_satus, over_volt_count);
+			if (detect_time <= over_volt_count) {
+				/* vchg continuous higher than 5.8v */
+				pr_err("charger is over voltage, stop charging\n");
+				op_charging_en(chg, false);
+				chg->chg_ovp = true;
+			}
+		}
+	} else {
+		if (vchg_mv < CHG_SOFT_OVP_MV - 100
+				&& vchg_mv > CHG_SOFT_UVP_MV + 100) {
+			uovp_satus = false;
+			if (!pre_uovp_satus)
+				not_over_volt_count++;
+			else
+				not_over_volt_count = 0;
+
+			pr_err("uovp_satus=%d, pre_uovp_satus=%d,not_over_volt_count=%d\n",
+				uovp_satus, pre_uovp_satus,
+					not_over_volt_count);
+			if (detect_time <= not_over_volt_count) {
+				/* vchg continuous lower than 5.7v */
+				pr_err("charger voltage is back to normal\n");
+				op_charging_en(chg, true);
+				chg->chg_ovp = false;
+				op_check_battery_temp(chg);
+				smblib_rerun_aicl(chg);
+			}
+		}
+	}
+	pre_uovp_satus = uovp_satus;
+}
+
+#if defined(CONFIG_FB)
+static int fb_notifier_callback(struct notifier_block *self,
+		unsigned long event, void *data)
+{
+	struct fb_event *evdata = data;
+	int *blank;
+	struct smb_charger *chip =
+		container_of(self, struct smb_charger, fb_notif);
+
+	if (evdata && evdata->data && chip) {
+		if (event == FB_EVENT_BLANK) {
+			blank = evdata->data;
+			if (*blank == FB_BLANK_UNBLANK) {
+				if (!chip->oem_lcd_is_on)
+					set_property_on_fg(chip,
+					POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF, 0);
+				chip->oem_lcd_is_on = true;
+			} else if (*blank == FB_BLANK_POWERDOWN) {
+				if (chip->oem_lcd_is_on != false)
+					set_property_on_fg(chip,
+					POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF, 1);
+				chip->oem_lcd_is_on = false;
+			}
+		}
+
+	}
+
+	return 0;
+}
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+static int msm_drm_notifier_callback(struct notifier_block *self,
+		unsigned long event, void *data)
+{
+	struct msm_drm_notifier *evdata = data;
+	struct smb_charger *chip =
+		container_of(self, struct smb_charger, msm_drm_notifier);
+	int *blank;
+	int typec_mode;
+	int rp_ua;
+
+	if (evdata->id != MSM_DRM_PRIMARY_DISPLAY)
+		return 0;
+	if (event != MSM_DRM_EARLY_EVENT_BLANK)
+		return 0;
+
+	typec_mode = smblib_get_prop_typec_mode(chip);
+
+	if (evdata && evdata->data && chip) {
+		blank = evdata->data;
+		if (*blank == MSM_DRM_BLANK_UNBLANK) {
+			if (!chip->oem_lcd_is_on)
+				set_property_on_fg(chip,
+				POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF, 0);
+			chip->oem_lcd_is_on = true;
+		} else if (*blank == MSM_DRM_BLANK_POWERDOWN) {
+			if (chip->oem_lcd_is_on != false)
+				set_property_on_fg(chip,
+				POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF, 1);
+			chip->oem_lcd_is_on = false;
+		}
+		/* add to set pd charging current 2.0A when panel on */
+		if (typec_mode == POWER_SUPPLY_TYPEC_SOURCE_HIGH) {
+			rp_ua = get_rp_based_dcp_current(chip, typec_mode);
+			vote(chip->usb_icl_votable,
+					SW_ICL_MAX_VOTER, true, rp_ua);
+		}
+	}
+
+	return 0;
+}
+#endif
+
+static void ffc_exit(struct smb_charger *chg) {
+	int icharging, batt_volt, temp;
+
+	if (chg->ffc_status == FFC_DEFAULT) {
+		chg->ffc_count = 0;
+		return;
+	}
+	batt_volt = get_prop_batt_voltage_now(chg) / 1000;
+	icharging = get_prop_batt_current_now(chg) / 1000;
+	temp = get_prop_batt_temp(chg);
+
+	if (chg->ffc_status == FFC_NOR_TAPER
+		|| chg->ffc_status == FFC_WARM_TAPER) {
+		if (temp > chg->FFC_TEMP_T1
+			&& temp < chg->FFC_TEMP_T2) {
+			chg->ffc_status = FFC_NOR_TAPER;
+			vote(g_chg->fcc_votable,
+				DEFAULT_VOTER, true, chg->FFC_NOR_FCC * 1000);
+		} else if (temp >= chg->FFC_TEMP_T2
+			&& temp < chg->FFC_TEMP_T3) {
+			chg->ffc_status = FFC_WARM_TAPER;
+			vote(g_chg->fcc_votable,
+				DEFAULT_VOTER, true, chg->FFC_WARM_FCC * 1000);
+		} else {
+			chg->ffc_count = 0;
+			chg->ffc_status = FFC_IDLE;
+		}
+	}
+
+	if (chg->ffc_status == FFC_FAST) {
+		if (batt_volt >= chg->FFC_VBAT_FULL)
+			chg->ffc_count++;
+		else
+			chg->ffc_count = 0;
+		if (chg->ffc_count >= 2) {
+			chg->ffc_count = 0;
+			chg->ffc_status = FFC_TAPER;
+			pr_info("ffc one done\n");
+		}
+	} else if (chg->ffc_status == FFC_TAPER) {
+			if (temp > chg->FFC_TEMP_T1
+				&& temp < chg->FFC_TEMP_T2) {
+				chg->ffc_status = FFC_NOR_TAPER;
+				vote(g_chg->fcc_votable,
+					DEFAULT_VOTER, true, chg->FFC_NOR_FCC * 1000);
+			} else if (temp >= chg->FFC_TEMP_T2
+				&& temp < chg->FFC_TEMP_T3) {
+				chg->ffc_status = FFC_WARM_TAPER;
+				vote(g_chg->fcc_votable,
+					DEFAULT_VOTER, true, chg->FFC_WARM_FCC * 1000);
+			} else {
+				chg->ffc_count = 0;
+				chg->ffc_status = FFC_IDLE;
+			}
+	} else if (chg->ffc_status == FFC_NOR_TAPER) {
+			if (icharging <= (-1)*chg->FFC_NORMAL_CUTOFF
+				&& (batt_volt >= chg->FFC_VBAT_FULL)) {
+					chg->ffc_count = 0;
+					chg->ffc_status = FFC_IDLE;
+			} else if (icharging > (-1)*chg->FFC_NORMAL_CUTOFF)
+				chg->ffc_count++;
+			else
+				chg->ffc_count = 0;
+			if (chg->ffc_count >= 2) {
+				chg->ffc_count = 0;
+				chg->ffc_status = FFC_IDLE;
+				pr_info("ffc nor taper done\n");
+			}
+	} else if (chg->ffc_status == FFC_WARM_TAPER) {
+			if (icharging <= (-1)*chg->FFC_WARM_CUTOFF
+				&& (batt_volt >= chg->FFC_VBAT_FULL)) {
+					chg->ffc_count = 0;
+					chg->ffc_status = FFC_IDLE;
+			} else if (icharging > (-1)*chg->FFC_WARM_CUTOFF)
+				chg->ffc_count++;
+			else
+				chg->ffc_count = 0;
+			if (chg->ffc_count >= 2) {
+				chg->ffc_count = 0;
+				chg->ffc_status = FFC_IDLE;
+				pr_info("ffc normal taper done\n");
+			}
+	} else if (chg->ffc_status == FFC_IDLE) {
+		chg->ffc_count++;
+		op_charging_en(chg, false);
+		if (chg->ffc_count > 2) {
+			chg->ffc_status = FFC_DEFAULT;
+			smblib_set_prop_charge_parameter_set(chg);
+			op_charging_en(chg, true);
+		}
+	} else {
+			chg->ffc_count = 0;
+			chg->ffc_status = FFC_DEFAULT;
+	}
+}
+
+#define FULL_COUNTS_SW		5
+#define FULL_COUNTS_HW		3
+
+static bool op_check_vbat_is_full_by_sw(struct smb_charger *chg)
+{
+	static bool ret_sw;
+	static bool ret_hw;
+	static int vbat_counts_sw;
+	static int vbat_counts_hw;
+	int vbatt_full_vol_sw;
+	int vbatt_full_vol_hw;
+	int tbatt_status, icharging, batt_volt;
+
+	if (!chg->check_batt_full_by_sw)
+		return false;
+	if (chg->ffc_status != FFC_DEFAULT)
+		return false;
+	if (!chg->vbus_present) {
+		vbat_counts_sw = 0;
+		vbat_counts_hw = 0;
+		ret_sw = false;
+		ret_hw = false;
+		return false;
+	}
+
+	tbatt_status = op_battery_temp_region_get(chg);
+	vbatt_full_vol_hw = chg->vbatmax[tbatt_status];
+	if (tbatt_status == BATT_TEMP_LITTLE_COLD)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else if (tbatt_status == BATT_TEMP_COOL)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else if (tbatt_status == BATT_TEMP_LITTLE_COOL)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else if (tbatt_status == BATT_TEMP_PRE_NORMAL)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else if (tbatt_status == BATT_TEMP_NORMAL)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else if (tbatt_status == BATT_TEMP_WARM)
+		vbatt_full_vol_sw = chg->vbatmax[tbatt_status] - 70;
+	else {
+		vbat_counts_sw = 0;
+		vbat_counts_hw = 0;
+		ret_sw = 0;
+		ret_hw = 0;
+		return false;
+	}
+
+	batt_volt = get_prop_batt_voltage_now(chg) / 1000;
+	icharging = get_prop_batt_current_now(chg) / 1000;
+	/* use SW Vfloat to check */
+	if (batt_volt > vbatt_full_vol_sw) {
+		if (icharging < 0 && (icharging * -1) <= chg->sw_iterm_ma) {
+			vbat_counts_sw++;
+			if (vbat_counts_sw > FULL_COUNTS_SW) {
+				vbat_counts_sw = 0;
+				ret_sw = true;
+			}
+		} else if (icharging >= 0) {
+			vbat_counts_sw++;
+			if (vbat_counts_sw > FULL_COUNTS_SW * 2) {
+				vbat_counts_sw = 0;
+				ret_sw = true;
+				pr_info("[BATTERY] Battery full by sw when icharging>=0!!\n");
+			}
+		} else {
+			vbat_counts_sw = 0;
+			ret_sw = false;
+		}
+	} else {
+		vbat_counts_sw = 0;
+		ret_sw = false;
+	}
+
+	/* use HW Vfloat to check */
+	if (batt_volt >= vbatt_full_vol_hw + 18) {
+		vbat_counts_hw++;
+		if (vbat_counts_hw >= FULL_COUNTS_HW) {
+			vbat_counts_hw = 0;
+			ret_hw = true;
+		}
+	} else {
+		vbat_counts_hw = 0;
+		ret_hw = false;
+	}
+
+	if (ret_sw == true || ret_hw == true) {
+		pr_info("[BATTERY] Battery full by sw[%s] !!\n",
+			(ret_sw == true) ? "S" : "H");
+		ret_sw = ret_hw = false;
+		return true;
+	} else {
+		return false;
+	}
+}
+
+void checkout_term_current(struct smb_charger *chg)
+{
+	bool chg_full;
+
+	if (chg->chg_done)
+		return;
+	chg_full = op_check_vbat_is_full_by_sw(chg);
+	if (chg_full) {
+		chg->chg_done = true;
+		op_charging_en(chg, false);
+		pr_info("chg_done:CAP=%d (Q:%d),VBAT=%d (Q:%d),IBAT=%d (Q:%d),BAT_TEMP=%d\n",
+				get_prop_batt_capacity(chg),
+				get_prop_fg_capacity(chg),
+				get_prop_batt_voltage_now(chg) / 1000,
+				get_prop_fg_voltage_now(chg) / 1000,
+				get_prop_batt_current_now(chg) / 1000,
+				get_prop_fg_current_now(chg) / 1000,
+				get_prop_batt_temp(chg));
+	}
+}
+
+/*
+static int usb_enum_check(const char *val, struct kernel_param *kp)
+{
+	const struct apsd_result *apsd_result;
+	struct smb_charger *chg = g_chg;
+	unsigned long usb_sw_reset = 0;
+	int ret = 0;
+
+	if (chg->usb_enum_status)
+		return 0;
+
+	ret = kstrtoul(val, 10, &usb_sw_reset);
+	if (ret)
+		return ret;
+
+	if (!usb_sw_reset || !is_usb_present(chg))
+		return 0;
+
+	apsd_result = smblib_get_apsd_result(chg);
+	if (apsd_result->bit != SDP_CHARGER_BIT)
+		return 0;
+
+	pr_info("usb don't enum for longtime in boot\n");
+	op_handle_usb_removal(chg);
+	chg->non_stand_chg_count = 0;
+	schedule_delayed_work(
+		&chg->non_standard_charger_check_work,
+		msecs_to_jiffies(TIME_1000MS));
+
+	return 0;
+}
+module_param_call(sys_boot_complete, usb_enum_check, NULL, NULL, 0644);
+MODULE_PARM_DESC(sys_boot_complete, "sys_boot_complete");
+*/
+static void check_non_standard_charger_work(struct work_struct *work)
+{
+	struct delayed_work *dwork = to_delayed_work(work);
+	struct smb_charger *chg = container_of(dwork,
+	struct smb_charger, non_standard_charger_check_work);
+
+	bool charger_present;
+	const struct apsd_result *apsd_result;
+	int aicl_result, rc;
+
+	pr_debug("chg->non_stand_chg_count=%d\n",
+		chg->non_stand_chg_count);
+	return;
+	charger_present = is_usb_present(chg);
+	if (!charger_present) {
+		pr_info("chk_non_std_chger,charger_present\n");
+		chg->non_stand_chg_count = 0;
+		return;
+	}
+	if (chg->usb_enum_status) {
+		pr_info("chk_non_std_chger,usb_enum_status\n");
+		chg->non_stand_chg_count = 0;
+		return;
+	}
+	if (chg->non_stand_chg_count
+		>= NON_STANDARD_CHARGER_CHECK_S) {
+		apsd_result = smblib_update_usb_type(chg);
+		if (apsd_result->bit == DCP_CHARGER_BIT
+			|| apsd_result->bit == OCP_CHARGER_BIT)
+			return;
+		rc = smblib_rerun_aicl(chg);
+		if (rc < 0)
+			smblib_err(chg, "Couldn't re-run AICL rc=%d\n", rc);
+		msleep(500);
+		aicl_result = op_get_aicl_result(chg);
+		chg->non_stand_chg_current = aicl_result;
+		chg->usb_psy_desc.type = POWER_SUPPLY_TYPE_USB_DCP;
+		if (chg->is_aging_test)
+			op_usb_icl_set(chg, DEFAULT_AGAING_CHG_MA*1000);
+		else if (aicl_result >= 700*1000)
+			op_usb_icl_set(chg, aicl_result - 200*1000);
+		else
+			op_usb_icl_set(chg, 1200*1000);
+		power_supply_changed(chg->batt_psy);
+		chg->is_power_changed = true;
+		chg->non_std_chg_present = true;
+		pr_err("non-standard_charger detected,aicl_result=%d\n",
+			aicl_result);
+	} else {
+		chg->non_stand_chg_count++;
+		schedule_delayed_work(
+			&chg->non_standard_charger_check_work,
+			msecs_to_jiffies(TIME_1000MS));
+	}
+}
+
+static void smbchg_re_det_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			re_det_work.work);
+
+	pr_debug("chg->redet_count=%d\n", chg->redet_count);
+	if (chg->usb_enum_status) {
+		pr_info("re_det, usb_enum_status\n");
+		chg->redet_count = 0;
+		return;
+	}
+	if (!chg->vbus_present) {
+		pr_info("re_det, vbus_no_present\n");
+		chg->redet_count = 0;
+		return;
+	}
+
+	if (chg->redet_count >= REDET_COUTNT) {
+		op_rerun_apsd(chg);
+		chg->usb_type_redet_done = true;
+	} else {
+		chg->redet_count++;
+		schedule_delayed_work(&chg->re_det_work,
+				msecs_to_jiffies(TIME_1000MS));
+	}
+}
+
+static void op_recovery_set_work(struct work_struct *work)
+{
+	struct smb_charger *chg = container_of(work,
+			struct smb_charger,
+			op_re_set_work.work);
+	int rc = 0;
+
+	pr_debug("chg->reset_count=%d\n", chg->reset_count);
+	if (!chg->charger_collpse) {
+		chg->reset_count = 0;
+		return;
+	}
+	if (!chg->vbus_present) {
+		chg->reset_count = 0;
+		return;
+	}
+
+	if (chg->reset_count >= 13) {
+
+		pr_err("op_set_collapse_fet\n");
+		rc = smblib_write(chg, USBIN_AICL_OPTIONS_CFG_REG, 0xc7);
+		if (rc < 0)
+			smblib_err(chg,
+			"Couldn't enable OTG regulator rc=%d\n", rc);
+		chg->charger_collpse = false;
+		chg->reset_count = 0;
+	} else {
+		chg->reset_count++;
+		schedule_delayed_work(&chg->op_re_set_work,
+				msecs_to_jiffies(TIME_1000MS));
+	}
+}
+
+void aging_test_check_aicl(struct smb_charger *chg)
+{
+	int aicl_result = 0, vbat = 0;
+
+	if (chg->usb_enum_status)
+		return;
+	vbat = get_prop_fg_voltage_now(chg) / 1000;
+	aicl_result = op_get_aicl_result(chg);
+	if (aicl_result < 800*1000) {
+		if (vbat < 4000) {
+			pr_info("set icl 900mA\n");
+			vote(chg->usb_icl_votable, AICL_RERUN_VOTER,
+				true, 900*1000);
+			vote(chg->usb_icl_votable, AICL_RERUN_VOTER, false, 0);
+		}
+	}
+}
+
+static int get_usb_temp(struct smb_charger *chg)
+{
+	int ret, i, result, temp, step_value;
+
+	if (chg->iio.op_connector_temp_chan) {
+		ret = iio_read_channel_processed(
+				chg->iio.op_connector_temp_chan,
+				&result);
+		chg->connecter_voltage = result/1000;
+	} else {
+		pr_err("op_connector_temp_chan no found!\n");
+		return -ENODATA;
+	}
+	for (i = ARRAY_SIZE(con_volt_30k) - 1; i >= 0; i--) {
+		if (con_volt_30k[i] >= chg->connecter_voltage)
+			break;
+		else if (i == 0)
+			break;
+	}
+
+	smblib_dbg(chg, PR_FAST_DEBUG, "connecter(vol:%d,temp:%d),Ibatt:%d,batt_temp:%d\n",
+				chg->connecter_voltage, con_temp_30k[i],
+				get_prop_batt_current_now(chg) / 1000,
+				get_prop_batt_temp(chg) / 10);
+
+	temp = con_temp_30k[i];
+	step_value = temp - chg->connecter_temp;
+
+	/*WR for temperature value(70~85) and steep filter, use last value*/
+	if (((temp >= 70) && (temp <= 85)) || (step_value >= 10)) {
+		chg->filter_count++;
+		if (chg->filter_count <= 3) {
+			pr_info("con_temp=(%d) pre_temp=(%d) filter_count(%d),filter not report!\n",
+				temp,
+				chg->connecter_temp,
+				chg->filter_count);
+			return chg->connecter_temp;
+		}
+		chg->filter_count = 0;
+	} else
+		chg->filter_count = 0;
+
+	return con_temp_30k[i];
+}
+
+void op_disconnect_vbus(struct smb_charger *chg, bool enable)
+{
+#ifdef	CONFIG_OP_DEBUG_CHG
+/* *#806# aging test not need Vbus disconnect feature*/
+	return;
+#else
+	if (chg->is_aging_test)
+		return;
+#endif
+	if (!gpio_is_valid(chg->vbus_ctrl))
+		return;
+	if (!enable) {
+		gpio_set_value(chg->vbus_ctrl, 0);
+		chg->disconnect_vbus = false;
+		pr_info("usb connecter connectd!");
+		return;
+	}
+	pr_info("usb connecter hot(%d),Vbus disconnected!\n",
+			chg->connecter_temp);
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		switch_mode_to_normal();
+		op_set_fast_chg_allow(chg, false);
+	}
+	smblib_set_usb_suspend(chg, true);
+	gpio_set_value(chg->vbus_ctrl, 1);
+	chg->disconnect_vbus = true;
+}
+
+/*usb connector hw auto detection*/
+static void op_otg_switch(struct work_struct *work)
+{
+	bool usb_pluged;
+	static bool pre_usb_pluged;
 
-		if (chg->lpd_stage == LPD_STAGE_FLOAT_CANCEL)
-			schedule_delayed_work(&chg->lpd_detach_work,
-					msecs_to_jiffies(100));
+	if (!g_chg)
+		return;
+	usb_pluged = gpio_get_value(g_chg->plug_irq) ? false : true;
+	if (usb_pluged == pre_usb_pluged) {
+		pr_info("same status,return;usb_present:%d\n", usb_pluged);
+		return;
 	}
+	pr_info("%s,usb_present:%d\n", __func__, usb_pluged);
+	if (usb_pluged) {
+		vote(g_chg->otg_toggle_votable, HW_DETECT_VOTER, 1, 0);
+		g_chg->hw_detect = 1;
+	} else {
+		vote(g_chg->otg_toggle_votable, HW_DETECT_VOTER, 0, 0);
+		g_chg->hw_detect = 0;
+		schedule_delayed_work(&g_chg->unplug_check_work,
+				msecs_to_jiffies(TIME_200MS));
+	}
+	pr_info("%s:hw_detect=%d\n", __func__, g_chg->hw_detect);
+	pre_usb_pluged = usb_pluged;
+}
+static void op_check_charger_wakup_source(struct smb_charger *chg, int vchg_mv)
+{
 
-	power_supply_changed(chg->usb_psy);
+	struct wakeup_source *ws;
 
-	return IRQ_HANDLED;
+	ws = &chg->chg_wake_lock;
+	if (chg->vbus_present)
+		return;
+	if (ws->active && vchg_mv <= 200) {
+		pr_info("%s release chg_wake_lock\n", __func__);
+		__pm_relax(&chg->chg_wake_lock);
+	}
 }
 
-irqreturn_t dc_plugin_irq_handler(int irq, void *data)
+static void op_heartbeat_work(struct work_struct *work)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
-	union power_supply_propval pval;
-	int input_present;
-	bool dcin_present, vbus_present;
-	int rc, wireless_vout = 0;
-	int sec_charger;
-
-	rc = iio_read_channel_processed(chg->iio.vph_v_chan,
-			&wireless_vout);
-	if (rc < 0)
-		return IRQ_HANDLED;
+	struct delayed_work *dwork = to_delayed_work(work);
+	struct smb_charger *chg = container_of(dwork,
+			struct smb_charger, heartbeat_work);
+	enum temp_region_type temp_region;
+	bool charger_present = 0;
+	bool fast_charging = 0;
+	static int vbat_mv;
+	union power_supply_propval vbus_val;
+	int rc;
 
-	wireless_vout *= 2;
-	wireless_vout /= 100000;
-	wireless_vout *= 100000;
+	op_otg_icl_contrl(chg);
+#ifndef CONFIG_OP_DEBUG_CHG
+	op_check_charge_timeout(chg);
+#endif
 
-	rc = smblib_is_input_present(chg, &input_present);
-	if (rc < 0)
-		return IRQ_HANDLED;
+#ifdef CONFIG_OP_DEBUG_CHG
+	rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+	if (rc < 0) {
+		pr_err("failed to read usb_voltage rc=%d\n", rc);
+		vbus_val.intval = CHG_VOLTAGE_NORMAL;
+	}
+#endif
+	charger_present = is_usb_present(chg);
+	if (!charger_present)
+		goto out;
+	/* charger present */
+	power_supply_changed(chg->batt_psy);
+	chg->dash_on = get_prop_fast_chg_started(chg);
+	if (chg->dash_on) {
+		switch_fast_chg(chg);
+		pr_info("fast chg started, usb_switch=%d\n",
+				op_is_usb_switch_on(chg));
+		/* add for disable normal charge */
+		fast_charging = op_get_fastchg_ing(chg);
+		if (fast_charging) {
+			if (!chg->disable_normal_chg_for_dash)
+				op_charging_en(chg, false);
+			chg->disable_normal_chg_for_dash = true;
+		}
+		goto out;
+	} else {
+		if (chg->disable_normal_chg_for_dash) {
+			chg->disable_normal_chg_for_dash = false;
+			op_charging_en(chg, true);
+		}
+		schedule_delayed_work(&chg->check_switch_dash_work,
+							msecs_to_jiffies(100));
+	}
+	rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+	if (rc < 0) {
+		pr_err("failed to read usb_voltage rc=%d\n", rc);
+		vbus_val.intval = CHG_VOLTAGE_NORMAL;
+	}
+	op_check_charger_wakup_source(chg, vbus_val.intval);
+	op_check_charger_uovp(chg, vbus_val.intval);
+	op_check_battery_uovp(chg);
+	if (vbus_val.intval > 4500)
+		op_check_charger_collapse(chg);
+
+	vbat_mv = get_prop_batt_voltage_now(chg) / 1000;
+	temp_region = op_battery_temp_region_get(chg);
+	if (temp_region == BATT_TEMP_LITTLE_COOL
+		|| temp_region ==  BATT_TEMP_COOL) {
+		if (vbat_mv > chg->temp_littel_cool_voltage
+		&& chg->temp_littel_cool_set_current_0_point_25c) {
+			chg->is_power_changed = true;
+		} else if (vbat_mv < chg->temp_littel_cool_voltage - 200
+		&& !chg->temp_littel_cool_set_current_0_point_25c) {
+			chg->is_power_changed = true;
+		}
+	}
+	ffc_exit(chg);
 
-	dcin_present = input_present & INPUT_PRESENT_DC;
-	vbus_present = input_present & INPUT_PRESENT_USB;
+	checkout_term_current(chg);
+	if (!chg->chg_ovp && chg->chg_done
+			&& temp_region > BATT_TEMP_COLD
+			&& temp_region < BATT_TEMP_HOT
+			&& chg->vbatdet[temp_region] >= vbat_mv) {
+		chg->chg_done = false;
+		chg->recharge_pending = true;
+		chg->recharge_status = true;
 
-	if (dcin_present) {
-		if (!vbus_present && chg->sec_cp_present) {
-			pval.intval = wireless_vout;
-			rc = smblib_set_prop_voltage_wls_output(chg, &pval);
-			if (rc < 0)
-				dev_err(chg->dev, "Couldn't set dc voltage to 2*vph  rc=%d\n",
-					rc);
+		op_charging_en(chg, true);
+		pr_debug("temp_region=%d, recharge_pending\n", temp_region);
+	}
 
-			rc = smblib_select_sec_charger(chg,
-					POWER_SUPPLY_CHARGER_SEC_CP,
-					POWER_SUPPLY_CP_WIRELESS, false);
-			if (rc < 0)
-				dev_err(chg->dev, "Couldn't enable secondary chargers  rc=%d\n",
-					rc);
+	if (!chg->chg_ovp && chg->battery_status == BATT_STATUS_GOOD
+			&& !chg->time_out) {
+		op_check_battery_temp(chg);
+	}
+#ifdef CONFIG_OP_DEBUG_CHG
+	chg->dump_count++;
+	if (chg->dump_count == 600) {
+		chg->dump_count = 0;
+		if ((get_prop_batt_current_now(chg) / 1000) > 0) {
+			op_dump_regs(chg);
+			aging_test_check_aicl(chg);
+		}
+	}
+#else
+	if (chg->is_aging_test) {
+		chg->dump_count++;
+		if (chg->dump_count == 600) {
+			chg->dump_count = 0;
+			if ((get_prop_batt_current_now(chg) / 1000) > 0) {
+				op_dump_regs(chg);
+				aging_test_check_aicl(chg);
+			}
 		}
-	} else if (chg->cp_reason == POWER_SUPPLY_CP_WIRELESS) {
-		sec_charger = chg->sec_pl_present ?
-					POWER_SUPPLY_CHARGER_SEC_PL :
-					POWER_SUPPLY_CHARGER_SEC_NONE;
-		rc = smblib_select_sec_charger(chg, sec_charger,
-					POWER_SUPPLY_CP_NONE, false);
-		if (rc < 0)
-			dev_err(chg->dev,
-				"Couldn't disable secondary charger rc=%d\n",
-						rc);
 	}
 
-	power_supply_changed(chg->dc_psy);
-
-	smblib_dbg(chg, PR_WLS, "dcin_present= %d, usbin_present= %d, cp_reason = %d\n",
-			dcin_present, vbus_present, chg->cp_reason);
+#endif
+out:
+		smblib_dbg(chg, PR_OP_DEBUG, "CAP=%d (Q:%d), VBAT=%d (Q:%d),\
+				IBAT=%d (Q:%d), BAT_TEMP=%d, CONNECTOR_TEMP=%d\
+				CHG_TYPE=%d, VBUS=%d AICL:%d\n",
+				get_prop_batt_capacity(chg),
+				get_prop_fg_capacity(chg),
+				get_prop_batt_voltage_now(chg) / 1000,
+				get_prop_fg_voltage_now(chg) / 1000,
+				get_prop_batt_current_now(chg) / 1000,
+				get_prop_fg_current_now(chg) / 1000,
+				get_prop_batt_temp(chg),
+				chg->connecter_temp,
+				chg->usb_psy_desc.type,
+				vbus_val.intval,
+				op_get_aicl_result(chg));
+	/*update time 6s*/
+	schedule_delayed_work(&chg->heartbeat_work,
+			round_jiffies_relative(msecs_to_jiffies
+				(HEARTBEAT_INTERVAL_MS)));
+}
+
+static int op_read(struct smb_charger *chg, u16 addr, u8 *val)
+{
+	unsigned int temp;
+	int rc = 0;
 
-	return IRQ_HANDLED;
+	pr_info("%s enter,temp:0x%x rc:0x%x\n", __func__, temp, rc);
+	if (pm_regmap) {
+		rc = regmap_read(pm_regmap, addr, &temp);
+		if (rc >= 0)
+			*val = (u8)temp;
+	}
+	pr_info("%s end,temp:0x%x,rc:0x%x\n", __func__, temp, rc);
+	return rc;
 }
 
-irqreturn_t high_duty_cycle_irq_handler(int irq, void *data)
+static int op_write(struct smb_charger *chg, u16 addr, u8 val)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
+	int rc = 0;
 
-	chg->is_hdc = true;
-	/*
-	 * Disable usb IRQs after the flag set and re-enable IRQs after
-	 * the flag cleared in the delayed work queue, to avoid any IRQ
-	 * storming during the delays
-	 */
-	if (chg->irq_info[HIGH_DUTY_CYCLE_IRQ].irq)
-		disable_irq_nosync(chg->irq_info[HIGH_DUTY_CYCLE_IRQ].irq);
+	if (pm_regmap)
+		rc = regmap_write(pm_regmap, addr, val);
+	return rc;
+}
 
-	schedule_delayed_work(&chg->clear_hdc_work, msecs_to_jiffies(60));
 
-	return IRQ_HANDLED;
+/*Modify for backup soc  Begin  */
+int op_masked_write(struct smb_charger *chg, u16 addr, u8 mask, u8 val)
+{
+	int rc = 0;
+
+	if (pm_regmap) {
+		rc = regmap_update_bits(pm_regmap, addr, mask, val);
+	} else {
+		pr_err("pm_pon is NULL\n");
+	}
+	return rc;
 }
 
-static void smblib_bb_removal_work(struct work_struct *work)
+void op_write_backup_flag(struct smb_charger *chg, bool bk_flag)
 {
-	struct smb_charger *chg = container_of(work, struct smb_charger,
-						bb_removal_work.work);
+	int rc = 0;
 
-	vote(chg->usb_icl_votable, BOOST_BACK_VOTER, false, 0);
-	vote(chg->awake_votable, BOOST_BACK_VOTER, false, 0);
+	rc = op_masked_write(chg, SOC_FLAG_REG,
+		BIT(0), bk_flag ? BIT(0):0);
+	if (rc) {
+		pr_err("failed to clean PM addr[0x%x], rc=%d\n",
+			SOC_FLAG_REG, rc);
+	}
 }
 
-#define BOOST_BACK_UNVOTE_DELAY_MS		750
-#define BOOST_BACK_STORM_COUNT			3
-#define WEAK_CHG_STORM_COUNT			8
-irqreturn_t switcher_power_ok_irq_handler(int irq, void *data)
+int op_read_backup_flag(struct smb_charger *chg)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
-	struct storm_watch *wdata = &irq_data->storm_data;
-	int rc, usb_icl;
-	u8 stat;
+	u8 flag;
+	int rc = 0;
 
-	if (!(chg->wa_flags & BOOST_BACK_WA))
-		return IRQ_HANDLED;
+	pr_info("%s enter,flag:0x%x,rc:0x%x\n", __func__, flag, rc);
+	rc = op_read(chg, SOC_FLAG_REG, &flag);
+	if (rc) {
+		pr_err("failed to read PM addr[0x%x], rc=%d\n",
+			SOC_FLAG_REG, rc);
+		return 0;
+	}
+	pr_info("%s end,flag:0x%x,rc:0x%x\n", __func__, flag, rc);
+	flag = flag & BIT(0);
+	return flag;
+}
 
-	rc = smblib_read(chg, POWER_PATH_STATUS_REG, &stat);
-	if (rc < 0) {
-		smblib_err(chg, "Couldn't read POWER_PATH_STATUS rc=%d\n", rc);
-		return IRQ_HANDLED;
+static int load_data(struct smb_charger *chip)
+{
+	u8 stored_soc = 0;
+	int rc = 0, shutdown_soc = 0;
+
+	if (!chip) {
+		pr_err("chip is NULL !\n");
+		return SOC_INVALID;
+	}
+	if (!op_read_backup_flag(chip))
+		return SOC_INVALID;
+	rc = op_read(chip, SOC_DATA_REG_0, &stored_soc);
+	if (rc) {
+		pr_err("failed to read addr[0x%x], rc=%d\n", SOC_DATA_REG_0, rc);
+		return SOC_INVALID;
 	}
 
-	/* skip suspending input if its already suspended by some other voter */
-	usb_icl = get_effective_result(chg->usb_icl_votable);
-	if ((stat & USE_USBIN_BIT) && usb_icl >= 0 && usb_icl <= USBIN_25MA)
-		return IRQ_HANDLED;
+	shutdown_soc = (stored_soc >> 1); /* get data from bit1~bit7 */
+	pr_info("stored_soc[0x%x], shutdown_soc[%d]\n", stored_soc, shutdown_soc);
+	return shutdown_soc;
+}
 
-	if (stat & USE_DCIN_BIT)
-		return IRQ_HANDLED;
+int load_soc(void)
+{
+	int soc = 0;
 
-	if (is_storming(&irq_data->storm_data)) {
-		/* This could be a weak charger reduce ICL */
-		if (!is_client_vote_enabled(chg->usb_icl_votable,
-						WEAK_CHARGER_VOTER)) {
-			smblib_err(chg,
-				"Weak charger detected: voting %dmA ICL\n",
-				*chg->weak_chg_icl_ua / 1000);
-			vote(chg->usb_icl_votable, WEAK_CHARGER_VOTER,
-					true, *chg->weak_chg_icl_ua);
-			/*
-			 * reset storm data and set the storm threshold
-			 * to 3 for reverse boost detection.
-			 */
-			update_storm_count(wdata, BOOST_BACK_STORM_COUNT);
-		} else {
-			smblib_err(chg,
-				"Reverse boost detected: voting 0mA to suspend input\n");
-			vote(chg->usb_icl_votable, BOOST_BACK_VOTER, true, 0);
-			vote(chg->awake_votable, BOOST_BACK_VOTER, true, 0);
-			/*
-			 * Remove the boost-back vote after a delay, to avoid
-			 * permanently suspending the input if the boost-back
-			 * condition is unintentionally hit.
-			 */
-			schedule_delayed_work(&chg->bb_removal_work,
-				msecs_to_jiffies(BOOST_BACK_UNVOTE_DELAY_MS));
+	soc = load_data(g_chg);
+	if (soc == SOC_INVALID || soc < 0 || soc > 100)
+		return -1;
+	return soc;
+}
+
+static void clear_backup_soc(struct smb_charger *chip)
+{
+	int rc = 0;
+	u8 soc_temp = 0;
+
+	rc = op_write(chip, SOC_DATA_REG_0, soc_temp);
+	if (rc)
+		pr_err("failed to clean addr[0x%x], rc=%d\n",
+				SOC_DATA_REG_0, rc);
+	op_write_backup_flag(chip, false);
+}
+
+void clean_backup_soc_ex(void)
+{
+	if(g_chg)
+		clear_backup_soc(g_chg);
+}
+
+static void backup_soc(struct smb_charger *chip, int soc)
+{
+	int rc = 0;
+	u8 invalid_soc = SOC_INVALID;
+	u8 soc_temp = (soc << 1); /* store data in bit1~bit7 */
+	if (!chip || soc < 0 || soc > 100) {
+		pr_err("chip or soc invalid, store an invalid soc\n");
+		if (chip) {
+			rc = op_write(chip, SOC_DATA_REG_0, invalid_soc);
+			if (rc)
+				pr_err("failed to write addr[0x%x], rc=%d\n",
+						SOC_DATA_REG_0, rc);
 		}
+		return;
 	}
 
-	return IRQ_HANDLED;
+	pr_err("backup_soc[%d]\n", soc);
+	rc = op_write(chip, SOC_DATA_REG_0, soc_temp);
+	if (rc)
+		pr_err("failed to write addr[0x%x], rc=%d\n",
+				SOC_DATA_REG_0, rc);
+	op_write_backup_flag(chip, true);
+}
+bool get_prop_fastchg_is_ok(struct smb_charger *chg)
+{
+	if (chg)
+		return op_get_fast_chg_status_is_ok(chg);
+	return true;
+}
+void backup_soc_ex(int soc)
+{
+	if (g_chg)
+		backup_soc(g_chg, soc);
 }
+/* Modify for backup soc  End*/
 
-irqreturn_t wdog_snarl_irq_handler(int irq, void *data)
+enum chg_protect_status_type {
+	PROTECT_CHG_OVP = 1, /* 1: VCHG > 5.8V     */
+	PROTECT_BATT_MISSING, /* 2: battery missing */
+	PROTECT_CHG_OVERTIME, /* 3: charge overtime */
+	PROTECT_BATT_OVP, /* 4: vbat >= 4.5     */
+	PROTECT_BATT_TEMP_REGION__HOT,/* 5: 55 < t          */
+	PROTECT_BATT_TEMP_REGION_COLD,/* 6:      t <= -3    */
+	PROTECT_BATT_TEMP_REGION_LITTLE_COLD, /* 7: -3 < t <=  0  */
+	PROTECT_BATT_TEMP_REGION_COOL,/* 8:  0 < t <=  5    */
+	PROTECT_BATT_TEMP_REGION_WARM /* 9: 45 < t <= 55   */
+};
+
+int get_prop_chg_protect_status(struct smb_charger *chg)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
+	int temp = 0, rc = 0;
+	bool batt_present = 0;
+	enum temp_region_type temp_region;
+	union power_supply_propval vbus_val;
 
-	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
+	if (chg->use_fake_protect_sts)
+		return chg->fake_protect_sts;
 
-	if (chg->wa_flags & SW_THERM_REGULATION_WA) {
-		cancel_delayed_work_sync(&chg->thermal_regulation_work);
-		vote(chg->awake_votable, SW_THERM_REGULATION_VOTER, true, 0);
-		schedule_delayed_work(&chg->thermal_regulation_work, 0);
-	}
+	if (!is_usb_present(chg))
+		return 0;
 
-	return IRQ_HANDLED;
+	rc = smblib_get_prop_usb_voltage_now(chg, &vbus_val);
+	if (rc < 0) {
+		pr_err("failed to read usb_voltage rc=%d\n", rc);
+		vbus_val.intval = CHG_VOLTAGE_NORMAL;
+	}
+
+	temp = get_prop_batt_temp(chg);
+	batt_present = get_prop_batt_present(chg);
+	temp_region = op_battery_temp_region_get(chg);
+	if (chg->chg_ovp && vbus_val.intval >= CHG_SOFT_OVP_MV - 100)
+		return PROTECT_CHG_OVP;
+	else if (!batt_present || BATT_REMOVE_TEMP > temp)
+		return  PROTECT_BATT_MISSING;
+	else if (chg->battery_status == BATT_STATUS_BAD)
+		return PROTECT_BATT_OVP;
+	else if (true == chg->time_out)
+		return PROTECT_CHG_OVERTIME;
+	else if (temp_region == BATT_TEMP_HOT)
+		return PROTECT_BATT_TEMP_REGION__HOT;
+	else if (temp_region == BATT_TEMP_COLD)
+		return PROTECT_BATT_TEMP_REGION_COLD;
+	else if (temp_region == BATT_TEMP_LITTLE_COLD
+			&& (chg->chg_done || chg->recharge_status))
+		return PROTECT_BATT_TEMP_REGION_LITTLE_COLD;
+	else if (temp_region == BATT_TEMP_WARM
+			&& (chg->chg_done || chg->recharge_status))
+		return PROTECT_BATT_TEMP_REGION_WARM;
+	else
+		return 0;
 }
 
-irqreturn_t wdog_bark_irq_handler(int irq, void *data)
+bool get_prop_fastchg_status(struct smb_charger *chg)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
-	int rc;
-
-	smblib_dbg(chg, PR_INTERRUPT, "IRQ: %s\n", irq_data->name);
+	int capacity = 0;
 
-	rc = smblib_write(chg, BARK_BITE_WDOG_PET_REG, BARK_BITE_WDOG_PET_BIT);
-	if (rc < 0)
-		smblib_err(chg, "Couldn't pet the dog rc=%d\n", rc);
+	if (chg->dash_present)
+		return true;
 
-	if (chg->step_chg_enabled)
-		power_supply_changed(chg->batt_psy);
+	if (chg->hvdcp_present) {
+		capacity = get_prop_batt_capacity(chg);
+		if (capacity >= 1 && capacity <= 85)
+			return true;
+	}
 
-	return IRQ_HANDLED;
+	return false;
 }
 
-static void smblib_die_rst_icl_regulate(struct smb_charger *chg)
-{
-	int rc;
-	u8 temp;
+static struct notify_dash_event notify_unplug_event  = {
+	.notify_event	= update_dash_unplug_status,
+	.op_contrl		= op_contrl,
+	.notify_dash_charger_present
+		= set_dash_charger_present,
+};
 
-	rc = smblib_read(chg, DIE_TEMP_STATUS_REG, &temp);
-	if (rc < 0) {
-		smblib_err(chg, "Couldn't read DIE_TEMP_STATUS_REG rc=%d\n",
-				rc);
-		return;
+void op_pm8998_regmap_register(struct regmap *regmap)
+{
+	if (pm_regmap) {
+		pm_regmap = regmap;
+		pr_err("multiple battery gauge called\n");
+	} else {
+		pm_regmap = regmap;
 	}
+}
 
-	/* Regulate ICL on die temp crossing DIE_RST threshold */
-	vote(chg->usb_icl_votable, DIE_TEMP_VOTER,
-				temp & DIE_TEMP_RST_BIT, 500000);
+void fastcharge_information_register(struct external_battery_gauge *fast_chg)
+{
+	if (fast_charger) {
+		fast_charger = fast_chg;
+		pr_err("multiple battery gauge called\n");
+	} else {
+		fast_charger = fast_chg;
+	}
 }
+EXPORT_SYMBOL(fastcharge_information_register);
 
-/*
- * triggered when DIE or SKIN or CONNECTOR temperature across
- * either of the _REG_L, _REG_H, _RST, or _SHDN thresholds
- */
-irqreturn_t temp_change_irq_handler(int irq, void *data)
+void fastcharge_information_unregister(struct external_battery_gauge *fast_chg)
 {
-	struct smb_irq_data *irq_data = data;
-	struct smb_charger *chg = irq_data->parent_data;
+	fast_charger = NULL;
+}
+EXPORT_SYMBOL(fastcharge_information_unregister);
 
-	smblib_die_rst_icl_regulate(chg);
+static int notify_usb_enumeration_function(int status)
+{
+	pr_info("status=%d\n", status);
+	g_chg->usb_enum_status = status;
 
-	return IRQ_HANDLED;
+	return g_chg->usb_enum_status;
 }
 
+static struct notify_usb_enumeration_status usb_enumeration  = {
+	.notify_usb_enumeration		= notify_usb_enumeration_function,
+};
+
 /**************
  * Additional USB PSY getters/setters
  * that call interrupt functions
@@ -5814,6 +9048,9 @@ static void smblib_lpd_ra_open_work(struct work_struct *work)
 	if (!(stat & TYPEC_WATER_DETECTION_STATUS_BIT)
 			|| (stat & TYPEC_TCCDEBOUNCE_DONE_STATUS_BIT)) {
 		chg->lpd_stage = LPD_STAGE_NONE;
+		*chg->lpd_result = 0;
+		pr_info("Quit if moisture status is gone:__lpd_result(%d)\n",
+				__lpd_result);
 		goto out;
 	}
 
@@ -5849,6 +9086,8 @@ static void smblib_lpd_ra_open_work(struct work_struct *work)
 		}
 
 		chg->lpd_reason = LPD_MOISTURE_DETECTED;
+		pr_info("lpd_reason:(%d),pr_role:(%d)\n",
+					chg->lpd_reason, pval.intval);
 
 	} else {
 		/* Floating cable, disable water detection irq temporarily */
@@ -5873,7 +9112,9 @@ static void smblib_lpd_ra_open_work(struct work_struct *work)
 	}
 
 	/* recheck in 60 seconds */
-	alarm_start_relative(&chg->lpd_recheck_timer, ms_to_ktime(60000));
+	if (check_boot_mode_disabled_lpd(chg))
+		alarm_start_relative(&chg->lpd_recheck_timer,
+							ms_to_ktime(60000));
 out:
 	vote(chg->awake_votable, LPD_VOTER, false, 0);
 }
@@ -5948,6 +9189,15 @@ static int smblib_create_votables(struct smb_charger *chg)
 		return rc;
 	}
 
+/*usb connector hw auto detection*/
+	chg->otg_toggle_votable = create_votable("OTG_TOGGLE", VOTE_SET_ANY,
+					smblib_otg_toggle_vote_callback,
+					chg);
+	if (IS_ERR(chg->otg_toggle_votable)) {
+		rc = PTR_ERR(chg->otg_toggle_votable);
+		return rc;
+	}
+
 	chg->awake_votable = create_votable("AWAKE", VOTE_SET_ANY,
 					smblib_awake_vote_callback,
 					chg);
@@ -5983,6 +9233,9 @@ static void smblib_destroy_votables(struct smb_charger *chg)
 {
 	if (chg->dc_suspend_votable)
 		destroy_votable(chg->dc_suspend_votable);
+/*usb connector hw auto detection*/
+	if (chg->otg_toggle_votable)
+		destroy_votable(chg->otg_toggle_votable);
 	if (chg->usb_icl_votable)
 		destroy_votable(chg->usb_icl_votable);
 	if (chg->awake_votable)
@@ -5999,6 +9252,8 @@ static void smblib_iio_deinit(struct smb_charger *chg)
 		iio_channel_release(chg->iio.usbin_i_chan);
 	if (!IS_ERR_OR_NULL(chg->iio.temp_chan))
 		iio_channel_release(chg->iio.temp_chan);
+	if (!IS_ERR_OR_NULL(chg->iio.op_connector_temp_chan))
+		iio_channel_release(chg->iio.op_connector_temp_chan);
 	if (!IS_ERR_OR_NULL(chg->iio.sbux_chan))
 		iio_channel_release(chg->iio.sbux_chan);
 	if (!IS_ERR_OR_NULL(chg->iio.vph_v_chan))
@@ -6019,12 +9274,58 @@ int smblib_init(struct smb_charger *chg)
 	int rc = 0;
 
 	mutex_init(&chg->smb_lock);
+	mutex_init(&chg->write_lock);
+	mutex_init(&chg->sw_dash_lock);
 	INIT_WORK(&chg->bms_update_work, bms_update_work);
 	INIT_WORK(&chg->pl_update_work, pl_update_work);
 	INIT_WORK(&chg->jeita_update_work, jeita_update_work);
+	INIT_DELAYED_WORK(&chg->rechk_sw_dsh_work, retrigger_dash_work);
+	INIT_DELAYED_WORK(&chg->re_kick_work, op_re_kick_work);
+	INIT_DELAYED_WORK(&chg->unplug_check_work, op_usb_remove_check_work);
+	INIT_DELAYED_WORK(&chg->op_check_apsd_work, op_chek_apsd_done_work);
+	INIT_DELAYED_WORK(&chg->recovery_suspend_work,
+		op_recovery_usb_suspend_work);
+	INIT_DELAYED_WORK(&chg->check_switch_dash_work,
+			op_check_allow_switch_dash_work);
+	INIT_DELAYED_WORK(&chg->heartbeat_work,
+			op_heartbeat_work);
+	INIT_DELAYED_WORK(&chg->non_standard_charger_check_work,
+		check_non_standard_charger_work);
+	INIT_DELAYED_WORK(&chg->re_det_work, smbchg_re_det_work);
+	INIT_DELAYED_WORK(&chg->op_re_set_work, op_recovery_set_work);
+	INIT_WORK(&chg->get_aicl_work, op_get_aicl_work);
+	/*usb connector hw auto detection*/
+	INIT_WORK(&chg->otg_switch_work, op_otg_switch);
+	INIT_DELAYED_WORK(&chg->connecter_check_work,
+			op_connect_temp_check_work);
+	schedule_delayed_work(&chg->heartbeat_work,
+			msecs_to_jiffies(HEARTBEAT_INTERVAL_MS));
+	if (gpio_is_valid(chg->vbus_ctrl))
+		schedule_delayed_work(&chg->connecter_check_work,
+				msecs_to_jiffies(200));
+	notify_dash_unplug_register(&notify_unplug_event);
+	wakeup_source_init(&chg->chg_wake_lock, "chg_wake_lock");
+	g_chg = chg;
+	regsister_notify_usb_enumeration_status(&usb_enumeration);
+#if defined(CONFIG_FB)
+	chg->fb_notif.notifier_call = fb_notifier_callback;
+
+	rc = fb_register_client(&chg->fb_notif);
+
+	if (rc)
+		pr_err("Unable to register fb_notifier: %d\n", rc);
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+		chg->msm_drm_notifier.notifier_call = msm_drm_notifier_callback;
+		rc = msm_drm_register_client(&chg->msm_drm_notifier);
+		if (rc)
+			pr_err("Smb unable to register notifier: %d\n", rc);
+#endif /*CONFIG_FB*/
+
 	INIT_DELAYED_WORK(&chg->clear_hdc_work, clear_hdc_work);
 	INIT_DELAYED_WORK(&chg->icl_change_work, smblib_icl_change_work);
 	INIT_DELAYED_WORK(&chg->pl_enable_work, smblib_pl_enable_work);
+		op_set_collapse_fet(chg, false);
+
 	INIT_DELAYED_WORK(&chg->uusb_otg_work, smblib_uusb_otg_work);
 	INIT_DELAYED_WORK(&chg->bb_removal_work, smblib_bb_removal_work);
 	INIT_DELAYED_WORK(&chg->lpd_ra_open_work, smblib_lpd_ra_open_work);
@@ -6037,6 +9338,7 @@ int smblib_init(struct smb_charger *chg)
 					smblib_chg_termination_work);
 
 		if (alarmtimer_get_rtcdev()) {
+			pr_info("chg_termination_alarm\n");
 			alarm_init(&chg->chg_termination_alarm, ALARM_BOOTTIME,
 						chg_termination_alarm_cb);
 		} else {
@@ -6050,6 +9352,7 @@ int smblib_init(struct smb_charger *chg)
 					smblib_moisture_protection_work);
 
 		if (alarmtimer_get_rtcdev()) {
+			pr_info("moisture_protection_alarm\n");
 			alarm_init(&chg->moisture_protection_alarm,
 				ALARM_BOOTTIME, moisture_protection_alarm_cb);
 		} else {
@@ -6075,15 +9378,6 @@ int smblib_init(struct smb_charger *chg)
 				rc);
 			return rc;
 		}
-
-		rc = qcom_step_chg_init(chg->dev, chg->step_chg_enabled,
-						chg->sw_jeita_enabled, false);
-		if (rc < 0) {
-			smblib_err(chg, "Couldn't init qcom_step_chg_init rc=%d\n",
-				rc);
-			return rc;
-		}
-
 		rc = smblib_create_votables(chg);
 		if (rc < 0) {
 			smblib_err(chg, "Couldn't create votables rc=%d\n",
@@ -6166,8 +9460,9 @@ int smblib_deinit(struct smb_charger *chg)
 		cancel_delayed_work_sync(&chg->bb_removal_work);
 		cancel_delayed_work_sync(&chg->lpd_ra_open_work);
 		cancel_delayed_work_sync(&chg->lpd_detach_work);
+		if (chg->nb.notifier_call)
+			power_supply_unreg_notifier(&chg->nb);
 		cancel_delayed_work_sync(&chg->thermal_regulation_work);
-		power_supply_unreg_notifier(&chg->nb);
 		smblib_destroy_votables(chg);
 		qcom_step_chg_deinit();
 		qcom_batt_deinit();
@@ -6178,7 +9473,7 @@ int smblib_deinit(struct smb_charger *chg)
 		smblib_err(chg, "Unsupported mode %d\n", chg->mode);
 		return -EINVAL;
 	}
-
+	notify_dash_unplug_unregister(&notify_unplug_event);
 	smblib_iio_deinit(chg);
 
 	return 0;
diff --git a/drivers/power/supply/qcom/smb5-lib.h b/drivers/power/supply/qcom/smb5-lib.h
index 55191b4958e2380695b09ab4e192d211d9115884..2d7fae2fc3e6ec8e2391f0a9b81ffb1b4e31bd18 100644
--- a/drivers/power/supply/qcom/smb5-lib.h
+++ b/drivers/power/supply/qcom/smb5-lib.h
@@ -19,6 +19,8 @@
 #include <linux/irqreturn.h>
 #include <linux/regulator/driver.h>
 #include <linux/regulator/consumer.h>
+
+#include <linux/power/oem_external_fg.h>
 #include <linux/extcon.h>
 #include "storm-watch.h"
 
@@ -29,10 +31,25 @@ enum print_reason {
 	PR_PARALLEL	= BIT(3),
 	PR_OTG		= BIT(4),
 	PR_WLS		= BIT(5),
+	PR_OP_DEBUG	= BIT(6),
+	PR_FAST_DEBUG = BIT(7),
 };
 
+#define BATT_TYPE_FCC_VOTER "BATT_TYPE_FCC_VOTER"
+#define PSY_ICL_VOTER		"PSY_ICL_VOTER"
+#define TEMP_REGION_MAX               9
+#define NON_STANDARD_CHARGER_CHECK_S 100
+#define TIME_1000MS 1000
+#define REDET_COUTNT 5
+#define APSD_CHECK_COUTNT 15
+#define DASH_CHECK_COUNT 40
+#define BOOST_BACK_COUNT 2
+#define TIME_200MS 200
+#define TIME_100MS 100
+#define TIME_3S 3000
 #define DEFAULT_VOTER			"DEFAULT_VOTER"
 #define USER_VOTER			"USER_VOTER"
+#define HW_DETECT_VOTER		"HW_DETECT_VOTER"
 #define PD_VOTER			"PD_VOTER"
 #define DCP_VOTER			"DCP_VOTER"
 #define QC_VOTER			"QC_VOTER"
@@ -315,6 +332,7 @@ struct smb_iio {
 	struct iio_channel	*mid_chan;
 	struct iio_channel	*batt_i_chan;
 	struct iio_channel	*connector_temp_chan;
+	struct iio_channel	*op_connector_temp_chan;
 	struct iio_channel	*sbux_chan;
 	struct iio_channel	*vph_v_chan;
 	struct iio_channel	*die_temp_chan;
@@ -331,6 +349,8 @@ struct smb_charger {
 	struct smb_iio		iio;
 	int			*debug_mask;
 	int			*pd_disabled;
+	int			*lpd_enable;
+	int			*lpd_result;
 	enum smb_mode		mode;
 	struct smb_chg_freq	chg_freq;
 	int			smb_version;
@@ -341,12 +361,18 @@ struct smb_charger {
 	/* locks */
 	struct mutex		smb_lock;
 	struct mutex		ps_change_lock;
+	struct mutex		write_lock;
+	struct mutex		sw_dash_lock;
+	struct pinctrl_state *ship_mode_default;
+	struct pinctrl_state *usb_temperature_default;
+	struct pinctrl *pinctrl;
 
 	/* power supplies */
 	struct power_supply		*batt_psy;
 	struct power_supply		*usb_psy;
 	struct power_supply		*dc_psy;
 	struct power_supply		*bms_psy;
+	struct power_supply_desc	usb_psy_desc;
 	struct power_supply		*usb_main_psy;
 	struct power_supply		*usb_port_psy;
 	struct power_supply		*wls_psy;
@@ -355,6 +381,12 @@ struct smb_charger {
 
 	/* notifiers */
 	struct notifier_block	nb;
+#if defined(CONFIG_FB)
+	struct notifier_block		fb_notif;
+#elif defined(CONFIG_MSM_RDM_NOTIFY)
+	struct notifier_block		msm_drm_notifier;
+#endif
+
 
 	/* parallel charging */
 	struct parallel_params	pl;
@@ -366,6 +398,8 @@ struct smb_charger {
 
 	/* votables */
 	struct votable		*dc_suspend_votable;
+	/*usb connector hw auto detection*/
+	struct votable		*otg_toggle_votable;
 	struct votable		*fcc_votable;
 	struct votable		*fv_votable;
 	struct votable		*usb_icl_votable;
@@ -384,6 +418,21 @@ struct smb_charger {
 	struct work_struct	moisture_protection_work;
 	struct work_struct	chg_termination_work;
 	struct delayed_work	ps_change_timeout_work;
+	struct delayed_work rechk_sw_dsh_work;
+	struct delayed_work	re_kick_work;
+	struct delayed_work	unplug_check_work;
+	struct delayed_work	recovery_suspend_work;
+	struct delayed_work	check_switch_dash_work;
+	struct delayed_work non_standard_charger_check_work;
+	struct delayed_work heartbeat_work;
+	struct delayed_work re_det_work;
+	struct delayed_work op_re_set_work;
+	struct delayed_work	op_check_apsd_work;
+	struct work_struct	get_aicl_work;
+	struct delayed_work connecter_check_work;
+	struct work_struct	otg_switch_work;
+	struct wakeup_source	chg_wake_lock;
+
 	struct delayed_work	clear_hdc_work;
 	struct delayed_work	icl_change_work;
 	struct delayed_work	pl_enable_work;
@@ -414,6 +463,87 @@ struct smb_charger {
 	bool			typec_legacy;
 
 	/* cached status */
+	int				BATT_TEMP_T0;
+	int				BATT_TEMP_T1;
+	int				BATT_TEMP_T2;
+	int				BATT_TEMP_T3;
+	int				BATT_TEMP_T4;
+	int				BATT_TEMP_T5;
+	int				BATT_TEMP_T6;
+	int				batt_health;
+	int				ibatmax[TEMP_REGION_MAX];
+	int				vbatmax[TEMP_REGION_MAX];
+	int				vbatdet[TEMP_REGION_MAX];
+	int				temp_littel_cool_voltage;
+	int				temp_littel_cool_current;
+	int				temp_cool_voltage;
+	int				temp_cool_current;
+	int				fake_chgvol;
+	int				fake_temp;
+	int				fake_protect_sts;
+	int				non_stand_chg_current;
+	int				non_stand_chg_count;
+	int				redet_count;
+	int				reset_count;
+	int				dump_count;
+	int				ck_apsd_count;
+	int				ck_dash_count;
+	int				ck_unplug_count;
+	int				recovery_boost_count;
+	int				op_icl_val;
+	int				plug_irq;
+	int				hw_detect;
+	bool				otg_switch;
+	bool				use_fake_chgvol;
+	bool				use_fake_temp;
+	bool				use_fake_protect_sts;
+	bool				vbus_present;
+	bool				hvdcp_present;
+	bool				dash_present;
+	bool				charger_collpse;
+	bool				usb_enum_status;
+	bool				non_std_chg_present;
+	bool				usb_type_redet_done;
+	bool				time_out;
+	bool				disable_normal_chg_for_dash;
+	bool				ship_mode;
+	bool				dash_on;
+	bool				chg_ovp;
+	bool				is_power_changed;
+	bool				recharge_pending;
+	bool				recharge_status;
+	bool temp_littel_cool_set_current_0_point_25c;
+	bool				oem_lcd_is_on;
+	bool				chg_enabled;
+	bool				op_apsd_done;
+	bool				re_trigr_dash_done;
+	bool				boot_usb_present;
+	bool				init_irq_done;
+	bool				is_aging_test;
+	bool				revert_boost_trigger;
+	bool               switch_on_fastchg;
+	int				ffc_count;
+	int				FFC_TEMP_T1;
+	int				FFC_TEMP_T2;
+	int				FFC_TEMP_T3;
+	int				FFC_NOR_FCC;
+	int				FFC_WARM_FCC;
+	int				FFC_NORMAL_CUTOFF;
+	int				FFC_WARM_CUTOFF;
+	int				FFC_VBAT_FULL;
+	enum ffc_step			ffc_status;
+	enum temp_region_type		mBattTempRegion;
+	enum batt_status_type		battery_status;
+	short				mBattTempBoundT0;
+	short				mBattTempBoundT1;
+	short				mBattTempBoundT2;
+	short				mBattTempBoundT3;
+	short				mBattTempBoundT4;
+	short				mBattTempBoundT5;
+	short				mBattTempBoundT6;
+	uint32_t			bus_client;
+	bool				is_audio_adapter;
+
 	bool			system_suspend_supported;
 	int			boost_threshold_ua;
 	int			system_temp_level;
@@ -431,6 +561,25 @@ struct smb_charger {
 	bool			suspend_input_on_debug_batt;
 	int			default_icl_ua;
 	int			otg_cl_ua;
+	int			sw_iterm_ma;
+	bool			check_batt_full_by_sw;
+	bool			OTG_ICL_CTRL;
+	int			OTG_LOW_BAT;
+	int			OTG_LOW_BAT_ICL;
+	int			OTG_NORMAL_BAT_ICL;
+	int			shipmode_en;
+	int			connecter_temp;
+	int			count_total;
+	int			count_run;
+	int			filter_count;
+	int			pre_temp;
+	int			current_temp;
+	bool			connector_short;
+	int			connecter_voltage;
+	int			disconnect_vbus;
+	int			vbus_ctrl;
+	bool			low_voltage_charger;
+	bool			lpd_disabled;
 	bool			uusb_apsd_rerun_done;
 	bool			typec_present;
 	int			fake_input_current_limited;
@@ -497,6 +646,16 @@ struct smb_charger {
 	int			wireless_vout;
 };
 
+int smblib_set_prop_charge_parameter_set(struct smb_charger *chg);
+extern void set_mcu_en_gpio_value(int value);
+extern void usb_sw_gpio_set(int value);
+extern bool op_set_fast_chg_allow(struct smb_charger *chg, bool enable);
+extern bool get_prop_fast_chg_started(struct smb_charger *chg);
+extern void mcu_en_gpio_set(int value);
+extern void switch_mode_to_normal(void);
+extern int __lpd_enable;
+extern int __lpd_result;
+extern struct smb_charger *g_chg;
 int smblib_read(struct smb_charger *chg, u16 addr, u8 *val);
 int smblib_masked_write(struct smb_charger *chg, u16 addr, u8 mask, u8 val);
 int smblib_write(struct smb_charger *chg, u16 addr, u8 val);
@@ -571,6 +730,8 @@ int smblib_get_prop_input_current_limited(struct smb_charger *chg,
 				union power_supply_propval *val);
 int smblib_get_prop_batt_iterm(struct smb_charger *chg,
 				union power_supply_propval *val);
+int smblib_get_prop_batt_temp(struct smb_charger *chg,
+				union power_supply_propval *val);
 int smblib_set_prop_input_suspend(struct smb_charger *chg,
 				const union power_supply_propval *val);
 int smblib_set_prop_batt_capacity(struct smb_charger *chg,
@@ -579,6 +740,31 @@ int smblib_set_prop_batt_status(struct smb_charger *chg,
 				const union power_supply_propval *val);
 int smblib_set_prop_system_temp_level(struct smb_charger *chg,
 				const union power_supply_propval *val);
+void op_bus_vote(int disable);
+int get_prop_fast_adapter_update(struct smb_charger *chg);
+void op_handle_usb_plugin(struct smb_charger *chg);
+int op_rerun_apsd(struct smb_charger *chg);
+irqreturn_t smblib_handle_aicl_done(int irq, void *data);
+void op_charge_info_init(struct smb_charger *chg);
+int update_dash_unplug_status(void);
+int get_prop_batt_status(struct smb_charger *chg);
+int get_prop_chg_protect_status(struct smb_charger *chg);
+int op_set_prop_otg_switch(struct smb_charger *chg,
+				bool enalbe);
+int check_allow_switch_dash(struct smb_charger *chg,
+				const union power_supply_propval *val);
+int smblib_set_prop_chg_voltage(struct smb_charger *chg,
+				const union power_supply_propval *val);
+int smblib_set_prop_batt_temp(struct smb_charger *chg,
+				const union power_supply_propval *val);
+int smblib_set_prop_chg_protect_status(struct smb_charger *chg,
+				const union power_supply_propval *val);
+bool op_get_fastchg_ing(struct smb_charger *chg);
+bool get_prop_fastchg_status(struct smb_charger *chg);
+int op_usb_icl_set(struct smb_charger *chg, int icl_ua);
+int op_get_aicl_result(struct smb_charger *chg);
+bool get_prop_fastchg_is_ok(struct smb_charger *chg);
+
 int smblib_set_prop_input_current_limited(struct smb_charger *chg,
 				const union power_supply_propval *val);
 
@@ -680,4 +866,5 @@ void smblib_apsd_enable(struct smb_charger *chg, bool enable);
 
 int smblib_init(struct smb_charger *chg);
 int smblib_deinit(struct smb_charger *chg);
+void op_disconnect_vbus(struct smb_charger *chg, bool enable);
 #endif /* __SMB5_CHARGER_H */
diff --git a/drivers/power/supply/qcom/smb5-reg.h b/drivers/power/supply/qcom/smb5-reg.h
index 9f5ff4cf744ea9de8834f2a62de043102e6a0c49..1e263a4be6da2a7d1f756274efdd48519a0fbf70 100644
--- a/drivers/power/supply/qcom/smb5-reg.h
+++ b/drivers/power/supply/qcom/smb5-reg.h
@@ -1,4 +1,4 @@
-/* Copyright (c) 2018 The Linux Foundation. All rights reserved.
+/* Copyright (c) 2018-2019 The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -33,6 +33,10 @@
  *  CHGR Peripheral Registers  *
  ********************************/
 #define BATTERY_CHARGER_STATUS_1_REG		(CHGR_BASE + 0x06)
+#define BVR_INITIAL_RAMP_BIT		BIT(7)
+#define ZERO_CHARGE_CURRENT_BIT		BIT(6)
+#define STEP_CHARGING_STATUS_SHIFT	3
+#define STEP_CHARGING_STATUS_MASK	GENMASK(5, 3)
 #define BATTERY_CHARGER_STATUS_MASK		GENMASK(2, 0)
 enum {
 	INHIBIT_CHARGE = 0,
@@ -290,6 +294,19 @@ enum {
 #define SUSPEND_ON_COLLAPSE_USBIN_BIT		BIT(7)
 #define USBIN_AICL_PERIODIC_RERUN_EN_BIT	BIT(4)
 #define USBIN_AICL_ADC_EN_BIT			BIT(3)
+#define SUSPEND_ON_COLLAPSE_USBIN_BIT		BIT(7)
+#define USBIN_AICL_HDC_EN_BIT			BIT(6)
+#define USBIN_AICL_START_AT_MAX_BIT		BIT(5)
+#define USBIN_AICL_EN_BIT			BIT(2)
+#define USBIN_HV_COLLAPSE_RESPONSE_BIT		BIT(1)
+#define USBIN_LV_COLLAPSE_RESPONSE_BIT		BIT(0)
+
+#define USBIN_5V_AICL_THRESHOLD_CFG_REG		(USBIN_BASE + 0x81)
+#define USBIN_5V_AICL_THRESHOLD_CFG_MASK	GENMASK(2, 0)
+
+#define USBIN_CONT_AICL_THRESHOLD_CFG_REG	(USBIN_BASE + 0x84)
+#define USBIN_CONT_AICL_THRESHOLD_CFG_MASK	GENMASK(5, 0)
+
 #define USBIN_AICL_EN_BIT			BIT(2)
 
 #define USB_ENG_SSUPPLY_USB2_REG		(USBIN_BASE + 0xC0)
@@ -312,7 +329,8 @@ enum {
  *  TYPEC Peripheral Registers  *
  ********************************/
 #define TYPE_C_SNK_STATUS_REG			(TYPEC_BASE + 0x06)
-#define DETECTED_SRC_TYPE_MASK			GENMASK(3, 0)
+#define DETECTED_SRC_TYPE_MASK			GENMASK(6, 0)
+#define SNK_RP_RP_BIT				BIT(6)
 #define SNK_RP_STD_BIT				BIT(3)
 #define SNK_RP_1P5_BIT				BIT(2)
 #define SNK_RP_3P0_BIT				BIT(1)
@@ -330,6 +348,8 @@ enum {
 #define TYPE_C_STATE_MACHINE_STATUS_REG		(TYPEC_BASE + 0x09)
 #define TYPEC_ATTACH_DETACH_STATE_BIT		BIT(5)
 
+#define DEBUG_ACCESS_SNK_CFG_REG                (TYPEC_BASE + 0x4A)
+
 #define TYPE_C_MISC_STATUS_REG			(TYPEC_BASE + 0x0B)
 #define TYPEC_WATER_DETECTION_STATUS_BIT	BIT(7)
 #define SNK_SRC_MODE_BIT			BIT(6)
@@ -354,7 +374,7 @@ enum {
 #define TYPEC_TRY_MODE_MASK			GENMASK(4, 3)
 #define EN_TRY_SNK_BIT				BIT(4)
 #define EN_TRY_SRC_BIT				BIT(3)
-#define TYPEC_POWER_ROLE_CMD_MASK		GENMASK(2, 0)
+#define TYPEC_POWER_ROLE_CMD_MASK		GENMASK(4, 0)
 #define EN_SRC_ONLY_BIT				BIT(2)
 #define EN_SNK_ONLY_BIT				BIT(1)
 #define TYPEC_DISABLE_CMD_BIT			BIT(0)
@@ -378,6 +398,7 @@ enum {
 
 #define TYPE_C_EXIT_STATE_CFG_REG		(TYPEC_BASE + 0x50)
 #define BYPASS_VSAFE0V_DURING_ROLE_SWAP_BIT	BIT(3)
+#define SEL_SRC_UPPER_REF_BIT			BIT(2)
 #define EXIT_SNK_BASED_ON_CC_BIT		BIT(0)
 
 #define TYPE_C_CURRSRC_CFG_REG			(TYPEC_BASE + 0x52)
diff --git a/drivers/regulator/core.c b/drivers/regulator/core.c
index 25f493570262339198dfc65e8493a0ed6ade7c52..20ee294b5d0fe8fda95a555387e210840544b16d 100644
--- a/drivers/regulator/core.c
+++ b/drivers/regulator/core.c
@@ -3975,6 +3975,7 @@ static void regulator_dev_release(struct device *dev)
 	kfree(rdev->constraints);
 	of_node_put(rdev->dev.of_node);
 	kfree(rdev);
+	rdev = NULL;
 }
 
 static struct class regulator_class = {
diff --git a/drivers/rtc/qpnp-rtc.c b/drivers/rtc/qpnp-rtc.c
index baca25e119ad26052f35ec4148017e74fe294b99..9219419e591cbdceec452553ef8ffa77cf7723e7 100644
--- a/drivers/rtc/qpnp-rtc.c
+++ b/drivers/rtc/qpnp-rtc.c
@@ -88,6 +88,10 @@ static int qpnp_write_wrapper(struct qpnp_rtc *rtc_dd, u8 *rtc_val,
 {
 	int rc;
 
+	if (base == (rtc_dd->alarm_base + REG_OFFSET_ALARM_CTRL1)) {
+				dev_info(rtc_dd->rtc_dev, "write ALARM_CTRL1=0x%x\n", *rtc_val);
+	}
+
 	rc = regmap_bulk_write(rtc_dd->regmap, base, rtc_val, count);
 	if (rc) {
 		dev_err(rtc_dd->rtc_dev, "SPMI write failed\n");
@@ -113,7 +117,7 @@ qpnp_rtc_set_time(struct device *dev, struct rtc_time *tm)
 	value[2] = (secs >> 16) & 0xFF;
 	value[3] = (secs >> 24) & 0xFF;
 
-	dev_dbg(dev, "Seconds value to be written to RTC = %lu\n", secs);
+	dev_err(dev, "Seconds value to be written to RTC = %lu\n", secs);
 
 	spin_lock_irqsave(&rtc_dd->alarm_ctrl_lock, irq_flags);
 	ctrl_reg = rtc_dd->alarm_ctrl_reg1;
@@ -272,7 +276,6 @@ qpnp_rtc_read_time(struct device *dev, struct rtc_time *tm)
 		dev_err(dev, "Invalid time read from RTC\n");
 		return rc;
 	}
-
 	dev_dbg(dev, "secs = %lu, h:m:s == %d:%d:%d, d/m/y = %d/%d/%d\n",
 			secs, tm->tm_hour, tm->tm_min, tm->tm_sec,
 			tm->tm_mday, tm->tm_mon, tm->tm_year);
@@ -311,6 +314,8 @@ qpnp_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
 	value[1] = (secs >> 8) & 0xFF;
 	value[2] = (secs >> 16) & 0xFF;
 	value[3] = (secs >> 24) & 0xFF;
+	dev_info(dev, "val[0] = 0x%x, val[1] = 0x%x, val[2] = 0x%x, val[3] = 0x%x\n",
+					value[0], value[1], value[2], value[3]);
 
 	spin_lock_irqsave(&rtc_dd->alarm_ctrl_lock, irq_flags);
 
@@ -335,7 +340,7 @@ qpnp_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
 
 	rtc_dd->alarm_ctrl_reg1 = ctrl_reg;
 
-	dev_dbg(dev, "Alarm Set for h:r:s=%d:%d:%d, d/m/y=%d/%d/%d\n",
+	dev_err(dev, "Alarm Set for h:r:s=%d:%d:%d, d/m/y=%d/%d/%d\n",
 			alarm->time.tm_hour, alarm->time.tm_min,
 			alarm->time.tm_sec, alarm->time.tm_mday,
 			alarm->time.tm_mon, alarm->time.tm_year);
@@ -652,11 +657,17 @@ static void qpnp_rtc_shutdown(struct platform_device *pdev)
 	unsigned long irq_flags;
 	struct qpnp_rtc *rtc_dd;
 	bool rtc_alarm_powerup;
+	struct rtc_wkalrm alarm;
 
 	if (!pdev) {
 		pr_err("qpnp-rtc: spmi device not found\n");
 		return;
 	}
+	qpnp_rtc_read_alarm(&pdev->dev, &alarm);
+	dev_err(&pdev->dev, "Alarm set for - h:r:s=%d:%d:%d, d/m/y=%d/%d/%d\n",
+			alarm.time.tm_hour, alarm.time.tm_min,
+			alarm.time.tm_sec, alarm.time.tm_mday,
+			alarm.time.tm_mon, alarm.time.tm_year);
 	rtc_dd = dev_get_drvdata(&pdev->dev);
 	if (!rtc_dd) {
 		pr_err("qpnp-rtc: rtc driver data not found\n");
@@ -665,7 +676,7 @@ static void qpnp_rtc_shutdown(struct platform_device *pdev)
 	rtc_alarm_powerup = rtc_dd->rtc_alarm_powerup;
 	if (!rtc_alarm_powerup && !poweron_alarm) {
 		spin_lock_irqsave(&rtc_dd->alarm_ctrl_lock, irq_flags);
-		dev_dbg(&pdev->dev, "Disabling alarm interrupts\n");
+		dev_err(&pdev->dev, "Disabling alarm interrupts\n");
 
 		/* Disable RTC alarms */
 		reg = rtc_dd->alarm_ctrl_reg1;
diff --git a/drivers/scsi/ufs/ufs-qcom.c b/drivers/scsi/ufs/ufs-qcom.c
index b7dc6f8ff10843dc9b9ad5121b57551e41eb1540..349a993dc419805af08cbb0176ce1970e7d74a83 100644
--- a/drivers/scsi/ufs/ufs-qcom.c
+++ b/drivers/scsi/ufs/ufs-qcom.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2013-2018, Linux Foundation. All rights reserved.
+ * Copyright (c) 2013-2019, Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -1363,11 +1363,16 @@ static void ufs_qcom_dev_ref_clk_ctrl(struct ufs_qcom_host *host, bool enable)
 
 		/*
 		 * If we call hibern8 exit after this, we need to make sure that
-		 * device ref_clk is stable for at least 1us before the hibern8
+		 * device ref_clk is stable for a given time before the hibern8
 		 * exit command.
 		 */
-		if (enable)
-			udelay(1);
+		if (enable) {
+			if (host->hba->dev_info.quirks &
+			    UFS_DEVICE_QUIRK_WAIT_AFTER_REF_CLK_UNGATE)
+				usleep_range(50, 60);
+			else
+				udelay(1);
+		}
 
 		host->is_dev_ref_clk_enabled = enable;
 	}
diff --git a/drivers/scsi/ufs/ufs_quirks.h b/drivers/scsi/ufs/ufs_quirks.h
index 2aca9a75b67b43c495480a3060bb4ec8e21b2021..ff3182b3af20a7a4db9453fb2d9b3740c537e867 100644
--- a/drivers/scsi/ufs/ufs_quirks.h
+++ b/drivers/scsi/ufs/ufs_quirks.h
@@ -140,4 +140,12 @@ struct ufs_dev_fix {
  */
 #define UFS_DEVICE_QUIRK_HS_G1_TO_HS_G3_SWITCH (1 << 8)
 
+/*
+ * Some UFS devices need more delay after device reference clk is turned on
+ * but before initiation of the state transition to STALL from a LS-MODE or
+ * from the HIBERN8 state. Enable this quirk to give UFS devices 50us delay
+ * instead of the default delay.
+ */
+#define UFS_DEVICE_QUIRK_WAIT_AFTER_REF_CLK_UNGATE	(1 << 10)
+
 #endif /* UFS_QUIRKS_H_ */
diff --git a/drivers/scsi/ufs/ufshcd.c b/drivers/scsi/ufs/ufshcd.c
index 64b1933ab559961d0dea102e20b83ba67fb0ed0b..1155f4b5d6b910474bd179831ae54ad327aa619f 100644
--- a/drivers/scsi/ufs/ufshcd.c
+++ b/drivers/scsi/ufs/ufshcd.c
@@ -3,7 +3,7 @@
  *
  * This code is based on drivers/scsi/ufs/ufshcd.c
  * Copyright (C) 2011-2013 Samsung India Software Operations
- * Copyright (c) 2013-2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2013-2019, The Linux Foundation. All rights reserved.
  *
  * Authors:
  *	Santosh Yaraganavi <santosh.sy@samsung.com>
@@ -48,6 +48,7 @@
 #include "unipro.h"
 #include "ufs-debugfs.h"
 #include "ufs-qcom.h"
+#include <linux/project_info.h>
 
 #ifdef CONFIG_DEBUG_FS
 
@@ -418,6 +419,8 @@ static struct ufs_dev_fix ufs_fixups[] = {
 	UFS_FIX(UFS_VENDOR_SKHYNIX, UFS_ANY_MODEL, UFS_DEVICE_NO_VCCQ),
 	UFS_FIX(UFS_VENDOR_SKHYNIX, UFS_ANY_MODEL,
 		UFS_DEVICE_QUIRK_HOST_PA_SAVECONFIGTIME),
+	UFS_FIX(UFS_VENDOR_SKHYNIX, UFS_ANY_MODEL,
+		UFS_DEVICE_QUIRK_WAIT_AFTER_REF_CLK_UNGATE),
 	UFS_FIX(UFS_VENDOR_SKHYNIX, "hB8aL1",
 		UFS_DEVICE_QUIRK_HS_G1_TO_HS_G3_SWITCH),
 	UFS_FIX(UFS_VENDOR_SKHYNIX, "hC8aL1",
@@ -2181,7 +2184,8 @@ int ufshcd_hold(struct ufs_hba *hba, bool async)
 			spin_unlock_irqrestore(hba->host->host_lock, flags);
 			flush_work(&hba->clk_gating.ungate_work);
 			spin_lock_irqsave(hba->host->host_lock, flags);
-			goto start;
+			if (hba->ufshcd_state == UFSHCD_STATE_OPERATIONAL)
+				goto start;
 		}
 		break;
 	case REQ_CLKS_OFF:
@@ -4065,6 +4069,7 @@ static int ufshcd_exec_dev_cmd(struct ufs_hba *hba,
 	int tag;
 	struct completion wait;
 	unsigned long flags;
+	bool has_read_lock = false;
 
 	/*
 	 * May get invoked from shutdown and IOCTL contexts.
@@ -4072,8 +4077,10 @@ static int ufshcd_exec_dev_cmd(struct ufs_hba *hba,
 	 * In error recovery context, it may come with lock acquired.
 	 */
 
-	if (!ufshcd_is_shutdown_ongoing(hba) && !ufshcd_eh_in_progress(hba))
+	if (!ufshcd_is_shutdown_ongoing(hba) && !ufshcd_eh_in_progress(hba)) {
 		down_read(&hba->lock);
+		has_read_lock = true;
+	}
 
 	/*
 	 * Get free slot, sleep if slots are unavailable.
@@ -4107,7 +4114,7 @@ static int ufshcd_exec_dev_cmd(struct ufs_hba *hba,
 out_put_tag:
 	ufshcd_put_dev_cmd_tag(hba, tag);
 	wake_up(&hba->dev_cmd.tag_wq);
-	if (!ufshcd_is_shutdown_ongoing(hba) && !ufshcd_eh_in_progress(hba))
+	if (has_read_lock)
 		up_read(&hba->lock);
 	return err;
 }
@@ -4623,6 +4630,116 @@ int ufshcd_read_device_desc(struct ufs_hba *hba, u8 *buf, u32 size)
 	return ufshcd_read_desc(hba, QUERY_DESC_IDN_DEVICE, 0, buf, size);
 }
 
+int ufshcd_read_geometry_desc(struct ufs_hba *hba, u8 *buf, u32 size)
+{
+	return ufshcd_read_desc(hba, QUERY_DESC_IDN_GEOMETRY, 0, buf, size);
+}
+
+static int ufs_get_capacity_info(struct ufs_hba *hba,  u64 *pcapacity)
+{
+	int err;
+	u8 geometry_buf[QUERY_DESC_GEOMETRY_DEF_SIZE];
+
+	err = ufshcd_read_geometry_desc(hba, geometry_buf,
+		QUERY_DESC_GEOMETRY_DEF_SIZE);
+
+	if (err)
+		goto out;
+
+	*pcapacity = (u64)geometry_buf[0x04] << 56 |
+		(u64)geometry_buf[0x04 + 1] << 48 |
+		(u64)geometry_buf[0x04 + 2] << 40 |
+		(u64)geometry_buf[0x04 + 3] << 32 |
+		(u64)geometry_buf[0x04 + 4] << 24 |
+		(u64)geometry_buf[0x04 + 5] << 16 |
+		(u64)geometry_buf[0x04 + 6] << 8 |
+		(u64)geometry_buf[0x04 + 7];
+
+	printk("ufs_get_capacity_info size = 0x%llx", *pcapacity);
+
+out:
+	return err;
+}
+
+static char *ufs_get_capacity_size(u64 capacity)
+{
+	if (capacity == 0x1D62000) { //16G
+		return "16G";
+	} else if (capacity == 0x3B9E000) { //32G
+		return "32G";
+	} else if (capacity == 0x7734000) { //64G
+		return "64G";
+	} else if (capacity == 0xEE60000) { //128G
+		return "128G";
+	} else if (capacity == 0xEE64000) { //128G V4
+		return "128G";
+	} else if (capacity == 0x1DCBC000) {
+		return "256G";
+	} else {
+		return "0G";
+	}
+}
+
+char ufs_vendor_and_rev[32] = {'\0'};
+char ufs_product_id[32] = {'\0'};
+int ufs_fill_info(struct ufs_hba *hba)
+{
+	int err = 0;
+	u64 ufs_capacity = 0;
+	char ufs_vendor[9] = {'\0'};
+	char ufs_rev[6] = {'\0'};
+
+	/* Error Handle: Before filling ufs info, we must confirm sdev_ufs_device structure is not NULL*/
+	if (!hba->sdev_ufs_device) {
+		dev_err(hba->dev, "%s:hba->sdev_ufs_device is NULL!\n", __func__);
+		goto out;
+	}
+
+	/* Copy UFS info from host controller structure (ex:vendor name, firmware revision) */
+	if (!hba->sdev_ufs_device->vendor) {
+		dev_err(hba->dev, "%s: UFS vendor info is NULL\n", __func__);
+		strlcpy(ufs_vendor, "UNKNOWN", 7);
+	} else {
+		strlcpy(ufs_vendor, hba->sdev_ufs_device->vendor,
+			sizeof(ufs_vendor)-1);
+	}
+
+	if (!hba->sdev_ufs_device->rev) {
+		dev_err(hba->dev, "%s: UFS firmware info is NULL\n", __func__);
+		strlcpy(ufs_rev, "NONE", 4);
+	} else {
+		strlcpy(ufs_rev, hba->sdev_ufs_device->rev, sizeof(ufs_rev)-1);
+	}
+
+	if (!hba->sdev_ufs_device->model) {
+		dev_err(hba->dev, "%s: UFS product id info is NULL\n", __func__);
+		strlcpy(ufs_product_id, "UNKNOWN", 7);
+	} else {
+		strlcpy(ufs_product_id, hba->sdev_ufs_device->model, 16);
+	}
+
+	/* Get UFS storage size*/
+	err = ufs_get_capacity_info(hba, &ufs_capacity);
+	if (err) {
+		dev_err(hba->dev, "%s: Failed getting capacity info\n", __func__);
+		goto out;
+	}
+
+	/* Combine vendor name with firmware revision */
+	strcat(ufs_vendor_and_rev, ufs_vendor);
+	if (strncmp(ufs_vendor, "MICRON", 6) != 0) {
+		strcat(ufs_vendor_and_rev, " ");
+		strcat(ufs_vendor_and_rev, ufs_get_capacity_size(ufs_capacity));
+	}
+	strcat(ufs_vendor_and_rev, " ");
+	strcat(ufs_vendor_and_rev, ufs_rev);
+
+	push_component_info(UFS, ufs_product_id, ufs_vendor_and_rev);
+out:
+	return err;
+
+}
+
 /**
  * ufshcd_read_string_desc - read string descriptor
  * @hba: pointer to adapter instance
@@ -5443,6 +5560,7 @@ int ufshcd_change_power_mode(struct ufs_hba *hba,
 			     struct ufs_pa_layer_attr *pwr_mode)
 {
 	int ret = 0;
+	u32 peer_rx_hs_adapt_initial_cap;
 
 	/* if already configured to the requested pwr_mode */
 	if (!hba->restore_needed &&
@@ -5493,8 +5611,19 @@ int ufshcd_change_power_mode(struct ufs_hba *hba,
 						pwr_mode->hs_rate);
 
 	if (pwr_mode->gear_tx == UFS_HS_G4) {
+		ret = ufshcd_dme_peer_get(hba,
+				 UIC_ARG_MIB_SEL(RX_HS_ADAPT_INITIAL_CAPABILITY,
+					UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)),
+				    &peer_rx_hs_adapt_initial_cap);
+		if (ret) {
+			dev_err(hba->dev,
+				"%s: RX_HS_ADAPT_INITIAL_CAP get failed %d\n",
+				__func__, ret);
+			peer_rx_hs_adapt_initial_cap =
+						PA_PEERRXHSADAPTINITIAL_Default;
+		}
 		ret = ufshcd_dme_set(hba, UIC_ARG_MIB(PA_PEERRXHSADAPTINITIAL),
-				     PA_PEERRXHSADAPTINITIAL_Default);
+				     peer_rx_hs_adapt_initial_cap);
 		/* INITIAL ADAPT */
 		ufshcd_dme_set(hba, UIC_ARG_MIB(PA_TXHSADAPTTYPE),
 			       PA_INITIAL_ADAPT);
@@ -5582,9 +5711,11 @@ static int ufshcd_complete_dev_init(struct ufs_hba *hba)
 	}
 
 	/* poll for max. 1000 iterations for fDeviceInit flag to clear */
-	for (i = 0; i < 1000 && !err && flag_res; i++)
+	for (i = 0; i < 1000 && !err && flag_res; i++) {
 		err = ufshcd_query_flag_retry(hba, UPIU_QUERY_OPCODE_READ_FLAG,
 			QUERY_FLAG_IDN_FDEVICEINIT, &flag_res);
+		usleep_range(1000, 1000); // 1ms sleep
+	}
 
 	if (err)
 		dev_err(hba->dev,
@@ -7678,7 +7809,10 @@ static int ufshcd_abort(struct scsi_cmnd *cmd)
 	 * To avoid these unnecessary/illegal step we skip to the last error
 	 * handling stage: reset and restore.
 	 */
-	if (lrbp->lun == UFS_UPIU_UFS_DEVICE_WLUN)
+	if ((lrbp->lun == UFS_UPIU_UFS_DEVICE_WLUN) ||
+	    (lrbp->lun == UFS_UPIU_REPORT_LUNS_WLUN) ||
+	    (lrbp->lun == UFS_UPIU_BOOT_WLUN) ||
+	    (lrbp->lun == UFS_UPIU_RPMB_WLUN))
 		return ufshcd_eh_host_reset_handler(cmd);
 
 	ufshcd_hold_all(hba);
@@ -8852,6 +8986,7 @@ static int ufshcd_probe_hba(struct ufs_hba *hba)
 			hba->clk_scaling.is_allowed = true;
 		}
 
+
 		scsi_scan_host(hba->host);
 		pm_runtime_put_sync(hba->dev);
 	}
@@ -8887,6 +9022,11 @@ static int ufshcd_probe_hba(struct ufs_hba *hba)
 	trace_ufshcd_init(dev_name(hba->dev), ret,
 		ktime_to_us(ktime_sub(ktime_get(), start)),
 		hba->curr_dev_pwr_mode, hba->uic_link_state);
+
+	if (!ret) {
+		ufs_fill_info(hba);
+	}
+
 	return ret;
 }
 
diff --git a/drivers/soc/qcom/Kconfig b/drivers/soc/qcom/Kconfig
index a8430d3dea0bfb71d44d41d3d9fc38880adb1c60..941b8dbf47095d2f21bc336095e1a842d16374a5 100644
--- a/drivers/soc/qcom/Kconfig
+++ b/drivers/soc/qcom/Kconfig
@@ -721,15 +721,6 @@ config MSM_NOPM
 	  This enables bare minimum support of power management at platform level.
 	  i.e WFI
 
-config MSM_QBT1000
-	bool "QBT1000 Ultrasonic Fingerprint Sensor"
-	help
-	  This driver provides services for configuring the fingerprint
-	  sensor hardware and for communicating with the trusted app which
-	  uses it. It enables clocks and provides commands for loading
-	  trusted apps, unloading them and marshalling buffers to the
-	  trusted fingerprint app.
-
 config APSS_CORE_EA
 	depends on CPU_FREQ && PM_OPP
 	bool "Qualcomm Technology Inc specific power aware driver"
@@ -827,6 +818,20 @@ config QCOM_CDSP_RM
 	  CPU L3 clock for improving IO-Coherent throughput and opt for QoS mode
 	  to improve RPC latency.
 
+config PROJECT_INFO
+	bool "detect project info"
+	default n
+        help
+           detect projcet info  If unsure, say n.
+
+config RF_CABLE_DETECT
+	bool "detect RF cable connection"
+	help
+	  detect RF cable connection for different RF configuration
+	  To compile this driver as a module, choose M here: the module
+	  will be called RF cable.
+	  If unsure, say N.
+
 config QCOM_CX_IPEAK
 	bool "Common driver to handle Cx iPeak limitation"
 	help
diff --git a/drivers/soc/qcom/Makefile b/drivers/soc/qcom/Makefile
index a4104f1fae16eb118396adb19d6fa0f579394b7f..7796af49539550c78d0b284bf46247402873abd8 100644
--- a/drivers/soc/qcom/Makefile
+++ b/drivers/soc/qcom/Makefile
@@ -73,7 +73,6 @@ obj-$(CONFIG_QSEE_IPC_IRQ_BRIDGE) += qsee_ipc_irq_bridge.o
 obj-$(CONFIG_QCOM_GLINK) += glink_probe.o
 obj-$(CONFIG_QCOM_GLINK_PKT) += glink_pkt.o
 obj-$(CONFIG_QCOM_QDSS_BRIDGE) += qdss_bridge.o
-obj-$(CONFIG_MSM_QBT1000) += qbt1000.o
 obj-$(CONFIG_MSM_EVENT_TIMER) += event_timer.o
 obj-$(CONFIG_MSM_IDLE_STATS)	+= lpm-stats.o
 obj-$(CONFIG_QTI_RPM_STATS_LOG) += rpm_stats.o
@@ -92,7 +91,9 @@ endif
 obj-$(CONFIG_QCOM_SMP2P_SLEEPSTATE) += smp2p_sleepstate.o
 obj-$(CONFIG_QCOM_MEM_OFFLINE) += mem-offline.o
 obj-$(CONFIG_QCOM_CDSP_RM) += cdsprm.o
+obj-$(CONFIG_PROJECT_INFO) += project_info.o
 obj-$(CONFIG_QCOM_CX_IPEAK) += cx_ipeak.o
 obj-$(CONFIG_QCOM_AOP_DDR_MESSAGING) += aop_ddr_msgs.o
+obj-$(CONFIG_RF_CABLE_DETECT) += op_rf_cable_monitor.o
 obj-$(CONFIG_MSM_HAB) += hab/
 obj-$(CONFIG_QCOM_HYP_CORE_CTL) += hyp_core_ctl.o
diff --git a/drivers/soc/qcom/cdsprm.c b/drivers/soc/qcom/cdsprm.c
index 216db8e5a3dca855178315af88659a68e5e34d70..e3f7109ae33c6833cedd52d1069865f30ead3357 100644
--- a/drivers/soc/qcom/cdsprm.c
+++ b/drivers/soc/qcom/cdsprm.c
@@ -29,6 +29,7 @@
 #include <linux/of.h>
 #include <linux/of_device.h>
 #include <linux/of_platform.h>
+#include <linux/kthread.h>
 #include <linux/workqueue.h>
 #include <linux/pm_qos.h>
 #include <linux/delay.h>
@@ -152,9 +153,8 @@ struct cdsprm {
 	struct completion		msg_avail;
 	struct cdsprm_request		msg_queue[CDSPRM_MSG_QUEUE_DEPTH];
 	unsigned int			msg_queue_idx;
-	struct workqueue_struct		*work_queue;
+	struct task_struct		*cdsprm_wq_task;
 	struct workqueue_struct		*delay_work_queue;
-	struct work_struct		cdsprm_work;
 	struct work_struct		cdsprm_delay_work;
 	struct mutex			rm_lock;
 	spinlock_t			l3_lock;
@@ -162,7 +162,6 @@ struct cdsprm {
 	struct mutex			rpmsg_lock;
 	struct rpmsg_device		*rpmsgdev;
 	enum delay_state		dt_state;
-	enum delay_state		work_state;
 	unsigned long long		timestamp;
 	struct pm_qos_request		pm_qos_req;
 	unsigned int			qos_latency_us;
@@ -200,6 +199,7 @@ struct cdsprm {
 
 static struct cdsprm gcdsprm;
 static LIST_HEAD(cdsprm_list);
+DECLARE_WAIT_QUEUE_HEAD(cdsprm_wq);
 
 /**
  * cdsprm_register_cdspl3gov() - Register a method to set L3 clock
@@ -620,7 +620,21 @@ static void cdsprm_rpmsg_send_details(void)
 	}
 }
 
-static void process_cdsp_request(struct work_struct *work)
+static struct cdsprm_request *get_next_request(void)
+{
+	struct cdsprm_request *req = NULL;
+	unsigned long flags;
+
+	spin_lock_irqsave(&gcdsprm.list_lock, flags);
+	req = list_first_entry_or_null(&cdsprm_list,
+				struct cdsprm_request, node);
+	spin_unlock_irqrestore(&gcdsprm.list_lock,
+					flags);
+
+	return req;
+}
+
+static int process_cdsp_request_thread(void *data)
 {
 	struct cdsprm_request *req = NULL;
 	struct sysmon_msg *msg = NULL;
@@ -629,91 +643,89 @@ static void process_cdsp_request(struct work_struct *work)
 	int result = 0;
 	struct sysmon_msg_tx rpmsg_msg_tx;
 
-	while (gcdsprm.work_state ==
-			CDSP_DELAY_THREAD_STARTED) {
-		req = list_first_entry_or_null(&cdsprm_list,
-				struct cdsprm_request, node);
-		if (req) {
-			msg = &req->msg;
-			if (!msg) {
-				spin_lock_irqsave(&gcdsprm.list_lock, flags);
-				list_del(&req->node);
-				req->busy = false;
-				spin_unlock_irqrestore(&gcdsprm.list_lock,
-					flags);
-				continue;
-			}
-			if ((msg->feature_id == SYSMON_CDSP_FEATURE_RM_RX) &&
-				gcdsprm.b_qosinitdone) {
-				process_rm_request(msg);
-			} else if (msg->feature_id ==
-				SYSMON_CDSP_FEATURE_L3_RX) {
-				l3_clock_khz =
-				msg->fs.l3_struct.l3_clock_khz;
-				spin_lock_irqsave(&gcdsprm.l3_lock, flags);
-				gcdsprm.set_l3_freq_cached =
-							gcdsprm.set_l3_freq;
-				spin_unlock_irqrestore(&gcdsprm.l3_lock, flags);
-				if (gcdsprm.set_l3_freq_cached) {
-					gcdsprm.set_l3_freq_cached(
-						l3_clock_khz);
-					pr_debug("Set L3 clock %d done\n",
+	while (!kthread_should_stop()) {
+		result = wait_event_interruptible(cdsprm_wq,
+						(req = get_next_request()));
+
+		if (result)
+			continue;
+
+		msg = &req->msg;
+
+		if ((msg->feature_id == SYSMON_CDSP_FEATURE_RM_RX) &&
+			gcdsprm.b_qosinitdone) {
+			process_rm_request(msg);
+		} else if (msg->feature_id ==
+			SYSMON_CDSP_FEATURE_L3_RX) {
+			l3_clock_khz = msg->fs.l3_struct.l3_clock_khz;
+
+			spin_lock_irqsave(&gcdsprm.l3_lock, flags);
+			gcdsprm.set_l3_freq_cached = gcdsprm.set_l3_freq;
+			spin_unlock_irqrestore(&gcdsprm.l3_lock, flags);
+
+			if (gcdsprm.set_l3_freq_cached) {
+				gcdsprm.set_l3_freq_cached(l3_clock_khz);
+				pr_debug("Set L3 clock %d done\n",
 					l3_clock_khz);
-				}
-			} else if (msg->feature_id ==
-					SYSMON_CDSP_FEATURE_NPU_LIMIT_RX) {
-				mutex_lock(&gcdsprm.npu_activity_lock);
-				gcdsprm.set_corner_limit_cached =
-					gcdsprm.set_corner_limit;
-				if (gcdsprm.set_corner_limit_cached) {
-					gcdsprm.npu_corner_limit =
-						msg->fs.npu_limit.corner;
-					gcdsprm.b_applyingNpuLimit = true;
-					result =
-					gcdsprm.set_corner_limit_cached(
+			}
+		} else if (msg->feature_id ==
+				SYSMON_CDSP_FEATURE_NPU_LIMIT_RX) {
+			mutex_lock(&gcdsprm.npu_activity_lock);
+
+			gcdsprm.set_corner_limit_cached =
+						gcdsprm.set_corner_limit;
+
+			if (gcdsprm.set_corner_limit_cached) {
+				gcdsprm.npu_corner_limit =
+					msg->fs.npu_limit.corner;
+				gcdsprm.b_applyingNpuLimit = true;
+				result = gcdsprm.set_corner_limit_cached(
 						gcdsprm.npu_corner_limit);
-					gcdsprm.b_applyingNpuLimit = false;
-					pr_debug("Set NPU limit to %d\n",
-						msg->fs.npu_limit.corner);
-				} else {
-					result = -ENOMSG;
-					pr_debug("NPU limit not registered\n");
-				}
-				mutex_unlock(&gcdsprm.npu_activity_lock);
-				/*
-				 * Send Limit ack back to DSP
-				 */
-				rpmsg_msg_tx.feature_id =
-					SYSMON_CDSP_FEATURE_NPU_LIMIT_TX;
-				if (result == 0) {
-					rpmsg_msg_tx.fs.npu_limit_ack.corner =
-						msg->fs.npu_limit.corner;
-				} else {
-					rpmsg_msg_tx.fs.npu_limit_ack.corner =
-							CDSPRM_NPU_CLK_OFF;
-				}
-				rpmsg_msg_tx.size = sizeof(rpmsg_msg_tx);
-				result = rpmsg_send(gcdsprm.rpmsgdev->ept,
-					&rpmsg_msg_tx,
-					sizeof(rpmsg_msg_tx));
-				if (result)
-					pr_err("rpmsg send failed %d\n",
-					result);
-				else
-					pr_debug("NPU limit ack sent\n");
-			} else if (msg->feature_id ==
-					SYSMON_CDSP_FEATURE_VERSION_RX) {
-				cdsprm_rpmsg_send_details();
-				pr_debug("Sent preserved data to DSP\n");
+				gcdsprm.b_applyingNpuLimit = false;
+				pr_debug("Set NPU limit to %d\n",
+					msg->fs.npu_limit.corner);
+			} else {
+				result = -ENOMSG;
+				pr_debug("NPU limit not registered\n");
 			}
-			spin_lock_irqsave(&gcdsprm.list_lock, flags);
-			list_del(&req->node);
-			req->busy = false;
-			spin_unlock_irqrestore(&gcdsprm.list_lock, flags);
-		} else {
-			wait_for_completion(&gcdsprm.msg_avail);
+
+			mutex_unlock(&gcdsprm.npu_activity_lock);
+			/*
+			 * Send Limit ack back to DSP
+			 */
+			rpmsg_msg_tx.feature_id =
+				SYSMON_CDSP_FEATURE_NPU_LIMIT_TX;
+
+			if (result == 0) {
+				rpmsg_msg_tx.fs.npu_limit_ack.corner =
+					msg->fs.npu_limit.corner;
+			} else {
+				rpmsg_msg_tx.fs.npu_limit_ack.corner =
+						CDSPRM_NPU_CLK_OFF;
+			}
+
+			rpmsg_msg_tx.size = sizeof(rpmsg_msg_tx);
+			result = rpmsg_send(gcdsprm.rpmsgdev->ept,
+				&rpmsg_msg_tx,
+				sizeof(rpmsg_msg_tx));
+
+			if (result)
+				pr_err("rpmsg send failed %d\n", result);
+			else
+				pr_debug("NPU limit ack sent\n");
+		} else if (msg->feature_id ==
+				SYSMON_CDSP_FEATURE_VERSION_RX) {
+			cdsprm_rpmsg_send_details();
+			pr_debug("Sent preserved data to DSP\n");
 		}
+
+		spin_lock_irqsave(&gcdsprm.list_lock, flags);
+		list_del(&req->node);
+		req->busy = false;
+		spin_unlock_irqrestore(&gcdsprm.list_lock, flags);
 	}
+
+	do_exit(0);
 }
 
 static int cdsprm_rpmsg_probe(struct rpmsg_device *dev)
@@ -801,6 +813,7 @@ static int cdsprm_rpmsg_callback(struct rpmsg_device *dev, void *data,
 
 	if (b_valid) {
 		spin_lock_irqsave(&gcdsprm.list_lock, flags);
+
 		if (!gcdsprm.msg_queue[gcdsprm.msg_queue_idx].busy) {
 			req = &gcdsprm.msg_queue[gcdsprm.msg_queue_idx];
 			req->busy = true;
@@ -816,17 +829,10 @@ static int cdsprm_rpmsg_callback(struct rpmsg_device *dev, void *data,
 				"Unable to queue cdsp request, no memory\n");
 			return -ENOMEM;
 		}
+
 		list_add_tail(&req->node, &cdsprm_list);
 		spin_unlock_irqrestore(&gcdsprm.list_lock, flags);
-		if (gcdsprm.work_state ==
-				CDSP_DELAY_THREAD_NOT_STARTED) {
-			gcdsprm.work_state =
-				CDSP_DELAY_THREAD_STARTED;
-			queue_work(gcdsprm.work_queue,
-					&gcdsprm.cdsprm_work);
-		} else {
-			complete(&gcdsprm.msg_avail);
-		}
+		wake_up_interruptible(&cdsprm_wq);
 	}
 
 	return 0;
@@ -1063,10 +1069,12 @@ static int __init cdsprm_init(void)
 	init_completion(&gcdsprm.msg_avail);
 	init_completion(&gcdsprm.npu_activity_complete);
 	init_completion(&gcdsprm.npu_corner_complete);
-	gcdsprm.work_queue = create_singlethread_workqueue("cdsprm-wq");
 
-	if (!gcdsprm.work_queue) {
-		pr_err("Failed to create rm work queue\n");
+	gcdsprm.cdsprm_wq_task = kthread_run(process_cdsp_request_thread,
+					NULL, "cdsprm-wq");
+
+	if (!gcdsprm.cdsprm_wq_task) {
+		pr_err("Failed to create kernel thread\n");
 		return -ENOMEM;
 	}
 
@@ -1080,7 +1088,6 @@ static int __init cdsprm_init(void)
 	}
 
 	INIT_WORK(&gcdsprm.cdsprm_delay_work, process_delayed_rm_request);
-	INIT_WORK(&gcdsprm.cdsprm_work, process_cdsp_request);
 	err = platform_driver_register(&cdsp_rm);
 
 	if (err) {
@@ -1113,7 +1120,7 @@ static int __init cdsprm_init(void)
 bail:
 	destroy_workqueue(gcdsprm.delay_work_queue);
 err_wq:
-	destroy_workqueue(gcdsprm.work_queue);
+	kthread_stop(gcdsprm.cdsprm_wq_task);
 
 	return err;
 }
@@ -1126,9 +1133,11 @@ static void __exit cdsprm_exit(void)
 	gcdsprm.b_rpmsg_register = false;
 	platform_driver_unregister(&cdsp_rm);
 	platform_driver_unregister(&hvx_rm);
-	gcdsprm.work_state = CDSP_DELAY_THREAD_NOT_STARTED;
 	complete(&gcdsprm.msg_avail);
-	destroy_workqueue(gcdsprm.work_queue);
+
+	if (gcdsprm.cdsprm_wq_task)
+		kthread_stop(gcdsprm.cdsprm_wq_task);
+
 	destroy_workqueue(gcdsprm.delay_work_queue);
 	debugfs_remove_recursive(gcdsprm.debugfs_dir);
 }
diff --git a/drivers/soc/qcom/dfc_qmi.c b/drivers/soc/qcom/dfc_qmi.c
index acb5ac44e6ef00ea1e6bb260b78dacea120095bc..376d8ec21e8a25e3bfcf2034cd80b8280b6e1734 100644
--- a/drivers/soc/qcom/dfc_qmi.c
+++ b/drivers/soc/qcom/dfc_qmi.c
@@ -15,7 +15,7 @@
 #include <net/pkt_sched.h>
 #include <linux/soc/qcom/qmi.h>
 #include <soc/qcom/rmnet_qmi.h>
-
+#include <soc/qcom/qmi_rmnet.h>
 #include "qmi_rmnet_i.h"
 #define CREATE_TRACE_POINTS
 #include <trace/events/dfc.h>
@@ -890,6 +890,10 @@ static int dfc_all_bearer_flow_ctl(struct net_device *dev,
 		bearer_itm->seq = fc_info->seq_num;
 		bearer_itm->ack_req = ack_req;
 		bearer_itm->ancillary = ancillary;
+
+		bearer_itm->last_grant = fc_info->num_bytes;
+		bearer_itm->last_seq = fc_info->seq_num;
+
 	}
 
 	list_for_each_entry(flow_itm, &qos->flow_head, list) {
@@ -930,6 +934,9 @@ static int dfc_update_fc_map(struct net_device *dev, struct qos_info *qos,
 		itm->ack_req = ack_req;
 		itm->ancillary = ancillary;
 
+		itm->last_grant = fc_info->num_bytes;
+		itm->last_seq = fc_info->seq_num;
+
 		if (action != -1)
 			rc = dfc_bearer_flow_ctl(dev, itm, qos);
 	} else {
@@ -1029,6 +1036,9 @@ static void dfc_qmi_ind_work(struct work_struct *work)
 	} while (svc_ind != NULL);
 
 	local_bh_enable();
+
+	qmi_rmnet_set_dl_msg_active(dfc->rmnet_port);
+
 }
 
 static void dfc_clnt_ind_cb(struct qmi_handle *qmi, struct sockaddr_qrtr *sq,
diff --git a/drivers/soc/qcom/fsa4480-i2c.c b/drivers/soc/qcom/fsa4480-i2c.c
index 38ce573788703c73d5858407c28454c1011bee60..34b4647e87c6fbdbc2da1c4070c7f4c2351bebbc 100644
--- a/drivers/soc/qcom/fsa4480-i2c.c
+++ b/drivers/soc/qcom/fsa4480-i2c.c
@@ -238,7 +238,7 @@ int fsa4480_switch_event(struct device_node *node,
 		return -EINVAL;
 	if (!fsa_priv->regmap)
 		return -EINVAL;
-
+	pr_err("%s event = %d\n", __func__, (int)event);
 	switch (event) {
 	case FSA_MIC_GND_SWAP:
 		regmap_read(fsa_priv->regmap, FSA4480_SWITCH_CONTROL,
diff --git a/drivers/soc/qcom/icnss.c b/drivers/soc/qcom/icnss.c
index 79d73184bf34b2c7a098b0b6a206d14927a5ab49..a5282f3ec609e809437cf900db11d38874f5fd6e 100644
--- a/drivers/soc/qcom/icnss.c
+++ b/drivers/soc/qcom/icnss.c
@@ -51,6 +51,9 @@
 #include "icnss_private.h"
 #include "icnss_qmi.h"
 
+#include <linux/project_info.h>
+static u32 fw_version;
+static u32 fw_version_ext;
 #define MAX_PROP_SIZE			32
 #define NUM_LOG_PAGES			10
 #define NUM_LOG_LONG_PAGES		4
@@ -868,6 +871,29 @@ static int icnss_driver_event_server_exit(void *data)
 	return 0;
 }
 
+/* Initial and show wlan firmware build version */
+void cnss_set_fw_version(u32 version, u32 ext)
+{
+	fw_version = version;
+	fw_version_ext = ext;
+}
+EXPORT_SYMBOL(cnss_set_fw_version);
+
+static ssize_t cnss_version_information_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	if (!penv)
+		return -ENODEV;
+	return scnprintf(buf, PAGE_SIZE, "%u.%u.%u.%u.%u\n",
+		 (fw_version & 0xf0000000) >> 28,
+	(fw_version & 0xf000000) >> 24, (fw_version & 0xf00000) >> 20,
+	fw_version & 0x7fff, (fw_version_ext & 0xf0000000) >> 28);
+}
+
+static DEVICE_ATTR(cnss_version_information, 0444,
+			cnss_version_information_show, NULL);
+
+
 static int icnss_call_driver_probe(struct icnss_priv *priv)
 {
 	int ret = 0;
@@ -3201,6 +3227,9 @@ static int icnss_probe(struct platform_device *pdev)
 			     ret);
 
 	penv = priv;
+	device_create_file(&penv->pdev->dev,
+		 &dev_attr_cnss_version_information);
+	push_component_info(WCN, "WCN3998", "QualComm");
 
 	icnss_pr_info("Platform driver probed successfully\n");
 
@@ -3223,6 +3252,8 @@ static int icnss_remove(struct platform_device *pdev)
 	device_init_wakeup(&penv->pdev->dev, false);
 
 	icnss_debugfs_destroy(penv);
+	device_remove_file(&penv->pdev->dev,
+		 &dev_attr_cnss_version_information);
 
 	icnss_modem_ssr_unregister_notifier(penv);
 
diff --git a/drivers/soc/qcom/icnss_qmi.c b/drivers/soc/qcom/icnss_qmi.c
index 8d391c47fa2b3722398674f344a5f55b8bb2cff3..d516cd82b7a290f0103d9d40a52a5d571ad8eeca 100644
--- a/drivers/soc/qcom/icnss_qmi.c
+++ b/drivers/soc/qcom/icnss_qmi.c
@@ -355,7 +355,7 @@ int wlfw_cap_send_sync_msg(struct icnss_priv *priv)
 				    ret);
 		goto out;
 	} else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
-		icnss_qmi_fatal_err("QMI Capability request rejected, result:%d error:%d\n",
+		icnss_pr_err("QMI Capability request rejected, result:%d error:%d\n",
 			resp->resp.result, resp->resp.error);
 		ret = -resp->resp.result;
 		if (resp->resp.error == QMI_ERR_PLAT_CCPM_CLK_INIT_FAILED)
diff --git a/drivers/soc/qcom/msm_bus/msm_bus_arb_rpmh.c b/drivers/soc/qcom/msm_bus/msm_bus_arb_rpmh.c
index 5f40edca58964b87f4f260b7c149a03e08e791b1..09e691630847d2455b6ddb9d8ad11374ade76ce0 100644
--- a/drivers/soc/qcom/msm_bus/msm_bus_arb_rpmh.c
+++ b/drivers/soc/qcom/msm_bus/msm_bus_arb_rpmh.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2014-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -17,6 +17,7 @@
 #include <linux/rtmutex.h>
 #include <linux/clk.h>
 #include <linux/msm-bus.h>
+#include <dt-bindings/msm/msm-bus-ids.h>
 #include "msm_bus_core.h"
 #include "msm_bus_rpmh.h"
 
@@ -1302,7 +1303,7 @@ static uint32_t register_client_adhoc(struct msm_bus_scale_pdata *pdata)
 		}
 		client->src_devs[i] = dev;
 
-		MSM_BUS_ERR("%s:find path.src %d dest %d",
+		MSM_BUS_DBG("%s:find path.src %d dest %d",
 				__func__, src, dest);
 
 		lnode[i] = getpath(dev, dest, client->pdata->name);
@@ -1316,7 +1317,7 @@ static uint32_t register_client_adhoc(struct msm_bus_scale_pdata *pdata)
 	handle = gen_handle(client);
 	msm_bus_dbg_client_data(client->pdata, MSM_BUS_DBG_REGISTER,
 					handle);
-	MSM_BUS_ERR("%s:Client handle %d %s", __func__, handle,
+	MSM_BUS_DBG("%s:Client handle %d %s", __func__, handle,
 						client->pdata->name);
 	rt_mutex_unlock(&msm_bus_adhoc_lock);
 	return handle;
@@ -1393,6 +1394,15 @@ static int update_client_paths(struct msm_bus_client *client, bool log_trns,
 			goto exit_update_client_paths;
 		}
 
+		if (dest == MSM_BUS_SLAVE_IPA_CORE && cur_idx <= 0 && idx > 0) {
+			struct device *dev;
+
+			dev = bus_find_device(&msm_bus_type, NULL,
+				(void *) &dest, msm_bus_device_match_adhoc);
+			if (dev)
+				msm_bus_commit_single(dev);
+		}
+
 		if (log_trns)
 			getpath_debug(src, lnode, pdata->active_only);
 	}
diff --git a/drivers/soc/qcom/msm_bus/msm_bus_fabric_rpmh.c b/drivers/soc/qcom/msm_bus/msm_bus_fabric_rpmh.c
index 772f0a73260abebba5c429a3d271bfdd95827757..b1116460122eabf0f4940e794bb12e0d22c1f32c 100644
--- a/drivers/soc/qcom/msm_bus/msm_bus_fabric_rpmh.c
+++ b/drivers/soc/qcom/msm_bus/msm_bus_fabric_rpmh.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2014-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -735,6 +735,26 @@ static void bcm_commit_single_req(struct msm_bus_node_device_type *cur_bcm,
 	kfree(cmd_active);
 }
 
+void msm_bus_commit_single(struct device *dev)
+{
+	struct msm_bus_node_device_type *bus_dev;
+	struct msm_bus_node_device_type *bcm_dev;
+
+	if (!dev)
+		return;
+
+	bus_dev = to_msm_bus_node(dev);
+	if (!bus_dev)
+		return;
+
+	bcm_dev = to_msm_bus_node(bus_dev->node_info->bcm_devs[0]);
+	if (!bcm_dev)
+		return;
+
+	bcm_commit_single_req(bcm_dev, bcm_dev->node_vec[DUAL_CTX].vec_a,
+	bcm_dev->node_vec[DUAL_CTX].vec_b);
+}
+
 void *msm_bus_realloc_devmem(struct device *dev, void *p, size_t old_size,
 					size_t new_size, gfp_t flags)
 {
diff --git a/drivers/soc/qcom/msm_bus/msm_bus_rpmh.h b/drivers/soc/qcom/msm_bus/msm_bus_rpmh.h
index ffa6f92177d4d684e334ab844ff131269f6b2408..ba752c631ad1691ce19ab870ec3420d410aef661 100644
--- a/drivers/soc/qcom/msm_bus/msm_bus_rpmh.h
+++ b/drivers/soc/qcom/msm_bus/msm_bus_rpmh.h
@@ -1,4 +1,4 @@
-/* Copyright (c) 2014-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -242,6 +242,7 @@ static inline struct msm_bus_node_device_type *to_msm_bus_node(struct device *d)
 int msm_bus_enable_limiter(struct msm_bus_node_device_type *nodedev,
 				int throttle_en, uint64_t lim_bw);
 int msm_bus_commit_data(struct list_head *clist);
+void msm_bus_commit_single(struct device *dev);
 int bcm_remove_handoff_req(struct device *dev, void *data);
 int commit_late_init_data(bool lock);
 int msm_bus_query_gen(struct list_head *qlist,
diff --git a/drivers/soc/qcom/op_rf_cable_monitor.c b/drivers/soc/qcom/op_rf_cable_monitor.c
new file mode 100644
index 0000000000000000000000000000000000000000..7d8acbcf45aa9889545c2884c786be6c253d9d25
--- /dev/null
+++ b/drivers/soc/qcom/op_rf_cable_monitor.c
@@ -0,0 +1,501 @@
+/*For OEM project monitor RF cable connection status,
+ * and config different RF configuration
+ */
+
+#include <linux/export.h>
+#include <linux/module.h>
+#include <linux/err.h>
+#include <linux/of.h>
+#include <linux/sys_soc.h>
+#include <linux/slab.h>
+#include <linux/stat.h>
+#include <linux/string.h>
+#include <linux/types.h>
+#include <linux/project_info.h>
+#include <linux/soc/qcom/smem.h>
+#include <linux/gpio.h>
+#include <linux/workqueue.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <soc/qcom/subsystem_restart.h>
+#include <linux/proc_fs.h>
+#include <linux/uaccess.h>
+#include <linux/platform_device.h>
+#include <linux/module.h>
+#include <linux/of_gpio.h>
+#include <linux/op_rf_cable_monitor.h>
+
+#define RF_CABLE_STATE_ACTIVE   "oem_rf_cable_active"
+
+
+static struct project_info *project_info_desc;
+
+struct cable_data {
+    int irq_0;
+    int irq_1;
+    int cable_gpio_0;
+    int cable_gpio_1;
+    int support_timer;
+    struct delayed_work work;
+    struct workqueue_struct *wqueue;
+    struct device *dev;
+    struct wakeup_source wl;
+    atomic_t running;
+    int rf_v2;
+    int rf_v3;
+    int rf_v3_pre;
+    spinlock_t lock;
+    int enable;
+    int is_rf_factory_mode;
+    struct pinctrl *gpio_pinctrl;
+    struct pinctrl_state *gpio_pinctrl_active;
+    struct pinctrl_state *gpio_pinctrl_suspend;
+};
+static struct cable_data *rf_cable_data;
+
+static char *cmdline_find_option(char *str)
+{
+    return strnstr(saved_command_line, str, strlen(saved_command_line));
+}
+
+int modify_rf_cable_smem_info(uint32 status)
+{
+    size_t size;
+
+    project_info_desc = qcom_smem_get(QCOM_SMEM_HOST_ANY,SMEM_PROJECT_INFO, &size);
+
+    if (IS_ERR_OR_NULL(project_info_desc))
+        pr_err("%s: get project_info failure\n", __func__);
+    else {
+        project_info_desc->rf_v3 = status;
+        pr_err("%s: rf_cable: %d\n",
+            __func__, project_info_desc->rf_v3);
+    }
+    return 0;
+}
+
+int modify_rf_v2_info(uint32 status)
+{
+    size_t size;
+
+    project_info_desc = qcom_smem_get(QCOM_SMEM_HOST_ANY, SMEM_PROJECT_INFO, &size);
+
+    if (IS_ERR_OR_NULL(project_info_desc))
+        pr_err("%s: get project_info failure\n", __func__);
+    else {
+        project_info_desc->rf_v2 = status;
+        pr_err("%s: rf_cable: %d\n",
+                __func__, project_info_desc->rf_v3);
+    }
+    return 0;
+}
+
+static void irq_cable_enable(int enable)
+{
+    unsigned long flags;
+
+    if (!rf_cable_data->support_timer) {
+
+        spin_lock_irqsave(&rf_cable_data->lock, flags);
+        if(enable) {
+             enable_irq(rf_cable_data->irq_0);
+             enable_irq(rf_cable_data->irq_1);
+        } else {
+            disable_irq_nosync(rf_cable_data->irq_0);
+            disable_irq_nosync(rf_cable_data->irq_1);
+        }
+        spin_unlock_irqrestore(&rf_cable_data->lock, flags);
+    }
+}
+
+static void rf_cable_work(struct work_struct *work)
+{
+
+    irq_cable_enable(0);
+    /*
+    pr_err("%s rf_v3_pre=%d, rf_v3=%d gpio0=%d gpio1=%d,\n",
+        __func__, rf_cable_data->rf_v3_pre,
+        rf_cable_data->rf_v3,
+        gpio_get_value(rf_cable_data->cable_gpio_0),
+        gpio_get_value(rf_cable_data->cable_gpio_1));
+    */
+    rf_cable_data->rf_v3 =
+        gpio_get_value(rf_cable_data->cable_gpio_0) ||
+        gpio_get_value(rf_cable_data->cable_gpio_1);
+
+    if (rf_cable_data->rf_v3 != rf_cable_data->rf_v3_pre)
+    {
+        modify_rf_cable_smem_info(rf_cable_data->rf_v3);
+        op_restart_modem();
+    }
+    rf_cable_data->rf_v3_pre =
+    gpio_get_value(rf_cable_data->cable_gpio_0) ||
+    gpio_get_value(rf_cable_data->cable_gpio_1);
+
+    irq_cable_enable(1);
+
+    if (rf_cable_data->support_timer) {
+
+        queue_delayed_work(rf_cable_data->wqueue, &rf_cable_data->work, msecs_to_jiffies(2*HZ));
+    }
+}
+
+irqreturn_t cable_interrupt(int irq, void *_dev)
+{
+    __pm_wakeup_event(&rf_cable_data->wl,
+        msecs_to_jiffies(CABLE_WAKELOCK_HOLD_TIME));
+    queue_delayed_work(rf_cable_data->wqueue,
+        &rf_cable_data->work, msecs_to_jiffies(500));
+    return IRQ_HANDLED;
+}
+
+static ssize_t rf_factory_mode_proc_read_func(struct file *file,
+        char __user *user_buf, size_t count, loff_t *ppos)
+{
+    char page[PAGESIZE];
+    int len;
+
+    len = scnprintf(page, sizeof(page), "%d\n", rf_cable_data->is_rf_factory_mode);
+
+    return simple_read_from_buffer(user_buf,
+            count, ppos, page, len);
+}
+
+static ssize_t rf_factory_mode_proc_write_func(struct file *file,
+        const char __user *buffer, size_t count, loff_t *ppos)
+{
+
+	int enable = 0;
+	char buf[10] = {0};
+	int ret = 0;
+
+    if (copy_from_user(buf, buffer, count))  {
+        pr_err("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    ret = kstrtoint(buf, 0, &enable);
+    if (ret < 0)
+        return ret;
+
+    pr_err("%s: input : %d\n", enable, __func__);
+    irq_cable_enable(0);
+    rf_cable_data->is_rf_factory_mode = enable;
+    if (!rf_cable_data->is_rf_factory_mode) {
+        modify_rf_v2_info(0);
+        pr_err("%s: Modem restart due to RF Factory Mode exit\n", enable, __func__);
+        op_restart_modem();
+    } else {
+        modify_rf_v2_info(2);
+        pr_err("%s: Modem restart due to RF Factory Mode entry\n", enable, __func__);
+        op_restart_modem();
+    }
+    irq_cable_enable(1);
+
+    return count;
+}
+
+static const struct file_operations rf_factory_mode_proc_fops = {
+    .write = rf_factory_mode_proc_write_func,
+    .read =  rf_factory_mode_proc_read_func,
+    .open = simple_open,
+    .owner = THIS_MODULE,
+};
+
+static ssize_t rf_cable_proc_read_func(struct file *file,
+    char __user *user_buf, size_t count, loff_t *ppos)
+{
+    char page[PAGESIZE];
+    int len;
+
+    len = scnprintf(page, sizeof(page), "%d\n", rf_cable_data->enable);
+
+    return simple_read_from_buffer(user_buf,
+        count, ppos, page, len);
+}
+
+static ssize_t rf_cable_proc_write_func(struct file *file,
+    const char __user *buffer, size_t count, loff_t *ppos)
+{
+    int enable = 0;
+    char buf[10];
+    int ret;
+
+    if (copy_from_user(buf, buffer, count))  {
+        pr_err("%s: read proc input error.\n", __func__);
+        return count;
+    }
+
+    ret = kstrtoint(buf, 0, &enable);
+    if (ret < 0)
+        return ret;
+
+    irq_cable_enable(0);
+
+    if (enable != rf_cable_data->enable) {
+        rf_cable_data->enable = enable;
+        if (!rf_cable_data->enable) {
+
+            rf_cable_data->rf_v3 = 1;
+
+            modify_rf_cable_smem_info(1);
+            if (!rf_cable_data->rf_v3_pre)
+                op_restart_modem();
+            rf_cable_data->rf_v3_pre = 1;
+        } else {
+
+            rf_cable_data->rf_v3 = gpio_get_value(rf_cable_data->cable_gpio_0) ||
+                gpio_get_value(rf_cable_data->cable_gpio_1);
+
+            modify_rf_cable_smem_info(rf_cable_data->rf_v3);
+            if (rf_cable_data->rf_v3 != rf_cable_data->rf_v3_pre)
+                op_restart_modem();
+            rf_cable_data->rf_v3_pre =
+            gpio_get_value(rf_cable_data->cable_gpio_0) ||
+            gpio_get_value(rf_cable_data->cable_gpio_1);
+        }
+    }
+    irq_cable_enable(1);
+
+    return count;
+}
+
+static const struct file_operations rf_enable_proc_fops = {
+    .write = rf_cable_proc_write_func,
+    .read =  rf_cable_proc_read_func,
+    .open = simple_open,
+    .owner = THIS_MODULE,
+};
+
+int create_rf_cable_procfs(void)
+{
+    int ret = 0;
+
+    if (!proc_create("rf_cable_config",
+        0644, NULL, &rf_enable_proc_fops)) {
+        pr_err("%s: proc_create enable fail!\n", __func__);
+        ret = -1;
+    }
+    rf_cable_data->enable = 1;
+
+    if (!proc_create("rf_factory_mode",
+                0644, NULL, &rf_factory_mode_proc_fops)) {
+        pr_err("%s: proc_create re_factory_mode fail!\n", __func__);
+        ret = -1;
+    }
+    rf_cable_data->is_rf_factory_mode = 0;
+    return ret;
+}
+
+static int op_rf_request_named_gpio(const char *label, int *gpio)
+{
+    struct device *dev = rf_cable_data->dev;
+    struct device_node *np = dev->of_node;
+    int rc = of_get_named_gpio(np, label, 0);
+
+    if (rc < 0) {
+        dev_err(dev, "failed to get '%s'\n", label);
+        *gpio = rc;
+        return rc;
+    }
+    *gpio = rc;
+    rc = devm_gpio_request(dev, *gpio, label);
+    if (rc) {
+        dev_err(dev, "failed to request gpio %d\n", *gpio);
+        return rc;
+    }
+    dev_info(dev, "%s - gpio: %d\n", label, *gpio);
+    return 0;
+}
+static int rf_cable_gpio_pinctrl_init(struct platform_device *pdev)
+{
+    int retval;
+    dev_dbg(&pdev->dev,"%s \n",__func__);
+
+    rf_cable_data->gpio_pinctrl = devm_pinctrl_get(&(pdev->dev));
+    if (IS_ERR_OR_NULL(rf_cable_data->gpio_pinctrl)) {
+        retval = PTR_ERR(rf_cable_data->gpio_pinctrl);
+        dev_dbg(&pdev->dev,"Target does not use pinctrl %d\n", retval);
+        goto err_pinctrl_get;
+    }
+
+    rf_cable_data->gpio_pinctrl_active
+        = pinctrl_lookup_state(rf_cable_data->gpio_pinctrl,
+                RF_CABLE_STATE_ACTIVE);
+    if (IS_ERR_OR_NULL(rf_cable_data->gpio_pinctrl_active)) {
+        retval = PTR_ERR(rf_cable_data->gpio_pinctrl_active);
+        dev_err(&pdev->dev,
+            "Can not lookup %s pinstate %d\n",
+            RF_CABLE_STATE_ACTIVE, retval);
+        goto err_pinctrl_lookup;
+    }
+
+    if ( rf_cable_data->gpio_pinctrl) {
+
+        retval = pinctrl_select_state(rf_cable_data->gpio_pinctrl,
+                    rf_cable_data->gpio_pinctrl_active);
+        if (retval < 0) {
+            dev_err(&pdev->dev,
+                "failed to select pin to active state");
+        }
+    }
+
+    return 0;
+
+err_pinctrl_lookup:
+    devm_pinctrl_put(rf_cable_data->gpio_pinctrl);
+err_pinctrl_get:
+    rf_cable_data->gpio_pinctrl = NULL;
+    return retval;
+}
+
+static int op_rf_cable_probe(struct platform_device *pdev)
+{
+    int rc = 0;
+    struct device *dev = &pdev->dev;
+
+    if (cmdline_find_option("ftm_mode")) {
+        pr_err("%s: ftm_mode FOUND! use 1 always\n", __func__);
+        modify_rf_cable_smem_info(1);
+    } else {
+        rf_cable_data = kzalloc(sizeof(struct cable_data), GFP_KERNEL);
+        if (!rf_cable_data) {
+            pr_err("%s: failed to allocate memory\n", __func__);
+            rc = -ENOMEM;
+            goto exit;
+        }
+
+        rf_cable_data->dev = dev;
+        dev_set_drvdata(dev, rf_cable_data);
+
+        rf_cable_gpio_pinctrl_init(pdev);
+
+        //request gpio 0 .gpio 1.
+        rc = op_rf_request_named_gpio("rf,cable-gpio-0",
+            &rf_cable_data->cable_gpio_0);
+        if (rc) {
+            pr_err("%s: op_rf_request_named_gpio gpio-0 fail\n",
+                __func__);
+            goto exit_gpio;
+        }
+        rc = op_rf_request_named_gpio("rf,cable-gpio-1",
+            &rf_cable_data->cable_gpio_1);
+        if (rc) {
+            pr_err("%s: op_rf_request_named_gpio gpio-1 fail\n",
+                __func__);
+            goto exit_gpio;
+        }
+        rc = of_property_read_u32(pdev->dev.of_node, "rf,cable-support-timer",
+                                 &rf_cable_data->support_timer);
+        if (rc) {
+            pr_err("%s: op_rf_request_named_gpio gpio-1 fail\n",
+                __func__);
+            goto exit_gpio;
+        }
+
+        //creat workqueue.
+        rf_cable_data->wqueue = create_singlethread_workqueue(
+            "op_rf_cable_wqueue");
+        INIT_DELAYED_WORK(&rf_cable_data->work, rf_cable_work);
+
+        //set input  and gpio to irq.
+        gpio_direction_input(rf_cable_data->cable_gpio_0);
+        gpio_direction_input(rf_cable_data->cable_gpio_1);
+
+        if (rf_cable_data->support_timer)
+        {
+            queue_delayed_work(rf_cable_data->wqueue, &rf_cable_data->work, msecs_to_jiffies(HZ));
+
+        } else {
+            rf_cable_data->irq_0 = gpio_to_irq(rf_cable_data->cable_gpio_0);
+            if (rf_cable_data->irq_0 < 0) {
+                pr_err("Unable to get irq number for GPIO %d, error %d\n",
+                    rf_cable_data->cable_gpio_0, rf_cable_data->irq_0);
+                rc = rf_cable_data->irq_0;
+                goto exit_gpio;
+            }
+
+            rf_cable_data->irq_1 = gpio_to_irq(rf_cable_data->cable_gpio_1);
+            if (rf_cable_data->irq_1 < 0) {
+                pr_err("Unable to get irq number for GPIO %d, error %d\n",
+                    rf_cable_data->cable_gpio_1, rf_cable_data->irq_1);
+                rc = rf_cable_data->irq_1;
+                goto exit_gpio;
+            }
+
+            //request _irq0
+            rc = request_irq(rf_cable_data->irq_0, cable_interrupt,
+                IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
+                "op_rf_cable", rf_cable_data);
+            if (rc) {
+                pr_err("could not request irq %d\n", rf_cable_data->irq_0);
+                goto exit_gpio;
+            }
+            pr_err("requested irq %d\n", rf_cable_data->irq_0);
+            enable_irq_wake(rf_cable_data->irq_0);
+
+             //request _irq1
+            rc = request_irq(rf_cable_data->irq_1, cable_interrupt,
+                IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
+                "op_rf_cable", rf_cable_data);
+            if (rc) {
+                pr_err("could not request irq %d\n", rf_cable_data->irq_1);
+                goto exit_gpio;
+            }
+
+            pr_err("requested irq %d\n", rf_cable_data->irq_1);
+            enable_irq_wake(rf_cable_data->irq_1);
+
+        }
+        wakeup_source_init(&rf_cable_data->wl,
+            "rf_cable_wake_lock");
+        spin_lock_init(&rf_cable_data->lock);
+        atomic_set(&rf_cable_data->running,
+            gpio_get_value(rf_cable_data->cable_gpio_0) ||
+            gpio_get_value(rf_cable_data->cable_gpio_1));
+
+        modify_rf_cable_smem_info(
+            gpio_get_value(rf_cable_data->cable_gpio_0) ||
+            gpio_get_value(rf_cable_data->cable_gpio_1));
+        create_rf_cable_procfs();
+    }
+    pr_err("%s: probe ok!\n", __func__);
+    return 0;
+
+exit_gpio:
+    kfree(rf_cable_data);
+exit:
+    pr_err("%s: probe Fail!\n", __func__);
+
+    return rc;
+}
+
+static const struct of_device_id rf_of_match[] = {
+    { .compatible = "oem,rf_cable", },
+    {}
+};
+MODULE_DEVICE_TABLE(of, rf_of_match);
+
+static struct platform_driver op_rf_cable_driver = {
+    .driver = {
+        .name       = "op_rf_cable",
+        .owner      = THIS_MODULE,
+        .of_match_table = rf_of_match,
+    },
+    .probe = op_rf_cable_probe,
+};
+
+static int __init op_rf_cable_init(void)
+{
+    int ret;
+
+    ret = platform_driver_register(&op_rf_cable_driver);
+    if (ret)
+        pr_err("rf_cable_driver register failed: %d\n", ret);
+
+    return ret;
+}
+
+MODULE_LICENSE("GPL v2");
+late_initcall(op_rf_cable_init);
+
diff --git a/drivers/soc/qcom/project_info.c b/drivers/soc/qcom/project_info.c
new file mode 100644
index 0000000000000000000000000000000000000000..538a8e231158e3baad6d7227cd572f20f00b68ae
--- /dev/null
+++ b/drivers/soc/qcom/project_info.c
@@ -0,0 +1,848 @@
+/* For OEM project information
+ *such as project name, hardware ID
+ */
+
+#include <linux/export.h>
+#include <linux/module.h>
+#include <linux/err.h>
+#include <linux/of.h>
+#include <linux/sys_soc.h>
+#include <linux/slab.h>
+#include <linux/stat.h>
+#include <linux/string.h>
+#include <linux/types.h>
+#include <linux/project_info.h>
+#include <linux/soc/qcom/smem.h>
+#include <linux/gpio.h>
+#include <soc/qcom/socinfo.h>
+#include <linux/of_gpio.h>
+#include <linux/platform_device.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/pinctrl/pinctrl.h>
+#include <linux/pinctrl/machine.h>
+#include <linux/soc/qcom/smem.h>
+#include <linux/pstore.h>
+
+
+static struct component_info component_info_desc[COMPONENT_MAX];
+static struct kobject *project_info_kobj;
+static struct project_info *project_info_desc;
+static struct dump_info *dp_info;
+
+static struct kobject *component_info;
+static ssize_t project_info_get(struct device *dev,
+    struct device_attribute *attr, char *buf);
+static ssize_t component_info_get(struct device *dev,
+    struct device_attribute *attr, char *buf);
+static int op_aboard_read_gpio(void);
+
+static DEVICE_ATTR(project_name, 0444, project_info_get, NULL);
+static DEVICE_ATTR(hw_id, 0444, project_info_get, NULL);
+static DEVICE_ATTR(rf_id_v1, 0444, project_info_get, NULL);
+static DEVICE_ATTR(rf_id_v2, 0444, project_info_get, NULL);
+static DEVICE_ATTR(rf_id_v3, 0444, project_info_get, NULL);
+static DEVICE_ATTR(modem, 0444, project_info_get, NULL);
+static DEVICE_ATTR(operator_no, 0444, project_info_get, NULL);
+static DEVICE_ATTR(ddr_manufacture_info, 0444, project_info_get, NULL);
+static DEVICE_ATTR(ddr_row, 0444, project_info_get, NULL);
+static DEVICE_ATTR(ddr_column, 0444, project_info_get, NULL);
+static DEVICE_ATTR(ddr_fw_version, 0444, project_info_get, NULL);
+static DEVICE_ATTR(ddr_reserve_info, 0444, project_info_get, NULL);
+static DEVICE_ATTR(secboot_status, 0444, project_info_get, NULL);
+static DEVICE_ATTR(platform_id, 0444, project_info_get, NULL);
+static DEVICE_ATTR(serialno, 0444, project_info_get, NULL);
+static DEVICE_ATTR(feature_id, 0444, project_info_get, NULL);
+static DEVICE_ATTR(aboard_id, 0444, project_info_get, NULL);
+
+
+void save_dump_reason_to_smem(char *info, char *function_name)
+{
+    int strl = 0, strl1 = 0;
+    size_t size;
+    static int flag = 0;
+
+    /* Make sure save_dump_reason_to_smem() is not
+    called infinite times by nested panic caller fns etc*/
+    if (flag > 1)
+        return;
+
+    dp_info = qcom_smem_get(QCOM_SMEM_HOST_ANY,SMEM_DUMP_INFO,&size);
+
+    if (IS_ERR_OR_NULL(dp_info))
+        pr_debug("%s: get dp_info failure\n", __func__);
+    else {
+        pr_debug("%s: info : %s\n",__func__, info);
+
+        strl = strlen(info)+1;
+        strl1 = strlen(function_name)+1;
+        strl = strl <  DUMP_REASON_SIZE ? strl: DUMP_REASON_SIZE;
+        strl1 = strl1 <  DUMP_REASON_SIZE ? strl1: DUMP_REASON_SIZE ;
+	if ((strlen(dp_info->dump_reason) + strl) < DUMP_REASON_SIZE)
+		strncat(dp_info->dump_reason,info, strl);
+
+	if (function_name != NULL && ((strlen(dp_info->dump_reason) + strl1) < DUMP_REASON_SIZE)) {
+		strncat(dp_info->dump_reason,function_name,strl1);
+		strncat(dp_info->dump_reason,"\n",1);
+	}
+    }
+    pr_debug("\r%s: dump_reason : %s strl=%d function caused panic :%s strl1=%d \n", __func__,
+                           dp_info->dump_reason, strl, function_name, strl1);
+    save_dump_reason_to_device_info(dp_info->dump_reason);
+    flag++;
+}
+
+uint8 get_secureboot_fuse_status(void)
+{
+    void __iomem *oem_config_base;
+    uint8 secure_oem_config = 0;
+
+    oem_config_base = ioremap(SECURE_BOOT1, 1);
+    if (!oem_config_base)
+        return -EINVAL;
+    secure_oem_config = __raw_readb(oem_config_base);
+    iounmap(oem_config_base);
+    pr_debug("secure_oem_config 0x%x\n", secure_oem_config);
+
+    return secure_oem_config;
+}
+
+static ssize_t project_info_get(struct device *dev,
+                struct device_attribute *attr,
+                char *buf)
+{
+    if (project_info_desc) {
+        if (attr == &dev_attr_project_name)
+            return snprintf(buf, BUF_SIZE, "%s\n",
+            project_info_desc->project_name);
+        if (attr == &dev_attr_hw_id)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->hw_version);
+        if (attr == &dev_attr_rf_id_v1)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->rf_v1);
+        if (attr == &dev_attr_rf_id_v2)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->rf_v2);
+        if (attr == &dev_attr_rf_id_v3)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->rf_v3);
+        if (attr == &dev_attr_modem)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->modem);
+        if (attr == &dev_attr_operator_no)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->operator);
+        if (attr == &dev_attr_ddr_manufacture_info)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->ddr_manufacture_info);
+        if (attr == &dev_attr_ddr_row)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->ddr_row);
+        if (attr == &dev_attr_ddr_column)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->ddr_column);
+        if (attr == &dev_attr_ddr_fw_version)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->ddr_fw_version);
+        if (attr == &dev_attr_ddr_reserve_info)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->ddr_reserve_info);
+        if (attr == &dev_attr_secboot_status)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            get_secureboot_fuse_status());
+        if (attr == &dev_attr_platform_id)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->platform_id);
+
+        if (attr == &dev_attr_serialno)
+            return snprintf(buf, BUF_SIZE, "0x%x\n",
+            socinfo_get_serial_number());
+
+        if (attr == &dev_attr_feature_id)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->feature_id);
+
+        if (attr == &dev_attr_aboard_id)
+            return snprintf(buf, BUF_SIZE, "%d\n",
+            project_info_desc->a_board_version);
+    }
+
+    return -EINVAL;
+}
+
+static struct attribute *project_info_sysfs_entries[] = {
+    &dev_attr_project_name.attr,
+    &dev_attr_hw_id.attr,
+    &dev_attr_rf_id_v1.attr,
+    &dev_attr_rf_id_v2.attr,
+    &dev_attr_rf_id_v3.attr,
+    &dev_attr_modem.attr,
+    &dev_attr_operator_no.attr,
+    &dev_attr_ddr_manufacture_info.attr,
+    &dev_attr_ddr_row.attr,
+    &dev_attr_ddr_column.attr,
+    &dev_attr_ddr_fw_version.attr,
+    &dev_attr_ddr_reserve_info.attr,
+    &dev_attr_secboot_status.attr,
+    &dev_attr_platform_id.attr,
+    &dev_attr_serialno.attr,
+    &dev_attr_feature_id.attr,
+    &dev_attr_aboard_id.attr,
+    NULL,
+};
+
+static struct attribute_group project_info_attr_group = {
+    .attrs  = project_info_sysfs_entries,
+};
+
+static DEVICE_ATTR(ddr, 0444, component_info_get, NULL);
+static DEVICE_ATTR(emmc, 0444, component_info_get, NULL);
+static DEVICE_ATTR(f_camera, 0444, component_info_get, NULL);
+static DEVICE_ATTR(r_camera, 0444, component_info_get, NULL);
+static DEVICE_ATTR(second_r_camera, 0444, component_info_get, NULL);
+static DEVICE_ATTR(third_r_camera, 0444, component_info_get, NULL);
+static DEVICE_ATTR(r_module, 0444, component_info_get, NULL);
+static DEVICE_ATTR(f_module, 0444, component_info_get, NULL);
+static DEVICE_ATTR(tp, 0444, component_info_get, NULL);
+static DEVICE_ATTR(lcd, 0444, component_info_get, NULL);
+static DEVICE_ATTR(wcn, 0444, component_info_get, NULL);
+static DEVICE_ATTR(l_sensor, 0444, component_info_get, NULL);
+static DEVICE_ATTR(g_sensor, 0444, component_info_get, NULL);
+static DEVICE_ATTR(m_sensor, 0444, component_info_get, NULL);
+static DEVICE_ATTR(gyro, 0444, component_info_get, NULL);
+static DEVICE_ATTR(backlight, 0444, component_info_get, NULL);
+static DEVICE_ATTR(mainboard, 0444, component_info_get, NULL);
+static DEVICE_ATTR(fingerprints, 0444, component_info_get, NULL);
+static DEVICE_ATTR(touch_key, 0444, component_info_get, NULL);
+static DEVICE_ATTR(ufs, 0444, component_info_get, NULL);
+static DEVICE_ATTR(Aboard, 0444, component_info_get, NULL);
+static DEVICE_ATTR(nfc, 0444, component_info_get, NULL);
+static DEVICE_ATTR(fast_charge, 0444, component_info_get, NULL);
+static DEVICE_ATTR(cpu, 0444, component_info_get, NULL);
+static DEVICE_ATTR(rf_version, 0444, component_info_get, NULL);
+
+
+char *get_component_version(enum COMPONENT_TYPE type)
+{
+    if (type >= COMPONENT_MAX) {
+        pr_err("%s == type %d invalid\n", __func__, type);
+        return "N/A";
+    }
+    return component_info_desc[type].version?:"N/A";
+}
+
+char *get_component_manufacture(enum COMPONENT_TYPE type)
+{
+    if (type >= COMPONENT_MAX) {
+        pr_err("%s == type %d invalid\n", __func__, type);
+        return "N/A";
+    }
+    return component_info_desc[type].manufacture?:"N/A";
+
+}
+
+int push_component_info(enum COMPONENT_TYPE type,
+    char *version, char *manufacture)
+{
+    if (type >= COMPONENT_MAX)
+        return -ENOMEM;
+    component_info_desc[type].version = version;
+    component_info_desc[type].manufacture = manufacture;
+
+    return 0;
+}
+EXPORT_SYMBOL(push_component_info);
+
+int reset_component_info(enum COMPONENT_TYPE type)
+{
+    if (type >= COMPONENT_MAX)
+        return -ENOMEM;
+    component_info_desc[type].version = NULL;
+    component_info_desc[type].manufacture = NULL;
+
+    return 0;
+}
+EXPORT_SYMBOL(reset_component_info);
+
+
+static struct attribute *component_info_sysfs_entries[] = {
+    &dev_attr_ddr.attr,
+    &dev_attr_emmc.attr,
+    &dev_attr_f_camera.attr,
+    &dev_attr_r_camera.attr,
+    &dev_attr_second_r_camera.attr,
+    &dev_attr_third_r_camera.attr,
+    &dev_attr_r_module.attr,
+    &dev_attr_f_module.attr,
+    &dev_attr_tp.attr,
+    &dev_attr_lcd.attr,
+    &dev_attr_wcn.attr,
+    &dev_attr_l_sensor.attr,
+    &dev_attr_g_sensor.attr,
+    &dev_attr_m_sensor.attr,
+    &dev_attr_gyro.attr,
+    &dev_attr_backlight.attr,
+    &dev_attr_mainboard.attr,
+    &dev_attr_fingerprints.attr,
+    &dev_attr_touch_key.attr,
+    &dev_attr_ufs.attr,
+    &dev_attr_Aboard.attr,
+    &dev_attr_nfc.attr,
+    &dev_attr_fast_charge.attr,
+    &dev_attr_cpu.attr,
+    &dev_attr_rf_version.attr,
+    NULL,
+};
+
+static struct attribute_group component_info_attr_group = {
+    .attrs  = component_info_sysfs_entries,
+};
+
+static ssize_t component_info_get(struct device *dev,
+                struct device_attribute *attr,
+                char *buf)
+{
+    if (attr == &dev_attr_ddr)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(DDR),
+        get_component_manufacture(DDR));
+    if (attr == &dev_attr_emmc)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(EMMC),
+        get_component_manufacture(EMMC));
+    if (attr == &dev_attr_f_camera)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(F_CAMERA),
+        get_component_manufacture(F_CAMERA));
+    if (attr == &dev_attr_r_camera)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(R_CAMERA),
+        get_component_manufacture(R_CAMERA));
+    if (attr == &dev_attr_second_r_camera)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(SECOND_R_CAMERA),
+        get_component_manufacture(SECOND_R_CAMERA));
+    if (attr == &dev_attr_third_r_camera)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(THIRD_R_CAMERA),
+        get_component_manufacture(THIRD_R_CAMERA));
+    if (attr == &dev_attr_r_module)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(R_MODULE),
+        get_component_manufacture(R_MODULE));
+    if (attr == &dev_attr_f_module)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(F_MODULE),
+        get_component_manufacture(F_MODULE));
+    if (attr == &dev_attr_tp)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(TP),
+        get_component_manufacture(TP));
+    if (attr == &dev_attr_lcd)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(LCD),
+        get_component_manufacture(LCD));
+    if (attr == &dev_attr_wcn)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(WCN),
+        get_component_manufacture(WCN));
+    if (attr == &dev_attr_l_sensor)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(I_SENSOR),
+        get_component_manufacture(I_SENSOR));
+    if (attr == &dev_attr_g_sensor)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(G_SENSOR),
+        get_component_manufacture(G_SENSOR));
+    if (attr == &dev_attr_m_sensor)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(M_SENSOR),
+        get_component_manufacture(M_SENSOR));
+    if (attr == &dev_attr_gyro)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(GYRO),
+        get_component_manufacture(GYRO));
+    if (attr == &dev_attr_backlight)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(BACKLIGHT),
+        get_component_manufacture(BACKLIGHT));
+    if (attr == &dev_attr_mainboard)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(MAINBOARD),
+        get_component_manufacture(MAINBOARD));
+    if (attr == &dev_attr_fingerprints)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(FINGERPRINTS),
+        get_component_manufacture(FINGERPRINTS));
+    if (attr == &dev_attr_touch_key)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(TOUCH_KEY),
+        get_component_manufacture(TOUCH_KEY));
+    if (attr == &dev_attr_ufs)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(UFS),
+        get_component_manufacture(UFS));
+    if (attr == &dev_attr_Aboard) {
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(ABOARD),
+        get_component_manufacture(ABOARD));
+    }
+    if (attr == &dev_attr_nfc)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(NFC),
+        get_component_manufacture(NFC));
+    if (attr == &dev_attr_fast_charge)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(FAST_CHARGE),
+        get_component_manufacture(FAST_CHARGE));
+    if (attr == &dev_attr_cpu)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(CPU),
+        get_component_manufacture(CPU));
+    if (attr == &dev_attr_rf_version)
+        return snprintf(buf, BUF_SIZE, "VER:\t%s\nMANU:\t%s\n",
+        get_component_version(RF_VERSION),
+        get_component_manufacture(RF_VERSION));
+    return -EINVAL;
+}
+
+static int __init project_info_init_sysfs(void)
+{
+    int error = 0;
+
+    project_info_kobj = kobject_create_and_add("project_info", NULL);
+    if (!project_info_kobj)
+        return -ENOMEM;
+    error = sysfs_create_group(project_info_kobj, &project_info_attr_group);
+    if (error) {
+        pr_err("project_info_init_sysfs project_info_attr_group failure\n");
+        return error;
+    }
+
+    component_info = kobject_create_and_add("component_info",
+        project_info_kobj);
+    pr_info("project_info_init_sysfs success\n");
+    if (!component_info)
+        return -ENOMEM;
+
+    error = sysfs_create_group(component_info, &component_info_attr_group);
+    if (error) {
+        pr_err("project_info_init_sysfs project_info_attr_group failure\n");
+        return error;
+    }
+    return 0;
+}
+
+late_initcall(project_info_init_sysfs);
+
+struct ddr_manufacture {
+    int id;
+    char name[20];
+};
+//ddr id and ddr name
+static char ddr_version[32] = {0};
+static char ddr_manufacture[20] = {0};
+char ddr_manufacture_and_fw_verion[40] = {0};
+static char cpu_type[20] = {0};
+
+struct ddr_manufacture ddr_manufacture_list[] = {
+    {1, "Samsung "},
+    {2, "Qimonda "},
+    {3, "Elpida "},
+    {4, "Etpon "},
+    {5, "Nanya "},
+    {6, "Hynix "},
+    {7, "Mosel "},
+    {8, "Winbond "},
+    {9, "Esmt "},
+    {255, "Micron"},
+    {0, "Unknown"},
+};
+
+struct cpu_list {
+    int id;
+    char name[20];
+};
+
+struct cpu_list cpu_list_msm[] = {
+    {194, "MSM8974AC "},
+    {217, "MSM8974AA "},
+    {218, "MSM8974AB "},
+    {207, "MSM8994 "},
+    {246, "MSM8996 "},
+    {292, "MSM8998 "},
+    {302, "MSM8996L "},
+    {305, "MSM8996SG "},
+    {310, "MSM8996AU "},
+    {321, "SDM845 "},
+    {339, "SM8150 "},
+    {0, "Unknown"},
+};
+
+void get_ddr_manufacture_name(void)
+{
+    uint32 i, length;
+
+    length = ARRAY_SIZE(ddr_manufacture_list);
+    if (project_info_desc) {
+        for (i = 0; i < length; i++) {
+            if (ddr_manufacture_list[i].id ==
+                project_info_desc->ddr_manufacture_info) {
+                snprintf(ddr_manufacture, sizeof(ddr_manufacture), "%s",
+                    ddr_manufacture_list[i].name);
+                break;
+            }
+        }
+    }
+}
+
+void get_cpu_type(void)
+{
+    uint32 i, length;
+
+    length = ARRAY_SIZE(cpu_list_msm);
+    if (project_info_desc) {
+        for (i = 0; i < length; i++) {
+            if (cpu_list_msm[i].id ==
+                project_info_desc->platform_id) {
+                snprintf(cpu_type, sizeof(cpu_type),
+                    "%s", cpu_list_msm[i].name);
+                break;
+            }
+        }
+    }
+}
+
+static char mainboard_version[64] = {0};
+static char mainboard_manufacture[8] = {'O',
+    'N', 'E', 'P', 'L', 'U', 'S', '\0'};
+static char Aboard_version[16] = {0};
+static char rf_version[16] = {0};
+
+struct a_borad_version{
+
+       int  version;
+       char   name[16];
+};
+struct main_board_info{
+   int  prj_version;
+   int  hw_version;
+   char  version_name[32];;
+};
+
+struct a_borad_version a_borad_version_string_arry_gpio[]={
+
+    {0,   "SAR"},
+    {1,   "Unknown" },
+    {2,   "Unknown"},
+    {3,   "NOSAR"},
+};
+struct main_board_info main_board_info_check[]={
+
+    {1,   11  , "T0"},
+    {1,   12  , "EVT1"},
+    {1,   13  , "EVT2"},
+    {1,   55  , "AM EVT2"},
+    {1,   54  , "EU EVT2"},
+    {1,   14  , "EVT3"},
+    {1,   53  , "AM EVT3"},
+    {1,   52  , "EU EVT3"},
+    {1,   15  , "DVT"},
+    {1,   21  , "PVT"},
+    {1,   22  , "MP"},
+
+};
+
+uint32 get_hw_version(void)
+{
+    size_t size;
+
+    project_info_desc = qcom_smem_get(QCOM_SMEM_HOST_ANY,SMEM_PROJECT_INFO, &size);
+
+    if (IS_ERR_OR_NULL(project_info_desc))
+        pr_err("%s: get project_info failure\n", __func__);
+    else {
+        pr_err("%s: hw version: %d\n", __func__,
+            project_info_desc->hw_version);
+        return project_info_desc->hw_version;
+    }
+    return 0;
+}
+
+void dump_reason_init_smem(void)
+{
+    int ret;
+
+    ret = qcom_smem_alloc(QCOM_SMEM_HOST_ANY,SMEM_DUMP_INFO,
+                                  sizeof(struct dump_info));
+
+    if (ret < 0 && ret != -EEXIST) {
+          pr_err("%s:unable to allocate dp_info \n", __func__);
+          return;
+    }
+}
+
+int __init init_project_info(void)
+{
+    static bool project_info_init_done;
+    int ddr_size = 0;
+    size_t size;
+    int i = 0;
+    char *p = NULL;
+
+    if (project_info_init_done)
+        return 0;
+
+    project_info_desc = qcom_smem_get(QCOM_SMEM_HOST_ANY,SMEM_PROJECT_INFO, &size);
+
+    if (IS_ERR_OR_NULL(project_info_desc)) {
+        pr_err("%s: get project_info failure\n", __func__);
+        return -1;
+    }
+    pr_err("%s: project_name: %s hw_version: %d prj=%d rf_v1: %d rf_v2: %d: rf_v3: %d  paltform_id:%d\n",
+        __func__, project_info_desc->project_name,
+        project_info_desc->hw_version,
+        project_info_desc->prj_version,
+        project_info_desc->rf_v1,
+        project_info_desc->rf_v2,
+        project_info_desc->rf_v3,
+        project_info_desc->platform_id);
+
+
+    p = &main_board_info_check[ARRAY_SIZE(main_board_info_check)-1].version_name[0];
+
+    for( i = 0 ; i < ARRAY_SIZE(main_board_info_check) ; i++ )
+    {
+        if(project_info_desc->prj_version == main_board_info_check[i].prj_version &&
+           project_info_desc->hw_version  == main_board_info_check[i].hw_version )
+        {
+           p = &main_board_info_check[i].version_name[0];
+           break;
+        }
+    }
+
+    snprintf(mainboard_version, sizeof(mainboard_version), "%d %d %s %s ",
+        project_info_desc->prj_version,project_info_desc->hw_version,
+        project_info_desc->project_name, p);
+
+    pr_err("board info: %s\n", mainboard_version);
+    push_component_info(MAINBOARD,
+        mainboard_version,
+        mainboard_manufacture);
+
+    snprintf(rf_version, sizeof(rf_version),  " %d",project_info_desc->rf_v1);
+    push_component_info(RF_VERSION, rf_version, mainboard_manufacture);
+
+    get_ddr_manufacture_name();
+
+	/* approximate as ceiling of total pages */
+	ddr_size = (totalram_pages + (1 << 18) - 1) >> 18;
+
+    snprintf(ddr_version, sizeof(ddr_version), "size_%dG_r_%d_c_%d",
+        ddr_size, project_info_desc->ddr_row,
+        project_info_desc->ddr_column);
+    snprintf(ddr_manufacture_and_fw_verion,
+        sizeof(ddr_manufacture_and_fw_verion),
+        "%s%s %u.%u", ddr_manufacture,
+        project_info_desc->ddr_reserve_info == 0x05 ? "20nm" :
+        (project_info_desc->ddr_reserve_info == 0x06 ? "18nm" : " "),
+        project_info_desc->ddr_fw_version >> 16,
+        project_info_desc->ddr_fw_version & 0x0000FFFF);
+    push_component_info(DDR, ddr_version, ddr_manufacture_and_fw_verion);
+
+    get_cpu_type();
+    push_component_info(CPU, cpu_type, "Qualcomm");
+    project_info_init_done = true;
+    dump_reason_init_smem();
+
+    return 0;
+}
+struct aborad_data {
+    int aboard_gpio_0;
+    int aboard_gpio_1;
+    int support_aboard_gpio_0;
+    int support_aboard_gpio_1;
+    struct pinctrl                      *pinctrl;
+    struct pinctrl_state                *pinctrl_state_active;
+
+    struct device *dev;
+};
+static struct aborad_data *data = NULL ;
+
+static int op_aboard_request_named_gpio(const char *label, int *gpio)
+{
+    struct device *dev = data->dev;
+    struct device_node *np = dev->of_node;
+    int rc = of_get_named_gpio(np, label, 0);
+
+    if (rc < 0) {
+        dev_err(dev, "failed to get '%s'\n", label);
+        *gpio = rc;
+        return rc;
+    }
+    *gpio = rc;
+
+    rc = devm_gpio_request(dev, *gpio, label);
+    if (rc) {
+        dev_err(dev, "failed to request gpio %d\n", *gpio);
+        return rc;
+    }
+
+    dev_info(dev, "%s gpio: %d\n", label, *gpio);
+    return 0;
+}
+
+static int op_aboard_read_gpio(void)
+{
+    int gpio0 = 0;
+    int gpio1 = 0;
+    if ( data == NULL || IS_ERR_OR_NULL(project_info_desc))
+    {
+        return 0 ;
+    }
+    if(data->support_aboard_gpio_0 == 1)
+        gpio0 = gpio_get_value(data->aboard_gpio_0);
+    if(data->support_aboard_gpio_1 == 1)
+        gpio1 = gpio_get_value(data->aboard_gpio_1);
+
+    if(data->support_aboard_gpio_0 == 1 && data->support_aboard_gpio_1 == 1)
+    {
+        pr_err("%s: gpio0=%d gpio1=%d\n", __func__, gpio0,gpio1);
+
+        if( gpio0 == 0 && gpio1 == 0 )
+        {
+            project_info_desc->a_board_version = 0 ;
+        }
+        else if( gpio0 == 0 && gpio1 == 1 )
+        {
+            project_info_desc->a_board_version = 1 ;
+        }
+        else if( gpio0 == 1 && gpio1 == 0 )
+        {
+            project_info_desc->a_board_version = 2 ;
+        }
+        else
+        {
+            project_info_desc->a_board_version = 3 ;
+        }
+    }else if(data->support_aboard_gpio_0 == 1 ){
+        pr_err("%s: gpio0=%d\n", __func__, gpio0);
+        project_info_desc->a_board_version = (gpio0 == 1 ? 0:3 );
+
+    }else if(data->support_aboard_gpio_1 == 1 ){
+        pr_err("%s: gpio1=%d\n", __func__, gpio1);
+        project_info_desc->a_board_version = (gpio1 == 1 ? 0:3 );
+    }
+
+    snprintf(Aboard_version, sizeof(Aboard_version), "%d %s",
+    project_info_desc->a_board_version,project_info_desc->a_board_version <4 ?
+    a_borad_version_string_arry_gpio[project_info_desc->a_board_version].name:"Unknown");
+
+    push_component_info(ABOARD, Aboard_version, mainboard_manufacture);
+    pr_err("%s: Aboard_gpio(%s)\n", __func__, Aboard_version);
+    return 0 ;
+
+}
+
+static int oem_aboard_probe(struct platform_device *pdev)
+{
+    int rc = 0;
+    struct device *dev = &pdev->dev;
+
+    data = kzalloc(sizeof(struct aborad_data), GFP_KERNEL);
+    if (!data) {
+        pr_err("%s: failed to allocate memory\n", __func__);
+        rc = -ENOMEM;
+        goto exit;
+    }
+
+    data->dev = dev;
+    rc = op_aboard_request_named_gpio("oem,aboard-gpio-0",&data->aboard_gpio_0);
+    if (rc) {
+        pr_err("%s: oem,aboard-gpio-0 fail\n", __func__);
+    }else{
+       data->support_aboard_gpio_0 = 1;
+    }
+
+    rc = op_aboard_request_named_gpio("oem,aboard-gpio-1",&data->aboard_gpio_1);
+    if (rc) {
+        pr_err("%s: oem,aboard-gpio-1 fail\n", __func__);
+    }else{
+       data->support_aboard_gpio_1 = 1;
+    }
+    
+    data->pinctrl = devm_pinctrl_get((data->dev));
+    if (IS_ERR_OR_NULL(data->pinctrl)) {
+        rc = PTR_ERR(data->pinctrl);
+        pr_err("%s pinctrl error!\n",__func__);
+        goto err_pinctrl_get;
+    }
+
+    data->pinctrl_state_active = pinctrl_lookup_state(data->pinctrl, "oem_aboard_active");
+
+    if (IS_ERR_OR_NULL(data->pinctrl_state_active)) {
+        rc = PTR_ERR(data->pinctrl_state_active);
+        pr_err("%s pinctrl state active error!\n",__func__);
+        goto err_pinctrl_lookup;
+    }
+
+    if (data->pinctrl) {
+        rc = pinctrl_select_state(data->pinctrl,data->pinctrl_state_active);
+    }
+    if(data->support_aboard_gpio_0 == 1)
+        gpio_direction_input(data->aboard_gpio_0);
+    if(data->support_aboard_gpio_1 == 1)
+        gpio_direction_input(data->aboard_gpio_1);
+    op_aboard_read_gpio();
+    pr_err("%s: probe ok!\n", __func__);
+    return 0;
+    
+err_pinctrl_lookup:
+    devm_pinctrl_put(data->pinctrl);
+err_pinctrl_get:
+    data->pinctrl = NULL;
+    kfree(data);
+exit:
+    pr_err("%s: probe Fail!\n", __func__);
+
+    return rc;
+}
+
+static const struct of_device_id aboard_of_match[] = {
+    { .compatible = "oem,aboard", },
+    {}
+};
+MODULE_DEVICE_TABLE(of, aboard_of_match);
+
+static struct platform_driver aboard_driver = {
+    .driver = {
+        .name       = "op_aboard",
+        .owner      = THIS_MODULE,
+        .of_match_table = aboard_of_match,
+    },
+    .probe = oem_aboard_probe,
+};
+
+static int __init init_project(void)
+{
+    int ret;
+
+    ret = init_project_info();
+
+    return ret;
+}
+static int __init init_aboard(void)
+{
+    int ret;
+
+    ret = platform_driver_register(&aboard_driver);
+    if (ret)
+        pr_err("aboard_driver register failed: %d\n", ret);
+
+    return ret;
+}
+
+
+subsys_initcall(init_project);
+late_initcall(init_aboard);
+
diff --git a/drivers/soc/qcom/qdsp6v2/cdsp-loader.c b/drivers/soc/qcom/qdsp6v2/cdsp-loader.c
index 9bb4eb0e19f1a4f67b701cfb38c4fae694d2304f..7d2c2691d231c05a2b17b82fda2fc8628e52fafe 100644
--- a/drivers/soc/qcom/qdsp6v2/cdsp-loader.c
+++ b/drivers/soc/qcom/qdsp6v2/cdsp-loader.c
@@ -20,6 +20,7 @@
 #include <linux/of_device.h>
 #include <linux/sysfs.h>
 #include <soc/qcom/subsystem_restart.h>
+#include <linux/oneplus/boot_mode.h>
 
 #define BOOT_CMD 1
 #define IMAGE_UNLOAD_CMD 0
@@ -68,6 +69,13 @@ static int cdsp_loader_do(struct platform_device *pdev)
 		goto fail;
 	}
 
+	if (get_boot_mode() == MSM_BOOT_MODE__FACTORY) {
+		dev_dbg(&pdev->dev,
+			"%s: do not load CDSP image in factory mode.\n",
+				__func__);
+		goto fail;
+	}
+
 	rc = of_property_read_string(pdev->dev.of_node,
 					"qcom,proc-img-to-load",
 					&img_name);
diff --git a/drivers/soc/qcom/qmi_rmnet.c b/drivers/soc/qcom/qmi_rmnet.c
index 6bf76e2280b8a0877f97db17c3ac48dcc2a53074..72b1218146154328590209af50cce95b8c8a8bf5 100644
--- a/drivers/soc/qcom/qmi_rmnet.c
+++ b/drivers/soc/qcom/qmi_rmnet.c
@@ -511,13 +511,15 @@ void qmi_rmnet_change_link(struct net_device *dev, void *port, void *tcm_pt)
 			return;
 
 		if (qmi_rmnet_setup_client(port, qmi, tcm) < 0) {
-			if (!qmi_rmnet_has_client(qmi) &&
+			/* retrieve qmi again as it could have been changed */
+			qmi = (struct qmi_info *)rmnet_get_qmi_pt(port);
+			if (qmi &&
+			    !qmi_rmnet_has_client(qmi) &&
 			    !qmi_rmnet_has_pending(qmi)) {
-				kfree(qmi);
 				rmnet_reset_qmi_pt(port);
+				kfree(qmi);
 			}
-		}
-		if (tcm->tcm_ifindex & FLAG_POWERSAVE_MASK) {
+		} else if (tcm->tcm_ifindex & FLAG_POWERSAVE_MASK) {
 			qmi_rmnet_work_init(port);
 			rmnet_set_powersave_format(port);
 		}
@@ -525,7 +527,7 @@ void qmi_rmnet_change_link(struct net_device *dev, void *port, void *tcm_pt)
 	case NLMSG_CLIENT_DELETE:
 		if (!qmi)
 			return;
-		if (tcm->tcm_ifindex & FLAG_POWERSAVE_MASK) {
+		if (tcm->tcm_handle == 0) { /* instance 0 */
 			rmnet_clear_powersave_format(port);
 			qmi_rmnet_work_exit(port);
 		}
@@ -573,7 +575,9 @@ void qmi_rmnet_enable_all_flows(struct net_device *dev)
 {
 	struct qos_info *qos;
 	struct rmnet_bearer_map *bearer;
-	int do_wake = 0;
+
+//	int do_wake = 0;
+	bool do_wake = false;
 
 	qos = (struct qos_info *)rmnet_get_qos_pt(dev);
 	if (!qos)
@@ -582,14 +586,20 @@ void qmi_rmnet_enable_all_flows(struct net_device *dev)
 	spin_lock_bh(&qos->qos_lock);
 
 	list_for_each_entry(bearer, &qos->bearer_head, list) {
-		bearer->grant_before_ps = bearer->grant_size;
-		bearer->seq_before_ps = bearer->seq;
+
+//		bearer->grant_before_ps = bearer->grant_size;
+//		bearer->seq_before_ps = bearer->seq;
+		if (!bearer->grant_size)
+			do_wake = true;
+
 		bearer->grant_size = DEFAULT_GRANT;
 		bearer->grant_thresh = DEFAULT_GRANT;
 		bearer->seq = 0;
 		bearer->ack_req = 0;
 		bearer->ancillary = 0;
-		do_wake = 1;
+
+//		do_wake = 1;
+
 	}
 
 	if (do_wake) {
@@ -601,6 +611,34 @@ void qmi_rmnet_enable_all_flows(struct net_device *dev)
 }
 EXPORT_SYMBOL(qmi_rmnet_enable_all_flows);
 
+
+bool qmi_rmnet_all_flows_enabled(struct net_device *dev)
+{
+	struct qos_info *qos;
+	struct rmnet_bearer_map *bearer;
+	bool ret = true;
+
+	qos = (struct qos_info *)rmnet_get_qos_pt(dev);
+	if (!qos)
+		return true;
+
+	spin_lock_bh(&qos->qos_lock);
+
+	list_for_each_entry(bearer, &qos->bearer_head, list) {
+		if (!bearer->grant_size) {
+			ret = false;
+			break;
+		}
+	}
+
+	spin_unlock_bh(&qos->qos_lock);
+
+	return ret;
+}
+EXPORT_SYMBOL(qmi_rmnet_all_flows_enabled);
+
+
+
 #ifdef CONFIG_QCOM_QMI_DFC
 void qmi_rmnet_burst_fc_check(struct net_device *dev,
 			      int ip_type, u32 mark, unsigned int len)
@@ -796,13 +834,14 @@ int qmi_rmnet_set_powersave_mode(void *port, uint8_t enable)
 }
 EXPORT_SYMBOL(qmi_rmnet_set_powersave_mode);
 
-void qmi_rmnet_work_restart(void *port)
+//void qmi_rmnet_work_restart(void *port)
+static void qmi_rmnet_work_restart(void *port)
 {
 	if (!rmnet_ps_wq || !rmnet_work)
 		return;
 	queue_delayed_work(rmnet_ps_wq, &rmnet_work->work, NO_DELAY);
 }
-EXPORT_SYMBOL(qmi_rmnet_work_restart);
+//EXPORT_SYMBOL(qmi_rmnet_work_restart);
 
 static void qmi_rmnet_check_stats(struct work_struct *work)
 {
@@ -811,6 +850,8 @@ static void qmi_rmnet_check_stats(struct work_struct *work)
 	u64 rxd, txd;
 	u64 rx, tx;
 
+	bool dl_msg_active;
+
 	real_work = container_of(to_delayed_work(work),
 				 struct rmnet_powersave_work, work);
 
@@ -822,17 +863,17 @@ static void qmi_rmnet_check_stats(struct work_struct *work)
 		return;
 
 	if (qmi->ps_enabled) {
-		/* Retry after small delay if qmi error
-		 * This resumes UL grants by disabling
-		 * powersave mode if successful.
-		 */
+		/* Register to get QMI DFC and DL marker */
 		if (qmi_rmnet_set_powersave_mode(real_work->port, 0) < 0) {
+			/* If this failed need to retry quickly */
 			queue_delayed_work(rmnet_ps_wq,
 					   &real_work->work, HZ / 50);
 			return;
 
 		}
-		qmi->ps_enabled = 0;
+
+//		qmi->ps_enabled = 0;
+		qmi->ps_enabled = false;
 
 		if (rmnet_get_powersave_notif(real_work->port))
 			qmi_rmnet_ps_off_notify(real_work->port);
@@ -847,18 +888,32 @@ static void qmi_rmnet_check_stats(struct work_struct *work)
 	real_work->old_rx_pkts = rx;
 	real_work->old_tx_pkts = tx;
 
+	dl_msg_active = qmi->dl_msg_active;
+	qmi->dl_msg_active = false;
+
+
 	if (!rxd && !txd) {
+
+		//If no DL msg  and flow disabled,  no need to  powersave
+		if (!dl_msg_active &&
+			!rmnet_all_flows_enabled(real_work->port))
+			goto end;
+		/* Deregister to suppress QMI DFC and DL marker */
+
 		if (qmi_rmnet_set_powersave_mode(real_work->port, 1) < 0) {
-			queue_delayed_work(rmnet_ps_wq,
+			if (rmnet_ps_wq)
+				queue_delayed_work(rmnet_ps_wq,
 					   &real_work->work, PS_INTERVAL);
 			return;
 		}
-		qmi->ps_enabled = 1;
+
+
+//		qmi->ps_enabled = 1;
+//		clear_bit(PS_WORK_ACTIVE_BIT, &qmi->ps_work_active);
+		qmi->ps_enabled = true;
+		//Clear the bit before enabling flow
 		clear_bit(PS_WORK_ACTIVE_BIT, &qmi->ps_work_active);
 
-		/* Enable flow after clear the bit so a new
-		 * work can be triggered.
-		 */
 		rmnet_enable_all_flows(real_work->port);
 
 		if (rmnet_get_powersave_notif(real_work->port))
@@ -867,7 +922,8 @@ static void qmi_rmnet_check_stats(struct work_struct *work)
 		return;
 	}
 end:
-	queue_delayed_work(rmnet_ps_wq, &real_work->work, PS_INTERVAL);
+	if (rmnet_ps_wq)
+		queue_delayed_work(rmnet_ps_wq, &real_work->work, PS_INTERVAL);
 }
 
 static void qmi_rmnet_work_set_active(void *port, int status)
@@ -934,4 +990,17 @@ void qmi_rmnet_work_exit(void *port)
 	rmnet_work = NULL;
 }
 EXPORT_SYMBOL(qmi_rmnet_work_exit);
+
+void qmi_rmnet_set_dl_msg_active(void *port)
+{
+	struct qmi_info *qmi;
+
+	qmi = (struct qmi_info *)rmnet_get_qmi_pt(port);
+	if (unlikely(!qmi))
+		return;
+
+	qmi->dl_msg_active = true;
+}
+EXPORT_SYMBOL(qmi_rmnet_set_dl_msg_active);
+
 #endif
diff --git a/drivers/soc/qcom/qmi_rmnet_i.h b/drivers/soc/qcom/qmi_rmnet_i.h
index 0e1042936f37968e5e548cca10b09606fa9de8cb..65cd008efa67b1c6e0cb8f05ddb689acda6577cd 100644
--- a/drivers/soc/qcom/qmi_rmnet_i.h
+++ b/drivers/soc/qcom/qmi_rmnet_i.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -41,8 +41,12 @@ struct rmnet_bearer_map {
 	u32 grant_thresh;
 	u16 seq;
 	u8  ack_req;
-	u32 grant_before_ps;
-	u16 seq_before_ps;
+
+//	u32 grant_before_ps;
+//	u16 seq_before_ps;
+	u32 last_grant;
+	u16 last_seq;
+
 	u32 ancillary;
 };
 
@@ -74,7 +78,11 @@ struct qmi_info {
 	void *dfc_clients[MAX_CLIENT_NUM];
 	void *dfc_pending[MAX_CLIENT_NUM];
 	unsigned long ps_work_active;
-	int ps_enabled;
+
+//	int ps_enabled;
+	bool ps_enabled;
+	bool dl_msg_active;
+
 };
 
 enum data_ep_type_enum_v01 {
diff --git a/drivers/soc/qcom/rpm_stats.c b/drivers/soc/qcom/rpm_stats.c
index e7d9fac5e589d824a48a21af62e47638756fea90..07bf8666dfbca8373f0c231b283deb89fee4499f 100644
--- a/drivers/soc/qcom/rpm_stats.c
+++ b/drivers/soc/qcom/rpm_stats.c
@@ -22,6 +22,8 @@
 #include <linux/of.h>
 #include <linux/uaccess.h>
 #include <asm/arch_timer.h>
+#include <linux/debugfs.h>
+#include "rpmh_master_stat.h"
 
 #define RPM_STATS_NUM_REC	2
 #define MSM_ARCH_TIMER_FREQ	19200000
@@ -63,6 +65,8 @@ struct msm_rpm_stats_data {
 
 };
 
+struct dentry *debugfs_root;
+
 struct msm_rpmstats_kobj_attr {
 	struct kobject *kobj;
 	struct kobj_attribute ka;
@@ -174,71 +178,59 @@ static inline int msm_rpmstats_copy_stats(
 	return length;
 }
 
-static ssize_t rpmstats_show(struct kobject *kobj,
-			struct kobj_attribute *attr, char *buf)
+#ifdef CONFIG_DEBUG_FS
+static int rpmh_stats_show(struct seq_file *s, void *data)
 {
+
 	struct msm_rpmstats_private_data prvdata;
 	struct msm_rpmstats_platform_data *pdata = NULL;
-	ssize_t length;
 
-	pdata = GET_PDATA_OF_ATTR(attr);
+	pdata = s->private;
 
 	prvdata.reg_base = ioremap_nocache(pdata->phys_addr_base,
 					pdata->phys_size);
 	if (!prvdata.reg_base) {
-		pr_err("ERROR could not ioremap start=%pa, len=%u\n",
-				&pdata->phys_addr_base, pdata->phys_size);
+		pr_err("%s: ERROR could not ioremap start=%pa, len=%u\n",
+			__func__, &pdata->phys_addr_base,
+			pdata->phys_size);
 		return -EBUSY;
 	}
 
 	prvdata.read_idx = prvdata.len = 0;
 	prvdata.platform_data = pdata;
-	prvdata.num_records = pdata->num_records;
+	prvdata.num_records = RPM_STATS_NUM_REC;
 
 	if (prvdata.read_idx < prvdata.num_records)
 		prvdata.len = msm_rpmstats_copy_stats(&prvdata);
 
-	length = scnprintf(buf, prvdata.len, "%s", prvdata.buf);
-	iounmap(prvdata.reg_base);
-	return length;
+	seq_printf(s, "%s", prvdata.buf);
+	return 0;
 }
 
-static int msm_rpmstats_create_sysfs(struct platform_device *pdev,
-				struct msm_rpmstats_platform_data *pd)
+static int rpmh_stats_open(struct inode *inode, struct file *file)
 {
-	struct kobject *rpmstats_kobj = NULL;
-	struct msm_rpmstats_kobj_attr *rpms_ka = NULL;
-	int ret = 0;
-
-	rpmstats_kobj = kobject_create_and_add("system_sleep", power_kobj);
-	if (!rpmstats_kobj) {
-		pr_err("Cannot create rpmstats kobject\n");
-		ret = -ENOMEM;
-		goto fail;
-	}
-
-	rpms_ka = kzalloc(sizeof(*rpms_ka), GFP_KERNEL);
-	if (!rpms_ka) {
-		kobject_put(rpmstats_kobj);
-		ret = -ENOMEM;
-		goto fail;
-	}
-
-	rpms_ka->kobj = rpmstats_kobj;
+	return single_open(file, rpmh_stats_show, inode->i_private);
+}
 
-	sysfs_attr_init(&rpms_ka->ka.attr);
-	rpms_ka->pd = pd;
-	rpms_ka->ka.attr.mode = 0444;
-	rpms_ka->ka.attr.name = "stats";
-	rpms_ka->ka.show = rpmstats_show;
-	rpms_ka->ka.store = NULL;
+#endif
 
-	ret = sysfs_create_file(rpmstats_kobj, &rpms_ka->ka.attr);
-	platform_set_drvdata(pdev, rpms_ka);
+static const struct file_operations rpmh_stats_fops = {
+#ifdef CONFIG_DEBUG_FS
+	.open		= rpmh_stats_open,
+	.read		= seq_read,
+	.llseek		= seq_lseek,
+	.release	= single_release,
+#endif
+};
 
-fail:
-	return ret;
-}
+static const struct file_operations rpmh_master_stats_fops = {
+#ifdef CONFIG_DEBUG_FS
+	.open	   = rpmh_master_stats_open,
+	.read	   = seq_read,
+	.llseek	 = seq_lseek,
+	.release	= single_release,
+#endif
+};
 
 static int msm_rpmstats_probe(struct platform_device *pdev)
 {
@@ -277,7 +269,17 @@ static int msm_rpmstats_probe(struct platform_device *pdev)
 	if (of_property_read_u32(pdev->dev.of_node, key, &pdata->num_records))
 		pdata->num_records = RPM_STATS_NUM_REC;
 
-	msm_rpmstats_create_sysfs(pdev, pdata);
+	debugfs_root = debugfs_create_dir("rpmh", NULL);
+	if (!debugfs_root) {
+		pr_err("%s: Cannot create rpmh dir\n", __func__);
+		return -ENOMEM;
+	}
+
+	debugfs_create_file("stats", 0444, debugfs_root, pdata,
+			    &rpmh_stats_fops);
+
+	debugfs_create_file("master_stats", 0444, debugfs_root, NULL,
+		&rpmh_master_stats_fops);
 
 	return 0;
 }
diff --git a/drivers/soc/qcom/rpmh_master_stat.c b/drivers/soc/qcom/rpmh_master_stat.c
index 22704b807700b39d4d3cdc4f4ec98fe408fb529d..237614b9bba7596683eeb1d4a705275924cab761 100644
--- a/drivers/soc/qcom/rpmh_master_stat.c
+++ b/drivers/soc/qcom/rpmh_master_stat.c
@@ -99,11 +99,11 @@ static void __iomem *rpmh_unit_base;
 
 static DEFINE_MUTEX(rpmh_stats_mutex);
 
-static ssize_t msm_rpmh_master_stats_print_data(char *prvbuf, ssize_t length,
+static void msm_rpmh_master_stats_print_data(struct seq_file *s,
 				struct msm_rpmh_master_stats *record,
 				const char *name)
 {
-	uint64_t accumulated_duration = record->accumulated_duration;
+	uint64_t temp_accumulated_duration = record->accumulated_duration;
 	/*
 	 * If a master is in sleep when reading the sleep stats from SMEM
 	 * adjust the accumulated sleep duration to show actual sleep time.
@@ -111,51 +111,52 @@ static ssize_t msm_rpmh_master_stats_print_data(char *prvbuf, ssize_t length,
 	 * the purpose of computing battery utilization.
 	 */
 	if (record->last_entered > record->last_exited)
-		accumulated_duration +=
+		temp_accumulated_duration +=
 				(arch_counter_get_cntvct()
 				- record->last_entered);
 
-	return snprintf(prvbuf, length, "%s\n\tVersion:0x%x\n"
+	seq_printf(s, "%s\n\tVersion:0x%x\n"
 			"\tSleep Count:0x%x\n"
 			"\tSleep Last Entered At:0x%llx\n"
 			"\tSleep Last Exited At:0x%llx\n"
 			"\tSleep Accumulated Duration:0x%llx\n\n",
-			name, record->version_id, record->counts,
-			record->last_entered, record->last_exited,
-			accumulated_duration);
+			name, record->version_id,
+			record->counts, record->last_entered,
+			record->last_exited, temp_accumulated_duration);
 }
 
-static ssize_t msm_rpmh_master_stats_show(struct kobject *kobj,
-				struct kobj_attribute *attr, char *buf)
+static int rpmh_master_stats_show(struct seq_file *s, void *data)
 {
-	ssize_t length;
 	int i = 0;
 	size_t size = 0;
 	struct msm_rpmh_master_stats *record = NULL;
 
 	mutex_lock(&rpmh_stats_mutex);
-
 	/* First Read APSS master stats */
+	msm_rpmh_master_stats_print_data(s, &apss_master_stats,
+		"APSS");
 
-	length = msm_rpmh_master_stats_print_data(buf, PAGE_SIZE,
-						&apss_master_stats, "APSS");
-
-	/* Read SMEM data written by other masters */
+	/*
+	 * Read SMEM data written by masters
+	 */
 
 	for (i = 0; i < ARRAY_SIZE(rpmh_masters); i++) {
 		record = (struct msm_rpmh_master_stats *) qcom_smem_get(
 					rpmh_masters[i].pid,
 					rpmh_masters[i].smem_id, &size);
-		if (!IS_ERR_OR_NULL(record) && (PAGE_SIZE - length > 0))
-			length += msm_rpmh_master_stats_print_data(
-					buf + length, PAGE_SIZE - length,
-					record,
-					rpmh_masters[i].master_name);
+		if (!IS_ERR_OR_NULL(record))
+			msm_rpmh_master_stats_print_data(s, record,
+			rpmh_masters[i].master_name);
 	}
 
 	mutex_unlock(&rpmh_stats_mutex);
 
-	return length;
+	return 0;
+}
+
+int rpmh_master_stats_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, rpmh_master_stats_show, inode->i_private);
 }
 
 static inline void msm_rpmh_apss_master_stats_update(
@@ -202,70 +203,20 @@ EXPORT_SYMBOL(msm_rpmh_master_stats_update);
 
 static int msm_rpmh_master_stats_probe(struct platform_device *pdev)
 {
-	struct rpmh_master_stats_prv_data *prvdata = NULL;
-	struct kobject *rpmh_master_stats_kobj = NULL;
-	int ret = -ENOMEM;
-
-	if (!pdev)
-		return -EINVAL;
-
-	prvdata = devm_kzalloc(&pdev->dev, sizeof(*prvdata), GFP_KERNEL);
-	if (!prvdata)
-		return ret;
-
-	rpmh_master_stats_kobj = kobject_create_and_add(
-					"rpmh_stats",
-					power_kobj);
-	if (!rpmh_master_stats_kobj)
-		return ret;
-
-	prvdata->kobj = rpmh_master_stats_kobj;
-
-	sysfs_attr_init(&prvdata->ka.attr);
-	prvdata->ka.attr.mode = 0444;
-	prvdata->ka.attr.name = "master_stats";
-	prvdata->ka.show = msm_rpmh_master_stats_show;
-	prvdata->ka.store = NULL;
-
-	ret = sysfs_create_file(prvdata->kobj, &prvdata->ka.attr);
-	if (ret) {
-		pr_err("sysfs_create_file failed\n");
-		goto fail_sysfs;
-	}
-
 	rpmh_unit_base = of_iomap(pdev->dev.of_node, 0);
 	if (!rpmh_unit_base) {
 		pr_err("Failed to get rpmh_unit_base\n");
-		ret = -ENOMEM;
-		goto fail_iomap;
+		return -ENOMEM;
 	}
 
 	apss_master_stats.version_id = 0x1;
-	platform_set_drvdata(pdev, prvdata);
-	return ret;
-
-fail_iomap:
-	sysfs_remove_file(prvdata->kobj, &prvdata->ka.attr);
-fail_sysfs:
-	kobject_put(prvdata->kobj);
-	return ret;
+
+	return 0;
 }
 
 static int msm_rpmh_master_stats_remove(struct platform_device *pdev)
 {
-	struct rpmh_master_stats_prv_data *prvdata;
-
-	if (!pdev)
-		return -EINVAL;
-
-	prvdata = (struct rpmh_master_stats_prv_data *)
-				platform_get_drvdata(pdev);
-
-	sysfs_remove_file(prvdata->kobj, &prvdata->ka.attr);
-	kobject_put(prvdata->kobj);
-	platform_set_drvdata(pdev, NULL);
 	iounmap(rpmh_unit_base);
-	rpmh_unit_base = NULL;
 
 	return 0;
 }
diff --git a/drivers/soc/qcom/rpmh_master_stat.h b/drivers/soc/qcom/rpmh_master_stat.h
index c3fe7dcff97d3c7402cc345854f4c376ab5e0dcd..7892c7dd8c536bfe3cdc6e7f2f71e2639148ccef 100644
--- a/drivers/soc/qcom/rpmh_master_stat.h
+++ b/drivers/soc/qcom/rpmh_master_stat.h
@@ -21,3 +21,5 @@ void msm_rpmh_master_stats_update(void);
 static inline void msm_rpmh_master_stats_update(void) {}
 
 #endif
+
+extern int rpmh_master_stats_open(struct inode *inode, struct file *file);
diff --git a/drivers/soc/qcom/service-locator.c b/drivers/soc/qcom/service-locator.c
index b35cd3b27d7487b6541a9a58da3c821e5041bac8..2d971671f24a6b8df998adf556499fc04a775549 100644
--- a/drivers/soc/qcom/service-locator.c
+++ b/drivers/soc/qcom/service-locator.c
@@ -32,7 +32,9 @@
 #define SERVREG_LOC_SERVICE_INSTANCE_ID			1
 
 #define QMI_SERVREG_LOC_SERVER_INITIAL_TIMEOUT		2000
-#define QMI_SERVREG_LOC_SERVER_TIMEOUT			2000
+
+#define QMI_SERVREG_LOC_SERVER_TIMEOUT      3000
+
 #define INITIAL_TIMEOUT					100000
 #define LOCATOR_SERVICE_TIMEOUT				300000
 
diff --git a/drivers/soc/qcom/smp2p_sleepstate.c b/drivers/soc/qcom/smp2p_sleepstate.c
index 443f4c23b4fa9ad1246409eeb94160083fb10962..8a6b2d40c2b2de8c774c70eba6ec4e63a63745bb 100644
--- a/drivers/soc/qcom/smp2p_sleepstate.c
+++ b/drivers/soc/qcom/smp2p_sleepstate.c
@@ -21,7 +21,7 @@
 
 #define PROC_AWAKE_ID 12 /* 12th bit */
 #define AWAKE_BIT BIT(PROC_AWAKE_ID)
-static struct qcom_smem_state *state;
+struct qcom_smem_state *qstate;
 struct wakeup_source notify_ws;
 
 /**
@@ -38,11 +38,11 @@ static int sleepstate_pm_notifier(struct notifier_block *nb,
 {
 	switch (event) {
 	case PM_SUSPEND_PREPARE:
-		qcom_smem_state_update_bits(state, AWAKE_BIT, 0);
+		//qcom_smem_state_update_bits(state, AWAKE_BIT, 0);
 		break;
 
 	case PM_POST_SUSPEND:
-		qcom_smem_state_update_bits(state, AWAKE_BIT, AWAKE_BIT);
+		//qcom_smem_state_update_bits(state, AWAKE_BIT, AWAKE_BIT);
 		break;
 	}
 
@@ -67,10 +67,10 @@ static int smp2p_sleepstate_probe(struct platform_device *pdev)
 	struct device *dev = &pdev->dev;
 	struct device_node *node = dev->of_node;
 
-	state = qcom_smem_state_get(&pdev->dev, 0, &ret);
-	if (IS_ERR(state))
-		return PTR_ERR(state);
-	qcom_smem_state_update_bits(state, AWAKE_BIT, AWAKE_BIT);
+	qstate = qcom_smem_state_get(&pdev->dev, 0, &ret);
+	if (IS_ERR(qstate))
+	    return PTR_ERR(qstate);
+	qcom_smem_state_update_bits(qstate, AWAKE_BIT, AWAKE_BIT); 
 
 	ret = register_pm_notifier(&sleepstate_pm_nb);
 	if (ret)
diff --git a/drivers/soc/qcom/subsys-pil-tz.c b/drivers/soc/qcom/subsys-pil-tz.c
index e5408d56570ef0f70f28e57868f8900917337d5b..0d23f84a20c5045ed9a94964c19deb4658ced04d 100644
--- a/drivers/soc/qcom/subsys-pil-tz.c
+++ b/drivers/soc/qcom/subsys-pil-tz.c
@@ -31,6 +31,7 @@
 
 #include <linux/soc/qcom/smem.h>
 #include <linux/soc/qcom/smem_state.h>
+#include <linux/project_info.h>
 
 #include "peripheral-loader.h"
 
@@ -800,7 +801,7 @@ static struct pil_reset_ops pil_ops_trusted = {
 static void log_failure_reason(const struct pil_tz_data *d)
 {
 	size_t size;
-	char *smem_reason, reason[MAX_SSR_REASON_LEN];
+	char *smem_reason, reason[MAX_SSR_REASON_LEN], *function_name;
 	const char *name = d->subsys_desc.name;
 
 	if (d->smem_id == -1)
@@ -818,6 +819,8 @@ static void log_failure_reason(const struct pil_tz_data *d)
 	}
 
 	strlcpy(reason, smem_reason, min(size, (size_t)MAX_SSR_REASON_LEN));
+        function_name = parse_function_builtin_return_address((unsigned long)__builtin_return_address(0));
+	save_dump_reason_to_smem(reason, function_name);
 	pr_err("%s subsystem failure reason: %s.\n", name, reason);
 }
 
diff --git a/drivers/soc/qcom/subsystem_restart.c b/drivers/soc/qcom/subsystem_restart.c
index 1b3e54c9b5a6d0ca991a0954611ec25d2f077521..56f05fd8fd6c74de4093d2add84e7ba15b698a7b 100644
--- a/drivers/soc/qcom/subsystem_restart.c
+++ b/drivers/soc/qcom/subsystem_restart.c
@@ -42,6 +42,11 @@
 #include <linux/timer.h>
 
 #include "peripheral-loader.h"
+#include <linux/proc_fs.h>
+#include <linux/param_rw.h>
+#include <linux/timer.h>
+#include <linux/timex.h>
+#include <linux/rtc.h>
 
 #define DISABLE_SSR 0x9889deed
 /* If set to 0x9889deed, call to subsystem_restart_dev() returns immediately */
@@ -191,6 +196,7 @@ struct subsys_device {
 	struct wakeup_source ssr_wlock;
 	char wlname[64];
 	struct work_struct device_restart_work;
+	struct work_struct crash_record_work;
 	struct subsys_tracking track;
 
 	void *notify;
@@ -838,6 +844,192 @@ struct subsys_device *find_subsys_device(const char *str)
 }
 EXPORT_SYMBOL(find_subsys_device);
 
+static int val;
+struct delayed_work	op_restart_modem_work;
+
+static ssize_t proc_restart_level_all_read(struct file *p_file,
+	char __user *puser_buf, size_t count, loff_t *p_offset)
+{
+	ssize_t len = 0;
+
+	len = copy_to_user(puser_buf, val?"1":"0", 1);
+	pr_info("the restart level switch is:%d\n", val);
+	return len;
+}
+
+static ssize_t proc_restart_level_all_write(struct file *p_file,
+	const char __user *puser_buf,
+	size_t count, loff_t *p_offset)
+{
+	char temp[2] = {0};
+	struct subsys_device *subsys;
+	int rc;
+
+	if (copy_from_user(temp, puser_buf, 1))
+		return -EFAULT;
+
+	rc = kstrtoint(temp, 0, &val);
+	if (rc != 0)
+		return -EINVAL;
+
+	cancel_delayed_work_sync(&op_restart_modem_work);
+
+	if (!strncasecmp(&temp[0], "0", 1)) {
+		subsys = find_subsys_device("venus");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("a640_zap");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("ipa_fws");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("adsp");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("slpi");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("modem");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("cdsp");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("spss");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("npu");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+		subsys = find_subsys_device("esoc0");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SUBSYS_COUPLED;
+
+
+	} else if (!strncasecmp(&temp[0], "1", 1)) {
+		subsys = find_subsys_device("venus");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("a640_zap");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("ipa_fws");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("adsp");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("slpi");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("modem");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("cdsp");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("spss");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("npu");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+		subsys = find_subsys_device("esoc0");
+		if (!subsys)
+			return -ENODEV;
+		subsys->restart_level = RESET_SOC;
+
+	}
+
+	pr_info("write the restart level switch to :%d\n", val);
+	return count;
+}
+
+static const struct file_operations restart_level_all_operations = {
+	.read = proc_restart_level_all_read,
+	.write = proc_restart_level_all_write,
+};
+
+static void init_restart_level_all_node(void)
+{
+	if (!proc_create("restart_level_all", 0644, NULL,
+			 &restart_level_all_operations)){
+		pr_err("%s : Failed to register proc interface\n", __func__);
+	}
+}
+
+static int restart_level;/*system original val*/
+
+static void op_restart_modem_work_fun(struct work_struct *work)
+{
+	struct subsys_device *subsys = find_subsys_device("modem");
+
+	subsys->restart_level = restart_level;
+	pr_err("%s:level=%d\n", __func__,subsys->restart_level);
+}
+
+int op_restart_modem_init(void)
+{
+	INIT_DELAYED_WORK(&op_restart_modem_work, op_restart_modem_work_fun);
+	return 0;
+}
+
+int op_restart_modem(void)
+{
+	struct subsys_device *subsys = find_subsys_device("modem");
+
+	if (!subsys)
+		return -ENODEV;
+	pr_err("%s:level=%d\n", __func__,subsys->restart_level);
+	restart_level = subsys->restart_level;
+	subsys->restart_level = RESET_SUBSYS_COUPLED;
+	if (subsystem_restart("modem") == -ENODEV)
+		pr_err("%s: SSR call failed\n", __func__);
+
+	schedule_delayed_work(&op_restart_modem_work,
+			msecs_to_jiffies(10*1000));
+	return 0;
+}
+EXPORT_SYMBOL(op_restart_modem);
+
 static int subsys_start(struct subsys_device *subsys)
 {
 	int ret;
@@ -1210,8 +1402,108 @@ static void device_restart_work_hdlr(struct work_struct *work)
 	 * sync() and fclose() on attempting the dump.
 	 */
 	msleep(100);
-	panic("subsys-restart: Resetting the SoC - %s crashed.",
+	if (true == modem_5G_panic) {
+		panic("5G DUMP : The expected panic to get 5G dump. ");
+	} else {
+		panic("subsys-restart: Resetting the SoC - %s crashed.",
 							dev->desc->name);
+	}
+}
+
+#define KMSG_BUFSIZE 512
+#define MAX_RECORD_COUNT 16
+#define PARAM_CRASH_RECORD_SIZE 20
+
+struct crash_index_list {
+	const char *crash_log_name;
+	const char *crash_index;
+};
+
+static struct crash_index_list crash_index[] = {
+	{ "modem",     "08"},
+	{ "slpi",      "09"},
+	{ "adsp",      "10"},
+	{ "AR6320",    "11"},
+	{ 0,            0 },
+};
+
+void check_crash_restart(struct work_struct *work)
+{
+	struct subsys_device *dev = container_of(work, struct subsys_device,
+							crash_record_work);
+	const char *name = dev->desc->name;
+	char crash_time[19];
+	char param_value[21];
+	int split = 0, times = 0;
+	int rc = 0;
+	int i = 0;
+	int crash_record_count = 0;
+	int is_find_key_word = 0;
+
+	struct timespec64 tspec;
+	struct rtc_time tm;
+	extern struct timezone sys_tz;
+	uint32 param_crash_record_offset = 0;
+
+	for (i = 0; crash_index[i].crash_index; i++) {
+		if (!strcmp(name, crash_index[i].crash_log_name)) {
+
+			/* Clean param_value buffer*/
+			memset(param_value, 0, sizeof(param_value));
+
+			/* Get crash key word ID */
+			strlcat(param_value, crash_index[i].crash_index,
+				sizeof(param_value));
+
+			if (!strcmp("08", crash_index[i].crash_index))
+				add_restart_08_count();
+			else
+				add_restart_other_count();
+
+			__getnstimeofday64(&tspec);
+			if (sys_tz.tz_minuteswest < 0 ||
+				(tspec.tv_sec - sys_tz.tz_minuteswest*60) >= 0)
+				tspec.tv_sec -= sys_tz.tz_minuteswest * 60;
+			rtc_time_to_tm(tspec.tv_sec, &tm);
+			scnprintf(crash_time, sizeof(crash_time),
+				"%02d%02d%02d_%02d:%02d:%02d",
+				tm.tm_year + 1900, tm.tm_mon + 1,
+				tm.tm_mday, tm.tm_hour, tm.tm_min, tm.tm_sec);
+
+			strlcat(param_value, crash_time, sizeof(param_value));
+
+			/* If find crash keyword, store crash record flag */
+			is_find_key_word = 1;
+		}
+	}
+
+	if (is_find_key_word) {
+		get_param_by_index_and_offset(9, 0x18, &crash_record_count,
+			sizeof(crash_record_count));
+		param_crash_record_offset = 0x1C;
+		param_crash_record_offset = param_crash_record_offset +
+			(crash_record_count * PARAM_CRASH_RECORD_SIZE);
+
+		pr_err("subsystem_restart: check_crash_restart: param_value = %s\n",
+			param_value);
+
+		/* Write crash record to PARAM */
+		split = sizeof(param_value)/4;
+		for (times = 0; times < split; times++) {
+			rc = set_param_by_index_and_offset(9,
+				param_crash_record_offset,
+					&param_value[times*4], 4);
+			param_crash_record_offset =
+				param_crash_record_offset + 4;
+		}
+
+		/* Counter+1 */
+		crash_record_count = crash_record_count + 1;
+		crash_record_count = crash_record_count % MAX_RECORD_COUNT;
+		set_param_by_index_and_offset(9, 0x18, &crash_record_count,
+			sizeof(crash_record_count));
+	}
+
 }
 
 int subsystem_restart_dev(struct subsys_device *dev)
@@ -1228,6 +1520,7 @@ int subsystem_restart_dev(struct subsys_device *dev)
 
 	name = dev->desc->name;
 
+	schedule_work(&dev->crash_record_work);
 	send_early_notifications(dev->early_notify);
 
 	/*
@@ -1808,6 +2101,7 @@ struct subsys_device *subsys_register(struct subsys_desc *desc)
 
 	snprintf(subsys->wlname, sizeof(subsys->wlname), "ssr(%s)", desc->name);
 	wakeup_source_init(&subsys->ssr_wlock, subsys->wlname);
+	INIT_WORK(&subsys->crash_record_work, check_crash_restart);
 	INIT_WORK(&subsys->work, subsystem_restart_wq_func);
 	INIT_WORK(&subsys->device_restart_work, device_restart_work_hdlr);
 	spin_lock_init(&subsys->track.s_lock);
@@ -1879,7 +2173,7 @@ struct subsys_device *subsys_register(struct subsys_desc *desc)
 		if (ret < 0)
 			goto err_setup_irqs;
 	}
-
+	op_restart_modem_init();
 	return subsys;
 err_setup_irqs:
 	if (subsys->desc->edge)
@@ -1971,6 +2265,7 @@ static int __init subsys_restart_init(void)
 	if (ret)
 		goto err_soc;
 
+	init_restart_level_all_node();
 	return 0;
 
 err_soc:
diff --git a/drivers/spi/spi-geni-qcom.c b/drivers/spi/spi-geni-qcom.c
index a1faace846028ffd4328adbe62b2d03265de0dbe..9858a327f4baeacc71f566bac85d76bbd44bd4d4 100644
--- a/drivers/spi/spi-geni-qcom.c
+++ b/drivers/spi/spi-geni-qcom.c
@@ -159,6 +159,7 @@ struct spi_geni_master {
 	void *ipc;
 	bool shared_se;
 	bool dis_autosuspend;
+	bool cmd_done;
 };
 
 static void spi_slv_setup(struct spi_geni_master *mas);
@@ -1368,7 +1369,7 @@ static irqreturn_t geni_spi_irq(int irq, void *data)
 
 		if ((m_irq & M_CMD_DONE_EN) || (m_irq & M_CMD_CANCEL_EN) ||
 			(m_irq & M_CMD_ABORT_EN)) {
-			complete(&mas->xfer_done);
+			mas->cmd_done = true;
 			/*
 			 * If this happens, then a CMD_DONE came before all the
 			 * buffer bytes were sent out. This is unusual, log this
@@ -1408,12 +1409,16 @@ static irqreturn_t geni_spi_irq(int irq, void *data)
 		if (dma_rx_status & RX_DMA_DONE)
 			mas->rx_rem_bytes = 0;
 		if (!mas->tx_rem_bytes && !mas->rx_rem_bytes)
-			complete(&mas->xfer_done);
+			mas->cmd_done = true;
 		if ((m_irq & M_CMD_CANCEL_EN) || (m_irq & M_CMD_ABORT_EN))
-			complete(&mas->xfer_done);
+			mas->cmd_done = true;
 	}
 exit_geni_spi_irq:
 	geni_write_reg(m_irq, mas->base, SE_GENI_M_IRQ_CLEAR);
+    if (mas->cmd_done) {
+         mas->cmd_done = false;
+         complete(&mas->xfer_done);
+    }
 	return IRQ_HANDLED;
 }
 
diff --git a/drivers/spmi/spmi-pmic-arb.c b/drivers/spmi/spmi-pmic-arb.c
old mode 100644
new mode 100755
index 1ff30da74e4693ed83e08e1391e83e3950017804..f5f74649fbc3eb19f4c16565b2cec6669b608496
--- a/drivers/spmi/spmi-pmic-arb.c
+++ b/drivers/spmi/spmi-pmic-arb.c
@@ -514,7 +514,7 @@ static void periph_interrupt(struct spmi_pmic_arb *pmic_arb, u16 apid)
 		id = ffs(status) - 1;
 		status &= ~BIT(id);
 		irq = irq_find_mapping(pmic_arb->domain,
-					spec_to_hwirq(sid, per, id, apid));
+					(unsigned int)spec_to_hwirq(sid, per, id, apid));
 		if (irq == 0) {
 			cleanup_irq(pmic_arb, apid, id);
 			continue;
diff --git a/drivers/staging/android/lowmemorykiller.c b/drivers/staging/android/lowmemorykiller.c
index e196bdba0dc6643e9d6e730d903d043575364647..20764617fca126263b5c8060a6999bdea3d3850f 100644
--- a/drivers/staging/android/lowmemorykiller.c
+++ b/drivers/staging/android/lowmemorykiller.c
@@ -87,7 +87,13 @@ static int lowmem_minfree_size = 4;
 static int lmk_fast_run = 1;
 
 static unsigned long lowmem_deathpending_timeout;
-
+#ifdef CONFIG_SMART_BOOST
+unsigned long killed_num;
+unsigned long get_max_minfree(void)
+{
+	return lowmem_minfree[lowmem_minfree_size - 1];
+}
+#endif
 #define lowmem_print(level, x...)			\
 	do {						\
 		if (lowmem_debug_level >= (level))	\
@@ -169,6 +175,27 @@ static int adjust_minadj(short *min_score_adj)
 	return ret;
 }
 
+#ifdef CONFIG_ADJ_CHAIN
+static int batch_kill = 1;
+module_param(batch_kill, int, 0644);
+MODULE_PARM_DESC(batch_kill, "lowmemorykiller kill more strategy");
+
+#define BATCH_KILL_MAX_CNT (5)
+static int batch_kill_cnt = 1;
+
+static inline void batch_kill_adjust(unsigned long pressure)
+{
+	if (batch_kill) {
+		if (pressure >= 95)
+			batch_kill_cnt = 3; // critical
+		else if (pressure >= 90)
+			batch_kill_cnt = 2; // medium
+		else
+			batch_kill_cnt = 1; // normal
+	}
+}
+#endif
+
 static int lmk_vmpressure_notifier(struct notifier_block *nb,
 				   unsigned long action, void *data)
 {
@@ -176,6 +203,9 @@ static int lmk_vmpressure_notifier(struct notifier_block *nb,
 	unsigned long pressure = action;
 	int array_size = ARRAY_SIZE(lowmem_adj);
 
+#ifdef CONFIG_ADJ_CHAIN
+	batch_kill_adjust(pressure);
+#endif
 	if (!enable_adaptive_lmk)
 		return 0;
 
@@ -183,8 +213,12 @@ static int lmk_vmpressure_notifier(struct notifier_block *nb,
 		other_file = global_node_page_state(NR_FILE_PAGES) -
 			global_node_page_state(NR_SHMEM) -
 			total_swapcache_pages();
+#ifdef CONFIG_DEFRAG_HELPER
+		other_free = global_zone_page_state(NR_FREE_PAGES) -
+			global_zone_page_state(NR_FREE_DEFRAG_POOL);
+#else
 		other_free = global_zone_page_state(NR_FREE_PAGES);
-
+#endif
 		atomic_set(&shift_adj, 1);
 		trace_almk_vmpressure(pressure, other_free, other_file);
 	} else if (pressure >= 90) {
@@ -197,7 +231,12 @@ static int lmk_vmpressure_notifier(struct notifier_block *nb,
 			global_node_page_state(NR_SHMEM) -
 			total_swapcache_pages();
 
+#ifdef CONFIG_DEFRAG_HELPER
+		other_free = global_zone_page_state(NR_FREE_PAGES) -
+			global_zone_page_state(NR_FREE_DEFRAG_POOL);
+#else
 		other_free = global_zone_page_state(NR_FREE_PAGES);
+#endif
 
 		if (other_free < lowmem_minfree[array_size - 1] &&
 		    other_file < vmpressure_file_min) {
@@ -456,6 +495,533 @@ static void mark_lmk_victim(struct task_struct *tsk)
 	}
 }
 
+#ifdef CONFIG_ADJ_CHAIN
+#include <linux/adj_chain.h>
+
+static bool selftest_running = false;
+static int selftest_min_score_adj = 906;
+
+static int quick_select = 1;
+module_param(quick_select, int, 0644);
+MODULE_PARM_DESC(quick_select, "lowmemorykiller quick select task from adj chain");
+
+static int time_measure = 1;
+module_param(time_measure, int, 0644);
+MODULE_PARM_DESC(time_measure, "lowmemorykiller select task time measurement");
+
+static bool trust_adj_chain = false;
+module_param(trust_adj_chain, bool, 0644);
+MODULE_PARM_DESC(trust_adj_chain, "lowmemorykiller trust adj chain to select task only from adj chain");
+
+/*
+ *0 for start marker
+ *1 for end marker
+ */
+enum measure_marker {
+	MEASURE_START_MARKER,
+	MEASURE_END_MARKER
+};
+
+enum lmk_stat_group {
+	LMK_FOREGROUND,
+	LMK_KSWAPD,
+	LMK_OTHERS,
+	LMK_TOTAL,
+	LMK_GROUP_SIZE
+};
+
+enum lmk_batch_kill_lvs {
+	LMK_BK_NORMAL,
+	LMK_BK_MEDIUM,
+	LMK_BK_CRITICAL,
+	LMK_BK_SIZE
+};
+
+enum lmk_missed_task {
+	LMK_NOTHING_MISSED,
+	LMK_ADJ_CHAIN_MISSED,
+	LMK_BOTH_MISSED,
+	LMK_MISSED_SIZE
+};
+
+struct batch_kill_wrapper {
+	struct list_head node;
+	struct task_struct *selected;
+	int selected_tasksize;
+	short selected_oom_score_adj;
+	short min_score_adj;
+	u32 bklv;
+	u32 missed;
+	u32 scan;
+};
+
+static inline void batch_kill_init(struct batch_kill_wrapper *bkws)
+{
+	int i;
+
+	for (i = 0; i < BATCH_KILL_MAX_CNT; ++i)
+		bkws[i].selected = NULL;
+
+	/* use first entry to record status */
+	bkws[0].scan = 0;
+	bkws[0].bklv = LMK_BK_NORMAL;
+	bkws[0].missed = LMK_NOTHING_MISSED;
+}
+
+static inline bool batch_kill_empty(struct batch_kill_wrapper *bkw)
+{
+	if (bkw->selected)
+		return false;
+	return true;
+}
+
+static inline void batch_kill_assign(
+	struct batch_kill_wrapper *bkw,
+	struct task_struct *tsk,
+	int tasksize,
+	short oom_score_adj,
+	int bklv)
+{
+	bkw->selected = tsk;
+	bkw->selected_tasksize = tasksize;
+	bkw->selected_oom_score_adj = oom_score_adj;
+	lowmem_print(1,
+			"batch select: '%s' (%d), adj %hd, size %d, to kill, bklv %d\n",
+			tsk->comm, tsk->pid, __adjr(oom_score_adj), tasksize, bklv);
+}
+
+/* statistic information */
+#define LMK_STAT_FOREGROUND_ADJ (0)
+#define LMK_STAT_TIME_LV (10)
+
+struct lmk_stat {
+	s64 time_us;
+	s64 max_time_us;
+	s64 min_time_us;
+	u32 t[LMK_STAT_TIME_LV];
+	u32 cnt;
+	u32 bklv[LMK_BK_SIZE];
+	u32 missed[LMK_MISSED_SIZE];
+	u64 scan;
+} lmk_s[LMK_GROUP_SIZE] = {
+	{	.min_time_us = S64_MAX,	},
+	{	.min_time_us = S64_MAX,	},
+	{	.min_time_us = S64_MAX,	},
+	{	.min_time_us = S64_MAX,	}
+};
+
+static const char *lmk_tags[LMK_GROUP_SIZE] = {
+	"FOREGROUND :",
+	"KSWAPD     :",
+	"OTHERS     :",
+	"TOTAL      :"
+};
+
+static s64 lmk_t_delim[LMK_STAT_TIME_LV] = {
+	50, 100, 200, 400, 800,
+	1600, 3200, 6400, 12800, S64_MAX
+};
+
+static int lmk_stat_show(char *buf, const struct kernel_param *kp)
+{
+	int offset = 0, i, j;
+
+	for (i = 0; i < LMK_GROUP_SIZE; ++i) {
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, lmk_tags[i]);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "%lld ", lmk_s[i].time_us);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "%lld ", lmk_s[i].max_time_us);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "%lld ", lmk_s[i].time_us ? lmk_s[i].min_time_us : 0);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "%lld ", lmk_s[i].cnt ? lmk_s[i].time_us / lmk_s[i].cnt : 0);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "%u, bklv: ",  lmk_s[i].cnt);
+		for (j = LMK_BK_NORMAL; j < LMK_BK_SIZE; ++j)
+			offset += snprintf(buf + offset, PAGE_SIZE - offset, "%u ",  lmk_s[i].bklv[j]);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, ", ratio: ");
+		for (j = 0; j < LMK_STAT_TIME_LV; ++j)
+			offset += snprintf(buf + offset, PAGE_SIZE - offset, "%u ",  lmk_s[i].t[j]);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, ", missed: ");
+		for (j = LMK_ADJ_CHAIN_MISSED; j < LMK_MISSED_SIZE; ++j)
+			offset += snprintf(buf + offset, PAGE_SIZE - offset, "%u ",  lmk_s[i].missed[j]);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, ", scan: %lld %lld",
+				lmk_s[i].scan, lmk_s[i].cnt ? lmk_s[i].scan / lmk_s[i].cnt : 0);
+		offset += snprintf(buf + offset, PAGE_SIZE - offset, "\n");
+	}
+	return offset;
+}
+
+static struct kernel_param_ops lmk_stat_ops = {
+	.get = lmk_stat_show,
+};
+module_param_cb(stat, &lmk_stat_ops, NULL, 0444);
+
+static inline enum lmk_stat_group lmk_which_group(void)
+{
+	const char *p = "kswapd";
+
+	if (current->signal) {
+		if (current->signal->oom_score_adj ==  LMK_STAT_FOREGROUND_ADJ) {
+			if (!strncmp(current->comm, p, strlen(p)))
+				return LMK_KSWAPD;
+			return LMK_FOREGROUND;
+		}
+	}
+	return LMK_OTHERS;
+}
+
+static inline void lmk_stat_analysis(ktime_t begin, ktime_t end, s64 t,
+				enum lmk_stat_group g, struct task_struct *tsk, struct batch_kill_wrapper *bkws)
+{
+	int i;
+
+	lowmem_print(1, "measure: analysis group: %s, begin: %lld, end: %lld, cost: %lldus, scan: %d, min_adj: %hd\n",
+		lmk_tags[g], ktime_to_us(begin), ktime_to_us(end), t, bkws[0].scan, bkws[0].min_score_adj);
+
+	if (!quick_select) {
+		/* original selection measure */
+		if (tsk) {
+			lowmem_print(1, "measure: analysis selected tsk: '%s' (%d) adj %hd\n",
+					tsk->comm, tsk->pid, tsk->signal->oom_score_adj);
+		} else {
+			lowmem_print(1, "measure: analysis no selected tsk\n");
+		}
+	} else {
+		/* adj chain selection measure */
+		for (i = 0; i < BATCH_KILL_MAX_CNT; ++i) {
+			struct task_struct *p = bkws[i].selected;
+
+			if (!p && i == 0) {
+				lowmem_print(1, "batch measure: analysis no selected tsk\n");
+				break;
+			} else if (!p)
+				break;
+			lowmem_print(1, "batch measure: analysis selected tsk: '%s' (%d) adj %hd\n",
+					p->comm, p->pid, p->signal->oom_score_adj);
+		}
+	}
+}
+
+static inline void lmk_stat_update(s64 t, enum lmk_stat_group g, struct batch_kill_wrapper *bkws)
+{
+	enum lmk_batch_kill_lvs lv = bkws[0].bklv;
+	enum lmk_missed_task mt = bkws[0].missed;
+	u64 scan = bkws[0].scan;
+	int i;
+
+	lmk_s[g].time_us += t;
+	if (t > lmk_s[g].max_time_us)
+		lmk_s[g].max_time_us = t;
+	if (t < lmk_s[g].min_time_us)
+		lmk_s[g].min_time_us = t;
+	++lmk_s[g].cnt;
+	for (i = 0; i < LMK_STAT_TIME_LV; ++i) {
+		if (t < lmk_t_delim[i]) {
+			++lmk_s[g].t[i];
+			break;
+		}
+	}
+	++lmk_s[g].bklv[lv];
+	if (mt != LMK_NOTHING_MISSED)
+		++lmk_s[g].missed[mt];
+	lmk_s[g].scan += scan;
+}
+
+static void time_measure_marker(enum measure_marker m, struct task_struct *tsk, struct batch_kill_wrapper *bkws)
+{
+	static ktime_t begin, end;
+	enum lmk_stat_group g = lmk_which_group();
+	s64 t;
+	int i;
+
+	switch (m) {
+	case MEASURE_START_MARKER:
+		begin = ktime_get();
+		break;
+	case MEASURE_END_MARKER:
+		end = ktime_get();
+		t = ktime_to_us(ktime_sub(end, begin));
+		if (unlikely(time_measure)) {
+			if (tsk)
+				lowmem_print(1, "measure: select %d (%s) adj %d, cost %lldus. qp %d\n",
+						tsk->pid, tsk->comm, tsk->signal->oom_score_adj,
+						t, quick_select);
+			else if (!batch_kill_empty(bkws)) {
+				for (i = 0; i < BATCH_KILL_MAX_CNT; ++i) {
+					tsk = bkws[i].selected;
+					if (tsk)
+						lowmem_print(1,
+								"batch measure: select %d (%s) adj %d, cost %lldus. qs %d bk %d\n",
+								tsk->pid, tsk->comm, tsk->signal->oom_score_adj,
+								t, quick_select, batch_kill);
+				}
+			}
+		}
+
+		/* record searching time longer than 12.8 ms*/
+		if (t >= lmk_t_delim[LMK_STAT_TIME_LV - 2])
+			lmk_stat_analysis(begin, end, t, g, tsk, bkws);
+
+		lmk_stat_update(t, g, bkws);
+		lmk_stat_update(t, LMK_TOTAL, bkws);
+		break;
+	}
+}
+
+static int lowmem_quick_select_next(
+		short min_score_adj,
+		struct task_struct **target,
+		bool batch_kill_enable,
+		struct batch_kill_wrapper *bkws,
+		int *selected_tasksize,
+		short *selected_oom_score_adj)
+{
+	struct task_struct *tsk, *p;
+	struct task_struct *selected = NULL;
+	int cur_high = adj_chain_hist_high;
+	int tasksize;
+	int limit = __adjc(min_score_adj);
+	int bkcnt = batch_kill_cnt;
+	int cnt = 0, i, bklv = bkcnt;
+
+	/*
+	 *critical: kill 3 tasks
+	 *medium: kill 2 tasks
+	 *normal: kill 1 task
+	 *clear pressure event by reset kill cnt to 1
+	 *FIXME
+	 *   bklv will be directly mapped to array index,
+	 *  it will be better to defined by pressure.
+	 */
+	bkws[0].bklv = bkcnt - 1;
+	batch_kill_cnt = 1;
+
+	read_lock(&tasklist_lock);
+	for (; cur_high >= limit; --cur_high) {
+		if (!list_empty(&adj_chain[cur_high])) {
+			/* reset selected_tasksize for batch kill */
+			*selected_tasksize = 0;
+
+			list_for_each_entry_rcu(tsk, &adj_chain[cur_high], adj_chain_tasks) {
+				/* record for scan cnt */
+				++bkws[0].scan;
+
+				/* align lmk original selection logic */
+				if (tsk->flags & PF_KTHREAD)
+					continue;
+
+				/* if task no longer has any memory ignore it */
+				if (test_task_flag(tsk, TIF_MM_RELEASED))
+					continue;
+
+				if (oom_reaper) {
+					p = find_lock_task_mm(tsk);
+					if (!p)
+						continue;
+
+					if (test_bit(MMF_OOM_VICTIM, &p->mm->flags)) {
+						if (test_bit(MMF_OOM_SKIP, &p->mm->flags)) {
+							task_unlock(p);
+							continue;
+						} else if (time_before_eq(jiffies,
+									lowmem_deathpending_timeout)) {
+							task_unlock(p);
+							read_unlock(&tasklist_lock);
+							rcu_read_unlock();
+							mutex_unlock(&scan_mutex);
+							return -1;
+						}
+					}
+				} else {
+					if (time_before_eq(jiffies,
+								lowmem_deathpending_timeout))
+						if (test_task_lmk_waiting(tsk)) {
+							read_unlock(&tasklist_lock);
+							rcu_read_unlock();
+							mutex_unlock(&scan_mutex);
+							return -1;
+						}
+
+					p = find_lock_task_mm(tsk);
+					if (!p)
+						continue;
+				}
+
+				tasksize = get_mm_rss(p->mm);
+
+				task_unlock(p);
+				if (tasksize <= 0)
+					continue;
+
+				/*
+				 * batch kill select
+				 * Since select will search adjchain from the highest to lower adj.
+				 * considering the case (adj: tasksize)
+				 * 906: 16 15 13, pick cnt 2
+				 * if we pick task after tasksize compared, it will only pick 16
+				 * and find next task with lower adj, which is not appropriate.
+				 * So we pick task before tasksize is compared.
+				 */
+				if (batch_kill_enable && bkcnt) {
+					batch_kill_assign(bkws + cnt, p, tasksize, cur_high, bklv);
+					++cnt;
+					--bkcnt;
+				}
+
+				if (selected) {
+					if (tasksize <= *selected_tasksize)
+						continue;
+				}
+				selected = p;
+				*selected_tasksize = tasksize;
+				*selected_oom_score_adj = cur_high;
+			}
+
+			if (selected) {
+				if (batch_kill_enable) {
+					bool exist = false;
+
+					for (i = 0; i < BATCH_KILL_MAX_CNT; ++i) {
+						if (bkws[i].selected == selected) {
+							exist = true;
+							break;
+						}
+					}
+					/* always make sure the best candidate been picked */
+					if (!exist) {
+						/* replace task with higher adj */
+						if (*selected_oom_score_adj >= bkws[0].selected_oom_score_adj)
+							batch_kill_assign(bkws + 0, selected,
+									*selected_tasksize, *selected_oom_score_adj, bklv);
+					}
+				} else {
+					lowmem_print(3, "select: '%s' (%d), adj %hd, size %d, to kill\n",
+							selected->comm, selected->pid,
+							__adjr(*selected_oom_score_adj), *selected_tasksize);
+					*target = selected;
+					goto select_complete;
+				}
+			}
+
+			if (!bkcnt)
+				goto select_complete;
+		}
+	}
+
+select_complete:
+	read_unlock(&tasklist_lock);
+
+	return 0;
+}
+
+static unsigned long lowmem_batch_kill(
+	struct batch_kill_wrapper *bkws,
+	struct shrink_control *sc,
+	int minfree,
+	int other_file,
+	int other_free,
+	short min_score_adj)
+{
+	unsigned long rem = 0;
+	struct task_struct *selected;
+	int selected_tasksize, i;
+	short selected_oom_score_adj;
+	bool signaled = false;
+
+	for (i = 0; i < BATCH_KILL_MAX_CNT; ++i) {
+		selected = bkws[i].selected;
+		selected_tasksize = bkws[i].selected_tasksize;
+		selected_oom_score_adj = bkws[i].selected_oom_score_adj;
+
+		if (selected) {
+			long cache_size = other_file * (long)(PAGE_SIZE / 1024);
+			long cache_limit = minfree * (long)(PAGE_SIZE / 1024);
+			long free = other_free * (long)(PAGE_SIZE / 1024);
+
+			if (test_task_lmk_waiting(selected) &&
+					(test_task_state(selected, TASK_UNINTERRUPTIBLE))) {
+				lowmem_print(2, "'%s' (%d) is already killed\n",
+						selected->comm,
+						selected->pid);
+				continue;
+			}
+
+			task_lock(selected);
+			send_sig(SIGKILL, selected, 0);
+			signaled = true;
+			if (selected->mm) {
+				task_set_lmk_waiting(selected);
+				if (!test_bit(MMF_OOM_SKIP, &selected->mm->flags) &&
+						oom_reaper) {
+					mark_lmk_victim(selected);
+					wake_oom_reaper(selected);
+				}
+			}
+			task_unlock(selected);
+			trace_lowmemory_kill(selected, cache_size, cache_limit, free);
+			lowmem_print(1, "batch Killing '%s' (%d) (tgid %d), adj %hd,\n"
+					"to free %ldkB on behalf of '%s' (%d) because\n"
+					"cache %ldkB is below limit %ldkB for oom score %hd\n"
+#ifdef CONFIG_SMART_BOOST
+					"uid_lru_list size %ld pages\n"
+#endif
+					"Free memory is %ldkB above reserved.\n"
+					"Free CMA is %ldkB\n"
+#ifdef CONFIG_DEFRAG_HELPER
+					"Free defrag is %ldkB\n"
+#endif
+					"Total reserve is %ldkB\n"
+					"Total free pages is %ldkB\n"
+					"Total file cache is %ldkB\n"
+					"SHMEM is %ldkB\n"
+					"SwapCached is %ldkB\n"
+					"GFP mask is 0x%x\n",
+					selected->comm, selected->pid, selected->tgid,
+					__adjr(selected_oom_score_adj),
+					selected_tasksize * (long)(PAGE_SIZE / 1024),
+					current->comm, current->pid,
+					cache_size, cache_limit,
+					min_score_adj,
+#ifdef CONFIG_SMART_BOOST
+					uid_lru_size(),
+#endif
+					free,
+					global_zone_page_state(NR_FREE_CMA_PAGES) *
+					(long)(PAGE_SIZE / 1024),
+#ifdef CONFIG_DEFRAG_HELPER
+					global_zone_page_state(NR_FREE_DEFRAG_POOL) *
+					(long)(PAGE_SIZE / 1024),
+#endif
+					totalreserve_pages * (long)(PAGE_SIZE / 1024),
+					global_zone_page_state(NR_FREE_PAGES) *
+						(long)(PAGE_SIZE / 1024),
+					global_node_page_state(NR_FILE_PAGES) *
+						(long)(PAGE_SIZE / 1024),
+					global_node_page_state(NR_SHMEM) *
+						(long)(PAGE_SIZE / 1024),
+					total_swapcache_pages() *
+						(long)(PAGE_SIZE / 1024),
+					sc->gfp_mask);
+
+			if (lowmem_debug_level >= 2 && selected_oom_score_adj == 0) {
+				show_mem(SHOW_MEM_FILTER_NODES, NULL);
+				show_mem_call_notifiers();
+				dump_tasks(NULL, NULL);
+			}
+
+			rem += selected_tasksize;
+		}
+	}
+	lowmem_print(4, "lowmem_scan %lu, %x, return %lu\n",
+			sc->nr_to_scan, sc->gfp_mask, rem);
+	rcu_read_unlock();
+	if (signaled) {
+		lowmem_deathpending_timeout = jiffies + HZ;
+		/* give the system time to free up the memory */
+		msleep_interruptible(20);
+	}
+	mutex_unlock(&scan_mutex);
+	return rem;
+}
+#endif
+
 static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 {
 	struct task_struct *tsk;
@@ -473,8 +1039,20 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 	int other_free;
 	int other_file;
 	bool lock_required = true;
-
+#ifdef CONFIG_ADJ_CHAIN
+	bool quick_select_enable = quick_select;
+	bool batch_kill_enable = batch_kill;
+	struct batch_kill_wrapper bkws[BATCH_KILL_MAX_CNT];
+	enum lmk_missed_task mt = LMK_NOTHING_MISSED;
+	batch_kill_init(bkws);
+#endif
+#ifdef CONFIG_DEFRAG_HELPER
+	other_free = global_zone_page_state(NR_FREE_PAGES) -
+			global_zone_page_state(NR_FREE_DEFRAG_POOL) -
+						totalreserve_pages;
+#else
 	other_free = global_zone_page_state(NR_FREE_PAGES) - totalreserve_pages;
+#endif
 
 	if (global_node_page_state(NR_SHMEM) + total_swapcache_pages() +
 			global_node_page_state(NR_UNEVICTABLE) <
@@ -504,16 +1082,21 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 		minfree = mult_frac(lowmem_minfree[i], scale_percent, 100);
 		if (other_free < minfree && other_file < minfree) {
 			min_score_adj = lowmem_adj[i];
-			break;
+		break;
 		}
 	}
-
 	ret = adjust_minadj(&min_score_adj);
 
 	lowmem_print(3, "%s %lu, %x, ofree %d %d, ma %hd\n",
 		     __func__, sc->nr_to_scan, sc->gfp_mask, other_free,
 		     other_file, min_score_adj);
 
+#ifdef CONFIG_ADJ_CHAIN
+	if (unlikely(selftest_running)) {
+		min_score_adj = selftest_min_score_adj;
+		goto selftest_bypass;
+	}
+#endif
 	if (min_score_adj == OOM_SCORE_ADJ_MAX + 1) {
 		trace_almk_shrink(0, ret, other_free, other_file, 0);
 		lowmem_print(5, "%s %lu, %x, return 0\n",
@@ -523,12 +1106,53 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 		return 0;
 	}
 
+#ifdef CONFIG_ADJ_CHAIN
+selftest_bypass:
+#endif
 	selected_oom_score_adj = min_score_adj;
 
 	rcu_read_lock();
+#ifdef CONFIG_ADJ_CHAIN
+	/* record for each time lmk scan's min_score_adj */
+	bkws[0].min_score_adj = min_score_adj;
+
+	/* marker for select begin */
+	time_measure_marker(MEASURE_START_MARKER, NULL, NULL);
+
+	if (quick_select_enable) {
+		if (lowmem_quick_select_next(min_score_adj,
+				&selected, batch_kill_enable, bkws,
+				&selected_tasksize, &selected_oom_score_adj))
+			return 0;
+
+		if (selected || !batch_kill_empty(bkws))
+			goto quick_select_fast;
+		else if (trust_adj_chain) {
+			/* marker for select end */
+			bkws[0].missed = LMK_ADJ_CHAIN_MISSED;
+			time_measure_marker(MEASURE_END_MARKER, selected, bkws);
+
+			/*
+			 * since trust adj chain, then we don't need to search tasklist again.
+			 * Basically, if candidate task can't be found in adj chain,
+			 * it should not be found in tasklist neither.
+			 */
+			trace_almk_shrink(1, ret, other_free, other_file, 0);
+			rcu_read_unlock();
+			lowmem_print(4, "%s %lu, %x, return %lu\n",
+					__func__, sc->nr_to_scan, sc->gfp_mask, rem);
+			mutex_unlock(&scan_mutex);
+			return rem;
+		}
+	}
+#endif
 	for_each_process(tsk) {
 		struct task_struct *p;
 		short oom_score_adj;
+#ifdef CONFIG_ADJ_CHAIN
+		/* record for scan cnt */
+		++bkws[0].scan;
+#endif
 
 		if (tsk->flags & PF_KTHREAD)
 			continue;
@@ -592,6 +1216,102 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 		lowmem_print(3, "select '%s' (%d), adj %hd, size %d, to kill\n",
 			     p->comm, p->pid, oom_score_adj, tasksize);
 	}
+#ifdef CONFIG_ADJ_CHAIN
+	/* adj chain diagnose */
+	if (!selected) {
+		/* which is good because it expected result */
+		mt = LMK_BOTH_MISSED;
+	} else {
+		struct list_head *h;
+		struct task_struct *tsk;
+		bool found = false;
+
+		if (!quick_select_enable)
+			goto bypass_diagnose;
+
+		mt = LMK_ADJ_CHAIN_MISSED;
+
+		lowmem_print(3, "missing task '%s' (%d) adj %hd, adj_chain_status(%d), size %d, "
+				"missed from adj chain, run diagnose\n",
+				selected->comm,
+				selected->pid,
+				selected_oom_score_adj,
+				selected->adj_chain_status,
+				selected_tasksize);
+
+		if (!found) {
+			if (selected->adj_chain_status) {
+				lowmem_print(3,
+					"missing task adj_chain_status(%d), under updating, "
+					"should be reattach to adj chain %hd later, don't worry!\n",
+					selected->adj_chain_status,
+					selected_oom_score_adj);
+				found = true;
+				mt = LMK_NOTHING_MISSED;
+			}
+		}
+
+		if (!found) {
+			list_for_each(h, &adj_chain[__adjc(selected_oom_score_adj)]) {
+				tsk = get_task_struct_adj_chain_rcu(h);
+				if (tsk == selected) {
+					lowmem_print(3,
+								"missing task exists in other adj chain\n");
+					found = true;
+					mt = LMK_NOTHING_MISSED;
+					break;
+				}
+			}
+		}
+
+		if (!found) {
+		/* worst case to search each adj chain for missing task */
+			int cur_high = __adjc(1000);
+
+			lowmem_print(3,
+					"missing task not exists adj chain,search for all adj chain\n");
+			for (; cur_high >= 0; --cur_high) {
+				if (!list_empty(&adj_chain[cur_high])) {
+					list_for_each(h, &adj_chain[cur_high]) {
+						tsk = get_task_struct_adj_chain_rcu(h);
+						if (tsk == selected) {
+							lowmem_print(3,
+									"missing task finally found with in adj chain %d\n",
+									__adjr(cur_high));
+							found = true;
+							mt = LMK_NOTHING_MISSED;
+							break;
+						}
+					}
+				}
+				if (found)
+					break;
+			}
+		}
+
+		/* missing someone ... oops */
+		if (!found) {
+			lowmem_print(1, "missing task '%s' (%d) adj %hd, adj_chain_status(%d)\n",
+					selected->comm, selected->pid, selected_oom_score_adj,
+					selected->adj_chain_status);
+		}
+
+		/* leave selected task NULL for further debugging */
+		selected = NULL;
+	}
+
+bypass_diagnose:
+	/* record missing task analysis result */
+	bkws[0].missed = mt;
+
+quick_select_fast:
+	/* marker for select end */
+	time_measure_marker(MEASURE_END_MARKER, selected, bkws);
+
+	if (batch_kill_enable && !batch_kill_empty(bkws))
+		return lowmem_batch_kill(bkws, sc, minfree, other_file,
+						other_free, min_score_adj);
+#endif
 	if (selected) {
 		long cache_size = other_file * (long)(PAGE_SIZE / 1024);
 		long cache_limit = minfree * (long)(PAGE_SIZE / 1024);
@@ -608,7 +1328,9 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 				mutex_unlock(&scan_mutex);
 			return 0;
 		}
-
+#ifdef CONFIG_SMART_BOOST
+		killed_num++;
+#endif
 		task_lock(selected);
 		send_sig(SIGKILL, selected, 0);
 		if (selected->mm) {
@@ -624,8 +1346,14 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 		lowmem_print(1, "Killing '%s' (%d) (tgid %d), adj %hd,\n"
 			"to free %ldkB on behalf of '%s' (%d) because\n"
 			"cache %ldkB is below limit %ldkB for oom score %hd\n"
+#ifdef CONFIG_SMART_BOOST
+			"uid_lru_list size %ld pages\n"
+#endif
 			"Free memory is %ldkB above reserved.\n"
 			"Free CMA is %ldkB\n"
+#ifdef CONFIG_DEFRAG_HELPER
+			"Free defrag is %ldkB\n"
+#endif
 			"Total reserve is %ldkB\n"
 			"Total free pages is %ldkB\n"
 			"Total file cache is %ldkB\n"
@@ -636,9 +1364,16 @@ static unsigned long lowmem_scan(struct shrinker *s, struct shrink_control *sc)
 			current->comm, current->pid,
 			cache_size, cache_limit,
 			min_score_adj,
+#ifdef CONFIG_SMART_BOOST
+			uid_lru_size(),
+#endif
 			free,
 			global_zone_page_state(NR_FREE_CMA_PAGES) *
 			(long)(PAGE_SIZE / 1024),
+#ifdef CONFIG_DEFRAG_HELPER
+			global_zone_page_state(NR_FREE_DEFRAG_POOL) *
+			(long)(PAGE_SIZE / 1024),
+#endif
 			totalreserve_pages * (long)(PAGE_SIZE / 1024),
 			global_zone_page_state(NR_FREE_PAGES) *
 			(long)(PAGE_SIZE / 1024),
@@ -787,3 +1522,41 @@ module_param_array_named(minfree, lowmem_minfree, uint, &lowmem_minfree_size,
 module_param_named(debug_level, lowmem_debug_level, uint, S_IRUGO | S_IWUSR);
 module_param_named(lmk_fast_run, lmk_fast_run, int, S_IRUGO | S_IWUSR);
 
+#ifdef CONFIG_ADJ_CHAIN
+static int selftest_store(const char *buf, const struct kernel_param *kp)
+{
+	unsigned int val;
+	unsigned int min_score_adj = 900;
+	long freeable;
+	struct shrink_control sc = {
+		.gfp_mask = GFP_KERNEL,
+		.nid = 0,
+		.memcg = NULL,
+	};
+
+	if (sscanf(buf, "%u %u\n", &val, &min_score_adj) <= 0)
+		return -EINVAL;
+
+	if (val < 1 || val > BATCH_KILL_MAX_CNT || min_score_adj < 352 || min_score_adj > 1000) {
+		lowmem_print(1, "selftest EINVAL\n");
+		return -EINVAL;
+	}
+
+	batch_kill_cnt = val;
+	selftest_min_score_adj = min_score_adj;
+	selftest_running = true;
+	freeable = lowmem_count(NULL, NULL);
+	if (freeable) {
+		lowmem_print(1, "selftest set batch kill cnt to %u, min_score_adj %d\n", val, min_score_adj);
+		lowmem_scan(NULL, &sc);
+	}
+	batch_kill_cnt = 1;
+	selftest_running = false;
+	return 0;
+}
+
+static struct kernel_param_ops selftest_ops = {
+	.set = selftest_store,
+};
+module_param_cb(selftest, &selftest_ops, NULL, 0200);
+#endif
diff --git a/drivers/thermal/qcom/bcl_soc.c b/drivers/thermal/qcom/bcl_soc.c
index 29e97e42a3c00a92ec3e6d24bc74db3bfa72a339..5d7552a5433c71c04962c04ba3c8d86a59e891ea 100644
--- a/drivers/thermal/qcom/bcl_soc.c
+++ b/drivers/thermal/qcom/bcl_soc.c
@@ -37,6 +37,7 @@ struct bcl_device {
 	bool					irq_enabled;
 	struct thermal_zone_device		*tz_dev;
 	struct thermal_zone_of_device_ops	ops;
+	struct work_struct		bcl_usb_work;
 };
 
 static struct bcl_device *bcl_perph;
@@ -107,11 +108,48 @@ static void bcl_evaluate_soc(struct work_struct *work)
 	mutex_unlock(&bcl_perph->state_trans_lock);
 }
 
+/*
+ * When low soc, bcl set 2 perf cores to isolation,
+ * insert usb recover the perf cores.
+ */
+static void bcl_usb_process(struct work_struct *work)
+{
+	static struct power_supply *usb_psy;
+	union power_supply_propval ret = {0,};
+	int err = 0;
+
+	if (!usb_psy)
+		usb_psy = power_supply_get_by_name("usb");
+	if (usb_psy) {
+		err = power_supply_get_property(usb_psy,
+				POWER_SUPPLY_PROP_PRESENT, &ret);
+		if (err) {
+			pr_err("USB status get error:%d\n",
+				err);
+			return;
+		}
+		if (ret.intval == 1) {
+			bcl_perph->tz_dev->ops->set_trip_temp(
+			bcl_perph->tz_dev, 1, 0);
+			thermal_zone_device_update(bcl_perph->tz_dev,
+			THERMAL_EVENT_UNSPECIFIED);
+		} else {
+			bcl_perph->tz_dev->ops->set_trip_temp(
+			bcl_perph->tz_dev, 1, 15);
+			thermal_zone_device_update(bcl_perph->tz_dev,
+			THERMAL_EVENT_UNSPECIFIED);
+		}
+	}
+}
+
 static int battery_supply_callback(struct notifier_block *nb,
 			unsigned long event, void *data)
 {
 	struct power_supply *psy = data;
 
+	if (!strcmp(psy->desc->name, "usb"))
+		schedule_work(&bcl_perph->bcl_usb_work);
+
 	if (strcmp(psy->desc->name, "battery"))
 		return NOTIFY_OK;
 	schedule_work(&bcl_perph->soc_eval_work);
@@ -123,6 +161,7 @@ static int bcl_soc_remove(struct platform_device *pdev)
 {
 	power_supply_unreg_notifier(&bcl_perph->psy_nb);
 	flush_work(&bcl_perph->soc_eval_work);
+	flush_work(&bcl_perph->bcl_usb_work);
 	if (bcl_perph->tz_dev)
 		thermal_zone_of_sensor_unregister(&pdev->dev,
 				bcl_perph->tz_dev);
@@ -142,14 +181,8 @@ static int bcl_soc_probe(struct platform_device *pdev)
 	bcl_perph->ops.get_temp = bcl_read_soc;
 	bcl_perph->ops.set_trips = bcl_set_soc;
 	INIT_WORK(&bcl_perph->soc_eval_work, bcl_evaluate_soc);
-	bcl_perph->psy_nb.notifier_call = battery_supply_callback;
-	ret = power_supply_reg_notifier(&bcl_perph->psy_nb);
-	if (ret < 0) {
-		pr_err("soc notifier registration error. defer. err:%d\n",
-			ret);
-		ret = -EPROBE_DEFER;
-		goto bcl_soc_probe_exit;
-	}
+	INIT_WORK(&bcl_perph->bcl_usb_work, bcl_usb_process);
+
 	bcl_perph->tz_dev = thermal_zone_of_sensor_register(&pdev->dev,
 				0, bcl_perph, &bcl_perph->ops);
 	if (IS_ERR(bcl_perph->tz_dev)) {
@@ -160,6 +193,14 @@ static int bcl_soc_probe(struct platform_device *pdev)
 		goto bcl_soc_probe_exit;
 	}
 	thermal_zone_device_update(bcl_perph->tz_dev, THERMAL_DEVICE_UP);
+	bcl_perph->psy_nb.notifier_call = battery_supply_callback;
+	ret = power_supply_reg_notifier(&bcl_perph->psy_nb);
+	if (ret < 0) {
+		pr_err("soc notifier registration error. defer. err:%d\n",
+			ret);
+		ret = -EPROBE_DEFER;
+		goto bcl_soc_probe_exit;
+	}
 	schedule_work(&bcl_perph->soc_eval_work);
 
 	dev_set_drvdata(&pdev->dev, bcl_perph);
diff --git a/drivers/thermal/qcom/qmi_sensors.c b/drivers/thermal/qcom/qmi_sensors.c
index 4feb3cb9f1fe888c3bb1de6990d43617a54542c1..a71e7d8f4800a9491d75121d0e85993900e9202f 100644
--- a/drivers/thermal/qcom/qmi_sensors.c
+++ b/drivers/thermal/qcom/qmi_sensors.c
@@ -40,6 +40,7 @@
 enum qmi_ts_sensor {
 	QMI_TS_PA,
 	QMI_TS_PA_1,
+	QMI_TS_PA_2,
 	QMI_TS_QFE_PA_0,
 	QMI_TS_QFE_WTR_0,
 	QMI_TS_MODEM_MODEM,
@@ -83,6 +84,7 @@ static atomic_t in_suspend;
 static char sensor_clients[QMI_TS_MAX_NR][QMI_CLIENT_NAME_LENGTH] = {
 	{"pa"},
 	{"pa_1"},
+	{"pa_2"},
 	{"qfe_pa0"},
 	{"qfe_wtr0"},
 	{"modem_tsens"},
diff --git a/drivers/tty/serial/msm_geni_serial.c b/drivers/tty/serial/msm_geni_serial.c
index a6c4aa183ff709cdd2125b6f06e769c8c6ce2e61..6167a784cffb7478617ea3557528fd2736194a16 100644
--- a/drivers/tty/serial/msm_geni_serial.c
+++ b/drivers/tty/serial/msm_geni_serial.c
@@ -29,7 +29,7 @@
 #include <linux/slab.h>
 #include <linux/tty.h>
 #include <linux/tty_flip.h>
-
+#include <linux/miscdevice.h>
 /* UART specific GENI registers */
 #define SE_UART_LOOPBACK_CFG		(0x22C)
 #define SE_UART_TX_TRANS_CFG		(0x25C)
@@ -128,6 +128,21 @@
 		ipc_log_string(ctx, x); \
 } while (0)
 
+
+/*we use dynamic add console , so we can't use __init  __exit, this will cause can't find func*/
+#ifdef __init
+#undef __init
+#endif
+
+#ifdef __exit
+#undef __exit
+#endif
+
+#define __init
+#define __exit
+
+
+
 #define DMA_RX_BUF_SIZE		(2048)
 #define UART_CONSOLE_RX_WM	(2)
 struct msm_geni_serial_port {
@@ -2309,7 +2324,7 @@ static const struct uart_ops msm_geni_serial_pops = {
 
 static const struct of_device_id msm_geni_device_tbl[] = {
 #if defined(CONFIG_SERIAL_CORE_CONSOLE) || defined(CONFIG_CONSOLE_POLL)
-	{ .compatible = "qcom,msm-geni-console",
+	{ .compatible = "qcom,msm-geni-console-oem",
 			.data = (void *)&msm_geni_console_driver},
 #endif
 	{ .compatible = "qcom,msm-geni-serial-hs",
@@ -2317,6 +2332,26 @@ static const struct of_device_id msm_geni_device_tbl[] = {
 	{},
 };
 
+struct oemconsole {
+	bool default_console;
+	bool console_initialized;
+};
+
+static struct oemconsole oem_console  = {
+	.default_console       = false,
+	.console_initialized   = false,
+};
+
+static int __init parse_console_config(char *str)
+{
+	if (str != NULL)
+		oem_console.default_console = true;
+	return 0;
+}
+early_param("console", parse_console_config);
+static int  msm_serial_oem_pinctrl_init(void);
+static int  oem_msm_geni_serial_init(void);
+
 static int msm_geni_serial_probe(struct platform_device *pdev)
 {
 	int ret = 0;
@@ -2681,13 +2716,31 @@ static const struct dev_pm_ops msm_geni_serial_pm_ops = {
 	.suspend_noirq = msm_geni_serial_sys_suspend_noirq,
 	.resume_noirq = msm_geni_serial_sys_resume_noirq,
 };
-
+static const struct of_device_id msm_geni_device_tbl_oem_hs[] = {
+	{ .compatible = "qcom,msm-geni-serial-hs"},
+	{},
+};
 static struct platform_driver msm_geni_serial_platform_driver = {
 	.remove = msm_geni_serial_remove,
 	.probe = msm_geni_serial_probe,
 	.driver = {
 		.name = "msm_geni_serial",
-		.of_match_table = msm_geni_device_tbl,
+		.of_match_table = msm_geni_device_tbl_oem_hs,
+		.pm = &msm_geni_serial_pm_ops,
+	},
+};
+
+static const struct of_device_id msm_geni_device_tbl_oem_console[] = {
+	{ .compatible = "qcom,msm-geni-console-oem",},
+	{},
+};
+
+static struct platform_driver msm_geni_serial_platform_driver_oem_console = {
+	.remove = msm_geni_serial_remove,
+	.probe = msm_geni_serial_probe,
+	.driver = {
+		.name = "msm_geni_serial_oem",
+		.of_match_table = msm_geni_device_tbl_oem_console,
 		.pm = &msm_geni_serial_pm_ops,
 	},
 };
@@ -2719,10 +2772,6 @@ static int __init msm_geni_serial_init(void)
 		msm_geni_console_port.uport.line = i;
 	}
 
-	ret = console_register(&msm_geni_console_driver);
-	if (ret)
-		return ret;
-
 	ret = uart_register_driver(&msm_geni_serial_hs_driver);
 	if (ret) {
 		uart_unregister_driver(&msm_geni_console_driver);
@@ -2737,6 +2786,12 @@ static int __init msm_geni_serial_init(void)
 	}
 
 	pr_info("%s: Driver initialized", __func__);
+
+	if(oem_console.default_console == 1)
+		 oem_msm_geni_serial_init();
+	else
+		 msm_serial_oem_pinctrl_init();
+
 	return ret;
 }
 module_init(msm_geni_serial_init);
@@ -2749,6 +2804,110 @@ static void __exit msm_geni_serial_exit(void)
 }
 module_exit(msm_geni_serial_exit);
 
+
+static int oem_msm_geni_serial_init(void)
+{
+	int ret = 0;
+
+	pr_err("%s console_initialized=%d \n", __func__,oem_console.console_initialized);
+
+	if(oem_console.console_initialized != 1 ) {
+		oem_console.console_initialized = 1;
+		ret = console_register(&msm_geni_console_driver);
+		if (ret)
+			return ret;
+
+		ret = platform_driver_register(&msm_geni_serial_platform_driver_oem_console);
+		if (ret) {
+			console_unregister(&msm_geni_console_driver);
+			return ret;
+		}
+		pr_info("%s: initialized", __func__);
+	}
+	return ret;
+}
+
+
+
+static int msm_serial_pinctrl_probe(struct platform_device *pdev)
+{
+
+	struct pinctrl *pinctrl = NULL;
+	struct pinctrl_state *set_state = NULL;
+	struct device *dev = &pdev->dev;
+
+	pr_err("%s\n", __func__);
+	pinctrl = devm_pinctrl_get(dev);
+
+	if (pinctrl != NULL) {
+
+		set_state = pinctrl_lookup_state(
+				pinctrl, "uart_pinctrl_deactive");
+
+		if (set_state != NULL)
+			pinctrl_select_state(pinctrl, set_state);
+
+		devm_pinctrl_put(pinctrl);
+	}
+	return 0;
+}
+
+static int msm_serial_pinctrl_remove(struct platform_device *pdev)
+{
+	return 0;
+}
+
+
+static const struct of_device_id oem_serial_pinctrl_of_match[] = {
+	{ .compatible = "oem,oem_serial_pinctrl" },
+	{}
+};
+
+
+static struct platform_driver msm_platform_serial_pinctrl_driver = {
+	.remove = msm_serial_pinctrl_remove,
+	.probe = msm_serial_pinctrl_probe,
+	.driver = {
+		.name = "oem_serial_pinctrl",
+		.of_match_table = oem_serial_pinctrl_of_match,
+	},
+};
+
+static int	msm_serial_oem_pinctrl_init(void)
+{
+	int ret = 0;
+
+	pr_err("%s\n", __func__);
+
+	ret = platform_driver_register(&msm_platform_serial_pinctrl_driver);
+
+	return ret;
+}
+EXPORT_SYMBOL(msm_serial_oem_pinctrl_init);
+
+#define SERIAL_CMDLINE "ttyMSM0,115200n8"
+char oem_force_cmdline_str[60];
+
+int msm_serial_oem_init(void)
+{
+	int ret = 0;
+
+	pr_err("%s\n", __func__);
+
+	memcpy(oem_force_cmdline_str, SERIAL_CMDLINE, sizeof(SERIAL_CMDLINE));
+	force_oem_console_setup(&oem_force_cmdline_str[0]);
+	oem_msm_geni_serial_init();
+	return ret;
+}
+EXPORT_SYMBOL(msm_serial_oem_init);
+
+void msm_serial_oem_exit(void)
+{
+	pr_err("%s\n", __func__);
+	msm_geni_serial_exit();
+}
+EXPORT_SYMBOL(msm_serial_oem_exit);
+
 MODULE_DESCRIPTION("Serial driver for GENI based QTI serial cores");
 MODULE_LICENSE("GPL v2");
 MODULE_ALIAS("tty:msm_geni_geni_serial");
diff --git a/drivers/tty/sysrq.c b/drivers/tty/sysrq.c
index 4e6a3713fae0dc68375afbfc9425ef1e6d9accba..443c6c38254c7a10e3154edddfdd1cd8435a3de6 100644
--- a/drivers/tty/sysrq.c
+++ b/drivers/tty/sysrq.c
@@ -135,17 +135,10 @@ static struct sysrq_key_op sysrq_unraw_op = {
 
 static void sysrq_handle_crash(int key)
 {
-	char *killer = NULL;
-
-	/* we need to release the RCU read lock here,
-	 * otherwise we get an annoying
-	 * 'BUG: sleeping function called from invalid context'
-	 * complaint from the kernel before the panic.
-	 */
+	/* release the RCU read lock before crashing */
 	rcu_read_unlock();
-	panic_on_oops = 1;	/* force panic */
-	wmb();
-	*killer = 1;
+
+	panic("sysrq triggered crash");
 }
 static struct sysrq_key_op sysrq_crash_op = {
 	.handler	= sysrq_handle_crash,
diff --git a/drivers/usb/core/driver.c b/drivers/usb/core/driver.c
index 6a0a20ef5043829283f26084f95b135b12deb6ce..9f0aa8e4fd805cfee8ebae72d5b96fda9875b72a 100644
--- a/drivers/usb/core/driver.c
+++ b/drivers/usb/core/driver.c
@@ -1809,6 +1809,13 @@ static int autosuspend_check(struct usb_device *udev)
 			 * or else their drivers don't support autosuspend
 			 * and so they are permanently active.
 			 */
+/* david.liu@bsp, 20171122 Avoid crash due to broken fs on otg */
+			if (!intf) {
+				dev_err(&udev->dev, "%s intf is NULL\n",
+						__func__);
+				return -EIO;
+			}
+
 			if (intf->dev.power.disable_depth)
 				continue;
 			if (atomic_read(&intf->dev.power.usage_count) > 0)
diff --git a/drivers/usb/core/hub.c b/drivers/usb/core/hub.c
index 01dde0450b55b7d39354406c612833812a69daa1..80c88aac18ef473ce4c4e6ca5b834c3ef12147a3 100644
--- a/drivers/usb/core/hub.c
+++ b/drivers/usb/core/hub.c
@@ -4333,6 +4333,9 @@ static void hub_set_initial_usb2_lpm_policy(struct usb_device *udev)
 	if (hub)
 		connect_type = hub->ports[udev->portnum - 1]->connect_type;
 
+	if (!udev->bos)
+		return;
+
 	if ((udev->bos->ext_cap->bmAttributes & cpu_to_le32(USB_BESL_SUPPORT)) ||
 			connect_type == USB_PORT_CONNECT_TYPE_HARD_WIRED) {
 		udev->usb2_hw_lpm_allowed = 1;
diff --git a/drivers/usb/dwc3/core.h b/drivers/usb/dwc3/core.h
index 92e637784237718f956207f724c7f0fc02828482..238bd2abcb82587258240e2a3ca40e8c8bd2a55a 100644
--- a/drivers/usb/dwc3/core.h
+++ b/drivers/usb/dwc3/core.h
@@ -855,8 +855,10 @@ struct dwc3_scratchpad_array {
 #define DWC3_GSI_EVT_BUF_ALLOC			10
 #define DWC3_GSI_EVT_BUF_SETUP			11
 #define DWC3_GSI_EVT_BUF_CLEANUP		12
-#define DWC3_GSI_EVT_BUF_FREE			13
-#define DWC3_CONTROLLER_NOTIFY_CLEAR_DB		14
+#define DWC3_GSI_EVT_BUF_CLEAR			13
+#define DWC3_GSI_EVT_BUF_FREE			14
+#define DWC3_CONTROLLER_NOTIFY_CLEAR_DB	15
+
 
 #define MAX_INTR_STATS				10
 
diff --git a/drivers/usb/dwc3/debug_ipc.c b/drivers/usb/dwc3/debug_ipc.c
index e5341a60976200d5d191fb26118cf813ea51c399..f021c73075035120701be441398a379a1389f00f 100644
--- a/drivers/usb/dwc3/debug_ipc.c
+++ b/drivers/usb/dwc3/debug_ipc.c
@@ -59,6 +59,8 @@ void dwc3_dbg_print(struct dwc3 *dwc, u8 ep_num, const char *name,
 
 	ipc_log_string(dwc->dwc_ipc_log_ctxt, "%02X %-25.25s %4i ?\t%s",
 			ep_num, name, status, extra);
+	pr_info("%02X %-25.25s %4i ?\t%s",
+			ep_num, name, status, extra);
 }
 
 /**
@@ -76,6 +78,8 @@ void dwc3_dbg_done(struct dwc3 *dwc, u8 ep_num,
 
 	ipc_log_string(dwc->dwc_ipc_log_ctxt, "%02X %-25.25s %4i ?\t%d",
 			ep_num, "DONE", status, count);
+	pr_info("%02X %-25.25s %4i ?\t%d",
+			ep_num, "DONE", status, count);
 }
 
 /**
@@ -109,6 +113,9 @@ void dwc3_dbg_queue(struct dwc3 *dwc, u8 ep_num,
 		ipc_log_string(dwc->dwc_ipc_log_ctxt,
 			"%02X %-25.25s %4i ?\t%d %d", ep_num, "QUEUE", status,
 			!req->no_interrupt, req->length);
+		pr_info("%02X %-25.25s %4i ?\t%d %d",
+			ep_num, "QUEUE", status,
+			!req->no_interrupt, req->length);
 	}
 }
 
@@ -129,6 +136,10 @@ void dwc3_dbg_setup(struct dwc3 *dwc, u8 ep_num,
 			ep_num, "SETUP", req->bRequestType,
 			req->bRequest, le16_to_cpu(req->wValue),
 			le16_to_cpu(req->wIndex), le16_to_cpu(req->wLength));
+		pr_info("%02X %-25.25s ?\t%02X %02X %04X %04X %d",
+			ep_num, "SETUP", req->bRequestType,
+			req->bRequest, le16_to_cpu(req->wValue),
+			le16_to_cpu(req->wIndex), le16_to_cpu(req->wLength));
 	}
 }
 
@@ -143,4 +154,5 @@ void dwc3_dbg_print_reg(struct dwc3 *dwc, const char *name, int reg)
 		return;
 
 	ipc_log_string(dwc->dwc_ipc_log_ctxt, "%s = 0x%08x", name, reg);
+	pr_info("%s = 0x%08x", name, reg);
 }
diff --git a/drivers/usb/dwc3/dwc3-msm.c b/drivers/usb/dwc3/dwc3-msm.c
index 61ee9f53395ba4ce1cfb4b85f18ecef381ea642e..edc7bc621fc951bdafdfc17a91eaee2d60e0817a 100644
--- a/drivers/usb/dwc3/dwc3-msm.c
+++ b/drivers/usb/dwc3/dwc3-msm.c
@@ -79,6 +79,7 @@
 #define CGCTL_REG		(QSCRATCH_REG_OFFSET + 0x28)
 #define PWR_EVNT_IRQ_STAT_REG    (QSCRATCH_REG_OFFSET + 0x58)
 #define PWR_EVNT_IRQ_MASK_REG    (QSCRATCH_REG_OFFSET + 0x5C)
+#define QSCRATCH_USB30_STS_REG	(QSCRATCH_REG_OFFSET + 0xF8)
 
 #define PWR_EVNT_POWERDOWN_IN_P3_MASK		BIT(2)
 #define PWR_EVNT_POWERDOWN_OUT_P3_MASK		BIT(3)
@@ -2002,6 +2003,15 @@ static void dwc3_msm_notify_event(struct dwc3 *dwc, unsigned int event,
 			dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT((i+1)), 0);
 		}
 		break;
+	case DWC3_GSI_EVT_BUF_CLEAR:
+		dev_dbg(mdwc->dev, "DWC3_GSI_EVT_BUF_CLEAR\n");
+		for (i = 0; i < mdwc->num_gsi_event_buffers; i++) {
+			reg = dwc3_readl(dwc->regs, DWC3_GEVNTCOUNT((i+1)));
+			reg &= DWC3_GEVNTCOUNT_MASK;
+			dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT((i+1)), reg);
+			dbg_log_string("remaining EVNTCOUNT(%d)=%d", i+1, reg);
+		}
+		break;
 	case DWC3_GSI_EVT_BUF_FREE:
 		dev_dbg(mdwc->dev, "DWC3_GSI_EVT_BUF_FREE\n");
 		if (!mdwc->gsi_ev_buff)
@@ -2107,6 +2117,7 @@ static void dwc3_msm_power_collapse_por(struct dwc3_msm *mdwc)
 
 static int dwc3_msm_prepare_suspend(struct dwc3_msm *mdwc, bool ignore_p3_state)
 {
+	struct dwc3 *dwc = platform_get_drvdata(mdwc->dwc3);
 	unsigned long timeout;
 	u32 reg = 0;
 
@@ -2134,8 +2145,19 @@ static int dwc3_msm_prepare_suspend(struct dwc3_msm *mdwc, bool ignore_p3_state)
 		if (reg & PWR_EVNT_LPM_IN_L2_MASK)
 			break;
 	}
-	if (!(reg & PWR_EVNT_LPM_IN_L2_MASK))
-		dev_err(mdwc->dev, "could not transition HS PHY to L2\n");
+	if (!(reg & PWR_EVNT_LPM_IN_L2_MASK)) {
+		dbg_event(0xFF, "PWR_EVNT_LPM",
+			dwc3_msm_read_reg(mdwc->base, PWR_EVNT_IRQ_STAT_REG));
+		dbg_event(0xFF, "QUSB_STS",
+			dwc3_msm_read_reg(mdwc->base, QSCRATCH_USB30_STS_REG));
+		/* Mark fatal error for host mode or USB bus suspend case */
+		if (mdwc->in_host_mode || (mdwc->vbus_active
+			&& mdwc->drd_state == DRD_STATE_PERIPHERAL_SUSPEND)) {
+			queue_work(mdwc->dwc3_wq, &mdwc->resume_work);
+			dev_err(mdwc->dev, "could not transition HS PHY to L2\n");
+			return -EBUSY;
+		}
+	}
 
 	/* Clear L2 event bit */
 	dwc3_msm_write_reg(mdwc->base, PWR_EVNT_IRQ_STAT_REG,
@@ -2741,9 +2763,9 @@ static void dwc3_resume_work(struct work_struct *w)
 
 		ret = extcon_get_property(edev, extcon_id,
 				EXTCON_PROP_USB_SS, &val);
-
-		if (!ret && val.intval == 0)
-			dwc->maximum_speed = USB_SPEED_HIGH;
+		if (!ret)
+			dwc->maximum_speed = val.intval ?
+			dwc->max_hw_supp_speed : USB_SPEED_HIGH;
 
 		if (mdwc->override_usb_speed &&
 				mdwc->override_usb_speed < dwc->maximum_speed) {
diff --git a/drivers/usb/dwc3/ep0.c b/drivers/usb/dwc3/ep0.c
index 5ef1377d441a26f9aeb844e669ed5d56b11dbd08..c17a151e95604c5a219968c247f73a1f3ab9b504 100644
--- a/drivers/usb/dwc3/ep0.c
+++ b/drivers/usb/dwc3/ep0.c
@@ -35,6 +35,22 @@
 #include "debug.h"
 #include "gadget.h"
 #include "io.h"
+#include <linux/power/oem_external_fg.h>
+
+static struct notify_usb_enumeration_status
+		*usb_enumeration_status = NULL;
+
+void regsister_notify_usb_enumeration_status(
+	struct notify_usb_enumeration_status *status)
+{
+	if (usb_enumeration_status) {
+		usb_enumeration_status = status;
+		pr_err("multiple usb_enumeration_status called\n");
+	} else {
+		usb_enumeration_status = status;
+	}
+}
+EXPORT_SYMBOL(regsister_notify_usb_enumeration_status);
 
 static bool enable_dwc3_u1u2;
 module_param(enable_dwc3_u1u2, bool, 0644);
@@ -306,6 +322,9 @@ void dwc3_ep0_out_start(struct dwc3 *dwc)
 
 	complete(&dwc->ep0_in_setup);
 
+	if (!dwc->softconnect)
+		return;
+
 	dep = dwc->eps[0];
 	dwc3_ep0_prepare_one_trb(dep, dwc->ep0_trb_addr, 8,
 			DWC3_TRBCTL_CONTROL_SETUP, false);
@@ -902,6 +921,10 @@ static int dwc3_ep0_std_request(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 		ret = dwc3_ep0_handle_feature(dwc, ctrl, 1);
 		break;
 	case USB_REQ_SET_ADDRESS:
+		if (usb_enumeration_status
+			&& usb_enumeration_status->notify_usb_enumeration) {
+			usb_enumeration_status->notify_usb_enumeration(true);
+		}
 		ret = dwc3_ep0_set_address(dwc, ctrl);
 		break;
 	case USB_REQ_SET_CONFIGURATION:
diff --git a/drivers/usb/dwc3/gadget.c b/drivers/usb/dwc3/gadget.c
index 844d5675a70031942f672cbe8876c30251561db5..8d575bc44928acc95c283d6e35ae16a0101ded11 100644
--- a/drivers/usb/dwc3/gadget.c
+++ b/drivers/usb/dwc3/gadget.c
@@ -1376,6 +1376,11 @@ static int __dwc3_gadget_kick_transfer(struct dwc3_ep *dep, u16 cmd_param)
 	int				ret;
 	u32				cmd;
 
+	if (dep->flags & DWC3_EP_END_TRANSFER_PENDING) {
+		dbg_event(dep->number, "ENDXFER Pending", dep->flags);
+		return -EBUSY;
+	}
+
 	starting = !(dep->flags & DWC3_EP_BUSY);
 
 	dwc3_prepare_trbs(dep);
@@ -2181,6 +2186,19 @@ static int dwc3_gadget_run_stop(struct dwc3 *dwc, int is_on, int suspend)
 
 	dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 
+	/* Controller is not halted until the events are acknowledged */
+	if (!is_on) {
+		/*
+		 * Clear out any pending events (i.e. End Transfer Command
+		 * Complete)
+		 */
+		reg1 = dwc3_readl(dwc->regs, DWC3_GEVNTCOUNT(0));
+		reg1 &= DWC3_GEVNTCOUNT_MASK;
+		dbg_log_string("remaining EVNTCOUNT(0)=%d", reg1);
+		dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT(0), reg1);
+		dwc3_notify_event(dwc, DWC3_GSI_EVT_BUF_CLEAR, 0);
+	}
+
 	do {
 		reg = dwc3_readl(dwc->regs, DWC3_DSTS);
 		reg &= DWC3_DSTS_DEVCTRLHLT;
@@ -2245,6 +2263,9 @@ static int dwc3_gadget_pullup(struct usb_gadget *g, int is_on)
 				msecs_to_jiffies(DWC3_PULL_UP_TIMEOUT));
 		if (ret == 0) {
 			dev_err(dwc->dev, "timed out waiting for SETUP phase\n");
+			pm_runtime_put_autosuspend(dwc->dev);
+			dbg_event(0xFF, "Pullup timeout put",
+				atomic_read(&dwc->dev->power.usage_count));
 			return -ETIMEDOUT;
 		}
 	}
@@ -3257,8 +3278,6 @@ static void dwc3_gadget_reset_interrupt(struct dwc3 *dwc)
 	dwc->b_suspend = false;
 	dwc3_notify_event(dwc, DWC3_CONTROLLER_NOTIFY_OTG_EVENT, 0);
 
-	usb_gadget_vbus_draw(&dwc->gadget, 100);
-
 	dwc3_reset_gadget(dwc);
 
 	reg = dwc3_readl(dwc->regs, DWC3_DCTL);
@@ -3664,8 +3683,6 @@ static void dwc3_gadget_interrupt(struct dwc3 *dwc,
 			if (dwc->gadget.state >= USB_STATE_CONFIGURED)
 				dwc3_gadget_suspend_interrupt(dwc,
 						event->event_info);
-			else
-				usb_gadget_vbus_draw(&dwc->gadget, 2);
 		}
 		break;
 	case DWC3_DEVICE_EVENT_SOF:
@@ -3810,6 +3827,12 @@ static irqreturn_t dwc3_check_event_buf(struct dwc3_event_buffer *evt)
 	if (dwc->err_evt_seen)
 		return IRQ_HANDLED;
 
+	/* Controller is being halted, ignore the interrupts */
+	if (!dwc->pullups_connected) {
+		dbg_event(0xFF, "NO_PULLUP", 0);
+		return IRQ_HANDLED;
+	}
+
 	/*
 	 * With PCIe legacy interrupt, test shows that top-half irq handler can
 	 * be called again after HW interrupt deassertion. Check if bottom-half
@@ -3824,6 +3847,19 @@ static irqreturn_t dwc3_check_event_buf(struct dwc3_event_buffer *evt)
 	if (!count)
 		return IRQ_NONE;
 
+	if (count > evt->length) {
+		dbg_event(0xFF, "HUGE_EVCNT", count);
+		/*
+		 * If writes from dwc3_interrupt and run_stop(0) races
+		 * with each other, the count can result in a very large
+		 * value.In that case setting the evt->lpos here
+		 * is a no-op. The value will be reset as part of run_stop(1).
+		 */
+		evt->lpos = (evt->lpos + count) % DWC3_EVENT_BUFFERS_SIZE;
+		dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT(0), count);
+		return IRQ_HANDLED;
+	}
+
 	evt->count = count;
 	evt->flags |= DWC3_EVENT_PENDING;
 
diff --git a/drivers/usb/gadget/composite.c b/drivers/usb/gadget/composite.c
index f28fdfe200e9902957f466a19180be13d0a5d9b5..ed81f00bb244d0d2fe73d347dc12f29f4ae65226 100644
--- a/drivers/usb/gadget/composite.c
+++ b/drivers/usb/gadget/composite.c
@@ -2426,7 +2426,6 @@ void composite_suspend(struct usb_gadget *gadget)
 	cdev->suspended = 1;
 	spin_unlock_irqrestore(&cdev->lock, flags);
 
-	usb_gadget_vbus_draw(gadget, 2);
 }
 
 void composite_resume(struct usb_gadget *gadget)
diff --git a/drivers/usb/gadget/configfs.c b/drivers/usb/gadget/configfs.c
index c0f8bb42d4c4526ffb05ad2205b01c1ad90e453b..08d6c94e117e46f204d43cb194a2855fb48c27dd 100644
--- a/drivers/usb/gadget/configfs.c
+++ b/drivers/usb/gadget/configfs.c
@@ -89,6 +89,7 @@ struct gadget_info {
 	struct usb_composite_driver composite;
 	struct usb_composite_dev cdev;
 	bool use_os_desc;
+	bool unbinding;
 	char b_vendor_code;
 	char qw_sign[OS_STRING_QW_SIGN_LEN];
 #ifdef CONFIG_USB_CONFIGFS_UEVENT
@@ -286,9 +287,12 @@ static int unregister_gadget(struct gadget_info *gi)
 	if (!gi->composite.gadget_driver.udc_name)
 		return -ENODEV;
 
+	gi->unbinding = true;
 	ret = usb_gadget_unregister_driver(&gi->composite.gadget_driver);
 	if (ret)
 		return ret;
+
+	gi->unbinding = false;
 	kfree(gi->composite.gadget_driver.udc_name);
 	gi->composite.gadget_driver.udc_name = NULL;
 	return 0;
@@ -1568,7 +1572,8 @@ static void android_disconnect(struct usb_gadget *gadget)
 	acc_disconnect();
 #endif
 	gi->connected = 0;
-	schedule_work(&gi->work);
+	if (!gi->unbinding)
+		schedule_work(&gi->work);
 	composite_disconnect(gadget);
 }
 #endif
diff --git a/drivers/usb/gadget/function/f_accessory.c b/drivers/usb/gadget/function/f_accessory.c
index ca97f6e9ea87901c86828cbf3b3b655754a8c2fd..78b4d12157b82cb965ed18cae2dbf8eaf21cab37 100644
--- a/drivers/usb/gadget/function/f_accessory.c
+++ b/drivers/usb/gadget/function/f_accessory.c
@@ -659,16 +659,16 @@ static ssize_t acc_write(struct file *fp, const char __user *buf,
 	}
 
 	while (count > 0) {
-		if (!dev->online) {
+		/* get an idle tx request to use */
+		req = 0;
+		ret = wait_event_interruptible(dev->write_wq,
+			((req = req_get(dev, &dev->tx_idle)) || !dev->online));
+		if (!dev->online || dev->disconnected) {
 			pr_debug("acc_write dev->error\n");
 			r = -EIO;
 			break;
 		}
 
-		/* get an idle tx request to use */
-		req = 0;
-		ret = wait_event_interruptible(dev->write_wq,
-			((req = req_get(dev, &dev->tx_idle)) || !dev->online));
 		if (!req) {
 			r = ret;
 			break;
@@ -837,6 +837,13 @@ int acc_ctrlrequest(struct usb_composite_dev *cdev,
 	u16	w_length = le16_to_cpu(ctrl->wLength);
 	unsigned long flags;
 
+	/*
+	 * If instance is not created which is the case in power off charging
+	 * mode, dev will be NULL. Hence return error if it is the case.
+	 */
+	if (!dev)
+		return -ENODEV;
+
 /*
 	printk(KERN_INFO "acc_ctrlrequest "
 			"%02x.%02x v%04x i%04x l%u\n",
diff --git a/drivers/usb/gadget/function/f_audio_source.c b/drivers/usb/gadget/function/f_audio_source.c
index 8124af33b7383b394974ae666ae5c230585653a9..d4e75bf95c28c88806f02cb5513ada11aa56fde0 100644
--- a/drivers/usb/gadget/function/f_audio_source.c
+++ b/drivers/usb/gadget/function/f_audio_source.c
@@ -570,14 +570,38 @@ static int audio_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
 
 	pr_debug("audio_set_alt intf %d, alt %d\n", intf, alt);
 
+	if (!alt) {
+		usb_ep_disable(audio->in_ep);
+		return 0;
+	}
+
 	ret = config_ep_by_speed(cdev->gadget, f, audio->in_ep);
-	if (ret)
+	if (ret) {
+		audio->in_ep->desc = NULL;
+		pr_err("config_ep fail for audio ep ret %d\n", ret);
+		return ret;
+	}
+	ret = usb_ep_enable(audio->in_ep);
+	if (ret) {
+		audio->in_ep->desc = NULL;
+		pr_err("failed to enable audio ret %d\n", ret);
 		return ret;
+	}
 
-	usb_ep_enable(audio->in_ep);
 	return 0;
 }
 
+/*
+ * Because the data interface supports multiple altsettings,
+ * this audio_source function *MUST* implement a get_alt() method.
+ */
+static int audio_get_alt(struct usb_function *f, unsigned int intf)
+{
+	struct audio_dev	*audio = func_to_audio(f);
+
+	return audio->in_ep->enabled ? 1 : 0;
+}
+
 static void audio_disable(struct usb_function *f)
 {
 	struct audio_dev	*audio = func_to_audio(f);
@@ -841,6 +865,7 @@ static struct audio_dev _audio_dev = {
 		.bind = audio_bind,
 		.unbind = audio_unbind,
 		.set_alt = audio_set_alt,
+		.get_alt = audio_get_alt,
 		.setup = audio_setup,
 		.disable = audio_disable,
 		.free_func = audio_free_func,
diff --git a/drivers/usb/gadget/function/f_fs.c b/drivers/usb/gadget/function/f_fs.c
index f83143cbb0c4dabe6d9cb76d6658d05dd52dab33..4021143106c4a630a02546f999ffcd183acd092a 100644
--- a/drivers/usb/gadget/function/f_fs.c
+++ b/drivers/usb/gadget/function/f_fs.c
@@ -645,11 +645,19 @@ static int ffs_ep0_open(struct inode *inode, struct file *file)
 	ffs_log("state %d setup_state %d flags %lu opened %d", ffs->state,
 		ffs->setup_state, ffs->flags, atomic_read(&ffs->opened));
 
-	if (unlikely(ffs->state == FFS_CLOSING))
+	if (atomic_read(&ffs->opened)) {
+		pr_err("ep0 is already opened!\n");
 		return -EBUSY;
+	}
+
+	if (unlikely(ffs->state == FFS_CLOSING)) {
+		pr_err("FFS_CLOSING!\n");
+		return -EBUSY;
+	}
 
 	file->private_data = ffs;
 	ffs_data_opened(ffs);
+	pr_info("ep0_open success!\n");
 
 	return 0;
 }
diff --git a/drivers/usb/gadget/function/f_mass_storage.c b/drivers/usb/gadget/function/f_mass_storage.c
index 5b2659a5c7eb28624744b30dfcf15587087e7d6b..9834a98f8a677f1f3447a2562ce09d5237cb1b54 100644
--- a/drivers/usb/gadget/function/f_mass_storage.c
+++ b/drivers/usb/gadget/function/f_mass_storage.c
@@ -228,6 +228,7 @@
 
 /*------------------------------------------------------------------------*/
 
+#define PAGE_CACHE_SIZE PAGE_SIZE
 #define FSG_DRIVER_DESC		"Mass Storage Function"
 #define FSG_DRIVER_VERSION	"2009/09/11"
 
@@ -1176,6 +1177,249 @@ static int do_read_header(struct fsg_common *common, struct fsg_buffhd *bh)
 	return 8;
 }
 
+static void _lba_to_msf(u8 *buf, int lba)
+{
+	lba += 150;
+	buf[0] = (lba / 75) / 60;
+	buf[1] = (lba / 75) % 60;
+	buf[2] = lba % 75;
+}
+
+static int _read_toc_raw(struct fsg_common *common,
+		struct fsg_buffhd *bh)
+{
+	struct fsg_lun *curlun = common->curlun;
+	u8 *buf = (u8 *) bh->buf;
+	u8 *q;
+	int len;
+	int msf = common->cmnd[1] & 0x02;
+
+	q = buf + 2;
+	*q++ = 1; /* first session */
+	*q++ = 1; /* last session */
+
+	*q++ = 1; /* session number */
+	*q++ = 0x14; /* data track */
+	*q++ = 0; /* track number */
+	*q++ = 0xa0; /* lead-in */
+	*q++ = 0; /* min */
+	*q++ = 0; /* sec */
+	*q++ = 0; /* frame */
+	*q++ = 0;
+	*q++ = 1; /* first track */
+	*q++ = 0x00; /* disk type */
+	*q++ = 0x00;
+
+	*q++ = 1; /* session number */
+	*q++ = 0x14; /* data track */
+	*q++ = 0; /* track number */
+	*q++ = 0xa1;
+	*q++ = 0; /* min */
+	*q++ = 0; /* sec */
+	*q++ = 0; /* frame */
+	*q++ = 0;
+	*q++ = 1; /* last track */
+	*q++ = 0x00;
+	*q++ = 0x00;
+
+	*q++ = 1; /* session number */
+	*q++ = 0x14; /* data track */
+	*q++ = 0; /* track number */
+	*q++ = 0xa2; /* lead-out */
+	*q++ = 0; /* min */
+	*q++ = 0; /* sec */
+	*q++ = 0; /* frame */
+
+	if (msf) {
+		*q++ = 0; /* reserved */
+		_lba_to_msf(q, curlun->num_sectors);
+		q += 3;
+	} else {
+		put_unaligned_be32(curlun->num_sectors, q);
+		q += 4;
+	}
+
+	*q++ = 1; /* session number */
+	*q++ = 0x14; /* ADR, control */
+	*q++ = 0;    /* track number */
+	*q++ = 1;    /* point */
+	*q++ = 0; /* min */
+	*q++ = 0; /* sec */
+	*q++ = 0; /* frame */
+
+	if (msf) {
+		*q++ = 0;
+		_lba_to_msf(q, 0);
+		q += 3;
+	} else {
+		*q++ = 0;
+		*q++ = 0;
+		*q++ = 0;
+		*q++ = 0;
+	}
+
+	len = q - buf;
+	put_unaligned_be16(len - 2, buf);
+
+	return len;
+}
+
+static void cd_data_to_raw(u8 *buf, int lba)
+{
+	/* sync bytes */
+	buf[0] = 0x00;
+	memset(buf + 1, 0xff, 10);
+	buf[11] = 0x00;
+	buf += 12;
+
+	/* MSF */
+	_lba_to_msf(buf, lba);
+	buf[3] = 0x01; /* mode 1 data */
+	buf += 4;
+
+	/* data */
+	buf += 2048;
+
+	/* XXX: ECC not computed */
+	memset(buf, 0, 288);
+}
+
+static int do_read_cd(struct fsg_common *common)
+{
+	struct fsg_lun *curlun = common->curlun;
+	struct fsg_buffhd *bh;
+	int rc;
+	u32 lba;
+	u32 amount_left;
+	u32 nb_sectors, transfer_request;
+	loff_t file_offset, file_offset_tmp;
+	unsigned int amount;
+	unsigned int partial_page;
+	ssize_t nread;
+
+	nb_sectors = (common->cmnd[6] << 16) |
+			(common->cmnd[7] << 8) | common->cmnd[8];
+	lba = get_unaligned_be32(&common->cmnd[2]);
+
+	if (nb_sectors == 0)
+		return 0;
+
+	if (lba >= curlun->num_sectors) {
+		curlun->sense_data =
+			SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE;
+		return -EINVAL;
+	}
+
+	transfer_request = common->cmnd[9];
+	if ((transfer_request & 0xf8) == 0xf8) {
+		file_offset = ((loff_t) lba) << 11;
+		/* read all data  - 2352 byte */
+		amount_left = 2352;
+	} else {
+		file_offset = ((loff_t) lba) << 9;
+		/* Carry out the file reads */
+		amount_left = common->data_size_from_cmnd;
+	}
+
+	if (unlikely(amount_left == 0))
+		return -EIO; /* No default reply */
+
+	for (;;) {
+		/*
+		 * Figure out how much we need to read:
+		 * Try to read the remaining amount.
+		 * But don't read more than the buffer size.
+		 * And don't try to read past the end of the file.
+		 * Finally, if we're not at a page boundary, don't read past
+		 *	the next page.
+		 * If this means reading 0 then we were asked to read past
+		 * the end of file.
+		 */
+		amount = min(amount_left, FSG_BUFLEN);
+		amount = min((loff_t) amount,
+				curlun->file_length - file_offset);
+		partial_page = file_offset & (PAGE_CACHE_SIZE - 1);
+		if (partial_page > 0)
+			amount = min(amount, (unsigned int) PAGE_CACHE_SIZE -
+					partial_page);
+
+		/* Wait for the next buffer to become available */
+		bh = common->next_buffhd_to_fill;
+		while (bh->state != BUF_STATE_EMPTY) {
+			rc = sleep_thread(common, true, bh);
+			if (rc)
+				return rc;
+		}
+
+		/*
+		 * If we were asked to read past the end of file,
+		 * end with an empty buffer.
+		 */
+		if (amount == 0) {
+			curlun->sense_data =
+				SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE;
+			curlun->sense_data_info = file_offset >> 9;
+			curlun->info_valid = 1;
+			bh->inreq->length = 0;
+			bh->state = BUF_STATE_FULL;
+			break;
+		}
+
+		/* Perform the read */
+		file_offset_tmp = file_offset;
+		if ((transfer_request & 0xf8) == 0xf8) {
+			nread = vfs_read(curlun->filp,
+					((char __user *)bh->buf)+16,
+						amount, &file_offset_tmp);
+		} else {
+			nread = vfs_read(curlun->filp,
+					(char __user *)bh->buf,
+					amount, &file_offset_tmp);
+		}
+		VLDBG(curlun, "file read %u @ %llu -> %d\n", amount,
+				(unsigned long long) file_offset,
+				(int) nread);
+		if (signal_pending(current))
+			return -EINTR;
+
+		if (nread < 0) {
+			LDBG(curlun, "error in file read: %d\n",
+					(int) nread);
+			nread = 0;
+		} else if (nread < amount) {
+			LDBG(curlun, "partial file read: %d/%u\n",
+					(int) nread, amount);
+			nread -= (nread & 511);	/* Round down to a block */
+		}
+		file_offset  += nread;
+		amount_left  -= nread;
+		common->residue -= nread;
+		bh->inreq->length = nread;
+		bh->state = BUF_STATE_FULL;
+
+		/* If an error occurred, report it and its position */
+		if (nread < amount) {
+			curlun->sense_data = SS_UNRECOVERED_READ_ERROR;
+			curlun->sense_data_info = file_offset >> 9;
+			curlun->info_valid = 1;
+			break;
+		}
+
+		if (amount_left == 0)
+			break; /* No more left to read */
+
+		/* Send this buffer and go read some more */
+		if (!start_in_transfer(common, bh))
+			return -EIO;
+		common->next_buffhd_to_fill = bh->next;
+	}
+
+	if ((transfer_request & 0xf8) == 0xf8)
+		cd_data_to_raw(bh->buf, lba);
+
+	return -EIO; /* No default reply */
+}
+
 static int do_read_toc(struct fsg_common *common, struct fsg_buffhd *bh)
 {
 	struct fsg_lun	*curlun = common->curlun;
@@ -1183,12 +1427,19 @@ static int do_read_toc(struct fsg_common *common, struct fsg_buffhd *bh)
 	int		start_track = common->cmnd[6];
 	u8		*buf = (u8 *)bh->buf;
 
+/* Anderson@, 2016/09/21, CD-ROM and VID customized */
+	int format = (common->cmnd[9] & 0xC0) >> 6;
+
 	if ((common->cmnd[1] & ~0x02) != 0 ||	/* Mask away MSF */
 			start_track > 1) {
 		curlun->sense_data = SS_INVALID_FIELD_IN_CDB;
 		return -EINVAL;
 	}
 
+/* Anderson@, 2016/09/21, CD-ROM and VID customized */
+	if (format == 2)
+		return _read_toc_raw(common, bh);
+
 	memset(buf, 0, 20);
 	buf[1] = (20-2);		/* TOC data length */
 	buf[2] = 1;			/* First track number */
@@ -1926,12 +2177,23 @@ static int do_scsi_command(struct fsg_common *common)
 			goto unknown_cmnd;
 		common->data_size_from_cmnd =
 			get_unaligned_be16(&common->cmnd[7]);
+
 		reply = check_command(common, 10, DATA_DIR_TO_HOST,
-				      (7<<6) | (1<<1), 1,
+				      (0xf<<6) | (1<<1), 1,
 				      "READ TOC");
 		if (reply == 0)
 			reply = do_read_toc(common, bh);
 		break;
+	case READ_CD:
+		common->data_size_from_cmnd = ((common->cmnd[6] << 16)
+						| (common->cmnd[7] << 8)
+						| (common->cmnd[8])) << 9;
+		reply = check_command(common, 12, DATA_DIR_TO_HOST,
+					(0xf<<2) | (7<<7), 1,
+					"READ CD");
+		if (reply == 0)
+			reply = do_read_cd(common);
+		break;
 
 	case READ_FORMAT_CAPACITIES:
 		common->data_size_from_cmnd =
@@ -2214,18 +2476,6 @@ static int do_set_interface(struct fsg_common *common, struct fsg_dev *new_fsg)
 			}
 		}
 
-		/* Disable the endpoints */
-		if (fsg->bulk_in_enabled) {
-			usb_ep_disable(fsg->bulk_in);
-			fsg->bulk_in_enabled = 0;
-		}
-		if (fsg->bulk_out_enabled) {
-			usb_ep_disable(fsg->bulk_out);
-			fsg->bulk_out_enabled = 0;
-		}
-
-		/* allow usb LPM after eps are disabled */
-		usb_gadget_autopm_put_async(common->gadget);
 		common->fsg = NULL;
 		wake_up(&common->fsg_wait);
 	}
@@ -2237,28 +2487,6 @@ static int do_set_interface(struct fsg_common *common, struct fsg_dev *new_fsg)
 	common->fsg = new_fsg;
 	fsg = common->fsg;
 
-	/* Enable the endpoints */
-	rc = config_ep_by_speed(common->gadget, &(fsg->function), fsg->bulk_in);
-	if (rc)
-		goto reset;
-	rc = usb_ep_enable(fsg->bulk_in);
-	if (rc)
-		goto reset;
-	fsg->bulk_in->driver_data = common;
-	fsg->bulk_in_enabled = 1;
-
-	rc = config_ep_by_speed(common->gadget, &(fsg->function),
-				fsg->bulk_out);
-	if (rc)
-		goto reset;
-	rc = usb_ep_enable(fsg->bulk_out);
-	if (rc)
-		goto reset;
-	fsg->bulk_out->driver_data = common;
-	fsg->bulk_out_enabled = 1;
-	common->bulk_out_maxpacket = usb_endpoint_maxp(fsg->bulk_out->desc);
-	clear_bit(IGNORE_BULK_OUT, &fsg->atomic_bitflags);
-
 	/* Allocate the requests */
 	for (i = 0; i < common->fsg_num_buffers; ++i) {
 		struct fsg_buffhd	*bh = &common->buffhds[i];
@@ -2289,20 +2517,71 @@ static int do_set_interface(struct fsg_common *common, struct fsg_dev *new_fsg)
 static int fsg_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
 {
 	struct fsg_dev *fsg = fsg_from_func(f);
-	fsg->common->new_fsg = fsg;
+	int rc;
 
+	fsg->common->new_fsg = fsg;
 	/* prevents usb LPM until thread runs to completion */
 	usb_gadget_autopm_get_async(fsg->common->gadget);
 
+	/* Enable the endpoints */
+
+
+	rc = config_ep_by_speed(fsg->common->gadget, &(fsg->function),
+				fsg->bulk_in);
+
+	if (rc)
+		goto err_exit;
+	rc = usb_ep_enable(fsg->bulk_in);
+	if (rc)
+		goto err_exit;
+	fsg->bulk_in->driver_data = fsg->common;
+	fsg->bulk_in_enabled = 1;
+
+	rc = config_ep_by_speed(fsg->common->gadget, &(fsg->function),
+	fsg->bulk_out);
+	if (rc)
+		goto reset_bulk_int;
+	rc = usb_ep_enable(fsg->bulk_out);
+	if (rc)
+		goto reset_bulk_int;
+	fsg->bulk_out->driver_data = fsg->common;
+	fsg->bulk_out_enabled = 1;
+	fsg->common->bulk_out_maxpacket =
+	usb_endpoint_maxp(fsg->bulk_out->desc);
+	clear_bit(IGNORE_BULK_OUT, &fsg->atomic_bitflags);
+
 	raise_exception(fsg->common, FSG_STATE_CONFIG_CHANGE);
 	return USB_GADGET_DELAYED_STATUS;
+
+reset_bulk_int:
+		usb_ep_disable(fsg->bulk_in);
+		fsg->bulk_in->driver_data = NULL;
+		fsg->bulk_in_enabled = 0;
+err_exit:
+		return rc;
 }
 
 static void fsg_disable(struct usb_function *f)
 {
 	struct fsg_dev *fsg = fsg_from_func(f);
+
+	/* Disable the endpoints */
+	if (fsg->bulk_in_enabled) {
+		usb_ep_disable(fsg->bulk_in);
+		fsg->bulk_in->driver_data = NULL;
+		fsg->bulk_in_enabled = 0;
+	}
+
+	if (fsg->bulk_out_enabled) {
+		usb_ep_disable(fsg->bulk_out);
+		fsg->bulk_out->driver_data = NULL;
+		fsg->bulk_out_enabled = 0;
+	}
+
 	fsg->common->new_fsg = NULL;
 	raise_exception(fsg->common, FSG_STATE_CONFIG_CHANGE);
+	/* allow usb LPM after eps are disabled */
+	usb_gadget_autopm_put_async(fsg->common->gadget);
 }
 
 
@@ -2874,6 +3153,9 @@ void fsg_common_set_inquiry_string(struct fsg_common *common, const char *vn,
 		     ? "File-CD Gadget"
 		     : "File-Stor Gadget"),
 		 i);
+	snprintf(common->inquiry_string,
+		sizeof(common->inquiry_string),
+		"%s",  "OnePlus Device Driver");
 }
 EXPORT_SYMBOL_GPL(fsg_common_set_inquiry_string);
 
@@ -3382,6 +3664,8 @@ static struct usb_function_instance *fsg_alloc_inst(void)
 
 	memset(&config, 0, sizeof(config));
 	config.removable = true;
+	config.cdrom = true;
+	config.ro = true;
 	rc = fsg_common_create_lun(opts->common, &config, 0, "lun.0",
 			(const char **)&opts->func_inst.group.cg_item.ci_name);
 	if (rc)
diff --git a/drivers/usb/gadget/function/f_mtp.c b/drivers/usb/gadget/function/f_mtp.c
index 8e1f9455ed7725a15afe29b253fdc00cd00747be..9bf3efd667d9d42aed8662c29736cc06b4ca37bd 100644
--- a/drivers/usb/gadget/function/f_mtp.c
+++ b/drivers/usb/gadget/function/f_mtp.c
@@ -39,9 +39,12 @@
 #include <linux/usb/f_mtp.h>
 #include <linux/configfs.h>
 #include <linux/usb/composite.h>
+#include <linux/pm_qos.h>
 
 #include "configfs.h"
 
+static bool mtp_receive_flag;
+
 #define MTP_RX_BUFFER_INIT_SIZE    1048576
 #define MTP_TX_BUFFER_INIT_SIZE    1048576
 #define MTP_BULK_BUFFER_SIZE       16384
@@ -49,6 +52,18 @@
 #define MAX_INST_NAME_LEN          40
 #define MTP_MAX_FILE_SIZE          0xFFFFFFFFL
 
+#define MTP_TX_BUFFER_BASE         0xAC300000
+#define MTP_RX_BUFFER_BASE         0xACB00000
+#define MTP_INTR_BUFFER_BASE       0xACD00000
+
+static int mtpBufferOffset;
+static bool useFixAddr;
+enum buf_type {
+	TX_BUFFER = 0,
+	RX_BUFFER,
+	INTR_BUFFER,
+};
+
 /* String IDs */
 #define INTERFACE_STRING_INDEX	0
 
@@ -79,7 +94,11 @@
 #define DRIVER_NAME "mtp"
 
 #define MAX_ITERATION		100
+/* values for qos requests */
+#define FILE_LENGTH	(10 * 1024 * 1024)
+#define PM_QOS_TIMEOUT	3000000
 
+static bool mtp_receive_flag;
 unsigned int mtp_rx_req_len = MTP_RX_BUFFER_INIT_SIZE;
 module_param(mtp_rx_req_len, uint, 0644);
 
@@ -90,6 +109,12 @@ unsigned int mtp_tx_reqs = MTP_TX_REQ_MAX;
 module_param(mtp_tx_reqs, uint, 0644);
 
 static const char mtp_shortname[] = DRIVER_NAME "_usb";
+static struct pm_qos_request little_cpu_mtp_freq;
+static struct pm_qos_request devfreq_mtp_request;
+static struct pm_qos_request big_cpu_mtp_freq;
+static struct pm_qos_request big_plus_cpu_mtp_freq;
+static struct delayed_work cpu_freq_qos_work;
+static struct workqueue_struct *cpu_freq_qos_queue;
 
 struct mtp_dev {
 	struct usb_function function;
@@ -384,7 +409,9 @@ static inline struct mtp_dev *func_to_mtp(struct usb_function *f)
 	return container_of(f, struct mtp_dev, function);
 }
 
-static struct usb_request *mtp_request_new(struct usb_ep *ep, int buffer_size)
+static struct usb_request *mtp_request_new(struct usb_ep *ep,
+		int buffer_size, enum buf_type type)
+
 {
 	struct usb_request *req = usb_ep_alloc_request(ep, GFP_KERNEL);
 
@@ -392,19 +419,42 @@ static struct usb_request *mtp_request_new(struct usb_ep *ep, int buffer_size)
 		return NULL;
 
 	/* now allocate buffers for the requests */
-	req->buf = kmalloc(buffer_size, GFP_KERNEL);
+	if (useFixAddr) {
+		if (type == TX_BUFFER)
+			req->buf = __va(MTP_TX_BUFFER_BASE + mtpBufferOffset);
+		else if (type == RX_BUFFER)
+			req->buf = __va(MTP_RX_BUFFER_BASE + mtpBufferOffset);
+		else
+			req->buf = __va(MTP_INTR_BUFFER_BASE + mtpBufferOffset);
+	} else
+		req->buf = kmalloc(buffer_size, GFP_KERNEL);
+	memset(req->buf, 0, buffer_size);
 	if (!req->buf) {
 		usb_ep_free_request(ep, req);
 		return NULL;
 	}
 
+	if (useFixAddr) {
+		if (buffer_size == INTR_BUFFER_SIZE)
+			mtpBufferOffset += 0x40; /* alignment */
+		else
+			mtpBufferOffset += buffer_size;
+	}
+
 	return req;
 }
 
 static void mtp_request_free(struct usb_request *req, struct usb_ep *ep)
 {
 	if (req) {
-		kfree(req->buf);
+		/*OP fix device crash when setting MTP as usb mode
+		 *use fixed memory
+		 */
+		if (useFixAddr) {
+			req->buf = NULL;
+			mtpBufferOffset = 0;
+		} else
+			kfree(req->buf);
 		usb_ep_free_request(ep, req);
 	}
 }
@@ -528,9 +578,23 @@ static int mtp_create_bulk_endpoints(struct mtp_dev *dev,
 	dev->ep_intr = ep;
 
 retry_tx_alloc:
+	/*OP fix device crash when setting MTP as usb mode use fixed memory */
+	if (mtp_tx_req_len == MTP_TX_BUFFER_INIT_SIZE
+		&& mtp_rx_req_len == MTP_RX_BUFFER_INIT_SIZE
+		&& mtp_tx_reqs == MTP_TX_REQ_MAX)
+		useFixAddr = true;
+	else
+		useFixAddr = false;
+	pr_info("useFixAddr:%s\n", useFixAddr ? "true" : "false");
+	mtpBufferOffset = 0;
+
 	/* now allocate requests for our endpoints */
 	for (i = 0; i < mtp_tx_reqs; i++) {
-		req = mtp_request_new(dev->ep_in, mtp_tx_req_len);
+		/*OP fix device crash when setting MTP as usb mode
+		 *use fixed memory
+		 */
+		req = mtp_request_new(dev->ep_in,
+				mtp_tx_req_len, TX_BUFFER);
 		if (!req) {
 			if (mtp_tx_req_len <= MTP_BULK_BUFFER_SIZE)
 				goto fail;
@@ -554,8 +618,11 @@ static int mtp_create_bulk_endpoints(struct mtp_dev *dev,
 		mtp_rx_req_len = MTP_BULK_BUFFER_SIZE;
 
 retry_rx_alloc:
+	/*OP fix device crash when setting MTP as usb mode use fixed memory */
+	mtpBufferOffset = 0;
 	for (i = 0; i < RX_REQ_MAX; i++) {
-		req = mtp_request_new(dev->ep_out, mtp_rx_req_len);
+		req = mtp_request_new(dev->ep_out,
+				mtp_rx_req_len, RX_BUFFER);
 		if (!req) {
 			if (mtp_rx_req_len <= MTP_BULK_BUFFER_SIZE)
 				goto fail;
@@ -567,13 +634,17 @@ static int mtp_create_bulk_endpoints(struct mtp_dev *dev,
 		req->complete = mtp_complete_out;
 		dev->rx_req[i] = req;
 	}
+	/*OP fix device crash when setting MTP as usb mode use fixed memory */
+	mtpBufferOffset = 0;
 	for (i = 0; i < INTR_REQ_MAX; i++) {
-		req = mtp_request_new(dev->ep_intr, INTR_BUFFER_SIZE);
+		req = mtp_request_new(dev->ep_intr,
+			INTR_BUFFER_SIZE, INTR_BUFFER);
 		if (!req)
 			goto fail;
 		req->complete = mtp_complete_intr;
 		mtp_req_put(dev, &dev->intr_idle, req);
 	}
+	mtpBufferOffset = 0;
 
 	return 0;
 
@@ -807,6 +878,22 @@ static void send_file_work(struct work_struct *data)
 
 	DBG(cdev, "send_file_work(%lld %lld)\n", offset, count);
 
+	if (dev->xfer_file_length >= FILE_LENGTH) {
+		pm_qos_update_request(&devfreq_mtp_request, MAX_CPUFREQ - 1);
+		pm_qos_update_request(&little_cpu_mtp_freq, MAX_CPUFREQ);
+		pm_qos_update_request(&big_cpu_mtp_freq, MAX_CPUFREQ);
+		pm_qos_update_request(&big_plus_cpu_mtp_freq, MAX_CPUFREQ);
+	} else {
+		pm_qos_update_request_timeout(&devfreq_mtp_request,
+		MAX_CPUFREQ - 1, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&little_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&big_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&big_plus_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+	}
+
 	if (dev->xfer_send_header) {
 		hdr_size = sizeof(struct mtp_data_header);
 		count += hdr_size;
@@ -895,6 +982,12 @@ static void send_file_work(struct work_struct *data)
 	if (req)
 		mtp_req_put(dev, &dev->tx_idle, req);
 
+	if (dev->xfer_file_length >= FILE_LENGTH) {
+		pm_qos_update_request(&devfreq_mtp_request, MIN_CPUFREQ);
+		pm_qos_update_request(&little_cpu_mtp_freq, MIN_CPUFREQ);
+		pm_qos_update_request(&big_cpu_mtp_freq, MIN_CPUFREQ);
+		pm_qos_update_request(&big_plus_cpu_mtp_freq, MIN_CPUFREQ);
+	}
 	DBG(cdev, "%s returning %d state:%d\n", __func__, r, dev->state);
 	/* write the result */
 	dev->xfer_result = r;
@@ -926,6 +1019,13 @@ static void receive_file_work(struct work_struct *data)
 		DBG(cdev, "%s- count(%lld) not multiple of mtu(%d)\n", __func__,
 						count, dev->ep_out->maxpacket);
 
+	if (delayed_work_pending(&cpu_freq_qos_work))
+		cancel_delayed_work(&cpu_freq_qos_work);
+
+	pm_qos_update_request(&devfreq_mtp_request, MAX_CPUFREQ - 1);
+	pm_qos_update_request(&little_cpu_mtp_freq, MAX_CPUFREQ);
+	pm_qos_update_request(&big_cpu_mtp_freq, MAX_CPUFREQ);
+	pm_qos_update_request(&big_plus_cpu_mtp_freq, MAX_CPUFREQ);
 	while (count > 0 || write_req) {
 		if (count > 0) {
 			/* queue a request */
@@ -1007,11 +1107,20 @@ static void receive_file_work(struct work_struct *data)
 		}
 	}
 
+	queue_delayed_work(cpu_freq_qos_queue, &cpu_freq_qos_work,
+		msecs_to_jiffies(1000)*3);
 	DBG(cdev, "receive_file_work returning %d\n", r);
 	/* write the result */
 	dev->xfer_result = r;
 	smp_wmb();
 }
+static void update_qos_request(struct work_struct *data)
+{
+	pm_qos_update_request(&devfreq_mtp_request, MIN_CPUFREQ);
+	pm_qos_update_request(&little_cpu_mtp_freq, MIN_CPUFREQ);
+	pm_qos_update_request(&big_cpu_mtp_freq, MIN_CPUFREQ);
+	pm_qos_update_request(&big_plus_cpu_mtp_freq, MIN_CPUFREQ);
+}
 
 static int mtp_send_event(struct mtp_dev *dev, struct mtp_event *event)
 {
@@ -1097,6 +1206,12 @@ static long mtp_send_receive_ioctl(struct file *fp, unsigned int code,
 		dev->xfer_send_header = 0;
 	} else {
 		work = &dev->receive_file_work;
+		pm_qos_update_request(&devfreq_mtp_request, MAX_CPUFREQ - 1);
+		pm_qos_update_request(&little_cpu_mtp_freq, MAX_CPUFREQ);
+		pm_qos_update_request(&big_cpu_mtp_freq, MAX_CPUFREQ);
+		pm_qos_update_request(&big_plus_cpu_mtp_freq, MAX_CPUFREQ);
+		msm_cpuidle_set_sleep_disable(true);
+		mtp_receive_flag = true;
 	}
 
 	/* We do the file transfer on a work queue so it will run
@@ -1106,6 +1221,18 @@ static long mtp_send_receive_ioctl(struct file *fp, unsigned int code,
 	queue_work(dev->wq, work);
 	/* wait for operation to complete */
 	flush_workqueue(dev->wq);
+	if (mtp_receive_flag) {
+		mtp_receive_flag = false;
+		pm_qos_update_request_timeout(&devfreq_mtp_request,
+		MAX_CPUFREQ - 1, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&little_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&big_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+		pm_qos_update_request_timeout(&big_plus_cpu_mtp_freq,
+		MAX_CPUFREQ, PM_QOS_TIMEOUT);
+		msm_cpuidle_set_sleep_disable(false);
+	}
 	fput(filp);
 
 	/* read the result */
@@ -1252,6 +1379,10 @@ static int mtp_release(struct inode *ip, struct file *fp)
 {
 	printk(KERN_INFO "mtp_release\n");
 
+	if (mtp_receive_flag) {
+		mtp_receive_flag = false;
+		msm_cpuidle_set_sleep_disable(false);
+	}
 	mtp_unlock(&_mtp_dev->open_excl);
 	return 0;
 }
@@ -1678,6 +1809,16 @@ static int __mtp_setup(struct mtp_instance *fi_mtp)
 	INIT_WORK(&dev->send_file_work, send_file_work);
 	INIT_WORK(&dev->receive_file_work, receive_file_work);
 
+	cpu_freq_qos_queue = create_singlethread_workqueue("f_mtp_qos");
+	INIT_DELAYED_WORK(&cpu_freq_qos_work, update_qos_request);
+	pm_qos_add_request(&little_cpu_mtp_freq, PM_QOS_C0_CPUFREQ_MIN,
+				MIN_CPUFREQ);
+	pm_qos_add_request(&devfreq_mtp_request, PM_QOS_DEVFREQ_MIN,
+				MIN_CPUFREQ);
+	pm_qos_add_request(&big_cpu_mtp_freq, PM_QOS_C1_CPUFREQ_MIN,
+				MIN_CPUFREQ);
+	pm_qos_add_request(&big_plus_cpu_mtp_freq, PM_QOS_C2_CPUFREQ_MIN,
+				MIN_CPUFREQ);
 	_mtp_dev = dev;
 
 	ret = misc_register(&mtp_device);
@@ -1688,6 +1829,11 @@ static int __mtp_setup(struct mtp_instance *fi_mtp)
 	return 0;
 
 err2:
+	pm_qos_remove_request(&big_plus_cpu_mtp_freq);
+	pm_qos_remove_request(&big_cpu_mtp_freq);
+	pm_qos_remove_request(&little_cpu_mtp_freq);
+	pm_qos_remove_request(&devfreq_mtp_request);
+	destroy_workqueue(cpu_freq_qos_queue);
 	destroy_workqueue(dev->wq);
 err1:
 	_mtp_dev = NULL;
@@ -1710,6 +1856,11 @@ static void mtp_cleanup(void)
 		return;
 
 	mtp_debugfs_remove();
+	pm_qos_remove_request(&big_plus_cpu_mtp_freq);
+	pm_qos_remove_request(&big_cpu_mtp_freq);
+	pm_qos_remove_request(&little_cpu_mtp_freq);
+	pm_qos_remove_request(&devfreq_mtp_request);
+	destroy_workqueue(cpu_freq_qos_queue);
 	misc_deregister(&mtp_device);
 	destroy_workqueue(dev->wq);
 	_mtp_dev = NULL;
@@ -1825,6 +1976,10 @@ static int mtp_ctrlreq_configfs(struct usb_function *f,
 static void mtp_free(struct usb_function *f)
 {
 	/*NO-OP: no function specific resource allocation in mtp_alloc*/
+	struct mtp_instance *fi_mtp;
+
+	fi_mtp = container_of(f->fi, struct mtp_instance, func_inst);
+	fi_mtp->func_inst.f = NULL;
 }
 
 struct usb_function *function_alloc_mtp_ptp(struct usb_function_instance *fi,
diff --git a/drivers/usb/gadget/udc/core.c b/drivers/usb/gadget/udc/core.c
index 4a0b075af8b09369800540376bf4050f12f3cb49..33fbbe78d764adb905139f9ff9f5008cd1008431 100644
--- a/drivers/usb/gadget/udc/core.c
+++ b/drivers/usb/gadget/udc/core.c
@@ -626,6 +626,7 @@ int usb_gadget_vbus_draw(struct usb_gadget *gadget, unsigned mA)
 		goto out;
 	}
 
+	pr_info("%s USB setting current is %umA\n", __func__, mA);
 	ret = gadget->ops->vbus_draw(gadget, mA);
 	if (!ret)
 		gadget->mA = mA;
diff --git a/drivers/usb/host/xhci-hub.c b/drivers/usb/host/xhci-hub.c
index 60215e04689e6fccdcb1b41767499c4bd2e06147..624d5aef9a0830e1d4efd93c381254e8d2cc3853 100644
--- a/drivers/usb/host/xhci-hub.c
+++ b/drivers/usb/host/xhci-hub.c
@@ -1288,6 +1288,7 @@ int xhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
 				/* Resume the port to U0 first */
 				xhci_set_link_state(xhci, port_array, wIndex,
 							XDEV_U0);
+				usb_phy_powerdown(hcd->usb3_phy);
 				spin_unlock_irqrestore(&xhci->lock, flags);
 				msleep(10);
 				spin_lock_irqsave(&xhci->lock, flags);
diff --git a/drivers/usb/host/xhci-mem.c b/drivers/usb/host/xhci-mem.c
index 21ad75751f5d997a64e4abc553629ffd3f35fd8b..0bc883176c2fb09614c00a89218343d43c870dd8 100644
--- a/drivers/usb/host/xhci-mem.c
+++ b/drivers/usb/host/xhci-mem.c
@@ -28,6 +28,11 @@
 
 #include "xhci.h"
 #include "xhci-trace.h"
+#include <linux/moduleparam.h>
+
+static bool usb2_lpm_disable = 1;
+module_param(usb2_lpm_disable, bool, 0644);
+MODULE_PARM_DESC(usb2_lpm_disable, "DISABLE USB2 LPM");
 
 /*
  * Allocates a generic ring segment from the ring pool, sets the dma address,
@@ -2247,7 +2252,7 @@ static void xhci_add_in_port(struct xhci_hcd *xhci, unsigned int num_ports,
 		xhci_dbg_trace(xhci, trace_xhci_dbg_init,
 				"xHCI 1.0: support USB2 software lpm");
 		xhci->sw_lpm_support = 1;
-		if (temp & XHCI_HLC) {
+		if (!usb2_lpm_disable && (temp & XHCI_HLC)) {
 			xhci_dbg_trace(xhci, trace_xhci_dbg_init,
 					"xHCI 1.0: support USB2 hardware lpm");
 			xhci->hw_lpm_support = 1;
diff --git a/drivers/usb/host/xhci-plat.c b/drivers/usb/host/xhci-plat.c
index 153d6eba1524aabfb26158bfca252a0ddf5c24f6..6e417bfbfc5fa2c01bdca6979710ef673e7d1aee 100644
--- a/drivers/usb/host/xhci-plat.c
+++ b/drivers/usb/host/xhci-plat.c
@@ -347,7 +347,8 @@ static int xhci_plat_probe(struct platform_device *pdev)
 	if (device_property_read_u32(&pdev->dev, "usb-core-id", &xhci->core_id))
 		xhci->core_id = -EINVAL;
 
-	hcd->usb_phy = devm_usb_get_phy_by_phandle(sysdev, "usb-phy", 0);
+	hcd->usb_phy = devm_usb_get_phy_by_phandle(pdev->dev.parent, "usb-phy",
+					0);
 	if (IS_ERR(hcd->usb_phy)) {
 		ret = PTR_ERR(hcd->usb_phy);
 		if (ret == -EPROBE_DEFER)
diff --git a/drivers/usb/host/xhci-ring.c b/drivers/usb/host/xhci-ring.c
index 5d76b81bdcbe01e1e01d8ad5eff7b3e183fdcd4d..6082d6227379a08d956cff68e11606fae5b0777b 100644
--- a/drivers/usb/host/xhci-ring.c
+++ b/drivers/usb/host/xhci-ring.c
@@ -2744,6 +2744,9 @@ irqreturn_t xhci_irq(struct usb_hcd *hcd)
 		goto out;
 	}
 
+	if (status & STS_HCE)
+		xhci_warn(xhci, "WARNING: Host controller Error\n");
+
 	if (!(status & STS_EINT))
 		goto out;
 
diff --git a/drivers/usb/host/xhci.c b/drivers/usb/host/xhci.c
index ad87c69869c9dc55059a1f3ad1796212f70c2512..0df6f977b027f00a85a10687e2b59486c2d93ac8 100644
--- a/drivers/usb/host/xhci.c
+++ b/drivers/usb/host/xhci.c
@@ -129,7 +129,9 @@ int xhci_halt(struct xhci_hcd *xhci)
 	ret = xhci_handshake(&xhci->op_regs->status,
 			STS_HALT, STS_HALT, XHCI_MAX_HALT_USEC);
 	if (ret) {
-		xhci_warn(xhci, "Host halt failed, %d\n", ret);
+		xhci_warn(xhci,
+			"Host not halted after %u ms. ret=%d\n",
+			XHCI_MAX_HALT_USEC, ret);
 		return ret;
 	}
 	xhci->xhc_state |= XHCI_STATE_HALTED;
@@ -966,6 +968,19 @@ int xhci_suspend(struct xhci_hcd *xhci, bool do_wakeup)
 		spin_unlock_irq(&xhci->lock);
 		return -ETIMEDOUT;
 	}
+	if ((readl_relaxed(&xhci->op_regs->status) & STS_EINT) ||
+			(readl_relaxed(&xhci->op_regs->status) & STS_PORT)) {
+		xhci_warn(xhci, "WARN: xHC EINT/PCD set status:%x\n",
+			readl_relaxed(&xhci->op_regs->status));
+		set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
+		set_bit(HCD_FLAG_HW_ACCESSIBLE, &xhci->shared_hcd->flags);
+		/* step 4: set Run/Stop bit */
+		command = readl_relaxed(&xhci->op_regs->command);
+		command |= CMD_RUN;
+		writel_relaxed(command, &xhci->op_regs->command);
+		spin_unlock_irq(&xhci->lock);
+		return -EBUSY;
+	}
 	xhci_clear_command_ring(xhci);
 
 	/* step 3: save registers */
diff --git a/drivers/usb/pd/policy_engine.c b/drivers/usb/pd/policy_engine.c
index 6bf1e8295024df3e6399113f8cbc264e1952a87f..7f11075ec3a8dc76006570d8590ecc6c6f856bcc 100644
--- a/drivers/usb/pd/policy_engine.c
+++ b/drivers/usb/pd/policy_engine.c
@@ -29,6 +29,11 @@
 #include <linux/usb/usbpd.h>
 #include "usbpd.h"
 
+/* To start USB stack for USB3.1 compliance testing */
+static bool usb_compliance_mode;
+module_param(usb_compliance_mode, bool, 0644);
+MODULE_PARM_DESC(usb_compliance_mode, "USB3.1 compliance testing");
+
 enum usbpd_state {
 	PE_UNKNOWN,
 	PE_ERROR_RECOVERY,
@@ -412,6 +417,8 @@ struct usbpd {
 	bool			peer_usb_comm;
 	bool			peer_pr_swap;
 	bool			peer_dr_swap;
+	bool		oem_bypass;
+	bool		periph_direct;
 
 	u32			sink_caps[7];
 	int			num_sink_caps;
@@ -425,6 +432,7 @@ struct usbpd {
 	int			bat_voltage_max;
 
 	enum power_supply_typec_mode typec_mode;
+	enum power_supply_type	psy_type;
 	enum power_supply_typec_power_role forced_pr;
 	bool			vbus_present;
 
@@ -1320,7 +1328,6 @@ static void usbpd_set_state(struct usbpd *pd, enum usbpd_state next_state)
 			pd->ss_lane_svid = 0x0;
 		}
 
-		dual_role_instance_changed(pd->dual_role);
 
 		val.intval = 1; /* Rp-1.5A; SinkTxNG for PD 3.0 */
 		power_supply_set_property(pd->usb_psy,
@@ -1420,16 +1427,21 @@ static void usbpd_set_state(struct usbpd *pd, enum usbpd_state next_state)
 
 			usbpd_err(&pd->dev, "Invalid request: %08x\n", pd->rdo);
 
-			if (pd->in_explicit_contract)
-				usbpd_set_state(pd, PE_SRC_READY);
-			else
-				/*
-				 * bypass PE_SRC_Capability_Response and
-				 * PE_SRC_Wait_New_Capabilities in this
-				 * implementation for simplicity.
-				 */
-				usbpd_set_state(pd, PE_SRC_SEND_CAPABILITIES);
-			break;
+			if (pd->oem_bypass) {
+				usbpd_info(&pd->dev, "oem bypass invalid request!\n");
+			} else {
+				if (pd->in_explicit_contract)
+					usbpd_set_state(pd, PE_SRC_READY);
+				else
+					/*
+					 * bypass PE_SRC_Capability_Response and
+					 * PE_SRC_Wait_New_Capabilities in this
+					 * implementation for simplicity.
+					 */
+					usbpd_set_state(pd,
+						PE_SRC_SEND_CAPABILITIES);
+				break;
+			}
 		}
 
 		/* PE_SRC_TRANSITION_SUPPLY pseudo-state */
@@ -1553,7 +1565,6 @@ static void usbpd_set_state(struct usbpd *pd, enum usbpd_state next_state)
 	case PE_SNK_STARTUP:
 		if (pd->current_dr == DR_NONE || pd->current_dr == DR_UFP) {
 			pd->current_dr = DR_UFP;
-
 			ret = power_supply_get_property(pd->usb_psy,
 					POWER_SUPPLY_PROP_REAL_TYPE, &val);
 			if (!ret) {
@@ -1564,8 +1575,6 @@ static void usbpd_set_state(struct usbpd *pd, enum usbpd_state next_state)
 			}
 		}
 
-		dual_role_instance_changed(pd->dual_role);
-
 		pd_reset_protocol(pd);
 
 		if (!pd->in_pr_swap) {
@@ -1769,8 +1778,13 @@ int usbpd_send_vdm(struct usbpd *pd, u32 vdm_hdr, const u32 *vdos, int num_vdos)
 {
 	struct vdm_tx *vdm_tx;
 
-	if (pd->vdm_tx)
-		return -EBUSY;
+	if (pd->vdm_tx) {
+		usbpd_warn(&pd->dev, "Discarding previously queued VDM tx (SVID:0x%04x)\n",
+				VDM_HDR_SVID(pd->vdm_tx->data[0]));
+
+		kfree(pd->vdm_tx);
+		pd->vdm_tx = NULL;
+	}
 
 	vdm_tx = kzalloc(sizeof(*vdm_tx), GFP_KERNEL);
 	if (!vdm_tx)
@@ -1854,17 +1868,13 @@ static void handle_vdm_rx(struct usbpd *pd, struct rx_msg *rx_msg)
 		return;
 	}
 
-	/* if this interrupts a previous exchange, abort queued response */
-	if (cmd_type == SVDM_CMD_TYPE_INITIATOR && pd->vdm_tx) {
-		usbpd_dbg(&pd->dev, "Discarding previously queued SVDM tx (SVID:0x%04x)\n",
-				VDM_HDR_SVID(pd->vdm_tx->data[0]));
-
-		kfree(pd->vdm_tx);
-		pd->vdm_tx = NULL;
-	}
-
 	if (handler && handler->svdm_received) {
 		handler->svdm_received(handler, cmd, cmd_type, vdos, num_vdos);
+
+		/* handle any previously queued TX */
+		if (pd->vdm_tx && !pd->sm_queued)
+			kick_sm(pd, 0);
+
 		return;
 	}
 
@@ -1872,17 +1882,10 @@ static void handle_vdm_rx(struct usbpd *pd, struct rx_msg *rx_msg)
 	switch (cmd_type) {
 	case SVDM_CMD_TYPE_INITIATOR:
 		if (cmd != USBPD_SVDM_ATTENTION) {
-			if (pd->spec_rev == USBPD_REV_30) {
-				ret = pd_send_msg(pd, MSG_NOT_SUPPORTED, NULL,
-						0, SOP_MSG);
-				if (ret)
-					usbpd_set_state(pd, PE_SEND_SOFT_RESET);
-			} else {
 				usbpd_send_svdm(pd, svid, cmd,
 						SVDM_CMD_TYPE_RESP_NAK,
 						SVDM_HDR_OBJ_POS(vdm_hdr),
 						NULL, 0);
-			}
 		}
 		break;
 
@@ -2396,8 +2399,6 @@ static int enable_vbus(struct usbpd *pd)
 /* For PD 3.0, check SinkTxOk before allowing initiating AMS */
 static inline bool is_sink_tx_ok(struct usbpd *pd)
 {
-	if (pd->spec_rev == USBPD_REV_30)
-		return pd->typec_mode == POWER_SUPPLY_TYPEC_SOURCE_HIGH;
 
 	return true;
 }
@@ -3366,7 +3367,7 @@ static int psy_changed(struct notifier_block *nb, unsigned long evt, void *ptr)
 	}
 
 	/* Don't proceed if PE_START=0; start USB directly if needed */
-	if (!val.intval && !pd->pd_connected &&
+	if (pd->periph_direct && !val.intval && !pd->pd_connected &&
 			typec_mode >= POWER_SUPPLY_TYPEC_SOURCE_DEFAULT) {
 		ret = power_supply_get_property(pd->usb_psy,
 				POWER_SUPPLY_PROP_REAL_TYPE, &val);
@@ -3378,8 +3379,9 @@ static int psy_changed(struct notifier_block *nb, unsigned long evt, void *ptr)
 
 		if (val.intval == POWER_SUPPLY_TYPE_USB ||
 			val.intval == POWER_SUPPLY_TYPE_USB_CDP ||
-			val.intval == POWER_SUPPLY_TYPE_USB_FLOAT) {
-			usbpd_dbg(&pd->dev, "typec mode:%d type:%d\n",
+			val.intval == POWER_SUPPLY_TYPE_USB_FLOAT ||
+			usb_compliance_mode) {
+			usbpd_info(&pd->dev, "typec mode:%d type:%d\n",
 				typec_mode, val.intval);
 			pd->typec_mode = typec_mode;
 			queue_work(pd->wq, &pd->start_periph_work);
@@ -3388,6 +3390,11 @@ static int psy_changed(struct notifier_block *nb, unsigned long evt, void *ptr)
 		return 0;
 	}
 
+	if (usb_compliance_mode) {
+		usbpd_info(&pd->dev, "start usb peripheral for testing");
+		start_usb_peripheral(pd);
+	}
+
 	ret = power_supply_get_property(pd->usb_psy,
 			POWER_SUPPLY_PROP_PRESENT, &val);
 	if (ret) {
@@ -3415,10 +3422,28 @@ static int psy_changed(struct notifier_block *nb, unsigned long evt, void *ptr)
 	if (pd->typec_mode == typec_mode)
 		return 0;
 
+	ret = power_supply_get_property(pd->usb_psy,
+			POWER_SUPPLY_PROP_REAL_TYPE, &val);
+	if (ret) {
+		usbpd_err(&pd->dev, "Unable to read USB TYPE: %d\n", ret);
+		return ret;
+	}
+
+	pd->psy_type = val.intval;
+
+	if ((typec_mode == POWER_SUPPLY_TYPEC_SOURCE_DEFAULT) ||
+		(typec_mode == POWER_SUPPLY_TYPEC_SOURCE_MEDIUM) ||
+		(typec_mode == POWER_SUPPLY_TYPEC_SOURCE_HIGH)) {
+		if (pd->psy_type == POWER_SUPPLY_TYPE_UNKNOWN) {
+			usbpd_err(&pd->dev, "typec_mode:%d, psy_type:%d\n",
+				typec_mode, pd->psy_type);
+			return 0;
+		}
+	}
 	pd->typec_mode = typec_mode;
 
-	usbpd_dbg(&pd->dev, "typec mode:%d present:%d orientation:%d\n",
-			typec_mode, pd->vbus_present,
+	usbpd_err(&pd->dev, "typec mode:%d present:%d type:%d orientation:%d\n",
+			typec_mode, pd->vbus_present, pd->psy_type,
 			usbpd_get_plug_orientation(pd));
 
 	switch (typec_mode) {
@@ -3473,8 +3498,12 @@ static int psy_changed(struct notifier_block *nb, unsigned long evt, void *ptr)
 				typec_mode == POWER_SUPPLY_TYPEC_SINK ?
 					"" : " (powered)");
 
-		if (pd->current_pr == PR_SRC)
+		usbpd_info(&pd->dev, "primary current_pr = %d\n",
+				pd->current_pr);
+		if (pd->current_pr == PR_SRC) {
+			pr_err("pd->current_pr == PR_SRC PR no change return!\n");
 			return 0;
+		}
 
 		pd->current_pr = PR_SRC;
 		break;
@@ -3549,6 +3578,8 @@ static int usbpd_dr_set_property(struct dual_role_phy_instance *dual_role,
 		enum dual_role_property prop, const unsigned int *val)
 {
 	struct usbpd *pd = dual_role_get_drvdata(dual_role);
+	union power_supply_propval value;
+	int wait_count = 5;
 	bool do_swap = false;
 
 	if (!pd)
@@ -3571,9 +3602,33 @@ static int usbpd_dr_set_property(struct dual_role_phy_instance *dual_role,
 		set_power_role(pd, PR_NONE);
 
 		/* wait until it takes effect */
-		while (pd->forced_pr != POWER_SUPPLY_TYPEC_PR_NONE)
+		while (pd->forced_pr != POWER_SUPPLY_TYPEC_PR_NONE &&
+				--wait_count)
 			msleep(20);
 
+		if (!wait_count) {
+			usbpd_err(&pd->dev, "setting mode timed out\n");
+			/* Setting it to DRP. HW can figure out new mode */
+			value.intval = POWER_SUPPLY_TYPEC_PR_DUAL;
+			power_supply_set_property(pd->usb_psy,
+				POWER_SUPPLY_PROP_TYPEC_POWER_ROLE, &value);
+				return -ETIMEDOUT;
+		}
+
+		/* if we cannot have a valid connection, fallback to old role */
+		wait_count = 5;
+		while (pd->current_pr == PR_NONE && --wait_count)
+			msleep(300);
+
+		if (!wait_count) {
+			usbpd_err(&pd->dev, "setting mode timed out\n");
+			/* Setting it to DRP. HW can figure out new mode */
+			value.intval = POWER_SUPPLY_TYPEC_PR_DUAL;
+			power_supply_set_property(pd->usb_psy,
+				POWER_SUPPLY_PROP_TYPEC_POWER_ROLE, &value);
+			return -ETIMEDOUT;
+		}
+
 		break;
 
 	case DUAL_ROLE_PROP_DR:
@@ -3597,12 +3652,6 @@ static int usbpd_dr_set_property(struct dual_role_phy_instance *dual_role,
 				return -EAGAIN;
 			}
 
-			if (pd->current_state == PE_SNK_READY &&
-					!is_sink_tx_ok(pd)) {
-				usbpd_err(&pd->dev, "Rp indicates SinkTxNG\n");
-				return -EAGAIN;
-			}
-
 			mutex_lock(&pd->swap_lock);
 			reinit_completion(&pd->is_ready);
 			pd->send_dr_swap = true;
@@ -3657,12 +3706,6 @@ static int usbpd_dr_set_property(struct dual_role_phy_instance *dual_role,
 				return -EAGAIN;
 			}
 
-			if (pd->current_state == PE_SNK_READY &&
-					!is_sink_tx_ok(pd)) {
-				usbpd_err(&pd->dev, "Rp indicates SinkTxNG\n");
-				return -EAGAIN;
-			}
-
 			mutex_lock(&pd->swap_lock);
 			reinit_completion(&pd->is_ready);
 			pd->send_pr_swap = true;
@@ -3958,7 +4001,7 @@ static ssize_t select_pdo_store(struct device *dev,
 	mutex_lock(&pd->swap_lock);
 
 	/* Only allowed if we are already in explicit sink contract */
-	if (pd->current_state != PE_SNK_READY || !is_sink_tx_ok(pd)) {
+	if (pd->current_state != PE_SNK_READY) {
 		usbpd_err(&pd->dev, "select_pdo: Cannot select new PDO yet\n");
 		ret = -EBUSY;
 		goto out;
@@ -4110,7 +4153,7 @@ static int trigger_tx_msg(struct usbpd *pd, bool *msg_tx_flag)
 	int ret = 0;
 
 	/* Only allowed if we are already in explicit sink contract */
-	if (pd->current_state != PE_SNK_READY || !is_sink_tx_ok(pd)) {
+	if (pd->current_state != PE_SNK_READY) {
 		usbpd_err(&pd->dev, "%s: Cannot send msg\n", __func__);
 		ret = -EBUSY;
 		goto out;
@@ -4534,6 +4577,8 @@ struct usbpd *usbpd_create(struct device *parent)
 		pd->dual_role->drv_data = pd;
 	}
 
+	pd->oem_bypass = true;
+	pd->periph_direct = false;
 	pd->current_pr = PR_NONE;
 	pd->current_dr = DR_NONE;
 	list_add_tail(&pd->instance, &_usbpd);
diff --git a/drivers/usb/phy/phy-msm-snps-hs.c b/drivers/usb/phy/phy-msm-snps-hs.c
index d76c143a929f8402ee82b4661e4fd21984701ed6..c6bda15d7dec65b281577ead6831674578c8553d 100644
--- a/drivers/usb/phy/phy-msm-snps-hs.c
+++ b/drivers/usb/phy/phy-msm-snps-hs.c
@@ -86,6 +86,10 @@
 #define USB_HSPHY_1P8_VOL_MAX			1800000 /* uV */
 #define USB_HSPHY_1P8_HPM_LOAD			19000	/* uA */
 
+unsigned int USB2_phy_tune1;
+module_param(USB2_phy_tune1, uint, 0644);
+MODULE_PARM_DESC(USB2_phy_tune1, "QUSB PHY v2 TUNE1");
+
 #define USB_HSPHY_VDD_HPM_LOAD			30000	/* uA */
 
 struct msm_hsphy {
@@ -330,9 +334,9 @@ static void hsusb_phy_write_seq(void __iomem *base, u32 *seq, int cnt,
 {
 	int i;
 
-	pr_debug("Seq count:%d\n", cnt);
+	pr_info("%s:Seq count:%d\n", __func__, cnt);
 	for (i = 0; i < cnt; i = i+2) {
-		pr_debug("write 0x%02x to 0x%02x\n", seq[i], seq[i+1]);
+		pr_info("%s:write 0x%02x to 0x%02x\n", __func__,seq[i], seq[i+1]);
 		writel_relaxed(seq[i], base + seq[i+1]);
 		if (delay)
 			usleep_range(delay, (delay + 2000));
@@ -429,6 +433,16 @@ static int msm_hsphy_init(struct usb_phy *uphy)
 			TXVREFTUNE0_MASK, val);
 	}
 
+	if (USB2_phy_tune1) {
+		pr_err("%s(): (modparam) USB2_phy_tune1 val:0x%02x\n",
+						__func__, USB2_phy_tune1);
+		writel_relaxed(USB2_phy_tune1,
+			phy->base + USB2PHY_USB_PHY_PARAMETER_OVERRIDE_X1);
+	}
+
+	pr_err("USB2_tune1_register_val:%x\n", readl_relaxed(phy->base +
+		USB2PHY_USB_PHY_PARAMETER_OVERRIDE_X1));
+
 	if (phy->param_ovrd0) {
 		msm_usb_write_readback(phy->base,
 			USB2PHY_USB_PHY_PARAMETER_OVERRIDE_X0,
diff --git a/fs/Kconfig b/fs/Kconfig
index 69163d44b2fe3eae8e6a46a9fc930af60d5c793e..9f78be7312047d3fe62e1d4fe02785aba4da6ff3 100644
--- a/fs/Kconfig
+++ b/fs/Kconfig
@@ -127,6 +127,8 @@ menu "DOS/FAT/NT Filesystems"
 source "fs/fat/Kconfig"
 source "fs/ntfs/Kconfig"
 
+source "fs/exfat/Kconfig"
+
 endmenu
 endif # BLOCK
 
diff --git a/fs/Makefile b/fs/Makefile
index 1e34e4bc81a33d3c9eb818ee28c6012d79d95e48..6a72193291e66f64b71a261c83e0f9921be3262b 100644
--- a/fs/Makefile
+++ b/fs/Makefile
@@ -130,3 +130,4 @@ obj-y				+= exofs/ # Multiple modules
 obj-$(CONFIG_CEPH_FS)		+= ceph/
 obj-$(CONFIG_PSTORE)		+= pstore/
 obj-$(CONFIG_EFIVAR_FS)		+= efivarfs/
+obj-$(CONFIG_EXFAT_FS)		+= exfat/
diff --git a/fs/aio.c b/fs/aio.c
index 3a749c3a92e3221920a229468fc3dbe2a1356a86..8d146b28435f4c5d01fec2760ea73c5802862756 100644
--- a/fs/aio.c
+++ b/fs/aio.c
@@ -557,10 +557,11 @@ void kiocb_set_cancel_fn(struct kiocb *iocb, kiocb_cancel_fn *cancel)
 	struct kioctx *ctx = req->ki_ctx;
 	unsigned long flags;
 
-	spin_lock_irqsave(&ctx->ctx_lock, flags);
+	if (WARN_ON_ONCE(!list_empty(&req->ki_list)))
+		return;
 
-	if (!req->ki_list.next)
-		list_add(&req->ki_list, &ctx->active_reqs);
+	spin_lock_irqsave(&ctx->ctx_lock, flags);
+	list_add_tail(&req->ki_list, &ctx->active_reqs);
 
 	req->ki_cancel = cancel;
 
@@ -1051,6 +1052,7 @@ static inline struct aio_kiocb *aio_get_req(struct kioctx *ctx)
 
 	percpu_ref_get(&ctx->reqs);
 
+	INIT_LIST_HEAD(&req->ki_list);
 	req->ki_ctx = ctx;
 	return req;
 out_put:
@@ -1118,16 +1120,7 @@ static void aio_complete(struct kiocb *kiocb, long res, long res2)
 		file_end_write(file);
 	}
 
-	/*
-	 * Special case handling for sync iocbs:
-	 *  - events go directly into the iocb for fast handling
-	 *  - the sync task with the iocb in its stack holds the single iocb
-	 *    ref, no other paths have a way to get another ref
-	 *  - the sync task helpfully left a reference to itself in the iocb
-	 */
-	BUG_ON(is_sync_kiocb(kiocb));
-
-	if (iocb->ki_list.next) {
+	if (!list_empty_careful(&iocb->ki_list)) {
 		unsigned long flags;
 
 		spin_lock_irqsave(&ctx->ctx_lock, flags);
diff --git a/fs/dcache.c b/fs/dcache.c
index 8d603ab43ff9e5e4f41692cbdf31ad0fb7dfda2f..42a196cfc666d5b791f05f27fcc205f8b736035c 100644
--- a/fs/dcache.c
+++ b/fs/dcache.c
@@ -1435,7 +1435,7 @@ static enum d_walk_ret select_collect(void *_data, struct dentry *dentry)
 		goto out;
 
 	if (dentry->d_flags & DCACHE_SHRINK_LIST) {
-		data->found++;
+		goto out;
 	} else {
 		if (dentry->d_flags & DCACHE_LRU_LIST)
 			d_lru_del(dentry);
diff --git a/fs/exec.c b/fs/exec.c
index f6f4ed966c73f20b3f6613dbae6760af701d14bf..a7e668458bbf148b2266a2b90d9ef0fb89eae578 100644
--- a/fs/exec.c
+++ b/fs/exec.c
@@ -71,6 +71,9 @@
 #include "internal.h"
 
 #include <trace/events/sched.h>
+#ifdef CONFIG_ADJ_CHAIN
+#include <linux/adj_chain.h>
+#endif
 
 int suid_dumpable = 0;
 
@@ -1147,6 +1150,12 @@ static int de_thread(struct task_struct *tsk)
 		list_replace_rcu(&leader->tasks, &tsk->tasks);
 		list_replace_init(&leader->sibling, &tsk->sibling);
 
+#ifdef CONFIG_ADJ_CHAIN
+		tsk->adj_chain_status |= 1 << AC_PROM_LEADER;
+		adj_chain_detach(tsk);
+		adj_chain_attach(tsk);
+		tsk->adj_chain_status &= ~(1 << AC_PROM_LEADER);
+#endif
 		tsk->group_leader = tsk;
 		leader->group_leader = tsk;
 
diff --git a/fs/exfat/Kconfig b/fs/exfat/Kconfig
new file mode 100644
index 0000000000000000000000000000000000000000..78b32aa2ca19652168d34eadd74211814e5f7582
--- /dev/null
+++ b/fs/exfat/Kconfig
@@ -0,0 +1,39 @@
+config EXFAT_FS
+	tristate "exFAT fs support"
+	select NLS
+	help
+	  This adds support for the exFAT file system.
+
+config EXFAT_DISCARD
+	bool "enable discard support"
+	depends on EXFAT_FS
+	default y
+
+config EXFAT_DELAYED_SYNC
+	bool "enable delayed sync"
+	depends on EXFAT_FS
+	default n
+
+config EXFAT_KERNEL_DEBUG
+	bool "enable kernel debug features via ioctl"
+	depends on EXFAT_FS
+	default n
+
+config EXFAT_DEBUG_MSG
+	bool "print debug messages"
+	depends on EXFAT_FS
+	default n
+
+config EXFAT_DEFAULT_CODEPAGE
+	int "Default codepage for exFAT"
+	default 437
+	depends on EXFAT_FS
+	help
+	  This option should be set to the codepage of your exFAT filesystems.
+
+config EXFAT_DEFAULT_IOCHARSET
+	string "Default iocharset for exFAT"
+	default "utf8"
+	depends on EXFAT_FS
+	help
+	  Set this to the default input/output character set you'd like exFAT to use.
diff --git a/fs/exfat/LICENSE b/fs/exfat/LICENSE
new file mode 100644
index 0000000000000000000000000000000000000000..d159169d1050894d3ea3b98e1c965c4058208fe1
--- /dev/null
+++ b/fs/exfat/LICENSE
@@ -0,0 +1,339 @@
+                    GNU GENERAL PUBLIC LICENSE
+                       Version 2, June 1991
+
+ Copyright (C) 1989, 1991 Free Software Foundation, Inc.,
+ 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
+ Everyone is permitted to copy and distribute verbatim copies
+ of this license document, but changing it is not allowed.
+
+                            Preamble
+
+  The licenses for most software are designed to take away your
+freedom to share and change it.  By contrast, the GNU General Public
+License is intended to guarantee your freedom to share and change free
+software--to make sure the software is free for all its users.  This
+General Public License applies to most of the Free Software
+Foundation's software and to any other program whose authors commit to
+using it.  (Some other Free Software Foundation software is covered by
+the GNU Lesser General Public License instead.)  You can apply it to
+your programs, too.
+
+  When we speak of free software, we are referring to freedom, not
+price.  Our General Public Licenses are designed to make sure that you
+have the freedom to distribute copies of free software (and charge for
+this service if you wish), that you receive source code or can get it
+if you want it, that you can change the software or use pieces of it
+in new free programs; and that you know you can do these things.
+
+  To protect your rights, we need to make restrictions that forbid
+anyone to deny you these rights or to ask you to surrender the rights.
+These restrictions translate to certain responsibilities for you if you
+distribute copies of the software, or if you modify it.
+
+  For example, if you distribute copies of such a program, whether
+gratis or for a fee, you must give the recipients all the rights that
+you have.  You must make sure that they, too, receive or can get the
+source code.  And you must show them these terms so they know their
+rights.
+
+  We protect your rights with two steps: (1) copyright the software, and
+(2) offer you this license which gives you legal permission to copy,
+distribute and/or modify the software.
+
+  Also, for each author's protection and ours, we want to make certain
+that everyone understands that there is no warranty for this free
+software.  If the software is modified by someone else and passed on, we
+want its recipients to know that what they have is not the original, so
+that any problems introduced by others will not reflect on the original
+authors' reputations.
+
+  Finally, any free program is threatened constantly by software
+patents.  We wish to avoid the danger that redistributors of a free
+program will individually obtain patent licenses, in effect making the
+program proprietary.  To prevent this, we have made it clear that any
+patent must be licensed for everyone's free use or not licensed at all.
+
+  The precise terms and conditions for copying, distribution and
+modification follow.
+
+                    GNU GENERAL PUBLIC LICENSE
+   TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION
+
+  0. This License applies to any program or other work which contains
+a notice placed by the copyright holder saying it may be distributed
+under the terms of this General Public License.  The "Program", below,
+refers to any such program or work, and a "work based on the Program"
+means either the Program or any derivative work under copyright law:
+that is to say, a work containing the Program or a portion of it,
+either verbatim or with modifications and/or translated into another
+language.  (Hereinafter, translation is included without limitation in
+the term "modification".)  Each licensee is addressed as "you".
+
+Activities other than copying, distribution and modification are not
+covered by this License; they are outside its scope.  The act of
+running the Program is not restricted, and the output from the Program
+is covered only if its contents constitute a work based on the
+Program (independent of having been made by running the Program).
+Whether that is true depends on what the Program does.
+
+  1. You may copy and distribute verbatim copies of the Program's
+source code as you receive it, in any medium, provided that you
+conspicuously and appropriately publish on each copy an appropriate
+copyright notice and disclaimer of warranty; keep intact all the
+notices that refer to this License and to the absence of any warranty;
+and give any other recipients of the Program a copy of this License
+along with the Program.
+
+You may charge a fee for the physical act of transferring a copy, and
+you may at your option offer warranty protection in exchange for a fee.
+
+  2. You may modify your copy or copies of the Program or any portion
+of it, thus forming a work based on the Program, and copy and
+distribute such modifications or work under the terms of Section 1
+above, provided that you also meet all of these conditions:
+
+    a) You must cause the modified files to carry prominent notices
+    stating that you changed the files and the date of any change.
+
+    b) You must cause any work that you distribute or publish, that in
+    whole or in part contains or is derived from the Program or any
+    part thereof, to be licensed as a whole at no charge to all third
+    parties under the terms of this License.
+
+    c) If the modified program normally reads commands interactively
+    when run, you must cause it, when started running for such
+    interactive use in the most ordinary way, to print or display an
+    announcement including an appropriate copyright notice and a
+    notice that there is no warranty (or else, saying that you provide
+    a warranty) and that users may redistribute the program under
+    these conditions, and telling the user how to view a copy of this
+    License.  (Exception: if the Program itself is interactive but
+    does not normally print such an announcement, your work based on
+    the Program is not required to print an announcement.)
+
+These requirements apply to the modified work as a whole.  If
+identifiable sections of that work are not derived from the Program,
+and can be reasonably considered independent and separate works in
+themselves, then this License, and its terms, do not apply to those
+sections when you distribute them as separate works.  But when you
+distribute the same sections as part of a whole which is a work based
+on the Program, the distribution of the whole must be on the terms of
+this License, whose permissions for other licensees extend to the
+entire whole, and thus to each and every part regardless of who wrote it.
+
+Thus, it is not the intent of this section to claim rights or contest
+your rights to work written entirely by you; rather, the intent is to
+exercise the right to control the distribution of derivative or
+collective works based on the Program.
+
+In addition, mere aggregation of another work not based on the Program
+with the Program (or with a work based on the Program) on a volume of
+a storage or distribution medium does not bring the other work under
+the scope of this License.
+
+  3. You may copy and distribute the Program (or a work based on it,
+under Section 2) in object code or executable form under the terms of
+Sections 1 and 2 above provided that you also do one of the following:
+
+    a) Accompany it with the complete corresponding machine-readable
+    source code, which must be distributed under the terms of Sections
+    1 and 2 above on a medium customarily used for software interchange; or,
+
+    b) Accompany it with a written offer, valid for at least three
+    years, to give any third party, for a charge no more than your
+    cost of physically performing source distribution, a complete
+    machine-readable copy of the corresponding source code, to be
+    distributed under the terms of Sections 1 and 2 above on a medium
+    customarily used for software interchange; or,
+
+    c) Accompany it with the information you received as to the offer
+    to distribute corresponding source code.  (This alternative is
+    allowed only for noncommercial distribution and only if you
+    received the program in object code or executable form with such
+    an offer, in accord with Subsection b above.)
+
+The source code for a work means the preferred form of the work for
+making modifications to it.  For an executable work, complete source
+code means all the source code for all modules it contains, plus any
+associated interface definition files, plus the scripts used to
+control compilation and installation of the executable.  However, as a
+special exception, the source code distributed need not include
+anything that is normally distributed (in either source or binary
+form) with the major components (compiler, kernel, and so on) of the
+operating system on which the executable runs, unless that component
+itself accompanies the executable.
+
+If distribution of executable or object code is made by offering
+access to copy from a designated place, then offering equivalent
+access to copy the source code from the same place counts as
+distribution of the source code, even though third parties are not
+compelled to copy the source along with the object code.
+
+  4. You may not copy, modify, sublicense, or distribute the Program
+except as expressly provided under this License.  Any attempt
+otherwise to copy, modify, sublicense or distribute the Program is
+void, and will automatically terminate your rights under this License.
+However, parties who have received copies, or rights, from you under
+this License will not have their licenses terminated so long as such
+parties remain in full compliance.
+
+  5. You are not required to accept this License, since you have not
+signed it.  However, nothing else grants you permission to modify or
+distribute the Program or its derivative works.  These actions are
+prohibited by law if you do not accept this License.  Therefore, by
+modifying or distributing the Program (or any work based on the
+Program), you indicate your acceptance of this License to do so, and
+all its terms and conditions for copying, distributing or modifying
+the Program or works based on it.
+
+  6. Each time you redistribute the Program (or any work based on the
+Program), the recipient automatically receives a license from the
+original licensor to copy, distribute or modify the Program subject to
+these terms and conditions.  You may not impose any further
+restrictions on the recipients' exercise of the rights granted herein.
+You are not responsible for enforcing compliance by third parties to
+this License.
+
+  7. If, as a consequence of a court judgment or allegation of patent
+infringement or for any other reason (not limited to patent issues),
+conditions are imposed on you (whether by court order, agreement or
+otherwise) that contradict the conditions of this License, they do not
+excuse you from the conditions of this License.  If you cannot
+distribute so as to satisfy simultaneously your obligations under this
+License and any other pertinent obligations, then as a consequence you
+may not distribute the Program at all.  For example, if a patent
+license would not permit royalty-free redistribution of the Program by
+all those who receive copies directly or indirectly through you, then
+the only way you could satisfy both it and this License would be to
+refrain entirely from distribution of the Program.
+
+If any portion of this section is held invalid or unenforceable under
+any particular circumstance, the balance of the section is intended to
+apply and the section as a whole is intended to apply in other
+circumstances.
+
+It is not the purpose of this section to induce you to infringe any
+patents or other property right claims or to contest validity of any
+such claims; this section has the sole purpose of protecting the
+integrity of the free software distribution system, which is
+implemented by public license practices.  Many people have made
+generous contributions to the wide range of software distributed
+through that system in reliance on consistent application of that
+system; it is up to the author/donor to decide if he or she is willing
+to distribute software through any other system and a licensee cannot
+impose that choice.
+
+This section is intended to make thoroughly clear what is believed to
+be a consequence of the rest of this License.
+
+  8. If the distribution and/or use of the Program is restricted in
+certain countries either by patents or by copyrighted interfaces, the
+original copyright holder who places the Program under this License
+may add an explicit geographical distribution limitation excluding
+those countries, so that distribution is permitted only in or among
+countries not thus excluded.  In such case, this License incorporates
+the limitation as if written in the body of this License.
+
+  9. The Free Software Foundation may publish revised and/or new versions
+of the General Public License from time to time.  Such new versions will
+be similar in spirit to the present version, but may differ in detail to
+address new problems or concerns.
+
+Each version is given a distinguishing version number.  If the Program
+specifies a version number of this License which applies to it and "any
+later version", you have the option of following the terms and conditions
+either of that version or of any later version published by the Free
+Software Foundation.  If the Program does not specify a version number of
+this License, you may choose any version ever published by the Free Software
+Foundation.
+
+  10. If you wish to incorporate parts of the Program into other free
+programs whose distribution conditions are different, write to the author
+to ask for permission.  For software which is copyrighted by the Free
+Software Foundation, write to the Free Software Foundation; we sometimes
+make exceptions for this.  Our decision will be guided by the two goals
+of preserving the free status of all derivatives of our free software and
+of promoting the sharing and reuse of software generally.
+
+                            NO WARRANTY
+
+  11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY
+FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW.  EXCEPT WHEN
+OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES
+PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED
+OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.  THE ENTIRE RISK AS
+TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU.  SHOULD THE
+PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING,
+REPAIR OR CORRECTION.
+
+  12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
+WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR
+REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES,
+INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING
+OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED
+TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY
+YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER
+PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGES.
+
+                     END OF TERMS AND CONDITIONS
+
+            How to Apply These Terms to Your New Programs
+
+  If you develop a new program, and you want it to be of the greatest
+possible use to the public, the best way to achieve this is to make it
+free software which everyone can redistribute and change under these terms.
+
+  To do so, attach the following notices to the program.  It is safest
+to attach them to the start of each source file to most effectively
+convey the exclusion of warranty; and each file should have at least
+the "copyright" line and a pointer to where the full notice is found.
+
+    <one line to give the program's name and a brief idea of what it does.>
+    Copyright (C) <year>  <name of author>
+
+    This program is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 2 of the License, or
+    (at your option) any later version.
+
+    This program is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License along
+    with this program; if not, write to the Free Software Foundation, Inc.,
+    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+
+Also add information on how to contact you by electronic and paper mail.
+
+If the program is interactive, make it output a short notice like this
+when it starts in an interactive mode:
+
+    Gnomovision version 69, Copyright (C) year name of author
+    Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'.
+    This is free software, and you are welcome to redistribute it
+    under certain conditions; type `show c' for details.
+
+The hypothetical commands `show w' and `show c' should show the appropriate
+parts of the General Public License.  Of course, the commands you use may
+be called something other than `show w' and `show c'; they could even be
+mouse-clicks or menu items--whatever suits your program.
+
+You should also get your employer (if you work as a programmer) or your
+school, if any, to sign a "copyright disclaimer" for the program, if
+necessary.  Here is a sample; alter the names:
+
+  Yoyodyne, Inc., hereby disclaims all copyright interest in the program
+  `Gnomovision' (which makes passes at compilers) written by James Hacker.
+
+  <signature of Ty Coon>, 1 April 1989
+  Ty Coon, President of Vice
+
+This General Public License does not permit incorporating your program into
+proprietary programs.  If your program is a subroutine library, you may
+consider it more useful to permit linking proprietary applications with the
+library.  If this is what you want to do, use the GNU Lesser General
+Public License instead of this License.
diff --git a/fs/exfat/Makefile b/fs/exfat/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..711ed87f991b4c039e6f7b1c3679f85bdc17966b
--- /dev/null
+++ b/fs/exfat/Makefile
@@ -0,0 +1,54 @@
+#
+# Makefile for Linux FAT12/FAT16/FAT32(VFAT)/FAT64(ExFAT) filesystem driver.
+#
+
+ifneq ($(KERNELRELEASE),)
+# call from kernel build system
+
+obj-$(CONFIG_EXFAT_FS) += exfat.o
+
+exfat-objs := exfat_core.o exfat_super.o exfat_api.o exfat_blkdev.o exfat_cache.o \
+			   exfat_data.o exfat_bitmap.o exfat_nls.o exfat_oal.o exfat_upcase.o
+
+else
+# external module build
+
+EXTRA_FLAGS += -I$(PWD)
+
+#
+# KDIR is a path to a directory containing kernel source.
+# It can be specified on the command line passed to make to enable the module to
+# be built and installed for a kernel other than the one currently running.
+# By default it is the path to the symbolic link created when
+# the current kernel's modules were installed, but
+# any valid path to the directory in which the target kernel's source is located
+# can be provided on the command line.
+#
+KDIR	?= /lib/modules/$(shell uname -r)/build
+MDIR	?= /lib/modules/$(shell uname -r)
+PWD	:= $(shell pwd)
+PWD	:= $(shell pwd)
+
+export CONFIG_EXFAT_FS := m
+
+all:
+	$(MAKE) -C $(KDIR) M=$(PWD) modules
+
+clean:
+	$(MAKE) -C $(KDIR) M=$(PWD) clean
+
+help:
+	$(MAKE) -C $(KDIR) M=$(PWD) help
+
+install: exfat.ko
+	rm -f ${MDIR}/kernel/fs/exfat/exfat.ko
+	install -m644 -b -D exfat.ko ${MDIR}/kernel/fs/exfat/exfat.ko
+	depmod -aq
+
+uninstall:
+	rm -rf ${MDIR}/kernel/fs/exfat
+	depmod -aq
+
+endif
+
+.PHONY : all clean install uninstall
diff --git a/fs/exfat/README.md b/fs/exfat/README.md
new file mode 100644
index 0000000000000000000000000000000000000000..feab40038352cf71d066b3423e200e49e62ffac1
--- /dev/null
+++ b/fs/exfat/README.md
@@ -0,0 +1,98 @@
+exfat-nofuse
+============
+
+Linux non-fuse read/write kernel driver for the exFAT, FAT12, FAT16 and vfat (FAT32) file systems.<br />
+Originally ported from Android kernel v3.0.
+
+Kudos to ksv1986 for the mutex patch!<br />
+Thanks to JackNorris for being awesome and providing the clear_inode() patch.<br />
+<br />
+Big thanks to lqs for completing the driver!<br />
+Big thanks to benpicco for fixing 3.11.y compatibility!
+
+
+Special thanks to github user AndreiLux for spreading the word about the leak!<br />
+
+
+Installing as a stand-alone module:
+====================================
+
+    make
+    sudo make install
+
+To load the driver manually, run this as root:
+
+    modprobe exfat
+
+You may also specify custom toolchains by using CROSS_COMPILE flag, in my case:
+>CROSS_COMPILE=../dorimanx-SG2-I9100-Kernel/android-toolchain/bin/arm-eabi-
+
+Installing as a part of the kernel:
+======================================
+
+Let's take [linux] as the path to your kernel source dir...
+
+	cd [linux]
+	cp -rvf exfat-nofuse [linux]/fs/exfat
+
+edit [linux]/fs/Kconfig
+```
+ menu "DOS/FAT/NT Filesystems"
+
+  source "fs/fat/Kconfig"
+ +source "fs/exfat/Kconfig"
+  source "fs/ntfs/Kconfig"
+  endmenu
+```
+  
+
+edit [linux]/fs/Makefile
+```
+  obj-$(CONFIG_FAT_FS)    += fat/
+ +obj-$(CONFIG_EXFAT_FS)  += exfat/
+  obj-$(CONFIG_BFS_FS)    += bfs/
+```
+
+	cd [linux]
+	make menuconfig
+
+Go to:
+> File systems > DOS/FAT/NT
+>   check exfat as MODULE (M)
+>   (437) Default codepage for exFAT
+>   (utf8) Default iocharset for exFAT
+
+> ESC to main menu
+> Save an Alternate Configuration File
+> ESC ESC
+
+build your kernel
+
+Have fun.
+
+
+Installing as a DKMS module:
+=================================
+
+You can have even more fun with exfat-nofuse by installing it as a DKMS module has the main advantage of being auto-compiled (and thus, possibly surviving) between kernel upgrades.
+
+First, get dkms. On Ubuntu this should be:
+
+	sudo apt install dkms
+
+Then copy the root of this repository to /usr/share:
+
+	sudo cp -R . /usr/src/exfat-1.2.8 (or whatever version number declared on dkms.conf is)
+	sudo dkms add -m exfat -v 1.2.8
+
+Build and load the module:
+
+	sudo dkms build -m exfat -v 1.2.8
+	sudo dkms install -m exfat -v 1.2.8
+
+Now you have a proper dkms module that will work for a long time... hopefully.
+
+
+
+Free Software for the Free Minds!
+=================================
diff --git a/fs/exfat/dkms.conf b/fs/exfat/dkms.conf
new file mode 100644
index 0000000000000000000000000000000000000000..d873c0aef4faae41cf6cc2a1fe56a52b855712ce
--- /dev/null
+++ b/fs/exfat/dkms.conf
@@ -0,0 +1,7 @@
+PACKAGE_NAME="exfat"
+PACKAGE_VERSION="1.2.8"
+MAKE="KDIR=/lib/modules/$kernelver/build MDIR=/lib/modules/$kernelver make"
+CLEAN="make clean"
+BUILT_MODULE_NAME[0]="exfat"
+AUTOINSTALL="yes"
+DEST_MODULE_LOCATION="/extra"
diff --git a/fs/exfat/exfat-km.mk b/fs/exfat/exfat-km.mk
new file mode 100644
index 0000000000000000000000000000000000000000..4e3ef07b36ece539fd14f6afbd0089bd1b495b51
--- /dev/null
+++ b/fs/exfat/exfat-km.mk
@@ -0,0 +1,11 @@
+EXFAT_FOLDER ?= external/exfat-nofuse
+
+EXFAT_MODULE:
+	make clean -C $(EXFAT_FOLDER) KDIR=$(KERNEL_OUT)
+	make -j8 -C $(EXFAT_FOLDER) ARCH=arm KDIR=$(KERNEL_OUT) \
+		$(if $(ARM_CROSS_COMPILE),$(ARM_CROSS_COMPILE),$(KERNEL_CROSS_COMPILE))
+	mv $(EXFAT_FOLDER)/exfat.ko $(KERNEL_MODULES_OUT)
+	$(if $(ARM_EABI_TOOLCHAIN),$(ARM_EABI_TOOLCHAIN)/arm-eabi-strip, \
+		$(KERNEL_TOOLCHAIN_PATH)strip) --strip-unneeded $(KERNEL_MODULES_OUT)/exfat.ko
+
+TARGET_KERNEL_MODULES += EXFAT_MODULE
diff --git a/fs/exfat/exfat_api.c b/fs/exfat/exfat_api.c
new file mode 100644
index 0000000000000000000000000000000000000000..32b29f0dd8d949b6f16a8d8cf0d6fff5f7e9475d
--- /dev/null
+++ b/fs/exfat/exfat_api.c
@@ -0,0 +1,528 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_api.c                                               */
+/*  PURPOSE : exFAT API Glue Layer                                      */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include <linux/version.h>
+#include <linux/module.h>
+#include <linux/init.h>
+
+#include "exfat_version.h"
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_super.h"
+#include "exfat_core.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions                                        */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Global Variable Definitions                                         */
+/*----------------------------------------------------------------------*/
+
+extern struct semaphore z_sem;
+
+/*----------------------------------------------------------------------*/
+/*  Local Variable Definitions                                          */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Local Function Declarations                                         */
+/*----------------------------------------------------------------------*/
+
+/*======================================================================*/
+/*  Global Function Definitions                                         */
+/*    - All functions for global use have same return value format,     */
+/*      that is, FFS_SUCCESS on success and several FS error code on    */
+/*      various error condition.                                        */
+/*======================================================================*/
+
+/*----------------------------------------------------------------------*/
+/*  exFAT Filesystem Init & Exit Functions                              */
+/*----------------------------------------------------------------------*/
+
+int FsInit(void)
+{
+	return ffsInit();
+}
+
+int FsShutdown(void)
+{
+	return ffsShutdown();
+}
+
+/*----------------------------------------------------------------------*/
+/*  Volume Management Functions                                         */
+/*----------------------------------------------------------------------*/
+
+/* FsMountVol : mount the file system volume */
+int FsMountVol(struct super_block *sb)
+{
+	int err;
+
+	sm_P(&z_sem);
+
+	err = buf_init(sb);
+	if (!err)
+		err = ffsMountVol(sb);
+	else
+		buf_shutdown(sb);
+
+	sm_V(&z_sem);
+
+	return err;
+} /* end of FsMountVol */
+
+/* FsUmountVol : unmount the file system volume */
+int FsUmountVol(struct super_block *sb)
+{
+	int err;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&z_sem);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsUmountVol(sb);
+	buf_shutdown(sb);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	sm_V(&z_sem);
+
+	return err;
+} /* end of FsUmountVol */
+
+/* FsGetVolInfo : get the information of a file system volume */
+int FsGetVolInfo(struct super_block *sb, VOL_INFO_T *info)
+{
+	int err;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if (info == NULL)
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsGetVolInfo(sb, info);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsGetVolInfo */
+
+/* FsSyncVol : synchronize a file system volume */
+int FsSyncVol(struct super_block *sb, int do_sync)
+{
+	int err;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsSyncVol(sb, do_sync);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsSyncVol */
+
+
+/*----------------------------------------------------------------------*/
+/*  File Operation Functions                                            */
+/*----------------------------------------------------------------------*/
+
+/* FsCreateFile : create a file */
+int FsLookupFile(struct inode *inode, char *path, FILE_ID_T *fid)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if ((fid == NULL) || (path == NULL) || (*path == '\0'))
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsLookupFile(inode, path, fid);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsLookupFile */
+
+/* FsCreateFile : create a file */
+int FsCreateFile(struct inode *inode, char *path, u8 mode, FILE_ID_T *fid)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if ((fid == NULL) || (path == NULL) || (*path == '\0'))
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsCreateFile(inode, path, mode, fid);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsCreateFile */
+
+int FsReadFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *rcount)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of the given file id */
+	if (fid == NULL)
+		return FFS_INVALIDFID;
+
+	/* check the validity of pointer parameters */
+	if (buffer == NULL)
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsReadFile(inode, fid, buffer, count, rcount);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsReadFile */
+
+int FsWriteFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *wcount)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of the given file id */
+	if (fid == NULL)
+		return FFS_INVALIDFID;
+
+	/* check the validity of pointer parameters */
+	if (buffer == NULL)
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsWriteFile(inode, fid, buffer, count, wcount);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsWriteFile */
+
+/* FsTruncateFile : resize the file length */
+int FsTruncateFile(struct inode *inode, u64 old_size, u64 new_size)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	DPRINTK("FsTruncateFile entered (inode %p size %llu)\n", inode, new_size);
+
+	err = ffsTruncateFile(inode, old_size, new_size);
+
+	DPRINTK("FsTruncateFile exitted (%d)\n", err);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsTruncateFile */
+
+/* FsMoveFile : move(rename) a old file into a new file */
+int FsMoveFile(struct inode *old_parent_inode, FILE_ID_T *fid, struct inode *new_parent_inode, struct dentry *new_dentry)
+{
+	int err;
+	struct super_block *sb = old_parent_inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of the given file id */
+	if (fid == NULL)
+		return FFS_INVALIDFID;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsMoveFile(old_parent_inode, fid, new_parent_inode, new_dentry);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsMoveFile */
+
+/* FsRemoveFile : remove a file */
+int FsRemoveFile(struct inode *inode, FILE_ID_T *fid)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of the given file id */
+	if (fid == NULL)
+		return FFS_INVALIDFID;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsRemoveFile(inode, fid);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsRemoveFile */
+
+/* FsSetAttr : set the attribute of a given file */
+int FsSetAttr(struct inode *inode, u32 attr)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsSetAttr(inode, attr);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsSetAttr */
+
+/* FsReadStat : get the information of a given file */
+int FsReadStat(struct inode *inode, DIR_ENTRY_T *info)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsGetStat(inode, info);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsReadStat */
+
+/* FsWriteStat : set the information of a given file */
+int FsWriteStat(struct inode *inode, DIR_ENTRY_T *info)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	DPRINTK("FsWriteStat entered (inode %p info %p\n", inode, info);
+
+	err = ffsSetStat(inode, info);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	DPRINTK("FsWriteStat exited (%d)\n", err);
+
+	return err;
+} /* end of FsWriteStat */
+
+/* FsMapCluster : return the cluster number in the given cluster offset */
+int FsMapCluster(struct inode *inode, s32 clu_offset, u32 *clu)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if (clu == NULL)
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsMapCluster(inode, clu_offset, clu);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsMapCluster */
+
+/*----------------------------------------------------------------------*/
+/*  Directory Operation Functions                                       */
+/*----------------------------------------------------------------------*/
+
+/* FsCreateDir : create(make) a directory */
+int FsCreateDir(struct inode *inode, char *path, FILE_ID_T *fid)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if ((fid == NULL) || (path == NULL) || (*path == '\0'))
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsCreateDir(inode, path, fid);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsCreateDir */
+
+/* FsReadDir : read a directory entry from the opened directory */
+int FsReadDir(struct inode *inode, DIR_ENTRY_T *dir_entry)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of pointer parameters */
+	if (dir_entry == NULL)
+		return FFS_ERROR;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsReadDir(inode, dir_entry);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsReadDir */
+
+/* FsRemoveDir : remove a directory */
+int FsRemoveDir(struct inode *inode, FILE_ID_T *fid)
+{
+	int err;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of the given file id */
+	if (fid == NULL)
+		return FFS_INVALIDFID;
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	err = ffsRemoveDir(inode, fid);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return err;
+} /* end of FsRemoveDir */
+
+EXPORT_SYMBOL(FsMountVol);
+EXPORT_SYMBOL(FsUmountVol);
+EXPORT_SYMBOL(FsGetVolInfo);
+EXPORT_SYMBOL(FsSyncVol);
+EXPORT_SYMBOL(FsLookupFile);
+EXPORT_SYMBOL(FsCreateFile);
+EXPORT_SYMBOL(FsReadFile);
+EXPORT_SYMBOL(FsWriteFile);
+EXPORT_SYMBOL(FsTruncateFile);
+EXPORT_SYMBOL(FsMoveFile);
+EXPORT_SYMBOL(FsRemoveFile);
+EXPORT_SYMBOL(FsSetAttr);
+EXPORT_SYMBOL(FsReadStat);
+EXPORT_SYMBOL(FsWriteStat);
+EXPORT_SYMBOL(FsMapCluster);
+EXPORT_SYMBOL(FsCreateDir);
+EXPORT_SYMBOL(FsReadDir);
+EXPORT_SYMBOL(FsRemoveDir);
+
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+/* FsReleaseCache: Release FAT & buf cache */
+int FsReleaseCache(struct super_block *sb)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* acquire the lock for file system critical section */
+	sm_P(&p_fs->v_sem);
+
+	FAT_release_all(sb);
+	buf_release_all(sb);
+
+	/* release the lock for file system critical section */
+	sm_V(&p_fs->v_sem);
+
+	return 0;
+}
+/* FsReleaseCache */
+
+EXPORT_SYMBOL(FsReleaseCache);
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+/*======================================================================*/
+/*  Local Function Definitions                                          */
+/*======================================================================*/
diff --git a/fs/exfat/exfat_api.h b/fs/exfat/exfat_api.h
new file mode 100644
index 0000000000000000000000000000000000000000..84bdf612a1e66cdaa5c05cc7ed8caccd31e60147
--- /dev/null
+++ b/fs/exfat/exfat_api.h
@@ -0,0 +1,206 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_api.h                                               */
+/*  PURPOSE : Header File for exFAT API Glue Layer                      */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_API_H
+#define _EXFAT_API_H
+
+#include <linux/fs.h>
+#include "exfat_config.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions                                        */
+/*----------------------------------------------------------------------*/
+
+#define EXFAT_SUPER_MAGIC       (0x2011BAB0L)
+#define EXFAT_ROOT_INO          1
+
+/* FAT types */
+#define FAT12                   0x01    /* FAT12 */
+#define FAT16                   0x0E    /* Win95 FAT16 (LBA) */
+#define FAT32                   0x0C    /* Win95 FAT32 (LBA) */
+#define EXFAT                   0x07    /* exFAT */
+
+/* file name lengths */
+#define MAX_CHARSET_SIZE        3       /* max size of multi-byte character	*/
+#define MAX_PATH_DEPTH          15      /* max depth of path name */
+#define MAX_NAME_LENGTH         256     /* max len of file name including NULL */
+#define MAX_PATH_LENGTH         260     /* max len of path name including NULL */
+#define DOS_NAME_LENGTH         11      /* DOS file name length excluding NULL */
+#define DOS_PATH_LENGTH         80      /* DOS path name length excluding NULL */
+
+/* file attributes */
+#define ATTR_NORMAL             0x0000
+#define ATTR_READONLY           0x0001
+#define ATTR_HIDDEN             0x0002
+#define ATTR_SYSTEM             0x0004
+#define ATTR_VOLUME             0x0008
+#define ATTR_SUBDIR             0x0010
+#define ATTR_ARCHIVE            0x0020
+#define ATTR_SYMLINK            0x0040
+#define ATTR_EXTEND             0x000F
+#define ATTR_RWMASK             0x007E
+
+/* file creation modes */
+#define FM_REGULAR              0x00
+#define FM_SYMLINK              0x40
+
+/* return values */
+#define FFS_SUCCESS             0
+#define FFS_MEDIAERR            1
+#define FFS_FORMATERR           2
+#define FFS_MOUNTED             3
+#define FFS_NOTMOUNTED          4
+#define FFS_ALIGNMENTERR        5
+#define FFS_SEMAPHOREERR        6
+#define FFS_INVALIDPATH         7
+#define FFS_INVALIDFID          8
+#define FFS_NOTFOUND            9
+#define FFS_FILEEXIST           10
+#define FFS_PERMISSIONERR       11
+#define FFS_NOTOPENED           12
+#define FFS_MAXOPENED           13
+#define FFS_FULL                14
+#define FFS_EOF                 15
+#define FFS_DIRBUSY             16
+#define FFS_MEMORYERR           17
+#define FFS_NAMETOOLONG		18
+#define FFS_ERROR               19
+
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+typedef struct {
+	u16      Year;
+	u16      Month;
+	u16      Day;
+	u16      Hour;
+	u16      Minute;
+	u16      Second;
+	u16      MilliSecond;
+} DATE_TIME_T;
+
+typedef struct {
+	u32      Offset;    /* start sector number of the partition */
+	u32      Size;      /* in sectors */
+} PART_INFO_T;
+
+typedef struct {
+	u32      SecSize;    /* sector size in bytes */
+	u32      DevSize;    /* block device size in sectors */
+} DEV_INFO_T;
+
+typedef struct {
+	u32      FatType;
+	u32      ClusterSize;
+	u32      NumClusters;
+	u32      FreeClusters;
+	u32      UsedClusters;
+} VOL_INFO_T;
+
+/* directory structure */
+typedef struct {
+	u32      dir;
+	s32       size;
+	u8       flags;
+} CHAIN_T;
+
+/* file id structure */
+typedef struct {
+	CHAIN_T     dir;
+	s32       entry;
+	u32      type;
+	u32      attr;
+	u32      start_clu;
+	u64      size;
+	u8       flags;
+	s64       rwoffset;
+	s32       hint_last_off;
+	u32      hint_last_clu;
+} FILE_ID_T;
+
+typedef struct {
+	char        Name[MAX_NAME_LENGTH * MAX_CHARSET_SIZE];
+	char        ShortName[DOS_NAME_LENGTH + 2];     /* used only for FAT12/16/32, not used for exFAT */
+	u32      Attr;
+	u64      Size;
+	u32      NumSubdirs;
+	DATE_TIME_T CreateTimestamp;
+	DATE_TIME_T ModifyTimestamp;
+	DATE_TIME_T AccessTimestamp;
+} DIR_ENTRY_T;
+
+/*======================================================================*/
+/*                                                                      */
+/*                     API FUNCTION DECLARATIONS                        */
+/*                  (CHANGE THIS PART IF REQUIRED)                      */
+/*                                                                      */
+/*======================================================================*/
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+/* file system initialization & shutdown functions */
+	int FsInit(void);
+	int FsShutdown(void);
+
+/* volume management functions */
+	int FsMountVol(struct super_block *sb);
+	int FsUmountVol(struct super_block *sb);
+	int FsGetVolInfo(struct super_block *sb, VOL_INFO_T *info);
+	int FsSyncVol(struct super_block *sb, int do_sync);
+
+/* file management functions */
+	int FsLookupFile(struct inode *inode, char *path, FILE_ID_T *fid);
+	int FsCreateFile(struct inode *inode, char *path, u8 mode, FILE_ID_T *fid);
+	int FsReadFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *rcount);
+	int FsWriteFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *wcount);
+	int FsTruncateFile(struct inode *inode, u64 old_size, u64 new_size);
+	int FsMoveFile(struct inode *old_parent_inode, FILE_ID_T *fid, struct inode *new_parent_inode, struct dentry *new_dentry);
+	int FsRemoveFile(struct inode *inode, FILE_ID_T *fid);
+	int FsSetAttr(struct inode *inode, u32 attr);
+	int FsReadStat(struct inode *inode, DIR_ENTRY_T *info);
+	int FsWriteStat(struct inode *inode, DIR_ENTRY_T *info);
+	int FsMapCluster(struct inode *inode, s32 clu_offset, u32 *clu);
+
+/* directory management functions */
+	int FsCreateDir(struct inode *inode, char *path, FILE_ID_T *fid);
+	int FsReadDir(struct inode *inode, DIR_ENTRY_T *dir_entry);
+	int FsRemoveDir(struct inode *inode, FILE_ID_T *fid);
+
+/* debug functions */
+s32 FsReleaseCache(struct super_block *sb);
+
+#endif /* _EXFAT_API_H */
diff --git a/fs/exfat/exfat_bitmap.c b/fs/exfat/exfat_bitmap.c
new file mode 100644
index 0000000000000000000000000000000000000000..b0672dd073fcfddbc4be448145aec74b39959982
--- /dev/null
+++ b/fs/exfat/exfat_bitmap.c
@@ -0,0 +1,63 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_global.c                                            */
+/*  PURPOSE : exFAT Miscellaneous Functions                             */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include "exfat_config.h"
+#include "exfat_bitmap.h"
+
+/*----------------------------------------------------------------------*/
+/*  Bitmap Manipulation Functions                                       */
+/*----------------------------------------------------------------------*/
+
+#define BITMAP_LOC(v)           ((v) >> 3)
+#define BITMAP_SHIFT(v)         ((v) & 0x07)
+
+s32 exfat_bitmap_test(u8 *bitmap, int i)
+{
+	u8 data;
+
+	data = bitmap[BITMAP_LOC(i)];
+	if ((data >> BITMAP_SHIFT(i)) & 0x01)
+		return 1;
+	return 0;
+} /* end of Bitmap_test */
+
+void exfat_bitmap_set(u8 *bitmap, int i)
+{
+	bitmap[BITMAP_LOC(i)] |= (0x01 << BITMAP_SHIFT(i));
+} /* end of Bitmap_set */
+
+void exfat_bitmap_clear(u8 *bitmap, int i)
+{
+	bitmap[BITMAP_LOC(i)] &= ~(0x01 << BITMAP_SHIFT(i));
+} /* end of Bitmap_clear */
diff --git a/fs/exfat/exfat_bitmap.h b/fs/exfat/exfat_bitmap.h
new file mode 100644
index 0000000000000000000000000000000000000000..4f482c7b28ccc6ab1f1a97fffc931faf2cd22fea
--- /dev/null
+++ b/fs/exfat/exfat_bitmap.h
@@ -0,0 +1,55 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_global.h                                            */
+/*  PURPOSE : Header File for exFAT Global Definitions & Misc Functions */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_BITMAP_H
+#define _EXFAT_BITMAP_H
+
+#include <linux/types.h>
+
+/*======================================================================*/
+/*                                                                      */
+/*       LIBRARY FUNCTION DECLARATIONS -- OTHER UTILITY FUNCTIONS       */
+/*                    (DO NOT CHANGE THIS PART !!)                      */
+/*                                                                      */
+/*======================================================================*/
+
+/*----------------------------------------------------------------------*/
+/*  Bitmap Manipulation Functions                                       */
+/*----------------------------------------------------------------------*/
+
+s32	exfat_bitmap_test(u8 *bitmap, int i);
+void	exfat_bitmap_set(u8 *bitmap, int i);
+void	exfat_bitmap_clear(u8 *bitmpa, int i);
+
+#endif /* _EXFAT_BITMAP_H */
diff --git a/fs/exfat/exfat_blkdev.c b/fs/exfat/exfat_blkdev.c
new file mode 100644
index 0000000000000000000000000000000000000000..eaccfd84e9f9bf12ec2adaa8251d9915563c3986
--- /dev/null
+++ b/fs/exfat/exfat_blkdev.c
@@ -0,0 +1,197 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_blkdev.c                                            */
+/*  PURPOSE : exFAT Block Device Driver Glue Layer                      */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include <linux/blkdev.h>
+#include <linux/log2.h>
+#include "exfat_config.h"
+#include "exfat_blkdev.h"
+#include "exfat_data.h"
+#include "exfat_api.h"
+#include "exfat_super.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions                                        */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Global Variable Definitions                                         */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Local Variable Definitions                                          */
+/*----------------------------------------------------------------------*/
+
+/*======================================================================*/
+/*  Function Definitions                                                */
+/*======================================================================*/
+
+s32 bdev_init(void)
+{
+	return FFS_SUCCESS;
+}
+
+s32 bdev_shutdown(void)
+{
+	return FFS_SUCCESS;
+}
+
+s32 bdev_open(struct super_block *sb)
+{
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_bd->opened)
+		return FFS_SUCCESS;
+
+	p_bd->sector_size      = bdev_logical_block_size(sb->s_bdev);
+	p_bd->sector_size_bits = ilog2(p_bd->sector_size);
+	p_bd->sector_size_mask = p_bd->sector_size - 1;
+	p_bd->num_sectors      = i_size_read(sb->s_bdev->bd_inode) >> p_bd->sector_size_bits;
+
+	p_bd->opened = TRUE;
+
+	return FFS_SUCCESS;
+}
+
+s32 bdev_close(struct super_block *sb)
+{
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (!p_bd->opened)
+		return FFS_SUCCESS;
+
+	p_bd->opened = FALSE;
+	return FFS_SUCCESS;
+}
+
+s32 bdev_read(struct super_block *sb, sector_t secno, struct buffer_head **bh, u32 num_secs, s32 read)
+{
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	long flags = sbi->debug_flags;
+
+	if (flags & EXFAT_DEBUGFLAGS_ERROR_RW)
+		return FFS_MEDIAERR;
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+	if (!p_bd->opened)
+		return FFS_MEDIAERR;
+
+	if (*bh)
+		__brelse(*bh);
+
+	if (read)
+		*bh = __bread(sb->s_bdev, secno, num_secs << p_bd->sector_size_bits);
+	else
+		*bh = __getblk(sb->s_bdev, secno, num_secs << p_bd->sector_size_bits);
+
+	if (*bh)
+		return FFS_SUCCESS;
+
+	WARN(!p_fs->dev_ejected,
+		"[EXFAT] No bh, device seems wrong or to be ejected.\n");
+
+	return FFS_MEDIAERR;
+}
+
+s32 bdev_write(struct super_block *sb, sector_t secno, struct buffer_head *bh, u32 num_secs, s32 sync)
+{
+	s32 count;
+	struct buffer_head *bh2;
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	long flags = sbi->debug_flags;
+
+	if (flags & EXFAT_DEBUGFLAGS_ERROR_RW)
+		return FFS_MEDIAERR;
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+	if (!p_bd->opened)
+		return FFS_MEDIAERR;
+
+	if (secno == bh->b_blocknr) {
+		lock_buffer(bh);
+		set_buffer_uptodate(bh);
+		mark_buffer_dirty(bh);
+		unlock_buffer(bh);
+		if (sync && (sync_dirty_buffer(bh) != 0))
+			return FFS_MEDIAERR;
+	} else {
+		count = num_secs << p_bd->sector_size_bits;
+
+		bh2 = __getblk(sb->s_bdev, secno, count);
+
+		if (bh2 == NULL)
+			goto no_bh;
+
+		lock_buffer(bh2);
+		memcpy(bh2->b_data, bh->b_data, count);
+		set_buffer_uptodate(bh2);
+		mark_buffer_dirty(bh2);
+		unlock_buffer(bh2);
+		if (sync && (sync_dirty_buffer(bh2) != 0)) {
+			__brelse(bh2);
+			goto no_bh;
+		}
+		__brelse(bh2);
+	}
+
+	return FFS_SUCCESS;
+
+no_bh:
+	WARN(!p_fs->dev_ejected,
+		"[EXFAT] No bh, device seems wrong or to be ejected.\n");
+
+	return FFS_MEDIAERR;
+}
+
+s32 bdev_sync(struct super_block *sb)
+{
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	long flags = sbi->debug_flags;
+
+	if (flags & EXFAT_DEBUGFLAGS_ERROR_RW)
+		return FFS_MEDIAERR;
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+	if (!p_bd->opened)
+		return FFS_MEDIAERR;
+
+	return sync_blockdev(sb->s_bdev);
+}
diff --git a/fs/exfat/exfat_blkdev.h b/fs/exfat/exfat_blkdev.h
new file mode 100644
index 0000000000000000000000000000000000000000..3363b591caebca468554b32b9cdd0b91e492dcca
--- /dev/null
+++ b/fs/exfat/exfat_blkdev.h
@@ -0,0 +1,73 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_blkdev.h                                            */
+/*  PURPOSE : Header File for exFAT Block Device Driver Glue Layer      */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_BLKDEV_H
+#define _EXFAT_BLKDEV_H
+
+#include <linux/fs.h>
+#include "exfat_config.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions (Non-Configurable)                     */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+typedef struct __BD_INFO_T {
+	s32 sector_size;      /* in bytes */
+	s32 sector_size_bits;
+	s32 sector_size_mask;
+	s32 num_sectors;      /* total number of sectors in this block device */
+	bool  opened;           /* opened or not */
+} BD_INFO_T;
+
+/*----------------------------------------------------------------------*/
+/*  External Variable Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+s32 bdev_init(void);
+s32 bdev_shutdown(void);
+s32 bdev_open(struct super_block *sb);
+s32 bdev_close(struct super_block *sb);
+s32 bdev_read(struct super_block *sb, sector_t secno, struct buffer_head **bh, u32 num_secs, s32 read);
+s32 bdev_write(struct super_block *sb, sector_t secno, struct buffer_head *bh, u32 num_secs, s32 sync);
+s32 bdev_sync(struct super_block *sb);
+
+#endif /* _EXFAT_BLKDEV_H */
diff --git a/fs/exfat/exfat_cache.c b/fs/exfat/exfat_cache.c
new file mode 100644
index 0000000000000000000000000000000000000000..4130102e373929de339c563ca95652a1db2ab73c
--- /dev/null
+++ b/fs/exfat/exfat_cache.c
@@ -0,0 +1,784 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_cache.c                                             */
+/*  PURPOSE : exFAT Cache Manager                                       */
+/*            (FAT Cache & Buffer Cache)                                */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Sung-Kwan Kim] : first writing                        */
+/*                                                                      */
+/************************************************************************/
+
+#include "exfat_config.h"
+#include "exfat_data.h"
+
+#include "exfat_cache.h"
+#include "exfat_super.h"
+#include "exfat_core.h"
+
+/*----------------------------------------------------------------------*/
+/*  Global Variable Definitions                                         */
+/*----------------------------------------------------------------------*/
+
+#define sm_P(s)
+#define sm_V(s)
+
+static s32 __FAT_read(struct super_block *sb, u32 loc, u32 *content);
+static s32 __FAT_write(struct super_block *sb, u32 loc, u32 content);
+
+static BUF_CACHE_T *FAT_cache_find(struct super_block *sb, sector_t sec);
+static BUF_CACHE_T *FAT_cache_get(struct super_block *sb, sector_t sec);
+static void FAT_cache_insert_hash(struct super_block *sb, BUF_CACHE_T *bp);
+static void FAT_cache_remove_hash(BUF_CACHE_T *bp);
+
+static u8 *__buf_getblk(struct super_block *sb, sector_t sec);
+
+static BUF_CACHE_T *buf_cache_find(struct super_block *sb, sector_t sec);
+static BUF_CACHE_T *buf_cache_get(struct super_block *sb, sector_t sec);
+static void buf_cache_insert_hash(struct super_block *sb, BUF_CACHE_T *bp);
+static void buf_cache_remove_hash(BUF_CACHE_T *bp);
+
+static void push_to_mru(BUF_CACHE_T *bp, BUF_CACHE_T *list);
+static void push_to_lru(BUF_CACHE_T *bp, BUF_CACHE_T *list);
+static void move_to_mru(BUF_CACHE_T *bp, BUF_CACHE_T *list);
+static void move_to_lru(BUF_CACHE_T *bp, BUF_CACHE_T *list);
+
+/*======================================================================*/
+/*  Cache Initialization Functions                                      */
+/*======================================================================*/
+
+s32 buf_init(struct super_block *sb)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	int i;
+
+	/* LRU list */
+	p_fs->FAT_cache_lru_list.next = p_fs->FAT_cache_lru_list.prev = &p_fs->FAT_cache_lru_list;
+
+	for (i = 0; i < FAT_CACHE_SIZE; i++) {
+		p_fs->FAT_cache_array[i].drv = -1;
+		p_fs->FAT_cache_array[i].sec = ~0;
+		p_fs->FAT_cache_array[i].flag = 0;
+		p_fs->FAT_cache_array[i].buf_bh = NULL;
+		p_fs->FAT_cache_array[i].prev = p_fs->FAT_cache_array[i].next = NULL;
+		push_to_mru(&(p_fs->FAT_cache_array[i]), &p_fs->FAT_cache_lru_list);
+	}
+
+	p_fs->buf_cache_lru_list.next = p_fs->buf_cache_lru_list.prev = &p_fs->buf_cache_lru_list;
+
+	for (i = 0; i < BUF_CACHE_SIZE; i++) {
+		p_fs->buf_cache_array[i].drv = -1;
+		p_fs->buf_cache_array[i].sec = ~0;
+		p_fs->buf_cache_array[i].flag = 0;
+		p_fs->buf_cache_array[i].buf_bh = NULL;
+		p_fs->buf_cache_array[i].prev = p_fs->buf_cache_array[i].next = NULL;
+		push_to_mru(&(p_fs->buf_cache_array[i]), &p_fs->buf_cache_lru_list);
+	}
+
+	/* HASH list */
+	for (i = 0; i < FAT_CACHE_HASH_SIZE; i++) {
+		p_fs->FAT_cache_hash_list[i].drv = -1;
+		p_fs->FAT_cache_hash_list[i].sec = ~0;
+		p_fs->FAT_cache_hash_list[i].hash_next = p_fs->FAT_cache_hash_list[i].hash_prev = &(p_fs->FAT_cache_hash_list[i]);
+	}
+
+	for (i = 0; i < FAT_CACHE_SIZE; i++)
+		FAT_cache_insert_hash(sb, &(p_fs->FAT_cache_array[i]));
+
+	for (i = 0; i < BUF_CACHE_HASH_SIZE; i++) {
+		p_fs->buf_cache_hash_list[i].drv = -1;
+		p_fs->buf_cache_hash_list[i].sec = ~0;
+		p_fs->buf_cache_hash_list[i].hash_next = p_fs->buf_cache_hash_list[i].hash_prev = &(p_fs->buf_cache_hash_list[i]);
+	}
+
+	for (i = 0; i < BUF_CACHE_SIZE; i++)
+		buf_cache_insert_hash(sb, &(p_fs->buf_cache_array[i]));
+
+	return FFS_SUCCESS;
+} /* end of buf_init */
+
+s32 buf_shutdown(struct super_block *sb)
+{
+	return FFS_SUCCESS;
+} /* end of buf_shutdown */
+
+/*======================================================================*/
+/*  FAT Read/Write Functions                                            */
+/*======================================================================*/
+
+/* in : sb, loc
+  * out: content
+  * returns 0 on success
+  *            -1 on error
+  */
+s32 FAT_read(struct super_block *sb, u32 loc, u32 *content)
+{
+	s32 ret;
+
+	sm_P(&f_sem);
+
+	ret = __FAT_read(sb, loc, content);
+
+	sm_V(&f_sem);
+
+	return ret;
+} /* end of FAT_read */
+
+s32 FAT_write(struct super_block *sb, u32 loc, u32 content)
+{
+	s32 ret;
+
+	sm_P(&f_sem);
+
+	ret = __FAT_write(sb, loc, content);
+
+	sm_V(&f_sem);
+
+	return ret;
+} /* end of FAT_write */
+
+static s32 __FAT_read(struct super_block *sb, u32 loc, u32 *content)
+{
+	s32 off;
+	u32 _content;
+	sector_t sec;
+	u8 *fat_sector, *fat_entry;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_fs->vol_type == FAT12) {
+		sec = p_fs->FAT1_start_sector + ((loc + (loc >> 1)) >> p_bd->sector_size_bits);
+		off = (loc + (loc >> 1)) & p_bd->sector_size_mask;
+
+		if (off == (p_bd->sector_size-1)) {
+			fat_sector = FAT_getblk(sb, sec);
+			if (!fat_sector)
+				return -1;
+
+			_content  = (u32) fat_sector[off];
+
+			fat_sector = FAT_getblk(sb, ++sec);
+			if (!fat_sector)
+				return -1;
+
+			_content |= (u32) fat_sector[0] << 8;
+		} else {
+			fat_sector = FAT_getblk(sb, sec);
+			if (!fat_sector)
+				return -1;
+
+			fat_entry = &(fat_sector[off]);
+			_content = GET16(fat_entry);
+		}
+
+		if (loc & 1)
+			_content >>= 4;
+
+		_content &= 0x00000FFF;
+
+		if (_content >= CLUSTER_16(0x0FF8)) {
+			*content = CLUSTER_32(~0);
+			return 0;
+		} else {
+			*content = CLUSTER_32(_content);
+			return 0;
+		}
+	} else if (p_fs->vol_type == FAT16) {
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-1));
+		off = (loc << 1) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+
+		_content = GET16_A(fat_entry);
+
+		_content &= 0x0000FFFF;
+
+		if (_content >= CLUSTER_16(0xFFF8)) {
+			*content = CLUSTER_32(~0);
+			return 0;
+		} else {
+			*content = CLUSTER_32(_content);
+			return 0;
+		}
+	} else if (p_fs->vol_type == FAT32) {
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-2));
+		off = (loc << 2) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+
+		_content = GET32_A(fat_entry);
+
+		_content &= 0x0FFFFFFF;
+
+		if (_content >= CLUSTER_32(0x0FFFFFF8)) {
+			*content = CLUSTER_32(~0);
+			return 0;
+		} else {
+			*content = CLUSTER_32(_content);
+			return 0;
+		}
+	} else {
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-2));
+		off = (loc << 2) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+		_content = GET32_A(fat_entry);
+
+		if (_content >= CLUSTER_32(0xFFFFFFF8)) {
+			*content = CLUSTER_32(~0);
+			return 0;
+		} else {
+			*content = CLUSTER_32(_content);
+			return 0;
+		}
+	}
+
+	*content = CLUSTER_32(~0);
+	return 0;
+} /* end of __FAT_read */
+
+static s32 __FAT_write(struct super_block *sb, u32 loc, u32 content)
+{
+	s32 off;
+	sector_t sec;
+	u8 *fat_sector, *fat_entry;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_fs->vol_type == FAT12) {
+
+		content &= 0x00000FFF;
+
+		sec = p_fs->FAT1_start_sector + ((loc + (loc >> 1)) >> p_bd->sector_size_bits);
+		off = (loc + (loc >> 1)) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		if (loc & 1) { /* odd */
+
+			content <<= 4;
+
+			if (off == (p_bd->sector_size-1)) {
+				fat_sector[off] = (u8)(content | (fat_sector[off] & 0x0F));
+				FAT_modify(sb, sec);
+
+				fat_sector = FAT_getblk(sb, ++sec);
+				if (!fat_sector)
+					return -1;
+
+				fat_sector[0] = (u8)(content >> 8);
+			} else {
+				fat_entry = &(fat_sector[off]);
+				content |= GET16(fat_entry) & 0x000F;
+
+				SET16(fat_entry, content);
+			}
+		} else { /* even */
+			fat_sector[off] = (u8)(content);
+
+			if (off == (p_bd->sector_size-1)) {
+				fat_sector[off] = (u8)(content);
+				FAT_modify(sb, sec);
+
+				fat_sector = FAT_getblk(sb, ++sec);
+				fat_sector[0] = (u8)((fat_sector[0] & 0xF0) | (content >> 8));
+			} else {
+				fat_entry = &(fat_sector[off]);
+				content |= GET16(fat_entry) & 0xF000;
+
+				SET16(fat_entry, content);
+			}
+		}
+	}
+
+	else if (p_fs->vol_type == FAT16) {
+
+		content &= 0x0000FFFF;
+
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-1));
+		off = (loc << 1) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+
+		SET16_A(fat_entry, content);
+	}
+
+	else if (p_fs->vol_type == FAT32) {
+
+		content &= 0x0FFFFFFF;
+
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-2));
+		off = (loc << 2) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+
+		content |= GET32_A(fat_entry) & 0xF0000000;
+
+		SET32_A(fat_entry, content);
+	}
+
+	else { /* p_fs->vol_type == EXFAT */
+
+		sec = p_fs->FAT1_start_sector + (loc >> (p_bd->sector_size_bits-2));
+		off = (loc << 2) & p_bd->sector_size_mask;
+
+		fat_sector = FAT_getblk(sb, sec);
+		if (!fat_sector)
+			return -1;
+
+		fat_entry = &(fat_sector[off]);
+
+		SET32_A(fat_entry, content);
+	}
+
+	FAT_modify(sb, sec);
+	return 0;
+} /* end of __FAT_write */
+
+u8 *FAT_getblk(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	bp = FAT_cache_find(sb, sec);
+	if (bp != NULL) {
+		move_to_mru(bp, &p_fs->FAT_cache_lru_list);
+		return bp->buf_bh->b_data;
+	}
+
+	bp = FAT_cache_get(sb, sec);
+
+	FAT_cache_remove_hash(bp);
+
+	bp->drv = p_fs->drv;
+	bp->sec = sec;
+	bp->flag = 0;
+
+	FAT_cache_insert_hash(sb, bp);
+
+	if (sector_read(sb, sec, &(bp->buf_bh), 1) != FFS_SUCCESS) {
+		FAT_cache_remove_hash(bp);
+		bp->drv = -1;
+		bp->sec = ~0;
+		bp->flag = 0;
+		bp->buf_bh = NULL;
+
+		move_to_lru(bp, &p_fs->FAT_cache_lru_list);
+		return NULL;
+	}
+
+	return bp->buf_bh->b_data;
+} /* end of FAT_getblk */
+
+void FAT_modify(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+
+	bp = FAT_cache_find(sb, sec);
+	if (bp != NULL)
+		sector_write(sb, sec, bp->buf_bh, 0);
+} /* end of FAT_modify */
+
+void FAT_release_all(struct super_block *sb)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&f_sem);
+
+	bp = p_fs->FAT_cache_lru_list.next;
+	while (bp != &p_fs->FAT_cache_lru_list) {
+		if (bp->drv == p_fs->drv) {
+			bp->drv = -1;
+			bp->sec = ~0;
+			bp->flag = 0;
+
+			if (bp->buf_bh) {
+				__brelse(bp->buf_bh);
+				bp->buf_bh = NULL;
+			}
+		}
+		bp = bp->next;
+	}
+
+	sm_V(&f_sem);
+} /* end of FAT_release_all */
+
+void FAT_sync(struct super_block *sb)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&f_sem);
+
+	bp = p_fs->FAT_cache_lru_list.next;
+	while (bp != &p_fs->FAT_cache_lru_list) {
+		if ((bp->drv == p_fs->drv) && (bp->flag & DIRTYBIT)) {
+			sync_dirty_buffer(bp->buf_bh);
+			bp->flag &= ~(DIRTYBIT);
+		}
+		bp = bp->next;
+	}
+
+	sm_V(&f_sem);
+} /* end of FAT_sync */
+
+static BUF_CACHE_T *FAT_cache_find(struct super_block *sb, sector_t sec)
+{
+	s32 off;
+	BUF_CACHE_T *bp, *hp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	off = (sec + (sec >> p_fs->sectors_per_clu_bits)) & (FAT_CACHE_HASH_SIZE - 1);
+
+	hp = &(p_fs->FAT_cache_hash_list[off]);
+	for (bp = hp->hash_next; bp != hp; bp = bp->hash_next) {
+		if ((bp->drv == p_fs->drv) && (bp->sec == sec)) {
+
+			WARN(!bp->buf_bh, "[EXFAT] FAT_cache has no bh. "
+					  "It will make system panic.\n");
+
+			touch_buffer(bp->buf_bh);
+			return bp;
+		}
+	}
+	return NULL;
+} /* end of FAT_cache_find */
+
+static BUF_CACHE_T *FAT_cache_get(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	bp = p_fs->FAT_cache_lru_list.prev;
+
+
+	move_to_mru(bp, &p_fs->FAT_cache_lru_list);
+	return bp;
+} /* end of FAT_cache_get */
+
+static void FAT_cache_insert_hash(struct super_block *sb, BUF_CACHE_T *bp)
+{
+	s32 off;
+	BUF_CACHE_T *hp;
+	FS_INFO_T *p_fs;
+
+	p_fs = &(EXFAT_SB(sb)->fs_info);
+	off = (bp->sec + (bp->sec >> p_fs->sectors_per_clu_bits)) & (FAT_CACHE_HASH_SIZE-1);
+
+	hp = &(p_fs->FAT_cache_hash_list[off]);
+	bp->hash_next = hp->hash_next;
+	bp->hash_prev = hp;
+	hp->hash_next->hash_prev = bp;
+	hp->hash_next = bp;
+} /* end of FAT_cache_insert_hash */
+
+static void FAT_cache_remove_hash(BUF_CACHE_T *bp)
+{
+	(bp->hash_prev)->hash_next = bp->hash_next;
+	(bp->hash_next)->hash_prev = bp->hash_prev;
+} /* end of FAT_cache_remove_hash */
+
+/*======================================================================*/
+/*  Buffer Read/Write Functions                                         */
+/*======================================================================*/
+
+u8 *buf_getblk(struct super_block *sb, sector_t sec)
+{
+	u8 *buf;
+
+	sm_P(&b_sem);
+
+	buf = __buf_getblk(sb, sec);
+
+	sm_V(&b_sem);
+
+	return buf;
+} /* end of buf_getblk */
+
+static u8 *__buf_getblk(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	bp = buf_cache_find(sb, sec);
+	if (bp != NULL) {
+		move_to_mru(bp, &p_fs->buf_cache_lru_list);
+		return bp->buf_bh->b_data;
+	}
+
+	bp = buf_cache_get(sb, sec);
+
+	buf_cache_remove_hash(bp);
+
+	bp->drv = p_fs->drv;
+	bp->sec = sec;
+	bp->flag = 0;
+
+	buf_cache_insert_hash(sb, bp);
+
+	if (sector_read(sb, sec, &(bp->buf_bh), 1) != FFS_SUCCESS) {
+		buf_cache_remove_hash(bp);
+		bp->drv = -1;
+		bp->sec = ~0;
+		bp->flag = 0;
+		bp->buf_bh = NULL;
+
+		move_to_lru(bp, &p_fs->buf_cache_lru_list);
+		return NULL;
+	}
+
+	return bp->buf_bh->b_data;
+
+} /* end of __buf_getblk */
+
+void buf_modify(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+
+	sm_P(&b_sem);
+
+	bp = buf_cache_find(sb, sec);
+	if (likely(bp != NULL))
+		sector_write(sb, sec, bp->buf_bh, 0);
+
+	WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n",
+	     (unsigned long long)sec);
+
+	sm_V(&b_sem);
+} /* end of buf_modify */
+
+void buf_lock(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+
+	sm_P(&b_sem);
+
+	bp = buf_cache_find(sb, sec);
+	if (likely(bp != NULL))
+		bp->flag |= LOCKBIT;
+
+	WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n",
+	     (unsigned long long)sec);
+
+	sm_V(&b_sem);
+} /* end of buf_lock */
+
+void buf_unlock(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+
+	sm_P(&b_sem);
+
+	bp = buf_cache_find(sb, sec);
+	if (likely(bp != NULL))
+		bp->flag &= ~(LOCKBIT);
+
+	WARN(!bp, "[EXFAT] failed to find buffer_cache(sector:%llu).\n",
+	     (unsigned long long)sec);
+
+	sm_V(&b_sem);
+} /* end of buf_unlock */
+
+void buf_release(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&b_sem);
+
+	bp = buf_cache_find(sb, sec);
+	if (likely(bp != NULL)) {
+		bp->drv = -1;
+		bp->sec = ~0;
+		bp->flag = 0;
+
+		if (bp->buf_bh) {
+			__brelse(bp->buf_bh);
+			bp->buf_bh = NULL;
+		}
+
+		move_to_lru(bp, &p_fs->buf_cache_lru_list);
+	}
+
+	sm_V(&b_sem);
+} /* end of buf_release */
+
+void buf_release_all(struct super_block *sb)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&b_sem);
+
+	bp = p_fs->buf_cache_lru_list.next;
+	while (bp != &p_fs->buf_cache_lru_list) {
+		if (bp->drv == p_fs->drv) {
+			bp->drv = -1;
+			bp->sec = ~0;
+			bp->flag = 0;
+
+			if (bp->buf_bh) {
+				__brelse(bp->buf_bh);
+				bp->buf_bh = NULL;
+			}
+		}
+		bp = bp->next;
+	}
+
+	sm_V(&b_sem);
+} /* end of buf_release_all */
+
+void buf_sync(struct super_block *sb)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	sm_P(&b_sem);
+
+	bp = p_fs->buf_cache_lru_list.next;
+	while (bp != &p_fs->buf_cache_lru_list) {
+		if ((bp->drv == p_fs->drv) && (bp->flag & DIRTYBIT)) {
+			sync_dirty_buffer(bp->buf_bh);
+			bp->flag &= ~(DIRTYBIT);
+		}
+		bp = bp->next;
+	}
+
+	sm_V(&b_sem);
+} /* end of buf_sync */
+
+static BUF_CACHE_T *buf_cache_find(struct super_block *sb, sector_t sec)
+{
+	s32 off;
+	BUF_CACHE_T *bp, *hp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	off = (sec + (sec >> p_fs->sectors_per_clu_bits)) & (BUF_CACHE_HASH_SIZE - 1);
+
+	hp = &(p_fs->buf_cache_hash_list[off]);
+	for (bp = hp->hash_next; bp != hp; bp = bp->hash_next) {
+		if ((bp->drv == p_fs->drv) && (bp->sec == sec)) {
+			touch_buffer(bp->buf_bh);
+			return bp;
+		}
+	}
+	return NULL;
+} /* end of buf_cache_find */
+
+static BUF_CACHE_T *buf_cache_get(struct super_block *sb, sector_t sec)
+{
+	BUF_CACHE_T *bp;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	bp = p_fs->buf_cache_lru_list.prev;
+	while (bp->flag & LOCKBIT)
+		bp = bp->prev;
+
+
+	move_to_mru(bp, &p_fs->buf_cache_lru_list);
+	return bp;
+} /* end of buf_cache_get */
+
+static void buf_cache_insert_hash(struct super_block *sb, BUF_CACHE_T *bp)
+{
+	s32 off;
+	BUF_CACHE_T *hp;
+	FS_INFO_T *p_fs;
+
+	p_fs = &(EXFAT_SB(sb)->fs_info);
+	off = (bp->sec + (bp->sec >> p_fs->sectors_per_clu_bits)) & (BUF_CACHE_HASH_SIZE-1);
+
+	hp = &(p_fs->buf_cache_hash_list[off]);
+	bp->hash_next = hp->hash_next;
+	bp->hash_prev = hp;
+	hp->hash_next->hash_prev = bp;
+	hp->hash_next = bp;
+} /* end of buf_cache_insert_hash */
+
+static void buf_cache_remove_hash(BUF_CACHE_T *bp)
+{
+	(bp->hash_prev)->hash_next = bp->hash_next;
+	(bp->hash_next)->hash_prev = bp->hash_prev;
+} /* end of buf_cache_remove_hash */
+
+/*======================================================================*/
+/*  Local Function Definitions                                          */
+/*======================================================================*/
+
+static void push_to_mru(BUF_CACHE_T *bp, BUF_CACHE_T *list)
+{
+	bp->next = list->next;
+	bp->prev = list;
+	list->next->prev = bp;
+	list->next = bp;
+} /* end of buf_cache_push_to_mru */
+
+static void push_to_lru(BUF_CACHE_T *bp, BUF_CACHE_T *list)
+{
+	bp->prev = list->prev;
+	bp->next = list;
+	list->prev->next = bp;
+	list->prev = bp;
+} /* end of buf_cache_push_to_lru */
+
+static void move_to_mru(BUF_CACHE_T *bp, BUF_CACHE_T *list)
+{
+	bp->prev->next = bp->next;
+	bp->next->prev = bp->prev;
+	push_to_mru(bp, list);
+} /* end of buf_cache_move_to_mru */
+
+static void move_to_lru(BUF_CACHE_T *bp, BUF_CACHE_T *list)
+{
+	bp->prev->next = bp->next;
+	bp->next->prev = bp->prev;
+	push_to_lru(bp, list);
+} /* end of buf_cache_move_to_lru */
diff --git a/fs/exfat/exfat_cache.h b/fs/exfat/exfat_cache.h
new file mode 100644
index 0000000000000000000000000000000000000000..540e31681d047078022555432889c6052aee88d0
--- /dev/null
+++ b/fs/exfat/exfat_cache.h
@@ -0,0 +1,85 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_cache.h                                             */
+/*  PURPOSE : Header File for exFAT Cache Manager                       */
+/*            (FAT Cache & Buffer Cache)                                */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Sung-Kwan Kim] : first writing                        */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_CACHE_H
+#define _EXFAT_CACHE_H
+
+#include <linux/fs.h>
+#include <linux/types.h>
+#include "exfat_config.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions                                        */
+/*----------------------------------------------------------------------*/
+
+#define LOCKBIT                 0x01
+#define DIRTYBIT                0x02
+
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+typedef struct __BUF_CACHE_T {
+	struct __BUF_CACHE_T *next;
+	struct __BUF_CACHE_T *prev;
+	struct __BUF_CACHE_T *hash_next;
+	struct __BUF_CACHE_T *hash_prev;
+	s32                drv;
+	sector_t          sec;
+	u32               flag;
+	struct buffer_head   *buf_bh;
+} BUF_CACHE_T;
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+s32  buf_init(struct super_block *sb);
+s32  buf_shutdown(struct super_block *sb);
+s32  FAT_read(struct super_block *sb, u32 loc, u32 *content);
+s32  FAT_write(struct super_block *sb, u32 loc, u32 content);
+u8 *FAT_getblk(struct super_block *sb, sector_t sec);
+void   FAT_modify(struct super_block *sb, sector_t sec);
+void   FAT_release_all(struct super_block *sb);
+void   FAT_sync(struct super_block *sb);
+u8 *buf_getblk(struct super_block *sb, sector_t sec);
+void   buf_modify(struct super_block *sb, sector_t sec);
+void   buf_lock(struct super_block *sb, sector_t sec);
+void   buf_unlock(struct super_block *sb, sector_t sec);
+void   buf_release(struct super_block *sb, sector_t sec);
+void   buf_release_all(struct super_block *sb);
+void   buf_sync(struct super_block *sb);
+
+#endif /* _EXFAT_CACHE_H */
diff --git a/fs/exfat/exfat_config.h b/fs/exfat/exfat_config.h
new file mode 100644
index 0000000000000000000000000000000000000000..33c6525e449bdf059a220cbb2286bf02cae1cc22
--- /dev/null
+++ b/fs/exfat/exfat_config.h
@@ -0,0 +1,69 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_config.h                                            */
+/*  PURPOSE : Header File for exFAT Configuable Policies                */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_CONFIG_H
+#define _EXFAT_CONFIG_H
+
+/*======================================================================*/
+/*                                                                      */
+/*                        FFS CONFIGURATIONS                            */
+/*                  (CHANGE THIS PART IF REQUIRED)                      */
+/*                                                                      */
+/*======================================================================*/
+
+/*----------------------------------------------------------------------*/
+/* Feature Config                                                       */
+/*----------------------------------------------------------------------*/
+#ifndef CONFIG_EXFAT_DISCARD
+#define CONFIG_EXFAT_DISCARD		1	/* mount option -o discard support */
+#endif
+
+#ifndef CONFIG_EXFAT_DELAYED_SYNC
+#define CONFIG_EXFAT_DELAYED_SYNC 0
+#endif
+
+#ifndef CONFIG_EXFAT_KERNEL_DEBUG
+#define CONFIG_EXFAT_KERNEL_DEBUG	1	/* kernel debug features via ioctl */
+#endif
+
+#ifndef CONFIG_EXFAT_DEBUG_MSG
+#define CONFIG_EXFAT_DEBUG_MSG		0	/* debugging message on/off */
+#endif
+
+#ifndef CONFIG_EXFAT_DEFAULT_CODEPAGE
+#define CONFIG_EXFAT_DEFAULT_CODEPAGE	437
+#define CONFIG_EXFAT_DEFAULT_IOCHARSET	"utf8"
+#endif
+
+#endif /* _EXFAT_CONFIG_H */
diff --git a/fs/exfat/exfat_core.c b/fs/exfat/exfat_core.c
new file mode 100644
index 0000000000000000000000000000000000000000..143b72155ef9e075c215ff1b5ecbb22cbfeff61a
--- /dev/null
+++ b/fs/exfat/exfat_core.c
@@ -0,0 +1,5138 @@
+/* Some of the source code in this file came from "linux/fs/fat/misc.c".  */
+/*
+ *  linux/fs/fat/misc.c
+ *
+ *  Written 1992,1993 by Werner Almesberger
+ *  22/11/2000 - Fixed fat_date_unix2dos for dates earlier than 01/01/1980
+ *         and date_dos2unix for date==0 by Igor Zhbanov(bsg@uniyar.ac.ru)
+ */
+
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_core.c                                              */
+/*  PURPOSE : exFAT File Manager                                        */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include <linux/version.h>
+#include <linux/param.h>
+#include <linux/log2.h>
+
+#include "exfat_bitmap.h"
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+#include "exfat_blkdev.h"
+#include "exfat_cache.h"
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_super.h"
+#include "exfat_core.h"
+
+#include <linux/blkdev.h>
+#include <linux/slab.h>
+
+static void __set_sb_dirty(struct super_block *sb)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	sb->s_dirt = 1;
+#else
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	sbi->s_dirt = 1;
+#endif
+}
+
+/*----------------------------------------------------------------------*/
+/*  Global Variable Definitions                                         */
+/*----------------------------------------------------------------------*/
+
+extern u8 uni_upcase[];
+
+/*----------------------------------------------------------------------*/
+/*  Local Variable Definitions                                          */
+/*----------------------------------------------------------------------*/
+
+static u8 name_buf[MAX_PATH_LENGTH * MAX_CHARSET_SIZE];
+
+static char *reserved_names[] = {
+	"AUX     ", "CON     ", "NUL     ", "PRN     ",
+	"COM1    ", "COM2    ", "COM3    ", "COM4    ",
+	"COM5    ", "COM6    ", "COM7    ", "COM8    ", "COM9    ",
+	"LPT1    ", "LPT2    ", "LPT3    ", "LPT4    ",
+	"LPT5    ", "LPT6    ", "LPT7    ", "LPT8    ", "LPT9    ",
+	NULL
+};
+
+static u8 free_bit[] = {
+	0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, /*   0 ~  19 */
+	0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3, /*  20 ~  39 */
+	0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /*  40 ~  59 */
+	0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, /*  60 ~  79 */
+	0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, 0, 1, 0, 2, /*  80 ~  99 */
+	0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, /* 100 ~ 119 */
+	0, 1, 0, 2, 0, 1, 0, 7, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /* 120 ~ 139 */
+	0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 5, /* 140 ~ 159 */
+	0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, /* 160 ~ 179 */
+	0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 6, 0, 1, 0, 2, 0, 1, 0, 3, /* 180 ~ 199 */
+	0, 1, 0, 2, 0, 1, 0, 4, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, /* 200 ~ 219 */
+	0, 1, 0, 5, 0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0, 4, /* 220 ~ 239 */
+	0, 1, 0, 2, 0, 1, 0, 3, 0, 1, 0, 2, 0, 1, 0                 /* 240 ~ 254 */
+};
+
+static u8 used_bit[] = {
+	0, 1, 1, 2, 1, 2, 2, 3, 1, 2, 2, 3, 2, 3, 3, 4, 1, 2, 2, 3, /*   0 ~  19 */
+	2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5, 1, 2, 2, 3, 2, 3, 3, 4, /*  20 ~  39 */
+	2, 3, 3, 4, 3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, /*  40 ~  59 */
+	4, 5, 5, 6, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, 3, 4, 4, 5, /*  60 ~  79 */
+	2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 2, 3, 3, 4, /*  80 ~  99 */
+	3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6, /* 100 ~ 119 */
+	4, 5, 5, 6, 5, 6, 6, 7, 1, 2, 2, 3, 2, 3, 3, 4, 2, 3, 3, 4, /* 120 ~ 139 */
+	3, 4, 4, 5, 2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, /* 140 ~ 159 */
+	2, 3, 3, 4, 3, 4, 4, 5, 3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, /* 160 ~ 179 */
+	4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7, 2, 3, 3, 4, 3, 4, 4, 5, /* 180 ~ 199 */
+	3, 4, 4, 5, 4, 5, 5, 6, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, /* 200 ~ 219 */
+	5, 6, 6, 7, 3, 4, 4, 5, 4, 5, 5, 6, 4, 5, 5, 6, 5, 6, 6, 7, /* 220 ~ 239 */
+	4, 5, 5, 6, 5, 6, 6, 7, 5, 6, 6, 7, 6, 7, 7, 8              /* 240 ~ 255 */
+};
+
+/*======================================================================*/
+/*  Global Function Definitions                                         */
+/*======================================================================*/
+
+/* ffsInit : roll back to the initial state of the file system */
+s32 ffsInit(void)
+{
+	s32 ret;
+
+	ret = bdev_init();
+	if (ret)
+		return ret;
+
+	ret = fs_init();
+	if (ret)
+		return ret;
+
+	return FFS_SUCCESS;
+} /* end of ffsInit */
+
+/* ffsShutdown : make free all memory-alloced global buffers */
+s32 ffsShutdown(void)
+{
+	s32 ret;
+	ret = fs_shutdown();
+	if (ret)
+		return ret;
+
+	ret = bdev_shutdown();
+	if (ret)
+		return ret;
+
+	return FFS_SUCCESS;
+} /* end of ffsShutdown */
+
+/* ffsMountVol : mount the file system volume */
+s32 ffsMountVol(struct super_block *sb)
+{
+	int i, ret;
+	PBR_SECTOR_T *p_pbr;
+	struct buffer_head *tmp_bh = NULL;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	printk("[EXFAT] trying to mount...\n");
+
+	sm_init(&p_fs->v_sem);
+	p_fs->dev_ejected = FALSE;
+
+	/* open the block device */
+	if (bdev_open(sb))
+		return FFS_MEDIAERR;
+
+	if (p_bd->sector_size < sb->s_blocksize)
+		return FFS_MEDIAERR;
+	if (p_bd->sector_size > sb->s_blocksize)
+		sb_set_blocksize(sb, p_bd->sector_size);
+
+	/* read Sector 0 */
+	if (sector_read(sb, 0, &tmp_bh, 1) != FFS_SUCCESS)
+		return FFS_MEDIAERR;
+
+	p_fs->PBR_sector = 0;
+
+	p_pbr = (PBR_SECTOR_T *) tmp_bh->b_data;
+
+	/* check the validity of PBR */
+	if (GET16_A(p_pbr->signature) != PBR_SIGNATURE) {
+		brelse(tmp_bh);
+		bdev_close(sb);
+		return FFS_FORMATERR;
+	}
+
+	/* fill fs_stuct */
+	for (i = 0; i < 53; i++)
+		if (p_pbr->bpb[i])
+			break;
+
+	if (i < 53) {
+		if (GET16(p_pbr->bpb+11)) /* num_fat_sectors */
+			ret = fat16_mount(sb, p_pbr);
+		else
+			ret = fat32_mount(sb, p_pbr);
+	} else {
+		ret = exfat_mount(sb, p_pbr);
+	}
+
+	brelse(tmp_bh);
+
+	if (ret) {
+		bdev_close(sb);
+		return ret;
+	}
+
+	if (p_fs->vol_type == EXFAT) {
+		ret = load_alloc_bitmap(sb);
+		if (ret) {
+			bdev_close(sb);
+			return ret;
+		}
+		ret = load_upcase_table(sb);
+		if (ret) {
+			free_alloc_bitmap(sb);
+			bdev_close(sb);
+			return ret;
+		}
+	}
+
+	if (p_fs->dev_ejected) {
+		if (p_fs->vol_type == EXFAT) {
+			free_upcase_table(sb);
+			free_alloc_bitmap(sb);
+		}
+		bdev_close(sb);
+		return FFS_MEDIAERR;
+	}
+
+	printk("[EXFAT] mounted successfully\n");
+
+	return FFS_SUCCESS;
+} /* end of ffsMountVol */
+
+/* ffsUmountVol : umount the file system volume */
+s32 ffsUmountVol(struct super_block *sb)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	printk("[EXFAT] trying to unmount...\n");
+
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+
+	if (p_fs->vol_type == EXFAT) {
+		free_upcase_table(sb);
+		free_alloc_bitmap(sb);
+	}
+
+	FAT_release_all(sb);
+	buf_release_all(sb);
+
+	/* close the block device */
+	bdev_close(sb);
+
+	if (p_fs->dev_ejected) {
+		printk("[EXFAT] unmounted with media errors. "
+			"device's already ejected.\n");
+		return FFS_MEDIAERR;
+	}
+
+	printk("[EXFAT] unmounted successfully\n");
+
+	return FFS_SUCCESS;
+} /* end of ffsUmountVol */
+
+/* ffsGetVolInfo : get the information of a file system volume */
+s32 ffsGetVolInfo(struct super_block *sb, VOL_INFO_T *info)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_fs->used_clusters == (u32) ~0)
+		p_fs->used_clusters = p_fs->fs_func->count_used_clusters(sb);
+
+	info->FatType = p_fs->vol_type;
+	info->ClusterSize = p_fs->cluster_size;
+	info->NumClusters = p_fs->num_clusters - 2; /* clu 0 & 1 */
+	info->UsedClusters = p_fs->used_clusters;
+	info->FreeClusters = info->NumClusters - info->UsedClusters;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsGetVolInfo */
+
+/* ffsSyncVol : synchronize all file system volumes */
+s32 ffsSyncVol(struct super_block *sb, s32 do_sync)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* synchronize the file system */
+	fs_sync(sb, do_sync);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsSyncVol */
+
+/*----------------------------------------------------------------------*/
+/*  File Operation Functions                                            */
+/*----------------------------------------------------------------------*/
+
+/* ffsLookupFile : lookup a file */
+s32 ffsLookupFile(struct inode *inode, char *path, FILE_ID_T *fid)
+{
+	s32 ret, dentry, num_entries;
+	CHAIN_T dir;
+	UNI_NAME_T uni_name;
+	DOS_NAME_T dos_name;
+	DENTRY_T *ep, *ep2;
+	ENTRY_SET_CACHE_T *es = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	DPRINTK("ffsLookupFile entered\n");
+
+	/* check the validity of directory name in the given pathname */
+	ret = resolve_path(inode, path, &dir, &uni_name);
+	if (ret)
+		return ret;
+
+	ret = get_num_entries_and_dos_name(sb, &dir, &uni_name, &num_entries, &dos_name);
+	if (ret)
+		return ret;
+
+	/* search the file name for directories */
+	dentry = p_fs->fs_func->find_dir_entry(sb, &dir, &uni_name, num_entries, &dos_name, TYPE_ALL);
+	if (dentry < -1)
+		return FFS_NOTFOUND;
+
+	fid->dir.dir = dir.dir;
+	fid->dir.size = dir.size;
+	fid->dir.flags = dir.flags;
+	fid->entry = dentry;
+
+	if (dentry == -1) {
+		fid->type = TYPE_DIR;
+		fid->rwoffset = 0;
+		fid->hint_last_off = -1;
+
+		fid->attr = ATTR_SUBDIR;
+		fid->flags = 0x01;
+		fid->size = 0;
+		fid->start_clu = p_fs->root_dir;
+	} else {
+		if (p_fs->vol_type == EXFAT) {
+			es = get_entry_set_in_dir(sb, &dir, dentry, ES_2_ENTRIES, &ep);
+			if (!es)
+				return FFS_MEDIAERR;
+			ep2 = ep+1;
+		} else {
+			ep = get_entry_in_dir(sb, &dir, dentry, NULL);
+			if (!ep)
+				return FFS_MEDIAERR;
+			ep2 = ep;
+		}
+
+		fid->type = p_fs->fs_func->get_entry_type(ep);
+		fid->rwoffset = 0;
+		fid->hint_last_off = -1;
+		fid->attr = p_fs->fs_func->get_entry_attr(ep);
+
+		fid->size = p_fs->fs_func->get_entry_size(ep2);
+		if ((fid->type == TYPE_FILE) && (fid->size == 0)) {
+			fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+			fid->start_clu = CLUSTER_32(~0);
+		} else {
+			fid->flags = p_fs->fs_func->get_entry_flag(ep2);
+			fid->start_clu = p_fs->fs_func->get_entry_clu0(ep2);
+		}
+
+		if (p_fs->vol_type == EXFAT)
+			release_entry_set(es);
+	}
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	DPRINTK("ffsLookupFile exited successfully\n");
+
+	return FFS_SUCCESS;
+} /* end of ffsLookupFile */
+
+/* ffsCreateFile : create a file */
+s32 ffsCreateFile(struct inode *inode, char *path, u8 mode, FILE_ID_T *fid)
+{
+	s32 ret/*, dentry*/;
+	CHAIN_T dir;
+	UNI_NAME_T uni_name;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	/* check the validity of directory name in the given pathname */
+	ret = resolve_path(inode, path, &dir, &uni_name);
+	if (ret)
+		return ret;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	/* create a new file */
+	ret = create_file(inode, &dir, &uni_name, mode, fid);
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return ret;
+} /* end of ffsCreateFile */
+
+/* ffsReadFile : read data from a opened file */
+s32 ffsReadFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *rcount)
+{
+	s32 offset, sec_offset, clu_offset;
+	u32 clu;
+	sector_t LogSector;
+	u64 oneblkread, read_bytes;
+	struct buffer_head *tmp_bh = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	/* check if the given file ID is opened */
+	if (fid->type != TYPE_FILE)
+		return FFS_PERMISSIONERR;
+
+	if (fid->rwoffset > fid->size)
+		fid->rwoffset = fid->size;
+
+	if (count > (fid->size - fid->rwoffset))
+		count = fid->size - fid->rwoffset;
+
+	if (count == 0) {
+		if (rcount != NULL)
+			*rcount = 0;
+		return FFS_EOF;
+	}
+
+	read_bytes = 0;
+
+	while (count > 0) {
+		clu_offset = (s32)(fid->rwoffset >> p_fs->cluster_size_bits);
+		clu = fid->start_clu;
+
+		if (fid->flags == 0x03) {
+			clu += clu_offset;
+		} else {
+			/* hint information */
+			if ((clu_offset > 0) && (fid->hint_last_off > 0) &&
+				(clu_offset >= fid->hint_last_off)) {
+				clu_offset -= fid->hint_last_off;
+				clu = fid->hint_last_clu;
+			}
+
+			while (clu_offset > 0) {
+				/* clu = FAT_read(sb, clu); */
+				if (FAT_read(sb, clu, &clu) == -1)
+					return FFS_MEDIAERR;
+
+				clu_offset--;
+			}
+		}
+
+		/* hint information */
+		fid->hint_last_off = (s32)(fid->rwoffset >> p_fs->cluster_size_bits);
+		fid->hint_last_clu = clu;
+
+		offset = (s32)(fid->rwoffset & (p_fs->cluster_size-1)); /* byte offset in cluster   */
+		sec_offset = offset >> p_bd->sector_size_bits;            /* sector offset in cluster */
+		offset &= p_bd->sector_size_mask;                         /* byte offset in sector    */
+
+		LogSector = START_SECTOR(clu) + sec_offset;
+
+		oneblkread = (u64)(p_bd->sector_size - offset);
+		if (oneblkread > count)
+			oneblkread = count;
+
+		if ((offset == 0) && (oneblkread == p_bd->sector_size)) {
+			if (sector_read(sb, LogSector, &tmp_bh, 1) != FFS_SUCCESS)
+				goto err_out;
+			memcpy(((char *) buffer)+read_bytes, ((char *) tmp_bh->b_data), (s32) oneblkread);
+		} else {
+			if (sector_read(sb, LogSector, &tmp_bh, 1) != FFS_SUCCESS)
+				goto err_out;
+			memcpy(((char *) buffer)+read_bytes, ((char *) tmp_bh->b_data)+offset, (s32) oneblkread);
+		}
+		count -= oneblkread;
+		read_bytes += oneblkread;
+		fid->rwoffset += oneblkread;
+	}
+	brelse(tmp_bh);
+
+err_out:
+	/* set the size of read bytes */
+	if (rcount != NULL)
+		*rcount = read_bytes;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsReadFile */
+
+/* ffsWriteFile : write data into a opened file */
+s32 ffsWriteFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *wcount)
+{
+	s32 modified = FALSE, offset, sec_offset, clu_offset;
+	s32 num_clusters, num_alloc, num_alloced = (s32) ~0;
+	u32 clu, last_clu;
+	sector_t LogSector, sector = 0;
+	u64 oneblkwrite, write_bytes;
+	CHAIN_T new_clu;
+	TIMESTAMP_T tm;
+	DENTRY_T *ep, *ep2;
+	ENTRY_SET_CACHE_T *es = NULL;
+	struct buffer_head *tmp_bh = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	/* check if the given file ID is opened */
+	if (fid->type != TYPE_FILE)
+		return FFS_PERMISSIONERR;
+
+	if (fid->rwoffset > fid->size)
+		fid->rwoffset = fid->size;
+
+	if (count == 0) {
+		if (wcount != NULL)
+			*wcount = 0;
+		return FFS_SUCCESS;
+	}
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	if (fid->size == 0)
+		num_clusters = 0;
+	else
+		num_clusters = (s32)((fid->size-1) >> p_fs->cluster_size_bits) + 1;
+
+	write_bytes = 0;
+
+	while (count > 0) {
+		clu_offset = (s32)(fid->rwoffset >> p_fs->cluster_size_bits);
+		clu = last_clu = fid->start_clu;
+
+		if (fid->flags == 0x03) {
+			if ((clu_offset > 0) && (clu != CLUSTER_32(~0))) {
+				last_clu += clu_offset - 1;
+
+				if (clu_offset == num_clusters)
+					clu = CLUSTER_32(~0);
+				else
+					clu += clu_offset;
+			}
+		} else {
+			/* hint information */
+			if ((clu_offset > 0) && (fid->hint_last_off > 0) &&
+				(clu_offset >= fid->hint_last_off)) {
+				clu_offset -= fid->hint_last_off;
+				clu = fid->hint_last_clu;
+			}
+
+			while ((clu_offset > 0) && (clu != CLUSTER_32(~0))) {
+				last_clu = clu;
+				/* clu = FAT_read(sb, clu); */
+				if (FAT_read(sb, clu, &clu) == -1)
+					return FFS_MEDIAERR;
+
+				clu_offset--;
+			}
+		}
+
+		if (clu == CLUSTER_32(~0)) {
+			num_alloc = (s32)((count-1) >> p_fs->cluster_size_bits) + 1;
+			new_clu.dir = (last_clu == CLUSTER_32(~0)) ? CLUSTER_32(~0) : last_clu+1;
+			new_clu.size = 0;
+			new_clu.flags = fid->flags;
+
+			/* (1) allocate a chain of clusters */
+			num_alloced = p_fs->fs_func->alloc_cluster(sb, num_alloc, &new_clu);
+			if (num_alloced == 0)
+				break;
+			else if (num_alloced < 0)
+				return FFS_MEDIAERR;
+
+			/* (2) append to the FAT chain */
+			if (last_clu == CLUSTER_32(~0)) {
+				if (new_clu.flags == 0x01)
+					fid->flags = 0x01;
+				fid->start_clu = new_clu.dir;
+				modified = TRUE;
+			} else {
+				if (new_clu.flags != fid->flags) {
+					exfat_chain_cont_cluster(sb, fid->start_clu, num_clusters);
+					fid->flags = 0x01;
+					modified = TRUE;
+				}
+				if (new_clu.flags == 0x01)
+					FAT_write(sb, last_clu, new_clu.dir);
+			}
+
+			num_clusters += num_alloced;
+			clu = new_clu.dir;
+		}
+
+		/* hint information */
+		fid->hint_last_off = (s32)(fid->rwoffset >> p_fs->cluster_size_bits);
+		fid->hint_last_clu = clu;
+
+		offset = (s32)(fid->rwoffset & (p_fs->cluster_size-1)); /* byte offset in cluster   */
+		sec_offset = offset >> p_bd->sector_size_bits;            /* sector offset in cluster */
+		offset &= p_bd->sector_size_mask;                         /* byte offset in sector    */
+
+		LogSector = START_SECTOR(clu) + sec_offset;
+
+		oneblkwrite = (u64)(p_bd->sector_size - offset);
+		if (oneblkwrite > count)
+			oneblkwrite = count;
+
+		if ((offset == 0) && (oneblkwrite == p_bd->sector_size)) {
+			if (sector_read(sb, LogSector, &tmp_bh, 0) != FFS_SUCCESS)
+				goto err_out;
+			memcpy(((char *) tmp_bh->b_data), ((char *) buffer)+write_bytes, (s32) oneblkwrite);
+			if (sector_write(sb, LogSector, tmp_bh, 0) != FFS_SUCCESS) {
+				brelse(tmp_bh);
+				goto err_out;
+			}
+		} else {
+			if ((offset > 0) || ((fid->rwoffset+oneblkwrite) < fid->size)) {
+				if (sector_read(sb, LogSector, &tmp_bh, 1) != FFS_SUCCESS)
+					goto err_out;
+			} else {
+				if (sector_read(sb, LogSector, &tmp_bh, 0) != FFS_SUCCESS)
+					goto err_out;
+			}
+
+			memcpy(((char *) tmp_bh->b_data)+offset, ((char *) buffer)+write_bytes, (s32) oneblkwrite);
+			if (sector_write(sb, LogSector, tmp_bh, 0) != FFS_SUCCESS) {
+				brelse(tmp_bh);
+				goto err_out;
+			}
+		}
+
+		count -= oneblkwrite;
+		write_bytes += oneblkwrite;
+		fid->rwoffset += oneblkwrite;
+
+		fid->attr |= ATTR_ARCHIVE;
+
+		if (fid->size < fid->rwoffset) {
+			fid->size = fid->rwoffset;
+			modified = TRUE;
+		}
+	}
+
+	brelse(tmp_bh);
+
+	/* (3) update the direcoty entry */
+	if (p_fs->vol_type == EXFAT) {
+		es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_ALL_ENTRIES, &ep);
+		if (es == NULL)
+			goto err_out;
+		ep2 = ep+1;
+	} else {
+		ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+		if (!ep)
+			goto err_out;
+		ep2 = ep;
+	}
+
+	p_fs->fs_func->set_entry_time(ep, tm_current(&tm), TM_MODIFY);
+	p_fs->fs_func->set_entry_attr(ep, fid->attr);
+
+	if (p_fs->vol_type != EXFAT)
+		buf_modify(sb, sector);
+
+	if (modified) {
+		if (p_fs->fs_func->get_entry_flag(ep2) != fid->flags)
+			p_fs->fs_func->set_entry_flag(ep2, fid->flags);
+
+		if (p_fs->fs_func->get_entry_size(ep2) != fid->size)
+			p_fs->fs_func->set_entry_size(ep2, fid->size);
+
+		if (p_fs->fs_func->get_entry_clu0(ep2) != fid->start_clu)
+			p_fs->fs_func->set_entry_clu0(ep2, fid->start_clu);
+
+		if (p_fs->vol_type != EXFAT)
+			buf_modify(sb, sector);
+	}
+
+	if (p_fs->vol_type == EXFAT) {
+		update_dir_checksum_with_entry_set(sb, es);
+		release_entry_set(es);
+	}
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+err_out:
+	/* set the size of written bytes */
+	if (wcount != NULL)
+		*wcount = write_bytes;
+
+	if (num_alloced == 0)
+		return FFS_FULL;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsWriteFile */
+
+/* ffsTruncateFile : resize the file length */
+s32 ffsTruncateFile(struct inode *inode, u64 old_size, u64 new_size)
+{
+	s32 num_clusters;
+	u32 last_clu = CLUSTER_32(0);
+	sector_t sector = 0;
+	CHAIN_T clu;
+	TIMESTAMP_T tm;
+	DENTRY_T *ep, *ep2;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+	ENTRY_SET_CACHE_T *es = NULL;
+
+	/* check if the given file ID is opened */
+	if (fid->type != TYPE_FILE)
+		return FFS_PERMISSIONERR;
+
+	if (fid->size != old_size) {
+		printk(KERN_ERR "[EXFAT] truncate : can't skip it because of "
+				"size-mismatch(old:%lld->fid:%lld).\n"
+				,old_size, fid->size);
+	}
+
+	if (old_size <= new_size)
+		return FFS_SUCCESS;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	clu.dir = fid->start_clu;
+	clu.size = (s32)((old_size-1) >> p_fs->cluster_size_bits) + 1;
+	clu.flags = fid->flags;
+
+	if (new_size > 0) {
+		num_clusters = (s32)((new_size-1) >> p_fs->cluster_size_bits) + 1;
+
+		if (clu.flags == 0x03) {
+			clu.dir += num_clusters;
+		} else {
+			while (num_clusters > 0) {
+				last_clu = clu.dir;
+				if (FAT_read(sb, clu.dir, &(clu.dir)) == -1)
+					return FFS_MEDIAERR;
+				num_clusters--;
+			}
+		}
+
+		clu.size -= num_clusters;
+	}
+
+	fid->size = new_size;
+	fid->attr |= ATTR_ARCHIVE;
+	if (new_size == 0) {
+		fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+		fid->start_clu = CLUSTER_32(~0);
+	}
+
+	/* (1) update the directory entry */
+	if (p_fs->vol_type == EXFAT) {
+		es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_ALL_ENTRIES, &ep);
+		if (es == NULL)
+			return FFS_MEDIAERR;
+		ep2 = ep+1;
+	} else {
+		ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+		if (!ep)
+			return FFS_MEDIAERR;
+		ep2 = ep;
+	}
+
+	p_fs->fs_func->set_entry_time(ep, tm_current(&tm), TM_MODIFY);
+	p_fs->fs_func->set_entry_attr(ep, fid->attr);
+
+	p_fs->fs_func->set_entry_size(ep2, new_size);
+	if (new_size == 0) {
+		p_fs->fs_func->set_entry_flag(ep2, 0x01);
+		p_fs->fs_func->set_entry_clu0(ep2, CLUSTER_32(0));
+	}
+
+	if (p_fs->vol_type != EXFAT)
+		buf_modify(sb, sector);
+	else {
+		update_dir_checksum_with_entry_set(sb, es);
+		release_entry_set(es);
+	}
+
+	/* (2) cut off from the FAT chain */
+	if (last_clu != CLUSTER_32(0)) {
+		if (fid->flags == 0x01)
+			FAT_write(sb, last_clu, CLUSTER_32(~0));
+	}
+
+	/* (3) free the clusters */
+	p_fs->fs_func->free_cluster(sb, &clu, 0);
+
+	/* hint information */
+	fid->hint_last_off = -1;
+	if (fid->rwoffset > fid->size)
+		fid->rwoffset = fid->size;
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsTruncateFile */
+
+static void update_parent_info(FILE_ID_T *fid, struct inode *parent_inode)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(parent_inode->i_sb)->fs_info);
+	FILE_ID_T *parent_fid = &(EXFAT_I(parent_inode)->fid);
+
+	if (unlikely((parent_fid->flags != fid->dir.flags)
+		|| (parent_fid->size != (fid->dir.size<<p_fs->cluster_size_bits))
+		|| (parent_fid->start_clu != fid->dir.dir))) {
+
+		fid->dir.dir = parent_fid->start_clu;
+		fid->dir.flags = parent_fid->flags;
+		fid->dir.size = ((parent_fid->size + (p_fs->cluster_size-1))
+						>> p_fs->cluster_size_bits);
+	}
+}
+
+/* ffsMoveFile : move(rename) a old file into a new file */
+s32 ffsMoveFile(struct inode *old_parent_inode, FILE_ID_T *fid, struct inode *new_parent_inode, struct dentry *new_dentry)
+{
+	s32 ret;
+	s32 dentry;
+	CHAIN_T olddir, newdir;
+	CHAIN_T *p_dir = NULL;
+	UNI_NAME_T uni_name;
+	DENTRY_T *ep;
+	struct super_block *sb = old_parent_inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	u8 *new_path = (u8 *) new_dentry->d_name.name;
+	struct inode *new_inode = new_dentry->d_inode;
+	int num_entries;
+	FILE_ID_T *new_fid = NULL;
+	s32 new_entry = 0;
+
+	/* check the validity of pointer parameters */
+	if ((new_path == NULL) || (*new_path == '\0'))
+		return FFS_ERROR;
+
+	update_parent_info(fid, old_parent_inode);
+
+	olddir.dir = fid->dir.dir;
+	olddir.size = fid->dir.size;
+	olddir.flags = fid->dir.flags;
+
+	dentry = fid->entry;
+
+	/* check if the old file is "." or ".." */
+	if (p_fs->vol_type != EXFAT) {
+		if ((olddir.dir != p_fs->root_dir) && (dentry < 2))
+			return FFS_PERMISSIONERR;
+	}
+
+	ep = get_entry_in_dir(sb, &olddir, dentry, NULL);
+	if (!ep)
+		return FFS_MEDIAERR;
+
+	if (p_fs->fs_func->get_entry_attr(ep) & ATTR_READONLY)
+		return FFS_PERMISSIONERR;
+
+	/* check whether new dir is existing directory and empty */
+	if (new_inode) {
+		u32 entry_type;
+
+		ret = FFS_MEDIAERR;
+		new_fid = &EXFAT_I(new_inode)->fid;
+
+		update_parent_info(new_fid, new_parent_inode);
+
+		p_dir = &(new_fid->dir);
+		new_entry = new_fid->entry;
+		ep = get_entry_in_dir(sb, p_dir, new_entry, NULL);
+		if (!ep)
+			goto out;
+
+		entry_type = p_fs->fs_func->get_entry_type(ep);
+
+		if (entry_type == TYPE_DIR) {
+			CHAIN_T new_clu;
+			new_clu.dir = new_fid->start_clu;
+			new_clu.size = (s32)((new_fid->size-1) >> p_fs->cluster_size_bits) + 1;
+			new_clu.flags = new_fid->flags;
+
+			if (!is_dir_empty(sb, &new_clu))
+				return FFS_FILEEXIST;
+		}
+	}
+
+	/* check the validity of directory name in the given new pathname */
+	ret = resolve_path(new_parent_inode, new_path, &newdir, &uni_name);
+	if (ret)
+		return ret;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	if (olddir.dir == newdir.dir)
+		ret = rename_file(new_parent_inode, &olddir, dentry, &uni_name, fid);
+	else
+		ret = move_file(new_parent_inode, &olddir, dentry, &newdir, &uni_name, fid);
+
+	if ((ret == FFS_SUCCESS) && new_inode) {
+		/* delete entries of new_dir */
+		ep = get_entry_in_dir(sb, p_dir, new_entry, NULL);
+		if (!ep)
+			goto out;
+
+		num_entries = p_fs->fs_func->count_ext_entries(sb, p_dir, new_entry, ep);
+		if (num_entries < 0)
+			goto out;
+		p_fs->fs_func->delete_dir_entry(sb, p_dir, new_entry, 0, num_entries+1);
+	}
+out:
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return ret;
+} /* end of ffsMoveFile */
+
+/* ffsRemoveFile : remove a file */
+s32 ffsRemoveFile(struct inode *inode, FILE_ID_T *fid)
+{
+	s32 dentry;
+	CHAIN_T dir, clu_to_free;
+	DENTRY_T *ep;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	dir.dir = fid->dir.dir;
+	dir.size = fid->dir.size;
+	dir.flags = fid->dir.flags;
+
+	dentry = fid->entry;
+
+	ep = get_entry_in_dir(sb, &dir, dentry, NULL);
+	if (!ep)
+		return FFS_MEDIAERR;
+
+	if (p_fs->fs_func->get_entry_attr(ep) & ATTR_READONLY)
+		return FFS_PERMISSIONERR;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	/* (1) update the directory entry */
+	remove_file(inode, &dir, dentry);
+
+	clu_to_free.dir = fid->start_clu;
+	clu_to_free.size = (s32)((fid->size-1) >> p_fs->cluster_size_bits) + 1;
+	clu_to_free.flags = fid->flags;
+
+	/* (2) free the clusters */
+	p_fs->fs_func->free_cluster(sb, &clu_to_free, 0);
+
+	fid->size = 0;
+	fid->start_clu = CLUSTER_32(~0);
+	fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsRemoveFile */
+
+/* ffsSetAttr : set the attribute of a given file */
+s32 ffsSetAttr(struct inode *inode, u32 attr)
+{
+	u32 type;
+	sector_t sector = 0;
+	DENTRY_T *ep;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+	u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0;
+	ENTRY_SET_CACHE_T *es = NULL;
+
+	if (fid->attr == attr) {
+		if (p_fs->dev_ejected)
+			return FFS_MEDIAERR;
+		return FFS_SUCCESS;
+	}
+
+	if (is_dir) {
+		if ((fid->dir.dir == p_fs->root_dir) &&
+			(fid->entry == -1)) {
+			if (p_fs->dev_ejected)
+				return FFS_MEDIAERR;
+			return FFS_SUCCESS;
+		}
+	}
+
+	/* get the directory entry of given file */
+	if (p_fs->vol_type == EXFAT) {
+		es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_ALL_ENTRIES, &ep);
+		if (es == NULL)
+			return FFS_MEDIAERR;
+	} else {
+		ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+		if (!ep)
+			return FFS_MEDIAERR;
+	}
+
+	type = p_fs->fs_func->get_entry_type(ep);
+
+	if (((type == TYPE_FILE) && (attr & ATTR_SUBDIR)) ||
+		((type == TYPE_DIR) && (!(attr & ATTR_SUBDIR)))) {
+		s32 err;
+		if (p_fs->dev_ejected)
+			err = FFS_MEDIAERR;
+		else
+			err = FFS_ERROR;
+
+		if (p_fs->vol_type == EXFAT)
+			release_entry_set(es);
+		return err;
+	}
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	/* set the file attribute */
+	fid->attr = attr;
+	p_fs->fs_func->set_entry_attr(ep, attr);
+
+	if (p_fs->vol_type != EXFAT)
+		buf_modify(sb, sector);
+	else {
+		update_dir_checksum_with_entry_set(sb, es);
+		release_entry_set(es);
+	}
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsSetAttr */
+
+/* ffsGetStat : get the information of a given file */
+s32 ffsGetStat(struct inode *inode, DIR_ENTRY_T *info)
+{
+	sector_t sector = 0;
+	s32 count;
+	CHAIN_T dir;
+	UNI_NAME_T uni_name;
+	TIMESTAMP_T tm;
+	DENTRY_T *ep, *ep2;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+	ENTRY_SET_CACHE_T *es = NULL;
+	u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0;
+
+	DPRINTK("ffsGetStat entered\n");
+
+	if (is_dir) {
+		if ((fid->dir.dir == p_fs->root_dir) &&
+			(fid->entry == -1)) {
+			info->Attr = ATTR_SUBDIR;
+			memset((char *) &info->CreateTimestamp, 0, sizeof(DATE_TIME_T));
+			memset((char *) &info->ModifyTimestamp, 0, sizeof(DATE_TIME_T));
+			memset((char *) &info->AccessTimestamp, 0, sizeof(DATE_TIME_T));
+			strcpy(info->ShortName, ".");
+			strcpy(info->Name, ".");
+
+			dir.dir = p_fs->root_dir;
+			dir.flags = 0x01;
+
+			if (p_fs->root_dir == CLUSTER_32(0)) /* FAT16 root_dir */
+				info->Size = p_fs->dentries_in_root << DENTRY_SIZE_BITS;
+			else
+				info->Size = count_num_clusters(sb, &dir) << p_fs->cluster_size_bits;
+
+			count = count_dos_name_entries(sb, &dir, TYPE_DIR);
+			if (count < 0)
+				return FFS_MEDIAERR;
+			info->NumSubdirs = count;
+
+			if (p_fs->dev_ejected)
+				return FFS_MEDIAERR;
+			return FFS_SUCCESS;
+		}
+	}
+
+	/* get the directory entry of given file or directory */
+	if (p_fs->vol_type == EXFAT) {
+		es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_2_ENTRIES, &ep);
+		if (es == NULL)
+			return FFS_MEDIAERR;
+		ep2 = ep+1;
+	} else {
+		ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+		if (!ep)
+			return FFS_MEDIAERR;
+		ep2 = ep;
+		buf_lock(sb, sector);
+	}
+
+	/* set FILE_INFO structure using the acquired DENTRY_T */
+	info->Attr = p_fs->fs_func->get_entry_attr(ep);
+
+	p_fs->fs_func->get_entry_time(ep, &tm, TM_CREATE);
+	info->CreateTimestamp.Year = tm.year;
+	info->CreateTimestamp.Month = tm.mon;
+	info->CreateTimestamp.Day = tm.day;
+	info->CreateTimestamp.Hour = tm.hour;
+	info->CreateTimestamp.Minute = tm.min;
+	info->CreateTimestamp.Second = tm.sec;
+	info->CreateTimestamp.MilliSecond = 0;
+
+	p_fs->fs_func->get_entry_time(ep, &tm, TM_MODIFY);
+	info->ModifyTimestamp.Year = tm.year;
+	info->ModifyTimestamp.Month = tm.mon;
+	info->ModifyTimestamp.Day = tm.day;
+	info->ModifyTimestamp.Hour = tm.hour;
+	info->ModifyTimestamp.Minute = tm.min;
+	info->ModifyTimestamp.Second = tm.sec;
+	info->ModifyTimestamp.MilliSecond = 0;
+
+	memset((char *) &info->AccessTimestamp, 0, sizeof(DATE_TIME_T));
+
+	*(uni_name.name) = 0x0;
+	/* XXX this is very bad for exfat cuz name is already included in es.
+	 API should be revised */
+	p_fs->fs_func->get_uni_name_from_ext_entry(sb, &(fid->dir), fid->entry, uni_name.name);
+	if (*(uni_name.name) == 0x0 && p_fs->vol_type != EXFAT)
+		get_uni_name_from_dos_entry(sb, (DOS_DENTRY_T *) ep, &uni_name, 0x1);
+	nls_uniname_to_cstring(sb, info->Name, &uni_name);
+
+	if (p_fs->vol_type == EXFAT) {
+		info->NumSubdirs = 2;
+	} else {
+		buf_unlock(sb, sector);
+		get_uni_name_from_dos_entry(sb, (DOS_DENTRY_T *) ep, &uni_name, 0x0);
+		nls_uniname_to_cstring(sb, info->ShortName, &uni_name);
+		info->NumSubdirs = 0;
+	}
+
+	info->Size = p_fs->fs_func->get_entry_size(ep2);
+
+	if (p_fs->vol_type == EXFAT)
+		release_entry_set(es);
+
+	if (is_dir) {
+		dir.dir = fid->start_clu;
+		dir.flags = 0x01;
+
+		if (info->Size == 0)
+			info->Size = (u64) count_num_clusters(sb, &dir) << p_fs->cluster_size_bits;
+
+		count = count_dos_name_entries(sb, &dir, TYPE_DIR);
+		if (count < 0)
+			return FFS_MEDIAERR;
+		info->NumSubdirs += count;
+	}
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	DPRINTK("ffsGetStat exited successfully\n");
+	return FFS_SUCCESS;
+} /* end of ffsGetStat */
+
+/* ffsSetStat : set the information of a given file */
+s32 ffsSetStat(struct inode *inode, DIR_ENTRY_T *info)
+{
+	sector_t sector = 0;
+	TIMESTAMP_T tm;
+	DENTRY_T *ep, *ep2;
+	ENTRY_SET_CACHE_T *es = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+	u8 is_dir = (fid->type == TYPE_DIR) ? 1 : 0;
+
+	if (is_dir) {
+		if ((fid->dir.dir == p_fs->root_dir) &&
+			(fid->entry == -1)) {
+			if (p_fs->dev_ejected)
+				return FFS_MEDIAERR;
+			return FFS_SUCCESS;
+		}
+	}
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	/* get the directory entry of given file or directory */
+	if (p_fs->vol_type == EXFAT) {
+		es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_ALL_ENTRIES, &ep);
+		if (es == NULL)
+			return FFS_MEDIAERR;
+		ep2 = ep+1;
+	} else {
+		/* for other than exfat */
+		ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+		if (!ep)
+			return FFS_MEDIAERR;
+		ep2 = ep;
+	}
+
+
+	p_fs->fs_func->set_entry_attr(ep, info->Attr);
+
+	/* set FILE_INFO structure using the acquired DENTRY_T */
+	tm.sec  = info->CreateTimestamp.Second;
+	tm.min  = info->CreateTimestamp.Minute;
+	tm.hour = info->CreateTimestamp.Hour;
+	tm.day  = info->CreateTimestamp.Day;
+	tm.mon  = info->CreateTimestamp.Month;
+	tm.year = info->CreateTimestamp.Year;
+	p_fs->fs_func->set_entry_time(ep, &tm, TM_CREATE);
+
+	tm.sec  = info->ModifyTimestamp.Second;
+	tm.min  = info->ModifyTimestamp.Minute;
+	tm.hour = info->ModifyTimestamp.Hour;
+	tm.day  = info->ModifyTimestamp.Day;
+	tm.mon  = info->ModifyTimestamp.Month;
+	tm.year = info->ModifyTimestamp.Year;
+	p_fs->fs_func->set_entry_time(ep, &tm, TM_MODIFY);
+
+
+	p_fs->fs_func->set_entry_size(ep2, info->Size);
+
+	if (p_fs->vol_type != EXFAT) {
+		buf_modify(sb, sector);
+	} else {
+		update_dir_checksum_with_entry_set(sb, es);
+		release_entry_set(es);
+	}
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsSetStat */
+
+s32 ffsMapCluster(struct inode *inode, s32 clu_offset, u32 *clu)
+{
+	s32 num_clusters, num_alloced, modified = FALSE;
+	u32 last_clu;
+	sector_t sector = 0;
+	CHAIN_T new_clu;
+	DENTRY_T *ep;
+	ENTRY_SET_CACHE_T *es = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+
+	fid->rwoffset = (s64)(clu_offset) << p_fs->cluster_size_bits;
+
+	if (EXFAT_I(inode)->mmu_private == 0)
+		num_clusters = 0;
+	else
+		num_clusters = (s32)((EXFAT_I(inode)->mmu_private-1) >> p_fs->cluster_size_bits) + 1;
+
+	*clu = last_clu = fid->start_clu;
+
+	if (fid->flags == 0x03) {
+		if ((clu_offset > 0) && (*clu != CLUSTER_32(~0))) {
+			last_clu += clu_offset - 1;
+
+			if (clu_offset == num_clusters)
+				*clu = CLUSTER_32(~0);
+			else
+				*clu += clu_offset;
+		}
+	} else {
+		/* hint information */
+		if ((clu_offset > 0) && (fid->hint_last_off > 0) &&
+			(clu_offset >= fid->hint_last_off)) {
+			clu_offset -= fid->hint_last_off;
+			*clu = fid->hint_last_clu;
+		}
+
+		while ((clu_offset > 0) && (*clu != CLUSTER_32(~0))) {
+			last_clu = *clu;
+			if (FAT_read(sb, *clu, clu) == -1)
+				return FFS_MEDIAERR;
+			clu_offset--;
+		}
+	}
+
+	if (*clu == CLUSTER_32(~0)) {
+		fs_set_vol_flags(sb, VOL_DIRTY);
+
+		new_clu.dir = (last_clu == CLUSTER_32(~0)) ? CLUSTER_32(~0) : last_clu+1;
+		new_clu.size = 0;
+		new_clu.flags = fid->flags;
+
+		/* (1) allocate a cluster */
+		num_alloced = p_fs->fs_func->alloc_cluster(sb, 1, &new_clu);
+		if (num_alloced < 0)
+			return FFS_MEDIAERR;
+		else if (num_alloced == 0)
+			return FFS_FULL;
+
+		/* (2) append to the FAT chain */
+		if (last_clu == CLUSTER_32(~0)) {
+			if (new_clu.flags == 0x01)
+				fid->flags = 0x01;
+			fid->start_clu = new_clu.dir;
+			modified = TRUE;
+		} else {
+			if (new_clu.flags != fid->flags) {
+				exfat_chain_cont_cluster(sb, fid->start_clu, num_clusters);
+				fid->flags = 0x01;
+				modified = TRUE;
+			}
+			if (new_clu.flags == 0x01)
+				FAT_write(sb, last_clu, new_clu.dir);
+		}
+
+		num_clusters += num_alloced;
+		*clu = new_clu.dir;
+
+		if (p_fs->vol_type == EXFAT) {
+			es = get_entry_set_in_dir(sb, &(fid->dir), fid->entry, ES_ALL_ENTRIES, &ep);
+			if (es == NULL)
+				return FFS_MEDIAERR;
+			/* get stream entry */
+			ep++;
+		}
+
+		/* (3) update directory entry */
+		if (modified) {
+			if (p_fs->vol_type != EXFAT) {
+				ep = get_entry_in_dir(sb, &(fid->dir), fid->entry, &sector);
+				if (!ep)
+					return FFS_MEDIAERR;
+			}
+
+			if (p_fs->fs_func->get_entry_flag(ep) != fid->flags)
+				p_fs->fs_func->set_entry_flag(ep, fid->flags);
+
+			if (p_fs->fs_func->get_entry_clu0(ep) != fid->start_clu)
+				p_fs->fs_func->set_entry_clu0(ep, fid->start_clu);
+
+			if (p_fs->vol_type != EXFAT)
+				buf_modify(sb, sector);
+		}
+
+		if (p_fs->vol_type == EXFAT) {
+			update_dir_checksum_with_entry_set(sb, es);
+			release_entry_set(es);
+		}
+
+		/* add number of new blocks to inode */
+		inode->i_blocks += num_alloced << (p_fs->cluster_size_bits - 9);
+	}
+
+	/* hint information */
+	fid->hint_last_off = (s32)(fid->rwoffset >> p_fs->cluster_size_bits);
+	fid->hint_last_clu = *clu;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsMapCluster */
+
+/*----------------------------------------------------------------------*/
+/*  Directory Operation Functions                                       */
+/*----------------------------------------------------------------------*/
+
+/* ffsCreateDir : create(make) a directory */
+s32 ffsCreateDir(struct inode *inode, char *path, FILE_ID_T *fid)
+{
+	s32 ret/*, dentry*/;
+	CHAIN_T dir;
+	UNI_NAME_T uni_name;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	DPRINTK("ffsCreateDir entered\n");
+
+	/* check the validity of directory name in the given old pathname */
+	ret = resolve_path(inode, path, &dir, &uni_name);
+	if (ret)
+		return ret;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	ret = create_dir(inode, &dir, &uni_name, fid);
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return ret;
+} /* end of ffsCreateDir */
+
+/* ffsReadDir : read a directory entry from the opened directory */
+s32 ffsReadDir(struct inode *inode, DIR_ENTRY_T *dir_entry)
+{
+	int i, dentry, clu_offset;
+	s32 dentries_per_clu, dentries_per_clu_bits = 0;
+	u32 type;
+	sector_t sector;
+	CHAIN_T dir, clu;
+	UNI_NAME_T uni_name;
+	TIMESTAMP_T tm;
+	DENTRY_T *ep;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+
+	/* check if the given file ID is opened */
+	if (fid->type != TYPE_DIR)
+		return FFS_PERMISSIONERR;
+
+	if (fid->entry == -1) {
+		dir.dir = p_fs->root_dir;
+		dir.flags = 0x01;
+	} else {
+		dir.dir = fid->start_clu;
+		dir.size = (s32)(fid->size >> p_fs->cluster_size_bits);
+		dir.flags = fid->flags;
+	}
+
+	dentry = (s32) fid->rwoffset;
+
+	if (dir.dir == CLUSTER_32(0)) { /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+
+		if (dentry == dentries_per_clu) {
+			clu.dir = CLUSTER_32(~0);
+		} else {
+			clu.dir = dir.dir;
+			clu.size = dir.size;
+			clu.flags = dir.flags;
+		}
+	} else {
+		dentries_per_clu = p_fs->dentries_per_clu;
+		dentries_per_clu_bits = ilog2(dentries_per_clu);
+
+		clu_offset = dentry >> dentries_per_clu_bits;
+		clu.dir = dir.dir;
+		clu.size = dir.size;
+		clu.flags = dir.flags;
+
+		if (clu.flags == 0x03) {
+			clu.dir += clu_offset;
+			clu.size -= clu_offset;
+		} else {
+			/* hint_information */
+			if ((clu_offset > 0) && (fid->hint_last_off > 0) &&
+				(clu_offset >= fid->hint_last_off)) {
+				clu_offset -= fid->hint_last_off;
+				clu.dir = fid->hint_last_clu;
+			}
+
+			while (clu_offset > 0) {
+				/* clu.dir = FAT_read(sb, clu.dir); */
+				if (FAT_read(sb, clu.dir, &(clu.dir)) == -1)
+					return FFS_MEDIAERR;
+
+				clu_offset--;
+			}
+		}
+	}
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		if (dir.dir == CLUSTER_32(0)) /* FAT16 root_dir */
+			i = dentry % dentries_per_clu;
+		else
+			i = dentry & (dentries_per_clu-1);
+
+		for ( ; i < dentries_per_clu; i++, dentry++) {
+			ep = get_entry_in_dir(sb, &clu, i, &sector);
+			if (!ep)
+				return FFS_MEDIAERR;
+
+			type = p_fs->fs_func->get_entry_type(ep);
+
+			if (type == TYPE_UNUSED)
+				break;
+
+			if ((type != TYPE_FILE) && (type != TYPE_DIR))
+				continue;
+
+			buf_lock(sb, sector);
+			dir_entry->Attr = p_fs->fs_func->get_entry_attr(ep);
+
+			p_fs->fs_func->get_entry_time(ep, &tm, TM_CREATE);
+			dir_entry->CreateTimestamp.Year = tm.year;
+			dir_entry->CreateTimestamp.Month = tm.mon;
+			dir_entry->CreateTimestamp.Day = tm.day;
+			dir_entry->CreateTimestamp.Hour = tm.hour;
+			dir_entry->CreateTimestamp.Minute = tm.min;
+			dir_entry->CreateTimestamp.Second = tm.sec;
+			dir_entry->CreateTimestamp.MilliSecond = 0;
+
+			p_fs->fs_func->get_entry_time(ep, &tm, TM_MODIFY);
+			dir_entry->ModifyTimestamp.Year = tm.year;
+			dir_entry->ModifyTimestamp.Month = tm.mon;
+			dir_entry->ModifyTimestamp.Day = tm.day;
+			dir_entry->ModifyTimestamp.Hour = tm.hour;
+			dir_entry->ModifyTimestamp.Minute = tm.min;
+			dir_entry->ModifyTimestamp.Second = tm.sec;
+			dir_entry->ModifyTimestamp.MilliSecond = 0;
+
+			memset((char *) &dir_entry->AccessTimestamp, 0, sizeof(DATE_TIME_T));
+
+			*(uni_name.name) = 0x0;
+			p_fs->fs_func->get_uni_name_from_ext_entry(sb, &dir, dentry, uni_name.name);
+			if (*(uni_name.name) == 0x0 && p_fs->vol_type != EXFAT)
+				get_uni_name_from_dos_entry(sb, (DOS_DENTRY_T *) ep, &uni_name, 0x1);
+			nls_uniname_to_cstring(sb, dir_entry->Name, &uni_name);
+			buf_unlock(sb, sector);
+
+			if (p_fs->vol_type == EXFAT) {
+				ep = get_entry_in_dir(sb, &clu, i+1, NULL);
+				if (!ep)
+					return FFS_MEDIAERR;
+			} else {
+				get_uni_name_from_dos_entry(sb, (DOS_DENTRY_T *) ep, &uni_name, 0x0);
+				nls_uniname_to_cstring(sb, dir_entry->ShortName, &uni_name);
+			}
+
+			dir_entry->Size = p_fs->fs_func->get_entry_size(ep);
+
+			/* hint information */
+			if (dir.dir == CLUSTER_32(0)) { /* FAT16 root_dir */
+			} else {
+				fid->hint_last_off = dentry >> dentries_per_clu_bits;
+				fid->hint_last_clu = clu.dir;
+			}
+
+			fid->rwoffset = (s64) ++dentry;
+
+			if (p_fs->dev_ejected)
+				return FFS_MEDIAERR;
+
+			return FFS_SUCCESS;
+		}
+
+		if (dir.dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (clu.flags == 0x03) {
+			if ((--clu.size) > 0)
+				clu.dir++;
+			else
+				clu.dir = CLUSTER_32(~0);
+		} else {
+			/* clu.dir = FAT_read(sb, clu.dir); */
+			if (FAT_read(sb, clu.dir, &(clu.dir)) == -1)
+				return FFS_MEDIAERR;
+		}
+	}
+
+	*(dir_entry->Name) = '\0';
+
+	fid->rwoffset = (s64) ++dentry;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsReadDir */
+
+/* ffsRemoveDir : remove a directory */
+s32 ffsRemoveDir(struct inode *inode, FILE_ID_T *fid)
+{
+	s32 dentry;
+	CHAIN_T dir, clu_to_free;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	dir.dir = fid->dir.dir;
+	dir.size = fid->dir.size;
+	dir.flags = fid->dir.flags;
+
+	dentry = fid->entry;
+
+	/* check if the file is "." or ".." */
+	if (p_fs->vol_type != EXFAT) {
+		if ((dir.dir != p_fs->root_dir) && (dentry < 2))
+			return FFS_PERMISSIONERR;
+	}
+
+	clu_to_free.dir = fid->start_clu;
+	clu_to_free.size = (s32)((fid->size-1) >> p_fs->cluster_size_bits) + 1;
+	clu_to_free.flags = fid->flags;
+
+	if (!is_dir_empty(sb, &clu_to_free))
+		return FFS_FILEEXIST;
+
+	fs_set_vol_flags(sb, VOL_DIRTY);
+
+	/* (1) update the directory entry */
+	remove_file(inode, &dir, dentry);
+
+	/* (2) free the clusters */
+	p_fs->fs_func->free_cluster(sb, &clu_to_free, 1);
+
+	fid->size = 0;
+	fid->start_clu = CLUSTER_32(~0);
+	fid->flags = (p_fs->vol_type == EXFAT)? 0x03: 0x01;
+
+#ifdef CONFIG_EXFAT_DELAYED_SYNC
+	fs_sync(sb, 0);
+	fs_set_vol_flags(sb, VOL_CLEAN);
+#endif
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	return FFS_SUCCESS;
+} /* end of ffsRemoveDir */
+
+/*======================================================================*/
+/*  Local Function Definitions                                          */
+/*======================================================================*/
+
+/*
+ *  File System Management Functions
+ */
+
+s32 fs_init(void)
+{
+	/* critical check for system requirement on size of DENTRY_T structure */
+	if (sizeof(DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(DOS_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(EXT_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(FILE_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(STRM_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(NAME_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(BMAP_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(CASE_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	if (sizeof(VOLM_DENTRY_T) != DENTRY_SIZE)
+		return FFS_ALIGNMENTERR;
+
+	return FFS_SUCCESS;
+} /* end of fs_init */
+
+s32 fs_shutdown(void)
+{
+	return FFS_SUCCESS;
+} /* end of fs_shutdown */
+
+void fs_set_vol_flags(struct super_block *sb, u32 new_flag)
+{
+	PBR_SECTOR_T *p_pbr;
+	BPBEX_T *p_bpb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_fs->vol_flag == new_flag)
+		return;
+
+	p_fs->vol_flag = new_flag;
+
+	if (p_fs->vol_type == EXFAT) {
+		if (p_fs->pbr_bh == NULL) {
+			if (sector_read(sb, p_fs->PBR_sector, &(p_fs->pbr_bh), 1) != FFS_SUCCESS)
+				return;
+		}
+
+		p_pbr = (PBR_SECTOR_T *) p_fs->pbr_bh->b_data;
+		p_bpb = (BPBEX_T *) p_pbr->bpb;
+		SET16(p_bpb->vol_flags, (u16) new_flag);
+
+		/* XXX duyoung
+		 what can we do here? (cuz fs_set_vol_flags() is void) */
+		if ((new_flag == VOL_DIRTY) && (!buffer_dirty(p_fs->pbr_bh)))
+			sector_write(sb, p_fs->PBR_sector, p_fs->pbr_bh, 1);
+		else
+			sector_write(sb, p_fs->PBR_sector, p_fs->pbr_bh, 0);
+	}
+} /* end of fs_set_vol_flags */
+
+void fs_sync(struct super_block *sb, s32 do_sync)
+{
+	if (do_sync)
+		bdev_sync(sb);
+} /* end of fs_sync */
+
+void fs_error(struct super_block *sb)
+{
+	struct exfat_mount_options *opts = &EXFAT_SB(sb)->options;
+
+	if (opts->errors == EXFAT_ERRORS_PANIC)
+		panic("[EXFAT] Filesystem panic from previous error\n");
+	else if ((opts->errors == EXFAT_ERRORS_RO) && !(sb->s_flags & MS_RDONLY)) {
+		sb->s_flags |= MS_RDONLY;
+		printk(KERN_ERR "[EXFAT] Filesystem has been set read-only\n");
+	}
+}
+
+/*
+ *  Cluster Management Functions
+ */
+
+s32 clear_cluster(struct super_block *sb, u32 clu)
+{
+	sector_t s, n;
+	s32 ret = FFS_SUCCESS;
+	struct buffer_head *tmp_bh = NULL;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (clu == CLUSTER_32(0)) { /* FAT16 root_dir */
+		s = p_fs->root_start_sector;
+		n = p_fs->data_start_sector;
+	} else {
+		s = START_SECTOR(clu);
+		n = s + p_fs->sectors_per_clu;
+	}
+
+	for (; s < n; s++) {
+		ret = sector_read(sb, s, &tmp_bh, 0);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		memset((char *) tmp_bh->b_data, 0x0, p_bd->sector_size);
+		ret = sector_write(sb, s, tmp_bh, 0);
+		if (ret != FFS_SUCCESS)
+			break;
+	}
+
+	brelse(tmp_bh);
+	return ret;
+} /* end of clear_cluster */
+
+s32 fat_alloc_cluster(struct super_block *sb, s32 num_alloc, CHAIN_T *p_chain)
+{
+	int i, num_clusters = 0;
+	u32 new_clu, last_clu = CLUSTER_32(~0), read_clu;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	new_clu = p_chain->dir;
+	if (new_clu == CLUSTER_32(~0))
+		new_clu = p_fs->clu_srch_ptr;
+	else if (new_clu >= p_fs->num_clusters)
+		new_clu = 2;
+
+	__set_sb_dirty(sb);
+
+	p_chain->dir = CLUSTER_32(~0);
+
+	for (i = 2; i < p_fs->num_clusters; i++) {
+		if (FAT_read(sb, new_clu, &read_clu) != 0)
+			return -1;
+
+		if (read_clu == CLUSTER_32(0)) {
+			if (FAT_write(sb, new_clu, CLUSTER_32(~0)) < 0)
+				return -1;
+			num_clusters++;
+
+			if (p_chain->dir == CLUSTER_32(~0))
+				p_chain->dir = new_clu;
+			else {
+				if (FAT_write(sb, last_clu, new_clu) < 0)
+					return -1;
+			}
+
+			last_clu = new_clu;
+
+			if ((--num_alloc) == 0) {
+				p_fs->clu_srch_ptr = new_clu;
+				if (p_fs->used_clusters != (u32) ~0)
+					p_fs->used_clusters += num_clusters;
+
+				return num_clusters;
+			}
+		}
+		if ((++new_clu) >= p_fs->num_clusters)
+			new_clu = 2;
+	}
+
+	p_fs->clu_srch_ptr = new_clu;
+	if (p_fs->used_clusters != (u32) ~0)
+		p_fs->used_clusters += num_clusters;
+
+	return num_clusters;
+} /* end of fat_alloc_cluster */
+
+s32 exfat_alloc_cluster(struct super_block *sb, s32 num_alloc, CHAIN_T *p_chain)
+{
+	s32 num_clusters = 0;
+	u32 hint_clu, new_clu, last_clu = CLUSTER_32(~0);
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	hint_clu = p_chain->dir;
+	if (hint_clu == CLUSTER_32(~0)) {
+		hint_clu = test_alloc_bitmap(sb, p_fs->clu_srch_ptr-2);
+		if (hint_clu == CLUSTER_32(~0))
+			return 0;
+	} else if (hint_clu >= p_fs->num_clusters) {
+		hint_clu = 2;
+		p_chain->flags = 0x01;
+	}
+
+	__set_sb_dirty(sb);
+
+	p_chain->dir = CLUSTER_32(~0);
+
+	while ((new_clu = test_alloc_bitmap(sb, hint_clu-2)) != CLUSTER_32(~0)) {
+		if (new_clu != hint_clu) {
+			if (p_chain->flags == 0x03) {
+				exfat_chain_cont_cluster(sb, p_chain->dir, num_clusters);
+				p_chain->flags = 0x01;
+			}
+		}
+
+		if (set_alloc_bitmap(sb, new_clu-2) != FFS_SUCCESS)
+			return -1;
+
+		num_clusters++;
+
+		if (p_chain->flags == 0x01) {
+			if (FAT_write(sb, new_clu, CLUSTER_32(~0)) < 0)
+				return -1;
+		}
+
+		if (p_chain->dir == CLUSTER_32(~0)) {
+			p_chain->dir = new_clu;
+		} else {
+			if (p_chain->flags == 0x01) {
+				if (FAT_write(sb, last_clu, new_clu) < 0)
+					return -1;
+			}
+		}
+		last_clu = new_clu;
+
+		if ((--num_alloc) == 0) {
+			p_fs->clu_srch_ptr = hint_clu;
+			if (p_fs->used_clusters != (u32) ~0)
+				p_fs->used_clusters += num_clusters;
+
+			p_chain->size += num_clusters;
+			return num_clusters;
+		}
+
+		hint_clu = new_clu + 1;
+		if (hint_clu >= p_fs->num_clusters) {
+			hint_clu = 2;
+
+			if (p_chain->flags == 0x03) {
+				exfat_chain_cont_cluster(sb, p_chain->dir, num_clusters);
+				p_chain->flags = 0x01;
+			}
+		}
+	}
+
+	p_fs->clu_srch_ptr = hint_clu;
+	if (p_fs->used_clusters != (u32) ~0)
+		p_fs->used_clusters += num_clusters;
+
+	p_chain->size += num_clusters;
+	return num_clusters;
+} /* end of exfat_alloc_cluster */
+
+void fat_free_cluster(struct super_block *sb, CHAIN_T *p_chain, s32 do_relse)
+{
+	s32 num_clusters = 0;
+	u32 clu, prev;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	int i;
+	sector_t sector;
+
+	if ((p_chain->dir == CLUSTER_32(0)) || (p_chain->dir == CLUSTER_32(~0)))
+		return;
+	__set_sb_dirty(sb);
+	clu = p_chain->dir;
+
+	if (p_chain->size <= 0)
+		return;
+
+	do {
+		if (p_fs->dev_ejected)
+			break;
+
+		if (do_relse) {
+			sector = START_SECTOR(clu);
+			for (i = 0; i < p_fs->sectors_per_clu; i++)
+				buf_release(sb, sector+i);
+		}
+
+		prev = clu;
+		if (FAT_read(sb, clu, &clu) == -1)
+			break;
+
+		if (FAT_write(sb, prev, CLUSTER_32(0)) < 0)
+			break;
+		num_clusters++;
+
+	} while (clu != CLUSTER_32(~0));
+
+	if (p_fs->used_clusters != (u32) ~0)
+		p_fs->used_clusters -= num_clusters;
+} /* end of fat_free_cluster */
+
+void exfat_free_cluster(struct super_block *sb, CHAIN_T *p_chain, s32 do_relse)
+{
+	s32 num_clusters = 0;
+	u32 clu;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	int i;
+	sector_t sector;
+
+	if ((p_chain->dir == CLUSTER_32(0)) || (p_chain->dir == CLUSTER_32(~0)))
+		return;
+
+	if (p_chain->size <= 0) {
+		printk(KERN_ERR "[EXFAT] free_cluster : skip free-req clu:%u, "
+				"because of zero-size truncation\n"
+				,p_chain->dir);
+		return;
+	}
+
+	__set_sb_dirty(sb);
+	clu = p_chain->dir;
+
+	if (p_chain->flags == 0x03) {
+		do {
+			if (do_relse) {
+				sector = START_SECTOR(clu);
+				for (i = 0; i < p_fs->sectors_per_clu; i++)
+					buf_release(sb, sector+i);
+			}
+
+			if (clr_alloc_bitmap(sb, clu-2) != FFS_SUCCESS)
+				break;
+			clu++;
+
+			num_clusters++;
+		} while (num_clusters < p_chain->size);
+	} else {
+		do {
+			if (p_fs->dev_ejected)
+				break;
+
+			if (do_relse) {
+				sector = START_SECTOR(clu);
+				for (i = 0; i < p_fs->sectors_per_clu; i++)
+					buf_release(sb, sector+i);
+			}
+
+			if (clr_alloc_bitmap(sb, clu-2) != FFS_SUCCESS)
+				break;
+
+			if (FAT_read(sb, clu, &clu) == -1)
+				break;
+			num_clusters++;
+		} while ((clu != CLUSTER_32(0)) && (clu != CLUSTER_32(~0)));
+	}
+
+	if (p_fs->used_clusters != (u32) ~0)
+		p_fs->used_clusters -= num_clusters;
+} /* end of exfat_free_cluster */
+
+u32 find_last_cluster(struct super_block *sb, CHAIN_T *p_chain)
+{
+	u32 clu, next;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	clu = p_chain->dir;
+
+	if (p_chain->flags == 0x03) {
+		clu += p_chain->size - 1;
+	} else {
+		while ((FAT_read(sb, clu, &next) == 0) && (next != CLUSTER_32(~0))) {
+			if (p_fs->dev_ejected)
+				break;
+			clu = next;
+		}
+	}
+
+	return clu;
+} /* end of find_last_cluster */
+
+s32 count_num_clusters(struct super_block *sb, CHAIN_T *p_chain)
+{
+	int i, count = 0;
+	u32 clu;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if ((p_chain->dir == CLUSTER_32(0)) || (p_chain->dir == CLUSTER_32(~0)))
+		return 0;
+
+	clu = p_chain->dir;
+
+	if (p_chain->flags == 0x03) {
+		count = p_chain->size;
+	} else {
+		for (i = 2; i < p_fs->num_clusters; i++) {
+			count++;
+			if (FAT_read(sb, clu, &clu) != 0)
+				return 0;
+			if (clu == CLUSTER_32(~0))
+				break;
+		}
+	}
+
+	return count;
+} /* end of count_num_clusters */
+
+s32 fat_count_used_clusters(struct super_block *sb)
+{
+	int i, count = 0;
+	u32 clu;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	for (i = 2; i < p_fs->num_clusters; i++) {
+		if (FAT_read(sb, i, &clu) != 0)
+			break;
+		if (clu != CLUSTER_32(0))
+			count++;
+	}
+
+	return count;
+} /* end of fat_count_used_clusters */
+
+s32 exfat_count_used_clusters(struct super_block *sb)
+{
+	int i, map_i, map_b, count = 0;
+	u8 k;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	map_i = map_b = 0;
+
+	for (i = 2; i < p_fs->num_clusters; i += 8) {
+		k = *(((u8 *) p_fs->vol_amap[map_i]->b_data) + map_b);
+		count += used_bit[k];
+
+		if ((++map_b) >= p_bd->sector_size) {
+			map_i++;
+			map_b = 0;
+		}
+	}
+
+	return count;
+} /* end of exfat_count_used_clusters */
+
+void exfat_chain_cont_cluster(struct super_block *sb, u32 chain, s32 len)
+{
+	if (len == 0)
+		return;
+
+	while (len > 1) {
+		if (FAT_write(sb, chain, chain+1) < 0)
+			break;
+		chain++;
+		len--;
+	}
+	FAT_write(sb, chain, CLUSTER_32(~0));
+} /* end of exfat_chain_cont_cluster */
+
+/*
+ *  Allocation Bitmap Management Functions
+ */
+
+s32 load_alloc_bitmap(struct super_block *sb)
+{
+	int i, j, ret;
+	u32 map_size;
+	u32 type;
+	sector_t sector;
+	CHAIN_T clu;
+	BMAP_DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	clu.dir = p_fs->root_dir;
+	clu.flags = 0x01;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		for (i = 0; i < p_fs->dentries_per_clu; i++) {
+			ep = (BMAP_DENTRY_T *) get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return FFS_MEDIAERR;
+
+			type = p_fs->fs_func->get_entry_type((DENTRY_T *) ep);
+
+			if (type == TYPE_UNUSED)
+				break;
+			if (type != TYPE_BITMAP)
+				continue;
+
+			if (ep->flags == 0x0) {
+				p_fs->map_clu  = GET32_A(ep->start_clu);
+				map_size = (u32) GET64_A(ep->size);
+
+				p_fs->map_sectors = ((map_size-1) >> p_bd->sector_size_bits) + 1;
+
+				p_fs->vol_amap = (struct buffer_head **) kmalloc(sizeof(struct buffer_head *) * p_fs->map_sectors, GFP_KERNEL);
+				if (p_fs->vol_amap == NULL)
+					return FFS_MEMORYERR;
+
+				sector = START_SECTOR(p_fs->map_clu);
+
+				for (j = 0; j < p_fs->map_sectors; j++) {
+					p_fs->vol_amap[j] = NULL;
+					ret = sector_read(sb, sector+j, &(p_fs->vol_amap[j]), 1);
+					if (ret != FFS_SUCCESS) {
+						/*  release all buffers and free vol_amap */
+						i = 0;
+						while (i < j)
+							brelse(p_fs->vol_amap[i++]);
+
+						if (p_fs->vol_amap)
+							kfree(p_fs->vol_amap);
+						p_fs->vol_amap = NULL;
+						return ret;
+					}
+				}
+
+				p_fs->pbr_bh = NULL;
+				return FFS_SUCCESS;
+			}
+		}
+
+		if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+			return FFS_MEDIAERR;
+	}
+
+	return FFS_FORMATERR;
+} /* end of load_alloc_bitmap */
+
+void free_alloc_bitmap(struct super_block *sb)
+{
+	int i;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	brelse(p_fs->pbr_bh);
+
+	for (i = 0; i < p_fs->map_sectors; i++)
+		__brelse(p_fs->vol_amap[i]);
+
+	if (p_fs->vol_amap)
+		kfree(p_fs->vol_amap);
+	p_fs->vol_amap = NULL;
+} /* end of free_alloc_bitmap */
+
+s32 set_alloc_bitmap(struct super_block *sb, u32 clu)
+{
+	int i, b;
+	sector_t sector;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	i = clu >> (p_bd->sector_size_bits + 3);
+	b = clu & ((p_bd->sector_size << 3) - 1);
+
+	sector = START_SECTOR(p_fs->map_clu) + i;
+
+	exfat_bitmap_set((u8 *) p_fs->vol_amap[i]->b_data, b);
+
+	return sector_write(sb, sector, p_fs->vol_amap[i], 0);
+} /* end of set_alloc_bitmap */
+
+s32 clr_alloc_bitmap(struct super_block *sb, u32 clu)
+{
+	int i, b;
+	sector_t sector;
+#ifdef CONFIG_EXFAT_DISCARD
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	struct exfat_mount_options *opts = &sbi->options;
+	int ret;
+#endif /* CONFIG_EXFAT_DISCARD */
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	i = clu >> (p_bd->sector_size_bits + 3);
+	b = clu & ((p_bd->sector_size << 3) - 1);
+
+	sector = START_SECTOR(p_fs->map_clu) + i;
+
+	exfat_bitmap_clear((u8 *) p_fs->vol_amap[i]->b_data, b);
+
+	return sector_write(sb, sector, p_fs->vol_amap[i], 0);
+
+#ifdef CONFIG_EXFAT_DISCARD
+	if (opts->discard) {
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
+		ret = sb_issue_discard(sb, START_SECTOR(clu), (1 << p_fs->sectors_per_clu_bits));
+#else
+		ret = sb_issue_discard(sb, START_SECTOR(clu), (1 << p_fs->sectors_per_clu_bits), GFP_NOFS, 0);
+#endif
+		if (ret == -EOPNOTSUPP) {
+			printk(KERN_WARNING "discard not supported by device, disabling");
+			opts->discard = 0;
+		}
+	}
+#endif /* CONFIG_EXFAT_DISCARD */
+} /* end of clr_alloc_bitmap */
+
+u32 test_alloc_bitmap(struct super_block *sb, u32 clu)
+{
+	int i, map_i, map_b;
+	u32 clu_base, clu_free;
+	u8 k, clu_mask;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	clu_base = (clu & ~(0x7)) + 2;
+	clu_mask = (1 << (clu - clu_base + 2)) - 1;
+
+	map_i = clu >> (p_bd->sector_size_bits + 3);
+	map_b = (clu >> 3) & p_bd->sector_size_mask;
+
+	for (i = 2; i < p_fs->num_clusters; i += 8) {
+		k = *(((u8 *) p_fs->vol_amap[map_i]->b_data) + map_b);
+		if (clu_mask > 0) {
+			k |= clu_mask;
+			clu_mask = 0;
+		}
+		if (k < 0xFF) {
+			clu_free = clu_base + free_bit[k];
+			if (clu_free < p_fs->num_clusters)
+				return clu_free;
+		}
+		clu_base += 8;
+
+		if (((++map_b) >= p_bd->sector_size) || (clu_base >= p_fs->num_clusters)) {
+			if ((++map_i) >= p_fs->map_sectors) {
+				clu_base = 2;
+				map_i = 0;
+			}
+			map_b = 0;
+		}
+	}
+
+	return CLUSTER_32(~0);
+} /* end of test_alloc_bitmap */
+
+void sync_alloc_bitmap(struct super_block *sb)
+{
+	int i;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_fs->vol_amap == NULL)
+		return;
+
+	for (i = 0; i < p_fs->map_sectors; i++)
+		sync_dirty_buffer(p_fs->vol_amap[i]);
+} /* end of sync_alloc_bitmap */
+
+/*
+ *  Upcase table Management Functions
+ */
+s32 __load_upcase_table(struct super_block *sb, sector_t sector, u32 num_sectors, u32 utbl_checksum)
+{
+	int i, ret = FFS_ERROR;
+	u32 j;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	struct buffer_head *tmp_bh = NULL;
+	sector_t end_sector = num_sectors + sector;
+
+	u8	skip = FALSE;
+	u32	index = 0;
+	u16	uni = 0;
+	u16 **upcase_table;
+
+	u32 checksum = 0;
+
+	upcase_table = p_fs->vol_utbl = (u16 **) kmalloc(UTBL_COL_COUNT * sizeof(u16 *), GFP_KERNEL);
+	if (upcase_table == NULL)
+		return FFS_MEMORYERR;
+	memset(upcase_table, 0, UTBL_COL_COUNT * sizeof(u16 *));
+
+	while (sector < end_sector) {
+		ret = sector_read(sb, sector, &tmp_bh, 1);
+		if (ret != FFS_SUCCESS) {
+			DPRINTK("sector read (0x%llX)fail\n", (unsigned long long)sector);
+			goto error;
+		}
+		sector++;
+
+		for (i = 0; i < p_bd->sector_size && index <= 0xFFFF; i += 2) {
+			uni = GET16(((u8 *) tmp_bh->b_data)+i);
+
+			checksum = ((checksum & 1) ? 0x80000000 : 0) + (checksum >> 1) + *(((u8 *) tmp_bh->b_data)+i);
+			checksum = ((checksum & 1) ? 0x80000000 : 0) + (checksum >> 1) + *(((u8 *) tmp_bh->b_data)+(i+1));
+
+			if (skip) {
+				DPRINTK("skip from 0x%X ", index);
+				index += uni;
+				DPRINTK("to 0x%X (amount of 0x%X)\n", index, uni);
+				skip = FALSE;
+			} else if (uni == index)
+				index++;
+			else if (uni == 0xFFFF)
+				skip = TRUE;
+			else { /* uni != index , uni != 0xFFFF */
+				u16 col_index = get_col_index(index);
+
+				if (upcase_table[col_index] == NULL) {
+					DPRINTK("alloc = 0x%X\n", col_index);
+					upcase_table[col_index] = (u16 *) kmalloc(UTBL_ROW_COUNT * sizeof(u16), GFP_KERNEL);
+					if (upcase_table[col_index] == NULL) {
+						ret = FFS_MEMORYERR;
+						goto error;
+					}
+
+					for (j = 0; j < UTBL_ROW_COUNT; j++)
+						upcase_table[col_index][j] = (col_index << LOW_INDEX_BIT) | j;
+				}
+
+				upcase_table[col_index][get_row_index(index)] = uni;
+				index++;
+			}
+		}
+	}
+	if (index >= 0xFFFF && utbl_checksum == checksum) {
+		if (tmp_bh)
+			brelse(tmp_bh);
+		return FFS_SUCCESS;
+	}
+	ret = FFS_ERROR;
+error:
+	if (tmp_bh)
+		brelse(tmp_bh);
+	free_upcase_table(sb);
+	return ret;
+}
+
+s32 __load_default_upcase_table(struct super_block *sb)
+{
+	int i, ret = FFS_ERROR;
+	u32 j;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	u8	skip = FALSE;
+	u32	index = 0;
+	u16	uni = 0;
+	u16 **upcase_table;
+
+	upcase_table = p_fs->vol_utbl = (u16 **) kmalloc(UTBL_COL_COUNT * sizeof(u16 *), GFP_KERNEL);
+	if (upcase_table == NULL)
+		return FFS_MEMORYERR;
+	memset(upcase_table, 0, UTBL_COL_COUNT * sizeof(u16 *));
+
+	for (i = 0; index <= 0xFFFF && i < NUM_UPCASE*2; i += 2) {
+		uni = GET16(uni_upcase + i);
+		if (skip) {
+			DPRINTK("skip from 0x%X ", index);
+			index += uni;
+			DPRINTK("to 0x%X (amount of 0x%X)\n", index, uni);
+			skip = FALSE;
+		} else if (uni == index)
+			index++;
+		else if (uni == 0xFFFF)
+			skip = TRUE;
+		else { /* uni != index , uni != 0xFFFF */
+			u16 col_index = get_col_index(index);
+
+			if (upcase_table[col_index] == NULL) {
+				DPRINTK("alloc = 0x%X\n", col_index);
+				upcase_table[col_index] = (u16 *) kmalloc(UTBL_ROW_COUNT * sizeof(u16), GFP_KERNEL);
+				if (upcase_table[col_index] == NULL) {
+					ret = FFS_MEMORYERR;
+					goto error;
+				}
+
+				for (j = 0; j < UTBL_ROW_COUNT; j++)
+					upcase_table[col_index][j] = (col_index << LOW_INDEX_BIT) | j;
+			}
+
+			upcase_table[col_index][get_row_index(index)] = uni;
+			index++;
+		}
+	}
+
+	if (index >= 0xFFFF)
+		return FFS_SUCCESS;
+
+error:
+	/* FATAL error: default upcase table has error */
+	free_upcase_table(sb);
+	return ret;
+}
+
+s32 load_upcase_table(struct super_block *sb)
+{
+	int i;
+	u32 tbl_clu, tbl_size;
+	sector_t sector;
+	u32 type, num_sectors;
+	CHAIN_T clu;
+	CASE_DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	clu.dir = p_fs->root_dir;
+	clu.flags = 0x01;
+
+	if (p_fs->dev_ejected)
+		return FFS_MEDIAERR;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		for (i = 0; i < p_fs->dentries_per_clu; i++) {
+			ep = (CASE_DENTRY_T *) get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return FFS_MEDIAERR;
+
+			type = p_fs->fs_func->get_entry_type((DENTRY_T *) ep);
+
+			if (type == TYPE_UNUSED)
+				break;
+			if (type != TYPE_UPCASE)
+				continue;
+
+			tbl_clu  = GET32_A(ep->start_clu);
+			tbl_size = (u32) GET64_A(ep->size);
+
+			sector = START_SECTOR(tbl_clu);
+			num_sectors = ((tbl_size-1) >> p_bd->sector_size_bits) + 1;
+			if (__load_upcase_table(sb, sector, num_sectors, GET32_A(ep->checksum)) != FFS_SUCCESS)
+				break;
+			else
+				return FFS_SUCCESS;
+		}
+		if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+			return FFS_MEDIAERR;
+	}
+	/* load default upcase table */
+	return __load_default_upcase_table(sb);
+} /* end of load_upcase_table */
+
+void free_upcase_table(struct super_block *sb)
+{
+	u32 i;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	u16 **upcase_table;
+
+	upcase_table = p_fs->vol_utbl;
+	for (i = 0; i < UTBL_COL_COUNT; i++) {
+		if (upcase_table[i])
+			kfree(upcase_table[i]);
+	}
+
+	if (p_fs->vol_utbl)
+		kfree(p_fs->vol_utbl);
+	p_fs->vol_utbl = NULL;
+} /* end of free_upcase_table */
+
+/*
+ *  Directory Entry Management Functions
+ */
+
+u32 fat_get_entry_type(DENTRY_T *p_entry)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+
+	if (*(ep->name) == 0x0)
+		return TYPE_UNUSED;
+
+	else if (*(ep->name) == 0xE5)
+		return TYPE_DELETED;
+
+	else if (ep->attr == ATTR_EXTEND)
+		return TYPE_EXTEND;
+
+	else if ((ep->attr & (ATTR_SUBDIR|ATTR_VOLUME)) == ATTR_VOLUME)
+		return TYPE_VOLUME;
+
+	else if ((ep->attr & (ATTR_SUBDIR|ATTR_VOLUME)) == ATTR_SUBDIR)
+		return TYPE_DIR;
+
+	return TYPE_FILE;
+} /* end of fat_get_entry_type */
+
+u32 exfat_get_entry_type(DENTRY_T *p_entry)
+{
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+
+	if (ep->type == 0x0) {
+		return TYPE_UNUSED;
+	} else if (ep->type < 0x80) {
+		return TYPE_DELETED;
+	} else if (ep->type == 0x80) {
+		return TYPE_INVALID;
+	} else if (ep->type < 0xA0) {
+		if (ep->type == 0x81) {
+			return TYPE_BITMAP;
+		} else if (ep->type == 0x82) {
+			return TYPE_UPCASE;
+		} else if (ep->type == 0x83) {
+			return TYPE_VOLUME;
+		} else if (ep->type == 0x85) {
+			if (GET16_A(ep->attr) & ATTR_SUBDIR)
+				return TYPE_DIR;
+			else
+				return TYPE_FILE;
+		}
+		return TYPE_CRITICAL_PRI;
+	} else if (ep->type < 0xC0) {
+		if (ep->type == 0xA0)
+			return TYPE_GUID;
+		else if (ep->type == 0xA1)
+			return TYPE_PADDING;
+		else if (ep->type == 0xA2)
+			return TYPE_ACLTAB;
+		return TYPE_BENIGN_PRI;
+	} else if (ep->type < 0xE0) {
+		if (ep->type == 0xC0)
+			return TYPE_STREAM;
+		else if (ep->type == 0xC1)
+			return TYPE_EXTEND;
+		else if (ep->type == 0xC2)
+			return TYPE_ACL;
+		return TYPE_CRITICAL_SEC;
+	}
+
+	return TYPE_BENIGN_SEC;
+} /* end of exfat_get_entry_type */
+
+void fat_set_entry_type(DENTRY_T *p_entry, u32 type)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+
+	if (type == TYPE_UNUSED)
+		*(ep->name) = 0x0;
+
+	else if (type == TYPE_DELETED)
+		*(ep->name) = 0xE5;
+
+	else if (type == TYPE_EXTEND)
+		ep->attr = ATTR_EXTEND;
+
+	else if (type == TYPE_DIR)
+		ep->attr = ATTR_SUBDIR;
+
+	else if (type == TYPE_FILE)
+		ep->attr = ATTR_ARCHIVE;
+
+	else if (type == TYPE_SYMLINK)
+		ep->attr = ATTR_ARCHIVE | ATTR_SYMLINK;
+} /* end of fat_set_entry_type */
+
+void exfat_set_entry_type(DENTRY_T *p_entry, u32 type)
+{
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+
+	if (type == TYPE_UNUSED) {
+		ep->type = 0x0;
+	} else if (type == TYPE_DELETED) {
+		ep->type &= ~0x80;
+	} else if (type == TYPE_STREAM) {
+		ep->type = 0xC0;
+	} else if (type == TYPE_EXTEND) {
+		ep->type = 0xC1;
+	} else if (type == TYPE_BITMAP) {
+		ep->type = 0x81;
+	} else if (type == TYPE_UPCASE) {
+		ep->type = 0x82;
+	} else if (type == TYPE_VOLUME) {
+		ep->type = 0x83;
+	} else if (type == TYPE_DIR) {
+		ep->type = 0x85;
+		SET16_A(ep->attr, ATTR_SUBDIR);
+	} else if (type == TYPE_FILE) {
+		ep->type = 0x85;
+		SET16_A(ep->attr, ATTR_ARCHIVE);
+	} else if (type == TYPE_SYMLINK) {
+		ep->type = 0x85;
+		SET16_A(ep->attr, ATTR_ARCHIVE | ATTR_SYMLINK);
+	}
+} /* end of exfat_set_entry_type */
+
+u32 fat_get_entry_attr(DENTRY_T *p_entry)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	return (u32) ep->attr;
+} /* end of fat_get_entry_attr */
+
+u32 exfat_get_entry_attr(DENTRY_T *p_entry)
+{
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+	return (u32) GET16_A(ep->attr);
+} /* end of exfat_get_entry_attr */
+
+void fat_set_entry_attr(DENTRY_T *p_entry, u32 attr)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	ep->attr = (u8) attr;
+} /* end of fat_set_entry_attr */
+
+void exfat_set_entry_attr(DENTRY_T *p_entry, u32 attr)
+{
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+	SET16_A(ep->attr, (u16) attr);
+} /* end of exfat_set_entry_attr */
+
+u8 fat_get_entry_flag(DENTRY_T *p_entry)
+{
+	return 0x01;
+} /* end of fat_get_entry_flag */
+
+u8 exfat_get_entry_flag(DENTRY_T *p_entry)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	return ep->flags;
+} /* end of exfat_get_entry_flag */
+
+void fat_set_entry_flag(DENTRY_T *p_entry, u8 flags)
+{
+} /* end of fat_set_entry_flag */
+
+void exfat_set_entry_flag(DENTRY_T *p_entry, u8 flags)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	ep->flags = flags;
+} /* end of exfat_set_entry_flag */
+
+u32 fat_get_entry_clu0(DENTRY_T *p_entry)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	return ((u32) GET16_A(ep->start_clu_hi) << 16) | GET16_A(ep->start_clu_lo);
+} /* end of fat_get_entry_clu0 */
+
+u32 exfat_get_entry_clu0(DENTRY_T *p_entry)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	return GET32_A(ep->start_clu);
+} /* end of exfat_get_entry_clu0 */
+
+void fat_set_entry_clu0(DENTRY_T *p_entry, u32 start_clu)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	SET16_A(ep->start_clu_lo, CLUSTER_16(start_clu));
+	SET16_A(ep->start_clu_hi, CLUSTER_16(start_clu >> 16));
+} /* end of fat_set_entry_clu0 */
+
+void exfat_set_entry_clu0(DENTRY_T *p_entry, u32 start_clu)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	SET32_A(ep->start_clu, start_clu);
+} /* end of exfat_set_entry_clu0 */
+
+u64 fat_get_entry_size(DENTRY_T *p_entry)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	return (u64) GET32_A(ep->size);
+} /* end of fat_get_entry_size */
+
+u64 exfat_get_entry_size(DENTRY_T *p_entry)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	return GET64_A(ep->valid_size);
+} /* end of exfat_get_entry_size */
+
+void fat_set_entry_size(DENTRY_T *p_entry, u64 size)
+{
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+	SET32_A(ep->size, (u32) size);
+} /* end of fat_set_entry_size */
+
+void exfat_set_entry_size(DENTRY_T *p_entry, u64 size)
+{
+	STRM_DENTRY_T *ep = (STRM_DENTRY_T *) p_entry;
+	SET64_A(ep->valid_size, size);
+	SET64_A(ep->size, size);
+} /* end of exfat_set_entry_size */
+
+void fat_get_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode)
+{
+	u16 t = 0x00, d = 0x21;
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+
+	switch (mode) {
+	case TM_CREATE:
+		t = GET16_A(ep->create_time);
+		d = GET16_A(ep->create_date);
+		break;
+	case TM_MODIFY:
+		t = GET16_A(ep->modify_time);
+		d = GET16_A(ep->modify_date);
+		break;
+	}
+
+	tp->sec  = (t & 0x001F) << 1;
+	tp->min  = (t >> 5) & 0x003F;
+	tp->hour = (t >> 11);
+	tp->day  = (d & 0x001F);
+	tp->mon  = (d >> 5) & 0x000F;
+	tp->year = (d >> 9);
+} /* end of fat_get_entry_time */
+
+void exfat_get_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode)
+{
+	u16 t = 0x00, d = 0x21;
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+
+	switch (mode) {
+	case TM_CREATE:
+		t = GET16_A(ep->create_time);
+		d = GET16_A(ep->create_date);
+		break;
+	case TM_MODIFY:
+		t = GET16_A(ep->modify_time);
+		d = GET16_A(ep->modify_date);
+		break;
+	case TM_ACCESS:
+		t = GET16_A(ep->access_time);
+		d = GET16_A(ep->access_date);
+		break;
+	}
+
+	tp->sec  = (t & 0x001F) << 1;
+	tp->min  = (t >> 5) & 0x003F;
+	tp->hour = (t >> 11);
+	tp->day  = (d & 0x001F);
+	tp->mon  = (d >> 5) & 0x000F;
+	tp->year = (d >> 9);
+} /* end of exfat_get_entry_time */
+
+void fat_set_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode)
+{
+	u16 t, d;
+	DOS_DENTRY_T *ep = (DOS_DENTRY_T *) p_entry;
+
+	t = (tp->hour << 11) | (tp->min << 5) | (tp->sec >> 1);
+	d = (tp->year <<  9) | (tp->mon << 5) |  tp->day;
+
+	switch (mode) {
+	case TM_CREATE:
+		SET16_A(ep->create_time, t);
+		SET16_A(ep->create_date, d);
+		break;
+	case TM_MODIFY:
+		SET16_A(ep->modify_time, t);
+		SET16_A(ep->modify_date, d);
+		break;
+	}
+} /* end of fat_set_entry_time */
+
+void exfat_set_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode)
+{
+	u16 t, d;
+	FILE_DENTRY_T *ep = (FILE_DENTRY_T *) p_entry;
+
+	t = (tp->hour << 11) | (tp->min << 5) | (tp->sec >> 1);
+	d = (tp->year <<  9) | (tp->mon << 5) |  tp->day;
+
+	switch (mode) {
+	case TM_CREATE:
+		SET16_A(ep->create_time, t);
+		SET16_A(ep->create_date, d);
+		break;
+	case TM_MODIFY:
+		SET16_A(ep->modify_time, t);
+		SET16_A(ep->modify_date, d);
+		break;
+	case TM_ACCESS:
+		SET16_A(ep->access_time, t);
+		SET16_A(ep->access_date, d);
+		break;
+	}
+} /* end of exfat_set_entry_time */
+
+s32 fat_init_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type,
+						 u32 start_clu, u64 size)
+{
+	sector_t sector;
+	DOS_DENTRY_T *dos_ep;
+
+	dos_ep = (DOS_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!dos_ep)
+		return FFS_MEDIAERR;
+
+	init_dos_entry(dos_ep, type, start_clu);
+	buf_modify(sb, sector);
+
+	return FFS_SUCCESS;
+} /* end of fat_init_dir_entry */
+
+s32 exfat_init_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type,
+						   u32 start_clu, u64 size)
+{
+	sector_t sector;
+	u8 flags;
+	FILE_DENTRY_T *file_ep;
+	STRM_DENTRY_T *strm_ep;
+
+	flags = (type == TYPE_FILE) ? 0x01 : 0x03;
+
+	/* we cannot use get_entry_set_in_dir here because file ep is not initialized yet */
+	file_ep = (FILE_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!file_ep)
+		return FFS_MEDIAERR;
+
+	strm_ep = (STRM_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry+1, &sector);
+	if (!strm_ep)
+		return FFS_MEDIAERR;
+
+	init_file_entry(file_ep, type);
+	buf_modify(sb, sector);
+
+	init_strm_entry(strm_ep, flags, start_clu, size);
+	buf_modify(sb, sector);
+
+	return FFS_SUCCESS;
+} /* end of exfat_init_dir_entry */
+
+s32 fat_init_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 num_entries,
+						 UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname)
+{
+	int i;
+	sector_t sector;
+	u8 chksum;
+	u16 *uniname = p_uniname->name;
+	DOS_DENTRY_T *dos_ep;
+	EXT_DENTRY_T *ext_ep;
+
+	dos_ep = (DOS_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!dos_ep)
+		return FFS_MEDIAERR;
+
+	dos_ep->lcase = p_dosname->name_case;
+	memcpy(dos_ep->name, p_dosname->name, DOS_NAME_LENGTH);
+	buf_modify(sb, sector);
+
+	if ((--num_entries) > 0) {
+		chksum = calc_checksum_1byte((void *) dos_ep->name, DOS_NAME_LENGTH, 0);
+
+		for (i = 1; i < num_entries; i++) {
+			ext_ep = (EXT_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry-i, &sector);
+			if (!ext_ep)
+				return FFS_MEDIAERR;
+
+			init_ext_entry(ext_ep, i, chksum, uniname);
+			buf_modify(sb, sector);
+			uniname += 13;
+		}
+
+		ext_ep = (EXT_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry-i, &sector);
+		if (!ext_ep)
+			return FFS_MEDIAERR;
+
+		init_ext_entry(ext_ep, i+0x40, chksum, uniname);
+		buf_modify(sb, sector);
+	}
+
+	return FFS_SUCCESS;
+} /* end of fat_init_ext_entry */
+
+s32 exfat_init_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 num_entries,
+						   UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname)
+{
+	int i;
+	sector_t sector;
+	u16 *uniname = p_uniname->name;
+	FILE_DENTRY_T *file_ep;
+	STRM_DENTRY_T *strm_ep;
+	NAME_DENTRY_T *name_ep;
+
+	file_ep = (FILE_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!file_ep)
+		return FFS_MEDIAERR;
+
+	file_ep->num_ext = (u8)(num_entries - 1);
+	buf_modify(sb, sector);
+
+	strm_ep = (STRM_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry+1, &sector);
+	if (!strm_ep)
+		return FFS_MEDIAERR;
+
+	strm_ep->name_len = p_uniname->name_len;
+	SET16_A(strm_ep->name_hash, p_uniname->name_hash);
+	buf_modify(sb, sector);
+
+	for (i = 2; i < num_entries; i++) {
+		name_ep = (NAME_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry+i, &sector);
+		if (!name_ep)
+			return FFS_MEDIAERR;
+
+		init_name_entry(name_ep, uniname);
+		buf_modify(sb, sector);
+		uniname += 15;
+	}
+
+	update_dir_checksum(sb, p_dir, entry);
+
+	return FFS_SUCCESS;
+} /* end of exfat_init_ext_entry */
+
+void init_dos_entry(DOS_DENTRY_T *ep, u32 type, u32 start_clu)
+{
+	TIMESTAMP_T tm, *tp;
+
+	fat_set_entry_type((DENTRY_T *) ep, type);
+	SET16_A(ep->start_clu_lo, CLUSTER_16(start_clu));
+	SET16_A(ep->start_clu_hi, CLUSTER_16(start_clu >> 16));
+	SET32_A(ep->size, 0);
+
+	tp = tm_current(&tm);
+	fat_set_entry_time((DENTRY_T *) ep, tp, TM_CREATE);
+	fat_set_entry_time((DENTRY_T *) ep, tp, TM_MODIFY);
+	SET16_A(ep->access_date, 0);
+	ep->create_time_ms = 0;
+} /* end of init_dos_entry */
+
+void init_ext_entry(EXT_DENTRY_T *ep, s32 order, u8 chksum, u16 *uniname)
+{
+	int i;
+	u8 end = FALSE;
+
+	fat_set_entry_type((DENTRY_T *) ep, TYPE_EXTEND);
+	ep->order = (u8) order;
+	ep->sysid = 0;
+	ep->checksum = chksum;
+	SET16_A(ep->start_clu, 0);
+
+	for (i = 0; i < 10; i += 2) {
+		if (!end) {
+			SET16(ep->unicode_0_4+i, *uniname);
+			if (*uniname == 0x0)
+				end = TRUE;
+			else
+				uniname++;
+		} else {
+			SET16(ep->unicode_0_4+i, 0xFFFF);
+		}
+	}
+
+	for (i = 0; i < 12; i += 2) {
+		if (!end) {
+			SET16_A(ep->unicode_5_10+i, *uniname);
+			if (*uniname == 0x0)
+				end = TRUE;
+			else
+				uniname++;
+		} else {
+			SET16_A(ep->unicode_5_10+i, 0xFFFF);
+		}
+	}
+
+	for (i = 0; i < 4; i += 2) {
+		if (!end) {
+			SET16_A(ep->unicode_11_12+i, *uniname);
+			if (*uniname == 0x0)
+				end = TRUE;
+			else
+				uniname++;
+		} else {
+			SET16_A(ep->unicode_11_12+i, 0xFFFF);
+		}
+	}
+} /* end of init_ext_entry */
+
+void init_file_entry(FILE_DENTRY_T *ep, u32 type)
+{
+	TIMESTAMP_T tm, *tp;
+
+	exfat_set_entry_type((DENTRY_T *) ep, type);
+
+	tp = tm_current(&tm);
+	exfat_set_entry_time((DENTRY_T *) ep, tp, TM_CREATE);
+	exfat_set_entry_time((DENTRY_T *) ep, tp, TM_MODIFY);
+	exfat_set_entry_time((DENTRY_T *) ep, tp, TM_ACCESS);
+	ep->create_time_ms = 0;
+	ep->modify_time_ms = 0;
+	ep->access_time_ms = 0;
+} /* end of init_file_entry */
+
+void init_strm_entry(STRM_DENTRY_T *ep, u8 flags, u32 start_clu, u64 size)
+{
+	exfat_set_entry_type((DENTRY_T *) ep, TYPE_STREAM);
+	ep->flags = flags;
+	SET32_A(ep->start_clu, start_clu);
+	SET64_A(ep->valid_size, size);
+	SET64_A(ep->size, size);
+} /* end of init_strm_entry */
+
+void init_name_entry(NAME_DENTRY_T *ep, u16 *uniname)
+{
+	int i;
+
+	exfat_set_entry_type((DENTRY_T *) ep, TYPE_EXTEND);
+	ep->flags = 0x0;
+
+	for (i = 0; i < 30; i++, i++) {
+		SET16_A(ep->unicode_0_14+i, *uniname);
+		if (*uniname == 0x0)
+			break;
+		uniname++;
+	}
+} /* end of init_name_entry */
+
+void fat_delete_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 order, s32 num_entries)
+{
+	int i;
+	sector_t sector;
+	DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	for (i = num_entries-1; i >= order; i--) {
+		ep = get_entry_in_dir(sb, p_dir, entry-i, &sector);
+		if (!ep)
+			return;
+
+		p_fs->fs_func->set_entry_type(ep, TYPE_DELETED);
+		buf_modify(sb, sector);
+	}
+} /* end of fat_delete_dir_entry */
+
+void exfat_delete_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 order, s32 num_entries)
+{
+	int i;
+	sector_t sector;
+	DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	for (i = order; i < num_entries; i++) {
+		ep = get_entry_in_dir(sb, p_dir, entry+i, &sector);
+		if (!ep)
+			return;
+
+		p_fs->fs_func->set_entry_type(ep, TYPE_DELETED);
+		buf_modify(sb, sector);
+	}
+} /* end of exfat_delete_dir_entry */
+
+void update_dir_checksum(struct super_block *sb, CHAIN_T *p_dir, s32 entry)
+{
+	int i, num_entries;
+	sector_t sector;
+	u16 chksum;
+	FILE_DENTRY_T *file_ep;
+	DENTRY_T *ep;
+
+	file_ep = (FILE_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!file_ep)
+		return;
+
+	buf_lock(sb, sector);
+
+	num_entries = (s32) file_ep->num_ext + 1;
+	chksum = calc_checksum_2byte((void *) file_ep, DENTRY_SIZE, 0, CS_DIR_ENTRY);
+
+	for (i = 1; i < num_entries; i++) {
+		ep = get_entry_in_dir(sb, p_dir, entry+i, NULL);
+		if (!ep) {
+			buf_unlock(sb, sector);
+			return;
+		}
+
+		chksum = calc_checksum_2byte((void *) ep, DENTRY_SIZE, chksum, CS_DEFAULT);
+	}
+
+	SET16_A(file_ep->checksum, chksum);
+	buf_modify(sb, sector);
+	buf_unlock(sb, sector);
+} /* end of update_dir_checksum */
+
+void update_dir_checksum_with_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es)
+{
+	DENTRY_T *ep;
+	u16 chksum = 0;
+	s32 chksum_type = CS_DIR_ENTRY, i;
+
+	ep = (DENTRY_T *)&(es->__buf);
+	for (i = 0; i < es->num_entries; i++) {
+		DPRINTK("update_dir_checksum_with_entry_set ep %p\n", ep);
+		chksum = calc_checksum_2byte((void *) ep, DENTRY_SIZE, chksum, chksum_type);
+		ep++;
+		chksum_type = CS_DEFAULT;
+	}
+
+	ep = (DENTRY_T *)&(es->__buf);
+	SET16_A(((FILE_DENTRY_T *)ep)->checksum, chksum);
+	write_whole_entry_set(sb, es);
+}
+
+static s32 _walk_fat_chain(struct super_block *sb, CHAIN_T *p_dir, s32 byte_offset, u32 *clu)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	s32 clu_offset;
+	u32 cur_clu;
+
+	clu_offset = byte_offset >> p_fs->cluster_size_bits;
+	cur_clu = p_dir->dir;
+
+	if (p_dir->flags == 0x03) {
+		cur_clu += clu_offset;
+	} else {
+		while (clu_offset > 0) {
+			if (FAT_read(sb, cur_clu, &cur_clu) == -1)
+				return FFS_MEDIAERR;
+			clu_offset--;
+		}
+	}
+
+	if (clu)
+		*clu = cur_clu;
+	return FFS_SUCCESS;
+}
+s32 find_location(struct super_block *sb, CHAIN_T *p_dir, s32 entry, sector_t *sector, s32 *offset)
+{
+	s32 off, ret;
+	u32 clu = 0;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	off = entry << DENTRY_SIZE_BITS;
+
+	if (p_dir->dir == CLUSTER_32(0)) { /* FAT16 root_dir */
+		*offset = off & p_bd->sector_size_mask;
+		*sector = off >> p_bd->sector_size_bits;
+		*sector += p_fs->root_start_sector;
+	} else {
+		ret = _walk_fat_chain(sb, p_dir, off, &clu);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		off &= p_fs->cluster_size - 1;	/* byte offset in cluster */
+
+		*offset = off & p_bd->sector_size_mask;	/* byte offset in sector    */
+		*sector = off >> p_bd->sector_size_bits;	/* sector offset in cluster */
+		*sector += START_SECTOR(clu);
+	}
+	return FFS_SUCCESS;
+} /* end of find_location */
+
+DENTRY_T *get_entry_with_sector(struct super_block *sb, sector_t sector, s32 offset)
+{
+	u8 *buf;
+
+	buf = buf_getblk(sb, sector);
+
+	if (buf == NULL)
+		return NULL;
+
+	return (DENTRY_T *)(buf + offset);
+} /* end of get_entry_with_sector */
+
+DENTRY_T *get_entry_in_dir(struct super_block *sb, CHAIN_T *p_dir, s32 entry, sector_t *sector)
+{
+	s32 off;
+	sector_t sec;
+	u8 *buf;
+
+	if (find_location(sb, p_dir, entry, &sec, &off) != FFS_SUCCESS)
+		return NULL;
+
+	buf = buf_getblk(sb, sec);
+
+	if (buf == NULL)
+		return NULL;
+
+	if (sector != NULL)
+		*sector = sec;
+	return (DENTRY_T *)(buf + off);
+} /* end of get_entry_in_dir */
+
+
+/* returns a set of dentries for a file or dir.
+ * Note that this is a copy (dump) of dentries so that user should call write_entry_set()
+ * to apply changes made in this entry set to the real device.
+ * in:
+ *   sb+p_dir+entry: indicates a file/dir
+ *   type:  specifies how many dentries should be included.
+ * out:
+ *   file_ep: will point the first dentry(= file dentry) on success
+ * return:
+ *   pointer of entry set on success,
+ *   NULL on failure.
+ */
+
+#define ES_MODE_STARTED				0
+#define ES_MODE_GET_FILE_ENTRY			1
+#define ES_MODE_GET_STRM_ENTRY			2
+#define ES_MODE_GET_NAME_ENTRY			3
+#define ES_MODE_GET_CRITICAL_SEC_ENTRY		4
+ENTRY_SET_CACHE_T *get_entry_set_in_dir(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type, DENTRY_T **file_ep)
+{
+	s32 off, ret, byte_offset;
+	u32 clu = 0;
+	sector_t sec;
+	u32 entry_type;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	ENTRY_SET_CACHE_T *es = NULL;
+	DENTRY_T *ep, *pos;
+	u8 *buf;
+	u8 num_entries;
+	s32 mode = ES_MODE_STARTED;
+
+	DPRINTK("get_entry_set_in_dir entered\n");
+	DPRINTK("p_dir dir %u flags %x size %d\n", p_dir->dir, p_dir->flags, p_dir->size);
+
+	byte_offset = entry << DENTRY_SIZE_BITS;
+	ret = _walk_fat_chain(sb, p_dir, byte_offset, &clu);
+	if (ret != FFS_SUCCESS)
+		return NULL;
+
+
+	byte_offset &= p_fs->cluster_size - 1;	/* byte offset in cluster */
+
+	off = byte_offset & p_bd->sector_size_mask;	/* byte offset in sector    */
+	sec = byte_offset >> p_bd->sector_size_bits;	/* sector offset in cluster */
+	sec += START_SECTOR(clu);
+
+	buf = buf_getblk(sb, sec);
+	if (buf == NULL)
+		goto err_out;
+
+
+	ep = (DENTRY_T *)(buf + off);
+	entry_type = p_fs->fs_func->get_entry_type(ep);
+
+	if ((entry_type != TYPE_FILE)
+		&& (entry_type != TYPE_DIR))
+		goto err_out;
+
+	if (type == ES_ALL_ENTRIES)
+		num_entries = ((FILE_DENTRY_T *)ep)->num_ext+1;
+	else
+		num_entries = type;
+
+	DPRINTK("trying to kmalloc %zx bytes for %d entries\n", offsetof(ENTRY_SET_CACHE_T, __buf) + (num_entries)  * sizeof(DENTRY_T), num_entries);
+	es = kmalloc(offsetof(ENTRY_SET_CACHE_T, __buf) + (num_entries)  * sizeof(DENTRY_T), GFP_KERNEL);
+	if (es == NULL)
+		goto err_out;
+
+	es->num_entries = num_entries;
+	es->sector = sec;
+	es->offset = off;
+	es->alloc_flag = p_dir->flags;
+
+	pos = (DENTRY_T *) &(es->__buf);
+
+	while(num_entries) {
+		/* instead of copying whole sector, we will check every entry.
+		 * this will provide minimum stablity and consistancy.
+		 */
+
+		entry_type = p_fs->fs_func->get_entry_type(ep);
+
+		if ((entry_type == TYPE_UNUSED) || (entry_type == TYPE_DELETED))
+			goto err_out;
+
+		switch (mode) {
+		case ES_MODE_STARTED:
+			if  ((entry_type == TYPE_FILE) || (entry_type == TYPE_DIR))
+				mode = ES_MODE_GET_FILE_ENTRY;
+			else
+				goto err_out;
+			break;
+		case ES_MODE_GET_FILE_ENTRY:
+			if (entry_type == TYPE_STREAM)
+				mode = ES_MODE_GET_STRM_ENTRY;
+			else
+				goto err_out;
+			break;
+		case ES_MODE_GET_STRM_ENTRY:
+			if (entry_type == TYPE_EXTEND)
+				mode = ES_MODE_GET_NAME_ENTRY;
+			else
+				goto err_out;
+			break;
+		case ES_MODE_GET_NAME_ENTRY:
+			if (entry_type == TYPE_EXTEND)
+				break;
+			else if (entry_type == TYPE_STREAM)
+				goto err_out;
+			else if (entry_type & TYPE_CRITICAL_SEC)
+				mode = ES_MODE_GET_CRITICAL_SEC_ENTRY;
+			else
+				goto err_out;
+			break;
+		case ES_MODE_GET_CRITICAL_SEC_ENTRY:
+			if ((entry_type == TYPE_EXTEND) || (entry_type == TYPE_STREAM))
+				goto err_out;
+			else if ((entry_type & TYPE_CRITICAL_SEC) != TYPE_CRITICAL_SEC)
+				goto err_out;
+			break;
+		}
+
+		memcpy(pos, ep, sizeof(DENTRY_T));
+
+		if (--num_entries == 0)
+			break;
+
+		if (((off + DENTRY_SIZE) & p_bd->sector_size_mask) < (off &  p_bd->sector_size_mask)) {
+			/* get the next sector */
+			if (IS_LAST_SECTOR_IN_CLUSTER(sec)) {
+				if (es->alloc_flag == 0x03) {
+					clu++;
+				} else {
+					if (FAT_read(sb, clu, &clu) == -1)
+						goto err_out;
+				}
+				sec = START_SECTOR(clu);
+			} else {
+				sec++;
+			}
+			buf = buf_getblk(sb, sec);
+			if (buf == NULL)
+				goto err_out;
+			off = 0;
+			ep = (DENTRY_T *)(buf);
+		} else {
+			ep++;
+			off += DENTRY_SIZE;
+		}
+		pos++;
+	}
+
+	if (file_ep)
+		*file_ep = (DENTRY_T *)&(es->__buf);
+
+	DPRINTK("es sec %llu offset %d flags %d, num_entries %u buf ptr %p\n",
+		   (unsigned long long)es->sector, es->offset, es->alloc_flag,
+		   es->num_entries, &(es->__buf));
+	DPRINTK("get_entry_set_in_dir exited %p\n", es);
+	return es;
+err_out:
+	DPRINTK("get_entry_set_in_dir exited NULL (es %p)\n", es);
+	if (es)
+		kfree(es);
+	return NULL;
+}
+
+void release_entry_set(ENTRY_SET_CACHE_T *es)
+{
+	DPRINTK("release_entry_set %p\n", es);
+	if (es)
+		kfree(es);
+}
+
+
+static s32 __write_partial_entries_in_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es, sector_t sec, s32 off, u32 count)
+{
+	s32 num_entries, buf_off = (off - es->offset);
+	u32 remaining_byte_in_sector, copy_entries;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	u32 clu;
+	u8 *buf, *esbuf = (u8 *)&(es->__buf);
+
+	DPRINTK("__write_partial_entries_in_entry_set entered\n");
+	DPRINTK("es %p sec %llu off %d count %d\n", es, (unsigned long long)sec, off, count);
+	num_entries = count;
+
+	while (num_entries) {
+		/* white per sector base */
+		remaining_byte_in_sector = (1 << p_bd->sector_size_bits) - off;
+		copy_entries = MIN(remaining_byte_in_sector >> DENTRY_SIZE_BITS , num_entries);
+		buf = buf_getblk(sb, sec);
+		if (buf == NULL)
+			goto err_out;
+		DPRINTK("es->buf %p buf_off %u\n", esbuf, buf_off);
+		DPRINTK("copying %d entries from %p to sector %llu\n", copy_entries, (esbuf + buf_off), (unsigned long long)sec);
+		memcpy(buf + off, esbuf + buf_off, copy_entries << DENTRY_SIZE_BITS);
+		buf_modify(sb, sec);
+		num_entries -= copy_entries;
+
+		if (num_entries) {
+			/* get next sector */
+			if (IS_LAST_SECTOR_IN_CLUSTER(sec)) {
+				clu = GET_CLUSTER_FROM_SECTOR(sec);
+				if (es->alloc_flag == 0x03) {
+					clu++;
+				} else {
+					if (FAT_read(sb, clu, &clu) == -1)
+						goto err_out;
+				}
+				sec = START_SECTOR(clu);
+			} else {
+				sec++;
+			}
+			off = 0;
+			buf_off += copy_entries << DENTRY_SIZE_BITS;
+		}
+	}
+
+	DPRINTK("__write_partial_entries_in_entry_set exited successfully\n");
+	return FFS_SUCCESS;
+err_out:
+	DPRINTK("__write_partial_entries_in_entry_set failed\n");
+	return FFS_ERROR;
+}
+
+/* write back all entries in entry set */
+s32 write_whole_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es)
+{
+	return __write_partial_entries_in_entry_set(sb, es, es->sector, es->offset, es->num_entries);
+}
+
+/* write back some entries in entry set */
+s32 write_partial_entries_in_entry_set (struct super_block *sb, ENTRY_SET_CACHE_T *es, DENTRY_T *ep, u32 count)
+{
+	s32 ret, byte_offset, off;
+	u32 clu=0;
+	sector_t sec;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	CHAIN_T dir;
+
+	/* vaidity check */
+	if (ep + count  > ((DENTRY_T *)&(es->__buf)) + es->num_entries)
+		return FFS_ERROR;
+
+	dir.dir = GET_CLUSTER_FROM_SECTOR(es->sector);
+	dir.flags = es->alloc_flag;
+	dir.size = 0xffffffff;		/* XXX */
+
+	byte_offset = (es->sector - START_SECTOR(dir.dir)) << p_bd->sector_size_bits;
+	byte_offset += ((void **)ep - &(es->__buf)) + es->offset;
+
+	ret =_walk_fat_chain(sb, &dir, byte_offset, &clu);
+	if (ret != FFS_SUCCESS)
+		return ret;
+	byte_offset &= p_fs->cluster_size - 1;	/* byte offset in cluster */
+	off = byte_offset & p_bd->sector_size_mask;	/* byte offset in sector    */
+	sec = byte_offset >> p_bd->sector_size_bits;	/* sector offset in cluster */
+	sec += START_SECTOR(clu);
+	return __write_partial_entries_in_entry_set(sb, es, sec, off, count);
+}
+
+/* search EMPTY CONTINUOUS "num_entries" entries */
+s32 search_deleted_or_unused_entry(struct super_block *sb, CHAIN_T *p_dir, s32 num_entries)
+{
+	int i, dentry, num_empty = 0;
+	s32 dentries_per_clu;
+	u32 type;
+	CHAIN_T clu;
+	DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	if (p_fs->hint_uentry.dir == p_dir->dir) {
+		if (p_fs->hint_uentry.entry == -1)
+			return -1;
+
+		clu.dir = p_fs->hint_uentry.clu.dir;
+		clu.size = p_fs->hint_uentry.clu.size;
+		clu.flags = p_fs->hint_uentry.clu.flags;
+
+		dentry = p_fs->hint_uentry.entry;
+	} else {
+		p_fs->hint_uentry.entry = -1;
+
+		clu.dir = p_dir->dir;
+		clu.size = p_dir->size;
+		clu.flags = p_dir->flags;
+
+		dentry = 0;
+	}
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+			i = dentry % dentries_per_clu;
+		else
+			i = dentry & (dentries_per_clu-1);
+
+		for (; i < dentries_per_clu; i++, dentry++) {
+			ep = get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return -1;
+
+			type = p_fs->fs_func->get_entry_type(ep);
+
+			if (type == TYPE_UNUSED) {
+				num_empty++;
+				if (p_fs->hint_uentry.entry == -1) {
+					p_fs->hint_uentry.dir = p_dir->dir;
+					p_fs->hint_uentry.entry = dentry;
+
+					p_fs->hint_uentry.clu.dir = clu.dir;
+					p_fs->hint_uentry.clu.size = clu.size;
+					p_fs->hint_uentry.clu.flags = clu.flags;
+				}
+			} else if (type == TYPE_DELETED) {
+				num_empty++;
+			} else {
+				num_empty = 0;
+			}
+
+			if (num_empty >= num_entries) {
+				p_fs->hint_uentry.dir = CLUSTER_32(~0);
+				p_fs->hint_uentry.entry = -1;
+
+				if (p_fs->vol_type == EXFAT)
+					return dentry - (num_entries-1);
+				else
+					return dentry;
+			}
+		}
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (clu.flags == 0x03) {
+			if ((--clu.size) > 0)
+				clu.dir++;
+			else
+				clu.dir = CLUSTER_32(~0);
+		} else {
+			if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+				return -1;
+		}
+	}
+
+	return -1;
+} /* end of search_deleted_or_unused_entry */
+
+s32 find_empty_entry(struct inode *inode, CHAIN_T *p_dir, s32 num_entries)
+{
+	s32 ret, dentry;
+	u32 last_clu;
+	sector_t sector;
+	u64 size = 0;
+	CHAIN_T clu;
+	DENTRY_T *ep = NULL;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		return search_deleted_or_unused_entry(sb, p_dir, num_entries);
+
+	while ((dentry = search_deleted_or_unused_entry(sb, p_dir, num_entries)) < 0) {
+		if (p_fs->dev_ejected)
+			break;
+
+		if (p_fs->vol_type == EXFAT) {
+			if (p_dir->dir != p_fs->root_dir)
+				size = i_size_read(inode);
+		}
+
+		last_clu = find_last_cluster(sb, p_dir);
+		clu.dir = last_clu + 1;
+		clu.size = 0;
+		clu.flags = p_dir->flags;
+
+		/* (1) allocate a cluster */
+		ret = p_fs->fs_func->alloc_cluster(sb, 1, &clu);
+		if (ret < 1)
+			return -1;
+
+		if (clear_cluster(sb, clu.dir) != FFS_SUCCESS)
+			return -1;
+
+		/* (2) append to the FAT chain */
+		if (clu.flags != p_dir->flags) {
+			exfat_chain_cont_cluster(sb, p_dir->dir, p_dir->size);
+			p_dir->flags = 0x01;
+			p_fs->hint_uentry.clu.flags = 0x01;
+		}
+		if (clu.flags == 0x01)
+			if (FAT_write(sb, last_clu, clu.dir) < 0)
+				return -1;
+
+		if (p_fs->hint_uentry.entry == -1) {
+			p_fs->hint_uentry.dir = p_dir->dir;
+			p_fs->hint_uentry.entry = p_dir->size << (p_fs->cluster_size_bits - DENTRY_SIZE_BITS);
+
+			p_fs->hint_uentry.clu.dir = clu.dir;
+			p_fs->hint_uentry.clu.size = 0;
+			p_fs->hint_uentry.clu.flags = clu.flags;
+		}
+		p_fs->hint_uentry.clu.size++;
+		p_dir->size++;
+
+		/* (3) update the directory entry */
+		if (p_fs->vol_type == EXFAT) {
+			if (p_dir->dir != p_fs->root_dir) {
+				size += p_fs->cluster_size;
+
+				ep = get_entry_in_dir(sb, &(fid->dir), fid->entry+1, &sector);
+				if (!ep)
+					return -1;
+				p_fs->fs_func->set_entry_size(ep, size);
+				p_fs->fs_func->set_entry_flag(ep, p_dir->flags);
+				buf_modify(sb, sector);
+
+				update_dir_checksum(sb, &(fid->dir), fid->entry);
+			}
+		}
+
+		i_size_write(inode, i_size_read(inode)+p_fs->cluster_size);
+		EXFAT_I(inode)->mmu_private += p_fs->cluster_size;
+		EXFAT_I(inode)->fid.size += p_fs->cluster_size;
+		EXFAT_I(inode)->fid.flags = p_dir->flags;
+		inode->i_blocks += 1 << (p_fs->cluster_size_bits - 9);
+	}
+
+	return dentry;
+} /* end of find_empty_entry */
+
+/* return values of fat_find_dir_entry()
+   >= 0 : return dir entiry position with the name in dir
+   -1 : (root dir, ".") it is the root dir itself
+   -2 : entry with the name does not exist */
+s32 fat_find_dir_entry(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 num_entries, DOS_NAME_T *p_dosname, u32 type)
+{
+	int i, dentry = 0, lossy = FALSE, len;
+	s32 order = 0, is_feasible_entry = TRUE, has_ext_entry = FALSE;
+	s32 dentries_per_clu;
+	u32 entry_type;
+	u16 entry_uniname[14], *uniname = NULL, unichar;
+	CHAIN_T clu;
+	DENTRY_T *ep;
+	DOS_DENTRY_T *dos_ep;
+	EXT_DENTRY_T *ext_ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_dir->dir == p_fs->root_dir) {
+		if ((!nls_uniname_cmp(sb, p_uniname->name, (u16 *) UNI_CUR_DIR_NAME)) ||
+			(!nls_uniname_cmp(sb, p_uniname->name, (u16 *) UNI_PAR_DIR_NAME)))
+			return -1; // special case, root directory itself
+	}
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	clu.dir = p_dir->dir;
+	clu.flags = p_dir->flags;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		for (i = 0; i < dentries_per_clu; i++, dentry++) {
+			ep = get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return -2;
+
+			entry_type = p_fs->fs_func->get_entry_type(ep);
+
+			if ((entry_type == TYPE_FILE) || (entry_type == TYPE_DIR)) {
+				if ((type == TYPE_ALL) || (type == entry_type)) {
+					if (is_feasible_entry && has_ext_entry)
+						return dentry;
+
+					dos_ep = (DOS_DENTRY_T *) ep;
+					if ((!lossy) && (!nls_dosname_cmp(sb, p_dosname->name, dos_ep->name)))
+						return dentry;
+				}
+				is_feasible_entry = TRUE;
+				has_ext_entry = FALSE;
+			} else if (entry_type == TYPE_EXTEND) {
+				if (is_feasible_entry) {
+					ext_ep = (EXT_DENTRY_T *) ep;
+					if (ext_ep->order > 0x40) {
+						order = (s32)(ext_ep->order - 0x40);
+						uniname = p_uniname->name + 13 * (order-1);
+					} else {
+						order = (s32) ext_ep->order;
+						uniname -= 13;
+					}
+
+					len = extract_uni_name_from_ext_entry(ext_ep, entry_uniname, order);
+
+					unichar = *(uniname+len);
+					*(uniname+len) = 0x0;
+
+					if (nls_uniname_cmp(sb, uniname, entry_uniname))
+						is_feasible_entry = FALSE;
+
+					*(uniname+len) = unichar;
+				}
+				has_ext_entry = TRUE;
+			} else if (entry_type == TYPE_UNUSED) {
+				return -2;
+			} else {
+				is_feasible_entry = TRUE;
+				has_ext_entry = FALSE;
+			}
+		}
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+			return -2;
+	}
+
+	return -2;
+} /* end of fat_find_dir_entry */
+
+/* return values of exfat_find_dir_entry()
+   >= 0 : return dir entiry position with the name in dir
+   -1 : (root dir, ".") it is the root dir itself
+   -2 : entry with the name does not exist */
+s32 exfat_find_dir_entry(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 num_entries, DOS_NAME_T *p_dosname, u32 type)
+{
+	int i = 0, dentry = 0, num_ext_entries = 0, len, step;
+	s32 order = 0, is_feasible_entry = FALSE;
+	s32 dentries_per_clu, num_empty = 0;
+	u32 entry_type;
+	u16 entry_uniname[16], *uniname = NULL, unichar;
+	CHAIN_T clu;
+	DENTRY_T *ep;
+	FILE_DENTRY_T *file_ep;
+	STRM_DENTRY_T *strm_ep;
+	NAME_DENTRY_T *name_ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_dir->dir == p_fs->root_dir) {
+		if ((!nls_uniname_cmp(sb, p_uniname->name, (u16 *) UNI_CUR_DIR_NAME)) ||
+			(!nls_uniname_cmp(sb, p_uniname->name, (u16 *) UNI_PAR_DIR_NAME)))
+			return -1; // special case, root directory itself
+	}
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	clu.dir = p_dir->dir;
+	clu.size = p_dir->size;
+	clu.flags = p_dir->flags;
+
+	p_fs->hint_uentry.dir = p_dir->dir;
+	p_fs->hint_uentry.entry = -1;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		while (i < dentries_per_clu) {
+			ep = get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return -2;
+
+			entry_type = p_fs->fs_func->get_entry_type(ep);
+			step = 1;
+
+			if ((entry_type == TYPE_UNUSED) || (entry_type == TYPE_DELETED)) {
+				is_feasible_entry = FALSE;
+
+				if (p_fs->hint_uentry.entry == -1) {
+					num_empty++;
+
+					if (num_empty == 1) {
+						p_fs->hint_uentry.clu.dir = clu.dir;
+						p_fs->hint_uentry.clu.size = clu.size;
+						p_fs->hint_uentry.clu.flags = clu.flags;
+					}
+					if ((num_empty >= num_entries) || (entry_type == TYPE_UNUSED))
+						p_fs->hint_uentry.entry = dentry - (num_empty-1);
+				}
+
+				if (entry_type == TYPE_UNUSED)
+					return -2;
+			} else {
+				num_empty = 0;
+
+				if ((entry_type == TYPE_FILE) || (entry_type == TYPE_DIR)) {
+					file_ep = (FILE_DENTRY_T *) ep;
+					if ((type == TYPE_ALL) || (type == entry_type)) {
+						num_ext_entries = file_ep->num_ext;
+						is_feasible_entry = TRUE;
+					} else {
+						is_feasible_entry = FALSE;
+						step = file_ep->num_ext + 1;
+					}
+				} else if (entry_type == TYPE_STREAM) {
+					if (is_feasible_entry) {
+						strm_ep = (STRM_DENTRY_T *) ep;
+						if (p_uniname->name_hash == GET16_A(strm_ep->name_hash) &&
+						    p_uniname->name_len == strm_ep->name_len) {
+							order = 1;
+						} else {
+							is_feasible_entry = FALSE;
+							step = num_ext_entries;
+						}
+					}
+				} else if (entry_type == TYPE_EXTEND) {
+					if (is_feasible_entry) {
+						name_ep = (NAME_DENTRY_T *) ep;
+
+						if ((++order) == 2)
+							uniname = p_uniname->name;
+						else
+							uniname += 15;
+
+						len = extract_uni_name_from_name_entry(name_ep, entry_uniname, order);
+
+						unichar = *(uniname+len);
+						*(uniname+len) = 0x0;
+
+						if (nls_uniname_cmp(sb, uniname, entry_uniname)) {
+							is_feasible_entry = FALSE;
+							step = num_ext_entries - order + 1;
+						} else if (order == num_ext_entries) {
+							p_fs->hint_uentry.dir = CLUSTER_32(~0);
+							p_fs->hint_uentry.entry = -1;
+							return dentry - (num_ext_entries);
+						}
+
+						*(uniname+len) = unichar;
+					}
+				} else {
+					is_feasible_entry = FALSE;
+				}
+			}
+
+			i += step;
+			dentry += step;
+		}
+
+		i -= dentries_per_clu;
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (clu.flags == 0x03) {
+			if ((--clu.size) > 0)
+				clu.dir++;
+			else
+				clu.dir = CLUSTER_32(~0);
+		} else {
+			if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+				return -2;
+		}
+	}
+
+	return -2;
+} /* end of exfat_find_dir_entry */
+
+/* returns -1 on error */
+s32 fat_count_ext_entries(struct super_block *sb, CHAIN_T *p_dir, s32 entry, DENTRY_T *p_entry)
+{
+	s32 count = 0;
+	u8 chksum;
+	DOS_DENTRY_T *dos_ep = (DOS_DENTRY_T *) p_entry;
+	EXT_DENTRY_T *ext_ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	chksum = calc_checksum_1byte((void *) dos_ep->name, DOS_NAME_LENGTH, 0);
+
+	for (entry--; entry >= 0; entry--) {
+		ext_ep = (EXT_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, NULL);
+		if (!ext_ep)
+			return -1;
+
+		if ((p_fs->fs_func->get_entry_type((DENTRY_T *) ext_ep) == TYPE_EXTEND) &&
+			(ext_ep->checksum == chksum)) {
+			count++;
+			if (ext_ep->order > 0x40)
+				return count;
+		} else {
+			return count;
+		}
+	}
+
+	return count;
+} /* end of fat_count_ext_entries */
+
+/* returns -1 on error */
+s32 exfat_count_ext_entries(struct super_block *sb, CHAIN_T *p_dir, s32 entry, DENTRY_T *p_entry)
+{
+	int i, count = 0;
+	u32 type;
+	FILE_DENTRY_T *file_ep = (FILE_DENTRY_T *) p_entry;
+	DENTRY_T *ext_ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	for (i = 0, entry++; i < file_ep->num_ext; i++, entry++) {
+		ext_ep = get_entry_in_dir(sb, p_dir, entry, NULL);
+		if (!ext_ep)
+			return -1;
+
+		type = p_fs->fs_func->get_entry_type(ext_ep);
+		if ((type == TYPE_EXTEND) || (type == TYPE_STREAM))
+			count++;
+		else
+			return count;
+	}
+
+	return count;
+} /* end of exfat_count_ext_entries */
+
+/* returns -1 on error */
+s32 count_dos_name_entries(struct super_block *sb, CHAIN_T *p_dir, u32 type)
+{
+	int i, count = 0;
+	s32 dentries_per_clu;
+	u32 entry_type;
+	CHAIN_T clu;
+	DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	clu.dir = p_dir->dir;
+	clu.size = p_dir->size;
+	clu.flags = p_dir->flags;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		for (i = 0; i < dentries_per_clu; i++) {
+			ep = get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return -1;
+
+			entry_type = p_fs->fs_func->get_entry_type(ep);
+
+			if (entry_type == TYPE_UNUSED)
+				return count;
+			if (!(type & TYPE_CRITICAL_PRI) && !(type & TYPE_BENIGN_PRI))
+				continue;
+
+			if ((type == TYPE_ALL) || (type == entry_type))
+				count++;
+		}
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (clu.flags == 0x03) {
+			if ((--clu.size) > 0)
+				clu.dir++;
+			else
+				clu.dir = CLUSTER_32(~0);
+		} else {
+			if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+				return -1;
+		}
+	}
+
+	return count;
+} /* end of count_dos_name_entries */
+
+bool is_dir_empty(struct super_block *sb, CHAIN_T *p_dir)
+{
+	int i, count = 0;
+	s32 dentries_per_clu;
+	u32 type;
+	CHAIN_T clu;
+	DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	clu.dir = p_dir->dir;
+	clu.size = p_dir->size;
+	clu.flags = p_dir->flags;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		for (i = 0; i < dentries_per_clu; i++) {
+			ep = get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				break;
+
+			type = p_fs->fs_func->get_entry_type(ep);
+
+			if (type == TYPE_UNUSED)
+				return TRUE;
+			if ((type != TYPE_FILE) && (type != TYPE_DIR))
+				continue;
+
+			if (p_dir->dir == CLUSTER_32(0)) { /* FAT16 root_dir */
+				return FALSE;
+			} else {
+				if (p_fs->vol_type == EXFAT)
+					return FALSE;
+				if ((p_dir->dir == p_fs->root_dir) || ((++count) > 2))
+					return FALSE;
+			}
+		}
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (clu.flags == 0x03) {
+			if ((--clu.size) > 0)
+				clu.dir++;
+			else
+				clu.dir = CLUSTER_32(~0);
+		} else {
+			if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+				break;
+		}
+	}
+
+	return TRUE;
+} /* end of is_dir_empty */
+
+/*
+ *  Name Conversion Functions
+ */
+
+/* input  : dir, uni_name
+   output : num_of_entry, dos_name(format : aaaaaa~1.bbb) */
+s32 get_num_entries_and_dos_name(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 *entries, DOS_NAME_T *p_dosname)
+{
+	s32 ret, num_entries, lossy = FALSE;
+	char **r;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	num_entries = p_fs->fs_func->calc_num_entries(p_uniname);
+	if (num_entries == 0)
+		return FFS_INVALIDPATH;
+
+	if (p_fs->vol_type != EXFAT) {
+		nls_uniname_to_dosname(sb, p_dosname, p_uniname, &lossy);
+
+		if (lossy) {
+			ret = fat_generate_dos_name(sb, p_dir, p_dosname);
+			if (ret)
+				return ret;
+		} else {
+			for (r = reserved_names; *r; r++) {
+				if (!strncmp((void *) p_dosname->name, *r, 8))
+					return FFS_INVALIDPATH;
+			}
+
+			if (p_dosname->name_case != 0xFF)
+				num_entries = 1;
+		}
+
+		if (num_entries > 1)
+			p_dosname->name_case = 0x0;
+	}
+
+	*entries = num_entries;
+
+	return FFS_SUCCESS;
+} /* end of get_num_entries_and_dos_name */
+
+void get_uni_name_from_dos_entry(struct super_block *sb, DOS_DENTRY_T *ep, UNI_NAME_T *p_uniname, u8 mode)
+{
+	DOS_NAME_T dos_name;
+
+	if (mode == 0x0)
+		dos_name.name_case = 0x0;
+	else
+		dos_name.name_case = ep->lcase;
+
+	memcpy(dos_name.name, ep->name, DOS_NAME_LENGTH);
+	nls_dosname_to_uniname(sb, p_uniname, &dos_name);
+} /* end of get_uni_name_from_dos_entry */
+
+void fat_get_uni_name_from_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u16 *uniname)
+{
+	int i;
+	EXT_DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	for (entry--, i = 1; entry >= 0; entry--, i++) {
+		ep = (EXT_DENTRY_T *) get_entry_in_dir(sb, p_dir, entry, NULL);
+		if (!ep)
+			return;
+
+		if (p_fs->fs_func->get_entry_type((DENTRY_T *) ep) == TYPE_EXTEND) {
+			extract_uni_name_from_ext_entry(ep, uniname, i);
+			if (ep->order > 0x40)
+				return;
+		} else {
+			return;
+		}
+
+		uniname += 13;
+	}
+} /* end of fat_get_uni_name_from_ext_entry */
+
+void exfat_get_uni_name_from_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u16 *uniname)
+{
+	int i;
+	DENTRY_T *ep;
+	ENTRY_SET_CACHE_T *es;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	es = get_entry_set_in_dir(sb, p_dir, entry, ES_ALL_ENTRIES, &ep);
+	if (es == NULL || es->num_entries < 3) {
+		if (es)
+			release_entry_set(es);
+		return;
+	}
+
+	ep += 2;
+
+	/*
+	* First entry  : file entry
+	* Second entry : stream-extension entry
+	* Third entry  : first file-name entry
+	* So, the index of first file-name dentry should start from 2.
+	*/
+	for (i = 2; i < es->num_entries; i++, ep++) {
+		if (p_fs->fs_func->get_entry_type(ep) == TYPE_EXTEND)
+			extract_uni_name_from_name_entry((NAME_DENTRY_T *)ep, uniname, i);
+		else
+			goto out;
+		uniname += 15;
+	}
+
+out:
+	release_entry_set(es);
+} /* end of exfat_get_uni_name_from_ext_entry */
+
+s32 extract_uni_name_from_ext_entry(EXT_DENTRY_T *ep, u16 *uniname, s32 order)
+{
+	int i, len = 0;
+
+	for (i = 0; i < 10; i += 2) {
+		*uniname = GET16(ep->unicode_0_4+i);
+		if (*uniname == 0x0)
+			return len;
+		uniname++;
+		len++;
+	}
+
+	if (order < 20) {
+		for (i = 0; i < 12; i += 2) {
+			*uniname = GET16_A(ep->unicode_5_10+i);
+			if (*uniname == 0x0)
+				return len;
+			uniname++;
+			len++;
+		}
+	} else {
+		for (i = 0; i < 8; i += 2) {
+			*uniname = GET16_A(ep->unicode_5_10+i);
+			if (*uniname == 0x0)
+				return len;
+			uniname++;
+			len++;
+		}
+		*uniname = 0x0; /* uniname[MAX_NAME_LENGTH-1] */
+		return len;
+	}
+
+	for (i = 0; i < 4; i += 2) {
+		*uniname = GET16_A(ep->unicode_11_12+i);
+		if (*uniname == 0x0)
+			return len;
+		uniname++;
+		len++;
+	}
+
+	*uniname = 0x0;
+	return len;
+
+} /* end of extract_uni_name_from_ext_entry */
+
+s32 extract_uni_name_from_name_entry(NAME_DENTRY_T *ep, u16 *uniname, s32 order)
+{
+	int i, len = 0;
+
+	for (i = 0; i < 30; i += 2) {
+		*uniname = GET16_A(ep->unicode_0_14+i);
+		if (*uniname == 0x0)
+			return len;
+		uniname++;
+		len++;
+	}
+
+	*uniname = 0x0;
+	return len;
+
+} /* end of extract_uni_name_from_name_entry */
+
+s32 fat_generate_dos_name(struct super_block *sb, CHAIN_T *p_dir, DOS_NAME_T *p_dosname)
+{
+	int i, j, count = 0, count_begin = FALSE;
+	s32 dentries_per_clu;
+	u32 type;
+	u8 bmap[128/* 1 ~ 1023 */];
+	CHAIN_T clu;
+	DOS_DENTRY_T *ep;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	memset(bmap, 0, sizeof bmap);
+	exfat_bitmap_set(bmap, 0);
+
+	if (p_dir->dir == CLUSTER_32(0)) /* FAT16 root_dir */
+		dentries_per_clu = p_fs->dentries_in_root;
+	else
+		dentries_per_clu = p_fs->dentries_per_clu;
+
+	clu.dir = p_dir->dir;
+	clu.flags = p_dir->flags;
+
+	while (clu.dir != CLUSTER_32(~0)) {
+		if (p_fs->dev_ejected)
+			break;
+
+		for (i = 0; i < dentries_per_clu; i++) {
+			ep = (DOS_DENTRY_T *) get_entry_in_dir(sb, &clu, i, NULL);
+			if (!ep)
+				return FFS_MEDIAERR;
+
+			type = p_fs->fs_func->get_entry_type((DENTRY_T *) ep);
+
+			if (type == TYPE_UNUSED)
+				break;
+			if ((type != TYPE_FILE) && (type != TYPE_DIR))
+				continue;
+
+			count = 0;
+			count_begin = FALSE;
+
+			for (j = 0; j < 8; j++) {
+				if (ep->name[j] == ' ')
+					break;
+
+				if (ep->name[j] == '~') {
+					count_begin = TRUE;
+				} else if (count_begin) {
+					if ((ep->name[j] >= '0') && (ep->name[j] <= '9')) {
+						count = count * 10 + (ep->name[j] - '0');
+					} else {
+						count = 0;
+						count_begin = FALSE;
+					}
+				}
+			}
+
+			if ((count > 0) && (count < 1024))
+				exfat_bitmap_set(bmap, count);
+		}
+
+		if (p_dir->dir == CLUSTER_32(0))
+			break; /* FAT16 root_dir */
+
+		if (FAT_read(sb, clu.dir, &(clu.dir)) != 0)
+			return FFS_MEDIAERR;
+	}
+
+	count = 0;
+	for (i = 0; i < 128; i++) {
+		if (bmap[i] != 0xFF) {
+			for (j = 0; j < 8; j++) {
+				if (exfat_bitmap_test(&(bmap[i]), j) == 0) {
+					count = (i << 3) + j;
+					break;
+				}
+			}
+			if (count != 0)
+				break;
+		}
+	}
+
+	if ((count == 0) || (count >= 1024))
+		return FFS_FILEEXIST;
+	else
+		fat_attach_count_to_dos_name(p_dosname->name, count);
+
+	/* Now dos_name has DOS~????.EXT */
+	return FFS_SUCCESS;
+} /* end of generate_dos_name */
+
+void fat_attach_count_to_dos_name(u8 *dosname, s32 count)
+{
+	int i, j, length;
+	char str_count[6];
+
+	snprintf(str_count, sizeof str_count, "~%d", count);
+	length = strlen(str_count);
+
+	i = j = 0;
+	while (j <= (8 - length)) {
+		i = j;
+		if (dosname[j] == ' ')
+			break;
+		if (dosname[j] & 0x80)
+			j += 2;
+		else
+			j++;
+	}
+
+	for (j = 0; j < length; i++, j++)
+		dosname[i] = (u8) str_count[j];
+
+	if (i == 7)
+		dosname[7] = ' ';
+
+} /* end of attach_count_to_dos_name */
+
+s32 fat_calc_num_entries(UNI_NAME_T *p_uniname)
+{
+	s32 len;
+
+	len = p_uniname->name_len;
+	if (len == 0)
+		return 0;
+
+	/* 1 dos name entry + extended entries */
+	return (len-1) / 13 + 2;
+
+} /* end of calc_num_enties */
+
+s32 exfat_calc_num_entries(UNI_NAME_T *p_uniname)
+{
+	s32 len;
+
+	len = p_uniname->name_len;
+	if (len == 0)
+		return 0;
+
+	/* 1 file entry + 1 stream entry + name entries */
+	return (len-1) / 15 + 3;
+
+} /* end of exfat_calc_num_enties */
+
+u8 calc_checksum_1byte(void *data, s32 len, u8 chksum)
+{
+	int i;
+	u8 *c = (u8 *) data;
+
+	for (i = 0; i < len; i++, c++)
+		chksum = (((chksum & 1) << 7) | ((chksum & 0xFE) >> 1)) + *c;
+
+	return chksum;
+} /* end of calc_checksum_1byte */
+
+u16 calc_checksum_2byte(void *data, s32 len, u16 chksum, s32 type)
+{
+	int i;
+	u8 *c = (u8 *) data;
+
+	switch (type) {
+	case CS_DIR_ENTRY:
+		for (i = 0; i < len; i++, c++) {
+			if ((i == 2) || (i == 3))
+				continue;
+			chksum = (((chksum & 1) << 15) | ((chksum & 0xFFFE) >> 1)) + (u16) *c;
+		}
+		break;
+	default
+			:
+		for (i = 0; i < len; i++, c++)
+			chksum = (((chksum & 1) << 15) | ((chksum & 0xFFFE) >> 1)) + (u16) *c;
+	}
+
+	return chksum;
+} /* end of calc_checksum_2byte */
+
+u32 calc_checksum_4byte(void *data, s32 len, u32 chksum, s32 type)
+{
+	int i;
+	u8 *c = (u8 *) data;
+
+	switch (type) {
+	case CS_PBR_SECTOR:
+		for (i = 0; i < len; i++, c++) {
+			if ((i == 106) || (i == 107) || (i == 112))
+				continue;
+			chksum = (((chksum & 1) << 31) | ((chksum & 0xFFFFFFFE) >> 1)) + (u32) *c;
+		}
+		break;
+	default
+			:
+		for (i = 0; i < len; i++, c++)
+			chksum = (((chksum & 1) << 31) | ((chksum & 0xFFFFFFFE) >> 1)) + (u32) *c;
+	}
+
+	return chksum;
+} /* end of calc_checksum_4byte */
+
+/*
+ *  Name Resolution Functions
+ */
+
+/* return values of resolve_path()
+   > 0 : return the length of the path
+   < 0 : return error */
+s32 resolve_path(struct inode *inode, char *path, CHAIN_T *p_dir, UNI_NAME_T *p_uniname)
+{
+	s32 lossy = FALSE;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+
+	if (strlen(path) >= (MAX_NAME_LENGTH * MAX_CHARSET_SIZE))
+		return FFS_INVALIDPATH;
+
+	strcpy(name_buf, path);
+
+	nls_cstring_to_uniname(sb, p_uniname, name_buf, &lossy);
+	if (lossy)
+		return FFS_INVALIDPATH;
+
+	fid->size = i_size_read(inode);
+
+	p_dir->dir = fid->start_clu;
+	p_dir->size = (s32)(fid->size >> p_fs->cluster_size_bits);
+	p_dir->flags = fid->flags;
+
+	return FFS_SUCCESS;
+}
+
+/*
+ *  File Operation Functions
+ */
+static FS_FUNC_T fat_fs_func = {
+	.alloc_cluster = fat_alloc_cluster,
+	.free_cluster = fat_free_cluster,
+	.count_used_clusters = fat_count_used_clusters,
+
+	.init_dir_entry = fat_init_dir_entry,
+	.init_ext_entry = fat_init_ext_entry,
+	.find_dir_entry = fat_find_dir_entry,
+	.delete_dir_entry = fat_delete_dir_entry,
+	.get_uni_name_from_ext_entry = fat_get_uni_name_from_ext_entry,
+	.count_ext_entries = fat_count_ext_entries,
+	.calc_num_entries = fat_calc_num_entries,
+
+	.get_entry_type = fat_get_entry_type,
+	.set_entry_type = fat_set_entry_type,
+	.get_entry_attr = fat_get_entry_attr,
+	.set_entry_attr = fat_set_entry_attr,
+	.get_entry_flag = fat_get_entry_flag,
+	.set_entry_flag = fat_set_entry_flag,
+	.get_entry_clu0 = fat_get_entry_clu0,
+	.set_entry_clu0 = fat_set_entry_clu0,
+	.get_entry_size = fat_get_entry_size,
+	.set_entry_size = fat_set_entry_size,
+	.get_entry_time = fat_get_entry_time,
+	.set_entry_time = fat_set_entry_time,
+};
+
+
+s32 fat16_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr)
+{
+	s32 num_reserved, num_root_sectors;
+	BPB16_T *p_bpb = (BPB16_T *) p_pbr->bpb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_bpb->num_fats == 0)
+		return FFS_FORMATERR;
+
+	num_root_sectors = GET16(p_bpb->num_root_entries) << DENTRY_SIZE_BITS;
+	num_root_sectors = ((num_root_sectors-1) >> p_bd->sector_size_bits) + 1;
+
+	p_fs->sectors_per_clu = p_bpb->sectors_per_clu;
+	p_fs->sectors_per_clu_bits = ilog2(p_bpb->sectors_per_clu);
+	p_fs->cluster_size_bits = p_fs->sectors_per_clu_bits + p_bd->sector_size_bits;
+	p_fs->cluster_size = 1 << p_fs->cluster_size_bits;
+
+	p_fs->num_FAT_sectors = GET16(p_bpb->num_fat_sectors);
+
+	p_fs->FAT1_start_sector = p_fs->PBR_sector + GET16(p_bpb->num_reserved);
+	if (p_bpb->num_fats == 1)
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector;
+	else
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector + p_fs->num_FAT_sectors;
+
+	p_fs->root_start_sector = p_fs->FAT2_start_sector + p_fs->num_FAT_sectors;
+	p_fs->data_start_sector = p_fs->root_start_sector + num_root_sectors;
+
+	p_fs->num_sectors = GET16(p_bpb->num_sectors);
+	if (p_fs->num_sectors == 0)
+		p_fs->num_sectors = GET32(p_bpb->num_huge_sectors);
+
+	num_reserved = p_fs->data_start_sector - p_fs->PBR_sector;
+	p_fs->num_clusters = ((p_fs->num_sectors - num_reserved) >> p_fs->sectors_per_clu_bits) + 2;
+	/* because the cluster index starts with 2 */
+
+	if (p_fs->num_clusters < FAT12_THRESHOLD)
+		p_fs->vol_type = FAT12;
+	else
+		p_fs->vol_type = FAT16;
+	p_fs->vol_id = GET32(p_bpb->vol_serial);
+
+	p_fs->root_dir = 0;
+	p_fs->dentries_in_root = GET16(p_bpb->num_root_entries);
+	p_fs->dentries_per_clu = 1 << (p_fs->cluster_size_bits - DENTRY_SIZE_BITS);
+
+	p_fs->vol_flag = VOL_CLEAN;
+	p_fs->clu_srch_ptr = 2;
+	p_fs->used_clusters = (u32) ~0;
+
+	p_fs->fs_func = &fat_fs_func;
+
+	return FFS_SUCCESS;
+} /* end of fat16_mount */
+
+s32 fat32_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr)
+{
+	s32 num_reserved;
+	BPB32_T *p_bpb = (BPB32_T *) p_pbr->bpb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_bpb->num_fats == 0)
+		return FFS_FORMATERR;
+
+	p_fs->sectors_per_clu = p_bpb->sectors_per_clu;
+	p_fs->sectors_per_clu_bits = ilog2(p_bpb->sectors_per_clu);
+	p_fs->cluster_size_bits = p_fs->sectors_per_clu_bits + p_bd->sector_size_bits;
+	p_fs->cluster_size = 1 << p_fs->cluster_size_bits;
+
+	p_fs->num_FAT_sectors = GET32(p_bpb->num_fat32_sectors);
+
+	p_fs->FAT1_start_sector = p_fs->PBR_sector + GET16(p_bpb->num_reserved);
+	if (p_bpb->num_fats == 1)
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector;
+	else
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector + p_fs->num_FAT_sectors;
+
+	p_fs->root_start_sector = p_fs->FAT2_start_sector + p_fs->num_FAT_sectors;
+	p_fs->data_start_sector = p_fs->root_start_sector;
+
+	p_fs->num_sectors = GET32(p_bpb->num_huge_sectors);
+	num_reserved = p_fs->data_start_sector - p_fs->PBR_sector;
+
+	p_fs->num_clusters = ((p_fs->num_sectors-num_reserved) >> p_fs->sectors_per_clu_bits) + 2;
+	/* because the cluster index starts with 2 */
+
+	p_fs->vol_type = FAT32;
+	p_fs->vol_id = GET32(p_bpb->vol_serial);
+
+	p_fs->root_dir = GET32(p_bpb->root_cluster);
+	p_fs->dentries_in_root = 0;
+	p_fs->dentries_per_clu = 1 << (p_fs->cluster_size_bits - DENTRY_SIZE_BITS);
+
+	p_fs->vol_flag = VOL_CLEAN;
+	p_fs->clu_srch_ptr = 2;
+	p_fs->used_clusters = (u32) ~0;
+
+	p_fs->fs_func = &fat_fs_func;
+
+	return FFS_SUCCESS;
+} /* end of fat32_mount */
+
+static FS_FUNC_T exfat_fs_func = {
+	.alloc_cluster = exfat_alloc_cluster,
+	.free_cluster = exfat_free_cluster,
+	.count_used_clusters = exfat_count_used_clusters,
+
+	.init_dir_entry = exfat_init_dir_entry,
+	.init_ext_entry = exfat_init_ext_entry,
+	.find_dir_entry = exfat_find_dir_entry,
+	.delete_dir_entry = exfat_delete_dir_entry,
+	.get_uni_name_from_ext_entry = exfat_get_uni_name_from_ext_entry,
+	.count_ext_entries = exfat_count_ext_entries,
+	.calc_num_entries = exfat_calc_num_entries,
+
+	.get_entry_type = exfat_get_entry_type,
+	.set_entry_type = exfat_set_entry_type,
+	.get_entry_attr = exfat_get_entry_attr,
+	.set_entry_attr = exfat_set_entry_attr,
+	.get_entry_flag = exfat_get_entry_flag,
+	.set_entry_flag = exfat_set_entry_flag,
+	.get_entry_clu0 = exfat_get_entry_clu0,
+	.set_entry_clu0 = exfat_set_entry_clu0,
+	.get_entry_size = exfat_get_entry_size,
+	.set_entry_size = exfat_set_entry_size,
+	.get_entry_time = exfat_get_entry_time,
+	.set_entry_time = exfat_set_entry_time,
+};
+
+s32 exfat_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr)
+{
+	BPBEX_T *p_bpb = (BPBEX_T *) p_pbr->bpb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+
+	if (p_bpb->num_fats == 0)
+		return FFS_FORMATERR;
+
+	p_fs->sectors_per_clu = 1 << p_bpb->sectors_per_clu_bits;
+	p_fs->sectors_per_clu_bits = p_bpb->sectors_per_clu_bits;
+	p_fs->cluster_size_bits = p_fs->sectors_per_clu_bits + p_bd->sector_size_bits;
+	p_fs->cluster_size = 1 << p_fs->cluster_size_bits;
+
+	p_fs->num_FAT_sectors = GET32(p_bpb->fat_length);
+
+	p_fs->FAT1_start_sector = p_fs->PBR_sector + GET32(p_bpb->fat_offset);
+	if (p_bpb->num_fats == 1)
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector;
+	else
+		p_fs->FAT2_start_sector = p_fs->FAT1_start_sector + p_fs->num_FAT_sectors;
+
+	p_fs->root_start_sector = p_fs->PBR_sector + GET32(p_bpb->clu_offset);
+	p_fs->data_start_sector = p_fs->root_start_sector;
+
+	p_fs->num_sectors = GET64(p_bpb->vol_length);
+	p_fs->num_clusters = GET32(p_bpb->clu_count) + 2;
+	/* because the cluster index starts with 2 */
+
+	p_fs->vol_type = EXFAT;
+	p_fs->vol_id = GET32(p_bpb->vol_serial);
+
+	p_fs->root_dir = GET32(p_bpb->root_cluster);
+	p_fs->dentries_in_root = 0;
+	p_fs->dentries_per_clu = 1 << (p_fs->cluster_size_bits - DENTRY_SIZE_BITS);
+
+	p_fs->vol_flag = (u32) GET16(p_bpb->vol_flags);
+	p_fs->clu_srch_ptr = 2;
+	p_fs->used_clusters = (u32) ~0;
+
+	p_fs->fs_func = &exfat_fs_func;
+
+	return FFS_SUCCESS;
+} /* end of exfat_mount */
+
+s32 create_dir(struct inode *inode, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, FILE_ID_T *fid)
+{
+	s32 ret, dentry, num_entries;
+	u64 size;
+	CHAIN_T clu;
+	DOS_NAME_T dos_name, dot_name;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, &num_entries, &dos_name);
+	if (ret)
+		return ret;
+
+	/* find_empty_entry must be called before alloc_cluster */
+	dentry = find_empty_entry(inode, p_dir, num_entries);
+	if (dentry < 0)
+		return FFS_FULL;
+
+	clu.dir = CLUSTER_32(~0);
+	clu.size = 0;
+	clu.flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+
+	/* (1) allocate a cluster */
+	ret = p_fs->fs_func->alloc_cluster(sb, 1, &clu);
+	if (ret < 0)
+		return FFS_MEDIAERR;
+	else if (ret == 0)
+		return FFS_FULL;
+
+	ret = clear_cluster(sb, clu.dir);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	if (p_fs->vol_type == EXFAT) {
+		size = p_fs->cluster_size;
+	} else {
+		size = 0;
+
+		/* initialize the . and .. entry
+		   Information for . points to itself
+		   Information for .. points to parent dir */
+
+		dot_name.name_case = 0x0;
+		memcpy(dot_name.name, DOS_CUR_DIR_NAME, DOS_NAME_LENGTH);
+
+		ret = p_fs->fs_func->init_dir_entry(sb, &clu, 0, TYPE_DIR, clu.dir, 0);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		ret = p_fs->fs_func->init_ext_entry(sb, &clu, 0, 1, NULL, &dot_name);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		memcpy(dot_name.name, DOS_PAR_DIR_NAME, DOS_NAME_LENGTH);
+
+		if (p_dir->dir == p_fs->root_dir)
+			ret = p_fs->fs_func->init_dir_entry(sb, &clu, 1, TYPE_DIR, CLUSTER_32(0), 0);
+		else
+			ret = p_fs->fs_func->init_dir_entry(sb, &clu, 1, TYPE_DIR, p_dir->dir, 0);
+
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		ret = p_fs->fs_func->init_ext_entry(sb, &clu, 1, 1, NULL, &dot_name);
+		if (ret != FFS_SUCCESS)
+			return ret;
+	}
+
+	/* (2) update the directory entry */
+	/* make sub-dir entry in parent directory */
+	ret = p_fs->fs_func->init_dir_entry(sb, p_dir, dentry, TYPE_DIR, clu.dir, size);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	ret = p_fs->fs_func->init_ext_entry(sb, p_dir, dentry, num_entries, p_uniname, &dos_name);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	fid->dir.dir = p_dir->dir;
+	fid->dir.size = p_dir->size;
+	fid->dir.flags = p_dir->flags;
+	fid->entry = dentry;
+
+	fid->attr = ATTR_SUBDIR;
+	fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+	fid->size = size;
+	fid->start_clu = clu.dir;
+
+	fid->type = TYPE_DIR;
+	fid->rwoffset = 0;
+	fid->hint_last_off = -1;
+
+	return FFS_SUCCESS;
+} /* end of create_dir */
+
+s32 create_file(struct inode *inode, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, u8 mode, FILE_ID_T *fid)
+{
+	s32 ret, dentry, num_entries;
+	DOS_NAME_T dos_name;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, &num_entries, &dos_name);
+	if (ret)
+		return ret;
+
+	/* find_empty_entry must be called before alloc_cluster() */
+	dentry = find_empty_entry(inode, p_dir, num_entries);
+	if (dentry < 0)
+		return FFS_FULL;
+
+	/* (1) update the directory entry */
+	/* fill the dos name directory entry information of the created file.
+	   the first cluster is not determined yet. (0) */
+	ret = p_fs->fs_func->init_dir_entry(sb, p_dir, dentry, TYPE_FILE | mode, CLUSTER_32(0), 0);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	ret = p_fs->fs_func->init_ext_entry(sb, p_dir, dentry, num_entries, p_uniname, &dos_name);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	fid->dir.dir = p_dir->dir;
+	fid->dir.size = p_dir->size;
+	fid->dir.flags = p_dir->flags;
+	fid->entry = dentry;
+
+	fid->attr = ATTR_ARCHIVE | mode;
+	fid->flags = (p_fs->vol_type == EXFAT) ? 0x03 : 0x01;
+	fid->size = 0;
+	fid->start_clu = CLUSTER_32(~0);
+
+	fid->type = TYPE_FILE;
+	fid->rwoffset = 0;
+	fid->hint_last_off = -1;
+
+	return FFS_SUCCESS;
+} /* end of create_file */
+
+void remove_file(struct inode *inode, CHAIN_T *p_dir, s32 entry)
+{
+	s32 num_entries;
+	sector_t sector;
+	DENTRY_T *ep;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	ep = get_entry_in_dir(sb, p_dir, entry, &sector);
+	if (!ep)
+		return;
+
+	buf_lock(sb, sector);
+
+	/* buf_lock() before call count_ext_entries() */
+	num_entries = p_fs->fs_func->count_ext_entries(sb, p_dir, entry, ep);
+	if (num_entries < 0) {
+		buf_unlock(sb, sector);
+		return;
+	}
+	num_entries++;
+
+	buf_unlock(sb, sector);
+
+	/* (1) update the directory entry */
+	p_fs->fs_func->delete_dir_entry(sb, p_dir, entry, 0, num_entries);
+} /* end of remove_file */
+
+s32 rename_file(struct inode *inode, CHAIN_T *p_dir, s32 oldentry, UNI_NAME_T *p_uniname, FILE_ID_T *fid)
+{
+	s32 ret, newentry = -1, num_old_entries, num_new_entries;
+	sector_t sector_old, sector_new;
+	DOS_NAME_T dos_name;
+	DENTRY_T *epold, *epnew;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	epold = get_entry_in_dir(sb, p_dir, oldentry, &sector_old);
+	if (!epold)
+		return FFS_MEDIAERR;
+
+	buf_lock(sb, sector_old);
+
+	/* buf_lock() before call count_ext_entries() */
+	num_old_entries = p_fs->fs_func->count_ext_entries(sb, p_dir, oldentry, epold);
+	if (num_old_entries < 0) {
+		buf_unlock(sb, sector_old);
+		return FFS_MEDIAERR;
+	}
+	num_old_entries++;
+
+	ret = get_num_entries_and_dos_name(sb, p_dir, p_uniname, &num_new_entries, &dos_name);
+	if (ret) {
+		buf_unlock(sb, sector_old);
+		return ret;
+	}
+
+	if (num_old_entries < num_new_entries) {
+		newentry = find_empty_entry(inode, p_dir, num_new_entries);
+		if (newentry < 0) {
+			buf_unlock(sb, sector_old);
+			return FFS_FULL;
+		}
+
+		epnew = get_entry_in_dir(sb, p_dir, newentry, &sector_new);
+		if (!epnew) {
+			buf_unlock(sb, sector_old);
+			return FFS_MEDIAERR;
+		}
+
+		memcpy((void *) epnew, (void *) epold, DENTRY_SIZE);
+		if (p_fs->fs_func->get_entry_type(epnew) == TYPE_FILE) {
+			p_fs->fs_func->set_entry_attr(epnew, p_fs->fs_func->get_entry_attr(epnew) | ATTR_ARCHIVE);
+			fid->attr |= ATTR_ARCHIVE;
+		}
+		buf_modify(sb, sector_new);
+		buf_unlock(sb, sector_old);
+
+		if (p_fs->vol_type == EXFAT) {
+			epold = get_entry_in_dir(sb, p_dir, oldentry+1, &sector_old);
+			buf_lock(sb, sector_old);
+			epnew = get_entry_in_dir(sb, p_dir, newentry+1, &sector_new);
+
+			if (!epold || !epnew) {
+				buf_unlock(sb, sector_old);
+				return FFS_MEDIAERR;
+			}
+
+			memcpy((void *) epnew, (void *) epold, DENTRY_SIZE);
+			buf_modify(sb, sector_new);
+			buf_unlock(sb, sector_old);
+		}
+
+		ret = p_fs->fs_func->init_ext_entry(sb, p_dir, newentry, num_new_entries, p_uniname, &dos_name);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		p_fs->fs_func->delete_dir_entry(sb, p_dir, oldentry, 0, num_old_entries);
+		fid->entry = newentry;
+	} else {
+		if (p_fs->fs_func->get_entry_type(epold) == TYPE_FILE) {
+			p_fs->fs_func->set_entry_attr(epold, p_fs->fs_func->get_entry_attr(epold) | ATTR_ARCHIVE);
+			fid->attr |= ATTR_ARCHIVE;
+		}
+		buf_modify(sb, sector_old);
+		buf_unlock(sb, sector_old);
+
+		ret = p_fs->fs_func->init_ext_entry(sb, p_dir, oldentry, num_new_entries, p_uniname, &dos_name);
+		if (ret != FFS_SUCCESS)
+			return ret;
+
+		p_fs->fs_func->delete_dir_entry(sb, p_dir, oldentry, num_new_entries, num_old_entries);
+	}
+
+	return FFS_SUCCESS;
+} /* end of rename_file */
+
+s32 move_file(struct inode *inode, CHAIN_T *p_olddir, s32 oldentry, CHAIN_T *p_newdir, UNI_NAME_T *p_uniname, FILE_ID_T *fid)
+{
+	s32 ret, newentry, num_new_entries, num_old_entries;
+	sector_t sector_mov, sector_new;
+	CHAIN_T clu;
+	DOS_NAME_T dos_name;
+	DENTRY_T *epmov, *epnew;
+	struct super_block *sb = inode->i_sb;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	epmov = get_entry_in_dir(sb, p_olddir, oldentry, &sector_mov);
+	if (!epmov)
+		return FFS_MEDIAERR;
+
+	/* check if the source and target directory is the same */
+	if (p_fs->fs_func->get_entry_type(epmov) == TYPE_DIR &&
+		p_fs->fs_func->get_entry_clu0(epmov) == p_newdir->dir)
+		return FFS_INVALIDPATH;
+
+	buf_lock(sb, sector_mov);
+
+	/* buf_lock() before call count_ext_entries() */
+	num_old_entries = p_fs->fs_func->count_ext_entries(sb, p_olddir, oldentry, epmov);
+	if (num_old_entries < 0) {
+		buf_unlock(sb, sector_mov);
+		return FFS_MEDIAERR;
+	}
+	num_old_entries++;
+
+	ret = get_num_entries_and_dos_name(sb, p_newdir, p_uniname, &num_new_entries, &dos_name);
+	if (ret) {
+		buf_unlock(sb, sector_mov);
+		return ret;
+	}
+
+	newentry = find_empty_entry(inode, p_newdir, num_new_entries);
+	if (newentry < 0) {
+		buf_unlock(sb, sector_mov);
+		return FFS_FULL;
+	}
+
+	epnew = get_entry_in_dir(sb, p_newdir, newentry, &sector_new);
+	if (!epnew) {
+		buf_unlock(sb, sector_mov);
+		return FFS_MEDIAERR;
+	}
+
+	memcpy((void *) epnew, (void *) epmov, DENTRY_SIZE);
+	if (p_fs->fs_func->get_entry_type(epnew) == TYPE_FILE) {
+		p_fs->fs_func->set_entry_attr(epnew, p_fs->fs_func->get_entry_attr(epnew) | ATTR_ARCHIVE);
+		fid->attr |= ATTR_ARCHIVE;
+	}
+	buf_modify(sb, sector_new);
+	buf_unlock(sb, sector_mov);
+
+	if (p_fs->vol_type == EXFAT) {
+		epmov = get_entry_in_dir(sb, p_olddir, oldentry+1, &sector_mov);
+		buf_lock(sb, sector_mov);
+		epnew = get_entry_in_dir(sb, p_newdir, newentry+1, &sector_new);
+		if (!epmov || !epnew) {
+			buf_unlock(sb, sector_mov);
+			return FFS_MEDIAERR;
+		}
+
+		memcpy((void *) epnew, (void *) epmov, DENTRY_SIZE);
+		buf_modify(sb, sector_new);
+		buf_unlock(sb, sector_mov);
+	} else if (p_fs->fs_func->get_entry_type(epnew) == TYPE_DIR) {
+		/* change ".." pointer to new parent dir */
+		clu.dir = p_fs->fs_func->get_entry_clu0(epnew);
+		clu.flags = 0x01;
+
+		epnew = get_entry_in_dir(sb, &clu, 1, &sector_new);
+		if (!epnew)
+			return FFS_MEDIAERR;
+
+		if (p_newdir->dir == p_fs->root_dir)
+			p_fs->fs_func->set_entry_clu0(epnew, CLUSTER_32(0));
+		else
+			p_fs->fs_func->set_entry_clu0(epnew, p_newdir->dir);
+		buf_modify(sb, sector_new);
+	}
+
+	ret = p_fs->fs_func->init_ext_entry(sb, p_newdir, newentry, num_new_entries, p_uniname, &dos_name);
+	if (ret != FFS_SUCCESS)
+		return ret;
+
+	p_fs->fs_func->delete_dir_entry(sb, p_olddir, oldentry, 0, num_old_entries);
+
+	fid->dir.dir = p_newdir->dir;
+	fid->dir.size = p_newdir->size;
+	fid->dir.flags = p_newdir->flags;
+
+	fid->entry = newentry;
+
+	return FFS_SUCCESS;
+} /* end of move_file */
+
+/*
+ *  Sector Read/Write Functions
+ */
+
+s32 sector_read(struct super_block *sb, sector_t sec, struct buffer_head **bh, s32 read)
+{
+	s32 ret = FFS_MEDIAERR;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if ((sec >= (p_fs->PBR_sector+p_fs->num_sectors)) && (p_fs->num_sectors > 0)) {
+		printk("[EXFAT] sector_read: out of range error! (sec = %llu)\n", (unsigned long long)sec);
+		fs_error(sb);
+		return ret;
+	}
+
+	if (!p_fs->dev_ejected) {
+		ret = bdev_read(sb, sec, bh, 1, read);
+		if (ret != FFS_SUCCESS)
+			p_fs->dev_ejected = TRUE;
+	}
+
+	return ret;
+} /* end of sector_read */
+
+s32 sector_write(struct super_block *sb, sector_t sec, struct buffer_head *bh, s32 sync)
+{
+	s32 ret = FFS_MEDIAERR;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (sec >= (p_fs->PBR_sector+p_fs->num_sectors) && (p_fs->num_sectors > 0)) {
+		printk("[EXFAT] sector_write: out of range error! (sec = %llu)\n", (unsigned long long)sec);
+		fs_error(sb);
+		return ret;
+	}
+
+	if (bh == NULL) {
+		printk("[EXFAT] sector_write: bh is NULL!\n");
+		fs_error(sb);
+		return ret;
+	}
+
+	if (!p_fs->dev_ejected) {
+		ret = bdev_write(sb, sec, bh, 1, sync);
+		if (ret != FFS_SUCCESS)
+			p_fs->dev_ejected = TRUE;
+	}
+
+	return ret;
+} /* end of sector_write */
+
+s32 multi_sector_read(struct super_block *sb, sector_t sec, struct buffer_head **bh, s32 num_secs, s32 read)
+{
+	s32 ret = FFS_MEDIAERR;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (((sec+num_secs) > (p_fs->PBR_sector+p_fs->num_sectors)) && (p_fs->num_sectors > 0)) {
+		printk("[EXFAT] multi_sector_read: out of range error! (sec = %llu, num_secs = %d)\n",
+		       (unsigned long long)sec, num_secs);
+		fs_error(sb);
+		return ret;
+	}
+
+	if (!p_fs->dev_ejected) {
+		ret = bdev_read(sb, sec, bh, num_secs, read);
+		if (ret != FFS_SUCCESS)
+			p_fs->dev_ejected = TRUE;
+	}
+
+	return ret;
+} /* end of multi_sector_read */
+
+s32 multi_sector_write(struct super_block *sb, sector_t sec, struct buffer_head *bh, s32 num_secs, s32 sync)
+{
+	s32 ret = FFS_MEDIAERR;
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if ((sec+num_secs) > (p_fs->PBR_sector+p_fs->num_sectors) && (p_fs->num_sectors > 0)) {
+		printk("[EXFAT] multi_sector_write: out of range error! (sec = %llu, num_secs = %d)\n",
+		       (unsigned long long)sec, num_secs);
+		fs_error(sb);
+		return ret;
+	}
+	if (bh == NULL) {
+		printk("[EXFAT] multi_sector_write: bh is NULL!\n");
+		fs_error(sb);
+		return ret;
+	}
+
+	if (!p_fs->dev_ejected) {
+		ret = bdev_write(sb, sec, bh, num_secs, sync);
+		if (ret != FFS_SUCCESS)
+			p_fs->dev_ejected = TRUE;
+	}
+
+	return ret;
+} /* end of multi_sector_write */
diff --git a/fs/exfat/exfat_core.h b/fs/exfat/exfat_core.h
new file mode 100644
index 0000000000000000000000000000000000000000..52d05c7007d32d34d68df3bfee5301d8fdf1a76f
--- /dev/null
+++ b/fs/exfat/exfat_core.h
@@ -0,0 +1,671 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_core.h                                              */
+/*  PURPOSE : Header File for exFAT File Manager                        */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_H
+#define _EXFAT_H
+
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+
+#include "exfat_blkdev.h"
+#include "exfat_cache.h"
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_cache.h"
+
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+  /* For Debugging Purpose */
+	/* IOCTL code 'f' used by
+	 *   - file systems typically #0~0x1F
+	 *   - embedded terminal devices #128~
+	 *   - exts for debugging purpose #99
+	 * number 100 and 101 is availble now but has possible conflicts
+	 */
+#define EXFAT_IOC_GET_DEBUGFLAGS       _IOR('f', 100, long)
+#define EXFAT_IOC_SET_DEBUGFLAGS       _IOW('f', 101, long)
+
+#define EXFAT_DEBUGFLAGS_INVALID_UMOUNT        0x01
+#define EXFAT_DEBUGFLAGS_ERROR_RW              0x02
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+	/*----------------------------------------------------------------------*/
+	/*  Constant & Macro Definitions                                        */
+	/*----------------------------------------------------------------------*/
+
+#define DENTRY_SIZE             32          /* dir entry size */
+#define DENTRY_SIZE_BITS        5
+
+/* PBR entries */
+#define PBR_SIGNATURE           0xAA55
+#define EXT_SIGNATURE           0xAA550000
+#define VOL_LABEL               "NO NAME    " /* size should be 11 */
+#define OEM_NAME                "MSWIN4.1"  /* size should be 8 */
+#define STR_FAT12               "FAT12   "  /* size should be 8 */
+#define STR_FAT16               "FAT16   "  /* size should be 8 */
+#define STR_FAT32               "FAT32   "  /* size should be 8 */
+#define STR_EXFAT               "EXFAT   "  /* size should be 8 */
+#define VOL_CLEAN               0x0000
+#define VOL_DIRTY               0x0002
+
+/* max number of clusters */
+#define FAT12_THRESHOLD         4087        /* 2^12 - 1 + 2 (clu 0 & 1) */
+#define FAT16_THRESHOLD         65527       /* 2^16 - 1 + 2 */
+#define FAT32_THRESHOLD         268435457   /* 2^28 - 1 + 2 */
+#define EXFAT_THRESHOLD         268435457   /* 2^28 - 1 + 2 */
+
+/* file types */
+#define TYPE_UNUSED             0x0000
+#define TYPE_DELETED            0x0001
+#define TYPE_INVALID            0x0002
+#define TYPE_CRITICAL_PRI       0x0100
+#define TYPE_BITMAP             0x0101
+#define TYPE_UPCASE             0x0102
+#define TYPE_VOLUME             0x0103
+#define TYPE_DIR                0x0104
+#define TYPE_FILE               0x011F
+#define TYPE_SYMLINK            0x015F
+#define TYPE_CRITICAL_SEC       0x0200
+#define TYPE_STREAM             0x0201
+#define TYPE_EXTEND             0x0202
+#define TYPE_ACL                0x0203
+#define TYPE_BENIGN_PRI         0x0400
+#define TYPE_GUID               0x0401
+#define TYPE_PADDING            0x0402
+#define TYPE_ACLTAB             0x0403
+#define TYPE_BENIGN_SEC         0x0800
+#define TYPE_ALL                0x0FFF
+
+/* time modes */
+#define TM_CREATE               0
+#define TM_MODIFY               1
+#define TM_ACCESS               2
+
+/* checksum types */
+#define CS_DIR_ENTRY            0
+#define CS_PBR_SECTOR           1
+#define CS_DEFAULT              2
+
+#define CLUSTER_16(x)           ((u16)(x))
+#define CLUSTER_32(x)           ((u32)(x))
+
+#define FALSE			0
+#define TRUE			1
+
+#define MIN(a, b)		(((a) < (b)) ? (a) : (b))
+#define MAX(a, b)		(((a) > (b)) ? (a) : (b))
+
+#define START_SECTOR(x) \
+	((((sector_t)((x) - 2)) << p_fs->sectors_per_clu_bits) + p_fs->data_start_sector)
+
+#define IS_LAST_SECTOR_IN_CLUSTER(sec) \
+		((((sec) - p_fs->data_start_sector + 1) & ((1 <<  p_fs->sectors_per_clu_bits) - 1)) == 0)
+
+#define GET_CLUSTER_FROM_SECTOR(sec)			\
+		((u32)((((sec) - p_fs->data_start_sector) >> p_fs->sectors_per_clu_bits) + 2))
+
+#define GET16(p_src) \
+	(((u16)(p_src)[0]) | (((u16)(p_src)[1]) << 8))
+#define GET32(p_src) \
+	(((u32)(p_src)[0]) | (((u32)(p_src)[1]) << 8) | \
+	(((u32)(p_src)[2]) << 16) | (((u32)(p_src)[3]) << 24))
+#define GET64(p_src) \
+	(((u64)(p_src)[0]) | (((u64)(p_src)[1]) << 8) | \
+	(((u64)(p_src)[2]) << 16) | (((u64)(p_src)[3]) << 24) | \
+	(((u64)(p_src)[4]) << 32) | (((u64)(p_src)[5]) << 40) | \
+	(((u64)(p_src)[6]) << 48) | (((u64)(p_src)[7]) << 56))
+
+
+#define SET16(p_dst, src)                                  \
+	do {                                              \
+		(p_dst)[0] = (u8)(src);                     \
+		(p_dst)[1] = (u8)(((u16)(src)) >> 8);       \
+	} while (0)
+#define SET32(p_dst, src)                                  \
+	do {                                              \
+		(p_dst)[0] = (u8)(src);                     \
+		(p_dst)[1] = (u8)(((u32)(src)) >> 8);       \
+		(p_dst)[2] = (u8)(((u32)(src)) >> 16);      \
+		(p_dst)[3] = (u8)(((u32)(src)) >> 24);      \
+	} while (0)
+#define SET64(p_dst, src)                                  \
+	do {                                              \
+		(p_dst)[0] = (u8)(src);                   \
+		(p_dst)[1] = (u8)(((u64)(src)) >> 8);     \
+		(p_dst)[2] = (u8)(((u64)(src)) >> 16);    \
+		(p_dst)[3] = (u8)(((u64)(src)) >> 24);    \
+		(p_dst)[4] = (u8)(((u64)(src)) >> 32);    \
+		(p_dst)[5] = (u8)(((u64)(src)) >> 40);    \
+		(p_dst)[6] = (u8)(((u64)(src)) >> 48);    \
+		(p_dst)[7] = (u8)(((u64)(src)) >> 56);    \
+	} while (0)
+
+#ifdef __LITTLE_ENDIAN
+#define GET16_A(p_src)		(*((u16 *)(p_src)))
+#define GET32_A(p_src)		(*((u32 *)(p_src)))
+#define GET64_A(p_src)		(*((u64 *)(p_src)))
+#define SET16_A(p_dst, src)	(*((u16 *)(p_dst)) = (u16)(src))
+#define SET32_A(p_dst, src)	(*((u32 *)(p_dst)) = (u32)(src))
+#define SET64_A(p_dst, src)	(*((u64 *)(p_dst)) = (u64)(src))
+#else /* BIG_ENDIAN */
+#define GET16_A(p_src)		GET16(p_src)
+#define GET32_A(p_src)		GET32(p_src)
+#define GET64_A(p_src)		GET64(p_src)
+#define SET16_A(p_dst, src)	SET16(p_dst, src)
+#define SET32_A(p_dst, src)	SET32(p_dst, src)
+#define SET64_A(p_dst, src)	SET64(p_dst, src)
+#endif
+
+/* Upcase tabel mecro */
+#define HIGH_INDEX_BIT (8)
+#define HIGH_INDEX_MASK (0xFF00)
+#define LOW_INDEX_BIT (16-HIGH_INDEX_BIT)
+#define UTBL_ROW_COUNT (1<<LOW_INDEX_BIT)
+#define UTBL_COL_COUNT (1<<HIGH_INDEX_BIT)
+
+#if CONFIG_EXFAT_DEBUG_MSG
+#define DPRINTK(...)			\
+	do {								\
+		printk("[EXFAT] " __VA_ARGS__);	\
+	} while (0)
+#else
+#define DPRINTK(...)
+#endif
+
+static inline u16 get_col_index(u16 i)
+{
+	return i >> LOW_INDEX_BIT;
+}
+static inline u16 get_row_index(u16 i)
+{
+	return i & ~HIGH_INDEX_MASK;
+}
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+/* MS_DOS FAT partition boot record (512 bytes) */
+typedef struct {
+	u8       jmp_boot[3];
+	u8       oem_name[8];
+	u8       bpb[109];
+	u8       boot_code[390];
+	u8       signature[2];
+} PBR_SECTOR_T;
+
+/* MS-DOS FAT12/16 BIOS parameter block (51 bytes) */
+typedef struct {
+	u8       sector_size[2];
+	u8       sectors_per_clu;
+	u8       num_reserved[2];
+	u8       num_fats;
+	u8       num_root_entries[2];
+	u8       num_sectors[2];
+	u8       media_type;
+	u8       num_fat_sectors[2];
+	u8       sectors_in_track[2];
+	u8       num_heads[2];
+	u8       num_hid_sectors[4];
+	u8       num_huge_sectors[4];
+
+	u8       phy_drv_no;
+	u8       reserved;
+	u8       ext_signature;
+	u8       vol_serial[4];
+	u8       vol_label[11];
+	u8       vol_type[8];
+} BPB16_T;
+
+/* MS-DOS FAT32 BIOS parameter block (79 bytes) */
+typedef struct {
+	u8       sector_size[2];
+	u8       sectors_per_clu;
+	u8       num_reserved[2];
+	u8       num_fats;
+	u8       num_root_entries[2];
+	u8       num_sectors[2];
+	u8       media_type;
+	u8       num_fat_sectors[2];
+	u8       sectors_in_track[2];
+	u8       num_heads[2];
+	u8       num_hid_sectors[4];
+	u8       num_huge_sectors[4];
+	u8       num_fat32_sectors[4];
+	u8       ext_flags[2];
+	u8       fs_version[2];
+	u8       root_cluster[4];
+	u8       fsinfo_sector[2];
+	u8       backup_sector[2];
+	u8       reserved[12];
+
+	u8       phy_drv_no;
+	u8       ext_reserved;
+	u8       ext_signature;
+	u8       vol_serial[4];
+	u8       vol_label[11];
+	u8       vol_type[8];
+} BPB32_T;
+
+/* MS-DOS EXFAT BIOS parameter block (109 bytes) */
+typedef struct {
+	u8       reserved1[53];
+	u8       vol_offset[8];
+	u8       vol_length[8];
+	u8       fat_offset[4];
+	u8       fat_length[4];
+	u8       clu_offset[4];
+	u8       clu_count[4];
+	u8       root_cluster[4];
+	u8       vol_serial[4];
+	u8       fs_version[2];
+	u8       vol_flags[2];
+	u8       sector_size_bits;
+	u8       sectors_per_clu_bits;
+	u8       num_fats;
+	u8       phy_drv_no;
+	u8       perc_in_use;
+	u8       reserved2[7];
+} BPBEX_T;
+
+/* MS-DOS FAT file system information sector (512 bytes) */
+typedef struct {
+	u8       signature1[4];
+	u8       reserved1[480];
+	u8       signature2[4];
+	u8       free_cluster[4];
+	u8       next_cluster[4];
+	u8       reserved2[14];
+	u8       signature3[2];
+} FSI_SECTOR_T;
+
+/* MS-DOS FAT directory entry (32 bytes) */
+typedef struct {
+	u8       dummy[32];
+} DENTRY_T;
+
+typedef struct {
+	u8       name[DOS_NAME_LENGTH];
+	u8       attr;
+	u8       lcase;
+	u8       create_time_ms;
+	u8       create_time[2];
+	u8       create_date[2];
+	u8       access_date[2];
+	u8       start_clu_hi[2];
+	u8       modify_time[2];
+	u8       modify_date[2];
+	u8       start_clu_lo[2];
+	u8       size[4];
+} DOS_DENTRY_T;
+
+/* MS-DOS FAT extended directory entry (32 bytes) */
+typedef struct {
+	u8       order;
+	u8       unicode_0_4[10];
+	u8       attr;
+	u8       sysid;
+	u8       checksum;
+	u8       unicode_5_10[12];
+	u8       start_clu[2];
+	u8       unicode_11_12[4];
+} EXT_DENTRY_T;
+
+/* MS-DOS EXFAT file directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       num_ext;
+	u8       checksum[2];
+	u8       attr[2];
+	u8       reserved1[2];
+	u8       create_time[2];
+	u8       create_date[2];
+	u8       modify_time[2];
+	u8       modify_date[2];
+	u8       access_time[2];
+	u8       access_date[2];
+	u8       create_time_ms;
+	u8       modify_time_ms;
+	u8       access_time_ms;
+	u8       reserved2[9];
+} FILE_DENTRY_T;
+
+/* MS-DOS EXFAT stream extension directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       flags;
+	u8       reserved1;
+	u8       name_len;
+	u8       name_hash[2];
+	u8       reserved2[2];
+	u8       valid_size[8];
+	u8       reserved3[4];
+	u8       start_clu[4];
+	u8       size[8];
+} STRM_DENTRY_T;
+
+/* MS-DOS EXFAT file name directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       flags;
+	u8       unicode_0_14[30];
+} NAME_DENTRY_T;
+
+/* MS-DOS EXFAT allocation bitmap directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       flags;
+	u8       reserved[18];
+	u8       start_clu[4];
+	u8       size[8];
+} BMAP_DENTRY_T;
+
+/* MS-DOS EXFAT up-case table directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       reserved1[3];
+	u8       checksum[4];
+	u8       reserved2[12];
+	u8       start_clu[4];
+	u8       size[8];
+} CASE_DENTRY_T;
+
+/* MS-DOS EXFAT volume label directory entry (32 bytes) */
+typedef struct {
+	u8       type;
+	u8       label_len;
+	u8       unicode_0_10[22];
+	u8       reserved[8];
+} VOLM_DENTRY_T;
+
+/* unused entry hint information */
+typedef struct {
+	u32      dir;
+	s32       entry;
+	CHAIN_T     clu;
+} UENTRY_T;
+
+typedef struct {
+	s32       (*alloc_cluster)(struct super_block *sb, s32 num_alloc, CHAIN_T *p_chain);
+	void        (*free_cluster)(struct super_block *sb, CHAIN_T *p_chain, s32 do_relse);
+	s32       (*count_used_clusters)(struct super_block *sb);
+
+	s32      (*init_dir_entry)(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type,
+								 u32 start_clu, u64 size);
+	s32      (*init_ext_entry)(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 num_entries,
+								 UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname);
+	s32       (*find_dir_entry)(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 num_entries, DOS_NAME_T *p_dosname, u32 type);
+	void        (*delete_dir_entry)(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 offset, s32 num_entries);
+	void        (*get_uni_name_from_ext_entry)(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u16 *uniname);
+	s32       (*count_ext_entries)(struct super_block *sb, CHAIN_T *p_dir, s32 entry, DENTRY_T *p_entry);
+	s32       (*calc_num_entries)(UNI_NAME_T *p_uniname);
+
+	u32      (*get_entry_type)(DENTRY_T *p_entry);
+	void        (*set_entry_type)(DENTRY_T *p_entry, u32 type);
+	u32      (*get_entry_attr)(DENTRY_T *p_entry);
+	void        (*set_entry_attr)(DENTRY_T *p_entry, u32 attr);
+	u8       (*get_entry_flag)(DENTRY_T *p_entry);
+	void        (*set_entry_flag)(DENTRY_T *p_entry, u8 flag);
+	u32      (*get_entry_clu0)(DENTRY_T *p_entry);
+	void        (*set_entry_clu0)(DENTRY_T *p_entry, u32 clu0);
+	u64      (*get_entry_size)(DENTRY_T *p_entry);
+	void        (*set_entry_size)(DENTRY_T *p_entry, u64 size);
+	void        (*get_entry_time)(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+	void        (*set_entry_time)(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+} FS_FUNC_T;
+
+typedef struct __FS_INFO_T {
+	u32      drv;                    /* drive ID */
+	u32      vol_type;               /* volume FAT type */
+	u32      vol_id;                 /* volume serial number */
+
+	u64      num_sectors;            /* num of sectors in volume */
+	u32      num_clusters;           /* num of clusters in volume */
+	u32      cluster_size;           /* cluster size in bytes */
+	u32      cluster_size_bits;
+	u32      sectors_per_clu;        /* cluster size in sectors */
+	u32      sectors_per_clu_bits;
+
+	u32      PBR_sector;             /* PBR sector */
+	u32      FAT1_start_sector;      /* FAT1 start sector */
+	u32      FAT2_start_sector;      /* FAT2 start sector */
+	u32      root_start_sector;      /* root dir start sector */
+	u32      data_start_sector;      /* data area start sector */
+	u32      num_FAT_sectors;        /* num of FAT sectors */
+
+	u32      root_dir;               /* root dir cluster */
+	u32      dentries_in_root;       /* num of dentries in root dir */
+	u32      dentries_per_clu;       /* num of dentries per cluster */
+
+	u32      vol_flag;               /* volume dirty flag */
+	struct buffer_head *pbr_bh;         /* PBR sector */
+
+	u32      map_clu;                /* allocation bitmap start cluster */
+	u32      map_sectors;            /* num of allocation bitmap sectors */
+	struct buffer_head **vol_amap;      /* allocation bitmap */
+
+	u16      **vol_utbl;               /* upcase table */
+
+	u32      clu_srch_ptr;           /* cluster search pointer */
+	u32      used_clusters;          /* number of used clusters */
+	UENTRY_T    hint_uentry;         /* unused entry hint information */
+
+	u32      dev_ejected;            /* block device operation error flag */
+
+	FS_FUNC_T	*fs_func;
+	struct semaphore v_sem;
+
+	/* FAT cache */
+	BUF_CACHE_T FAT_cache_array[FAT_CACHE_SIZE];
+	BUF_CACHE_T FAT_cache_lru_list;
+	BUF_CACHE_T FAT_cache_hash_list[FAT_CACHE_HASH_SIZE];
+
+	/* buf cache */
+	BUF_CACHE_T buf_cache_array[BUF_CACHE_SIZE];
+	BUF_CACHE_T buf_cache_lru_list;
+	BUF_CACHE_T buf_cache_hash_list[BUF_CACHE_HASH_SIZE];
+} FS_INFO_T;
+
+#define ES_2_ENTRIES		2
+#define ES_3_ENTRIES		3
+#define ES_ALL_ENTRIES	0
+
+typedef struct {
+	sector_t	sector;	/* sector number that contains file_entry */
+	s32	offset;		/* byte offset in the sector */
+	s32	alloc_flag;	/* flag in stream entry. 01 for cluster chain, 03 for contig. clusteres. */
+	u32 num_entries;
+
+	/* __buf should be the last member */
+	void *__buf;
+} ENTRY_SET_CACHE_T;
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+/* file system initialization & shutdown functions */
+s32 ffsInit(void);
+s32 ffsShutdown(void);
+
+/* volume management functions */
+s32 ffsMountVol(struct super_block *sb);
+s32 ffsUmountVol(struct super_block *sb);
+s32 ffsCheckVol(struct super_block *sb);
+s32 ffsGetVolInfo(struct super_block *sb, VOL_INFO_T *info);
+s32 ffsSyncVol(struct super_block *sb, s32 do_sync);
+
+/* file management functions */
+s32 ffsLookupFile(struct inode *inode, char *path, FILE_ID_T *fid);
+s32 ffsCreateFile(struct inode *inode, char *path, u8 mode, FILE_ID_T *fid);
+s32 ffsReadFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *rcount);
+s32 ffsWriteFile(struct inode *inode, FILE_ID_T *fid, void *buffer, u64 count, u64 *wcount);
+s32 ffsTruncateFile(struct inode *inode, u64 old_size, u64 new_size);
+s32 ffsMoveFile(struct inode *old_parent_inode, FILE_ID_T *fid, struct inode *new_parent_inode, struct dentry *new_dentry);
+s32 ffsRemoveFile(struct inode *inode, FILE_ID_T *fid);
+s32 ffsSetAttr(struct inode *inode, u32 attr);
+s32 ffsGetStat(struct inode *inode, DIR_ENTRY_T *info);
+s32 ffsSetStat(struct inode *inode, DIR_ENTRY_T *info);
+s32 ffsMapCluster(struct inode *inode, s32 clu_offset, u32 *clu);
+
+/* directory management functions */
+s32 ffsCreateDir(struct inode *inode, char *path, FILE_ID_T *fid);
+s32 ffsReadDir(struct inode *inode, DIR_ENTRY_T *dir_ent);
+s32 ffsRemoveDir(struct inode *inode, FILE_ID_T *fid);
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations (NOT TO UPPER LAYER)                 */
+/*----------------------------------------------------------------------*/
+
+/* fs management functions */
+s32  fs_init(void);
+s32  fs_shutdown(void);
+void   fs_set_vol_flags(struct super_block *sb, u32 new_flag);
+void   fs_sync(struct super_block *sb, s32 do_sync);
+void   fs_error(struct super_block *sb);
+
+/* cluster management functions */
+s32   clear_cluster(struct super_block *sb, u32 clu);
+s32  fat_alloc_cluster(struct super_block *sb, s32 num_alloc, CHAIN_T *p_chain);
+s32  exfat_alloc_cluster(struct super_block *sb, s32 num_alloc, CHAIN_T *p_chain);
+void   fat_free_cluster(struct super_block *sb, CHAIN_T *p_chain, s32 do_relse);
+void   exfat_free_cluster(struct super_block *sb, CHAIN_T *p_chain, s32 do_relse);
+u32 find_last_cluster(struct super_block *sb, CHAIN_T *p_chain);
+s32  count_num_clusters(struct super_block *sb, CHAIN_T *dir);
+s32  fat_count_used_clusters(struct super_block *sb);
+s32  exfat_count_used_clusters(struct super_block *sb);
+void   exfat_chain_cont_cluster(struct super_block *sb, u32 chain, s32 len);
+
+/* allocation bitmap management functions */
+s32  load_alloc_bitmap(struct super_block *sb);
+void   free_alloc_bitmap(struct super_block *sb);
+s32   set_alloc_bitmap(struct super_block *sb, u32 clu);
+s32   clr_alloc_bitmap(struct super_block *sb, u32 clu);
+u32 test_alloc_bitmap(struct super_block *sb, u32 clu);
+void   sync_alloc_bitmap(struct super_block *sb);
+
+/* upcase table management functions */
+s32  load_upcase_table(struct super_block *sb);
+void   free_upcase_table(struct super_block *sb);
+
+/* dir entry management functions */
+u32 fat_get_entry_type(DENTRY_T *p_entry);
+u32 exfat_get_entry_type(DENTRY_T *p_entry);
+void   fat_set_entry_type(DENTRY_T *p_entry, u32 type);
+void   exfat_set_entry_type(DENTRY_T *p_entry, u32 type);
+u32 fat_get_entry_attr(DENTRY_T *p_entry);
+u32 exfat_get_entry_attr(DENTRY_T *p_entry);
+void   fat_set_entry_attr(DENTRY_T *p_entry, u32 attr);
+void   exfat_set_entry_attr(DENTRY_T *p_entry, u32 attr);
+u8  fat_get_entry_flag(DENTRY_T *p_entry);
+u8  exfat_get_entry_flag(DENTRY_T *p_entry);
+void   fat_set_entry_flag(DENTRY_T *p_entry, u8 flag);
+void   exfat_set_entry_flag(DENTRY_T *p_entry, u8 flag);
+u32 fat_get_entry_clu0(DENTRY_T *p_entry);
+u32 exfat_get_entry_clu0(DENTRY_T *p_entry);
+void   fat_set_entry_clu0(DENTRY_T *p_entry, u32 start_clu);
+void   exfat_set_entry_clu0(DENTRY_T *p_entry, u32 start_clu);
+u64 fat_get_entry_size(DENTRY_T *p_entry);
+u64 exfat_get_entry_size(DENTRY_T *p_entry);
+void   fat_set_entry_size(DENTRY_T *p_entry, u64 size);
+void   exfat_set_entry_size(DENTRY_T *p_entry, u64 size);
+void   fat_get_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+void   exfat_get_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+void   fat_set_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+void   exfat_set_entry_time(DENTRY_T *p_entry, TIMESTAMP_T *tp, u8 mode);
+s32   fat_init_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type, u32 start_clu, u64 size);
+s32   exfat_init_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type, u32 start_clu, u64 size);
+s32   fat_init_ext_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 num_entries, UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname);
+s32   exfat_init_ext_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 num_entries, UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname);
+void   init_dos_entry(DOS_DENTRY_T *ep, u32 type, u32 start_clu);
+void   init_ext_entry(EXT_DENTRY_T *ep, s32 order, u8 chksum, u16 *uniname);
+void   init_file_entry(FILE_DENTRY_T *ep, u32 type);
+void   init_strm_entry(STRM_DENTRY_T *ep, u8 flags, u32 start_clu, u64 size);
+void   init_name_entry(NAME_DENTRY_T *ep, u16 *uniname);
+void   fat_delete_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 order, s32 num_entries);
+void   exfat_delete_dir_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, s32 order, s32 num_entries);
+
+s32   find_location(struct super_block *sb, CHAIN_T *p_dir, s32 entry, sector_t *sector, s32 *offset);
+DENTRY_T *get_entry_with_sector(struct super_block *sb, sector_t sector, s32 offset);
+DENTRY_T *get_entry_in_dir(struct super_block *sb, CHAIN_T *p_dir, s32 entry, sector_t *sector);
+ENTRY_SET_CACHE_T *get_entry_set_in_dir(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u32 type, DENTRY_T **file_ep);
+void release_entry_set(ENTRY_SET_CACHE_T *es);
+s32 write_whole_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es);
+s32 write_partial_entries_in_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es, DENTRY_T *ep, u32 count);
+s32  search_deleted_or_unused_entry(struct super_block *sb, CHAIN_T *p_dir, s32 num_entries);
+s32  find_empty_entry(struct inode *inode, CHAIN_T *p_dir, s32 num_entries);
+s32  fat_find_dir_entry(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 num_entries, DOS_NAME_T *p_dosname, u32 type);
+s32  exfat_find_dir_entry(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 num_entries, DOS_NAME_T *p_dosname, u32 type);
+s32  fat_count_ext_entries(struct super_block *sb, CHAIN_T *p_dir, s32 entry, DENTRY_T *p_entry);
+s32  exfat_count_ext_entries(struct super_block *sb, CHAIN_T *p_dir, s32 entry, DENTRY_T *p_entry);
+s32  count_dos_name_entries(struct super_block *sb, CHAIN_T *p_dir, u32 type);
+void   update_dir_checksum(struct super_block *sb, CHAIN_T *p_dir, s32 entry);
+void update_dir_checksum_with_entry_set(struct super_block *sb, ENTRY_SET_CACHE_T *es);
+bool   is_dir_empty(struct super_block *sb, CHAIN_T *p_dir);
+
+/* name conversion functions */
+s32  get_num_entries_and_dos_name(struct super_block *sb, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, s32 *entries, DOS_NAME_T *p_dosname);
+void   get_uni_name_from_dos_entry(struct super_block *sb, DOS_DENTRY_T *ep, UNI_NAME_T *p_uniname, u8 mode);
+void   fat_get_uni_name_from_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u16 *uniname);
+void   exfat_get_uni_name_from_ext_entry(struct super_block *sb, CHAIN_T *p_dir, s32 entry, u16 *uniname);
+s32  extract_uni_name_from_ext_entry(EXT_DENTRY_T *ep, u16 *uniname, s32 order);
+s32  extract_uni_name_from_name_entry(NAME_DENTRY_T *ep, u16 *uniname, s32 order);
+s32  fat_generate_dos_name(struct super_block *sb, CHAIN_T *p_dir, DOS_NAME_T *p_dosname);
+void   fat_attach_count_to_dos_name(u8 *dosname, s32 count);
+s32  fat_calc_num_entries(UNI_NAME_T *p_uniname);
+s32  exfat_calc_num_entries(UNI_NAME_T *p_uniname);
+u8  calc_checksum_1byte(void *data, s32 len, u8 chksum);
+u16 calc_checksum_2byte(void *data, s32 len, u16 chksum, s32 type);
+u32 calc_checksum_4byte(void *data, s32 len, u32 chksum, s32 type);
+
+/* name resolution functions */
+s32  resolve_path(struct inode *inode, char *path, CHAIN_T *p_dir, UNI_NAME_T *p_uniname);
+s32  resolve_name(u8 *name, u8 **arg);
+
+/* file operation functions */
+s32  fat16_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr);
+s32  fat32_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr);
+s32  exfat_mount(struct super_block *sb, PBR_SECTOR_T *p_pbr);
+s32  create_dir(struct inode *inode, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, FILE_ID_T *fid);
+s32  create_file(struct inode *inode, CHAIN_T *p_dir, UNI_NAME_T *p_uniname, u8 mode, FILE_ID_T *fid);
+void   remove_file(struct inode *inode, CHAIN_T *p_dir, s32 entry);
+s32  rename_file(struct inode *inode, CHAIN_T *p_dir, s32 old_entry, UNI_NAME_T *p_uniname, FILE_ID_T *fid);
+s32  move_file(struct inode *inode, CHAIN_T *p_olddir, s32 oldentry, CHAIN_T *p_newdir, UNI_NAME_T *p_uniname, FILE_ID_T *fid);
+
+/* sector read/write functions */
+s32   sector_read(struct super_block *sb, sector_t sec, struct buffer_head **bh, s32 read);
+s32   sector_write(struct super_block *sb, sector_t sec, struct buffer_head *bh, s32 sync);
+s32   multi_sector_read(struct super_block *sb, sector_t sec, struct buffer_head **bh, s32 num_secs, s32 read);
+s32   multi_sector_write(struct super_block *sb, sector_t sec, struct buffer_head *bh, s32 num_secs, s32 sync);
+
+#endif /* _EXFAT_H */
diff --git a/fs/exfat/exfat_data.c b/fs/exfat/exfat_data.c
new file mode 100644
index 0000000000000000000000000000000000000000..65da07aff547a2dd123ce93e31d3e601b41ef222
--- /dev/null
+++ b/fs/exfat/exfat_data.c
@@ -0,0 +1,77 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_data.c                                              */
+/*  PURPOSE : exFAT Configuable Data Definitions                        */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+
+#include "exfat_blkdev.h"
+#include "exfat_cache.h"
+#include "exfat_nls.h"
+#include "exfat_super.h"
+#include "exfat_core.h"
+
+/*======================================================================*/
+/*                                                                      */
+/*                    GLOBAL VARIABLE DEFINITIONS                       */
+/*                                                                      */
+/*======================================================================*/
+
+/*----------------------------------------------------------------------*/
+/*  File Manager                                                        */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Buffer Manager                                                      */
+/*----------------------------------------------------------------------*/
+
+/* FAT cache */
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+DECLARE_MUTEX(f_sem);
+#else
+DEFINE_SEMAPHORE(f_sem);
+#endif
+BUF_CACHE_T FAT_cache_array[FAT_CACHE_SIZE];
+BUF_CACHE_T FAT_cache_lru_list;
+BUF_CACHE_T FAT_cache_hash_list[FAT_CACHE_HASH_SIZE];
+
+/* buf cache */
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+DECLARE_MUTEX(b_sem);
+#else
+DEFINE_SEMAPHORE(b_sem);
+#endif
+BUF_CACHE_T buf_cache_array[BUF_CACHE_SIZE];
+BUF_CACHE_T buf_cache_lru_list;
+BUF_CACHE_T buf_cache_hash_list[BUF_CACHE_HASH_SIZE];
diff --git a/fs/exfat/exfat_data.h b/fs/exfat/exfat_data.h
new file mode 100644
index 0000000000000000000000000000000000000000..53b0e39397fa114cd89d556efdd868c06644c91c
--- /dev/null
+++ b/fs/exfat/exfat_data.h
@@ -0,0 +1,58 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_data.h                                              */
+/*  PURPOSE : Header File for exFAT Configuable Constants               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_DATA_H
+#define _EXFAT_DATA_H
+
+#include "exfat_config.h"
+
+/*======================================================================*/
+/*                                                                      */
+/*                        FFS CONFIGURATIONS                            */
+/*                  (CHANGE THIS PART IF REQUIRED)                      */
+/*                                                                      */
+/*======================================================================*/
+
+/* max number of root directory entries in FAT12/16 */
+/* (should be an exponential value of 2)            */
+#define MAX_DENTRY              512
+
+/* cache size (in number of sectors)                */
+/* (should be an exponential value of 2)            */
+#define FAT_CACHE_SIZE          128
+#define FAT_CACHE_HASH_SIZE     64
+#define BUF_CACHE_SIZE          256
+#define BUF_CACHE_HASH_SIZE     64
+
+#endif /* _EXFAT_DATA_H */
diff --git a/fs/exfat/exfat_nls.c b/fs/exfat/exfat_nls.c
new file mode 100644
index 0000000000000000000000000000000000000000..a48b3d05a7c4bcada7602aa96b35acf9849e5eb1
--- /dev/null
+++ b/fs/exfat/exfat_nls.c
@@ -0,0 +1,448 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_nls.c                                               */
+/*  PURPOSE : exFAT NLS Manager                                         */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include "exfat_config.h"
+#include "exfat_data.h"
+
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_super.h"
+#include "exfat_core.h"
+
+#include <linux/nls.h>
+
+/*----------------------------------------------------------------------*/
+/*  Global Variable Definitions                                         */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Local Variable Definitions                                          */
+/*----------------------------------------------------------------------*/
+
+static u16 bad_dos_chars[] = {
+	/* + , ; = [ ] */
+	0x002B, 0x002C, 0x003B, 0x003D, 0x005B, 0x005D,
+	0xFF0B, 0xFF0C, 0xFF1B, 0xFF1D, 0xFF3B, 0xFF3D,
+	0
+};
+
+static u16 bad_uni_chars[] = {
+	/* " * / : < > ? \ | */
+	0x0022,         0x002A, 0x002F, 0x003A,
+	0x003C, 0x003E, 0x003F, 0x005C, 0x007C,
+	0
+};
+
+/*----------------------------------------------------------------------*/
+/*  Local Function Declarations                                         */
+/*----------------------------------------------------------------------*/
+
+static s32  convert_uni_to_ch(struct nls_table *nls, u8 *ch, u16 uni, s32 *lossy);
+static s32  convert_ch_to_uni(struct nls_table *nls, u16 *uni, u8 *ch, s32 *lossy);
+
+/*======================================================================*/
+/*  Global Function Definitions                                         */
+/*======================================================================*/
+
+u16 nls_upper(struct super_block *sb, u16 a)
+{
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+
+	if (EXFAT_SB(sb)->options.casesensitive)
+		return a;
+	if (p_fs->vol_utbl != NULL && (p_fs->vol_utbl)[get_col_index(a)] != NULL)
+		return (p_fs->vol_utbl)[get_col_index(a)][get_row_index(a)];
+	else
+		return a;
+}
+
+u16 *nls_wstrchr(u16 *str, u16 wchar)
+{
+	while (*str) {
+		if (*(str++) == wchar)
+			return str;
+	}
+
+	return 0;
+}
+
+s32 nls_dosname_cmp(struct super_block *sb, u8 *a, u8 *b)
+{
+	return strncmp((void *) a, (void *) b, DOS_NAME_LENGTH);
+} /* end of nls_dosname_cmp */
+
+s32 nls_uniname_cmp(struct super_block *sb, u16 *a, u16 *b)
+{
+	int i;
+
+	for (i = 0; i < MAX_NAME_LENGTH; i++, a++, b++) {
+		if (nls_upper(sb, *a) != nls_upper(sb, *b))
+			return 1;
+		if (*a == 0x0)
+			return 0;
+	}
+	return 0;
+} /* end of nls_uniname_cmp */
+
+void nls_uniname_to_dosname(struct super_block *sb, DOS_NAME_T *p_dosname, UNI_NAME_T *p_uniname, s32 *p_lossy)
+{
+	int i, j, len, lossy = FALSE;
+	u8 buf[MAX_CHARSET_SIZE];
+	u8 lower = 0, upper = 0;
+	u8 *dosname = p_dosname->name;
+	u16 *uniname = p_uniname->name;
+	u16 *p, *last_period;
+	struct nls_table *nls = EXFAT_SB(sb)->nls_disk;
+
+	for (i = 0; i < DOS_NAME_LENGTH; i++)
+		*(dosname+i) = ' ';
+
+	if (!nls_uniname_cmp(sb, uniname, (u16 *) UNI_CUR_DIR_NAME)) {
+		*(dosname) = '.';
+		p_dosname->name_case = 0x0;
+		if (p_lossy != NULL)
+			*p_lossy = FALSE;
+		return;
+	}
+
+	if (!nls_uniname_cmp(sb, uniname, (u16 *) UNI_PAR_DIR_NAME)) {
+		*(dosname) = '.';
+		*(dosname+1) = '.';
+		p_dosname->name_case = 0x0;
+		if (p_lossy != NULL)
+			*p_lossy = FALSE;
+		return;
+	}
+
+	/* search for the last embedded period */
+	last_period = NULL;
+	for (p = uniname; *p; p++) {
+		if (*p == (u16) '.')
+			last_period = p;
+	}
+
+	i = 0;
+	while (i < DOS_NAME_LENGTH) {
+		if (i == 8) {
+			if (last_period == NULL)
+				break;
+
+			if (uniname <= last_period) {
+				if (uniname < last_period)
+					lossy = TRUE;
+				uniname = last_period + 1;
+			}
+		}
+
+		if (*uniname == (u16) '\0') {
+			break;
+		} else if (*uniname == (u16) ' ') {
+			lossy = TRUE;
+		} else if (*uniname == (u16) '.') {
+			if (uniname < last_period)
+				lossy = TRUE;
+			else
+				i = 8;
+		} else if (nls_wstrchr(bad_dos_chars, *uniname)) {
+			lossy = TRUE;
+			*(dosname+i) = '_';
+			i++;
+		} else {
+			len = convert_uni_to_ch(nls, buf, *uniname, &lossy);
+
+			if (len > 1) {
+				if ((i >= 8) && ((i+len) > DOS_NAME_LENGTH))
+					break;
+
+				if ((i <  8) && ((i+len) > 8)) {
+					i = 8;
+					continue;
+				}
+
+				lower = 0xFF;
+
+				for (j = 0; j < len; j++, i++)
+					*(dosname+i) = *(buf+j);
+			} else { /* len == 1 */
+				if ((*buf >= 'a') && (*buf <= 'z')) {
+					*(dosname+i) = *buf - ('a' - 'A');
+
+					if (i < 8)
+						lower |= 0x08;
+					else
+						lower |= 0x10;
+				} else if ((*buf >= 'A') && (*buf <= 'Z')) {
+					*(dosname+i) = *buf;
+
+					if (i < 8)
+						upper |= 0x08;
+					else
+						upper |= 0x10;
+				} else {
+					*(dosname+i) = *buf;
+				}
+				i++;
+			}
+		}
+
+		uniname++;
+	}
+
+	if (*dosname == 0xE5)
+		*dosname = 0x05;
+
+	if (*uniname != 0x0)
+		lossy = TRUE;
+
+	if (upper & lower)
+		p_dosname->name_case = 0xFF;
+	else
+		p_dosname->name_case = lower;
+
+	if (p_lossy != NULL)
+		*p_lossy = lossy;
+} /* end of nls_uniname_to_dosname */
+
+void nls_dosname_to_uniname(struct super_block *sb, UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname)
+{
+	int i = 0, j, n = 0;
+	u8 buf[DOS_NAME_LENGTH+2];
+	u8 *dosname = p_dosname->name;
+	u16 *uniname = p_uniname->name;
+	struct nls_table *nls = EXFAT_SB(sb)->nls_disk;
+
+	if (*dosname == 0x05) {
+		*buf = 0xE5;
+		i++;
+		n++;
+	}
+
+	for (; i < 8; i++, n++) {
+		if (*(dosname+i) == ' ')
+			break;
+
+		if ((*(dosname+i) >= 'A') && (*(dosname+i) <= 'Z') && (p_dosname->name_case & 0x08))
+			*(buf+n) = *(dosname+i) + ('a' - 'A');
+		else
+			*(buf+n) = *(dosname+i);
+	}
+	if (*(dosname+8) != ' ') {
+		*(buf+n) = '.';
+		n++;
+	}
+
+	for (i = 8; i < DOS_NAME_LENGTH; i++, n++) {
+		if (*(dosname+i) == ' ')
+			break;
+
+		if ((*(dosname+i) >= 'A') && (*(dosname+i) <= 'Z') && (p_dosname->name_case & 0x10))
+			*(buf+n) = *(dosname+i) + ('a' - 'A');
+		else
+			*(buf+n) = *(dosname+i);
+	}
+	*(buf+n) = '\0';
+
+	i = j = 0;
+	while (j < (MAX_NAME_LENGTH-1)) {
+		if (*(buf+i) == '\0')
+			break;
+
+		i += convert_ch_to_uni(nls, uniname, (buf+i), NULL);
+
+		uniname++;
+		j++;
+	}
+
+	*uniname = (u16) '\0';
+} /* end of nls_dosname_to_uniname */
+
+void nls_uniname_to_cstring(struct super_block *sb, u8 *p_cstring, UNI_NAME_T *p_uniname)
+{
+	int i, j, len;
+	u8 buf[MAX_CHARSET_SIZE];
+	u16 *uniname = p_uniname->name;
+	struct nls_table *nls = EXFAT_SB(sb)->nls_io;
+
+	if (nls == NULL) {
+		len = utf16s_to_utf8s(uniname, MAX_NAME_LENGTH, UTF16_HOST_ENDIAN, p_cstring, MAX_NAME_LENGTH);
+		p_cstring[len] = 0;
+		return;
+	}
+
+	i = 0;
+	while (i < (MAX_NAME_LENGTH-1)) {
+		if (*uniname == (u16) '\0')
+			break;
+
+		len = convert_uni_to_ch(nls, buf, *uniname, NULL);
+
+		if (len > 1) {
+			for (j = 0; j < len; j++)
+				*p_cstring++ = (char) *(buf+j);
+		} else { /* len == 1 */
+			*p_cstring++ = (char) *buf;
+		}
+
+		uniname++;
+		i++;
+	}
+
+	*p_cstring = '\0';
+} /* end of nls_uniname_to_cstring */
+
+void nls_cstring_to_uniname(struct super_block *sb, UNI_NAME_T *p_uniname, u8 *p_cstring, s32 *p_lossy)
+{
+	int i, j, lossy = FALSE;
+	u8 *end_of_name;
+	u8 upname[MAX_NAME_LENGTH * 2];
+	u16 *uniname = p_uniname->name;
+	struct nls_table *nls = EXFAT_SB(sb)->nls_io;
+
+
+	/* strip all trailing spaces */
+	end_of_name = p_cstring + strlen((char *) p_cstring);
+
+	while (*(--end_of_name) == ' ') {
+		if (end_of_name < p_cstring)
+			break;
+	}
+	*(++end_of_name) = '\0';
+
+	if (strcmp((char *) p_cstring, ".") && strcmp((char *) p_cstring, "..")) {
+
+		/* strip all trailing periods */
+		while (*(--end_of_name) == '.') {
+			if (end_of_name < p_cstring)
+				break;
+		}
+		*(++end_of_name) = '\0';
+	}
+
+	if (*p_cstring == '\0')
+		lossy = TRUE;
+
+	if (nls == NULL) {
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,101)
+		i = utf8s_to_utf16s(p_cstring, MAX_NAME_LENGTH, uniname);
+#else
+		i = utf8s_to_utf16s(p_cstring, MAX_NAME_LENGTH, UTF16_HOST_ENDIAN, uniname, MAX_NAME_LENGTH);
+#endif
+		for (j = 0; j < i; j++)
+			SET16_A(upname + j * 2, nls_upper(sb, uniname[j]));
+		uniname[i] = '\0';
+	}
+	else {
+		i = j = 0;
+		while (j < (MAX_NAME_LENGTH-1)) {
+			if (*(p_cstring+i) == '\0')
+				break;
+
+			i += convert_ch_to_uni(nls, uniname, (u8 *)(p_cstring+i), &lossy);
+
+			if ((*uniname < 0x0020) || nls_wstrchr(bad_uni_chars, *uniname))
+				lossy = TRUE;
+
+			SET16_A(upname + j * 2, nls_upper(sb, *uniname));
+
+			uniname++;
+			j++;
+		}
+
+		if (*(p_cstring+i) != '\0')
+			lossy = TRUE;
+		*uniname = (u16) '\0';
+	}
+
+	p_uniname->name_len = j;
+	p_uniname->name_hash = calc_checksum_2byte((void *) upname, j<<1, 0, CS_DEFAULT);
+
+	if (p_lossy != NULL)
+		*p_lossy = lossy;
+} /* end of nls_cstring_to_uniname */
+
+/*======================================================================*/
+/*  Local Function Definitions                                          */
+/*======================================================================*/
+
+static s32 convert_ch_to_uni(struct nls_table *nls, u16 *uni, u8 *ch, s32 *lossy)
+{
+	int len;
+
+	*uni = 0x0;
+
+	if (ch[0] < 0x80) {
+		*uni = (u16) ch[0];
+		return 1;
+	}
+
+	len = nls->char2uni(ch, NLS_MAX_CHARSET_SIZE, uni);
+	if (len < 0) {
+		/* conversion failed */
+		printk("%s: fail to use nls\n", __func__);
+		if (lossy != NULL)
+			*lossy = TRUE;
+		*uni = (u16) '_';
+		if (!strcmp(nls->charset, "utf8"))
+			return 1;
+		else
+			return 2;
+	}
+
+	return len;
+} /* end of convert_ch_to_uni */
+
+static s32 convert_uni_to_ch(struct nls_table *nls, u8 *ch, u16 uni, s32 *lossy)
+{
+	int len;
+
+	ch[0] = 0x0;
+
+	if (uni < 0x0080) {
+		ch[0] = (u8) uni;
+		return 1;
+	}
+
+	len = nls->uni2char(uni, ch, NLS_MAX_CHARSET_SIZE);
+	if (len < 0) {
+		/* conversion failed */
+		printk("%s: fail to use nls\n", __func__);
+		if (lossy != NULL)
+			*lossy = TRUE;
+		ch[0] = '_';
+		return 1;
+	}
+
+	return len;
+
+} /* end of convert_uni_to_ch */
diff --git a/fs/exfat/exfat_nls.h b/fs/exfat/exfat_nls.h
new file mode 100644
index 0000000000000000000000000000000000000000..bc516d762e903bed317cc79729cc2111829f1ead
--- /dev/null
+++ b/fs/exfat/exfat_nls.h
@@ -0,0 +1,91 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_nls.h                                               */
+/*  PURPOSE : Header File for exFAT NLS Manager                         */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_NLS_H
+#define _EXFAT_NLS_H
+
+#include <linux/types.h>
+#include <linux/nls.h>
+
+#include "exfat_config.h"
+#include "exfat_api.h"
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions                                        */
+/*----------------------------------------------------------------------*/
+
+#define NUM_UPCASE              2918
+
+#define DOS_CUR_DIR_NAME        ".          "
+#define DOS_PAR_DIR_NAME        "..         "
+
+#ifdef __LITTLE_ENDIAN
+#define UNI_CUR_DIR_NAME        ".\0"
+#define UNI_PAR_DIR_NAME        ".\0.\0"
+#else
+#define UNI_CUR_DIR_NAME        "\0."
+#define UNI_PAR_DIR_NAME        "\0.\0."
+#endif
+
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+/* DOS name stucture */
+typedef struct {
+	u8       name[DOS_NAME_LENGTH];
+	u8       name_case;
+} DOS_NAME_T;
+
+/* unicode name stucture */
+typedef struct {
+	u16      name[MAX_NAME_LENGTH];
+	u16      name_hash;
+	u8       name_len;
+} UNI_NAME_T;
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+/* NLS management function */
+u16 nls_upper(struct super_block *sb, u16 a);
+s32  nls_dosname_cmp(struct super_block *sb, u8 *a, u8 *b);
+s32  nls_uniname_cmp(struct super_block *sb, u16 *a, u16 *b);
+void   nls_uniname_to_dosname(struct super_block *sb, DOS_NAME_T *p_dosname, UNI_NAME_T *p_uniname, s32 *p_lossy);
+void   nls_dosname_to_uniname(struct super_block *sb, UNI_NAME_T *p_uniname, DOS_NAME_T *p_dosname);
+void   nls_uniname_to_cstring(struct super_block *sb, u8 *p_cstring, UNI_NAME_T *p_uniname);
+void   nls_cstring_to_uniname(struct super_block *sb, UNI_NAME_T *p_uniname, u8 *p_cstring, s32 *p_lossy);
+
+#endif /* _EXFAT_NLS_H */
diff --git a/fs/exfat/exfat_oal.c b/fs/exfat/exfat_oal.c
new file mode 100644
index 0000000000000000000000000000000000000000..743544244ca899d89bb4781140947d833f0eaaa5
--- /dev/null
+++ b/fs/exfat/exfat_oal.c
@@ -0,0 +1,196 @@
+/* Some of the source code in this file came from "linux/fs/fat/misc.c".  */
+/*
+ *  linux/fs/fat/misc.c
+ *
+ *  Written 1992,1993 by Werner Almesberger
+ *  22/11/2000 - Fixed fat_date_unix2dos for dates earlier than 01/01/1980
+ *         and date_dos2unix for date==0 by Igor Zhbanov(bsg@uniyar.ac.ru)
+ */
+
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_oal.c                                               */
+/*  PURPOSE : exFAT OS Adaptation Layer                                 */
+/*            (Semaphore Functions & Real-Time Clock Functions)         */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include <linux/semaphore.h>
+#include <linux/time.h>
+
+#include "exfat_config.h"
+#include "exfat_api.h"
+#include "exfat_oal.h"
+
+/*======================================================================*/
+/*                                                                      */
+/*            SEMAPHORE FUNCTIONS                                       */
+/*                                                                      */
+/*======================================================================*/
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+DECLARE_MUTEX(z_sem);
+#else
+DEFINE_SEMAPHORE(z_sem);
+#endif
+
+s32 sm_init(struct semaphore *sm)
+{
+	sema_init(sm, 1);
+	return 0;
+} /* end of sm_init */
+
+s32 sm_P(struct semaphore *sm)
+{
+	down(sm);
+	return 0;
+} /* end of sm_P */
+
+void sm_V(struct semaphore *sm)
+{
+	up(sm);
+} /* end of sm_V */
+
+
+/*======================================================================*/
+/*                                                                      */
+/*            REAL-TIME CLOCK FUNCTIONS                                 */
+/*                                                                      */
+/*======================================================================*/
+
+extern struct timezone sys_tz;
+
+/*
+ * The epoch of FAT timestamp is 1980.
+ *     :  bits  : value
+ * date:  0 -  4: day    (1 -  31)
+ * date:  5 -  8: month  (1 -  12)
+ * date:  9 - 15: year   (0 - 127) from 1980
+ * time:  0 -  4: sec    (0 -  29) 2sec counts
+ * time:  5 - 10: min    (0 -  59)
+ * time: 11 - 15: hour   (0 -  23)
+ */
+#define UNIX_SECS_1980   315532800L
+
+#if BITS_PER_LONG == 64
+#define UNIX_SECS_2108   4354819200L
+#endif
+/* days between 1.1.70 and 1.1.80 (2 leap days) */
+#define DAYS_DELTA_DECADE	(365 * 10 + 2)
+/* 120 (2100 - 1980) isn't leap year */
+#define NO_LEAP_YEAR_2100    (120)
+#define IS_LEAP_YEAR(y)  (!((y) & 3) && (y) != NO_LEAP_YEAR_2100)
+
+#define SECS_PER_MIN     (60)
+#define SECS_PER_HOUR    (60 * SECS_PER_MIN)
+#define SECS_PER_DAY     (24 * SECS_PER_HOUR)
+
+#define MAKE_LEAP_YEAR(leap_year, year)                         \
+	do {                                                    \
+		if (unlikely(year > NO_LEAP_YEAR_2100))         \
+			leap_year = ((year + 3) / 4) - 1;       \
+		else                                            \
+			leap_year = ((year + 3) / 4);           \
+	} while (0)
+
+/* Linear day numbers of the respective 1sts in non-leap years. */
+static time_t accum_days_in_year[] = {
+	/* Jan  Feb  Mar  Apr  May  Jun  Jul  Aug  Sep  Oct  Nov  Dec */
+	0,   0,  31,  59,  90, 120, 151, 181, 212, 243, 273, 304, 334, 0, 0, 0,
+};
+
+TIMESTAMP_T *tm_current(TIMESTAMP_T *tp)
+{
+	struct timespec ts;
+	time_t second, day, leap_day, month, year;
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(4,8,0)
+	ts = CURRENT_TIME_SEC;
+#else
+	ktime_get_real_ts(&ts);
+#endif
+
+	second = ts.tv_sec;
+	second -= sys_tz.tz_minuteswest * SECS_PER_MIN;
+
+	/* Jan 1 GMT 00:00:00 1980. But what about another time zone? */
+	if (second < UNIX_SECS_1980) {
+		tp->sec  = 0;
+		tp->min  = 0;
+		tp->hour = 0;
+		tp->day  = 1;
+		tp->mon  = 1;
+		tp->year = 0;
+		return tp;
+	}
+#if BITS_PER_LONG == 64
+	if (second >= UNIX_SECS_2108) {
+		tp->sec  = 59;
+		tp->min  = 59;
+		tp->hour = 23;
+		tp->day  = 31;
+		tp->mon  = 12;
+		tp->year = 127;
+		return tp;
+	}
+#endif
+
+	day = second / SECS_PER_DAY - DAYS_DELTA_DECADE;
+	year = day / 365;
+
+	MAKE_LEAP_YEAR(leap_day, year);
+	if (year * 365 + leap_day > day)
+		year--;
+
+	MAKE_LEAP_YEAR(leap_day, year);
+
+	day -= year * 365 + leap_day;
+
+	if (IS_LEAP_YEAR(year) && day == accum_days_in_year[3]) {
+		month = 2;
+	} else {
+		if (IS_LEAP_YEAR(year) && day > accum_days_in_year[3])
+			day--;
+		for (month = 1; month < 12; month++) {
+			if (accum_days_in_year[month + 1] > day)
+				break;
+		}
+	}
+	day -= accum_days_in_year[month];
+
+	tp->sec  = second % SECS_PER_MIN;
+	tp->min  = (second / SECS_PER_MIN) % 60;
+	tp->hour = (second / SECS_PER_HOUR) % 24;
+	tp->day  = day + 1;
+	tp->mon  = month;
+	tp->year = year;
+
+	return tp;
+} /* end of tm_current */
diff --git a/fs/exfat/exfat_oal.h b/fs/exfat/exfat_oal.h
new file mode 100644
index 0000000000000000000000000000000000000000..b6dd7897ab6e2f3f4276b2e32429a5f3aa1d0d36
--- /dev/null
+++ b/fs/exfat/exfat_oal.h
@@ -0,0 +1,74 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_oal.h                                               */
+/*  PURPOSE : Header File for exFAT OS Adaptation Layer                 */
+/*            (Semaphore Functions & Real-Time Clock Functions)         */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#ifndef _EXFAT_OAL_H
+#define _EXFAT_OAL_H
+
+#include <linux/semaphore.h>
+#include "exfat_config.h"
+#include <linux/version.h>
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions (Configurable)                         */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Constant & Macro Definitions (Non-Configurable)                     */
+/*----------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------*/
+/*  Type Definitions                                                    */
+/*----------------------------------------------------------------------*/
+
+typedef struct {
+	u16      sec;        /* 0 ~ 59               */
+	u16      min;        /* 0 ~ 59               */
+	u16      hour;       /* 0 ~ 23               */
+	u16      day;        /* 1 ~ 31               */
+	u16      mon;        /* 1 ~ 12               */
+	u16      year;       /* 0 ~ 127 (since 1980) */
+} TIMESTAMP_T;
+
+/*----------------------------------------------------------------------*/
+/*  External Function Declarations                                      */
+/*----------------------------------------------------------------------*/
+
+s32 sm_init(struct semaphore *sm);
+s32 sm_P(struct semaphore *sm);
+void  sm_V(struct semaphore *sm);
+
+TIMESTAMP_T *tm_current(TIMESTAMP_T *tm);
+
+#endif /* _EXFAT_OAL_H */
diff --git a/fs/exfat/exfat_super.c b/fs/exfat/exfat_super.c
new file mode 100644
index 0000000000000000000000000000000000000000..ab828c37468e3a4ed6de0e10292c85b53c631517
--- /dev/null
+++ b/fs/exfat/exfat_super.c
@@ -0,0 +1,2697 @@
+/* Some of the source code in this file came from "linux/fs/fat/file.c","linux/fs/fat/inode.c" and "linux/fs/fat/misc.c".  */
+/*
+ *  linux/fs/fat/file.c
+ *
+ *  Written 1992,1993 by Werner Almesberger
+ *
+ *  regular file handling primitives for fat-based filesystems
+ */
+
+/*
+ *  linux/fs/fat/inode.c
+ *
+ *  Written 1992,1993 by Werner Almesberger
+ *  VFAT extensions by Gordon Chaffee, merged with msdos fs by Henrik Storner
+ *  Rewritten for the constant inumbers support by Al Viro
+ *
+ *  Fixes:
+ *
+ *    Max Cohan: Fixed invalid FSINFO offset when info_sector is 0
+ */
+
+/*
+ *  linux/fs/fat/misc.c
+ *
+ *  Written 1992,1993 by Werner Almesberger
+ *  22/11/2000 - Fixed fat_date_unix2dos for dates earlier than 01/01/1980
+ *         and date_dos2unix for date==0 by Igor Zhbanov(bsg@uniyar.ac.ru)
+ */
+
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+#include <linux/version.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/time.h>
+#include <linux/slab.h>
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
+#include <linux/smp_lock.h>
+#endif
+#include <linux/seq_file.h>
+#include <linux/pagemap.h>
+#include <linux/mpage.h>
+#include <linux/buffer_head.h>
+#include <linux/exportfs.h>
+#include <linux/mount.h>
+#include <linux/vfs.h>
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0)
+#include <linux/aio.h>
+#endif
+#include <linux/parser.h>
+#include <linux/uio.h>
+#include <linux/writeback.h>
+#include <linux/log2.h>
+#include <linux/hash.h>
+#include <linux/backing-dev.h>
+#include <linux/sched.h>
+#include <linux/fs_struct.h>
+#include <linux/namei.h>
+#include <asm/current.h>
+#include <asm/unaligned.h>
+
+#include "exfat_version.h"
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+
+#include "exfat_blkdev.h"
+#include "exfat_cache.h"
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_core.h"
+
+#include "exfat_super.h"
+
+static struct kmem_cache *exfat_inode_cachep;
+
+static int exfat_default_codepage = CONFIG_EXFAT_DEFAULT_CODEPAGE;
+static char exfat_default_iocharset[] = CONFIG_EXFAT_DEFAULT_IOCHARSET;
+
+extern struct timezone sys_tz;
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(4,8,0)
+#define current_time(x)	(CURRENT_TIME_SEC)
+#endif
+
+#define CHECK_ERR(x)	BUG_ON(x)
+
+#define UNIX_SECS_1980    315532800L
+
+#if BITS_PER_LONG == 64
+#define UNIX_SECS_2108    4354819200L
+#endif
+/* days between 1.1.70 and 1.1.80 (2 leap days) */
+#define DAYS_DELTA_DECADE    (365 * 10 + 2)
+/* 120 (2100 - 1980) isn't leap year */
+#define NO_LEAP_YEAR_2100    (120)
+#define IS_LEAP_YEAR(y)    (!((y) & 0x3) && (y) != NO_LEAP_YEAR_2100)
+
+#define SECS_PER_MIN    (60)
+#define SECS_PER_HOUR   (60 * SECS_PER_MIN)
+#define SECS_PER_DAY    (24 * SECS_PER_HOUR)
+
+#define MAKE_LEAP_YEAR(leap_year, year)                         \
+	do {                                                    \
+		if (unlikely(year > NO_LEAP_YEAR_2100))         \
+			leap_year = ((year + 3) / 4) - 1;       \
+		else                                            \
+			leap_year = ((year + 3) / 4);           \
+	} while (0)
+
+/* Linear day numbers of the respective 1sts in non-leap years. */
+static time_t accum_days_in_year[] = {
+	/* Jan  Feb  Mar  Apr  May  Jun  Jul  Aug  Sep  Oct  Nov  Dec */
+	0,   0,  31,  59,  90, 120, 151, 181, 212, 243, 273, 304, 334, 0, 0, 0,
+};
+
+static void _exfat_truncate(struct inode *inode, loff_t old_size);
+
+/* Convert a FAT time/date pair to a UNIX date (seconds since 1 1 70). */
+void exfat_time_fat2unix(struct exfat_sb_info *sbi, struct timespec *ts,
+						 DATE_TIME_T *tp)
+{
+	time_t year = tp->Year;
+	time_t ld;
+
+	MAKE_LEAP_YEAR(ld, year);
+
+	if (IS_LEAP_YEAR(year) && (tp->Month) > 2)
+		ld++;
+
+	ts->tv_sec =  tp->Second  + tp->Minute * SECS_PER_MIN
+				  + tp->Hour * SECS_PER_HOUR
+				  + (year * 365 + ld + accum_days_in_year[(tp->Month)] + (tp->Day - 1) + DAYS_DELTA_DECADE) * SECS_PER_DAY
+				  + sys_tz.tz_minuteswest * SECS_PER_MIN;
+	ts->tv_nsec = 0;
+}
+
+/* Convert linear UNIX date to a FAT time/date pair. */
+void exfat_time_unix2fat(struct exfat_sb_info *sbi, struct timespec *ts,
+						 DATE_TIME_T *tp)
+{
+	time_t second = ts->tv_sec;
+	time_t day, month, year;
+	time_t ld;
+
+	second -= sys_tz.tz_minuteswest * SECS_PER_MIN;
+
+	/* Jan 1 GMT 00:00:00 1980. But what about another time zone? */
+	if (second < UNIX_SECS_1980) {
+		tp->Second  = 0;
+		tp->Minute  = 0;
+		tp->Hour = 0;
+		tp->Day  = 1;
+		tp->Month  = 1;
+		tp->Year = 0;
+		return;
+	}
+#if (BITS_PER_LONG == 64)
+	if (second >= UNIX_SECS_2108) {
+		tp->Second  = 59;
+		tp->Minute  = 59;
+		tp->Hour = 23;
+		tp->Day  = 31;
+		tp->Month  = 12;
+		tp->Year = 127;
+		return;
+	}
+#endif
+	day = second / SECS_PER_DAY - DAYS_DELTA_DECADE;
+	year = day / 365;
+	MAKE_LEAP_YEAR(ld, year);
+	if (year * 365 + ld > day)
+		year--;
+
+	MAKE_LEAP_YEAR(ld, year);
+	day -= year * 365 + ld;
+
+	if (IS_LEAP_YEAR(year) && day == accum_days_in_year[3]) {
+		month = 2;
+	} else {
+		if (IS_LEAP_YEAR(year) && day > accum_days_in_year[3])
+			day--;
+		for (month = 1; month < 12; month++) {
+			if (accum_days_in_year[month + 1] > day)
+				break;
+		}
+	}
+	day -= accum_days_in_year[month];
+
+	tp->Second  = second % SECS_PER_MIN;
+	tp->Minute  = (second / SECS_PER_MIN) % 60;
+	tp->Hour = (second / SECS_PER_HOUR) % 24;
+	tp->Day  = day + 1;
+	tp->Month  = month;
+	tp->Year = year;
+}
+
+static struct inode *exfat_iget(struct super_block *sb, loff_t i_pos);
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+static int exfat_generic_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg);
+#else
+static long exfat_generic_ioctl(struct file *filp, unsigned int cmd, unsigned long arg);
+#endif
+static int exfat_sync_inode(struct inode *inode);
+static struct inode *exfat_build_inode(struct super_block *sb, FILE_ID_T *fid, loff_t i_pos);
+static void exfat_detach(struct inode *inode);
+static void exfat_attach(struct inode *inode, loff_t i_pos);
+static inline unsigned long exfat_hash(loff_t i_pos);
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34)
+static int exfat_write_inode(struct inode *inode, int wait);
+#else
+static int exfat_write_inode(struct inode *inode, struct writeback_control *wbc);
+#endif
+static void exfat_write_super(struct super_block *sb);
+
+static void __lock_super(struct super_block *sb)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	lock_super(sb);
+#else
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	mutex_lock(&sbi->s_lock);
+#endif
+}
+
+static void __unlock_super(struct super_block *sb)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	unlock_super(sb);
+#else
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	mutex_unlock(&sbi->s_lock);
+#endif
+}
+
+static int __is_sb_dirty(struct super_block *sb)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	return sb->s_dirt;
+#else
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	return sbi->s_dirt;
+#endif
+}
+
+static void __set_sb_clean(struct super_block *sb)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	sb->s_dirt = 0;
+#else
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	sbi->s_dirt = 0;
+#endif
+}
+
+static int __exfat_revalidate(struct dentry *dentry)
+{
+	return 0;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+static int exfat_revalidate(struct dentry *dentry, unsigned int flags)
+#else
+static int exfat_revalidate(struct dentry *dentry, struct nameidata *nd)
+#endif
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+	if (flags & LOOKUP_RCU)
+		return -ECHILD;
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,00)
+	if (nd && nd->flags & LOOKUP_RCU)
+		return -ECHILD;
+#endif
+
+	if (dentry->d_inode)
+		return 1;
+	return __exfat_revalidate(dentry);
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+static int exfat_revalidate_ci(struct dentry *dentry, unsigned int flags)
+#else
+static int exfat_revalidate_ci(struct dentry *dentry, struct nameidata *nd)
+#endif
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+	if (flags & LOOKUP_RCU)
+		return -ECHILD;
+#else
+	unsigned int flags;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,00)
+	if (nd && nd->flags & LOOKUP_RCU)
+		return -ECHILD;
+#endif
+
+	flags = nd ? nd->flags : 0;
+#endif
+
+	if (dentry->d_inode)
+		return 1;
+
+	if (!flags)
+		return 0;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,00)
+	if (flags & (LOOKUP_CREATE | LOOKUP_RENAME_TARGET))
+		return 0;
+#else
+	if (!(nd->flags & (LOOKUP_CONTINUE | LOOKUP_PARENT))) {
+		if (nd->flags & (LOOKUP_CREATE | LOOKUP_RENAME_TARGET))
+			return 0;
+	}
+#endif
+
+	return __exfat_revalidate(dentry);
+}
+
+static unsigned int __exfat_striptail_len(unsigned int len, const char *name)
+{
+	while (len && name[len - 1] == '.')
+		len--;
+	return len;
+}
+
+static unsigned int exfat_striptail_len(const struct qstr *qstr)
+{
+	return __exfat_striptail_len(qstr->len, qstr->name);
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+static int exfat_d_hash(const struct dentry *dentry, struct qstr *qstr)
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+static int exfat_d_hash(struct dentry *dentry, struct qstr *qstr)
+#else
+static int exfat_d_hash(const struct dentry *dentry, const struct inode *inode,
+		struct qstr *qstr)
+#endif
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,8,0)
+	qstr->hash = full_name_hash(dentry, qstr->name, exfat_striptail_len(qstr));
+#else
+	qstr->hash = full_name_hash(qstr->name, exfat_striptail_len(qstr));
+#endif
+	return 0;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+static int exfat_d_hashi(const struct dentry *dentry, struct qstr *qstr)
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+static int exfat_d_hashi(struct dentry *dentry, struct qstr *qstr)
+#else
+static int exfat_d_hashi(const struct dentry *dentry, const struct inode *inode,
+		struct qstr *qstr)
+#endif
+{
+	struct super_block *sb = dentry->d_sb;
+	const unsigned char *name;
+	unsigned int len;
+	unsigned long hash;
+
+	name = qstr->name;
+	len = exfat_striptail_len(qstr);
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,8,0)
+	hash = init_name_hash(dentry);
+#else
+	hash = init_name_hash();
+#endif
+	while (len--)
+		hash = partial_name_hash(nls_upper(sb, *name++), hash);
+	qstr->hash = end_name_hash(hash);
+
+	return 0;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,8,0)
+static int exfat_cmpi(const struct dentry *dentry,
+		unsigned int len, const char *str, const struct qstr *name)
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+static int exfat_cmpi(const struct dentry *parent, const struct dentry *dentry,
+		unsigned int len, const char *str, const struct qstr *name)
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+static int exfat_cmpi(struct dentry *parent, struct qstr *a, struct qstr *b)
+#else
+static int exfat_cmpi(const struct dentry *parent, const struct inode *pinode,
+		const struct dentry *dentry, const struct inode *inode,
+		unsigned int len, const char *str, const struct qstr *name)
+#endif
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,8,0)
+	struct nls_table *t = EXFAT_SB(dentry->d_sb)->nls_io;
+#else
+	struct nls_table *t = EXFAT_SB(parent->d_sb)->nls_io;
+#endif
+	unsigned int alen, blen;
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+	alen = exfat_striptail_len(a);
+	blen = exfat_striptail_len(b);
+#else
+	alen = exfat_striptail_len(name);
+	blen = __exfat_striptail_len(len, str);
+#endif
+	if (alen == blen) {
+		if (t == NULL) {
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+			if (strncasecmp(a->name, b->name, alen) == 0)
+#else
+			if (strncasecmp(name->name, str, alen) == 0)
+#endif
+				return 0;
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+		} else if (nls_strnicmp(t, a->name, b->name, alen) == 0)
+#else
+		} else if (nls_strnicmp(t, name->name, str, alen) == 0)
+#endif
+			return 0;
+	}
+	return 1;
+}
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,8,0)
+static int exfat_cmp(const struct dentry *dentry,
+		unsigned int len, const char *str, const struct qstr *name)
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+static int exfat_cmp(const struct dentry *parent, const struct dentry *dentry,
+		unsigned int len, const char *str, const struct qstr *name)
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+static int exfat_cmp(struct dentry *parent, struct qstr *a,
+			struct qstr *b)
+#else
+static int exfat_cmp(const struct dentry *parent, const struct inode *pinode,
+		const struct dentry *dentry, const struct inode *inode,
+		unsigned int len, const char *str, const struct qstr *name)
+#endif
+{
+	unsigned int alen, blen;
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+	alen = exfat_striptail_len(a);
+	blen = exfat_striptail_len(b);
+#else
+	alen = exfat_striptail_len(name);
+	blen = __exfat_striptail_len(len, str);
+#endif
+	if (alen == blen) {
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+		if (strncmp(a->name, b->name, alen) == 0)
+#else
+		if (strncmp(name->name, str, alen) == 0)
+#endif
+			return 0;
+	}
+	return 1;
+}
+
+static const struct dentry_operations exfat_ci_dentry_ops = {
+	.d_revalidate   = exfat_revalidate_ci,
+	.d_hash         = exfat_d_hashi,
+	.d_compare      = exfat_cmpi,
+};
+
+static const struct dentry_operations exfat_dentry_ops = {
+	.d_revalidate   = exfat_revalidate,
+	.d_hash         = exfat_d_hash,
+	.d_compare      = exfat_cmp,
+};
+
+/*======================================================================*/
+/*  Directory Entry Operations                                          */
+/*======================================================================*/
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+static int exfat_readdir(struct file *filp, struct dir_context *ctx)
+#else
+static int exfat_readdir(struct file *filp, void *dirent, filldir_t filldir)
+#endif
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,9,0)
+	struct inode *inode = file_inode(filp);
+#else
+	struct inode *inode = filp->f_path.dentry->d_inode;
+#endif
+	struct super_block *sb = inode->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+	BD_INFO_T *p_bd = &(EXFAT_SB(sb)->bd_info);
+	DIR_ENTRY_T de;
+	unsigned long inum;
+	loff_t cpos;
+	int err = 0;
+
+	__lock_super(sb);
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+	cpos = ctx->pos;
+#else
+	cpos = filp->f_pos;
+#endif
+	/* Fake . and .. for the root directory. */
+	if ((p_fs->vol_type == EXFAT) || (inode->i_ino == EXFAT_ROOT_INO)) {
+		while (cpos < 2) {
+			if (inode->i_ino == EXFAT_ROOT_INO)
+				inum = EXFAT_ROOT_INO;
+			else if (cpos == 0)
+				inum = inode->i_ino;
+			else /* (cpos == 1) */
+				inum = parent_ino(filp->f_path.dentry);
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+			if (!dir_emit_dots(filp, ctx))
+#else
+			if (filldir(dirent, "..", cpos+1, cpos, inum, DT_DIR) < 0)
+#endif
+				goto out;
+			cpos++;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+			ctx->pos++;
+#else
+			filp->f_pos++;
+#endif
+		}
+		if (cpos == 2)
+			cpos = 0;
+	}
+	if (cpos & (DENTRY_SIZE - 1)) {
+		err = -ENOENT;
+		goto out;
+	}
+
+get_new:
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+	EXFAT_I(inode)->fid.rwoffset = cpos >> DENTRY_SIZE_BITS;
+
+	err = FsReadDir(inode, &de);
+	if (err) {
+		/* at least we tried to read a sector
+		 * move cpos to next sector position (should be aligned)
+		 */
+		if (err == FFS_MEDIAERR) {
+			cpos += 1 << p_bd->sector_size_bits;
+			cpos &= ~((1 << p_bd->sector_size_bits)-1);
+		}
+
+		err = -EIO;
+		goto end_of_dir;
+	}
+
+	cpos = EXFAT_I(inode)->fid.rwoffset << DENTRY_SIZE_BITS;
+
+	if (!de.Name[0])
+		goto end_of_dir;
+
+	if (!memcmp(de.ShortName, DOS_CUR_DIR_NAME, DOS_NAME_LENGTH)) {
+		inum = inode->i_ino;
+	} else if (!memcmp(de.ShortName, DOS_PAR_DIR_NAME, DOS_NAME_LENGTH)) {
+		inum = parent_ino(filp->f_path.dentry);
+	} else {
+		loff_t i_pos = ((loff_t) EXFAT_I(inode)->fid.start_clu << 32) |
+					   ((EXFAT_I(inode)->fid.rwoffset-1) & 0xffffffff);
+
+		struct inode *tmp = exfat_iget(sb, i_pos);
+		if (tmp) {
+			inum = tmp->i_ino;
+			iput(tmp);
+		} else {
+			inum = iunique(sb, EXFAT_ROOT_INO);
+		}
+	}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+	if (!dir_emit(ctx, de.Name, strlen(de.Name), inum,
+		(de.Attr & ATTR_SUBDIR) ? DT_DIR : DT_REG))
+#else
+	if (filldir(dirent, de.Name, strlen(de.Name), cpos-1, inum,
+				(de.Attr & ATTR_SUBDIR) ? DT_DIR : DT_REG) < 0)
+#endif
+		goto out;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+	ctx->pos = cpos;
+#else
+	filp->f_pos = cpos;
+#endif
+	goto get_new;
+
+end_of_dir:
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+	ctx->pos = cpos;
+#else
+	filp->f_pos = cpos;
+#endif
+out:
+	__unlock_super(sb);
+	return err;
+}
+
+static int exfat_ioctl_volume_id(struct inode *dir)
+{
+	struct super_block *sb = dir->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+
+	return p_fs->vol_id;
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+static int exfat_generic_ioctl(struct inode *inode, struct file *filp,
+							   unsigned int cmd, unsigned long arg)
+#else
+static long exfat_generic_ioctl(struct file *filp,
+								unsigned int cmd, unsigned long arg)
+#endif
+{
+#if !(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36))
+    #if !(LINUX_VERSION_CODE < KERNEL_VERSION(3,18,3))
+		  struct inode *inode = filp->f_path.dentry->d_inode;
+    #else
+		  struct inode *inode = filp->f_dentry->d_inode;
+	#endif
+#endif
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	unsigned int flags;
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+	switch (cmd) {
+	case EXFAT_IOCTL_GET_VOLUME_ID:
+		return exfat_ioctl_volume_id(inode);
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	case EXFAT_IOC_GET_DEBUGFLAGS: {
+		struct super_block *sb = inode->i_sb;
+		struct exfat_sb_info *sbi = EXFAT_SB(sb);
+
+		flags = sbi->debug_flags;
+		return put_user(flags, (int __user *)arg);
+	}
+	case EXFAT_IOC_SET_DEBUGFLAGS: {
+		struct super_block *sb = inode->i_sb;
+		struct exfat_sb_info *sbi = EXFAT_SB(sb);
+
+		if (!capable(CAP_SYS_ADMIN))
+			return -EPERM;
+
+		if (get_user(flags, (int __user *) arg))
+			return -EFAULT;
+
+		__lock_super(sb);
+		sbi->debug_flags = flags;
+		__unlock_super(sb);
+
+		return 0;
+	}
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+	default:
+		return -ENOTTY; /* Inappropriate ioctl for device */
+	}
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,35)
+static int exfat_file_fsync(struct file *filp, struct dentry *dentry,
+				int datasync)
+#else
+static int exfat_file_fsync(struct file *filp, int datasync)
+#endif
+{
+	struct inode *inode = filp->f_mapping->host;
+	struct super_block *sb = inode->i_sb;
+	int res, err;
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,35)
+	res = simple_fsync(filp, dentry, datasync);
+#else
+	res = generic_file_fsync(filp, datasync);
+#endif
+	err = FsSyncVol(sb, 1);
+
+	return res ? res : err;
+}
+#endif
+
+const struct file_operations exfat_dir_operations = {
+	.llseek     = generic_file_llseek,
+	.read       = generic_read_dir,
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,11,0)
+	.iterate    = exfat_readdir,
+#else
+	.readdir    = exfat_readdir,
+#endif
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+	.ioctl      = exfat_generic_ioctl,
+	.fsync      = exfat_file_fsync,
+#else
+	.unlocked_ioctl = exfat_generic_ioctl,
+	.fsync      = generic_file_fsync,
+#endif
+};
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+static int exfat_create(struct inode *dir, struct dentry *dentry, umode_t mode,
+						bool excl)
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)
+static int exfat_create(struct inode *dir, struct dentry *dentry, umode_t mode,
+						struct nameidata *nd)
+#else
+static int exfat_create(struct inode *dir, struct dentry *dentry, int mode,
+						struct nameidata *nd)
+#endif
+{
+	struct super_block *sb = dir->i_sb;
+	struct inode *inode;
+	FILE_ID_T fid;
+	loff_t i_pos;
+	int err;
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_create entered\n");
+
+	err = FsCreateFile(dir, (u8 *) dentry->d_name.name, FM_REGULAR, &fid);
+	if (err) {
+		if (err == FFS_INVALIDPATH)
+			err = -EINVAL;
+		else if (err == FFS_FILEEXIST)
+			err = -EEXIST;
+		else if (err == FFS_FULL)
+			err = -ENOSPC;
+		else if (err == FFS_NAMETOOLONG)
+			err = -ENAMETOOLONG;
+		else
+			err = -EIO;
+		goto out;
+	}
+	dir->i_version++;
+	dir->i_ctime = dir->i_mtime = dir->i_atime = current_time(dir);
+	if (IS_DIRSYNC(dir))
+		(void) exfat_sync_inode(dir);
+	else
+		mark_inode_dirty(dir);
+
+	i_pos = ((loff_t) fid.dir.dir << 32) | (fid.entry & 0xffffffff);
+
+	inode = exfat_build_inode(sb, &fid, i_pos);
+	if (IS_ERR(inode)) {
+		err = PTR_ERR(inode);
+		goto out;
+	}
+	inode->i_version++;
+	inode->i_mtime = inode->i_atime = inode->i_ctime = current_time(inode);
+	/* timestamp is already written, so mark_inode_dirty() is unnecessary. */
+
+	dentry->d_time = dentry->d_parent->d_inode->i_version;
+	d_instantiate(dentry, inode);
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_create exited\n");
+	return err;
+}
+
+static int exfat_find(struct inode *dir, struct qstr *qname,
+					  FILE_ID_T *fid)
+{
+	int err;
+
+	if (qname->len == 0)
+		return -ENOENT;
+
+	err = FsLookupFile(dir, (u8 *) qname->name, fid);
+	if (err)
+		return -ENOENT;
+
+	return 0;
+}
+
+static int exfat_d_anon_disconn(struct dentry *dentry)
+{
+	return IS_ROOT(dentry) && (dentry->d_flags & DCACHE_DISCONNECTED);
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+static struct dentry *exfat_lookup(struct inode *dir, struct dentry *dentry,
+						   unsigned int flags)
+#else
+static struct dentry *exfat_lookup(struct inode *dir, struct dentry *dentry,
+						   struct nameidata *nd)
+#endif
+{
+	struct super_block *sb = dir->i_sb;
+	struct inode *inode;
+	struct dentry *alias;
+	int err;
+	FILE_ID_T fid;
+	loff_t i_pos;
+	u64 ret;
+	mode_t i_mode;
+
+	__lock_super(sb);
+	DPRINTK("exfat_lookup entered\n");
+	err = exfat_find(dir, &dentry->d_name, &fid);
+	if (err) {
+		if (err == -ENOENT) {
+			inode = NULL;
+			goto out;
+		}
+		goto error;
+	}
+
+	i_pos = ((loff_t) fid.dir.dir << 32) | (fid.entry & 0xffffffff);
+	inode = exfat_build_inode(sb, &fid, i_pos);
+	if (IS_ERR(inode)) {
+		err = PTR_ERR(inode);
+		goto error;
+	}
+
+	i_mode = inode->i_mode;
+	if (S_ISLNK(i_mode) && !EXFAT_I(inode)->target) {
+		EXFAT_I(inode)->target = kmalloc(i_size_read(inode)+1, GFP_KERNEL);
+		if (!EXFAT_I(inode)->target) {
+			err = -ENOMEM;
+			goto error;
+		}
+		FsReadFile(dir, &fid, EXFAT_I(inode)->target, i_size_read(inode), &ret);
+		*(EXFAT_I(inode)->target + i_size_read(inode)) = '\0';
+	}
+
+	alias = d_find_alias(inode);
+	if (alias && !exfat_d_anon_disconn(alias)) {
+		CHECK_ERR(d_unhashed(alias));
+		if (!S_ISDIR(i_mode))
+			d_move(alias, dentry);
+		iput(inode);
+		__unlock_super(sb);
+		DPRINTK("exfat_lookup exited 1\n");
+		return alias;
+	} else {
+		dput(alias);
+	}
+out:
+	__unlock_super(sb);
+	dentry->d_time = dentry->d_parent->d_inode->i_version;
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38)
+	dentry->d_op = sb->s_root->d_op;
+	dentry = d_splice_alias(inode, dentry);
+	if (dentry) {
+		dentry->d_op = sb->s_root->d_op;
+		dentry->d_time = dentry->d_parent->d_inode->i_version;
+	}
+#else
+	dentry = d_splice_alias(inode, dentry);
+	if (dentry)
+		dentry->d_time = dentry->d_parent->d_inode->i_version;
+#endif
+	DPRINTK("exfat_lookup exited 2\n");
+	return dentry;
+
+error:
+	__unlock_super(sb);
+	DPRINTK("exfat_lookup exited 3\n");
+	return ERR_PTR(err);
+}
+
+static int exfat_unlink(struct inode *dir, struct dentry *dentry)
+{
+	struct inode *inode = dentry->d_inode;
+	struct super_block *sb = dir->i_sb;
+	int err;
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_unlink entered\n");
+
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+
+	err = FsRemoveFile(dir, &(EXFAT_I(inode)->fid));
+	if (err) {
+		if (err == FFS_PERMISSIONERR)
+			err = -EPERM;
+		else
+			err = -EIO;
+		goto out;
+	}
+	dir->i_version++;
+	dir->i_mtime = dir->i_atime = current_time(dir);
+	if (IS_DIRSYNC(dir))
+		(void) exfat_sync_inode(dir);
+	else
+		mark_inode_dirty(dir);
+
+	clear_nlink(inode);
+	inode->i_mtime = inode->i_atime = current_time(inode);
+	exfat_detach(inode);
+	remove_inode_hash(inode);
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_unlink exited\n");
+	return err;
+}
+
+static int exfat_symlink(struct inode *dir, struct dentry *dentry, const char *target)
+{
+	struct super_block *sb = dir->i_sb;
+	struct inode *inode;
+	FILE_ID_T fid;
+	loff_t i_pos;
+	int err;
+	u64 len = (u64) strlen(target);
+	u64 ret;
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_symlink entered\n");
+
+	err = FsCreateFile(dir, (u8 *) dentry->d_name.name, FM_SYMLINK, &fid);
+	if (err) {
+		if (err == FFS_INVALIDPATH)
+			err = -EINVAL;
+		else if (err == FFS_FILEEXIST)
+			err = -EEXIST;
+		else if (err == FFS_FULL)
+			err = -ENOSPC;
+		else
+			err = -EIO;
+		goto out;
+	}
+
+	err = FsWriteFile(dir, &fid, (char *) target, len, &ret);
+
+	if (err) {
+		FsRemoveFile(dir, &fid);
+
+		if (err == FFS_FULL)
+			err = -ENOSPC;
+		else
+			err = -EIO;
+		goto out;
+	}
+
+	dir->i_version++;
+	dir->i_ctime = dir->i_mtime = dir->i_atime = current_time(dir);
+	if (IS_DIRSYNC(dir))
+		(void) exfat_sync_inode(dir);
+	else
+		mark_inode_dirty(dir);
+
+	i_pos = ((loff_t) fid.dir.dir << 32) | (fid.entry & 0xffffffff);
+
+	inode = exfat_build_inode(sb, &fid, i_pos);
+	if (IS_ERR(inode)) {
+		err = PTR_ERR(inode);
+		goto out;
+	}
+	inode->i_version++;
+	inode->i_mtime = inode->i_atime = inode->i_ctime = current_time(inode);
+	/* timestamp is already written, so mark_inode_dirty() is unneeded. */
+
+	EXFAT_I(inode)->target = kmalloc(len+1, GFP_KERNEL);
+	if (!EXFAT_I(inode)->target) {
+		err = -ENOMEM;
+		goto out;
+	}
+	memcpy(EXFAT_I(inode)->target, target, len+1);
+
+	dentry->d_time = dentry->d_parent->d_inode->i_version;
+	d_instantiate(dentry, inode);
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_symlink exited\n");
+	return err;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)
+static int exfat_mkdir(struct inode *dir, struct dentry *dentry, umode_t mode)
+#else
+static int exfat_mkdir(struct inode *dir, struct dentry *dentry, int mode)
+#endif
+{
+	struct super_block *sb = dir->i_sb;
+	struct inode *inode;
+	FILE_ID_T fid;
+	loff_t i_pos;
+	int err;
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_mkdir entered\n");
+
+	err = FsCreateDir(dir, (u8 *) dentry->d_name.name, &fid);
+	if (err) {
+		if (err == FFS_INVALIDPATH)
+			err = -EINVAL;
+		else if (err == FFS_FILEEXIST)
+			err = -EEXIST;
+		else if (err == FFS_FULL)
+			err = -ENOSPC;
+		else if (err == FFS_NAMETOOLONG)
+			err = -ENAMETOOLONG;
+		else
+			err = -EIO;
+		goto out;
+	}
+	dir->i_version++;
+	dir->i_ctime = dir->i_mtime = dir->i_atime = current_time(dir);
+	if (IS_DIRSYNC(dir))
+		(void) exfat_sync_inode(dir);
+	else
+		mark_inode_dirty(dir);
+	inc_nlink(dir);
+
+	i_pos = ((loff_t) fid.dir.dir << 32) | (fid.entry & 0xffffffff);
+
+	inode = exfat_build_inode(sb, &fid, i_pos);
+	if (IS_ERR(inode)) {
+		err = PTR_ERR(inode);
+		goto out;
+	}
+	inode->i_version++;
+	inode->i_mtime = inode->i_atime = inode->i_ctime = current_time(inode);
+	/* timestamp is already written, so mark_inode_dirty() is unneeded. */
+
+	dentry->d_time = dentry->d_parent->d_inode->i_version;
+	d_instantiate(dentry, inode);
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_mkdir exited\n");
+	return err;
+}
+
+static int exfat_rmdir(struct inode *dir, struct dentry *dentry)
+{
+	struct inode *inode = dentry->d_inode;
+	struct super_block *sb = dir->i_sb;
+	int err;
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_rmdir entered\n");
+
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+
+	err = FsRemoveDir(dir, &(EXFAT_I(inode)->fid));
+	if (err) {
+		if (err == FFS_INVALIDPATH)
+			err = -EINVAL;
+		else if (err == FFS_FILEEXIST)
+			err = -ENOTEMPTY;
+		else if (err == FFS_NOTFOUND)
+			err = -ENOENT;
+		else if (err == FFS_DIRBUSY)
+			err = -EBUSY;
+		else
+			err = -EIO;
+		goto out;
+	}
+	dir->i_version++;
+	dir->i_mtime = dir->i_atime = current_time(dir);
+	if (IS_DIRSYNC(dir))
+		(void) exfat_sync_inode(dir);
+	else
+		mark_inode_dirty(dir);
+	drop_nlink(dir);
+
+	clear_nlink(inode);
+	inode->i_mtime = inode->i_atime = current_time(inode);
+	exfat_detach(inode);
+	remove_inode_hash(inode);
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_rmdir exited\n");
+	return err;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,9,0)
+static int exfat_rename(struct inode *old_dir, struct dentry *old_dentry,
+						struct inode *new_dir, struct dentry *new_dentry,
+						unsigned int flags)
+#else
+static int exfat_rename(struct inode *old_dir, struct dentry *old_dentry,
+						struct inode *new_dir, struct dentry *new_dentry)
+#endif
+{
+	struct inode *old_inode, *new_inode;
+	struct super_block *sb = old_dir->i_sb;
+	loff_t i_pos;
+	int err;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,9,0)
+	if (flags)
+		return -EINVAL;
+#endif
+
+	__lock_super(sb);
+
+	DPRINTK("exfat_rename entered\n");
+
+	old_inode = old_dentry->d_inode;
+	new_inode = new_dentry->d_inode;
+
+	EXFAT_I(old_inode)->fid.size = i_size_read(old_inode);
+
+	err = FsMoveFile(old_dir, &(EXFAT_I(old_inode)->fid), new_dir, new_dentry);
+	if (err) {
+		if (err == FFS_PERMISSIONERR)
+			err = -EPERM;
+		else if (err == FFS_INVALIDPATH)
+			err = -EINVAL;
+		else if (err == FFS_FILEEXIST)
+			err = -EEXIST;
+		else if (err == FFS_NOTFOUND)
+			err = -ENOENT;
+		else if (err == FFS_FULL)
+			err = -ENOSPC;
+		else
+			err = -EIO;
+		goto out;
+	}
+	new_dir->i_version++;
+	new_dir->i_ctime = new_dir->i_mtime = new_dir->i_atime = current_time(new_dir);
+	if (IS_DIRSYNC(new_dir))
+		(void) exfat_sync_inode(new_dir);
+	else
+		mark_inode_dirty(new_dir);
+
+	i_pos = ((loff_t) EXFAT_I(old_inode)->fid.dir.dir << 32) |
+			(EXFAT_I(old_inode)->fid.entry & 0xffffffff);
+
+	exfat_detach(old_inode);
+	exfat_attach(old_inode, i_pos);
+	if (IS_DIRSYNC(new_dir))
+		(void) exfat_sync_inode(old_inode);
+	else
+		mark_inode_dirty(old_inode);
+
+	if ((S_ISDIR(old_inode->i_mode)) && (old_dir != new_dir)) {
+		drop_nlink(old_dir);
+		if (!new_inode)
+			inc_nlink(new_dir);
+	}
+
+	old_dir->i_version++;
+	old_dir->i_ctime = old_dir->i_mtime = current_time(old_dir);
+	if (IS_DIRSYNC(old_dir))
+		(void) exfat_sync_inode(old_dir);
+	else
+		mark_inode_dirty(old_dir);
+
+	if (new_inode) {
+		exfat_detach(new_inode);
+		drop_nlink(new_inode);
+		if (S_ISDIR(new_inode->i_mode))
+			drop_nlink(new_inode);
+		new_inode->i_ctime = current_time(new_inode);
+	}
+
+out:
+	__unlock_super(sb);
+	DPRINTK("exfat_rename exited\n");
+	return err;
+}
+
+static int exfat_cont_expand(struct inode *inode, loff_t size)
+{
+	struct address_space *mapping = inode->i_mapping;
+	loff_t start = i_size_read(inode), count = size - i_size_read(inode);
+	int err, err2;
+
+	err = generic_cont_expand_simple(inode, size);
+	if (err != 0)
+		return err;
+
+	inode->i_ctime = inode->i_mtime = current_time(inode);
+	mark_inode_dirty(inode);
+
+	if (IS_SYNC(inode)) {
+		err = filemap_fdatawrite_range(mapping, start, start + count - 1);
+		err2 = sync_mapping_buffers(mapping);
+		err = (err) ? (err) : (err2);
+		err2 = write_inode_now(inode, 1);
+		err = (err) ? (err) : (err2);
+		if (!err)
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32)
+			err =  wait_on_page_writeback_range(mapping,
+					start >> PAGE_CACHE_SHIFT,
+					(start + count - 1) >> PAGE_CACHE_SHIFT);
+#else
+			err =  filemap_fdatawait_range(mapping, start, start + count - 1);
+#endif
+	}
+	return err;
+}
+
+static int exfat_allow_set_time(struct exfat_sb_info *sbi, struct inode *inode)
+{
+	mode_t allow_utime = sbi->options.allow_utime;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+	if (!uid_eq(current_fsuid(), inode->i_uid))
+#else
+	if (current_fsuid() != inode->i_uid)
+#endif
+	{
+		if (in_group_p(inode->i_gid))
+			allow_utime >>= 3;
+		if (allow_utime & MAY_WRITE)
+			return 1;
+	}
+
+	/* use a default check */
+	return 0;
+}
+
+static int exfat_sanitize_mode(const struct exfat_sb_info *sbi,
+							   struct inode *inode, umode_t *mode_ptr)
+{
+	mode_t i_mode, mask, perm;
+
+	i_mode = inode->i_mode;
+
+	if (S_ISREG(i_mode) || S_ISLNK(i_mode))
+		mask = sbi->options.fs_fmask;
+	else
+		mask = sbi->options.fs_dmask;
+
+	perm = *mode_ptr & ~(S_IFMT | mask);
+
+	/* Of the r and x bits, all (subject to umask) must be present.*/
+	if ((perm & (S_IRUGO | S_IXUGO)) != (i_mode & (S_IRUGO|S_IXUGO)))
+		return -EPERM;
+
+	if (exfat_mode_can_hold_ro(inode)) {
+		/* Of the w bits, either all (subject to umask) or none must be present. */
+		if ((perm & S_IWUGO) && ((perm & S_IWUGO) != (S_IWUGO & ~mask)))
+			return -EPERM;
+	} else {
+		/* If exfat_mode_can_hold_ro(inode) is false, can't change w bits. */
+		if ((perm & S_IWUGO) != (S_IWUGO & ~mask))
+			return -EPERM;
+	}
+
+	*mode_ptr &= S_IFMT | perm;
+
+	return 0;
+}
+
+static int exfat_setattr(struct dentry *dentry, struct iattr *attr)
+{
+
+	struct exfat_sb_info *sbi = EXFAT_SB(dentry->d_sb);
+	struct inode *inode = dentry->d_inode;
+	unsigned int ia_valid;
+	int error;
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,35)
+	loff_t old_size;
+#endif
+
+	DPRINTK("exfat_setattr entered\n");
+
+	if ((attr->ia_valid & ATTR_SIZE)
+		&& (attr->ia_size > i_size_read(inode))) {
+		error = exfat_cont_expand(inode, attr->ia_size);
+		if (error || attr->ia_valid == ATTR_SIZE)
+			return error;
+		attr->ia_valid &= ~ATTR_SIZE;
+	}
+
+	ia_valid = attr->ia_valid;
+
+	if ((ia_valid & (ATTR_MTIME_SET | ATTR_ATIME_SET | ATTR_TIMES_SET))
+		&& exfat_allow_set_time(sbi, inode)) {
+		attr->ia_valid &= ~(ATTR_MTIME_SET | ATTR_ATIME_SET | ATTR_TIMES_SET);
+	}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,9,0)
+	error = setattr_prepare(dentry, attr);
+#else
+	error = inode_change_ok(inode, attr);
+#endif
+	attr->ia_valid = ia_valid;
+	if (error)
+		return error;
+
+	if (((attr->ia_valid & ATTR_UID) &&
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+		 (!uid_eq(attr->ia_uid, sbi->options.fs_uid))) ||
+		((attr->ia_valid & ATTR_GID) &&
+		 (!gid_eq(attr->ia_gid, sbi->options.fs_gid))) ||
+#else
+		 (attr->ia_uid != sbi->options.fs_uid)) ||
+		((attr->ia_valid & ATTR_GID) &&
+		 (attr->ia_gid != sbi->options.fs_gid)) ||
+#endif
+		((attr->ia_valid & ATTR_MODE) &&
+		 (attr->ia_mode & ~(S_IFREG | S_IFLNK | S_IFDIR | S_IRWXUGO)))) {
+		return -EPERM;
+	}
+
+	/*
+	 * We don't return -EPERM here. Yes, strange, but this is too
+	 * old behavior.
+	 */
+	if (attr->ia_valid & ATTR_MODE) {
+		if (exfat_sanitize_mode(sbi, inode, &attr->ia_mode) < 0)
+			attr->ia_valid &= ~ATTR_MODE;
+	}
+
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+	if (attr->ia_valid)
+		error = inode_setattr(inode, attr);
+#else
+	if (attr->ia_valid & ATTR_SIZE) {
+		old_size = i_size_read(inode);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,4,00)
+		down_write(&EXFAT_I(inode)->truncate_lock);
+		truncate_setsize(inode, attr->ia_size);
+		_exfat_truncate(inode, old_size);
+		up_write(&EXFAT_I(inode)->truncate_lock);
+#else
+		truncate_setsize(inode, attr->ia_size);
+		_exfat_truncate(inode, old_size);
+#endif
+	}
+	setattr_copy(inode, attr);
+	mark_inode_dirty(inode);
+#endif
+
+	DPRINTK("exfat_setattr exited\n");
+	return error;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)
+static int exfat_getattr(const struct path *path, struct kstat *stat,
+			 u32 request_mask, unsigned int flags)
+{
+	struct inode *inode = path->dentry->d_inode;
+#else
+static int exfat_getattr(struct vfsmount *mnt, struct dentry *dentry, struct kstat *stat)
+{
+	struct inode *inode = dentry->d_inode;
+#endif
+
+	DPRINTK("exfat_getattr entered\n");
+
+	generic_fillattr(inode, stat);
+	stat->blksize = EXFAT_SB(inode->i_sb)->fs_info.cluster_size;
+
+	DPRINTK("exfat_getattr exited\n");
+	return 0;
+}
+
+const struct inode_operations exfat_dir_inode_operations = {
+	.create        = exfat_create,
+	.lookup        = exfat_lookup,
+	.unlink        = exfat_unlink,
+	.symlink       = exfat_symlink,
+	.mkdir         = exfat_mkdir,
+	.rmdir         = exfat_rmdir,
+	.rename        = exfat_rename,
+	.setattr       = exfat_setattr,
+	.getattr       = exfat_getattr,
+};
+
+/*======================================================================*/
+/*  File Operations                                                     */
+/*======================================================================*/
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,5,0)
+static const char *exfat_get_link(struct dentry *dentry, struct inode *inode, struct delayed_call *done)
+{
+	struct exfat_inode_info *ei = EXFAT_I(inode);
+	if (ei->target != NULL) {
+		char *cookie = ei->target;
+		if (cookie != NULL) {
+			return (char *)(ei->target);
+		}
+	}
+	return NULL;
+}
+#elif LINUX_VERSION_CODE > KERNEL_VERSION(4,1,0)
+static const char *exfat_follow_link(struct dentry *dentry, void **cookie)
+{
+	struct exfat_inode_info *ei = EXFAT_I(dentry->d_inode);
+	return *cookie = (char *)(ei->target);
+}
+#else
+static void *exfat_follow_link(struct dentry *dentry, struct nameidata *nd)
+{
+	struct exfat_inode_info *ei = EXFAT_I(dentry->d_inode);
+	nd_set_link(nd, (char *)(ei->target));
+	return NULL;
+}
+#endif
+
+const struct inode_operations exfat_symlink_inode_operations = {
+	#if LINUX_VERSION_CODE < KERNEL_VERSION(4,10,0)
+		.readlink    = generic_readlink,
+	#endif
+	#if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
+		.follow_link = exfat_follow_link,
+	#endif
+	#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,5,0)
+		.get_link = exfat_get_link,
+	#endif
+};
+
+static int exfat_file_release(struct inode *inode, struct file *filp)
+{
+	struct super_block *sb = inode->i_sb;
+
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+	FsSyncVol(sb, 0);
+	return 0;
+}
+
+const struct file_operations exfat_file_operations = {
+	.llseek      = generic_file_llseek,
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)
+	.read        = do_sync_read,
+	.write       = do_sync_write,
+	.aio_read    = generic_file_aio_read,
+	.aio_write   = generic_file_aio_write,
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4,1,0)
+	.read        = new_sync_read,
+	.write       = new_sync_write,
+#endif
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,16,0)
+	.read_iter   = generic_file_read_iter,
+	.write_iter  = generic_file_write_iter,
+#endif
+	.mmap        = generic_file_mmap,
+	.release     = exfat_file_release,
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+	.ioctl       = exfat_generic_ioctl,
+	.fsync       = exfat_file_fsync,
+#else
+	.unlocked_ioctl  = exfat_generic_ioctl,
+	.fsync       = generic_file_fsync,
+#endif
+	.splice_read = generic_file_splice_read,
+};
+
+static void _exfat_truncate(struct inode *inode, loff_t old_size)
+{
+	struct super_block *sb = inode->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+	int err;
+
+	__lock_super(sb);
+
+	/*
+	 * This protects against truncating a file bigger than it was then
+	 * trying to write into the hole.
+	 */
+	if (EXFAT_I(inode)->mmu_private > i_size_read(inode))
+		EXFAT_I(inode)->mmu_private = i_size_read(inode);
+
+	if (EXFAT_I(inode)->fid.start_clu == 0)
+		goto out;
+
+	err = FsTruncateFile(inode, old_size, i_size_read(inode));
+	if (err)
+		goto out;
+
+	inode->i_ctime = inode->i_mtime = current_time(inode);
+	if (IS_DIRSYNC(inode))
+		(void) exfat_sync_inode(inode);
+	else
+		mark_inode_dirty(inode);
+
+	inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1))
+					   & ~((loff_t)p_fs->cluster_size - 1)) >> 9;
+out:
+	__unlock_super(sb);
+}
+
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,36)
+static void exfat_truncate(struct inode *inode)
+{
+	_exfat_truncate(inode, i_size_read(inode));
+}
+#endif
+
+const struct inode_operations exfat_file_inode_operations = {
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,36)
+	.truncate    = exfat_truncate,
+#endif
+	.setattr     = exfat_setattr,
+	.getattr     = exfat_getattr,
+};
+
+/*======================================================================*/
+/*  Address Space Operations                                            */
+/*======================================================================*/
+
+static int exfat_bmap(struct inode *inode, sector_t sector, sector_t *phys,
+					  unsigned long *mapped_blocks, int *create)
+{
+	struct super_block *sb = inode->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+	BD_INFO_T *p_bd = &(sbi->bd_info);
+	const unsigned long blocksize = sb->s_blocksize;
+	const unsigned char blocksize_bits = sb->s_blocksize_bits;
+	sector_t last_block;
+	int err, clu_offset, sec_offset;
+	unsigned int cluster;
+
+	*phys = 0;
+	*mapped_blocks = 0;
+
+	if ((p_fs->vol_type == FAT12) || (p_fs->vol_type == FAT16)) {
+		if (inode->i_ino == EXFAT_ROOT_INO) {
+			if (sector < (p_fs->dentries_in_root >> (p_bd->sector_size_bits-DENTRY_SIZE_BITS))) {
+				*phys = sector + p_fs->root_start_sector;
+				*mapped_blocks = 1;
+			}
+			return 0;
+		}
+	}
+
+	last_block = (i_size_read(inode) + (blocksize - 1)) >> blocksize_bits;
+	if (sector >= last_block) {
+		if (*create == 0)
+			return 0;
+	} else {
+		*create = 0;
+	}
+
+	clu_offset = sector >> p_fs->sectors_per_clu_bits;  /* cluster offset */
+	sec_offset = sector & (p_fs->sectors_per_clu - 1);  /* sector offset in cluster */
+
+	EXFAT_I(inode)->fid.size = i_size_read(inode);
+
+	err = FsMapCluster(inode, clu_offset, &cluster);
+
+	if (err) {
+		if (err == FFS_FULL)
+			return -ENOSPC;
+		else
+			return -EIO;
+	} else if (cluster != CLUSTER_32(~0)) {
+		*phys = START_SECTOR(cluster) + sec_offset;
+		*mapped_blocks = p_fs->sectors_per_clu - sec_offset;
+	}
+
+	return 0;
+}
+
+static int exfat_get_block(struct inode *inode, sector_t iblock,
+						   struct buffer_head *bh_result, int create)
+{
+	struct super_block *sb = inode->i_sb;
+	unsigned long max_blocks = bh_result->b_size >> inode->i_blkbits;
+	int err;
+	unsigned long mapped_blocks;
+	sector_t phys;
+
+	__lock_super(sb);
+
+	err = exfat_bmap(inode, iblock, &phys, &mapped_blocks, &create);
+	if (err) {
+		__unlock_super(sb);
+		return err;
+	}
+
+	if (phys) {
+		max_blocks = min(mapped_blocks, max_blocks);
+		if (create) {
+			EXFAT_I(inode)->mmu_private += max_blocks << sb->s_blocksize_bits;
+			set_buffer_new(bh_result);
+		}
+		map_bh(bh_result, sb, phys);
+	}
+
+	bh_result->b_size = max_blocks << sb->s_blocksize_bits;
+	__unlock_super(sb);
+
+	return 0;
+}
+
+static int exfat_readpage(struct file *file, struct page *page)
+{
+	int ret;
+	ret =  mpage_readpage(page, exfat_get_block);
+	return ret;
+}
+
+static int exfat_readpages(struct file *file, struct address_space *mapping,
+				   struct list_head *pages, unsigned nr_pages)
+{
+	int ret;
+	ret =  mpage_readpages(mapping, pages, nr_pages, exfat_get_block);
+	return ret;
+}
+
+static int exfat_writepage(struct page *page, struct writeback_control *wbc)
+{
+	int ret;
+	ret = block_write_full_page(page, exfat_get_block, wbc);
+	return ret;
+}
+
+static int exfat_writepages(struct address_space *mapping,
+						struct writeback_control *wbc)
+{
+	int ret;
+	ret = mpage_writepages(mapping, wbc, exfat_get_block);
+	return ret;
+}
+
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,34)
+static void exfat_write_failed(struct address_space *mapping, loff_t to)
+{
+	struct inode *inode = mapping->host;
+	if (to > i_size_read(inode)) {
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,12,0)
+		truncate_pagecache(inode, i_size_read(inode));
+#else
+		truncate_pagecache(inode, to, i_size_read(inode));
+#endif
+		EXFAT_I(inode)->fid.size = i_size_read(inode);
+		_exfat_truncate(inode, i_size_read(inode));
+	}
+}
+#endif
+
+static int exfat_write_begin(struct file *file, struct address_space *mapping,
+				 loff_t pos, unsigned len, unsigned flags,
+					 struct page **pagep, void **fsdata)
+{
+	int ret;
+	*pagep = NULL;
+	ret = cont_write_begin(file, mapping, pos, len, flags, pagep, fsdata,
+				   exfat_get_block,
+				   &EXFAT_I(mapping->host)->mmu_private);
+
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,34)
+	if (ret < 0)
+		exfat_write_failed(mapping, pos+len);
+#endif
+	return ret;
+}
+
+static int exfat_write_end(struct file *file, struct address_space *mapping,
+				   loff_t pos, unsigned len, unsigned copied,
+					   struct page *pagep, void *fsdata)
+{
+	struct inode *inode = mapping->host;
+	FILE_ID_T *fid = &(EXFAT_I(inode)->fid);
+	int err;
+
+	err = generic_write_end(file, mapping, pos, len, copied, pagep, fsdata);
+
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,34)
+	if (err < len)
+		exfat_write_failed(mapping, pos+len);
+#endif
+
+	if (!(err < 0) && !(fid->attr & ATTR_ARCHIVE)) {
+		inode->i_mtime = inode->i_ctime = current_time(inode);
+		fid->attr |= ATTR_ARCHIVE;
+		mark_inode_dirty(inode);
+	}
+	return err;
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)
+#ifdef CONFIG_AIO_OPTIMIZATION
+static ssize_t exfat_direct_IO(int rw, struct kiocb *iocb,
+						struct iov_iter *iter, loff_t offset)
+#else
+static ssize_t exfat_direct_IO(int rw, struct kiocb *iocb,
+					   const struct iovec *iov,
+					   loff_t offset, unsigned long nr_segs)
+#endif
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4,2,0)
+static ssize_t exfat_direct_IO(int rw, struct kiocb *iocb,
+					   struct iov_iter *iter, loff_t offset)
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4,7,0)
+static ssize_t exfat_direct_IO(struct kiocb *iocb,
+					   struct iov_iter *iter, loff_t offset)
+#else /* >= 4.7.x */
+static ssize_t exfat_direct_IO(struct kiocb *iocb, struct iov_iter *iter)
+#endif
+{
+	struct inode *inode = iocb->ki_filp->f_mapping->host;
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,34)
+	struct address_space *mapping = iocb->ki_filp->f_mapping;
+#endif
+	ssize_t ret;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,2,0)
+	int rw;
+
+	rw = iov_iter_rw(iter);
+#endif
+
+	if (rw == WRITE) {
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0)
+#ifdef CONFIG_AIO_OPTIMIZATION
+		if (EXFAT_I(inode)->mmu_private <
+					(offset + iov_iter_count(iter)))
+#else
+		if (EXFAT_I(inode)->mmu_private < (offset + iov_length(iov, nr_segs)))
+#endif
+#elif LINUX_VERSION_CODE < KERNEL_VERSION(4,7,0)
+		if (EXFAT_I(inode)->mmu_private < (offset + iov_iter_count(iter)))
+#else
+		if (EXFAT_I(inode)->mmu_private < iov_iter_count(iter))
+#endif
+			return 0;
+	}
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,7,0)
+	ret = blockdev_direct_IO(iocb, inode, iter, exfat_get_block);
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(4,1,0)
+	ret = blockdev_direct_IO(iocb, inode, iter,
+					offset, exfat_get_block);
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,16,0)
+	ret = blockdev_direct_IO(rw, iocb, inode, iter,
+					offset, exfat_get_block);
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,1,0)
+#ifdef CONFIG_AIO_OPTIMIZATION
+	ret = blockdev_direct_IO(rw, iocb, inode, iter,
+					offset, exfat_get_block);
+#else
+	ret = blockdev_direct_IO(rw, iocb, inode, iov,
+					offset, nr_segs, exfat_get_block);
+#endif
+#else
+        ret = blockdev_direct_IO(rw, iocb, inode, inode->i_sb->s_bdev, iov,
+					offset, nr_segs, exfat_get_block, NULL);
+#endif
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,7,0)
+	if ((ret < 0) && (rw & WRITE))
+		exfat_write_failed(mapping, iov_iter_count(iter));
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(3,16,0)
+	if ((ret < 0) && (rw & WRITE))
+		exfat_write_failed(mapping, offset+iov_iter_count(iter));
+#elif LINUX_VERSION_CODE > KERNEL_VERSION(2,6,34)
+	if ((ret < 0) && (rw & WRITE))
+#ifdef CONFIG_AIO_OPTIMIZATION
+		exfat_write_failed(mapping, offset+iov_iter_count(iter));
+#else
+		exfat_write_failed(mapping, offset+iov_length(iov, nr_segs));
+#endif
+#endif
+	return ret;
+}
+
+static sector_t _exfat_bmap(struct address_space *mapping, sector_t block)
+{
+	sector_t blocknr;
+
+	/* exfat_get_cluster() assumes the requested blocknr isn't truncated. */
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,4,00)
+	down_read(&EXFAT_I(mapping->host)->truncate_lock);
+	blocknr = generic_block_bmap(mapping, block, exfat_get_block);
+	up_read(&EXFAT_I(mapping->host)->truncate_lock);
+#else
+	down_read(&EXFAT_I(mapping->host)->i_alloc_sem);
+	blocknr = generic_block_bmap(mapping, block, exfat_get_block);
+	up_read(&EXFAT_I(mapping->host)->i_alloc_sem);
+#endif
+
+	return blocknr;
+}
+
+const struct address_space_operations exfat_aops = {
+	.readpage    = exfat_readpage,
+	.readpages   = exfat_readpages,
+	.writepage   = exfat_writepage,
+	.writepages  = exfat_writepages,
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,39)
+	.sync_page   = block_sync_page,
+#endif
+	.write_begin = exfat_write_begin,
+	.write_end   = exfat_write_end,
+	.direct_IO   = exfat_direct_IO,
+	.bmap        = _exfat_bmap
+};
+
+/*======================================================================*/
+/*  Super Operations                                                    */
+/*======================================================================*/
+
+static inline unsigned long exfat_hash(loff_t i_pos)
+{
+	return hash_32(i_pos, EXFAT_HASH_BITS);
+}
+
+static struct inode *exfat_iget(struct super_block *sb, loff_t i_pos)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	struct exfat_inode_info *info;
+	struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos);
+	struct inode *inode = NULL;
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0)
+	struct hlist_node *node;
+
+	spin_lock(&sbi->inode_hash_lock);
+	hlist_for_each_entry(info, node, head, i_hash_fat) {
+#else
+	spin_lock(&sbi->inode_hash_lock);
+	hlist_for_each_entry(info, head, i_hash_fat) {
+#endif
+		CHECK_ERR(info->vfs_inode.i_sb != sb);
+
+		if (i_pos != info->i_pos)
+			continue;
+		inode = igrab(&info->vfs_inode);
+		if (inode)
+			break;
+	}
+	spin_unlock(&sbi->inode_hash_lock);
+	return inode;
+}
+
+static void exfat_attach(struct inode *inode, loff_t i_pos)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb);
+	struct hlist_head *head = sbi->inode_hashtable + exfat_hash(i_pos);
+
+	spin_lock(&sbi->inode_hash_lock);
+	EXFAT_I(inode)->i_pos = i_pos;
+	hlist_add_head(&EXFAT_I(inode)->i_hash_fat, head);
+	spin_unlock(&sbi->inode_hash_lock);
+}
+
+static void exfat_detach(struct inode *inode)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb);
+
+	spin_lock(&sbi->inode_hash_lock);
+	hlist_del_init(&EXFAT_I(inode)->i_hash_fat);
+	EXFAT_I(inode)->i_pos = 0;
+	spin_unlock(&sbi->inode_hash_lock);
+}
+
+/* doesn't deal with root inode */
+static int exfat_fill_inode(struct inode *inode, FILE_ID_T *fid)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+	DIR_ENTRY_T info;
+
+	memcpy(&(EXFAT_I(inode)->fid), fid, sizeof(FILE_ID_T));
+
+	FsReadStat(inode, &info);
+
+	EXFAT_I(inode)->i_pos = 0;
+	EXFAT_I(inode)->target = NULL;
+	inode->i_uid = sbi->options.fs_uid;
+	inode->i_gid = sbi->options.fs_gid;
+	inode->i_version++;
+	inode->i_generation = get_seconds();
+
+	if (info.Attr & ATTR_SUBDIR) { /* directory */
+		inode->i_generation &= ~1;
+		inode->i_mode = exfat_make_mode(sbi, info.Attr, S_IRWXUGO);
+		inode->i_op = &exfat_dir_inode_operations;
+		inode->i_fop = &exfat_dir_operations;
+
+		i_size_write(inode, info.Size);
+		EXFAT_I(inode)->mmu_private = i_size_read(inode);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,00)
+		set_nlink(inode, info.NumSubdirs);
+#else
+		inode->i_nlink = info.NumSubdirs;
+#endif
+	} else if (info.Attr & ATTR_SYMLINK) { /* symbolic link */
+		inode->i_generation |= 1;
+		inode->i_mode = exfat_make_mode(sbi, info.Attr, S_IRWXUGO);
+		inode->i_op = &exfat_symlink_inode_operations;
+
+		i_size_write(inode, info.Size);
+		EXFAT_I(inode)->mmu_private = i_size_read(inode);
+	} else { /* regular file */
+		inode->i_generation |= 1;
+		inode->i_mode = exfat_make_mode(sbi, info.Attr, S_IRWXUGO);
+		inode->i_op = &exfat_file_inode_operations;
+		inode->i_fop = &exfat_file_operations;
+		inode->i_mapping->a_ops = &exfat_aops;
+		inode->i_mapping->nrpages = 0;
+
+		i_size_write(inode, info.Size);
+		EXFAT_I(inode)->mmu_private = i_size_read(inode);
+	}
+	exfat_save_attr(inode, info.Attr);
+
+	inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1))
+					   & ~((loff_t)p_fs->cluster_size - 1)) >> 9;
+
+	exfat_time_fat2unix(sbi, &inode->i_mtime, &info.ModifyTimestamp);
+	exfat_time_fat2unix(sbi, &inode->i_ctime, &info.CreateTimestamp);
+	exfat_time_fat2unix(sbi, &inode->i_atime, &info.AccessTimestamp);
+
+	return 0;
+}
+
+static struct inode *exfat_build_inode(struct super_block *sb,
+									   FILE_ID_T *fid, loff_t i_pos) {
+	struct inode *inode;
+	int err;
+
+	inode = exfat_iget(sb, i_pos);
+	if (inode)
+		goto out;
+	inode = new_inode(sb);
+	if (!inode) {
+		inode = ERR_PTR(-ENOMEM);
+		goto out;
+	}
+	inode->i_ino = iunique(sb, EXFAT_ROOT_INO);
+	inode->i_version = 1;
+	err = exfat_fill_inode(inode, fid);
+	if (err) {
+		iput(inode);
+		inode = ERR_PTR(err);
+		goto out;
+	}
+	exfat_attach(inode, i_pos);
+	insert_inode_hash(inode);
+out:
+	return inode;
+}
+
+static int exfat_sync_inode(struct inode *inode)
+{
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34)
+	return exfat_write_inode(inode, 0);
+#else
+	return exfat_write_inode(inode, NULL);
+#endif
+}
+
+static struct inode *exfat_alloc_inode(struct super_block *sb)
+{
+	struct exfat_inode_info *ei;
+
+	ei = kmem_cache_alloc(exfat_inode_cachep, GFP_NOFS);
+	if (!ei)
+		return NULL;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,4,00)
+	init_rwsem(&ei->truncate_lock);
+#endif
+
+	return &ei->vfs_inode;
+}
+
+static void exfat_destroy_inode(struct inode *inode)
+{
+	if (EXFAT_I(inode)->target)
+		kfree(EXFAT_I(inode)->target);
+	EXFAT_I(inode)->target = NULL;
+
+	kmem_cache_free(exfat_inode_cachep, EXFAT_I(inode));
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34)
+static int exfat_write_inode(struct inode *inode, int wait)
+#else
+static int exfat_write_inode(struct inode *inode, struct writeback_control *wbc)
+#endif
+{
+	struct super_block *sb = inode->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	DIR_ENTRY_T info;
+
+	if (inode->i_ino == EXFAT_ROOT_INO)
+		return 0;
+
+	info.Attr = exfat_make_attr(inode);
+	info.Size = i_size_read(inode);
+
+	exfat_time_unix2fat(sbi, &inode->i_mtime, &info.ModifyTimestamp);
+	exfat_time_unix2fat(sbi, &inode->i_ctime, &info.CreateTimestamp);
+	exfat_time_unix2fat(sbi, &inode->i_atime, &info.AccessTimestamp);
+
+	FsWriteStat(inode, &info);
+
+	return 0;
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+static void exfat_delete_inode(struct inode *inode)
+{
+	truncate_inode_pages(&inode->i_data, 0);
+	clear_inode(inode);
+}
+
+static void exfat_clear_inode(struct inode *inode)
+{
+	exfat_detach(inode);
+	remove_inode_hash(inode);
+}
+#else
+static void exfat_evict_inode(struct inode *inode)
+{
+	truncate_inode_pages(&inode->i_data, 0);
+
+	if (!inode->i_nlink)
+		i_size_write(inode, 0);
+	invalidate_inode_buffers(inode);
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,5,0)
+	end_writeback(inode);
+#else
+	clear_inode(inode);
+#endif
+	exfat_detach(inode);
+
+	remove_inode_hash(inode);
+}
+#endif
+
+static void exfat_free_super(struct exfat_sb_info *sbi)
+{
+	if (sbi->nls_disk)
+		unload_nls(sbi->nls_disk);
+	if (sbi->nls_io)
+		unload_nls(sbi->nls_io);
+	if (sbi->options.iocharset != exfat_default_iocharset)
+		kfree(sbi->options.iocharset);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)
+	/* mutex_init is in exfat_fill_super function. only for 3.7+ */
+	mutex_destroy(&sbi->s_lock);
+#endif
+	kfree(sbi);
+}
+
+static void exfat_put_super(struct super_block *sb)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	if (__is_sb_dirty(sb))
+		exfat_write_super(sb);
+
+	FsUmountVol(sb);
+
+	sb->s_fs_info = NULL;
+	exfat_free_super(sbi);
+}
+
+static void exfat_write_super(struct super_block *sb)
+{
+	__lock_super(sb);
+
+	__set_sb_clean(sb);
+
+	if (!(sb->s_flags & MS_RDONLY))
+		FsSyncVol(sb, 1);
+
+	__unlock_super(sb);
+}
+
+static int exfat_sync_fs(struct super_block *sb, int wait)
+{
+	int err = 0;
+
+	if (__is_sb_dirty(sb)) {
+		__lock_super(sb);
+		__set_sb_clean(sb);
+		err = FsSyncVol(sb, 1);
+		__unlock_super(sb);
+	}
+
+	return err;
+}
+
+static int exfat_statfs(struct dentry *dentry, struct kstatfs *buf)
+{
+	struct super_block *sb = dentry->d_sb;
+	u64 id = huge_encode_dev(sb->s_bdev->bd_dev);
+	FS_INFO_T *p_fs = &(EXFAT_SB(sb)->fs_info);
+	VOL_INFO_T info;
+
+	if (p_fs->used_clusters == (u32) ~0) {
+		if (FFS_MEDIAERR == FsGetVolInfo(sb, &info))
+			return -EIO;
+
+	} else {
+		info.FatType = p_fs->vol_type;
+		info.ClusterSize = p_fs->cluster_size;
+		info.NumClusters = p_fs->num_clusters - 2;
+		info.UsedClusters = p_fs->used_clusters;
+		info.FreeClusters = info.NumClusters - info.UsedClusters;
+
+		if (p_fs->dev_ejected)
+			printk("[EXFAT] statfs on device is ejected\n");
+	}
+
+	buf->f_type = sb->s_magic;
+	buf->f_bsize = info.ClusterSize;
+	buf->f_blocks = info.NumClusters;
+	buf->f_bfree = info.FreeClusters;
+	buf->f_bavail = info.FreeClusters;
+	buf->f_fsid.val[0] = (u32)id;
+	buf->f_fsid.val[1] = (u32)(id >> 32);
+	buf->f_namelen = 260;
+
+	return 0;
+}
+
+static int exfat_remount(struct super_block *sb, int *flags, char *data)
+{
+	*flags |= MS_NODIRATIME;
+	return 0;
+}
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,3,0)
+static int exfat_show_options(struct seq_file *m, struct dentry *root)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(root->d_sb);
+#else
+static int exfat_show_options(struct seq_file *m, struct vfsmount *mnt)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(mnt->mnt_sb);
+#endif
+	struct exfat_mount_options *opts = &sbi->options;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+	if (__kuid_val(opts->fs_uid))
+		seq_printf(m, ",uid=%u", __kuid_val(opts->fs_uid));
+	if (__kgid_val(opts->fs_gid))
+		seq_printf(m, ",gid=%u", __kgid_val(opts->fs_gid));
+#else
+	if (opts->fs_uid != 0)
+		seq_printf(m, ",uid=%u", opts->fs_uid);
+	if (opts->fs_gid != 0)
+		seq_printf(m, ",gid=%u", opts->fs_gid);
+#endif
+	seq_printf(m, ",fmask=%04o", opts->fs_fmask);
+	seq_printf(m, ",dmask=%04o", opts->fs_dmask);
+	if (opts->allow_utime)
+		seq_printf(m, ",allow_utime=%04o", opts->allow_utime);
+	if (sbi->nls_disk)
+		seq_printf(m, ",codepage=%s", sbi->nls_disk->charset);
+	if (sbi->nls_io)
+		seq_printf(m, ",iocharset=%s", sbi->nls_io->charset);
+	seq_printf(m, ",namecase=%u", opts->casesensitive);
+	if (opts->errors == EXFAT_ERRORS_CONT)
+		seq_puts(m, ",errors=continue");
+	else if (opts->errors == EXFAT_ERRORS_PANIC)
+		seq_puts(m, ",errors=panic");
+	else
+		seq_puts(m, ",errors=remount-ro");
+#ifdef CONFIG_EXFAT_DISCARD
+	if (opts->discard)
+		seq_printf(m, ",discard");
+#endif
+	return 0;
+}
+
+const struct super_operations exfat_sops = {
+	.alloc_inode   = exfat_alloc_inode,
+	.destroy_inode = exfat_destroy_inode,
+	.write_inode   = exfat_write_inode,
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)
+	.delete_inode  = exfat_delete_inode,
+	.clear_inode   = exfat_clear_inode,
+#else
+	.evict_inode  = exfat_evict_inode,
+#endif
+	.put_super     = exfat_put_super,
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0)
+	.write_super   = exfat_write_super,
+#endif
+	.sync_fs       = exfat_sync_fs,
+	.statfs        = exfat_statfs,
+	.remount_fs    = exfat_remount,
+	.show_options  = exfat_show_options,
+};
+
+/*======================================================================*/
+/*  Export Operations                                                   */
+/*======================================================================*/
+
+static struct inode *exfat_nfs_get_inode(struct super_block *sb,
+				       u64 ino, u32 generation)
+{
+	struct inode *inode = NULL;
+	if (ino < EXFAT_ROOT_INO)
+		return inode;
+	inode = ilookup(sb, ino);
+
+	if (inode && generation && (inode->i_generation != generation)) {
+		iput(inode);
+		inode = NULL;
+	}
+
+	return inode;
+}
+
+static struct dentry *exfat_fh_to_dentry(struct super_block *sb, struct fid *fid,
+				int fh_len, int fh_type)
+{
+	return generic_fh_to_dentry(sb, fid, fh_len, fh_type,
+				    exfat_nfs_get_inode);
+}
+
+static struct dentry *exfat_fh_to_parent(struct super_block *sb, struct fid *fid,
+				int fh_len, int fh_type)
+{
+	return generic_fh_to_parent(sb, fid, fh_len, fh_type,
+				    exfat_nfs_get_inode);
+}
+
+const struct export_operations exfat_export_ops = {
+	.fh_to_dentry   = exfat_fh_to_dentry,
+	.fh_to_parent   = exfat_fh_to_parent,
+};
+
+/*======================================================================*/
+/*  Super Block Read Operations                                         */
+/*======================================================================*/
+
+enum {
+	Opt_uid,
+	Opt_gid,
+	Opt_umask,
+	Opt_dmask,
+	Opt_fmask,
+	Opt_allow_utime,
+	Opt_codepage,
+	Opt_charset,
+	Opt_namecase,
+	Opt_debug,
+	Opt_err_cont,
+	Opt_err_panic,
+	Opt_err_ro,
+	Opt_utf8_hack,
+	Opt_err,
+#ifdef CONFIG_EXFAT_DISCARD
+	Opt_discard,
+#endif /* EXFAT_CONFIG_DISCARD */
+};
+
+static const match_table_t exfat_tokens = {
+	{Opt_uid, "uid=%u"},
+	{Opt_gid, "gid=%u"},
+	{Opt_umask, "umask=%o"},
+	{Opt_dmask, "dmask=%o"},
+	{Opt_fmask, "fmask=%o"},
+	{Opt_allow_utime, "allow_utime=%o"},
+	{Opt_codepage, "codepage=%u"},
+	{Opt_charset, "iocharset=%s"},
+	{Opt_namecase, "namecase=%u"},
+	{Opt_debug, "debug"},
+	{Opt_err_cont, "errors=continue"},
+	{Opt_err_panic, "errors=panic"},
+	{Opt_err_ro, "errors=remount-ro"},
+	{Opt_utf8_hack, "utf8"},
+#ifdef CONFIG_EXFAT_DISCARD
+	{Opt_discard, "discard"},
+#endif /* CONFIG_EXFAT_DISCARD */
+	{Opt_err, NULL}
+};
+
+static int parse_options(char *options, int silent, int *debug,
+						 struct exfat_mount_options *opts)
+{
+	char *p;
+	substring_t args[MAX_OPT_ARGS];
+	int option;
+	char *iocharset;
+
+	opts->fs_uid = current_uid();
+	opts->fs_gid = current_gid();
+	opts->fs_fmask = opts->fs_dmask = current->fs->umask;
+	opts->allow_utime = (unsigned short) -1;
+	opts->codepage = exfat_default_codepage;
+	opts->iocharset = exfat_default_iocharset;
+	opts->casesensitive = 0;
+	opts->errors = EXFAT_ERRORS_RO;
+#ifdef CONFIG_EXFAT_DISCARD
+	opts->discard = 0;
+#endif
+	*debug = 0;
+
+	if (!options)
+		goto out;
+
+	while ((p = strsep(&options, ",")) != NULL) {
+		int token;
+		if (!*p)
+			continue;
+
+		token = match_token(p, exfat_tokens, args);
+		switch (token) {
+		case Opt_uid:
+			if (match_int(&args[0], &option))
+				return 0;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+			opts->fs_uid = KUIDT_INIT(option);
+#else
+			opts->fs_uid = option;
+#endif
+			break;
+		case Opt_gid:
+			if (match_int(&args[0], &option))
+				return 0;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+			opts->fs_gid = KGIDT_INIT(option);
+#else
+			opts->fs_gid = option;
+#endif
+			break;
+		case Opt_umask:
+		case Opt_dmask:
+		case Opt_fmask:
+			if (match_octal(&args[0], &option))
+				return 0;
+			if (token != Opt_dmask)
+				opts->fs_fmask = option;
+			if (token != Opt_fmask)
+				opts->fs_dmask = option;
+			break;
+		case Opt_allow_utime:
+			if (match_octal(&args[0], &option))
+				return 0;
+			opts->allow_utime = option & (S_IWGRP | S_IWOTH);
+			break;
+		case Opt_codepage:
+			if (match_int(&args[0], &option))
+				return 0;
+			opts->codepage = option;
+			break;
+		case Opt_charset:
+			if (opts->iocharset != exfat_default_iocharset)
+				kfree(opts->iocharset);
+			iocharset = match_strdup(&args[0]);
+			if (!iocharset)
+				return -ENOMEM;
+			opts->iocharset = iocharset;
+			break;
+		case Opt_namecase:
+			if (match_int(&args[0], &option))
+				return 0;
+			opts->casesensitive = option;
+			break;
+		case Opt_err_cont:
+			opts->errors = EXFAT_ERRORS_CONT;
+			break;
+		case Opt_err_panic:
+			opts->errors = EXFAT_ERRORS_PANIC;
+			break;
+		case Opt_err_ro:
+			opts->errors = EXFAT_ERRORS_RO;
+			break;
+		case Opt_debug:
+			*debug = 1;
+			break;
+#ifdef CONFIG_EXFAT_DISCARD
+		case Opt_discard:
+			opts->discard = 1;
+			break;
+#endif /* CONFIG_EXFAT_DISCARD */
+		case Opt_utf8_hack:
+			break;
+		default:
+			if (!silent)
+				printk(KERN_ERR "[EXFAT] Unrecognized mount option %s or missing value\n", p);
+			return -EINVAL;
+		}
+	}
+
+out:
+	if (opts->allow_utime == (unsigned short) -1)
+		opts->allow_utime = ~opts->fs_dmask & (S_IWGRP | S_IWOTH);
+
+	return 0;
+}
+
+static void exfat_hash_init(struct super_block *sb)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	int i;
+
+	spin_lock_init(&sbi->inode_hash_lock);
+	for (i = 0; i < EXFAT_HASH_SIZE; i++)
+		INIT_HLIST_HEAD(&sbi->inode_hashtable[i]);
+}
+
+static int exfat_read_root(struct inode *inode)
+{
+	struct super_block *sb = inode->i_sb;
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	FS_INFO_T *p_fs = &(sbi->fs_info);
+	DIR_ENTRY_T info;
+
+	EXFAT_I(inode)->fid.dir.dir = p_fs->root_dir;
+	EXFAT_I(inode)->fid.dir.flags = 0x01;
+	EXFAT_I(inode)->fid.entry = -1;
+	EXFAT_I(inode)->fid.start_clu = p_fs->root_dir;
+	EXFAT_I(inode)->fid.flags = 0x01;
+	EXFAT_I(inode)->fid.type = TYPE_DIR;
+	EXFAT_I(inode)->fid.rwoffset = 0;
+	EXFAT_I(inode)->fid.hint_last_off = -1;
+
+	EXFAT_I(inode)->target = NULL;
+
+	FsReadStat(inode, &info);
+
+	inode->i_uid = sbi->options.fs_uid;
+	inode->i_gid = sbi->options.fs_gid;
+	inode->i_version++;
+	inode->i_generation = 0;
+	inode->i_mode = exfat_make_mode(sbi, ATTR_SUBDIR, S_IRWXUGO);
+	inode->i_op = &exfat_dir_inode_operations;
+	inode->i_fop = &exfat_dir_operations;
+
+	i_size_write(inode, info.Size);
+	inode->i_blocks = ((i_size_read(inode) + (p_fs->cluster_size - 1))
+					   & ~((loff_t)p_fs->cluster_size - 1)) >> 9;
+	EXFAT_I(inode)->i_pos = ((loff_t) p_fs->root_dir << 32) | 0xffffffff;
+	EXFAT_I(inode)->mmu_private = i_size_read(inode);
+
+	exfat_save_attr(inode, ATTR_SUBDIR);
+	inode->i_mtime = inode->i_atime = inode->i_ctime = current_time(inode);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,2,00)
+	set_nlink(inode, info.NumSubdirs + 2);
+#else
+	inode->i_nlink = info.NumSubdirs + 2;
+#endif
+
+	return 0;
+}
+
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,37)
+static void setup_dops(struct super_block *sb)
+{
+	if (EXFAT_SB(sb)->options.casesensitive == 0)
+		sb->s_d_op = &exfat_ci_dentry_ops;
+	else
+		sb->s_d_op = &exfat_dentry_ops;
+}
+#endif
+
+static int exfat_fill_super(struct super_block *sb, void *data, int silent)
+{
+	struct inode *root_inode = NULL;
+	struct exfat_sb_info *sbi;
+	int debug, ret;
+	long error;
+	char buf[50];
+
+	/*
+	 * GFP_KERNEL is ok here, because while we do hold the
+	 * supeblock lock, memory pressure can't call back into
+	 * the filesystem, since we're only just about to mount
+	 * it and have no inodes etc active!
+	 */
+	sbi = kzalloc(sizeof(struct exfat_sb_info), GFP_KERNEL);
+	if (!sbi)
+		return -ENOMEM;
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,0)
+	mutex_init(&sbi->s_lock);
+#endif
+	sb->s_fs_info = sbi;
+	sb->s_flags |= MS_NODIRATIME;
+	sb->s_magic = EXFAT_SUPER_MAGIC;
+	sb->s_op = &exfat_sops;
+	sb->s_export_op = &exfat_export_ops;
+
+	error = parse_options(data, silent, &debug, &sbi->options);
+	if (error)
+		goto out_fail;
+
+#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,37)
+	setup_dops(sb);
+#endif
+
+	error = -EIO;
+	sb_min_blocksize(sb, 512);
+	sb->s_maxbytes = 0x7fffffffffffffffLL;    /* maximum file size */
+
+	ret = FsMountVol(sb);
+	if (ret) {
+		if (!silent)
+			printk(KERN_ERR "[EXFAT] FsMountVol failed\n");
+
+		goto out_fail;
+	}
+
+	/* set up enough so that it can read an inode */
+	exfat_hash_init(sb);
+
+	/*
+	 * The low byte of FAT's first entry must have same value with
+	 * media-field.  But in real world, too many devices is
+	 * writing wrong value.  So, removed that validity check.
+	 *
+	 * if (FAT_FIRST_ENT(sb, media) != first)
+	 */
+
+	/* codepage is not meaningful in exfat */
+	if (sbi->fs_info.vol_type != EXFAT) {
+		error = -EINVAL;
+		sprintf(buf, "cp%d", sbi->options.codepage);
+		sbi->nls_disk = load_nls(buf);
+		if (!sbi->nls_disk) {
+			printk(KERN_ERR "[EXFAT] Codepage %s not found\n", buf);
+			goto out_fail2;
+		}
+	}
+
+	sbi->nls_io = load_nls(sbi->options.iocharset);
+
+	error = -ENOMEM;
+	root_inode = new_inode(sb);
+	if (!root_inode)
+		goto out_fail2;
+	root_inode->i_ino = EXFAT_ROOT_INO;
+	root_inode->i_version = 1;
+	error = exfat_read_root(root_inode);
+	if (error < 0)
+		goto out_fail2;
+	error = -ENOMEM;
+	exfat_attach(root_inode, EXFAT_I(root_inode)->i_pos);
+	insert_inode_hash(root_inode);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,4,00)
+	sb->s_root = d_make_root(root_inode);
+#else
+	sb->s_root = d_alloc_root(root_inode);
+#endif
+	if (!sb->s_root) {
+		printk(KERN_ERR "[EXFAT] Getting the root inode failed\n");
+		goto out_fail2;
+	}
+
+	return 0;
+
+out_fail2:
+	FsUmountVol(sb);
+out_fail:
+	if (root_inode)
+		iput(root_inode);
+	sb->s_fs_info = NULL;
+	exfat_free_super(sbi);
+	return error;
+}
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
+static int exfat_get_sb(struct file_system_type *fs_type,
+						int flags, const char *dev_name,
+						void *data, struct vfsmount *mnt)
+{
+	return get_sb_bdev(fs_type, flags, dev_name, data, exfat_fill_super, mnt);
+}
+#else
+static struct dentry *exfat_fs_mount(struct file_system_type *fs_type,
+									 int flags, const char *dev_name,
+									 void *data) {
+	return mount_bdev(fs_type, flags, dev_name, data, exfat_fill_super);
+}
+#endif
+
+static void init_once(void *foo)
+{
+	struct exfat_inode_info *ei = (struct exfat_inode_info *)foo;
+
+	INIT_HLIST_NODE(&ei->i_hash_fat);
+	inode_init_once(&ei->vfs_inode);
+}
+
+static int __init exfat_init_inodecache(void)
+{
+	exfat_inode_cachep = kmem_cache_create("exfat_inode_cache",
+										   sizeof(struct exfat_inode_info),
+										   0, (SLAB_RECLAIM_ACCOUNT|
+												   SLAB_MEM_SPREAD),
+										   init_once);
+	if (exfat_inode_cachep == NULL)
+		return -ENOMEM;
+	return 0;
+}
+
+static void __exit exfat_destroy_inodecache(void)
+{
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,6,0)
+	/*
+	 * Make sure all delayed rcu free inodes are flushed before we
+	 * destroy cache.
+	 */
+	rcu_barrier();
+#endif
+	kmem_cache_destroy(exfat_inode_cachep);
+}
+
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+static void exfat_debug_kill_sb(struct super_block *sb)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(sb);
+	struct block_device *bdev = sb->s_bdev;
+
+	long flags;
+
+	if (sbi) {
+		flags = sbi->debug_flags;
+
+		if (flags & EXFAT_DEBUGFLAGS_INVALID_UMOUNT) {
+			/* invalidate_bdev drops all device cache include dirty.
+			   we use this to simulate device removal */
+			FsReleaseCache(sb);
+			invalidate_bdev(bdev);
+		}
+	}
+
+	kill_block_super(sb);
+}
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+
+static struct file_system_type exfat_fs_type = {
+	.owner       = THIS_MODULE,
+#if defined(CONFIG_MACH_LGE) || defined(CONFIG_HTC_BATT_CORE)
+	.name        = "texfat",
+#else
+	.name        = "exfat",
+#endif
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,37)
+	.get_sb      = exfat_get_sb,
+#else
+	.mount       = exfat_fs_mount,
+#endif
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	.kill_sb    = exfat_debug_kill_sb,
+#else
+	.kill_sb    = kill_block_super,
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+	.fs_flags    = FS_REQUIRES_DEV,
+};
+
+static int __init init_exfat(void)
+{
+	int err;
+
+	err = FsInit();
+	if (err) {
+		if (err == FFS_MEMORYERR)
+			return -ENOMEM;
+		else
+			return -EIO;
+	}
+
+	printk(KERN_INFO "exFAT: Version %s\n", EXFAT_VERSION);
+
+	err = exfat_init_inodecache();
+	if (err)
+		goto out;
+
+	err = register_filesystem(&exfat_fs_type);
+	if (err)
+		goto out;
+
+	return 0;
+out:
+	FsShutdown();
+	return err;
+}
+
+static void __exit exit_exfat(void)
+{
+	exfat_destroy_inodecache();
+	unregister_filesystem(&exfat_fs_type);
+	FsShutdown();
+}
+
+module_init(init_exfat);
+module_exit(exit_exfat);
+
+MODULE_LICENSE("GPL");
+MODULE_DESCRIPTION("exFAT Filesystem Driver");
+#ifdef MODULE_ALIAS_FS
+#if defined(CONFIG_MACH_LGE) || defined(CONFIG_HTC_BATT_CORE)
+MODULE_ALIAS_FS("texfat");
+#else
+MODULE_ALIAS_FS("exfat");
+#endif
+#endif
diff --git a/fs/exfat/exfat_super.h b/fs/exfat/exfat_super.h
new file mode 100644
index 0000000000000000000000000000000000000000..916811e3d31e24f8418ec1a08296db8d4e7574cc
--- /dev/null
+++ b/fs/exfat/exfat_super.h
@@ -0,0 +1,171 @@
+/* Some of the source code in this file came from "linux/fs/fat/fat.h".  */
+
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+#ifndef _EXFAT_LINUX_H
+#define _EXFAT_LINUX_H
+
+#include <linux/buffer_head.h>
+#include <linux/string.h>
+#include <linux/nls.h>
+#include <linux/fs.h>
+#include <linux/mutex.h>
+#include <linux/swap.h>
+
+#include "exfat_config.h"
+#include "exfat_data.h"
+#include "exfat_oal.h"
+
+#include "exfat_blkdev.h"
+#include "exfat_cache.h"
+#include "exfat_nls.h"
+#include "exfat_api.h"
+#include "exfat_core.h"
+
+#define EXFAT_ERRORS_CONT  1    /* ignore error and continue */
+#define EXFAT_ERRORS_PANIC 2    /* panic on error */
+#define EXFAT_ERRORS_RO    3    /* remount r/o on error */
+
+/* ioctl command */
+#define EXFAT_IOCTL_GET_VOLUME_ID _IOR('r', 0x12, __u32)
+
+struct exfat_mount_options {
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0)
+	kuid_t fs_uid;
+	kgid_t fs_gid;
+#else
+	uid_t fs_uid;
+	gid_t fs_gid;
+#endif
+	unsigned short fs_fmask;
+	unsigned short fs_dmask;
+	unsigned short allow_utime; /* permission for setting the [am]time */
+	unsigned short codepage;    /* codepage for shortname conversions */
+	char *iocharset;            /* charset for filename input/display */
+	unsigned char casesensitive;
+	unsigned char errors;       /* on error: continue, panic, remount-ro */
+#ifdef CONFIG_EXFAT_DISCARD
+	unsigned char discard;      /* flag on if -o dicard specified and device support discard() */
+#endif /* CONFIG_EXFAT_DISCARD */
+};
+
+#define EXFAT_HASH_BITS    8
+#define EXFAT_HASH_SIZE    (1UL << EXFAT_HASH_BITS)
+
+/*
+ * EXFAT file system in-core superblock data
+ */
+struct exfat_sb_info {
+	FS_INFO_T fs_info;
+	BD_INFO_T bd_info;
+
+	struct exfat_mount_options options;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,7,00)
+	int s_dirt;
+	struct mutex s_lock;
+#endif
+	struct nls_table *nls_disk; /* Codepage used on disk */
+	struct nls_table *nls_io;   /* Charset used for input and display */
+
+	struct inode *fat_inode;
+
+	spinlock_t inode_hash_lock;
+	struct hlist_head inode_hashtable[EXFAT_HASH_SIZE];
+#ifdef CONFIG_EXFAT_KERNEL_DEBUG
+	long debug_flags;
+#endif /* CONFIG_EXFAT_KERNEL_DEBUG */
+};
+
+/*
+ * EXFAT file system inode data in memory
+ */
+struct exfat_inode_info {
+	FILE_ID_T fid;
+	char  *target;
+	/* NOTE: mmu_private is 64bits, so must hold ->i_mutex to access */
+	loff_t mmu_private;         /* physically allocated size */
+	loff_t i_pos;               /* on-disk position of directory entry or 0 */
+	struct hlist_node i_hash_fat;	/* hash by i_location */
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,4,00)
+	struct rw_semaphore truncate_lock;
+#endif
+	struct inode vfs_inode;
+	struct rw_semaphore i_alloc_sem; /* protect bmap against truncate */
+};
+
+#define EXFAT_SB(sb)		((struct exfat_sb_info *)((sb)->s_fs_info))
+
+static inline struct exfat_inode_info *EXFAT_I(struct inode *inode)
+{
+	return container_of(inode, struct exfat_inode_info, vfs_inode);
+}
+
+/*
+ * If ->i_mode can't hold S_IWUGO (i.e. ATTR_RO), we use ->i_attrs to
+ * save ATTR_RO instead of ->i_mode.
+ *
+ * If it's directory and !sbi->options.rodir, ATTR_RO isn't read-only
+ * bit, it's just used as flag for app.
+ */
+static inline int exfat_mode_can_hold_ro(struct inode *inode)
+{
+	struct exfat_sb_info *sbi = EXFAT_SB(inode->i_sb);
+
+	if (S_ISDIR(inode->i_mode))
+		return 0;
+
+	if ((~sbi->options.fs_fmask) & S_IWUGO)
+		return 1;
+	return 0;
+}
+
+/* Convert attribute bits and a mask to the UNIX mode. */
+static inline mode_t exfat_make_mode(struct exfat_sb_info *sbi,
+									 u32 attr, mode_t mode)
+{
+	if ((attr & ATTR_READONLY) && !(attr & ATTR_SUBDIR))
+		mode &= ~S_IWUGO;
+
+	if (attr & ATTR_SUBDIR)
+		return (mode & ~sbi->options.fs_dmask) | S_IFDIR;
+	else if (attr & ATTR_SYMLINK)
+		return (mode & ~sbi->options.fs_dmask) | S_IFLNK;
+	else
+		return (mode & ~sbi->options.fs_fmask) | S_IFREG;
+}
+
+/* Return the FAT attribute byte for this inode */
+static inline u32 exfat_make_attr(struct inode *inode)
+{
+	if (exfat_mode_can_hold_ro(inode) && !(inode->i_mode & S_IWUGO))
+		return (EXFAT_I(inode)->fid.attr) | ATTR_READONLY;
+	else
+		return EXFAT_I(inode)->fid.attr;
+}
+
+static inline void exfat_save_attr(struct inode *inode, u32 attr)
+{
+	if (exfat_mode_can_hold_ro(inode))
+		EXFAT_I(inode)->fid.attr = attr & ATTR_RWMASK;
+	else
+		EXFAT_I(inode)->fid.attr = attr & (ATTR_RWMASK | ATTR_READONLY);
+}
+
+#endif /* _EXFAT_LINUX_H */
diff --git a/fs/exfat/exfat_upcase.c b/fs/exfat/exfat_upcase.c
new file mode 100644
index 0000000000000000000000000000000000000000..3807f37caacb5a56a3754e7484cc41927264a220
--- /dev/null
+++ b/fs/exfat/exfat_upcase.c
@@ -0,0 +1,405 @@
+/*
+ *  Copyright (C) 2012-2013 Samsung Electronics Co., Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the Free Software
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ */
+
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_upcase.c                                            */
+/*  PURPOSE : exFAT Up-case Table                                       */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY (Ver 0.9)                                          */
+/*                                                                      */
+/*  - 2010.11.15 [Joosun Hahn] : first writing                          */
+/*                                                                      */
+/************************************************************************/
+
+#include "exfat_config.h"
+
+#include "exfat_nls.h"
+
+const u8 uni_upcase[NUM_UPCASE<<1] = {
+	0x00, 0x00, 0x01, 0x00, 0x02, 0x00, 0x03, 0x00, 0x04, 0x00, 0x05, 0x00, 0x06, 0x00, 0x07, 0x00,
+	0x08, 0x00, 0x09, 0x00, 0x0A, 0x00, 0x0B, 0x00, 0x0C, 0x00, 0x0D, 0x00, 0x0E, 0x00, 0x0F, 0x00,
+	0x10, 0x00, 0x11, 0x00, 0x12, 0x00, 0x13, 0x00, 0x14, 0x00, 0x15, 0x00, 0x16, 0x00, 0x17, 0x00,
+	0x18, 0x00, 0x19, 0x00, 0x1A, 0x00, 0x1B, 0x00, 0x1C, 0x00, 0x1D, 0x00, 0x1E, 0x00, 0x1F, 0x00,
+	0x20, 0x00, 0x21, 0x00, 0x22, 0x00, 0x23, 0x00, 0x24, 0x00, 0x25, 0x00, 0x26, 0x00, 0x27, 0x00,
+	0x28, 0x00, 0x29, 0x00, 0x2A, 0x00, 0x2B, 0x00, 0x2C, 0x00, 0x2D, 0x00, 0x2E, 0x00, 0x2F, 0x00,
+	0x30, 0x00, 0x31, 0x00, 0x32, 0x00, 0x33, 0x00, 0x34, 0x00, 0x35, 0x00, 0x36, 0x00, 0x37, 0x00,
+	0x38, 0x00, 0x39, 0x00, 0x3A, 0x00, 0x3B, 0x00, 0x3C, 0x00, 0x3D, 0x00, 0x3E, 0x00, 0x3F, 0x00,
+	0x40, 0x00, 0x41, 0x00, 0x42, 0x00, 0x43, 0x00, 0x44, 0x00, 0x45, 0x00, 0x46, 0x00, 0x47, 0x00,
+	0x48, 0x00, 0x49, 0x00, 0x4A, 0x00, 0x4B, 0x00, 0x4C, 0x00, 0x4D, 0x00, 0x4E, 0x00, 0x4F, 0x00,
+	0x50, 0x00, 0x51, 0x00, 0x52, 0x00, 0x53, 0x00, 0x54, 0x00, 0x55, 0x00, 0x56, 0x00, 0x57, 0x00,
+	0x58, 0x00, 0x59, 0x00, 0x5A, 0x00, 0x5B, 0x00, 0x5C, 0x00, 0x5D, 0x00, 0x5E, 0x00, 0x5F, 0x00,
+	0x60, 0x00, 0x41, 0x00, 0x42, 0x00, 0x43, 0x00, 0x44, 0x00, 0x45, 0x00, 0x46, 0x00, 0x47, 0x00,
+	0x48, 0x00, 0x49, 0x00, 0x4A, 0x00, 0x4B, 0x00, 0x4C, 0x00, 0x4D, 0x00, 0x4E, 0x00, 0x4F, 0x00,
+	0x50, 0x00, 0x51, 0x00, 0x52, 0x00, 0x53, 0x00, 0x54, 0x00, 0x55, 0x00, 0x56, 0x00, 0x57, 0x00,
+	0x58, 0x00, 0x59, 0x00, 0x5A, 0x00, 0x7B, 0x00, 0x7C, 0x00, 0x7D, 0x00, 0x7E, 0x00, 0x7F, 0x00,
+	0x80, 0x00, 0x81, 0x00, 0x82, 0x00, 0x83, 0x00, 0x84, 0x00, 0x85, 0x00, 0x86, 0x00, 0x87, 0x00,
+	0x88, 0x00, 0x89, 0x00, 0x8A, 0x00, 0x8B, 0x00, 0x8C, 0x00, 0x8D, 0x00, 0x8E, 0x00, 0x8F, 0x00,
+	0x90, 0x00, 0x91, 0x00, 0x92, 0x00, 0x93, 0x00, 0x94, 0x00, 0x95, 0x00, 0x96, 0x00, 0x97, 0x00,
+	0x98, 0x00, 0x99, 0x00, 0x9A, 0x00, 0x9B, 0x00, 0x9C, 0x00, 0x9D, 0x00, 0x9E, 0x00, 0x9F, 0x00,
+	0xA0, 0x00, 0xA1, 0x00, 0xA2, 0x00, 0xA3, 0x00, 0xA4, 0x00, 0xA5, 0x00, 0xA6, 0x00, 0xA7, 0x00,
+	0xA8, 0x00, 0xA9, 0x00, 0xAA, 0x00, 0xAB, 0x00, 0xAC, 0x00, 0xAD, 0x00, 0xAE, 0x00, 0xAF, 0x00,
+	0xB0, 0x00, 0xB1, 0x00, 0xB2, 0x00, 0xB3, 0x00, 0xB4, 0x00, 0xB5, 0x00, 0xB6, 0x00, 0xB7, 0x00,
+	0xB8, 0x00, 0xB9, 0x00, 0xBA, 0x00, 0xBB, 0x00, 0xBC, 0x00, 0xBD, 0x00, 0xBE, 0x00, 0xBF, 0x00,
+	0xC0, 0x00, 0xC1, 0x00, 0xC2, 0x00, 0xC3, 0x00, 0xC4, 0x00, 0xC5, 0x00, 0xC6, 0x00, 0xC7, 0x00,
+	0xC8, 0x00, 0xC9, 0x00, 0xCA, 0x00, 0xCB, 0x00, 0xCC, 0x00, 0xCD, 0x00, 0xCE, 0x00, 0xCF, 0x00,
+	0xD0, 0x00, 0xD1, 0x00, 0xD2, 0x00, 0xD3, 0x00, 0xD4, 0x00, 0xD5, 0x00, 0xD6, 0x00, 0xD7, 0x00,
+	0xD8, 0x00, 0xD9, 0x00, 0xDA, 0x00, 0xDB, 0x00, 0xDC, 0x00, 0xDD, 0x00, 0xDE, 0x00, 0xDF, 0x00,
+	0xC0, 0x00, 0xC1, 0x00, 0xC2, 0x00, 0xC3, 0x00, 0xC4, 0x00, 0xC5, 0x00, 0xC6, 0x00, 0xC7, 0x00,
+	0xC8, 0x00, 0xC9, 0x00, 0xCA, 0x00, 0xCB, 0x00, 0xCC, 0x00, 0xCD, 0x00, 0xCE, 0x00, 0xCF, 0x00,
+	0xD0, 0x00, 0xD1, 0x00, 0xD2, 0x00, 0xD3, 0x00, 0xD4, 0x00, 0xD5, 0x00, 0xD6, 0x00, 0xF7, 0x00,
+	0xD8, 0x00, 0xD9, 0x00, 0xDA, 0x00, 0xDB, 0x00, 0xDC, 0x00, 0xDD, 0x00, 0xDE, 0x00, 0x78, 0x01,
+	0x00, 0x01, 0x00, 0x01, 0x02, 0x01, 0x02, 0x01, 0x04, 0x01, 0x04, 0x01, 0x06, 0x01, 0x06, 0x01,
+	0x08, 0x01, 0x08, 0x01, 0x0A, 0x01, 0x0A, 0x01, 0x0C, 0x01, 0x0C, 0x01, 0x0E, 0x01, 0x0E, 0x01,
+	0x10, 0x01, 0x10, 0x01, 0x12, 0x01, 0x12, 0x01, 0x14, 0x01, 0x14, 0x01, 0x16, 0x01, 0x16, 0x01,
+	0x18, 0x01, 0x18, 0x01, 0x1A, 0x01, 0x1A, 0x01, 0x1C, 0x01, 0x1C, 0x01, 0x1E, 0x01, 0x1E, 0x01,
+	0x20, 0x01, 0x20, 0x01, 0x22, 0x01, 0x22, 0x01, 0x24, 0x01, 0x24, 0x01, 0x26, 0x01, 0x26, 0x01,
+	0x28, 0x01, 0x28, 0x01, 0x2A, 0x01, 0x2A, 0x01, 0x2C, 0x01, 0x2C, 0x01, 0x2E, 0x01, 0x2E, 0x01,
+	0x30, 0x01, 0x31, 0x01, 0x32, 0x01, 0x32, 0x01, 0x34, 0x01, 0x34, 0x01, 0x36, 0x01, 0x36, 0x01,
+	0x38, 0x01, 0x39, 0x01, 0x39, 0x01, 0x3B, 0x01, 0x3B, 0x01, 0x3D, 0x01, 0x3D, 0x01, 0x3F, 0x01,
+	0x3F, 0x01, 0x41, 0x01, 0x41, 0x01, 0x43, 0x01, 0x43, 0x01, 0x45, 0x01, 0x45, 0x01, 0x47, 0x01,
+	0x47, 0x01, 0x49, 0x01, 0x4A, 0x01, 0x4A, 0x01, 0x4C, 0x01, 0x4C, 0x01, 0x4E, 0x01, 0x4E, 0x01,
+	0x50, 0x01, 0x50, 0x01, 0x52, 0x01, 0x52, 0x01, 0x54, 0x01, 0x54, 0x01, 0x56, 0x01, 0x56, 0x01,
+	0x58, 0x01, 0x58, 0x01, 0x5A, 0x01, 0x5A, 0x01, 0x5C, 0x01, 0x5C, 0x01, 0x5E, 0x01, 0x5E, 0x01,
+	0x60, 0x01, 0x60, 0x01, 0x62, 0x01, 0x62, 0x01, 0x64, 0x01, 0x64, 0x01, 0x66, 0x01, 0x66, 0x01,
+	0x68, 0x01, 0x68, 0x01, 0x6A, 0x01, 0x6A, 0x01, 0x6C, 0x01, 0x6C, 0x01, 0x6E, 0x01, 0x6E, 0x01,
+	0x70, 0x01, 0x70, 0x01, 0x72, 0x01, 0x72, 0x01, 0x74, 0x01, 0x74, 0x01, 0x76, 0x01, 0x76, 0x01,
+	0x78, 0x01, 0x79, 0x01, 0x79, 0x01, 0x7B, 0x01, 0x7B, 0x01, 0x7D, 0x01, 0x7D, 0x01, 0x7F, 0x01,
+	0x43, 0x02, 0x81, 0x01, 0x82, 0x01, 0x82, 0x01, 0x84, 0x01, 0x84, 0x01, 0x86, 0x01, 0x87, 0x01,
+	0x87, 0x01, 0x89, 0x01, 0x8A, 0x01, 0x8B, 0x01, 0x8B, 0x01, 0x8D, 0x01, 0x8E, 0x01, 0x8F, 0x01,
+	0x90, 0x01, 0x91, 0x01, 0x91, 0x01, 0x93, 0x01, 0x94, 0x01, 0xF6, 0x01, 0x96, 0x01, 0x97, 0x01,
+	0x98, 0x01, 0x98, 0x01, 0x3D, 0x02, 0x9B, 0x01, 0x9C, 0x01, 0x9D, 0x01, 0x20, 0x02, 0x9F, 0x01,
+	0xA0, 0x01, 0xA0, 0x01, 0xA2, 0x01, 0xA2, 0x01, 0xA4, 0x01, 0xA4, 0x01, 0xA6, 0x01, 0xA7, 0x01,
+	0xA7, 0x01, 0xA9, 0x01, 0xAA, 0x01, 0xAB, 0x01, 0xAC, 0x01, 0xAC, 0x01, 0xAE, 0x01, 0xAF, 0x01,
+	0xAF, 0x01, 0xB1, 0x01, 0xB2, 0x01, 0xB3, 0x01, 0xB3, 0x01, 0xB5, 0x01, 0xB5, 0x01, 0xB7, 0x01,
+	0xB8, 0x01, 0xB8, 0x01, 0xBA, 0x01, 0xBB, 0x01, 0xBC, 0x01, 0xBC, 0x01, 0xBE, 0x01, 0xF7, 0x01,
+	0xC0, 0x01, 0xC1, 0x01, 0xC2, 0x01, 0xC3, 0x01, 0xC4, 0x01, 0xC5, 0x01, 0xC4, 0x01, 0xC7, 0x01,
+	0xC8, 0x01, 0xC7, 0x01, 0xCA, 0x01, 0xCB, 0x01, 0xCA, 0x01, 0xCD, 0x01, 0xCD, 0x01, 0xCF, 0x01,
+	0xCF, 0x01, 0xD1, 0x01, 0xD1, 0x01, 0xD3, 0x01, 0xD3, 0x01, 0xD5, 0x01, 0xD5, 0x01, 0xD7, 0x01,
+	0xD7, 0x01, 0xD9, 0x01, 0xD9, 0x01, 0xDB, 0x01, 0xDB, 0x01, 0x8E, 0x01, 0xDE, 0x01, 0xDE, 0x01,
+	0xE0, 0x01, 0xE0, 0x01, 0xE2, 0x01, 0xE2, 0x01, 0xE4, 0x01, 0xE4, 0x01, 0xE6, 0x01, 0xE6, 0x01,
+	0xE8, 0x01, 0xE8, 0x01, 0xEA, 0x01, 0xEA, 0x01, 0xEC, 0x01, 0xEC, 0x01, 0xEE, 0x01, 0xEE, 0x01,
+	0xF0, 0x01, 0xF1, 0x01, 0xF2, 0x01, 0xF1, 0x01, 0xF4, 0x01, 0xF4, 0x01, 0xF6, 0x01, 0xF7, 0x01,
+	0xF8, 0x01, 0xF8, 0x01, 0xFA, 0x01, 0xFA, 0x01, 0xFC, 0x01, 0xFC, 0x01, 0xFE, 0x01, 0xFE, 0x01,
+	0x00, 0x02, 0x00, 0x02, 0x02, 0x02, 0x02, 0x02, 0x04, 0x02, 0x04, 0x02, 0x06, 0x02, 0x06, 0x02,
+	0x08, 0x02, 0x08, 0x02, 0x0A, 0x02, 0x0A, 0x02, 0x0C, 0x02, 0x0C, 0x02, 0x0E, 0x02, 0x0E, 0x02,
+	0x10, 0x02, 0x10, 0x02, 0x12, 0x02, 0x12, 0x02, 0x14, 0x02, 0x14, 0x02, 0x16, 0x02, 0x16, 0x02,
+	0x18, 0x02, 0x18, 0x02, 0x1A, 0x02, 0x1A, 0x02, 0x1C, 0x02, 0x1C, 0x02, 0x1E, 0x02, 0x1E, 0x02,
+	0x20, 0x02, 0x21, 0x02, 0x22, 0x02, 0x22, 0x02, 0x24, 0x02, 0x24, 0x02, 0x26, 0x02, 0x26, 0x02,
+	0x28, 0x02, 0x28, 0x02, 0x2A, 0x02, 0x2A, 0x02, 0x2C, 0x02, 0x2C, 0x02, 0x2E, 0x02, 0x2E, 0x02,
+	0x30, 0x02, 0x30, 0x02, 0x32, 0x02, 0x32, 0x02, 0x34, 0x02, 0x35, 0x02, 0x36, 0x02, 0x37, 0x02,
+	0x38, 0x02, 0x39, 0x02, 0x65, 0x2C, 0x3B, 0x02, 0x3B, 0x02, 0x3D, 0x02, 0x66, 0x2C, 0x3F, 0x02,
+	0x40, 0x02, 0x41, 0x02, 0x41, 0x02, 0x43, 0x02, 0x44, 0x02, 0x45, 0x02, 0x46, 0x02, 0x46, 0x02,
+	0x48, 0x02, 0x48, 0x02, 0x4A, 0x02, 0x4A, 0x02, 0x4C, 0x02, 0x4C, 0x02, 0x4E, 0x02, 0x4E, 0x02,
+	0x50, 0x02, 0x51, 0x02, 0x52, 0x02, 0x81, 0x01, 0x86, 0x01, 0x55, 0x02, 0x89, 0x01, 0x8A, 0x01,
+	0x58, 0x02, 0x8F, 0x01, 0x5A, 0x02, 0x90, 0x01, 0x5C, 0x02, 0x5D, 0x02, 0x5E, 0x02, 0x5F, 0x02,
+	0x93, 0x01, 0x61, 0x02, 0x62, 0x02, 0x94, 0x01, 0x64, 0x02, 0x65, 0x02, 0x66, 0x02, 0x67, 0x02,
+	0x97, 0x01, 0x96, 0x01, 0x6A, 0x02, 0x62, 0x2C, 0x6C, 0x02, 0x6D, 0x02, 0x6E, 0x02, 0x9C, 0x01,
+	0x70, 0x02, 0x71, 0x02, 0x9D, 0x01, 0x73, 0x02, 0x74, 0x02, 0x9F, 0x01, 0x76, 0x02, 0x77, 0x02,
+	0x78, 0x02, 0x79, 0x02, 0x7A, 0x02, 0x7B, 0x02, 0x7C, 0x02, 0x64, 0x2C, 0x7E, 0x02, 0x7F, 0x02,
+	0xA6, 0x01, 0x81, 0x02, 0x82, 0x02, 0xA9, 0x01, 0x84, 0x02, 0x85, 0x02, 0x86, 0x02, 0x87, 0x02,
+	0xAE, 0x01, 0x44, 0x02, 0xB1, 0x01, 0xB2, 0x01, 0x45, 0x02, 0x8D, 0x02, 0x8E, 0x02, 0x8F, 0x02,
+	0x90, 0x02, 0x91, 0x02, 0xB7, 0x01, 0x93, 0x02, 0x94, 0x02, 0x95, 0x02, 0x96, 0x02, 0x97, 0x02,
+	0x98, 0x02, 0x99, 0x02, 0x9A, 0x02, 0x9B, 0x02, 0x9C, 0x02, 0x9D, 0x02, 0x9E, 0x02, 0x9F, 0x02,
+	0xA0, 0x02, 0xA1, 0x02, 0xA2, 0x02, 0xA3, 0x02, 0xA4, 0x02, 0xA5, 0x02, 0xA6, 0x02, 0xA7, 0x02,
+	0xA8, 0x02, 0xA9, 0x02, 0xAA, 0x02, 0xAB, 0x02, 0xAC, 0x02, 0xAD, 0x02, 0xAE, 0x02, 0xAF, 0x02,
+	0xB0, 0x02, 0xB1, 0x02, 0xB2, 0x02, 0xB3, 0x02, 0xB4, 0x02, 0xB5, 0x02, 0xB6, 0x02, 0xB7, 0x02,
+	0xB8, 0x02, 0xB9, 0x02, 0xBA, 0x02, 0xBB, 0x02, 0xBC, 0x02, 0xBD, 0x02, 0xBE, 0x02, 0xBF, 0x02,
+	0xC0, 0x02, 0xC1, 0x02, 0xC2, 0x02, 0xC3, 0x02, 0xC4, 0x02, 0xC5, 0x02, 0xC6, 0x02, 0xC7, 0x02,
+	0xC8, 0x02, 0xC9, 0x02, 0xCA, 0x02, 0xCB, 0x02, 0xCC, 0x02, 0xCD, 0x02, 0xCE, 0x02, 0xCF, 0x02,
+	0xD0, 0x02, 0xD1, 0x02, 0xD2, 0x02, 0xD3, 0x02, 0xD4, 0x02, 0xD5, 0x02, 0xD6, 0x02, 0xD7, 0x02,
+	0xD8, 0x02, 0xD9, 0x02, 0xDA, 0x02, 0xDB, 0x02, 0xDC, 0x02, 0xDD, 0x02, 0xDE, 0x02, 0xDF, 0x02,
+	0xE0, 0x02, 0xE1, 0x02, 0xE2, 0x02, 0xE3, 0x02, 0xE4, 0x02, 0xE5, 0x02, 0xE6, 0x02, 0xE7, 0x02,
+	0xE8, 0x02, 0xE9, 0x02, 0xEA, 0x02, 0xEB, 0x02, 0xEC, 0x02, 0xED, 0x02, 0xEE, 0x02, 0xEF, 0x02,
+	0xF0, 0x02, 0xF1, 0x02, 0xF2, 0x02, 0xF3, 0x02, 0xF4, 0x02, 0xF5, 0x02, 0xF6, 0x02, 0xF7, 0x02,
+	0xF8, 0x02, 0xF9, 0x02, 0xFA, 0x02, 0xFB, 0x02, 0xFC, 0x02, 0xFD, 0x02, 0xFE, 0x02, 0xFF, 0x02,
+	0x00, 0x03, 0x01, 0x03, 0x02, 0x03, 0x03, 0x03, 0x04, 0x03, 0x05, 0x03, 0x06, 0x03, 0x07, 0x03,
+	0x08, 0x03, 0x09, 0x03, 0x0A, 0x03, 0x0B, 0x03, 0x0C, 0x03, 0x0D, 0x03, 0x0E, 0x03, 0x0F, 0x03,
+	0x10, 0x03, 0x11, 0x03, 0x12, 0x03, 0x13, 0x03, 0x14, 0x03, 0x15, 0x03, 0x16, 0x03, 0x17, 0x03,
+	0x18, 0x03, 0x19, 0x03, 0x1A, 0x03, 0x1B, 0x03, 0x1C, 0x03, 0x1D, 0x03, 0x1E, 0x03, 0x1F, 0x03,
+	0x20, 0x03, 0x21, 0x03, 0x22, 0x03, 0x23, 0x03, 0x24, 0x03, 0x25, 0x03, 0x26, 0x03, 0x27, 0x03,
+	0x28, 0x03, 0x29, 0x03, 0x2A, 0x03, 0x2B, 0x03, 0x2C, 0x03, 0x2D, 0x03, 0x2E, 0x03, 0x2F, 0x03,
+	0x30, 0x03, 0x31, 0x03, 0x32, 0x03, 0x33, 0x03, 0x34, 0x03, 0x35, 0x03, 0x36, 0x03, 0x37, 0x03,
+	0x38, 0x03, 0x39, 0x03, 0x3A, 0x03, 0x3B, 0x03, 0x3C, 0x03, 0x3D, 0x03, 0x3E, 0x03, 0x3F, 0x03,
+	0x40, 0x03, 0x41, 0x03, 0x42, 0x03, 0x43, 0x03, 0x44, 0x03, 0x45, 0x03, 0x46, 0x03, 0x47, 0x03,
+	0x48, 0x03, 0x49, 0x03, 0x4A, 0x03, 0x4B, 0x03, 0x4C, 0x03, 0x4D, 0x03, 0x4E, 0x03, 0x4F, 0x03,
+	0x50, 0x03, 0x51, 0x03, 0x52, 0x03, 0x53, 0x03, 0x54, 0x03, 0x55, 0x03, 0x56, 0x03, 0x57, 0x03,
+	0x58, 0x03, 0x59, 0x03, 0x5A, 0x03, 0x5B, 0x03, 0x5C, 0x03, 0x5D, 0x03, 0x5E, 0x03, 0x5F, 0x03,
+	0x60, 0x03, 0x61, 0x03, 0x62, 0x03, 0x63, 0x03, 0x64, 0x03, 0x65, 0x03, 0x66, 0x03, 0x67, 0x03,
+	0x68, 0x03, 0x69, 0x03, 0x6A, 0x03, 0x6B, 0x03, 0x6C, 0x03, 0x6D, 0x03, 0x6E, 0x03, 0x6F, 0x03,
+	0x70, 0x03, 0x71, 0x03, 0x72, 0x03, 0x73, 0x03, 0x74, 0x03, 0x75, 0x03, 0x76, 0x03, 0x77, 0x03,
+	0x78, 0x03, 0x79, 0x03, 0x7A, 0x03, 0xFD, 0x03, 0xFE, 0x03, 0xFF, 0x03, 0x7E, 0x03, 0x7F, 0x03,
+	0x80, 0x03, 0x81, 0x03, 0x82, 0x03, 0x83, 0x03, 0x84, 0x03, 0x85, 0x03, 0x86, 0x03, 0x87, 0x03,
+	0x88, 0x03, 0x89, 0x03, 0x8A, 0x03, 0x8B, 0x03, 0x8C, 0x03, 0x8D, 0x03, 0x8E, 0x03, 0x8F, 0x03,
+	0x90, 0x03, 0x91, 0x03, 0x92, 0x03, 0x93, 0x03, 0x94, 0x03, 0x95, 0x03, 0x96, 0x03, 0x97, 0x03,
+	0x98, 0x03, 0x99, 0x03, 0x9A, 0x03, 0x9B, 0x03, 0x9C, 0x03, 0x9D, 0x03, 0x9E, 0x03, 0x9F, 0x03,
+	0xA0, 0x03, 0xA1, 0x03, 0xA2, 0x03, 0xA3, 0x03, 0xA4, 0x03, 0xA5, 0x03, 0xA6, 0x03, 0xA7, 0x03,
+	0xA8, 0x03, 0xA9, 0x03, 0xAA, 0x03, 0xAB, 0x03, 0x86, 0x03, 0x88, 0x03, 0x89, 0x03, 0x8A, 0x03,
+	0xB0, 0x03, 0x91, 0x03, 0x92, 0x03, 0x93, 0x03, 0x94, 0x03, 0x95, 0x03, 0x96, 0x03, 0x97, 0x03,
+	0x98, 0x03, 0x99, 0x03, 0x9A, 0x03, 0x9B, 0x03, 0x9C, 0x03, 0x9D, 0x03, 0x9E, 0x03, 0x9F, 0x03,
+	0xA0, 0x03, 0xA1, 0x03, 0xA3, 0x03, 0xA3, 0x03, 0xA4, 0x03, 0xA5, 0x03, 0xA6, 0x03, 0xA7, 0x03,
+	0xA8, 0x03, 0xA9, 0x03, 0xAA, 0x03, 0xAB, 0x03, 0x8C, 0x03, 0x8E, 0x03, 0x8F, 0x03, 0xCF, 0x03,
+	0xD0, 0x03, 0xD1, 0x03, 0xD2, 0x03, 0xD3, 0x03, 0xD4, 0x03, 0xD5, 0x03, 0xD6, 0x03, 0xD7, 0x03,
+	0xD8, 0x03, 0xD8, 0x03, 0xDA, 0x03, 0xDA, 0x03, 0xDC, 0x03, 0xDC, 0x03, 0xDE, 0x03, 0xDE, 0x03,
+	0xE0, 0x03, 0xE0, 0x03, 0xE2, 0x03, 0xE2, 0x03, 0xE4, 0x03, 0xE4, 0x03, 0xE6, 0x03, 0xE6, 0x03,
+	0xE8, 0x03, 0xE8, 0x03, 0xEA, 0x03, 0xEA, 0x03, 0xEC, 0x03, 0xEC, 0x03, 0xEE, 0x03, 0xEE, 0x03,
+	0xF0, 0x03, 0xF1, 0x03, 0xF9, 0x03, 0xF3, 0x03, 0xF4, 0x03, 0xF5, 0x03, 0xF6, 0x03, 0xF7, 0x03,
+	0xF7, 0x03, 0xF9, 0x03, 0xFA, 0x03, 0xFA, 0x03, 0xFC, 0x03, 0xFD, 0x03, 0xFE, 0x03, 0xFF, 0x03,
+	0x00, 0x04, 0x01, 0x04, 0x02, 0x04, 0x03, 0x04, 0x04, 0x04, 0x05, 0x04, 0x06, 0x04, 0x07, 0x04,
+	0x08, 0x04, 0x09, 0x04, 0x0A, 0x04, 0x0B, 0x04, 0x0C, 0x04, 0x0D, 0x04, 0x0E, 0x04, 0x0F, 0x04,
+	0x10, 0x04, 0x11, 0x04, 0x12, 0x04, 0x13, 0x04, 0x14, 0x04, 0x15, 0x04, 0x16, 0x04, 0x17, 0x04,
+	0x18, 0x04, 0x19, 0x04, 0x1A, 0x04, 0x1B, 0x04, 0x1C, 0x04, 0x1D, 0x04, 0x1E, 0x04, 0x1F, 0x04,
+	0x20, 0x04, 0x21, 0x04, 0x22, 0x04, 0x23, 0x04, 0x24, 0x04, 0x25, 0x04, 0x26, 0x04, 0x27, 0x04,
+	0x28, 0x04, 0x29, 0x04, 0x2A, 0x04, 0x2B, 0x04, 0x2C, 0x04, 0x2D, 0x04, 0x2E, 0x04, 0x2F, 0x04,
+	0x10, 0x04, 0x11, 0x04, 0x12, 0x04, 0x13, 0x04, 0x14, 0x04, 0x15, 0x04, 0x16, 0x04, 0x17, 0x04,
+	0x18, 0x04, 0x19, 0x04, 0x1A, 0x04, 0x1B, 0x04, 0x1C, 0x04, 0x1D, 0x04, 0x1E, 0x04, 0x1F, 0x04,
+	0x20, 0x04, 0x21, 0x04, 0x22, 0x04, 0x23, 0x04, 0x24, 0x04, 0x25, 0x04, 0x26, 0x04, 0x27, 0x04,
+	0x28, 0x04, 0x29, 0x04, 0x2A, 0x04, 0x2B, 0x04, 0x2C, 0x04, 0x2D, 0x04, 0x2E, 0x04, 0x2F, 0x04,
+	0x00, 0x04, 0x01, 0x04, 0x02, 0x04, 0x03, 0x04, 0x04, 0x04, 0x05, 0x04, 0x06, 0x04, 0x07, 0x04,
+	0x08, 0x04, 0x09, 0x04, 0x0A, 0x04, 0x0B, 0x04, 0x0C, 0x04, 0x0D, 0x04, 0x0E, 0x04, 0x0F, 0x04,
+	0x60, 0x04, 0x60, 0x04, 0x62, 0x04, 0x62, 0x04, 0x64, 0x04, 0x64, 0x04, 0x66, 0x04, 0x66, 0x04,
+	0x68, 0x04, 0x68, 0x04, 0x6A, 0x04, 0x6A, 0x04, 0x6C, 0x04, 0x6C, 0x04, 0x6E, 0x04, 0x6E, 0x04,
+	0x70, 0x04, 0x70, 0x04, 0x72, 0x04, 0x72, 0x04, 0x74, 0x04, 0x74, 0x04, 0x76, 0x04, 0x76, 0x04,
+	0x78, 0x04, 0x78, 0x04, 0x7A, 0x04, 0x7A, 0x04, 0x7C, 0x04, 0x7C, 0x04, 0x7E, 0x04, 0x7E, 0x04,
+	0x80, 0x04, 0x80, 0x04, 0x82, 0x04, 0x83, 0x04, 0x84, 0x04, 0x85, 0x04, 0x86, 0x04, 0x87, 0x04,
+	0x88, 0x04, 0x89, 0x04, 0x8A, 0x04, 0x8A, 0x04, 0x8C, 0x04, 0x8C, 0x04, 0x8E, 0x04, 0x8E, 0x04,
+	0x90, 0x04, 0x90, 0x04, 0x92, 0x04, 0x92, 0x04, 0x94, 0x04, 0x94, 0x04, 0x96, 0x04, 0x96, 0x04,
+	0x98, 0x04, 0x98, 0x04, 0x9A, 0x04, 0x9A, 0x04, 0x9C, 0x04, 0x9C, 0x04, 0x9E, 0x04, 0x9E, 0x04,
+	0xA0, 0x04, 0xA0, 0x04, 0xA2, 0x04, 0xA2, 0x04, 0xA4, 0x04, 0xA4, 0x04, 0xA6, 0x04, 0xA6, 0x04,
+	0xA8, 0x04, 0xA8, 0x04, 0xAA, 0x04, 0xAA, 0x04, 0xAC, 0x04, 0xAC, 0x04, 0xAE, 0x04, 0xAE, 0x04,
+	0xB0, 0x04, 0xB0, 0x04, 0xB2, 0x04, 0xB2, 0x04, 0xB4, 0x04, 0xB4, 0x04, 0xB6, 0x04, 0xB6, 0x04,
+	0xB8, 0x04, 0xB8, 0x04, 0xBA, 0x04, 0xBA, 0x04, 0xBC, 0x04, 0xBC, 0x04, 0xBE, 0x04, 0xBE, 0x04,
+	0xC0, 0x04, 0xC1, 0x04, 0xC1, 0x04, 0xC3, 0x04, 0xC3, 0x04, 0xC5, 0x04, 0xC5, 0x04, 0xC7, 0x04,
+	0xC7, 0x04, 0xC9, 0x04, 0xC9, 0x04, 0xCB, 0x04, 0xCB, 0x04, 0xCD, 0x04, 0xCD, 0x04, 0xC0, 0x04,
+	0xD0, 0x04, 0xD0, 0x04, 0xD2, 0x04, 0xD2, 0x04, 0xD4, 0x04, 0xD4, 0x04, 0xD6, 0x04, 0xD6, 0x04,
+	0xD8, 0x04, 0xD8, 0x04, 0xDA, 0x04, 0xDA, 0x04, 0xDC, 0x04, 0xDC, 0x04, 0xDE, 0x04, 0xDE, 0x04,
+	0xE0, 0x04, 0xE0, 0x04, 0xE2, 0x04, 0xE2, 0x04, 0xE4, 0x04, 0xE4, 0x04, 0xE6, 0x04, 0xE6, 0x04,
+	0xE8, 0x04, 0xE8, 0x04, 0xEA, 0x04, 0xEA, 0x04, 0xEC, 0x04, 0xEC, 0x04, 0xEE, 0x04, 0xEE, 0x04,
+	0xF0, 0x04, 0xF0, 0x04, 0xF2, 0x04, 0xF2, 0x04, 0xF4, 0x04, 0xF4, 0x04, 0xF6, 0x04, 0xF6, 0x04,
+	0xF8, 0x04, 0xF8, 0x04, 0xFA, 0x04, 0xFA, 0x04, 0xFC, 0x04, 0xFC, 0x04, 0xFE, 0x04, 0xFE, 0x04,
+	0x00, 0x05, 0x00, 0x05, 0x02, 0x05, 0x02, 0x05, 0x04, 0x05, 0x04, 0x05, 0x06, 0x05, 0x06, 0x05,
+	0x08, 0x05, 0x08, 0x05, 0x0A, 0x05, 0x0A, 0x05, 0x0C, 0x05, 0x0C, 0x05, 0x0E, 0x05, 0x0E, 0x05,
+	0x10, 0x05, 0x10, 0x05, 0x12, 0x05, 0x12, 0x05, 0x14, 0x05, 0x15, 0x05, 0x16, 0x05, 0x17, 0x05,
+	0x18, 0x05, 0x19, 0x05, 0x1A, 0x05, 0x1B, 0x05, 0x1C, 0x05, 0x1D, 0x05, 0x1E, 0x05, 0x1F, 0x05,
+	0x20, 0x05, 0x21, 0x05, 0x22, 0x05, 0x23, 0x05, 0x24, 0x05, 0x25, 0x05, 0x26, 0x05, 0x27, 0x05,
+	0x28, 0x05, 0x29, 0x05, 0x2A, 0x05, 0x2B, 0x05, 0x2C, 0x05, 0x2D, 0x05, 0x2E, 0x05, 0x2F, 0x05,
+	0x30, 0x05, 0x31, 0x05, 0x32, 0x05, 0x33, 0x05, 0x34, 0x05, 0x35, 0x05, 0x36, 0x05, 0x37, 0x05,
+	0x38, 0x05, 0x39, 0x05, 0x3A, 0x05, 0x3B, 0x05, 0x3C, 0x05, 0x3D, 0x05, 0x3E, 0x05, 0x3F, 0x05,
+	0x40, 0x05, 0x41, 0x05, 0x42, 0x05, 0x43, 0x05, 0x44, 0x05, 0x45, 0x05, 0x46, 0x05, 0x47, 0x05,
+	0x48, 0x05, 0x49, 0x05, 0x4A, 0x05, 0x4B, 0x05, 0x4C, 0x05, 0x4D, 0x05, 0x4E, 0x05, 0x4F, 0x05,
+	0x50, 0x05, 0x51, 0x05, 0x52, 0x05, 0x53, 0x05, 0x54, 0x05, 0x55, 0x05, 0x56, 0x05, 0x57, 0x05,
+	0x58, 0x05, 0x59, 0x05, 0x5A, 0x05, 0x5B, 0x05, 0x5C, 0x05, 0x5D, 0x05, 0x5E, 0x05, 0x5F, 0x05,
+	0x60, 0x05, 0x31, 0x05, 0x32, 0x05, 0x33, 0x05, 0x34, 0x05, 0x35, 0x05, 0x36, 0x05, 0x37, 0x05,
+	0x38, 0x05, 0x39, 0x05, 0x3A, 0x05, 0x3B, 0x05, 0x3C, 0x05, 0x3D, 0x05, 0x3E, 0x05, 0x3F, 0x05,
+	0x40, 0x05, 0x41, 0x05, 0x42, 0x05, 0x43, 0x05, 0x44, 0x05, 0x45, 0x05, 0x46, 0x05, 0x47, 0x05,
+	0x48, 0x05, 0x49, 0x05, 0x4A, 0x05, 0x4B, 0x05, 0x4C, 0x05, 0x4D, 0x05, 0x4E, 0x05, 0x4F, 0x05,
+	0x50, 0x05, 0x51, 0x05, 0x52, 0x05, 0x53, 0x05, 0x54, 0x05, 0x55, 0x05, 0x56, 0x05, 0xFF, 0xFF,
+	0xF6, 0x17, 0x63, 0x2C, 0x7E, 0x1D, 0x7F, 0x1D, 0x80, 0x1D, 0x81, 0x1D, 0x82, 0x1D, 0x83, 0x1D,
+	0x84, 0x1D, 0x85, 0x1D, 0x86, 0x1D, 0x87, 0x1D, 0x88, 0x1D, 0x89, 0x1D, 0x8A, 0x1D, 0x8B, 0x1D,
+	0x8C, 0x1D, 0x8D, 0x1D, 0x8E, 0x1D, 0x8F, 0x1D, 0x90, 0x1D, 0x91, 0x1D, 0x92, 0x1D, 0x93, 0x1D,
+	0x94, 0x1D, 0x95, 0x1D, 0x96, 0x1D, 0x97, 0x1D, 0x98, 0x1D, 0x99, 0x1D, 0x9A, 0x1D, 0x9B, 0x1D,
+	0x9C, 0x1D, 0x9D, 0x1D, 0x9E, 0x1D, 0x9F, 0x1D, 0xA0, 0x1D, 0xA1, 0x1D, 0xA2, 0x1D, 0xA3, 0x1D,
+	0xA4, 0x1D, 0xA5, 0x1D, 0xA6, 0x1D, 0xA7, 0x1D, 0xA8, 0x1D, 0xA9, 0x1D, 0xAA, 0x1D, 0xAB, 0x1D,
+	0xAC, 0x1D, 0xAD, 0x1D, 0xAE, 0x1D, 0xAF, 0x1D, 0xB0, 0x1D, 0xB1, 0x1D, 0xB2, 0x1D, 0xB3, 0x1D,
+	0xB4, 0x1D, 0xB5, 0x1D, 0xB6, 0x1D, 0xB7, 0x1D, 0xB8, 0x1D, 0xB9, 0x1D, 0xBA, 0x1D, 0xBB, 0x1D,
+	0xBC, 0x1D, 0xBD, 0x1D, 0xBE, 0x1D, 0xBF, 0x1D, 0xC0, 0x1D, 0xC1, 0x1D, 0xC2, 0x1D, 0xC3, 0x1D,
+	0xC4, 0x1D, 0xC5, 0x1D, 0xC6, 0x1D, 0xC7, 0x1D, 0xC8, 0x1D, 0xC9, 0x1D, 0xCA, 0x1D, 0xCB, 0x1D,
+	0xCC, 0x1D, 0xCD, 0x1D, 0xCE, 0x1D, 0xCF, 0x1D, 0xD0, 0x1D, 0xD1, 0x1D, 0xD2, 0x1D, 0xD3, 0x1D,
+	0xD4, 0x1D, 0xD5, 0x1D, 0xD6, 0x1D, 0xD7, 0x1D, 0xD8, 0x1D, 0xD9, 0x1D, 0xDA, 0x1D, 0xDB, 0x1D,
+	0xDC, 0x1D, 0xDD, 0x1D, 0xDE, 0x1D, 0xDF, 0x1D, 0xE0, 0x1D, 0xE1, 0x1D, 0xE2, 0x1D, 0xE3, 0x1D,
+	0xE4, 0x1D, 0xE5, 0x1D, 0xE6, 0x1D, 0xE7, 0x1D, 0xE8, 0x1D, 0xE9, 0x1D, 0xEA, 0x1D, 0xEB, 0x1D,
+	0xEC, 0x1D, 0xED, 0x1D, 0xEE, 0x1D, 0xEF, 0x1D, 0xF0, 0x1D, 0xF1, 0x1D, 0xF2, 0x1D, 0xF3, 0x1D,
+	0xF4, 0x1D, 0xF5, 0x1D, 0xF6, 0x1D, 0xF7, 0x1D, 0xF8, 0x1D, 0xF9, 0x1D, 0xFA, 0x1D, 0xFB, 0x1D,
+	0xFC, 0x1D, 0xFD, 0x1D, 0xFE, 0x1D, 0xFF, 0x1D, 0x00, 0x1E, 0x00, 0x1E, 0x02, 0x1E, 0x02, 0x1E,
+	0x04, 0x1E, 0x04, 0x1E, 0x06, 0x1E, 0x06, 0x1E, 0x08, 0x1E, 0x08, 0x1E, 0x0A, 0x1E, 0x0A, 0x1E,
+	0x0C, 0x1E, 0x0C, 0x1E, 0x0E, 0x1E, 0x0E, 0x1E, 0x10, 0x1E, 0x10, 0x1E, 0x12, 0x1E, 0x12, 0x1E,
+	0x14, 0x1E, 0x14, 0x1E, 0x16, 0x1E, 0x16, 0x1E, 0x18, 0x1E, 0x18, 0x1E, 0x1A, 0x1E, 0x1A, 0x1E,
+	0x1C, 0x1E, 0x1C, 0x1E, 0x1E, 0x1E, 0x1E, 0x1E, 0x20, 0x1E, 0x20, 0x1E, 0x22, 0x1E, 0x22, 0x1E,
+	0x24, 0x1E, 0x24, 0x1E, 0x26, 0x1E, 0x26, 0x1E, 0x28, 0x1E, 0x28, 0x1E, 0x2A, 0x1E, 0x2A, 0x1E,
+	0x2C, 0x1E, 0x2C, 0x1E, 0x2E, 0x1E, 0x2E, 0x1E, 0x30, 0x1E, 0x30, 0x1E, 0x32, 0x1E, 0x32, 0x1E,
+	0x34, 0x1E, 0x34, 0x1E, 0x36, 0x1E, 0x36, 0x1E, 0x38, 0x1E, 0x38, 0x1E, 0x3A, 0x1E, 0x3A, 0x1E,
+	0x3C, 0x1E, 0x3C, 0x1E, 0x3E, 0x1E, 0x3E, 0x1E, 0x40, 0x1E, 0x40, 0x1E, 0x42, 0x1E, 0x42, 0x1E,
+	0x44, 0x1E, 0x44, 0x1E, 0x46, 0x1E, 0x46, 0x1E, 0x48, 0x1E, 0x48, 0x1E, 0x4A, 0x1E, 0x4A, 0x1E,
+	0x4C, 0x1E, 0x4C, 0x1E, 0x4E, 0x1E, 0x4E, 0x1E, 0x50, 0x1E, 0x50, 0x1E, 0x52, 0x1E, 0x52, 0x1E,
+	0x54, 0x1E, 0x54, 0x1E, 0x56, 0x1E, 0x56, 0x1E, 0x58, 0x1E, 0x58, 0x1E, 0x5A, 0x1E, 0x5A, 0x1E,
+	0x5C, 0x1E, 0x5C, 0x1E, 0x5E, 0x1E, 0x5E, 0x1E, 0x60, 0x1E, 0x60, 0x1E, 0x62, 0x1E, 0x62, 0x1E,
+	0x64, 0x1E, 0x64, 0x1E, 0x66, 0x1E, 0x66, 0x1E, 0x68, 0x1E, 0x68, 0x1E, 0x6A, 0x1E, 0x6A, 0x1E,
+	0x6C, 0x1E, 0x6C, 0x1E, 0x6E, 0x1E, 0x6E, 0x1E, 0x70, 0x1E, 0x70, 0x1E, 0x72, 0x1E, 0x72, 0x1E,
+	0x74, 0x1E, 0x74, 0x1E, 0x76, 0x1E, 0x76, 0x1E, 0x78, 0x1E, 0x78, 0x1E, 0x7A, 0x1E, 0x7A, 0x1E,
+	0x7C, 0x1E, 0x7C, 0x1E, 0x7E, 0x1E, 0x7E, 0x1E, 0x80, 0x1E, 0x80, 0x1E, 0x82, 0x1E, 0x82, 0x1E,
+	0x84, 0x1E, 0x84, 0x1E, 0x86, 0x1E, 0x86, 0x1E, 0x88, 0x1E, 0x88, 0x1E, 0x8A, 0x1E, 0x8A, 0x1E,
+	0x8C, 0x1E, 0x8C, 0x1E, 0x8E, 0x1E, 0x8E, 0x1E, 0x90, 0x1E, 0x90, 0x1E, 0x92, 0x1E, 0x92, 0x1E,
+	0x94, 0x1E, 0x94, 0x1E, 0x96, 0x1E, 0x97, 0x1E, 0x98, 0x1E, 0x99, 0x1E, 0x9A, 0x1E, 0x9B, 0x1E,
+	0x9C, 0x1E, 0x9D, 0x1E, 0x9E, 0x1E, 0x9F, 0x1E, 0xA0, 0x1E, 0xA0, 0x1E, 0xA2, 0x1E, 0xA2, 0x1E,
+	0xA4, 0x1E, 0xA4, 0x1E, 0xA6, 0x1E, 0xA6, 0x1E, 0xA8, 0x1E, 0xA8, 0x1E, 0xAA, 0x1E, 0xAA, 0x1E,
+	0xAC, 0x1E, 0xAC, 0x1E, 0xAE, 0x1E, 0xAE, 0x1E, 0xB0, 0x1E, 0xB0, 0x1E, 0xB2, 0x1E, 0xB2, 0x1E,
+	0xB4, 0x1E, 0xB4, 0x1E, 0xB6, 0x1E, 0xB6, 0x1E, 0xB8, 0x1E, 0xB8, 0x1E, 0xBA, 0x1E, 0xBA, 0x1E,
+	0xBC, 0x1E, 0xBC, 0x1E, 0xBE, 0x1E, 0xBE, 0x1E, 0xC0, 0x1E, 0xC0, 0x1E, 0xC2, 0x1E, 0xC2, 0x1E,
+	0xC4, 0x1E, 0xC4, 0x1E, 0xC6, 0x1E, 0xC6, 0x1E, 0xC8, 0x1E, 0xC8, 0x1E, 0xCA, 0x1E, 0xCA, 0x1E,
+	0xCC, 0x1E, 0xCC, 0x1E, 0xCE, 0x1E, 0xCE, 0x1E, 0xD0, 0x1E, 0xD0, 0x1E, 0xD2, 0x1E, 0xD2, 0x1E,
+	0xD4, 0x1E, 0xD4, 0x1E, 0xD6, 0x1E, 0xD6, 0x1E, 0xD8, 0x1E, 0xD8, 0x1E, 0xDA, 0x1E, 0xDA, 0x1E,
+	0xDC, 0x1E, 0xDC, 0x1E, 0xDE, 0x1E, 0xDE, 0x1E, 0xE0, 0x1E, 0xE0, 0x1E, 0xE2, 0x1E, 0xE2, 0x1E,
+	0xE4, 0x1E, 0xE4, 0x1E, 0xE6, 0x1E, 0xE6, 0x1E, 0xE8, 0x1E, 0xE8, 0x1E, 0xEA, 0x1E, 0xEA, 0x1E,
+	0xEC, 0x1E, 0xEC, 0x1E, 0xEE, 0x1E, 0xEE, 0x1E, 0xF0, 0x1E, 0xF0, 0x1E, 0xF2, 0x1E, 0xF2, 0x1E,
+	0xF4, 0x1E, 0xF4, 0x1E, 0xF6, 0x1E, 0xF6, 0x1E, 0xF8, 0x1E, 0xF8, 0x1E, 0xFA, 0x1E, 0xFB, 0x1E,
+	0xFC, 0x1E, 0xFD, 0x1E, 0xFE, 0x1E, 0xFF, 0x1E, 0x08, 0x1F, 0x09, 0x1F, 0x0A, 0x1F, 0x0B, 0x1F,
+	0x0C, 0x1F, 0x0D, 0x1F, 0x0E, 0x1F, 0x0F, 0x1F, 0x08, 0x1F, 0x09, 0x1F, 0x0A, 0x1F, 0x0B, 0x1F,
+	0x0C, 0x1F, 0x0D, 0x1F, 0x0E, 0x1F, 0x0F, 0x1F, 0x18, 0x1F, 0x19, 0x1F, 0x1A, 0x1F, 0x1B, 0x1F,
+	0x1C, 0x1F, 0x1D, 0x1F, 0x16, 0x1F, 0x17, 0x1F, 0x18, 0x1F, 0x19, 0x1F, 0x1A, 0x1F, 0x1B, 0x1F,
+	0x1C, 0x1F, 0x1D, 0x1F, 0x1E, 0x1F, 0x1F, 0x1F, 0x28, 0x1F, 0x29, 0x1F, 0x2A, 0x1F, 0x2B, 0x1F,
+	0x2C, 0x1F, 0x2D, 0x1F, 0x2E, 0x1F, 0x2F, 0x1F, 0x28, 0x1F, 0x29, 0x1F, 0x2A, 0x1F, 0x2B, 0x1F,
+	0x2C, 0x1F, 0x2D, 0x1F, 0x2E, 0x1F, 0x2F, 0x1F, 0x38, 0x1F, 0x39, 0x1F, 0x3A, 0x1F, 0x3B, 0x1F,
+	0x3C, 0x1F, 0x3D, 0x1F, 0x3E, 0x1F, 0x3F, 0x1F, 0x38, 0x1F, 0x39, 0x1F, 0x3A, 0x1F, 0x3B, 0x1F,
+	0x3C, 0x1F, 0x3D, 0x1F, 0x3E, 0x1F, 0x3F, 0x1F, 0x48, 0x1F, 0x49, 0x1F, 0x4A, 0x1F, 0x4B, 0x1F,
+	0x4C, 0x1F, 0x4D, 0x1F, 0x46, 0x1F, 0x47, 0x1F, 0x48, 0x1F, 0x49, 0x1F, 0x4A, 0x1F, 0x4B, 0x1F,
+	0x4C, 0x1F, 0x4D, 0x1F, 0x4E, 0x1F, 0x4F, 0x1F, 0x50, 0x1F, 0x59, 0x1F, 0x52, 0x1F, 0x5B, 0x1F,
+	0x54, 0x1F, 0x5D, 0x1F, 0x56, 0x1F, 0x5F, 0x1F, 0x58, 0x1F, 0x59, 0x1F, 0x5A, 0x1F, 0x5B, 0x1F,
+	0x5C, 0x1F, 0x5D, 0x1F, 0x5E, 0x1F, 0x5F, 0x1F, 0x68, 0x1F, 0x69, 0x1F, 0x6A, 0x1F, 0x6B, 0x1F,
+	0x6C, 0x1F, 0x6D, 0x1F, 0x6E, 0x1F, 0x6F, 0x1F, 0x68, 0x1F, 0x69, 0x1F, 0x6A, 0x1F, 0x6B, 0x1F,
+	0x6C, 0x1F, 0x6D, 0x1F, 0x6E, 0x1F, 0x6F, 0x1F, 0xBA, 0x1F, 0xBB, 0x1F, 0xC8, 0x1F, 0xC9, 0x1F,
+	0xCA, 0x1F, 0xCB, 0x1F, 0xDA, 0x1F, 0xDB, 0x1F, 0xF8, 0x1F, 0xF9, 0x1F, 0xEA, 0x1F, 0xEB, 0x1F,
+	0xFA, 0x1F, 0xFB, 0x1F, 0x7E, 0x1F, 0x7F, 0x1F, 0x88, 0x1F, 0x89, 0x1F, 0x8A, 0x1F, 0x8B, 0x1F,
+	0x8C, 0x1F, 0x8D, 0x1F, 0x8E, 0x1F, 0x8F, 0x1F, 0x88, 0x1F, 0x89, 0x1F, 0x8A, 0x1F, 0x8B, 0x1F,
+	0x8C, 0x1F, 0x8D, 0x1F, 0x8E, 0x1F, 0x8F, 0x1F, 0x98, 0x1F, 0x99, 0x1F, 0x9A, 0x1F, 0x9B, 0x1F,
+	0x9C, 0x1F, 0x9D, 0x1F, 0x9E, 0x1F, 0x9F, 0x1F, 0x98, 0x1F, 0x99, 0x1F, 0x9A, 0x1F, 0x9B, 0x1F,
+	0x9C, 0x1F, 0x9D, 0x1F, 0x9E, 0x1F, 0x9F, 0x1F, 0xA8, 0x1F, 0xA9, 0x1F, 0xAA, 0x1F, 0xAB, 0x1F,
+	0xAC, 0x1F, 0xAD, 0x1F, 0xAE, 0x1F, 0xAF, 0x1F, 0xA8, 0x1F, 0xA9, 0x1F, 0xAA, 0x1F, 0xAB, 0x1F,
+	0xAC, 0x1F, 0xAD, 0x1F, 0xAE, 0x1F, 0xAF, 0x1F, 0xB8, 0x1F, 0xB9, 0x1F, 0xB2, 0x1F, 0xBC, 0x1F,
+	0xB4, 0x1F, 0xB5, 0x1F, 0xB6, 0x1F, 0xB7, 0x1F, 0xB8, 0x1F, 0xB9, 0x1F, 0xBA, 0x1F, 0xBB, 0x1F,
+	0xBC, 0x1F, 0xBD, 0x1F, 0xBE, 0x1F, 0xBF, 0x1F, 0xC0, 0x1F, 0xC1, 0x1F, 0xC2, 0x1F, 0xC3, 0x1F,
+	0xC4, 0x1F, 0xC5, 0x1F, 0xC6, 0x1F, 0xC7, 0x1F, 0xC8, 0x1F, 0xC9, 0x1F, 0xCA, 0x1F, 0xCB, 0x1F,
+	0xC3, 0x1F, 0xCD, 0x1F, 0xCE, 0x1F, 0xCF, 0x1F, 0xD8, 0x1F, 0xD9, 0x1F, 0xD2, 0x1F, 0xD3, 0x1F,
+	0xD4, 0x1F, 0xD5, 0x1F, 0xD6, 0x1F, 0xD7, 0x1F, 0xD8, 0x1F, 0xD9, 0x1F, 0xDA, 0x1F, 0xDB, 0x1F,
+	0xDC, 0x1F, 0xDD, 0x1F, 0xDE, 0x1F, 0xDF, 0x1F, 0xE8, 0x1F, 0xE9, 0x1F, 0xE2, 0x1F, 0xE3, 0x1F,
+	0xE4, 0x1F, 0xEC, 0x1F, 0xE6, 0x1F, 0xE7, 0x1F, 0xE8, 0x1F, 0xE9, 0x1F, 0xEA, 0x1F, 0xEB, 0x1F,
+	0xEC, 0x1F, 0xED, 0x1F, 0xEE, 0x1F, 0xEF, 0x1F, 0xF0, 0x1F, 0xF1, 0x1F, 0xF2, 0x1F, 0xF3, 0x1F,
+	0xF4, 0x1F, 0xF5, 0x1F, 0xF6, 0x1F, 0xF7, 0x1F, 0xF8, 0x1F, 0xF9, 0x1F, 0xFA, 0x1F, 0xFB, 0x1F,
+	0xF3, 0x1F, 0xFD, 0x1F, 0xFE, 0x1F, 0xFF, 0x1F, 0x00, 0x20, 0x01, 0x20, 0x02, 0x20, 0x03, 0x20,
+	0x04, 0x20, 0x05, 0x20, 0x06, 0x20, 0x07, 0x20, 0x08, 0x20, 0x09, 0x20, 0x0A, 0x20, 0x0B, 0x20,
+	0x0C, 0x20, 0x0D, 0x20, 0x0E, 0x20, 0x0F, 0x20, 0x10, 0x20, 0x11, 0x20, 0x12, 0x20, 0x13, 0x20,
+	0x14, 0x20, 0x15, 0x20, 0x16, 0x20, 0x17, 0x20, 0x18, 0x20, 0x19, 0x20, 0x1A, 0x20, 0x1B, 0x20,
+	0x1C, 0x20, 0x1D, 0x20, 0x1E, 0x20, 0x1F, 0x20, 0x20, 0x20, 0x21, 0x20, 0x22, 0x20, 0x23, 0x20,
+	0x24, 0x20, 0x25, 0x20, 0x26, 0x20, 0x27, 0x20, 0x28, 0x20, 0x29, 0x20, 0x2A, 0x20, 0x2B, 0x20,
+	0x2C, 0x20, 0x2D, 0x20, 0x2E, 0x20, 0x2F, 0x20, 0x30, 0x20, 0x31, 0x20, 0x32, 0x20, 0x33, 0x20,
+	0x34, 0x20, 0x35, 0x20, 0x36, 0x20, 0x37, 0x20, 0x38, 0x20, 0x39, 0x20, 0x3A, 0x20, 0x3B, 0x20,
+	0x3C, 0x20, 0x3D, 0x20, 0x3E, 0x20, 0x3F, 0x20, 0x40, 0x20, 0x41, 0x20, 0x42, 0x20, 0x43, 0x20,
+	0x44, 0x20, 0x45, 0x20, 0x46, 0x20, 0x47, 0x20, 0x48, 0x20, 0x49, 0x20, 0x4A, 0x20, 0x4B, 0x20,
+	0x4C, 0x20, 0x4D, 0x20, 0x4E, 0x20, 0x4F, 0x20, 0x50, 0x20, 0x51, 0x20, 0x52, 0x20, 0x53, 0x20,
+	0x54, 0x20, 0x55, 0x20, 0x56, 0x20, 0x57, 0x20, 0x58, 0x20, 0x59, 0x20, 0x5A, 0x20, 0x5B, 0x20,
+	0x5C, 0x20, 0x5D, 0x20, 0x5E, 0x20, 0x5F, 0x20, 0x60, 0x20, 0x61, 0x20, 0x62, 0x20, 0x63, 0x20,
+	0x64, 0x20, 0x65, 0x20, 0x66, 0x20, 0x67, 0x20, 0x68, 0x20, 0x69, 0x20, 0x6A, 0x20, 0x6B, 0x20,
+	0x6C, 0x20, 0x6D, 0x20, 0x6E, 0x20, 0x6F, 0x20, 0x70, 0x20, 0x71, 0x20, 0x72, 0x20, 0x73, 0x20,
+	0x74, 0x20, 0x75, 0x20, 0x76, 0x20, 0x77, 0x20, 0x78, 0x20, 0x79, 0x20, 0x7A, 0x20, 0x7B, 0x20,
+	0x7C, 0x20, 0x7D, 0x20, 0x7E, 0x20, 0x7F, 0x20, 0x80, 0x20, 0x81, 0x20, 0x82, 0x20, 0x83, 0x20,
+	0x84, 0x20, 0x85, 0x20, 0x86, 0x20, 0x87, 0x20, 0x88, 0x20, 0x89, 0x20, 0x8A, 0x20, 0x8B, 0x20,
+	0x8C, 0x20, 0x8D, 0x20, 0x8E, 0x20, 0x8F, 0x20, 0x90, 0x20, 0x91, 0x20, 0x92, 0x20, 0x93, 0x20,
+	0x94, 0x20, 0x95, 0x20, 0x96, 0x20, 0x97, 0x20, 0x98, 0x20, 0x99, 0x20, 0x9A, 0x20, 0x9B, 0x20,
+	0x9C, 0x20, 0x9D, 0x20, 0x9E, 0x20, 0x9F, 0x20, 0xA0, 0x20, 0xA1, 0x20, 0xA2, 0x20, 0xA3, 0x20,
+	0xA4, 0x20, 0xA5, 0x20, 0xA6, 0x20, 0xA7, 0x20, 0xA8, 0x20, 0xA9, 0x20, 0xAA, 0x20, 0xAB, 0x20,
+	0xAC, 0x20, 0xAD, 0x20, 0xAE, 0x20, 0xAF, 0x20, 0xB0, 0x20, 0xB1, 0x20, 0xB2, 0x20, 0xB3, 0x20,
+	0xB4, 0x20, 0xB5, 0x20, 0xB6, 0x20, 0xB7, 0x20, 0xB8, 0x20, 0xB9, 0x20, 0xBA, 0x20, 0xBB, 0x20,
+	0xBC, 0x20, 0xBD, 0x20, 0xBE, 0x20, 0xBF, 0x20, 0xC0, 0x20, 0xC1, 0x20, 0xC2, 0x20, 0xC3, 0x20,
+	0xC4, 0x20, 0xC5, 0x20, 0xC6, 0x20, 0xC7, 0x20, 0xC8, 0x20, 0xC9, 0x20, 0xCA, 0x20, 0xCB, 0x20,
+	0xCC, 0x20, 0xCD, 0x20, 0xCE, 0x20, 0xCF, 0x20, 0xD0, 0x20, 0xD1, 0x20, 0xD2, 0x20, 0xD3, 0x20,
+	0xD4, 0x20, 0xD5, 0x20, 0xD6, 0x20, 0xD7, 0x20, 0xD8, 0x20, 0xD9, 0x20, 0xDA, 0x20, 0xDB, 0x20,
+	0xDC, 0x20, 0xDD, 0x20, 0xDE, 0x20, 0xDF, 0x20, 0xE0, 0x20, 0xE1, 0x20, 0xE2, 0x20, 0xE3, 0x20,
+	0xE4, 0x20, 0xE5, 0x20, 0xE6, 0x20, 0xE7, 0x20, 0xE8, 0x20, 0xE9, 0x20, 0xEA, 0x20, 0xEB, 0x20,
+	0xEC, 0x20, 0xED, 0x20, 0xEE, 0x20, 0xEF, 0x20, 0xF0, 0x20, 0xF1, 0x20, 0xF2, 0x20, 0xF3, 0x20,
+	0xF4, 0x20, 0xF5, 0x20, 0xF6, 0x20, 0xF7, 0x20, 0xF8, 0x20, 0xF9, 0x20, 0xFA, 0x20, 0xFB, 0x20,
+	0xFC, 0x20, 0xFD, 0x20, 0xFE, 0x20, 0xFF, 0x20, 0x00, 0x21, 0x01, 0x21, 0x02, 0x21, 0x03, 0x21,
+	0x04, 0x21, 0x05, 0x21, 0x06, 0x21, 0x07, 0x21, 0x08, 0x21, 0x09, 0x21, 0x0A, 0x21, 0x0B, 0x21,
+	0x0C, 0x21, 0x0D, 0x21, 0x0E, 0x21, 0x0F, 0x21, 0x10, 0x21, 0x11, 0x21, 0x12, 0x21, 0x13, 0x21,
+	0x14, 0x21, 0x15, 0x21, 0x16, 0x21, 0x17, 0x21, 0x18, 0x21, 0x19, 0x21, 0x1A, 0x21, 0x1B, 0x21,
+	0x1C, 0x21, 0x1D, 0x21, 0x1E, 0x21, 0x1F, 0x21, 0x20, 0x21, 0x21, 0x21, 0x22, 0x21, 0x23, 0x21,
+	0x24, 0x21, 0x25, 0x21, 0x26, 0x21, 0x27, 0x21, 0x28, 0x21, 0x29, 0x21, 0x2A, 0x21, 0x2B, 0x21,
+	0x2C, 0x21, 0x2D, 0x21, 0x2E, 0x21, 0x2F, 0x21, 0x30, 0x21, 0x31, 0x21, 0x32, 0x21, 0x33, 0x21,
+	0x34, 0x21, 0x35, 0x21, 0x36, 0x21, 0x37, 0x21, 0x38, 0x21, 0x39, 0x21, 0x3A, 0x21, 0x3B, 0x21,
+	0x3C, 0x21, 0x3D, 0x21, 0x3E, 0x21, 0x3F, 0x21, 0x40, 0x21, 0x41, 0x21, 0x42, 0x21, 0x43, 0x21,
+	0x44, 0x21, 0x45, 0x21, 0x46, 0x21, 0x47, 0x21, 0x48, 0x21, 0x49, 0x21, 0x4A, 0x21, 0x4B, 0x21,
+	0x4C, 0x21, 0x4D, 0x21, 0x32, 0x21, 0x4F, 0x21, 0x50, 0x21, 0x51, 0x21, 0x52, 0x21, 0x53, 0x21,
+	0x54, 0x21, 0x55, 0x21, 0x56, 0x21, 0x57, 0x21, 0x58, 0x21, 0x59, 0x21, 0x5A, 0x21, 0x5B, 0x21,
+	0x5C, 0x21, 0x5D, 0x21, 0x5E, 0x21, 0x5F, 0x21, 0x60, 0x21, 0x61, 0x21, 0x62, 0x21, 0x63, 0x21,
+	0x64, 0x21, 0x65, 0x21, 0x66, 0x21, 0x67, 0x21, 0x68, 0x21, 0x69, 0x21, 0x6A, 0x21, 0x6B, 0x21,
+	0x6C, 0x21, 0x6D, 0x21, 0x6E, 0x21, 0x6F, 0x21, 0x60, 0x21, 0x61, 0x21, 0x62, 0x21, 0x63, 0x21,
+	0x64, 0x21, 0x65, 0x21, 0x66, 0x21, 0x67, 0x21, 0x68, 0x21, 0x69, 0x21, 0x6A, 0x21, 0x6B, 0x21,
+	0x6C, 0x21, 0x6D, 0x21, 0x6E, 0x21, 0x6F, 0x21, 0x80, 0x21, 0x81, 0x21, 0x82, 0x21, 0x83, 0x21,
+	0x83, 0x21, 0xFF, 0xFF, 0x4B, 0x03, 0xB6, 0x24, 0xB7, 0x24, 0xB8, 0x24, 0xB9, 0x24, 0xBA, 0x24,
+	0xBB, 0x24, 0xBC, 0x24, 0xBD, 0x24, 0xBE, 0x24, 0xBF, 0x24, 0xC0, 0x24, 0xC1, 0x24, 0xC2, 0x24,
+	0xC3, 0x24, 0xC4, 0x24, 0xC5, 0x24, 0xC6, 0x24, 0xC7, 0x24, 0xC8, 0x24, 0xC9, 0x24, 0xCA, 0x24,
+	0xCB, 0x24, 0xCC, 0x24, 0xCD, 0x24, 0xCE, 0x24, 0xCF, 0x24, 0xFF, 0xFF, 0x46, 0x07, 0x00, 0x2C,
+	0x01, 0x2C, 0x02, 0x2C, 0x03, 0x2C, 0x04, 0x2C, 0x05, 0x2C, 0x06, 0x2C, 0x07, 0x2C, 0x08, 0x2C,
+	0x09, 0x2C, 0x0A, 0x2C, 0x0B, 0x2C, 0x0C, 0x2C, 0x0D, 0x2C, 0x0E, 0x2C, 0x0F, 0x2C, 0x10, 0x2C,
+	0x11, 0x2C, 0x12, 0x2C, 0x13, 0x2C, 0x14, 0x2C, 0x15, 0x2C, 0x16, 0x2C, 0x17, 0x2C, 0x18, 0x2C,
+	0x19, 0x2C, 0x1A, 0x2C, 0x1B, 0x2C, 0x1C, 0x2C, 0x1D, 0x2C, 0x1E, 0x2C, 0x1F, 0x2C, 0x20, 0x2C,
+	0x21, 0x2C, 0x22, 0x2C, 0x23, 0x2C, 0x24, 0x2C, 0x25, 0x2C, 0x26, 0x2C, 0x27, 0x2C, 0x28, 0x2C,
+	0x29, 0x2C, 0x2A, 0x2C, 0x2B, 0x2C, 0x2C, 0x2C, 0x2D, 0x2C, 0x2E, 0x2C, 0x5F, 0x2C, 0x60, 0x2C,
+	0x60, 0x2C, 0x62, 0x2C, 0x63, 0x2C, 0x64, 0x2C, 0x65, 0x2C, 0x66, 0x2C, 0x67, 0x2C, 0x67, 0x2C,
+	0x69, 0x2C, 0x69, 0x2C, 0x6B, 0x2C, 0x6B, 0x2C, 0x6D, 0x2C, 0x6E, 0x2C, 0x6F, 0x2C, 0x70, 0x2C,
+	0x71, 0x2C, 0x72, 0x2C, 0x73, 0x2C, 0x74, 0x2C, 0x75, 0x2C, 0x75, 0x2C, 0x77, 0x2C, 0x78, 0x2C,
+	0x79, 0x2C, 0x7A, 0x2C, 0x7B, 0x2C, 0x7C, 0x2C, 0x7D, 0x2C, 0x7E, 0x2C, 0x7F, 0x2C, 0x80, 0x2C,
+	0x80, 0x2C, 0x82, 0x2C, 0x82, 0x2C, 0x84, 0x2C, 0x84, 0x2C, 0x86, 0x2C, 0x86, 0x2C, 0x88, 0x2C,
+	0x88, 0x2C, 0x8A, 0x2C, 0x8A, 0x2C, 0x8C, 0x2C, 0x8C, 0x2C, 0x8E, 0x2C, 0x8E, 0x2C, 0x90, 0x2C,
+	0x90, 0x2C, 0x92, 0x2C, 0x92, 0x2C, 0x94, 0x2C, 0x94, 0x2C, 0x96, 0x2C, 0x96, 0x2C, 0x98, 0x2C,
+	0x98, 0x2C, 0x9A, 0x2C, 0x9A, 0x2C, 0x9C, 0x2C, 0x9C, 0x2C, 0x9E, 0x2C, 0x9E, 0x2C, 0xA0, 0x2C,
+	0xA0, 0x2C, 0xA2, 0x2C, 0xA2, 0x2C, 0xA4, 0x2C, 0xA4, 0x2C, 0xA6, 0x2C, 0xA6, 0x2C, 0xA8, 0x2C,
+	0xA8, 0x2C, 0xAA, 0x2C, 0xAA, 0x2C, 0xAC, 0x2C, 0xAC, 0x2C, 0xAE, 0x2C, 0xAE, 0x2C, 0xB0, 0x2C,
+	0xB0, 0x2C, 0xB2, 0x2C, 0xB2, 0x2C, 0xB4, 0x2C, 0xB4, 0x2C, 0xB6, 0x2C, 0xB6, 0x2C, 0xB8, 0x2C,
+	0xB8, 0x2C, 0xBA, 0x2C, 0xBA, 0x2C, 0xBC, 0x2C, 0xBC, 0x2C, 0xBE, 0x2C, 0xBE, 0x2C, 0xC0, 0x2C,
+	0xC0, 0x2C, 0xC2, 0x2C, 0xC2, 0x2C, 0xC4, 0x2C, 0xC4, 0x2C, 0xC6, 0x2C, 0xC6, 0x2C, 0xC8, 0x2C,
+	0xC8, 0x2C, 0xCA, 0x2C, 0xCA, 0x2C, 0xCC, 0x2C, 0xCC, 0x2C, 0xCE, 0x2C, 0xCE, 0x2C, 0xD0, 0x2C,
+	0xD0, 0x2C, 0xD2, 0x2C, 0xD2, 0x2C, 0xD4, 0x2C, 0xD4, 0x2C, 0xD6, 0x2C, 0xD6, 0x2C, 0xD8, 0x2C,
+	0xD8, 0x2C, 0xDA, 0x2C, 0xDA, 0x2C, 0xDC, 0x2C, 0xDC, 0x2C, 0xDE, 0x2C, 0xDE, 0x2C, 0xE0, 0x2C,
+	0xE0, 0x2C, 0xE2, 0x2C, 0xE2, 0x2C, 0xE4, 0x2C, 0xE5, 0x2C, 0xE6, 0x2C, 0xE7, 0x2C, 0xE8, 0x2C,
+	0xE9, 0x2C, 0xEA, 0x2C, 0xEB, 0x2C, 0xEC, 0x2C, 0xED, 0x2C, 0xEE, 0x2C, 0xEF, 0x2C, 0xF0, 0x2C,
+	0xF1, 0x2C, 0xF2, 0x2C, 0xF3, 0x2C, 0xF4, 0x2C, 0xF5, 0x2C, 0xF6, 0x2C, 0xF7, 0x2C, 0xF8, 0x2C,
+	0xF9, 0x2C, 0xFA, 0x2C, 0xFB, 0x2C, 0xFC, 0x2C, 0xFD, 0x2C, 0xFE, 0x2C, 0xFF, 0x2C, 0xA0, 0x10,
+	0xA1, 0x10, 0xA2, 0x10, 0xA3, 0x10, 0xA4, 0x10, 0xA5, 0x10, 0xA6, 0x10, 0xA7, 0x10, 0xA8, 0x10,
+	0xA9, 0x10, 0xAA, 0x10, 0xAB, 0x10, 0xAC, 0x10, 0xAD, 0x10, 0xAE, 0x10, 0xAF, 0x10, 0xB0, 0x10,
+	0xB1, 0x10, 0xB2, 0x10, 0xB3, 0x10, 0xB4, 0x10, 0xB5, 0x10, 0xB6, 0x10, 0xB7, 0x10, 0xB8, 0x10,
+	0xB9, 0x10, 0xBA, 0x10, 0xBB, 0x10, 0xBC, 0x10, 0xBD, 0x10, 0xBE, 0x10, 0xBF, 0x10, 0xC0, 0x10,
+	0xC1, 0x10, 0xC2, 0x10, 0xC3, 0x10, 0xC4, 0x10, 0xC5, 0x10, 0xFF, 0xFF, 0x1B, 0xD2, 0x21, 0xFF,
+	0x22, 0xFF, 0x23, 0xFF, 0x24, 0xFF, 0x25, 0xFF, 0x26, 0xFF, 0x27, 0xFF, 0x28, 0xFF, 0x29, 0xFF,
+	0x2A, 0xFF, 0x2B, 0xFF, 0x2C, 0xFF, 0x2D, 0xFF, 0x2E, 0xFF, 0x2F, 0xFF, 0x30, 0xFF, 0x31, 0xFF,
+	0x32, 0xFF, 0x33, 0xFF, 0x34, 0xFF, 0x35, 0xFF, 0x36, 0xFF, 0x37, 0xFF, 0x38, 0xFF, 0x39, 0xFF,
+	0x3A, 0xFF, 0x5B, 0xFF, 0x5C, 0xFF, 0x5D, 0xFF, 0x5E, 0xFF, 0x5F, 0xFF, 0x60, 0xFF, 0x61, 0xFF,
+	0x62, 0xFF, 0x63, 0xFF, 0x64, 0xFF, 0x65, 0xFF, 0x66, 0xFF, 0x67, 0xFF, 0x68, 0xFF, 0x69, 0xFF,
+	0x6A, 0xFF, 0x6B, 0xFF, 0x6C, 0xFF, 0x6D, 0xFF, 0x6E, 0xFF, 0x6F, 0xFF, 0x70, 0xFF, 0x71, 0xFF,
+	0x72, 0xFF, 0x73, 0xFF, 0x74, 0xFF, 0x75, 0xFF, 0x76, 0xFF, 0x77, 0xFF, 0x78, 0xFF, 0x79, 0xFF,
+	0x7A, 0xFF, 0x7B, 0xFF, 0x7C, 0xFF, 0x7D, 0xFF, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0xFF, 0x81, 0xFF,
+	0x82, 0xFF, 0x83, 0xFF, 0x84, 0xFF, 0x85, 0xFF, 0x86, 0xFF, 0x87, 0xFF, 0x88, 0xFF, 0x89, 0xFF,
+	0x8A, 0xFF, 0x8B, 0xFF, 0x8C, 0xFF, 0x8D, 0xFF, 0x8E, 0xFF, 0x8F, 0xFF, 0x90, 0xFF, 0x91, 0xFF,
+	0x92, 0xFF, 0x93, 0xFF, 0x94, 0xFF, 0x95, 0xFF, 0x96, 0xFF, 0x97, 0xFF, 0x98, 0xFF, 0x99, 0xFF,
+	0x9A, 0xFF, 0x9B, 0xFF, 0x9C, 0xFF, 0x9D, 0xFF, 0x9E, 0xFF, 0x9F, 0xFF, 0xA0, 0xFF, 0xA1, 0xFF,
+	0xA2, 0xFF, 0xA3, 0xFF, 0xA4, 0xFF, 0xA5, 0xFF, 0xA6, 0xFF, 0xA7, 0xFF, 0xA8, 0xFF, 0xA9, 0xFF,
+	0xAA, 0xFF, 0xAB, 0xFF, 0xAC, 0xFF, 0xAD, 0xFF, 0xAE, 0xFF, 0xAF, 0xFF, 0xB0, 0xFF, 0xB1, 0xFF,
+	0xB2, 0xFF, 0xB3, 0xFF, 0xB4, 0xFF, 0xB5, 0xFF, 0xB6, 0xFF, 0xB7, 0xFF, 0xB8, 0xFF, 0xB9, 0xFF,
+	0xBA, 0xFF, 0xBB, 0xFF, 0xBC, 0xFF, 0xBD, 0xFF, 0xBE, 0xFF, 0xBF, 0xFF, 0xC0, 0xFF, 0xC1, 0xFF,
+	0xC2, 0xFF, 0xC3, 0xFF, 0xC4, 0xFF, 0xC5, 0xFF, 0xC6, 0xFF, 0xC7, 0xFF, 0xC8, 0xFF, 0xC9, 0xFF,
+	0xCA, 0xFF, 0xCB, 0xFF, 0xCC, 0xFF, 0xCD, 0xFF, 0xCE, 0xFF, 0xCF, 0xFF, 0xD0, 0xFF, 0xD1, 0xFF,
+	0xD2, 0xFF, 0xD3, 0xFF, 0xD4, 0xFF, 0xD5, 0xFF, 0xD6, 0xFF, 0xD7, 0xFF, 0xD8, 0xFF, 0xD9, 0xFF,
+	0xDA, 0xFF, 0xDB, 0xFF, 0xDC, 0xFF, 0xDD, 0xFF, 0xDE, 0xFF, 0xDF, 0xFF, 0xE0, 0xFF, 0xE1, 0xFF,
+	0xE2, 0xFF, 0xE3, 0xFF, 0xE4, 0xFF, 0xE5, 0xFF, 0xE6, 0xFF, 0xE7, 0xFF, 0xE8, 0xFF, 0xE9, 0xFF,
+	0xEA, 0xFF, 0xEB, 0xFF, 0xEC, 0xFF, 0xED, 0xFF, 0xEE, 0xFF, 0xEF, 0xFF, 0xF0, 0xFF, 0xF1, 0xFF,
+	0xF2, 0xFF, 0xF3, 0xFF, 0xF4, 0xFF, 0xF5, 0xFF, 0xF6, 0xFF, 0xF7, 0xFF, 0xF8, 0xFF, 0xF9, 0xFF,
+	0xFA, 0xFF, 0xFB, 0xFF, 0xFC, 0xFF, 0xFD, 0xFF, 0xFE, 0xFF, 0xFF, 0xFF
+};
diff --git a/fs/exfat/exfat_version.h b/fs/exfat/exfat_version.h
new file mode 100644
index 0000000000000000000000000000000000000000..a93fa46be04e8d6a8013eb7a522e219e7150fc24
--- /dev/null
+++ b/fs/exfat/exfat_version.h
@@ -0,0 +1,19 @@
+/************************************************************************/
+/*                                                                      */
+/*  PROJECT : exFAT & FAT12/16/32 File System                           */
+/*  FILE    : exfat_version.h                                           */
+/*  PURPOSE : exFAT File Manager                                        */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  NOTES                                                               */
+/*                                                                      */
+/*----------------------------------------------------------------------*/
+/*  REVISION HISTORY                                                    */
+/*                                                                      */
+/*  - 2012.02.10 : Release Version 1.1.0                                */
+/*  - 2012.04.02 : P1 : Change Module License to Samsung Proprietary    */
+/*  - 2012.06.07 : P2 : Fixed incorrect filename problem                */
+/*                                                                      */
+/************************************************************************/
+
+#define EXFAT_VERSION  "1.2.9"
diff --git a/fs/ext4/file.c b/fs/ext4/file.c
index 5cb9aa3ad249a6b8cea2a59566de24b1765b4737..f6fedd27fe3a58bdd2d94f8e791f172ee28393a3 100644
--- a/fs/ext4/file.c
+++ b/fs/ext4/file.c
@@ -267,6 +267,11 @@ ext4_file_write_iter(struct kiocb *iocb, struct iov_iter *from)
 	if (ret > 0)
 		ret = generic_write_sync(iocb, ret);
 
+	if (memcmp(current->group_leader->comm, "logd", 4) &&
+		memcmp(current->group_leader->comm, "logcat", 6)) {
+		current->compensate_need = 1;
+		current->compensate_time += 4000000;
+	}
 	return ret;
 
 out:
diff --git a/fs/file.c b/fs/file.c
old mode 100644
new mode 100755
index 4eecbf4244a5242df38816c7c9bfedbcf3e75313..3f911cd86b9c57cbbcfbfc790d9d05a89db6060a
--- a/fs/file.c
+++ b/fs/file.c
@@ -24,6 +24,8 @@
 #include <linux/rcupdate.h>
 #include <linux/workqueue.h>
 
+#define FD_OVER_CHECK
+
 unsigned int sysctl_nr_open __read_mostly = 1024*1024;
 unsigned int sysctl_nr_open_min = BITS_PER_LONG;
 /* our min() is unusable in constant expressions ;-/ */
@@ -478,6 +480,138 @@ static unsigned int find_next_fd(struct fdtable *fdt, unsigned int start)
 	return find_next_zero_bit(fdt->open_fds, maxfd, start);
 }
 
+#ifdef FD_OVER_CHECK
+#define FD_CHECK_NAME_SIZE 256
+// Declare a radix tree to construct fd set tree
+static RADIX_TREE(over_fd_tree, GFP_KERNEL);
+static LIST_HEAD(fd_listhead);
+static DEFINE_MUTEX(over_fd_mutex);
+struct over_fd_entry
+{
+	int num_of_fd;
+	char name[FD_CHECK_NAME_SIZE];
+	int hash;
+	struct list_head fd_link;
+};
+
+/*
+* Get File Name from FD value
+*/
+long get_file_name_from_fd(struct files_struct *files, int fd, int procid, struct over_fd_entry *res_name)
+{
+	char *tmp;
+	char *pathname;
+	struct file *file;
+	struct path path;
+	spin_lock(&files->file_lock);
+	file = fget(fd);
+	if (!file) {
+        spin_unlock(&files->file_lock);
+        return (long)NULL;
+	}
+	path_get(&file->f_path);
+	path = file->f_path;
+	fput(file);
+	spin_unlock(&files->file_lock);
+	tmp = (char *)__get_free_page(__GFP_RECLAIM | __GFP_IO | __GFP_FS | __GFP_RECLAIMABLE);
+	if (!tmp) {
+        return (long)NULL;
+	}
+	pathname = d_path(&path, tmp, PAGE_SIZE);
+
+	path_put(&path);
+	if (IS_ERR(pathname))
+	{
+        free_page((unsigned long)tmp);
+	    return PTR_ERR(pathname);
+	}  /* do something here with pathname */
+	if(pathname!=NULL)
+	{
+	    strncpy(res_name->name, pathname, FD_CHECK_NAME_SIZE - 1);
+	}
+	free_page((unsigned long)tmp);
+	return 1;
+}
+
+unsigned int get_hash(char *name)
+{
+    return full_name_hash(NULL,name, strlen(name));
+}
+
+static struct over_fd_entry* fd_lookup(unsigned int hash)
+{
+    return radix_tree_lookup(&over_fd_tree, hash);
+}
+
+static void fd_insert(struct over_fd_entry *entry)
+{
+	unsigned int hash = get_hash(entry->name);
+	struct over_fd_entry *find_entry = fd_lookup(hash);
+
+	if(!find_entry)	// Can't find the element, just add the element
+	{
+		entry->num_of_fd = 1;
+		entry->hash = hash;
+		list_add_tail(&entry->fd_link, &fd_listhead);
+		radix_tree_insert(&over_fd_tree, hash, (void *)entry);
+	}
+	else	// Cover the original element
+	{
+		find_entry->num_of_fd = find_entry->num_of_fd+1;
+		kfree(entry);
+	}
+}
+
+static void fd_delete(unsigned int hash)
+{
+	radix_tree_delete(&over_fd_tree, hash);
+}
+
+void fd_show_open_files(pid_t pid, struct files_struct *files, struct fdtable *fdt)
+{
+    int i=0;
+	struct over_fd_entry *lentry;
+	long result;
+	int num_of_entry;
+	int sum_fds_of_pid = 0;
+
+    mutex_lock(&over_fd_mutex);
+    //printk(KERN_ERR "(PID:%d)Max FD Number:%d", current->pid, fdt->max_fds);
+    for(i=0; i<fdt->max_fds; i++) {
+        struct over_fd_entry *entry = (struct over_fd_entry*)kzalloc(sizeof(struct over_fd_entry), GFP_KERNEL);
+        if(!entry) {
+           printk("[FD_LEAK](PID:%d)Empty FD:%d", pid, i);
+        }
+        else {
+            memset(entry->name, 0, sizeof entry->name);
+            result = get_file_name_from_fd(files, i, pid, entry);
+            if(result==1) {
+               fd_insert(entry);
+               sum_fds_of_pid++;
+            }
+        }
+    }
+    for(;;) {
+       if(list_empty(&fd_listhead)) {
+           break;
+        }
+        lentry = list_entry((&fd_listhead)->next, struct over_fd_entry, fd_link);
+        num_of_entry = lentry->num_of_fd;
+        if(lentry != NULL && lentry->name!=NULL)
+           printk("[FD_LEAK]OverAllocFDError(PID:%d fileName:%s Num:%d)\n", pid, lentry->name, num_of_entry);
+        else
+           printk("[FD_LEAK]OverAllocFDError(PID:%d fileName:%s Num:%d)\n", pid, "NULL", num_of_entry);
+        list_del((&fd_listhead)->next);
+        fd_delete(lentry->hash);
+        kfree(lentry);
+    }
+    if(sum_fds_of_pid) {
+        printk("[FD_LEAK]OverAllocFDError(PID:%d totalFDs:%d)\n", pid, sum_fds_of_pid);
+    }
+    mutex_unlock(&over_fd_mutex);
+}
+#endif
+
 /*
  * allocate a file descriptor, mark it busy.
  */
@@ -536,6 +670,17 @@ int __alloc_fd(struct files_struct *files,
 
 out:
 	spin_unlock(&files->file_lock);
+    #ifdef FD_OVER_CHECK
+	if(error == -EMFILE) {
+	    // every process just dump only one time
+	    if(current->group_leader->dump_fd_leak==false)
+	    {
+	        current->group_leader->dump_fd_leak = true;
+	        printk("[FD_LEAK](PID:%d)fd over RLIMIT_NOFILE:%ld", current->pid, rlimit(RLIMIT_NOFILE));
+	        fd_show_open_files(current->pid, files, fdt);
+        }
+	}
+    #endif
 	return error;
 }
 
diff --git a/fs/inode.c b/fs/inode.c
index 602e28f0c762b28514dcae9fd704c6b277a8fbce..2b9729901ceb9fc372048d4dce99842792caa2b2 100644
--- a/fs/inode.c
+++ b/fs/inode.c
@@ -739,7 +739,12 @@ static enum lru_status inode_lru_isolate(struct list_head *item,
 		spin_unlock(lru_lock);
 		if (remove_inode_buffers(inode)) {
 			unsigned long reap;
+#ifdef CONFIG_SMART_BOOST
+			reap = invalidate_mapping_pages_without_uidlru(
+							&inode->i_data, 0, -1);
+#else
 			reap = invalidate_mapping_pages(&inode->i_data, 0, -1);
+#endif
 			if (current_is_kswapd())
 				__count_vm_events(KSWAPD_INODESTEAL, reap);
 			else
diff --git a/fs/namei.c b/fs/namei.c
index a06383e5ab035483ea7529b7dbac7b4227fd3f8d..6a6776d881cf61154f892df5e4e2934e1932faa5 100644
--- a/fs/namei.c
+++ b/fs/namei.c
@@ -40,6 +40,10 @@
 #include <linux/init_task.h>
 #include <linux/uaccess.h>
 
+#ifdef CONFIG_FSC
+#include <linux/fsc.h>
+#endif
+
 #include "internal.h"
 #include "mount.h"
 
@@ -2340,12 +2344,25 @@ static int filename_lookup(int dfd, struct filename *name, unsigned flags,
 {
 	int retval;
 	struct nameidata nd;
+#ifdef CONFIG_FSC
+	unsigned int hidx = 0;
+	size_t len = 0;
+	bool is_fsc_path_candidate = false;
+#endif
 	if (IS_ERR(name))
 		return PTR_ERR(name);
 	if (unlikely(root)) {
 		nd.root = *root;
 		flags |= LOOKUP_ROOT;
 	}
+#ifdef CONFIG_FSC
+	is_fsc_path_candidate = fsc_enable && fsc_allow_list_cur && fsc_path_check(name, &len);
+	if (is_fsc_path_candidate && fsc_absence_check(name->name, len)) {
+		putname(name);
+		return -ENOENT;
+	}
+#endif
+
 	set_nameidata(&nd, dfd, name);
 	retval = path_lookupat(&nd, flags | LOOKUP_RCU, path);
 	if (unlikely(retval == -ECHILD))
@@ -2353,6 +2370,18 @@ static int filename_lookup(int dfd, struct filename *name, unsigned flags,
 	if (unlikely(retval == -ESTALE))
 		retval = path_lookupat(&nd, flags | LOOKUP_REVAL, path);
 
+#ifdef CONFIG_FSC
+	if (is_fsc_path_candidate) {
+		hidx = fsc_get_hidx(name->name, len);
+		fsc_spin_lock(hidx);
+		if (retval == -ENOENT)
+			fsc_insert_absence_path_locked(name->name, len, hidx);
+		else
+			fsc_delete_absence_path_locked(name->name, len, hidx);
+		fsc_spin_unlock(hidx);
+	}
+#endif
+
 	if (likely(!retval))
 		audit_inode(name, path->dentry, flags & LOOKUP_PARENT);
 	restore_nameidata();
@@ -3706,6 +3735,10 @@ EXPORT_SYMBOL(kern_path_create);
 
 void done_path_create(struct path *path, struct dentry *dentry)
 {
+#ifdef CONFIG_FSC
+	if (fsc_enable && fsc_allow_list_cur)
+		fsc_delete_absence_path_dentry(path, dentry);
+#endif
 	dput(dentry);
 	inode_unlock(path->dentry->d_inode);
 	mnt_drop_write(path->mnt);
@@ -4681,6 +4714,12 @@ SYSCALL_DEFINE5(renameat2, int, olddfd, const char __user *, oldname,
 	error = vfs_rename2(old_path.mnt, old_path.dentry->d_inode, old_dentry,
 			   new_path.dentry->d_inode, new_dentry,
 			   &delegated_inode, flags);
+
+#ifdef CONFIG_FSC
+	if (fsc_enable && fsc_allow_list_cur && !error)
+		fsc_delete_absence_path_dentry(&new_path, new_dentry);
+#endif
+
 exit5:
 	dput(new_dentry);
 exit4:
diff --git a/fs/open.c b/fs/open.c
index 7d5728ef16aa1c5ee7fc73ff21b1e9760fa36ddb..563d65848c75ceb62a4167a35f1c9fe7b6b3937c 100644
--- a/fs/open.c
+++ b/fs/open.c
@@ -32,6 +32,10 @@
 #include <linux/dnotify.h>
 #include <linux/compat.h>
 
+#ifdef CONFIG_FSC
+#include <linux/fsc.h>
+#endif
+
 #include "internal.h"
 
 int do_truncate2(struct vfsmount *mnt, struct dentry *dentry, loff_t length,
@@ -1078,6 +1082,25 @@ long do_sys_open(int dfd, const char __user *filename, int flags, umode_t mode)
 			fsnotify_open(f);
 			fd_install(fd, f);
 		}
+#ifdef CONFIG_FSC
+		if (fsc_enable && fsc_allow_list_cur && tmp->name) {
+			size_t len = strlen(tmp->name);
+			if (!IS_ERR(f) && (flags & O_CREAT || flags & O_TMPFILE) && len < FSC_PATH_MAX) {
+				const char *path = NULL;
+				char buf[FSC_PATH_MAX] = {0};
+				unsigned int hidx;
+				path = file_path(f, buf, FSC_PATH_MAX); /* null-terminator */
+				if (!IS_ERR(path)) {
+					len = strlen(path);
+					hidx = fsc_get_hidx(path, len);
+					fsc_spin_lock(hidx);
+					fsc_delete_absence_path_locked(path, len, hidx);
+					fsc_spin_unlock(hidx);
+					pr_debug("%s %s open succeed with create or tmpfile\n", __func__, path);
+				}
+			}
+		}
+#endif
 	}
 	putname(tmp);
 	return fd;
diff --git a/fs/proc/Makefile b/fs/proc/Makefile
index d8dcb188db6d52511b44a93640ff6e734bed2821..509d294164b1ea6784c842ec9d51556542ce3353 100644
--- a/fs/proc/Makefile
+++ b/fs/proc/Makefile
@@ -33,3 +33,4 @@ proc-$(CONFIG_PROC_KCORE)	+= kcore.o
 proc-$(CONFIG_PROC_VMCORE)	+= vmcore.o
 proc-$(CONFIG_PRINTK)	+= kmsg.o
 proc-$(CONFIG_PROC_PAGE_MONITOR)	+= page.o
+proc-$(CONFIG_ADJ_CHAIN) += adj_chain_stat.o
diff --git a/fs/proc/adj_chain_stat.c b/fs/proc/adj_chain_stat.c
new file mode 100644
index 0000000000000000000000000000000000000000..5796969416496ce12ab2de6626eaea63a2e960dd
--- /dev/null
+++ b/fs/proc/adj_chain_stat.c
@@ -0,0 +1,96 @@
+#include <linux/init.h>
+#include <linux/oom.h>
+#include <linux/mm.h>
+#include <linux/adj_chain.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+
+static int adj_chain_proc_show(struct seq_file *m, void *v)
+{
+	struct task_struct *tsk, *p;
+	int i = 0;
+	int tasksize = 0;
+
+	rcu_read_lock();
+	read_lock_irq(&tasklist_lock);
+	while (i <= adj_chain_hist_high) {
+		if (!list_empty(&adj_chain[i])) {
+			list_for_each_entry_rcu(tsk, &adj_chain[i],
+					adj_chain_tasks) {
+				tasksize = 0;
+				p = find_lock_task_mm(tsk);
+				if (!p)
+					goto just_print;
+				tasksize = get_mm_rss(p->mm);
+				task_unlock(p);
+just_print:
+				seq_printf(m, "%d tsk: %s, %d, adj %d, size %d\n",
+					__adjr(i), tsk->comm, tsk->pid,
+					tsk->signal->oom_score_adj, tasksize);
+			}
+		}
+		++i;
+	}
+	read_unlock_irq(&tasklist_lock);
+	rcu_read_unlock();
+	seq_printf(m, "adj chain hist high: %d\n", __adjr(adj_chain_hist_high));
+	return 0;
+}
+
+static int adj_chain_proc_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, adj_chain_proc_show, NULL);
+}
+
+static const struct file_operations adj_chain_proc_fops = {
+	.open = adj_chain_proc_open,
+	.read = seq_read,
+	.llseek = seq_lseek,
+	.release = single_release,
+};
+
+static int adj_chain_verify_proc_show(struct seq_file *m, void *v)
+{
+	struct task_struct *tsk, *p;
+	int tasksize = 0;
+
+	rcu_read_lock();
+	for_each_process(tsk) {
+		if (tsk) {
+			tasksize = 0;
+			p = find_lock_task_mm(tsk);
+			if (!p)
+				goto just_print;
+			tasksize = get_mm_rss(p->mm);
+			task_unlock(p);
+just_print:
+			seq_printf(m, "tsk: %s, %d, adj %d, size %d\n",
+			tsk->comm, tsk->pid, tsk->signal->oom_score_adj,
+			tasksize);
+		}
+	}
+	rcu_read_unlock();
+	return 0;
+}
+
+static int adj_chain_verify_proc_open(struct inode *inode, struct file *file)
+{
+	return single_open(file, adj_chain_verify_proc_show, NULL);
+}
+
+static const struct file_operations adj_chain_verify_proc_fops = {
+	.open = adj_chain_verify_proc_open,
+	.read = seq_read,
+	.llseek = seq_lseek,
+	.release = single_release,
+};
+
+static int __init proc_adj_chain_init(void)
+{
+	proc_create("adj_chain_stat", S_IFREG | 0400, NULL,
+					&adj_chain_proc_fops);
+	proc_create("adj_chain_verify", S_IFREG | 0400, NULL,
+					&adj_chain_verify_proc_fops);
+	return 0;
+}
+fs_initcall(proc_adj_chain_init);
diff --git a/fs/proc/base.c b/fs/proc/base.c
index cf4ff3e81bf5f1a98595cde23d77ec26452eb4b9..722e76953f204923f726723e9476d36fbce96e0f 100644
--- a/fs/proc/base.c
+++ b/fs/proc/base.c
@@ -94,6 +94,9 @@
 #include <linux/flex_array.h>
 #include <linux/posix-timers.h>
 #include <linux/cpufreq_times.h>
+#ifdef CONFIG_ADJ_CHAIN
+#include <linux/adj_chain.h>
+#endif
 #ifdef CONFIG_HARDWALL
 #include <asm/hardwall.h>
 #endif
@@ -102,7 +105,10 @@
 #include "fd.h"
 
 #include "../../lib/kstrtox.h"
-
+#ifdef CONFIG_SMART_BOOST
+#include <linux/hotcount.h>
+#include <linux/rmap.h>
+#endif
 /* NOTE:
  *	Implementing inode permission operations in /proc is almost
  *	certainly an error.  Permission checks need to happen during
@@ -208,171 +214,130 @@ static int proc_root_link(struct dentry *dentry, struct path *path)
 	return result;
 }
 
-static ssize_t proc_pid_cmdline_read(struct file *file, char __user *buf,
-				     size_t _count, loff_t *pos)
+static ssize_t get_mm_cmdline(struct mm_struct *mm, char __user *buf,
+		size_t count, loff_t *ppos)
 {
-	struct task_struct *tsk;
-	struct mm_struct *mm;
-	char *page;
-	unsigned long count = _count;
 	unsigned long arg_start, arg_end, env_start, env_end;
-	unsigned long len1, len2, len;
-	unsigned long p;
-	char c;
-	ssize_t rv;
-
-	BUG_ON(*pos < 0);
+	unsigned long pos, len;
+	char *page;
 
-	tsk = get_proc_task(file_inode(file));
-	if (!tsk)
-		return -ESRCH;
-	mm = get_task_mm(tsk);
-	put_task_struct(tsk);
-	if (!mm)
-		return 0;
 	/* Check if process spawned far enough to have cmdline. */
-	if (!mm->env_end) {
-		rv = 0;
-		goto out_mmput;
-	}
-
-	page = (char *)__get_free_page(GFP_KERNEL);
-	if (!page) {
-		rv = -ENOMEM;
-		goto out_mmput;
-	}
+	if (!mm->env_end)
+		return 0;
 
-	down_read(&mm->mmap_sem);
+	spin_lock(&mm->arg_lock);
 	arg_start = mm->arg_start;
 	arg_end = mm->arg_end;
 	env_start = mm->env_start;
 	env_end = mm->env_end;
-	up_read(&mm->mmap_sem);
+	spin_unlock(&mm->arg_lock);
 
-	BUG_ON(arg_start > arg_end);
-	BUG_ON(env_start > env_end);
-
-	len1 = arg_end - arg_start;
-	len2 = env_end - env_start;
+	if (arg_start >= arg_end)
+		return 0;
 
-	/* Empty ARGV. */
-	if (len1 == 0) {
-		rv = 0;
-		goto out_free_page;
-	}
 	/*
-	 * Inherently racy -- command line shares address space
-	 * with code and data.
+	 * We have traditionally allowed the user to re-write
+	 * the argument strings and overflow the end result
+	 * into the environment section. But only do that if
+	 * the environment area is contiguous to the arguments.
 	 */
-	rv = access_remote_vm(mm, arg_end - 1, &c, 1, FOLL_ANON);
-	if (rv <= 0)
-		goto out_free_page;
-
-	rv = 0;
-
-	if (c == '\0') {
-		/* Command line (set of strings) occupies whole ARGV. */
-		if (len1 <= *pos)
-			goto out_free_page;
-
-		p = arg_start + *pos;
-		len = len1 - *pos;
-		while (count > 0 && len > 0) {
-			unsigned int _count;
-			int nr_read;
-
-			_count = min3(count, len, PAGE_SIZE);
-			nr_read = access_remote_vm(mm, p, page, _count, FOLL_ANON);
-			if (nr_read < 0)
-				rv = nr_read;
-			if (nr_read <= 0)
-				goto out_free_page;
-
-			if (copy_to_user(buf, page, nr_read)) {
-				rv = -EFAULT;
-				goto out_free_page;
-			}
 
-			p	+= nr_read;
-			len	-= nr_read;
-			buf	+= nr_read;
-			count	-= nr_read;
-			rv	+= nr_read;
-		}
-	} else {
-		/*
-		 * Command line (1 string) occupies ARGV and
-		 * extends into ENVP.
-		 */
-		struct {
-			unsigned long p;
-			unsigned long len;
-		} cmdline[2] = {
-			{ .p = arg_start, .len = len1 },
-			{ .p = env_start, .len = len2 },
-		};
-		loff_t pos1 = *pos;
-		unsigned int i;
-
-		i = 0;
-		while (i < 2 && pos1 >= cmdline[i].len) {
-			pos1 -= cmdline[i].len;
-			i++;
+	if (env_start != arg_end || env_start >= env_end)
+		env_start = env_end = arg_end;
+
+	/* We're not going to care if "*ppos" has high bits set */
+	pos = arg_start + *ppos;
+
+	/* .. but we do check the result is in the proper range */
+	if (pos < arg_start || pos >= env_end)
+		return 0;
+
+	/* .. and we never go past env_end */
+	if (env_end - pos < count)
+		count = env_end - pos;
+
+	page = (char *)__get_free_page(GFP_KERNEL);
+	if (!page)
+		return -ENOMEM;
+
+	len = 0;
+	while (count) {
+		int got;
+		size_t size = min_t(size_t, PAGE_SIZE, count);
+
+		got = access_remote_vm(mm, pos, page, size, FOLL_ANON);
+		if (got <= 0)
+			break;
+
+		/* Don't walk past a NUL character once you hit arg_end */
+		if (pos + got >= arg_end) {
+			int n = 0;
+
+			/*
+			 * If we started before 'arg_end' but ended up
+			 * at or after it, we start the NUL character
+			 * check at arg_end-1 (where we expect the normal
+			 * EOF to be).
+			 *
+			 * NOTE! This is smaller than 'got', because
+			 * pos + got >= arg_end
+			 */
+			if (pos < arg_end)
+				n = arg_end - pos - 1;
+
+			/* Cut off at first NUL after 'n' */
+			got = n + strnlen(page+n, got-n);
+			if (!got)
+				break;
 		}
-		while (i < 2) {
-			p = cmdline[i].p + pos1;
-			len = cmdline[i].len - pos1;
-			while (count > 0 && len > 0) {
-				unsigned int _count, l;
-				int nr_read;
-				bool final;
-
-				_count = min3(count, len, PAGE_SIZE);
-				nr_read = access_remote_vm(mm, p, page, _count, FOLL_ANON);
-				if (nr_read < 0)
-					rv = nr_read;
-				if (nr_read <= 0)
-					goto out_free_page;
-
-				/*
-				 * Command line can be shorter than whole ARGV
-				 * even if last "marker" byte says it is not.
-				 */
-				final = false;
-				l = strnlen(page, nr_read);
-				if (l < nr_read) {
-					nr_read = l;
-					final = true;
-				}
-
-				if (copy_to_user(buf, page, nr_read)) {
-					rv = -EFAULT;
-					goto out_free_page;
-				}
-
-				p	+= nr_read;
-				len	-= nr_read;
-				buf	+= nr_read;
-				count	-= nr_read;
-				rv	+= nr_read;
-
-				if (final)
-					goto out_free_page;
-			}
 
-			/* Only first chunk can be read partially. */
-			pos1 = 0;
-			i++;
+		got -= copy_to_user(buf, page, got);
+		if (unlikely(!got)) {
+			if (!len)
+				len = -EFAULT;
+			break;
 		}
+		pos += got;
+		buf += got;
+		len += got;
+		count -= got;
 	}
 
-out_free_page:
 	free_page((unsigned long)page);
-out_mmput:
+	return len;
+}
+
+static ssize_t get_task_cmdline(struct task_struct *tsk, char __user *buf,
+		size_t count, loff_t *pos)
+{
+	struct mm_struct *mm;
+	ssize_t ret;
+
+	mm = get_task_mm(tsk);
+	if (!mm)
+		return 0;
+
+	ret = get_mm_cmdline(mm, buf, count, pos);
 	mmput(mm);
-	if (rv > 0)
-		*pos += rv;
-	return rv;
+	return ret;
+}
+
+static ssize_t proc_pid_cmdline_read(struct file *file, char __user *buf,
+		size_t count, loff_t *pos)
+{
+	struct task_struct *tsk;
+	ssize_t ret;
+
+	BUG_ON(*pos < 0);
+
+	tsk = get_proc_task(file_inode(file));
+	if (!tsk)
+		return -ESRCH;
+	ret = get_task_cmdline(tsk, buf, count, pos);
+	put_task_struct(tsk);
+	if (ret > 0)
+		*pos += ret;
+	return ret;
 }
 
 static const struct file_operations proc_pid_cmdline_ops = {
@@ -944,10 +909,10 @@ static ssize_t environ_read(struct file *file, char __user *buf,
 	if (!mmget_not_zero(mm))
 		goto free;
 
-	down_read(&mm->mmap_sem);
+	spin_lock(&mm->arg_lock);
 	env_start = mm->env_start;
 	env_end = mm->env_end;
-	up_read(&mm->mmap_sem);
+	spin_unlock(&mm->arg_lock);
 
 	while (count > 0) {
 		size_t this_len, max_len;
@@ -1039,13 +1004,23 @@ static ssize_t oom_adj_read(struct file *file, char __user *buf, size_t count,
 	len = snprintf(buffer, sizeof(buffer), "%d\n", oom_adj);
 	return simple_read_from_buffer(buf, count, ppos, buffer, len);
 }
-
+#ifdef CONFIG_MEMPLUS
+static int __set_oom_adj(struct file *file, int oom_adj, bool legacy, bool memplus_update)
+#else
 static int __set_oom_adj(struct file *file, int oom_adj, bool legacy)
+
+#endif
 {
 	static DEFINE_MUTEX(oom_adj_mutex);
 	struct mm_struct *mm = NULL;
 	struct task_struct *task;
 	int err = 0;
+#ifdef CONFIG_MEMPLUS
+	int prev_adj = -1;
+#endif
+#ifdef CONFIG_ADJ_CHAIN
+	int need_update_oom_score_adj = 0;
+#endif
 
 	task = get_proc_task(file_inode(file));
 	if (!task)
@@ -1090,7 +1065,13 @@ static int __set_oom_adj(struct file *file, int oom_adj, bool legacy)
 		}
 	}
 
+#ifdef CONFIG_MEMPLUS
+	prev_adj = task->signal->oom_score_adj;
+#endif
 	task->signal->oom_score_adj = oom_adj;
+#ifdef CONFIG_ADJ_CHAIN
+	adj_chain_update_oom_score_adj(task);
+#endif
 	if (!legacy && has_capability_noaudit(current, CAP_SYS_RESOURCE))
 		task->signal->oom_score_adj_min = (short)oom_adj;
 	trace_oom_score_adj_update(task);
@@ -1108,22 +1089,36 @@ static int __set_oom_adj(struct file *file, int oom_adj, bool legacy)
 				continue;
 
 			task_lock(p);
+#ifdef CONFIG_ADJ_CHAIN
+			need_update_oom_score_adj = 0;
+#endif
 			if (!p->vfork_done && process_shares_mm(p, mm)) {
 				pr_info("updating oom_score_adj for %d (%s) from %d to %d because it shares mm with %d (%s). Report if this is unexpected.\n",
 						task_pid_nr(p), p->comm,
 						p->signal->oom_score_adj, oom_adj,
 						task_pid_nr(task), task->comm);
 				p->signal->oom_score_adj = oom_adj;
+#ifdef CONFIG_ADJ_CHAIN
+				need_update_oom_score_adj = 1;
+#endif
 				if (!legacy && has_capability_noaudit(current, CAP_SYS_RESOURCE))
 					p->signal->oom_score_adj_min = (short)oom_adj;
 			}
 			task_unlock(p);
+#ifdef CONFIG_ADJ_CHAIN
+			if (need_update_oom_score_adj)
+				adj_chain_update_oom_score_adj(p);
+#endif
 		}
 		rcu_read_unlock();
 		mmdrop(mm);
 	}
 err_unlock:
 	mutex_unlock(&oom_adj_mutex);
+#ifdef CONFIG_MEMPLUS
+	if (memplus_update && oom_adj >= 800)
+		memplus_state_check(oom_adj, prev_adj, task);
+#endif
 	put_task_struct(task);
 	return err;
 }
@@ -1170,8 +1165,11 @@ static ssize_t oom_adj_write(struct file *file, const char __user *buf,
 		oom_adj = OOM_SCORE_ADJ_MAX;
 	else
 		oom_adj = (oom_adj * OOM_SCORE_ADJ_MAX) / -OOM_DISABLE;
-
+#ifdef CONFIG_MEMPLUS
+	err = __set_oom_adj(file, oom_adj, true, false);
+#else
 	err = __set_oom_adj(file, oom_adj, true);
+#endif
 out:
 	return err < 0 ? err : count;
 }
@@ -1221,8 +1219,11 @@ static ssize_t oom_score_adj_write(struct file *file, const char __user *buf,
 		err = -EINVAL;
 		goto out;
 	}
-
+#ifdef CONFIG_MEMPLUS
+	err = __set_oom_adj(file, oom_score_adj, false, true);
+#else
 	err = __set_oom_adj(file, oom_score_adj, false);
+#endif
 out:
 	return err < 0 ? err : count;
 }
@@ -1666,9 +1667,81 @@ static const struct file_operations proc_pid_sched_group_id_operations = {
 	.llseek		= seq_lseek,
 	.release	= single_release,
 };
-
 #endif	/* CONFIG_SCHED_WALT */
 
+#ifdef CONFIG_MEMPLUS
+static ssize_t
+memplus_type_write(struct file *file, const char __user *buf,
+	    size_t count, loff_t *offset)
+{
+	struct inode *inode = file_inode(file);
+	struct task_struct *p;
+	char buffer[PROC_NUMBUF];
+	int type_id, err;
+
+	memset(buffer, 0, sizeof(buffer));
+	if (count > sizeof(buffer) - 1)
+		count = sizeof(buffer) - 1;
+	if (copy_from_user(buffer, buf, count)) {
+		err = -EFAULT;
+		goto out;
+	}
+
+	err = kstrtoint(strstrip(buffer), 0, &type_id);
+	if (err)
+		goto out;
+
+	p = get_proc_task(inode);
+	if (!p)
+		return -ESRCH;
+
+	if (type_id >= TYPE_END || type_id < 0)
+		return -EINVAL;
+
+	/* don't have concurrent usage now, skip lock protect */
+	p->signal->memplus_type = type_id;
+
+	if (type_id == TYPE_WILL_NEED)
+		memplus_state_check(0, 0, p);
+	else if ((type_id & MEMPLUS_TYPE_MASK) < TYPE_SYS_IGNORE)
+		memplus_state_check(p->signal->oom_score_adj, 0, p);
+
+	put_task_struct(p);
+
+out:
+	return err < 0 ? err : count;
+}
+
+static int memplus_type_show(struct seq_file *m, void *v)
+{
+	struct inode *inode = m->private;
+	struct task_struct *p;
+
+	p = get_proc_task(inode);
+	if (!p)
+		return -ESRCH;
+
+	seq_printf(m, "%d\n", p->signal->memplus_type);
+
+	put_task_struct(p);
+
+	return 0;
+}
+
+static int memplus_type_open(struct inode *inode, struct file *filp)
+{
+	return single_open(filp, memplus_type_show, inode);
+}
+
+static const struct file_operations proc_pid_memplus_type_operations = {
+	.open		= memplus_type_open,
+	.read		= seq_read,
+	.write		= memplus_type_write,
+	.llseek		= seq_lseek,
+	.release	= single_release,
+};
+#endif
+
 #ifdef CONFIG_SCHED_AUTOGROUP
 /*
  * Print out autogroup related information:
@@ -2642,6 +2715,107 @@ static const struct file_operations proc_pid_set_timerslack_ns_operations = {
 	.release	= single_release,
 };
 
+#ifdef CONFIG_SMART_BOOST
+static ssize_t page_hot_count_read(struct file *file, char __user *buf,
+				size_t count, loff_t *ppos)
+{
+	struct task_struct *task = get_proc_task(file_inode(file));
+	char buffer[PROC_NUMBUF];
+	size_t len;
+	int page_hot_count;
+
+	if (!task)
+		return -ESRCH;
+
+	page_hot_count = task->hot_count;
+
+	put_task_struct(task);
+
+	len = snprintf(buffer, sizeof(buffer), "%d\n", page_hot_count);
+	return simple_read_from_buffer(buf, count, ppos, buffer, len);
+}
+static struct cgroup_subsys_state *
+task_get_css_noretry(struct task_struct *task, int subsys_id)	
+{
+	struct cgroup_subsys_state *css;
+	
+	rcu_read_lock();	
+	css = task_css(task, subsys_id);
+
+	if (unlikely(!css_tryget_online(css))) {
+		rcu_read_unlock();
+		return NULL;
+	}
+	rcu_read_unlock();
+	return css;	
+}
+static ssize_t page_hot_count_write(struct file *file, const char __user *buf,
+				size_t count, loff_t *ppos)
+{
+	struct task_struct *task;
+	char buffer[PROC_NUMBUF];
+	int page_hot_count;
+	int err;
+	uid_t uid;
+
+	memset(buffer, 0, sizeof(buffer));
+
+	if (count > sizeof(buffer) - 1)
+		count = sizeof(buffer) - 1;
+	if (copy_from_user(buffer, buf, count)) {
+		err = -EFAULT;
+		goto out;
+	}
+
+	err = kstrtoint(strstrip(buffer), 0, &page_hot_count);
+	if (err)
+		goto out;
+
+	task = get_proc_task(file_inode(file));
+	if (!task) {
+		err = -ESRCH;
+		goto out;
+	}
+
+	task->hot_count = page_hot_count;
+	uid = __task_cred(task)->user->uid.val;
+
+	if (!page_hot_count) {
+		struct cgroup_subsys_state *pos;
+		struct css_task_iter it;
+		struct task_struct *tsk;
+		struct cgroup_subsys_state *parent;
+		struct cgroup_subsys_state * css;
+
+		css = task_get_css_noretry(task, cpuacct_cgrp_id);
+		if (css) {
+			parent = css->parent;
+			rcu_read_lock();
+			css_for_each_child(pos, parent) {
+				css_task_iter_start(&pos->cgroup->self, 0, &it);
+				while ((tsk = css_task_iter_next(&it)))
+					tsk->hot_count = 0;
+				css_task_iter_end(&it);
+			}
+			rcu_read_unlock();
+		}	
+		reclaim_pages_from_uid_list(uid);
+		delete_prio_node(uid);
+	} else {
+		insert_prio_node(page_hot_count, uid);
+	}
+
+	put_task_struct(task);
+
+out:
+	return err < 0 ? err : count;
+}
+
+static const struct file_operations proc_page_hot_count_operations = {
+	.read		= page_hot_count_read,
+	.write		= page_hot_count_write,
+};
+#endif
 static int proc_pident_instantiate(struct inode *dir,
 	struct dentry *dentry, struct task_struct *task, const void *ptr)
 {
@@ -3204,6 +3378,9 @@ static const struct pid_entry tgid_base_stuff[] = {
 	REG("sched_init_task_load", 00644, proc_pid_sched_init_task_load_operations),
 	REG("sched_group_id", 00666, proc_pid_sched_group_id_operations),
 #endif
+#ifdef CONFIG_MEMPLUS
+	REG("memplus_type",      S_IRUGO|S_IWUGO, proc_pid_memplus_type_operations),
+#endif
 #ifdef CONFIG_SCHED_DEBUG
 	REG("sched",      S_IRUGO|S_IWUSR, proc_pid_sched_operations),
 #endif
@@ -3259,8 +3436,8 @@ static const struct pid_entry tgid_base_stuff[] = {
 	ONE("cgroup",  S_IRUGO, proc_cgroup_show),
 #endif
 	ONE("oom_score",  S_IRUGO, proc_oom_score),
-	REG("oom_adj",    S_IRUSR, proc_oom_adj_operations),
-	REG("oom_score_adj", S_IRUSR, proc_oom_score_adj_operations),
+	REG("oom_adj",    S_IRUGO|S_IWUSR, proc_oom_adj_operations),
+	REG("oom_score_adj", S_IRUGO|S_IWUSR, proc_oom_score_adj_operations),
 #ifdef CONFIG_AUDITSYSCALL
 	REG("loginuid",   S_IWUSR|S_IRUGO, proc_loginuid_operations),
 	REG("sessionid",  S_IRUGO, proc_sessionid_operations),
@@ -3292,6 +3469,9 @@ static const struct pid_entry tgid_base_stuff[] = {
 	REG("timers",	  S_IRUGO, proc_timers_operations),
 #endif
 	REG("timerslack_ns", S_IRUGO|S_IWUGO, proc_pid_set_timerslack_ns_operations),
+#ifdef CONFIG_SMART_BOOST
+	REG("page_hot_count", 0666, proc_page_hot_count_operations),
+#endif
 #ifdef CONFIG_LIVEPATCH
 	ONE("patch_state",  S_IRUSR, proc_pid_patch_state),
 #endif
diff --git a/fs/proc/generic.c b/fs/proc/generic.c
old mode 100644
new mode 100755
index 793a6757466860e6b8c34f2559f8186c0756239e..c04c4acf98688b6efbc6bacb8853a46b09c340fb
--- a/fs/proc/generic.c
+++ b/fs/proc/generic.c
@@ -326,8 +326,8 @@ static int proc_register(struct proc_dir_entry * dir, struct proc_dir_entry * dp
 	write_lock(&proc_subdir_lock);
 	dp->parent = dir;
 	if (pde_subdir_insert(dir, dp) == false) {
-		WARN(1, "proc_dir_entry '%s/%s' already registered\n",
-		     dir->name, dp->name);
+//		WARN(1, "proc_dir_entry '%s/%s' already registered\n",
+//		     dir->name, dp->name);
 		write_unlock(&proc_subdir_lock);
 		proc_free_inum(dp->low_ino);
 		return -EEXIST;
diff --git a/fs/proc/meminfo.c b/fs/proc/meminfo.c
index 6bb20f8642590f72163adc591831754f8b34a961..937d4c0a5a184e15257ccbe5c07c77e26dda40a7 100644
--- a/fs/proc/meminfo.c
+++ b/fs/proc/meminfo.c
@@ -51,7 +51,9 @@ static int meminfo_proc_show(struct seq_file *m, void *v)
 	long available;
 	unsigned long pages[NR_LRU_LISTS];
 	int lru;
-
+#ifdef CONFIG_SMART_BOOST
+	int iter;
+#endif
 	si_meminfo(&i);
 	si_swapinfo(&i);
 	committed = percpu_counter_read_positive(&vm_committed_as);
@@ -73,11 +75,33 @@ static int meminfo_proc_show(struct seq_file *m, void *v)
 	show_val_kb(m, "Cached:         ", cached);
 	show_val_kb(m, "SwapCached:     ", total_swapcache_pages());
 	show_val_kb(m, "Active:         ", pages[LRU_ACTIVE_ANON] +
-					   pages[LRU_ACTIVE_FILE]);
+#ifndef CONFIG_MEMPLUS
+							   pages[LRU_ACTIVE_FILE]);
+#else
+							   pages[LRU_ACTIVE_FILE] +
+							   pages[LRU_ACTIVE_ANON_SWPCACHE]);
+#endif
 	show_val_kb(m, "Inactive:       ", pages[LRU_INACTIVE_ANON] +
-					   pages[LRU_INACTIVE_FILE]);
-	show_val_kb(m, "Active(anon):   ", pages[LRU_ACTIVE_ANON]);
-	show_val_kb(m, "Inactive(anon): ", pages[LRU_INACTIVE_ANON]);
+#ifndef CONFIG_MEMPLUS
+						   pages[LRU_INACTIVE_FILE]);
+#else
+						   pages[LRU_INACTIVE_FILE] +
+						   pages[LRU_INACTIVE_ANON_SWPCACHE]);
+#endif
+	show_val_kb(m, "Active(anon):   ",
+#ifndef CONFIG_MEMPLUS
+						pages[LRU_ACTIVE_ANON]);
+#else
+						pages[LRU_ACTIVE_ANON] +
+						pages[LRU_ACTIVE_ANON_SWPCACHE]);
+#endif
+	show_val_kb(m, "Inactive(anon): ",
+#ifndef CONFIG_MEMPLUS
+						pages[LRU_INACTIVE_ANON]);
+#else
+						pages[LRU_INACTIVE_ANON] +
+						pages[LRU_INACTIVE_ANON_SWPCACHE]);
+#endif
 	show_val_kb(m, "Active(file):   ", pages[LRU_ACTIVE_FILE]);
 	show_val_kb(m, "Inactive(file): ", pages[LRU_INACTIVE_FILE]);
 	show_val_kb(m, "Unevictable:    ", pages[LRU_UNEVICTABLE]);
@@ -154,7 +178,25 @@ static int meminfo_proc_show(struct seq_file *m, void *v)
 	show_val_kb(m, "CmaFree:        ",
 		    global_zone_page_state(NR_FREE_CMA_PAGES));
 #endif
-
+#ifdef CONFIG_DEFRAG_HELPER
+	show_val_kb(m, "DefragPoolFree: ",
+		    global_zone_page_state(NR_FREE_DEFRAG_POOL));
+	show_val_kb(m, "RealMemFree:    ", i.freeram -
+		    global_zone_page_state(NR_FREE_DEFRAG_POOL));
+#endif
+#ifdef CONFIG_SMART_BOOST
+	show_val_kb(m, "killed_num:     ", killed_num);
+	show_val_kb(m, "a_shrink_num:   ", active_nr);
+	show_val_kb(m, "ina_shrink_num: ", inactive_nr);
+	show_val_kb(m, "vmpressure_20:  ", atomic_read(&vmpress[0]));
+	show_val_kb(m, "vmpressure_40:  ", atomic_read(&vmpress[1]));
+	show_val_kb(m, "vmpressure_60:  ", atomic_read(&vmpress[2]));
+	show_val_kb(m, "vmpressure_80:  ", atomic_read(&vmpress[3]));
+	show_val_kb(m, "vmpressure_100: ", atomic_read(&vmpress[4]));
+	for (iter = 0; iter < 3; iter++)
+		show_val_kb(m, "priority:       ", priority_nr[iter]);
+	show_val_kb(m, "alloc_slow_nr:  ", alloc_slow_nr);
+#endif
 	hugetlb_report_meminfo(m);
 
 	arch_report_meminfo(m);
diff --git a/fs/pstore/Kconfig b/fs/pstore/Kconfig
index b42e5bd6d8ffdd124cdadbbaa05c267510cbca09..34cc5f25ff37186d3970be37286b562ad6e92950 100644
--- a/fs/pstore/Kconfig
+++ b/fs/pstore/Kconfig
@@ -71,6 +71,14 @@ config PSTORE_FTRACE
 
 	  If unsure, say N.
 
+config PSTORE_DEVICE_INFO
+	bool "Log user space messages"
+	depends on PSTORE
+	help
+	  add device_info.txt for ramdump.
+
+	  If unsure, say N.
+
 config PSTORE_RAM
 	tristate "Log panic/oops to a RAM buffer"
 	depends on PSTORE
diff --git a/fs/pstore/Makefile b/fs/pstore/Makefile
index 967b5891f325d487dcd24b7249dd3b28e60bc89c..8e382eb2b2e8b90ae07517ae7fbfe0944b85540c 100644
--- a/fs/pstore/Makefile
+++ b/fs/pstore/Makefile
@@ -12,3 +12,5 @@ pstore-$(CONFIG_PSTORE_PMSG)	+= pmsg.o
 
 ramoops-objs += ram.o ram_core.o
 obj-$(CONFIG_PSTORE_RAM)	+= ramoops.o
+
+pstore-$(CONFIG_PSTORE_DEVICE_INFO)	+= device_info.o
diff --git a/fs/pstore/device_info.c b/fs/pstore/device_info.c
new file mode 100644
index 0000000000000000000000000000000000000000..82d069a1614957cabe9771b2e1d3791818a190c7
--- /dev/null
+++ b/fs/pstore/device_info.c
@@ -0,0 +1,190 @@
+
+#include <linux/kernel.h>
+
+#include <linux/init.h>
+
+#include <linux/types.h>
+
+#include <linux/pstore.h>
+#include <soc/qcom/socinfo.h>
+
+#include <linux/pstore.h>
+#include "internal.h"
+#include <linux/param_rw.h>
+
+extern struct pstore_info *psinfo;
+
+//extern char ufs_vendor_and_rev[32];
+
+
+#define MAX_ITEM 5
+#define MAX_LENGTH 32
+
+enum
+{
+	serialno = 0,
+	hw_version,
+	rf_version,
+	ddr_manufacture_info,
+	pcba_number
+};
+
+char oem_serialno[16];
+char oem_hw_version[3];
+char oem_rf_version[3];
+char oem_ddr_manufacture_info[16];
+char oem_pcba_number[30];
+
+const char cmdline_info[MAX_ITEM][MAX_LENGTH] =
+{
+	"androidboot.serialno=",
+	"androidboot.hw_version=",
+	"androidboot.rf_version=",
+	"ddr_manufacture_info=",
+};
+
+
+
+static int __init device_info_init(void)
+{
+	int i, j;
+	char *substr, *target_str;
+
+	for(i=0; i<MAX_ITEM; i++)
+	{
+		substr = strstr(boot_command_line, cmdline_info[i]);
+		if(substr != NULL)
+			substr += strlen(cmdline_info[i]);
+		else
+			continue;
+
+		if(i == serialno)
+			target_str = oem_serialno;
+		else if(i == hw_version)
+			target_str = oem_hw_version;
+		else if(i == rf_version)
+			target_str = oem_rf_version;
+		else if(i == ddr_manufacture_info)
+			target_str = oem_ddr_manufacture_info;
+		else if(i == pcba_number)
+			target_str = oem_pcba_number;
+
+		for(j=0; substr[j] != ' '; j++)
+			target_str[j] = substr[j];
+		target_str[j] = '\0';
+	}
+	return 1;
+}
+
+/*device info init to black*/
+static void  pstore_device_info_init(void )
+{
+    size_t oldsize;
+    size_t size =0;
+    unsigned long flags;
+
+    struct ramoops_context *cxt = psinfo->data;
+    struct pstore_record record;
+
+    if (psinfo == NULL)
+        return;
+
+    size = cxt->device_info_size;
+
+	pstore_record_init(&record, psinfo);
+	record.type = PSTORE_TYPE_DEVICE_INFO;
+    record.buf = psinfo->buf;
+    record.size = size;
+
+    oldsize = psinfo->bufsize;
+
+
+    if (size > psinfo->bufsize)
+        size = psinfo->bufsize;
+
+    if (oops_in_progress) {
+        if (!spin_trylock_irqsave(&psinfo->buf_lock, flags))
+            return;
+    } else {
+        spin_lock_irqsave(&psinfo->buf_lock, flags);
+    }
+    memset(record.buf, ' ', size);
+    psinfo->write(&record);
+    spin_unlock_irqrestore(&psinfo->buf_lock, flags);
+
+    psinfo->bufsize = oldsize ;
+}
+
+static void pstore_write_device_info(const char *s, unsigned c)
+{
+
+	const char *e = s + c;
+
+	if (psinfo == NULL)
+		return;
+
+	while (s < e) {
+		struct pstore_record record;
+		unsigned long flags;
+
+		pstore_record_init(&record, psinfo);
+		record.type = PSTORE_TYPE_DEVICE_INFO;
+
+		if (c > psinfo->bufsize)
+			c = psinfo->bufsize;
+
+		if (oops_in_progress) {
+			if (!spin_trylock_irqsave(&psinfo->buf_lock, flags))
+				break;
+		} else {
+			spin_lock_irqsave(&psinfo->buf_lock, flags);
+		}
+		record.buf = (char *)s;
+		record.size = c;
+		psinfo->write(&record);
+		spin_unlock_irqrestore(&psinfo->buf_lock, flags);
+		s += c;
+		c = e - s;
+	}
+
+}
+
+static void write_device_info(const char *key, const char *value)
+{
+	pstore_write_device_info(key, strlen(key));
+	pstore_write_device_info(": ", 2);
+	pstore_write_device_info(value, strlen(value));
+	pstore_write_device_info("\r\n", 2);
+}
+
+static int __init init_device_info(void)
+{
+	char *ptr = NULL;
+
+	pstore_device_info_init();
+	device_info_init();
+	ptr = oem_pcba_number;
+	get_param_by_index_and_offset(0, 0x4D, ptr, 28);
+
+	write_device_info("hardware version", oem_hw_version);
+	write_device_info("rf version", oem_rf_version);
+	write_device_info("ddr manufacturer", oem_ddr_manufacture_info);
+	write_device_info("pcba number", oem_pcba_number);
+	write_device_info("serial number", oem_serialno);
+
+	scnprintf(oem_serialno, sizeof(oem_serialno), "%x", socinfo_get_serial_number());
+	write_device_info("socinfo serial_number", oem_serialno);
+
+	//write_device_info("ufs vendor and rev", ufs_vendor_and_rev);
+
+	write_device_info("kernel version", linux_banner);
+	write_device_info("boot command", saved_command_line);
+
+	return 0;
+}
+
+late_initcall(init_device_info);
+
+void save_dump_reason_to_device_info(char *reason) {
+        write_device_info("dump reason is ", reason);
+}
diff --git a/fs/pstore/inode.c b/fs/pstore/inode.c
index d814723fb27dcdfc80168bf97a5c10ab20fcc0c2..18e01a30244b9647eba811da5a8ba4fbcfd9bac5 100644
--- a/fs/pstore/inode.c
+++ b/fs/pstore/inode.c
@@ -373,6 +373,11 @@ int pstore_mkfile(struct dentry *root, struct pstore_record *record)
 		scnprintf(name, sizeof(name), "powerpc-opal-%s-%llu",
 			  record->psi->name, record->id);
 		break;
+
+	case PSTORE_TYPE_DEVICE_INFO:
+		scnprintf(name, sizeof(name), "device-info-%s-%lld", record->psi->name, record->id);
+		break;
+
 	case PSTORE_TYPE_UNKNOWN:
 		scnprintf(name, sizeof(name), "unknown-%s-%llu",
 			  record->psi->name, record->id);
diff --git a/fs/pstore/platform.c b/fs/pstore/platform.c
index 2b21d180157c16a823f2f21d41e31d820bf77232..691eb9aef1bd0cacc8782a7a3d8ca42487b279dd 100644
--- a/fs/pstore/platform.c
+++ b/fs/pstore/platform.c
@@ -624,6 +624,45 @@ static void pstore_console_write(struct console *con, const char *s, unsigned c)
 	}
 }
 
+static void  pstore_console_init(void )
+{
+    size_t oldsize;
+    size_t size =0;
+    unsigned long flags;
+    struct ramoops_context *cxt = psinfo->data;
+    struct pstore_record record;
+
+    if (psinfo == NULL)
+        return;
+
+    size = cxt->console_size;
+
+	pstore_record_init(&record, psinfo);
+	record.type = PSTORE_TYPE_CONSOLE;
+    record.buf = psinfo->buf;
+    record.size = size;
+
+    oldsize = psinfo->bufsize;
+
+
+    if (size > psinfo->bufsize)
+        size = psinfo->bufsize;
+
+    if (oops_in_progress) {
+        if (!spin_trylock_irqsave(&psinfo->buf_lock, flags))
+            return;
+    } else {
+        spin_lock_irqsave(&psinfo->buf_lock, flags);
+    }
+    memset(record.buf, ' ', size);
+    
+
+    psinfo->write(&record);
+    spin_unlock_irqrestore(&psinfo->buf_lock, flags);
+
+    psinfo->bufsize = oldsize ;
+}
+
 static struct console pstore_console = {
 	.name	= "pstore",
 	.write	= pstore_console_write,
@@ -633,6 +672,7 @@ static struct console pstore_console = {
 
 static void pstore_register_console(void)
 {
+    pstore_console_init();
 	register_console(&pstore_console);
 }
 
diff --git a/fs/pstore/ram.c b/fs/pstore/ram.c
index 379b53546fe82c724f253b577656dd81dad58e56..54ee2546cb800820fe20cda586ecfda82564adb1 100644
--- a/fs/pstore/ram.c
+++ b/fs/pstore/ram.c
@@ -52,6 +52,10 @@ static ulong ramoops_ftrace_size = MIN_MEM_SIZE;
 module_param_named(ftrace_size, ramoops_ftrace_size, ulong, 0400);
 MODULE_PARM_DESC(ftrace_size, "size of ftrace log");
 
+static ulong ramoops_device_info_size = MIN_MEM_SIZE;
+module_param_named(device_info_size, ramoops_device_info_size, ulong, 0400);
+MODULE_PARM_DESC(device_info_size, "size of device info");
+
 static ulong ramoops_pmsg_size = MIN_MEM_SIZE;
 module_param_named(pmsg_size, ramoops_pmsg_size, ulong, 0400);
 MODULE_PARM_DESC(pmsg_size, "size of user space message log");
@@ -83,31 +87,6 @@ MODULE_PARM_DESC(ramoops_ecc,
 		"ECC buffer size in bytes (1 is a special value, means 16 "
 		"bytes ECC)");
 
-struct ramoops_context {
-	struct persistent_ram_zone **dprzs;	/* Oops dump zones */
-	struct persistent_ram_zone *cprz;	/* Console zone */
-	struct persistent_ram_zone **fprzs;	/* Ftrace zones */
-	struct persistent_ram_zone *mprz;	/* PMSG zone */
-	phys_addr_t phys_addr;
-	unsigned long size;
-	unsigned int memtype;
-	size_t record_size;
-	size_t console_size;
-	size_t ftrace_size;
-	size_t pmsg_size;
-	int dump_oops;
-	u32 flags;
-	struct persistent_ram_ecc_info ecc_info;
-	unsigned int max_dump_cnt;
-	unsigned int dump_write_cnt;
-	/* _read_cnt need clear on ramoops_pstore_open */
-	unsigned int dump_read_cnt;
-	unsigned int console_read_cnt;
-	unsigned int max_ftrace_cnt;
-	unsigned int ftrace_read_cnt;
-	unsigned int pmsg_read_cnt;
-	struct pstore_info pstore;
-};
 
 static struct platform_device *dummy;
 static struct ramoops_platform_data *dummy_data;
@@ -120,6 +99,7 @@ static int ramoops_pstore_open(struct pstore_info *psi)
 	cxt->console_read_cnt = 0;
 	cxt->ftrace_read_cnt = 0;
 	cxt->pmsg_read_cnt = 0;
+	cxt->device_info_read_cnt = 0;
 	return 0;
 }
 
@@ -280,6 +260,11 @@ static ssize_t ramoops_pstore_read(struct pstore_record *record)
 					   1, &record->id, &record->type,
 					   PSTORE_TYPE_PMSG, 0);
 
+    if (!prz_ok(prz))
+     	prz = ramoops_get_next_prz(&cxt->dprz, &cxt->device_info_read_cnt,
+     				   1, &record->id, &record->type,
+                       PSTORE_TYPE_DEVICE_INFO, 0);
+
 	/* ftrace is last since it may want to dynamically allocate memory. */
 	if (!prz_ok(prz)) {
 		if (!(cxt->flags & RAMOOPS_FLAG_FTRACE_PER_CPU)) {
@@ -402,7 +387,12 @@ static int notrace ramoops_pstore_write(struct pstore_record *record)
 	} else if (record->type == PSTORE_TYPE_PMSG) {
 		pr_warn_ratelimited("PMSG shouldn't call %s\n", __func__);
 		return -EINVAL;
-	}
+	} else if (record->type == PSTORE_TYPE_DEVICE_INFO) {
+		if (!cxt->dprz)
+			return -ENOMEM;
+		persistent_ram_write(cxt->dprz, record->buf, record->size);
+		return 0;
+    }
 
 	if (record->type != PSTORE_TYPE_DMESG)
 		return -EINVAL;
@@ -481,6 +471,11 @@ static int ramoops_pstore_erase(struct pstore_record *record)
 	case PSTORE_TYPE_PMSG:
 		prz = cxt->mprz;
 		break;
+
+	case PSTORE_TYPE_DEVICE_INFO:
+		prz = cxt->dprz;
+		break;
+
 	default:
 		return -EINVAL;
 	}
@@ -699,6 +694,7 @@ static int ramoops_parse_dt(struct platform_device *pdev,
 	parse_size("console-size", pdata->console_size);
 	parse_size("ftrace-size", pdata->ftrace_size);
 	parse_size("pmsg-size", pdata->pmsg_size);
+	parse_size("devinfo-size", pdata->device_info_size);
 	parse_size("ecc-size", pdata->ecc_info.ecc_size);
 	parse_size("flags", pdata->flags);
 
@@ -750,8 +746,8 @@ static int ramoops_probe(struct platform_device *pdev)
 		goto fail_out;
 	}
 
-	if (!pdata->mem_size || (!pdata->record_size && !pdata->console_size &&
-			!pdata->ftrace_size && !pdata->pmsg_size)) {
+if (!pdata->mem_size || (!pdata->record_size && !pdata->console_size &&
+			!pdata->ftrace_size && !pdata->pmsg_size  && !pdata->device_info_size)) {
 		pr_err("The memory size and the record/console size must be "
 			"non-zero\n");
 		goto fail_out;
@@ -766,6 +762,9 @@ static int ramoops_probe(struct platform_device *pdev)
 	if (pdata->pmsg_size && !is_power_of_2(pdata->pmsg_size))
 		pdata->pmsg_size = rounddown_pow_of_two(pdata->pmsg_size);
 
+	if (pdata->device_info_size && !is_power_of_2(pdata->device_info_size))
+		pdata->device_info_size = rounddown_pow_of_two(pdata->device_info_size);
+
 	cxt->size = pdata->mem_size;
 	cxt->phys_addr = pdata->mem_address;
 	cxt->memtype = pdata->mem_type;
@@ -776,11 +775,12 @@ static int ramoops_probe(struct platform_device *pdev)
 	cxt->dump_oops = pdata->dump_oops;
 	cxt->flags = pdata->flags;
 	cxt->ecc_info = pdata->ecc_info;
+	cxt->device_info_size = pdata->device_info_size;
 
 	paddr = cxt->phys_addr;
 
 	dump_mem_sz = cxt->size - cxt->console_size - cxt->ftrace_size
-			- cxt->pmsg_size;
+			- cxt->pmsg_size  - cxt->device_info_size;
 	err = ramoops_init_przs("dump", dev, cxt, &cxt->dprzs, &paddr,
 				dump_mem_sz, cxt->record_size,
 				&cxt->max_dump_cnt, 0, 0);
@@ -808,6 +808,11 @@ static int ramoops_probe(struct platform_device *pdev)
 	if (err)
 		goto fail_init_mprz;
 
+	err = ramoops_init_prz("devinfo", dev, cxt, &cxt->dprz, &paddr,
+                cxt->device_info_size, 0);
+	if (err)
+		goto fail_init_dprz;
+
 	cxt->pstore.data = cxt;
 	/*
 	 * Console can handle any buffer size, so prefer LOG_LINE_MAX. If we
@@ -851,6 +856,13 @@ static int ramoops_probe(struct platform_device *pdev)
 	ramoops_console_size = pdata->console_size;
 	ramoops_pmsg_size = pdata->pmsg_size;
 	ramoops_ftrace_size = pdata->ftrace_size;
+	ramoops_device_info_size = pdata->device_info_size;
+
+	pr_err("ramoops	  cprz=0X%llX console_size=0X%lX  ftrace_size=0X%lX mprz=0x%llX pmsg_size=0X%lX dprz=0X%llX devinfo_size=0X%lX \n",
+			cxt->cprz->paddr, cxt->console_size,
+			cxt->ftrace_size,
+			cxt->mprz->paddr, cxt->pmsg_size,
+			cxt->dprz->paddr, cxt->device_info_size);
 
 	pr_info("attached 0x%lx@0x%llx, ecc: %d/%d\n",
 		cxt->size, (unsigned long long)cxt->phys_addr,
@@ -862,6 +874,8 @@ static int ramoops_probe(struct platform_device *pdev)
 	kfree(cxt->pstore.buf);
 fail_clear:
 	cxt->pstore.bufsize = 0;
+	persistent_ram_free(cxt->dprz);
+fail_init_dprz:
 	persistent_ram_free(cxt->mprz);
 fail_init_mprz:
 fail_init_fprz:
@@ -883,6 +897,7 @@ static int ramoops_remove(struct platform_device *pdev)
 
 	persistent_ram_free(cxt->mprz);
 	persistent_ram_free(cxt->cprz);
+	persistent_ram_free(cxt->dprz);
 	ramoops_free_przs(cxt);
 
 	return 0;
@@ -921,6 +936,7 @@ static void ramoops_register_dummy(void)
 	dummy_data->record_size = record_size;
 	dummy_data->console_size = ramoops_console_size;
 	dummy_data->ftrace_size = ramoops_ftrace_size;
+	dummy_data->device_info_size = ramoops_device_info_size;
 	dummy_data->pmsg_size = ramoops_pmsg_size;
 	dummy_data->dump_oops = dump_oops;
 	dummy_data->flags = RAMOOPS_FLAG_FTRACE_PER_CPU;
diff --git a/fs/sdcardfs/lookup.c b/fs/sdcardfs/lookup.c
index 73179ce2591fdb2704691ea25701b76efb265a18..a9e28ae8091f7387c070434a2f34125a1c03ee8b 100644
--- a/fs/sdcardfs/lookup.c
+++ b/fs/sdcardfs/lookup.c
@@ -369,18 +369,13 @@ static struct dentry *__sdcardfs_lookup(struct dentry *dentry,
 	/* See if the low-level filesystem might want
 	 * to use its own hash
 	 */
-	lower_dentry = d_hash_and_lookup(lower_dir_dentry, &dname);
+	lower_dentry = lookup_one_len_unlocked(dname.name, lower_dir_dentry,
+					       dname.len);
 	if (IS_ERR(lower_dentry))
 		return lower_dentry;
 
-	if (!lower_dentry) {
-		/* We called vfs_path_lookup earlier, and did not get a negative
-		 * dentry then. Don't confuse the lower filesystem by forcing
-		 * one on it now...
-		 */
+	if (d_really_is_negative(lower_dentry))
 		err = -ENOENT;
-		goto out;
-	}
 
 	lower_path.dentry = lower_dentry;
 	lower_path.mnt = mntget(lower_dir_mnt);
diff --git a/include/drm/drm_mipi_dsi.h b/include/drm/drm_mipi_dsi.h
old mode 100644
new mode 100755
index 328f232f33eef1cb5bd4c8c68c5f1fe9f8aa5bc9..de326896bac594f5e712c817f808abddf46c4ef1
--- a/include/drm/drm_mipi_dsi.h
+++ b/include/drm/drm_mipi_dsi.h
@@ -46,7 +46,8 @@ struct mipi_dsi_msg {
 	u32 wait_ms;
 
 	size_t tx_len;
-	const void *tx_buf;
+	//const void *tx_buf;
+	u8 *tx_buf;
 
 	size_t rx_len;
 	void *rx_buf;
@@ -236,11 +237,13 @@ int mipi_dsi_turn_on_peripheral(struct mipi_dsi_device *dsi);
 int mipi_dsi_set_maximum_return_packet_size(struct mipi_dsi_device *dsi,
 					    u16 value);
 
-ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, const void *payload,
+
+ssize_t mipi_dsi_generic_write(struct mipi_dsi_device *dsi, void *payload,
 			       size_t size);
-ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, const void *params,
+ssize_t mipi_dsi_generic_read(struct mipi_dsi_device *dsi, void *params,
 			      size_t num_params, void *data, size_t size);
 
+
 /**
  * enum mipi_dsi_dcs_tear_mode - Tearing Effect Output Line mode
  * @MIPI_DSI_DCS_TEAR_MODE_VBLANK: the TE output line consists of V-Blanking
@@ -260,7 +263,8 @@ enum mipi_dsi_dcs_tear_mode {
 #define MIPI_DSI_DCS_POWER_MODE_IDLE    (1 << 6)
 
 ssize_t mipi_dsi_dcs_write_buffer(struct mipi_dsi_device *dsi,
-				  const void *data, size_t len);
+				  void *data, size_t len);
+
 ssize_t mipi_dsi_dcs_write(struct mipi_dsi_device *dsi, u8 cmd,
 			   const void *data, size_t len);
 ssize_t mipi_dsi_dcs_read(struct mipi_dsi_device *dsi, u8 cmd, void *data,
@@ -286,6 +290,9 @@ int mipi_dsi_dcs_set_display_brightness(struct mipi_dsi_device *dsi,
 					u16 brightness);
 int mipi_dsi_dcs_get_display_brightness(struct mipi_dsi_device *dsi,
 					u16 *brightness);
+int mipi_dsi_dcs_set_display_brightness_samsung(struct mipi_dsi_device *dsi,
+					u16 brightness);
+
 
 /**
  * struct mipi_dsi_driver - DSI driver
diff --git a/include/linux/adj_chain.h b/include/linux/adj_chain.h
new file mode 100644
index 0000000000000000000000000000000000000000..2aa22a2e119e64a60ec41d48a1f8e468ddd8b353
--- /dev/null
+++ b/include/linux/adj_chain.h
@@ -0,0 +1,47 @@
+#ifndef _LINUX_ADJ_CHAIN_H
+#define _LINUX_ADJ_CHAIN_H
+
+#include <linux/list.h>
+#include <linux/sched.h>
+#include <uapi/linux/oom.h>
+#include <linux/sched/signal.h>
+
+#define ADJ_CHAIN_MAX ((OOM_SCORE_ADJ_MAX) - (OOM_SCORE_ADJ_MIN))
+
+// real adj to adj chain index
+#define __adjc(adj) (adj + OOM_SCORE_ADJ_MAX)
+
+// adj chain index to real adj
+#define __adjr(adj) (adj - OOM_SCORE_ADJ_MAX)
+
+// adj chain helper
+#define __adj_tasks(adj) (adj_chain[adj].adj_chain_tasks)
+#define adj_tasks(adj) (adj_chain[__adjc(adj)].adj_chain_tasks)
+#define get_oom_score_adj(p) (p->signal->oom_score_adj)
+#define get_task_struct_adj_chain_rcu(h) \
+	list_entry_rcu(h, struct task_struct, adj_chain_tasks)
+enum {
+	AC_ATTACH,
+	AC_DETACH,
+	AC_UPDATE_ADJ,
+	AC_PROM_LEADER
+};
+
+#ifdef CONFIG_ADJ_CHAIN
+#define adj_chain_init_list(p) INIT_LIST_HEAD(&(p)->adj_chain_tasks)
+#define adj_chain_empty(adj) list_empty(&__adj_tasks(adj))
+extern struct list_head adj_chain[ADJ_CHAIN_MAX + 1];
+extern int adj_chain_ready;
+extern int adj_chain_hist_high;
+extern void adj_chain_update_oom_score_adj(struct task_struct *p);
+extern void adj_chain_attach(struct task_struct *p);
+extern void adj_chain_detach(struct task_struct *p);
+#else
+#define adj_chain_init_list(p)
+#define adj_chain_empty(adj) (1)
+static inline void adj_chain_update_oom_score_adj(struct task_struct *p) { }
+static inline void adj_chain_attach(struct task_struct *p) { }
+static inline void adj_chain_detach(struct task_struct *p) { }
+#endif // CONFIG_ADJ_CHAIN
+
+#endif // _LINUX_ADJ_CHAIN_H
diff --git a/include/linux/device.h b/include/linux/device.h
index fdad8ab16e360bc8b841a421ed52b943f64766e8..1fdd38e2904cddea2856dc07b3506a8b1d85cab9 100644
--- a/include/linux/device.h
+++ b/include/linux/device.h
@@ -309,6 +309,8 @@ struct driver_attribute {
 			 size_t count);
 };
 
+#define DRIVER_ATTR(_name, _mode, _show, _store) \
+	struct driver_attribute driver_attr_##_name = __ATTR(_name, _mode, _show, _store)
 #define DRIVER_ATTR_RW(_name) \
 	struct driver_attribute driver_attr_##_name = __ATTR_RW(_name)
 #define DRIVER_ATTR_RO(_name) \
diff --git a/include/linux/esoc_client.h b/include/linux/esoc_client.h
index 0875a8f6ec49561f00a5366f25bc27e5c05e7a96..b5454fe34d3f26f8a80b31becdc3809471596c23 100644
--- a/include/linux/esoc_client.h
+++ b/include/linux/esoc_client.h
@@ -16,6 +16,8 @@
 #include <linux/esoc_ctrl.h>
 #include <linux/notifier.h>
 
+extern int oem_get_download_mode(void);
+
 struct esoc_client_hook {
 	char *name;
 	void *priv;
diff --git a/include/linux/freezer.h b/include/linux/freezer.h
index 3995df1d068f66b6c1574312b8740d35e2ad0de5..84b371f8a93dcd4d547dfc05418f87ca7f507dca 100644
--- a/include/linux/freezer.h
+++ b/include/linux/freezer.h
@@ -67,6 +67,9 @@ static inline bool try_to_freeze(void)
 	return try_to_freeze_unsafe();
 }
 
+extern void unfreezer_fork(struct task_struct *task);
+extern bool freeze_cgroup_task(struct task_struct *p);
+
 extern bool freeze_task(struct task_struct *p);
 extern bool set_freezable(void);
 
diff --git a/include/linux/fs.h b/include/linux/fs.h
index 679de7f736839a2c435abf4487fed13916a00655..ea30b4fb0f8b094ccab21bc809cccae8b6db243e 100644
--- a/include/linux/fs.h
+++ b/include/linux/fs.h
@@ -2585,7 +2585,11 @@ extern int invalidate_partition(struct gendisk *, int);
 #endif
 unsigned long invalidate_mapping_pages(struct address_space *mapping,
 					pgoff_t start, pgoff_t end);
-
+#ifdef CONFIG_SMART_BOOST
+unsigned long invalidate_mapping_pages_without_uidlru(
+					struct address_space *mapping,
+					pgoff_t start, pgoff_t end);
+#endif
 static inline void invalidate_remote_inode(struct inode *inode)
 {
 	if (S_ISREG(inode->i_mode) || S_ISDIR(inode->i_mode) ||
diff --git a/include/linux/fsc.h b/include/linux/fsc.h
new file mode 100644
index 0000000000000000000000000000000000000000..fe8ecf5d2cfee6ee5cec5a4bd076a2921d3ca7fa
--- /dev/null
+++ b/include/linux/fsc.h
@@ -0,0 +1,24 @@
+#ifndef _LINUX_FSC_H_
+#define _LINUX_FSC_H_
+
+#include <linux/fs.h>
+#include <linux/sched.h>
+
+#define FSC_PATH_MAX (256)
+#define FSC_SCAN_BULK (512)
+#define FSC_HASH_BUCKET (8192)
+#define FSC_SUMMARY_MAX (128)
+
+extern unsigned int fsc_enable;
+extern int fsc_allow_list_cur;
+
+extern void fsc_spin_lock(unsigned int hidx);
+extern void fsc_spin_unlock(unsigned int hidx);
+extern unsigned int fsc_get_hidx(const char* path, size_t len);
+extern void fsc_insert_absence_path_locked(const char* path, size_t len, u32 hidx);
+extern void fsc_delete_absence_path_locked(const char* path, size_t len, u32 hidx);
+extern char *fsc_absolute_path(struct path* path, struct dentry* dentry, char *buf, size_t buflen);
+extern void fsc_delete_absence_path_dentry(struct path*, struct dentry* dentry);
+extern bool fsc_absence_check(const char* path, size_t len);
+extern bool fsc_path_check(struct filename *name, size_t *len);
+#endif
diff --git a/include/linux/hotcount.h b/include/linux/hotcount.h
new file mode 100644
index 0000000000000000000000000000000000000000..0435b9f91f1792576631651f0b88e3c56bb71240
--- /dev/null
+++ b/include/linux/hotcount.h
@@ -0,0 +1,6 @@
+#ifndef _HOTCOUNT_H_
+#define _HOTCOUNT_H_
+extern void insert_prio_node(unsigned int new_hotcount, uid_t uid);
+extern void delete_prio_node(uid_t uid);
+extern void print_prio_chain(struct seq_file *m);
+#endif
diff --git a/include/linux/init_task.h b/include/linux/init_task.h
index 8062e6cc607c82074d2e3513cd2db30f07333038..ad9bfcc60b362dba639e0809ad6eae798e7ea391 100644
--- a/include/linux/init_task.h
+++ b/include/linux/init_task.h
@@ -67,6 +67,12 @@ extern struct fs_struct init_fs;
 #define INIT_CPUTIMER(s)
 #endif
 
+#if defined(CONFIG_MEMPLUS)
+#define INIT_RECLAIM_STATE	.reclaim_timeout = 0, .swapin_should_readahead_m = 0, .reclaim_state_lock = __SPIN_LOCK_UNLOCKED(reclaim_state_lock), .memplus_type = 0,
+#else
+#define INIT_RECLAIM_STATE
+#endif
+
 #define INIT_SIGNALS(sig) {						\
 	.nr_threads	= 1,						\
 	.thread_head	= LIST_HEAD_INIT(init_task.thread_node),	\
@@ -81,6 +87,7 @@ extern struct fs_struct init_fs;
 	INIT_PREV_CPUTIME(sig)						\
 	.cred_guard_mutex =						\
 		 __MUTEX_INITIALIZER(sig.cred_guard_mutex),		\
+	INIT_RECLAIM_STATE						\
 }
 
 extern struct nsproxy init_nsproxy;
diff --git a/include/linux/input/qpnp-power-on.h b/include/linux/input/qpnp-power-on.h
index 4fa954a9b1de05247f9cee7fea22eef6823c4fde..0bb8ef611ce508b4f2d428cc80e8f3472f45db3a 100644
--- a/include/linux/input/qpnp-power-on.h
+++ b/include/linux/input/qpnp-power-on.h
@@ -53,6 +53,51 @@ enum pon_power_off_type {
 	PON_POWER_OFF_MAX_TYPE		= 0x10,
 };
 
+struct qpnp_pon {
+	struct device		*dev;
+	struct regmap		*regmap;
+	struct input_dev	*pon_input;
+	struct qpnp_pon_config	*pon_cfg;
+	struct pon_regulator	*pon_reg_cfg;
+	struct list_head	list;
+	struct delayed_work	bark_work;
+	struct delayed_work     press_work;
+	struct work_struct  up_work;
+	atomic_t	   press_count;
+	struct dentry		*debugfs;
+	struct device_node      *pbs_dev_node;
+	int			pon_trigger_reason;
+	int			pon_power_off_reason;
+	int			num_pon_reg;
+	int			num_pon_config;
+	u32			dbc_time_us;
+	u32			uvlo;
+	int			warm_reset_poff_type;
+	int			hard_reset_poff_type;
+	int			shutdown_poff_type;
+	int			resin_warm_reset_type;
+	int			resin_hard_reset_type;
+	int			resin_shutdown_type;
+	u16			base;
+	u8			subtype;
+	u8			pon_ver;
+	u8			warm_reset_reason1;
+	u8			warm_reset_reason2;
+	u8                      twm_state;
+	bool			is_spon;
+	bool			store_hard_reset_reason;
+	bool			resin_hard_reset_disable;
+	bool			resin_shutdown_disable;
+	bool			ps_hold_hard_reset_disable;
+	bool			ps_hold_shutdown_disable;
+	bool			kpdpwr_dbc_enable;
+	bool                    support_twm_config;
+	bool			resin_pon_reset;
+	ktime_t			kpdpwr_last_release_time;
+	struct notifier_block   pon_nb;
+	bool			legacy_hard_reset_offset;
+};
+
 enum pon_restart_reason {
 	PON_RESTART_REASON_UNKNOWN		= 0x00,
 	PON_RESTART_REASON_RECOVERY		= 0x01,
@@ -61,8 +106,31 @@ enum pon_restart_reason {
 	PON_RESTART_REASON_DMVERITY_CORRUPTED	= 0x04,
 	PON_RESTART_REASON_DMVERITY_ENFORCE	= 0x05,
 	PON_RESTART_REASON_KEYS_CLEAR		= 0x06,
+
+	PON_RESTART_REASON_AGING		= 0x07,
+	PON_RESTART_REASON_REBOOT		= 0x10,
+	PON_RESTART_REASON_FACTORY		= 0x11,
+	PON_RESTART_REASON_WLAN 		= 0x12,
+	PON_RESTART_REASON_RF			= 0x13,
+	PON_RESTART_REASON_MOS			= 0x14,
+	PON_RESTART_REASON_KERNEL		= 0x15,
+	PON_RESTART_REASON_ANDROID		= 0x16,
+	PON_RESTART_REASON_MODEM		= 0x17,
+	PON_RESTART_REASON_PANIC		= 0x18,
 };
 
+/* Define OEM reboot mode magic*/
+#define AGING_MODE		0x77665510
+#define FACTORY_MODE	0x77665504
+#define WLAN_MODE		0x77665505
+#define RF_MODE			0x77665506
+#define MOS_MODE		0x77665507
+#define KERNEL_MODE		0x7766550d
+#define ANDROID_MODE	0x7766550c
+#define MODEM_MODE		0x7766550b
+#define OEM_PANIC		0x77665518
+
+
 #ifdef CONFIG_INPUT_QPNP_POWER_ON
 int qpnp_pon_system_pwr_off(enum pon_power_off_type type);
 int qpnp_pon_is_warm_reset(void);
diff --git a/include/linux/mm.h b/include/linux/mm.h
index 6e72885d23d47c683649b7806aac992a398ae377..fad2a257e730bee24c01a99e53d0b016f5452604 100644
--- a/include/linux/mm.h
+++ b/include/linux/mm.h
@@ -2362,7 +2362,7 @@ int __must_check write_one_page(struct page *page);
 void task_dirty_inc(struct task_struct *tsk);
 
 /* readahead.c */
-#define VM_MAX_READAHEAD	128	/* kbytes */
+#define VM_MAX_READAHEAD	512	/* kbytes */
 #define VM_MIN_READAHEAD	16	/* kbytes (includes current page) */
 
 int force_page_cache_readahead(struct address_space *mapping, struct file *filp,
diff --git a/include/linux/mm_inline.h b/include/linux/mm_inline.h
index 10191c28fc04ce22c605d54a87257ee5ff427651..fa5daa54c283f82163c3a744b9dd715b47858d1e 100644
--- a/include/linux/mm_inline.h
+++ b/include/linux/mm_inline.h
@@ -22,7 +22,63 @@ static inline int page_is_file_cache(struct page *page)
 {
 	return !PageSwapBacked(page);
 }
+#ifdef CONFIG_SMART_BOOST
+static __always_inline void __update_lru_size(struct lruvec *lruvec,
+				enum lru_list lru, enum zone_type zid,
+				int nr_pages, bool is_uidlru)
+
+{
+	struct pglist_data *pgdat = lruvec_pgdat(lruvec);
+
+	if (!is_uidlru) {
+		__mod_node_page_state(pgdat, NR_LRU_BASE + lru, nr_pages);
+		__mod_zone_page_state(&pgdat->node_zones[zid],
+					NR_ZONE_LRU_BASE + lru, nr_pages);
+	} else {
+		__mod_zone_page_state(&pgdat->node_zones[zid],
+						NR_ZONE_UID_LRU, nr_pages);
+	}
+}
 
+static __always_inline void update_lru_size(struct lruvec *lruvec,
+				enum lru_list lru, enum zone_type zid,
+				int nr_pages, bool is_uidlru)
+{
+	__update_lru_size(lruvec, lru, zid, nr_pages, is_uidlru);
+#ifdef CONFIG_MEMCG
+	if (!is_uidlru)
+		mem_cgroup_update_lru_size(lruvec, lru, zid, nr_pages);
+
+#endif
+}
+
+static __always_inline void add_page_to_lru_list(struct page *page,
+				struct lruvec *lruvec, enum lru_list lru)
+{
+	update_lru_size(lruvec, lru, page_zonenum(page),
+				hpage_nr_pages(page), false);
+	list_add(&page->lru, &lruvec->lists[lru]);
+}
+
+static __always_inline void add_page_to_lru_list_tail(struct page *page,
+				struct lruvec *lruvec, enum lru_list lru)
+{
+	update_lru_size(lruvec, lru, page_zonenum(page),
+				hpage_nr_pages(page), false);
+	list_add_tail(&page->lru, &lruvec->lists[lru]);
+}
+
+static __always_inline void del_page_from_lru_list(struct page *page,
+				struct lruvec *lruvec, enum lru_list lru,
+				bool is_uidlru)
+{
+	list_del(&page->lru);
+	if (is_uidlru)
+		ClearPageUIDLRU(page);
+	update_lru_size(lruvec, lru, page_zonenum(page),
+				-hpage_nr_pages(page), is_uidlru);
+}
+#else
 static __always_inline void __update_lru_size(struct lruvec *lruvec,
 				enum lru_list lru, enum zone_type zid,
 				int nr_pages)
@@ -64,6 +120,7 @@ static __always_inline void del_page_from_lru_list(struct page *page,
 	list_del(&page->lru);
 	update_lru_size(lruvec, lru, page_zonenum(page), -hpage_nr_pages(page));
 }
+#endif
 
 /**
  * page_lru_base_type - which LRU list type should a page be on?
@@ -77,6 +134,10 @@ static inline enum lru_list page_lru_base_type(struct page *page)
 {
 	if (page_is_file_cache(page))
 		return LRU_INACTIVE_FILE;
+#ifdef CONFIG_MEMPLUS
+	if (PageSwapCache(page))
+		return LRU_INACTIVE_ANON_SWPCACHE;
+#endif
 	return LRU_INACTIVE_ANON;
 }
 
diff --git a/include/linux/mm_types.h b/include/linux/mm_types.h
index 10bc2286b4c48c7ffa841c8ba1bf7d3520acf810..49e76e355eac69627bac674ce94c5be71203baf6 100644
--- a/include/linux/mm_types.h
+++ b/include/linux/mm_types.h
@@ -300,6 +300,7 @@ struct vm_area_struct {
 	struct mm_struct *vm_mm;	/* The address space we belong to. */
 	pgprot_t vm_page_prot;		/* Access permissions of this VMA. */
 	unsigned long vm_flags;		/* Flags, see mm.h. */
+	unsigned int memplus_flags; /* memplus flags, 1:  had swapin, 0: had swapout*/
 
 	/*
 	 * For areas with an address space and backing store,
@@ -430,6 +431,8 @@ struct mm_struct {
 	unsigned long exec_vm;		/* VM_EXEC & ~VM_WRITE & ~VM_STACK */
 	unsigned long stack_vm;		/* VM_STACK */
 	unsigned long def_flags;
+
+	spinlock_t arg_lock; /* protect the below fields */
 	unsigned long start_code, end_code, start_data, end_data;
 	unsigned long start_brk, brk, start_stack;
 	unsigned long arg_start, arg_end, env_start, env_end;
diff --git a/include/linux/mmzone.h b/include/linux/mmzone.h
index 68b4d9720ab795c669dedf7b97980c11e0a8eb1c..92a88db8e9f90adcaf8b85bf5a77a21142895503 100644
--- a/include/linux/mmzone.h
+++ b/include/linux/mmzone.h
@@ -58,6 +58,9 @@ enum migratetype {
 #endif
 	MIGRATE_PCPTYPES, /* the number of types on the pcp lists */
 	MIGRATE_HIGHATOMIC = MIGRATE_PCPTYPES,
+#ifdef CONFIG_DEFRAG_HELPER
+	MIGRATE_UNMOVABLE_DEFRAG_POOL,
+#endif
 #ifdef CONFIG_MEMORY_ISOLATION
 	MIGRATE_ISOLATE,	/* can't allocate from here */
 #endif
@@ -82,6 +85,12 @@ static inline bool is_migrate_movable(int mt)
 	return is_migrate_cma(mt) || mt == MIGRATE_MOVABLE;
 }
 
+#ifdef CONFIG_DEFRAG_HELPER
+static inline int is_migrate_defrag(int migratetype)
+{
+	return migratetype == MIGRATE_UNMOVABLE_DEFRAG_POOL;
+}
+#endif
 #define for_each_migratetype_order(order, type) \
 	for (order = 0; order < MAX_ORDER; order++) \
 		for (type = 0; type < MIGRATE_TYPES; type++)
@@ -98,6 +107,9 @@ extern int page_group_by_mobility_disabled;
 struct free_area {
 	struct list_head	free_list[MIGRATE_TYPES];
 	unsigned long		nr_free;
+#ifdef CONFIG_DEFRAG_HELPER
+	unsigned long		nr_free_defrag;
+#endif
 };
 
 struct pglist_data;
@@ -139,6 +151,10 @@ enum zone_stat_item {
 	NR_ZONE_ACTIVE_ANON,
 	NR_ZONE_INACTIVE_FILE,
 	NR_ZONE_ACTIVE_FILE,
+#ifdef CONFIG_MEMPLUS
+	NR_ZONE_INACTIVE_ANON_SWAPCACHE,
+	NR_ZONE_ACTIVE_ANON_SWAPCACHE,
+#endif
 	NR_ZONE_UNEVICTABLE,
 	NR_ZONE_WRITE_PENDING,	/* Count of dirty, writeback and unstable pages */
 	NR_MLOCK,		/* mlock()ed pages found and moved off LRU */
@@ -148,8 +164,14 @@ enum zone_stat_item {
 	NR_BOUNCE,
 #if IS_ENABLED(CONFIG_ZSMALLOC)
 	NR_ZSPAGES,		/* allocated in zsmalloc */
+#endif
+#ifdef CONFIG_SMART_BOOST
+	NR_ZONE_UID_LRU,
 #endif
 	NR_FREE_CMA_PAGES,
+#ifdef CONFIG_DEFRAG_HELPER
+	NR_FREE_DEFRAG_POOL,
+#endif
 	NR_VM_ZONE_STAT_ITEMS };
 
 enum node_stat_item {
@@ -158,6 +180,10 @@ enum node_stat_item {
 	NR_ACTIVE_ANON,		/*  "     "     "   "       "         */
 	NR_INACTIVE_FILE,	/*  "     "     "   "       "         */
 	NR_ACTIVE_FILE,		/*  "     "     "   "       "         */
+#ifdef CONFIG_MEMPLUS
+	NR_INACTIVE_ANON_SWAPCACHE,
+	NR_ACTIVE_ANON_SWAPCACHE,
+#endif
 	NR_UNEVICTABLE,		/*  "     "     "   "       "         */
 	NR_SLAB_RECLAIMABLE,
 	NR_SLAB_UNRECLAIMABLE,
@@ -204,13 +230,20 @@ enum lru_list {
 	LRU_ACTIVE_ANON = LRU_BASE + LRU_ACTIVE,
 	LRU_INACTIVE_FILE = LRU_BASE + LRU_FILE,
 	LRU_ACTIVE_FILE = LRU_BASE + LRU_FILE + LRU_ACTIVE,
+#ifdef CONFIG_MEMPLUS
+	LRU_INACTIVE_ANON_SWPCACHE,
+	LRU_ACTIVE_ANON_SWPCACHE,
+#endif
 	LRU_UNEVICTABLE,
 	NR_LRU_LISTS
 };
 
 #define for_each_lru(lru) for (lru = 0; lru < NR_LRU_LISTS; lru++)
-
+#ifdef CONFIG_MEMPLUS
+#define for_each_evictable_lru(lru) for (lru = 0; lru <= LRU_ACTIVE_ANON_SWPCACHE; lru++)
+#else
 #define for_each_evictable_lru(lru) for (lru = 0; lru <= LRU_ACTIVE_FILE; lru++)
+#endif
 
 static inline int is_file_lru(enum lru_list lru)
 {
@@ -219,7 +252,11 @@ static inline int is_file_lru(enum lru_list lru)
 
 static inline int is_active_lru(enum lru_list lru)
 {
+#ifdef CONFIG_MEMPLUS
+		return (lru == LRU_ACTIVE_ANON || lru == LRU_ACTIVE_FILE || lru == LRU_ACTIVE_ANON_SWPCACHE);
+#else
 	return (lru == LRU_ACTIVE_ANON || lru == LRU_ACTIVE_FILE);
+#endif
 }
 
 struct zone_reclaim_stat {
@@ -235,8 +272,20 @@ struct zone_reclaim_stat {
 	unsigned long		recent_scanned[2];
 };
 
+#ifdef CONFIG_SMART_BOOST
+struct uid_node {
+	struct uid_node __rcu *next;
+	uid_t uid;
+	unsigned int hot_count;
+	struct list_head  page_cache_list;
+	struct rcu_head rcu;
+};
+#endif
 struct lruvec {
 	struct list_head		lists[NR_LRU_LISTS];
+#ifdef CONFIG_SMART_BOOST
+	struct uid_node **uid_hash;
+#endif
 	struct zone_reclaim_stat	reclaim_stat;
 	/* Evictions & activations on the inactive file list */
 	atomic_long_t			inactive_age;
@@ -249,7 +298,11 @@ struct lruvec {
 
 /* Mask used at gathering information at once (see memcontrol.c) */
 #define LRU_ALL_FILE (BIT(LRU_INACTIVE_FILE) | BIT(LRU_ACTIVE_FILE))
+#ifdef CONFIG_MEMPLUS
+#define LRU_ALL_ANON (BIT(LRU_INACTIVE_ANON) | BIT(LRU_ACTIVE_ANON) | BIT(LRU_INACTIVE_ANON_SWPCACHE) | BIT(LRU_ACTIVE_ANON_SWPCACHE))
+#else
 #define LRU_ALL_ANON (BIT(LRU_INACTIVE_ANON) | BIT(LRU_ACTIVE_ANON))
+#endif
 #define LRU_ALL	     ((1 << NR_LRU_LISTS) - 1)
 
 /* Isolate unmapped file */
@@ -879,7 +932,7 @@ static inline int is_highmem_idx(enum zone_type idx)
 }
 
 /**
- * is_highmem - helper function to quickly check if a struct zone is a 
+ * is_highmem - helper function to quickly check if a struct zone is a
  *              highmem zone or not.  This is an attempt to keep references
  *              to ZONE_{DMA/NORMAL/HIGHMEM/etc} in general code to a minimum.
  * @zone - pointer to struct zone variable
diff --git a/include/linux/msm_drm_notify.h b/include/linux/msm_drm_notify.h
old mode 100644
new mode 100755
index 924ba852c99cb62ea8bc1acfd4d1d92f080ace85..feeae13c72f7e30056c231005f095187eb805c24
--- a/include/linux/msm_drm_notify.h
+++ b/include/linux/msm_drm_notify.h
@@ -25,6 +25,15 @@ enum {
 	MSM_DRM_BLANK_UNBLANK,
 	/* panel: power off */
 	MSM_DRM_BLANK_POWERDOWN,
+	/* panel: power on for tp*/
+	MSM_DRM_BLANK_UNBLANK_CUST,
+    /* panel: lcd doze mode */
+	MSM_DRM_BLANK_NORMAL,
+    /* panel: power off */
+	MSM_DRM_BLANK_POWERDOWN_CUST,
+	MSM_DRM_ONSCREENFINGERPRINT_EVENT,
+	MSM_DRM_DYNAMICFPS_60 = 60,
+	MSM_DRM_DYNAMICFPS_90 = 90,
 };
 
 enum msm_drm_display_id {
diff --git a/include/linux/oem_force_dump.h b/include/linux/oem_force_dump.h
new file mode 100644
index 0000000000000000000000000000000000000000..4dee0ebd619b4b6ce1a6179cf8cd49b68b102741
--- /dev/null
+++ b/include/linux/oem_force_dump.h
@@ -0,0 +1,16 @@
+/*
+ * oem_force_dump.h
+ *
+ * header file supporting debug functions for Oneplus device.
+ *
+ * hefaxi@filesystems, 2015/07/03.
+ */
+
+#ifndef OEM_FORCE_DUMP_H
+#define OEM_FORCE_DUMP_H
+
+extern void oem_check_force_dump_key(unsigned int code, int value);
+extern int oem_get_download_mode(void);
+void send_msg(char *message);
+int  msm_serial_oem_init(void);
+#endif
diff --git a/include/linux/oneplus/boot_mode.h b/include/linux/oneplus/boot_mode.h
new file mode 100755
index 0000000000000000000000000000000000000000..b8c7ec0452d937d8176f04db570f99d3b06f2c88
--- /dev/null
+++ b/include/linux/oneplus/boot_mode.h
@@ -0,0 +1,27 @@
+#ifndef _BOOT_MODE_H_
+#define _BOOT_MODE_H_ 1
+
+enum oem_boot_mode {
+	MSM_BOOT_MODE__NORMAL,
+	MSM_BOOT_MODE__FASTBOOT,
+	MSM_BOOT_MODE__RECOVERY,
+	MSM_BOOT_MODE__AGING,
+	MSM_BOOT_MODE__FACTORY,
+	MSM_BOOT_MODE__RF,
+	MSM_BOOT_MODE__WLAN,
+	MSM_BOOT_MODE__MOS,
+	MSM_BOOT_MODE__CHARGE,
+};
+
+enum oem_boot_mode get_boot_mode(void);
+
+enum oem_projcet {
+    OEM_PROJECT_18821=18821,
+    OEM_PROJECT_18827=18827,
+    OEM_PROJECT_11811=11811,
+};
+
+int get_oem_project(void);
+int get_second_board_absent(void);
+
+#endif
diff --git a/include/linux/op_rf_cable_monitor.h b/include/linux/op_rf_cable_monitor.h
new file mode 100644
index 0000000000000000000000000000000000000000..9a43dded248c9d815521be7204fa3848f9c7babc
--- /dev/null
+++ b/include/linux/op_rf_cable_monitor.h
@@ -0,0 +1,10 @@
+#ifndef _OP_RF_CABLE_MONITOR
+#define _OP_RF_CABLE_MONITOR 1
+
+extern char *saved_command_line;
+extern void op_restart_modem(void);
+
+#define CABLE_WAKELOCK_HOLD_TIME 5000
+#define PAGESIZE 512
+
+#endif
diff --git a/include/linux/page-flags.h b/include/linux/page-flags.h
index 584b14c774c181e85eac69be4f5a3ad037cb75d4..dc79725047a593912223a807d3a947a4410775ab 100644
--- a/include/linux/page-flags.h
+++ b/include/linux/page-flags.h
@@ -105,6 +105,12 @@ enum pageflags {
 #if defined(CONFIG_IDLE_PAGE_TRACKING) && defined(CONFIG_64BIT)
 	PG_young,
 	PG_idle,
+#endif
+#ifdef CONFIG_MEMPLUS
+	PG_willneed,
+#endif
+#ifdef CONFIG_SMART_BOOST
+	PG_uidlru,
 #endif
 	__NR_PAGEFLAGS,
 
@@ -271,6 +277,12 @@ PAGEFLAG(Referenced, referenced, PF_HEAD)
 PAGEFLAG(Dirty, dirty, PF_HEAD) TESTSCFLAG(Dirty, dirty, PF_HEAD)
 	__CLEARPAGEFLAG(Dirty, dirty, PF_HEAD)
 PAGEFLAG(LRU, lru, PF_HEAD) __CLEARPAGEFLAG(LRU, lru, PF_HEAD)
+#ifdef CONFIG_MEMPLUS
+PAGEFLAG(Willneed, willneed, PF_HEAD) __CLEARPAGEFLAG(Willneed, willneed, PF_HEAD)
+#endif
+#ifdef CONFIG_SMART_BOOST
+PAGEFLAG(UIDLRU, uidlru, PF_HEAD) __CLEARPAGEFLAG(UIDLRU, uidlru, PF_HEAD)
+#endif
 PAGEFLAG(Active, active, PF_HEAD) __CLEARPAGEFLAG(Active, active, PF_HEAD)
 	TESTCLEARFLAG(Active, active, PF_HEAD)
 __PAGEFLAG(Slab, slab, PF_NO_TAIL)
@@ -333,8 +345,17 @@ static __always_inline int PageSwapCache(struct page *page)
 	return PageSwapBacked(page) && test_bit(PG_swapcache, &page->flags);
 
 }
-SETPAGEFLAG(SwapCache, swapcache, PF_NO_TAIL)
-CLEARPAGEFLAG(SwapCache, swapcache, PF_NO_TAIL)
+#include <oneplus/memplus/memplus.h>
+static __always_inline void ClearPageSwapCache(struct page *page)
+{
+	memplus_move_swapcache_to_anon_lru(page);
+}
+
+static __always_inline void SetPageSwapCache(struct page *page)
+{
+	memplus_move_anon_to_swapcache_lru(page);
+}
+
 #else
 PAGEFLAG_FALSE(SwapCache)
 #endif
diff --git a/include/linux/page-isolation.h b/include/linux/page-isolation.h
index 05a04e60368640baa285f03cd18d3e9a1d8d1b9d..ced422e5a2621b2b4f2204c2580412d571ede4b4 100644
--- a/include/linux/page-isolation.h
+++ b/include/linux/page-isolation.h
@@ -33,9 +33,13 @@ static inline bool is_migrate_isolate(int migratetype)
 bool has_unmovable_pages(struct zone *zone, struct page *page, int count,
 			 bool skip_hwpoisoned_pages);
 void set_pageblock_migratetype(struct page *page, int migratetype);
+#ifdef CONFIG_DEFRAG_HELPER
+int move_freepages_block(struct zone *zone, struct page *page,
+				int migratetype, int *num_movable, int old_mt);
+#else
 int move_freepages_block(struct zone *zone, struct page *page,
 				int migratetype, int *num_movable);
-
+#endif
 /*
  * Changes migrate type in [start_pfn, end_pfn) to be MIGRATE_ISOLATE.
  * If specified range includes migrate types other than MOVABLE or CMA,
diff --git a/include/linux/param_rw.h b/include/linux/param_rw.h
new file mode 100644
index 0000000000000000000000000000000000000000..cb3978255fca0cf66a1fded330666704292ffcd4
--- /dev/null
+++ b/include/linux/param_rw.h
@@ -0,0 +1,36 @@
+#ifndef __PARAM_RW_H
+#define __PARAM_RW_H
+
+#define PARAM_SID_LENGTH 1024
+#define DEFAULT_PARAM_DUMP_SIZE 64
+
+typedef unsigned int       uint32;
+
+typedef enum {
+	PARAM_SID_PRODUCT = 0,
+	PARAM_SID_CONFIG,
+	PARAM_SID_LCD,
+	PARAM_SID_TP,
+	PARAM_SID_TP_KPD,
+	PARAM_SID_CAMERA,
+	PARAM_SID_SENSORS,
+	PARAM_SID_BATTERY,
+	PARAM_SID_RTC,
+	PARAM_SID_CRASH_RECORD,
+	PARAM_SID_SALEINFO,
+	PARAM_SID_MISC,
+	PARAM_SID_DOWNLOAD,
+	PARAM_SID_PHONE_HISTORY,
+	NUM_PARAM_PLAINTEXT_SEGMENT,
+
+	PARAM_SID_INVALID = -1
+} param_sid_index_t;
+
+int get_param_by_index_and_offset(uint32 sid_index, uint32 offset, void * buf, int length);
+int set_param_by_index_and_offset(uint32 sid_index, uint32 offset, void * buf, int length);
+
+int add_restart_08_count(void);
+int add_restart_other_count(void);
+//end
+#endif
+
diff --git a/include/linux/pm_qos.h b/include/linux/pm_qos.h
index 27b0048044f037028318b78298e68e738465d9c3..d6d64d6543934be3a1c1dfe744e61ba3d45eba46 100644
--- a/include/linux/pm_qos.h
+++ b/include/linux/pm_qos.h
@@ -18,6 +18,14 @@ enum {
 	PM_QOS_NETWORK_LATENCY,
 	PM_QOS_NETWORK_THROUGHPUT,
 	PM_QOS_MEMORY_BANDWIDTH,
+	PM_QOS_C0_CPUFREQ_MAX,
+	PM_QOS_C0_CPUFREQ_MIN,
+	PM_QOS_C1_CPUFREQ_MAX,
+	PM_QOS_C1_CPUFREQ_MIN,
+	PM_QOS_C2_CPUFREQ_MAX,
+	PM_QOS_C2_CPUFREQ_MIN,
+	PM_QOS_DEVFREQ_MAX,
+	PM_QOS_DEVFREQ_MIN,
 
 	/* insert new class ID */
 	PM_QOS_NUM_CLASSES,
@@ -41,6 +49,17 @@ enum pm_qos_flags_status {
 #define PM_QOS_LATENCY_TOLERANCE_NO_CONSTRAINT	(-1)
 #define PM_QOS_LATENCY_ANY			((s32)(~(__u32)0 >> 1))
 
+#define        MIN_CPUFREQ  0
+#define        MAX_CPUFREQ  0x40
+#define        MASK_CPUFREQ 0xE0
+
+#define PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE       MAX_CPUFREQ
+#define PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE       MIN_CPUFREQ
+#define PM_QOS_DEVFREQ_MAX_DEFAULT_VALUE       MAX_CPUFREQ
+#define PM_QOS_DEVFREQ_MIN_DEFAULT_VALUE       MIN_CPUFREQ
+
+extern void msm_cpuidle_set_sleep_disable(bool disable);
+
 #define PM_QOS_FLAG_NO_POWER_OFF	(1 << 0)
 #define PM_QOS_FLAG_REMOTE_WAKEUP	(1 << 1)
 
diff --git a/include/linux/pm_wakeup.h b/include/linux/pm_wakeup.h
index 4c2cba7ec1d44edec6881ed7ac1e80ee27312c44..30dbec18ed33d0bbdbd2f85c50b3ae861740bfe7 100644
--- a/include/linux/pm_wakeup.h
+++ b/include/linux/pm_wakeup.h
@@ -108,6 +108,7 @@ extern void __pm_relax(struct wakeup_source *ws);
 extern void pm_relax(struct device *dev);
 extern void pm_wakeup_ws_event(struct wakeup_source *ws, unsigned int msec, bool hard);
 extern void pm_wakeup_dev_event(struct device *dev, unsigned int msec, bool hard);
+extern void pm_print_active_wakeup_sources_queue(bool on);
 
 #else /* !CONFIG_PM_SLEEP */
 
diff --git a/include/linux/power/oem_external_fg.h b/include/linux/power/oem_external_fg.h
new file mode 100644
index 0000000000000000000000000000000000000000..7ae3d1f30504547ce1c20f87e14c56deb9a472b3
--- /dev/null
+++ b/include/linux/power/oem_external_fg.h
@@ -0,0 +1,133 @@
+#ifndef	__OEM_EXTERNAL_FG_H__
+#define __OEM_EXTERNAL_FG_H__
+#include <linux/regmap.h>
+#include <linux/input/qpnp-power-on.h>
+
+enum {
+	ADAPTER_FW_UPDATE_NONE,
+	ADAPTER_FW_NEED_UPDATE,
+	ADAPTER_FW_UPDATE_SUCCESS,
+	ADAPTER_FW_UPDATE_FAIL,
+};
+
+struct op_adapter_chip {
+	int		timer_delay;
+	bool	tx_byte_over;
+	bool	rx_byte_over;
+	bool	rx_timeout;
+	unsigned long uart_tx_gpio;
+	unsigned long uart_rx_gpio;
+	char	*adapter_firmware_data;
+	unsigned int	adapter_fw_data_count;
+	unsigned int	tx_invalid_val;
+	bool	adapter_update_ing;
+	struct op_adapter_operations	*vops;
+};
+struct op_adapter_operations {
+	bool (*adapter_update)(struct op_adapter_chip *chip,
+			unsigned long tx_pin, unsigned long rx_pin);
+};
+
+struct external_battery_gauge {
+	int (*get_battery_mvolts)(void);
+	int (*get_battery_temperature)(void);
+	bool (*is_battery_present)(void);
+	bool (*is_battery_temp_within_range)(void);
+	bool (*is_battery_id_valid)(void);
+	bool (*is_usb_switch_on)(void);
+	int (*get_battery_status)(void);
+	int (*get_batt_remaining_capacity)(void);
+	int (*get_batt_health)(void);
+	int (*get_batt_bq_soc)(void);
+	int (*monitor_for_recharging)(void);
+	int (*get_battery_soc)(void);
+	int (*get_average_current)(void);
+	int (*get_batt_cc)(void);
+	int (*get_batt_fcc)(void);
+	bool (*fast_chg_started)(void);
+	bool (*fast_chg_status_is_ok)(void);
+	bool (*fast_switch_to_normal)(void);
+	int (*set_switch_to_noraml_false)(void);
+	int (*set_fast_chg_allow)(bool enable);
+	void (*clean)(void);
+	bool (*get_fast_chg_allow)(void);
+	int (*fast_normal_to_warm)(void);
+	int (*set_normal_to_warm_false)(void);
+	int (*get_adapter_update)(void);
+	bool (*is_enhance_dash)(void);
+	bool (*get_fast_chg_ing)(void);
+	bool (*get_fast_low_temp_full)(void);
+	int (*set_low_temp_full_false)(void);
+	int (*set_allow_reading)(int enable);
+	int (*set_lcd_off_status)(int status);
+	int (*fast_chg_started_status)(bool status);
+	bool (*get_fastchg_firmware_already_updated)(void);
+	int (*get_device_type)(void);
+};
+
+struct notify_dash_event {
+	int (*notify_event)(void);
+	int (*op_contrl)(int status, bool check_power_ok);
+	int (*notify_dash_charger_present)(int true);
+};
+
+struct notify_usb_enumeration_status {
+	int (*notify_usb_enumeration)(int status);
+};
+
+enum temp_region_type {
+	BATT_TEMP_COLD = 0,
+	BATT_TEMP_LITTLE_COLD,
+	BATT_TEMP_COOL,
+	BATT_TEMP_LITTLE_COOL,
+	BATT_TEMP_PRE_NORMAL,
+	BATT_TEMP_NORMAL,
+	BATT_TEMP_WARM,
+	BATT_TEMP_HOT,
+	BATT_TEMP_INVALID,
+};
+enum ffc_step {
+	FFC_DEFAULT = 0,
+	FFC_FAST,
+	FFC_TAPER,
+	FFC_NOR_TAPER,
+	FFC_WARM_TAPER,
+	FFC_IDLE,
+};
+
+enum batt_status_type {
+	BATT_STATUS_GOOD,
+	BATT_STATUS_BAD_TEMP, /* cold or hot */
+	BATT_STATUS_BAD,
+	BATT_STATUS_REMOVED, /* on v2.2 only */
+	BATT_STATUS_INVALID_v1 = BATT_STATUS_REMOVED,
+	BATT_STATUS_INVALID
+};
+void op_pm8998_regmap_register(struct regmap *regmap);
+
+void regsister_notify_usb_enumeration_status(
+	struct notify_usb_enumeration_status *event);
+void notify_dash_unplug_register(struct notify_dash_event *event);
+void notify_dash_unplug_unregister(struct notify_dash_event *event);
+void fastcharge_information_unregister(struct external_battery_gauge *fast_chg);
+void fastcharge_information_register(struct external_battery_gauge *fast_chg);
+void external_battery_gauge_register(struct external_battery_gauge *batt_gauge);
+void external_battery_gauge_unregister(
+	struct external_battery_gauge *batt_gauge);
+void bq27541_information_register(struct external_battery_gauge *fast_chg);
+void bq27541_information_unregister(struct external_battery_gauge *fast_chg);
+bool get_extern_fg_regist_done(void);
+bool get_extern_bq_present(void);
+int get_prop_pre_shutdown_soc(void);
+extern int get_charging_status(void);
+extern int fuelgauge_battery_temp_region_get(void);
+extern bool get_oem_charge_done_status(void);
+extern int load_soc(void);
+extern void backup_soc_ex(int soc);
+extern void clean_backup_soc_ex(void);
+extern void op_bus_vote(int disable);
+extern bool dash_adapter_update_is_tx_gpio(unsigned int  gpio_num);
+extern bool dash_adapter_update_is_rx_gpio(unsigned  int gpio_num);
+extern int is_hw_support_n76e(void);
+void op_switch_normal_set(void);
+#endif
diff --git a/include/linux/power_supply.h b/include/linux/power_supply.h
index ec6e8ab65c20430e3dc157879e41261021a409b7..34af127ea1cdef83a7fe121253d86adad404ecc7 100644
--- a/include/linux/power_supply.h
+++ b/include/linux/power_supply.h
@@ -148,6 +148,27 @@ enum {
 enum power_supply_property {
 	/* Properties of type `int' */
 	POWER_SUPPLY_PROP_STATUS = 0,
+	POWER_SUPPLY_PROP_SET_ALLOW_READ_EXTERN_FG_IIC,
+	POWER_SUPPLY_PROP_CC_TO_CV_POINT,
+	POWER_SUPPLY_PROP_CHG_PROTECT_STATUS,
+	POWER_SUPPLY_PROP_FASTCHG_IS_OK,
+	POWER_SUPPLY_PROP_FASTCHG_STATUS,
+	POWER_SUPPLY_PROP_FASTCHG_STARTING,
+	POWER_SUPPLY_CUTOFF_VOLT_WITH_CHARGER,
+	POWER_SUPPLY_PROP_UPDATE_LCD_IS_OFF,
+	POWER_SUPPLY_PROP_CHECK_USB_UNPLUG,
+	POWER_SUPPLY_PROP_OTG_SWITCH,
+	POWER_SUPPLY_PROP_HW_DETECT,
+	POWER_SUPPLY_PROP_SWITCH_DASH,
+	POWER_SUPPLY_PROP_NOTIFY_CHARGER_SET_PARAMETER,
+	POWER_SUPPLY_PROP_FG_CAPACITY,
+	POWER_SUPPLY_PROP_FG_VOLTAGE_NOW,
+	POWER_SUPPLY_PROP_FG_CURRENT_NOW,
+	POWER_SUPPLY_PROP_IS_AGING_TEST,
+	POWER_SUPPLY_PROP_CONNECTER_TEMP,
+	POWER_SUPPLY_PROP_CONNECT_DISABLE,
+	POWER_SUPPLY_PROP_BQ_SOC,
+	POWER_SUPPLY_PROP_OEM_TYPEC_CC_ORIENTATION,
 	POWER_SUPPLY_PROP_CHARGE_TYPE,
 	POWER_SUPPLY_PROP_HEALTH,
 	POWER_SUPPLY_PROP_PRESENT,
@@ -358,6 +379,7 @@ enum power_supply_type {
 	POWER_SUPPLY_TYPE_UFP,			/* Type-C UFP */
 	POWER_SUPPLY_TYPE_DFP,			/* Type-C DFP */
 	POWER_SUPPLY_TYPE_CHARGE_PUMP,		/* Charge Pump */
+	POWER_SUPPLY_TYPE_DASH,
 };
 
 /* Indicates USB Type-C CC connection status */
diff --git a/include/linux/printk.h b/include/linux/printk.h
index 6106befed7569199c2ab1d28e45779041bb5a459..9e80b55c19a5f318a56cab0aca16a16031c2a78c 100644
--- a/include/linux/printk.h
+++ b/include/linux/printk.h
@@ -527,5 +527,5 @@ static inline void print_hex_dump_debug(const char *prefix_str, int prefix_type,
 {
 }
 #endif
-
+int force_oem_console_setup(char *str);
 #endif
diff --git a/include/linux/project_info.h b/include/linux/project_info.h
new file mode 100755
index 0000000000000000000000000000000000000000..4e62dfa4d6270ce71875adf0d676b93ecb037fe2
--- /dev/null
+++ b/include/linux/project_info.h
@@ -0,0 +1,93 @@
+#ifndef _PROJECT_INFO_H_
+#define _PROJECT_INFO_H_ 1
+typedef		__u32		uint32;
+typedef     __u8        uint8;
+
+/*******SECURE_BOOTn = 0x00786078+ 0x4*n, n=[1..14]******/
+#define SECURE_BOOT_BASE		0x00786078
+#define SECURE_BOOT1			(SECURE_BOOT_BASE + 0x4*1)
+#define BUF_SIZE		64
+
+#define SMEM_DUMP_INFO 135
+#define SMEM_PROJECT_INFO 136
+
+#include <linux/string.h>
+#include <linux/kallsyms.h>
+extern unsigned long totalram_pages;
+
+struct project_info {
+    char project_name[8];  //eg, 16859
+    uint32  hw_version;  //PCB number, T0, EVT
+    uint32  rf_v1;   //v1 for mainboard_rf_version
+    uint32  rf_v2;   //v2 for aboard_rf_version
+    uint32  rf_v3;
+    uint32  modem;
+    uint32  operator;
+    uint32  ddr_manufacture_info;
+    uint32  ddr_row;
+    uint32  ddr_column;
+    uint32  ddr_fw_version;
+    uint32  ddr_reserve_info;
+    uint32  platform_id;
+    uint32  ftm_uart_boot_mode;
+    uint32  feature_id;
+    uint32  a_board_version;
+    uint32  prj_version;
+};
+
+#define DUMP_REASON_SIZE 256
+
+struct dump_info{
+    char    dump_reason[DUMP_REASON_SIZE];  //dump reason
+};
+
+struct component_info {
+	char *version;
+	char *manufacture;
+};
+
+enum{
+	HW_VERSION__UNKNOWN,
+	HW_VERSION__11 = 11,//all EVB
+	HW_VERSION__12,	//T0
+};
+
+enum COMPONENT_TYPE {
+	DDR,
+	EMMC,
+	F_CAMERA,
+	R_CAMERA,
+	SECOND_R_CAMERA,
+	THIRD_R_CAMERA,
+	R_MODULE,
+	F_MODULE,
+	TP,
+	LCD,
+	WCN,
+	I_SENSOR,
+	G_SENSOR,
+	M_SENSOR,
+	GYRO,
+	BACKLIGHT,
+	MAINBOARD,
+	/*Add new component here*/
+	FINGERPRINTS,
+	TOUCH_KEY,
+	UFS,
+	ABOARD,
+	NFC,
+	FAST_CHARGE,
+	CPU,
+    RF_VERSION,
+	COMPONENT_MAX,
+};
+
+char *parse_function_builtin_return_address(unsigned long function_address);
+int push_component_info(enum COMPONENT_TYPE type,
+	char *version, char *manufacture);
+int reset_component_info(enum COMPONENT_TYPE type);
+uint32 get_hw_version(void);
+void save_dump_reason_to_smem(char *info, char *function_name);
+
+
+#endif
diff --git a/include/linux/pstore.h b/include/linux/pstore.h
index 61f806a7fe29ec570a1c8f066767ef31c67b3042..584b987b000fbf36a8ede49ee58c0e2374152077 100644
--- a/include/linux/pstore.h
+++ b/include/linux/pstore.h
@@ -30,6 +30,8 @@
 #include <linux/time.h>
 #include <linux/types.h>
 
+#include <linux/pstore_ram.h>
+
 struct module;
 
 /* pstore record types (see fs/pstore/inode.c for filename templates) */
@@ -44,6 +46,7 @@ enum pstore_type_id {
 	PSTORE_TYPE_PPC_COMMON	= 6,
 	PSTORE_TYPE_PMSG	= 7,
 	PSTORE_TYPE_PPC_OPAL	= 8,
+	PSTORE_TYPE_DEVICE_INFO	= 9,
 	PSTORE_TYPE_UNKNOWN	= 255
 };
 
@@ -274,4 +277,35 @@ pstore_ftrace_write_timestamp(struct pstore_ftrace_record *rec, u64 val)
 }
 #endif
 
+struct ramoops_context {
+	struct persistent_ram_zone **dprzs;	/* Oops dump zones */
+	struct persistent_ram_zone *cprz;	/* Console zone */
+	struct persistent_ram_zone **fprzs;	/* Ftrace zones */
+	struct persistent_ram_zone *mprz;	/* PMSG zone */
+    struct persistent_ram_zone *dprz;
+	phys_addr_t phys_addr;
+	unsigned long size;
+	unsigned int memtype;
+	size_t record_size;
+	size_t console_size;
+	size_t ftrace_size;
+	size_t pmsg_size;
+    size_t device_info_size;
+	int dump_oops;
+	u32 flags;
+	struct persistent_ram_ecc_info ecc_info;
+	unsigned int max_dump_cnt;
+	unsigned int dump_write_cnt;
+	/* _read_cnt need clear on ramoops_pstore_open */
+	unsigned int dump_read_cnt;
+	unsigned int console_read_cnt;
+	unsigned int max_ftrace_cnt;
+	unsigned int ftrace_read_cnt;
+	unsigned int pmsg_read_cnt;
+	unsigned int device_info_read_cnt;
+	struct pstore_info pstore;
+};
+
+void save_dump_reason_to_device_info(char *buf);
+
 #endif /*_LINUX_PSTORE_H*/
diff --git a/include/linux/pstore_ram.h b/include/linux/pstore_ram.h
index 10fe2e28701faad19811d1d26ef05644571aafc3..a95b2c0e9df2eb7e67be3253b60c838408687676 100644
--- a/include/linux/pstore_ram.h
+++ b/include/linux/pstore_ram.h
@@ -98,6 +98,7 @@ struct ramoops_platform_data {
 	unsigned long	console_size;
 	unsigned long	ftrace_size;
 	unsigned long	pmsg_size;
+	unsigned long	device_info_size;
 	int		dump_oops;
 	u32		flags;
 	struct persistent_ram_ecc_info ecc_info;
diff --git a/include/linux/qcom-geni-se.h b/include/linux/qcom-geni-se.h
index a61f0014da824aaca1ecdf97532bd2c0ce0b6db9..fbe26ac009b84c706590bfa87b8e068312306d85 100644
--- a/include/linux/qcom-geni-se.h
+++ b/include/linux/qcom-geni-se.h
@@ -67,12 +67,13 @@ struct se_geni_rsc {
 	struct pinctrl *geni_pinctrl;
 	struct pinctrl_state *geni_gpio_active;
 	struct pinctrl_state *geni_gpio_sleep;
+	struct pinctrl_state *geni_gpio_reset;
 	int	clk_freq_out;
 };
 
 #define PINCTRL_DEFAULT	"default"
 #define PINCTRL_SLEEP	"sleep"
-
+#define PINCTRL_RESET	"reset"
 #define KHz(freq) (1000 * (freq))
 
 /* Common SE registers */
diff --git a/include/linux/rmap.h b/include/linux/rmap.h
index 7268a54b895669f69828f72685ce099edc39f9b2..4b9d81f210837983e3a2ba38ac9222a5fd2d2387 100644
--- a/include/linux/rmap.h
+++ b/include/linux/rmap.h
@@ -16,7 +16,9 @@ extern int isolate_lru_page(struct page *page);
 extern void putback_lru_page(struct page *page);
 extern unsigned long reclaim_pages_from_list(struct list_head *page_list,
 					     struct vm_area_struct *vma);
-
+#ifdef CONFIG_SMART_BOOST
+extern unsigned long reclaim_pages_from_uid_list(uid_t uid);
+#endif
 /*
  * The anon_vma heads a list of private "related" vmas, to scan if
  * an anonymous page pointing to this anon_vma needs to be unmapped:
diff --git a/include/linux/rwsem.h b/include/linux/rwsem.h
index c427ffaa49048c851689a6f09cfc9dfe5061bee5..fa3291f9b38a50a03b004b6900fe4636ae0620c0 100644
--- a/include/linux/rwsem.h
+++ b/include/linux/rwsem.h
@@ -42,6 +42,10 @@ struct rw_semaphore {
 #ifdef CONFIG_DEBUG_LOCK_ALLOC
 	struct lockdep_map	dep_map;
 #endif
+#ifdef CONFIG_RWSEM_PRIO_AWARE
+	/* count for waiters preempt to queue in wait list */
+	long m_count;
+#endif
 };
 
 /*
@@ -83,12 +87,19 @@ static inline int rwsem_is_locked(struct rw_semaphore *sem)
 #define __RWSEM_OPT_INIT(lockname)
 #endif
 
+#ifdef CONFIG_RWSEM_PRIO_AWARE
+#define __RWSEM_PRIO_AWARE_INIT(lockname)	.m_count = 0
+#else
+#define __RWSEM_PRIO_AWARE_INIT(lockname)
+#endif
+
 #define __RWSEM_INITIALIZER(name)				\
 	{ __RWSEM_INIT_COUNT(name),				\
 	  .wait_list = LIST_HEAD_INIT((name).wait_list),	\
 	  .wait_lock = __RAW_SPIN_LOCK_UNLOCKED(name.wait_lock)	\
 	  __RWSEM_OPT_INIT(name)				\
-	  __RWSEM_DEP_MAP_INIT(name) }
+	  __RWSEM_DEP_MAP_INIT(name),				\
+	  __RWSEM_PRIO_AWARE_INIT(name) }
 
 #define DECLARE_RWSEM(name) \
 	struct rw_semaphore name = __RWSEM_INITIALIZER(name)
diff --git a/include/linux/sched.h b/include/linux/sched.h
old mode 100644
new mode 100755
index 40406dffce4442706763c10b09d8d0753ca79e97..a2eca455be0b83023e80d609acbacb559c5aff81
--- a/include/linux/sched.h
+++ b/include/linux/sched.h
@@ -754,6 +754,16 @@ struct task_struct {
 	unsigned int			flags;
 	unsigned int			ptrace;
 
+	/* add for fd leak debug */
+	bool dump_fd_leak;
+
+	int compensate_time;
+	int compensate_need;
+
+        //huruihuan add for kill task in D status
+	unsigned int kill_flag;
+	struct timespec ttu;
+
 #ifdef CONFIG_SMP
 	struct llist_node		wake_entry;
 	int				on_cpu;
@@ -829,6 +839,12 @@ struct task_struct {
 	struct sched_info		sched_info;
 
 	struct list_head		tasks;
+
+#ifdef CONFIG_ADJ_CHAIN
+	struct list_head adj_chain_tasks;
+	u32 adj_chain_status;
+#endif
+
 #ifdef CONFIG_SMP
 	struct plist_node		pushable_tasks;
 	struct rb_node			pushable_dl_tasks;
@@ -1341,6 +1357,16 @@ struct task_struct {
 	 */
 	randomized_struct_fields_end
 
+#ifdef CONFIG_SMART_BOOST
+	int hot_count;
+#endif
+#ifdef CONFIG_OPCHAIN
+	u64 utask_tag;
+	u64 utask_tag_base;
+	int etask_claim;
+	int claim_cpu;
+	bool utask_slave;
+#endif
 	/* CPU-specific state of this task: */
 	struct thread_struct		thread;
 
diff --git a/include/linux/sched/signal.h b/include/linux/sched/signal.h
index fbf86ecd149d3826f519964dd61e6ef15efb2450..718c00e52a1dfbaaa84d6af9f34947dc9235ceac 100644
--- a/include/linux/sched/signal.h
+++ b/include/linux/sched/signal.h
@@ -214,6 +214,12 @@ struct signal_struct {
 	 * oom
 	 */
 	bool oom_flag_origin;
+#if defined(CONFIG_MEMPLUS)
+	spinlock_t	reclaim_state_lock;
+	unsigned long reclaim_timeout;
+	int swapin_should_readahead_m;
+	int memplus_type;
+#endif
 	short oom_score_adj;		/* OOM kill score adjustment */
 	short oom_score_adj_min;	/* OOM kill score adjustment min value.
 					 * Only settable by CAP_SYS_RESOURCE. */
diff --git a/include/linux/swap.h b/include/linux/swap.h
index 827aa3d26100b1a483dab394b5592650569990b3..717791aeb5720386edfc11880c2aa764437d256d 100644
--- a/include/linux/swap.h
+++ b/include/linux/swap.h
@@ -175,6 +175,10 @@ enum {
 					/* add others here before... */
 	SWP_SCANNING	= (1 << 12),	/* refcount in scan_swap_map */
 };
+#ifdef CONFIG_MEMPLUS
+#define SLOW_BDV 0
+#define FAST_BDV SWP_SYNCHRONOUS_IO
+#endif
 
 #define SWAP_CLUSTER_MAX 32UL
 #define COMPACT_CLUSTER_MAX SWAP_CLUSTER_MAX
@@ -314,6 +318,9 @@ extern unsigned long nr_free_pagecache_pages(void);
 
 
 /* linux/mm/swap.c */
+#ifdef CONFIG_MEMPLUS
+extern void lru_cache_add_active_anon(struct page *page);
+#endif
 extern void lru_cache_add(struct page *);
 extern void lru_cache_add_anon(struct page *page);
 extern void lru_cache_add_file(struct page *page);
@@ -362,6 +369,8 @@ extern int sysctl_swap_ratio_enable;
 extern int remove_mapping(struct address_space *mapping, struct page *page);
 extern unsigned long vm_total_pages;
 
+extern unsigned int vm_breath_period;
+extern int vm_breath_priority;
 #ifdef CONFIG_NUMA
 extern int node_reclaim_mode;
 extern int sysctl_min_unmapped_ratio;
@@ -409,7 +418,12 @@ extern struct address_space *swapper_spaces[];
 		>> SWAP_ADDRESS_SPACE_SHIFT])
 extern unsigned long total_swapcache_pages(void);
 extern void show_swap_cache_info(void);
+#ifdef CONFIG_MEMPLUS
+extern int add_to_swap(struct page *, unsigned long swap_bdv);
+extern bool is_fast_entry(swp_entry_t entry);
+#else
 extern int add_to_swap(struct page *page);
+#endif
 extern int add_to_swap_cache(struct page *, swp_entry_t, gfp_t);
 extern int __add_to_swap_cache(struct page *page, swp_entry_t entry);
 extern void __delete_from_swap_cache(struct page *);
@@ -439,19 +453,54 @@ extern bool has_usable_swap(void);
 /* Swap 50% full? Release swapcache more aggressively.. */
 static inline bool vm_swap_full(void)
 {
+#ifdef CONFIG_MEMPLUS
+	/* don't bother replace any swapcache only entries */
+	if (vm_memory_plus > 0)
+		return false;
+#endif
+
 	return atomic_long_read(&nr_swap_pages) * 2 < total_swap_pages;
 }
 
 static inline long get_nr_swap_pages(void)
 {
+#ifdef CONFIG_MEMPLUS
+	if (vm_memory_plus > 0)
+		return 0;
+#endif
 	return atomic_long_read(&nr_swap_pages);
 }
 
+#ifdef CONFIG_SMART_BOOST
+extern int sysctl_page_cache_reside_switch;
+extern int sysctl_page_cache_reside_max;
+extern unsigned long uid_lru_size(void);
+extern void uid_lru_cache_add(struct page *page);
+extern void _uid_lru_add_fn(struct page *page, struct lruvec *lruvec);
+extern struct uid_node *find_uid_node(uid_t uid, struct lruvec *lruvec);
+extern struct uid_node *insert_uid_node(struct uid_node **hash_table,
+							uid_t uid);
+extern struct uid_node **alloc_uid_hash_table(void);
+extern unsigned long killed_num;
+extern unsigned long inactive_nr;
+extern unsigned long active_nr;
+extern atomic_t vmpress[];
+extern unsigned long priority_nr[];
+extern unsigned long alloc_slow_nr;
+#endif
 extern void si_swapinfo(struct sysinfo *);
+#ifdef CONFIG_MEMPLUS
+extern swp_entry_t get_swap_page(struct page *page, unsigned long swap_bdv);
+#else
 extern swp_entry_t get_swap_page(struct page *page);
+#endif
 extern void put_swap_page(struct page *page, swp_entry_t entry);
 extern swp_entry_t get_swap_page_of_type(int);
+#ifdef CONFIG_MEMPLUS
+extern int get_swap_pages(int n, bool cluster, swp_entry_t swp_entries[], unsigned long swap_bdv);
+#else
 extern int get_swap_pages(int n, bool cluster, swp_entry_t swp_entries[]);
+#endif
 extern int add_swap_count_continuation(swp_entry_t, gfp_t);
 extern void swap_shmem_alloc(swp_entry_t);
 extern int swap_duplicate(swp_entry_t);
@@ -554,8 +603,11 @@ static inline struct page *lookup_swap_cache(swp_entry_t swp,
 {
 	return NULL;
 }
-
+#ifdef CONFIG_MEMPLUS
+static inline int add_to_swap(struct page *page, unsigned long swap_bdv)
+#else
 static inline int add_to_swap(struct page *page)
+#endif
 {
 	return 0;
 }
diff --git a/include/linux/sysctl.h b/include/linux/sysctl.h
index 701fef39dcc889b8d793ce65fb273fa7860c8e47..13e9baac6ee105c8756d3d08444910f9d9c39483 100644
--- a/include/linux/sysctl.h
+++ b/include/linux/sysctl.h
@@ -44,6 +44,8 @@ extern int proc_dostring(struct ctl_table *, int,
 			 void __user *, size_t *, loff_t *);
 extern int proc_dointvec(struct ctl_table *, int,
 			 void __user *, size_t *, loff_t *);
+extern int proc_dointvec_oem(struct ctl_table *, int,
+			 void __user *, size_t *, loff_t *);
 extern int proc_douintvec(struct ctl_table *, int,
 			 void __user *, size_t *, loff_t *);
 extern int proc_dointvec_minmax(struct ctl_table *, int,
diff --git a/include/linux/uidgid.h b/include/linux/uidgid.h
index b0542cd11aeb09f5d0c979e1acf31ad8d550bb6d..a54c52c76f7d84f571aedb3eb8df60ebb205908f 100644
--- a/include/linux/uidgid.h
+++ b/include/linux/uidgid.h
@@ -55,6 +55,8 @@ static inline gid_t __kgid_val(kgid_t gid)
 #define GLOBAL_ROOT_UID KUIDT_INIT(0)
 #define GLOBAL_ROOT_GID KGIDT_INIT(0)
 
+#define GLOBAL_SYSTEM_UID KUIDT_INIT(1000)
+
 #define INVALID_UID KUIDT_INIT(-1)
 #define INVALID_GID KGIDT_INIT(-1)
 
diff --git a/include/linux/vm_event_item.h b/include/linux/vm_event_item.h
index ca85428994d838efc0e0042fbf79d02f7d0f6a4e..b02c1c661aa84df046f47beea22976491e277121 100644
--- a/include/linux/vm_event_item.h
+++ b/include/linux/vm_event_item.h
@@ -28,6 +28,10 @@ enum vm_event_item { PGPGIN, PGPGOUT, PGPGOUTCLEAN, PSWPIN, PSWPOUT,
 		FOR_ALL_ZONES(PGSCAN_SKIP),
 		PGFREE, PGACTIVATE, PGDEACTIVATE, PGLAZYFREE,
 		PGFAULT, PGMAJFAULT,
+#ifdef CONFIG_MEMPLUS
+		PGADDTOSWAP,
+		PGSWAPWRITE,
+#endif
 		PGLAZYFREED,
 		PGREFILL,
 		PGSTEAL_KSWAPD,
@@ -112,6 +116,12 @@ enum vm_event_item { PGPGIN, PGPGOUT, PGPGOUTCLEAN, PSWPIN, PSWPOUT,
 #endif
 #ifdef CONFIG_SPECULATIVE_PAGE_FAULT
 		SPECULATIVE_PGFAULT,
+#endif
+#ifdef CONFIG_SMART_BOOST
+		FOR_ALL_ZONES(ALLOCSTALL_PRI1),
+		FOR_ALL_ZONES(ALLOCSTALL_PRI2),
+		FOR_ALL_ZONES(ALLOCSTALL_PRI3),
+		FOR_ALL_ZONES(ALLOCSTALL_PRI4),
 #endif
 		NR_VM_EVENT_ITEMS
 };
diff --git a/include/linux/vmstat.h b/include/linux/vmstat.h
index 1e0cb72e0598bb668f1207c6e031f2b731321187..d7189a668d356e6df14d2fa2d62ee36a5591c97b 100644
--- a/include/linux/vmstat.h
+++ b/include/linux/vmstat.h
@@ -7,7 +7,9 @@
 #include <linux/mmzone.h>
 #include <linux/vm_event_item.h>
 #include <linux/atomic.h>
-
+#ifdef CONFIG_SMART_BOOST
+#include <linux/hotcount.h>
+#endif
 extern int sysctl_stat_interval;
 
 #ifdef CONFIG_VM_EVENT_COUNTERS
@@ -378,6 +380,10 @@ static inline void __mod_zone_freepage_state(struct zone *zone, int nr_pages,
 	__mod_zone_page_state(zone, NR_FREE_PAGES, nr_pages);
 	if (is_migrate_cma(migratetype))
 		__mod_zone_page_state(zone, NR_FREE_CMA_PAGES, nr_pages);
+#ifdef CONFIG_DEFRAG_HELPER
+	if (is_migrate_defrag(migratetype))
+		__mod_zone_page_state(zone, NR_FREE_DEFRAG_POOL, nr_pages);
+#endif
 }
 
 extern const char * const vmstat_text[];
diff --git a/include/net/cfg80211.h b/include/net/cfg80211.h
index 54a221e14c68b94bb281082cd5265704b8629bf0..b0a37e35d3b6bf610f936931bac4516c54ae5659 100644
--- a/include/net/cfg80211.h
+++ b/include/net/cfg80211.h
@@ -47,6 +47,12 @@
 /* Indicate backport support for per chain rssi scan */
 #define CFG80211_SCAN_PER_CHAIN_RSSI_SUPPORT 1
 
+/* Indicate backport support for DBS scan control */
+#define CFG80211_SCAN_DBS_CONTROL_SUPPORT 1
+
+/* Indicate backport support for per chain rssi scan */
+#define CFG80211_SCAN_PER_CHAIN_RSSI_SUPPORT 1
+
 /**
  * DOC: Introduction
  *
diff --git a/include/oneplus/memplus/memplus.h b/include/oneplus/memplus/memplus.h
new file mode 100644
index 0000000000000000000000000000000000000000..6a9a32a29859202bef0c3836f08ec47bb0b21cbf
--- /dev/null
+++ b/include/oneplus/memplus/memplus.h
@@ -0,0 +1,40 @@
+#ifndef _MEMORY_PLUS_H
+#define _MEMORY_PLUS_H
+
+#ifdef CONFIG_MEMPLUS
+#define AID_APP	10000  /* first app user */
+extern int vm_memory_plus;
+extern int vm_memory_plus_test_worstcase;
+void memplus_state_check(int cur_adj, int prev_adj, struct task_struct* task);
+enum {
+	RECLAIM_STANDBY,
+	RECLAIM_QUEUE,
+	RECLAIM_DONE,
+	SWAPIN_QUEUE,
+};
+
+enum {
+	TYPE_NORMAL,
+	TYPE_FREQUENT,
+	TYPE_SYS_IGNORE,
+	TYPE_WILL_NEED,
+	TYPE_END
+};
+#define MEMPLUS_TYPE_MASK	0x7
+bool memplus_enabled(void);
+bool current_is_reclaimd(void);
+bool current_is_swapind(void);
+extern void memplus_move_swapcache_to_anon_lru(struct page *page);
+extern void memplus_move_anon_to_swapcache_lru(struct page *page);
+#else
+static __always_inline void memplus_move_swapcache_to_anon_lru(struct page *page)
+{
+     clear_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+}
+static __always_inline void memplus_move_anon_to_swapcache_lru(struct page *page)
+{
+     set_bit(PG_swapcache, &(PF_NO_TAIL(page, 1))->flags);
+}
+
+#endif
+#endif /* _MEMORY_PLUS_H */
diff --git a/include/scsi/scsi_proto.h b/include/scsi/scsi_proto.h
index 1c41dbcfcb35544f03e3557fbf765c81b2c770a6..e39422fe211cd789eefc7df9f59afba1fc054292 100644
--- a/include/scsi/scsi_proto.h
+++ b/include/scsi/scsi_proto.h
@@ -72,6 +72,7 @@
 #define WRITE_SAME            0x41
 #define UNMAP		      0x42
 #define READ_TOC              0x43
+#define READ_CD               0xbe
 #define READ_HEADER           0x44
 #define GET_EVENT_STATUS_NOTIFICATION 0x4a
 #define LOG_SELECT            0x4c
diff --git a/include/soc/qcom/icnss.h b/include/soc/qcom/icnss.h
index 7ef3db418100e481c6fcc5a0629dfe7f6a41fe13..3117a5f7cd81f16b2238146f0565745bc5b0c452 100644
--- a/include/soc/qcom/icnss.h
+++ b/include/soc/qcom/icnss.h
@@ -144,4 +144,5 @@ extern bool icnss_is_fw_ready(void);
 extern bool icnss_is_fw_down(void);
 extern bool icnss_is_rejuvenate(void);
 extern int icnss_trigger_recovery(struct device *dev);
+extern void cnss_set_fw_version(u32 version, u32 ext);
 #endif /* _ICNSS_WLAN_H_ */
diff --git a/include/soc/qcom/qmi_rmnet.h b/include/soc/qcom/qmi_rmnet.h
index 0bb1b9a10aedbff7abeb3909de0bd48105a3692c..39aba5b0c57c68ecbd704b7eaa2229c545424558 100644
--- a/include/soc/qcom/qmi_rmnet.h
+++ b/include/soc/qcom/qmi_rmnet.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -28,6 +28,9 @@ struct qmi_rmnet_ps_ind {
 void qmi_rmnet_qmi_exit(void *qmi_pt, void *port);
 void qmi_rmnet_change_link(struct net_device *dev, void *port, void *tcm_pt);
 void qmi_rmnet_enable_all_flows(struct net_device *dev);
+
+bool qmi_rmnet_all_flows_enabled(struct net_device *dev);
+
 #else
 static inline void qmi_rmnet_qmi_exit(void *qmi_pt, void *port)
 {
@@ -42,6 +45,14 @@ static inline void
 qmi_rmnet_enable_all_flows(struct net_device *dev)
 {
 }
+
+static inline bool
+qmi_rmnet_all_flows_enabled(struct net_device *dev)
+{
+	return true;
+}
+
+
 #endif
 
 #ifdef CONFIG_QCOM_QMI_DFC
@@ -79,7 +90,9 @@ int qmi_rmnet_set_powersave_mode(void *port, uint8_t enable);
 void qmi_rmnet_work_init(void *port);
 void qmi_rmnet_work_exit(void *port);
 void qmi_rmnet_work_maybe_restart(void *port);
-void qmi_rmnet_work_restart(void *port);
+//void qmi_rmnet_work_restart(void *port);
+
+void qmi_rmnet_set_dl_msg_active(void *port);
 
 int qmi_rmnet_ps_ind_register(void *port,
 			      struct qmi_rmnet_ps_ind *ps_ind);
@@ -96,10 +109,11 @@ static inline int qmi_rmnet_set_powersave_mode(void *port, uint8_t enable)
 static inline void qmi_rmnet_work_init(void *port)
 {
 }
-static inline void qmi_rmnet_work_restart(void *port)
-{
 
-}
+//static inline void qmi_rmnet_work_restart(void *port)
+//{
+//
+//}
 static inline void qmi_rmnet_work_exit(void *port)
 {
 }
@@ -107,6 +121,9 @@ static inline void qmi_rmnet_work_exit(void *port)
 static inline void qmi_rmnet_work_maybe_restart(void *port)
 {
 
+}
+static inline void qmi_rmnet_set_dl_msg_active(void *port)
+{
 }
 
 static inline int qmi_rmnet_ps_ind_register(struct rmnet_port *port,
diff --git a/include/soc/qcom/rmnet_qmi.h b/include/soc/qcom/rmnet_qmi.h
index 241d95c97b25cea39b70ba3b540c4fe100add2d6..5e1600cc27a448bf6af112e7f07c2cb65def180f 100644
--- a/include/soc/qcom/rmnet_qmi.h
+++ b/include/soc/qcom/rmnet_qmi.h
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2018, The Linux Foundation. All rights reserved.
+ * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -27,6 +27,9 @@ struct net_device *rmnet_get_rmnet_dev(void *port, u8 mux_id);
 void rmnet_reset_qmi_pt(void *port);
 void rmnet_init_qmi_pt(void *port, void *qmi);
 void rmnet_enable_all_flows(void *port);
+
+bool rmnet_all_flows_enabled(void *port);
+
 void rmnet_set_powersave_format(void *port);
 void rmnet_clear_powersave_format(void *port);
 void rmnet_get_packets(void *port, u64 *rx, u64 *tx);
@@ -65,6 +68,11 @@ static inline void rmnet_enable_all_flows(void *port)
 {
 }
 
+static inline bool rmnet_all_flows_enabled(void *port)
+{
+	return true;
+}
+
 static inline void rmnet_set_port_format(void *port)
 {
 }
diff --git a/include/soc/qcom/subsystem_restart.h b/include/soc/qcom/subsystem_restart.h
index 8b63e5bad436e24433026b9a6694d0e08a7f5113..a2211dea388632e45625b0659074d3261635cd88 100644
--- a/include/soc/qcom/subsystem_restart.h
+++ b/include/soc/qcom/subsystem_restart.h
@@ -19,6 +19,7 @@
 
 struct subsys_device;
 extern struct bus_type subsys_bus_type;
+extern bool modem_5G_panic;
 
 enum {
 	RESET_SOC = 0,
diff --git a/include/trace/events/kmem.h b/include/trace/events/kmem.h
index bf170725c397b168af7847e2bf3162c45ff657c3..dca2bc234698a33823c17d0b9fcb07d6b2dd578f 100644
--- a/include/trace/events/kmem.h
+++ b/include/trace/events/kmem.h
@@ -233,6 +233,34 @@ TRACE_EVENT(mm_page_alloc,
 		show_gfp_flags(__entry->gfp_flags))
 );
 
+TRACE_EVENT(mm_page_alloc_time,
+
+	TP_PROTO(u64 time, unsigned int order,
+			gfp_t gfp_flags, int migratetype),
+
+	TP_ARGS(time, order, gfp_flags, migratetype),
+
+	TP_STRUCT__entry(
+		__field(	u64,			time		)
+		__field(	unsigned int,	order		)
+		__field(	gfp_t,		gfp_flags	)
+		__field(	int,		migratetype	)
+	),
+
+	TP_fast_assign(
+		__entry->time			= time;
+		__entry->order		= order;
+		__entry->gfp_flags	= gfp_flags;
+		__entry->migratetype	= migratetype;
+	),
+
+	TP_printk("alloc_pages consumed %llu ms order=%d migratetype=%d gfp_flags=%s",
+		__entry->time,
+		__entry->order,
+		__entry->migratetype,
+		show_gfp_flags(__entry->gfp_flags))
+);
+
 DECLARE_EVENT_CLASS(mm_page,
 
 	TP_PROTO(struct page *page, unsigned int order, int migratetype),
diff --git a/include/trace/events/mmflags.h b/include/trace/events/mmflags.h
index 72162f3a03fac22e15f670e872ced6f9008595a3..ad03949e702fbef1bbaa989bc60113772944f834 100644
--- a/include/trace/events/mmflags.h
+++ b/include/trace/events/mmflags.h
@@ -80,6 +80,18 @@
 #define IF_HAVE_PG_IDLE(flag,string)
 #endif
 
+#ifdef CONFIG_MEMPLUS
+#define IF_HAVE_PG_WILLNEED(flag,string) ,{1UL << flag, string}
+#else
+#define IF_HAVE_PG_WILLNEED(flag,string)
+#endif
+
+#ifdef CONFIG_SMART_BOOST
+#define IF_HAVE_PG_UIDRU(flag,string) ,{1UL << flag, string}
+#else
+#define IF_HAVE_PG_UIDRU(flag,string)
+#endif
+
 #define __def_pageflag_names						\
 	{1UL << PG_locked,		"locked"	},		\
 	{1UL << PG_waiters,		"waiters"	},		\
@@ -105,7 +117,10 @@ IF_HAVE_PG_MLOCK(PG_mlocked,		"mlocked"	)		\
 IF_HAVE_PG_UNCACHED(PG_uncached,	"uncached"	)		\
 IF_HAVE_PG_HWPOISON(PG_hwpoison,	"hwpoison"	)		\
 IF_HAVE_PG_IDLE(PG_young,		"young"		)		\
-IF_HAVE_PG_IDLE(PG_idle,		"idle"		)
+IF_HAVE_PG_IDLE(PG_idle,		"idle"		)		\
+IF_HAVE_PG_WILLNEED(PG_willneed, "willneed")				\
+IF_HAVE_PG_UIDRU(PG_uidlru,     "uidlru")
+
 
 #define show_page_flags(flags)						\
 	(flags) ? __print_flags(flags, "|",				\
diff --git a/include/trace/events/sched.h b/include/trace/events/sched.h
old mode 100644
new mode 100755
index 5bc0cbe93260956c063f26855978b8914286046c..b93a51a0bc6b13458e529ad8de59d058f5a111ac
--- a/include/trace/events/sched.h
+++ b/include/trace/events/sched.h
@@ -1445,6 +1445,57 @@ TRACE_EVENT(sched_energy_diff,
 		__entry->backup_cpu, __entry->backup_energy)
 );
 
+#ifdef CONFIG_OPCHAIN
+TRACE_EVENT(sched_task_util,
+
+	TP_PROTO(struct task_struct *p, int next_cpu, int backup_cpu,
+		int target_cpu, bool sync, bool need_idle, int fastpath,
+		bool placement_boost, int rtg_cpu, bool ux_task, u64 start_t),
+
+	TP_ARGS(p, next_cpu, backup_cpu, target_cpu, sync, need_idle, fastpath,
+		placement_boost, rtg_cpu, ux_task, start_t),
+
+	TP_STRUCT__entry(
+		__field(int, pid			)
+		__array(char, comm, TASK_COMM_LEN	)
+		__field(unsigned long, util		)
+		__field(int, prev_cpu			)
+		__field(int, next_cpu			)
+		__field(int, backup_cpu			)
+		__field(int, target_cpu			)
+		__field(bool, sync			)
+		__field(bool, need_idle			)
+		__field(int, fastpath			)
+		__field(int, placement_boost		)
+		__field(int, rtg_cpu			)
+		__field(u64, latency			)
+		__field(bool, ux_task			)
+	),
+
+	TP_fast_assign(
+		__entry->pid			= p->pid;
+		memcpy(__entry->comm, p->comm, TASK_COMM_LEN);
+		__entry->util			= task_util(p);
+		__entry->prev_cpu		= task_cpu(p);
+		__entry->next_cpu		= next_cpu;
+		__entry->backup_cpu		= backup_cpu;
+		__entry->target_cpu		= target_cpu;
+		__entry->sync			= sync;
+		__entry->need_idle		= need_idle;
+		__entry->fastpath		= fastpath;
+		__entry->placement_boost	= placement_boost;
+		__entry->rtg_cpu		= rtg_cpu;
+		__entry->latency		= (sched_clock() - start_t);
+		__entry->ux_task		= ux_task;
+	),
+
+	TP_printk("pid=%d comm=%s util=%lu prev_cpu=%d next_cpu=%d backup_cpu=%d target_cpu=%d sync=%d need_idle=%d fastpath=%d placement_boost=%d rtg_cpu=%d ux_task=%d latency=%llu",
+		__entry->pid, __entry->comm, __entry->util, __entry->prev_cpu,
+		__entry->next_cpu, __entry->backup_cpu, __entry->target_cpu,
+		__entry->sync, __entry->need_idle, __entry->fastpath,
+		__entry->placement_boost, __entry->rtg_cpu, __entry->ux_task, __entry->latency)
+)
+#else
 TRACE_EVENT(sched_task_util,
 
 	TP_PROTO(struct task_struct *p, int next_cpu, int backup_cpu,
@@ -1492,7 +1543,7 @@ TRACE_EVENT(sched_task_util,
 		__entry->sync, __entry->need_idle, __entry->fastpath,
 		__entry->placement_boost, __entry->rtg_cpu, __entry->latency)
 )
-
+#endif
 /*
  * Tracepoint for sched_get_nr_running_avg
  */
diff --git a/include/uapi/asm-generic/setup.h b/include/uapi/asm-generic/setup.h
index 88ac5100df3598f23a7b0159fa91d9f29a24f3da..5594006fb7e21079cdfd852792235a56c7ab811d 100644
--- a/include/uapi/asm-generic/setup.h
+++ b/include/uapi/asm-generic/setup.h
@@ -2,6 +2,6 @@
 #ifndef __ASM_GENERIC_SETUP_H
 #define __ASM_GENERIC_SETUP_H
 
-#define COMMAND_LINE_SIZE	512
+#define COMMAND_LINE_SIZE	1024
 
 #endif	/* __ASM_GENERIC_SETUP_H */
diff --git a/include/uapi/drm/msm_drm.h b/include/uapi/drm/msm_drm.h
index 6ce22ea6f7ae3177c02647794beae6f3b165fd52..07d30b3de6a9bc17e0a02edb2a8a3546d7f13c69 100644
--- a/include/uapi/drm/msm_drm.h
+++ b/include/uapi/drm/msm_drm.h
@@ -360,6 +360,16 @@ struct drm_msm_event_resp {
 	__u8 data[];
 };
 
+/**
+ * struct drm_msm_power_ctrl: Payload to enable/disable the power vote
+ * @enable: enable/disable the power vote
+ * @flags:  operation control flags, for future use
+ */
+struct drm_msm_power_ctrl {
+	__u32 enable;
+	__u32 flags;
+};
+
 #define DRM_MSM_GET_PARAM              0x00
 /* placeholder:
 #define DRM_MSM_SET_PARAM              0x01
@@ -376,6 +386,7 @@ struct drm_msm_event_resp {
 #define DRM_MSM_REGISTER_EVENT         0x41
 #define DRM_MSM_DEREGISTER_EVENT       0x42
 #define DRM_MSM_RMFB2                  0x43
+#define DRM_MSM_POWER_CTRL             0x44
 
 /* sde custom events */
 #define DRM_EVENT_HISTOGRAM 0x80000000
@@ -403,6 +414,8 @@ struct drm_msm_event_resp {
 			DRM_MSM_DEREGISTER_EVENT), struct drm_msm_event_req)
 #define DRM_IOCTL_MSM_RMFB2 DRM_IOW((DRM_COMMAND_BASE + \
 			DRM_MSM_RMFB2), unsigned int)
+#define DRM_IOCTL_MSM_POWER_CTRL DRM_IOW((DRM_COMMAND_BASE + \
+			DRM_MSM_POWER_CTRL), struct drm_msm_power_ctrl)
 
 #if defined(__cplusplus)
 }
diff --git a/include/uapi/linux/ipa_qmi_service_v01.h b/include/uapi/linux/ipa_qmi_service_v01.h
index 8747cbd64ad8a24d4a6f09036b7f0018189134ad..159799bb4f7da377ee1973e6b80b2d1017d034fe 100644
--- a/include/uapi/linux/ipa_qmi_service_v01.h
+++ b/include/uapi/linux/ipa_qmi_service_v01.h
@@ -1,4 +1,4 @@
-/* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2013-2019, The Linux Foundation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 and
@@ -92,8 +92,8 @@ enum ipa_qmi_error_type_v01 {
 };
 
 struct ipa_qmi_response_type_v01 {
-	enum ipa_qmi_result_type_v01 result;
-	enum ipa_qmi_error_type_v01 error;
+	uint16_t result;
+	uint16_t error;
 };
 
 enum ipa_platform_type_enum_v01 {
diff --git a/include/uapi/linux/netlink.h b/include/uapi/linux/netlink.h
index 5fa3fcc1012873eb10811d276b4584d4926c6224..b0970408513f700b62d6f1649ed217ded893a1c6 100644
--- a/include/uapi/linux/netlink.h
+++ b/include/uapi/linux/netlink.h
@@ -31,6 +31,7 @@
 #define NETLINK_SMC		22	/* SMC monitoring */
 #define NETLINK_SOCKEV		23	/* Socket Administrative Events */
 #define NETLINK_INET_DIAG	NETLINK_SOCK_DIAG
+#define NETLINK_ADB         23
 
 #define MAX_LINKS 32		
 
diff --git a/include/uapi/linux/qbt1000.h b/include/uapi/linux/qbt1000.h
index 0012d23029cec5fcd241e3f10997a9f19b23cd3b..499136b39b2540c3a87fe8ee23c0b52cbf662175 100644
--- a/include/uapi/linux/qbt1000.h
+++ b/include/uapi/linux/qbt1000.h
@@ -18,9 +18,10 @@ enum qbt1000_commands {
 	QBT1000_UNLOAD_APP = 101,
 	QBT1000_SEND_TZCMD = 102,
 	QBT1000_SET_FINGER_DETECT_KEY = 103,
-	QBT1000_CONFIGURE_POWER_KEY = 104
+	QBT1000_CONFIGURE_POWER_KEY = 104,
+	QBT1000_ENABLE_GESTURES = 105,
+	QBT1000_SET_SENSOR_POSITION = 107
 };
-#define QBT1000_ENABLE_GESTURES 105
 
 /*
  * enum qbt1000_fw_event -
@@ -105,5 +106,20 @@ struct qbt1000_set_finger_detect_key {
 struct qbt1000_configure_power_key {
 	unsigned int enable;
 };
+/*
+ * struct qbt1000_set_sensor_pos
+ * used to set the sensor position for under-display
+ * @top - upper limit position of the sensor (in pixels)
+ * @bottom - lower limit position of the sensor (in pixels)
+ * @left - left limit position of the sensor (in pixels)
+ * @right - right limit position of the sensor (in pixels)
+ */
+struct qbt1000_sensor_pos {
+	bool         enable;
+	unsigned int top;
+	unsigned int bottom;
+	unsigned int left;
+	unsigned int right;
+};
 
 #endif /* _UAPI_QBT1000_H_ */
diff --git a/include/uapi/linux/qrtr.h b/include/uapi/linux/qrtr.h
index f7e2fb3d752b5a35bb55ba3dd5313c8ff84f6893..ad3b401f1e2e1f2aa8bb5ad9e04788f0527bb816 100644
--- a/include/uapi/linux/qrtr.h
+++ b/include/uapi/linux/qrtr.h
@@ -27,6 +27,8 @@ enum qrtr_pkt_type {
 	QRTR_TYPE_NEW_LOOKUP	= 10,
 	QRTR_TYPE_DEL_LOOKUP	= 11,
 };
+#define QRTR_TYPE_DEL_PROC	13
+
 
 struct qrtr_ctrl_pkt {
 	__le32 cmd;
@@ -43,6 +45,11 @@ struct qrtr_ctrl_pkt {
 			__le32 node;
 			__le32 port;
 		} client;
+
+		struct {
+			__le32 rsvd;
+			__le32 node;
+		} proc;
 	};
 } __packed;
 
diff --git a/include/uapi/media/cam_defs.h b/include/uapi/media/cam_defs.h
old mode 100644
new mode 100755
index 234b6462fe5b3ebbb90784403332c710e10bbd5f..3700d1b271f6adc9ef1a3d87108781c9c0045041
--- a/include/uapi/media/cam_defs.h
+++ b/include/uapi/media/cam_defs.h
@@ -21,6 +21,8 @@
 #define CAM_COMMON_OPCODE_BASE_v2           0x150
 #define CAM_ACQUIRE_HW                      (CAM_COMMON_OPCODE_BASE_v2 + 0x1)
 #define CAM_RELEASE_HW                      (CAM_COMMON_OPCODE_BASE_v2 + 0x2)
+#define CAM_GET_DPC_DATA                    (CAM_COMMON_OPCODE_BASE_v2 + 0x3)
+#define CAM_GET_FUSE_ID                     (CAM_COMMON_OPCODE_BASE_v2 + 0x4)
 
 #define CAM_EXT_OPCODE_BASE                     0x200
 #define CAM_CONFIG_DEV_EXTERNAL                 (CAM_EXT_OPCODE_BASE + 0x1)
@@ -84,7 +86,8 @@ struct cam_control {
 /* camera IOCTL */
 #define VIDIOC_CAM_CONTROL \
 	_IOWR('V', BASE_VIDIOC_PRIVATE, struct cam_control)
-
+#define VIDIOC_CAM_FTM_POWNER_UP 0
+#define VIDIOC_CAM_FTM_POWNER_DOWN 1
 /**
  * struct cam_hw_version - Structure for HW version of camera devices
  *
diff --git a/include/uapi/media/cam_req_mgr.h b/include/uapi/media/cam_req_mgr.h
index b903078dccbdeddd65953b2e284078ab16e428f5..b41ab6bfb4c4c2ac1cb21985b0ca5003b6c09b52 100644
--- a/include/uapi/media/cam_req_mgr.h
+++ b/include/uapi/media/cam_req_mgr.h
@@ -34,7 +34,7 @@
  * Max handles supported by cam_req_mgr
  * It includes both session and device handles
  */
-#define CAM_REQ_MGR_MAX_HANDLES           64
+#define CAM_REQ_MGR_MAX_HANDLES           128
 #define MAX_LINKS_PER_SESSION             2
 
 /* V4L event type which user space will subscribe to */
diff --git a/include/uapi/media/cam_sensor.h b/include/uapi/media/cam_sensor.h
index f5af6047f5ac8801288f90c8a736a7f0ff4024e9..65d7079c998849938b3bc5da2a4e5db833d0017a 100644
--- a/include/uapi/media/cam_sensor.h
+++ b/include/uapi/media/cam_sensor.h
@@ -474,4 +474,16 @@ struct cam_flash_query_cap_info {
 	uint32_t    max_current_torch[CAM_FLASH_MAX_LED_TRIGGERS];
 } __attribute__ ((packed));
 
+#define FD_DFCT_MAX_NUM 5
+#define SG_DFCT_MAX_NUM 299
+
+struct sony_dfct_tbl_t {
+	//---- single static defect ----
+	int sg_dfct_num;		// the number of single static defect
+	int sg_dfct_addr[SG_DFCT_MAX_NUM];		// [ u25 ( upper-u13 = x-addr, lower-u12 = y-addr ) ]
+	//---- FD static defect ----
+	int fd_dfct_num;		// the number of FD static defect
+	int fd_dfct_addr[FD_DFCT_MAX_NUM];		// [ u25 ( upper-u13 = x-addr, lower-u12 = y-addr ) ]
+} __attribute__ ((packed));
+
 #endif
diff --git a/init/Kconfig b/init/Kconfig
old mode 100644
new mode 100755
index 7ff9d2ab3b8d5a9480b688d59ba6dc3acec67d61..dccbbf8c70985b4674730ced3c264ff251f0c950
--- a/init/Kconfig
+++ b/init/Kconfig
@@ -515,7 +515,7 @@ config IKCONFIG_PROC
 config LOG_BUF_SHIFT
 	int "Kernel log buffer size (16 => 64KB, 17 => 128KB)"
 	range 12 25
-	default 17
+	default 18
 	depends on PRINTK
 	help
 	  Select the minimal kernel log buffer size as a power of 2.
diff --git a/init/main.c b/init/main.c
index c4a45145e102db935d2b7c6032b24e2e797189a1..85250937436795727513097dea8b4d2b6437896b 100644
--- a/init/main.c
+++ b/init/main.c
@@ -207,6 +207,7 @@ EXPORT_SYMBOL(loops_per_jiffy);
 static int __init debug_kernel(char *str)
 {
 	console_loglevel = CONSOLE_LOGLEVEL_DEBUG;
+	default_message_loglevel = CONSOLE_LOGLEVEL_DEBUG;
 	return 0;
 }
 
diff --git a/kernel/Kconfig.locks b/kernel/Kconfig.locks
index 84d882f3e2993b9ce3fdef1cc6aff5c52a8f4622..621c296fe8f84548a87a5b30aacee9185cabb217 100644
--- a/kernel/Kconfig.locks
+++ b/kernel/Kconfig.locks
@@ -248,3 +248,7 @@ config ARCH_USE_QUEUED_RWLOCKS
 config QUEUED_RWLOCKS
 	def_bool y if ARCH_USE_QUEUED_RWLOCKS
 	depends on SMP
+
+config RWSEM_PRIO_AWARE
+       def_bool y
+       depends on RWSEM_XCHGADD_ALGORITHM
diff --git a/kernel/cgroup/cgroup-v1.c b/kernel/cgroup/cgroup-v1.c
index 292b60183e57e00e23d85493a09d316a4c8dd283..604b50420b067a5f776a814313cf6eb4fdae5784 100644
--- a/kernel/cgroup/cgroup-v1.c
+++ b/kernel/cgroup/cgroup-v1.c
@@ -540,6 +540,7 @@ static ssize_t __cgroup1_procs_write(struct kernfs_open_file *of,
 	cred = current_cred();
 	tcred = get_task_cred(task);
 	if (!uid_eq(cred->euid, GLOBAL_ROOT_UID) &&
+            !uid_eq(cred->euid, GLOBAL_SYSTEM_UID) &&
 	    !uid_eq(cred->euid, tcred->uid) &&
 	    !uid_eq(cred->euid, tcred->suid) &&
 	    !ns_capable(tcred->user_ns, CAP_SYS_NICE))
diff --git a/kernel/cgroup/freezer.c b/kernel/cgroup/freezer.c
index 08236798d17315622d73540d62a89dcbafdc5c77..590d2ffe31c7d944169baecd84552691d5f0d39c 100644
--- a/kernel/cgroup/freezer.c
+++ b/kernel/cgroup/freezer.c
@@ -22,6 +22,8 @@
 #include <linux/freezer.h>
 #include <linux/seq_file.h>
 #include <linux/mutex.h>
+#include <linux/sched/task.h>
+#include <linux/sched/signal.h>
 
 /*
  * A cgroup is freezing if any FREEZING flags are set.  FREEZING_SELF is
@@ -43,6 +45,7 @@ enum freezer_state_flags {
 struct freezer {
 	struct cgroup_subsys_state	css;
 	unsigned int			state;
+	unsigned int                    oem_freeze_flag;
 };
 
 static DEFINE_MUTEX(freezer_mutex);
@@ -322,7 +325,7 @@ static void freeze_cgroup(struct freezer *freezer)
 
 	css_task_iter_start(&freezer->css, 0, &it);
 	while ((task = css_task_iter_next(&it)))
-		freeze_task(task);
+		freeze_cgroup_task(task);
 	css_task_iter_end(&it);
 }
 
@@ -330,11 +333,22 @@ static void unfreeze_cgroup(struct freezer *freezer)
 {
 	struct css_task_iter it;
 	struct task_struct *task;
+	struct task_struct *tmp_tsk = NULL;
+	struct task_struct *g, *p;
 
 	css_task_iter_start(&freezer->css, 0, &it);
-	while ((task = css_task_iter_next(&it)))
+	while ((task = css_task_iter_next(&it))) {
+		tmp_tsk = task;
 		__thaw_task(task);
+	}
 	css_task_iter_end(&it);
+	read_lock(&tasklist_lock);
+	do_each_thread(g, p) {
+		if (tmp_tsk && tmp_tsk->real_cred && p->real_cred &&
+			p->real_cred->uid.val == tmp_tsk->real_cred->uid.val)
+			__thaw_task(p);
+	} while_each_thread(g, p);
+	read_unlock(&tasklist_lock);
 }
 
 /**
@@ -392,6 +406,7 @@ static void freezer_change_state(struct freezer *freezer, bool freeze)
 	 * CGROUP_FREEZING_PARENT.
 	 */
 	mutex_lock(&freezer_mutex);
+	freezer->oem_freeze_flag = freeze ? 1 : 0;
 	rcu_read_lock();
 	css_for_each_descendant_pre(pos, &freezer->css) {
 		struct freezer *pos_f = css_freezer(pos);
@@ -416,6 +431,29 @@ static void freezer_change_state(struct freezer *freezer, bool freeze)
 	mutex_unlock(&freezer_mutex);
 }
 
+void unfreezer_fork(struct task_struct *task)
+{
+       struct freezer *freezer = NULL;
+
+       /*
+        * The root cgroup is non-freezable, so we can skip locking the
+       */
+       if (task_css_is_root(task, freezer_cgrp_id))
+               return;
+
+       rcu_read_lock();
+       freezer = task_freezer(task);
+       rcu_read_unlock();
+
+       /* Only unfreeze the "writed FROZEN" group
+       */
+       if (freezer->oem_freeze_flag != 1)
+               return;
+
+       pr_debug("%s:%s(%d)try to unfreeze\n", __func__, task->comm, task->pid);
+       freezer_change_state(freezer, 0);
+}
+
 static ssize_t freezer_write(struct kernfs_open_file *of,
 			     char *buf, size_t nbytes, loff_t off)
 {
diff --git a/kernel/exit.c b/kernel/exit.c
index ac1a814e7a5fe6fcaac6e15b6f0ced8a4cc220ae..58f1b55bf685d94b156243bc7b6fce83f66a74b6 100644
--- a/kernel/exit.c
+++ b/kernel/exit.c
@@ -61,6 +61,9 @@
 #include <linux/kcov.h>
 #include <linux/random.h>
 #include <linux/rcuwait.h>
+#ifdef CONFIG_ADJ_CHAIN
+#include <linux/adj_chain.h>
+#endif
 #include <linux/compat.h>
 
 #include <linux/uaccess.h>
@@ -76,6 +79,9 @@ static void __unhash_process(struct task_struct *p, bool group_dead)
 		detach_pid(p, PIDTYPE_PGID);
 		detach_pid(p, PIDTYPE_SID);
 
+#ifdef CONFIG_ADJ_CHAIN
+		adj_chain_detach(p);
+#endif
 		list_del_rcu(&p->tasks);
 		list_del_init(&p->sibling);
 		__this_cpu_dec(process_counts);
diff --git a/kernel/fork.c b/kernel/fork.c
index d875b3d2f6b15be7ce1c5a219ca4d9a50254c999..4701aad8883ad5432d8b5ed9c032d8924c1f106b 100644
--- a/kernel/fork.c
+++ b/kernel/fork.c
@@ -89,6 +89,9 @@
 #include <linux/sysctl.h>
 #include <linux/kcov.h>
 #include <linux/livepatch.h>
+#ifdef CONFIG_ADJ_CHAIN
+#include <linux/adj_chain.h>
+#endif
 #include <linux/thread_info.h>
 #include <linux/cpufreq_times.h>
 
@@ -578,6 +581,13 @@ static struct task_struct *dup_task_struct(struct task_struct *orig, int node)
 	tsk->splice_pipe = NULL;
 	tsk->task_frag.page = NULL;
 	tsk->wake_q.next = NULL;
+#ifdef CONFIG_OPCHAIN
+	tsk->utask_tag = 0;
+	tsk->utask_tag_base = 0;
+	tsk->etask_claim = 0;
+	tsk->claim_cpu = -1;
+	tsk->utask_slave = 0;
+#endif
 
 	account_kernel_stack(tsk, 1);
 
@@ -828,6 +838,7 @@ static struct mm_struct *mm_init(struct mm_struct *mm, struct task_struct *p,
 	mm->pinned_vm = 0;
 	memset(&mm->rss_stat, 0, sizeof(mm->rss_stat));
 	spin_lock_init(&mm->page_table_lock);
+	spin_lock_init(&mm->arg_lock);
 	mm_init_cpumask(mm);
 	mm_init_aio(mm);
 	mm_init_owner(mm, p);
@@ -1445,6 +1456,11 @@ static int copy_signal(unsigned long clone_flags, struct task_struct *tsk)
 
 	sig->oom_score_adj = current->signal->oom_score_adj;
 	sig->oom_score_adj_min = current->signal->oom_score_adj_min;
+#ifdef CONFIG_MEMPLUS
+	sig->swapin_should_readahead_m = RECLAIM_STANDBY;
+	sig->reclaim_state_lock = __SPIN_LOCK_UNLOCKED(reclaim_state_lock);
+	sig->memplus_type = TYPE_NORMAL;
+#endif
 
 	mutex_init(&sig->cred_guard_mutex);
 
@@ -1896,6 +1912,9 @@ static __latent_entropy struct task_struct *copy_process(
 	if (likely(p->pid)) {
 		ptrace_init_task(p, (clone_flags & CLONE_PTRACE) || trace);
 
+#ifdef CONFIG_ADJ_CHAIN
+		adj_chain_init_list(p);
+#endif
 		init_task_pid(p, PIDTYPE_PID, pid);
 		if (thread_group_leader(p)) {
 			init_task_pid(p, PIDTYPE_PGID, task_pgrp(current));
@@ -1917,6 +1936,9 @@ static __latent_entropy struct task_struct *copy_process(
 							 p->real_parent->signal->is_child_subreaper;
 			list_add_tail(&p->sibling, &p->real_parent->children);
 			list_add_tail_rcu(&p->tasks, &init_task.tasks);
+#ifdef CONFIG_ADJ_CHAIN
+			adj_chain_attach(p);
+#endif
 			attach_pid(p, PIDTYPE_PGID);
 			attach_pid(p, PIDTYPE_SID);
 			__this_cpu_inc(process_counts);
@@ -2075,6 +2097,10 @@ long _do_fork(unsigned long clone_flags,
 
 		trace_sched_process_fork(current, p);
 
+#ifdef CONFIG_SMART_BOOST
+		if (!(clone_flags & CLONE_VM))
+			p->hot_count = 0;
+#endif
 		pid = get_task_pid(p, PIDTYPE_PID);
 		nr = pid_vnr(pid);
 
diff --git a/kernel/freezer.c b/kernel/freezer.c
index 6f56a9e219facf003d802bd1e9c0cd2dea9824d3..b9bda624ef4a46ae456e3ed7d06332595d8c3892 100644
--- a/kernel/freezer.c
+++ b/kernel/freezer.c
@@ -71,7 +71,7 @@ bool __refrigerator(bool check_kthr_stop)
 		spin_lock_irq(&freezer_lock);
 		current->flags |= PF_FROZEN;
 		if (!freezing(current) ||
-		    (check_kthr_stop && kthread_should_stop()))
+		    (check_kthr_stop && kthread_should_stop()) || current->kill_flag)
 			current->flags &= ~PF_FROZEN;
 		spin_unlock_irq(&freezer_lock);
 
@@ -104,6 +104,25 @@ static void fake_signal_wake_up(struct task_struct *p)
 	}
 }
 
+bool freeze_cgroup_task(struct task_struct *p)
+{
+       unsigned long flags;
+
+       spin_lock_irqsave(&freezer_lock, flags);
+       if (!freezing(p) || frozen(p)) {
+               spin_unlock_irqrestore(&freezer_lock, flags);
+               return false;
+       }
+
+       if (!(p->flags & PF_KTHREAD))
+               fake_signal_wake_up(p);
+       else
+               wake_up_state(p, TASK_INTERRUPTIBLE);
+
+       spin_unlock_irqrestore(&freezer_lock, flags);
+       return true;
+}
+
 /**
  * freeze_task - send a freeze request to given task
  * @p: task to send the request to
diff --git a/kernel/irq/manage.c b/kernel/irq/manage.c
old mode 100644
new mode 100755
index 406aeb8c5f9a57948be57613fecd74981e287c3c..066641ff67ca338b6a3b06ff4ce54e5e71f988f5
--- a/kernel/irq/manage.c
+++ b/kernel/irq/manage.c
@@ -639,6 +639,47 @@ int irq_set_irq_wake(unsigned int irq, unsigned int on)
 	return ret;
 }
 EXPORT_SYMBOL(irq_set_irq_wake);
+static int mask_wake_irq_set(const char *buff, const struct kernel_param *kp)
+{
+	char buf[256], *b;
+	char *irq_num_str;
+	unsigned int irq_num;
+	int ret;
+
+	pr_info("mask_wake_irq_set: %s\n", buff);
+	strlcpy(buf, buff, sizeof(buf));
+	b = strim(buf);
+
+	while (b) {
+		irq_num_str = strsep(&b, ",");
+		if (irq_num_str) {
+			ret = kstrtoint(irq_num_str, 0, &irq_num);
+			if (ret < 0)
+				return ret;
+
+			pr_info("mask_wake_irq_set irq_num: %d\n", irq_num);
+			irq_set_irq_wake(irq_num, 0);
+		}
+	}
+
+	return 0;
+}
+
+static int mask_wake_irq_get(char *buff, const struct kernel_param *kp)
+{
+	int cnt = 0;
+
+	cnt += snprintf(buff + cnt, PAGE_SIZE - cnt, "haha\n");
+
+	return cnt;
+}
+
+static const struct kernel_param_ops mask_wake_irq_ops = {
+	.set = mask_wake_irq_set,
+	.get = mask_wake_irq_get,
+};
+
+module_param_cb(mask_wake_irq, &mask_wake_irq_ops, NULL, 0644);
 
 /*
  * Internal function that tells the architecture code whether a
diff --git a/kernel/irq/proc.c b/kernel/irq/proc.c
index d4e8d20dd64e39af8ca0e99043ad5f59379f98e0..f30cf7516686d5b03e0a07f77865adbfada0abcc 100644
--- a/kernel/irq/proc.c
+++ b/kernel/irq/proc.c
@@ -526,6 +526,8 @@ int show_interrupts(struct seq_file *p, void *v)
 	struct irqaction *action;
 	struct irq_desc *desc;
 
+	unsigned long irq_flags;
+
 	if (i > ACTUAL_NR_IRQS)
 		return 0;
 
@@ -571,10 +573,16 @@ int show_interrupts(struct seq_file *p, void *v)
 	}
 	if (desc->irq_data.domain)
 		seq_printf(p, " %*d", prec, (int) desc->irq_data.hwirq);
-	else
-		seq_printf(p, " %*s", prec, "");
 #ifdef CONFIG_GENERIC_IRQ_SHOW_LEVEL
-	seq_printf(p, " %-8s", irqd_is_level_type(&desc->irq_data) ? "Level" : "Edge");
+
+	irq_flags = irqd_get_trigger_type(&desc->irq_data);
+	if (irq_flags & IRQ_TYPE_LEVEL_MASK)
+		seq_printf(p, " %-8s", "Level");
+	else if (irq_flags & IRQ_TYPE_EDGE_BOTH)
+		seq_printf(p, " %-8s", "Edge");
+	else
+		seq_printf(p, " %-8s", "None");
+
 #endif
 	if (desc->name)
 		seq_printf(p, "-%-8s", desc->name);
diff --git a/kernel/locking/rwsem-xadd.c b/kernel/locking/rwsem-xadd.c
index a903367793758f3e1cc52ab34c18f1bfa78f38e3..8b41d8883dceb69a5d34742dabc120b479f2ec48 100644
--- a/kernel/locking/rwsem-xadd.c
+++ b/kernel/locking/rwsem-xadd.c
@@ -90,21 +90,13 @@ void __init_rwsem(struct rw_semaphore *sem, const char *name,
 	sem->owner = NULL;
 	osq_lock_init(&sem->osq);
 #endif
+#ifdef CONFIG_RWSEM_PRIO_AWARE
+	sem->m_count = 0;
+#endif
 }
 
 EXPORT_SYMBOL(__init_rwsem);
 
-enum rwsem_waiter_type {
-	RWSEM_WAITING_FOR_WRITE,
-	RWSEM_WAITING_FOR_READ
-};
-
-struct rwsem_waiter {
-	struct list_head list;
-	struct task_struct *task;
-	enum rwsem_waiter_type type;
-};
-
 enum rwsem_wake_type {
 	RWSEM_WAKE_ANY,		/* Wake whatever's at head of wait list */
 	RWSEM_WAKE_READERS,	/* Wake readers only */
@@ -228,6 +220,7 @@ __rwsem_down_read_failed_common(struct rw_semaphore *sem, int state)
 	long count, adjustment = -RWSEM_ACTIVE_READ_BIAS;
 	struct rwsem_waiter waiter;
 	DEFINE_WAKE_Q(wake_q);
+	bool is_first_waiter = false;
 
 	waiter.task = current;
 	waiter.type = RWSEM_WAITING_FOR_READ;
@@ -235,7 +228,9 @@ __rwsem_down_read_failed_common(struct rw_semaphore *sem, int state)
 	raw_spin_lock_irq(&sem->wait_lock);
 	if (list_empty(&sem->wait_list))
 		adjustment += RWSEM_WAITING_BIAS;
-	list_add_tail(&waiter.list, &sem->wait_list);
+
+	/* is_first_waiter == true means we are first in the queue */
+	is_first_waiter = rwsem_list_add_per_prio(&waiter, sem);
 
 	/* we're now waiting on the lock, but no longer actively locking */
 	count = atomic_long_add_return(adjustment, &sem->count);
@@ -248,7 +243,8 @@ __rwsem_down_read_failed_common(struct rw_semaphore *sem, int state)
 	 */
 	if (count == RWSEM_WAITING_BIAS ||
 	    (count > RWSEM_WAITING_BIAS &&
-	     adjustment != -RWSEM_ACTIVE_READ_BIAS))
+	     (adjustment != -RWSEM_ACTIVE_READ_BIAS ||
+	     is_first_waiter)))
 		__rwsem_mark_wake(sem, RWSEM_WAKE_ANY, &wake_q);
 
 	raw_spin_unlock_irq(&sem->wait_lock);
@@ -498,6 +494,7 @@ __rwsem_down_write_failed_common(struct rw_semaphore *sem, int state)
 	struct rwsem_waiter waiter;
 	struct rw_semaphore *ret = sem;
 	DEFINE_WAKE_Q(wake_q);
+	bool is_first_waiter = false;
 
 	/* undo write bias from down_write operation, stop active locking */
 	count = atomic_long_sub_return(RWSEM_ACTIVE_WRITE_BIAS, &sem->count);
@@ -519,7 +516,11 @@ __rwsem_down_write_failed_common(struct rw_semaphore *sem, int state)
 	if (list_empty(&sem->wait_list))
 		waiting = false;
 
-	list_add_tail(&waiter.list, &sem->wait_list);
+	/*
+	 * is_first_waiter == true means we are first in the queue,
+	 * so there is no read locks that were queued ahead of us.
+	 */
+	is_first_waiter = rwsem_list_add_per_prio(&waiter, sem);
 
 	/* we're now waiting on the lock, but no longer actively locking */
 	if (waiting) {
@@ -530,7 +531,7 @@ __rwsem_down_write_failed_common(struct rw_semaphore *sem, int state)
 		 * no active writers, the lock must be read owned; so we try to
 		 * wake any read locks that were queued ahead of us.
 		 */
-		if (count > RWSEM_WAITING_BIAS) {
+		if (!is_first_waiter && count > RWSEM_WAITING_BIAS) {
 			__rwsem_mark_wake(sem, RWSEM_WAKE_READERS, &wake_q);
 			/*
 			 * The wakeup is normally called _after_ the wait_lock
diff --git a/kernel/locking/rwsem.h b/kernel/locking/rwsem.h
index 410ee7b9ac2c05d7edeb75c1b7e5c9056932e02c..df2d6ee84d26cad7f11a2f82b2e571a22d8023a6 100644
--- a/kernel/locking/rwsem.h
+++ b/kernel/locking/rwsem.h
@@ -20,6 +20,17 @@
 #define RWSEM_ANONYMOUSLY_OWNED	(1UL << 0)
 #define RWSEM_READER_OWNED	((struct task_struct *)RWSEM_ANONYMOUSLY_OWNED)
 
+enum rwsem_waiter_type {
+	RWSEM_WAITING_FOR_WRITE,
+	RWSEM_WAITING_FOR_READ
+};
+
+struct rwsem_waiter {
+	struct list_head list;
+	struct task_struct *task;
+	enum rwsem_waiter_type type;
+};
+
 #ifdef CONFIG_RWSEM_SPIN_ON_OWNER
 /*
  * All writes to owner are protected by WRITE_ONCE() to make sure that
@@ -79,3 +90,60 @@ static inline void rwsem_set_reader_owned(struct rw_semaphore *sem)
 {
 }
 #endif
+
+#ifdef CONFIG_RWSEM_PRIO_AWARE
+
+#define RWSEM_MAX_PREEMPT_ALLOWED 3000
+
+/*
+ * Return true if current waiter is added in the front of the rwsem wait list.
+ */
+static inline bool rwsem_list_add_per_prio(struct rwsem_waiter *waiter_in,
+				    struct rw_semaphore *sem)
+{
+	struct list_head *pos;
+	struct list_head *head;
+	struct rwsem_waiter *waiter = NULL;
+
+	pos = head = &sem->wait_list;
+	/*
+	 * Rules for task prio aware rwsem wait list queueing:
+	 * 1:	Only try to preempt waiters with which task priority
+	 *	which is higher than DEFAULT_PRIO.
+	 * 2:	To avoid starvation, add count to record
+	 *	how many high priority waiters preempt to queue in wait
+	 *	list.
+	 *	If preempt count is exceed RWSEM_MAX_PREEMPT_ALLOWED,
+	 *	use simple fifo until wait list is empty.
+	 */
+	if (list_empty(head)) {
+		list_add_tail(&waiter_in->list, head);
+		sem->m_count = 0;
+		return true;
+	}
+
+	if (waiter_in->task->prio < DEFAULT_PRIO
+		&& sem->m_count < RWSEM_MAX_PREEMPT_ALLOWED) {
+
+		list_for_each(pos, head) {
+			waiter = list_entry(pos, struct rwsem_waiter, list);
+			if (waiter->task->prio > waiter_in->task->prio) {
+				list_add(&waiter_in->list, pos->prev);
+				sem->m_count++;
+				return &waiter_in->list == head->next;
+			}
+		}
+	}
+
+	list_add_tail(&waiter_in->list, head);
+
+	return false;
+}
+#else
+static inline bool rwsem_list_add_per_prio(struct rwsem_waiter *waiter_in,
+				    struct rw_semaphore *sem)
+{
+	list_add_tail(&waiter_in->list, &sem->wait_list);
+	return false;
+}
+#endif
diff --git a/kernel/panic.c b/kernel/panic.c
index 2676c1f5c2b4ec96d07bf07c4c18a8e844c5d056..18debdd4f68a6551fccb1927b0d17dfee7e423dc 100644
--- a/kernel/panic.c
+++ b/kernel/panic.c
@@ -30,10 +30,12 @@
 #define CREATE_TRACE_POINTS
 #include <trace/events/exception.h>
 #include <soc/qcom/minidump.h>
+#include <linux/project_info.h>
 
 #define PANIC_TIMER_STEP 100
 #define PANIC_BLINK_SPD 18
 
+static char caller_function_name[KSYM_SYMBOL_LEN];
 int panic_on_oops = CONFIG_PANIC_ON_OOPS_VALUE;
 static unsigned long tainted_mask;
 static int pause_on_oops;
@@ -49,6 +51,19 @@ ATOMIC_NOTIFIER_HEAD(panic_notifier_list);
 
 EXPORT_SYMBOL(panic_notifier_list);
 
+char *parse_function_builtin_return_address(unsigned long function_address)
+{
+        char *cur = caller_function_name;
+
+        if (!function_address)
+              return NULL;
+
+        sprint_symbol(caller_function_name, function_address);
+        strsep(&cur, "+");
+       return caller_function_name;
+}
+EXPORT_SYMBOL(parse_function_builtin_return_address);
+
 static long no_blink(int state)
 {
 	return 0;
@@ -140,6 +155,7 @@ void panic(const char *fmt, ...)
 	int state = 0;
 	int old_cpu, this_cpu;
 	bool _crash_kexec_post_notifiers = crash_kexec_post_notifiers;
+	char *function_name;
 
 	trace_kernel_panic(0);
 
@@ -179,6 +195,8 @@ void panic(const char *fmt, ...)
 	va_end(args);
 	dump_stack_minidump(0);
 	pr_emerg("Kernel panic - not syncing: %s\n", buf);
+	function_name = parse_function_builtin_return_address((unsigned long)__builtin_return_address(0));
+	save_dump_reason_to_smem(buf, function_name);
 #ifdef CONFIG_DEBUG_BUGVERBOSE
 	/*
 	 * Avoid nested stack-dumping if a panic occurs during oops processing
diff --git a/kernel/power/main.c b/kernel/power/main.c
index 3a2ca9066583fad36e3b91fe99515058d453a62e..9a44d9626ba03c03293a326dfa7a6d08c8b40ec3 100644
--- a/kernel/power/main.c
+++ b/kernel/power/main.c
@@ -768,7 +768,7 @@ EXPORT_SYMBOL_GPL(pm_wq);
 
 static int __init pm_start_workqueue(void)
 {
-	pm_wq = alloc_workqueue("pm", WQ_FREEZABLE, 0);
+	pm_wq = alloc_workqueue("pm", WQ_FREEZABLE | WQ_MEM_RECLAIM, 0);
 
 	return pm_wq ? 0 : -ENOMEM;
 }
diff --git a/kernel/power/qos.c b/kernel/power/qos.c
index 3b06174ebdc01332453a3fdcc277dbfc807b067c..d51708c473777d3ed581a513cdee789538c265d8 100644
--- a/kernel/power/qos.c
+++ b/kernel/power/qos.c
@@ -129,6 +129,134 @@ static struct pm_qos_object memory_bandwidth_pm_qos = {
 	.name = "memory_bandwidth",
 };
 
+static BLOCKING_NOTIFIER_HEAD(c0_cpufreq_max_notifier);
+static struct pm_qos_constraints c0_cpufreq_max_constraints = {
+	.list = PLIST_HEAD_INIT(c0_cpufreq_max_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.type = PM_QOS_MIN,
+	.notifiers = &c0_cpufreq_max_notifier,
+};
+static struct pm_qos_object c0_cpufreq_max_pm_qos = {
+	.constraints = &c0_cpufreq_max_constraints,
+	.name = "c0_cpufreq_max",
+};
+
+
+static BLOCKING_NOTIFIER_HEAD(c0_cpufreq_min_notifier);
+static struct pm_qos_constraints c0_cpufreq_min_constraints = {
+	.list = PLIST_HEAD_INIT(c0_cpufreq_min_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.type = PM_QOS_MAX,
+	.notifiers = &c0_cpufreq_min_notifier,
+};
+static struct pm_qos_object c0_cpufreq_min_pm_qos = {
+	.constraints = &c0_cpufreq_min_constraints,
+	.name = "c0_cpufreq_min",
+};
+
+static BLOCKING_NOTIFIER_HEAD(c1_cpufreq_max_notifier);
+static struct pm_qos_constraints c1_cpufreq_max_constraints = {
+	.list = PLIST_HEAD_INIT(c1_cpufreq_max_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.type = PM_QOS_MIN,
+	.notifiers = &c1_cpufreq_max_notifier,
+};
+static struct pm_qos_object c1_cpufreq_max_pm_qos = {
+	.constraints = &c1_cpufreq_max_constraints,
+	.name = "c1_cpufreq_max",
+};
+
+static BLOCKING_NOTIFIER_HEAD(c1_cpufreq_min_notifier);
+static struct pm_qos_constraints c1_cpufreq_min_constraints = {
+	.list = PLIST_HEAD_INIT(c1_cpufreq_min_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.type = PM_QOS_MAX,
+	.notifiers = &c1_cpufreq_min_notifier,
+};
+static struct pm_qos_object c1_cpufreq_min_pm_qos = {
+	.constraints = &c1_cpufreq_min_constraints,
+	.name = "c1_cpufreq_min",
+};
+
+static BLOCKING_NOTIFIER_HEAD(c2_cpufreq_max_notifier);
+static struct pm_qos_constraints c2_cpufreq_max_constraints = {
+	.list = PLIST_HEAD_INIT(c2_cpufreq_max_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MAX_DEFAULT_VALUE,
+	.type = PM_QOS_MIN,
+	.notifiers = &c2_cpufreq_max_notifier,
+};
+static struct pm_qos_object c2_cpufreq_max_pm_qos = {
+	.constraints = &c2_cpufreq_max_constraints,
+	.name = "c2_cpufreq_max",
+};
+
+static BLOCKING_NOTIFIER_HEAD(c2_cpufreq_min_notifier);
+static struct pm_qos_constraints c2_cpufreq_min_constraints = {
+	.list = PLIST_HEAD_INIT(c2_cpufreq_min_constraints.list),
+	.target_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE },
+	.default_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_CPUFREQ_MIN_DEFAULT_VALUE,
+	.type = PM_QOS_MAX,
+	.notifiers = &c2_cpufreq_min_notifier,
+};
+static struct pm_qos_object c2_cpufreq_min_pm_qos = {
+	.constraints = &c2_cpufreq_min_constraints,
+	.name = "c2_cpufreq_min",
+};
+
+static BLOCKING_NOTIFIER_HEAD(devfreq_max_notifier);
+static struct pm_qos_constraints devfreq_max_constraints = {
+	.list = PLIST_HEAD_INIT(devfreq_max_constraints.list),
+	.target_value = PM_QOS_DEVFREQ_MAX_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_DEVFREQ_MAX_DEFAULT_VALUE },
+	.default_value = PM_QOS_DEVFREQ_MAX_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_DEVFREQ_MAX_DEFAULT_VALUE,
+	.type = PM_QOS_MIN,
+	.notifiers = &devfreq_max_notifier,
+};
+static struct pm_qos_object devfreq_max_pm_qos = {
+	.constraints = &devfreq_max_constraints,
+	.name = "devfreq_max",
+};
+
+static BLOCKING_NOTIFIER_HEAD(devfreq_min_notifier);
+static struct pm_qos_constraints devfreq_min_constraints = {
+	.list = PLIST_HEAD_INIT(devfreq_min_constraints.list),
+	.target_value = PM_QOS_DEVFREQ_MIN_DEFAULT_VALUE,
+	.target_per_cpu = { [0 ... (NR_CPUS - 1)] =
+				PM_QOS_DEVFREQ_MIN_DEFAULT_VALUE },
+	.default_value = PM_QOS_DEVFREQ_MIN_DEFAULT_VALUE,
+	.no_constraint_value = PM_QOS_DEVFREQ_MIN_DEFAULT_VALUE,
+	.type = PM_QOS_MAX,
+	.notifiers = &devfreq_min_notifier,
+};
+static struct pm_qos_object devfreq_min_pm_qos = {
+	.constraints = &devfreq_min_constraints,
+	.name = "devfreq_min",
+};
 
 static struct pm_qos_object *pm_qos_array[] = {
 	&null_pm_qos,
@@ -136,6 +264,14 @@ static struct pm_qos_object *pm_qos_array[] = {
 	&network_lat_pm_qos,
 	&network_throughput_pm_qos,
 	&memory_bandwidth_pm_qos,
+	&c0_cpufreq_max_pm_qos,
+	&c0_cpufreq_min_pm_qos,
+	&c1_cpufreq_max_pm_qos,
+	&c1_cpufreq_min_pm_qos,
+	&c2_cpufreq_max_pm_qos,
+	&c2_cpufreq_min_pm_qos,
+	&devfreq_max_pm_qos,
+	&devfreq_min_pm_qos,
 };
 
 static ssize_t pm_qos_power_write(struct file *filp, const char __user *buf,
@@ -641,11 +777,12 @@ void pm_qos_add_request(struct pm_qos_request *req,
 		break;
 	}
 
-	req->pm_qos_class = pm_qos_class;
 	INIT_DELAYED_WORK(&req->work, pm_qos_work_fn);
 	trace_pm_qos_add_request(pm_qos_class, value);
 	pm_qos_update_target(pm_qos_array[pm_qos_class]->constraints,
 			     &req->node, PM_QOS_ADD_REQ, value);
+	/* Fixes rare panic */
+	req->pm_qos_class = pm_qos_class;
 
 #ifdef CONFIG_SMP
 	if (req->type == PM_QOS_REQ_AFFINE_IRQ &&
diff --git a/kernel/power/suspend.c b/kernel/power/suspend.c
old mode 100644
new mode 100755
index fb096c288bb983b08f19a6dcfad9ba78f0c7baa3..0c9164d3d439bd4d7cb2828b0fa1b18a1c7d446f
--- a/kernel/power/suspend.c
+++ b/kernel/power/suspend.c
@@ -36,6 +36,12 @@
 
 #include "power.h"
 
+#include <linux/gpio.h>
+#include <linux/soc/qcom/smem_state.h>
+extern struct qcom_smem_state *qstate;
+#define PROC_AWAKE_ID 12 /* 12th bit */
+#define AWAKE_BIT BIT(PROC_AWAKE_ID)
+
 const char * const pm_labels[] = {
 	[PM_SUSPEND_TO_IDLE] = "freeze",
 	[PM_SUSPEND_STANDBY] = "standby",
@@ -63,6 +69,7 @@ static DECLARE_WAIT_QUEUE_HEAD(s2idle_wait_head);
 
 enum s2idle_states __read_mostly s2idle_state;
 static DEFINE_RAW_SPINLOCK(s2idle_lock);
+extern int check_touchirq_triggerd(void);
 
 void s2idle_set_ops(const struct platform_s2idle_ops *ops)
 {
@@ -440,6 +447,11 @@ static int suspend_enter(suspend_state_t state, bool *wakeup)
 
 	arch_suspend_disable_irqs();
 	BUG_ON(!irqs_disabled());
+        if (check_touchirq_triggerd()) {
+		pr_err("[TP]touchpanel irq status is low\n");
+                error = -EBUSY;
+                goto Enable_irq;
+       }
 
 	error = syscore_suspend();
 	if (!error) {
@@ -459,6 +471,7 @@ static int suspend_enter(suspend_state_t state, bool *wakeup)
 		syscore_resume();
 	}
 
+Enable_irq:
 	arch_suspend_enable_irqs();
 	BUG_ON(irqs_disabled());
 
@@ -632,9 +645,16 @@ int pm_suspend(suspend_state_t state)
 	if (state <= PM_SUSPEND_ON || state >= PM_SUSPEND_MAX)
 		return -EINVAL;
 
+	qcom_smem_state_update_bits(qstate, AWAKE_BIT, 0);
+	pr_err("%s: PM_SUSPEND_PREPARE smp2p_change_state", __func__); 
+
 	pm_suspend_marker("entry");
 	pr_info("suspend entry (%s)\n", mem_sleep_labels[state]);
 	error = enter_state(state);
+
+	qcom_smem_state_update_bits(qstate, AWAKE_BIT, AWAKE_BIT);
+	pr_err("%s: PM_POST_SUSPEND smp2p_change_state", __func__);
+
 	if (error) {
 		suspend_stats.fail++;
 		dpm_save_failed_errno(error);
diff --git a/kernel/printk/printk.c b/kernel/printk/printk.c
index 100e43a5255f2b1707ca2c292838a39126ce0670..eabfdfe332b3f0d67336359e178d1863f5d446c1 100644
--- a/kernel/printk/printk.c
+++ b/kernel/printk/printk.c
@@ -43,6 +43,8 @@
 #include <linux/poll.h>
 #include <linux/irq_work.h>
 #include <linux/utsname.h>
+#include <linux/rtc.h>
+#include <linux/time.h>
 #include <linux/ctype.h>
 #include <linux/uio.h>
 #include <linux/sched/clock.h>
@@ -1093,6 +1095,14 @@ static void __init log_buf_add_cpu(void)
 static inline void log_buf_add_cpu(void) {}
 #endif /* CONFIG_SMP */
 
+static int __init ftm_console_silent_setup(char *str)
+{
+	pr_info("ftm_silent_log \n");
+	console_silent();
+	return 0;
+}
+early_param("ftm_console_silent", ftm_console_silent_setup);
+
 void __init setup_log_buf(int early)
 {
 	unsigned long flags;
@@ -1213,21 +1223,9 @@ static inline void boot_delay_msec(int level)
 static bool printk_time = IS_ENABLED(CONFIG_PRINTK_TIME);
 module_param_named(time, printk_time, bool, S_IRUGO | S_IWUSR);
 
-static size_t print_time(u64 ts, char *buf)
-{
-	unsigned long rem_nsec;
-
-	if (!printk_time)
-		return 0;
-
-	rem_nsec = do_div(ts, 1000000000);
+static bool print_wall_time = 1;
+module_param_named(print_wall_time, print_wall_time, bool, 0644);
 
-	if (!buf)
-		return snprintf(NULL, 0, "[%5lu.000000] ", (unsigned long)ts);
-
-	return sprintf(buf, "[%5lu.%06lu] ",
-		       (unsigned long)ts, rem_nsec / 1000);
-}
 
 static size_t print_prefix(const struct printk_log *msg, bool syslog, char *buf)
 {
@@ -1247,8 +1245,6 @@ static size_t print_prefix(const struct printk_log *msg, bool syslog, char *buf)
 				len++;
 		}
 	}
-
-	len += print_time(msg->ts_nsec, buf ? buf + len : NULL);
 	return len;
 }
 
@@ -1698,6 +1694,13 @@ int vprintk_store(int facility, int level,
 	char *text = textbuf;
 	size_t text_len;
 	enum log_flags lflags = 0;
+	static char texttmp[LOG_LINE_MAX];
+	static bool last_new_line = true;
+	u64 ts_sec = local_clock();
+	unsigned long rem_nsec;
+
+	rem_nsec = do_div(ts_sec, 1000000000);
+
 
 	/*
 	 * The printf needs to come first; we need the syslog
@@ -1733,6 +1736,44 @@ int vprintk_store(int facility, int level,
 		}
 	}
 
+	if (last_new_line) {
+		if (print_wall_time && ts_sec >= 20) {
+			struct timespec64 tspec;
+			struct rtc_time tm;
+
+			__getnstimeofday64(&tspec);
+
+			if (sys_tz.tz_minuteswest < 0
+				|| (tspec.tv_sec-sys_tz.tz_minuteswest*60) >= 0)
+				tspec.tv_sec -= sys_tz.tz_minuteswest * 60;
+			rtc_time_to_tm(tspec.tv_sec, &tm);
+
+			text_len = scnprintf(texttmp, sizeof(texttmp),
+				"[%02d%02d%02d_%02d:%02d:%02d.%06ld]@%d %s",
+				tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,
+				tm.tm_hour, tm.tm_min, tm.tm_sec,
+				tspec.tv_nsec / 1000, raw_smp_processor_id(), text);
+		} else {
+			text_len = scnprintf(texttmp, sizeof(texttmp),
+				"[%5lu.%06lu]@%d %s", (unsigned long)ts_sec,
+				rem_nsec / 1000, raw_smp_processor_id(), text);
+		}
+
+		text = texttmp;
+
+		/* mark and strip a trailing newline */
+		if (text_len && text[text_len-1] == '\n') {
+			text_len--;
+			lflags |= LOG_NEWLINE;
+		}
+	}
+
+	if (lflags & LOG_NEWLINE)
+		last_new_line = true;
+	else
+		last_new_line = false;
+
+
 #ifdef CONFIG_EARLY_PRINTK_DIRECT
 	printascii(text);
 #endif
@@ -1946,7 +1987,7 @@ static int __add_preferred_console(char *name, int idx, char *options,
  * Set up a console.  Called via do_early_param() in init/main.c
  * for each "console=" parameter in the boot command line.
  */
-static int __init console_setup(char *str)
+static int  console_setup(char *str)
 {
 	char buf[sizeof(console_cmdline[0].name) + 4]; /* 4 for "ttyS" */
 	char *s, *options, *brl_options = NULL;
@@ -1986,6 +2027,15 @@ static int __init console_setup(char *str)
 }
 __setup("console=", console_setup);
 
+
+int  force_oem_console_setup(char *str)
+{
+	console_setup(str);
+	return 1;
+}
+EXPORT_SYMBOL(force_oem_console_setup);
+
+
 /**
  * add_preferred_console - add a device to the list of preferred consoles.
  * @name: device name
diff --git a/kernel/reboot.c b/kernel/reboot.c
index bd30a973fe946b03916a1eeb873928adfe1b32b0..e37767cfb827872a10f92afd8585d4584c47c1e3 100644
--- a/kernel/reboot.c
+++ b/kernel/reboot.c
@@ -16,6 +16,8 @@
 #include <linux/syscalls.h>
 #include <linux/syscore_ops.h>
 #include <linux/uaccess.h>
+#include <linux/delay.h>
+#include <linux/oem_force_dump.h>
 
 /*
  * this indicates whether you can reboot with ctrl-alt-del: the default is yes
@@ -220,6 +222,15 @@ void kernel_restart(char *cmd)
 		pr_emerg("Restarting system\n");
 	else
 		pr_emerg("Restarting system with command '%s'\n", cmd);
+
+	if (oem_get_download_mode()) {
+		if (((cmd != NULL && cmd[0] != '\0') &&
+				!strcmp(cmd, "dm-verity device corrupted"))) {
+			panic("dm-verity device corrupted Force Dump");
+			pr_emerg("Restarting system painc\n");
+			msleep(10000);
+		}
+	}
 	kmsg_dump(KMSG_DUMP_RESTART);
 	machine_restart(cmd);
 }
diff --git a/kernel/sched/cpufreq_schedutil.c b/kernel/sched/cpufreq_schedutil.c
index 1e23ffb7a0995a157fc1cadab568f1c4a91758c0..34bd062e2404fdebc5d4d054f441e202075bdac4 100644
--- a/kernel/sched/cpufreq_schedutil.c
+++ b/kernel/sched/cpufreq_schedutil.c
@@ -203,13 +203,14 @@ static void sugov_update_commit(struct sugov_policy *sg_policy, u64 time,
 	if (policy->fast_switch_enabled) {
 		sugov_track_cycles(sg_policy, sg_policy->policy->cur, time);
 		next_freq = cpufreq_driver_fast_switch(policy, next_freq);
-		if (!next_freq)
+		if (!next_freq || (next_freq == policy->cur))
 			return;
 
 		policy->cur = next_freq;
 		for_each_cpu(cpu, policy->cpus) {
 			trace_cpu_frequency(next_freq, cpu);
 		}
+		cpufreq_stats_record_transition(policy, next_freq);
 	} else {
 		if (use_pelt())
 			sg_policy->work_in_progress = true;
diff --git a/kernel/sched/fair.c b/kernel/sched/fair.c
old mode 100644
new mode 100755
index 82e0a01423bf92326a9544278ad11ffb21c7224d..dfa7d8e071d079486bc2d8d6cc4d5a5937dc2ea6
--- a/kernel/sched/fair.c
+++ b/kernel/sched/fair.c
@@ -40,6 +40,11 @@
 #include "tune.h"
 #include "walt.h"
 
+#ifdef CONFIG_OPCHAIN
+#include <../drivers/oneplus/coretech/opchain/opchain_helper.h>
+
+#define opc_claim_bit_test(claim, cpu) (claim & ((1 << cpu) | (1 << (cpu + num_present_cpus()))))
+#endif
 #ifdef CONFIG_SMP
 static inline bool task_fits_max(struct task_struct *p, int cpu);
 #endif /* CONFIG_SMP */
@@ -5255,6 +5260,9 @@ enqueue_task_fair(struct rq *rq, struct task_struct *p, int flags)
 	struct sched_entity *se = &p->se;
 	int task_new = !(flags & ENQUEUE_WAKEUP);
 
+#ifdef CONFIG_OPCHAIN
+	opc_task_switch(true, cpu_of(rq), p, 0);
+#endif
 #ifdef CONFIG_SCHED_WALT
 	p->misfit = !task_fits_max(p, rq->cpu);
 #endif
@@ -5347,6 +5355,9 @@ static void dequeue_task_fair(struct rq *rq, struct task_struct *p, int flags)
 	struct sched_entity *se = &p->se;
 	int task_sleep = flags & DEQUEUE_SLEEP;
 
+#ifdef CONFIG_OPCHAIN
+	opc_task_switch(false, cpu_of(rq), p, rq->clock);
+#endif
 	/*
 	 * The code below (indirectly) updates schedutil which looks at
 	 * the cfs_rq utilization to select a frequency.
@@ -7286,6 +7297,9 @@ struct find_best_target_env {
 	int placement_boost;
 	bool need_idle;
 	int fastpath;
+#ifdef CONFIG_OPCHAIN
+	int op_path;
+#endif
 };
 
 static bool is_packing_eligible(struct task_struct *p, int target_cpu,
@@ -7325,7 +7339,16 @@ static int start_cpu(struct task_struct *p, bool boosted,
 {
 	struct root_domain *rd = cpu_rq(smp_processor_id())->rd;
 	int start_cpu = -1;
+#ifdef CONFIG_OPCHAIN
+	bool is_uxtop = is_opc_task(p, UT_FORE);
+	if (is_uxtop && task_sched_boost(p)) {
+		if (rd->mid_cap_orig_cpu != -1
+				&& task_fits_max(p, rd->mid_cap_orig_cpu))
+			return rd->mid_cap_orig_cpu;
 
+		return rd->max_cap_orig_cpu;
+	}
+#endif
 	if (boosted)
 		return rd->max_cap_orig_cpu;
 
@@ -7460,7 +7483,12 @@ static inline int find_best_target(struct task_struct *p, int *backup_cpu,
 			 * so prev_cpu will receive a negative bias due to the double
 			 * accounting. However, the blocked utilization may be zero.
 			 */
+#ifdef CONFIG_OPCHAIN
+			wake_util = opc_cpu_util(cpu_util_wake(i, p),
+									i, p, fbt_env->op_path);
+#else
 			wake_util = cpu_util_wake(i, p);
+#endif
 			new_util = wake_util + task_util_est(p);
 			spare_wake_cap = capacity_orig_of(i) - wake_util;
 
@@ -8037,7 +8065,9 @@ static int find_energy_efficient_cpu(struct sched_domain *sd,
 	int placement_boost = task_boost_policy(p);
 	u64 start_t = 0;
 	int next_cpu = -1, backup_cpu = -1;
-
+#ifdef CONFIG_OPCHAIN
+	bool is_uxtop = is_opc_task(p, UT_FORE);
+#endif
 	fbt_env.fastpath = 0;
 
 	if (trace_sched_task_util_enabled())
@@ -8045,14 +8075,22 @@ static int find_energy_efficient_cpu(struct sched_domain *sd,
 
 	if (need_idle)
 		sync = 0;
-
+#ifdef CONFIG_OPCHAIN
+	if (sysctl_sched_sync_hint_enable && sync &&
+				bias_to_waker_cpu(p, cpu, rtg_target) &&
+				(!is_uxtop || cpu >= FIRST_BIG_CORE)) {
+		target_cpu = cpu;
+		fbt_env.fastpath = SYNC_WAKEUP;
+		goto out;
+	}
+#else
 	if (sysctl_sched_sync_hint_enable && sync &&
 				bias_to_waker_cpu(p, cpu, rtg_target)) {
 		target_cpu = cpu;
 		fbt_env.fastpath = SYNC_WAKEUP;
 		goto out;
 	}
-
+#endif
 	/* prepopulate energy diff environment */
 	eenv = get_eenv(p, prev_cpu);
 	if (eenv->max_cpu_count < 2)
@@ -8157,10 +8195,15 @@ static int find_energy_efficient_cpu(struct sched_domain *sd,
 out:
 	if (target_cpu < 0)
 		target_cpu = prev_cpu;
-
+#ifdef CONFIG_OPCHAIN
+	trace_sched_task_util(p, next_cpu, backup_cpu, target_cpu, sync,
+			need_idle, fbt_env.fastpath, placement_boost,
+			rtg_target ? cpumask_first(rtg_target) : -1, is_uxtop, start_t);
+#else
 	trace_sched_task_util(p, next_cpu, backup_cpu, target_cpu, sync,
 			need_idle, fbt_env.fastpath, placement_boost,
 			rtg_target ? cpumask_first(rtg_target) : -1, start_t);
+#endif
 	return target_cpu;
 }
 
@@ -8893,6 +8936,10 @@ enum group_type {
 #define LBF_SOME_PINNED	0x08
 #define LBF_IGNORE_BIG_TASKS 0x100
 #define LBF_IGNORE_PREFERRED_CLUSTER_TASKS 0x200
+#ifdef CONFIG_OPCHAIN
+#define LBF_IGNORE_UX_TOP 0x800
+#define LBF_IGNORE_SLAVE 0xC00
+#endif
 
 struct lb_env {
 	struct sched_domain	*sd;
@@ -9090,7 +9137,13 @@ int can_migrate_task(struct task_struct *p, struct lb_env *env)
 		!task_fits_max(p, env->dst_cpu))
 		return 0;
 #endif
+#ifdef CONFIG_OPCHAIN
+	if (env->flags & LBF_IGNORE_UX_TOP && is_opc_task(p, UT_FORE))
+		return 0;
 
+	if (env->flags & LBF_IGNORE_SLAVE && p->utask_slave)
+		return 0;
+#endif
 	if (task_running(env->src_rq, p)) {
 		schedstat_inc(p->se.statistics.nr_failed_migrations_running);
 		return 0;
@@ -9185,7 +9238,9 @@ static int detach_tasks(struct lb_env *env)
 	unsigned long load = 0;
 	int detached = 0;
 	int orig_loop = env->loop;
-
+#ifdef CONFIG_OPCHAIN
+	int src_claim = opc_get_claim_on_cpu(env->src_cpu);
+#endif
 	lockdep_assert_held(&env->src_rq->lock);
 
 	if (env->imbalance <= 0)
@@ -9193,9 +9248,18 @@ static int detach_tasks(struct lb_env *env)
 
 	if (!same_cluster(env->dst_cpu, env->src_cpu))
 		env->flags |= LBF_IGNORE_PREFERRED_CLUSTER_TASKS;
-
+#ifdef CONFIG_OPCHAIN
+	if (cpu_capacity(env->dst_cpu) < cpu_capacity(env->src_cpu)) {
+		env->flags |= LBF_IGNORE_BIG_TASKS;
+		if (src_claim == 1)
+			env->flags |= LBF_IGNORE_UX_TOP | LBF_IGNORE_SLAVE;
+		else if (src_claim == -1)
+			env->flags |= LBF_IGNORE_SLAVE;
+	}
+#else
 	if (cpu_capacity(env->dst_cpu) < cpu_capacity(env->src_cpu))
 		env->flags |= LBF_IGNORE_BIG_TASKS;
+#endif
 
 redo:
 	while (!list_empty(tasks)) {
@@ -9267,6 +9331,10 @@ static int detach_tasks(struct lb_env *env)
 		tasks = &env->src_rq->cfs_tasks;
 		env->flags &= ~(LBF_IGNORE_BIG_TASKS |
 				LBF_IGNORE_PREFERRED_CLUSTER_TASKS);
+#ifdef CONFIG_OPCHAIN
+		if (env->flags & LBF_IGNORE_SLAVE)
+			env->flags &= ~LBF_IGNORE_SLAVE;
+#endif
 		env->loop = orig_loop;
 		goto redo;
 	}
@@ -9615,8 +9683,8 @@ static void update_cpu_capacity(struct sched_domain *sd, int cpu)
 		mcc->cpu = cpu;
 #ifdef CONFIG_SCHED_DEBUG
 		raw_spin_unlock_irqrestore(&mcc->lock, flags);
-		printk_deferred("CPU%d: update max cpu_capacity %lu\n",
-							cpu, capacity);
+		/*printk_deferred("CPU%d: update max cpu_capacity %lu\n",
+							cpu, capacity);*/
 		goto skip_unlock;
 #endif
 	}
diff --git a/kernel/sched/rt.c b/kernel/sched/rt.c
old mode 100644
new mode 100755
index c48bf6920bdafee922c8ee343d448af9212a0713..ff3d07e78cc2cffc441ea8294e7e528e90e46a6d
--- a/kernel/sched/rt.c
+++ b/kernel/sched/rt.c
@@ -12,6 +12,9 @@
 #include "tune.h"
 
 #include "walt.h"
+#ifdef CONFIG_OPCHAIN
+#include <../drivers/oneplus/coretech/opchain/opchain_helper.h>
+#endif
 
 int sched_rr_timeslice = RR_TIMESLICE;
 int sysctl_sched_rr_timeslice = (MSEC_PER_SEC / HZ) * RR_TIMESLICE;
@@ -1762,6 +1765,9 @@ static int rt_energy_aware_wake_cpu(struct task_struct *task)
 	bool boost_on_big = sched_boost() == FULL_THROTTLE_BOOST ?
 				  (sched_boost_policy() == SCHED_BOOST_ON_BIG) :
 				  false;
+#ifdef CONFIG_OPCHAIN
+	bool best_cpu_is_claimed = false;
+#endif
 
 	rcu_read_lock();
 
@@ -1798,7 +1804,16 @@ static int rt_energy_aware_wake_cpu(struct task_struct *task)
 
 			if (__cpu_overutilized(cpu, tutil))
 				continue;
-
+#ifdef CONFIG_OPCHAIN
+			if (best_cpu_is_claimed) {
+				best_cpu_idle_idx = cpu_idle_idx;
+				best_cpu_util_cum = util_cum;
+				best_cpu_util = util;
+				best_cpu = cpu;
+				best_cpu_is_claimed = false;
+				continue;
+			}
+#endif
 			/* Find the least loaded CPU */
 			if (util > best_cpu_util)
 				continue;
@@ -1829,7 +1844,14 @@ static int rt_energy_aware_wake_cpu(struct task_struct *task)
 						best_cpu_util_cum < util_cum)
 					continue;
 			}
-
+#ifdef CONFIG_OPCHAIN
+			if (opc_get_claim_on_cpu(cpu)) {
+				if (best_cpu != -1)
+					continue;
+				else
+					best_cpu_is_claimed = true;
+			}
+#endif
 			best_cpu_idle_idx = cpu_idle_idx;
 			best_cpu_util_cum = util_cum;
 			best_cpu_util = util;
diff --git a/kernel/sched/walt.c b/kernel/sched/walt.c
index b68af0770880e12e991cf4a7474c9605ce0def45..1aaa0a15cbe23d2b5d2d4960cdc6c62fc50bbb68 100644
--- a/kernel/sched/walt.c
+++ b/kernel/sched/walt.c
@@ -1770,6 +1770,11 @@ static void update_history(struct rq *rq, struct task_struct *p,
 
 static u64 add_to_task_demand(struct rq *rq, struct task_struct *p, u64 delta)
 {
+	if (p->compensate_need) {
+		delta += p->compensate_time;
+		p->compensate_time = 0;
+		p->compensate_need = 0;
+	}
 	delta = scale_exec_time(delta, rq);
 	p->ravg.sum += delta;
 	if (unlikely(p->ravg.sum > sched_ravg_window))
@@ -2646,7 +2651,7 @@ int update_preferred_cluster(struct related_thread_group *grp,
 {
 	u32 new_load = task_load(p);
 
-	if (!grp)
+	if (!grp || !p->grp)
 		return 0;
 
 	/*
diff --git a/kernel/signal.c b/kernel/signal.c
index bd4bc311e20c15b45e2212519a5f8842b0f027ba..2aa45871d8122ff4e430bd997c759f22ae042342 100644
--- a/kernel/signal.c
+++ b/kernel/signal.c
@@ -993,6 +993,18 @@ static inline void userns_fixup_signal_uid(struct siginfo *info, struct task_str
 }
 #endif
 
+static int print_key_process_murder __read_mostly = 1;
+static bool is_zygote_process(struct task_struct *t)
+{
+       const struct cred *tcred = __task_cred(t);
+
+       if(!strcmp(t->comm, "main") && (tcred->uid.val == 0) && (t->parent != 0 && !strcmp(t->parent->comm,"init")))
+               return true;
+       else
+               return false;
+       return false;
+}
+
 static int __send_signal(int sig, struct siginfo *info, struct task_struct *t,
 			int group, int from_ancestor_ns)
 {
@@ -1004,6 +1016,20 @@ static int __send_signal(int sig, struct siginfo *info, struct task_struct *t,
 	assert_spin_locked(&t->sighand->siglock);
 
 	result = TRACE_SIGNAL_IGNORED;
+
+	if(print_key_process_murder) {
+		if(!strcmp(t->comm, "system_server") ||
+			is_zygote_process(t) ||
+			!strcmp(t->comm, "surfaceflinger") ||
+			!strcmp(t->comm, "servicemanager") ||
+			(!strcmp(t->comm, "netd") && sig == 9))
+		{
+			struct task_struct *tg = current->group_leader;
+			printk("process %d:%s, %d:%s send sig:%d to process %d:%s\n",
+				tg->pid, tg->comm, current->pid, current->comm, sig, t->pid, t->comm);
+		}
+	}
+
 	if (!prepare_signal(sig, t,
 			from_ancestor_ns || (info == SEND_SIG_PRIV) || (info == SEND_SIG_FORCED)))
 		goto ret;
@@ -1160,6 +1186,19 @@ int do_send_sig_info(int sig, struct siginfo *info, struct task_struct *p,
 	unsigned long flags;
 	int ret = -ESRCH;
 
+	if(sig == SIGKILL) {
+		if(p && p->flags & PF_FROZEN) {
+		struct task_struct *child = p;
+		rcu_read_lock();
+		do {
+			child = next_thread(child);
+			child->kill_flag = 1;
+			__thaw_task(child);
+		} while(child !=p);
+		rcu_read_unlock();
+		}
+	}
+
 	if (lock_task_sighand(p, &flags)) {
 		ret = send_signal(sig, info, p, group);
 		unlock_task_sighand(p, &flags);
@@ -2972,6 +3011,7 @@ COMPAT_SYSCALL_DEFINE4(rt_sigtimedwait, compat_sigset_t __user *, uthese,
 SYSCALL_DEFINE2(kill, pid_t, pid, int, sig)
 {
 	struct siginfo info;
+	struct task_struct *p;
 
 	info.si_signo = sig;
 	info.si_errno = 0;
@@ -2979,6 +3019,12 @@ SYSCALL_DEFINE2(kill, pid_t, pid, int, sig)
 	info.si_pid = task_tgid_vnr(current);
 	info.si_uid = from_kuid_munged(current_user_ns(), current_uid());
 
+	if (sig == SIGQUIT || sig == SIGSEGV ||  sig == SIGABRT) {
+                p = pid_task(find_vpid(pid), PIDTYPE_PID);
+                if (p)
+                        unfreezer_fork(p);
+        }
+
 	return kill_something_info(sig, &info, pid);
 }
 
diff --git a/kernel/sys.c b/kernel/sys.c
index 26a5cf02b094d5a8e3c2f145bae32a9e281d33ae..76e9ec7432a0c4aef4f4889063c072ba7168b51f 100644
--- a/kernel/sys.c
+++ b/kernel/sys.c
@@ -1954,7 +1954,12 @@ static int prctl_set_mm_map(int opt, const void __user *addr, unsigned long data
 			return error;
 	}
 
-	down_write(&mm->mmap_sem);
+	/*
+	 * arg_lock protects concurent updates but we still need mmap_sem for
+	 * read to exclude races with sys_brk.
+	 */
+
+	down_read(&mm->mmap_sem);
 
 	/*
 	 * We don't validate if these members are pointing to
@@ -1968,6 +1973,7 @@ static int prctl_set_mm_map(int opt, const void __user *addr, unsigned long data
 	 *    to any problem in kernel itself
 	 */
 
+	spin_lock(&mm->arg_lock);
 	mm->start_code	= prctl_map.start_code;
 	mm->end_code	= prctl_map.end_code;
 	mm->start_data	= prctl_map.start_data;
@@ -1979,6 +1985,7 @@ static int prctl_set_mm_map(int opt, const void __user *addr, unsigned long data
 	mm->arg_end	= prctl_map.arg_end;
 	mm->env_start	= prctl_map.env_start;
 	mm->env_end	= prctl_map.env_end;
+	spin_unlock(&mm->arg_lock);
 
 	/*
 	 * Note this update of @saved_auxv is lockless thus
@@ -1991,7 +1998,7 @@ static int prctl_set_mm_map(int opt, const void __user *addr, unsigned long data
 	if (prctl_map.auxv_size)
 		memcpy(mm->saved_auxv, user_auxv, sizeof(user_auxv));
 
-	up_write(&mm->mmap_sem);
+	up_read(&mm->mmap_sem);
 	return 0;
 }
 #endif /* CONFIG_CHECKPOINT_RESTORE */
diff --git a/kernel/sysctl.c b/kernel/sysctl.c
index 9a2146de5e5a88bc593d53a31740f5f984c6c6d7..f711449b9cbd9e9391dcf81d4b9c711f2f1a27cd 100644
--- a/kernel/sysctl.c
+++ b/kernel/sysctl.c
@@ -952,7 +952,7 @@ static struct ctl_table kern_table[] = {
 		.data		= &console_loglevel,
 		.maxlen		= 4*sizeof(int),
 		.mode		= 0644,
-		.proc_handler	= proc_dointvec,
+		.proc_handler	= proc_dointvec_oem,
 	},
 	{
 		.procname	= "printk_ratelimit",
@@ -1414,6 +1414,24 @@ static struct ctl_table vm_table[] = {
 		.extra1		= &zero,
 		.extra2		= &two,
 	},
+#ifdef CONFIG_SMART_BOOST
+	{
+		.procname	= "page_cache_reside_switch",
+		.data		= &sysctl_page_cache_reside_switch,
+		.maxlen		= sizeof(sysctl_page_cache_reside_switch),
+		.mode		= 0666,
+		.proc_handler	= proc_dointvec_minmax,
+		.extra1		= &zero,
+		.extra2		= &two,
+	},
+	{
+		.procname	= "page_cache_reside_max",
+		.data		= &sysctl_page_cache_reside_max,
+		.maxlen		= sizeof(sysctl_page_cache_reside_max),
+		.mode		= 0666,
+		.proc_handler	= proc_dointvec_minmax,
+	},
+#endif
 	{
 		.procname	= "oom_kill_allocating_task",
 		.data		= &sysctl_oom_kill_allocating_task,
@@ -1528,6 +1546,21 @@ static struct ctl_table vm_table[] = {
 		.extra1		= &zero,
 		.extra2		= &one_hundred,
 	},
+	{
+		.procname	= "breath_period",
+		.data		= &vm_breath_period,
+		.maxlen		= sizeof(vm_breath_period),
+		.mode		= 0644,
+		.proc_handler	= proc_dointvec_minmax,
+		.extra1		= &zero,
+	},
+	{
+		.procname	= "breath_priority",
+		.data		= &vm_breath_priority,
+		.maxlen		= sizeof(vm_breath_priority),
+		.mode		= 0644,
+		.proc_handler	= proc_dointvec,
+	},
 	{
 		.procname       = "want_old_faultaround_pte",
 		.data           = &want_old_faultaround_pte,
@@ -1537,6 +1570,26 @@ static struct ctl_table vm_table[] = {
 		.extra1         = &zero,
 		.extra2         = &one,
 	},
+#ifdef CONFIG_MEMPLUS
+	{
+		.procname	= "memory_plus_test_worstcase",
+		.data		= &vm_memory_plus_test_worstcase,
+		.maxlen 	= sizeof(vm_memory_plus),
+		.mode		= 0644,
+		.proc_handler	= proc_dointvec_minmax,
+		.extra1 	= &neg_one,
+		.extra2 	= &one_thousand,
+	},
+	{
+		.procname	= "memory_plus",
+		.data		= &vm_memory_plus,
+		.maxlen 	= sizeof(vm_memory_plus),
+		.mode		= 0644,
+		.proc_handler	= proc_dointvec_minmax,
+		.extra1 	= &neg_one,
+		.extra2 	= &one_thousand,
+	},
+#endif
 #ifdef CONFIG_HUGETLB_PAGE
 	{
 		.procname	= "nr_hugepages",
@@ -2650,6 +2703,24 @@ int proc_dointvec(struct ctl_table *table, int write,
 {
 	return do_proc_dointvec(table, write, buffer, lenp, ppos, NULL, NULL);
 }
+static unsigned int oem_en_chg_prk_lv = 1;
+module_param(oem_en_chg_prk_lv, uint, 0644);
+
+int proc_dointvec_oem(struct ctl_table *table, int write,
+		     void __user *buffer, size_t *lenp, loff_t *ppos)
+{
+    if(oem_en_chg_prk_lv || !write )
+		return do_proc_dointvec(table, write, buffer, lenp, ppos, NULL, NULL);
+    else
+		return -ENOSYS;
+}
+static int __init oem_disable_chg_prk_lv(char *str)
+{
+	oem_en_chg_prk_lv = 0;
+	return 0;
+}
+early_param("debug", oem_disable_chg_prk_lv);
+
 
 /**
  * proc_douintvec - read a vector of unsigned integers
diff --git a/lib/lzo/lzo1x_compress.c b/lib/lzo/lzo1x_compress.c
index 236eb21167b5db1f5cd542efbf6c66dd770455fc..aaeba008eb0e44621a02aab766202a433d4c7f8f 100644
--- a/lib/lzo/lzo1x_compress.c
+++ b/lib/lzo/lzo1x_compress.c
@@ -17,6 +17,9 @@
 #include <linux/lzo.h>
 #include "lzodefs.h"
 
+#define OVERFLOW_ADD_CHECK(a, b)  \
+		(((a) + (b)) < (a))
+
 static noinline size_t
 lzo1x_1_do_compress(const unsigned char *in, size_t in_len,
 		    unsigned char *out, size_t *out_len,
@@ -39,6 +42,8 @@ lzo1x_1_do_compress(const unsigned char *in, size_t in_len,
 		size_t t, m_len, m_off;
 		u32 dv;
 literal:
+		if (unlikely(OVERFLOW_ADD_CHECK(ip, 1 + ((ip - ii) >> 5))))
+			break;
 		ip += 1 + ((ip - ii) >> 5);
 next:
 		if (unlikely(ip >= ip_end))
@@ -99,7 +104,8 @@ lzo1x_1_do_compress(const unsigned char *in, size_t in_len,
 				m_len += 8;
 				v = get_unaligned((const u64 *) (ip + m_len)) ^
 				    get_unaligned((const u64 *) (m_pos + m_len));
-				if (unlikely(ip + m_len >= ip_end))
+				if (unlikely(OVERFLOW_ADD_CHECK(ip, m_len)
+						|| (ip + m_len >= ip_end)))
 					goto m_len_done;
 			} while (v == 0);
 		}
@@ -124,7 +130,8 @@ lzo1x_1_do_compress(const unsigned char *in, size_t in_len,
 				m_len += 4;
 				v = get_unaligned((const u32 *) (ip + m_len)) ^
 				    get_unaligned((const u32 *) (m_pos + m_len));
-				if (unlikely(ip + m_len >= ip_end))
+				if (unlikely(OVERFLOW_ADD_CHECK(ip, m_len)
+						|| (ip + m_len >= ip_end)))
 					goto m_len_done;
 			} while (v == 0);
 		}
@@ -160,7 +167,8 @@ lzo1x_1_do_compress(const unsigned char *in, size_t in_len,
 				if (ip[m_len] != m_pos[m_len])
 					break;
 				m_len += 1;
-				if (unlikely(ip + m_len >= ip_end))
+				if (unlikely(OVERFLOW_ADD_CHECK(ip, m_len)
+						|| (ip + m_len >= ip_end)))
 					goto m_len_done;
 			} while (ip[m_len] == m_pos[m_len]);
 		}
@@ -224,8 +232,8 @@ int lzo1x_1_compress(const unsigned char *in, size_t in_len,
 
 	while (l > 20) {
 		size_t ll = l <= (M4_MAX_OFFSET + 1) ? l : (M4_MAX_OFFSET + 1);
-		uintptr_t ll_end = (uintptr_t) ip + ll;
-		if ((ll_end + ((t + ll) >> 5)) <= ll_end)
+		// check for address space wraparound
+		if (((uintptr_t) ip + ll + ((t + ll) >> 5)) <= (uintptr_t) ip)
 			break;
 		BUILD_BUG_ON(D_SIZE * sizeof(lzo_dict_t) > LZO1X_1_MEM_COMPRESS);
 		memset(wrkmem, 0, D_SIZE * sizeof(lzo_dict_t));
diff --git a/mm/Kconfig b/mm/Kconfig
index 56574779b02f71f7ab97932d64937a191ce953d9..f559a4c8c4761f94c5ac478b9d925cafb685a2d4 100644
--- a/mm/Kconfig
+++ b/mm/Kconfig
@@ -820,7 +820,7 @@ config HAVE_LOW_MEMORY_KILLER
 config PROCESS_RECLAIM
 	bool "Enable process reclaim"
 	depends on PROC_FS
-	default y
+	default n
 	help
 	 It allows to reclaim pages of the process by /proc/pid/reclaim.
 
@@ -832,3 +832,9 @@ config PROCESS_RECLAIM
 	 (addr, addr + size-bytes) of the process.
 
 	 Any other value is ignored.
+
+config SMART_BOOST
+	bool "support smart boost feature"
+	default n
+	help
+	 this feature allow memory used by recent-app stay in kernel.
diff --git a/mm/compaction.c b/mm/compaction.c
index b95be89763995fd7e8e78ca0339fd464305557da..af362161fe76da5c1a59857b4d62c425ca10391e 100644
--- a/mm/compaction.c
+++ b/mm/compaction.c
@@ -884,7 +884,12 @@ isolate_migratepages_block(struct compact_control *cc, unsigned long low_pfn,
 		VM_BUG_ON_PAGE(PageCompound(page), page);
 
 		/* Successfully isolated */
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, page_lru(page),
+					PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, page_lru(page));
+#endif
 		inc_node_page_state(page,
 				NR_ISOLATED_ANON + page_is_file_cache(page));
 
diff --git a/mm/filemap.c b/mm/filemap.c
index e77e15d08670f57c81f2c92d0d4d5214b72f3762..51920f3bf2f8247b9fa86d242fd04a372257313e 100644
--- a/mm/filemap.c
+++ b/mm/filemap.c
@@ -800,7 +800,9 @@ int add_to_page_cache_locked(struct page *page, struct address_space *mapping,
 					  gfp_mask, NULL);
 }
 EXPORT_SYMBOL(add_to_page_cache_locked);
-
+#ifdef CONFIG_SMART_BOOST
+extern unsigned long get_max_minfree(void);
+#endif
 int add_to_page_cache_lru(struct page *page, struct address_space *mapping,
 				pgoff_t offset, gfp_t gfp_mask)
 {
@@ -827,7 +829,16 @@ int add_to_page_cache_lru(struct page *page, struct address_space *mapping,
 			workingset_activation(page);
 		} else
 			ClearPageActive(page);
+#ifdef CONFIG_SMART_BOOST
+		if (sysctl_page_cache_reside_switch &&
+			current->group_leader->hot_count > 0 &&
+			(global_node_page_state(NR_FILE_PAGES) - total_swapcache_pages()) > get_max_minfree())
+			uid_lru_cache_add(page);
+		else
+			lru_cache_add(page);
+#else
 		lru_cache_add(page);
+#endif
 	}
 	return ret;
 }
diff --git a/mm/init-mm.c b/mm/init-mm.c
index e71ac37a98c46029eece9fb0766a7d71b300ec62..3d3f39937e2694ab941ebcea9d19d46852c9ca9d 100644
--- a/mm/init-mm.c
+++ b/mm/init-mm.c
@@ -25,6 +25,7 @@ struct mm_struct init_mm = {
 	.mm_count	= ATOMIC_INIT(1),
 	.mmap_sem	= __RWSEM_INITIALIZER(init_mm.mmap_sem),
 	.page_table_lock =  __SPIN_LOCK_UNLOCKED(init_mm.page_table_lock),
+	.arg_lock      =  __SPIN_LOCK_UNLOCKED(init_mm.arg_lock),
 	.mmlist		= LIST_HEAD_INIT(init_mm.mmlist),
 	.user_ns	= &init_user_ns,
 	INIT_MM_CONTEXT(init_mm)
diff --git a/mm/internal.h b/mm/internal.h
index b84f706a6f178b044a0c7963dd73c0156040026c..3a774a3fa6060cd1ba62782cab36992918568af7 100644
--- a/mm/internal.h
+++ b/mm/internal.h
@@ -100,6 +100,8 @@ static inline void set_page_refcounted(struct page *page)
 
 extern unsigned long highest_memmap_pfn;
 
+extern atomic_t alloc_ongoing;
+
 /*
  * Maximum number of reclaim retries without progress before the OOM
  * killer is consider the only way forward.
@@ -141,6 +143,7 @@ struct alloc_context {
 	int migratetype;
 	enum zone_type high_zoneidx;
 	bool spread_dirty_pages;
+	bool lr_handle;
 };
 
 #define ac_classzone_idx(ac) zonelist_zone_idx(ac->preferred_zoneref)
@@ -515,6 +518,9 @@ unsigned long reclaim_clean_pages_from_list(struct zone *zone,
 #define ALLOC_HIGH		0x20 /* __GFP_HIGH set */
 #define ALLOC_CPUSET		0x40 /* check for correct cpuset */
 #define ALLOC_CMA		0x80 /* allow allocations from CMA areas */
+#ifdef CONFIG_DEFRAG_HELPER
+#define ALLOC_UNMOVE    0x800
+#endif
 
 enum ttu_flags;
 struct tlbflush_unmap_batch;
diff --git a/mm/madvise.c b/mm/madvise.c
index 3edbc0d0760f2929d879d6b620087e6b8e9ef7cf..6e895b3a22532b381b4125e73105e86b97da6475 100644
--- a/mm/madvise.c
+++ b/mm/madvise.c
@@ -192,8 +192,13 @@ static long madvise_behavior(struct vm_area_struct *vma,
 }
 
 #ifdef CONFIG_SWAP
+#ifdef CONFIG_MEMPLUS
+int swapin_walk_pmd_entry(pmd_t *pmd, unsigned long start,
+	unsigned long end, struct mm_walk *walk)
+#else
 static int swapin_walk_pmd_entry(pmd_t *pmd, unsigned long start,
 	unsigned long end, struct mm_walk *walk)
+#endif
 {
 	pte_t *orig_pte;
 	struct vm_area_struct *vma = walk->private;
@@ -208,6 +213,10 @@ static int swapin_walk_pmd_entry(pmd_t *pmd, unsigned long start,
 		struct page *page;
 		spinlock_t *ptl;
 
+#ifdef CONFIG_MEMPLUS
+		if (!list_empty(&vma->vm_mm->mmap_sem.wait_list))
+			return -1;
+#endif
 		orig_pte = pte_offset_map_lock(vma->vm_mm, pmd, start, &ptl);
 		pte = *(orig_pte + ((index - start) / PAGE_SIZE));
 		pte_unmap_unlock(orig_pte, ptl);
@@ -217,7 +226,28 @@ static int swapin_walk_pmd_entry(pmd_t *pmd, unsigned long start,
 		entry = pte_to_swp_entry(pte);
 		if (unlikely(non_swap_entry(entry)))
 			continue;
-
+#ifdef CONFIG_MEMPLUS
+		if (is_fast_entry(entry)) {
+			int ret = 0;
+			struct vm_fault fe = {
+				.vma = vma,
+				.pte = &pte,
+				.orig_pte = pte,
+				.address = index,
+				.flags = FAULT_FLAG_ALLOW_RETRY | FAULT_FLAG_RETRY_NOWAIT,
+				.pmd = pmd,
+				.vma_flags = vma->vm_flags,
+				.vma_page_prot = vma->vm_page_prot,
+			};
+
+			ret = do_swap_page(&fe);
+			if (ret & VM_FAULT_ERROR) {
+				printk(KERN_ERR "%s: do_swap_page ERROR\n", __func__);
+				break;
+			}
+			continue;
+		} else
+#endif
 		page = read_swap_cache_async(entry, GFP_HIGHUSER_MOVABLE,
 							vma, index, false);
 		if (page)
diff --git a/mm/memcontrol.c b/mm/memcontrol.c
index 6a9a7e1066efa896c56f7ddf2c2fadaa14252b38..9d324789c2b6bbb7ece15f48a364d690ede3bae9 100644
--- a/mm/memcontrol.c
+++ b/mm/memcontrol.c
@@ -105,6 +105,10 @@ static const char *const mem_cgroup_lru_names[] = {
 	"active_anon",
 	"inactive_file",
 	"active_file",
+#ifdef CONFIG_MEMPLUS
+	"inactive_anon_swpcache",
+	"active_anon_swpcache",
+#endif
 	"unevictable",
 };
 
@@ -2077,7 +2081,12 @@ static void lock_page_lru(struct page *page, int *isolated)
 
 		lruvec = mem_cgroup_page_lruvec(page, zone->zone_pgdat);
 		ClearPageLRU(page);
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, page_lru(page),
+					PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, page_lru(page));
+#endif
 		*isolated = 1;
 	} else
 		*isolated = 0;
diff --git a/mm/memory.c b/mm/memory.c
index 52080e48f3cc0284bc1ce067561251f44c7caac1..8b9e5dd20d0c74575c4f1fd24291e72d37255670 100644
--- a/mm/memory.c
+++ b/mm/memory.c
@@ -1087,6 +1087,7 @@ static int copy_pte_range(struct mm_struct *dst_mm, struct mm_struct *src_mm,
 	spinlock_t *src_ptl, *dst_ptl;
 	int progress = 0;
 	int rss[NR_MM_COUNTERS];
+	unsigned long orig_addr = addr;
 	swp_entry_t entry = (swp_entry_t){0};
 
 again:
@@ -1125,6 +1126,16 @@ static int copy_pte_range(struct mm_struct *dst_mm, struct mm_struct *src_mm,
 	} while (dst_pte++, src_pte++, addr += PAGE_SIZE, addr != end);
 
 	arch_leave_lazy_mmu_mode();
+
+	/*
+	 * Prevent the page fault handler to copy the page while stale tlb entry
+	 * are still not flushed.
+	 * ethan.peng 2019/1/22 CR2366100.
+	 */
+	if (IS_ENABLED(CONFIG_SPECULATIVE_PAGE_FAULT) &&
+	    is_cow_mapping(vma->vm_flags))
+		flush_tlb_range(vma, orig_addr, end);
+
 	spin_unlock(src_ptl);
 	pte_unmap(orig_src_pte);
 	add_mm_rss_vec(dst_mm, rss);
@@ -3202,7 +3213,10 @@ int do_swap_page(struct vm_fault *vmf)
 	 * before page_add_anon_rmap() and swap_free(); try_to_free_swap()
 	 * must be called after the swap_free(), or it will never succeed.
 	 */
-
+#ifdef CONFIG_MEMPLUS
+	if (current_is_swapind())
+		SetPageWillneed(page);
+#endif
 	inc_mm_counter_fast(vma->vm_mm, MM_ANONPAGES);
 	dec_mm_counter_fast(vma->vm_mm, MM_SWAPENTS);
 	pte = mk_pte(page, vmf->vma_page_prot);
diff --git a/mm/mlock.c b/mm/mlock.c
index c8ea725535b048e47807d02ac3a2350286465c91..ad88e4cc969cfb6d5da0fe873aee1d5e62ad5437 100644
--- a/mm/mlock.c
+++ b/mm/mlock.c
@@ -109,7 +109,12 @@ static bool __munlock_isolate_lru_page(struct page *page, bool getpage)
 		if (getpage)
 			get_page(page);
 		ClearPageLRU(page);
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, page_lru(page),
+					PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, page_lru(page));
+#endif
 		return true;
 	}
 
diff --git a/mm/page_alloc.c b/mm/page_alloc.c
index 02aa2caa0efc6f7b6cd96d9ce97d5a7a1f7573f8..e6e1697c5e79ee7e13b244b4c1d5f50660086956 100644
--- a/mm/page_alloc.c
+++ b/mm/page_alloc.c
@@ -73,7 +73,9 @@
 #include <asm/tlbflush.h>
 #include <asm/div64.h>
 #include "internal.h"
-
+#ifdef CONFIG_DEFRAG_HELPER
+#include <../drivers/oneplus/coretech/defrag/defrag_helper.h>
+#endif
 /* prevent >1 _updater_ of zone percpu pageset ->high and ->batch fields */
 static DEFINE_MUTEX(pcp_batch_high_lock);
 #define MIN_PERCPU_PAGELIST_FRACTION	(8)
@@ -104,6 +106,9 @@ volatile unsigned long latent_entropy __latent_entropy;
 EXPORT_SYMBOL(latent_entropy);
 #endif
 
+#ifdef CONFIG_SMART_BOOST
+unsigned long alloc_slow_nr;
+#endif
 /*
  * Array of node states.
  */
@@ -243,6 +248,9 @@ char * const migratetype_names[MIGRATE_TYPES] = {
 	"CMA",
 #endif
 	"HighAtomic",
+#ifdef CONFIG_DEFRAG_HELPER
+	"Defrag-Pool",
+#endif
 #ifdef CONFIG_MEMORY_ISOLATION
 	"Isolate",
 #endif
@@ -274,6 +282,19 @@ int watermark_scale_factor = 10;
  * down to the min watermarks controlled by min_free_kbytes above.
  */
 int extra_free_kbytes = 0;
+atomic_t alloc_ongoing = ATOMIC_INIT(0);
+
+extern atomic64_t vm_high_priority_ns;
+extern atomic64_t vm_low_priority_ns;
+extern atomic64_t vm_all_priority_ns;
+extern atomic64_t vm_high_priority_count;
+extern atomic64_t vm_all_priority_count;
+
+extern atomic64_t vm_high_priority_ns_1ms;
+extern atomic64_t vm_low_priority_ns_1ms;
+extern atomic64_t vm_all_priority_ns_1ms;
+extern atomic64_t vm_high_priority_count_1ms;
+extern atomic64_t vm_all_priority_count_1ms;
 
 static unsigned long __meminitdata nr_kernel_pages;
 static unsigned long __meminitdata nr_all_pages;
@@ -857,6 +878,10 @@ static inline void __free_one_page(struct page *page,
 		} else {
 			list_del(&buddy->lru);
 			zone->free_area[order].nr_free--;
+#ifdef CONFIG_DEFRAG_HELPER
+			if (is_migrate_defrag(migratetype))
+				zone->free_area[order].nr_free_defrag--;
+#endif
 			rmv_page_order(buddy);
 		}
 		combined_pfn = buddy_pfn & pfn;
@@ -917,6 +942,10 @@ static inline void __free_one_page(struct page *page,
 	list_add(&page->lru, &zone->free_area[order].free_list[migratetype]);
 out:
 	zone->free_area[order].nr_free++;
+#ifdef CONFIG_DEFRAG_HELPER
+	if (is_migrate_defrag(migratetype))
+		zone->free_area[order].nr_free_defrag++;
+#endif
 }
 
 /*
@@ -1683,6 +1712,10 @@ static inline void expand(struct zone *zone, struct page *page,
 
 		list_add(&page[size].lru, &area->free_list[migratetype]);
 		area->nr_free++;
+#ifdef CONFIG_DEFRAG_HELPER
+		if (is_migrate_defrag(migratetype))
+			area->nr_free_defrag++;
+#endif
 		set_page_order(&page[size], high);
 	}
 }
@@ -1830,6 +1863,10 @@ struct page *__rmqueue_smallest(struct zone *zone, unsigned int order,
 		list_del(&page->lru);
 		rmv_page_order(page);
 		area->nr_free--;
+#ifdef CONFIG_DEFRAG_HELPER
+		if (is_migrate_defrag(migratetype))
+			area->nr_free_defrag--;
+#endif
 		expand(zone, page, order, current_order, area, migratetype);
 		set_pcppage_migratetype(page, migratetype);
 		return page;
@@ -1850,6 +1887,9 @@ static int fallbacks[MIGRATE_TYPES][4] = {
 #ifdef CONFIG_CMA
 	[MIGRATE_CMA]         = { MIGRATE_TYPES }, /* Never used */
 #endif
+#ifdef CONFIG_DEFRAG_HELPER
+	[MIGRATE_UNMOVABLE_DEFRAG_POOL]		=  {MIGRATE_TYPES},
+#endif
 #ifdef CONFIG_MEMORY_ISOLATION
 	[MIGRATE_ISOLATE]     = { MIGRATE_TYPES }, /* Never used */
 #endif
@@ -1873,7 +1913,11 @@ static inline struct page *__rmqueue_cma_fallback(struct zone *zone,
  */
 static int move_freepages(struct zone *zone,
 			  struct page *start_page, struct page *end_page,
+#ifdef CONFIG_DEFRAG_HELPER
+			  int migratetype, int *num_movable, int old_mt)
+#else
 			  int migratetype, int *num_movable)
+#endif
 {
 	struct page *page;
 	unsigned int order;
@@ -1919,6 +1963,12 @@ static int move_freepages(struct zone *zone,
 		order = page_order(page);
 		list_move(&page->lru,
 			  &zone->free_area[order].free_list[migratetype]);
+#ifdef CONFIG_DEFRAG_HELPER
+		if (is_migrate_defrag(migratetype))
+			zone->free_area[order].nr_free_defrag++;
+		else if (is_migrate_defrag(old_mt))
+			zone->free_area[order].nr_free_defrag--;
+#endif
 		page += 1 << order;
 		pages_moved += 1 << order;
 	}
@@ -1927,7 +1977,11 @@ static int move_freepages(struct zone *zone,
 }
 
 int move_freepages_block(struct zone *zone, struct page *page,
+#ifdef CONFIG_DEFRAG_HELPER
+				int migratetype, int *num_movable, int old_mt)
+#else
 				int migratetype, int *num_movable)
+#endif
 {
 	unsigned long start_pfn, end_pfn;
 	struct page *start_page, *end_page;
@@ -1944,8 +1998,13 @@ int move_freepages_block(struct zone *zone, struct page *page,
 	if (!zone_spans_pfn(zone, end_pfn))
 		return 0;
 
+#ifndef CONFIG_DEFRAG_HELPER
 	return move_freepages(zone, start_page, end_page, migratetype,
 								num_movable);
+#else
+	return move_freepages(zone, start_page, end_page, migratetype,
+							num_movable, old_mt);
+#endif
 }
 
 static void change_pageblock_range(struct page *pageblock_page,
@@ -2026,9 +2085,13 @@ static void steal_suitable_fallback(struct zone *zone, struct page *page,
 	/* We are not allowed to try stealing from the whole block */
 	if (!whole_block)
 		goto single_page;
-
+#ifdef CONFIG_DEFRAG_HELPER
+	free_pages = move_freepages_block(zone, page, start_type,
+				&movable_pages, old_block_type);
+#else
 	free_pages = move_freepages_block(zone, page, start_type,
 						&movable_pages);
+#endif
 	/*
 	 * Determine how many pages are compatible with our allocation.
 	 * For movable allocation, it's the number of movable pages which
@@ -2068,6 +2131,12 @@ static void steal_suitable_fallback(struct zone *zone, struct page *page,
 single_page:
 	area = &zone->free_area[current_order];
 	list_move(&page->lru, &area->free_list[start_type]);
+#ifdef CONFIG_DEFRAG_HELPER
+	if (is_migrate_defrag(start_type))
+		area->nr_free_defrag++;
+	else if (is_migrate_defrag(old_block_type))
+		area->nr_free_defrag--;
+#endif
 }
 
 /*
@@ -2133,11 +2202,19 @@ static void reserve_highatomic_pageblock(struct page *page, struct zone *zone,
 
 	/* Yoink! */
 	mt = get_pageblock_migratetype(page);
+#ifndef CONFIG_DEFRAG_HELPER
 	if (!is_migrate_highatomic(mt) && !is_migrate_isolate(mt)
 	    && !is_migrate_cma(mt)) {
 		zone->nr_reserved_highatomic += pageblock_nr_pages;
 		set_pageblock_migratetype(page, MIGRATE_HIGHATOMIC);
 		move_freepages_block(zone, page, MIGRATE_HIGHATOMIC, NULL);
+#else
+	if (mt != MIGRATE_HIGHATOMIC && !is_migrate_isolate(mt) &&
+			!is_migrate_cma(mt) && !is_migrate_defrag(mt)) {
+		zone->nr_reserved_highatomic += pageblock_nr_pages;
+		set_pageblock_migratetype(page, MIGRATE_HIGHATOMIC);
+		move_freepages_block(zone, page, MIGRATE_HIGHATOMIC, NULL, mt);
+#endif
 	}
 
 out_unlock:
@@ -2214,8 +2291,13 @@ static bool unreserve_highatomic_pageblock(const struct alloc_context *ac,
 			 * may increase.
 			 */
 			set_pageblock_migratetype(page, ac->migratetype);
+#ifndef CONFIG_DEFRAG_HELPER
 			ret = move_freepages_block(zone, page, ac->migratetype,
 									NULL);
+#else
+			ret = move_freepages_block(zone, page, ac->migratetype,
+							NULL, MIGRATE_HIGHATOMIC);
+#endif
 			if (ret) {
 				spin_unlock_irqrestore(&zone->lock, flags);
 				return ret;
@@ -2342,6 +2424,14 @@ static inline struct page *__rmqueue_cma(struct zone *zone, unsigned int order)
 }
 #endif
 
+#ifdef CONFIG_DEFRAG_HELPER
+struct page *ctech___rmqueue(struct zone *zone, unsigned int order,
+			int migratetype)
+{
+	return __rmqueue(zone, order, migratetype);
+}
+EXPORT_SYMBOL(ctech___rmqueue);
+#endif
 /*
  * Obtain a specified number of elements from the buddy allocator, all under
  * a single hold of the lock, for efficiency.  Add them to the supplied list.
@@ -2766,6 +2856,10 @@ int __isolate_free_page(struct page *page, unsigned int order)
 	/* Remove page from free list */
 	list_del(&page->lru);
 	zone->free_area[order].nr_free--;
+#ifdef CONFIG_DEFRAG_HELPER
+	if (is_migrate_defrag(mt))
+		zone->free_area[order].nr_free_defrag--;
+#endif
 	rmv_page_order(page);
 
 	/*
@@ -2876,15 +2970,27 @@ static struct page *rmqueue_pcplist(struct zone *preferred_zone,
 /*
  * Allocate a page from the given zone. Use pcplists for order-0 allocations.
  */
+#ifdef CONFIG_DEFRAG_HELPER
+static inline
+struct page *rmqueue_fp(int fp, struct zone *preferred_zone,
+			struct zone *zone, unsigned int order,
+			gfp_t gfp_flags, unsigned int alloc_flags,
+			int migratetype)
+#else
 static inline
 struct page *rmqueue(struct zone *preferred_zone,
 			struct zone *zone, unsigned int order,
 			gfp_t gfp_flags, unsigned int alloc_flags,
 			int migratetype)
+#endif
 {
 	unsigned long flags;
 	struct page *page;
 
+#ifdef CONFIG_DEFRAG_HELPER
+	if (fp)
+		fp_usage_add(order);
+#endif
 	if (likely(order == 0)) {
 		page = rmqueue_pcplist(preferred_zone, zone, order,
 				gfp_flags, migratetype);
@@ -2896,8 +3002,13 @@ struct page *rmqueue(struct zone *preferred_zone,
 	 * allocate greater than order-1 page units with __GFP_NOFAIL.
 	 */
 	WARN_ON_ONCE((gfp_flags & __GFP_NOFAIL) && (order > 1));
-	spin_lock_irqsave(&zone->lock, flags);
 
+#ifdef CONFIG_DEFRAG_HELPER
+	page = ctech_defrag_alloc(zone, flags, migratetype, order);
+	if (page)
+		goto out;
+#endif
+	spin_lock_irqsave(&zone->lock, flags);
 	do {
 		page = NULL;
 
@@ -2930,6 +3041,10 @@ struct page *rmqueue(struct zone *preferred_zone,
 	return page;
 
 failed:
+#ifdef CONFIG_DEFRAG_HELPER
+	if (fp)
+		fp_fail_add(order);
+#endif
 	local_irq_restore(flags);
 	return NULL;
 }
@@ -3025,6 +3140,10 @@ bool __zone_watermark_ok(struct zone *z, unsigned int order, unsigned long mark,
 	long min = mark;
 	int o;
 	const bool alloc_harder = (alloc_flags & (ALLOC_HARDER|ALLOC_OOM));
+#ifdef CONFIG_DEFRAG_HELPER
+	long ctech_calc;
+	long ctech_en;
+#endif
 
 	/* free_pages may go negative - that's OK */
 	free_pages -= (1 << order) - 1;
@@ -3059,6 +3178,11 @@ bool __zone_watermark_ok(struct zone *z, unsigned int order, unsigned long mark,
 		free_pages -= zone_page_state(z, NR_FREE_CMA_PAGES);
 #endif
 
+#ifdef CONFIG_DEFRAG_HELPER
+	ctech_calc = ctech_defrag_calc(z, order, alloc_flags);
+	ctech_en = !ctech_calc;
+	free_pages -= ctech_calc;
+#endif
 	/*
 	 * Check watermarks for an order-0 allocation request. If these
 	 * are not met, then a high-order request also cannot go ahead
@@ -3097,6 +3221,12 @@ bool __zone_watermark_ok(struct zone *z, unsigned int order, unsigned long mark,
 		    !list_empty(&area->free_list[MIGRATE_CMA])) {
 			return true;
 		}
+#endif
+#ifdef CONFIG_DEFRAG_HELPER
+		if (ctech_check_alloc_flag(alloc_flags, order) &&
+			!list_empty(&area->free_list[MIGRATE_UNMOVABLE_DEFRAG_POOL])) {
+			return true;
+		}
 #endif
 		if (alloc_harder &&
 			!list_empty(&area->free_list[MIGRATE_HIGHATOMIC]))
@@ -3117,13 +3247,17 @@ static inline bool zone_watermark_fast(struct zone *z, unsigned int order,
 {
 	long free_pages = zone_page_state(z, NR_FREE_PAGES);
 	long cma_pages = 0;
-
+#ifdef CONFIG_DEFRAG_HELPER
+	long defrag_pages = 0;
+#endif
 #ifdef CONFIG_CMA
 	/* If allocation can't use CMA areas don't use free CMA pages */
 	if (!(alloc_flags & ALLOC_CMA))
 		cma_pages = zone_page_state(z, NR_FREE_CMA_PAGES);
 #endif
-
+#ifdef CONFIG_DEFRAG_HELPER
+	defrag_pages = zone_page_state(z, NR_FREE_DEFRAG_POOL);
+#endif
 	/*
 	 * Fast check for order-0 only. If this fails then the reserves
 	 * need to be calculated. There is a corner case where the check
@@ -3131,7 +3265,13 @@ static inline bool zone_watermark_fast(struct zone *z, unsigned int order,
 	 * the caller is !atomic then it'll uselessly search the free
 	 * list. That corner case is then slower but it is harmless.
 	 */
-	if (!order && (free_pages - cma_pages) > mark + z->lowmem_reserve[classzone_idx])
+#ifdef CONFIG_DEFRAG_HELPER
+	if (!order && (free_pages - cma_pages - defrag_pages) > mark +
+			z->lowmem_reserve[classzone_idx])
+#else
+	if (!order && (free_pages - cma_pages) > mark +
+			z->lowmem_reserve[classzone_idx])
+#endif
 		return true;
 
 	return __zone_watermark_ok(z, order, mark, classzone_idx, alloc_flags,
@@ -3167,9 +3307,25 @@ static bool zone_allows_reclaim(struct zone *local_zone, struct zone *zone)
  * get_page_from_freelist goes through the zonelist trying to allocate
  * a page.
  */
+#ifdef CONFIG_DEFRAG_HELPER
+static struct page *
+get_page_from_freelist_fp(int fp, gfp_t gfp_mask, unsigned int order,
+			int alloc_flags, const struct alloc_context *ac);
 static struct page *
 get_page_from_freelist(gfp_t gfp_mask, unsigned int order, int alloc_flags,
-						const struct alloc_context *ac)
+					const struct alloc_context *ac)
+{
+	return get_page_from_freelist_fp(0, gfp_mask, order, alloc_flags, ac);
+}
+
+static struct page *
+get_page_from_freelist_fp(int fp, gfp_t gfp_mask, unsigned int order,
+			int alloc_flags, const struct alloc_context *ac)
+#else
+static struct page *
+get_page_from_freelist(gfp_t gfp_mask, unsigned int order, int alloc_flags,
+					const struct alloc_context *ac)
+#endif
 {
 	struct zoneref *z = ac->preferred_zoneref;
 	struct zone *zone;
@@ -3180,7 +3336,7 @@ get_page_from_freelist(gfp_t gfp_mask, unsigned int order, int alloc_flags,
 	 * See also __cpuset_node_allowed() comment in kernel/cpuset.c.
 	 */
 	for_next_zone_zonelist_nodemask(zone, z, ac->zonelist, ac->high_zoneidx,
-								ac->nodemask) {
+							ac->nodemask) {
 		struct page *page;
 		unsigned long mark;
 
@@ -3250,8 +3406,14 @@ get_page_from_freelist(gfp_t gfp_mask, unsigned int order, int alloc_flags,
 		}
 
 try_this_zone:
+#ifdef CONFIG_DEFRAG_HELPER
+		page = rmqueue_fp(fp, ac->preferred_zoneref->zone,
+							zone, order, gfp_mask,
+						alloc_flags, ac->migratetype);
+#else
 		page = rmqueue(ac->preferred_zoneref->zone, zone, order,
-				gfp_mask, alloc_flags, ac->migratetype);
+					gfp_mask, alloc_flags, ac->migratetype);
+#endif
 		if (page) {
 			prep_new_page(page, order, gfp_mask, alloc_flags);
 
@@ -3757,12 +3919,23 @@ static void wake_all_kswapds(unsigned int order, const struct alloc_context *ac)
 	struct zoneref *z;
 	struct zone *zone;
 	pg_data_t *last_pgdat = NULL;
+	struct task_struct *kswapd;
 
 	for_each_zone_zonelist_nodemask(zone, z, ac->zonelist,
 					ac->high_zoneidx, ac->nodemask) {
 		if (last_pgdat != zone->zone_pgdat)
 			wakeup_kswapd(zone, order, ac->high_zoneidx);
 		last_pgdat = zone->zone_pgdat;
+		kswapd = zone->zone_pgdat->kswapd;
+
+		/* early state check to prevent memory barrier and spinlock */
+		if (ac->lr_handle && kswapd->state == TASK_INTERRUPTIBLE)
+			wake_up_state(kswapd, TASK_INTERRUPTIBLE);
+
+#ifdef CONFIG_MEMPLUS
+		if (vm_memory_plus_test_worstcase)
+			wake_up_process(kswapd);
+#endif
 	}
 }
 
@@ -3801,6 +3974,10 @@ gfp_to_alloc_flags(gfp_t gfp_mask)
 	if ((gfpflags_to_migratetype(gfp_mask) == MIGRATE_MOVABLE) &&
 				(gfp_mask & __GFP_CMA))
 		alloc_flags |= ALLOC_CMA;
+#endif
+#ifdef CONFIG_DEFRAG_HELPER
+	if (gfpflags_to_migratetype(gfp_mask) == MIGRATE_UNMOVABLE)
+		alloc_flags |= ALLOC_UNMOVE;
 #endif
 	return alloc_flags;
 }
@@ -4261,6 +4438,7 @@ static inline bool prepare_alloc_pages(gfp_t gfp_mask, unsigned int order,
 	ac->zonelist = node_zonelist(preferred_nid, gfp_mask);
 	ac->nodemask = nodemask;
 	ac->migratetype = gfpflags_to_migratetype(gfp_mask);
+	ac->lr_handle = false;
 
 	if (cpusets_enabled()) {
 		*alloc_mask |= __GFP_HARDWALL;
@@ -4278,9 +4456,21 @@ static inline bool prepare_alloc_pages(gfp_t gfp_mask, unsigned int order,
 	if (should_fail_alloc_page(gfp_mask, order))
 		return false;
 
+#ifdef CONFIG_MEMPLUS
+	if (vm_memory_plus_test_worstcase)
+		wake_all_kswapds(2, ac);
+#endif
+	if (current->signal->oom_score_adj <= vm_breath_priority) {
+		ac->lr_handle = true;
+		atomic_inc(&alloc_ongoing);
+	}
 	if (IS_ENABLED(CONFIG_CMA) && ac->migratetype == MIGRATE_MOVABLE &&
 			(gfp_mask & __GFP_CMA))
 		*alloc_flags |= ALLOC_CMA;
+#ifdef CONFIG_DEFRAG_HELPER
+	if (ac->migratetype == MIGRATE_UNMOVABLE)
+		*alloc_flags |= ALLOC_UNMOVE;
+#endif
 
 	return true;
 }
@@ -4312,6 +4502,10 @@ __alloc_pages_nodemask(gfp_t gfp_mask, unsigned int order, int preferred_nid,
 	unsigned int alloc_flags = ALLOC_WMARK_LOW;
 	gfp_t alloc_mask; /* The gfp_t that was actually used for allocation */
 	struct alloc_context ac = { };
+	u64 alloc_ns = 0;
+	struct timespec alloc_diff = {0};
+	struct timespec alloc_ts1 = {0};
+	struct timespec alloc_ts2 = {0};
 
 	gfp_mask &= gfp_allowed_mask;
 	alloc_mask = gfp_mask;
@@ -4321,10 +4515,17 @@ __alloc_pages_nodemask(gfp_t gfp_mask, unsigned int order, int preferred_nid,
 	finalise_ac(gfp_mask, order, &ac);
 
 	/* First allocation attempt */
+#ifdef CONFIG_DEFRAG_HELPER
+	page = get_page_from_freelist_fp(1, alloc_mask, order,
+							alloc_flags, &ac);
+#else
 	page = get_page_from_freelist(alloc_mask, order, alloc_flags, &ac);
+#endif
 	if (likely(page))
 		goto out;
 
+	getnstimeofday(&alloc_ts1);
+
 	/*
 	 * Apply scoped allocation constraints. This is mainly about GFP_NOFS
 	 * resp. GFP_NOIO which has to be inherited for all allocation requests
@@ -4351,6 +4552,41 @@ __alloc_pages_nodemask(gfp_t gfp_mask, unsigned int order, int preferred_nid,
 	}
 
 	trace_mm_page_alloc(page, order, alloc_mask, ac.migratetype);
+	if (ac.lr_handle) {
+		ac.lr_handle = false;
+		atomic_dec(&alloc_ongoing);
+	}
+	if ((alloc_ts1.tv_sec != 0) || (alloc_ts1.tv_nsec != 0)) {
+		getnstimeofday(&alloc_ts2);
+		alloc_diff = timespec_sub(alloc_ts2, alloc_ts1);
+		alloc_ns = timespec_to_ns(&alloc_diff);
+
+		atomic64_add(alloc_ns, &vm_all_priority_ns);
+		atomic64_inc(&vm_all_priority_count);
+		if (ac.lr_handle) {
+			atomic64_add(alloc_ns, &vm_high_priority_ns);
+			atomic64_inc(&vm_high_priority_count);
+		} else
+			atomic64_add(alloc_ns, &vm_low_priority_ns);
+
+		/* alloc_ns > 1ms, we print record */
+		/* > 1ms */
+		if (alloc_ns > 1*1000*1000) {
+			atomic64_add(alloc_ns, &vm_all_priority_ns_1ms);
+			atomic64_inc(&vm_all_priority_count_1ms);
+			if (ac.lr_handle) {
+				atomic64_add(alloc_ns, &vm_high_priority_ns_1ms);
+				atomic64_inc(&vm_high_priority_count_1ms);
+			} else
+				atomic64_add(alloc_ns, &vm_low_priority_ns_1ms);
+			//trace_mm_page_alloc_time(alloc_ns/1000000, order, alloc_mask, ac.migratetype);
+			//trace_printk("alloc_pages consumed %llu ns order=%d migratetype=%d high=%d\n"
+			//		, alloc_ns
+			//		, order
+			//		, ac.migratetype
+			//		, ac.lr_handle);
+		}
+	}
 
 	return page;
 }
@@ -4784,6 +5020,9 @@ static void show_migration_types(unsigned char type)
 #endif
 #ifdef CONFIG_MEMORY_ISOLATION
 		[MIGRATE_ISOLATE]	= 'I',
+#endif
+#ifdef CONFIG_DEFRAG_HELPER
+		[MIGRATE_UNMOVABLE_DEFRAG_POOL]	= 'D',
 #endif
 	};
 	char tmp[MIGRATE_TYPES + 1];
@@ -4828,7 +5067,15 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 		" unevictable:%lu dirty:%lu writeback:%lu unstable:%lu\n"
 		" slab_reclaimable:%lu slab_unreclaimable:%lu\n"
 		" mapped:%lu shmem:%lu pagetables:%lu bounce:%lu\n"
+#ifdef CONFIG_DEFRAG_HELPER
+		" defragfree:%lu\n"
+#endif
+#ifdef CONFIG_SMART_BOOST
+		" free:%lu free_pcp:%lu free_cma:%lu\n"
+		" ramboost:%lu\n",
+#else
 		" free:%lu free_pcp:%lu free_cma:%lu\n",
+#endif
 		global_node_page_state(NR_ACTIVE_ANON),
 		global_node_page_state(NR_INACTIVE_ANON),
 		global_node_page_state(NR_ISOLATED_ANON),
@@ -4845,9 +5092,17 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 		global_node_page_state(NR_SHMEM),
 		global_zone_page_state(NR_PAGETABLE),
 		global_zone_page_state(NR_BOUNCE),
+#ifdef CONFIG_DEFRAG_HELPER
+		global_zone_page_state(NR_FREE_DEFRAG_POOL),
+#endif
 		global_zone_page_state(NR_FREE_PAGES),
 		free_pcp,
+#ifdef CONFIG_SMART_BOOST
+		global_zone_page_state(NR_FREE_CMA_PAGES),
+		global_zone_page_state(NR_ZONE_UID_LRU));
+#else
 		global_zone_page_state(NR_FREE_CMA_PAGES));
+#endif
 
 	for_each_online_pgdat(pgdat) {
 		if (show_mem_node_skip(filter, pgdat->node_id, nodemask))
@@ -4929,7 +5184,13 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 			" bounce:%lukB"
 			" free_pcp:%lukB"
 			" local_pcp:%ukB"
+#ifdef CONFIG_DEFRAG_HELPER
+			" defrag:%lukB"
+#endif
 			" free_cma:%lukB"
+#ifdef CONFIG_SMART_BOOST
+			" ramboost:%lukB"
+#endif
 			"\n",
 			zone->name,
 			K(zone_page_state(zone, NR_FREE_PAGES)),
@@ -4950,7 +5211,15 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 			K(zone_page_state(zone, NR_BOUNCE)),
 			K(free_pcp),
 			K(this_cpu_read(zone->pageset->pcp.count)),
+#ifdef CONFIG_DEFRAG_HELPER
+			K(zone_page_state(zone, NR_FREE_DEFRAG_POOL)),
+#endif
+#ifdef CONFIG_SMART_BOOST
+			K(zone_page_state(zone, NR_FREE_CMA_PAGES)),
+			K(zone_page_state(zone, NR_ZONE_UID_LRU)));
+#else
 			K(zone_page_state(zone, NR_FREE_CMA_PAGES)));
+#endif
 		printk("lowmem_reserve[]:");
 		for (i = 0; i < MAX_NR_ZONES; i++)
 			printk(KERN_CONT " %ld", zone->lowmem_reserve[i]);
@@ -4961,7 +5230,9 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 		unsigned int order;
 		unsigned long nr[MAX_ORDER], flags, total = 0;
 		unsigned char types[MAX_ORDER];
-
+#ifdef CONFIG_DEFRAG_HELPER
+		unsigned long nr_defrag[MAX_ORDER], total_defrag = 0;
+#endif
 		if (show_mem_node_skip(filter, zone_to_nid(zone), nodemask))
 			continue;
 		show_node(zone);
@@ -4974,6 +5245,10 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 
 			nr[order] = area->nr_free;
 			total += nr[order] << order;
+#ifdef CONFIG_DEFRAG_HELPER
+			nr_defrag[order] = area->nr_free_defrag;
+			total_defrag += nr_defrag[order] << order;
+#endif
 
 			types[order] = 0;
 			for (type = 0; type < MIGRATE_TYPES; type++) {
@@ -4989,6 +5264,14 @@ void show_free_areas(unsigned int filter, nodemask_t *nodemask)
 				show_migration_types(types[order]);
 		}
 		printk(KERN_CONT "= %lukB\n", K(total));
+#ifdef CONFIG_DEFRAG_HELPER
+		printk(KERN_CONT "DEFRAG: ");
+		for (order = 0; order < MAX_ORDER; order++) {
+			printk(KERN_CONT "%lu*%lukB ",
+			       nr_defrag[order], K(1UL) << order);
+		}
+		printk(KERN_CONT "= %lukB\n", K(total_defrag));
+#endif
 	}
 
 	hugetlb_show_meminfo();
@@ -5412,6 +5695,7 @@ void __ref build_all_zonelists(pg_data_t *pgdat)
  * up by free_all_bootmem() once the early boot process is
  * done. Non-atomic initialization, single-pass.
  */
+#define DEFRAG_POOL_SIZE (128 * pageblock_nr_pages)
 void __meminit memmap_init_zone(unsigned long size, int nid, unsigned long zone,
 		unsigned long start_pfn, enum memmap_context context)
 {
@@ -5420,6 +5704,9 @@ void __meminit memmap_init_zone(unsigned long size, int nid, unsigned long zone,
 	pg_data_t *pgdat = NODE_DATA(nid);
 	unsigned long pfn;
 	unsigned long nr_initialised = 0;
+#ifdef CONFIG_DEFRAG_HELPER
+	unsigned long unmov_end_pfn = 0;
+#endif
 #ifdef CONFIG_HAVE_MEMBLOCK_NODE_MAP
 	struct memblock_region *r = NULL, *tmp;
 #endif
@@ -5427,6 +5714,10 @@ void __meminit memmap_init_zone(unsigned long size, int nid, unsigned long zone,
 	if (highest_memmap_pfn < end_pfn - 1)
 		highest_memmap_pfn = end_pfn - 1;
 
+#ifdef CONFIG_DEFRAG_HELPER
+	if (nid == 0)
+		unmov_end_pfn = start_pfn + (size >> 2);
+#endif
 	/*
 	 * Honor reservation requested by the driver for this ZONE_DEVICE
 	 * memory
@@ -5488,8 +5779,27 @@ void __meminit memmap_init_zone(unsigned long size, int nid, unsigned long zone,
 			struct page *page = pfn_to_page(pfn);
 
 			__init_single_page(page, pfn, zone, nid);
+#ifndef CONFIG_DEFRAG_HELPER
 			set_pageblock_migratetype(page, MIGRATE_MOVABLE);
+#else
+			if (zone != ZONE_MOVABLE) {
+				if (unmov_end_pfn && pfn < unmov_end_pfn)
+					set_pageblock_migratetype(page,
+								MIGRATE_UNMOVABLE);
+				else {
+					if (unmov_end_pfn && pfn <
+						(unmov_end_pfn + DEFRAG_POOL_SIZE))
+						set_pageblock_migratetype(page,
+							MIGRATE_UNMOVABLE_DEFRAG_POOL);
+					else
+						set_pageblock_migratetype(page,
+								MIGRATE_MOVABLE);
+				}
+			} else
+				set_pageblock_migratetype(page, MIGRATE_MOVABLE);
+#endif
 			cond_resched();
+
 		} else {
 			__init_single_pfn(pfn, zone, nid);
 		}
@@ -5502,6 +5812,9 @@ static void __meminit zone_init_free_lists(struct zone *zone)
 	for_each_migratetype_order(order, t) {
 		INIT_LIST_HEAD(&zone->free_area[order].free_list[t]);
 		zone->free_area[order].nr_free = 0;
+#ifdef CONFIG_DEFRAG_HELPER
+		zone->free_area[order].nr_free_defrag = 0;
+#endif
 	}
 }
 
@@ -7893,6 +8206,10 @@ __offline_isolated_pages(unsigned long start_pfn, unsigned long end_pfn)
 		list_del(&page->lru);
 		rmv_page_order(page);
 		zone->free_area[order].nr_free--;
+#ifdef CONFIG_DEFRAG_HELPER
+		if (is_migrate_defrag(get_pageblock_migratetype(page)))
+			zone->free_area[order].nr_free_defrag--;
+#endif
 		for (i = 0; i < (1 << order); i++)
 			SetPageReserved((page+i));
 		post_alloc_hook(page, order, GFP_NOWAIT);
diff --git a/mm/page_isolation.c b/mm/page_isolation.c
index 44f213935bf68722eb85271520faa6b7581ed3c6..72ff7936944b963ea4cff775a71b6e4fed743a1e 100644
--- a/mm/page_isolation.c
+++ b/mm/page_isolation.c
@@ -69,7 +69,11 @@ static int set_migratetype_isolate(struct page *page,
 		set_pageblock_migratetype(page, MIGRATE_ISOLATE);
 		zone->nr_isolate_pageblock++;
 		nr_pages = move_freepages_block(zone, page, MIGRATE_ISOLATE,
+#ifndef CONFIG_DEFRAG_HELPER
 									NULL);
+#else
+							NULL, migratetype);
+#endif
 
 		__mod_zone_freepage_state(zone, -nr_pages, migratetype);
 	}
@@ -123,7 +127,12 @@ static void unset_migratetype_isolate(struct page *page, unsigned migratetype)
 	 * pageblock scanning for freepage moving.
 	 */
 	if (!isolated_page) {
+#ifndef CONFIG_DEFRAG_HELPER
 		nr_pages = move_freepages_block(zone, page, migratetype, NULL);
+#else
+		nr_pages = move_freepages_block(zone, page, migratetype, NULL,
+							MIGRATE_ISOLATE);
+#endif
 		__mod_zone_freepage_state(zone, nr_pages, migratetype);
 	}
 	set_pageblock_migratetype(page, migratetype);
diff --git a/mm/page_poison.c b/mm/page_poison.c
index 6d3c7418fbd1f4a69b93509db52cf22f8611fc59..8da35a204a368a7f43ae2d8ac6e47caea48d81f8 100644
--- a/mm/page_poison.c
+++ b/mm/page_poison.c
@@ -82,6 +82,7 @@ static void check_poison_mem(struct page *page,
 		pr_err("pagealloc: memory corruption on page with phys start 0x%lx\n",
 			(unsigned long)page_to_phys(page));
 
+	pr_err("virt: %p, phys: 0x%llx\n", start, virt_to_phys(start));
 	print_hex_dump(KERN_ERR, "", DUMP_PREFIX_ADDRESS, 16, 1, start,
 			end - start + 1, 1);
 	BUG_ON(PANIC_CORRUPTION);
diff --git a/mm/shmem.c b/mm/shmem.c
index 1aed230562234b8a6aaca161e55c89d3b892aef0..8c8af1440184c05b792b2fa3805aeabf5f6ac3e0 100644
--- a/mm/shmem.c
+++ b/mm/shmem.c
@@ -1317,8 +1317,11 @@ static int shmem_writepage(struct page *page, struct writeback_control *wbc)
 		flush_dcache_page(page);
 		SetPageUptodate(page);
 	}
-
+#ifdef CONFIG_MEMPLUS
+	swap = get_swap_page(page, FAST_BDV);
+#else
 	swap = get_swap_page(page);
+#endif
 	if (!swap.val)
 		goto redirty;
 
diff --git a/mm/swap.c b/mm/swap.c
index 274981cf0652fec43927e9a029010b2ec346efa6..762740fff77be420f5b5d7682e684d0732e4a261 100644
--- a/mm/swap.c
+++ b/mm/swap.c
@@ -66,7 +66,12 @@ static void __page_cache_release(struct page *page)
 		lruvec = mem_cgroup_page_lruvec(page, zone->zone_pgdat);
 		VM_BUG_ON_PAGE(!PageLRU(page), page);
 		__ClearPageLRU(page);
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, page_off_lru(page),
+						PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, page_off_lru(page));
+#endif
 		spin_unlock_irqrestore(zone_lru_lock(zone), flags);
 	}
 	__ClearPageWaiters(page);
@@ -220,7 +225,12 @@ static void pagevec_move_tail_fn(struct page *page, struct lruvec *lruvec,
 	int *pgmoved = arg;
 
 	if (PageLRU(page) && !PageUnevictable(page)) {
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, page_lru(page),
+						PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, page_lru(page));
+#endif
 		ClearPageActive(page);
 		add_page_to_lru_list_tail(page, lruvec, page_lru(page));
 		(*pgmoved)++;
@@ -276,8 +286,12 @@ static void __activate_page(struct page *page, struct lruvec *lruvec,
 	if (PageLRU(page) && !PageActive(page) && !PageUnevictable(page)) {
 		int file = page_is_file_cache(page);
 		int lru = page_lru_base_type(page);
-
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, lru,
+						PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec, lru);
+#endif
 		SetPageActive(page);
 		lru += LRU_ACTIVE;
 		add_page_to_lru_list(page, lruvec, lru);
@@ -400,6 +414,16 @@ void mark_page_accessed(struct page *page)
 }
 EXPORT_SYMBOL(mark_page_accessed);
 
+#ifdef CONFIG_SMART_BOOST
+static void __uid_lru_cache_add(struct page *page)
+{
+	struct pglist_data *pagepgdat = page_pgdat(page);
+	struct lruvec *lruvec;
+
+	lruvec = mem_cgroup_page_lruvec(page, pagepgdat);
+	_uid_lru_add_fn(page, lruvec);
+}
+#endif
 static void __lru_cache_add(struct page *page)
 {
 	struct pagevec *pvec = &get_cpu_var(lru_add_pvec);
@@ -410,6 +434,14 @@ static void __lru_cache_add(struct page *page)
 	put_cpu_var(lru_add_pvec);
 }
 
+#ifdef CONFIG_MEMPLUS
+void lru_cache_add_active_anon(struct page *page)
+{
+	SetPageActive(page);
+	__lru_cache_add(page);
+}
+#endif
+
 /**
  * lru_cache_add: add a page to the page lists
  * @page: the page to add
@@ -428,7 +460,14 @@ void lru_cache_add_file(struct page *page)
 	__lru_cache_add(page);
 }
 EXPORT_SYMBOL(lru_cache_add_file);
-
+#ifdef CONFIG_SMART_BOOST
+void uid_lru_cache_add(struct page *page)
+{
+	VM_BUG_ON_PAGE(PageActive(page) && PageUnevictable(page), page);
+	VM_BUG_ON_PAGE(PageLRU(page), page);
+	__uid_lru_cache_add(page);
+}
+#endif
 /**
  * lru_cache_add - add a page to a page list
  * @page: the page to be added to the LRU.
@@ -543,8 +582,12 @@ static void lru_deactivate_file_fn(struct page *page, struct lruvec *lruvec,
 	active = PageActive(page);
 	file = page_is_file_cache(page);
 	lru = page_lru_base_type(page);
-
+#ifdef CONFIG_SMART_BOOST
+	del_page_from_lru_list(page, lruvec, lru + active,
+					PageUIDLRU(page) ? true:false);
+#else
 	del_page_from_lru_list(page, lruvec, lru + active);
+#endif
 	ClearPageActive(page);
 	ClearPageReferenced(page);
 	add_page_to_lru_list(page, lruvec, lru);
@@ -577,9 +620,14 @@ static void lru_lazyfree_fn(struct page *page, struct lruvec *lruvec,
 	if (PageLRU(page) && PageAnon(page) && PageSwapBacked(page) &&
 	    !PageSwapCache(page) && !PageUnevictable(page)) {
 		bool active = PageActive(page);
-
+#ifdef CONFIG_SMART_BOOST
+		del_page_from_lru_list(page, lruvec, LRU_INACTIVE_ANON + active,
+					PageUIDLRU(page) ? true:false);
+#else
 		del_page_from_lru_list(page, lruvec,
-				       LRU_INACTIVE_ANON + active);
+				LRU_INACTIVE_ANON + active);
+#endif
+
 		ClearPageActive(page);
 		ClearPageReferenced(page);
 		/*
@@ -804,7 +852,12 @@ void release_pages(struct page **pages, int nr, bool cold)
 			lruvec = mem_cgroup_page_lruvec(page, locked_pgdat);
 			VM_BUG_ON_PAGE(!PageLRU(page), page);
 			__ClearPageLRU(page);
+#ifdef CONFIG_SMART_BOOST
+			del_page_from_lru_list(page, lruvec, page_off_lru(page),
+						PageUIDLRU(page) ? true:false);
+#else
 			del_page_from_lru_list(page, lruvec, page_off_lru(page));
+#endif
 		}
 
 		/* Clear Active bit in case of parallel mark_page_accessed */
@@ -879,7 +932,36 @@ void lru_add_page_tail(struct page *page, struct page *page_tail,
 		update_page_reclaim_stat(lruvec, file, PageActive(page_tail));
 }
 #endif /* CONFIG_TRANSPARENT_HUGEPAGE */
+#ifdef CONFIG_SMART_BOOST
+void _uid_lru_add_fn(struct page *page, struct lruvec *lruvec)
+{
+	struct uid_node *uid_nd;
+	unsigned long flag;
+	struct pglist_data *pgdat = lruvec_pgdat(lruvec);
+	uid_t uid = __task_cred(current)->user->uid.val;
 
+	if (!pgdat)
+		pgdat = page_pgdat(page);
+
+	get_page(page);
+	spin_lock_irqsave(&pgdat->lru_lock, flag);
+	VM_BUG_ON_PAGE(PageLRU(page), page);
+	VM_BUG_ON_PAGE(PageUIDLRU(page), page);
+	SetPageLRU(page);
+	SetPageUIDLRU(page);
+	uid_nd = find_uid_node(uid, lruvec);
+	if (uid_nd == NULL) {
+		if (lruvec->uid_hash == NULL)
+			lruvec->uid_hash = alloc_uid_hash_table();
+		uid_nd = insert_uid_node(lruvec->uid_hash, uid);
+	}
+	list_add(&page->lru, &uid_nd->page_cache_list);
+	mod_zone_page_state(page_zone(page), NR_ZONE_UID_LRU,
+					hpage_nr_pages(page));
+	spin_unlock_irqrestore(&pgdat->lru_lock, flag);
+	put_page(page);
+}
+#endif
 static void __pagevec_lru_add_fn(struct page *page, struct lruvec *lruvec,
 				 void *arg)
 {
diff --git a/mm/swap_slots.c b/mm/swap_slots.c
index f778aa38127ed6532870e970edaaa19f029fdedf..337dba43f71fbc6ede864a4668eca29b61cd9b80 100644
--- a/mm/swap_slots.c
+++ b/mm/swap_slots.c
@@ -264,8 +264,13 @@ static int refill_swap_slots_cache(struct swap_slots_cache *cache)
 
 	cache->cur = 0;
 	if (swap_slot_cache_active)
+#ifdef CONFIG_MEMPLUS
+		cache->nr = get_swap_pages(SWAP_SLOTS_CACHE_SIZE, false,
+					   cache->slots, SLOW_BDV);
+#else
 		cache->nr = get_swap_pages(SWAP_SLOTS_CACHE_SIZE, false,
 					   cache->slots);
+#endif
 
 	return cache->nr;
 }
@@ -304,8 +309,11 @@ int free_swap_slot(swp_entry_t entry)
 
 	return 0;
 }
-
+#ifdef CONFIG_MEMPLUS
+swp_entry_t get_swap_page(struct page *page, unsigned long swap_bdv)
+#else
 swp_entry_t get_swap_page(struct page *page)
+#endif
 {
 	swp_entry_t entry, *pentry;
 	struct swap_slots_cache *cache;
@@ -314,7 +322,11 @@ swp_entry_t get_swap_page(struct page *page)
 
 	if (PageTransHuge(page)) {
 		if (IS_ENABLED(CONFIG_THP_SWAP))
+#ifdef CONFIG_MEMPLUS
+			get_swap_pages(1, true, &entry, swap_bdv);
+#else
 			get_swap_pages(1, true, &entry);
+#endif
 		return entry;
 	}
 
@@ -347,8 +359,11 @@ swp_entry_t get_swap_page(struct page *page)
 		if (entry.val)
 			return entry;
 	}
-
+#ifdef CONFIG_MEMPLUS
+	get_swap_pages(1, false, &entry, swap_bdv);
+#else
 	get_swap_pages(1, false, &entry);
+#endif
 
 	return entry;
 }
diff --git a/mm/swap_state.c b/mm/swap_state.c
index 6b2fa4835719795a49475faf497c61739b48266b..cc3a7f0a7266dfb928b895cff0125da062b71d52 100644
--- a/mm/swap_state.c
+++ b/mm/swap_state.c
@@ -23,6 +23,10 @@
 #include <linux/huge_mm.h>
 
 #include <asm/pgtable.h>
+#ifdef CONFIG_MEMPLUS
+#include <linux/mm_inline.h>
+#endif
+
 
 /*
  * swapper_space is a fiction, retained to simplify the path through
@@ -204,15 +208,22 @@ void __delete_from_swap_cache(struct page *page)
  * Allocate swap space for the page and add the page to the
  * swap cache.  Caller needs to hold the page lock. 
  */
+#ifdef CONFIG_MEMPLUS
+int add_to_swap(struct page *page, unsigned long swap_bdv)
+#else
 int add_to_swap(struct page *page)
+#endif
 {
 	swp_entry_t entry;
 	int err;
 
 	VM_BUG_ON_PAGE(!PageLocked(page), page);
 	VM_BUG_ON_PAGE(!PageUptodate(page), page);
-
+#ifdef CONFIG_MEMPLUS
+	entry = get_swap_page(page, swap_bdv);
+#else
 	entry = get_swap_page(page);
+#endif
 	if (!entry.val)
 		return 0;
 
@@ -250,6 +261,9 @@ int add_to_swap(struct page *page)
 	 * the problem.
 	 */
 	set_page_dirty(page);
+#ifdef CONFIG_MEMPLUS
+	count_vm_event(PGADDTOSWAP);
+#endif
 
 	return 1;
 
@@ -446,6 +460,11 @@ struct page *__read_swap_cache_async(swp_entry_t entry, gfp_t gfp_mask,
 			/*
 			 * Initiate read into locked page and return.
 			 */
+#ifdef CONFIG_MEMPLUS
+			if (memplus_enabled())
+				lru_cache_add_active_anon(new_page);
+			else
+#endif
 			lru_cache_add_anon(new_page);
 			*new_page_allocated = true;
 			return new_page;
diff --git a/mm/swapfile.c b/mm/swapfile.c
index 31d13e19b3468007a0b28e4ee3b40ceef6dfc47d..2d26679cdf30acb9618e9fee73d10ca74c209280 100644
--- a/mm/swapfile.c
+++ b/mm/swapfile.c
@@ -923,8 +923,11 @@ static unsigned long scan_swap_map(struct swap_info_struct *si,
 		return 0;
 
 }
-
+#ifdef CONFIG_MEMPLUS
+int get_swap_pages(int n_goal, bool cluster, swp_entry_t swp_entries[], unsigned long swap_bdv)
+#else
 int get_swap_pages(int n_goal, bool cluster, swp_entry_t swp_entries[])
+#endif
 {
 	unsigned long nr_pages = cluster ? SWAPFILE_CLUSTER : 1;
 	struct swap_info_struct *si, *next;
@@ -977,6 +980,13 @@ int get_swap_pages(int n_goal, bool cluster, swp_entry_t swp_entries[])
 		spin_unlock(&swap_avail_lock);
 start:
 		spin_lock(&si->lock);
+#ifdef CONFIG_MEMPLUS
+		if (swap_bdv ^ (si->flags & SWP_SYNCHRONOUS_IO)) {
+			spin_lock(&swap_avail_lock);
+			spin_unlock(&si->lock);
+			goto nextsi;
+		}
+#endif
 		if (!si->highest_bit || !(si->flags & SWP_WRITEOK)) {
 			spin_lock(&swap_avail_lock);
 			if (plist_node_empty(&si->avail_lists[node])) {
@@ -1215,6 +1225,53 @@ static void swapcache_free(swp_entry_t entry)
 			free_swap_slot(entry);
 	}
 }
+#ifdef CONFIG_MEMPLUS
+bool is_fast_entry(swp_entry_t entry)
+{
+	struct swap_info_struct *p;
+	bool ret = false;
+	
+	p = swap_info_get(entry);
+	if (p) {
+		if (p->flags & SWP_SYNCHRONOUS_IO)
+			ret = true;
+		spin_unlock(&p->lock);
+	}
+	return ret;
+}
+bool enough_swap_size(unsigned long req_size, int swap_bdv)
+{
+	bool ret = false;
+	unsigned int n = 0;
+	unsigned int type;
+
+	if (swap_bdv > 1)
+		return ret;
+
+	spin_lock(&swap_lock);
+	for (type = 0; type < nr_swapfiles; type++) {
+		struct swap_info_struct *sis = swap_info[type];
+		int fast_i = (sis->flags & SWP_SYNCHRONOUS_IO)? 1:0;
+
+		if (fast_i == swap_bdv) {
+			spin_lock(&sis->lock);
+			if (sis->flags & SWP_WRITEOK) {
+				n += sis->pages - sis->inuse_pages;
+				if (n > req_size) {
+					ret = true;
+					spin_unlock(&sis->lock);
+					goto unlock;
+				}
+			}
+			spin_unlock(&sis->lock);
+		}
+	}
+
+unlock:
+	spin_unlock(&swap_lock);
+	return ret;
+}
+#endif /* CONFIG_MEMPLUS */
 
 #ifdef CONFIG_THP_SWAP
 static void swapcache_free_cluster(swp_entry_t entry)
diff --git a/mm/truncate.c b/mm/truncate.c
index 2330223841fbbdf40c4e50764a11a557d9c7b426..e7d45f3f76b815b86252f5999b39e387a196bd4e 100644
--- a/mm/truncate.c
+++ b/mm/truncate.c
@@ -560,6 +560,80 @@ unsigned long invalidate_mapping_pages(struct address_space *mapping,
 }
 EXPORT_SYMBOL(invalidate_mapping_pages);
 
+#ifdef CONFIG_SMART_BOOST
+unsigned long invalidate_mapping_pages_without_uidlru(
+		struct address_space *mapping,
+		pgoff_t start, pgoff_t end)
+{
+	pgoff_t indices[PAGEVEC_SIZE];
+	struct pagevec pvec;
+	pgoff_t index = start;
+	unsigned long ret;
+	unsigned long count = 0;
+	int i;
+
+	pagevec_init(&pvec, 0);
+	while (index <= end && pagevec_lookup_entries(&pvec, mapping, index,
+			min(end - index, (pgoff_t)PAGEVEC_SIZE - 1) + 1,
+			indices)) {
+		for (i = 0; i < pagevec_count(&pvec); i++) {
+			struct page *page = pvec.pages[i];
+
+			/* We rely upon deletion not changing page->index */
+			index = indices[i];
+			if (index > end)
+				break;
+
+			if (radix_tree_exceptional_entry(page)) {
+				invalidate_exceptional_entry(mapping, index,
+							     page);
+				continue;
+			}
+
+			if (PageUIDLRU(page))
+				continue;
+			if (!trylock_page(page))
+				continue;
+
+			WARN_ON(page_to_index(page) != index);
+
+			/* Middle of THP: skip */
+			if (PageTransTail(page)) {
+				unlock_page(page);
+				continue;
+			} else if (PageTransHuge(page)) {
+				index += HPAGE_PMD_NR - 1;
+				i += HPAGE_PMD_NR - 1;
+				/*
+				 * 'end' is in the middle of THP. Don't
+				 * invalidate the page as the part outside of
+				 * 'end' could be still useful.
+				 */
+				if (index > end) {
+					unlock_page(page);
+					continue;
+				}
+			}
+
+			ret = invalidate_inode_page(page);
+			unlock_page(page);
+			/*
+			 * Invalidation is a hint that the page is no longer
+			 * of interest and try to speed up its reclaim.
+			 */
+			if (!ret)
+				deactivate_file_page(page);
+			count += ret;
+		}
+		pagevec_remove_exceptionals(&pvec);
+		pagevec_release(&pvec);
+		cond_resched();
+		index++;
+	}
+	return count;
+}
+EXPORT_SYMBOL(invalidate_mapping_pages_without_uidlru);
+#endif
 /*
  * This is like invalidate_complete_page(), except it ignores the page's
  * refcount.  We do this because invalidate_inode_pages2() needs stronger
diff --git a/mm/vmpressure.c b/mm/vmpressure.c
index 679fe3020b77db8c1d94147138510c8b3e25c22c..fb5c5764eff268c07e682d33c5e1d49f723b4284 100644
--- a/mm/vmpressure.c
+++ b/mm/vmpressure.c
@@ -51,7 +51,9 @@ static unsigned long vmpressure_win = SWAP_CLUSTER_MAX * 16;
  */
 static const unsigned int vmpressure_level_med = 60;
 static const unsigned int vmpressure_level_critical = 95;
-
+#ifdef CONFIG_SMART_BOOST
+atomic_t vmpress[5];
+#endif
 static unsigned long vmpressure_scale_max = 100;
 module_param_named(vmpressure_scale_max, vmpressure_scale_max,
 			ulong, 0644);
@@ -414,6 +416,18 @@ static void vmpressure_global(gfp_t gfp, unsigned long scanned,
 
 	pressure = vmpressure_calc_pressure(scanned, reclaimed);
 	pressure = vmpressure_account_stall(pressure, stall, scanned);
+#ifdef CONFIG_SMART_BOOST
+	if (pressure < 20)
+		atomic_inc(&vmpress[0]);
+	else if (pressure < 40)
+		atomic_inc(&vmpress[1]);
+	else if (pressure < 60)
+		atomic_inc(&vmpress[2]);
+	else if (pressure < 80)
+		atomic_inc(&vmpress[3]);
+	else
+		atomic_inc(&vmpress[4]);
+#endif
 	vmpressure_notify(pressure);
 }
 
diff --git a/mm/vmscan.c b/mm/vmscan.c
index 4cc4d0560330b59d90505b3988813273fda62765..1a3b3c748920b582bb23443eaa004841669cff1e 100644
--- a/mm/vmscan.c
+++ b/mm/vmscan.c
@@ -16,6 +16,7 @@
 
 #include <linux/mm.h>
 #include <linux/sched/mm.h>
+#include <linux/sched/debug.h>
 #include <linux/module.h>
 #include <linux/gfp.h>
 #include <linux/kernel_stat.h>
@@ -61,6 +62,12 @@
 #define CREATE_TRACE_POINTS
 #include <trace/events/vmscan.h>
 
+#ifdef CONFIG_SMART_BOOST
+int sysctl_page_cache_reside_switch;
+int sysctl_page_cache_reside_max = 153600; //600M
+unsigned long inactive_nr, active_nr;
+unsigned long priority_nr[3];
+#endif
 struct scan_control {
 	/* How many pages shrink_list() should reclaim */
 	unsigned long nr_to_reclaim;
@@ -111,6 +118,11 @@ struct scan_control {
 	/* One of the zones is ready for compaction */
 	unsigned int compaction_ready:1;
 
+#ifdef CONFIG_MEMPLUS
+	/* 1: swap to zram, 0: swap to file */
+	unsigned int swp_bdv_type:1;
+#endif
+
 	/* Incremented by the number of inactive pages that were scanned */
 	unsigned long nr_scanned;
 
@@ -157,6 +169,14 @@ struct scan_control {
  * From 0 .. 100.  Higher means more swappy.
  */
 int vm_swappiness = 60;
+/*
+ * time for kswapd to breath between each scanning loop
+ */
+unsigned int vm_breath_period __read_mostly = 4000;
+/*
+ * default adj for kswapd to perform lazy-reclaim
+ */
+int vm_breath_priority __read_mostly = 500;
 /*
  * The total number of pages which are beyond the high watermark within all
  * zones.
@@ -166,6 +186,205 @@ unsigned long vm_total_pages;
 static LIST_HEAD(shrinker_list);
 static DECLARE_RWSEM(shrinker_rwsem);
 
+#ifdef CONFIG_SMART_BOOST
+static LIST_HEAD(hotcount_prio_list);
+static DEFINE_RWLOCK(prio_list_lock);
+
+struct hotcount_prio_node {
+	unsigned int hotcount;
+	uid_t uid;
+	struct list_head list;
+};
+
+static unsigned int find_node_uid_prio(struct hotcount_prio_node **node,
+		struct list_head **prio_pos,
+		uid_t uid,
+		unsigned int hotcount)
+{
+	struct hotcount_prio_node *pos;
+	unsigned int ret_hotcount = 0;
+
+	read_lock(&prio_list_lock);
+	list_for_each_entry(pos, &hotcount_prio_list, list) {
+
+		if (*node && *prio_pos)
+			break;
+
+		if (pos->uid == uid) {
+			*node = pos;
+			ret_hotcount = pos->hotcount;
+		}
+		if ((!(*prio_pos)) &&
+			(pos->hotcount > hotcount))
+			*prio_pos = &pos->list;
+	}
+
+	if (!(*prio_pos))
+		*prio_pos = &hotcount_prio_list;
+
+	read_unlock(&prio_list_lock);
+
+	return ret_hotcount;
+}
+
+void insert_prio_node(unsigned int new_hotcount, uid_t uid)
+{
+	struct hotcount_prio_node *node = NULL;
+	struct list_head *prio_pos = NULL;
+	unsigned int old_hotcount;
+
+	old_hotcount = find_node_uid_prio(&node, &prio_pos, uid, new_hotcount);
+
+	if (node) {
+		if (old_hotcount == new_hotcount)
+			return;
+
+		write_lock(&prio_list_lock);
+
+		if (&node->list == prio_pos) {
+			node->hotcount = new_hotcount;
+			goto unlock;
+		}
+		list_del(&node->list);
+	} else {
+		node = (struct hotcount_prio_node *)
+			kmalloc(sizeof(struct hotcount_prio_node), GFP_KERNEL);
+		if (!node) {
+			pr_err("no memory to insert prio_node!\n");
+			return;
+		}
+		node->uid = uid;
+		write_lock(&prio_list_lock);
+	}
+
+	node->hotcount = new_hotcount;
+	list_add_tail(&node->list, prio_pos);
+unlock:
+	write_unlock(&prio_list_lock);
+}
+EXPORT_SYMBOL(insert_prio_node);
+
+void delete_prio_node(uid_t uid)
+{
+	struct hotcount_prio_node *pos;
+	int found = 0;
+
+	read_lock(&prio_list_lock);
+	list_for_each_entry(pos, &hotcount_prio_list, list)
+		if (pos->uid == uid) {
+			found = 1;
+			break;
+		}
+	read_unlock(&prio_list_lock);
+
+	if (found) {
+		write_lock(&prio_list_lock);
+		list_del(&pos->list);
+		write_unlock(&prio_list_lock);
+		kfree(pos);
+	}
+}
+EXPORT_SYMBOL(delete_prio_node);
+
+void print_prio_chain(struct seq_file *m)
+{
+	struct hotcount_prio_node *pos;
+
+	read_lock(&prio_list_lock);
+	list_for_each_entry(pos, &hotcount_prio_list, list)
+		seq_printf(m, "%d(%d)\t", pos->uid, pos->hotcount);
+	read_unlock(&prio_list_lock);
+
+	seq_putc(m, '\n');
+}
+EXPORT_SYMBOL(print_prio_chain);
+
+#define UID_HASH_ORDER 5
+#define uid_hashfn(nr)	hash_long((unsigned long)nr, UID_HASH_ORDER)
+
+struct uid_node **alloc_uid_hash_table(void)
+{
+	struct uid_node **hash_table;
+	int size = (1 << UID_HASH_ORDER) * sizeof(struct uid_node *);
+
+	if (size <= PAGE_SIZE)
+		hash_table = kzalloc(size, GFP_ATOMIC);
+	else
+		hash_table = (struct uid_node **)__get_free_pages(
+				GFP_ATOMIC | __GFP_ZERO, get_order(size));
+	if (!hash_table)
+		return NULL;
+	return hash_table;
+}
+
+struct uid_node *alloc_uid_node(uid_t uid)
+{
+	struct uid_node *uid_nd;
+
+	uid_nd = kzalloc(sizeof(struct uid_node), GFP_ATOMIC);
+	if (!uid_nd)
+		return NULL;
+	uid_nd->uid = uid;
+	uid_nd->hot_count = 0; /* initialize a new UID's count */
+	uid_nd->next = NULL;
+	INIT_LIST_HEAD(&uid_nd->page_cache_list);
+	return uid_nd;
+}
+
+struct uid_node *insert_uid_node(struct uid_node **hash_table, uid_t uid)
+{
+	struct uid_node *puid;
+	unsigned int index, sise = 1 << UID_HASH_ORDER;
+
+	index = uid_hashfn((unsigned long)uid);
+	if (index >= sise)
+		return NULL;
+	puid = alloc_uid_node(uid);
+
+	if (!puid)
+		return NULL;
+
+	rcu_assign_pointer(puid->next, hash_table[index]);
+	rcu_assign_pointer(hash_table[index], puid);
+	return puid;
+}
+
+struct uid_node *find_uid_node(uid_t uid, struct lruvec *lruvec)
+{
+	struct uid_node *uid_nd, *ret = NULL;
+	unsigned int index;
+
+	index = uid_hashfn((unsigned int)uid);
+
+	if (lruvec->uid_hash == NULL)
+		return NULL;
+	if (index >= (1 << UID_HASH_ORDER))
+		return NULL;
+	for (uid_nd = rcu_dereference(lruvec->uid_hash[index]);
+		uid_nd != NULL; uid_nd = rcu_dereference(uid_nd->next)) {
+		if (uid_nd->uid == uid) {
+			ret = uid_nd;
+			break;
+		}
+	}
+	return ret;
+}
+
+void free_hash_table(struct lruvec *lruvec)
+{
+	int i, table_num;
+	struct uid_node *puid, **np;
+
+	table_num = 1 << UID_HASH_ORDER;
+	for (i = 0; i < table_num; i++) {
+		np = &lruvec->uid_hash[i];
+		while ((puid = rcu_dereference(*np)) != NULL) {
+			rcu_assign_pointer(*np, rcu_dereference(puid->next));
+			kfree_rcu(puid, rcu);
+		}
+	}
+}
+#endif
 #ifdef CONFIG_MEMCG
 static bool global_reclaim(struct scan_control *sc)
 {
@@ -664,6 +883,10 @@ static pageout_t pageout(struct page *page, struct address_space *mapping,
 			/* synchronous write or broken a_ops? */
 			ClearPageReclaim(page);
 		}
+#ifdef CONFIG_MEMPLUS
+		if (PageSwapCache(page))
+			count_vm_event(PGSWAPWRITE);
+#endif
 		trace_mm_vmscan_writepage(page);
 		inc_node_page_state(page, NR_VMSCAN_WRITE);
 		return PAGE_SUCCESS;
@@ -983,6 +1206,10 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 	unsigned nr_immediate = 0;
 	unsigned nr_ref_keep = 0;
 	unsigned nr_unmap_fail = 0;
+#ifdef CONFIG_MEMPLUS
+	bool memplus_en = memplus_enabled();
+	bool added_to_swap = false;
+#endif
 
 	cond_resched();
 
@@ -1162,7 +1389,12 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 								    page_list))
 						goto activate_locked;
 				}
-				if (!add_to_swap(page)) {
+#ifdef CONFIG_MEMPLUS
+				if (!add_to_swap(page, sc->swp_bdv_type?FAST_BDV:SLOW_BDV))
+#else
+				if (!add_to_swap(page))
+#endif
+				{
 					if (!PageTransHuge(page))
 						goto activate_locked;
 					/* Fallback to swap normal pages */
@@ -1172,11 +1404,18 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 #ifdef CONFIG_TRANSPARENT_HUGEPAGE
 					count_vm_event(THP_SWPOUT_FALLBACK);
 #endif
+#ifdef CONFIG_MEMPLUS
+					if (!add_to_swap(page, sc->swp_bdv_type?FAST_BDV:SLOW_BDV))
+#else
 					if (!add_to_swap(page))
+#endif
 						goto activate_locked;
 				}
 
 				may_enter_fs = 1;
+#ifdef CONFIG_MEMPLUS
+				added_to_swap = true;
+#endif
 
 				/* Adding to swap updated mapping */
 				mapping = page_mapping(page);
@@ -1235,6 +1474,10 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 				goto keep_locked;
 			if (!sc->may_writepage)
 				goto keep_locked;
+#ifdef CONFIG_MEMPLUS
+			if (memplus_en && !added_to_swap && current_is_reclaimd() && !sc->swp_bdv_type)
+				goto keep_locked;
+#endif
 
 			/*
 			 * Page is dirty. Flush the TLB if a writable entry
@@ -1308,6 +1551,10 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 				}
 			}
 		}
+#ifdef CONFIG_MEMPLUS
+		if (!vm_memory_plus_test_worstcase && memplus_en && current_is_reclaimd() && !sc->swp_bdv_type)
+			goto keep_locked;
+#endif
 
 		if (PageAnon(page) && !PageSwapBacked(page)) {
 			/* follow __remove_mapping for reference */
@@ -1389,6 +1636,110 @@ static unsigned long shrink_page_list(struct list_head *page_list,
 	return nr_reclaimed;
 }
 
+#ifdef CONFIG_SMART_BOOST
+static unsigned long isolate_uid_lru_pages(struct page *page)
+{
+	int ret = -EBUSY;
+
+	//VM_BUG_ON_PAGE(!page_count(page), page);
+	WARN_RATELIMIT(PageTail(page), "trying to isolate tail page");
+
+	if (PageLRU(page)) {
+		struct zone *zone = page_zone(page);
+		struct lruvec *lruvec;
+		int lru = page_lru(page);
+
+		if (unlikely(!get_page_unless_zero(page)))
+			return ret;
+
+		if (PageUnevictable(page))
+			return ret;
+
+		lruvec = mem_cgroup_page_lruvec(page, zone->zone_pgdat);
+		ClearPageLRU(page);
+		del_page_from_lru_list(page, lruvec, lru,
+			PageUIDLRU(page) ? true:false);
+		ret = 0;
+	}
+
+	return ret;
+}
+
+unsigned long reclaim_pages_from_uid_list(uid_t uid)
+{
+	LIST_HEAD(page_list);
+	LIST_HEAD(putback_page_list);
+	struct pglist_data *pgdat;
+	struct uid_node *node;
+	struct lruvec *lruvec;
+	unsigned long node_size = 0;
+	struct mem_cgroup *memcg;
+	struct scan_control sc = {
+		.gfp_mask = GFP_KERNEL,
+		.priority = DEF_PRIORITY,
+		.may_writepage = 1,
+		.may_unmap = 1,
+		.may_swap = 1,
+	};
+
+	unsigned long nr_reclaimed = 0, nr_isolate = 0, nr_isolate_failed = 0;
+	struct page *page;
+
+	for_each_online_pgdat(pgdat) {
+		memcg = mem_cgroup_iter(NULL, NULL, NULL);
+		do {
+			lruvec = mem_cgroup_lruvec(pgdat, memcg);
+			if (!lruvec)
+				goto next;
+			spin_lock_irq(&pgdat->lru_lock);
+			node = find_uid_node(uid, lruvec);
+			if (!node) {
+				spin_unlock_irq(&pgdat->lru_lock);
+				goto next;
+			}
+
+			while (!list_empty(&node->page_cache_list)) {
+				page = lru_to_page(&node->page_cache_list);
+				VM_BUG_ON_PAGE(!PageUIDLRU(page), page);
+
+				if (isolate_uid_lru_pages(page)) {
+					list_move(&page->lru,
+						&putback_page_list);
+					nr_isolate_failed++;
+					continue;
+				}
+
+				ClearPageActive(page);
+				list_add(&page->lru, &page_list);
+				nr_isolate++;
+			}
+
+			list_splice_init(&putback_page_list,
+					&node->page_cache_list);
+			spin_unlock_irq(&pgdat->lru_lock);
+
+			nr_reclaimed = shrink_page_list(&page_list, NULL, &sc,
+					TTU_IGNORE_ACCESS, NULL, true);
+
+			pr_err("%s: reclaimed:%lu isolate:%lu isolate_failed:%lu ",
+				__func__, nr_reclaimed,
+				nr_isolate, nr_isolate_failed);
+
+			node_size = 0;
+			while (!list_empty(&page_list)) {
+				page = lru_to_page(&page_list);
+				list_del(&page->lru);
+				node_size++;
+				putback_lru_page(page);
+			}
+next:
+			memcg = mem_cgroup_iter(NULL, memcg, NULL);
+			pr_err("putback:%lu\n", node_size);
+		} while (memcg);
+	}
+	return nr_reclaimed;
+}
+#endif
 unsigned long reclaim_clean_pages_from_list(struct zone *zone,
 					    struct list_head *page_list)
 {
@@ -1417,6 +1768,98 @@ unsigned long reclaim_clean_pages_from_list(struct zone *zone,
 	mod_node_page_state(zone->zone_pgdat, NR_ISOLATED_FILE, -ret);
 	return ret;
 }
+#ifdef CONFIG_MEMPLUS
+unsigned long memplus_reclaim_page_list(struct list_head *page_list,
+					struct scan_control *sc)
+{
+	unsigned long nr_reclaimed;
+	struct page *page;
+
+	list_for_each_entry(page, page_list, lru) {
+		ClearPageActive(page);
+		ClearPageWillneed(page);
+	}
+
+	nr_reclaimed = shrink_page_list(page_list, NULL, sc,
+			TTU_IGNORE_ACCESS, NULL, true);
+
+	while (!list_empty(page_list)) {
+		page = lru_to_page(page_list);
+		list_del(&page->lru);
+		dec_node_page_state(page, NR_ISOLATED_ANON +
+				page_is_file_cache(page));
+		putback_lru_page(page);
+	}
+
+	return nr_reclaimed;
+}
+
+unsigned long swapout_to_zram(struct list_head *page_list,
+					struct vm_area_struct *vma)
+{
+	struct scan_control sc = {
+		.gfp_mask = GFP_KERNEL,
+		.priority = DEF_PRIORITY,
+		.may_writepage = 1,
+		.may_unmap = 1,
+		.may_swap = 1,
+		.target_vma = vma,
+		.swp_bdv_type = 1,
+	};
+
+	return memplus_reclaim_page_list(page_list, &sc);
+}
+
+unsigned long swapout_to_disk(struct list_head *page_list,
+					struct vm_area_struct *vma)
+{
+	struct scan_control sc = {
+		.gfp_mask = GFP_KERNEL,
+		.priority = DEF_PRIORITY,
+		.may_writepage = 1,
+		.may_unmap = 1,
+		.may_swap = 1,
+		.target_vma = vma,
+		.swp_bdv_type = 0,
+	};
+
+	return memplus_reclaim_page_list(page_list, &sc);
+}
+
+unsigned long memplus_reclaim_pages(struct list_head *page_list,
+					struct vm_area_struct *vma)
+{
+	struct scan_control sc = {
+		.gfp_mask = GFP_KERNEL,
+		.priority = DEF_PRIORITY,
+		.may_writepage = 1,
+		.may_unmap = 1,
+		.may_swap = 1,
+		.target_vma = vma,
+	};
+
+	unsigned long nr_reclaimed;
+	struct page *page;
+
+	list_for_each_entry(page, page_list, lru) {
+		ClearPageWillneed(page);
+		ClearPageActive(page);
+	}
+
+	nr_reclaimed = shrink_page_list(page_list, NULL, &sc,
+			TTU_IGNORE_ACCESS, NULL, true);
+
+	while (!list_empty(page_list)) {
+		page = lru_to_page(page_list);
+		list_del(&page->lru);
+		dec_node_page_state(page, NR_ISOLATED_ANON +
+				page_is_file_cache(page));
+		putback_lru_page(page);
+	}
+
+	return nr_reclaimed;
+}
+#endif
 
 #ifdef CONFIG_PROCESS_RECLAIM
 unsigned long reclaim_pages_from_list(struct list_head *page_list,
@@ -1542,8 +1985,11 @@ static __always_inline void update_lru_sizes(struct lruvec *lruvec,
 	for (zid = 0; zid < MAX_NR_ZONES; zid++) {
 		if (!nr_zone_taken[zid])
 			continue;
-
+#ifdef CONFIG_SMART_BOOST
+		__update_lru_size(lruvec, lru, zid, -nr_zone_taken[zid], false);
+#else
 		__update_lru_size(lruvec, lru, zid, -nr_zone_taken[zid]);
+#endif
 #ifdef CONFIG_MEMCG
 		mem_cgroup_update_lru_size(lruvec, lru, zid, -nr_zone_taken[zid]);
 #endif
@@ -1583,6 +2029,9 @@ static unsigned long isolate_lru_pages(unsigned long nr_to_scan,
 	unsigned long skipped = 0;
 	unsigned long scan, total_scan, nr_pages;
 	LIST_HEAD(pages_skipped);
+#ifdef CONFIG_MEMPLUS
+	bool sc_only = memplus_enabled() && (BIT(lru) & LRU_ALL_ANON);
+#endif
 
 	scan = 0;
 	for (total_scan = 0;
@@ -1608,6 +2057,13 @@ static unsigned long isolate_lru_pages(unsigned long nr_to_scan,
 		 * pages, triggering a premature OOM.
 		 */
 		scan++;
+
+#ifdef CONFIG_MEMPLUS
+		if (sc_only && (!PageSwapCache(page) || PageWillneed(page))) {
+			list_move(&page->lru, src);
+			continue;
+		}
+#endif
 		switch (__isolate_lru_page(page, mode)) {
 		case 0:
 			nr_pages = hpage_nr_pages(page);
@@ -1694,7 +2150,12 @@ int isolate_lru_page(struct page *page)
 			int lru = page_lru(page);
 			get_page(page);
 			ClearPageLRU(page);
+#ifdef CONFIG_SMART_BOOST
+			del_page_from_lru_list(page, lruvec, lru,
+					PageUIDLRU(page) ? true:false);
+#else
 			del_page_from_lru_list(page, lruvec, lru);
+#endif
 			ret = 0;
 		}
 		spin_unlock_irq(zone_lru_lock(zone));
@@ -1803,7 +2264,12 @@ putback_inactive_pages(struct lruvec *lruvec, struct list_head *page_list)
 		if (put_page_testzero(page)) {
 			__ClearPageLRU(page);
 			__ClearPageActive(page);
+#ifdef CONFIG_SMART_BOOST
+			del_page_from_lru_list(page, lruvec, lru,
+					PageUIDLRU(page) ? true:false);
+#else
 			del_page_from_lru_list(page, lruvec, lru);
+#endif
 
 			if (unlikely(PageCompound(page))) {
 				spin_unlock_irq(&pgdat->lru_lock);
@@ -1853,6 +2319,9 @@ shrink_inactive_list(unsigned long nr_to_scan, struct lruvec *lruvec,
 	struct zone_reclaim_stat *reclaim_stat = &lruvec->reclaim_stat;
 	bool stalled = false;
 
+#ifdef CONFIG_SMART_BOOST
+	inactive_nr++;
+#endif
 	while (unlikely(too_many_isolated(pgdat, file, sc, stalled))) {
 		if (stalled)
 			return 0;
@@ -2035,14 +2504,23 @@ static unsigned move_active_pages_to_lru(struct lruvec *lruvec,
 		SetPageLRU(page);
 
 		nr_pages = hpage_nr_pages(page);
+#ifdef CONFIG_SMART_BOOST
+		update_lru_size(lruvec, lru, page_zonenum(page), nr_pages,
+						PageUIDLRU(page) ? true:false);
+#else
 		update_lru_size(lruvec, lru, page_zonenum(page), nr_pages);
+#endif
 		list_move(&page->lru, &lruvec->lists[lru]);
 
 		if (put_page_testzero(page)) {
 			__ClearPageLRU(page);
 			__ClearPageActive(page);
+#ifdef CONFIG_SMART_BOOST
+			del_page_from_lru_list(page, lruvec, lru,
+					PageUIDLRU(page) ? true:false);
+#else
 			del_page_from_lru_list(page, lruvec, lru);
-
+#endif
 			if (unlikely(PageCompound(page))) {
 				spin_unlock_irq(&pgdat->lru_lock);
 				mem_cgroup_uncharge(page);
@@ -2064,6 +2542,93 @@ static unsigned move_active_pages_to_lru(struct lruvec *lruvec,
 	return nr_moved;
 }
 
+#ifdef CONFIG_SMART_BOOST
+#define SMART_BOOST_PUTBACK_LRU 2
+extern unsigned long get_max_minfree(void);
+unsigned long uid_lru_size()
+{
+	return global_zone_page_state(NR_ZONE_UID_LRU);
+}
+
+static int active_list_is_low(struct lruvec *lruvec)
+{
+	unsigned long active = global_zone_page_state(NR_ZONE_ACTIVE_FILE);
+	unsigned long inactive = global_zone_page_state(NR_ZONE_INACTIVE_FILE);
+	unsigned long total_uid_lru_nr = uid_lru_size();
+	if ((active + inactive) > get_max_minfree())
+		return ((active + inactive) << 1) < (total_uid_lru_nr >> 2);
+	else	
+		return SMART_BOOST_PUTBACK_LRU;
+}
+
+static void shrink_uid_lru_list(struct lruvec *lruvec,
+				struct pglist_data *pgdat,
+				struct scan_control *sc)
+{
+	LIST_HEAD(putback_list);
+	LIST_HEAD(frees_list);
+	unsigned long nr_reclaimed = 0, nr_isolate_failed = 0;
+	unsigned long uid_size = uid_lru_size();
+	long nr_to_shrink = uid_size >> sc->priority;
+	int putback_lru = active_list_is_low(lruvec);
+	struct hotcount_prio_node *pos;
+	struct page *page;
+
+	if (uid_size <= 0)
+		return;
+
+	if (SMART_BOOST_PUTBACK_LRU == putback_lru)
+		nr_to_shrink = uid_size;
+
+	read_lock(&prio_list_lock);
+	spin_lock_irq(&pgdat->lru_lock);
+	list_for_each_entry(pos, &hotcount_prio_list, list) {
+		struct uid_node *tmp_uid_list = find_uid_node(pos->uid, lruvec);
+
+		if (!nr_to_shrink)
+			break;
+
+		if (tmp_uid_list == NULL)
+			continue;
+
+		while (!list_empty(&tmp_uid_list->page_cache_list)) {
+			page = lru_to_page(&tmp_uid_list->page_cache_list);
+			VM_BUG_ON_PAGE(!PageUIDLRU(page), page);
+
+			if (isolate_uid_lru_pages(page)) {
+				list_move(&page->lru, &putback_list);
+				nr_isolate_failed++;
+				continue;
+			}
+
+			ClearPageActive(page);
+			list_add(&page->lru, &frees_list);
+			nr_to_shrink--;
+			if (!nr_to_shrink)
+				break;
+		}
+
+		list_splice_init(&putback_list, &tmp_uid_list->page_cache_list);
+	}
+	spin_unlock_irq(&pgdat->lru_lock);
+	read_unlock(&prio_list_lock);
+
+	if (putback_lru != SMART_BOOST_PUTBACK_LRU)
+		nr_reclaimed = shrink_page_list(&frees_list, pgdat, sc,
+				TTU_IGNORE_ACCESS, NULL, true);
+
+	while (!list_empty(&frees_list)) {
+		page = lru_to_page(&frees_list);
+		list_del(&page->lru);
+		putback_lru_page(page);
+	}
+
+	sc->nr_reclaimed += nr_reclaimed;
+	/*pr_err("%s: reclaimed:%lu isolate:%lu isolate_failed:%lu ",
+			__func__, nr_reclaimed,
+			sc->nr_to_reclaim << 1, nr_isolate_failed);*/
+}
+#endif
 static void shrink_active_list(unsigned long nr_to_scan,
 			       struct lruvec *lruvec,
 			       struct scan_control *sc,
@@ -2082,7 +2647,9 @@ static void shrink_active_list(unsigned long nr_to_scan,
 	isolate_mode_t isolate_mode = 0;
 	int file = is_file_lru(lru);
 	struct pglist_data *pgdat = lruvec_pgdat(lruvec);
-
+#ifdef CONFIG_SMART_BOOST
+	active_nr++;
+#endif
 	lru_add_drain();
 
 	if (!sc->may_unmap)
@@ -2162,6 +2729,12 @@ static void shrink_active_list(unsigned long nr_to_scan,
 	free_hot_cold_page_list(&l_hold, true);
 	trace_mm_vmscan_lru_shrink_active(pgdat->node_id, nr_taken, nr_activate,
 			nr_deactivate, nr_rotated, sc->priority, file);
+#ifdef CONFIG_SMART_BOOST
+	if (sysctl_page_cache_reside_switch &&
+		((active_list_is_low(lruvec)) ||
+		(!current_is_kswapd() && sc->priority <= 11 && (sc->nr_reclaimed < sc->nr_to_reclaim))))
+		shrink_uid_lru_list(lruvec, pgdat, sc);
+#endif
 }
 
 /*
@@ -2210,7 +2783,12 @@ static bool inactive_list_is_low(struct lruvec *lruvec, bool file,
 	 */
 	if (!file && !total_swap_pages)
 		return false;
-
+#ifdef CONFIG_MEMPLUS
+	if (!file) {
+		inactive_lru = LRU_INACTIVE_ANON_SWPCACHE;
+		active_lru = LRU_ACTIVE_ANON_SWPCACHE;
+	}
+#endif
 	inactive = lruvec_lru_size(lruvec, inactive_lru, sc->reclaim_idx);
 	active = lruvec_lru_size(lruvec, active_lru, sc->reclaim_idx);
 
@@ -2288,6 +2866,16 @@ static void get_scan_count(struct lruvec *lruvec, struct mem_cgroup *memcg,
 	unsigned long ap, fp;
 	enum lru_list lru;
 
+#ifdef CONFIG_MEMPLUS
+	if (memplus_enabled()) {
+		if(vm_memory_plus_test_worstcase)
+			scan_balance = SCAN_ANON;
+		else
+			scan_balance = SCAN_EQUAL;
+		goto out;
+	}
+#endif
+
 	/* If we have no swap space, do not bother scanning anon pages. */
 	if (!sc->may_swap || mem_cgroup_get_nr_swap_pages(memcg) <= 0) {
 		scan_balance = SCAN_FILE;
@@ -2444,6 +3032,12 @@ static void get_scan_count(struct lruvec *lruvec, struct mem_cgroup *memcg,
 
 		switch (scan_balance) {
 		case SCAN_EQUAL:
+#ifdef CONFIG_MEMPLUS
+			if (lru == LRU_INACTIVE_ANON || lru == LRU_ACTIVE_ANON) {
+				size = 0;
+				scan = 0;
+			}
+#endif
 			/* Scan lists relative to size */
 			break;
 		case SCAN_FRACT:
@@ -2508,8 +3102,14 @@ static void shrink_node_memcg(struct pglist_data *pgdat, struct mem_cgroup *memc
 			 sc->priority == DEF_PRIORITY);
 
 	blk_start_plug(&plug);
+#ifndef CONFIG_MEMPLUS
+	while (nr[LRU_INACTIVE_ANON] || nr[LRU_ACTIVE_FILE] ||
+					nr[LRU_INACTIVE_FILE]) 
+#else
 	while (nr[LRU_INACTIVE_ANON] || nr[LRU_ACTIVE_FILE] ||
-					nr[LRU_INACTIVE_FILE]) {
+				nr[LRU_INACTIVE_FILE] || nr[LRU_INACTIVE_ANON_SWPCACHE])
+#endif
+	{
 		unsigned long nr_anon, nr_file, percentage;
 		unsigned long nr_scanned;
 
@@ -2536,7 +3136,12 @@ static void shrink_node_memcg(struct pglist_data *pgdat, struct mem_cgroup *memc
 		 * proportional to the original scan target.
 		 */
 		nr_file = nr[LRU_INACTIVE_FILE] + nr[LRU_ACTIVE_FILE];
+#ifdef CONIG_MEMPLUS
+		nr_anon = nr[LRU_INACTIVE_ANON_SWPCACHE] + nr[LRU_ACTIVE_ANON_SWPCACHE];
+#else
 		nr_anon = nr[LRU_INACTIVE_ANON] + nr[LRU_ACTIVE_ANON];
+#endif
+
 
 		/*
 		 * It's just vindictive to attack the larger once the smaller
@@ -2548,9 +3153,15 @@ static void shrink_node_memcg(struct pglist_data *pgdat, struct mem_cgroup *memc
 			break;
 
 		if (nr_file > nr_anon) {
+#ifdef CONIG_MEMPLUS
+			unsigned long scan_target = targets[LRU_INACTIVE_ANON_SWPCACHE] +
+						targets[LRU_ACTIVE_ANON_SWPCACHE] + 1;
+			lru = LRU_INACTIVE_ANON_SWPCACHE;
+#else
 			unsigned long scan_target = targets[LRU_INACTIVE_ANON] +
 						targets[LRU_ACTIVE_ANON] + 1;
 			lru = LRU_BASE;
+#endif
 			percentage = nr_anon * 100 / scan_target;
 		} else {
 			unsigned long scan_target = targets[LRU_INACTIVE_FILE] +
@@ -2567,7 +3178,11 @@ static void shrink_node_memcg(struct pglist_data *pgdat, struct mem_cgroup *memc
 		 * Recalculate the other LRU scan count based on its original
 		 * scan target and the percentage scanning already complete
 		 */
+#ifdef CONIG_MEMPLUS
+		lru = (lru == LRU_FILE) ? LRU_INACTIVE_ANON_SWPCACHE : LRU_FILE;
+#else
 		lru = (lru == LRU_FILE) ? LRU_BASE : LRU_FILE;
+#endif
 		nr_scanned = targets[lru] - nr[lru];
 		nr[lru] = targets[lru] * (100 - percentage) / 100;
 		nr[lru] -= min(nr[lru], nr_scanned);
@@ -2587,8 +3202,11 @@ static void shrink_node_memcg(struct pglist_data *pgdat, struct mem_cgroup *memc
 	 * rebalance the anon lru active/inactive ratio.
 	 */
 	if (inactive_list_is_low(lruvec, false, memcg, sc, true))
-		shrink_active_list(SWAP_CLUSTER_MAX, lruvec,
-				   sc, LRU_ACTIVE_ANON);
+#ifdef CONFIG_MEMPLUS
+		shrink_active_list(SWAP_CLUSTER_MAX, lruvec, sc, LRU_ACTIVE_ANON_SWPCACHE);
+#else
+		shrink_active_list(SWAP_CLUSTER_MAX, lruvec, sc, LRU_ACTIVE_ANON);
+#endif
 }
 
 /* Use reclaim/compaction for costly allocs or under memory pressure */
@@ -2720,7 +3338,6 @@ static bool shrink_node(pg_data_t *pgdat, struct scan_control *sc)
 			vmpressure(sc->gfp_mask, memcg, false,
 				   sc->nr_scanned - scanned,
 				   sc->nr_reclaimed - reclaimed);
-
 			/*
 			 * Direct reclaim and kswapd have to scan all memory
 			 * cgroups to fulfill the overall scan target for the
@@ -2980,7 +3597,18 @@ static unsigned long do_try_to_free_pages(struct zonelist *zonelist,
 	}
 
 	delayacct_freepages_end();
-
+#ifdef CONFIG_SMART_BOOST
+	if (global_reclaim(sc)) {
+		if (sc->priority <= 12 && sc->priority > 10)
+			__count_zid_vm_events(ALLOCSTALL_PRI1, sc->reclaim_idx, 1);
+		else if (sc->priority <= 10 && sc->priority > 5)
+			__count_zid_vm_events(ALLOCSTALL_PRI2, sc->reclaim_idx, 1);
+		else if (sc->priority <= 5 && sc->priority > 1)
+			__count_zid_vm_events(ALLOCSTALL_PRI3, sc->reclaim_idx, 1);
+		else
+			__count_zid_vm_events(ALLOCSTALL_PRI4, sc->reclaim_idx, 1);
+	}
+#endif
 	if (sc->nr_reclaimed)
 		return sc->nr_reclaimed;
 
@@ -3265,8 +3893,11 @@ static void age_active_anon(struct pglist_data *pgdat,
 		struct lruvec *lruvec = mem_cgroup_lruvec(pgdat, memcg);
 
 		if (inactive_list_is_low(lruvec, false, memcg, sc, true))
-			shrink_active_list(SWAP_CLUSTER_MAX, lruvec,
-					   sc, LRU_ACTIVE_ANON);
+#ifdef CONFIG_MEMPLUS
+			shrink_active_list(SWAP_CLUSTER_MAX, lruvec, sc, LRU_ACTIVE_ANON_SWPCACHE);
+#else
+			shrink_active_list(SWAP_CLUSTER_MAX, lruvec, sc, LRU_ACTIVE_ANON);
+#endif
 
 		memcg = mem_cgroup_iter(NULL, memcg, NULL);
 	} while (memcg);
@@ -3391,6 +4022,17 @@ static bool kswapd_shrink_node(pg_data_t *pgdat,
 	return sc->nr_scanned >= sc->nr_to_reclaim;
 }
 
+void __sched usleep_range_interruptible(unsigned long min, unsigned long max)
+{
+	ktime_t kmin;
+	u64 delta;
+
+	__set_current_state(TASK_INTERRUPTIBLE);
+
+	kmin = ktime_set(0, min * NSEC_PER_USEC);
+	delta = (u64)(max - min) * NSEC_PER_USEC;
+	schedule_hrtimeout_range(&kmin, delta, HRTIMER_MODE_REL);
+}
 /*
  * For kswapd, balance_pgdat() will reclaim pages across a node from zones
  * that are eligible for use by the caller until at least one zone is
@@ -3452,6 +4094,11 @@ static int balance_pgdat(pg_data_t *pgdat, int order, int classzone_idx)
 		 * sc.reclaim_idx is not used as buffer_heads_over_limit may
 		 * have adjusted it.
 		 */
+#ifdef CONFIG_MEMPLUS
+		if (vm_memory_plus_test_worstcase) {
+			/* don't exam balance state */
+		} else
+#endif
 		if (pgdat_balanced(pgdat, sc.order, classzone_idx))
 			goto out;
 
@@ -3467,6 +4114,10 @@ static int balance_pgdat(pg_data_t *pgdat, int order, int classzone_idx)
 		 * If we're getting trouble reclaiming, start doing writepage
 		 * even in laptop mode.
 		 */
+#ifdef CONFIG_MEMPLUS
+		if (vm_memory_plus_test_worstcase)
+			sc.may_writepage = 1;
+#endif
 		if (sc.priority < DEF_PRIORITY - 2)
 			sc.may_writepage = 1;
 
@@ -3503,14 +4154,30 @@ static int balance_pgdat(pg_data_t *pgdat, int order, int classzone_idx)
 		 * progress in reclaiming pages
 		 */
 		nr_reclaimed = sc.nr_reclaimed - nr_reclaimed;
-		if (raise_priority || !nr_reclaimed)
+		if (raise_priority || !nr_reclaimed) {
 			sc.priority--;
+
+			if (vm_breath_period && nr_reclaimed &&
+						!atomic_read(&alloc_ongoing)) {
+				sc.priority++;
+				usleep_range_interruptible(vm_breath_period,
+							vm_breath_period << 1);
+			}
+		}
 	} while (sc.priority >= 1);
 
 	if (!sc.nr_reclaimed)
 		pgdat->kswapd_failures++;
 
 out:
+#ifdef CONFIG_SMART_BOOST
+	if (sc.priority < 5)
+		priority_nr[0]++;
+	else if (sc.priority > 5 && sc.priority < 10)
+		priority_nr[1]++;
+	else
+		priority_nr[2]++;
+#endif
 	snapshot_refaults(NULL, pgdat);
 	/*
 	 * Return the order kswapd stopped reclaiming at as
@@ -3670,6 +4337,11 @@ static int kswapd(void *p)
 		classzone_idx = kswapd_classzone_idx(pgdat, classzone_idx);
 
 kswapd_try_sleep:
+#ifdef CONFIG_MEMPLUS
+		if(vm_memory_plus_test_worstcase) {
+			/* don't sleep */
+		} else
+#endif
 		kswapd_try_to_sleep(pgdat, alloc_order, reclaim_order,
 					classzone_idx);
 
@@ -3975,6 +4647,12 @@ static int __node_reclaim(struct pglist_data *pgdat, gfp_t gfp_mask, unsigned in
 		do {
 			shrink_node(pgdat, &sc);
 		} while (sc.nr_reclaimed < nr_pages && --sc.priority >= 0);
+#ifdef CONFIG_SMART_BOOST
+		if (sc.priority >= 0 && sc.priority <= 2)
+			__count_zid_vm_events(ALLOCSTALL_PRI2, sc->reclaim_idx, 1);
+		else
+			__count_zid_vm_events(ALLOCSTALL_PRI1, sc->reclaim_idx, 1);
+#endif
 	}
 
 	p->reclaim_state = NULL;
@@ -4092,7 +4770,12 @@ void check_move_unevictable_pages(struct page **pages, int nr_pages)
 
 			VM_BUG_ON_PAGE(PageActive(page), page);
 			ClearPageUnevictable(page);
+#ifdef CONFIG_SMART_BOOST
+			del_page_from_lru_list(page, lruvec, LRU_UNEVICTABLE,
+						PageUIDLRU(page) ? true:false);
+#else
 			del_page_from_lru_list(page, lruvec, LRU_UNEVICTABLE);
+#endif
 			add_page_to_lru_list(page, lruvec, lru);
 			pgrescued++;
 		}
diff --git a/mm/vmstat.c b/mm/vmstat.c
index 49a72eb4c74d1ca6fc5667e97ad5959cfb45885e..9fd6b8e140a5a8049aec0b954dcfe9a22db154a6 100644
--- a/mm/vmstat.c
+++ b/mm/vmstat.c
@@ -1041,6 +1041,10 @@ const char * const vmstat_text[] = {
 	"nr_zone_active_anon",
 	"nr_zone_inactive_file",
 	"nr_zone_active_file",
+#ifdef CONFIG_MEMPLUS
+	"nr_zone_inactive_anon_swpcache",
+	"nr_zone_active_anon_swpcache",
+#endif
 	"nr_zone_unevictable",
 	"nr_zone_write_pending",
 	"nr_mlock",
@@ -1049,9 +1053,14 @@ const char * const vmstat_text[] = {
 	"nr_bounce",
 #if IS_ENABLED(CONFIG_ZSMALLOC)
 	"nr_zspages",
+#endif
+#ifdef CONFIG_SMART_BOOST
+	"nr_uid_lru",
 #endif
 	"nr_free_cma",
-
+#ifdef CONFIG_DEFRAG_HELPER
+	"nr_free_defrag",
+#endif
 	/* enum numa_stat_item counters */
 #ifdef CONFIG_NUMA
 	"numa_hit",
@@ -1061,12 +1070,15 @@ const char * const vmstat_text[] = {
 	"numa_local",
 	"numa_other",
 #endif
-
 	/* Node-based counters */
 	"nr_inactive_anon",
 	"nr_active_anon",
 	"nr_inactive_file",
 	"nr_active_file",
+#ifdef CONFIG_MEMPLUS
+	"nr_inactive_anon_swpcache",
+	"nr_active_anon_swpcache",
+#endif
 	"nr_unevictable",
 	"nr_slab_reclaimable",
 	"nr_slab_unreclaimable",
@@ -1115,6 +1127,10 @@ const char * const vmstat_text[] = {
 
 	"pgfault",
 	"pgmajfault",
+#ifdef CONFIG_MEMPLUS
+	"pg_add_to_swap",
+	"pg_swap_write",
+#endif
 	"pglazyfreed",
 
 	"pgrefill",
@@ -1222,7 +1238,13 @@ const char * const vmstat_text[] = {
 	"swap_ra_hit",
 #endif
 #ifdef CONFIG_SPECULATIVE_PAGE_FAULT
-	"speculative_pgfault"
+	"speculative_pgfault",
+#endif
+#ifdef CONFIG_SMART_BOOST
+	TEXTS_FOR_ZONES("allocstall_pri1")
+	TEXTS_FOR_ZONES("allocstall_pri2")
+	TEXTS_FOR_ZONES("allocstall_pri3")
+	TEXTS_FOR_ZONES("allocstall_pri4")
 #endif
 #endif /* CONFIG_VM_EVENT_COUNTERS */
 };
@@ -1281,6 +1303,9 @@ static void walk_zones_in_node(struct seq_file *m, pg_data_t *pgdat,
 #endif
 
 #ifdef CONFIG_PROC_FS
+#ifdef CONFIG_DEFRAG_HELPER
+#include <../drivers/oneplus/coretech/defrag/defrag_helper.h>
+#endif
 static void frag_show_print(struct seq_file *m, pg_data_t *pgdat,
 						struct zone *zone)
 {
@@ -1299,6 +1324,9 @@ static int frag_show(struct seq_file *m, void *arg)
 {
 	pg_data_t *pgdat = (pg_data_t *)arg;
 	walk_zones_in_node(m, pgdat, true, false, frag_show_print);
+#ifdef CONFIG_DEFRAG_HELPER
+	print_fp_statistics(m);
+#endif
 	return 0;
 }
 
@@ -1308,6 +1336,11 @@ static void pagetypeinfo_showfree_print(struct seq_file *m,
 	int order, mtype;
 
 	for (mtype = 0; mtype < MIGRATE_TYPES; mtype++) {
+#ifdef CONFIG_DEFRAG_HELPER
+		if ((mtype == MIGRATE_UNMOVABLE_DEFRAG_POOL) &&
+					likely(!alloc_status))
+			continue;
+#endif
 		seq_printf(m, "Node %4d, zone %8s, type %12s ",
 					pgdat->node_id,
 					zone->name,
@@ -1376,7 +1409,16 @@ static void pagetypeinfo_showblockcount_print(struct seq_file *m,
 	/* Print counts */
 	seq_printf(m, "Node %d, zone %8s ", pgdat->node_id, zone->name);
 	for (mtype = 0; mtype < MIGRATE_TYPES; mtype++)
+#ifdef CONFIG_DEFRAG_HELPER
+	{
+		if ((mtype == MIGRATE_UNMOVABLE_DEFRAG_POOL) &&
+						likely(!alloc_status))
+			continue;
+#endif
 		seq_printf(m, "%12lu ", count[mtype]);
+#ifdef CONFIG_DEFRAG_HELPER
+	}
+#endif
 	seq_putc(m, '\n');
 }
 
@@ -1388,7 +1430,16 @@ static int pagetypeinfo_showblockcount(struct seq_file *m, void *arg)
 
 	seq_printf(m, "\n%-23s", "Number of blocks type ");
 	for (mtype = 0; mtype < MIGRATE_TYPES; mtype++)
+#ifdef CONFIG_DEFRAG_HELPER
+	{
+		if ((mtype == MIGRATE_UNMOVABLE_DEFRAG_POOL) &&
+						likely(!alloc_status))
+			continue;
+#endif
 		seq_printf(m, "%12s ", migratetype_names[mtype]);
+#ifdef CONFIG_DEFRAG_HELPER
+	}
+#endif
 	seq_putc(m, '\n');
 	walk_zones_in_node(m, pgdat, true, false,
 		pagetypeinfo_showblockcount_print);
@@ -1592,6 +1643,39 @@ static int zoneinfo_show(struct seq_file *m, void *arg)
 	return 0;
 }
 
+atomic64_t vm_high_priority_ns = ATOMIC64_INIT(0);
+atomic64_t vm_low_priority_ns = ATOMIC64_INIT(0);
+atomic64_t vm_all_priority_ns = ATOMIC64_INIT(0);
+atomic64_t vm_high_priority_count = ATOMIC64_INIT(0);
+atomic64_t vm_all_priority_count = ATOMIC64_INIT(0);
+
+atomic64_t vm_high_priority_ns_1ms = ATOMIC64_INIT(0);
+atomic64_t vm_low_priority_ns_1ms = ATOMIC64_INIT(0);
+atomic64_t vm_all_priority_ns_1ms = ATOMIC64_INIT(0);
+atomic64_t vm_high_priority_count_1ms = ATOMIC64_INIT(0);
+atomic64_t vm_all_priority_count_1ms = ATOMIC64_INIT(0);
+
+static int lr_stat_show(struct seq_file *m, void *arg)
+{
+	seq_printf(m, "alloc time stat\n");
+	seq_printf(m, "All: all %lu (cnt %lu) high %lu (cnt %lu) low %lu\n"
+			, atomic64_read(&vm_all_priority_ns)
+			, atomic64_read(&vm_all_priority_count)
+			, atomic64_read(&vm_high_priority_ns)
+			, atomic64_read(&vm_high_priority_count)
+			, atomic64_read(&vm_low_priority_ns)
+			);
+	seq_printf(m, ">1ms: all %lu (cnt %lu) high %lu (cnt %lu) low %lu\n"
+			, atomic64_read(&vm_all_priority_ns_1ms)
+			, atomic64_read(&vm_all_priority_count_1ms)
+			, atomic64_read(&vm_high_priority_ns_1ms)
+			, atomic64_read(&vm_high_priority_count_1ms)
+			, atomic64_read(&vm_low_priority_ns_1ms)
+			);
+	seq_putc(m, '\n');
+	return 0;
+}
+
 static const struct seq_operations zoneinfo_op = {
 	.start	= frag_start, /* iterate over all zones. The same as in
 			       * fragmentation. */
@@ -1599,11 +1683,22 @@ static const struct seq_operations zoneinfo_op = {
 	.stop	= frag_stop,
 	.show	= zoneinfo_show,
 };
+static const struct seq_operations lr_stat_op = {
+	.start	= frag_start, /* iterate over all zones. The same as in
+			       * fragmentation. */
+	.next	= frag_next,
+	.stop	= frag_stop,
+	.show	= lr_stat_show,
+};
 
 static int zoneinfo_open(struct inode *inode, struct file *file)
 {
 	return seq_open(file, &zoneinfo_op);
 }
+static int lr_stat_open(struct inode *inode, struct file *file)
+{
+	return seq_open(file, &lr_stat_op);
+}
 
 static const struct file_operations zoneinfo_file_operations = {
 	.open		= zoneinfo_open,
@@ -1611,7 +1706,87 @@ static const struct file_operations zoneinfo_file_operations = {
 	.llseek		= seq_lseek,
 	.release	= seq_release,
 };
+static const struct file_operations proc_lr_stat_file_operations = {
+	.open		= lr_stat_open,
+	.read		= seq_read,
+	.llseek		= seq_lseek,
+	.release	= seq_release,
+};
 
+#ifdef CONFIG_SMART_BOOST
+static void uid_lru_info_show_print(struct seq_file *m, pg_data_t *pgdat)
+{
+	int i;
+	struct uid_node **table;
+	struct list_head *pos;
+	unsigned long nr_pages;
+	struct mem_cgroup *memcg;
+
+	seq_printf(m, "Node %d\n", pgdat->node_id);
+	seq_puts(m, "uid_lru_list priority:\n");
+	print_prio_chain(m);
+	seq_puts(m, "uid\thot_count\tpages\n");
+
+	memcg = mem_cgroup_iter(NULL, NULL, NULL);
+	do {
+		struct lruvec *lruvec = mem_cgroup_lruvec(pgdat, memcg);
+		if (!lruvec)
+			goto next;
+		table = lruvec->uid_hash;
+		if (!table)
+			goto next;
+		for (i = 0; i < (1 << 5); i++) {
+
+			struct uid_node *node = rcu_dereference(table[i]);
+
+			if (!node)
+				continue;
+			do {
+				nr_pages = 0;
+				list_for_each(pos, &node->page_cache_list)
+					nr_pages++;
+				seq_printf(m, "%d\t%d\t%lu\n",
+					node->uid,
+					node->hot_count,
+					nr_pages);
+			} while ((node = rcu_dereference(node->next)) != NULL);
+		}
+next:
+		memcg = mem_cgroup_iter(NULL, memcg, NULL);
+	} while (memcg);
+	seq_putc(m, '\n');
+}
+/*
+ * Output information about zones in @pgdat.
+ */
+static int uid_lru_info_show(struct seq_file *m, void *arg)
+{
+	pg_data_t *pgdat = (pg_data_t *)arg;
+
+	uid_lru_info_show_print(m, pgdat);
+
+	return 0;
+}
+
+static const struct seq_operations uid_lru_info_op = {
+	.start	= frag_start,
+	.next	= frag_next,
+	.stop	= frag_stop,
+	.show	= uid_lru_info_show,
+};
+
+static int uid_lru_info_open(struct inode *inode, struct file *file)
+{
+	return seq_open(file, &uid_lru_info_op);
+}
+
+static const struct file_operations proc_uid_lru_info_file_operations = {
+	.open		= uid_lru_info_open,
+	.read		= seq_read,
+	.llseek		= seq_lseek,
+	.release	= seq_release,
+};
+#endif
 enum writeback_stat_item {
 	NR_DIRTY_THRESHOLD,
 	NR_DIRTY_BG_THRESHOLD,
@@ -1956,6 +2131,11 @@ void __init init_mm_internals(void)
 	proc_create("pagetypeinfo", 0444, NULL, &pagetypeinfo_file_operations);
 	proc_create("vmstat", 0444, NULL, &vmstat_file_operations);
 	proc_create("zoneinfo", 0444, NULL, &zoneinfo_file_operations);
+	proc_create("lr_stat", S_IRUGO, NULL, &proc_lr_stat_file_operations);
+#endif
+#ifdef CONFIG_SMART_BOOST
+	proc_create("uid_lru_info", 0444, NULL,
+			&proc_uid_lru_info_file_operations);
 #endif
 }
 
diff --git a/net/qrtr/qrtr.c b/net/qrtr/qrtr.c
index e8b39aef8e2bcb8aefaa1d386b03f6f36ea36dc3..35e84bbb5bea35c64686bdb479fc6843bebf928d 100644
--- a/net/qrtr/qrtr.c
+++ b/net/qrtr/qrtr.c
@@ -233,6 +233,10 @@ static void qrtr_log_tx_msg(struct qrtr_node *node, struct qrtr_hdr_v1 *hdr,
 			QRTR_INFO(node->ilc,
 				  "TX CTRL: cmd:0x%x node[0x%x]\n",
 				  hdr->type, hdr->src_node_id);
+		else if (hdr->type == QRTR_TYPE_DEL_PROC)
+			QRTR_INFO(node->ilc,
+				  "TX CTRL: cmd:0x%x node[0x%x]\n",
+				  hdr->type, pkt->proc.node);
 	}
 }
 
@@ -773,49 +777,44 @@ static struct sk_buff *qrtr_alloc_ctrl_packet(struct qrtr_ctrl_pkt **pkt)
 static struct qrtr_sock *qrtr_port_lookup(int port);
 static void qrtr_port_put(struct qrtr_sock *ipc);
 
-static bool qrtr_must_forward(u32 src_nid, u32 dst_nid, u32 type)
+static bool qrtr_must_forward(struct qrtr_node *src,
+			      struct qrtr_node *dst, u32 type)
 {
-	struct qrtr_node *dst;
-	struct qrtr_node *src;
-	bool ret = false;
-
-	if (src_nid == qrtr_local_nid)
+	/* Node structure is not maintained for local processor.
+	 * Hence src is null in that case.
+	 */
+	if (!src)
 		return true;
 
+	if (!dst)
+		return false;
+
 	if (type == QRTR_TYPE_HELLO || type == QRTR_TYPE_RESUME_TX)
-		return ret;
+		return false;
 
-	dst = qrtr_node_lookup(dst_nid);
-	src = qrtr_node_lookup(src_nid);
-	if (!dst || !src)
-		goto out;
-	if (dst == src)
-		goto out;
-	if (dst->nid == QRTR_EP_NID_AUTO)
-		goto out;
+	if (dst == src || dst->nid == QRTR_EP_NID_AUTO)
+		return false;
 
 	if (abs(dst->net_id - src->net_id) > 1)
-		ret = true;
-
-out:
-	qrtr_node_release(dst);
-	qrtr_node_release(src);
+		return true;
 
-	return ret;
+	return false;
 }
 
 static void qrtr_fwd_ctrl_pkt(struct sk_buff *skb)
 {
 	struct qrtr_node *node;
+	struct qrtr_node *src;
 	struct qrtr_cb *cb = (struct qrtr_cb *)skb->cb;
 
+	src = qrtr_node_lookup(cb->src_node);
 	down_read(&qrtr_node_lock);
 	list_for_each_entry(node, &qrtr_all_epts, item) {
 		struct sockaddr_qrtr from;
 		struct sockaddr_qrtr to;
 		struct sk_buff *skbn;
 
-		if (!qrtr_must_forward(cb->src_node, node->nid, cb->type))
+		if (!qrtr_must_forward(src, node, cb->type))
 			continue;
 
 		skbn = skb_clone(skb, GFP_KERNEL);
@@ -833,6 +832,7 @@ static void qrtr_fwd_ctrl_pkt(struct sk_buff *skb)
 		qrtr_node_enqueue(node, skbn, cb->type, &from, &to, 0);
 	}
 	up_read(&qrtr_node_lock);
+	qrtr_node_release(src);
 }
 
 static void qrtr_fwd_pkt(struct sk_buff *skb, struct qrtr_cb *cb)
@@ -949,6 +949,60 @@ int qrtr_endpoint_register(struct qrtr_endpoint *ep, unsigned int net_id)
 }
 EXPORT_SYMBOL_GPL(qrtr_endpoint_register);
 
+static u32 qrtr_calc_checksum(struct qrtr_ctrl_pkt *pkt)
+{
+	u32 checksum = 0;
+	u32 mask = 0xffff;
+	u16 upper_nb;
+	u16 lower_nb;
+	u32 *msg;
+	int i;
+
+	if (!pkt)
+		return checksum;
+	msg = (u32 *)pkt;
+
+	for (i = 0; i < sizeof(*pkt) / sizeof(*msg); i++) {
+		lower_nb = *msg & mask;
+		upper_nb = (*msg >> 16) & mask;
+		checksum += (upper_nb + lower_nb);
+		msg++;
+	}
+	while (checksum > 0xffff)
+		checksum = (checksum & mask) + ((checksum >> 16) & mask);
+
+	checksum = ~checksum & mask;
+
+	return checksum;
+}
+
+static void qrtr_fwd_del_proc(struct qrtr_node *src, unsigned int nid)
+{
+	struct sockaddr_qrtr from = {AF_QIPCRTR, 0, QRTR_PORT_CTRL};
+	struct sockaddr_qrtr to = {AF_QIPCRTR, 0, QRTR_PORT_CTRL};
+	struct qrtr_ctrl_pkt *pkt;
+	struct qrtr_node *dst;
+	struct sk_buff *skb;
+
+	list_for_each_entry(dst, &qrtr_all_epts, item) {
+		if (!qrtr_must_forward(src, dst, QRTR_TYPE_DEL_PROC))
+			continue;
+
+		skb = qrtr_alloc_ctrl_packet(&pkt);
+		if (!skb)
+			return;
+
+		pkt->cmd = cpu_to_le32(QRTR_TYPE_DEL_PROC);
+		pkt->proc.rsvd = QRTR_DEL_PROC_MAGIC;
+		pkt->proc.node = cpu_to_le32(nid);
+		pkt->proc.rsvd = cpu_to_le32(qrtr_calc_checksum(pkt));
+
+		from.sq_node = src->nid;
+		to.sq_node = dst->nid;
+		qrtr_node_enqueue(dst, skb, QRTR_TYPE_DEL_PROC, &from, &to, 0);
+	}
+}
+
 /**
  * qrtr_endpoint_unregister - unregister endpoint
  * @ep: endpoint to unregister
@@ -980,6 +1034,8 @@ void qrtr_endpoint_unregister(struct qrtr_endpoint *ep)
 		src.sq_node = iter.index;
 		pkt->cmd = cpu_to_le32(QRTR_TYPE_BYE);
 		qrtr_local_enqueue(NULL, skb, QRTR_TYPE_BYE, &src, &dst, 0);
+
+		qrtr_fwd_del_proc(node, iter.index);
 	}
 	up_read(&qrtr_node_lock);
 
@@ -1294,6 +1350,7 @@ static int qrtr_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
 	struct sock *sk = sock->sk;
 	struct qrtr_ctrl_pkt *pkt;
 	struct qrtr_node *node;
+	struct qrtr_node *srv_node;
 	struct sk_buff *skb;
 	size_t plen;
 	u32 type = QRTR_TYPE_DATA;
@@ -1331,6 +1388,7 @@ static int qrtr_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
 	}
 
 	node = NULL;
+	srv_node = NULL;
 	if (addr->sq_node == QRTR_NODE_BCAST) {
 		enqueue_fn = qrtr_bcast_enqueue;
 		if (addr->sq_port != QRTR_PORT_CTRL) {
@@ -1384,11 +1442,14 @@ static int qrtr_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
 
 		/* drop new server cmds that are not forwardable to dst node*/
 		pkt = (struct qrtr_ctrl_pkt *)skb->data;
-		if (!qrtr_must_forward(pkt->server.node, addr->sq_node, type)) {
+		srv_node = qrtr_node_lookup(pkt->server.node);
+		if (!qrtr_must_forward(srv_node, node, type)) {
 			rc = 0;
 			kfree_skb(skb);
+			qrtr_node_release(srv_node);
 			goto out_node;
 		}
+		qrtr_node_release(srv_node);
 	}
 
 	rc = enqueue_fn(node, skb, type, &ipc->us, addr, msg->msg_flags);
diff --git a/net/qrtr/qrtr.h b/net/qrtr/qrtr.h
index 5005b1c5b56dd5f408179a6a504d1144e842cd8f..f9aede45fdc5ca9c10d40916ca00988403787069 100644
--- a/net/qrtr/qrtr.h
+++ b/net/qrtr/qrtr.h
@@ -10,6 +10,8 @@ struct sk_buff;
 #define QRTR_EP_NID_AUTO (-1)
 #define QRTR_EP_NET_ID_AUTO (1)
 
+#define QRTR_DEL_PROC_MAGIC	0xe111
+
 /**
  * struct qrtr_endpoint - endpoint handle
  * @xmit: Callback for outgoing packets
diff --git a/net/wireless/db.txt b/net/wireless/db.txt
index 9f75f1add7e32cf7c5a4ffe1aed8a8119e0f574f..ec44231a7a23b2b53e3961d0ae464140d13cb475 100644
--- a/net/wireless/db.txt
+++ b/net/wireless/db.txt
@@ -1,10 +1,10 @@
 # This is the world regulatory domain
 country 00:
-	(2402 - 2472 @ 40), (20)
+	(2402 - 2472 @ 40), (23)
 	# Channel 12 - 13.
-	(2457 - 2482 @ 40), (20), PASSIVE-SCAN, NO-IBSS
+	(2457 - 2482 @ 40), (23), PASSIVE-SCAN, NO-IBSS
 	# Channel 14. Only JP enables this and for 802.11b only
-	(2474 - 2494 @ 20), (20), PASSIVE-SCAN, NO-IBSS, NO-OFDM
+	(2474 - 2494 @ 20), (23), PASSIVE-SCAN, NO-IBSS, NO-OFDM
 	# Channel 36 - 48
 	(5170 - 5250 @ 80), (20), PASSIVE-SCAN, NO-IBSS
 	(5250 - 5330 @ 80), (20), PASSIVE-SCAN, NO-IBSS
@@ -17,37 +17,37 @@ country 00:
 
 
 country AE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country AF: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country AI: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country AL: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5150 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5350 @ 80), (23), DFS, AUTO-BW
 	(5470 - 5710 @ 160), (30), DFS
 
 country AM: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 20), (18)
 	(5250 - 5330 @ 20), (18), DFS
 
 country AN: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -69,7 +69,7 @@ country AS: DFS-FCC
 	(5735 - 5850 @ 80), (30)
 
 country AT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -86,7 +86,7 @@ country AT: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country AU: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5590 @ 80), (24), DFS
@@ -96,34 +96,34 @@ country AU: DFS-FCC
 	(57240 - 65880 @ 2160), (43), NO-OUTDOOR
 
 country AW: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country AZ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (18), AUTO-BW
 	(5250 - 5330 @ 80), (18), DFS, AUTO-BW
 
 country BA: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country BB: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (30)
 
 country BD:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5735 - 5835 @ 80), (30)
 
 country BE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -140,14 +140,14 @@ country BE: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country BF: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country BG: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -164,12 +164,12 @@ country BG: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country BH:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 20), (23)
 	(5735 - 5835 @ 20), (33)
 
 country BL: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -182,13 +182,13 @@ country BM: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country BN: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (20), AUTO-BW
 	(5250 - 5330 @ 80), (20), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (20)
 
 country BO: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5250 - 5330 @ 80), (30), DFS
 	(5735 - 5835 @ 80), (30)
 	# 60 gHz band channels 1-3, FCC
@@ -204,48 +204,49 @@ country BR: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country BS: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country BT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country BY: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country BZ:
-	(2402 - 2482 @ 40), (20)
-	(5170 - 5330 @ 160), (23)
-	(5490 - 5730 @ 160), (30)
-	(5735 - 5835 @ 80), (30)
+	(2402 - 2482 @ 40), (36)
+	(5170 - 5330 @ 160), (27)
+	(5490 - 5730 @ 160), (36)
+	(5735 - 5835 @ 80), (36)
 
 country CA: DFS-FCC
 	(2402 - 2472 @ 40), (30)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
-	(5490 - 5730 @ 160), (24), DFS
+	(5490 - 5590 @ 80), (24), DFS
+	(5650 - 5730 @ 80), (24), DFS
 	(5735 - 5835 @ 80), (30)
 	# 60 gHz band channels 1-3
 	(57240 - 63720 @ 2160), (40)
 
 country CF: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 40), (24)
 	(5250 - 5330 @ 40), (24), DFS
 	(5490 - 5730 @ 40), (24), DFS
 	(5735 - 5835 @ 40), (30)
 
 country CH: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -262,21 +263,21 @@ country CH: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country CI: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country CL:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (20)
 	(5735 - 5835 @ 80), (20)
 	# 60 gHz band channels 1-3
 	(57240 - 63720 @ 2160), (50), NO-OUTDOOR
 
 country CN: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (33)
@@ -284,14 +285,14 @@ country CN: DFS-FCC
 	(59400 - 63720 @ 2160), (44)
 
 country CO: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country CR: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 20), (24)
 	(5250 - 5330 @ 20), (24), DFS
 	(5490 - 5730 @ 20), (24), DFS
@@ -300,14 +301,14 @@ country CR: DFS-FCC
 	(57240 - 63720 @ 2160), (30)
 
 country CX: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country CY: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -326,7 +327,7 @@ country CY: DFS-ETSI
 # Data from http://www.ctu.eu/164/download/VOR/VOR-12-08-2005-34.pdf
 # and http://www.ctu.eu/164/download/VOR/VOR-12-05-2007-6-AN.pdf
 country CZ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -349,7 +350,7 @@ country CZ: DFS-ETSI
 
 country DE: DFS-ETSI
 	# entries 279004 and 280006
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -366,7 +367,7 @@ country DE: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country DK: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -395,13 +396,13 @@ country DO: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country DZ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5670 @ 160), (23), DFS
 
 country EC: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 20), (24)
 	(5250 - 5330 @ 20), (24), DFS
 	(5490 - 5730 @ 20), (24), DFS
@@ -410,7 +411,7 @@ country EC: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country EE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -427,12 +428,12 @@ country EE: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country EG: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 40), (23)
 	(5250 - 5330 @ 40), (23), DFS
 
 country ES: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -449,13 +450,13 @@ country ES: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country ET: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country FI: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -496,7 +497,7 @@ country FR: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country GB: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -520,18 +521,18 @@ country GD: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country GE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (18), AUTO-BW
 	(5250 - 5330 @ 80), (18), DFS, AUTO-BW
 
 country GF: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country GH: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -550,13 +551,13 @@ country GL: DFS-ETSI
 	(5490 - 5710 @ 160), (30), DFS
 
 country GP: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country GR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -573,7 +574,7 @@ country GR: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country GT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -592,7 +593,7 @@ country GY:
 	(5735 - 5835 @ 80), (30)
 
 country HK: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -601,7 +602,7 @@ country HK: DFS-FCC
 	(57240 - 65880 @ 2160), (40)
 
 country HN:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (24)
 	(5490 - 5730 @ 160), (24)
 	(5735 - 5835 @ 80), (30)
@@ -609,7 +610,7 @@ country HN:
 	(57240 - 63720 @ 2160), (40)
 
 country HR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -633,7 +634,7 @@ country HT: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country HU: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -655,7 +656,7 @@ country ID:
 	(5735 - 5815 @ 20), (30)
 
 country IE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -672,25 +673,25 @@ country IE: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country IL: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	# 60 gHz band channels 1-4, base on Etsi En 302 567
 	(57000 - 66000 @ 2160), (40)
 
 country IN:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (23)
 	(5735 - 5835 @ 80), (33)
 
 country IQ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country IS: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -707,7 +708,7 @@ country IS: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country IT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -724,7 +725,7 @@ country IT: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country JM: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -733,7 +734,7 @@ country JM: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country JO:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23)
 	(5735 - 5835 @ 80), (23)
 	# 60 gHz band channels 1-4, ref: Etsi En 302 567
@@ -748,26 +749,26 @@ country JP: DFS-JP
 	(57240 - 65880 @ 2160), (40)
 
 country KE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23)
 	(5490 - 5570 @ 80), (30), DFS
 	(5735 - 5775 @ 40), (23)
 
 country KH: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country KN: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
-	(5250 - 5330 @ 80), (30), DFS, AUTO-BW
+	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 	(5735 - 5815 @ 80), (30)
 
 country KR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (20), AUTO-BW
 	(5250 - 5330 @ 80), (20), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (30), DFS
@@ -777,36 +778,36 @@ country KR: DFS-ETSI
 	(57240 - 65880 @ 2160), (43)
 
 country KW: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 
 country KY: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country KZ:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 
 country LB: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country LC: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (20), AUTO-BW
 	(5250 - 5330 @ 80), (30), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 	(5735 - 5815 @ 80), (30)
 
 country LI: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -823,20 +824,20 @@ country LI: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country LK: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 20), (24)
 	(5250 - 5330 @ 20), (24), DFS
 	(5490 - 5730 @ 20), (24), DFS
 	(5735 - 5835 @ 20), (30)
 
 country LS: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country LT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -853,7 +854,7 @@ country LT: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country LU: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -870,7 +871,7 @@ country LU: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country LV: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -887,32 +888,32 @@ country LV: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country MA: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	# 60 gHz band channels 1-4, ref: Etsi En 302 567
 	(57000 - 66000 @ 2160), (40)
 
 country MC: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country MD: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country ME: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country MF: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -925,20 +926,20 @@ country MH: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country MK: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country MN: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country MO: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -952,19 +953,19 @@ country MP: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country MQ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country MR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country MT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -981,20 +982,20 @@ country MT: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country MU: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country MV: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (20), AUTO-BW
 	(5250 - 5330 @ 80), (20), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (20)
 
 country MW: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1009,7 +1010,7 @@ country MX: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country MY: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5650 @ 160), (24), DFS
@@ -1018,14 +1019,14 @@ country MY: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country NA: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (30), DFS
 	(5735 - 5835 @ 80), (33)
 
 country NG: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5250 - 5330 @ 80), (30), DFS
 	(5735 - 5835 @ 80), (30)
 
@@ -1039,7 +1040,7 @@ country NI: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country NL: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1056,7 +1057,7 @@ country NL: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country NO: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1073,7 +1074,7 @@ country NO: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country NP:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (20)
 	(5735 - 5835 @ 80), (20)
 
@@ -1087,7 +1088,7 @@ country NZ: DFS-FCC
 	(57000 - 66000 @ 2160), (40)
 
 country OM: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1099,27 +1100,27 @@ country PA:
 	(5735 - 5835 @ 80), (36)
 
 country PE: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country PF: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country PG: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country PH: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1132,7 +1133,7 @@ country PK:
 	(5735 - 5835 @ 80), (30)
 
 country PL: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1149,7 +1150,7 @@ country PL: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country PM: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1169,7 +1170,7 @@ country PS: DFS-FCC
 	(4940 - 4990 @ 40), (33)
 
 country PT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1193,7 +1194,7 @@ country PW: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country PY: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1206,13 +1207,13 @@ country QA:
 	(5735 - 5835 @ 80), (30)
 
 country RE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country RO: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1231,15 +1232,15 @@ country RO: DFS-ETSI
 # Source:
 # http://www.ratel.rs/upload/documents/Plan_namene/Plan_namene-sl_glasnik.pdf
 country RS: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
-        (5250 - 5330 @ 80), (23), DFS, AUTO-BW
+	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 	# 60 gHz band channels 1-4, ref: Etsi En 302 567
 	(57000 - 66000 @ 2160), (40)
 
 country RU:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (23)
 	(5490 - 5730 @ 160), (30)
 	(5735 - 5835 @ 80), (30)
@@ -1247,20 +1248,20 @@ country RU:
 	(57240 - 65880 @ 2160), (40)
 
 country RW: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country SA: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country SE: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1277,7 +1278,7 @@ country SE: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country SG: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1286,7 +1287,7 @@ country SG: DFS-FCC
 	(57000 - 66000 @ 2160), (40), NO-OUTDOOR
 
 country SI: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1303,7 +1304,7 @@ country SI: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country SK: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1320,44 +1321,44 @@ country SK: DFS-ETSI
 	(57000 - 66000 @ 2160), (40)
 
 country SN:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5330 @ 160), (24)
 	(5490 - 5730 @ 160), (24)
 	(5735 - 5835 @ 80), (30)
 
 country SR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country SV: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 20), (23)
 	(5250 - 5330 @ 20), (23), DFS
 	(5735 - 5835 @ 20), (30)
 
 country TC: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country TD: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country TG: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 40), (23)
 	(5250 - 5330 @ 40), (23), DFS
 	(5490 - 5710 @ 40), (30), DFS
 
 country TH: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1366,12 +1367,12 @@ country TH: DFS-FCC
 	(57240 - 65880 @ 2160), (40)
 
 country TN: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 
 country TR: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
@@ -1379,10 +1380,10 @@ country TR: DFS-ETSI
 	(57240 - 65880 @ 2160), (40), NO-OUTDOOR
 
 country TT:
-	(2402 - 2482 @ 40), (20)
-	(5170 - 5330 @ 160), (24)
-	(5490 - 5730 @ 160), (24)
-	(5735 - 5835 @ 80), (30)
+	(2402 - 2482 @ 40), (23)
+	(5170 - 5330 @ 160), (27)
+	(5490 - 5730 @ 160), (36)
+	(5735 - 5835 @ 80), (36)
 	# 60 gHz band channels 1-3, FCC
 	(57240 - 63720 @ 2160), (40)
 
@@ -1396,7 +1397,7 @@ country TW: DFS-FCC
 	(57240 - 63720 @ 2160), (40)
 
 country TZ:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5735 - 5835 @ 80), (30)
 
 # Source:
@@ -1407,7 +1408,7 @@ country TZ:
 # rules in the referenced laws. Such a range is used because of
 # disputable definitions there.
 country UA: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (20), AUTO-BW
 	(5250 - 5330 @ 80), (20), DFS, AUTO-BW
 	(5490 - 5670 @ 160), (20), DFS
@@ -1416,7 +1417,7 @@ country UA: DFS-ETSI
 	(57240 - 65880 @ 2160), (20)
 
 country UG: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1446,28 +1447,28 @@ country US: DFS-FCC
 	(57240 - 70200 @ 2160), (40)
 
 country UY: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
-        (5250 - 5330 @ 80), (23), DFS, AUTO-BW
+	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (30)
 	# 60 gHz band channels 1-4
 	(57240 - 65880 @ 2160), (40)
 
 country UZ: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
-	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
+	(5250 - 5330 @ 80), (20), DFS, AUTO-BW
 
 country VC: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country VE: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (30)
 	(5170 - 5250 @ 80), (23), AUTO-BW
-        (5250 - 5330 @ 80), (23), DFS, AUTO-BW
+	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5735 - 5835 @ 80), (30)
 
 country VI: DFS-FCC
@@ -1478,7 +1479,7 @@ country VI: DFS-FCC
 	(5735 - 5835 @ 80), (30)
 
 country VN: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24)
 	(5250 - 5330 @ 80), (24), DFS
 	(5490 - 5730 @ 80), (24), DFS
@@ -1487,42 +1488,42 @@ country VN: DFS-FCC
 	(57240 - 65880 @ 2160), (40)
 
 country VU: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
 	(5735 - 5835 @ 80), (30)
 
 country WF: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country WS: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 40), (23)
 	(5250 - 5330 @ 40), (23), DFS
 	(5490 - 5710 @ 40), (30), DFS
 
 country XA: DFS-JP
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(2474 - 2494 @ 20), (20), NO-OFDM
 	(5170 - 5250 @ 80), (20), NO-IR, AUTO-BW, NO-OUTDOOR
 	(5250 - 5330 @ 80), (20), DFS, AUTO-BW, NO-OUTDOOR
 	(5490 - 5710 @ 160), (20), DFS
 
 country YE:
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 
 country YT: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
 
 country ZA: DFS-FCC
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (24), AUTO-BW
 	(5250 - 5330 @ 80), (24), DFS, AUTO-BW
 	(5490 - 5730 @ 160), (24), DFS
@@ -1531,7 +1532,7 @@ country ZA: DFS-FCC
 	(57240 - 65880 @ 2160), (40), NO-OUTDOOR
 
 country ZW: DFS-ETSI
-	(2402 - 2482 @ 40), (20)
+	(2402 - 2482 @ 40), (23)
 	(5170 - 5250 @ 80), (23), AUTO-BW
 	(5250 - 5330 @ 80), (23), DFS, AUTO-BW
 	(5490 - 5710 @ 160), (30), DFS
diff --git a/scripts/checkpatch.pl b/scripts/checkpatch.pl
old mode 100755
new mode 100644
index 2e879e714be222e1abe7b25eba3f2b6334904e97..4d9179bb62d5284571686221795ff39d26f91fd2
--- a/scripts/checkpatch.pl
+++ b/scripts/checkpatch.pl
@@ -2774,16 +2774,16 @@ sub process {
 		}
 
 # Check for added, moved or deleted files
-		if (!$reported_maintainer_file && !$in_commit_log &&
-		    ($line =~ /^(?:new|deleted) file mode\s*\d+\s*$/ ||
-		     $line =~ /^rename (?:from|to) [\w\/\.\-]+\s*$/ ||
-		     ($line =~ /\{\s*([\w\/\.\-]*)\s*\=\>\s*([\w\/\.\-]*)\s*\}/ &&
-		      (defined($1) || defined($2))))) {
-			$is_patch = 1;
-			$reported_maintainer_file = 1;
-			WARN("FILE_PATH_CHANGES",
-			     "added, moved or deleted file(s), does MAINTAINERS need updating?\n" . $herecurr);
-		}
+#		if (!$reported_maintainer_file && !$in_commit_log &&
+#		    ($line =~ /^(?:new|deleted) file mode\s*\d+\s*$/ ||
+#		     $line =~ /^rename (?:from|to) [\w\/\.\-]+\s*$/ ||
+#		     ($line =~ /\{\s*([\w\/\.\-]*)\s*\=\>\s*([\w\/\.\-]*)\s*\}/ &&
+#		      (defined($1) || defined($2))))) {
+#			$is_patch = 1;
+#			$reported_maintainer_file = 1;
+#			WARN("FILE_PATH_CHANGES",
+#			     "added, moved or deleted file(s), does MAINTAINERS need updating?\n" . $herecurr);
+#		}
 
 #check the patch for invalid author credentials
 		if ($chk_author && $line =~ /^From:.*(quicinc|qualcomm)\.com/) {
@@ -3727,6 +3727,11 @@ sub process {
 			}
 		}
 
+		if ($rawline =~ /\bVENDOR_EDIT\b/) {
+			WARN("VENDOR_EDIT",
+			     "Please remove VENDOR_EDIT before you commit it\n" . $herecurr);
+		}
+
 #
 # Checks which are anchored on the added line.
 #
diff --git a/sound/usb/usb_audio_qmi_svc.c b/sound/usb/usb_audio_qmi_svc.c
index 64e403ed4febdc214ad9dc6b6061c56e8acc3459..18f858e19a90203c6b2601209d172f1f68d2e476 100644
--- a/sound/usb/usb_audio_qmi_svc.c
+++ b/sound/usb/usb_audio_qmi_svc.c
@@ -1249,7 +1249,6 @@ static void uaudio_qmi_svc_disconnect_cb(struct qmi_handle *handle,
 {
 	struct uaudio_qmi_svc *svc = uaudio_svc;
 
-	uaudio_dbg("client node:%x port:%x\n", node, port);
 	if (svc->uaudio_svc_hdl != handle) {
 		uaudio_err("handle mismatch\n");
 		return;